122 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			122 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
 | 
						|
#include <touchgfx/hal/OSWrappers.hpp>
 | 
						|
#include <touchgfx/hal/GPIO.hpp>
 | 
						|
#include <touchgfx/hal/HAL.hpp>
 | 
						|
 | 
						|
#include <assert.h>
 | 
						|
#include <cmsis_os.h>
 | 
						|
 | 
						|
using namespace touchgfx;
 | 
						|
 | 
						|
static osSemaphoreId frame_buffer_sem = 0;
 | 
						|
static osMessageQId vsync_queue = 0;
 | 
						|
 | 
						|
// Just a dummy value to insert in the VSYNC queue.
 | 
						|
static uint32_t dummy = 0x5a;
 | 
						|
 | 
						|
void OSWrappers::initialize()
 | 
						|
{
 | 
						|
    // Create a queue of length 1
 | 
						|
    osSemaphoreDef(frame_buffer_sem);
 | 
						|
    frame_buffer_sem = osSemaphoreCreate(osSemaphore(frame_buffer_sem), 1); // Binary semaphore
 | 
						|
    osSemaphoreWait(frame_buffer_sem, osWaitForever); // take the lock
 | 
						|
 | 
						|
    // Create a queue of length 1
 | 
						|
    osMessageQDef(vsync_queue, 1, uint32_t);
 | 
						|
    vsync_queue = osMessageCreate(osMessageQ(vsync_queue),NULL);
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::takeFrameBufferSemaphore()
 | 
						|
{
 | 
						|
    assert(frame_buffer_sem);
 | 
						|
    osSemaphoreWait(frame_buffer_sem, osWaitForever);
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::giveFrameBufferSemaphore()
 | 
						|
{
 | 
						|
    assert(frame_buffer_sem);
 | 
						|
    osSemaphoreRelease(frame_buffer_sem);
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::tryTakeFrameBufferSemaphore()
 | 
						|
{
 | 
						|
    assert(frame_buffer_sem);
 | 
						|
    osSemaphoreWait(frame_buffer_sem, 0);
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::giveFrameBufferSemaphoreFromISR()
 | 
						|
{
 | 
						|
    assert(frame_buffer_sem);
 | 
						|
    osSemaphoreRelease(frame_buffer_sem);
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::signalVSync()
 | 
						|
{
 | 
						|
    if (vsync_queue)
 | 
						|
    {
 | 
						|
        osMessagePut(vsync_queue, dummy, 0);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::waitForVSync()
 | 
						|
{
 | 
						|
    if (vsync_queue)
 | 
						|
    {
 | 
						|
        // First make sure the queue is empty, by trying to remove an element with 0 timeout.
 | 
						|
        osMessageGet(vsync_queue, 0);
 | 
						|
 | 
						|
        // Then, wait for next VSYNC to occur.
 | 
						|
        osMessageGet(vsync_queue, osWaitForever);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
void OSWrappers::taskDelay(uint16_t ms)
 | 
						|
{
 | 
						|
    osDelay(static_cast<uint32_t>(ms));
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
// NOTE:
 | 
						|
// The remainder of this file is FreeRTOS-specific. If using a different OS,
 | 
						|
// you can just remove all the following code, as it is optional.
 | 
						|
// However, if MCU load percentage readout is required, you need to find a way
 | 
						|
// to inform TouchGFX of when the idle task is switched in/out and call the
 | 
						|
// setMCUActive function accordingly (see below).
 | 
						|
 | 
						|
//FreeRTOS hook function being called when idle task is switched in or out.
 | 
						|
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;
 | 
						|
}
 | 
						|
 | 
						|
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);
 | 
						|
    }
 | 
						|
}
 |