33 lines
1.0 KiB
C++
33 lines
1.0 KiB
C++
#include "PusTmZcWriter.h"
|
|
|
|
#include "fsfw/globalfunctions/CRC.h"
|
|
|
|
PusTmZeroCopyWriter::PusTmZeroCopyWriter(TimeReaderIF& timeReader, uint8_t* data, size_t size)
|
|
: PusTmReader(&timeReader, data, size) {}
|
|
|
|
void PusTmZeroCopyWriter::setSequenceCount(uint16_t seqCount) {
|
|
if (isNull()) {
|
|
return;
|
|
}
|
|
auto* spHeader =
|
|
reinterpret_cast<ccsds::PrimaryHeader*>(const_cast<uint8_t*>((pointers.spHeaderStart)));
|
|
ccsds::setSequenceCount(*spHeader, seqCount);
|
|
}
|
|
|
|
void PusTmZeroCopyWriter::updateErrorControl() {
|
|
if (isNull()) {
|
|
return;
|
|
}
|
|
auto* crcStart = const_cast<uint8_t*>((pointers.crcStart));
|
|
uint16_t crc16 =
|
|
CRC::crc16ccitt(PusTmReader::getFullData(), getFullPacketLen() - sizeof(ecss::PusChecksumT));
|
|
crcStart[0] = (crc16 >> 8) & 0xff;
|
|
crcStart[1] = crc16 & 0xff;
|
|
}
|
|
|
|
void PusTmZeroCopyWriter::setMessageCount(uint16_t msgCount) {
|
|
size_t serSize = 0;
|
|
SerializeAdapter::serialize(&msgCount, const_cast<uint8_t*>(pointers.secHeaderStart + 3),
|
|
&serSize, 2, SerializeIF::Endianness::NETWORK);
|
|
}
|