56 lines
1.7 KiB
C++
56 lines
1.7 KiB
C++
#include <framework/serviceinterface/ServiceInterfaceStream.h>
|
|
#include <framework/serviceinterface/ServiceInterfaceStream.h>
|
|
#include <framework/tcdistribution/TcDistributor.h>
|
|
#include <framework/tmtcservices/TmTcMessage.h>
|
|
#include <framework/ipc/QueueFactory.h>
|
|
|
|
TcDistributor::TcDistributor(object_id_t set_object_id) :
|
|
SystemObject(set_object_id), tcQueue(NULL) {
|
|
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;
|
|
// debug << "TcDistributor: performing Operation." << std::endl;
|
|
for (status = tcQueue->receiveMessage(¤tMessage); status == RETURN_OK;
|
|
status = tcQueue->receiveMessage(¤tMessage)) {
|
|
status = handlePacket();
|
|
}
|
|
if (status == OperatingSystemIF::QUEUE_EMPTY) {
|
|
return RETURN_OK;
|
|
} else {
|
|
return status;
|
|
}
|
|
}
|
|
|
|
ReturnValue_t TcDistributor::handlePacket() {
|
|
|
|
iterator_t 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() {
|
|
debug << "Distributor content is: " << std::endl << "ID\t| message queue id"
|
|
<< std::endl;
|
|
for (iterator_t it = this->queueMap.begin(); it != this->queueMap.end();
|
|
it++) {
|
|
debug << it->first << "\t| 0x" << std::hex << it->second << std::dec
|
|
<< std::endl;
|
|
}
|
|
debug << std::dec;
|
|
|
|
}
|
|
|
|
ReturnValue_t TcDistributor::callbackAfterSending(ReturnValue_t queueStatus) {
|
|
return RETURN_OK;
|
|
}
|