action
container
contrib
controller
coordinates
datalinklayer
datapool
defaultcfg
devicehandlers
events
fdir
globalfunctions
health
internalError
ipc
memory
modes
monitoring
objectmanager
osal
FreeRTOS
BinSemaphUsingTask.cpp
BinSemaphUsingTask.h
BinarySemaphore.cpp
BinarySemaphore.h
Clock.cpp
CountingSemaphUsingTask.cpp
CountingSemaphUsingTask.h
CountingSemaphore.cpp
CountingSemaphore.h
FixedTimeslotTask.cpp
FixedTimeslotTask.h
FreeRTOSTaskIF.h
MessageQueue.cpp
MessageQueue.h
Mutex.cpp
Mutex.h
MutexFactory.cpp
PeriodicTask.cpp
PeriodicTask.h
QueueFactory.cpp
README.md
SemaphoreFactory.cpp
TaskFactory.cpp
TaskManagement.cpp
TaskManagement.h
Timekeeper.cpp
Timekeeper.h
host
linux
rtems
windows
Endiness.h
InternalErrorCodes.h
parameters
power
pus
returnvalues
rmap
serialize
serviceinterface
storagemanager
subsystem
tasks
tcdistribution
thermal
timemanager
tmstorage
tmtcpacket
tmtcservices
unittest
.gitignore
.gitmodules
FSFWVersion.h
LICENSE
NOTICE
README.md
fsfw.mk
109 lines
2.8 KiB
C++
109 lines
2.8 KiB
C++
#include "../../osal/FreeRTOS/BinarySemaphore.h"
|
|
#include "../../osal/FreeRTOS/TaskManagement.h"
|
|
#include "../../serviceinterface/ServiceInterfaceStream.h"
|
|
|
|
BinarySemaphore::BinarySemaphore() {
|
|
handle = xSemaphoreCreateBinary();
|
|
if(handle == nullptr) {
|
|
sif::error << "Semaphore: Binary semaph creation failure" << std::endl;
|
|
}
|
|
// Initiated semaphore must be given before it can be taken.
|
|
xSemaphoreGive(handle);
|
|
}
|
|
|
|
BinarySemaphore::~BinarySemaphore() {
|
|
vSemaphoreDelete(handle);
|
|
}
|
|
|
|
BinarySemaphore::BinarySemaphore(BinarySemaphore&& s) {
|
|
handle = xSemaphoreCreateBinary();
|
|
if(handle == nullptr) {
|
|
sif::error << "Binary semaphore creation failure" << std::endl;
|
|
}
|
|
xSemaphoreGive(handle);
|
|
}
|
|
|
|
BinarySemaphore& BinarySemaphore::operator =(
|
|
BinarySemaphore&& s) {
|
|
if(&s != this) {
|
|
handle = xSemaphoreCreateBinary();
|
|
if(handle == nullptr) {
|
|
sif::error << "Binary semaphore creation failure" << std::endl;
|
|
}
|
|
xSemaphoreGive(handle);
|
|
}
|
|
return *this;
|
|
}
|
|
|
|
ReturnValue_t BinarySemaphore::acquire(TimeoutType timeoutType,
|
|
uint32_t timeoutMs) {
|
|
TickType_t timeout = 0;
|
|
if(timeoutType == TimeoutType::POLLING) {
|
|
timeout = 0;
|
|
}
|
|
else if(timeoutType == TimeoutType::WAITING){
|
|
timeout = pdMS_TO_TICKS(timeoutMs);
|
|
}
|
|
else {
|
|
timeout = portMAX_DELAY;
|
|
}
|
|
return acquireWithTickTimeout(timeoutType, timeout);
|
|
}
|
|
|
|
ReturnValue_t BinarySemaphore::acquireWithTickTimeout(TimeoutType timeoutType,
|
|
TickType_t timeoutTicks) {
|
|
if(handle == nullptr) {
|
|
return SemaphoreIF::SEMAPHORE_INVALID;
|
|
}
|
|
|
|
BaseType_t returncode = xSemaphoreTake(handle, timeoutTicks);
|
|
if (returncode == pdPASS) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
else {
|
|
return SemaphoreIF::SEMAPHORE_TIMEOUT;
|
|
}
|
|
}
|
|
|
|
ReturnValue_t BinarySemaphore::release() {
|
|
return release(handle);
|
|
}
|
|
|
|
ReturnValue_t BinarySemaphore::release(SemaphoreHandle_t semaphore) {
|
|
if (semaphore == nullptr) {
|
|
return SemaphoreIF::SEMAPHORE_INVALID;
|
|
}
|
|
BaseType_t returncode = xSemaphoreGive(semaphore);
|
|
if (returncode == pdPASS) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
else {
|
|
return SemaphoreIF::SEMAPHORE_NOT_OWNED;
|
|
}
|
|
}
|
|
|
|
uint8_t BinarySemaphore::getSemaphoreCounter() const {
|
|
return uxSemaphoreGetCount(handle);
|
|
}
|
|
|
|
SemaphoreHandle_t BinarySemaphore::getSemaphore() {
|
|
return handle;
|
|
}
|
|
|
|
|
|
// Be careful with the stack size here. This is called from an ISR!
|
|
ReturnValue_t BinarySemaphore::releaseFromISR(
|
|
SemaphoreHandle_t semaphore, BaseType_t * higherPriorityTaskWoken) {
|
|
if (semaphore == nullptr) {
|
|
return SemaphoreIF::SEMAPHORE_INVALID;
|
|
}
|
|
BaseType_t returncode = xSemaphoreGiveFromISR(semaphore,
|
|
higherPriorityTaskWoken);
|
|
if (returncode == pdPASS) {
|
|
return HasReturnvaluesIF::RETURN_OK;
|
|
}
|
|
else {
|
|
return SemaphoreIF::SEMAPHORE_NOT_OWNED;
|
|
}
|
|
}
|