dynamic switching of cadu data sample time and clock manipulation

mission/tmtc/CCSDSHandler.cpp

@@ -1,6 +1,7 @@
 #include "CCSDSHandler.h"
 
 #include <linux/obc/PdecHandler.h>
+#include <linux/obc/PtmeConfig.h>
 
 #include "fsfw/events/EventManagerIF.h"
 #include "fsfw/ipc/QueueFactory.h"
@@ -10,14 +11,14 @@
 #include "fsfw/serviceinterface/serviceInterfaceDefintions.h"
 
 CCSDSHandler::CCSDSHandler(object_id_t objectId, object_id_t ptmeId, object_id_t tcDestination,
-                           TxRateSetterIF* txRateSetterIF, GpioIF* gpioIF, gpioId_t enTxClock,
+                           PtmeConfig* ptmeConfig, GpioIF* gpioIF, gpioId_t enTxClock,
                            gpioId_t enTxData)
     : SystemObject(objectId),
       ptmeId(ptmeId),
       tcDestination(tcDestination),
       parameterHelper(this),
       actionHelper(this, nullptr),
-      txRateSetterIF(txRateSetterIF),
+      ptmeConfig(ptmeConfig),
       gpioIF(gpioIF),
       enTxClock(enTxClock),
       enTxData(enTxData) {
@@ -111,6 +112,15 @@ ReturnValue_t CCSDSHandler::initialize() {
 #endif
     return result;
   }
+  result = ptmeConfig->initialize();
+  if (result != RETURN_OK) {
+    return ObjectManagerIF::CHILD_INIT_FAILED;
+  }
+
+#if OBSW_SYRLINKS_SIMULATED == 1
+  ptmeConfig->invertTxClock(true);
+#endif /* OBSW_SYRLINKS_SIMULATED == 1*/
+
   return result;
 }
 
@@ -193,27 +203,43 @@ ReturnValue_t CCSDSHandler::executeAction(ActionId_t actionId, MessageQueueId_t
   ReturnValue_t result = RETURN_OK;
   switch (actionId) {
     case SET_LOW_RATE: {
-      result = txRateSetterIF->setRate(RATE_100KBPS);
+      result = ptmeConfig->setRate(RATE_100KBPS);
       break;
     }
     case SET_HIGH_RATE: {
-      result = txRateSetterIF->setRate(RATE_500KBPS);
+      result = ptmeConfig->setRate(RATE_500KBPS);
       break;
     }
     case ARBITRARY_RATE: {
       uint32_t bitrate = 0;
       SerializeAdapter::deSerialize(&bitrate, &data, &size, SerializeIF::Endianness::BIG);
-      result = txRateSetterIF->setRate(bitrate);
+      result = ptmeConfig->setRate(bitrate);
       break;
     }
     case EN_TRANSMITTER: {
       enableTransmit();
       return EXECUTION_FINISHED;
     }
-    case DIS_TRANSMITTER: {
+    case DISABLE_TRANSMITTER: {
       disableTransmit();
       return EXECUTION_FINISHED;
     }
+    case ENABLE_TX_CLK_MANIPULATOR: {
+      result = ptmeConfig->configTxManipulator(true);
+      break;
+    }
+    case DISABLE_TX_CLK_MANIPULATOR: {
+      result = ptmeConfig->configTxManipulator(false);
+      break;
+    }
+    case UPDATE_ON_RISING_EDGE: {
+      result = ptmeConfig->invertTxClock(false);
+      break;
+    }
+    case UPDATE_ON_FALLING_EDGE: {
+      result = ptmeConfig->invertTxClock(true);
+      break;
+    }
     default:
       return COMMAND_NOT_IMPLEMENTED;
   }