Update FSFW from upstream #71
@ -146,7 +146,7 @@ ReturnValue_t Clock::getDateAndTime(TimeOfDay_t* time) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
ReturnValue_t Clock::convertTimeOfDayToTimeval(const TimeOfDay_t* from, timeval* to) {
|
ReturnValue_t Clock::convertTimeOfDayToTimeval(const TimeOfDay_t* from, timeval* to) {
|
||||||
struct tm time_tm{};
|
struct tm time_tm {};
|
||||||
|
|
||||||
time_tm.tm_year = from->year - 1900;
|
time_tm.tm_year = from->year - 1900;
|
||||||
time_tm.tm_mon = from->month - 1;
|
time_tm.tm_mon = from->month - 1;
|
||||||
|
@ -54,7 +54,7 @@ ReturnValue_t PusTcCreator::serialize(uint8_t **buffer, size_t *size, size_t max
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
uint16_t crc16 = CRC::crc16ccitt(start, getFullPacketLen() - 2);
|
uint16_t crc16 = CRC::crc16ccitt(start, getFullPacketLen() - sizeof(ecss::PusChecksumT));
|
||||||
return SerializeAdapter::serialize(&crc16, buffer, size, maxSize, streamEndianness);
|
return SerializeAdapter::serialize(&crc16, buffer, size, maxSize, streamEndianness);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -95,3 +95,13 @@ SpacePacketParams &PusTcCreator::getSpParams() { return spCreator.getParams(); }
|
|||||||
ReturnValue_t PusTcCreator::serialize(uint8_t **buffer, size_t *size, size_t maxSize) {
|
ReturnValue_t PusTcCreator::serialize(uint8_t **buffer, size_t *size, size_t maxSize) {
|
||||||
return serialize(buffer, size, maxSize, SerializeIF::Endianness::NETWORK);
|
return serialize(buffer, size, maxSize, SerializeIF::Endianness::NETWORK);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void PusTcCreator::setRawAppData(ecss::DataWrapper::BufPairT bufPair) {
|
||||||
|
pusParams.dataWrapper.setRawData(bufPair);
|
||||||
|
updateSpLengthField();
|
||||||
|
}
|
||||||
|
|
||||||
|
void PusTcCreator::setSerializableAppData(SerializeIF *serAppData) {
|
||||||
|
pusParams.dataWrapper.setSerializable(serAppData);
|
||||||
|
updateSpLengthField();
|
||||||
|
}
|
||||||
|
@ -33,6 +33,9 @@ class PusTcCreator : public PusTcIF, public SerializeIF, public CreatorDataIF {
|
|||||||
void updateSpLengthField();
|
void updateSpLengthField();
|
||||||
PusTcParams &getPusParams();
|
PusTcParams &getPusParams();
|
||||||
SpacePacketParams &getSpParams();
|
SpacePacketParams &getSpParams();
|
||||||
|
void setRawAppData(ecss::DataWrapper::BufPairT bufPair);
|
||||||
|
void setSerializableAppData(SerializeIF *serAppData);
|
||||||
|
|
||||||
ReturnValue_t serialize(uint8_t **buffer, size_t *size, size_t maxSize);
|
ReturnValue_t serialize(uint8_t **buffer, size_t *size, size_t maxSize);
|
||||||
[[nodiscard]] size_t getSerializedSize() const override;
|
[[nodiscard]] size_t getSerializedSize() const override;
|
||||||
ReturnValue_t deSerialize(const uint8_t **buffer, size_t *size,
|
ReturnValue_t deSerialize(const uint8_t **buffer, size_t *size,
|
||||||
|
@ -23,20 +23,18 @@ ReturnValue_t PusTcReader::parseData(bool withCrc) {
|
|||||||
if (result != HasReturnvaluesIF::RETURN_OK) {
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
// We already have access to the space packet fields here, so we can perform a sanity check
|
|
||||||
// on the length field
|
|
||||||
if (spReader.getFullPacketLen() < spReader.getBufSize()) {
|
|
||||||
return SerializeIF::STREAM_TOO_SHORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
size_t currentOffset = SpacePacketReader::getHeaderLen();
|
size_t currentOffset = SpacePacketReader::getHeaderLen();
|
||||||
pointers.secHeaderStart = pointers.spHeaderStart + currentOffset;
|
pointers.secHeaderStart = pointers.spHeaderStart + currentOffset;
|
||||||
// Might become variable sized field in the future
|
// Might become variable sized field in the future
|
||||||
// TODO: No support for spare bytes yet
|
// TODO: No support for spare bytes yet
|
||||||
currentOffset += ecss::PusTcDataFieldHeader::MIN_SIZE;
|
currentOffset += ecss::PusTcDataFieldHeader::MIN_SIZE;
|
||||||
pointers.userDataStart = pointers.spHeaderStart + currentOffset;
|
|
||||||
appDataSize = spReader.getFullPacketLen() - currentOffset - sizeof(ecss::PusChecksumT);
|
appDataSize = spReader.getFullPacketLen() - currentOffset - sizeof(ecss::PusChecksumT);
|
||||||
pointers.crcStart = pointers.userDataStart + appDataSize;
|
pointers.userDataStart = nullptr;
|
||||||
|
if (appDataSize > 0) {
|
||||||
|
pointers.userDataStart = pointers.spHeaderStart + currentOffset;
|
||||||
|
}
|
||||||
|
currentOffset += appDataSize;
|
||||||
|
pointers.crcStart = pointers.spHeaderStart + currentOffset;
|
||||||
if (withCrc) {
|
if (withCrc) {
|
||||||
uint16_t crc16 = CRC::crc16ccitt(spReader.getFullData(), getFullPacketLen());
|
uint16_t crc16 = CRC::crc16ccitt(spReader.getFullData(), getFullPacketLen());
|
||||||
if (crc16 != 0) {
|
if (crc16 != 0) {
|
||||||
@ -47,25 +45,28 @@ ReturnValue_t PusTcReader::parseData(bool withCrc) {
|
|||||||
return HasReturnvaluesIF::RETURN_OK;
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
uint8_t PusTcReader::getAcknowledgeFlags() const {
|
uint8_t PusTcReader::getPusVersion() const { return (pointers.secHeaderStart[0] >> 4) & 0b1111; }
|
||||||
return (pointers.secHeaderStart[0] >> 4) & 0b1111;
|
|
||||||
}
|
uint8_t PusTcReader::getAcknowledgeFlags() const { return pointers.secHeaderStart[0] & 0b1111; }
|
||||||
|
|
||||||
uint8_t PusTcReader::getService() const { return pointers.secHeaderStart[1]; }
|
uint8_t PusTcReader::getService() const { return pointers.secHeaderStart[1]; }
|
||||||
|
|
||||||
uint8_t PusTcReader::getSubService() const { return pointers.secHeaderStart[2]; }
|
uint8_t PusTcReader::getSubService() const { return pointers.secHeaderStart[2]; }
|
||||||
|
|
||||||
uint16_t PusTcReader::getSourceId() const {
|
uint16_t PusTcReader::getSourceId() const {
|
||||||
return (pointers.secHeaderStart[3] << 8) | pointers.secHeaderStart[4];
|
return (pointers.secHeaderStart[3] << 8) | pointers.secHeaderStart[4];
|
||||||
}
|
}
|
||||||
|
|
||||||
uint16_t PusTcReader::getErrorControl() const {
|
uint16_t PusTcReader::getErrorControl() const {
|
||||||
return pointers.crcStart[0] << 8 | pointers.crcStart[1];
|
return (pointers.crcStart[0] << 8) | pointers.crcStart[1];
|
||||||
}
|
}
|
||||||
|
|
||||||
uint16_t PusTcReader::getPacketIdRaw() const { return spReader.getPacketIdRaw(); }
|
uint16_t PusTcReader::getPacketIdRaw() const { return spReader.getPacketIdRaw(); }
|
||||||
|
|
||||||
uint16_t PusTcReader::getPacketSeqCtrlRaw() const { return spReader.getPacketSeqCtrlRaw(); }
|
uint16_t PusTcReader::getPacketSeqCtrlRaw() const { return spReader.getPacketSeqCtrlRaw(); }
|
||||||
|
|
||||||
uint16_t PusTcReader::getPacketDataLen() const { return spReader.getPacketDataLen(); }
|
uint16_t PusTcReader::getPacketDataLen() const { return spReader.getPacketDataLen(); }
|
||||||
uint8_t PusTcReader::getPusVersion() const { return spReader.getVersion(); }
|
|
||||||
const uint8_t* PusTcReader::getFullData() { return pointers.spHeaderStart; }
|
const uint8_t* PusTcReader::getFullData() { return pointers.spHeaderStart; }
|
||||||
|
|
||||||
ReturnValue_t PusTcReader::setData(uint8_t* pData, size_t size_, void* args) {
|
ReturnValue_t PusTcReader::setData(uint8_t* pData, size_t size_, void* args) {
|
||||||
@ -80,13 +81,4 @@ ReturnValue_t PusTcReader::setReadOnlyData(const uint8_t* data, size_t size_) {
|
|||||||
const uint8_t* PusTcReader::getUserData() const { return pointers.userDataStart; }
|
const uint8_t* PusTcReader::getUserData() const { return pointers.userDataStart; }
|
||||||
size_t PusTcReader::getUserDataLen() const { return appDataSize; }
|
size_t PusTcReader::getUserDataLen() const { return appDataSize; }
|
||||||
|
|
||||||
/*
|
bool PusTcReader::isNull() const { return spReader.isNull(); }
|
||||||
void PusTcReader::print() {
|
|
||||||
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
||||||
sif::info << "TcPacketBase::print:" << std::endl;
|
|
||||||
#else
|
|
||||||
sif::printInfo("TcPacketBase::print:\n");
|
|
||||||
#endif
|
|
||||||
arrayprinter::print(getWholeData(), getFullSize());
|
|
||||||
}
|
|
||||||
*/
|
|
||||||
|
@ -34,6 +34,7 @@ class PusTcReader : public PusTcIF,
|
|||||||
*/
|
*/
|
||||||
PusTcReader(const uint8_t* setData, size_t size);
|
PusTcReader(const uint8_t* setData, size_t size);
|
||||||
|
|
||||||
|
[[nodiscard]] bool isNull() const;
|
||||||
ReturnValue_t parseDataWithCrcCheck();
|
ReturnValue_t parseDataWithCrcCheck();
|
||||||
ReturnValue_t parseDataWithoutCrcCheck();
|
ReturnValue_t parseDataWithoutCrcCheck();
|
||||||
|
|
||||||
@ -60,7 +61,7 @@ class PusTcReader : public PusTcIF,
|
|||||||
|
|
||||||
ReturnValue_t setReadOnlyData(const uint8_t* data, size_t size);
|
ReturnValue_t setReadOnlyData(const uint8_t* data, size_t size);
|
||||||
[[nodiscard]] const uint8_t* getUserData() const override;
|
[[nodiscard]] const uint8_t* getUserData() const override;
|
||||||
size_t getUserDataLen() const override;
|
[[nodiscard]] size_t getUserDataLen() const override;
|
||||||
|
|
||||||
protected:
|
protected:
|
||||||
/**
|
/**
|
||||||
|
@ -74,7 +74,7 @@ ReturnValue_t PusTmCreator::serialize(uint8_t** buffer, size_t* size, size_t max
|
|||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
uint16_t crc16 = CRC::crc16ccitt(*buffer, getFullPacketLen() - 2);
|
uint16_t crc16 = CRC::crc16ccitt(*buffer, getFullPacketLen() - sizeof(ecss::PusChecksumT));
|
||||||
return SerializeAdapter::serialize(&crc16, buffer, size, maxSize, streamEndianness);
|
return SerializeAdapter::serialize(&crc16, buffer, size, maxSize, streamEndianness);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -57,10 +57,6 @@ ReturnValue_t PusTmReader::parseData(bool crcCheck) {
|
|||||||
if (result != HasReturnvaluesIF::RETURN_OK) {
|
if (result != HasReturnvaluesIF::RETURN_OK) {
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
if (spReader.getFullPacketLen() < spReader.getBufSize()) {
|
|
||||||
return SerializeIF::STREAM_TOO_SHORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
size_t currentOffset = SpacePacketReader::getHeaderLen();
|
size_t currentOffset = SpacePacketReader::getHeaderLen();
|
||||||
pointers.secHeaderStart = pointers.spHeaderStart + currentOffset;
|
pointers.secHeaderStart = pointers.spHeaderStart + currentOffset;
|
||||||
currentOffset += PusTmIF::MIN_SEC_HEADER_LEN;
|
currentOffset += PusTmIF::MIN_SEC_HEADER_LEN;
|
||||||
|
@ -2,4 +2,5 @@ target_sources(${FSFW_TEST_TGT} PRIVATE
|
|||||||
testCcsdsCreator.cpp
|
testCcsdsCreator.cpp
|
||||||
testCcsdsReader.cpp
|
testCcsdsReader.cpp
|
||||||
testPusTcCreator.cpp
|
testPusTcCreator.cpp
|
||||||
|
testPusTcReader.cpp
|
||||||
)
|
)
|
||||||
|
@ -54,6 +54,8 @@ TEST_CASE("PUS TC Creator", "[pus-tc-creator]") {
|
|||||||
REQUIRE(((buf[9] << 8) | buf[10]) == 0);
|
REQUIRE(((buf[9] << 8) | buf[10]) == 0);
|
||||||
// CRC16 check
|
// CRC16 check
|
||||||
REQUIRE(CRC::crc16ccitt(buf.data(), serLen) == 0);
|
REQUIRE(CRC::crc16ccitt(buf.data(), serLen) == 0);
|
||||||
|
REQUIRE(buf[11] == 0xee);
|
||||||
|
REQUIRE(buf[12] == 0x63);
|
||||||
}
|
}
|
||||||
|
|
||||||
SECTION("Custom Source ID") {
|
SECTION("Custom Source ID") {
|
||||||
@ -82,12 +84,10 @@ TEST_CASE("PUS TC Creator", "[pus-tc-creator]") {
|
|||||||
SECTION("Test with Application Data Serializable") {
|
SECTION("Test with Application Data Serializable") {
|
||||||
auto& params = creator.getPusParams();
|
auto& params = creator.getPusParams();
|
||||||
auto simpleSer = SimpleSerializable();
|
auto simpleSer = SimpleSerializable();
|
||||||
params.dataWrapper.setSerializable(&simpleSer);
|
creator.setSerializableAppData(&simpleSer);
|
||||||
auto& dataWrapper = creator.getDataWrapper();
|
auto& dataWrapper = creator.getDataWrapper();
|
||||||
REQUIRE(dataWrapper.type == ecss::DataTypes::SERIALIZABLE);
|
REQUIRE(dataWrapper.type == ecss::DataTypes::SERIALIZABLE);
|
||||||
REQUIRE(dataWrapper.dataUnion.serializable == &simpleSer);
|
REQUIRE(dataWrapper.dataUnion.serializable == &simpleSer);
|
||||||
REQUIRE(creator.getSerializedSize() == 13);
|
|
||||||
creator.updateSpLengthField();
|
|
||||||
REQUIRE(creator.getSerializedSize() == 16);
|
REQUIRE(creator.getSerializedSize() == 16);
|
||||||
REQUIRE(creator.serialize(&dataPtr, &serLen, buf.size()) == HasReturnvaluesIF::RETURN_OK);
|
REQUIRE(creator.serialize(&dataPtr, &serLen, buf.size()) == HasReturnvaluesIF::RETURN_OK);
|
||||||
REQUIRE(serLen == 16);
|
REQUIRE(serLen == 16);
|
||||||
|
81
unittests/tmtcpacket/testPusTcReader.cpp
Normal file
81
unittests/tmtcpacket/testPusTcReader.cpp
Normal file
@ -0,0 +1,81 @@
|
|||||||
|
#include <array>
|
||||||
|
#include <catch2/catch_test_macros.hpp>
|
||||||
|
|
||||||
|
#include "fsfw/tmtcpacket/pus/tc/PusTcCreator.h"
|
||||||
|
#include "fsfw/tmtcpacket/pus/tc/PusTcReader.h"
|
||||||
|
|
||||||
|
TEST_CASE("PUS TC Reader", "[pus-tc-reader]") {
|
||||||
|
auto packetId = PacketId(ccsds::PacketType::TC, true, 0x02);
|
||||||
|
auto spParams =
|
||||||
|
SpacePacketParams(packetId, PacketSeqCtrl(ccsds::SequenceFlags::UNSEGMENTED, 0x34), 0x00);
|
||||||
|
auto pusParams = PusTcParams(17, 1);
|
||||||
|
PusTcCreator creator(spParams, pusParams);
|
||||||
|
std::array<uint8_t, 32> buf{};
|
||||||
|
uint8_t* dataPtr = buf.data();
|
||||||
|
size_t serLen = 0;
|
||||||
|
PusTcReader reader;
|
||||||
|
auto checkReaderFields = [&](PusTcReader& reader) {
|
||||||
|
REQUIRE(not reader.isNull());
|
||||||
|
REQUIRE(reader.getPacketType() == ccsds::PacketType::TC);
|
||||||
|
REQUIRE(reader.getApid() == 0x02);
|
||||||
|
REQUIRE(reader.getService() == 17);
|
||||||
|
REQUIRE(reader.getSubService() == 1);
|
||||||
|
REQUIRE(reader.getFullPacketLen() == 13);
|
||||||
|
REQUIRE(reader.getPacketDataLen() == 6);
|
||||||
|
REQUIRE(reader.getPusVersion() == 2);
|
||||||
|
REQUIRE(reader.getSequenceCount() == 0x34);
|
||||||
|
REQUIRE(reader.getUserData() == nullptr);
|
||||||
|
REQUIRE(reader.getUserDataLen() == 0);
|
||||||
|
REQUIRE(reader.getFullData() == buf.data());
|
||||||
|
REQUIRE(reader.getSourceId() == 0x00);
|
||||||
|
REQUIRE(reader.getAcknowledgeFlags() == 0b1111);
|
||||||
|
// This value was verified to be correct
|
||||||
|
REQUIRE(reader.getErrorControl() == 0xee63);
|
||||||
|
};
|
||||||
|
|
||||||
|
SECTION("State") {
|
||||||
|
REQUIRE(creator.serialize(&dataPtr, &serLen, buf.size()) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
REQUIRE(reader.isNull());
|
||||||
|
|
||||||
|
SECTION("Setter") {
|
||||||
|
REQUIRE(reader.setReadOnlyData(buf.data(), serLen) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
REQUIRE(reader.parseDataWithCrcCheck() == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
checkReaderFields(reader);
|
||||||
|
}
|
||||||
|
SECTION("Directly Constructed") {
|
||||||
|
PusTcReader secondReader(buf.data(), serLen);
|
||||||
|
REQUIRE(not secondReader.isNull());
|
||||||
|
REQUIRE(secondReader.parseDataWithCrcCheck() == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
checkReaderFields(secondReader);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
SECTION("Invalid CRC") {
|
||||||
|
REQUIRE(creator.serialize(&dataPtr, &serLen, buf.size()) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
REQUIRE(reader.setReadOnlyData(buf.data(), serLen) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
buf[11] = 0x00;
|
||||||
|
REQUIRE(reader.parseDataWithCrcCheck() == PusIF::INVALID_CRC_16);
|
||||||
|
}
|
||||||
|
|
||||||
|
SECTION("Invalid CRC but no check") {
|
||||||
|
REQUIRE(creator.serialize(&dataPtr, &serLen, buf.size()) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
REQUIRE(reader.setReadOnlyData(buf.data(), serLen) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
buf[11] = 0x00;
|
||||||
|
REQUIRE(reader.parseDataWithoutCrcCheck() == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
}
|
||||||
|
|
||||||
|
SECTION("With application data") {
|
||||||
|
auto& params = creator.getPusParams();
|
||||||
|
std::array<uint8_t, 3> data{1, 2, 3};
|
||||||
|
creator.setRawAppData({data.data(), data.size()});
|
||||||
|
REQUIRE(creator.serialize(&dataPtr, &serLen, buf.size()) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
REQUIRE(reader.setReadOnlyData(buf.data(), serLen) == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
REQUIRE(reader.parseDataWithCrcCheck() == HasReturnvaluesIF::RETURN_OK);
|
||||||
|
const uint8_t* userDataPtr = reader.getUserData();
|
||||||
|
REQUIRE(userDataPtr != nullptr);
|
||||||
|
REQUIRE(reader.getUserDataLen() == 3);
|
||||||
|
REQUIRE(userDataPtr[0] == 1);
|
||||||
|
REQUIRE(userDataPtr[1] == 2);
|
||||||
|
REQUIRE(userDataPtr[2] == 3);
|
||||||
|
}
|
||||||
|
}
|
@ -1 +0,0 @@
|
|||||||
|
|
Loading…
Reference in New Issue
Block a user