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

addes pus packet c implementation

Browse Source
This commit is contained in:
Robin Müller
2021-04-12 23:55:33 +02:00
parent 9a2fbefc9f
commit f906605097
9 changed files with 237 additions and 40 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
tmtcpacket/pus/TmPacketPusA.cpp
View File

@ -49,27 +49,7 @@ uint16_t TmPacketPusA::getDataFieldSize() {
return sizeof(PUSTmDataFieldHeaderPusA);
}
bool TmPacketPusA::checkAndSetStamper() {
if (timeStamper == NULL) {
timeStamper = objectManager->get<TimeStamperIF>(timeStamperId);
if (timeStamper == NULL) {
#if FSFW_CPP_OSTREAM_ENABLED == 1
sif::error << "TmPacketPusA::checkAndSetStamper: Stamper not found!"
<< std::endl;
#endif
return false;
}
}
return true;
}
ReturnValue_t TmPacketPusA::getPacketTime(timeval* timestamp) const {
size_t tempSize = 0;
return CCSDSTime::convertFromCcsds(timestamp, tmData->data_field.time,
&tempSize, sizeof(tmData->data_field.time));
}
uint8_t* TmPacketPusA::getPacketTimeRaw() const{
uint8_t* TmPacketPusA::getPacketTimeRaw() const {
return tmData->data_field.time;
}
@ -92,7 +72,7 @@ void TmPacketPusA::initializeTmPacket(uint16_t apid, uint8_t service,
tmData->data_field.service_subtype = subservice;
tmData->data_field.subcounter = packetSubcounter;
//Timestamp packet
if (checkAndSetStamper()) {
if (TmPacketBase::checkAndSetStamper()) {
timeStamper->addTimeStamp(tmData->data_field.time,
sizeof(tmData->data_field.time));
}