44 lines
1.4 KiB
C++
44 lines
1.4 KiB
C++
|
#include "../../osal/FreeRTOS/CountingSemaphore.h"
|
||
|
|
#include "../../serviceinterface/ServiceInterfaceStream.h"
|
||
|
|
#include "../../osal/FreeRTOS/TaskManagement.h"
|
||
|
|
|
||
|
|
#include <freertos/semphr.h>
|
||
|
|
|
||
|
|
// 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) {
|
||
|
|
sif::error << "CountingSemaphoreUsingTask: Max count bigger than "
|
||
|
|
"intial cout. Setting initial count to max count." << std::endl;
|
||
|
|
initCount = maxCount;
|
||
|
|
}
|
||
|
|
|
||
|
|
handle = xSemaphoreCreateCounting(maxCount, initCount);
|
||
|
|
if(handle == nullptr) {
|
||
|
|
sif::error << "CountingSemaphore: Creation failure" << std::endl;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
CountingSemaphore::CountingSemaphore(CountingSemaphore&& other):
|
||
|
|
maxCount(other.maxCount), initCount(other.initCount) {
|
||
|
|
handle = xSemaphoreCreateCounting(other.maxCount, other.initCount);
|
||
|
|
if(handle == nullptr) {
|
||
|
|
sif::error << "CountingSemaphore: Creation failure" << std::endl;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
CountingSemaphore& CountingSemaphore::operator =(
|
||
|
|
CountingSemaphore&& other) {
|
||
|
|
handle = xSemaphoreCreateCounting(other.maxCount, other.initCount);
|
||
|
|
if(handle == nullptr) {
|
||
|
|
sif::error << "CountingSemaphore: Creation failure" << std::endl;
|
||
|
|
}
|
||
|
|
return * this;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
uint8_t CountingSemaphore::getMaxCount() const {
|
||
|
|
return maxCount;
|
||
|
|
}
|