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_A/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 * RL-ARM - 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.70
DieterGraef 0:f9b6112278fe 7 *----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 8 *
DieterGraef 0:f9b6112278fe 9 * Copyright (c) 1999-2009 KEIL, 2009-2013 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 #ifdef __CORTEX_A9
DieterGraef 0:f9b6112278fe 42 #include "rt_HAL_CA.h"
DieterGraef 0:f9b6112278fe 43 #else
DieterGraef 0:f9b6112278fe 44 #include "rt_HAL_CM.h"
DieterGraef 0:f9b6112278fe 45 #endif
DieterGraef 0:f9b6112278fe 46
DieterGraef 0:f9b6112278fe 47 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 48 * Global Variables
DieterGraef 0:f9b6112278fe 49 *---------------------------------------------------------------------------*/
DieterGraef 0:f9b6112278fe 50
DieterGraef 0:f9b6112278fe 51 /* List head of chained ready tasks */
DieterGraef 0:f9b6112278fe 52 struct OS_XCB os_rdy;
DieterGraef 0:f9b6112278fe 53 /* List head of chained delay tasks */
DieterGraef 0:f9b6112278fe 54 struct OS_XCB os_dly;
DieterGraef 0:f9b6112278fe 55
DieterGraef 0:f9b6112278fe 56
DieterGraef 0:f9b6112278fe 57 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 58 * Functions
DieterGraef 0:f9b6112278fe 59 *---------------------------------------------------------------------------*/
DieterGraef 0:f9b6112278fe 60
DieterGraef 0:f9b6112278fe 61
DieterGraef 0:f9b6112278fe 62 /*--------------------------- rt_put_prio -----------------------------------*/
DieterGraef 0:f9b6112278fe 63
DieterGraef 0:f9b6112278fe 64 void rt_put_prio (P_XCB p_CB, P_TCB p_task) {
DieterGraef 0:f9b6112278fe 65 /* Put task identified with "p_task" into list ordered by priority. */
DieterGraef 0:f9b6112278fe 66 /* "p_CB" points to head of list; list has always an element at end with */
DieterGraef 0:f9b6112278fe 67 /* a priority less than "p_task->prio". */
DieterGraef 0:f9b6112278fe 68 P_TCB p_CB2;
DieterGraef 0:f9b6112278fe 69 U32 prio;
DieterGraef 0:f9b6112278fe 70 BOOL sem_mbx = __FALSE;
DieterGraef 0:f9b6112278fe 71
DieterGraef 0:f9b6112278fe 72 if (p_CB->cb_type == SCB || p_CB->cb_type == MCB || p_CB->cb_type == MUCB) {
DieterGraef 0:f9b6112278fe 73 sem_mbx = __TRUE;
DieterGraef 0:f9b6112278fe 74 }
DieterGraef 0:f9b6112278fe 75 prio = p_task->prio;
DieterGraef 0:f9b6112278fe 76 p_CB2 = p_CB->p_lnk;
DieterGraef 0:f9b6112278fe 77 /* Search for an entry in the list */
DieterGraef 0:f9b6112278fe 78 while (p_CB2 != NULL && prio <= p_CB2->prio) {
DieterGraef 0:f9b6112278fe 79 p_CB = (P_XCB)p_CB2;
DieterGraef 0:f9b6112278fe 80 p_CB2 = p_CB2->p_lnk;
DieterGraef 0:f9b6112278fe 81 }
DieterGraef 0:f9b6112278fe 82 /* Entry found, insert the task into the list */
DieterGraef 0:f9b6112278fe 83 p_task->p_lnk = p_CB2;
DieterGraef 0:f9b6112278fe 84 p_CB->p_lnk = p_task;
DieterGraef 0:f9b6112278fe 85 if (sem_mbx) {
DieterGraef 0:f9b6112278fe 86 if (p_CB2 != NULL) {
DieterGraef 0:f9b6112278fe 87 p_CB2->p_rlnk = p_task;
DieterGraef 0:f9b6112278fe 88 }
DieterGraef 0:f9b6112278fe 89 p_task->p_rlnk = (P_TCB)p_CB;
DieterGraef 0:f9b6112278fe 90 }
DieterGraef 0:f9b6112278fe 91 else {
DieterGraef 0:f9b6112278fe 92 p_task->p_rlnk = NULL;
DieterGraef 0:f9b6112278fe 93 }
DieterGraef 0:f9b6112278fe 94 }
DieterGraef 0:f9b6112278fe 95
DieterGraef 0:f9b6112278fe 96
DieterGraef 0:f9b6112278fe 97 /*--------------------------- rt_get_first ----------------------------------*/
DieterGraef 0:f9b6112278fe 98
DieterGraef 0:f9b6112278fe 99 P_TCB rt_get_first (P_XCB p_CB) {
DieterGraef 0:f9b6112278fe 100 /* Get task at head of list: it is the task with highest priority. */
DieterGraef 0:f9b6112278fe 101 /* "p_CB" points to head of list. */
DieterGraef 0:f9b6112278fe 102 P_TCB p_first;
DieterGraef 0:f9b6112278fe 103
DieterGraef 0:f9b6112278fe 104 p_first = p_CB->p_lnk;
DieterGraef 0:f9b6112278fe 105 p_CB->p_lnk = p_first->p_lnk;
DieterGraef 0:f9b6112278fe 106 if (p_CB->cb_type == SCB || p_CB->cb_type == MCB || p_CB->cb_type == MUCB) {
DieterGraef 0:f9b6112278fe 107 if (p_first->p_lnk != NULL) {
DieterGraef 0:f9b6112278fe 108 p_first->p_lnk->p_rlnk = (P_TCB)p_CB;
DieterGraef 0:f9b6112278fe 109 p_first->p_lnk = NULL;
DieterGraef 0:f9b6112278fe 110 }
DieterGraef 0:f9b6112278fe 111 p_first->p_rlnk = NULL;
DieterGraef 0:f9b6112278fe 112 }
DieterGraef 0:f9b6112278fe 113 else {
DieterGraef 0:f9b6112278fe 114 p_first->p_lnk = NULL;
DieterGraef 0:f9b6112278fe 115 }
DieterGraef 0:f9b6112278fe 116 return (p_first);
DieterGraef 0:f9b6112278fe 117 }
DieterGraef 0:f9b6112278fe 118
DieterGraef 0:f9b6112278fe 119
DieterGraef 0:f9b6112278fe 120 /*--------------------------- rt_put_rdy_first ------------------------------*/
DieterGraef 0:f9b6112278fe 121
DieterGraef 0:f9b6112278fe 122 void rt_put_rdy_first (P_TCB p_task) {
DieterGraef 0:f9b6112278fe 123 /* Put task identified with "p_task" at the head of the ready list. The */
DieterGraef 0:f9b6112278fe 124 /* task must have at least a priority equal to highest priority in list. */
DieterGraef 0:f9b6112278fe 125 p_task->p_lnk = os_rdy.p_lnk;
DieterGraef 0:f9b6112278fe 126 p_task->p_rlnk = NULL;
DieterGraef 0:f9b6112278fe 127 os_rdy.p_lnk = p_task;
DieterGraef 0:f9b6112278fe 128 }
DieterGraef 0:f9b6112278fe 129
DieterGraef 0:f9b6112278fe 130
DieterGraef 0:f9b6112278fe 131 /*--------------------------- rt_get_same_rdy_prio --------------------------*/
DieterGraef 0:f9b6112278fe 132
DieterGraef 0:f9b6112278fe 133 P_TCB rt_get_same_rdy_prio (void) {
DieterGraef 0:f9b6112278fe 134 /* Remove a task of same priority from ready list if any exists. Other- */
DieterGraef 0:f9b6112278fe 135 /* wise return NULL. */
DieterGraef 0:f9b6112278fe 136 P_TCB p_first;
DieterGraef 0:f9b6112278fe 137
DieterGraef 0:f9b6112278fe 138 p_first = os_rdy.p_lnk;
DieterGraef 0:f9b6112278fe 139 if (p_first->prio == os_tsk.run->prio) {
DieterGraef 0:f9b6112278fe 140 os_rdy.p_lnk = os_rdy.p_lnk->p_lnk;
DieterGraef 0:f9b6112278fe 141 return (p_first);
DieterGraef 0:f9b6112278fe 142 }
DieterGraef 0:f9b6112278fe 143 return (NULL);
DieterGraef 0:f9b6112278fe 144 }
DieterGraef 0:f9b6112278fe 145
DieterGraef 0:f9b6112278fe 146
DieterGraef 0:f9b6112278fe 147 /*--------------------------- rt_resort_prio --------------------------------*/
DieterGraef 0:f9b6112278fe 148
DieterGraef 0:f9b6112278fe 149 void rt_resort_prio (P_TCB p_task) {
DieterGraef 0:f9b6112278fe 150 /* Re-sort ordered lists after the priority of 'p_task' has changed. */
DieterGraef 0:f9b6112278fe 151 P_TCB p_CB;
DieterGraef 0:f9b6112278fe 152
DieterGraef 0:f9b6112278fe 153 if (p_task->p_rlnk == NULL) {
DieterGraef 0:f9b6112278fe 154 if (p_task->state == READY) {
DieterGraef 0:f9b6112278fe 155 /* Task is chained into READY list. */
DieterGraef 0:f9b6112278fe 156 p_CB = (P_TCB)&os_rdy;
DieterGraef 0:f9b6112278fe 157 goto res;
DieterGraef 0:f9b6112278fe 158 }
DieterGraef 0:f9b6112278fe 159 }
DieterGraef 0:f9b6112278fe 160 else {
DieterGraef 0:f9b6112278fe 161 p_CB = p_task->p_rlnk;
DieterGraef 0:f9b6112278fe 162 while (p_CB->cb_type == TCB) {
DieterGraef 0:f9b6112278fe 163 /* Find a header of this task chain list. */
DieterGraef 0:f9b6112278fe 164 p_CB = p_CB->p_rlnk;
DieterGraef 0:f9b6112278fe 165 }
DieterGraef 0:f9b6112278fe 166 res:rt_rmv_list (p_task);
DieterGraef 0:f9b6112278fe 167 rt_put_prio ((P_XCB)p_CB, p_task);
DieterGraef 0:f9b6112278fe 168 }
DieterGraef 0:f9b6112278fe 169 }
DieterGraef 0:f9b6112278fe 170
DieterGraef 0:f9b6112278fe 171
DieterGraef 0:f9b6112278fe 172 /*--------------------------- rt_put_dly ------------------------------------*/
DieterGraef 0:f9b6112278fe 173
DieterGraef 0:f9b6112278fe 174 void rt_put_dly (P_TCB p_task, U16 delay) {
DieterGraef 0:f9b6112278fe 175 /* Put a task identified with "p_task" into chained delay wait list using */
DieterGraef 0:f9b6112278fe 176 /* a delay value of "delay". */
DieterGraef 0:f9b6112278fe 177 P_TCB p;
DieterGraef 0:f9b6112278fe 178 U32 delta,idelay = delay;
DieterGraef 0:f9b6112278fe 179
DieterGraef 0:f9b6112278fe 180 p = (P_TCB)&os_dly;
DieterGraef 0:f9b6112278fe 181 if (p->p_dlnk == NULL) {
DieterGraef 0:f9b6112278fe 182 /* Delay list empty */
DieterGraef 0:f9b6112278fe 183 delta = 0;
DieterGraef 0:f9b6112278fe 184 goto last;
DieterGraef 0:f9b6112278fe 185 }
DieterGraef 0:f9b6112278fe 186 delta = os_dly.delta_time;
DieterGraef 0:f9b6112278fe 187 while (delta < idelay) {
DieterGraef 0:f9b6112278fe 188 if (p->p_dlnk == NULL) {
DieterGraef 0:f9b6112278fe 189 /* End of list found */
DieterGraef 0:f9b6112278fe 190 last: p_task->p_dlnk = NULL;
DieterGraef 0:f9b6112278fe 191 p->p_dlnk = p_task;
DieterGraef 0:f9b6112278fe 192 p_task->p_blnk = p;
DieterGraef 0:f9b6112278fe 193 p->delta_time = (U16)(idelay - delta);
DieterGraef 0:f9b6112278fe 194 p_task->delta_time = 0;
DieterGraef 0:f9b6112278fe 195 return;
DieterGraef 0:f9b6112278fe 196 }
DieterGraef 0:f9b6112278fe 197 p = p->p_dlnk;
DieterGraef 0:f9b6112278fe 198 delta += p->delta_time;
DieterGraef 0:f9b6112278fe 199 }
DieterGraef 0:f9b6112278fe 200 /* Right place found */
DieterGraef 0:f9b6112278fe 201 p_task->p_dlnk = p->p_dlnk;
DieterGraef 0:f9b6112278fe 202 p->p_dlnk = p_task;
DieterGraef 0:f9b6112278fe 203 p_task->p_blnk = p;
DieterGraef 0:f9b6112278fe 204 if (p_task->p_dlnk != NULL) {
DieterGraef 0:f9b6112278fe 205 p_task->p_dlnk->p_blnk = p_task;
DieterGraef 0:f9b6112278fe 206 }
DieterGraef 0:f9b6112278fe 207 p_task->delta_time = (U16)(delta - idelay);
DieterGraef 0:f9b6112278fe 208 p->delta_time -= p_task->delta_time;
DieterGraef 0:f9b6112278fe 209 }
DieterGraef 0:f9b6112278fe 210
DieterGraef 0:f9b6112278fe 211
DieterGraef 0:f9b6112278fe 212 /*--------------------------- rt_dec_dly ------------------------------------*/
DieterGraef 0:f9b6112278fe 213
DieterGraef 0:f9b6112278fe 214 void rt_dec_dly (void) {
DieterGraef 0:f9b6112278fe 215 /* Decrement delta time of list head: remove tasks having a value of zero.*/
DieterGraef 0:f9b6112278fe 216 P_TCB p_rdy;
DieterGraef 0:f9b6112278fe 217
DieterGraef 0:f9b6112278fe 218 if (os_dly.p_dlnk == NULL) {
DieterGraef 0:f9b6112278fe 219 return;
DieterGraef 0:f9b6112278fe 220 }
DieterGraef 0:f9b6112278fe 221 os_dly.delta_time--;
DieterGraef 0:f9b6112278fe 222 while ((os_dly.delta_time == 0) && (os_dly.p_dlnk != NULL)) {
DieterGraef 0:f9b6112278fe 223 p_rdy = os_dly.p_dlnk;
DieterGraef 0:f9b6112278fe 224 if (p_rdy->p_rlnk != NULL) {
DieterGraef 0:f9b6112278fe 225 /* Task is really enqueued, remove task from semaphore/mailbox */
DieterGraef 0:f9b6112278fe 226 /* timeout waiting list. */
DieterGraef 0:f9b6112278fe 227 p_rdy->p_rlnk->p_lnk = p_rdy->p_lnk;
DieterGraef 0:f9b6112278fe 228 if (p_rdy->p_lnk != NULL) {
DieterGraef 0:f9b6112278fe 229 p_rdy->p_lnk->p_rlnk = p_rdy->p_rlnk;
DieterGraef 0:f9b6112278fe 230 p_rdy->p_lnk = NULL;
DieterGraef 0:f9b6112278fe 231 }
DieterGraef 0:f9b6112278fe 232 p_rdy->p_rlnk = NULL;
DieterGraef 0:f9b6112278fe 233 }
DieterGraef 0:f9b6112278fe 234 rt_put_prio (&os_rdy, p_rdy);
DieterGraef 0:f9b6112278fe 235 os_dly.delta_time = p_rdy->delta_time;
DieterGraef 0:f9b6112278fe 236 if (p_rdy->state == WAIT_ITV) {
DieterGraef 0:f9b6112278fe 237 /* Calculate the next time for interval wait. */
DieterGraef 0:f9b6112278fe 238 p_rdy->delta_time = p_rdy->interval_time + (U16)os_time;
DieterGraef 0:f9b6112278fe 239 }
DieterGraef 0:f9b6112278fe 240 p_rdy->state = READY;
DieterGraef 0:f9b6112278fe 241 os_dly.p_dlnk = p_rdy->p_dlnk;
DieterGraef 0:f9b6112278fe 242 if (p_rdy->p_dlnk != NULL) {
DieterGraef 0:f9b6112278fe 243 p_rdy->p_dlnk->p_blnk = (P_TCB)&os_dly;
DieterGraef 0:f9b6112278fe 244 p_rdy->p_dlnk = NULL;
DieterGraef 0:f9b6112278fe 245 }
DieterGraef 0:f9b6112278fe 246 p_rdy->p_blnk = NULL;
DieterGraef 0:f9b6112278fe 247 }
DieterGraef 0:f9b6112278fe 248 }
DieterGraef 0:f9b6112278fe 249
DieterGraef 0:f9b6112278fe 250
DieterGraef 0:f9b6112278fe 251 /*--------------------------- rt_rmv_list -----------------------------------*/
DieterGraef 0:f9b6112278fe 252
DieterGraef 0:f9b6112278fe 253 void rt_rmv_list (P_TCB p_task) {
DieterGraef 0:f9b6112278fe 254 /* Remove task identified with "p_task" from ready, semaphore or mailbox */
DieterGraef 0:f9b6112278fe 255 /* waiting list if enqueued. */
DieterGraef 0:f9b6112278fe 256 P_TCB p_b;
DieterGraef 0:f9b6112278fe 257
DieterGraef 0:f9b6112278fe 258 if (p_task->p_rlnk != NULL) {
DieterGraef 0:f9b6112278fe 259 /* A task is enqueued in semaphore / mailbox waiting list. */
DieterGraef 0:f9b6112278fe 260 p_task->p_rlnk->p_lnk = p_task->p_lnk;
DieterGraef 0:f9b6112278fe 261 if (p_task->p_lnk != NULL) {
DieterGraef 0:f9b6112278fe 262 p_task->p_lnk->p_rlnk = p_task->p_rlnk;
DieterGraef 0:f9b6112278fe 263 }
DieterGraef 0:f9b6112278fe 264 return;
DieterGraef 0:f9b6112278fe 265 }
DieterGraef 0:f9b6112278fe 266
DieterGraef 0:f9b6112278fe 267 p_b = (P_TCB)&os_rdy;
DieterGraef 0:f9b6112278fe 268 while (p_b != NULL) {
DieterGraef 0:f9b6112278fe 269 /* Search the ready list for task "p_task" */
DieterGraef 0:f9b6112278fe 270 if (p_b->p_lnk == p_task) {
DieterGraef 0:f9b6112278fe 271 p_b->p_lnk = p_task->p_lnk;
DieterGraef 0:f9b6112278fe 272 return;
DieterGraef 0:f9b6112278fe 273 }
DieterGraef 0:f9b6112278fe 274 p_b = p_b->p_lnk;
DieterGraef 0:f9b6112278fe 275 }
DieterGraef 0:f9b6112278fe 276 }
DieterGraef 0:f9b6112278fe 277
DieterGraef 0:f9b6112278fe 278
DieterGraef 0:f9b6112278fe 279 /*--------------------------- rt_rmv_dly ------------------------------------*/
DieterGraef 0:f9b6112278fe 280
DieterGraef 0:f9b6112278fe 281 void rt_rmv_dly (P_TCB p_task) {
DieterGraef 0:f9b6112278fe 282 /* Remove task identified with "p_task" from delay list if enqueued. */
DieterGraef 0:f9b6112278fe 283 P_TCB p_b;
DieterGraef 0:f9b6112278fe 284
DieterGraef 0:f9b6112278fe 285 p_b = p_task->p_blnk;
DieterGraef 0:f9b6112278fe 286 if (p_b != NULL) {
DieterGraef 0:f9b6112278fe 287 /* Task is really enqueued */
DieterGraef 0:f9b6112278fe 288 p_b->p_dlnk = p_task->p_dlnk;
DieterGraef 0:f9b6112278fe 289 if (p_task->p_dlnk != NULL) {
DieterGraef 0:f9b6112278fe 290 /* 'p_task' is in the middle of list */
DieterGraef 0:f9b6112278fe 291 p_b->delta_time += p_task->delta_time;
DieterGraef 0:f9b6112278fe 292 p_task->p_dlnk->p_blnk = p_b;
DieterGraef 0:f9b6112278fe 293 p_task->p_dlnk = NULL;
DieterGraef 0:f9b6112278fe 294 }
DieterGraef 0:f9b6112278fe 295 else {
DieterGraef 0:f9b6112278fe 296 /* 'p_task' is at the end of list */
DieterGraef 0:f9b6112278fe 297 p_b->delta_time = 0;
DieterGraef 0:f9b6112278fe 298 }
DieterGraef 0:f9b6112278fe 299 p_task->p_blnk = NULL;
DieterGraef 0:f9b6112278fe 300 }
DieterGraef 0:f9b6112278fe 301 }
DieterGraef 0:f9b6112278fe 302
DieterGraef 0:f9b6112278fe 303
DieterGraef 0:f9b6112278fe 304 /*--------------------------- rt_psq_enq ------------------------------------*/
DieterGraef 0:f9b6112278fe 305
DieterGraef 0:f9b6112278fe 306 void rt_psq_enq (OS_ID entry, U32 arg) {
DieterGraef 0:f9b6112278fe 307 /* Insert post service request "entry" into ps-queue. */
DieterGraef 0:f9b6112278fe 308 U32 idx;
DieterGraef 0:f9b6112278fe 309
DieterGraef 0:f9b6112278fe 310 idx = rt_inc_qi (os_psq->size, &os_psq->count, &os_psq->first);
DieterGraef 0:f9b6112278fe 311 if (idx < os_psq->size) {
DieterGraef 0:f9b6112278fe 312 os_psq->q[idx].id = entry;
DieterGraef 0:f9b6112278fe 313 os_psq->q[idx].arg = arg;
DieterGraef 0:f9b6112278fe 314 }
DieterGraef 0:f9b6112278fe 315 else {
DieterGraef 0:f9b6112278fe 316 os_error (OS_ERR_FIFO_OVF);
DieterGraef 0:f9b6112278fe 317 }
DieterGraef 0:f9b6112278fe 318 }
DieterGraef 0:f9b6112278fe 319
DieterGraef 0:f9b6112278fe 320
DieterGraef 0:f9b6112278fe 321 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 322 * end of file
DieterGraef 0:f9b6112278fe 323 *---------------------------------------------------------------------------*/
DieterGraef 0:f9b6112278fe 324