76 lines
2.8 KiB
C++
76 lines
2.8 KiB
C++
#include "PusTcCreator.h"
|
|
|
|
#include "PusTcIF.h"
|
|
#include "fsfw/globalfunctions/CRC.h"
|
|
#include "fsfw/serialize/SerializeAdapter.h"
|
|
|
|
PusTcCreator::PusTcCreator(SpacePacketParams spParams, PusTcParams pusParams)
|
|
: spCreator(spParams), pusParams(pusParams) {
|
|
updateSpLengthField();
|
|
}
|
|
|
|
ReturnValue_t PusTcCreator::serialize(uint8_t **buffer, size_t *size, size_t maxSize,
|
|
SerializeIF::Endianness streamEndianness) const {
|
|
if (*size + PusTcIF::MIN_LEN + pusParams.appDataLen > maxSize) {
|
|
return SerializeIF::BUFFER_TOO_SHORT;
|
|
}
|
|
ReturnValue_t result = spCreator.serialize(buffer, size, maxSize, streamEndianness);
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
|
return result;
|
|
}
|
|
if (pusParams.pusVersion != ecss::PusVersion::PUS_C) {
|
|
// TODO: Dedicated returnvalue
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
**buffer = pusParams.pusVersion << 4 | pusParams.ackFlags;
|
|
*buffer += 1;
|
|
**buffer = pusParams.service;
|
|
*buffer += 1;
|
|
**buffer = pusParams.subservice;
|
|
*buffer += 1;
|
|
result =
|
|
SerializeAdapter::serialize(&pusParams.sourceId, buffer, size, maxSize, streamEndianness);
|
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
|
return result;
|
|
}
|
|
std::memcpy(*buffer, pusParams.appData, pusParams.appDataLen);
|
|
*buffer += pusParams.appDataLen;
|
|
*size += pusParams.appDataLen;
|
|
uint16_t crc16 = CRC::crc16ccitt(*buffer, getFullPacketLen() - 2);
|
|
return SerializeAdapter::serialize(&crc16, buffer, size, maxSize, streamEndianness);
|
|
}
|
|
|
|
void PusTcCreator::updateSpLengthField() {
|
|
spCreator.setDataLen(ecss::PusTcDataFieldHeader::MIN_LEN + pusParams.appDataLen + 1);
|
|
}
|
|
|
|
size_t PusTcCreator::getSerializedSize() const { return spCreator.getFullPacketLen(); }
|
|
|
|
ReturnValue_t PusTcCreator::deSerialize(const uint8_t **buffer, size_t *size,
|
|
SerializeIF::Endianness streamEndianness) {
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
|
|
uint16_t PusTcCreator::getPacketIdRaw() const { return spCreator.getPacketIdRaw(); }
|
|
|
|
uint16_t PusTcCreator::getPacketSeqCtrlRaw() const { return spCreator.getPacketSeqCtrlRaw(); }
|
|
|
|
uint16_t PusTcCreator::getPacketDataLen() const { return spCreator.getPacketDataLen(); }
|
|
|
|
uint8_t PusTcCreator::getPusVersion() const { return pusParams.pusVersion; }
|
|
|
|
uint8_t PusTcCreator::getAcknowledgeFlags() const { return pusParams.ackFlags; }
|
|
|
|
uint8_t PusTcCreator::getService() const { return pusParams.service; }
|
|
|
|
uint8_t PusTcCreator::getSubService() const { return pusParams.subservice; }
|
|
|
|
uint16_t PusTcCreator::getSourceId() const { return pusParams.sourceId; }
|
|
|
|
const uint8_t *PusTcCreator::getUserData(size_t &appDataLen) const {
|
|
appDataLen = getUserDataSize();
|
|
return pusParams.appData;
|
|
}
|
|
|
|
uint16_t PusTcCreator::getUserDataSize() const { return pusParams.appDataLen; }
|