finally it works

linux/csp/CspComIF.cpp

@@ -3,6 +3,8 @@
 #include <csp/drivers/can_socketcan.h>
 #include <fsfw/serialize/SerializeAdapter.h>
 #include <fsfw/serviceinterface/ServiceInterfaceStream.h>
+#include <mission/devices/devicedefinitions/GomspaceDefinitions.h>
+#include <p60pdu.h>
 
 #include "CspCookie.h"
 
@@ -65,44 +67,56 @@ ReturnValue_t CspComIF::initializeInterface(CookieIF* cookie) {
     /* Insert device information in CSP map */
     cspDeviceMap.emplace(cspAddress, vectorBuffer(maxReplyLength));
   }
-
   return HasReturnvaluesIF::RETURN_OK;
 }
 
 ReturnValue_t CspComIF::sendMessage(CookieIF* cookie, const uint8_t* sendData, size_t sendLen) {
   int result;
-  if (cookie == NULL) {
+  if (cookie == nullptr) {
     return HasReturnvaluesIF::RETURN_FAILED;
   }
   CspCookie* cspCookie = dynamic_cast<CspCookie*>(cookie);
-  if (cspCookie == NULL) {
+  if (cspCookie == nullptr) {
     return HasReturnvaluesIF::RETURN_FAILED;
   }
 
-  /* Extract csp port and bytes to query from command buffer */
   uint8_t cspPort;
   uint16_t querySize = 0;
-  result = getPortAndQuerySize(&sendData, &sendLen, &cspPort, &querySize);
-  if (result != HasReturnvaluesIF::RETURN_OK) {
-    return result;
+  if(cspCookie->getRequest() == CspCookie::SpecialRequestTypes::DEFAULT_COM_IF) {
+    /* Extract csp port and bytes to query from command buffer */
+    result = getPortAndQuerySize(&sendData, &sendLen, &cspPort, &querySize);
+    if (result != HasReturnvaluesIF::RETURN_OK) {
+      return result;
+    }
+  } else {
+    cspPort = cspCookie->getCspPort();
+    querySize = cspCookie->getReplyLen();
   }
   uint8_t cspAddress = cspCookie->getCspAddress();
   switch (cspPort) {
-    case (Ports::CSP_PING): {
+    case (GOMSPACE::CspPorts::CSP_PING): {
       initiatePingRequest(cspAddress, querySize);
       break;
     }
-    case (Ports::CSP_REBOOT): {
+    case (GOMSPACE::CspPorts::CSP_REBOOT): {
       csp_reboot(cspAddress);
       break;
     }
-    case (Ports::P60_PORT_GNDWDT_RESET):
-    case (Ports::P60_PORT_RPARAM): {
-      /* No CSP fixed port was selected. Send data to the specified port and
-       * wait for querySize number of bytes */
-      result = cspTransfer(cspAddress, cspPort, sendData, sendLen, querySize);
-      if (result != HasReturnvaluesIF::RETURN_OK) {
-        return HasReturnvaluesIF::RETURN_FAILED;
+    case (GOMSPACE::CspPorts::P60_PORT_GNDWDT_RESET_ENUM):
+    case (GOMSPACE::CspPorts::P60_PORT_RPARAM_ENUM): {
+      if(cspCookie->getRequest() == CspCookie::SpecialRequestTypes::GET_PDU_HK) {
+        param_index_t requestStruct{};
+        requestStruct.physaddr = cspDeviceMap[cspAddress].data();
+        if(!p60pdu_get_hk(&requestStruct, cspAddress, cspCookie->getTimeout())) {
+          return HasReturnvaluesIF::RETURN_FAILED;
+        }
+      } else {
+        /* No CSP fixed port was selected. Send data to the specified port and
+         * wait for querySize number of bytes */
+        result = cspTransfer(cspAddress, cspPort, sendData, sendLen, querySize);
+        if (result != HasReturnvaluesIF::RETURN_OK) {
+          return HasReturnvaluesIF::RETURN_FAILED;
+        }
       }
       replySize = querySize;
       break;