2022-09-13 14:46:41 +02:00
|
|
|
#include "TcDistributorBase.h"
|
2022-08-01 11:05:46 +02:00
|
|
|
|
2022-08-03 15:12:29 +02:00
|
|
|
#include "definitions.h"
|
2022-08-01 11:05:46 +02:00
|
|
|
#include "fsfw/ipc/QueueFactory.h"
|
2021-07-13 20:22:54 +02:00
|
|
|
#include "fsfw/tmtcservices/TmTcMessage.h"
|
2016-06-15 23:48:41 +02:00
|
|
|
|
2022-08-01 17:16:37 +02:00
|
|
|
TcDistributorBase::TcDistributorBase(object_id_t objectId, MessageQueueIF* tcQueue_)
|
|
|
|
: SystemObject(objectId), tcQueue(tcQueue_) {
|
|
|
|
if (tcQueue == nullptr) {
|
|
|
|
ownedQueue = true;
|
|
|
|
tcQueue = QueueFactory::instance()->createMessageQueue(DISTRIBUTER_MAX_PACKETS);
|
|
|
|
}
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|
|
|
|
|
2022-08-01 17:16:37 +02:00
|
|
|
TcDistributorBase::~TcDistributorBase() {
|
|
|
|
if (ownedQueue) {
|
|
|
|
QueueFactory::instance()->deleteMessageQueue(tcQueue);
|
|
|
|
}
|
|
|
|
}
|
2016-06-15 23:48:41 +02:00
|
|
|
|
2022-08-01 11:00:36 +02:00
|
|
|
ReturnValue_t TcDistributorBase::performOperation(uint8_t opCode) {
|
2022-07-27 17:00:43 +02:00
|
|
|
ReturnValue_t status;
|
2022-08-22 16:35:53 +02:00
|
|
|
ReturnValue_t result = returnvalue::OK;
|
|
|
|
for (status = tcQueue->receiveMessage(¤tMessage); status == returnvalue::OK;
|
2022-02-02 10:29:30 +01:00
|
|
|
status = tcQueue->receiveMessage(¤tMessage)) {
|
2022-08-01 17:16:37 +02:00
|
|
|
ReturnValue_t packetResult = handlePacket();
|
2022-08-22 16:35:53 +02:00
|
|
|
if (packetResult != returnvalue::OK) {
|
2022-08-01 17:16:37 +02:00
|
|
|
result = packetResult;
|
2022-08-03 15:12:29 +02:00
|
|
|
triggerEvent(tmtcdistrib::HANDLE_PACKET_FAILED, packetResult, 1);
|
2022-08-01 17:16:37 +02:00
|
|
|
}
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
|
|
|
if (status == MessageQueueIF::EMPTY) {
|
2022-08-01 17:16:37 +02:00
|
|
|
return result;
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
2022-08-01 17:16:37 +02:00
|
|
|
return result;
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|
|
|
|
|
2022-08-01 11:00:36 +02:00
|
|
|
ReturnValue_t TcDistributorBase::handlePacket() {
|
|
|
|
MessageQueueId_t destId;
|
|
|
|
ReturnValue_t result = selectDestination(destId);
|
2022-08-22 16:35:53 +02:00
|
|
|
if (result != returnvalue::OK) {
|
2022-08-01 11:00:36 +02:00
|
|
|
return result;
|
2022-02-02 10:29:30 +01:00
|
|
|
}
|
2022-08-03 11:33:10 +02:00
|
|
|
return callbackAfterSending(tcQueue->sendMessage(destId, ¤tMessage));
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|
|
|
|
|
2022-08-01 11:00:36 +02:00
|
|
|
ReturnValue_t TcDistributorBase::callbackAfterSending(ReturnValue_t queueStatus) {
|
2022-08-22 16:35:53 +02:00
|
|
|
return returnvalue::OK;
|
2016-06-15 23:48:41 +02:00
|
|
|
}
|