fsfw/tcdistribution/TcDistributor.cpp

57 lines
1.6 KiB
C++
Raw Normal View History

2020-08-13 20:53:35 +02:00
#include "TcDistributor.h"
2020-10-01 13:23:06 +02:00
#include "../serviceinterface/ServiceInterfaceStream.h"
2020-08-13 20:53:35 +02:00
#include "../tmtcservices/TmTcMessage.h"
#include "../ipc/QueueFactory.h"
2020-10-01 13:23:06 +02:00
TcDistributor::TcDistributor(object_id_t objectId) :
SystemObject(objectId) {
tcQueue = QueueFactory::instance()->
createMessageQueue(DISTRIBUTER_MAX_PACKETS);
}
TcDistributor::~TcDistributor() {
QueueFactory::instance()->deleteMessageQueue(tcQueue);
}
ReturnValue_t TcDistributor::performOperation(uint8_t opCode) {
ReturnValue_t status = RETURN_OK;
for (status = tcQueue->receiveMessage(&currentMessage); status == RETURN_OK;
status = tcQueue->receiveMessage(&currentMessage)) {
status = handlePacket();
}
2018-07-13 18:28:26 +02:00
if (status == MessageQueueIF::EMPTY) {
return RETURN_OK;
} else {
return status;
}
}
ReturnValue_t TcDistributor::handlePacket() {
2020-10-01 13:23:06 +02:00
TcMqMapIter queueMapIt = this->selectDestination();
ReturnValue_t returnValue = RETURN_FAILED;
if (queueMapIt != this->queueMap.end()) {
returnValue = this->tcQueue->sendMessage(queueMapIt->second,
&this->currentMessage);
}
return this->callbackAfterSending(returnValue);
}
void TcDistributor::print() {
2021-01-03 14:16:52 +01:00
#if FSFW_CPP_OSTREAM_ENABLED == 1
2020-10-01 13:23:06 +02:00
sif::debug << "Distributor content is: " << std::endl
<< "ID\t| Message Queue ID" << std::endl;
sif::debug << std::setfill('0') << std::setw(8) << std::hex;
for (const auto& queueMapIter: queueMap) {
sif::debug << queueMapIter.first << "\t| 0x" << queueMapIter.second
<< std::endl;
}
2020-10-01 13:23:06 +02:00
sif::debug << std::setfill(' ') << std::dec;
#endif
}
ReturnValue_t TcDistributor::callbackAfterSending(ReturnValue_t queueStatus) {
return RETURN_OK;
}