58 lines
1.9 KiB
C++
58 lines
1.9 KiB
C++
#include "fsfw/ipc/QueueFactory.h"
|
|
|
|
#include "fsfw/ipc/MessageQueueSenderIF.h"
|
|
#include "fsfw/osal/rtems/MessageQueue.h"
|
|
#include "fsfw/osal/rtems/RtemsBasic.h"
|
|
|
|
QueueFactory* QueueFactory::factoryInstance = nullptr;
|
|
|
|
ReturnValue_t MessageQueueSenderIF::sendMessage(MessageQueueId_t sendTo,
|
|
MessageQueueMessageIF* message,
|
|
MessageQueueId_t sentFrom, bool ignoreFault) {
|
|
// TODO add ignoreFault functionality
|
|
message->setSender(sentFrom);
|
|
rtems_status_code result =
|
|
rtems_message_queue_send(sendTo, message->getBuffer(), message->getMessageSize());
|
|
switch (result) {
|
|
case RTEMS_SUCCESSFUL:
|
|
// message sent successfully
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
case RTEMS_INVALID_ID:
|
|
// invalid queue id
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
case RTEMS_INVALID_SIZE:
|
|
// invalid message size
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
case RTEMS_INVALID_ADDRESS:
|
|
// buffer is NULL
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
case RTEMS_UNSATISFIED:
|
|
// out of message buffers
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
case RTEMS_TOO_MANY:
|
|
// queue's limit has been reached
|
|
return MessageQueueIF::FULL;
|
|
|
|
default:
|
|
return HasReturnvaluesIF::RETURN_FAILED;
|
|
}
|
|
}
|
|
|
|
QueueFactory* QueueFactory::instance() {
|
|
if (factoryInstance == nullptr) {
|
|
factoryInstance = new QueueFactory;
|
|
}
|
|
return factoryInstance;
|
|
}
|
|
|
|
QueueFactory::QueueFactory() = default;
|
|
|
|
QueueFactory::~QueueFactory() = default;
|
|
|
|
MessageQueueIF* QueueFactory::createMessageQueue(uint32_t messageDepth, size_t maxMessageSize,
|
|
MqArgs* args) {
|
|
return new MessageQueue(messageDepth, maxMessageSize, args);
|
|
}
|
|
|
|
void QueueFactory::deleteMessageQueue(MessageQueueIF* queue) { delete queue; }
|