fsfw/tmtcpacket/pus/tc/TcPacketStoredBase.cpp

#include "TcPacketStoredBase.h"

#include "../../../objectmanager/ObjectManager.h"
#include "../../../serviceinterface/ServiceInterface.h"
#include "../../../objectmanager/frameworkObjects.h"

#include <cstring>

StorageManagerIF* TcPacketStoredBase::store = nullptr;

TcPacketStoredBase::TcPacketStoredBase() {
    this->storeAddress.raw = StorageManagerIF::INVALID_ADDRESS;
    this->checkAndSetStore();

}

TcPacketStoredBase::~TcPacketStoredBase() {
}

ReturnValue_t TcPacketStoredBase::getData(const uint8_t ** dataPtr,
        size_t* dataSize) {
    auto result = this->store->getData(storeAddress, dataPtr, dataSize);
    if(result != HasReturnvaluesIF::RETURN_OK) {
#if FSFW_CPP_OSTREAM_ENABLED == 1
        sif::warning << "TcPacketStoredBase: Could not get data!" << std::endl;
#else
        sif::printWarning("TcPacketStoredBase: Could not get data!\n");
#endif
    }
    return result;
}



bool TcPacketStoredBase::checkAndSetStore() {
    if (this->store == nullptr) {
        this->store = ObjectManager::instance()->get<StorageManagerIF>(objects::TC_STORE);
        if (this->store == nullptr) {
#if FSFW_CPP_OSTREAM_ENABLED == 1
            sif::error << "TcPacketStoredBase::TcPacketStoredBase: TC Store not found!"
                    << std::endl;
#endif
            return false;
        }
    }
    return true;
}

void TcPacketStoredBase::setStoreAddress(store_address_t setAddress) {
    this->storeAddress = setAddress;
    const uint8_t* tempData = nullptr;
    size_t tempSize;
    ReturnValue_t status = StorageManagerIF::RETURN_FAILED;
    if (this->checkAndSetStore()) {
        status = this->store->getData(this->storeAddress, &tempData, &tempSize);
    }
    TcPacketBase* tcPacketBase = this->getPacketBase();
    if(tcPacketBase == nullptr) {
        return;
    }
    if (status == StorageManagerIF::RETURN_OK) {
        tcPacketBase->setData(tempData);
    }
    else {
        tcPacketBase->setData(nullptr);
        this->storeAddress.raw = StorageManagerIF::INVALID_ADDRESS;
    }
}

store_address_t TcPacketStoredBase::getStoreAddress() {
    return this->storeAddress;
}