Arlindo Montagnoli / Mbed 2 deprecated ProjetoBB

ProjetoBB

Dependencies:   F7_Ethernet WebSocketClient mbed mcp3008

Fork of Nucleo_F746ZG_Ethernet by Dieter Graef

mbed-rtos/rtx/TARGET_CORTEX_M/rt_List.c@0:f9b6112278fe, 2016-06-18 (annotated)

Committer:
DieterGraef
Date:
Sat Jun 18 10:49:12 2016 +0000
Revision:
0:f9b6112278fe
Ethernet for the NUCLEO STM32F746 Board Testprogram uses DHCP and NTP to set the clock

Who changed what in which revision?

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