steering-wheel/Middlewares/ST/touchgfx/os/OSWrappers.cpp

109 lines
2.7 KiB
C++

#include <touchgfx/hal/OSWrappers.hpp>
#include "FreeRTOS.h"
#include "task.h"
#include "queue.h"
#include "semphr.h"
#include <touchgfx/hal/GPIO.hpp>
#include <touchgfx/hal/HAL.hpp>
using namespace touchgfx;
static xSemaphoreHandle frame_buffer_sem;
static xQueueHandle vsync_q = 0;
// Just a dummy value to insert in the VSYNC queue.
static uint8_t dummy = 0x5a;
void OSWrappers::initialize()
{
vSemaphoreCreateBinary(frame_buffer_sem);
// Create a queue of length 1
vsync_q = xQueueGenericCreate(1, 1, 0);
}
void OSWrappers::takeFrameBufferSemaphore()
{
xSemaphoreTake(frame_buffer_sem, portMAX_DELAY);
}
void OSWrappers::giveFrameBufferSemaphore()
{
xSemaphoreGive(frame_buffer_sem);
}
void OSWrappers::tryTakeFrameBufferSemaphore()
{
xSemaphoreTake(frame_buffer_sem, 0);
}
void OSWrappers::giveFrameBufferSemaphoreFromISR()
{
// Since this is called from an interrupt, FreeRTOS requires special handling to trigger a
// re-scheduling. May be applicable for other OSes as well.
portBASE_TYPE px = pdFALSE;
xSemaphoreGiveFromISR(frame_buffer_sem, &px);
portEND_SWITCHING_ISR(px);
}
void OSWrappers::signalVSync()
{
if (vsync_q)
{
// Since this is called from an interrupt, FreeRTOS requires special handling to trigger a
// re-scheduling. May be applicable for other OSes as well.
portBASE_TYPE px = pdFALSE;
xQueueSendFromISR(vsync_q, &dummy, &px);
portEND_SWITCHING_ISR(px);
}
}
void OSWrappers::waitForVSync()
{
// First make sure the queue is empty, by trying to remove an element with 0 timeout.
xQueueReceive(vsync_q, &dummy, 0);
// Then, wait for next VSYNC to occur.
xQueueReceive(vsync_q, &dummy, portMAX_DELAY);
}
void OSWrappers::taskDelay(uint16_t ms)
{
vTaskDelay(ms);
}
static portBASE_TYPE IdleTaskHook(void* p)
{
if ((int)p) // Idle task sched out
{
touchgfx::HAL::getInstance()->setMCUActive(true);
}
else // Idle task sched in
{
touchgfx::HAL::getInstance()->setMCUActive(false);
}
return pdTRUE;
}
// FreeRTOS specific handlers
extern "C"
{
void vApplicationStackOverflowHook(xTaskHandle xTask,
signed portCHAR* pcTaskName)
{
while (1);
}
void vApplicationMallocFailedHook(xTaskHandle xTask,
signed portCHAR* pcTaskName)
{
while (1);
}
void vApplicationIdleHook(void)
{
// Set task tag in order to have the "IdleTaskHook" function called when the idle task is
// switched in/out. Used solely for measuring MCU load, and can be removed if MCU load
// readout is not needed.
vTaskSetApplicationTaskTag(NULL, IdleTaskHook);
}
}