54 lines
1.7 KiB
C++
54 lines
1.7 KiB
C++
#include "fsfw/timemanager/CdsShortTimeStamper.h"
|
|
|
|
#include <cstring>
|
|
|
|
#include "fsfw/timemanager/Clock.h"
|
|
|
|
CdsShortTimeStamper::CdsShortTimeStamper() : SystemObject(0, false) {}
|
|
|
|
CdsShortTimeStamper::CdsShortTimeStamper(object_id_t objectId) : SystemObject(objectId) {}
|
|
|
|
ReturnValue_t CdsShortTimeStamper::serialize(uint8_t **buffer, size_t *size, size_t maxSize,
|
|
SerializeIF::Endianness streamEndianness) const {
|
|
if (*size + getSerializedSize() > maxSize) {
|
|
return SerializeIF::BUFFER_TOO_SHORT;
|
|
}
|
|
timeval now{};
|
|
Clock::getClock_timeval(&now);
|
|
CCSDSTime::CDS_short cds{};
|
|
ReturnValue_t result = CCSDSTime::convertToCcsds(&cds, &now);
|
|
if (result != returnvalue::OK) {
|
|
return result;
|
|
}
|
|
std::memcpy(*buffer, &cds, sizeof(cds));
|
|
*buffer += getSerializedSize();
|
|
*size += getSerializedSize();
|
|
return result;
|
|
}
|
|
|
|
size_t CdsShortTimeStamper::getSerializedSize() const { return getTimestampSize(); }
|
|
|
|
ReturnValue_t CdsShortTimeStamper::deSerialize(const uint8_t **buffer, size_t *size,
|
|
SerializeIF::Endianness streamEndianness) {
|
|
if (size == nullptr or buffer == nullptr) {
|
|
return returnvalue::FAILED;
|
|
}
|
|
if (*size < getTimestampSize()) {
|
|
return SerializeIF::STREAM_TOO_SHORT;
|
|
}
|
|
size_t foundLen = 0;
|
|
if (((**buffer >> 4) & 0b111) != CCSDSTime::TimeCodeIdentification::CDS) {
|
|
return BAD_TIMESTAMP;
|
|
}
|
|
auto res = CCSDSTime::convertFromCcsds(&readTime, *buffer, &foundLen, *size);
|
|
if (res == returnvalue::OK) {
|
|
*size -= getSerializedSize();
|
|
*buffer += getSerializedSize();
|
|
}
|
|
return res;
|
|
}
|
|
|
|
timeval &CdsShortTimeStamper::getTime() { return readTime; }
|
|
|
|
size_t CdsShortTimeStamper::getTimestampSize() const { return TIMESTAMP_LEN; }
|