fsfw/osal/FreeRTOS/CountingSemaphore.cpp

54 lines
1.5 KiB
C++
Raw Normal View History

2020-12-14 11:17:22 +01:00
#include "CountingSemaphore.h"
#include "TaskManagement.h"
2020-09-18 13:15:14 +02:00
#include "../../serviceinterface/ServiceInterfaceStream.h"
#include "FreeRTOS.h"
#include "semphr.h"
2020-09-18 13:15:14 +02:00
// Make sure #define configUSE_COUNTING_SEMAPHORES 1 is set in
// free FreeRTOSConfig.h file.
CountingSemaphore::CountingSemaphore(const uint8_t maxCount, uint8_t initCount):
maxCount(maxCount), initCount(initCount) {
if(initCount > maxCount) {
2021-01-03 14:16:52 +01:00
#if FSFW_CPP_OSTREAM_ENABLED == 1
2020-09-18 13:15:14 +02:00
sif::error << "CountingSemaphoreUsingTask: Max count bigger than "
"intial cout. Setting initial count to max count." << std::endl;
#endif
2020-09-18 13:15:14 +02:00
initCount = maxCount;
}
handle = xSemaphoreCreateCounting(maxCount, initCount);
if(handle == nullptr) {
2021-01-03 14:16:52 +01:00
#if FSFW_CPP_OSTREAM_ENABLED == 1
2020-09-18 13:15:14 +02:00
sif::error << "CountingSemaphore: Creation failure" << std::endl;
#endif
2020-09-18 13:15:14 +02:00
}
}
CountingSemaphore::CountingSemaphore(CountingSemaphore&& other):
maxCount(other.maxCount), initCount(other.initCount) {
handle = xSemaphoreCreateCounting(other.maxCount, other.initCount);
if(handle == nullptr) {
2021-01-03 14:16:52 +01:00
#if FSFW_CPP_OSTREAM_ENABLED == 1
2020-09-18 13:15:14 +02:00
sif::error << "CountingSemaphore: Creation failure" << std::endl;
#endif
2020-09-18 13:15:14 +02:00
}
}
CountingSemaphore& CountingSemaphore::operator =(
CountingSemaphore&& other) {
handle = xSemaphoreCreateCounting(other.maxCount, other.initCount);
if(handle == nullptr) {
2021-01-03 14:16:52 +01:00
#if FSFW_CPP_OSTREAM_ENABLED == 1
2020-09-18 13:15:14 +02:00
sif::error << "CountingSemaphore: Creation failure" << std::endl;
#endif
2020-09-18 13:15:14 +02:00
}
return * this;
}
uint8_t CountingSemaphore::getMaxCount() const {
return maxCount;
}