You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
89 lines
2.1 KiB
89 lines
2.1 KiB
//
|
|
// Created by MightyPork on 2017/11/21.
|
|
//
|
|
|
|
#include "platform.h"
|
|
#include "task_sched.h"
|
|
|
|
extern osMessageQId queSchedLPHandle;
|
|
extern osMessageQId queSchedHPHandle;
|
|
|
|
volatile uint32_t jobQueHighWaterMarkHP = 0;
|
|
volatile uint32_t jobQueHighWaterMarkLP = 0;
|
|
|
|
/**
|
|
* Schedule a function for later execution in the jobs thread
|
|
*
|
|
* @param callback - the callback function
|
|
* @param prio - priority, selects which job queue to use
|
|
* @param data1 - first data object, NULL if not needed; usually context/handle
|
|
* @param data2 - second data object, NULL if not needed; usually data/argument
|
|
*/
|
|
void scheduleJob(Job *job, enum task_sched_prio prio)
|
|
{
|
|
QueueHandle_t que = (prio == TSK_SCHED_LOW ? queSchedLPHandle : queSchedHPHandle);
|
|
|
|
assert_param(que != NULL);
|
|
assert_param(job->cb != NULL);
|
|
|
|
uint32_t count;
|
|
if (inIRQ()) {
|
|
BaseType_t xHigherPriorityTaskWoken = pdFALSE;
|
|
assert_param(pdPASS == xQueueSendFromISR(que, job, &xHigherPriorityTaskWoken));
|
|
portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
|
|
|
|
#if USE_STACK_MONITOR
|
|
count = (uint32_t) uxQueueMessagesWaitingFromISR(que);
|
|
#endif
|
|
} else {
|
|
assert_param(pdPASS == xQueueSend(que, job, 100));
|
|
|
|
#if USE_STACK_MONITOR
|
|
count = (uint32_t) uxQueueMessagesWaiting(que);
|
|
#endif
|
|
}
|
|
|
|
#if USE_STACK_MONITOR
|
|
if (prio == TSK_SCHED_LOW) {
|
|
jobQueHighWaterMarkLP = MAX(jobQueHighWaterMarkLP, count);
|
|
} else {
|
|
jobQueHighWaterMarkHP = MAX(jobQueHighWaterMarkHP, count);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/**
|
|
* Low priority task queue handler
|
|
*
|
|
* @param argument
|
|
*/
|
|
void TaskSchedLP (const void * argument)
|
|
{
|
|
dbg("> Low priority queue task started!");
|
|
|
|
struct sched_que_item job;
|
|
while (1) {
|
|
xQueueReceive(queSchedLPHandle, &job, osWaitForever);
|
|
|
|
assert_param(job.cb != NULL);
|
|
job.cb(&job);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* High priority task queue handler
|
|
*
|
|
* @param argument
|
|
*/
|
|
void TaskSchedHP (const void * argument)
|
|
{
|
|
dbg("> High priority queue task started!");
|
|
|
|
struct sched_que_item job;
|
|
while (1) {
|
|
xQueueReceive(queSchedHPHandle, &job, osWaitForever);
|
|
|
|
assert_param(job.cb != NULL);
|
|
job.cb(&job);
|
|
}
|
|
}
|
|
|