mbed official / mbed-rtos

Official mbed Real Time Operating System based on the RTX implementation of the CMSIS-RTOS API open standard.

Dependents:   denki-yohou_b TestY201 Network-RTOS NTPClient_HelloWorld ... more

Deprecated

This is the mbed 2 rtos library. mbed OS 5 integrates the mbed library with mbed-rtos. With this, we have provided thread safety for all mbed APIs. If you'd like to learn about using mbed OS 5, please see the docs.

rtx/TARGET_CORTEX_M/rt_List.c@49:77c8e4604045, 2014-11-06 (annotated)

Committer:
mbed_official
Date:
Thu Nov 06 13:00:11 2014 +0000
Revision:
49:77c8e4604045
Child:
112:53ace74b190c
Synchronized with git revision 7b90c2ba137baaf9769219e0e8a7b8e8d1299c4f



Full URL: https://github.com/mbedmicro/mbed/commit/7b90c2ba137baaf9769219e0e8a7b8e8d1299c4f/



This target is not yet tested, so it can't be released as part of the official

SDK build for now.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 49:77c8e4604045 1 /*----------------------------------------------------------------------------
mbed_official 49:77c8e4604045 2 * RL-ARM - RTX
mbed_official 49:77c8e4604045 3 *----------------------------------------------------------------------------
mbed_official 49:77c8e4604045 4 * Name: RT_LIST.C
mbed_official 49:77c8e4604045 5 * Purpose: Functions for the management of different lists
mbed_official 49:77c8e4604045 6 * Rev.: V4.60
mbed_official 49:77c8e4604045 7 *----------------------------------------------------------------------------
mbed_official 49:77c8e4604045 8 *
mbed_official 49:77c8e4604045 9 * Copyright (c) 1999-2009 KEIL, 2009-2012 ARM Germany GmbH
mbed_official 49:77c8e4604045 10 * All rights reserved.
mbed_official 49:77c8e4604045 11 * Redistribution and use in source and binary forms, with or without
mbed_official 49:77c8e4604045 12 * modification, are permitted provided that the following conditions are met:
mbed_official 49:77c8e4604045 13 * - Redistributions of source code must retain the above copyright
mbed_official 49:77c8e4604045 14 * notice, this list of conditions and the following disclaimer.
mbed_official 49:77c8e4604045 15 * - Redistributions in binary form must reproduce the above copyright
mbed_official 49:77c8e4604045 16 * notice, this list of conditions and the following disclaimer in the
mbed_official 49:77c8e4604045 17 * documentation and/or other materials provided with the distribution.
mbed_official 49:77c8e4604045 18 * - Neither the name of ARM nor the names of its contributors may be used
mbed_official 49:77c8e4604045 19 * to endorse or promote products derived from this software without
mbed_official 49:77c8e4604045 20 * specific prior written permission.
mbed_official 49:77c8e4604045 21 *
mbed_official 49:77c8e4604045 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
mbed_official 49:77c8e4604045 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
mbed_official 49:77c8e4604045 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
mbed_official 49:77c8e4604045 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
mbed_official 49:77c8e4604045 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
mbed_official 49:77c8e4604045 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
mbed_official 49:77c8e4604045 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
mbed_official 49:77c8e4604045 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
mbed_official 49:77c8e4604045 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
mbed_official 49:77c8e4604045 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
mbed_official 49:77c8e4604045 32 * POSSIBILITY OF SUCH DAMAGE.
mbed_official 49:77c8e4604045 33 *---------------------------------------------------------------------------*/
mbed_official 49:77c8e4604045 34
mbed_official 49:77c8e4604045 35 #include "rt_TypeDef.h"
mbed_official 49:77c8e4604045 36 #include "RTX_Conf.h"
mbed_official 49:77c8e4604045 37 #include "rt_System.h"
mbed_official 49:77c8e4604045 38 #include "rt_List.h"
mbed_official 49:77c8e4604045 39 #include "rt_Task.h"
mbed_official 49:77c8e4604045 40 #include "rt_Time.h"
mbed_official 49:77c8e4604045 41 #include "rt_HAL_CM.h"
mbed_official 49:77c8e4604045 42
mbed_official 49:77c8e4604045 43 /*----------------------------------------------------------------------------
mbed_official 49:77c8e4604045 44 * Global Variables
mbed_official 49:77c8e4604045 45 *---------------------------------------------------------------------------*/
mbed_official 49:77c8e4604045 46
mbed_official 49:77c8e4604045 47 /* List head of chained ready tasks */
mbed_official 49:77c8e4604045 48 struct OS_XCB os_rdy;
mbed_official 49:77c8e4604045 49 /* List head of chained delay tasks */
mbed_official 49:77c8e4604045 50 struct OS_XCB os_dly;
mbed_official 49:77c8e4604045 51
mbed_official 49:77c8e4604045 52
mbed_official 49:77c8e4604045 53 /*----------------------------------------------------------------------------
mbed_official 49:77c8e4604045 54 * Functions
mbed_official 49:77c8e4604045 55 *---------------------------------------------------------------------------*/
mbed_official 49:77c8e4604045 56
mbed_official 49:77c8e4604045 57
mbed_official 49:77c8e4604045 58 /*--------------------------- rt_put_prio -----------------------------------*/
mbed_official 49:77c8e4604045 59
mbed_official 49:77c8e4604045 60 void rt_put_prio (P_XCB p_CB, P_TCB p_task) {
mbed_official 49:77c8e4604045 61 /* Put task identified with "p_task" into list ordered by priority. */
mbed_official 49:77c8e4604045 62 /* "p_CB" points to head of list; list has always an element at end with */
mbed_official 49:77c8e4604045 63 /* a priority less than "p_task->prio". */
mbed_official 49:77c8e4604045 64 P_TCB p_CB2;
mbed_official 49:77c8e4604045 65 U32 prio;
mbed_official 49:77c8e4604045 66 BOOL sem_mbx = __FALSE;
mbed_official 49:77c8e4604045 67
mbed_official 49:77c8e4604045 68 if (p_CB->cb_type == SCB || p_CB->cb_type == MCB || p_CB->cb_type == MUCB) {
mbed_official 49:77c8e4604045 69 sem_mbx = __TRUE;
mbed_official 49:77c8e4604045 70 }
mbed_official 49:77c8e4604045 71 prio = p_task->prio;
mbed_official 49:77c8e4604045 72 p_CB2 = p_CB->p_lnk;
mbed_official 49:77c8e4604045 73 /* Search for an entry in the list */
mbed_official 49:77c8e4604045 74 while (p_CB2 != NULL && prio <= p_CB2->prio) {
mbed_official 49:77c8e4604045 75 p_CB = (P_XCB)p_CB2;
mbed_official 49:77c8e4604045 76 p_CB2 = p_CB2->p_lnk;
mbed_official 49:77c8e4604045 77 }
mbed_official 49:77c8e4604045 78 /* Entry found, insert the task into the list */
mbed_official 49:77c8e4604045 79 p_task->p_lnk = p_CB2;
mbed_official 49:77c8e4604045 80 p_CB->p_lnk = p_task;
mbed_official 49:77c8e4604045 81 if (sem_mbx) {
mbed_official 49:77c8e4604045 82 if (p_CB2 != NULL) {
mbed_official 49:77c8e4604045 83 p_CB2->p_rlnk = p_task;
mbed_official 49:77c8e4604045 84 }
mbed_official 49:77c8e4604045 85 p_task->p_rlnk = (P_TCB)p_CB;
mbed_official 49:77c8e4604045 86 }
mbed_official 49:77c8e4604045 87 else {
mbed_official 49:77c8e4604045 88 p_task->p_rlnk = NULL;
mbed_official 49:77c8e4604045 89 }
mbed_official 49:77c8e4604045 90 }
mbed_official 49:77c8e4604045 91
mbed_official 49:77c8e4604045 92
mbed_official 49:77c8e4604045 93 /*--------------------------- rt_get_first ----------------------------------*/
mbed_official 49:77c8e4604045 94
mbed_official 49:77c8e4604045 95 P_TCB rt_get_first (P_XCB p_CB) {
mbed_official 49:77c8e4604045 96 /* Get task at head of list: it is the task with highest priority. */
mbed_official 49:77c8e4604045 97 /* "p_CB" points to head of list. */
mbed_official 49:77c8e4604045 98 P_TCB p_first;
mbed_official 49:77c8e4604045 99
mbed_official 49:77c8e4604045 100 p_first = p_CB->p_lnk;
mbed_official 49:77c8e4604045 101 p_CB->p_lnk = p_first->p_lnk;
mbed_official 49:77c8e4604045 102 if (p_CB->cb_type == SCB || p_CB->cb_type == MCB || p_CB->cb_type == MUCB) {
mbed_official 49:77c8e4604045 103 if (p_first->p_lnk != NULL) {
mbed_official 49:77c8e4604045 104 p_first->p_lnk->p_rlnk = (P_TCB)p_CB;
mbed_official 49:77c8e4604045 105 p_first->p_lnk = NULL;
mbed_official 49:77c8e4604045 106 }
mbed_official 49:77c8e4604045 107 p_first->p_rlnk = NULL;
mbed_official 49:77c8e4604045 108 }
mbed_official 49:77c8e4604045 109 else {
mbed_official 49:77c8e4604045 110 p_first->p_lnk = NULL;
mbed_official 49:77c8e4604045 111 }
mbed_official 49:77c8e4604045 112 return (p_first);
mbed_official 49:77c8e4604045 113 }
mbed_official 49:77c8e4604045 114
mbed_official 49:77c8e4604045 115
mbed_official 49:77c8e4604045 116 /*--------------------------- rt_put_rdy_first ------------------------------*/
mbed_official 49:77c8e4604045 117
mbed_official 49:77c8e4604045 118 void rt_put_rdy_first (P_TCB p_task) {
mbed_official 49:77c8e4604045 119 /* Put task identified with "p_task" at the head of the ready list. The */
mbed_official 49:77c8e4604045 120 /* task must have at least a priority equal to highest priority in list. */
mbed_official 49:77c8e4604045 121 p_task->p_lnk = os_rdy.p_lnk;
mbed_official 49:77c8e4604045 122 p_task->p_rlnk = NULL;
mbed_official 49:77c8e4604045 123 os_rdy.p_lnk = p_task;
mbed_official 49:77c8e4604045 124 }
mbed_official 49:77c8e4604045 125
mbed_official 49:77c8e4604045 126
mbed_official 49:77c8e4604045 127 /*--------------------------- rt_get_same_rdy_prio --------------------------*/
mbed_official 49:77c8e4604045 128
mbed_official 49:77c8e4604045 129 P_TCB rt_get_same_rdy_prio (void) {
mbed_official 49:77c8e4604045 130 /* Remove a task of same priority from ready list if any exists. Other- */
mbed_official 49:77c8e4604045 131 /* wise return NULL. */
mbed_official 49:77c8e4604045 132 P_TCB p_first;
mbed_official 49:77c8e4604045 133
mbed_official 49:77c8e4604045 134 p_first = os_rdy.p_lnk;
mbed_official 49:77c8e4604045 135 if (p_first->prio == os_tsk.run->prio) {
mbed_official 49:77c8e4604045 136 os_rdy.p_lnk = os_rdy.p_lnk->p_lnk;
mbed_official 49:77c8e4604045 137 return (p_first);
mbed_official 49:77c8e4604045 138 }
mbed_official 49:77c8e4604045 139 return (NULL);
mbed_official 49:77c8e4604045 140 }
mbed_official 49:77c8e4604045 141
mbed_official 49:77c8e4604045 142
mbed_official 49:77c8e4604045 143 /*--------------------------- rt_resort_prio --------------------------------*/
mbed_official 49:77c8e4604045 144
mbed_official 49:77c8e4604045 145 void rt_resort_prio (P_TCB p_task) {
mbed_official 49:77c8e4604045 146 /* Re-sort ordered lists after the priority of 'p_task' has changed. */
mbed_official 49:77c8e4604045 147 P_TCB p_CB;
mbed_official 49:77c8e4604045 148
mbed_official 49:77c8e4604045 149 if (p_task->p_rlnk == NULL) {
mbed_official 49:77c8e4604045 150 if (p_task->state == READY) {
mbed_official 49:77c8e4604045 151 /* Task is chained into READY list. */
mbed_official 49:77c8e4604045 152 p_CB = (P_TCB)&os_rdy;
mbed_official 49:77c8e4604045 153 goto res;
mbed_official 49:77c8e4604045 154 }
mbed_official 49:77c8e4604045 155 }
mbed_official 49:77c8e4604045 156 else {
mbed_official 49:77c8e4604045 157 p_CB = p_task->p_rlnk;
mbed_official 49:77c8e4604045 158 while (p_CB->cb_type == TCB) {
mbed_official 49:77c8e4604045 159 /* Find a header of this task chain list. */
mbed_official 49:77c8e4604045 160 p_CB = p_CB->p_rlnk;
mbed_official 49:77c8e4604045 161 }
mbed_official 49:77c8e4604045 162 res:rt_rmv_list (p_task);
mbed_official 49:77c8e4604045 163 rt_put_prio ((P_XCB)p_CB, p_task);
mbed_official 49:77c8e4604045 164 }
mbed_official 49:77c8e4604045 165 }
mbed_official 49:77c8e4604045 166
mbed_official 49:77c8e4604045 167
mbed_official 49:77c8e4604045 168 /*--------------------------- rt_put_dly ------------------------------------*/
mbed_official 49:77c8e4604045 169
mbed_official 49:77c8e4604045 170 void rt_put_dly (P_TCB p_task, U16 delay) {
mbed_official 49:77c8e4604045 171 /* Put a task identified with "p_task" into chained delay wait list using */
mbed_official 49:77c8e4604045 172 /* a delay value of "delay". */
mbed_official 49:77c8e4604045 173 P_TCB p;
mbed_official 49:77c8e4604045 174 U32 delta,idelay = delay;
mbed_official 49:77c8e4604045 175
mbed_official 49:77c8e4604045 176 p = (P_TCB)&os_dly;
mbed_official 49:77c8e4604045 177 if (p->p_dlnk == NULL) {
mbed_official 49:77c8e4604045 178 /* Delay list empty */
mbed_official 49:77c8e4604045 179 delta = 0;
mbed_official 49:77c8e4604045 180 goto last;
mbed_official 49:77c8e4604045 181 }
mbed_official 49:77c8e4604045 182 delta = os_dly.delta_time;
mbed_official 49:77c8e4604045 183 while (delta < idelay) {
mbed_official 49:77c8e4604045 184 if (p->p_dlnk == NULL) {
mbed_official 49:77c8e4604045 185 /* End of list found */
mbed_official 49:77c8e4604045 186 last: p_task->p_dlnk = NULL;
mbed_official 49:77c8e4604045 187 p->p_dlnk = p_task;
mbed_official 49:77c8e4604045 188 p_task->p_blnk = p;
mbed_official 49:77c8e4604045 189 p->delta_time = (U16)(idelay - delta);
mbed_official 49:77c8e4604045 190 p_task->delta_time = 0;
mbed_official 49:77c8e4604045 191 return;
mbed_official 49:77c8e4604045 192 }
mbed_official 49:77c8e4604045 193 p = p->p_dlnk;
mbed_official 49:77c8e4604045 194 delta += p->delta_time;
mbed_official 49:77c8e4604045 195 }
mbed_official 49:77c8e4604045 196 /* Right place found */
mbed_official 49:77c8e4604045 197 p_task->p_dlnk = p->p_dlnk;
mbed_official 49:77c8e4604045 198 p->p_dlnk = p_task;
mbed_official 49:77c8e4604045 199 p_task->p_blnk = p;
mbed_official 49:77c8e4604045 200 if (p_task->p_dlnk != NULL) {
mbed_official 49:77c8e4604045 201 p_task->p_dlnk->p_blnk = p_task;
mbed_official 49:77c8e4604045 202 }
mbed_official 49:77c8e4604045 203 p_task->delta_time = (U16)(delta - idelay);
mbed_official 49:77c8e4604045 204 p->delta_time -= p_task->delta_time;
mbed_official 49:77c8e4604045 205 }
mbed_official 49:77c8e4604045 206
mbed_official 49:77c8e4604045 207
mbed_official 49:77c8e4604045 208 /*--------------------------- rt_dec_dly ------------------------------------*/
mbed_official 49:77c8e4604045 209
mbed_official 49:77c8e4604045 210 void rt_dec_dly (void) {
mbed_official 49:77c8e4604045 211 /* Decrement delta time of list head: remove tasks having a value of zero.*/
mbed_official 49:77c8e4604045 212 P_TCB p_rdy;
mbed_official 49:77c8e4604045 213
mbed_official 49:77c8e4604045 214 if (os_dly.p_dlnk == NULL) {
mbed_official 49:77c8e4604045 215 return;
mbed_official 49:77c8e4604045 216 }
mbed_official 49:77c8e4604045 217 os_dly.delta_time--;
mbed_official 49:77c8e4604045 218 while ((os_dly.delta_time == 0) && (os_dly.p_dlnk != NULL)) {
mbed_official 49:77c8e4604045 219 p_rdy = os_dly.p_dlnk;
mbed_official 49:77c8e4604045 220 if (p_rdy->p_rlnk != NULL) {
mbed_official 49:77c8e4604045 221 /* Task is really enqueued, remove task from semaphore/mailbox */
mbed_official 49:77c8e4604045 222 /* timeout waiting list. */
mbed_official 49:77c8e4604045 223 p_rdy->p_rlnk->p_lnk = p_rdy->p_lnk;
mbed_official 49:77c8e4604045 224 if (p_rdy->p_lnk != NULL) {
mbed_official 49:77c8e4604045 225 p_rdy->p_lnk->p_rlnk = p_rdy->p_rlnk;
mbed_official 49:77c8e4604045 226 p_rdy->p_lnk = NULL;
mbed_official 49:77c8e4604045 227 }
mbed_official 49:77c8e4604045 228 p_rdy->p_rlnk = NULL;
mbed_official 49:77c8e4604045 229 }
mbed_official 49:77c8e4604045 230 rt_put_prio (&os_rdy, p_rdy);
mbed_official 49:77c8e4604045 231 os_dly.delta_time = p_rdy->delta_time;
mbed_official 49:77c8e4604045 232 if (p_rdy->state == WAIT_ITV) {
mbed_official 49:77c8e4604045 233 /* Calculate the next time for interval wait. */
mbed_official 49:77c8e4604045 234 p_rdy->delta_time = p_rdy->interval_time + (U16)os_time;
mbed_official 49:77c8e4604045 235 }
mbed_official 49:77c8e4604045 236 p_rdy->state = READY;
mbed_official 49:77c8e4604045 237 os_dly.p_dlnk = p_rdy->p_dlnk;
mbed_official 49:77c8e4604045 238 if (p_rdy->p_dlnk != NULL) {
mbed_official 49:77c8e4604045 239 p_rdy->p_dlnk->p_blnk = (P_TCB)&os_dly;
mbed_official 49:77c8e4604045 240 p_rdy->p_dlnk = NULL;
mbed_official 49:77c8e4604045 241 }
mbed_official 49:77c8e4604045 242 p_rdy->p_blnk = NULL;
mbed_official 49:77c8e4604045 243 }
mbed_official 49:77c8e4604045 244 }
mbed_official 49:77c8e4604045 245
mbed_official 49:77c8e4604045 246
mbed_official 49:77c8e4604045 247 /*--------------------------- rt_rmv_list -----------------------------------*/
mbed_official 49:77c8e4604045 248
mbed_official 49:77c8e4604045 249 void rt_rmv_list (P_TCB p_task) {
mbed_official 49:77c8e4604045 250 /* Remove task identified with "p_task" from ready, semaphore or mailbox */
mbed_official 49:77c8e4604045 251 /* waiting list if enqueued. */
mbed_official 49:77c8e4604045 252 P_TCB p_b;
mbed_official 49:77c8e4604045 253
mbed_official 49:77c8e4604045 254 if (p_task->p_rlnk != NULL) {
mbed_official 49:77c8e4604045 255 /* A task is enqueued in semaphore / mailbox waiting list. */
mbed_official 49:77c8e4604045 256 p_task->p_rlnk->p_lnk = p_task->p_lnk;
mbed_official 49:77c8e4604045 257 if (p_task->p_lnk != NULL) {
mbed_official 49:77c8e4604045 258 p_task->p_lnk->p_rlnk = p_task->p_rlnk;
mbed_official 49:77c8e4604045 259 }
mbed_official 49:77c8e4604045 260 return;
mbed_official 49:77c8e4604045 261 }
mbed_official 49:77c8e4604045 262
mbed_official 49:77c8e4604045 263 p_b = (P_TCB)&os_rdy;
mbed_official 49:77c8e4604045 264 while (p_b != NULL) {
mbed_official 49:77c8e4604045 265 /* Search the ready list for task "p_task" */
mbed_official 49:77c8e4604045 266 if (p_b->p_lnk == p_task) {
mbed_official 49:77c8e4604045 267 p_b->p_lnk = p_task->p_lnk;
mbed_official 49:77c8e4604045 268 return;
mbed_official 49:77c8e4604045 269 }
mbed_official 49:77c8e4604045 270 p_b = p_b->p_lnk;
mbed_official 49:77c8e4604045 271 }
mbed_official 49:77c8e4604045 272 }
mbed_official 49:77c8e4604045 273
mbed_official 49:77c8e4604045 274
mbed_official 49:77c8e4604045 275 /*--------------------------- rt_rmv_dly ------------------------------------*/
mbed_official 49:77c8e4604045 276
mbed_official 49:77c8e4604045 277 void rt_rmv_dly (P_TCB p_task) {
mbed_official 49:77c8e4604045 278 /* Remove task identified with "p_task" from delay list if enqueued. */
mbed_official 49:77c8e4604045 279 P_TCB p_b;
mbed_official 49:77c8e4604045 280
mbed_official 49:77c8e4604045 281 p_b = p_task->p_blnk;
mbed_official 49:77c8e4604045 282 if (p_b != NULL) {
mbed_official 49:77c8e4604045 283 /* Task is really enqueued */
mbed_official 49:77c8e4604045 284 p_b->p_dlnk = p_task->p_dlnk;
mbed_official 49:77c8e4604045 285 if (p_task->p_dlnk != NULL) {
mbed_official 49:77c8e4604045 286 /* 'p_task' is in the middle of list */
mbed_official 49:77c8e4604045 287 p_b->delta_time += p_task->delta_time;
mbed_official 49:77c8e4604045 288 p_task->p_dlnk->p_blnk = p_b;
mbed_official 49:77c8e4604045 289 p_task->p_dlnk = NULL;
mbed_official 49:77c8e4604045 290 }
mbed_official 49:77c8e4604045 291 else {
mbed_official 49:77c8e4604045 292 /* 'p_task' is at the end of list */
mbed_official 49:77c8e4604045 293 p_b->delta_time = 0;
mbed_official 49:77c8e4604045 294 }
mbed_official 49:77c8e4604045 295 p_task->p_blnk = NULL;
mbed_official 49:77c8e4604045 296 }
mbed_official 49:77c8e4604045 297 }
mbed_official 49:77c8e4604045 298
mbed_official 49:77c8e4604045 299
mbed_official 49:77c8e4604045 300 /*--------------------------- rt_psq_enq ------------------------------------*/
mbed_official 49:77c8e4604045 301
mbed_official 49:77c8e4604045 302 void rt_psq_enq (OS_ID entry, U32 arg) {
mbed_official 49:77c8e4604045 303 /* Insert post service request "entry" into ps-queue. */
mbed_official 49:77c8e4604045 304 U32 idx;
mbed_official 49:77c8e4604045 305
mbed_official 49:77c8e4604045 306 idx = rt_inc_qi (os_psq->size, &os_psq->count, &os_psq->first);
mbed_official 49:77c8e4604045 307 if (idx < os_psq->size) {
mbed_official 49:77c8e4604045 308 os_psq->q[idx].id = entry;
mbed_official 49:77c8e4604045 309 os_psq->q[idx].arg = arg;
mbed_official 49:77c8e4604045 310 }
mbed_official 49:77c8e4604045 311 else {
mbed_official 49:77c8e4604045 312 os_error (OS_ERR_FIFO_OVF);
mbed_official 49:77c8e4604045 313 }
mbed_official 49:77c8e4604045 314 }
mbed_official 49:77c8e4604045 315
mbed_official 49:77c8e4604045 316
mbed_official 49:77c8e4604045 317 /*----------------------------------------------------------------------------
mbed_official 49:77c8e4604045 318 * end of file
mbed_official 49:77c8e4604045 319 *---------------------------------------------------------------------------*/
mbed_official 49:77c8e4604045 320