ソースの整理中ですが、利用はできます。

Dependencies:   EthernetInterface HttpServer TextLCD mbed-rpc mbed-rtos mbed Socket lwip-eth lwip-sys lwip

Committer:
yueee_yt
Date:
Wed Mar 12 04:19:54 2014 +0000
Revision:
0:7766f6712673
???????????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yueee_yt 0:7766f6712673 1 /*----------------------------------------------------------------------------
yueee_yt 0:7766f6712673 2 * RL-ARM - RTX
yueee_yt 0:7766f6712673 3 *----------------------------------------------------------------------------
yueee_yt 0:7766f6712673 4 * Name: RT_MUTEX.C
yueee_yt 0:7766f6712673 5 * Purpose: Implements mutex synchronization objects
yueee_yt 0:7766f6712673 6 * Rev.: V4.60
yueee_yt 0:7766f6712673 7 *----------------------------------------------------------------------------
yueee_yt 0:7766f6712673 8 *
yueee_yt 0:7766f6712673 9 * Copyright (c) 1999-2009 KEIL, 2009-2012 ARM Germany GmbH
yueee_yt 0:7766f6712673 10 * All rights reserved.
yueee_yt 0:7766f6712673 11 * Redistribution and use in source and binary forms, with or without
yueee_yt 0:7766f6712673 12 * modification, are permitted provided that the following conditions are met:
yueee_yt 0:7766f6712673 13 * - Redistributions of source code must retain the above copyright
yueee_yt 0:7766f6712673 14 * notice, this list of conditions and the following disclaimer.
yueee_yt 0:7766f6712673 15 * - Redistributions in binary form must reproduce the above copyright
yueee_yt 0:7766f6712673 16 * notice, this list of conditions and the following disclaimer in the
yueee_yt 0:7766f6712673 17 * documentation and/or other materials provided with the distribution.
yueee_yt 0:7766f6712673 18 * - Neither the name of ARM nor the names of its contributors may be used
yueee_yt 0:7766f6712673 19 * to endorse or promote products derived from this software without
yueee_yt 0:7766f6712673 20 * specific prior written permission.
yueee_yt 0:7766f6712673 21 *
yueee_yt 0:7766f6712673 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
yueee_yt 0:7766f6712673 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
yueee_yt 0:7766f6712673 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
yueee_yt 0:7766f6712673 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
yueee_yt 0:7766f6712673 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
yueee_yt 0:7766f6712673 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
yueee_yt 0:7766f6712673 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
yueee_yt 0:7766f6712673 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
yueee_yt 0:7766f6712673 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
yueee_yt 0:7766f6712673 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
yueee_yt 0:7766f6712673 32 * POSSIBILITY OF SUCH DAMAGE.
yueee_yt 0:7766f6712673 33 *---------------------------------------------------------------------------*/
yueee_yt 0:7766f6712673 34
yueee_yt 0:7766f6712673 35 #include "rt_TypeDef.h"
yueee_yt 0:7766f6712673 36 #include "RTX_Conf.h"
yueee_yt 0:7766f6712673 37 #include "rt_List.h"
yueee_yt 0:7766f6712673 38 #include "rt_Task.h"
yueee_yt 0:7766f6712673 39 #include "rt_Mutex.h"
yueee_yt 0:7766f6712673 40 #include "rt_HAL_CM.h"
yueee_yt 0:7766f6712673 41
yueee_yt 0:7766f6712673 42
yueee_yt 0:7766f6712673 43 /*----------------------------------------------------------------------------
yueee_yt 0:7766f6712673 44 * Functions
yueee_yt 0:7766f6712673 45 *---------------------------------------------------------------------------*/
yueee_yt 0:7766f6712673 46
yueee_yt 0:7766f6712673 47
yueee_yt 0:7766f6712673 48 /*--------------------------- rt_mut_init -----------------------------------*/
yueee_yt 0:7766f6712673 49
yueee_yt 0:7766f6712673 50 void rt_mut_init (OS_ID mutex) {
yueee_yt 0:7766f6712673 51 /* Initialize a mutex object */
yueee_yt 0:7766f6712673 52 P_MUCB p_MCB = mutex;
yueee_yt 0:7766f6712673 53
yueee_yt 0:7766f6712673 54 p_MCB->cb_type = MUCB;
yueee_yt 0:7766f6712673 55 p_MCB->prio = 0;
yueee_yt 0:7766f6712673 56 p_MCB->level = 0;
yueee_yt 0:7766f6712673 57 p_MCB->p_lnk = NULL;
yueee_yt 0:7766f6712673 58 p_MCB->owner = NULL;
yueee_yt 0:7766f6712673 59 }
yueee_yt 0:7766f6712673 60
yueee_yt 0:7766f6712673 61
yueee_yt 0:7766f6712673 62 /*--------------------------- rt_mut_delete ---------------------------------*/
yueee_yt 0:7766f6712673 63
yueee_yt 0:7766f6712673 64 #ifdef __CMSIS_RTOS
yueee_yt 0:7766f6712673 65 OS_RESULT rt_mut_delete (OS_ID mutex) {
yueee_yt 0:7766f6712673 66 /* Delete a mutex object */
yueee_yt 0:7766f6712673 67 P_MUCB p_MCB = mutex;
yueee_yt 0:7766f6712673 68 P_TCB p_TCB;
yueee_yt 0:7766f6712673 69
yueee_yt 0:7766f6712673 70 /* Restore owner task's priority. */
yueee_yt 0:7766f6712673 71 if (p_MCB->level != 0) {
yueee_yt 0:7766f6712673 72 p_MCB->owner->prio = p_MCB->prio;
yueee_yt 0:7766f6712673 73 if (p_MCB->owner != os_tsk.run) {
yueee_yt 0:7766f6712673 74 rt_resort_prio (p_MCB->owner);
yueee_yt 0:7766f6712673 75 }
yueee_yt 0:7766f6712673 76 }
yueee_yt 0:7766f6712673 77
yueee_yt 0:7766f6712673 78 while (p_MCB->p_lnk != NULL) {
yueee_yt 0:7766f6712673 79 /* A task is waiting for mutex. */
yueee_yt 0:7766f6712673 80 p_TCB = rt_get_first ((P_XCB)p_MCB);
yueee_yt 0:7766f6712673 81 rt_ret_val(p_TCB, 0/*osOK*/);
yueee_yt 0:7766f6712673 82 rt_rmv_dly(p_TCB);
yueee_yt 0:7766f6712673 83 p_TCB->state = READY;
yueee_yt 0:7766f6712673 84 rt_put_prio (&os_rdy, p_TCB);
yueee_yt 0:7766f6712673 85 }
yueee_yt 0:7766f6712673 86
yueee_yt 0:7766f6712673 87 if (os_rdy.p_lnk && (os_rdy.p_lnk->prio > os_tsk.run->prio)) {
yueee_yt 0:7766f6712673 88 /* preempt running task */
yueee_yt 0:7766f6712673 89 rt_put_prio (&os_rdy, os_tsk.run);
yueee_yt 0:7766f6712673 90 os_tsk.run->state = READY;
yueee_yt 0:7766f6712673 91 rt_dispatch (NULL);
yueee_yt 0:7766f6712673 92 }
yueee_yt 0:7766f6712673 93
yueee_yt 0:7766f6712673 94 p_MCB->cb_type = 0;
yueee_yt 0:7766f6712673 95
yueee_yt 0:7766f6712673 96 return (OS_R_OK);
yueee_yt 0:7766f6712673 97 }
yueee_yt 0:7766f6712673 98 #endif
yueee_yt 0:7766f6712673 99
yueee_yt 0:7766f6712673 100
yueee_yt 0:7766f6712673 101 /*--------------------------- rt_mut_release --------------------------------*/
yueee_yt 0:7766f6712673 102
yueee_yt 0:7766f6712673 103 OS_RESULT rt_mut_release (OS_ID mutex) {
yueee_yt 0:7766f6712673 104 /* Release a mutex object */
yueee_yt 0:7766f6712673 105 P_MUCB p_MCB = mutex;
yueee_yt 0:7766f6712673 106 P_TCB p_TCB;
yueee_yt 0:7766f6712673 107
yueee_yt 0:7766f6712673 108 if (p_MCB->level == 0 || p_MCB->owner != os_tsk.run) {
yueee_yt 0:7766f6712673 109 /* Unbalanced mutex release or task is not the owner */
yueee_yt 0:7766f6712673 110 return (OS_R_NOK);
yueee_yt 0:7766f6712673 111 }
yueee_yt 0:7766f6712673 112 if (--p_MCB->level != 0) {
yueee_yt 0:7766f6712673 113 return (OS_R_OK);
yueee_yt 0:7766f6712673 114 }
yueee_yt 0:7766f6712673 115 /* Restore owner task's priority. */
yueee_yt 0:7766f6712673 116 os_tsk.run->prio = p_MCB->prio;
yueee_yt 0:7766f6712673 117 if (p_MCB->p_lnk != NULL) {
yueee_yt 0:7766f6712673 118 /* A task is waiting for mutex. */
yueee_yt 0:7766f6712673 119 p_TCB = rt_get_first ((P_XCB)p_MCB);
yueee_yt 0:7766f6712673 120 #ifdef __CMSIS_RTOS
yueee_yt 0:7766f6712673 121 rt_ret_val(p_TCB, 0/*osOK*/);
yueee_yt 0:7766f6712673 122 #else
yueee_yt 0:7766f6712673 123 rt_ret_val(p_TCB, OS_R_MUT);
yueee_yt 0:7766f6712673 124 #endif
yueee_yt 0:7766f6712673 125 rt_rmv_dly (p_TCB);
yueee_yt 0:7766f6712673 126 /* A waiting task becomes the owner of this mutex. */
yueee_yt 0:7766f6712673 127 p_MCB->level = 1;
yueee_yt 0:7766f6712673 128 p_MCB->owner = p_TCB;
yueee_yt 0:7766f6712673 129 p_MCB->prio = p_TCB->prio;
yueee_yt 0:7766f6712673 130 /* Priority inversion, check which task continues. */
yueee_yt 0:7766f6712673 131 if (os_tsk.run->prio >= rt_rdy_prio()) {
yueee_yt 0:7766f6712673 132 rt_dispatch (p_TCB);
yueee_yt 0:7766f6712673 133 }
yueee_yt 0:7766f6712673 134 else {
yueee_yt 0:7766f6712673 135 /* Ready task has higher priority than running task. */
yueee_yt 0:7766f6712673 136 rt_put_prio (&os_rdy, os_tsk.run);
yueee_yt 0:7766f6712673 137 rt_put_prio (&os_rdy, p_TCB);
yueee_yt 0:7766f6712673 138 os_tsk.run->state = READY;
yueee_yt 0:7766f6712673 139 p_TCB->state = READY;
yueee_yt 0:7766f6712673 140 rt_dispatch (NULL);
yueee_yt 0:7766f6712673 141 }
yueee_yt 0:7766f6712673 142 }
yueee_yt 0:7766f6712673 143 else {
yueee_yt 0:7766f6712673 144 /* Check if own priority raised by priority inversion. */
yueee_yt 0:7766f6712673 145 if (rt_rdy_prio() > os_tsk.run->prio) {
yueee_yt 0:7766f6712673 146 rt_put_prio (&os_rdy, os_tsk.run);
yueee_yt 0:7766f6712673 147 os_tsk.run->state = READY;
yueee_yt 0:7766f6712673 148 rt_dispatch (NULL);
yueee_yt 0:7766f6712673 149 }
yueee_yt 0:7766f6712673 150 }
yueee_yt 0:7766f6712673 151 return (OS_R_OK);
yueee_yt 0:7766f6712673 152 }
yueee_yt 0:7766f6712673 153
yueee_yt 0:7766f6712673 154
yueee_yt 0:7766f6712673 155 /*--------------------------- rt_mut_wait -----------------------------------*/
yueee_yt 0:7766f6712673 156
yueee_yt 0:7766f6712673 157 OS_RESULT rt_mut_wait (OS_ID mutex, U16 timeout) {
yueee_yt 0:7766f6712673 158 /* Wait for a mutex, continue when mutex is free. */
yueee_yt 0:7766f6712673 159 P_MUCB p_MCB = mutex;
yueee_yt 0:7766f6712673 160
yueee_yt 0:7766f6712673 161 if (p_MCB->level == 0) {
yueee_yt 0:7766f6712673 162 p_MCB->owner = os_tsk.run;
yueee_yt 0:7766f6712673 163 p_MCB->prio = os_tsk.run->prio;
yueee_yt 0:7766f6712673 164 goto inc;
yueee_yt 0:7766f6712673 165 }
yueee_yt 0:7766f6712673 166 if (p_MCB->owner == os_tsk.run) {
yueee_yt 0:7766f6712673 167 /* OK, running task is the owner of this mutex. */
yueee_yt 0:7766f6712673 168 inc:p_MCB->level++;
yueee_yt 0:7766f6712673 169 return (OS_R_OK);
yueee_yt 0:7766f6712673 170 }
yueee_yt 0:7766f6712673 171 /* Mutex owned by another task, wait until released. */
yueee_yt 0:7766f6712673 172 if (timeout == 0) {
yueee_yt 0:7766f6712673 173 return (OS_R_TMO);
yueee_yt 0:7766f6712673 174 }
yueee_yt 0:7766f6712673 175 /* Raise the owner task priority if lower than current priority. */
yueee_yt 0:7766f6712673 176 /* This priority inversion is called priority inheritance. */
yueee_yt 0:7766f6712673 177 if (p_MCB->prio < os_tsk.run->prio) {
yueee_yt 0:7766f6712673 178 p_MCB->owner->prio = os_tsk.run->prio;
yueee_yt 0:7766f6712673 179 rt_resort_prio (p_MCB->owner);
yueee_yt 0:7766f6712673 180 }
yueee_yt 0:7766f6712673 181 if (p_MCB->p_lnk != NULL) {
yueee_yt 0:7766f6712673 182 rt_put_prio ((P_XCB)p_MCB, os_tsk.run);
yueee_yt 0:7766f6712673 183 }
yueee_yt 0:7766f6712673 184 else {
yueee_yt 0:7766f6712673 185 p_MCB->p_lnk = os_tsk.run;
yueee_yt 0:7766f6712673 186 os_tsk.run->p_lnk = NULL;
yueee_yt 0:7766f6712673 187 os_tsk.run->p_rlnk = (P_TCB)p_MCB;
yueee_yt 0:7766f6712673 188 }
yueee_yt 0:7766f6712673 189 rt_block(timeout, WAIT_MUT);
yueee_yt 0:7766f6712673 190 return (OS_R_TMO);
yueee_yt 0:7766f6712673 191 }
yueee_yt 0:7766f6712673 192
yueee_yt 0:7766f6712673 193
yueee_yt 0:7766f6712673 194 /*----------------------------------------------------------------------------
yueee_yt 0:7766f6712673 195 * end of file
yueee_yt 0:7766f6712673 196 *---------------------------------------------------------------------------*/
yueee_yt 0:7766f6712673 197