eive-obsw/linux/payload/ScexHelper.cpp

86 lines
2.5 KiB
C++
Raw Normal View History

2022-04-21 19:47:09 +02:00
#include <fsfw/globalfunctions/CRC.h>
2023-03-26 16:42:00 +02:00
#include <linux/payload/ScexHelper.h>
2022-04-21 19:47:09 +02:00
#include "fsfw/serviceinterface.h"
2022-08-29 16:05:05 +02:00
using namespace returnvalue;
2022-04-21 19:47:09 +02:00
ScexHelper::ScexHelper() {}
ReturnValue_t ScexHelper::serialize(uint8_t** buffer, size_t* size, size_t maxSize,
Endianness streamEndianness) const {
2022-08-29 16:05:05 +02:00
return FAILED;
2022-04-21 19:47:09 +02:00
}
size_t ScexHelper::getSerializedSize() const { return totalPacketLen; }
ReturnValue_t ScexHelper::deSerialize(const uint8_t** buffer, size_t* size,
Endianness streamEndianness) {
if (buffer == nullptr or size == nullptr) {
2022-08-29 16:05:05 +02:00
return FAILED;
2022-04-21 19:47:09 +02:00
}
if (*size < 7) {
return STREAM_TOO_SHORT;
}
start = *buffer;
cmdByteRaw = **buffer;
2022-04-29 15:46:16 +02:00
cmd = static_cast<scex::Cmds>((cmdByteRaw >> 1) & 0b11111);
2022-04-21 19:47:09 +02:00
*buffer += 1;
packetCounter = **buffer;
*buffer += 1;
totalPacketCounter = **buffer;
*buffer += 1;
payloadLen = (**buffer << 8) | *(*buffer + 1);
*buffer += 2;
2022-05-19 11:56:59 +02:00
payloadStart = *buffer;
2022-04-29 15:46:16 +02:00
totalPacketLen = payloadLen + scex::HEADER_LEN + scex::CRC_LEN;
2022-04-21 19:47:09 +02:00
if (totalPacketLen >= *size) {
return STREAM_TOO_SHORT;
}
*buffer += payloadLen;
crc = (**buffer << 8) | *(*buffer + 1);
if (CRC::crc16ccitt(start, totalPacketLen) != 0) {
return INVALID_CRC;
}
2022-08-29 16:05:05 +02:00
return OK;
2022-04-21 19:47:09 +02:00
}
2022-04-29 15:46:16 +02:00
scex::Cmds ScexHelper::getCmd() const { return cmd; }
2022-04-21 19:47:09 +02:00
uint8_t ScexHelper::getCmdByteRaw() const { return cmdByteRaw; }
uint16_t ScexHelper::getCrc() const { return crc; }
size_t ScexHelper::getExpectedPacketLen() const { return totalPacketLen; }
uint8_t ScexHelper::getPacketCounter() const { return packetCounter; }
uint16_t ScexHelper::getPayloadLen() const { return payloadLen; }
const uint8_t* ScexHelper::getStart() const { return start; }
uint8_t ScexHelper::getTotalPacketCounter() const { return totalPacketCounter; }
std::ostream& operator<<(std::ostream& os, const ScexHelper& h) {
using namespace std;
sif::info << "Command Byte Raw: 0x" << std::setw(2) << std::setfill('0') << std::hex
<< (int)h.cmdByteRaw << " | Command: 0x" << std::setw(2) << std::setfill('0')
<< std::hex << static_cast<int>(h.cmd) << std::dec << std::endl;
sif::info << "PacketCounter: " << h.packetCounter << endl;
sif::info << "TotalPacketCount: " << h.totalPacketCounter << endl;
sif::info << "PayloadLength: " << h.payloadLen << endl;
2022-04-27 18:21:32 +02:00
sif::info << "TotalPacketLength: " << h.totalPacketLen;
2022-04-21 19:47:09 +02:00
return os;
}
std::ofstream& operator<<(std::ofstream& of, const ScexHelper& h) {
of.write(reinterpret_cast<const char*>(h.start), h.getSerializedSize());
return of;
}