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_Task.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_TASK.C
DieterGraef 0:f9b6112278fe 5 * Purpose: Task functions and system start up.
DieterGraef 0:f9b6112278fe 6 * Rev.: V4.80
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_Task.h"
DieterGraef 0:f9b6112278fe 39 #include "rt_List.h"
DieterGraef 0:f9b6112278fe 40 #include "rt_MemBox.h"
DieterGraef 0:f9b6112278fe 41 #include "rt_Robin.h"
DieterGraef 0:f9b6112278fe 42 #include "rt_HAL_CM.h"
DieterGraef 0:f9b6112278fe 43
DieterGraef 0:f9b6112278fe 44 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 45 * Global Variables
DieterGraef 0:f9b6112278fe 46 *---------------------------------------------------------------------------*/
DieterGraef 0:f9b6112278fe 47
DieterGraef 0:f9b6112278fe 48 /* Running and next task info. */
DieterGraef 0:f9b6112278fe 49 struct OS_TSK os_tsk;
DieterGraef 0:f9b6112278fe 50
DieterGraef 0:f9b6112278fe 51 /* Task Control Blocks of idle demon */
DieterGraef 0:f9b6112278fe 52 struct OS_TCB os_idle_TCB;
DieterGraef 0:f9b6112278fe 53
DieterGraef 0:f9b6112278fe 54
DieterGraef 0:f9b6112278fe 55 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 56 * Local Functions
DieterGraef 0:f9b6112278fe 57 *---------------------------------------------------------------------------*/
DieterGraef 0:f9b6112278fe 58
DieterGraef 0:f9b6112278fe 59 static OS_TID rt_get_TID (void) {
DieterGraef 0:f9b6112278fe 60 U32 tid;
DieterGraef 0:f9b6112278fe 61
DieterGraef 0:f9b6112278fe 62 for (tid = 1U; tid <= os_maxtaskrun; tid++) {
DieterGraef 0:f9b6112278fe 63 if (os_active_TCB[tid-1U] == NULL) {
DieterGraef 0:f9b6112278fe 64 return ((OS_TID)tid);
DieterGraef 0:f9b6112278fe 65 }
DieterGraef 0:f9b6112278fe 66 }
DieterGraef 0:f9b6112278fe 67 return (0U);
DieterGraef 0:f9b6112278fe 68 }
DieterGraef 0:f9b6112278fe 69
DieterGraef 0:f9b6112278fe 70
DieterGraef 0:f9b6112278fe 71 /*--------------------------- rt_init_context -------------------------------*/
DieterGraef 0:f9b6112278fe 72
DieterGraef 0:f9b6112278fe 73 static void rt_init_context (P_TCB p_TCB, U8 priority, FUNCP task_body) {
DieterGraef 0:f9b6112278fe 74 /* Initialize general part of the Task Control Block. */
DieterGraef 0:f9b6112278fe 75 p_TCB->cb_type = TCB;
DieterGraef 0:f9b6112278fe 76 p_TCB->state = READY;
DieterGraef 0:f9b6112278fe 77 p_TCB->prio = priority;
DieterGraef 0:f9b6112278fe 78 p_TCB->prio_base = priority;
DieterGraef 0:f9b6112278fe 79 p_TCB->p_lnk = NULL;
DieterGraef 0:f9b6112278fe 80 p_TCB->p_rlnk = NULL;
DieterGraef 0:f9b6112278fe 81 p_TCB->p_dlnk = NULL;
DieterGraef 0:f9b6112278fe 82 p_TCB->p_blnk = NULL;
DieterGraef 0:f9b6112278fe 83 p_TCB->p_mlnk = NULL;
DieterGraef 0:f9b6112278fe 84 p_TCB->delta_time = 0U;
DieterGraef 0:f9b6112278fe 85 p_TCB->interval_time = 0U;
DieterGraef 0:f9b6112278fe 86 p_TCB->events = 0U;
DieterGraef 0:f9b6112278fe 87 p_TCB->waits = 0U;
DieterGraef 0:f9b6112278fe 88 p_TCB->stack_frame = 0U;
DieterGraef 0:f9b6112278fe 89
DieterGraef 0:f9b6112278fe 90 if (p_TCB->priv_stack == 0U) {
DieterGraef 0:f9b6112278fe 91 /* Allocate the memory space for the stack. */
DieterGraef 0:f9b6112278fe 92 p_TCB->stack = rt_alloc_box (mp_stk);
DieterGraef 0:f9b6112278fe 93 }
DieterGraef 0:f9b6112278fe 94 rt_init_stack (p_TCB, task_body);
DieterGraef 0:f9b6112278fe 95 }
DieterGraef 0:f9b6112278fe 96
DieterGraef 0:f9b6112278fe 97
DieterGraef 0:f9b6112278fe 98 /*--------------------------- rt_switch_req ---------------------------------*/
DieterGraef 0:f9b6112278fe 99
DieterGraef 0:f9b6112278fe 100 void rt_switch_req (P_TCB p_new) {
DieterGraef 0:f9b6112278fe 101 /* Switch to next task (identified by "p_new"). */
DieterGraef 0:f9b6112278fe 102 os_tsk.new_tsk = p_new;
DieterGraef 0:f9b6112278fe 103 p_new->state = RUNNING;
DieterGraef 0:f9b6112278fe 104 DBG_TASK_SWITCH(p_new->task_id);
DieterGraef 0:f9b6112278fe 105 }
DieterGraef 0:f9b6112278fe 106
DieterGraef 0:f9b6112278fe 107
DieterGraef 0:f9b6112278fe 108 /*--------------------------- rt_dispatch -----------------------------------*/
DieterGraef 0:f9b6112278fe 109
DieterGraef 0:f9b6112278fe 110 void rt_dispatch (P_TCB next_TCB) {
DieterGraef 0:f9b6112278fe 111 /* Dispatch next task if any identified or dispatch highest ready task */
DieterGraef 0:f9b6112278fe 112 /* "next_TCB" identifies a task to run or has value NULL (=no next task) */
DieterGraef 0:f9b6112278fe 113 if (next_TCB == NULL) {
DieterGraef 0:f9b6112278fe 114 /* Running task was blocked: continue with highest ready task */
DieterGraef 0:f9b6112278fe 115 next_TCB = rt_get_first (&os_rdy);
DieterGraef 0:f9b6112278fe 116 rt_switch_req (next_TCB);
DieterGraef 0:f9b6112278fe 117 }
DieterGraef 0:f9b6112278fe 118 else {
DieterGraef 0:f9b6112278fe 119 /* Check which task continues */
DieterGraef 0:f9b6112278fe 120 if (next_TCB->prio > os_tsk.run->prio) {
DieterGraef 0:f9b6112278fe 121 /* preempt running task */
DieterGraef 0:f9b6112278fe 122 rt_put_rdy_first (os_tsk.run);
DieterGraef 0:f9b6112278fe 123 os_tsk.run->state = READY;
DieterGraef 0:f9b6112278fe 124 rt_switch_req (next_TCB);
DieterGraef 0:f9b6112278fe 125 }
DieterGraef 0:f9b6112278fe 126 else {
DieterGraef 0:f9b6112278fe 127 /* put next task into ready list, no task switch takes place */
DieterGraef 0:f9b6112278fe 128 next_TCB->state = READY;
DieterGraef 0:f9b6112278fe 129 rt_put_prio (&os_rdy, next_TCB);
DieterGraef 0:f9b6112278fe 130 }
DieterGraef 0:f9b6112278fe 131 }
DieterGraef 0:f9b6112278fe 132 }
DieterGraef 0:f9b6112278fe 133
DieterGraef 0:f9b6112278fe 134
DieterGraef 0:f9b6112278fe 135 /*--------------------------- rt_block --------------------------------------*/
DieterGraef 0:f9b6112278fe 136
DieterGraef 0:f9b6112278fe 137 void rt_block (U16 timeout, U8 block_state) {
DieterGraef 0:f9b6112278fe 138 /* Block running task and choose next ready task. */
DieterGraef 0:f9b6112278fe 139 /* "timeout" sets a time-out value or is 0xffff (=no time-out). */
DieterGraef 0:f9b6112278fe 140 /* "block_state" defines the appropriate task state */
DieterGraef 0:f9b6112278fe 141 P_TCB next_TCB;
DieterGraef 0:f9b6112278fe 142
DieterGraef 0:f9b6112278fe 143 if (timeout) {
DieterGraef 0:f9b6112278fe 144 if (timeout < 0xFFFFU) {
DieterGraef 0:f9b6112278fe 145 rt_put_dly (os_tsk.run, timeout);
DieterGraef 0:f9b6112278fe 146 }
DieterGraef 0:f9b6112278fe 147 os_tsk.run->state = block_state;
DieterGraef 0:f9b6112278fe 148 next_TCB = rt_get_first (&os_rdy);
DieterGraef 0:f9b6112278fe 149 rt_switch_req (next_TCB);
DieterGraef 0:f9b6112278fe 150 }
DieterGraef 0:f9b6112278fe 151 }
DieterGraef 0:f9b6112278fe 152
DieterGraef 0:f9b6112278fe 153
DieterGraef 0:f9b6112278fe 154 /*--------------------------- rt_tsk_pass -----------------------------------*/
DieterGraef 0:f9b6112278fe 155
DieterGraef 0:f9b6112278fe 156 void rt_tsk_pass (void) {
DieterGraef 0:f9b6112278fe 157 /* Allow tasks of same priority level to run cooperatively.*/
DieterGraef 0:f9b6112278fe 158 P_TCB p_new;
DieterGraef 0:f9b6112278fe 159
DieterGraef 0:f9b6112278fe 160 p_new = rt_get_same_rdy_prio();
DieterGraef 0:f9b6112278fe 161 if (p_new != NULL) {
DieterGraef 0:f9b6112278fe 162 rt_put_prio ((P_XCB)&os_rdy, os_tsk.run);
DieterGraef 0:f9b6112278fe 163 os_tsk.run->state = READY;
DieterGraef 0:f9b6112278fe 164 rt_switch_req (p_new);
DieterGraef 0:f9b6112278fe 165 }
DieterGraef 0:f9b6112278fe 166 }
DieterGraef 0:f9b6112278fe 167
DieterGraef 0:f9b6112278fe 168
DieterGraef 0:f9b6112278fe 169 /*--------------------------- rt_tsk_self -----------------------------------*/
DieterGraef 0:f9b6112278fe 170
DieterGraef 0:f9b6112278fe 171 OS_TID rt_tsk_self (void) {
DieterGraef 0:f9b6112278fe 172 /* Return own task identifier value. */
DieterGraef 0:f9b6112278fe 173 if (os_tsk.run == NULL) {
DieterGraef 0:f9b6112278fe 174 return (0U);
DieterGraef 0:f9b6112278fe 175 }
DieterGraef 0:f9b6112278fe 176 return ((OS_TID)os_tsk.run->task_id);
DieterGraef 0:f9b6112278fe 177 }
DieterGraef 0:f9b6112278fe 178
DieterGraef 0:f9b6112278fe 179
DieterGraef 0:f9b6112278fe 180 /*--------------------------- rt_tsk_prio -----------------------------------*/
DieterGraef 0:f9b6112278fe 181
DieterGraef 0:f9b6112278fe 182 OS_RESULT rt_tsk_prio (OS_TID task_id, U8 new_prio) {
DieterGraef 0:f9b6112278fe 183 /* Change execution priority of a task to "new_prio". */
DieterGraef 0:f9b6112278fe 184 P_TCB p_task;
DieterGraef 0:f9b6112278fe 185
DieterGraef 0:f9b6112278fe 186 if (task_id == 0U) {
DieterGraef 0:f9b6112278fe 187 /* Change execution priority of calling task. */
DieterGraef 0:f9b6112278fe 188 os_tsk.run->prio = new_prio;
DieterGraef 0:f9b6112278fe 189 os_tsk.run->prio_base = new_prio;
DieterGraef 0:f9b6112278fe 190 run:if (rt_rdy_prio() > new_prio) {
DieterGraef 0:f9b6112278fe 191 rt_put_prio (&os_rdy, os_tsk.run);
DieterGraef 0:f9b6112278fe 192 os_tsk.run->state = READY;
DieterGraef 0:f9b6112278fe 193 rt_dispatch (NULL);
DieterGraef 0:f9b6112278fe 194 }
DieterGraef 0:f9b6112278fe 195 return (OS_R_OK);
DieterGraef 0:f9b6112278fe 196 }
DieterGraef 0:f9b6112278fe 197
DieterGraef 0:f9b6112278fe 198 /* Find the task in the "os_active_TCB" array. */
DieterGraef 0:f9b6112278fe 199 if ((task_id > os_maxtaskrun) || (os_active_TCB[task_id-1U] == NULL)) {
DieterGraef 0:f9b6112278fe 200 /* Task with "task_id" not found or not started. */
DieterGraef 0:f9b6112278fe 201 return (OS_R_NOK);
DieterGraef 0:f9b6112278fe 202 }
DieterGraef 0:f9b6112278fe 203 p_task = os_active_TCB[task_id-1U];
DieterGraef 0:f9b6112278fe 204 p_task->prio = new_prio;
DieterGraef 0:f9b6112278fe 205 p_task->prio_base = new_prio;
DieterGraef 0:f9b6112278fe 206 if (p_task == os_tsk.run) {
DieterGraef 0:f9b6112278fe 207 goto run;
DieterGraef 0:f9b6112278fe 208 }
DieterGraef 0:f9b6112278fe 209 rt_resort_prio (p_task);
DieterGraef 0:f9b6112278fe 210 if (p_task->state == READY) {
DieterGraef 0:f9b6112278fe 211 /* Task enqueued in a ready list. */
DieterGraef 0:f9b6112278fe 212 p_task = rt_get_first (&os_rdy);
DieterGraef 0:f9b6112278fe 213 rt_dispatch (p_task);
DieterGraef 0:f9b6112278fe 214 }
DieterGraef 0:f9b6112278fe 215 return (OS_R_OK);
DieterGraef 0:f9b6112278fe 216 }
DieterGraef 0:f9b6112278fe 217
DieterGraef 0:f9b6112278fe 218
DieterGraef 0:f9b6112278fe 219 /*--------------------------- rt_tsk_create ---------------------------------*/
DieterGraef 0:f9b6112278fe 220
DieterGraef 0:f9b6112278fe 221 OS_TID rt_tsk_create (FUNCP task, U32 prio_stksz, void *stk, void *argv) {
DieterGraef 0:f9b6112278fe 222 /* Start a new task declared with "task". */
DieterGraef 0:f9b6112278fe 223 P_TCB task_context;
DieterGraef 0:f9b6112278fe 224 U32 i;
DieterGraef 0:f9b6112278fe 225
DieterGraef 0:f9b6112278fe 226 /* Priority 0 is reserved for idle task! */
DieterGraef 0:f9b6112278fe 227 if ((prio_stksz & 0xFFU) == 0U) {
DieterGraef 0:f9b6112278fe 228 prio_stksz += 1U;
DieterGraef 0:f9b6112278fe 229 }
DieterGraef 0:f9b6112278fe 230 task_context = rt_alloc_box (mp_tcb);
DieterGraef 0:f9b6112278fe 231 if (task_context == NULL) {
DieterGraef 0:f9b6112278fe 232 return (0U);
DieterGraef 0:f9b6112278fe 233 }
DieterGraef 0:f9b6112278fe 234 /* If "size != 0" use a private user provided stack. */
DieterGraef 0:f9b6112278fe 235 task_context->stack = stk;
DieterGraef 0:f9b6112278fe 236 task_context->priv_stack = prio_stksz >> 8;
DieterGraef 0:f9b6112278fe 237
DieterGraef 0:f9b6112278fe 238 /* Find a free entry in 'os_active_TCB' table. */
DieterGraef 0:f9b6112278fe 239 i = rt_get_TID ();
DieterGraef 0:f9b6112278fe 240 if (i == 0U) {
DieterGraef 0:f9b6112278fe 241 return (0U);
DieterGraef 0:f9b6112278fe 242 }
DieterGraef 0:f9b6112278fe 243 task_context->task_id = (U8)i;
DieterGraef 0:f9b6112278fe 244 /* Pass parameter 'argv' to 'rt_init_context' */
DieterGraef 0:f9b6112278fe 245 task_context->msg = argv;
DieterGraef 0:f9b6112278fe 246 /* For 'size == 0' system allocates the user stack from the memory pool. */
DieterGraef 0:f9b6112278fe 247 rt_init_context (task_context, (U8)(prio_stksz & 0xFFU), task);
DieterGraef 0:f9b6112278fe 248
DieterGraef 0:f9b6112278fe 249 os_active_TCB[i-1U] = task_context;
DieterGraef 0:f9b6112278fe 250 DBG_TASK_NOTIFY(task_context, __TRUE);
DieterGraef 0:f9b6112278fe 251 rt_dispatch (task_context);
DieterGraef 0:f9b6112278fe 252 return ((OS_TID)i);
DieterGraef 0:f9b6112278fe 253 }
DieterGraef 0:f9b6112278fe 254
DieterGraef 0:f9b6112278fe 255
DieterGraef 0:f9b6112278fe 256 /*--------------------------- rt_tsk_delete ---------------------------------*/
DieterGraef 0:f9b6112278fe 257
DieterGraef 0:f9b6112278fe 258 OS_RESULT rt_tsk_delete (OS_TID task_id) {
DieterGraef 0:f9b6112278fe 259 /* Terminate the task identified with "task_id". */
DieterGraef 0:f9b6112278fe 260 P_TCB task_context;
DieterGraef 0:f9b6112278fe 261 P_TCB p_TCB;
DieterGraef 0:f9b6112278fe 262 P_MUCB p_MCB, p_MCB0;
DieterGraef 0:f9b6112278fe 263
DieterGraef 0:f9b6112278fe 264 if ((task_id == 0U) || (task_id == os_tsk.run->task_id)) {
DieterGraef 0:f9b6112278fe 265 /* Terminate itself. */
DieterGraef 0:f9b6112278fe 266 os_tsk.run->state = INACTIVE;
DieterGraef 0:f9b6112278fe 267 os_tsk.run->tsk_stack = rt_get_PSP ();
DieterGraef 0:f9b6112278fe 268 rt_stk_check ();
DieterGraef 0:f9b6112278fe 269 p_MCB = os_tsk.run->p_mlnk;
DieterGraef 0:f9b6112278fe 270 while (p_MCB) {
DieterGraef 0:f9b6112278fe 271 /* Release mutexes owned by this task */
DieterGraef 0:f9b6112278fe 272 if (p_MCB->p_lnk) {
DieterGraef 0:f9b6112278fe 273 /* A task is waiting for mutex. */
DieterGraef 0:f9b6112278fe 274 p_TCB = rt_get_first ((P_XCB)p_MCB);
DieterGraef 0:f9b6112278fe 275 #ifdef __CMSIS_RTOS
DieterGraef 0:f9b6112278fe 276 rt_ret_val (p_TCB, 0U/*osOK*/);
DieterGraef 0:f9b6112278fe 277 #else
DieterGraef 0:f9b6112278fe 278 rt_ret_val (p_TCB, OS_R_MUT);
DieterGraef 0:f9b6112278fe 279 #endif
DieterGraef 0:f9b6112278fe 280 rt_rmv_dly (p_TCB);
DieterGraef 0:f9b6112278fe 281 p_TCB->state = READY;
DieterGraef 0:f9b6112278fe 282 rt_put_prio (&os_rdy, p_TCB);
DieterGraef 0:f9b6112278fe 283 /* A waiting task becomes the owner of this mutex. */
DieterGraef 0:f9b6112278fe 284 p_MCB0 = p_MCB->p_mlnk;
DieterGraef 0:f9b6112278fe 285 p_MCB->level = 1U;
DieterGraef 0:f9b6112278fe 286 p_MCB->owner = p_TCB;
DieterGraef 0:f9b6112278fe 287 p_MCB->p_mlnk = p_TCB->p_mlnk;
DieterGraef 0:f9b6112278fe 288 p_TCB->p_mlnk = p_MCB;
DieterGraef 0:f9b6112278fe 289 p_MCB = p_MCB0;
DieterGraef 0:f9b6112278fe 290 }
DieterGraef 0:f9b6112278fe 291 else {
DieterGraef 0:f9b6112278fe 292 p_MCB0 = p_MCB->p_mlnk;
DieterGraef 0:f9b6112278fe 293 p_MCB->level = 0U;
DieterGraef 0:f9b6112278fe 294 p_MCB->owner = NULL;
DieterGraef 0:f9b6112278fe 295 p_MCB->p_mlnk = NULL;
DieterGraef 0:f9b6112278fe 296 p_MCB = p_MCB0;
DieterGraef 0:f9b6112278fe 297 }
DieterGraef 0:f9b6112278fe 298 }
DieterGraef 0:f9b6112278fe 299 os_active_TCB[os_tsk.run->task_id-1U] = NULL;
DieterGraef 0:f9b6112278fe 300 rt_free_box (mp_stk, os_tsk.run->stack);
DieterGraef 0:f9b6112278fe 301 os_tsk.run->stack = NULL;
DieterGraef 0:f9b6112278fe 302 DBG_TASK_NOTIFY(os_tsk.run, __FALSE);
DieterGraef 0:f9b6112278fe 303 rt_free_box (mp_tcb, os_tsk.run);
DieterGraef 0:f9b6112278fe 304 os_tsk.run = NULL;
DieterGraef 0:f9b6112278fe 305 rt_dispatch (NULL);
DieterGraef 0:f9b6112278fe 306 /* The program should never come to this point. */
DieterGraef 0:f9b6112278fe 307 }
DieterGraef 0:f9b6112278fe 308 else {
DieterGraef 0:f9b6112278fe 309 /* Find the task in the "os_active_TCB" array. */
DieterGraef 0:f9b6112278fe 310 if ((task_id > os_maxtaskrun) || (os_active_TCB[task_id-1U] == NULL)) {
DieterGraef 0:f9b6112278fe 311 /* Task with "task_id" not found or not started. */
DieterGraef 0:f9b6112278fe 312 return (OS_R_NOK);
DieterGraef 0:f9b6112278fe 313 }
DieterGraef 0:f9b6112278fe 314 task_context = os_active_TCB[task_id-1U];
DieterGraef 0:f9b6112278fe 315 rt_rmv_list (task_context);
DieterGraef 0:f9b6112278fe 316 rt_rmv_dly (task_context);
DieterGraef 0:f9b6112278fe 317 p_MCB = task_context->p_mlnk;
DieterGraef 0:f9b6112278fe 318 while (p_MCB) {
DieterGraef 0:f9b6112278fe 319 /* Release mutexes owned by this task */
DieterGraef 0:f9b6112278fe 320 if (p_MCB->p_lnk) {
DieterGraef 0:f9b6112278fe 321 /* A task is waiting for mutex. */
DieterGraef 0:f9b6112278fe 322 p_TCB = rt_get_first ((P_XCB)p_MCB);
DieterGraef 0:f9b6112278fe 323 #ifdef __CMSIS_RTOS
DieterGraef 0:f9b6112278fe 324 rt_ret_val (p_TCB, 0U/*osOK*/);
DieterGraef 0:f9b6112278fe 325 #else
DieterGraef 0:f9b6112278fe 326 rt_ret_val (p_TCB, OS_R_MUT);
DieterGraef 0:f9b6112278fe 327 #endif
DieterGraef 0:f9b6112278fe 328 rt_rmv_dly (p_TCB);
DieterGraef 0:f9b6112278fe 329 p_TCB->state = READY;
DieterGraef 0:f9b6112278fe 330 rt_put_prio (&os_rdy, p_TCB);
DieterGraef 0:f9b6112278fe 331 /* A waiting task becomes the owner of this mutex. */
DieterGraef 0:f9b6112278fe 332 p_MCB0 = p_MCB->p_mlnk;
DieterGraef 0:f9b6112278fe 333 p_MCB->level = 1U;
DieterGraef 0:f9b6112278fe 334 p_MCB->owner = p_TCB;
DieterGraef 0:f9b6112278fe 335 p_MCB->p_mlnk = p_TCB->p_mlnk;
DieterGraef 0:f9b6112278fe 336 p_TCB->p_mlnk = p_MCB;
DieterGraef 0:f9b6112278fe 337 p_MCB = p_MCB0;
DieterGraef 0:f9b6112278fe 338 }
DieterGraef 0:f9b6112278fe 339 else {
DieterGraef 0:f9b6112278fe 340 p_MCB0 = p_MCB->p_mlnk;
DieterGraef 0:f9b6112278fe 341 p_MCB->level = 0U;
DieterGraef 0:f9b6112278fe 342 p_MCB->owner = NULL;
DieterGraef 0:f9b6112278fe 343 p_MCB->p_mlnk = NULL;
DieterGraef 0:f9b6112278fe 344 p_MCB = p_MCB0;
DieterGraef 0:f9b6112278fe 345 }
DieterGraef 0:f9b6112278fe 346 }
DieterGraef 0:f9b6112278fe 347 os_active_TCB[task_id-1U] = NULL;
DieterGraef 0:f9b6112278fe 348 rt_free_box (mp_stk, task_context->stack);
DieterGraef 0:f9b6112278fe 349 task_context->stack = NULL;
DieterGraef 0:f9b6112278fe 350 DBG_TASK_NOTIFY(task_context, __FALSE);
DieterGraef 0:f9b6112278fe 351 rt_free_box (mp_tcb, task_context);
DieterGraef 0:f9b6112278fe 352 if (rt_rdy_prio() > os_tsk.run->prio) {
DieterGraef 0:f9b6112278fe 353 /* Ready task has higher priority than running task. */
DieterGraef 0:f9b6112278fe 354 os_tsk.run->state = READY;
DieterGraef 0:f9b6112278fe 355 rt_put_prio (&os_rdy, os_tsk.run);
DieterGraef 0:f9b6112278fe 356 rt_dispatch (NULL);
DieterGraef 0:f9b6112278fe 357 }
DieterGraef 0:f9b6112278fe 358 }
DieterGraef 0:f9b6112278fe 359 return (OS_R_OK);
DieterGraef 0:f9b6112278fe 360 }
DieterGraef 0:f9b6112278fe 361
DieterGraef 0:f9b6112278fe 362
DieterGraef 0:f9b6112278fe 363 /*--------------------------- rt_sys_init -----------------------------------*/
DieterGraef 0:f9b6112278fe 364
DieterGraef 0:f9b6112278fe 365 #ifdef __CMSIS_RTOS
DieterGraef 0:f9b6112278fe 366 void rt_sys_init (void) {
DieterGraef 0:f9b6112278fe 367 #else
DieterGraef 0:f9b6112278fe 368 void rt_sys_init (FUNCP first_task, U32 prio_stksz, void *stk) {
DieterGraef 0:f9b6112278fe 369 #endif
DieterGraef 0:f9b6112278fe 370 /* Initialize system and start up task declared with "first_task". */
DieterGraef 0:f9b6112278fe 371 U32 i;
DieterGraef 0:f9b6112278fe 372
DieterGraef 0:f9b6112278fe 373 DBG_INIT();
DieterGraef 0:f9b6112278fe 374
DieterGraef 0:f9b6112278fe 375 /* Initialize dynamic memory and task TCB pointers to NULL. */
DieterGraef 0:f9b6112278fe 376 for (i = 0U; i < os_maxtaskrun; i++) {
DieterGraef 0:f9b6112278fe 377 os_active_TCB[i] = NULL;
DieterGraef 0:f9b6112278fe 378 }
DieterGraef 0:f9b6112278fe 379 rt_init_box (mp_tcb, (U32)mp_tcb_size, sizeof(struct OS_TCB));
DieterGraef 0:f9b6112278fe 380 rt_init_box (mp_stk, mp_stk_size, BOX_ALIGN_8 | (U16)(os_stackinfo));
DieterGraef 0:f9b6112278fe 381 rt_init_box ((U32 *)m_tmr, (U32)mp_tmr_size, sizeof(struct OS_TMR));
DieterGraef 0:f9b6112278fe 382
DieterGraef 0:f9b6112278fe 383 /* Set up TCB of idle demon */
DieterGraef 0:f9b6112278fe 384 os_idle_TCB.task_id = 255U;
DieterGraef 0:f9b6112278fe 385 os_idle_TCB.priv_stack = 0U;
DieterGraef 0:f9b6112278fe 386 rt_init_context (&os_idle_TCB, 0U, os_idle_demon);
DieterGraef 0:f9b6112278fe 387
DieterGraef 0:f9b6112278fe 388 /* Set up ready list: initially empty */
DieterGraef 0:f9b6112278fe 389 os_rdy.cb_type = HCB;
DieterGraef 0:f9b6112278fe 390 os_rdy.p_lnk = NULL;
DieterGraef 0:f9b6112278fe 391 /* Set up delay list: initially empty */
DieterGraef 0:f9b6112278fe 392 os_dly.cb_type = HCB;
DieterGraef 0:f9b6112278fe 393 os_dly.p_dlnk = NULL;
DieterGraef 0:f9b6112278fe 394 os_dly.p_blnk = NULL;
DieterGraef 0:f9b6112278fe 395 os_dly.delta_time = 0U;
DieterGraef 0:f9b6112278fe 396
DieterGraef 0:f9b6112278fe 397 /* Fix SP and system variables to assume idle task is running */
DieterGraef 0:f9b6112278fe 398 /* Transform main program into idle task by assuming idle TCB */
DieterGraef 0:f9b6112278fe 399 #ifndef __CMSIS_RTOS
DieterGraef 0:f9b6112278fe 400 rt_set_PSP (os_idle_TCB.tsk_stack+32U);
DieterGraef 0:f9b6112278fe 401 #endif
DieterGraef 0:f9b6112278fe 402 os_tsk.run = &os_idle_TCB;
DieterGraef 0:f9b6112278fe 403 os_tsk.run->state = RUNNING;
DieterGraef 0:f9b6112278fe 404
DieterGraef 0:f9b6112278fe 405 /* Initialize ps queue */
DieterGraef 0:f9b6112278fe 406 os_psq->first = 0U;
DieterGraef 0:f9b6112278fe 407 os_psq->last = 0U;
DieterGraef 0:f9b6112278fe 408 os_psq->size = os_fifo_size;
DieterGraef 0:f9b6112278fe 409
DieterGraef 0:f9b6112278fe 410 rt_init_robin ();
DieterGraef 0:f9b6112278fe 411
DieterGraef 0:f9b6112278fe 412 #ifndef __CMSIS_RTOS
DieterGraef 0:f9b6112278fe 413 /* Initialize SVC and PendSV */
DieterGraef 0:f9b6112278fe 414 rt_svc_init ();
DieterGraef 0:f9b6112278fe 415
DieterGraef 0:f9b6112278fe 416 /* Initialize and start system clock timer */
DieterGraef 0:f9b6112278fe 417 os_tick_irqn = os_tick_init ();
DieterGraef 0:f9b6112278fe 418 if (os_tick_irqn >= 0) {
DieterGraef 0:f9b6112278fe 419 OS_X_INIT((U32)os_tick_irqn);
DieterGraef 0:f9b6112278fe 420 }
DieterGraef 0:f9b6112278fe 421
DieterGraef 0:f9b6112278fe 422 /* Start up first user task before entering the endless loop */
DieterGraef 0:f9b6112278fe 423 rt_tsk_create (first_task, prio_stksz, stk, NULL);
DieterGraef 0:f9b6112278fe 424 #endif
DieterGraef 0:f9b6112278fe 425 }
DieterGraef 0:f9b6112278fe 426
DieterGraef 0:f9b6112278fe 427
DieterGraef 0:f9b6112278fe 428 /*--------------------------- rt_sys_start ----------------------------------*/
DieterGraef 0:f9b6112278fe 429
DieterGraef 0:f9b6112278fe 430 #ifdef __CMSIS_RTOS
DieterGraef 0:f9b6112278fe 431 void rt_sys_start (void) {
DieterGraef 0:f9b6112278fe 432 /* Start system */
DieterGraef 0:f9b6112278fe 433
DieterGraef 0:f9b6112278fe 434 /* Initialize SVC and PendSV */
DieterGraef 0:f9b6112278fe 435 rt_svc_init ();
DieterGraef 0:f9b6112278fe 436
DieterGraef 0:f9b6112278fe 437 /* Initialize and start system clock timer */
DieterGraef 0:f9b6112278fe 438 os_tick_irqn = os_tick_init ();
DieterGraef 0:f9b6112278fe 439 if (os_tick_irqn >= 0) {
DieterGraef 0:f9b6112278fe 440 OS_X_INIT((U32)os_tick_irqn);
DieterGraef 0:f9b6112278fe 441 }
DieterGraef 0:f9b6112278fe 442 }
DieterGraef 0:f9b6112278fe 443 #endif
DieterGraef 0:f9b6112278fe 444
DieterGraef 0:f9b6112278fe 445 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 446 * end of file
DieterGraef 0:f9b6112278fe 447 *---------------------------------------------------------------------------*/