WIP: somethings wrong.. #19
154
osal/FreeRTOS/BinarySemaphore.cpp
Normal file
154
osal/FreeRTOS/BinarySemaphore.cpp
Normal file
@ -0,0 +1,154 @@
|
|||||||
|
/**
|
||||||
|
* @file BinarySemaphore.cpp
|
||||||
|
*
|
||||||
|
* @date 25.02.2020
|
||||||
|
*/
|
||||||
|
#include <framework/osal/FreeRTOS/BinarySemaphore.h>
|
||||||
|
#include <framework/osal/FreeRTOS/TaskManagement.h>
|
||||||
|
|
||||||
|
#include <framework/serviceinterface/ServiceInterfaceStream.h>
|
||||||
|
|
||||||
|
BinarySemaphore::BinarySemaphore() {
|
||||||
|
handle = xSemaphoreCreateBinary();
|
||||||
|
if(handle == nullptr) {
|
||||||
|
|
||||||
|
error << "Binary semaphore creation failure" << std::endl;
|
||||||
|
}
|
||||||
|
xSemaphoreGive(handle);
|
||||||
|
}
|
||||||
|
|
||||||
|
BinarySemaphore::~BinarySemaphore() {
|
||||||
|
vSemaphoreDelete(handle);
|
||||||
|
}
|
||||||
|
|
||||||
|
// This copy ctor is important as it prevents the assignment to a ressource
|
||||||
|
// (other.handle) variable which is later deleted!
|
||||||
|
BinarySemaphore::BinarySemaphore(const BinarySemaphore& other) {
|
||||||
|
handle = xSemaphoreCreateBinary();
|
||||||
|
if(handle == nullptr) {
|
||||||
|
error << "Binary semaphore creation failure" << std::endl;
|
||||||
|
}
|
||||||
|
xSemaphoreGive(handle);
|
||||||
|
}
|
||||||
|
|
||||||
|
BinarySemaphore& BinarySemaphore::operator =(const BinarySemaphore& s) {
|
||||||
|
if(this != &s) {
|
||||||
|
handle = xSemaphoreCreateBinary();
|
||||||
|
if(handle == nullptr) {
|
||||||
|
error << "Binary semaphore creation failure" << std::endl;
|
||||||
|
}
|
||||||
|
xSemaphoreGive(handle);
|
||||||
|
}
|
||||||
|
return *this;
|
||||||
|
}
|
||||||
|
|
||||||
|
BinarySemaphore::BinarySemaphore(BinarySemaphore&& s) {
|
||||||
|
handle = xSemaphoreCreateBinary();
|
||||||
|
if(handle == nullptr) {
|
||||||
|
error << "Binary semaphore creation failure" << std::endl;
|
||||||
|
}
|
||||||
|
xSemaphoreGive(handle);
|
||||||
|
}
|
||||||
|
|
||||||
|
BinarySemaphore& BinarySemaphore::operator =(
|
||||||
|
BinarySemaphore&& s) {
|
||||||
|
if(&s != this) {
|
||||||
|
handle = xSemaphoreCreateBinary();
|
||||||
|
if(handle == nullptr) {
|
||||||
|
error << "Binary semaphore creation failure" << std::endl;
|
||||||
|
}
|
||||||
|
xSemaphoreGive(handle);
|
||||||
|
}
|
||||||
|
return *this;
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t BinarySemaphore::takeBinarySemaphore(uint32_t timeoutMs) {
|
||||||
|
if(handle == nullptr) {
|
||||||
|
return SEMAPHORE_NULLPOINTER;
|
||||||
|
}
|
||||||
|
TickType_t timeout = BinarySemaphore::NO_BLOCK_TICKS;
|
||||||
|
if(timeoutMs == BinarySemaphore::BLOCK_TIMEOUT) {
|
||||||
|
timeout = BinarySemaphore::BLOCK_TIMEOUT_TICKS;
|
||||||
|
}
|
||||||
|
else if(timeoutMs > BinarySemaphore::NO_BLOCK_TIMEOUT){
|
||||||
|
timeout = pdMS_TO_TICKS(timeoutMs);
|
||||||
|
}
|
||||||
|
|
||||||
|
BaseType_t returncode = xSemaphoreTake(handle, timeout);
|
||||||
|
if (returncode == pdPASS) {
|
||||||
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
return SEMAPHORE_TIMEOUT;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t BinarySemaphore::takeBinarySemaphoreTickTimeout(
|
||||||
|
TickType_t timeoutTicks) {
|
||||||
|
if(handle == nullptr) {
|
||||||
|
return SEMAPHORE_NULLPOINTER;
|
||||||
|
}
|
||||||
|
|
||||||
|
BaseType_t returncode = xSemaphoreTake(handle, timeoutTicks);
|
||||||
|
if (returncode == pdPASS) {
|
||||||
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
|
} else {
|
||||||
|
return SEMAPHORE_TIMEOUT;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t BinarySemaphore::giveBinarySemaphore() {
|
||||||
|
if (handle == nullptr) {
|
||||||
|
return SEMAPHORE_NULLPOINTER;
|
||||||
|
}
|
||||||
|
BaseType_t returncode = xSemaphoreGive(handle);
|
||||||
|
if (returncode == pdPASS) {
|
||||||
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
|
} else {
|
||||||
|
return SEMAPHORE_NOT_OWNED;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
SemaphoreHandle_t BinarySemaphore::getSemaphore() {
|
||||||
|
return handle;
|
||||||
|
}
|
||||||
|
|
||||||
|
ReturnValue_t BinarySemaphore::giveBinarySemaphore(SemaphoreHandle_t semaphore) {
|
||||||
|
if (semaphore == nullptr) {
|
||||||
|
return SEMAPHORE_NULLPOINTER;
|
||||||
|
}
|
||||||
|
BaseType_t returncode = xSemaphoreGive(semaphore);
|
||||||
|
if (returncode == pdPASS) {
|
||||||
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
|
} else {
|
||||||
|
return HasReturnvaluesIF::RETURN_FAILED;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void BinarySemaphore::resetSemaphore() {
|
||||||
|
if(handle != nullptr) {
|
||||||
|
vSemaphoreDelete(handle);
|
||||||
|
handle = xSemaphoreCreateBinary();
|
||||||
|
xSemaphoreGive(handle);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Be careful with the stack size here. This is called from an ISR!
|
||||||
|
ReturnValue_t BinarySemaphore::giveBinarySemaphoreFromISR(SemaphoreHandle_t semaphore,
|
||||||
|
BaseType_t * higherPriorityTaskWoken) {
|
||||||
|
if (semaphore == nullptr) {
|
||||||
|
return SEMAPHORE_NULLPOINTER;
|
||||||
|
}
|
||||||
|
BaseType_t returncode = xSemaphoreGiveFromISR(semaphore, higherPriorityTaskWoken);
|
||||||
|
if (returncode == pdPASS) {
|
||||||
|
if(*higherPriorityTaskWoken == pdPASS) {
|
||||||
|
// Request context switch because unblocking the semaphore
|
||||||
|
// caused a high priority task unblock.
|
||||||
|
TaskManagement::requestContextSwitch(CallContext::isr);
|
||||||
|
}
|
||||||
|
return HasReturnvaluesIF::RETURN_OK;
|
||||||
|
} else {
|
||||||
|
return SEMAPHORE_NOT_OWNED;
|
||||||
|
}
|
||||||
|
}
|
134
osal/FreeRTOS/BinarySemaphore.h
Normal file
134
osal/FreeRTOS/BinarySemaphore.h
Normal file
@ -0,0 +1,134 @@
|
|||||||
|
/**
|
||||||
|
* @file BinarySempahore.h
|
||||||
|
*
|
||||||
|
* @date 25.02.2020
|
||||||
|
*/
|
||||||
|
#ifndef FRAMEWORK_OSAL_FREERTOS_BINARYSEMPAHORE_H_
|
||||||
|
#define FRAMEWORK_OSAL_FREERTOS_BINARYSEMPAHORE_H_
|
||||||
|
|
||||||
|
#include <framework/returnvalues/HasReturnvaluesIF.h>
|
||||||
|
|
||||||
|
extern "C" {
|
||||||
|
#include "FreeRTOS.h"
|
||||||
|
#include "semphr.h"
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief OS Tool to achieve synchronization of between tasks or between task and ISR
|
||||||
|
* @details
|
||||||
|
* Documentation: https://www.freertos.org/Embedded-RTOS-Binary-Semaphores.html
|
||||||
|
*
|
||||||
|
* SHOULDDO: check freeRTOS version and use new task notifications,
|
||||||
|
* if non-ancient freeRTOS version is used.
|
||||||
|
*
|
||||||
|
* @ingroup osal
|
||||||
|
*/
|
||||||
|
class BinarySemaphore: public HasReturnvaluesIF {
|
||||||
|
public:
|
||||||
|
static const uint8_t INTERFACE_ID = CLASS_ID::SEMAPHORE_IF;
|
||||||
|
|
||||||
|
//! No block time, poll the semaphore. Can also be used as tick type.
|
||||||
|
//! Can be passed as tick type and ms value.
|
||||||
|
static constexpr uint32_t NO_BLOCK_TIMEOUT = 0;
|
||||||
|
static constexpr TickType_t NO_BLOCK_TICKS = 0;
|
||||||
|
//! No block time, poll the semaphore.
|
||||||
|
//! Can be passed as tick type and ms value.
|
||||||
|
static constexpr TickType_t BLOCK_TIMEOUT_TICKS = portMAX_DELAY;
|
||||||
|
static constexpr uint32_t BLOCK_TIMEOUT = portMAX_DELAY;
|
||||||
|
|
||||||
|
//! Semaphore timeout
|
||||||
|
static constexpr ReturnValue_t SEMAPHORE_TIMEOUT = MAKE_RETURN_CODE(1);
|
||||||
|
/** The current semaphore can not be given, because it is not owned */
|
||||||
|
static constexpr ReturnValue_t SEMAPHORE_NOT_OWNED = MAKE_RETURN_CODE(2);
|
||||||
|
static constexpr ReturnValue_t SEMAPHORE_NULLPOINTER = MAKE_RETURN_CODE(3);
|
||||||
|
|
||||||
|
BinarySemaphore();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Copy ctor
|
||||||
|
*/
|
||||||
|
BinarySemaphore(const BinarySemaphore&);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Copy assignment
|
||||||
|
*/
|
||||||
|
BinarySemaphore& operator=(const BinarySemaphore&);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Move constructor
|
||||||
|
*/
|
||||||
|
BinarySemaphore (BinarySemaphore &&);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Move assignment
|
||||||
|
*/
|
||||||
|
BinarySemaphore & operator=(BinarySemaphore &&);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Delete the binary semaphore to prevent a memory leak
|
||||||
|
*/
|
||||||
|
virtual ~BinarySemaphore();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Take the binary semaphore.
|
||||||
|
* If the semaphore has already been taken, the task will be blocked
|
||||||
|
* for a maximum of #timeoutMs or until the semaphore is given back,
|
||||||
|
* for example by an ISR or another task.
|
||||||
|
* @param timeoutMs
|
||||||
|
* @return -@c RETURN_OK on success
|
||||||
|
* -@c RETURN_FAILED on failure
|
||||||
|
*/
|
||||||
|
ReturnValue_t takeBinarySemaphore(uint32_t timeoutMs =
|
||||||
|
BinarySemaphore::NO_BLOCK_TIMEOUT);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Same as lockBinarySemaphore() with timeout in FreeRTOS ticks.
|
||||||
|
* @param timeoutTicks
|
||||||
|
* @return - @c RETURN_OK on success
|
||||||
|
* - @c RETURN_FAILED on failure
|
||||||
|
*/
|
||||||
|
ReturnValue_t takeBinarySemaphoreTickTimeout(TickType_t timeoutTicks =
|
||||||
|
BinarySemaphore::NO_BLOCK_TICKS);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Give back the binary semaphore
|
||||||
|
* @return - @c RETURN_OK on success
|
||||||
|
* - @c RETURN_FAILED on failure
|
||||||
|
*/
|
||||||
|
ReturnValue_t giveBinarySemaphore();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Get Handle to the semaphore.
|
||||||
|
* @return
|
||||||
|
*/
|
||||||
|
SemaphoreHandle_t getSemaphore();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Reset the semaphore.
|
||||||
|
*/
|
||||||
|
void resetSemaphore();
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Wrapper function to give back semaphore from handle
|
||||||
|
* @param semaphore
|
||||||
|
* @return - @c RETURN_OK on success
|
||||||
|
* - @c RETURN_FAILED on failure
|
||||||
|
*/
|
||||||
|
static ReturnValue_t giveBinarySemaphore(SemaphoreHandle_t semaphore);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Wrapper function to give back semaphore from handle when called from an ISR
|
||||||
|
* @param semaphore
|
||||||
|
* @param higherPriorityTaskWoken This will be set to pdPASS if a task with a higher priority
|
||||||
|
* was unblocked
|
||||||
|
* @return - @c RETURN_OK on success
|
||||||
|
* - @c RETURN_FAILED on failure
|
||||||
|
*/
|
||||||
|
static ReturnValue_t giveBinarySemaphoreFromISR(SemaphoreHandle_t semaphore,
|
||||||
|
BaseType_t * higherPriorityTaskWoken);
|
||||||
|
private:
|
||||||
|
SemaphoreHandle_t handle;
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif /* FRAMEWORK_OSAL_FREERTOS_BINARYSEMPAHORE_H_ */
|
@ -1,10 +1,11 @@
|
|||||||
#include <framework/osal/FreeRTOS/TaskManagement.h>
|
#include <framework/osal/FreeRTOS/TaskManagement.h>
|
||||||
|
|
||||||
void TaskManagement::requestContextSwitchFromTask() {
|
void TaskManagement::requestContextSwitchFromTask() {
|
||||||
vTaskDelay(0);
|
vTaskDelay(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
void TaskManagement::requestContextSwitch(CallContext callContext = CallContext::task) {
|
void TaskManagement::requestContextSwitch(
|
||||||
|
CallContext callContext = CallContext::task) {
|
||||||
if(callContext == CallContext::isr) {
|
if(callContext == CallContext::isr) {
|
||||||
// This function depends on the partmacro.h definition for the specific device
|
// This function depends on the partmacro.h definition for the specific device
|
||||||
requestContextSwitchFromISR();
|
requestContextSwitchFromISR();
|
||||||
@ -12,7 +13,7 @@ void TaskManagement::requestContextSwitch(CallContext callContext = CallContext:
|
|||||||
requestContextSwitchFromTask();
|
requestContextSwitchFromTask();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
TaskHandle_t TaskManagement::getCurrentTaskHandle() {
|
TaskHandle_t TaskManagement::getCurrentTaskHandle() {
|
||||||
return xTaskGetCurrentTaskHandle();
|
return xTaskGetCurrentTaskHandle();
|
||||||
}
|
}
|
||||||
@ -20,5 +21,3 @@ TaskHandle_t TaskManagement::getCurrentTaskHandle() {
|
|||||||
configSTACK_DEPTH_TYPE TaskManagement::getTaskStackHighWatermark() {
|
configSTACK_DEPTH_TYPE TaskManagement::getTaskStackHighWatermark() {
|
||||||
return uxTaskGetStackHighWaterMark(TaskManagement::getCurrentTaskHandle());
|
return uxTaskGetStackHighWaterMark(TaskManagement::getCurrentTaskHandle());
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
@ -8,7 +8,7 @@ extern "C" {
|
|||||||
#include <freertos/task.h>
|
#include <freertos/task.h>
|
||||||
}
|
}
|
||||||
#include <cstdint>
|
#include <cstdint>
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Architecture dependant portmacro.h function call.
|
* Architecture dependant portmacro.h function call.
|
||||||
* Should be implemented in bsp.
|
* Should be implemented in bsp.
|
||||||
@ -18,7 +18,8 @@ extern "C" void requestContextSwitchFromISR();
|
|||||||
/*!
|
/*!
|
||||||
* Used by functions to tell if they are being called from
|
* Used by functions to tell if they are being called from
|
||||||
* within an ISR or from a regular task. This is required because FreeRTOS
|
* within an ISR or from a regular task. This is required because FreeRTOS
|
||||||
* has different functions for handling semaphores and messages from within an ISR and task.
|
* has different functions for handling semaphores and messages from within
|
||||||
|
* an ISR and task.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
enum CallContext {
|
enum CallContext {
|
||||||
@ -30,10 +31,10 @@ enum CallContext {
|
|||||||
class TaskManagement {
|
class TaskManagement {
|
||||||
public:
|
public:
|
||||||
/**
|
/**
|
||||||
* In this function, a function dependant on the portmacro.h header function calls
|
* @brief In this function, a function dependant on the portmacro.h header
|
||||||
* to request a context switch can be specified.
|
* function calls to request a context switch can be specified.
|
||||||
* This can be used if sending to the queue from an ISR caused a task to unblock
|
* This can be used if sending to the queue from an ISR caused a task
|
||||||
* and a context switch is required.
|
* to unblock and a context switch is required.
|
||||||
*/
|
*/
|
||||||
static void requestContextSwitch(CallContext callContext);
|
static void requestContextSwitch(CallContext callContext);
|
||||||
|
|
||||||
@ -41,7 +42,7 @@ public:
|
|||||||
* If task preemption in FreeRTOS is disabled, a context switch
|
* If task preemption in FreeRTOS is disabled, a context switch
|
||||||
* can be requested manually by calling this function.
|
* can be requested manually by calling this function.
|
||||||
*/
|
*/
|
||||||
static void requestContextSwitchFromTask(void);
|
static void requestContextSwitchFromTask(void);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @return The current task handle
|
* @return The current task handle
|
||||||
@ -57,7 +58,7 @@ public:
|
|||||||
* @return Smallest value of stack remaining since the task was started in
|
* @return Smallest value of stack remaining since the task was started in
|
||||||
* words.
|
* words.
|
||||||
*/
|
*/
|
||||||
static configSTACK_DEPTH_TYPE getTaskStackHighWatermark();
|
static configSTACK_DEPTH_TYPE getTaskStackHighWatermark();
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif /* FRAMEWORK_OSAL_FREERTOS_TASKMANAGEMENT_H_ */
|
#endif /* FRAMEWORK_OSAL_FREERTOS_TASKMANAGEMENT_H_ */
|
||||||
|
Loading…
Reference in New Issue
Block a user