ELEC2645 (2018/19) / Mbed 2 deprecated el17dg

Initial publish

Dependencies:   mbed

Fork of el17dg by Dmitrijs Griskovs

mbed-rtos/rtx/TARGET_ARM7/rt_Semaphore.c@40:e3bbda7444fa, 2019-05-07 (annotated)

Committer:
Noximilien
Date:
Tue May 07 15:22:35 2019 +0000
Revision:
40:e3bbda7444fa
Parent:
1:5aa2312d3e94 
The Final, Submission Version. I have read and agreed to the academic integrity. SID:201160286

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Noximilien 1:5aa2312d3e94 1 /*----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 2 * RL-ARM - RTX
Noximilien 1:5aa2312d3e94 3 *----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 4 * Name: RT_SEMAPHORE.C
Noximilien 1:5aa2312d3e94 5 * Purpose: Implements binary and counting semaphores
Noximilien 1:5aa2312d3e94 6 * Rev.: V4.60
Noximilien 1:5aa2312d3e94 7 *----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 8 *
Noximilien 1:5aa2312d3e94 9 * Copyright (c) 1999-2009 KEIL, 2009-2015 ARM Germany GmbH
Noximilien 1:5aa2312d3e94 10 * All rights reserved.
Noximilien 1:5aa2312d3e94 11 * Redistribution and use in source and binary forms, with or without
Noximilien 1:5aa2312d3e94 12 * modification, are permitted provided that the following conditions are met:
Noximilien 1:5aa2312d3e94 13 * - Redistributions of source code must retain the above copyright
Noximilien 1:5aa2312d3e94 14 * notice, this list of conditions and the following disclaimer.
Noximilien 1:5aa2312d3e94 15 * - Redistributions in binary form must reproduce the above copyright
Noximilien 1:5aa2312d3e94 16 * notice, this list of conditions and the following disclaimer in the
Noximilien 1:5aa2312d3e94 17 * documentation and/or other materials provided with the distribution.
Noximilien 1:5aa2312d3e94 18 * - Neither the name of ARM nor the names of its contributors may be used
Noximilien 1:5aa2312d3e94 19 * to endorse or promote products derived from this software without
Noximilien 1:5aa2312d3e94 20 * specific prior written permission.
Noximilien 1:5aa2312d3e94 21 *
Noximilien 1:5aa2312d3e94 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Noximilien 1:5aa2312d3e94 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Noximilien 1:5aa2312d3e94 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Noximilien 1:5aa2312d3e94 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
Noximilien 1:5aa2312d3e94 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
Noximilien 1:5aa2312d3e94 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
Noximilien 1:5aa2312d3e94 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
Noximilien 1:5aa2312d3e94 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
Noximilien 1:5aa2312d3e94 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
Noximilien 1:5aa2312d3e94 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Noximilien 1:5aa2312d3e94 32 * POSSIBILITY OF SUCH DAMAGE.
Noximilien 1:5aa2312d3e94 33 *---------------------------------------------------------------------------*/
Noximilien 1:5aa2312d3e94 34
Noximilien 1:5aa2312d3e94 35 #include "rt_TypeDef.h"
Noximilien 1:5aa2312d3e94 36 #include "RTX_Conf.h"
Noximilien 1:5aa2312d3e94 37 #include "rt_System.h"
Noximilien 1:5aa2312d3e94 38 #include "rt_List.h"
Noximilien 1:5aa2312d3e94 39 #include "rt_Task.h"
Noximilien 1:5aa2312d3e94 40 #include "rt_Semaphore.h"
Noximilien 1:5aa2312d3e94 41 #include "rt_HAL_CM.h"
Noximilien 1:5aa2312d3e94 42
Noximilien 1:5aa2312d3e94 43
Noximilien 1:5aa2312d3e94 44 /*----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 45 * Functions
Noximilien 1:5aa2312d3e94 46 *---------------------------------------------------------------------------*/
Noximilien 1:5aa2312d3e94 47
Noximilien 1:5aa2312d3e94 48
Noximilien 1:5aa2312d3e94 49 /*--------------------------- rt_sem_init -----------------------------------*/
Noximilien 1:5aa2312d3e94 50
Noximilien 1:5aa2312d3e94 51 void rt_sem_init (OS_ID semaphore, U16 token_count) {
Noximilien 1:5aa2312d3e94 52 /* Initialize a semaphore */
Noximilien 1:5aa2312d3e94 53 P_SCB p_SCB = semaphore;
Noximilien 1:5aa2312d3e94 54
Noximilien 1:5aa2312d3e94 55 p_SCB->cb_type = SCB;
Noximilien 1:5aa2312d3e94 56 p_SCB->p_lnk = NULL;
Noximilien 1:5aa2312d3e94 57 p_SCB->tokens = token_count;
Noximilien 1:5aa2312d3e94 58 }
Noximilien 1:5aa2312d3e94 59
Noximilien 1:5aa2312d3e94 60
Noximilien 1:5aa2312d3e94 61 /*--------------------------- rt_sem_delete ---------------------------------*/
Noximilien 1:5aa2312d3e94 62
Noximilien 1:5aa2312d3e94 63 #ifdef __CMSIS_RTOS
Noximilien 1:5aa2312d3e94 64 OS_RESULT rt_sem_delete (OS_ID semaphore) {
Noximilien 1:5aa2312d3e94 65 /* Delete semaphore */
Noximilien 1:5aa2312d3e94 66 P_SCB p_SCB = semaphore;
Noximilien 1:5aa2312d3e94 67 P_TCB p_TCB;
Noximilien 1:5aa2312d3e94 68
Noximilien 1:5aa2312d3e94 69 while (p_SCB->p_lnk != NULL) {
Noximilien 1:5aa2312d3e94 70 /* A task is waiting for token */
Noximilien 1:5aa2312d3e94 71 p_TCB = rt_get_first ((P_XCB)p_SCB);
Noximilien 1:5aa2312d3e94 72 rt_ret_val(p_TCB, 0);
Noximilien 1:5aa2312d3e94 73 rt_rmv_dly(p_TCB);
Noximilien 1:5aa2312d3e94 74 p_TCB->state = READY;
Noximilien 1:5aa2312d3e94 75 rt_put_prio (&os_rdy, p_TCB);
Noximilien 1:5aa2312d3e94 76 }
Noximilien 1:5aa2312d3e94 77
Noximilien 1:5aa2312d3e94 78 if (os_rdy.p_lnk && (os_rdy.p_lnk->prio > os_tsk.run->prio)) {
Noximilien 1:5aa2312d3e94 79 /* preempt running task */
Noximilien 1:5aa2312d3e94 80 rt_put_prio (&os_rdy, os_tsk.run);
Noximilien 1:5aa2312d3e94 81 os_tsk.run->state = READY;
Noximilien 1:5aa2312d3e94 82 rt_dispatch (NULL);
Noximilien 1:5aa2312d3e94 83 }
Noximilien 1:5aa2312d3e94 84
Noximilien 1:5aa2312d3e94 85 p_SCB->cb_type = 0;
Noximilien 1:5aa2312d3e94 86
Noximilien 1:5aa2312d3e94 87 return (OS_R_OK);
Noximilien 1:5aa2312d3e94 88 }
Noximilien 1:5aa2312d3e94 89 #endif
Noximilien 1:5aa2312d3e94 90
Noximilien 1:5aa2312d3e94 91
Noximilien 1:5aa2312d3e94 92 /*--------------------------- rt_sem_send -----------------------------------*/
Noximilien 1:5aa2312d3e94 93
Noximilien 1:5aa2312d3e94 94 OS_RESULT rt_sem_send (OS_ID semaphore) {
Noximilien 1:5aa2312d3e94 95 /* Return a token to semaphore */
Noximilien 1:5aa2312d3e94 96 P_SCB p_SCB = semaphore;
Noximilien 1:5aa2312d3e94 97 P_TCB p_TCB;
Noximilien 1:5aa2312d3e94 98
Noximilien 1:5aa2312d3e94 99 if (p_SCB->p_lnk != NULL) {
Noximilien 1:5aa2312d3e94 100 /* A task is waiting for token */
Noximilien 1:5aa2312d3e94 101 p_TCB = rt_get_first ((P_XCB)p_SCB);
Noximilien 1:5aa2312d3e94 102 #ifdef __CMSIS_RTOS
Noximilien 1:5aa2312d3e94 103 rt_ret_val(p_TCB, 1);
Noximilien 1:5aa2312d3e94 104 #else
Noximilien 1:5aa2312d3e94 105 rt_ret_val(p_TCB, OS_R_SEM);
Noximilien 1:5aa2312d3e94 106 #endif
Noximilien 1:5aa2312d3e94 107 rt_rmv_dly (p_TCB);
Noximilien 1:5aa2312d3e94 108 rt_dispatch (p_TCB);
Noximilien 1:5aa2312d3e94 109 }
Noximilien 1:5aa2312d3e94 110 else {
Noximilien 1:5aa2312d3e94 111 /* Store token. */
Noximilien 1:5aa2312d3e94 112 p_SCB->tokens++;
Noximilien 1:5aa2312d3e94 113 }
Noximilien 1:5aa2312d3e94 114 return (OS_R_OK);
Noximilien 1:5aa2312d3e94 115 }
Noximilien 1:5aa2312d3e94 116
Noximilien 1:5aa2312d3e94 117
Noximilien 1:5aa2312d3e94 118 /*--------------------------- rt_sem_wait -----------------------------------*/
Noximilien 1:5aa2312d3e94 119
Noximilien 1:5aa2312d3e94 120 OS_RESULT rt_sem_wait (OS_ID semaphore, U16 timeout) {
Noximilien 1:5aa2312d3e94 121 /* Obtain a token; possibly wait for it */
Noximilien 1:5aa2312d3e94 122 P_SCB p_SCB = semaphore;
Noximilien 1:5aa2312d3e94 123
Noximilien 1:5aa2312d3e94 124 if (p_SCB->tokens) {
Noximilien 1:5aa2312d3e94 125 p_SCB->tokens--;
Noximilien 1:5aa2312d3e94 126 return (OS_R_OK);
Noximilien 1:5aa2312d3e94 127 }
Noximilien 1:5aa2312d3e94 128 /* No token available: wait for one */
Noximilien 1:5aa2312d3e94 129 if (timeout == 0) {
Noximilien 1:5aa2312d3e94 130 return (OS_R_TMO);
Noximilien 1:5aa2312d3e94 131 }
Noximilien 1:5aa2312d3e94 132 if (p_SCB->p_lnk != NULL) {
Noximilien 1:5aa2312d3e94 133 rt_put_prio ((P_XCB)p_SCB, os_tsk.run);
Noximilien 1:5aa2312d3e94 134 }
Noximilien 1:5aa2312d3e94 135 else {
Noximilien 1:5aa2312d3e94 136 p_SCB->p_lnk = os_tsk.run;
Noximilien 1:5aa2312d3e94 137 os_tsk.run->p_lnk = NULL;
Noximilien 1:5aa2312d3e94 138 os_tsk.run->p_rlnk = (P_TCB)p_SCB;
Noximilien 1:5aa2312d3e94 139 }
Noximilien 1:5aa2312d3e94 140 rt_block(timeout, WAIT_SEM);
Noximilien 1:5aa2312d3e94 141 return (OS_R_TMO);
Noximilien 1:5aa2312d3e94 142 }
Noximilien 1:5aa2312d3e94 143
Noximilien 1:5aa2312d3e94 144
Noximilien 1:5aa2312d3e94 145 /*--------------------------- isr_sem_send ----------------------------------*/
Noximilien 1:5aa2312d3e94 146
Noximilien 1:5aa2312d3e94 147 void isr_sem_send (OS_ID semaphore) {
Noximilien 1:5aa2312d3e94 148 /* Same function as "os_sem"send", but to be called by ISRs */
Noximilien 1:5aa2312d3e94 149 P_SCB p_SCB = semaphore;
Noximilien 1:5aa2312d3e94 150
Noximilien 1:5aa2312d3e94 151 rt_psq_enq (p_SCB, 0);
Noximilien 1:5aa2312d3e94 152 rt_psh_req ();
Noximilien 1:5aa2312d3e94 153 }
Noximilien 1:5aa2312d3e94 154
Noximilien 1:5aa2312d3e94 155
Noximilien 1:5aa2312d3e94 156 /*--------------------------- rt_sem_psh ------------------------------------*/
Noximilien 1:5aa2312d3e94 157
Noximilien 1:5aa2312d3e94 158 void rt_sem_psh (P_SCB p_CB) {
Noximilien 1:5aa2312d3e94 159 /* Check if task has to be waken up */
Noximilien 1:5aa2312d3e94 160 P_TCB p_TCB;
Noximilien 1:5aa2312d3e94 161
Noximilien 1:5aa2312d3e94 162 if (p_CB->p_lnk != NULL) {
Noximilien 1:5aa2312d3e94 163 /* A task is waiting for token */
Noximilien 1:5aa2312d3e94 164 p_TCB = rt_get_first ((P_XCB)p_CB);
Noximilien 1:5aa2312d3e94 165 rt_rmv_dly (p_TCB);
Noximilien 1:5aa2312d3e94 166 p_TCB->state = READY;
Noximilien 1:5aa2312d3e94 167 #ifdef __CMSIS_RTOS
Noximilien 1:5aa2312d3e94 168 rt_ret_val(p_TCB, 1);
Noximilien 1:5aa2312d3e94 169 #else
Noximilien 1:5aa2312d3e94 170 rt_ret_val(p_TCB, OS_R_SEM);
Noximilien 1:5aa2312d3e94 171 #endif
Noximilien 1:5aa2312d3e94 172 rt_put_prio (&os_rdy, p_TCB);
Noximilien 1:5aa2312d3e94 173 }
Noximilien 1:5aa2312d3e94 174 else {
Noximilien 1:5aa2312d3e94 175 /* Store token */
Noximilien 1:5aa2312d3e94 176 p_CB->tokens++;
Noximilien 1:5aa2312d3e94 177 }
Noximilien 1:5aa2312d3e94 178 }
Noximilien 1:5aa2312d3e94 179
Noximilien 1:5aa2312d3e94 180 /*----------------------------------------------------------------------------
Noximilien 1:5aa2312d3e94 181 * end of file
Noximilien 1:5aa2312d3e94 182 *---------------------------------------------------------------------------*/
Noximilien 1:5aa2312d3e94 183