CCSDSHeader.cpp

Go to the documentation of this file.

#include "CCSDSHeader.h"
#include "CCSDSUtils.h"
 
CCSDS::ResultBool CCSDS::Header::deserialize(const std::vector<uint8_t> &data) {
  RET_IF_ERR_MSG(data.size() != 6, ErrorCode::INVALID_HEADER_DATA, "Invalid Header Data provided: size != 6");
 
  uint64_t headerData = 0;
  for (int i = 0; i < 6; ++i) {
    headerData |= static_cast<uint64_t>(data[i]) << (40 - i * 8); // Combine MSB to LSB
  }
  FORWARD_RESULT(setData(headerData));
  return true;
}
 
CCSDS::ResultBool CCSDS::Header::setData(const uint64_t &data) {
  RET_IF_ERR_MSG(data > 0xFFFFFFFFFFFF, ErrorCode::INVALID_HEADER_DATA,
                 "Input data exceeds expected bit size for version or size.");
  // Decompose data using mask and shifts
  m_dataLength = (data & 0xFFFF); // last 16 bits
  m_packetSequenceControl = (data >> 16) & 0xFFFF; // middle 16 bits
  m_packetIdentificationAndVersion = (data >> 32); // first 16 bits
 
  // decompose packet identifier
  m_versionNumber = (m_packetIdentificationAndVersion >> 13); // First 3 bits for version
  m_type = (m_packetIdentificationAndVersion >> 12) & 0x1; // Next 1 bit
  m_dataFieldHeaderFlag = (m_packetIdentificationAndVersion >> 11) & 0x1; // Next 1 bit
  m_APID = (m_packetIdentificationAndVersion & 0x07FF); // Last 11 bits
 
  // decompose sequence control
  m_sequenceFlags = (m_packetSequenceControl >> 14); // first 2 bits
  m_sequenceCount = (m_packetSequenceControl & 0x3FFF); // Last 14 bits.
  return true;
}
 
std::vector<uint8_t> CCSDS::Header::serialize() {
  m_packetSequenceControl = (static_cast<uint16_t>(m_sequenceFlags) << 14) | m_sequenceCount;
  m_packetIdentificationAndVersion = (static_cast<uint16_t>(m_versionNumber) << 13) | (m_type << 12) | static_cast<
                                       uint16_t>((m_dataFieldHeaderFlag) << 11) | m_APID;
 
  std::vector data{
    static_cast<unsigned char>(m_packetIdentificationAndVersion >> 8),
    static_cast<unsigned char>(m_packetIdentificationAndVersion & 0xFF),
    static_cast<unsigned char>(m_packetSequenceControl >> 8),
    static_cast<unsigned char>(m_packetSequenceControl & 0xFF),
    static_cast<unsigned char>(m_dataLength >> 8),
    static_cast<unsigned char>(m_dataLength & 0xFF),
  };
  return data;
}
 
void CCSDS::Header::setData(const PrimaryHeader &data) {
  m_versionNumber = data.versionNumber & 0x0007;
  m_type = data.type & 0x0001;
  m_dataFieldHeaderFlag = data.dataFieldHeaderFlag & 0x0001;
  m_APID = data.APID & 0x07FF;
  m_sequenceFlags = data.sequenceFlags & 0x0003;
  m_sequenceCount = data.sequenceCount & 0x3FFF;
  m_dataLength = data.dataLength;
 
  m_packetSequenceControl = (static_cast<uint16_t>(m_sequenceFlags) << 14) | m_sequenceCount;
  m_packetIdentificationAndVersion = (static_cast<uint16_t>(m_versionNumber) << 13) | (m_type << 12) | static_cast<
                                       uint16_t>((m_dataFieldHeaderFlag) << 11) | m_APID;
}