fsfw/osal/host/QueueMapManager.cpp

57 lines
1.6 KiB
C++
Raw Normal View History

2020-09-05 21:19:53 +02:00
#include "QueueMapManager.h"
2020-09-05 20:18:52 +02:00
#include "../../ipc/MutexFactory.h"
#include "../../ipc/MutexHelper.h"
QueueMapManager* QueueMapManager::mqManagerInstance = nullptr;
QueueMapManager::QueueMapManager() {
mapLock = MutexFactory::instance()->createMutex();
}
QueueMapManager* QueueMapManager::instance() {
if (mqManagerInstance == nullptr){
mqManagerInstance = new QueueMapManager();
}
return QueueMapManager::mqManagerInstance;
}
ReturnValue_t QueueMapManager::addMessageQueue(
MessageQueueIF* queueToInsert, MessageQueueId_t* id) {
// Not thread-safe, but it is assumed all message queues are created
// at software initialization now. If this is to be made thread-safe in
// the future, it propably would be sufficient to lock the increment
// operation here
uint32_t currentId = queueCounter++;
auto returnPair = queueMap.emplace(currentId, queueToInsert);
if(not returnPair.second) {
// this should never happen for the atomic variable.
#if CPP_OSTREAM_ENABLED == 1
2020-09-05 20:18:52 +02:00
sif::error << "QueueMapManager: This ID is already inside the map!"
<< std::endl;
#endif
2020-09-05 20:18:52 +02:00
return HasReturnvaluesIF::RETURN_FAILED;
}
if (id != nullptr) {
*id = currentId;
}
return HasReturnvaluesIF::RETURN_OK;
}
MessageQueueIF* QueueMapManager::getMessageQueue(
MessageQueueId_t messageQueueId) const {
2020-09-05 21:19:53 +02:00
MutexHelper(mapLock, MutexIF::TimeoutType::WAITING, 50);
2020-09-05 20:18:52 +02:00
auto queueIter = queueMap.find(messageQueueId);
if(queueIter != queueMap.end()) {
return queueIter->second;
}
else {
#if CPP_OSTREAM_ENABLED == 1
2020-12-02 00:32:07 +01:00
sif::warning << "QueueMapManager::getQueueHandle: The ID " <<
2020-09-05 20:18:52 +02:00
messageQueueId << " does not exists in the map" << std::endl;
#endif
2020-09-05 20:18:52 +02:00
return nullptr;
}
}