Merge pull request #617 from ut-issl/feature/add_relative_velocity_di…

…rection_pointing
ut-issl · Mar 20, 2024 · d53e900 · d53e900
2 parents ccc3b96 + a0d516c
commit d53e900
Show file tree

Hide file tree

Showing 3 changed files with 13 additions and 6 deletions.
diff --git a/data/sample/initialize_files/sample_satellite.ini b/data/sample/initialize_files/sample_satellite.ini
@@ -33,6 +33,7 @@ initial_torque_b_Nm(2) = 0.000
 // SUN_POINTING
 // EARTH_CENTER_POINTING
 // VELOCITY_DIRECTION_POINTING
+// GROUND_SPEED_DIRECTION_POINTING
 // ORBIT_NORMAL_POINTING
 main_mode = INERTIAL_STABILIZE
 sub_mode = SUN_POINTING

diff --git a/src/dynamics/attitude/controlled_attitude.cpp b/src/dynamics/attitude/controlled_attitude.cpp
@@ -93,6 +93,9 @@ libra::Vector<3> ControlledAttitude::CalcTargetDirection_i(AttitudeControlMode m
  }
  } else if (mode == AttitudeControlMode::kVelocityDirectionPointing) {
  direction = orbit_->GetVelocity_i_m_s();
+ } else if (mode == AttitudeControlMode::kGroundSpeedDirectionPointing) {
+ libra::Matrix<3, 3> dcm_ecef2eci = local_celestial_information_->GetGlobalInformation().GetEarthRotation().GetDcmJ2000ToEcef().Transpose();
+ direction = dcm_ecef2eci * orbit_->GetVelocity_ecef_m_s();
  } else if (mode == AttitudeControlMode::kOrbitNormalPointing) {
  direction = OuterProduct(orbit_->GetPosition_i_m(), orbit_->GetVelocity_i_m_s());
  }
@@ -140,6 +143,8 @@ AttitudeControlMode ConvertStringToCtrlMode(const std::string mode) {
  return AttitudeControlMode::kEarthCenterPointing;
  } else if (mode == "VELOCITY_DIRECTION_POINTING") {
  return AttitudeControlMode::kVelocityDirectionPointing;
+ } else if (mode == "GROUND_SPEED_DIRECTION_POINTING") {
+ return AttitudeControlMode::kGroundSpeedDirectionPointing;
  } else if (mode == "ORBIT_NORMAL_POINTING") {
  return AttitudeControlMode::kOrbitNormalPointing;
  } else {

diff --git a/src/dynamics/attitude/controlled_attitude.hpp b/src/dynamics/attitude/controlled_attitude.hpp
@@ -18,12 +18,13 @@
  * @brief Attitude control mode
  */
 enum class AttitudeControlMode {
- kInertialStabilize, //!< Inertial stabilize
- kSunPointing, //!< Sun pointing
- kEarthCenterPointing, //!< Earth center pointing
- kVelocityDirectionPointing, //!< Spacecraft velocity direction pointing
- kOrbitNormalPointing, //!< Orbit normal direction pointing
- kNoControl, // No Control
+ kInertialStabilize, //!< Inertial stabilize
+ kSunPointing, //!< Sun pointing
+ kEarthCenterPointing, //!< Earth center pointing
+ kVelocityDirectionPointing, //!< Spacecraft velocity direction pointing
+ kGroundSpeedDirectionPointing, //!< Ground speed direction pointing
+ kOrbitNormalPointing, //!< Orbit normal direction pointing
+ kNoControl, // No Control
 };
 
 /**