50 lines
1.5 KiB
C++
50 lines
1.5 KiB
C++
|
#include "QueueMapManager.h"
|
||
|
#include "../../ipc/MutexFactory.h"
|
||
|
#include "../../ipc/MutexGuard.h"
|
||
|
|
||
|
QueueMapManager::QueueMapManager() {
|
||
|
mapLock = MutexFactory::instance()->createMutex();
|
||
|
}
|
||
|
|
||
|
ReturnValue_t QueueMapManager::addMessageQueue(QueueHandle_t queue, MessageQueueId_t* id) {
|
||
|
MutexGuard lock(mapLock);
|
||
|
uint32_t currentId = queueCounter++;
|
||
|
auto returnPair = queueMap.emplace(currentId, queue);
|
||
|
if(not returnPair.second) {
|
||
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||
|
sif::error << "QueueMapManager::addMessageQueue This ID is already "
|
||
|
"inside the map!" << std::endl;
|
||
|
#else
|
||
|
sif::printError("QueueMapManager::addMessageQueue This ID is already "
|
||
|
"inside the map!\n");
|
||
|
#endif
|
||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||
|
}
|
||
|
if (id != nullptr) {
|
||
|
*id = currentId;
|
||
|
}
|
||
|
return HasReturnvaluesIF::RETURN_OK;
|
||
|
|
||
|
}
|
||
|
|
||
|
QueueHandle_t QueueMapManager::getMessageQueue(MessageQueueId_t messageQueueId) const {
|
||
|
auto queueIter = queueMap.find(messageQueueId);
|
||
|
if(queueIter != queueMap.end()) {
|
||
|
return queueIter->second;
|
||
|
}
|
||
|
else {
|
||
|
#if FSFW_CPP_OSTREAM_ENABLED == 1
|
||
|
sif::warning << "QueueMapManager::getQueueHandle: The ID " << messageQueueId <<
|
||
|
" does not exists in the map!" << std::endl;
|
||
|
#else
|
||
|
sif::printWarning("QueueMapManager::getQueueHandle: The ID %d does not exist in the map!\n",
|
||
|
messageQueueId);
|
||
|
#endif
|
||
|
}
|
||
|
return nullptr;
|
||
|
}
|
||
|
|
||
|
QueueMapManager::~QueueMapManager() {
|
||
|
MutexFactory::instance()->deleteMutex(mapLock);
|
||
|
}
|