fsfw/tcdistribution/TcPacketCheck.cpp

40 lines
1.2 KiB
C++
Raw Normal View History

2020-10-01 13:21:23 +02:00
#include "TcPacketCheck.h"
2020-08-28 18:33:29 +02:00
#include "../globalfunctions/CRC.h"
#include "../serviceinterface/ServiceInterfaceStream.h"
#include "../storagemanager/StorageManagerIF.h"
#include "../tmtcservices/VerificationCodes.h"
2020-10-01 13:21:23 +02:00
TcPacketCheck::TcPacketCheck( uint16_t setApid ) : apid(setApid) {
2020-08-28 18:33:29 +02:00
}
2020-10-01 13:21:23 +02:00
ReturnValue_t TcPacketCheck::checkPacket( TcPacketStored* currentPacket ) {
uint16_t calculated_crc = CRC::crc16ccitt( currentPacket->getWholeData(),
currentPacket->getFullSize() );
2020-08-28 18:33:29 +02:00
if ( calculated_crc != 0 ) {
return INCORRECT_CHECKSUM;
}
2020-10-01 13:21:23 +02:00
bool condition = (not currentPacket->hasSecondaryHeader()) or
(currentPacket->getPacketVersionNumber() != CCSDS_VERSION_NUMBER) or
(not currentPacket->isTelecommand());
2020-08-28 18:33:29 +02:00
if ( condition ) {
return INCORRECT_PRIMARY_HEADER;
}
2020-10-01 13:21:23 +02:00
if ( currentPacket->getAPID() != this->apid )
2020-08-28 18:33:29 +02:00
return ILLEGAL_APID;
2020-10-01 13:21:23 +02:00
if ( not currentPacket->isSizeCorrect() ) {
2020-08-28 18:33:29 +02:00
return INCOMPLETE_PACKET;
}
2020-10-01 13:21:23 +02:00
condition = (currentPacket->getSecondaryHeaderFlag() != CCSDS_SECONDARY_HEADER_FLAG) ||
(currentPacket->getPusVersionNumber() != PUS_VERSION_NUMBER);
2020-08-28 18:33:29 +02:00
if ( condition ) {
return INCORRECT_SECONDARY_HEADER;
}
return RETURN_OK;
}
uint16_t TcPacketCheck::getApid() const {
return apid;
}