81 lines
3.0 KiB
C++
81 lines
3.0 KiB
C++
#include "fsfw/datalinklayer/TcTransferFrame.h"
|
|
|
|
#include "fsfw/serviceinterface/ServiceInterface.h"
|
|
|
|
TcTransferFrame::TcTransferFrame() { frame = nullptr; }
|
|
|
|
TcTransferFrame::TcTransferFrame(uint8_t* setData) { this->frame = (tc_transfer_frame*)setData; }
|
|
|
|
uint8_t TcTransferFrame::getVersionNumber() {
|
|
return (this->frame->header.flagsAndScid & 0b11000000) >> 6;
|
|
}
|
|
|
|
bool TcTransferFrame::bypassFlagSet() {
|
|
return (this->frame->header.flagsAndScid & 0b00100000) != 0;
|
|
}
|
|
|
|
bool TcTransferFrame::controlCommandFlagSet() {
|
|
return (this->frame->header.flagsAndScid & 0b00010000) != 0;
|
|
}
|
|
|
|
bool TcTransferFrame::spareIsZero() {
|
|
return ((this->frame->header.flagsAndScid & 0b00001100) == 0);
|
|
}
|
|
|
|
uint16_t TcTransferFrame::getSpacecraftId() {
|
|
return ((this->frame->header.flagsAndScid & 0b00000011) << 8) +
|
|
this->frame->header.spacecraftId_l;
|
|
}
|
|
|
|
uint8_t TcTransferFrame::getVirtualChannelId() {
|
|
return (this->frame->header.vcidAndLength_h & 0b11111100) >> 2;
|
|
}
|
|
|
|
uint16_t TcTransferFrame::getFrameLength() {
|
|
return ((this->frame->header.vcidAndLength_h & 0b00000011) << 8) + this->frame->header.length_l;
|
|
}
|
|
|
|
uint16_t TcTransferFrame::getDataLength() {
|
|
return this->getFrameLength() - this->getHeaderSize() - 1 - FRAME_CRC_SIZE +
|
|
1; // -1 for the segment header.
|
|
}
|
|
|
|
uint8_t TcTransferFrame::getSequenceNumber() { return this->frame->header.sequenceNumber; }
|
|
|
|
uint8_t TcTransferFrame::getSequenceFlags() { return (this->frame->dataField & 0b11000000) >> 6; }
|
|
|
|
uint8_t TcTransferFrame::getMAPId() { return this->frame->dataField & 0b00111111; }
|
|
|
|
uint8_t* TcTransferFrame::getDataField() { return &(this->frame->dataField) + 1; }
|
|
|
|
uint8_t* TcTransferFrame::getFullFrame() { return (uint8_t*)this->frame; }
|
|
|
|
uint16_t TcTransferFrame::getFullSize() { return this->getFrameLength() + 1; }
|
|
|
|
uint16_t TcTransferFrame::getHeaderSize() { return sizeof(frame->header); }
|
|
|
|
uint16_t TcTransferFrame::getFullDataLength() {
|
|
return this->getFrameLength() - this->getHeaderSize() - FRAME_CRC_SIZE + 1;
|
|
}
|
|
|
|
uint8_t* TcTransferFrame::getFullDataField() { return &frame->dataField; }
|
|
|
|
void TcTransferFrame::print() {
|
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
sif::debug << "Raw Frame: " << std::hex << std::endl;
|
|
for (uint16_t count = 0; count < this->getFullSize(); count++) {
|
|
sif::debug << (uint16_t)this->getFullFrame()[count] << " ";
|
|
}
|
|
sif::debug << std::dec << std::endl;
|
|
|
|
sif::debug << "Frame Header:" << std::endl;
|
|
sif::debug << "Version Number: " << std::hex << (uint16_t)this->getVersionNumber() << std::endl;
|
|
sif::debug << "Bypass Flag set?| Ctrl Cmd Flag set?: " << (uint16_t)this->bypassFlagSet() << " | "
|
|
<< (uint16_t)this->controlCommandFlagSet() << std::endl;
|
|
sif::debug << "SCID : " << this->getSpacecraftId() << std::endl;
|
|
sif::debug << "VCID : " << (uint16_t)this->getVirtualChannelId() << std::endl;
|
|
sif::debug << "Frame length: " << std::dec << this->getFrameLength() << std::endl;
|
|
sif::debug << "Sequence Number: " << (uint16_t)this->getSequenceNumber() << std::endl;
|
|
#endif
|
|
}
|