123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872 |
- /* --------------------------------------------------------------------------
- * Portions Copyright © 2017 STMicroelectronics International N.V. All rights reserved.
- * Portions Copyright (c) 2013-2017 ARM Limited. All rights reserved.
- * --------------------------------------------------------------------------
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Licensed under the Apache License, Version 2.0 (the License); you may
- * not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an AS IS BASIS, WITHOUT
- * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- *
- * Name: cmsis_os2.c
- * Purpose: CMSIS RTOS2 wrapper for FreeRTOS
- *
- *---------------------------------------------------------------------------*/
- #include <string.h>
- #include "cmsis_os2.h" // ::CMSIS:RTOS2
- #include "cmsis_compiler.h"
- #include "FreeRTOS.h" // ARM.FreeRTOS::RTOS:Core
- #include "task.h" // ARM.FreeRTOS::RTOS:Core
- #include "event_groups.h" // ARM.FreeRTOS::RTOS:Event Groups
- #include "semphr.h" // ARM.FreeRTOS::RTOS:Core
- /*---------------------------------------------------------------------------*/
- #ifndef __ARM_ARCH_6M__
- #define __ARM_ARCH_6M__ 0
- #endif
- #ifndef __ARM_ARCH_7M__
- #define __ARM_ARCH_7M__ 0
- #endif
- #ifndef __ARM_ARCH_7EM__
- #define __ARM_ARCH_7EM__ 0
- #endif
- #ifndef __ARM_ARCH_8M_MAIN__
- #define __ARM_ARCH_8M_MAIN__ 0
- #endif
- #ifndef __ARM_ARCH_7A__
- #define __ARM_ARCH_7A__ 0
- #endif
- #if ((__ARM_ARCH_7M__ == 1U) || \
- (__ARM_ARCH_7EM__ == 1U) || \
- (__ARM_ARCH_8M_MAIN__ == 1U))
- #define IS_IRQ_MASKED() ((__get_PRIMASK() != 0U) || ((KernelState == osKernelRunning) && (__get_BASEPRI() != 0U)))
- #elif (__ARM_ARCH_6M__ == 1U)
- #define IS_IRQ_MASKED() ((__get_PRIMASK() != 0U) && (KernelState == osKernelRunning))
- #elif (__ARM_ARCH_7A__ == 1)
- #define IS_IRQ_MASKED() (0U)
- #else
- #define IS_IRQ_MASKED() (__get_PRIMASK() != 0U)
- #endif
- #if (__ARM_ARCH_7A__ == 1U)
- /* CPSR mode bitmasks */
- #define CPSR_MODE_USER 0x10U
- #define CPSR_MODE_SYSTEM 0x1FU
- #define IS_IRQ_MODE() ((__get_mode() != CPSR_MODE_USER) && (__get_mode() != CPSR_MODE_SYSTEM))
- #else
- #define IS_IRQ_MODE() (__get_IPSR() != 0U)
- #endif
- #define IS_IRQ() (IS_IRQ_MODE() || IS_IRQ_MASKED())
- /* Limits */
- #define MAX_BITS_TASK_NOTIFY 31U
- #define MAX_BITS_EVENT_GROUPS 24U
- #define THREAD_FLAGS_INVALID_BITS (~((1UL << MAX_BITS_TASK_NOTIFY) - 1U))
- #define EVENT_FLAGS_INVALID_BITS (~((1UL << MAX_BITS_EVENT_GROUPS) - 1U))
- /* Kernel version and identification string definition */
- #define KERNEL_VERSION (((uint32_t)tskKERNEL_VERSION_MAJOR * 10000000UL) | \
- ((uint32_t)tskKERNEL_VERSION_MINOR * 10000UL) | \
- ((uint32_t)tskKERNEL_VERSION_BUILD * 1UL))
- #define KERNEL_ID "FreeRTOS V10.0.1"
- /* Timer callback information structure definition */
- typedef struct {
- osTimerFunc_t func;
- void *arg;
- } TimerCallback_t;
- /* Kernel initialization state */
- static osKernelState_t KernelState;
- /* Heap region definition used by heap_5 variant */
- #if defined(USE_FreeRTOS_HEAP_5)
- #if (configAPPLICATION_ALLOCATED_HEAP == 1)
- /*
- The application writer has already defined the array used for the RTOS
- heap - probably so it can be placed in a special segment or address.
- */
- extern uint8_t ucHeap[configTOTAL_HEAP_SIZE];
- #else
- static uint8_t ucHeap[configTOTAL_HEAP_SIZE];
- #endif /* configAPPLICATION_ALLOCATED_HEAP */
- static HeapRegion_t xHeapRegions[] = {
- { ucHeap, configTOTAL_HEAP_SIZE },
- { NULL, 0 }
- };
- #endif /* USE_FreeRTOS_HEAP_5 */
- #if defined(SysTick)
- /* FreeRTOS tick timer interrupt handler prototype */
- extern void xPortSysTickHandler (void);
- /*
- SysTick handler implementation that also clears overflow flag.
- */
- void SysTick_Handler (void) {
- /* Clear overflow flag */
- SysTick->CTRL;
- /* Call tick handler */
- xPortSysTickHandler();
- }
- #endif /* SysTick */
- /*---------------------------------------------------------------------------*/
- osStatus_t osKernelInitialize (void) {
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else {
- if (KernelState == osKernelInactive) {
- #if defined(USE_FreeRTOS_HEAP_5)
- vPortDefineHeapRegions (xHeapRegions);
- #endif
- KernelState = osKernelReady;
- stat = osOK;
- } else {
- stat = osError;
- }
- }
- return (stat);
- }
- osStatus_t osKernelGetInfo (osVersion_t *version, char *id_buf, uint32_t id_size) {
- if (version != NULL) {
- version->api = KERNEL_VERSION;
- version->kernel = KERNEL_VERSION;
- }
- if ((id_buf != NULL) && (id_size != 0U)) {
- if (id_size > sizeof(KERNEL_ID)) {
- id_size = sizeof(KERNEL_ID);
- }
- memcpy(id_buf, KERNEL_ID, id_size);
- }
- return (osOK);
- }
- osKernelState_t osKernelGetState (void) {
- osKernelState_t state;
- switch (xTaskGetSchedulerState()) {
- case taskSCHEDULER_RUNNING:
- state = osKernelRunning;
- break;
- case taskSCHEDULER_SUSPENDED:
- state = osKernelLocked;
- break;
- case taskSCHEDULER_NOT_STARTED:
- default:
- if (KernelState == osKernelReady) {
- state = osKernelReady;
- } else {
- state = osKernelInactive;
- }
- break;
- }
- return (state);
- }
- osStatus_t osKernelStart (void) {
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else {
- if (KernelState == osKernelReady) {
- KernelState = osKernelRunning;
- vTaskStartScheduler();
- stat = osOK;
- } else {
- stat = osError;
- }
- }
- return (stat);
- }
- int32_t osKernelLock (void) {
- int32_t lock;
- if (IS_IRQ()) {
- lock = (int32_t)osErrorISR;
- }
- else {
- switch (xTaskGetSchedulerState()) {
- case taskSCHEDULER_SUSPENDED:
- lock = 1;
- break;
- case taskSCHEDULER_RUNNING:
- vTaskSuspendAll();
- lock = 0;
- break;
- case taskSCHEDULER_NOT_STARTED:
- default:
- lock = (int32_t)osError;
- break;
- }
- }
- return (lock);
- }
- int32_t osKernelUnlock (void) {
- int32_t lock;
- if (IS_IRQ()) {
- lock = (int32_t)osErrorISR;
- }
- else {
- switch (xTaskGetSchedulerState()) {
- case taskSCHEDULER_SUSPENDED:
- lock = 1;
- if (xTaskResumeAll() != pdTRUE) {
- if (xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED) {
- lock = (int32_t)osError;
- }
- }
- break;
- case taskSCHEDULER_RUNNING:
- lock = 0;
- break;
- case taskSCHEDULER_NOT_STARTED:
- default:
- lock = (int32_t)osError;
- break;
- }
- }
- return (lock);
- }
- int32_t osKernelRestoreLock (int32_t lock) {
- if (IS_IRQ()) {
- lock = (int32_t)osErrorISR;
- }
- else {
- switch (xTaskGetSchedulerState()) {
- case taskSCHEDULER_SUSPENDED:
- case taskSCHEDULER_RUNNING:
- if (lock == 1) {
- vTaskSuspendAll();
- }
- else {
- if (lock != 0) {
- lock = (int32_t)osError;
- }
- else {
- if (xTaskResumeAll() != pdTRUE) {
- if (xTaskGetSchedulerState() != taskSCHEDULER_RUNNING) {
- lock = (int32_t)osError;
- }
- }
- }
- }
- break;
- case taskSCHEDULER_NOT_STARTED:
- default:
- lock = (int32_t)osError;
- break;
- }
- }
- return (lock);
- }
- uint32_t osKernelGetTickCount (void) {
- TickType_t ticks;
- if (IS_IRQ()) {
- ticks = xTaskGetTickCountFromISR();
- } else {
- ticks = xTaskGetTickCount();
- }
- return (ticks);
- }
- uint32_t osKernelGetTickFreq (void) {
- return (configTICK_RATE_HZ);
- }
- uint32_t osKernelGetSysTimerCount (void) {
- TickType_t ticks;
- uint32_t val;
- portDISABLE_INTERRUPTS();
- ticks = xTaskGetTickCount();
- val = ticks * ( configCPU_CLOCK_HZ / configTICK_RATE_HZ );
- portENABLE_INTERRUPTS();
- return (val);
- }
- uint32_t osKernelGetSysTimerFreq (void) {
- return (configCPU_CLOCK_HZ);
- }
- /*---------------------------------------------------------------------------*/
- osThreadId_t osThreadNew (osThreadFunc_t func, void *argument, const osThreadAttr_t *attr) {
- char empty;
- const char *name;
- uint32_t stack;
- TaskHandle_t hTask;
- UBaseType_t prio;
- int32_t mem;
- hTask = NULL;
- if (!IS_IRQ() && (func != NULL)) {
- stack = configMINIMAL_STACK_SIZE;
- prio = (UBaseType_t)osPriorityNormal;
- empty = '\0';
- name = ∅
- mem = -1;
- if (attr != NULL) {
- if (attr->name != NULL) {
- name = attr->name;
- }
- if (attr->priority != osPriorityNone) {
- prio = (UBaseType_t)attr->priority;
- }
- if ((prio < osPriorityIdle) || (prio > osPriorityISR) || ((attr->attr_bits & osThreadJoinable) == osThreadJoinable)) {
- return (NULL);
- }
- if (attr->stack_size > 0U) {
- /* In FreeRTOS stack is not in bytes, but in sizeof(StackType_t) which is 4 on ARM ports. */
- /* Stack size should be therefore 4 byte aligned in order to avoid division caused side effects */
- stack = attr->stack_size / sizeof(StackType_t);
- }
- if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticTask_t)) &&
- (attr->stack_mem != NULL) && (attr->stack_size > 0U)) {
- mem = 1;
- }
- else {
- if ((attr->cb_mem == NULL) && (attr->cb_size == 0U) && (attr->stack_mem == NULL)) {
- mem = 0;
- }
- }
- }
- else {
- mem = 0;
- }
- if (mem == 1) {
- hTask = xTaskCreateStatic ((TaskFunction_t)func, name, stack, argument, prio, (StackType_t *)attr->stack_mem,
- (StaticTask_t *)attr->cb_mem);
- }
- else {
- if (mem == 0) {
- if (xTaskCreate ((TaskFunction_t)func, name, (uint16_t)stack, argument, prio, &hTask) != pdPASS) {
- hTask = NULL;
- }
- }
- }
- }
- return ((osThreadId_t)hTask);
- }
- const char *osThreadGetName (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- const char *name;
- if (IS_IRQ() || (hTask == NULL)) {
- name = NULL;
- } else {
- name = pcTaskGetName (hTask);
- }
- return (name);
- }
- osThreadId_t osThreadGetId (void) {
- osThreadId_t id;
- if (IS_IRQ()) {
- id = NULL;
- } else {
- id = (osThreadId_t)xTaskGetCurrentTaskHandle();
- }
- return (id);
- }
- osThreadState_t osThreadGetState (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- osThreadState_t state;
- if (IS_IRQ() || (hTask == NULL)) {
- state = osThreadError;
- }
- else {
- switch (eTaskGetState (hTask)) {
- case eRunning: state = osThreadRunning; break;
- case eReady: state = osThreadReady; break;
- case eBlocked:
- case eSuspended: state = osThreadBlocked; break;
- case eDeleted: state = osThreadTerminated; break;
- case eInvalid:
- default: state = osThreadError; break;
- }
- }
- return (state);
- }
- uint32_t osThreadGetStackSpace (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- uint32_t sz;
- if (IS_IRQ() || (hTask == NULL)) {
- sz = 0U;
- } else {
- sz = (uint32_t)uxTaskGetStackHighWaterMark (hTask);
- }
- return (sz);
- }
- uint32_t osThreadGetStackSize (osThreadId_t thread_id) {
- /*
- * this implmentation is not correct.
- * this function is implmented to avoid link errors (undefined reference)
- * Bug reported : https://github.com/ARM-software/CMSIS-FreeRTOS/issues/14
- */
- (void) thread_id;
- return 0;
- }
- osStatus_t osThreadSetPriority (osThreadId_t thread_id, osPriority_t priority) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if ((hTask == NULL) || (priority < osPriorityIdle) || (priority > osPriorityISR)) {
- stat = osErrorParameter;
- }
- else {
- stat = osOK;
- vTaskPrioritySet (hTask, (UBaseType_t)priority);
- }
- return (stat);
- }
- osPriority_t osThreadGetPriority (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- osPriority_t prio;
- if (IS_IRQ() || (hTask == NULL)) {
- prio = osPriorityError;
- } else {
- prio = (osPriority_t)uxTaskPriorityGet (hTask);
- }
- return (prio);
- }
- osStatus_t osThreadYield (void) {
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- } else {
- stat = osOK;
- taskYIELD();
- }
- return (stat);
- }
- osStatus_t osThreadSuspend (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hTask == NULL) {
- stat = osErrorParameter;
- }
- else {
- stat = osOK;
- vTaskSuspend (hTask);
- }
- return (stat);
- }
- osStatus_t osThreadResume (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hTask == NULL) {
- stat = osErrorParameter;
- }
- else {
- stat = osOK;
- vTaskResume (hTask);
- }
- return (stat);
- }
- __NO_RETURN void osThreadExit (void) {
- #ifndef USE_FreeRTOS_HEAP_1
- vTaskDelete (NULL);
- #endif
- for (;;);
- }
- osStatus_t osThreadTerminate (osThreadId_t thread_id) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- osStatus_t stat;
- #ifndef USE_FreeRTOS_HEAP_1
- eTaskState tstate;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hTask == NULL) {
- stat = osErrorParameter;
- }
- else {
- tstate = eTaskGetState (hTask);
- if (tstate != eDeleted) {
- stat = osOK;
- vTaskDelete (hTask);
- } else {
- stat = osErrorResource;
- }
- }
- #else
- stat = osError;
- #endif
- return (stat);
- }
- uint32_t osThreadGetCount (void) {
- uint32_t count;
- if (IS_IRQ()) {
- count = 0U;
- } else {
- count = uxTaskGetNumberOfTasks();
- }
- return (count);
- }
- uint32_t osThreadEnumerate (osThreadId_t *thread_array, uint32_t array_items) {
- uint32_t i, count;
- TaskStatus_t *task;
- if (IS_IRQ() || (thread_array == NULL) || (array_items == 0U)) {
- count = 0U;
- } else {
- vTaskSuspendAll();
- count = uxTaskGetNumberOfTasks();
- task = pvPortMalloc (count * sizeof(TaskStatus_t));
- if (task != NULL) {
- count = uxTaskGetSystemState (task, count, NULL);
- for (i = 0U; (i < count) && (i < array_items); i++) {
- thread_array[i] = (osThreadId_t)task[i].xHandle;
- }
- count = i;
- }
- (void)xTaskResumeAll();
- vPortFree (task);
- }
- return (count);
- }
- uint32_t osThreadFlagsSet (osThreadId_t thread_id, uint32_t flags) {
- TaskHandle_t hTask = (TaskHandle_t)thread_id;
- uint32_t rflags;
- BaseType_t yield;
- if ((hTask == NULL) || ((flags & THREAD_FLAGS_INVALID_BITS) != 0U)) {
- rflags = (uint32_t)osErrorParameter;
- }
- else {
- rflags = (uint32_t)osError;
- if (IS_IRQ()) {
- yield = pdFALSE;
- (void)xTaskNotifyFromISR (hTask, flags, eSetBits, &yield);
- (void)xTaskNotifyAndQueryFromISR (hTask, 0, eNoAction, &rflags, NULL);
- portYIELD_FROM_ISR (yield);
- }
- else {
- (void)xTaskNotify (hTask, flags, eSetBits);
- (void)xTaskNotifyAndQuery (hTask, 0, eNoAction, &rflags);
- }
- }
- /* Return flags after setting */
- return (rflags);
- }
- uint32_t osThreadFlagsClear (uint32_t flags) {
- TaskHandle_t hTask;
- uint32_t rflags, cflags;
- if (IS_IRQ()) {
- rflags = (uint32_t)osErrorISR;
- }
- else if ((flags & THREAD_FLAGS_INVALID_BITS) != 0U) {
- rflags = (uint32_t)osErrorParameter;
- }
- else {
- hTask = xTaskGetCurrentTaskHandle();
- if (xTaskNotifyAndQuery (hTask, 0, eNoAction, &cflags) == pdPASS) {
- rflags = cflags;
- cflags &= ~flags;
- if (xTaskNotify (hTask, cflags, eSetValueWithOverwrite) != pdPASS) {
- rflags = (uint32_t)osError;
- }
- }
- else {
- rflags = (uint32_t)osError;
- }
- }
- /* Return flags before clearing */
- return (rflags);
- }
- uint32_t osThreadFlagsGet (void) {
- TaskHandle_t hTask;
- uint32_t rflags;
- if (IS_IRQ()) {
- rflags = (uint32_t)osErrorISR;
- }
- else {
- hTask = xTaskGetCurrentTaskHandle();
- if (xTaskNotifyAndQuery (hTask, 0, eNoAction, &rflags) != pdPASS) {
- rflags = (uint32_t)osError;
- }
- }
- return (rflags);
- }
- uint32_t osThreadFlagsWait (uint32_t flags, uint32_t options, uint32_t timeout) {
- uint32_t rflags, nval;
- uint32_t clear;
- TickType_t t0, td, tout;
- BaseType_t rval;
- if (IS_IRQ()) {
- rflags = (uint32_t)osErrorISR;
- }
- else if ((flags & THREAD_FLAGS_INVALID_BITS) != 0U) {
- rflags = (uint32_t)osErrorParameter;
- }
- else {
- if ((options & osFlagsNoClear) == osFlagsNoClear) {
- clear = 0U;
- } else {
- clear = flags;
- }
- rflags = 0U;
- tout = timeout;
- t0 = xTaskGetTickCount();
- do {
- rval = xTaskNotifyWait (0, clear, &nval, tout);
- if (rval == pdPASS) {
- rflags &= flags;
- rflags |= nval;
- if ((options & osFlagsWaitAll) == osFlagsWaitAll) {
- if ((flags & rflags) == flags) {
- break;
- } else {
- if (timeout == 0U) {
- rflags = (uint32_t)osErrorResource;
- break;
- }
- }
- }
- else {
- if ((flags & rflags) != 0) {
- break;
- } else {
- if (timeout == 0U) {
- rflags = (uint32_t)osErrorResource;
- break;
- }
- }
- }
- /* Update timeout */
- td = xTaskGetTickCount() - t0;
- if (td > tout) {
- tout = 0;
- } else {
- tout -= td;
- }
- }
- else {
- if (timeout == 0) {
- rflags = (uint32_t)osErrorResource;
- } else {
- rflags = (uint32_t)osErrorTimeout;
- }
- }
- }
- while (rval != pdFAIL);
- }
- /* Return flags before clearing */
- return (rflags);
- }
- osStatus_t osDelay (uint32_t ticks) {
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else {
- stat = osOK;
- if (ticks != 0U) {
- vTaskDelay(ticks);
- }
- }
- return (stat);
- }
- osStatus_t osDelayUntil (uint32_t ticks) {
- TickType_t tcnt;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else {
- stat = osOK;
- tcnt = xTaskGetTickCount();
- vTaskDelayUntil (&tcnt, (TickType_t)(ticks - tcnt));
- }
- return (stat);
- }
- /*---------------------------------------------------------------------------*/
- static void TimerCallback (TimerHandle_t hTimer) {
- TimerCallback_t *callb;
- callb = (TimerCallback_t *)pvTimerGetTimerID (hTimer);
- if (callb != NULL) {
- callb->func (callb->arg);
- }
- }
- osTimerId_t osTimerNew (osTimerFunc_t func, osTimerType_t type, void *argument, const osTimerAttr_t *attr) {
- const char *name;
- TimerHandle_t hTimer;
- TimerCallback_t *callb;
- UBaseType_t reload;
- int32_t mem;
- hTimer = NULL;
- if (!IS_IRQ() && (func != NULL)) {
- /* Allocate memory to store callback function and argument */
- callb = pvPortMalloc (sizeof(TimerCallback_t));
- if (callb != NULL) {
- callb->func = func;
- callb->arg = argument;
- if (type == osTimerOnce) {
- reload = pdFALSE;
- } else {
- reload = pdTRUE;
- }
- mem = -1;
- name = NULL;
- if (attr != NULL) {
- if (attr->name != NULL) {
- name = attr->name;
- }
- if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticTimer_t))) {
- mem = 1;
- }
- else {
- if ((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
- mem = 0;
- }
- }
- }
- else {
- mem = 0;
- }
- if (mem == 1) {
- hTimer = xTimerCreateStatic (name, 1, reload, callb, TimerCallback, (StaticTimer_t *)attr->cb_mem);
- }
- else {
- if (mem == 0) {
- hTimer = xTimerCreate (name, 1, reload, callb, TimerCallback);
- }
- }
- }
- }
- return ((osTimerId_t)hTimer);
- }
- const char *osTimerGetName (osTimerId_t timer_id) {
- TimerHandle_t hTimer = (TimerHandle_t)timer_id;
- const char *p;
- if (IS_IRQ() || (hTimer == NULL)) {
- p = NULL;
- } else {
- p = pcTimerGetName (hTimer);
- }
- return (p);
- }
- osStatus_t osTimerStart (osTimerId_t timer_id, uint32_t ticks) {
- TimerHandle_t hTimer = (TimerHandle_t)timer_id;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hTimer == NULL) {
- stat = osErrorParameter;
- }
- else {
- if (xTimerChangePeriod (hTimer, ticks, 0) == pdPASS) {
- stat = osOK;
- } else {
- stat = osErrorResource;
- }
- }
- return (stat);
- }
- osStatus_t osTimerStop (osTimerId_t timer_id) {
- TimerHandle_t hTimer = (TimerHandle_t)timer_id;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hTimer == NULL) {
- stat = osErrorParameter;
- }
- else {
- if (xTimerIsTimerActive (hTimer) == pdFALSE) {
- stat = osErrorResource;
- }
- else {
- if (xTimerStop (hTimer, 0) == pdPASS) {
- stat = osOK;
- } else {
- stat = osError;
- }
- }
- }
- return (stat);
- }
- uint32_t osTimerIsRunning (osTimerId_t timer_id) {
- TimerHandle_t hTimer = (TimerHandle_t)timer_id;
- uint32_t running;
- if (IS_IRQ() || (hTimer == NULL)) {
- running = 0U;
- } else {
- running = (uint32_t)xTimerIsTimerActive (hTimer);
- }
- return (running);
- }
- osStatus_t osTimerDelete (osTimerId_t timer_id) {
- TimerHandle_t hTimer = (TimerHandle_t)timer_id;
- osStatus_t stat;
- #ifndef USE_FreeRTOS_HEAP_1
- TimerCallback_t *callb;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hTimer == NULL) {
- stat = osErrorParameter;
- }
- else {
- callb = (TimerCallback_t *)pvTimerGetTimerID (hTimer);
- if (xTimerDelete (hTimer, 0) == pdPASS) {
- vPortFree (callb);
- stat = osOK;
- } else {
- stat = osErrorResource;
- }
- }
- #else
- stat = osError;
- #endif
- return (stat);
- }
- /*---------------------------------------------------------------------------*/
- osEventFlagsId_t osEventFlagsNew (const osEventFlagsAttr_t *attr) {
- EventGroupHandle_t hEventGroup;
- int32_t mem;
- hEventGroup = NULL;
- if (!IS_IRQ()) {
- mem = -1;
- if (attr != NULL) {
- if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticEventGroup_t))) {
- mem = 1;
- }
- else {
- if ((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
- mem = 0;
- }
- }
- }
- else {
- mem = 0;
- }
- if (mem == 1) {
- hEventGroup = xEventGroupCreateStatic (attr->cb_mem);
- }
- else {
- if (mem == 0) {
- hEventGroup = xEventGroupCreate();
- }
- }
- }
- return ((osEventFlagsId_t)hEventGroup);
- }
- uint32_t osEventFlagsSet (osEventFlagsId_t ef_id, uint32_t flags) {
- EventGroupHandle_t hEventGroup = (EventGroupHandle_t)ef_id;
- uint32_t rflags;
- BaseType_t yield;
- if ((hEventGroup == NULL) || ((flags & EVENT_FLAGS_INVALID_BITS) != 0U)) {
- rflags = (uint32_t)osErrorParameter;
- }
- else if (IS_IRQ()) {
- yield = pdFALSE;
- if (xEventGroupSetBitsFromISR (hEventGroup, (EventBits_t)flags, &yield) != pdFAIL) {
- rflags = (uint32_t)osErrorResource;
- } else {
- rflags = flags;
- portYIELD_FROM_ISR (yield);
- }
- }
- else {
- rflags = xEventGroupSetBits (hEventGroup, (EventBits_t)flags);
- }
- return (rflags);
- }
- uint32_t osEventFlagsClear (osEventFlagsId_t ef_id, uint32_t flags) {
- EventGroupHandle_t hEventGroup = (EventGroupHandle_t)ef_id;
- uint32_t rflags;
- if ((hEventGroup == NULL) || ((flags & EVENT_FLAGS_INVALID_BITS) != 0U)) {
- rflags = (uint32_t)osErrorParameter;
- }
- else if (IS_IRQ()) {
- rflags = xEventGroupGetBitsFromISR (hEventGroup);
- if (xEventGroupClearBitsFromISR (hEventGroup, (EventBits_t)flags) == pdFAIL) {
- rflags = (uint32_t)osErrorResource;
- }
- }
- else {
- rflags = xEventGroupClearBits (hEventGroup, (EventBits_t)flags);
- }
- return (rflags);
- }
- uint32_t osEventFlagsGet (osEventFlagsId_t ef_id) {
- EventGroupHandle_t hEventGroup = (EventGroupHandle_t)ef_id;
- uint32_t rflags;
- if (ef_id == NULL) {
- rflags = 0U;
- }
- else if (IS_IRQ()) {
- rflags = xEventGroupGetBitsFromISR (hEventGroup);
- }
- else {
- rflags = xEventGroupGetBits (hEventGroup);
- }
- return (rflags);
- }
- uint32_t osEventFlagsWait (osEventFlagsId_t ef_id, uint32_t flags, uint32_t options, uint32_t timeout) {
- EventGroupHandle_t hEventGroup = (EventGroupHandle_t)ef_id;
- BaseType_t wait_all;
- BaseType_t exit_clr;
- uint32_t rflags;
- if ((hEventGroup == NULL) || ((flags & EVENT_FLAGS_INVALID_BITS) != 0U)) {
- rflags = (uint32_t)osErrorParameter;
- }
- else if (IS_IRQ()) {
- rflags = (uint32_t)osErrorISR;
- }
- else {
- if (options & osFlagsWaitAll) {
- wait_all = pdTRUE;
- } else {
- wait_all = pdFAIL;
- }
- if (options & osFlagsNoClear) {
- exit_clr = pdFAIL;
- } else {
- exit_clr = pdTRUE;
- }
- rflags = xEventGroupWaitBits (hEventGroup, (EventBits_t)flags, exit_clr, wait_all, (TickType_t)timeout);
- if (options & osFlagsWaitAll) {
- if (flags != rflags) {
- if (timeout > 0U) {
- rflags = (uint32_t)osErrorTimeout;
- } else {
- rflags = (uint32_t)osErrorResource;
- }
- }
- }
- else {
- if ((flags & rflags) == 0U) {
- if (timeout > 0U) {
- rflags = (uint32_t)osErrorTimeout;
- } else {
- rflags = (uint32_t)osErrorResource;
- }
- }
- }
- }
- return (rflags);
- }
- osStatus_t osEventFlagsDelete (osEventFlagsId_t ef_id) {
- EventGroupHandle_t hEventGroup = (EventGroupHandle_t)ef_id;
- osStatus_t stat;
- #ifndef USE_FreeRTOS_HEAP_1
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hEventGroup == NULL) {
- stat = osErrorParameter;
- }
- else {
- stat = osOK;
- vEventGroupDelete (hEventGroup);
- }
- #else
- stat = osError;
- #endif
- return (stat);
- }
- /*---------------------------------------------------------------------------*/
- osMutexId_t osMutexNew (const osMutexAttr_t *attr) {
- SemaphoreHandle_t hMutex;
- uint32_t type;
- uint32_t rmtx;
- int32_t mem;
- #if (configQUEUE_REGISTRY_SIZE > 0)
- const char *name;
- #endif
- hMutex = NULL;
- if (!IS_IRQ()) {
- if (attr != NULL) {
- type = attr->attr_bits;
- } else {
- type = 0U;
- }
- if ((type & osMutexRecursive) == osMutexRecursive) {
- rmtx = 1U;
- } else {
- rmtx = 0U;
- }
- if ((type & osMutexRobust) != osMutexRobust) {
- mem = -1;
- if (attr != NULL) {
- if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticSemaphore_t))) {
- mem = 1;
- }
- else {
- if ((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
- mem = 0;
- }
- }
- }
- else {
- mem = 0;
- }
- if (mem == 1) {
- if (rmtx != 0U) {
- hMutex = xSemaphoreCreateRecursiveMutexStatic (attr->cb_mem);
- }
- else {
- hMutex = xSemaphoreCreateMutexStatic (attr->cb_mem);
- }
- }
- else {
- if (mem == 0) {
- if (rmtx != 0U) {
- hMutex = xSemaphoreCreateRecursiveMutex ();
- } else {
- hMutex = xSemaphoreCreateMutex ();
- }
- }
- }
- #if (configQUEUE_REGISTRY_SIZE > 0)
- if (hMutex != NULL) {
- if (attr != NULL) {
- name = attr->name;
- } else {
- name = NULL;
- }
- vQueueAddToRegistry (hMutex, name);
- }
- #endif
- if ((hMutex != NULL) && (rmtx != 0U)) {
- hMutex = (SemaphoreHandle_t)((uint32_t)hMutex | 1U);
- }
- }
- }
- return ((osMutexId_t)hMutex);
- }
- osStatus_t osMutexAcquire (osMutexId_t mutex_id, uint32_t timeout) {
- SemaphoreHandle_t hMutex;
- osStatus_t stat;
- uint32_t rmtx;
- hMutex = (SemaphoreHandle_t)((uint32_t)mutex_id & ~1U);
- rmtx = (uint32_t)mutex_id & 1U;
- stat = osOK;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hMutex == NULL) {
- stat = osErrorParameter;
- }
- else {
- if (rmtx != 0U) {
- if (xSemaphoreTakeRecursive (hMutex, timeout) != pdPASS) {
- if (timeout != 0U) {
- stat = osErrorTimeout;
- } else {
- stat = osErrorResource;
- }
- }
- }
- else {
- if (xSemaphoreTake (hMutex, timeout) != pdPASS) {
- if (timeout != 0U) {
- stat = osErrorTimeout;
- } else {
- stat = osErrorResource;
- }
- }
- }
- }
- return (stat);
- }
- osStatus_t osMutexRelease (osMutexId_t mutex_id) {
- SemaphoreHandle_t hMutex;
- osStatus_t stat;
- uint32_t rmtx;
- hMutex = (SemaphoreHandle_t)((uint32_t)mutex_id & ~1U);
- rmtx = (uint32_t)mutex_id & 1U;
- stat = osOK;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hMutex == NULL) {
- stat = osErrorParameter;
- }
- else {
- if (rmtx != 0U) {
- if (xSemaphoreGiveRecursive (hMutex) != pdPASS) {
- stat = osErrorResource;
- }
- }
- else {
- if (xSemaphoreGive (hMutex) != pdPASS) {
- stat = osErrorResource;
- }
- }
- }
- return (stat);
- }
- osThreadId_t osMutexGetOwner (osMutexId_t mutex_id) {
- SemaphoreHandle_t hMutex;
- osThreadId_t owner;
- hMutex = (SemaphoreHandle_t)((uint32_t)mutex_id & ~1U);
- if (IS_IRQ() || (hMutex == NULL)) {
- owner = NULL;
- } else {
- owner = (osThreadId_t)xSemaphoreGetMutexHolder (hMutex);
- }
- return (owner);
- }
- osStatus_t osMutexDelete (osMutexId_t mutex_id) {
- osStatus_t stat;
- #ifndef USE_FreeRTOS_HEAP_1
- SemaphoreHandle_t hMutex;
- hMutex = (SemaphoreHandle_t)((uint32_t)mutex_id & ~1U);
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hMutex == NULL) {
- stat = osErrorParameter;
- }
- else {
- #if (configQUEUE_REGISTRY_SIZE > 0)
- vQueueUnregisterQueue (hMutex);
- #endif
- stat = osOK;
- vSemaphoreDelete (hMutex);
- }
- #else
- stat = osError;
- #endif
- return (stat);
- }
- /*---------------------------------------------------------------------------*/
- osSemaphoreId_t osSemaphoreNew (uint32_t max_count, uint32_t initial_count, const osSemaphoreAttr_t *attr) {
- SemaphoreHandle_t hSemaphore;
- int32_t mem;
- #if (configQUEUE_REGISTRY_SIZE > 0)
- const char *name;
- #endif
- hSemaphore = NULL;
- if (!IS_IRQ() && (max_count > 0U) && (initial_count <= max_count)) {
- mem = -1;
- if (attr != NULL) {
- if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticSemaphore_t))) {
- mem = 1;
- }
- else {
- if ((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
- mem = 0;
- }
- }
- }
- else {
- mem = 0;
- }
- if (mem != -1) {
- if (max_count == 1U) {
- if (mem == 1) {
- hSemaphore = xSemaphoreCreateBinaryStatic ((StaticSemaphore_t *)attr->cb_mem);
- }
- else {
- hSemaphore = xSemaphoreCreateBinary();
- }
- if ((hSemaphore != NULL) && (initial_count != 0U)) {
- if (xSemaphoreGive (hSemaphore) != pdPASS) {
- vSemaphoreDelete (hSemaphore);
- hSemaphore = NULL;
- }
- }
- }
- else {
- if (mem == 1) {
- hSemaphore = xSemaphoreCreateCountingStatic (max_count, initial_count, (StaticSemaphore_t *)attr->cb_mem);
- }
- else {
- hSemaphore = xSemaphoreCreateCounting (max_count, initial_count);
- }
- }
- #if (configQUEUE_REGISTRY_SIZE > 0)
- if (hSemaphore != NULL) {
- if (attr != NULL) {
- name = attr->name;
- } else {
- name = NULL;
- }
- vQueueAddToRegistry (hSemaphore, name);
- }
- #endif
- }
- }
- return ((osSemaphoreId_t)hSemaphore);
- }
- osStatus_t osSemaphoreAcquire (osSemaphoreId_t semaphore_id, uint32_t timeout) {
- SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
- osStatus_t stat;
- BaseType_t yield;
- stat = osOK;
- if (hSemaphore == NULL) {
- stat = osErrorParameter;
- }
- else if (IS_IRQ()) {
- if (timeout != 0U) {
- stat = osErrorParameter;
- }
- else {
- yield = pdFALSE;
- if (xSemaphoreTakeFromISR (hSemaphore, &yield) != pdPASS) {
- stat = osErrorResource;
- } else {
- portYIELD_FROM_ISR (yield);
- }
- }
- }
- else {
- if (xSemaphoreTake (hSemaphore, (TickType_t)timeout) != pdPASS) {
- if (timeout != 0U) {
- stat = osErrorTimeout;
- } else {
- stat = osErrorResource;
- }
- }
- }
- return (stat);
- }
- osStatus_t osSemaphoreRelease (osSemaphoreId_t semaphore_id) {
- SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
- osStatus_t stat;
- BaseType_t yield;
- stat = osOK;
- if (hSemaphore == NULL) {
- stat = osErrorParameter;
- }
- else if (IS_IRQ()) {
- yield = pdFALSE;
- if (xSemaphoreGiveFromISR (hSemaphore, &yield) != pdTRUE) {
- stat = osErrorResource;
- } else {
- portYIELD_FROM_ISR (yield);
- }
- }
- else {
- if (xSemaphoreGive (hSemaphore) != pdPASS) {
- stat = osErrorResource;
- }
- }
- return (stat);
- }
- uint32_t osSemaphoreGetCount (osSemaphoreId_t semaphore_id) {
- SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
- uint32_t count;
- if (hSemaphore == NULL) {
- count = 0U;
- }
- else if (IS_IRQ()) {
- count = uxQueueMessagesWaitingFromISR (hSemaphore);
- } else {
- count = (uint32_t)uxSemaphoreGetCount (hSemaphore);
- }
- return (count);
- }
- osStatus_t osSemaphoreDelete (osSemaphoreId_t semaphore_id) {
- SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
- osStatus_t stat;
- #ifndef USE_FreeRTOS_HEAP_1
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hSemaphore == NULL) {
- stat = osErrorParameter;
- }
- else {
- #if (configQUEUE_REGISTRY_SIZE > 0)
- vQueueUnregisterQueue (hSemaphore);
- #endif
- stat = osOK;
- vSemaphoreDelete (hSemaphore);
- }
- #else
- stat = osError;
- #endif
- return (stat);
- }
- /*---------------------------------------------------------------------------*/
- osMessageQueueId_t osMessageQueueNew (uint32_t msg_count, uint32_t msg_size, const osMessageQueueAttr_t *attr) {
- QueueHandle_t hQueue;
- int32_t mem;
- #if (configQUEUE_REGISTRY_SIZE > 0)
- const char *name;
- #endif
- hQueue = NULL;
- if (!IS_IRQ() && (msg_count > 0U) && (msg_size > 0U)) {
- mem = -1;
- if (attr != NULL) {
- if ((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticQueue_t)) &&
- (attr->mq_mem != NULL) && (attr->mq_size >= (msg_count * msg_size))) {
- mem = 1;
- }
- else {
- if ((attr->cb_mem == NULL) && (attr->cb_size == 0U) &&
- (attr->mq_mem == NULL) && (attr->mq_size == 0U)) {
- mem = 0;
- }
- }
- }
- else {
- mem = 0;
- }
- if (mem == 1) {
- hQueue = xQueueCreateStatic (msg_count, msg_size, attr->mq_mem, attr->cb_mem);
- }
- else {
- if (mem == 0) {
- hQueue = xQueueCreate (msg_count, msg_size);
- }
- }
- #if (configQUEUE_REGISTRY_SIZE > 0)
- if (hQueue != NULL) {
- if (attr != NULL) {
- name = attr->name;
- } else {
- name = NULL;
- }
- vQueueAddToRegistry (hQueue, name);
- }
- #endif
- }
- return ((osMessageQueueId_t)hQueue);
- }
- osStatus_t osMessageQueuePut (osMessageQueueId_t mq_id, const void *msg_ptr, uint8_t msg_prio, uint32_t timeout) {
- QueueHandle_t hQueue = (QueueHandle_t)mq_id;
- osStatus_t stat;
- BaseType_t yield;
- (void)msg_prio; /* Message priority is ignored */
- stat = osOK;
- if (IS_IRQ()) {
- if ((hQueue == NULL) || (msg_ptr == NULL) || (timeout != 0U)) {
- stat = osErrorParameter;
- }
- else {
- yield = pdFALSE;
- if (xQueueSendToBackFromISR (hQueue, msg_ptr, &yield) != pdTRUE) {
- stat = osErrorResource;
- } else {
- portYIELD_FROM_ISR (yield);
- }
- }
- }
- else {
- if ((hQueue == NULL) || (msg_ptr == NULL)) {
- stat = osErrorParameter;
- }
- else {
- if (xQueueSendToBack (hQueue, msg_ptr, (TickType_t)timeout) != pdPASS) {
- if (timeout != 0U) {
- stat = osErrorTimeout;
- } else {
- stat = osErrorResource;
- }
- }
- }
- }
- return (stat);
- }
- osStatus_t osMessageQueueGet (osMessageQueueId_t mq_id, void *msg_ptr, uint8_t *msg_prio, uint32_t timeout) {
- QueueHandle_t hQueue = (QueueHandle_t)mq_id;
- osStatus_t stat;
- BaseType_t yield;
- (void)msg_prio; /* Message priority is ignored */
- stat = osOK;
- if (IS_IRQ()) {
- if ((hQueue == NULL) || (msg_ptr == NULL) || (timeout != 0U)) {
- stat = osErrorParameter;
- }
- else {
- yield = pdFALSE;
- if (xQueueReceiveFromISR (hQueue, msg_ptr, &yield) != pdPASS) {
- stat = osErrorResource;
- } else {
- portYIELD_FROM_ISR (yield);
- }
- }
- }
- else {
- if ((hQueue == NULL) || (msg_ptr == NULL)) {
- stat = osErrorParameter;
- }
- else {
- if (xQueueReceive (hQueue, msg_ptr, (TickType_t)timeout) != pdPASS) {
- if (timeout != 0U) {
- stat = osErrorTimeout;
- } else {
- stat = osErrorResource;
- }
- }
- }
- }
- return (stat);
- }
- uint32_t osMessageQueueGetCapacity (osMessageQueueId_t mq_id) {
- StaticQueue_t *mq = (StaticQueue_t *)mq_id;
- uint32_t capacity;
- if (mq == NULL) {
- capacity = 0U;
- } else {
- /* capacity = pxQueue->uxLength */
- capacity = mq->uxDummy4[1];
- }
- return (capacity);
- }
- uint32_t osMessageQueueGetMsgSize (osMessageQueueId_t mq_id) {
- StaticQueue_t *mq = (StaticQueue_t *)mq_id;
- uint32_t size;
- if (mq == NULL) {
- size = 0U;
- } else {
- /* size = pxQueue->uxItemSize */
- size = mq->uxDummy4[2];
- }
- return (size);
- }
- uint32_t osMessageQueueGetCount (osMessageQueueId_t mq_id) {
- QueueHandle_t hQueue = (QueueHandle_t)mq_id;
- UBaseType_t count;
- if (hQueue == NULL) {
- count = 0U;
- }
- else if (IS_IRQ()) {
- count = uxQueueMessagesWaitingFromISR (hQueue);
- }
- else {
- count = uxQueueMessagesWaiting (hQueue);
- }
- return ((uint32_t)count);
- }
- uint32_t osMessageQueueGetSpace (osMessageQueueId_t mq_id) {
- StaticQueue_t *mq = (StaticQueue_t *)mq_id;
- uint32_t space;
- uint32_t isrm;
- if (mq == NULL) {
- space = 0U;
- }
- else if (IS_IRQ()) {
- isrm = taskENTER_CRITICAL_FROM_ISR();
- /* space = pxQueue->uxLength - pxQueue->uxMessagesWaiting; */
- space = mq->uxDummy4[1] - mq->uxDummy4[0];
- taskEXIT_CRITICAL_FROM_ISR(isrm);
- }
- else {
- space = (uint32_t)uxQueueSpacesAvailable ((QueueHandle_t)mq);
- }
- return (space);
- }
- osStatus_t osMessageQueueReset (osMessageQueueId_t mq_id) {
- QueueHandle_t hQueue = (QueueHandle_t)mq_id;
- osStatus_t stat;
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hQueue == NULL) {
- stat = osErrorParameter;
- }
- else {
- stat = osOK;
- (void)xQueueReset (hQueue);
- }
- return (stat);
- }
- osStatus_t osMessageQueueDelete (osMessageQueueId_t mq_id) {
- QueueHandle_t hQueue = (QueueHandle_t)mq_id;
- osStatus_t stat;
- #ifndef USE_FreeRTOS_HEAP_1
- if (IS_IRQ()) {
- stat = osErrorISR;
- }
- else if (hQueue == NULL) {
- stat = osErrorParameter;
- }
- else {
- #if (configQUEUE_REGISTRY_SIZE > 0)
- vQueueUnregisterQueue (hQueue);
- #endif
- stat = osOK;
- vQueueDelete (hQueue);
- }
- #else
- stat = osError;
- #endif
- return (stat);
- }
- /*---------------------------------------------------------------------------*/
- /* Callback function prototypes */
- extern void vApplicationIdleHook (void);
- extern void vApplicationTickHook (void);
- extern void vApplicationMallocFailedHook (void);
- extern void vApplicationDaemonTaskStartupHook (void);
- extern void vApplicationStackOverflowHook (TaskHandle_t xTask, signed char *pcTaskName);
- /**
- Dummy implementation of the callback function vApplicationIdleHook().
- */
- #if (configUSE_IDLE_HOOK == 1)
- __WEAK void vApplicationIdleHook (void){}
- #endif
- /**
- Dummy implementation of the callback function vApplicationTickHook().
- */
- #if (configUSE_TICK_HOOK == 1)
- __WEAK void vApplicationTickHook (void){}
- #endif
- /**
- Dummy implementation of the callback function vApplicationMallocFailedHook().
- */
- #if (configUSE_MALLOC_FAILED_HOOK == 1)
- __WEAK void vApplicationMallocFailedHook (void){}
- #endif
- /**
- Dummy implementation of the callback function vApplicationDaemonTaskStartupHook().
- */
- #if (configUSE_DAEMON_TASK_STARTUP_HOOK == 1)
- __WEAK void vApplicationDaemonTaskStartupHook (void){}
- #endif
- /**
- Dummy implementation of the callback function vApplicationStackOverflowHook().
- */
- #if (configCHECK_FOR_STACK_OVERFLOW > 0)
- __WEAK void vApplicationStackOverflowHook (TaskHandle_t xTask, signed char *pcTaskName) {
- (void)xTask;
- (void)pcTaskName;
- }
- #endif
- /*---------------------------------------------------------------------------*/
- /* External Idle and Timer task static memory allocation functions */
- extern void vApplicationGetIdleTaskMemory (StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize);
- extern void vApplicationGetTimerTaskMemory (StaticTask_t **ppxTimerTaskTCBBuffer, StackType_t **ppxTimerTaskStackBuffer, uint32_t *pulTimerTaskStackSize);
- /* Idle task control block and stack */
- static StaticTask_t Idle_TCB;
- static StackType_t Idle_Stack[configMINIMAL_STACK_SIZE];
- /* Timer task control block and stack */
- static StaticTask_t Timer_TCB;
- static StackType_t Timer_Stack[configTIMER_TASK_STACK_DEPTH];
- /*
- vApplicationGetIdleTaskMemory gets called when configSUPPORT_STATIC_ALLOCATION
- equals to 1 and is required for static memory allocation support.
- */
- void vApplicationGetIdleTaskMemory (StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize) {
- *ppxIdleTaskTCBBuffer = &Idle_TCB;
- *ppxIdleTaskStackBuffer = &Idle_Stack[0];
- *pulIdleTaskStackSize = (uint32_t)configMINIMAL_STACK_SIZE;
- }
- /*
- vApplicationGetTimerTaskMemory gets called when configSUPPORT_STATIC_ALLOCATION
- equals to 1 and is required for static memory allocation support.
- */
- void vApplicationGetTimerTaskMemory (StaticTask_t **ppxTimerTaskTCBBuffer, StackType_t **ppxTimerTaskStackBuffer, uint32_t *pulTimerTaskStackSize) {
- *ppxTimerTaskTCBBuffer = &Timer_TCB;
- *ppxTimerTaskStackBuffer = &Timer_Stack[0];
- *pulTimerTaskStackSize = (uint32_t)configTIMER_TASK_STACK_DEPTH;
- }
|