58 lines
1.8 KiB
C++
58 lines
1.8 KiB
C++
#include "SpacePacketReader.h"
|
|
|
|
#include "fsfw/serialize/SerializeIF.h"
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
SpacePacketReader::SpacePacketReader(const uint8_t* setAddress, size_t maxSize_) {
|
|
setInternalFields(setAddress, maxSize_);
|
|
}
|
|
|
|
ReturnValue_t SpacePacketReader::checkSize() const {
|
|
if (isNull()) {
|
|
return returnvalue::FAILED;
|
|
}
|
|
if (getFullPacketLen() > bufSize) {
|
|
return SerializeIF::STREAM_TOO_SHORT;
|
|
}
|
|
return returnvalue::OK;
|
|
}
|
|
|
|
SpacePacketReader::~SpacePacketReader() = default;
|
|
|
|
inline uint16_t SpacePacketReader::getPacketIdRaw() const { return ccsds::getPacketId(*spHeader); }
|
|
|
|
const uint8_t* SpacePacketReader::getPacketData() const { return packetDataField; }
|
|
|
|
ReturnValue_t SpacePacketReader::setData(uint8_t* data, size_t maxSize_, void* args) {
|
|
return setInternalFields(data, maxSize_);
|
|
}
|
|
|
|
uint16_t SpacePacketReader::getPacketSeqCtrlRaw() const {
|
|
return ccsds::getPacketSeqCtrl(*spHeader);
|
|
}
|
|
|
|
uint16_t SpacePacketReader::getPacketDataLen() const { return ccsds::getPacketLen(*spHeader); }
|
|
|
|
ReturnValue_t SpacePacketReader::setInternalFields(const uint8_t* data, size_t maxSize_) {
|
|
bufSize = maxSize_;
|
|
if (maxSize_ < ccsds::HEADER_LEN) {
|
|
return SerializeIF::STREAM_TOO_SHORT;
|
|
}
|
|
spHeader = reinterpret_cast<const ccsds::PrimaryHeader*>(data);
|
|
if (maxSize_ > ccsds::HEADER_LEN) {
|
|
packetDataField = data + ccsds::HEADER_LEN;
|
|
}
|
|
return checkSize();
|
|
}
|
|
|
|
const uint8_t* SpacePacketReader::getFullData() const {
|
|
return reinterpret_cast<const uint8_t*>(spHeader);
|
|
}
|
|
size_t SpacePacketReader::getBufSize() const { return bufSize; }
|
|
|
|
bool SpacePacketReader::isNull() const { return spHeader == nullptr; }
|
|
|
|
ReturnValue_t SpacePacketReader::setReadOnlyData(const uint8_t* data, size_t maxSize) {
|
|
return setData(const_cast<uint8_t*>(data), maxSize, nullptr);
|
|
}
|