fsfw/tmtcpacket/pus/TcPacketStored.cpp

124 lines
3.4 KiB
C++
Raw Normal View History

2020-10-28 02:20:12 +01:00
#include "TcPacketStored.h"
2020-08-13 20:53:35 +02:00
#include "../../objectmanager/ObjectManagerIF.h"
#include "../../serviceinterface/ServiceInterfaceStream.h"
2020-10-28 02:20:12 +01:00
2020-05-18 16:41:37 +02:00
#include <cstring>
2020-10-28 02:20:12 +01:00
StorageManagerIF* TcPacketStored::store = nullptr;
TcPacketStored::TcPacketStored(store_address_t setAddress) :
2020-05-18 16:41:37 +02:00
TcPacketBase(nullptr), storeAddress(setAddress) {
2020-10-28 02:20:12 +01:00
setStoreAddress(storeAddress);
}
2020-10-28 02:20:12 +01:00
TcPacketStored::TcPacketStored(uint16_t apid, uint8_t service,
uint8_t subservice, uint8_t sequenceCount, const uint8_t* data,
size_t size, uint8_t ack) :
2020-05-18 16:41:37 +02:00
TcPacketBase(nullptr) {
this->storeAddress.raw = StorageManagerIF::INVALID_ADDRESS;
2020-10-28 02:20:12 +01:00
if (not this->checkAndSetStore()) {
return;
}
2020-10-28 02:20:12 +01:00
uint8_t* pData = nullptr;
ReturnValue_t returnValue = this->store->getFreeElement(&this->storeAddress,
2020-10-28 02:20:12 +01:00
(TC_PACKET_MIN_SIZE + size), &pData);
if (returnValue != this->store->RETURN_OK) {
#if CPP_OSTREAM_ENABLED == 1
sif::warning << "TcPacketStored: Could not get free element from store!"
<< std::endl;
#endif
return;
}
2020-10-28 02:20:12 +01:00
this->setData(pData);
initializeTcPacket(apid, sequenceCount, ack, service, subservice);
2020-05-19 18:55:13 +02:00
memcpy(&tcData->appData, data, size);
this->setPacketDataLength(
size + sizeof(PUSTcDataFieldHeader) + CRC_SIZE - 1);
this->setErrorControl();
}
ReturnValue_t TcPacketStored::getData(const uint8_t ** dataPtr,
size_t* dataSize) {
auto result = this->store->getData(storeAddress, dataPtr, dataSize);
if(result != HasReturnvaluesIF::RETURN_OK) {
#if CPP_OSTREAM_ENABLED == 1
sif::warning << "TcPacketStored: Could not get data!" << std::endl;
#endif
}
return result;
}
2020-10-28 02:20:12 +01:00
TcPacketStored::TcPacketStored(): TcPacketBase(nullptr) {
this->storeAddress.raw = StorageManagerIF::INVALID_ADDRESS;
this->checkAndSetStore();
}
ReturnValue_t TcPacketStored::deletePacket() {
ReturnValue_t result = this->store->deleteData(this->storeAddress);
this->storeAddress.raw = StorageManagerIF::INVALID_ADDRESS;
2020-10-28 02:20:12 +01:00
this->setData(nullptr);
return result;
}
bool TcPacketStored::checkAndSetStore() {
2020-10-28 02:20:12 +01:00
if (this->store == nullptr) {
this->store = objectManager->get<StorageManagerIF>(objects::TC_STORE);
2020-10-28 02:20:12 +01:00
if (this->store == nullptr) {
#if CPP_OSTREAM_ENABLED == 1
sif::error << "TcPacketStored::TcPacketStored: TC Store not found!"
<< std::endl;
#endif
return false;
}
}
return true;
}
void TcPacketStored::setStoreAddress(store_address_t setAddress) {
this->storeAddress = setAddress;
2020-10-28 02:20:12 +01:00
const uint8_t* tempData = nullptr;
2020-05-18 16:41:37 +02:00
size_t temp_size;
ReturnValue_t status = StorageManagerIF::RETURN_FAILED;
if (this->checkAndSetStore()) {
2020-10-28 02:20:12 +01:00
status = this->store->getData(this->storeAddress, &tempData,
&temp_size);
}
if (status == StorageManagerIF::RETURN_OK) {
2020-10-28 02:20:12 +01:00
this->setData(tempData);
} else {
2020-10-28 02:20:12 +01:00
this->setData(nullptr);
this->storeAddress.raw = StorageManagerIF::INVALID_ADDRESS;
}
}
store_address_t TcPacketStored::getStoreAddress() {
return this->storeAddress;
}
bool TcPacketStored::isSizeCorrect() {
2020-10-28 02:20:12 +01:00
const uint8_t* temp_data = nullptr;
2020-05-18 16:41:37 +02:00
size_t temp_size;
ReturnValue_t status = this->store->getData(this->storeAddress, &temp_data,
&temp_size);
if (status == StorageManagerIF::RETURN_OK) {
if (this->getFullSize() == temp_size) {
return true;
}
}
return false;
}
TcPacketStored::TcPacketStored(const uint8_t* data, uint32_t size) :
TcPacketBase(data) {
if (getFullSize() != size) {
return;
}
if (this->checkAndSetStore()) {
ReturnValue_t status = store->addData(&storeAddress, data, size);
if (status != HasReturnvaluesIF::RETURN_OK) {
2020-10-28 02:20:12 +01:00
this->setData(nullptr);
}
}
}