added SUS datapool to AcsController

mission/controller/AcsController.cpp

@@ -3,7 +3,7 @@
 #include <fsfw/datapool/PoolReadGuard.h>
 
 AcsController::AcsController(object_id_t objectId)
-    : ExtendedControllerBase(objectId, objects::NO_OBJECT), mgmData(this) {}
+    : ExtendedControllerBase(objectId, objects::NO_OBJECT), mgmData(this), susData(this) {}
 
 ReturnValue_t AcsController::handleCommandMessage(CommandMessage *message) {
   return returnvalue::OK;
@@ -35,6 +35,12 @@ void AcsController::performControlOperation() {
       copyMgmData();
     }
   }
+  {
+    PoolReadGuard pg(&susData);
+    if (pg.getReadResult() == returnvalue::OK) {
+      copySusData();
+    }
+  }
 }
 
 ReturnValue_t AcsController::initializeLocalDataPool(localpool::DataPool &localDataPoolMap,
@@ -94,3 +100,78 @@ void AcsController::copyMgmData() {
     }
   }
 }
+
+void AcsController::copySusData() {
+  {
+    PoolReadGuard pg(&susSets[0]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus0.value, susSets[0].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[1]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus1.value, susSets[1].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[2]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus2.value, susSets[2].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[3]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus3.value, susSets[3].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[4]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus4.value, susSets[4].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[5]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus5.value, susSets[5].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[6]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus6.value, susSets[6].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[7]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus7.value, susSets[7].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[8]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus8.value, susSets[8].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[9]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus9.value, susSets[9].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[10]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus10.value, susSets[10].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+  {
+    PoolReadGuard pg(&susSets[11]);
+    if (pg.getReadResult() == returnvalue::OK) {
+      std::memcpy(susData.sus11.value, susSets[11].channels.value, 6 * sizeof(uint16_t));
+    }
+  }
+}