145 lines
5.7 KiB
C++
145 lines
5.7 KiB
C++
//#include "CfdpRouter.h"
|
|
//#include "fsfw/tcdistribution/CcsdsDistributorIF.h"
|
|
//#include "fsfw/tmtcpacket/cfdp/CfdpPacketStored.h"
|
|
//
|
|
//#ifndef FSFW_CFDP_DISTRIBUTOR_DEBUGGING
|
|
//#define FSFW_CFDP_DISTRIBUTOR_DEBUGGING 1
|
|
//#endif
|
|
//
|
|
// CfdpHandler::CfdpHandler(uint16_t setApid, object_id_t setObjectId,
|
|
// object_id_t setPacketSource)
|
|
// : TcDistributorBase(setObjectId),
|
|
// apid(setApid),
|
|
// checker(setApid),
|
|
// tcStatus(RETURN_FAILED),
|
|
// packetSource(setPacketSource) {}
|
|
//
|
|
// CfdpHandler::~CfdpHandler() = default;
|
|
//
|
|
// ReturnValue_t CfdpHandler::selectDestination(MessageQueueId_t& destId) {
|
|
// //#if FSFW_CFDP_DISTRIBUTOR_DEBUGGING == 1
|
|
// // store_address_t storeId = this->currentMessage.getStorageId();
|
|
// //#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
// // sif::debug << "CFDPDistributor::handlePacket received: " << storeId.poolIndex << ", "
|
|
// // << storeId.packetIndex << std::endl;
|
|
// //#else
|
|
// // sif::printDebug("CFDPDistributor::handlePacket received: %d, %d\n", storeId.poolIndex,
|
|
// // storeId.packetIndex);
|
|
// //#endif
|
|
// //#endif
|
|
// // auto queueMapIt = this->queueMap.end();
|
|
// // if (this->currentPacket == nullptr) {
|
|
// // return queueMapIt;
|
|
// // }
|
|
// // this->currentPacket->setStoreAddress(this->currentMessage.getStorageId());
|
|
// // if (currentPacket->getFullData() != nullptr) {
|
|
// // tcStatus = checker.checkPacket(*currentPacket, currentPacket->getFullPacketLen());
|
|
// // if (tcStatus != HasReturnvaluesIF::RETURN_OK) {
|
|
// //#if FSFW_VERBOSE_LEVEL >= 1
|
|
// //#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
// // sif::debug << "CFDPDistributor::handlePacket: Packet format invalid, code "
|
|
// // << static_cast<int>(tcStatus) << std::endl;
|
|
// //#else
|
|
// // sif::printDebug("CFDPDistributor::handlePacket: Packet format invalid, code %d\n",
|
|
// // static_cast<int>(tcStatus));
|
|
// //#endif
|
|
// //#endif
|
|
// // }
|
|
// // queueMapIt = this->queueMap.find(0);
|
|
// // } else {
|
|
// // tcStatus = PACKET_LOST;
|
|
// // }
|
|
// //
|
|
// // if (queueMapIt == this->queueMap.end()) {
|
|
// // tcStatus = DESTINATION_NOT_FOUND;
|
|
// //#if FSFW_VERBOSE_LEVEL >= 1
|
|
// //#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
// // sif::debug << "CFDPDistributor::handlePacket: Destination not found" << std::endl;
|
|
// //#else
|
|
// // sif::printDebug("CFDPDistributor::handlePacket: Destination not found\n");
|
|
// //#endif /* !FSFW_CPP_OSTREAM_ENABLED == 1 */
|
|
// //#endif
|
|
// // }
|
|
// //
|
|
// // if (tcStatus != RETURN_OK) {
|
|
// // return this->queueMap.end();
|
|
// // } else {
|
|
// // return queueMapIt;
|
|
// // }
|
|
// return HasReturnvaluesIF::RETURN_OK;
|
|
//}
|
|
//
|
|
// ReturnValue_t CfdpHandler::registerHandler(AcceptsTelecommandsIF* handler) {
|
|
// // uint16_t handlerId =
|
|
// // handler->getIdentifier(); // should be 0, because CfdpHandler does not set a set a
|
|
// // service-ID
|
|
// //#if FSFW_CFDP_DISTRIBUTOR_DEBUGGING == 1
|
|
// //#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
// // sif::info << "CFDPDistributor::registerHandler: Handler ID: " << static_cast<int>(handlerId)
|
|
// // << std::endl;
|
|
// //#else
|
|
// // sif::printInfo("CFDPDistributor::registerHandler: Handler ID: %d\n",
|
|
// // static_cast<int>(handlerId));
|
|
// //#endif
|
|
// //#endif
|
|
// // MessageQueueId_t queue = handler->getRequestQueue();
|
|
// // auto returnPair = queueMap.emplace(handlerId, queue);
|
|
// // if (not returnPair.second) {
|
|
// //#if FSFW_VERBOSE_LEVEL >= 1
|
|
// //#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
// // sif::error << "CFDPDistributor::registerHandler: Service ID already"
|
|
// // " exists in map"
|
|
// // << std::endl;
|
|
// //#else
|
|
// // sif::printError("CFDPDistributor::registerHandler: Service ID already exists in map\n");
|
|
// //#endif
|
|
// //#endif
|
|
// // return SERVICE_ID_ALREADY_EXISTS;
|
|
// // }
|
|
// return HasReturnvaluesIF::RETURN_OK;
|
|
//}
|
|
//
|
|
// MessageQueueId_t CfdpHandler::getRequestQueue() const { return tcQueue->getId(); }
|
|
//
|
|
//// ReturnValue_t CFDPDistributor::callbackAfterSending(ReturnValue_t queueStatus) {
|
|
//// if (queueStatus != RETURN_OK) {
|
|
//// tcStatus = queueStatus;
|
|
//// }
|
|
//// if (tcStatus != RETURN_OK) {
|
|
//// this->verifyChannel.sendFailureReport(tc_verification::ACCEPTANCE_FAILURE,
|
|
//// currentPacket, tcStatus);
|
|
//// // A failed packet is deleted immediately after reporting,
|
|
//// // otherwise it will block memory.
|
|
//// currentPacket->deletePacket();
|
|
//// return RETURN_FAILED;
|
|
//// } else {
|
|
//// this->verifyChannel.sendSuccessReport(tc_verification::ACCEPTANCE_SUCCESS,
|
|
//// currentPacket);
|
|
//// return RETURN_OK;
|
|
//// }
|
|
//// }
|
|
//
|
|
// uint32_t CfdpHandler::getIdentifier() const { return this->apid; }
|
|
//
|
|
// ReturnValue_t CfdpHandler::initialize() {
|
|
// // currentPacket = new CfdpPacketStored();
|
|
// // if (currentPacket == nullptr) {
|
|
// // // Should not happen, memory allocation failed!
|
|
// // return ObjectManagerIF::CHILD_INIT_FAILED;
|
|
// // }
|
|
// //
|
|
// // auto* ccsdsDistributor = ObjectManager::instance()->get<CcsdsDistributorIF>(packetSource);
|
|
// // if (ccsdsDistributor == nullptr) {
|
|
// //#if FSFW_CPP_OSTREAM_ENABLED == 1
|
|
// // sif::error << "CFDPDistributor::initialize: Packet source invalid" << std::endl;
|
|
// // sif::error << " Make sure it exists and implements CCSDSDistributorIF!" << std::endl;
|
|
// //#else
|
|
// // sif::printError("CFDPDistributor::initialize: Packet source invalid\n");
|
|
// // sif::printError("Make sure it exists and implements CcsdsDistributorIF\n");
|
|
// //#endif
|
|
// // return RETURN_FAILED;
|
|
// // }
|
|
// // return ccsdsDistributor->registerApplication(this);
|
|
// return HasReturnvaluesIF::RETURN_OK;
|
|
//}
|