verify successfull TM serialization
This commit is contained in:
@ -22,9 +22,9 @@ class TimeStamperIF : public SerializeIF {
|
||||
//! size reserved for timestamps.
|
||||
// static const uint8_t MISSION_TIMESTAMP_SIZE = fsfwconfig::FSFW_MISSION_TIMESTAMP_SIZE;
|
||||
|
||||
[[nodiscard]] virtual size_t getTimestampSize() const = 0;
|
||||
virtual ReturnValue_t addTimeStamp(uint8_t* buffer, uint8_t maxSize) = 0;
|
||||
[[nodiscard]] virtual size_t getTimestampSize() const { return getSerializedSize(); }
|
||||
|
||||
virtual ReturnValue_t addTimeStamp(uint8_t* buffer, uint8_t maxSize) = 0;
|
||||
~TimeStamperIF() override = default;
|
||||
};
|
||||
|
||||
|
@ -5,15 +5,12 @@
|
||||
#include "fsfw/globalfunctions/CRC.h"
|
||||
#include "fsfw/timemanager/TimeStamperIF.h"
|
||||
|
||||
PusTmCreator::PusTmCreator(SpacePacketParams initSpParams, PusTmParams initPusParams,
|
||||
TimeStamperIF* timeStamper)
|
||||
: pusParams(initPusParams), spCreator(std::move(initSpParams)) {}
|
||||
|
||||
PusTmCreator::PusTmCreator(TimeStamperIF* timeStamper_) {
|
||||
pusParams.secHeader.timeStamper = timeStamper_;
|
||||
PusTmCreator::PusTmCreator(SpacePacketParams initSpParams, PusTmParams initPusParams)
|
||||
: pusParams(initPusParams), spCreator(std::move(initSpParams)) {
|
||||
setup();
|
||||
}
|
||||
|
||||
PusTmCreator::PusTmCreator() = default;
|
||||
PusTmCreator::PusTmCreator() { setup(); }
|
||||
|
||||
uint16_t PusTmCreator::getPacketIdRaw() const { return spCreator.getPacketIdRaw(); }
|
||||
uint16_t PusTmCreator::getPacketSeqCtrlRaw() const { return spCreator.getPacketSeqCtrlRaw(); }
|
||||
@ -31,6 +28,7 @@ uint16_t PusTmCreator::getDestId() { return 0; }
|
||||
|
||||
ReturnValue_t PusTmCreator::serialize(uint8_t** buffer, size_t* size, size_t maxSize,
|
||||
SerializeIF::Endianness streamEndianness) const {
|
||||
const uint8_t* start = *buffer;
|
||||
if (*size + getSerializedSize() > maxSize) {
|
||||
return SerializeIF::BUFFER_TOO_SHORT;
|
||||
}
|
||||
@ -74,7 +72,7 @@ ReturnValue_t PusTmCreator::serialize(uint8_t** buffer, size_t* size, size_t max
|
||||
return result;
|
||||
}
|
||||
}
|
||||
uint16_t crc16 = CRC::crc16ccitt(*buffer, getFullPacketLen() - sizeof(ecss::PusChecksumT));
|
||||
uint16_t crc16 = CRC::crc16ccitt(start, getFullPacketLen() - sizeof(ecss::PusChecksumT));
|
||||
return SerializeAdapter::serialize(&crc16, buffer, size, maxSize, streamEndianness);
|
||||
}
|
||||
|
||||
@ -85,15 +83,25 @@ ReturnValue_t PusTmCreator::deSerialize(const uint8_t** buffer, size_t* size,
|
||||
}
|
||||
|
||||
ecss::DataWrapper& PusTmCreator::getDataWrapper() { return pusParams.dataWrapper; }
|
||||
TimeStamperIF* PusTmCreator::getTimestamper() { return pusParams.secHeader.timeStamper; }
|
||||
TimeStamperIF* PusTmCreator::getTimestamper() const { return pusParams.secHeader.timeStamper; }
|
||||
SpacePacketParams& PusTmCreator::getSpParams() { return spCreator.getParams(); }
|
||||
|
||||
void PusTmCreator::updateSpLengthField() {
|
||||
size_t headerLen = PusTmIF::MIN_SIZE;
|
||||
size_t headerLen = PusTmIF::MIN_SEC_HEADER_LEN + pusParams.dataWrapper.getLength() +
|
||||
sizeof(ecss::PusChecksumT) - 1;
|
||||
if (pusParams.secHeader.timeStamper != nullptr) {
|
||||
headerLen += pusParams.secHeader.timeStamper->getSerializedSize();
|
||||
}
|
||||
spCreator.setDataLen(headerLen + pusParams.dataWrapper.getLength() + 1);
|
||||
spCreator.setDataLen(headerLen);
|
||||
}
|
||||
|
||||
void PusTmCreator::setApid(uint16_t apid) { spCreator.setApid(apid); }
|
||||
|
||||
ReturnValue_t PusTmCreator::serialize(uint8_t** buffer, size_t* size, size_t maxSize) const {
|
||||
return serialize(buffer, size, maxSize, SerializeIF::Endianness::NETWORK);
|
||||
}
|
||||
|
||||
void PusTmCreator::setup() {
|
||||
updateSpLengthField();
|
||||
spCreator.setPacketType(ccsds::PacketType::TM);
|
||||
}
|
||||
|
@ -6,18 +6,35 @@
|
||||
#include "fsfw/tmtcpacket/pus/CreatorDataIF.h"
|
||||
|
||||
struct PusTmSecHeader {
|
||||
uint8_t pusVersion;
|
||||
uint8_t scTimeRefStatus;
|
||||
uint8_t service;
|
||||
uint8_t subservice;
|
||||
uint16_t messageTypeCounter;
|
||||
uint16_t destId;
|
||||
TimeStamperIF* timeStamper;
|
||||
PusTmSecHeader() = default;
|
||||
PusTmSecHeader(uint8_t service, uint8_t subservice, TimeStamperIF* timeStamper)
|
||||
: service(service), subservice(subservice), timeStamper(timeStamper) {}
|
||||
|
||||
uint8_t service = 0;
|
||||
uint8_t subservice = 0;
|
||||
TimeStamperIF* timeStamper = nullptr;
|
||||
uint8_t pusVersion = ecss::PusVersion::PUS_C;
|
||||
uint8_t scTimeRefStatus = 0;
|
||||
uint16_t messageTypeCounter = 0;
|
||||
uint16_t destId = 0;
|
||||
};
|
||||
|
||||
struct PusTmParams {
|
||||
PusTmParams() = default;
|
||||
explicit PusTmParams(PusTmSecHeader secHeader) : secHeader(secHeader){};
|
||||
PusTmParams(PusTmSecHeader secHeader, ecss::DataWrapper dataWrapper)
|
||||
: secHeader(secHeader), dataWrapper(dataWrapper) {}
|
||||
|
||||
PusTmParams(uint8_t service, uint8_t subservice, TimeStamperIF* timeStamper)
|
||||
: secHeader(service, subservice, timeStamper) {}
|
||||
|
||||
PusTmParams(uint8_t service, uint8_t subservice, TimeStamperIF* timeStamper,
|
||||
ecss::DataWrapper dataWrapper_)
|
||||
: PusTmParams(service, subservice, timeStamper) {
|
||||
dataWrapper = dataWrapper_;
|
||||
}
|
||||
PusTmSecHeader secHeader;
|
||||
ecss::DataWrapper dataWrapper;
|
||||
ecss::DataWrapper dataWrapper{};
|
||||
};
|
||||
|
||||
class TimeStamperIF;
|
||||
@ -25,10 +42,7 @@ class TimeStamperIF;
|
||||
class PusTmCreator : public SerializeIF, public PusTmIF, public CreatorDataIF {
|
||||
public:
|
||||
PusTmCreator();
|
||||
|
||||
explicit PusTmCreator(TimeStamperIF* timeStamper);
|
||||
PusTmCreator(SpacePacketParams initSpParams, PusTmParams initPusParams,
|
||||
TimeStamperIF* timeStamper);
|
||||
PusTmCreator(SpacePacketParams initSpParams, PusTmParams initPusParams);
|
||||
~PusTmCreator() override = default;
|
||||
|
||||
void setTimeStamper(TimeStamperIF* timeStamper);
|
||||
@ -45,17 +59,19 @@ class PusTmCreator : public SerializeIF, public PusTmIF, public CreatorDataIF {
|
||||
uint8_t getScTimeRefStatus() override;
|
||||
uint16_t getMessageTypeCounter() override;
|
||||
uint16_t getDestId() override;
|
||||
ReturnValue_t serialize(uint8_t** buffer, size_t* size, size_t maxSize) const;
|
||||
ReturnValue_t serialize(uint8_t** buffer, size_t* size, size_t maxSize,
|
||||
Endianness streamEndianness) const override;
|
||||
[[nodiscard]] size_t getSerializedSize() const override;
|
||||
ReturnValue_t deSerialize(const uint8_t** buffer, size_t* size,
|
||||
Endianness streamEndianness) override;
|
||||
TimeStamperIF* getTimestamper();
|
||||
[[nodiscard]] TimeStamperIF* getTimestamper() const;
|
||||
|
||||
private:
|
||||
ecss::DataWrapper& getDataWrapper() override;
|
||||
|
||||
private:
|
||||
void setup();
|
||||
PusTmParams pusParams{};
|
||||
SpacePacketCreator spCreator;
|
||||
};
|
||||
|
@ -4,12 +4,12 @@
|
||||
|
||||
TmStoreHelper::TmStoreHelper(uint16_t defaultApid, StorageManagerIF* tmStore,
|
||||
TimeStamperIF* timeStamper)
|
||||
: creator(timeStamper), tmStore(tmStore) {
|
||||
: tmStore(tmStore) {
|
||||
creator.setApid(defaultApid);
|
||||
creator.setTimeStamper(timeStamper);
|
||||
}
|
||||
|
||||
TmStoreHelper::TmStoreHelper(uint16_t defaultApid, StorageManagerIF* tmStore)
|
||||
: creator(nullptr), tmStore(tmStore) {
|
||||
TmStoreHelper::TmStoreHelper(uint16_t defaultApid, StorageManagerIF* tmStore) : tmStore(tmStore) {
|
||||
creator.setApid(defaultApid);
|
||||
}
|
||||
|
||||
|
Reference in New Issue
Block a user