some bugfixes

linux/devices/ploc/PlocMPSoCHandler.cpp

@@ -410,7 +410,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcMemWrite(const uint8_t* commandData,
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcMemWrite.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -424,7 +424,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcMemRead(const uint8_t* commandData,
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcMemRead.getFullPacketLen());
   tmMemReadReport.rememberRequestedSize = tcMemRead.getMemLen() * 4 + TmMemReadReport::FIX_SIZE;
   return RETURN_OK;
 }
@@ -443,7 +443,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcFlashDelete(const uint8_t* commandData,
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcFlashDelete.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -457,7 +457,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcReplayStart(const uint8_t* commandData,
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcReplayStart.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -470,7 +470,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcReplayStop() {
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcReplayStop.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -484,7 +484,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcDownlinkPwrOn(const uint8_t* commandDat
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcDownlinkPwrOn.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -497,7 +497,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcDownlinkPwrOff() {
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcDownlinkPwrOff.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -511,7 +511,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcReplayWriteSequence(const uint8_t* comm
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcReplayWriteSeq.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -524,7 +524,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcModeReplay() {
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcModeReplay.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -537,7 +537,7 @@ ReturnValue_t PlocMPSoCHandler::prepareTcModeIdle() {
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcModeIdle.getFullPacketLen());
   return RETURN_OK;
 }
 
@@ -551,17 +551,19 @@ ReturnValue_t PlocMPSoCHandler::prepareTcCamCmdSend(const uint8_t* commandData,
     sequenceCount--;
     return result;
   }
-  finishTcPrep();
+  finishTcPrep(tcCamCmdSend.getFullPacketLen());
   nextReplyId = mpsoc::TM_CAM_CMD_RPT;
   return RETURN_OK;
 }
 
-void PlocMPSoCHandler::finishTcPrep() { nextReplyId = mpsoc::ACK_REPORT; }
+void PlocMPSoCHandler::finishTcPrep(size_t packetLen) {
+  nextReplyId = mpsoc::ACK_REPORT;
+  rawPacket = commandBuffer;
+  rawPacketLen = packetLen;
+}
 
 ReturnValue_t PlocMPSoCHandler::verifyPacket(const uint8_t* start, size_t foundLen) {
-  uint16_t receivedCrc = *(start + foundLen - 2) << 8 | *(start + foundLen - 1);
-  uint16_t recalculatedCrc = CRC::crc16ccitt(start, foundLen - 2);
-  if (receivedCrc != recalculatedCrc) {
+  if (CRC::crc16ccitt(start, foundLen) != 0) {
     return MPSoCReturnValuesIF::CRC_FAILURE;
   }
   return RETURN_OK;
@@ -683,7 +685,7 @@ ReturnValue_t PlocMPSoCHandler::handleCamCmdRpt(const uint8_t* data) {
       reinterpret_cast<const char*>(dataFieldPtr),
       tmCamCmdRpt.rememberSpacePacketSize - mpsoc::SPACE_PACKET_HEADER_SIZE - sizeof(uint16_t) - 3);
 #if OBSW_DEBUG_PLOC_MPSOC == 1
-  uint8_t ackValue = *(packet.getPacketData() + packet.getPacketDataLength() - 2);
+  uint8_t ackValue = *(packetReader.getPacketData() + packetReader.getPacketDataLen() - 2);
   sif::info << "PlocMPSoCHandler: CamCmdRpt message: " << camCmdRptMsg << std::endl;
   sif::info << "PlocMPSoCHandler: CamCmdRpt Ack value: 0x" << std::hex
             << static_cast<unsigned int>(ackValue) << std::endl;