mohr/fsfw
1
0
Fork 0
forked from fsfw/fsfw
Code Pull Requests Activity

add basic CCSDS tests

Browse Source
This commit is contained in:
Robin Müller
2022-07-22 18:46:58 +02:00
parent cb05329dd9
commit 133894f4ba
4 changed files with 69 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
src/fsfw/tmtcpacket/ccsds/PacketId.h
View File

@ -42,8 +42,20 @@ struct PacketId : public SerializeIF {
ReturnValue_t serialize(uint8_t **buffer, size_t *size, size_t maxSize,
Endianness streamEndianness) const override {
uint16_t pscRaw = raw();
return SerializeAdapter::serialize(&pscRaw, buffer, size, maxSize, streamEndianness);
if (*size + getSerializedSize() > maxSize) {
return SerializeIF::BUFFER_TOO_SHORT;
}
uint16_t idRaw = raw();
// Leave the first three bits untouched, they could generally contain the CCSDS version,
// or more generally, the packet ID is a 13 bit field
**buffer &= ~0x1f;
**buffer |= (idRaw >> 8) & 0x1f;
*size += 1;
*buffer += 1;
**buffer = idRaw & 0xff;
*size += 1;
*buffer += 1;
return HasReturnvaluesIF::RETURN_OK;
}
[[nodiscard]] size_t getSerializedSize() const override { return 2; }