imtq assy added

mission/system/objects/CMakeLists.txt

@@ -7,6 +7,7 @@ target_sources(
           TcsSubsystem.cpp
           PayloadSubsystem.cpp
           AcsBoardAssembly.cpp
+          ImtqAssembly.cpp
           Stack5VHandler.cpp
           SusAssembly.cpp
           RwAssembly.cpp

mission/system/objects/ImtqAssembly.cpp

@@ -1 +1,46 @@
 #include "ImtqAssembly.h"
+
+#include <eive/objects.h>
+
+using namespace returnvalue;
+
+ImtqAssembly::ImtqAssembly(object_id_t objectId) : AssemblyBase(objectId) {}
+
+ReturnValue_t ImtqAssembly::commandChildren(Mode_t mode, Submode_t submode) {
+  commandTable[0].setMode(mode);
+  commandTable[0].setSubmode(submode);
+  if (recoveryState == RECOVERY_IDLE) {
+    ReturnValue_t result = checkAndHandleHealthState(mode, submode);
+    if (result == NEED_TO_CHANGE_HEALTH) {
+      return OK;
+    }
+  }
+  HybridIterator<ModeListEntry> iter(commandTable.begin(), commandTable.end());
+  executeTable(iter);
+  return returnvalue::OK;
+}
+
+ReturnValue_t ImtqAssembly::checkChildrenStateOn(Mode_t wantedMode, Submode_t wantedSubmode) {
+  if (childrenMap[objects::IMTQ_HANDLER].mode != wantedMode) {
+    return NOT_ENOUGH_CHILDREN_IN_CORRECT_STATE;
+  }
+  return returnvalue::OK;
+}
+
+ReturnValue_t ImtqAssembly::isModeCombinationValid(Mode_t mode, Submode_t submode) {
+  if (mode == MODE_ON or mode == DeviceHandlerIF::MODE_NORMAL or mode == MODE_OFF) {
+    return returnvalue::OK;
+  }
+  return returnvalue::FAILED;
+}
+
+ReturnValue_t ImtqAssembly::checkAndHandleHealthState(Mode_t deviceMode, Submode_t deviceSubmode) {
+  HealthState health = healthHelper.healthTable->getHealth(objects::SYRLINKS_HANDLER);
+  if (health == FAULTY or health == PERMANENT_FAULTY) {
+    overwriteDeviceHealth(objects::SYRLINKS_HANDLER, health);
+    return NEED_TO_CHANGE_HEALTH;
+  } else if (health == EXTERNAL_CONTROL) {
+    modeHelper.setForced(true);
+  }
+  return OK;
+}

mission/system/objects/ImtqAssembly.h

@@ -1,15 +1,17 @@
-/*
- * ImtqAssembly.h
- *
- *  Created on: Mar 2, 2023
- *      Author: rmueller
- */
+#pragma once
 
-#ifndef MISSION_SYSTEM_OBJECTS_IMTQASSEMBLY_H_
-#define MISSION_SYSTEM_OBJECTS_IMTQASSEMBLY_H_
+#include <fsfw/devicehandlers/AssemblyBase.h>
 
+class ImtqAssembly : public AssemblyBase {
+ public:
+  ImtqAssembly(object_id_t objectId);
 
+ private:
+  FixedArrayList<ModeListEntry, 1> commandTable;
 
+  ReturnValue_t commandChildren(Mode_t mode, Submode_t submode) override;
+  ReturnValue_t checkChildrenStateOn(Mode_t wantedMode, Submode_t wantedSubmode) override;
+  ReturnValue_t isModeCombinationValid(Mode_t mode, Submode_t submode) override;
 
-
-#endif /* MISSION_SYSTEM_OBJECTS_IMTQASSEMBLY_H_ */
+  ReturnValue_t checkAndHandleHealthState(Mode_t deviceMode, Submode_t deviceSubmode);
+};