eive-obsw/mission/payload/plocSpBase.h

118 lines
3.4 KiB
C
Raw Normal View History

2023-03-26 16:42:00 +02:00
#ifndef MISSION_PAYLOAD_PLOCSPBASE_H_
#define MISSION_PAYLOAD_PLOCSPBASE_H_
2023-03-26 16:42:00 +02:00
#include <fsfw/globalfunctions/CRC.h>
#include <fsfw/tmtcpacket/ccsds/SpacePacketCreator.h>
2022-08-15 18:34:26 +02:00
#include <fsfw/tmtcpacket/ccsds/SpacePacketReader.h>
#include <cstdint>
2022-08-15 18:34:26 +02:00
namespace ploc {
2022-08-15 18:34:26 +02:00
struct SpTcParams {
SpTcParams(SpacePacketCreator& creator) : creator(creator) {}
SpTcParams(SpacePacketCreator& creator, uint8_t* buf, size_t maxSize)
: creator(creator), buf(buf), maxSize(maxSize) {}
2023-02-28 19:56:42 +01:00
// Set full payload length. Must also consider the two CRC bytes
2022-11-07 10:30:09 +01:00
void setFullPayloadLen(size_t fullPayloadLen_) { fullPayloadLen = fullPayloadLen_; }
SpacePacketCreator& creator;
uint8_t* buf = nullptr;
size_t maxSize = 0;
2022-11-07 10:30:09 +01:00
size_t fullPayloadLen = 0;
};
2022-08-15 18:34:26 +02:00
class SpTcBase {
public:
2022-11-07 13:37:51 +01:00
SpTcBase(SpTcParams params) : SpTcBase(params, 0x00, 1, 0) {}
SpTcBase(SpTcParams params, uint16_t apid, size_t payloadLen)
: SpTcBase(params, apid, payloadLen, 0) {}
2022-11-07 13:37:51 +01:00
SpTcBase(SpTcParams params, uint16_t apid, size_t payloadLen, uint16_t seqCount)
: spParams(params) {
spParams.creator.setApid(apid);
spParams.creator.setSeqCount(seqCount);
2022-08-15 18:58:56 +02:00
payloadStart = spParams.buf + ccsds::HEADER_LEN;
2022-11-07 13:37:51 +01:00
spParams.fullPayloadLen = payloadLen;
2022-08-15 18:58:56 +02:00
updateSpFields();
}
2022-08-15 18:58:56 +02:00
void updateSpFields() {
2022-11-07 13:37:51 +01:00
updateLenFromParams();
spParams.creator.setPacketType(ccsds::PacketType::TC);
}
2022-11-07 13:37:51 +01:00
void updateLenFromParams() { spParams.creator.setDataLenField(spParams.fullPayloadLen - 1); }
const uint8_t* getFullPacket() const { return spParams.buf; }
2022-11-18 17:25:52 +01:00
const uint8_t* getPacketData() const { return spParams.buf + ccsds::HEADER_LEN; }
size_t getFullPacketLen() const { return spParams.creator.getFullPacketLen(); }
uint16_t getApid() const { return spParams.creator.getApid(); }
2022-11-08 16:26:30 +01:00
uint16_t getSeqCount() const { return spParams.creator.getSequenceCount(); }
ReturnValue_t checkPayloadLen() {
2022-11-07 10:30:09 +01:00
if (ccsds::HEADER_LEN + spParams.fullPayloadLen > spParams.maxSize) {
return SerializeIF::BUFFER_TOO_SHORT;
}
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
}
ReturnValue_t serializeHeader() {
2022-08-15 18:58:56 +02:00
updateSpFields();
size_t serLen = 0;
return spParams.creator.serializeBe(spParams.buf, serLen, spParams.maxSize);
}
ReturnValue_t checkSizeAndSerializeHeader() {
ReturnValue_t result = checkPayloadLen();
2022-08-24 17:27:47 +02:00
if (result != returnvalue::OK) {
return result;
}
return serializeHeader();
}
2022-11-07 10:30:09 +01:00
ReturnValue_t calcAndSetCrc() {
/* Calculate crc */
2022-08-18 15:32:24 +02:00
uint16_t crc = CRC::crc16ccitt(spParams.buf, getFullPacketLen() - 2);
/* Add crc to packet data field of space packet */
size_t serializedSize = 0;
2022-08-18 15:32:24 +02:00
return SerializeAdapter::serialize(&crc, spParams.buf + getFullPacketLen() - 2, &serializedSize,
spParams.maxSize, SerializeIF::Endianness::BIG);
}
protected:
2022-08-15 18:34:26 +02:00
ploc::SpTcParams spParams;
uint8_t* payloadStart;
};
2022-08-15 18:34:26 +02:00
/**
* @brief Class for handling tm replies of the supervisor.
*/
class SpTmReader : public SpacePacketReader {
public:
SpTmReader() = default;
/**
* @brief Constructor creates idle packet and sets length field to maximum allowed size.
*/
SpTmReader(const uint8_t* buf, size_t maxSize) : SpacePacketReader(buf, maxSize) {}
2022-11-08 11:08:21 +01:00
ReturnValue_t checkCrc() const {
2022-08-21 01:38:45 +02:00
if (CRC::crc16ccitt(getFullData(), getFullPacketLen()) != 0) {
2022-08-24 17:27:47 +02:00
return returnvalue::FAILED;
2022-08-15 18:34:26 +02:00
}
2022-08-24 17:27:47 +02:00
return returnvalue::OK;
2022-08-15 18:34:26 +02:00
}
};
} // namespace ploc
2023-03-26 16:42:00 +02:00
#endif /* MISSION_PAYLOAD_PLOCSPBASE_H_ */