Add MTQ magnetometer interference

ut-issl · Oct 12, 2023 · 6dffefc · 6dffefc
1 parent 200026f
commit 6dffefc
Show file tree

Hide file tree

Showing 2 changed files with 9 additions and 0 deletions.
diff --git a/src/simulation/spacecraft/aocs_module_components.cpp b/src/simulation/spacecraft/aocs_module_components.cpp
@@ -170,6 +170,12 @@ AocsModuleComponents::AocsModuleComponents(const Dynamics *dynamics, Structure *
   rw0003_z_ = new Rw0003(InitReactionWheel(clock_generator, power_controller_->GetPowerPort((int)PowerPortIdx::RWZ), 3, rw_ini_path, compo_step_sec),
                          1, rw0003_z_hils_port_id, i2c_address_z, aobc_, hils_port_manager_);
 
+
+  // Component interference
+  const std::string interference_file_path = ini_access.ReadString("COMPONENTS_FILES", "component_interference_file");
+  configuration_->main_logger_->CopyFileToLogDirectory(interference_file_path);
+  mtq_magnetometer_interference_ = new MtqMagnetometerInterference(interference_file_path, *rm3100_external_, *mtq_seiren_);
+
   // Thruster
   const std::string thruster_ini_path = ini_access.ReadString("COMPONENTS_FILE", "thruster_file");
   thruster_ = new SimpleThruster(InitSimpleThruster(clock_generator, 1, thruster_ini_path, structure_, dynamics_));

diff --git a/src/simulation/spacecraft/aocs_module_components.hpp b/src/simulation/spacecraft/aocs_module_components.hpp
@@ -25,6 +25,7 @@
 #include "../../component/aocs/rw0003.hpp"
 #include "../../component/aocs/sagitta.hpp"
 #include "../../component/aocs/stim210.hpp"
+#include <components/real/aocs/mtq_magnetometer_interference.hpp>
 // Propulsion
 #include <components/real/propulsion/simple_thruster.hpp>
 // Mission
@@ -97,6 +98,8 @@ class AocsModuleComponents : public InstalledComponents {
   Rw0003 *rw0003_x_;                           //!< RW00003 Reaction wheel X axis
   Rw0003 *rw0003_y_;                           //!< RW00003 Reaction wheel Y axis
   Rw0003 *rw0003_z_;                           //!< RW00003 Reaction wheel Z axis
+  // Component Interference
+  MtqMagnetometerInterference* mtq_magnetometer_interference_;  //!< Additional Bias noise by MTQ-Magnetometer interference
   // Thruster
   SimpleThruster *thruster_;  //!< Thruster
   // Mission