Austin Blackstone / Mbed 2 deprecated client-lwip-lightswitch-demo-expanded

mbed client lightswitch demo

Dependencies:   mbed Socket lwip-eth lwip-sys lwip

Fork of mbed-client-classic-example-lwip by Austin Blackstone

mbed-rtos/rtx/TARGET_CORTEX_M/rt_CMSIS.c@11:cada08fc8a70, 2016-06-09 (annotated)

Committer:
mbedAustin
Date:
Thu Jun 09 17:08:36 2016 +0000
Revision:
11:cada08fc8a70
Commit for public Consumption

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbedAustin 11:cada08fc8a70 1 /*----------------------------------------------------------------------------
mbedAustin 11:cada08fc8a70 2 * RL-ARM - RTX
mbedAustin 11:cada08fc8a70 3 *----------------------------------------------------------------------------
mbedAustin 11:cada08fc8a70 4 * Name: rt_CMSIS.c
mbedAustin 11:cada08fc8a70 5 * Purpose: CMSIS RTOS API
mbedAustin 11:cada08fc8a70 6 * Rev.: V4.60
mbedAustin 11:cada08fc8a70 7 *----------------------------------------------------------------------------
mbedAustin 11:cada08fc8a70 8 *
mbedAustin 11:cada08fc8a70 9 * Copyright (c) 1999-2009 KEIL, 2009-2012 ARM Germany GmbH
mbedAustin 11:cada08fc8a70 10 * All rights reserved.
mbedAustin 11:cada08fc8a70 11 * Redistribution and use in source and binary forms, with or without
mbedAustin 11:cada08fc8a70 12 * modification, are permitted provided that the following conditions are met:
mbedAustin 11:cada08fc8a70 13 * - Redistributions of source code must retain the above copyright
mbedAustin 11:cada08fc8a70 14 * notice, this list of conditions and the following disclaimer.
mbedAustin 11:cada08fc8a70 15 * - Redistributions in binary form must reproduce the above copyright
mbedAustin 11:cada08fc8a70 16 * notice, this list of conditions and the following disclaimer in the
mbedAustin 11:cada08fc8a70 17 * documentation and/or other materials provided with the distribution.
mbedAustin 11:cada08fc8a70 18 * - Neither the name of ARM nor the names of its contributors may be used
mbedAustin 11:cada08fc8a70 19 * to endorse or promote products derived from this software without
mbedAustin 11:cada08fc8a70 20 * specific prior written permission.
mbedAustin 11:cada08fc8a70 21 *
mbedAustin 11:cada08fc8a70 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
mbedAustin 11:cada08fc8a70 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
mbedAustin 11:cada08fc8a70 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
mbedAustin 11:cada08fc8a70 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
mbedAustin 11:cada08fc8a70 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
mbedAustin 11:cada08fc8a70 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
mbedAustin 11:cada08fc8a70 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
mbedAustin 11:cada08fc8a70 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
mbedAustin 11:cada08fc8a70 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
mbedAustin 11:cada08fc8a70 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
mbedAustin 11:cada08fc8a70 32 * POSSIBILITY OF SUCH DAMAGE.
mbedAustin 11:cada08fc8a70 33 *---------------------------------------------------------------------------*/
mbedAustin 11:cada08fc8a70 34
mbedAustin 11:cada08fc8a70 35 #define __CMSIS_GENERIC
mbedAustin 11:cada08fc8a70 36
mbedAustin 11:cada08fc8a70 37 #if defined (__CORTEX_M4) || defined (__CORTEX_M4F)
mbedAustin 11:cada08fc8a70 38 #include "core_cm4.h"
mbedAustin 11:cada08fc8a70 39 #elif defined (__CORTEX_M7) || defined (__CORTEX_M7F)
mbedAustin 11:cada08fc8a70 40 #include "core_cm7.h"
mbedAustin 11:cada08fc8a70 41 #elif defined (__CORTEX_M3)
mbedAustin 11:cada08fc8a70 42 #include "core_cm3.h"
mbedAustin 11:cada08fc8a70 43 #elif defined (__CORTEX_M0)
mbedAustin 11:cada08fc8a70 44 #include "core_cm0.h"
mbedAustin 11:cada08fc8a70 45 #elif defined (__CORTEX_M0PLUS)
mbedAustin 11:cada08fc8a70 46 #include "core_cm0plus.h"
mbedAustin 11:cada08fc8a70 47 #else
mbedAustin 11:cada08fc8a70 48 #error "Missing __CORTEX_Mx definition"
mbedAustin 11:cada08fc8a70 49 #endif
mbedAustin 11:cada08fc8a70 50
mbedAustin 11:cada08fc8a70 51 #include "rt_TypeDef.h"
mbedAustin 11:cada08fc8a70 52 #include "RTX_Conf.h"
mbedAustin 11:cada08fc8a70 53 #include "rt_System.h"
mbedAustin 11:cada08fc8a70 54 #include "rt_Task.h"
mbedAustin 11:cada08fc8a70 55 #include "rt_Event.h"
mbedAustin 11:cada08fc8a70 56 #include "rt_List.h"
mbedAustin 11:cada08fc8a70 57 #include "rt_Time.h"
mbedAustin 11:cada08fc8a70 58 #include "rt_Mutex.h"
mbedAustin 11:cada08fc8a70 59 #include "rt_Semaphore.h"
mbedAustin 11:cada08fc8a70 60 #include "rt_Mailbox.h"
mbedAustin 11:cada08fc8a70 61 #include "rt_MemBox.h"
mbedAustin 11:cada08fc8a70 62 #include "rt_HAL_CM.h"
mbedAustin 11:cada08fc8a70 63
mbedAustin 11:cada08fc8a70 64 #define os_thread_cb OS_TCB
mbedAustin 11:cada08fc8a70 65
mbedAustin 11:cada08fc8a70 66 #include "cmsis_os.h"
mbedAustin 11:cada08fc8a70 67
mbedAustin 11:cada08fc8a70 68 #if (osFeature_Signals != 16)
mbedAustin 11:cada08fc8a70 69 #error Invalid "osFeature_Signals" value!
mbedAustin 11:cada08fc8a70 70 #endif
mbedAustin 11:cada08fc8a70 71 #if (osFeature_Semaphore > 65535)
mbedAustin 11:cada08fc8a70 72 #error Invalid "osFeature_Semaphore" value!
mbedAustin 11:cada08fc8a70 73 #endif
mbedAustin 11:cada08fc8a70 74 #if (osFeature_Wait != 0)
mbedAustin 11:cada08fc8a70 75 #error osWait not supported!
mbedAustin 11:cada08fc8a70 76 #endif
mbedAustin 11:cada08fc8a70 77
mbedAustin 11:cada08fc8a70 78
mbedAustin 11:cada08fc8a70 79 // ==== Enumeration, structures, defines ====
mbedAustin 11:cada08fc8a70 80
mbedAustin 11:cada08fc8a70 81 // Service Calls defines
mbedAustin 11:cada08fc8a70 82
mbedAustin 11:cada08fc8a70 83 #if defined (__CC_ARM) /* ARM Compiler */
mbedAustin 11:cada08fc8a70 84
mbedAustin 11:cada08fc8a70 85 #define __NO_RETURN __declspec(noreturn)
mbedAustin 11:cada08fc8a70 86
mbedAustin 11:cada08fc8a70 87 #define osEvent_type osEvent
mbedAustin 11:cada08fc8a70 88 #define osEvent_ret_status ret
mbedAustin 11:cada08fc8a70 89 #define osEvent_ret_value ret
mbedAustin 11:cada08fc8a70 90 #define osEvent_ret_msg ret
mbedAustin 11:cada08fc8a70 91 #define osEvent_ret_mail ret
mbedAustin 11:cada08fc8a70 92
mbedAustin 11:cada08fc8a70 93 #define osCallback_type osCallback
mbedAustin 11:cada08fc8a70 94 #define osCallback_ret ret
mbedAustin 11:cada08fc8a70 95
mbedAustin 11:cada08fc8a70 96 #define SVC_0_1(f,t,...) \
mbedAustin 11:cada08fc8a70 97 __svc_indirect(0) t _##f (t(*)()); \
mbedAustin 11:cada08fc8a70 98 t f (void); \
mbedAustin 11:cada08fc8a70 99 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 100 static __inline t __##f (void) { \
mbedAustin 11:cada08fc8a70 101 return _##f(f); \
mbedAustin 11:cada08fc8a70 102 }
mbedAustin 11:cada08fc8a70 103
mbedAustin 11:cada08fc8a70 104 #define SVC_1_1(f,t,t1,...) \
mbedAustin 11:cada08fc8a70 105 __svc_indirect(0) t _##f (t(*)(t1),t1); \
mbedAustin 11:cada08fc8a70 106 t f (t1 a1); \
mbedAustin 11:cada08fc8a70 107 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 108 static __inline t __##f (t1 a1) { \
mbedAustin 11:cada08fc8a70 109 return _##f(f,a1); \
mbedAustin 11:cada08fc8a70 110 }
mbedAustin 11:cada08fc8a70 111
mbedAustin 11:cada08fc8a70 112 #define SVC_2_1(f,t,t1,t2,...) \
mbedAustin 11:cada08fc8a70 113 __svc_indirect(0) t _##f (t(*)(t1,t2),t1,t2); \
mbedAustin 11:cada08fc8a70 114 t f (t1 a1, t2 a2); \
mbedAustin 11:cada08fc8a70 115 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 116 static __inline t __##f (t1 a1, t2 a2) { \
mbedAustin 11:cada08fc8a70 117 return _##f(f,a1,a2); \
mbedAustin 11:cada08fc8a70 118 }
mbedAustin 11:cada08fc8a70 119
mbedAustin 11:cada08fc8a70 120 #define SVC_3_1(f,t,t1,t2,t3,...) \
mbedAustin 11:cada08fc8a70 121 __svc_indirect(0) t _##f (t(*)(t1,t2,t3),t1,t2,t3); \
mbedAustin 11:cada08fc8a70 122 t f (t1 a1, t2 a2, t3 a3); \
mbedAustin 11:cada08fc8a70 123 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 124 static __inline t __##f (t1 a1, t2 a2, t3 a3) { \
mbedAustin 11:cada08fc8a70 125 return _##f(f,a1,a2,a3); \
mbedAustin 11:cada08fc8a70 126 }
mbedAustin 11:cada08fc8a70 127
mbedAustin 11:cada08fc8a70 128 #define SVC_4_1(f,t,t1,t2,t3,t4,...) \
mbedAustin 11:cada08fc8a70 129 __svc_indirect(0) t _##f (t(*)(t1,t2,t3,t4),t1,t2,t3,t4); \
mbedAustin 11:cada08fc8a70 130 t f (t1 a1, t2 a2, t3 a3, t4 a4); \
mbedAustin 11:cada08fc8a70 131 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 132 static __inline t __##f (t1 a1, t2 a2, t3 a3, t4 a4) { \
mbedAustin 11:cada08fc8a70 133 return _##f(f,a1,a2,a3,a4); \
mbedAustin 11:cada08fc8a70 134 }
mbedAustin 11:cada08fc8a70 135
mbedAustin 11:cada08fc8a70 136 #define SVC_1_2 SVC_1_1
mbedAustin 11:cada08fc8a70 137 #define SVC_1_3 SVC_1_1
mbedAustin 11:cada08fc8a70 138 #define SVC_2_3 SVC_2_1
mbedAustin 11:cada08fc8a70 139
mbedAustin 11:cada08fc8a70 140 #elif defined (__GNUC__) /* GNU Compiler */
mbedAustin 11:cada08fc8a70 141
mbedAustin 11:cada08fc8a70 142 #define __NO_RETURN __attribute__((noreturn))
mbedAustin 11:cada08fc8a70 143
mbedAustin 11:cada08fc8a70 144 typedef uint32_t __attribute__((vector_size(8))) ret64;
mbedAustin 11:cada08fc8a70 145 typedef uint32_t __attribute__((vector_size(16))) ret128;
mbedAustin 11:cada08fc8a70 146
mbedAustin 11:cada08fc8a70 147 #define RET_pointer __r0
mbedAustin 11:cada08fc8a70 148 #define RET_int32_t __r0
mbedAustin 11:cada08fc8a70 149 #define RET_osStatus __r0
mbedAustin 11:cada08fc8a70 150 #define RET_osPriority __r0
mbedAustin 11:cada08fc8a70 151 #define RET_osEvent {(osStatus)__r0, {(uint32_t)__r1}, {(void *)__r2}}
mbedAustin 11:cada08fc8a70 152 #define RET_osCallback {(void *)__r0, (void *)__r1}
mbedAustin 11:cada08fc8a70 153
mbedAustin 11:cada08fc8a70 154 #define osEvent_type ret128
mbedAustin 11:cada08fc8a70 155 #define osEvent_ret_status (ret128){ret.status}
mbedAustin 11:cada08fc8a70 156 #define osEvent_ret_value (ret128){ret.status, ret.value.v}
mbedAustin 11:cada08fc8a70 157 #define osEvent_ret_msg (ret128){ret.status, ret.value.v, (uint32_t)ret.def.message_id}
mbedAustin 11:cada08fc8a70 158 #define osEvent_ret_mail (ret128){ret.status, ret.value.v, (uint32_t)ret.def.mail_id}
mbedAustin 11:cada08fc8a70 159
mbedAustin 11:cada08fc8a70 160 #define osCallback_type ret64
mbedAustin 11:cada08fc8a70 161 #define osCallback_ret (ret64) {(uint32_t)ret.fp, (uint32_t)ret.arg}
mbedAustin 11:cada08fc8a70 162
mbedAustin 11:cada08fc8a70 163 #define SVC_ArgN(n) \
mbedAustin 11:cada08fc8a70 164 register int __r##n __asm("r"#n);
mbedAustin 11:cada08fc8a70 165
mbedAustin 11:cada08fc8a70 166 #define SVC_ArgR(n,t,a) \
mbedAustin 11:cada08fc8a70 167 register t __r##n __asm("r"#n) = a;
mbedAustin 11:cada08fc8a70 168
mbedAustin 11:cada08fc8a70 169 #define SVC_Arg0() \
mbedAustin 11:cada08fc8a70 170 SVC_ArgN(0) \
mbedAustin 11:cada08fc8a70 171 SVC_ArgN(1) \
mbedAustin 11:cada08fc8a70 172 SVC_ArgN(2) \
mbedAustin 11:cada08fc8a70 173 SVC_ArgN(3)
mbedAustin 11:cada08fc8a70 174
mbedAustin 11:cada08fc8a70 175 #define SVC_Arg1(t1) \
mbedAustin 11:cada08fc8a70 176 SVC_ArgR(0,t1,a1) \
mbedAustin 11:cada08fc8a70 177 SVC_ArgN(1) \
mbedAustin 11:cada08fc8a70 178 SVC_ArgN(2) \
mbedAustin 11:cada08fc8a70 179 SVC_ArgN(3)
mbedAustin 11:cada08fc8a70 180
mbedAustin 11:cada08fc8a70 181 #define SVC_Arg2(t1,t2) \
mbedAustin 11:cada08fc8a70 182 SVC_ArgR(0,t1,a1) \
mbedAustin 11:cada08fc8a70 183 SVC_ArgR(1,t2,a2) \
mbedAustin 11:cada08fc8a70 184 SVC_ArgN(2) \
mbedAustin 11:cada08fc8a70 185 SVC_ArgN(3)
mbedAustin 11:cada08fc8a70 186
mbedAustin 11:cada08fc8a70 187 #define SVC_Arg3(t1,t2,t3) \
mbedAustin 11:cada08fc8a70 188 SVC_ArgR(0,t1,a1) \
mbedAustin 11:cada08fc8a70 189 SVC_ArgR(1,t2,a2) \
mbedAustin 11:cada08fc8a70 190 SVC_ArgR(2,t3,a3) \
mbedAustin 11:cada08fc8a70 191 SVC_ArgN(3)
mbedAustin 11:cada08fc8a70 192
mbedAustin 11:cada08fc8a70 193 #define SVC_Arg4(t1,t2,t3,t4) \
mbedAustin 11:cada08fc8a70 194 SVC_ArgR(0,t1,a1) \
mbedAustin 11:cada08fc8a70 195 SVC_ArgR(1,t2,a2) \
mbedAustin 11:cada08fc8a70 196 SVC_ArgR(2,t3,a3) \
mbedAustin 11:cada08fc8a70 197 SVC_ArgR(3,t4,a4)
mbedAustin 11:cada08fc8a70 198
mbedAustin 11:cada08fc8a70 199 #if (defined (__CORTEX_M0)) || defined (__CORTEX_M0PLUS)
mbedAustin 11:cada08fc8a70 200 #define SVC_Call(f) \
mbedAustin 11:cada08fc8a70 201 __asm volatile \
mbedAustin 11:cada08fc8a70 202 ( \
mbedAustin 11:cada08fc8a70 203 "ldr r7,="#f"\n\t" \
mbedAustin 11:cada08fc8a70 204 "mov r12,r7\n\t" \
mbedAustin 11:cada08fc8a70 205 "svc 0" \
mbedAustin 11:cada08fc8a70 206 : "=r" (__r0), "=r" (__r1), "=r" (__r2), "=r" (__r3) \
mbedAustin 11:cada08fc8a70 207 : "r" (__r0), "r" (__r1), "r" (__r2), "r" (__r3) \
mbedAustin 11:cada08fc8a70 208 : "r7", "r12", "lr", "cc" \
mbedAustin 11:cada08fc8a70 209 );
mbedAustin 11:cada08fc8a70 210 #else
mbedAustin 11:cada08fc8a70 211 #define SVC_Call(f) \
mbedAustin 11:cada08fc8a70 212 __asm volatile \
mbedAustin 11:cada08fc8a70 213 ( \
mbedAustin 11:cada08fc8a70 214 "ldr r12,="#f"\n\t" \
mbedAustin 11:cada08fc8a70 215 "svc 0" \
mbedAustin 11:cada08fc8a70 216 : "=r" (__r0), "=r" (__r1), "=r" (__r2), "=r" (__r3) \
mbedAustin 11:cada08fc8a70 217 : "r" (__r0), "r" (__r1), "r" (__r2), "r" (__r3) \
mbedAustin 11:cada08fc8a70 218 : "r12", "lr", "cc" \
mbedAustin 11:cada08fc8a70 219 );
mbedAustin 11:cada08fc8a70 220 #endif
mbedAustin 11:cada08fc8a70 221
mbedAustin 11:cada08fc8a70 222 #define SVC_0_1(f,t,rv) \
mbedAustin 11:cada08fc8a70 223 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 224 static inline t __##f (void) { \
mbedAustin 11:cada08fc8a70 225 SVC_Arg0(); \
mbedAustin 11:cada08fc8a70 226 SVC_Call(f); \
mbedAustin 11:cada08fc8a70 227 return (t) rv; \
mbedAustin 11:cada08fc8a70 228 }
mbedAustin 11:cada08fc8a70 229
mbedAustin 11:cada08fc8a70 230 #define SVC_1_1(f,t,t1,rv) \
mbedAustin 11:cada08fc8a70 231 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 232 static inline t __##f (t1 a1) { \
mbedAustin 11:cada08fc8a70 233 SVC_Arg1(t1); \
mbedAustin 11:cada08fc8a70 234 SVC_Call(f); \
mbedAustin 11:cada08fc8a70 235 return (t) rv; \
mbedAustin 11:cada08fc8a70 236 }
mbedAustin 11:cada08fc8a70 237
mbedAustin 11:cada08fc8a70 238 #define SVC_2_1(f,t,t1,t2,rv) \
mbedAustin 11:cada08fc8a70 239 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 240 static inline t __##f (t1 a1, t2 a2) { \
mbedAustin 11:cada08fc8a70 241 SVC_Arg2(t1,t2); \
mbedAustin 11:cada08fc8a70 242 SVC_Call(f); \
mbedAustin 11:cada08fc8a70 243 return (t) rv; \
mbedAustin 11:cada08fc8a70 244 }
mbedAustin 11:cada08fc8a70 245
mbedAustin 11:cada08fc8a70 246 #define SVC_3_1(f,t,t1,t2,t3,rv) \
mbedAustin 11:cada08fc8a70 247 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 248 static inline t __##f (t1 a1, t2 a2, t3 a3) { \
mbedAustin 11:cada08fc8a70 249 SVC_Arg3(t1,t2,t3); \
mbedAustin 11:cada08fc8a70 250 SVC_Call(f); \
mbedAustin 11:cada08fc8a70 251 return (t) rv; \
mbedAustin 11:cada08fc8a70 252 }
mbedAustin 11:cada08fc8a70 253
mbedAustin 11:cada08fc8a70 254 #define SVC_4_1(f,t,t1,t2,t3,t4,rv) \
mbedAustin 11:cada08fc8a70 255 __attribute__((always_inline)) \
mbedAustin 11:cada08fc8a70 256 static inline t __##f (t1 a1, t2 a2, t3 a3, t4 a4) { \
mbedAustin 11:cada08fc8a70 257 SVC_Arg4(t1,t2,t3,t4); \
mbedAustin 11:cada08fc8a70 258 SVC_Call(f); \
mbedAustin 11:cada08fc8a70 259 return (t) rv; \
mbedAustin 11:cada08fc8a70 260 }
mbedAustin 11:cada08fc8a70 261
mbedAustin 11:cada08fc8a70 262 #define SVC_1_2 SVC_1_1
mbedAustin 11:cada08fc8a70 263 #define SVC_1_3 SVC_1_1
mbedAustin 11:cada08fc8a70 264 #define SVC_2_3 SVC_2_1
mbedAustin 11:cada08fc8a70 265
mbedAustin 11:cada08fc8a70 266 #elif defined (__ICCARM__) /* IAR Compiler */
mbedAustin 11:cada08fc8a70 267
mbedAustin 11:cada08fc8a70 268 #define __NO_RETURN __noreturn
mbedAustin 11:cada08fc8a70 269
mbedAustin 11:cada08fc8a70 270 #define osEvent_type osEvent
mbedAustin 11:cada08fc8a70 271 #define osEvent_ret_status ret
mbedAustin 11:cada08fc8a70 272 #define osEvent_ret_value ret
mbedAustin 11:cada08fc8a70 273 #define osEvent_ret_msg ret
mbedAustin 11:cada08fc8a70 274 #define osEvent_ret_mail ret
mbedAustin 11:cada08fc8a70 275
mbedAustin 11:cada08fc8a70 276 #define osCallback_type osCallback
mbedAustin 11:cada08fc8a70 277 #define osCallback_ret ret
mbedAustin 11:cada08fc8a70 278
mbedAustin 11:cada08fc8a70 279 #define RET_osEvent osEvent
mbedAustin 11:cada08fc8a70 280 #define RET_osCallback osCallback
mbedAustin 11:cada08fc8a70 281
mbedAustin 11:cada08fc8a70 282 #define SVC_Setup(f) \
mbedAustin 11:cada08fc8a70 283 __asm( \
mbedAustin 11:cada08fc8a70 284 "mov r12,%0\n" \
mbedAustin 11:cada08fc8a70 285 :: "r"(&f): "r12" \
mbedAustin 11:cada08fc8a70 286 );
mbedAustin 11:cada08fc8a70 287
mbedAustin 11:cada08fc8a70 288
mbedAustin 11:cada08fc8a70 289 #define SVC_0_1(f,t,...) \
mbedAustin 11:cada08fc8a70 290 t f (void); \
mbedAustin 11:cada08fc8a70 291 _Pragma("swi_number=0") __swi t _##f (void); \
mbedAustin 11:cada08fc8a70 292 static inline t __##f (void) { \
mbedAustin 11:cada08fc8a70 293 SVC_Setup(f); \
mbedAustin 11:cada08fc8a70 294 return _##f(); \
mbedAustin 11:cada08fc8a70 295 }
mbedAustin 11:cada08fc8a70 296
mbedAustin 11:cada08fc8a70 297 #define SVC_1_1(f,t,t1,...) \
mbedAustin 11:cada08fc8a70 298 t f (t1 a1); \
mbedAustin 11:cada08fc8a70 299 _Pragma("swi_number=0") __swi t _##f (t1 a1); \
mbedAustin 11:cada08fc8a70 300 static inline t __##f (t1 a1) { \
mbedAustin 11:cada08fc8a70 301 SVC_Setup(f); \
mbedAustin 11:cada08fc8a70 302 return _##f(a1); \
mbedAustin 11:cada08fc8a70 303 }
mbedAustin 11:cada08fc8a70 304
mbedAustin 11:cada08fc8a70 305 #define SVC_2_1(f,t,t1,t2,...) \
mbedAustin 11:cada08fc8a70 306 t f (t1 a1, t2 a2); \
mbedAustin 11:cada08fc8a70 307 _Pragma("swi_number=0") __swi t _##f (t1 a1, t2 a2); \
mbedAustin 11:cada08fc8a70 308 static inline t __##f (t1 a1, t2 a2) { \
mbedAustin 11:cada08fc8a70 309 SVC_Setup(f); \
mbedAustin 11:cada08fc8a70 310 return _##f(a1,a2); \
mbedAustin 11:cada08fc8a70 311 }
mbedAustin 11:cada08fc8a70 312
mbedAustin 11:cada08fc8a70 313 #define SVC_3_1(f,t,t1,t2,t3,...) \
mbedAustin 11:cada08fc8a70 314 t f (t1 a1, t2 a2, t3 a3); \
mbedAustin 11:cada08fc8a70 315 _Pragma("swi_number=0") __swi t _##f (t1 a1, t2 a2, t3 a3); \
mbedAustin 11:cada08fc8a70 316 static inline t __##f (t1 a1, t2 a2, t3 a3) { \
mbedAustin 11:cada08fc8a70 317 SVC_Setup(f); \
mbedAustin 11:cada08fc8a70 318 return _##f(a1,a2,a3); \
mbedAustin 11:cada08fc8a70 319 }
mbedAustin 11:cada08fc8a70 320
mbedAustin 11:cada08fc8a70 321 #define SVC_4_1(f,t,t1,t2,t3,t4,...) \
mbedAustin 11:cada08fc8a70 322 t f (t1 a1, t2 a2, t3 a3, t4 a4); \
mbedAustin 11:cada08fc8a70 323 _Pragma("swi_number=0") __swi t _##f (t1 a1, t2 a2, t3 a3, t4 a4); \
mbedAustin 11:cada08fc8a70 324 static inline t __##f (t1 a1, t2 a2, t3 a3, t4 a4) { \
mbedAustin 11:cada08fc8a70 325 SVC_Setup(f); \
mbedAustin 11:cada08fc8a70 326 return _##f(a1,a2,a3,a4); \
mbedAustin 11:cada08fc8a70 327 }
mbedAustin 11:cada08fc8a70 328
mbedAustin 11:cada08fc8a70 329 #define SVC_1_2 SVC_1_1
mbedAustin 11:cada08fc8a70 330 #define SVC_1_3 SVC_1_1
mbedAustin 11:cada08fc8a70 331 #define SVC_2_3 SVC_2_1
mbedAustin 11:cada08fc8a70 332
mbedAustin 11:cada08fc8a70 333 #endif
mbedAustin 11:cada08fc8a70 334
mbedAustin 11:cada08fc8a70 335
mbedAustin 11:cada08fc8a70 336 // Callback structure
mbedAustin 11:cada08fc8a70 337 typedef struct {
mbedAustin 11:cada08fc8a70 338 void *fp; // Function pointer
mbedAustin 11:cada08fc8a70 339 void *arg; // Function argument
mbedAustin 11:cada08fc8a70 340 } osCallback;
mbedAustin 11:cada08fc8a70 341
mbedAustin 11:cada08fc8a70 342
mbedAustin 11:cada08fc8a70 343 // OS Section definitions
mbedAustin 11:cada08fc8a70 344 #ifdef OS_SECTIONS_LINK_INFO
mbedAustin 11:cada08fc8a70 345 extern const uint32_t os_section_id$$Base;
mbedAustin 11:cada08fc8a70 346 extern const uint32_t os_section_id$$Limit;
mbedAustin 11:cada08fc8a70 347 #endif
mbedAustin 11:cada08fc8a70 348
mbedAustin 11:cada08fc8a70 349 // OS Timers external resources
mbedAustin 11:cada08fc8a70 350 extern osThreadDef_t os_thread_def_osTimerThread;
mbedAustin 11:cada08fc8a70 351 extern osThreadId osThreadId_osTimerThread;
mbedAustin 11:cada08fc8a70 352 extern osMessageQDef_t os_messageQ_def_osTimerMessageQ;
mbedAustin 11:cada08fc8a70 353 extern osMessageQId osMessageQId_osTimerMessageQ;
mbedAustin 11:cada08fc8a70 354
mbedAustin 11:cada08fc8a70 355
mbedAustin 11:cada08fc8a70 356 // ==== Helper Functions ====
mbedAustin 11:cada08fc8a70 357
mbedAustin 11:cada08fc8a70 358 /// Convert timeout in millisec to system ticks
mbedAustin 11:cada08fc8a70 359 static uint32_t rt_ms2tick (uint32_t millisec) {
mbedAustin 11:cada08fc8a70 360 uint32_t tick;
mbedAustin 11:cada08fc8a70 361
mbedAustin 11:cada08fc8a70 362 if (millisec == osWaitForever) return 0xFFFF; // Indefinite timeout
mbedAustin 11:cada08fc8a70 363 if (millisec > 4000000) return 0xFFFE; // Max ticks supported
mbedAustin 11:cada08fc8a70 364
mbedAustin 11:cada08fc8a70 365 tick = ((1000 * millisec) + os_clockrate - 1) / os_clockrate;
mbedAustin 11:cada08fc8a70 366 if (tick > 0xFFFE) return 0xFFFE;
mbedAustin 11:cada08fc8a70 367
mbedAustin 11:cada08fc8a70 368 return tick;
mbedAustin 11:cada08fc8a70 369 }
mbedAustin 11:cada08fc8a70 370
mbedAustin 11:cada08fc8a70 371 /// Convert Thread ID to TCB pointer
mbedAustin 11:cada08fc8a70 372 static P_TCB rt_tid2ptcb (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 373 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 374
mbedAustin 11:cada08fc8a70 375 if (thread_id == NULL) return NULL;
mbedAustin 11:cada08fc8a70 376
mbedAustin 11:cada08fc8a70 377 if ((uint32_t)thread_id & 3) return NULL;
mbedAustin 11:cada08fc8a70 378
mbedAustin 11:cada08fc8a70 379 #ifdef OS_SECTIONS_LINK_INFO
mbedAustin 11:cada08fc8a70 380 if ((os_section_id$$Base != 0) && (os_section_id$$Limit != 0)) {
mbedAustin 11:cada08fc8a70 381 if (thread_id < (osThreadId)os_section_id$$Base) return NULL;
mbedAustin 11:cada08fc8a70 382 if (thread_id >= (osThreadId)os_section_id$$Limit) return NULL;
mbedAustin 11:cada08fc8a70 383 }
mbedAustin 11:cada08fc8a70 384 #endif
mbedAustin 11:cada08fc8a70 385
mbedAustin 11:cada08fc8a70 386 ptcb = thread_id;
mbedAustin 11:cada08fc8a70 387
mbedAustin 11:cada08fc8a70 388 if (ptcb->cb_type != TCB) return NULL;
mbedAustin 11:cada08fc8a70 389
mbedAustin 11:cada08fc8a70 390 return ptcb;
mbedAustin 11:cada08fc8a70 391 }
mbedAustin 11:cada08fc8a70 392
mbedAustin 11:cada08fc8a70 393 /// Convert ID pointer to Object pointer
mbedAustin 11:cada08fc8a70 394 static void *rt_id2obj (void *id) {
mbedAustin 11:cada08fc8a70 395
mbedAustin 11:cada08fc8a70 396 if ((uint32_t)id & 3) return NULL;
mbedAustin 11:cada08fc8a70 397
mbedAustin 11:cada08fc8a70 398 #ifdef OS_SECTIONS_LINK_INFO
mbedAustin 11:cada08fc8a70 399 if ((os_section_id$$Base != 0) && (os_section_id$$Limit != 0)) {
mbedAustin 11:cada08fc8a70 400 if (id < (void *)os_section_id$$Base) return NULL;
mbedAustin 11:cada08fc8a70 401 if (id >= (void *)os_section_id$$Limit) return NULL;
mbedAustin 11:cada08fc8a70 402 }
mbedAustin 11:cada08fc8a70 403 #endif
mbedAustin 11:cada08fc8a70 404
mbedAustin 11:cada08fc8a70 405 return id;
mbedAustin 11:cada08fc8a70 406 }
mbedAustin 11:cada08fc8a70 407
mbedAustin 11:cada08fc8a70 408
mbedAustin 11:cada08fc8a70 409 // ==== Kernel Control ====
mbedAustin 11:cada08fc8a70 410
mbedAustin 11:cada08fc8a70 411 uint8_t os_initialized; // Kernel Initialized flag
mbedAustin 11:cada08fc8a70 412 uint8_t os_running; // Kernel Running flag
mbedAustin 11:cada08fc8a70 413
mbedAustin 11:cada08fc8a70 414 // Kernel Control Service Calls declarations
mbedAustin 11:cada08fc8a70 415 SVC_0_1(svcKernelInitialize, osStatus, RET_osStatus)
mbedAustin 11:cada08fc8a70 416 SVC_0_1(svcKernelStart, osStatus, RET_osStatus)
mbedAustin 11:cada08fc8a70 417 SVC_0_1(svcKernelRunning, int32_t, RET_int32_t)
mbedAustin 11:cada08fc8a70 418
mbedAustin 11:cada08fc8a70 419 extern void sysThreadError (osStatus status);
mbedAustin 11:cada08fc8a70 420 osThreadId svcThreadCreate (osThreadDef_t *thread_def, void *argument);
mbedAustin 11:cada08fc8a70 421 osMessageQId svcMessageCreate (osMessageQDef_t *queue_def, osThreadId thread_id);
mbedAustin 11:cada08fc8a70 422
mbedAustin 11:cada08fc8a70 423 // Kernel Control Service Calls
mbedAustin 11:cada08fc8a70 424
mbedAustin 11:cada08fc8a70 425 /// Initialize the RTOS Kernel for creating objects
mbedAustin 11:cada08fc8a70 426 osStatus svcKernelInitialize (void) {
mbedAustin 11:cada08fc8a70 427 if (os_initialized) return osOK;
mbedAustin 11:cada08fc8a70 428
mbedAustin 11:cada08fc8a70 429 rt_sys_init(); // RTX System Initialization
mbedAustin 11:cada08fc8a70 430 os_tsk.run->prio = 255; // Highest priority
mbedAustin 11:cada08fc8a70 431
mbedAustin 11:cada08fc8a70 432 sysThreadError(osOK);
mbedAustin 11:cada08fc8a70 433
mbedAustin 11:cada08fc8a70 434 os_initialized = 1;
mbedAustin 11:cada08fc8a70 435
mbedAustin 11:cada08fc8a70 436 return osOK;
mbedAustin 11:cada08fc8a70 437 }
mbedAustin 11:cada08fc8a70 438
mbedAustin 11:cada08fc8a70 439 /// Start the RTOS Kernel
mbedAustin 11:cada08fc8a70 440 osStatus svcKernelStart (void) {
mbedAustin 11:cada08fc8a70 441
mbedAustin 11:cada08fc8a70 442 if (os_running) return osOK;
mbedAustin 11:cada08fc8a70 443
mbedAustin 11:cada08fc8a70 444 // Create OS Timers resources (Message Queue & Thread)
mbedAustin 11:cada08fc8a70 445 osMessageQId_osTimerMessageQ = svcMessageCreate (&os_messageQ_def_osTimerMessageQ, NULL);
mbedAustin 11:cada08fc8a70 446 osThreadId_osTimerThread = svcThreadCreate(&os_thread_def_osTimerThread, NULL);
mbedAustin 11:cada08fc8a70 447
mbedAustin 11:cada08fc8a70 448 rt_tsk_prio(0, 0); // Lowest priority
mbedAustin 11:cada08fc8a70 449 __set_PSP(os_tsk.run->tsk_stack + 8*4); // New context
mbedAustin 11:cada08fc8a70 450 os_tsk.run = NULL; // Force context switch
mbedAustin 11:cada08fc8a70 451
mbedAustin 11:cada08fc8a70 452 rt_sys_start();
mbedAustin 11:cada08fc8a70 453
mbedAustin 11:cada08fc8a70 454 os_running = 1;
mbedAustin 11:cada08fc8a70 455
mbedAustin 11:cada08fc8a70 456 return osOK;
mbedAustin 11:cada08fc8a70 457 }
mbedAustin 11:cada08fc8a70 458
mbedAustin 11:cada08fc8a70 459 /// Check if the RTOS kernel is already started
mbedAustin 11:cada08fc8a70 460 int32_t svcKernelRunning(void) {
mbedAustin 11:cada08fc8a70 461 return os_running;
mbedAustin 11:cada08fc8a70 462 }
mbedAustin 11:cada08fc8a70 463
mbedAustin 11:cada08fc8a70 464 // Kernel Control Public API
mbedAustin 11:cada08fc8a70 465
mbedAustin 11:cada08fc8a70 466 /// Initialize the RTOS Kernel for creating objects
mbedAustin 11:cada08fc8a70 467 osStatus osKernelInitialize (void) {
mbedAustin 11:cada08fc8a70 468 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 469 if ((__get_CONTROL() & 1) == 0) { // Privileged mode
mbedAustin 11:cada08fc8a70 470 return svcKernelInitialize();
mbedAustin 11:cada08fc8a70 471 } else {
mbedAustin 11:cada08fc8a70 472 return __svcKernelInitialize();
mbedAustin 11:cada08fc8a70 473 }
mbedAustin 11:cada08fc8a70 474 }
mbedAustin 11:cada08fc8a70 475
mbedAustin 11:cada08fc8a70 476 /// Start the RTOS Kernel
mbedAustin 11:cada08fc8a70 477 osStatus osKernelStart (void) {
mbedAustin 11:cada08fc8a70 478 uint32_t stack[8];
mbedAustin 11:cada08fc8a70 479
mbedAustin 11:cada08fc8a70 480 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 481 switch (__get_CONTROL() & 0x03) {
mbedAustin 11:cada08fc8a70 482 case 0x00: // Privileged Thread mode & MSP
mbedAustin 11:cada08fc8a70 483 __set_PSP((uint32_t)(stack + 8)); // Initial PSP
mbedAustin 11:cada08fc8a70 484 if (os_flags & 1) {
mbedAustin 11:cada08fc8a70 485 __set_CONTROL(0x02); // Set Privileged Thread mode & PSP
mbedAustin 11:cada08fc8a70 486 } else {
mbedAustin 11:cada08fc8a70 487 __set_CONTROL(0x03); // Set Unprivileged Thread mode & PSP
mbedAustin 11:cada08fc8a70 488 }
mbedAustin 11:cada08fc8a70 489 __DSB();
mbedAustin 11:cada08fc8a70 490 __ISB();
mbedAustin 11:cada08fc8a70 491 break;
mbedAustin 11:cada08fc8a70 492 case 0x01: // Unprivileged Thread mode & MSP
mbedAustin 11:cada08fc8a70 493 return osErrorOS;
mbedAustin 11:cada08fc8a70 494 case 0x02: // Privileged Thread mode & PSP
mbedAustin 11:cada08fc8a70 495 if ((os_flags & 1) == 0) { // Unprivileged Thread mode requested
mbedAustin 11:cada08fc8a70 496 __set_CONTROL(0x03); // Set Unprivileged Thread mode & PSP
mbedAustin 11:cada08fc8a70 497 __DSB();
mbedAustin 11:cada08fc8a70 498 __ISB();
mbedAustin 11:cada08fc8a70 499 }
mbedAustin 11:cada08fc8a70 500 break;
mbedAustin 11:cada08fc8a70 501 case 0x03: // Unprivileged Thread mode & PSP
mbedAustin 11:cada08fc8a70 502 if (os_flags & 1) return osErrorOS; // Privileged Thread mode requested
mbedAustin 11:cada08fc8a70 503 break;
mbedAustin 11:cada08fc8a70 504 }
mbedAustin 11:cada08fc8a70 505 return __svcKernelStart();
mbedAustin 11:cada08fc8a70 506 }
mbedAustin 11:cada08fc8a70 507
mbedAustin 11:cada08fc8a70 508 /// Check if the RTOS kernel is already started
mbedAustin 11:cada08fc8a70 509 int32_t osKernelRunning(void) {
mbedAustin 11:cada08fc8a70 510 if ((__get_IPSR() != 0) || ((__get_CONTROL() & 1) == 0)) {
mbedAustin 11:cada08fc8a70 511 // in ISR or Privileged
mbedAustin 11:cada08fc8a70 512 return os_running;
mbedAustin 11:cada08fc8a70 513 } else {
mbedAustin 11:cada08fc8a70 514 return __svcKernelRunning();
mbedAustin 11:cada08fc8a70 515 }
mbedAustin 11:cada08fc8a70 516 }
mbedAustin 11:cada08fc8a70 517
mbedAustin 11:cada08fc8a70 518
mbedAustin 11:cada08fc8a70 519 // ==== Thread Management ====
mbedAustin 11:cada08fc8a70 520
mbedAustin 11:cada08fc8a70 521 __NO_RETURN void osThreadExit (void);
mbedAustin 11:cada08fc8a70 522
mbedAustin 11:cada08fc8a70 523 // Thread Service Calls declarations
mbedAustin 11:cada08fc8a70 524 SVC_2_1(svcThreadCreate, osThreadId, osThreadDef_t *, void *, RET_pointer)
mbedAustin 11:cada08fc8a70 525 SVC_0_1(svcThreadGetId, osThreadId, RET_pointer)
mbedAustin 11:cada08fc8a70 526 SVC_1_1(svcThreadTerminate, osStatus, osThreadId, RET_osStatus)
mbedAustin 11:cada08fc8a70 527 SVC_0_1(svcThreadYield, osStatus, RET_osStatus)
mbedAustin 11:cada08fc8a70 528 SVC_2_1(svcThreadSetPriority, osStatus, osThreadId, osPriority, RET_osStatus)
mbedAustin 11:cada08fc8a70 529 SVC_1_1(svcThreadGetPriority, osPriority, osThreadId, RET_osPriority)
mbedAustin 11:cada08fc8a70 530
mbedAustin 11:cada08fc8a70 531 // Thread Service Calls
mbedAustin 11:cada08fc8a70 532 extern OS_TID rt_get_TID (void);
mbedAustin 11:cada08fc8a70 533 extern void rt_init_context (P_TCB p_TCB, U8 priority, FUNCP task_body);
mbedAustin 11:cada08fc8a70 534
mbedAustin 11:cada08fc8a70 535 /// Create a thread and add it to Active Threads and set it to state READY
mbedAustin 11:cada08fc8a70 536 osThreadId svcThreadCreate (osThreadDef_t *thread_def, void *argument) {
mbedAustin 11:cada08fc8a70 537 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 538
mbedAustin 11:cada08fc8a70 539 if ((thread_def == NULL) ||
mbedAustin 11:cada08fc8a70 540 (thread_def->pthread == NULL) ||
mbedAustin 11:cada08fc8a70 541 (thread_def->tpriority < osPriorityIdle) ||
mbedAustin 11:cada08fc8a70 542 (thread_def->tpriority > osPriorityRealtime) ||
mbedAustin 11:cada08fc8a70 543 (thread_def->stacksize == 0) ||
mbedAustin 11:cada08fc8a70 544 (thread_def->stack_pointer == NULL) ) {
mbedAustin 11:cada08fc8a70 545 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 546 return NULL;
mbedAustin 11:cada08fc8a70 547 }
mbedAustin 11:cada08fc8a70 548
mbedAustin 11:cada08fc8a70 549 U8 priority = thread_def->tpriority - osPriorityIdle + 1;
mbedAustin 11:cada08fc8a70 550 P_TCB task_context = &thread_def->tcb;
mbedAustin 11:cada08fc8a70 551
mbedAustin 11:cada08fc8a70 552 /* Utilize the user provided stack. */
mbedAustin 11:cada08fc8a70 553 task_context->stack = (U32*)thread_def->stack_pointer;
mbedAustin 11:cada08fc8a70 554 task_context->priv_stack = thread_def->stacksize;
mbedAustin 11:cada08fc8a70 555 /* Find a free entry in 'os_active_TCB' table. */
mbedAustin 11:cada08fc8a70 556 OS_TID tsk = rt_get_TID ();
mbedAustin 11:cada08fc8a70 557 os_active_TCB[tsk-1] = task_context;
mbedAustin 11:cada08fc8a70 558 task_context->task_id = tsk;
mbedAustin 11:cada08fc8a70 559 /* Pass parameter 'argv' to 'rt_init_context' */
mbedAustin 11:cada08fc8a70 560 task_context->msg = argument;
mbedAustin 11:cada08fc8a70 561 /* Initialize thread context structure, including the thread's stack. */
mbedAustin 11:cada08fc8a70 562 rt_init_context (task_context, priority, (FUNCP)thread_def->pthread);
mbedAustin 11:cada08fc8a70 563
mbedAustin 11:cada08fc8a70 564 /* Dispatch this task to the scheduler for execution. */
mbedAustin 11:cada08fc8a70 565 DBG_TASK_NOTIFY(task_context, __TRUE);
mbedAustin 11:cada08fc8a70 566 rt_dispatch (task_context);
mbedAustin 11:cada08fc8a70 567
mbedAustin 11:cada08fc8a70 568 ptcb = (P_TCB)os_active_TCB[tsk - 1]; // TCB pointer
mbedAustin 11:cada08fc8a70 569
mbedAustin 11:cada08fc8a70 570 *((uint32_t *)ptcb->tsk_stack + 13) = (uint32_t)osThreadExit;
mbedAustin 11:cada08fc8a70 571
mbedAustin 11:cada08fc8a70 572 return ptcb;
mbedAustin 11:cada08fc8a70 573 }
mbedAustin 11:cada08fc8a70 574
mbedAustin 11:cada08fc8a70 575 /// Return the thread ID of the current running thread
mbedAustin 11:cada08fc8a70 576 osThreadId svcThreadGetId (void) {
mbedAustin 11:cada08fc8a70 577 OS_TID tsk;
mbedAustin 11:cada08fc8a70 578
mbedAustin 11:cada08fc8a70 579 tsk = rt_tsk_self();
mbedAustin 11:cada08fc8a70 580 if (tsk == 0) return NULL;
mbedAustin 11:cada08fc8a70 581 return (P_TCB)os_active_TCB[tsk - 1];
mbedAustin 11:cada08fc8a70 582 }
mbedAustin 11:cada08fc8a70 583
mbedAustin 11:cada08fc8a70 584 /// Terminate execution of a thread and remove it from ActiveThreads
mbedAustin 11:cada08fc8a70 585 osStatus svcThreadTerminate (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 586 OS_RESULT res;
mbedAustin 11:cada08fc8a70 587 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 588
mbedAustin 11:cada08fc8a70 589 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 590 if (ptcb == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 591
mbedAustin 11:cada08fc8a70 592 res = rt_tsk_delete(ptcb->task_id); // Delete task
mbedAustin 11:cada08fc8a70 593
mbedAustin 11:cada08fc8a70 594 if (res == OS_R_NOK) return osErrorResource; // Delete task failed
mbedAustin 11:cada08fc8a70 595
mbedAustin 11:cada08fc8a70 596 return osOK;
mbedAustin 11:cada08fc8a70 597 }
mbedAustin 11:cada08fc8a70 598
mbedAustin 11:cada08fc8a70 599 /// Pass control to next thread that is in state READY
mbedAustin 11:cada08fc8a70 600 osStatus svcThreadYield (void) {
mbedAustin 11:cada08fc8a70 601 rt_tsk_pass(); // Pass control to next task
mbedAustin 11:cada08fc8a70 602 return osOK;
mbedAustin 11:cada08fc8a70 603 }
mbedAustin 11:cada08fc8a70 604
mbedAustin 11:cada08fc8a70 605 /// Change priority of an active thread
mbedAustin 11:cada08fc8a70 606 osStatus svcThreadSetPriority (osThreadId thread_id, osPriority priority) {
mbedAustin 11:cada08fc8a70 607 OS_RESULT res;
mbedAustin 11:cada08fc8a70 608 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 609
mbedAustin 11:cada08fc8a70 610 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 611 if (ptcb == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 612
mbedAustin 11:cada08fc8a70 613 if ((priority < osPriorityIdle) || (priority > osPriorityRealtime)) {
mbedAustin 11:cada08fc8a70 614 return osErrorValue;
mbedAustin 11:cada08fc8a70 615 }
mbedAustin 11:cada08fc8a70 616
mbedAustin 11:cada08fc8a70 617 res = rt_tsk_prio( // Change task priority
mbedAustin 11:cada08fc8a70 618 ptcb->task_id, // Task ID
mbedAustin 11:cada08fc8a70 619 priority - osPriorityIdle + 1 // New task priority
mbedAustin 11:cada08fc8a70 620 );
mbedAustin 11:cada08fc8a70 621
mbedAustin 11:cada08fc8a70 622 if (res == OS_R_NOK) return osErrorResource; // Change task priority failed
mbedAustin 11:cada08fc8a70 623
mbedAustin 11:cada08fc8a70 624 return osOK;
mbedAustin 11:cada08fc8a70 625 }
mbedAustin 11:cada08fc8a70 626
mbedAustin 11:cada08fc8a70 627 /// Get current priority of an active thread
mbedAustin 11:cada08fc8a70 628 osPriority svcThreadGetPriority (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 629 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 630
mbedAustin 11:cada08fc8a70 631 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 632 if (ptcb == NULL) return osPriorityError;
mbedAustin 11:cada08fc8a70 633
mbedAustin 11:cada08fc8a70 634 return (osPriority)(ptcb->prio - 1 + osPriorityIdle);
mbedAustin 11:cada08fc8a70 635 }
mbedAustin 11:cada08fc8a70 636
mbedAustin 11:cada08fc8a70 637
mbedAustin 11:cada08fc8a70 638 // Thread Public API
mbedAustin 11:cada08fc8a70 639
mbedAustin 11:cada08fc8a70 640 /// Create a thread and add it to Active Threads and set it to state READY
mbedAustin 11:cada08fc8a70 641 osThreadId osThreadCreate (osThreadDef_t *thread_def, void *argument) {
mbedAustin 11:cada08fc8a70 642 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 643 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 644 // Privileged and not running
mbedAustin 11:cada08fc8a70 645 return svcThreadCreate(thread_def, argument);
mbedAustin 11:cada08fc8a70 646 } else {
mbedAustin 11:cada08fc8a70 647 return __svcThreadCreate(thread_def, argument);
mbedAustin 11:cada08fc8a70 648 }
mbedAustin 11:cada08fc8a70 649 }
mbedAustin 11:cada08fc8a70 650
mbedAustin 11:cada08fc8a70 651 /// Return the thread ID of the current running thread
mbedAustin 11:cada08fc8a70 652 osThreadId osThreadGetId (void) {
mbedAustin 11:cada08fc8a70 653 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 654 return __svcThreadGetId();
mbedAustin 11:cada08fc8a70 655 }
mbedAustin 11:cada08fc8a70 656
mbedAustin 11:cada08fc8a70 657 /// Terminate execution of a thread and remove it from ActiveThreads
mbedAustin 11:cada08fc8a70 658 osStatus osThreadTerminate (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 659 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 660 return __svcThreadTerminate(thread_id);
mbedAustin 11:cada08fc8a70 661 }
mbedAustin 11:cada08fc8a70 662
mbedAustin 11:cada08fc8a70 663 /// Pass control to next thread that is in state READY
mbedAustin 11:cada08fc8a70 664 osStatus osThreadYield (void) {
mbedAustin 11:cada08fc8a70 665 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 666 return __svcThreadYield();
mbedAustin 11:cada08fc8a70 667 }
mbedAustin 11:cada08fc8a70 668
mbedAustin 11:cada08fc8a70 669 /// Change priority of an active thread
mbedAustin 11:cada08fc8a70 670 osStatus osThreadSetPriority (osThreadId thread_id, osPriority priority) {
mbedAustin 11:cada08fc8a70 671 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 672 return __svcThreadSetPriority(thread_id, priority);
mbedAustin 11:cada08fc8a70 673 }
mbedAustin 11:cada08fc8a70 674
mbedAustin 11:cada08fc8a70 675 /// Get current priority of an active thread
mbedAustin 11:cada08fc8a70 676 osPriority osThreadGetPriority (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 677 if (__get_IPSR() != 0) return osPriorityError;// Not allowed in ISR
mbedAustin 11:cada08fc8a70 678 return __svcThreadGetPriority(thread_id);
mbedAustin 11:cada08fc8a70 679 }
mbedAustin 11:cada08fc8a70 680
mbedAustin 11:cada08fc8a70 681 /// INTERNAL - Not Public
mbedAustin 11:cada08fc8a70 682 /// Auto Terminate Thread on exit (used implicitly when thread exists)
mbedAustin 11:cada08fc8a70 683 __NO_RETURN void osThreadExit (void) {
mbedAustin 11:cada08fc8a70 684 __svcThreadTerminate(__svcThreadGetId());
mbedAustin 11:cada08fc8a70 685 for (;;); // Should never come here
mbedAustin 11:cada08fc8a70 686 }
mbedAustin 11:cada08fc8a70 687
mbedAustin 11:cada08fc8a70 688
mbedAustin 11:cada08fc8a70 689 // ==== Generic Wait Functions ====
mbedAustin 11:cada08fc8a70 690
mbedAustin 11:cada08fc8a70 691 // Generic Wait Service Calls declarations
mbedAustin 11:cada08fc8a70 692 SVC_1_1(svcDelay, osStatus, uint32_t, RET_osStatus)
mbedAustin 11:cada08fc8a70 693 #if osFeature_Wait != 0
mbedAustin 11:cada08fc8a70 694 SVC_1_3(svcWait, os_InRegs osEvent, uint32_t, RET_osEvent)
mbedAustin 11:cada08fc8a70 695 #endif
mbedAustin 11:cada08fc8a70 696
mbedAustin 11:cada08fc8a70 697 // Generic Wait Service Calls
mbedAustin 11:cada08fc8a70 698
mbedAustin 11:cada08fc8a70 699 /// Wait for Timeout (Time Delay)
mbedAustin 11:cada08fc8a70 700 osStatus svcDelay (uint32_t millisec) {
mbedAustin 11:cada08fc8a70 701 if (millisec == 0) return osOK;
mbedAustin 11:cada08fc8a70 702 rt_dly_wait(rt_ms2tick(millisec));
mbedAustin 11:cada08fc8a70 703 return osEventTimeout;
mbedAustin 11:cada08fc8a70 704 }
mbedAustin 11:cada08fc8a70 705
mbedAustin 11:cada08fc8a70 706 /// Wait for Signal, Message, Mail, or Timeout
mbedAustin 11:cada08fc8a70 707 #if osFeature_Wait != 0
mbedAustin 11:cada08fc8a70 708 os_InRegs osEvent_type svcWait (uint32_t millisec) {
mbedAustin 11:cada08fc8a70 709 osEvent ret;
mbedAustin 11:cada08fc8a70 710
mbedAustin 11:cada08fc8a70 711 if (millisec == 0) {
mbedAustin 11:cada08fc8a70 712 ret.status = osOK;
mbedAustin 11:cada08fc8a70 713 return osEvent_ret_status;
mbedAustin 11:cada08fc8a70 714 }
mbedAustin 11:cada08fc8a70 715
mbedAustin 11:cada08fc8a70 716 /* To Do: osEventSignal, osEventMessage, osEventMail */
mbedAustin 11:cada08fc8a70 717 rt_dly_wait(rt_ms2tick(millisec));
mbedAustin 11:cada08fc8a70 718 ret.status = osEventTimeout;
mbedAustin 11:cada08fc8a70 719
mbedAustin 11:cada08fc8a70 720 return osEvent_ret_status;
mbedAustin 11:cada08fc8a70 721 }
mbedAustin 11:cada08fc8a70 722 #endif
mbedAustin 11:cada08fc8a70 723
mbedAustin 11:cada08fc8a70 724
mbedAustin 11:cada08fc8a70 725 // Generic Wait API
mbedAustin 11:cada08fc8a70 726
mbedAustin 11:cada08fc8a70 727 /// Wait for Timeout (Time Delay)
mbedAustin 11:cada08fc8a70 728 osStatus osDelay (uint32_t millisec) {
mbedAustin 11:cada08fc8a70 729 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 730 return __svcDelay(millisec);
mbedAustin 11:cada08fc8a70 731 }
mbedAustin 11:cada08fc8a70 732
mbedAustin 11:cada08fc8a70 733 /// Wait for Signal, Message, Mail, or Timeout
mbedAustin 11:cada08fc8a70 734 os_InRegs osEvent osWait (uint32_t millisec) {
mbedAustin 11:cada08fc8a70 735 osEvent ret;
mbedAustin 11:cada08fc8a70 736
mbedAustin 11:cada08fc8a70 737 #if osFeature_Wait == 0
mbedAustin 11:cada08fc8a70 738 ret.status = osErrorOS;
mbedAustin 11:cada08fc8a70 739 return ret;
mbedAustin 11:cada08fc8a70 740 #else
mbedAustin 11:cada08fc8a70 741 if (__get_IPSR() != 0) { // Not allowed in ISR
mbedAustin 11:cada08fc8a70 742 ret.status = osErrorISR;
mbedAustin 11:cada08fc8a70 743 return ret;
mbedAustin 11:cada08fc8a70 744 }
mbedAustin 11:cada08fc8a70 745 return __svcWait(millisec);
mbedAustin 11:cada08fc8a70 746 #endif
mbedAustin 11:cada08fc8a70 747 }
mbedAustin 11:cada08fc8a70 748
mbedAustin 11:cada08fc8a70 749
mbedAustin 11:cada08fc8a70 750 // ==== Timer Management ====
mbedAustin 11:cada08fc8a70 751
mbedAustin 11:cada08fc8a70 752 // Timer definitions
mbedAustin 11:cada08fc8a70 753 #define osTimerInvalid 0
mbedAustin 11:cada08fc8a70 754 #define osTimerStopped 1
mbedAustin 11:cada08fc8a70 755 #define osTimerRunning 2
mbedAustin 11:cada08fc8a70 756
mbedAustin 11:cada08fc8a70 757 // Timer structures
mbedAustin 11:cada08fc8a70 758
mbedAustin 11:cada08fc8a70 759 typedef struct os_timer_cb_ { // Timer Control Block
mbedAustin 11:cada08fc8a70 760 struct os_timer_cb_ *next; // Pointer to next active Timer
mbedAustin 11:cada08fc8a70 761 uint8_t state; // Timer State
mbedAustin 11:cada08fc8a70 762 uint8_t type; // Timer Type (Periodic/One-shot)
mbedAustin 11:cada08fc8a70 763 uint16_t reserved; // Reserved
mbedAustin 11:cada08fc8a70 764 uint16_t tcnt; // Timer Delay Count
mbedAustin 11:cada08fc8a70 765 uint16_t icnt; // Timer Initial Count
mbedAustin 11:cada08fc8a70 766 void *arg; // Timer Function Argument
mbedAustin 11:cada08fc8a70 767 osTimerDef_t *timer; // Pointer to Timer definition
mbedAustin 11:cada08fc8a70 768 } os_timer_cb;
mbedAustin 11:cada08fc8a70 769
mbedAustin 11:cada08fc8a70 770 // Timer variables
mbedAustin 11:cada08fc8a70 771 os_timer_cb *os_timer_head; // Pointer to first active Timer
mbedAustin 11:cada08fc8a70 772
mbedAustin 11:cada08fc8a70 773
mbedAustin 11:cada08fc8a70 774 // Timer Helper Functions
mbedAustin 11:cada08fc8a70 775
mbedAustin 11:cada08fc8a70 776 // Insert Timer into the list sorted by time
mbedAustin 11:cada08fc8a70 777 static void rt_timer_insert (os_timer_cb *pt, uint32_t tcnt) {
mbedAustin 11:cada08fc8a70 778 os_timer_cb *p, *prev;
mbedAustin 11:cada08fc8a70 779
mbedAustin 11:cada08fc8a70 780 prev = NULL;
mbedAustin 11:cada08fc8a70 781 p = os_timer_head;
mbedAustin 11:cada08fc8a70 782 while (p != NULL) {
mbedAustin 11:cada08fc8a70 783 if (tcnt < p->tcnt) break;
mbedAustin 11:cada08fc8a70 784 tcnt -= p->tcnt;
mbedAustin 11:cada08fc8a70 785 prev = p;
mbedAustin 11:cada08fc8a70 786 p = p->next;
mbedAustin 11:cada08fc8a70 787 }
mbedAustin 11:cada08fc8a70 788 pt->next = p;
mbedAustin 11:cada08fc8a70 789 pt->tcnt = (uint16_t)tcnt;
mbedAustin 11:cada08fc8a70 790 if (p != NULL) {
mbedAustin 11:cada08fc8a70 791 p->tcnt -= pt->tcnt;
mbedAustin 11:cada08fc8a70 792 }
mbedAustin 11:cada08fc8a70 793 if (prev != NULL) {
mbedAustin 11:cada08fc8a70 794 prev->next = pt;
mbedAustin 11:cada08fc8a70 795 } else {
mbedAustin 11:cada08fc8a70 796 os_timer_head = pt;
mbedAustin 11:cada08fc8a70 797 }
mbedAustin 11:cada08fc8a70 798 }
mbedAustin 11:cada08fc8a70 799
mbedAustin 11:cada08fc8a70 800 // Remove Timer from the list
mbedAustin 11:cada08fc8a70 801 static int rt_timer_remove (os_timer_cb *pt) {
mbedAustin 11:cada08fc8a70 802 os_timer_cb *p, *prev;
mbedAustin 11:cada08fc8a70 803
mbedAustin 11:cada08fc8a70 804 prev = NULL;
mbedAustin 11:cada08fc8a70 805 p = os_timer_head;
mbedAustin 11:cada08fc8a70 806 while (p != NULL) {
mbedAustin 11:cada08fc8a70 807 if (p == pt) break;
mbedAustin 11:cada08fc8a70 808 prev = p;
mbedAustin 11:cada08fc8a70 809 p = p->next;
mbedAustin 11:cada08fc8a70 810 }
mbedAustin 11:cada08fc8a70 811 if (p == NULL) return -1;
mbedAustin 11:cada08fc8a70 812 if (prev != NULL) {
mbedAustin 11:cada08fc8a70 813 prev->next = pt->next;
mbedAustin 11:cada08fc8a70 814 } else {
mbedAustin 11:cada08fc8a70 815 os_timer_head = pt->next;
mbedAustin 11:cada08fc8a70 816 }
mbedAustin 11:cada08fc8a70 817 if (pt->next != NULL) {
mbedAustin 11:cada08fc8a70 818 pt->next->tcnt += pt->tcnt;
mbedAustin 11:cada08fc8a70 819 }
mbedAustin 11:cada08fc8a70 820
mbedAustin 11:cada08fc8a70 821 return 0;
mbedAustin 11:cada08fc8a70 822 }
mbedAustin 11:cada08fc8a70 823
mbedAustin 11:cada08fc8a70 824
mbedAustin 11:cada08fc8a70 825 // Timer Service Calls declarations
mbedAustin 11:cada08fc8a70 826 SVC_3_1(svcTimerCreate, osTimerId, osTimerDef_t *, os_timer_type, void *, RET_pointer)
mbedAustin 11:cada08fc8a70 827 SVC_2_1(svcTimerStart, osStatus, osTimerId, uint32_t, RET_osStatus)
mbedAustin 11:cada08fc8a70 828 SVC_1_1(svcTimerStop, osStatus, osTimerId, RET_osStatus)
mbedAustin 11:cada08fc8a70 829 SVC_1_1(svcTimerDelete, osStatus, osTimerId, RET_osStatus)
mbedAustin 11:cada08fc8a70 830 SVC_1_2(svcTimerCall, os_InRegs osCallback, osTimerId, RET_osCallback)
mbedAustin 11:cada08fc8a70 831
mbedAustin 11:cada08fc8a70 832 // Timer Management Service Calls
mbedAustin 11:cada08fc8a70 833
mbedAustin 11:cada08fc8a70 834 /// Create timer
mbedAustin 11:cada08fc8a70 835 osTimerId svcTimerCreate (osTimerDef_t *timer_def, os_timer_type type, void *argument) {
mbedAustin 11:cada08fc8a70 836 os_timer_cb *pt;
mbedAustin 11:cada08fc8a70 837
mbedAustin 11:cada08fc8a70 838 if ((timer_def == NULL) || (timer_def->ptimer == NULL)) {
mbedAustin 11:cada08fc8a70 839 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 840 return NULL;
mbedAustin 11:cada08fc8a70 841 }
mbedAustin 11:cada08fc8a70 842
mbedAustin 11:cada08fc8a70 843 pt = timer_def->timer;
mbedAustin 11:cada08fc8a70 844 if (pt == NULL) {
mbedAustin 11:cada08fc8a70 845 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 846 return NULL;
mbedAustin 11:cada08fc8a70 847 }
mbedAustin 11:cada08fc8a70 848
mbedAustin 11:cada08fc8a70 849 if ((type != osTimerOnce) && (type != osTimerPeriodic)) {
mbedAustin 11:cada08fc8a70 850 sysThreadError(osErrorValue);
mbedAustin 11:cada08fc8a70 851 return NULL;
mbedAustin 11:cada08fc8a70 852 }
mbedAustin 11:cada08fc8a70 853
mbedAustin 11:cada08fc8a70 854 if (osThreadId_osTimerThread == NULL) {
mbedAustin 11:cada08fc8a70 855 sysThreadError(osErrorResource);
mbedAustin 11:cada08fc8a70 856 return NULL;
mbedAustin 11:cada08fc8a70 857 }
mbedAustin 11:cada08fc8a70 858
mbedAustin 11:cada08fc8a70 859 if (pt->state != osTimerInvalid){
mbedAustin 11:cada08fc8a70 860 sysThreadError(osErrorResource);
mbedAustin 11:cada08fc8a70 861 return NULL;
mbedAustin 11:cada08fc8a70 862 }
mbedAustin 11:cada08fc8a70 863
mbedAustin 11:cada08fc8a70 864 pt->state = osTimerStopped;
mbedAustin 11:cada08fc8a70 865 pt->type = (uint8_t)type;
mbedAustin 11:cada08fc8a70 866 pt->arg = argument;
mbedAustin 11:cada08fc8a70 867 pt->timer = timer_def;
mbedAustin 11:cada08fc8a70 868
mbedAustin 11:cada08fc8a70 869 return (osTimerId)pt;
mbedAustin 11:cada08fc8a70 870 }
mbedAustin 11:cada08fc8a70 871
mbedAustin 11:cada08fc8a70 872 /// Start or restart timer
mbedAustin 11:cada08fc8a70 873 osStatus svcTimerStart (osTimerId timer_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 874 os_timer_cb *pt;
mbedAustin 11:cada08fc8a70 875 uint32_t tcnt;
mbedAustin 11:cada08fc8a70 876
mbedAustin 11:cada08fc8a70 877 pt = rt_id2obj(timer_id);
mbedAustin 11:cada08fc8a70 878 if (pt == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 879
mbedAustin 11:cada08fc8a70 880 tcnt = rt_ms2tick(millisec);
mbedAustin 11:cada08fc8a70 881 if (tcnt == 0) return osErrorValue;
mbedAustin 11:cada08fc8a70 882
mbedAustin 11:cada08fc8a70 883 switch (pt->state) {
mbedAustin 11:cada08fc8a70 884 case osTimerRunning:
mbedAustin 11:cada08fc8a70 885 if (rt_timer_remove(pt) != 0) {
mbedAustin 11:cada08fc8a70 886 return osErrorResource;
mbedAustin 11:cada08fc8a70 887 }
mbedAustin 11:cada08fc8a70 888 break;
mbedAustin 11:cada08fc8a70 889 case osTimerStopped:
mbedAustin 11:cada08fc8a70 890 pt->state = osTimerRunning;
mbedAustin 11:cada08fc8a70 891 pt->icnt = (uint16_t)tcnt;
mbedAustin 11:cada08fc8a70 892 break;
mbedAustin 11:cada08fc8a70 893 default:
mbedAustin 11:cada08fc8a70 894 return osErrorResource;
mbedAustin 11:cada08fc8a70 895 }
mbedAustin 11:cada08fc8a70 896
mbedAustin 11:cada08fc8a70 897 rt_timer_insert(pt, tcnt);
mbedAustin 11:cada08fc8a70 898
mbedAustin 11:cada08fc8a70 899 return osOK;
mbedAustin 11:cada08fc8a70 900 }
mbedAustin 11:cada08fc8a70 901
mbedAustin 11:cada08fc8a70 902 /// Stop timer
mbedAustin 11:cada08fc8a70 903 osStatus svcTimerStop (osTimerId timer_id) {
mbedAustin 11:cada08fc8a70 904 os_timer_cb *pt;
mbedAustin 11:cada08fc8a70 905
mbedAustin 11:cada08fc8a70 906 pt = rt_id2obj(timer_id);
mbedAustin 11:cada08fc8a70 907 if (pt == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 908
mbedAustin 11:cada08fc8a70 909 if (pt->state != osTimerRunning) return osErrorResource;
mbedAustin 11:cada08fc8a70 910
mbedAustin 11:cada08fc8a70 911 pt->state = osTimerStopped;
mbedAustin 11:cada08fc8a70 912
mbedAustin 11:cada08fc8a70 913 if (rt_timer_remove(pt) != 0) {
mbedAustin 11:cada08fc8a70 914 return osErrorResource;
mbedAustin 11:cada08fc8a70 915 }
mbedAustin 11:cada08fc8a70 916
mbedAustin 11:cada08fc8a70 917 return osOK;
mbedAustin 11:cada08fc8a70 918 }
mbedAustin 11:cada08fc8a70 919
mbedAustin 11:cada08fc8a70 920 /// Delete timer
mbedAustin 11:cada08fc8a70 921 osStatus svcTimerDelete (osTimerId timer_id) {
mbedAustin 11:cada08fc8a70 922 os_timer_cb *pt;
mbedAustin 11:cada08fc8a70 923
mbedAustin 11:cada08fc8a70 924 pt = rt_id2obj(timer_id);
mbedAustin 11:cada08fc8a70 925 if (pt == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 926
mbedAustin 11:cada08fc8a70 927 switch (pt->state) {
mbedAustin 11:cada08fc8a70 928 case osTimerRunning:
mbedAustin 11:cada08fc8a70 929 rt_timer_remove(pt);
mbedAustin 11:cada08fc8a70 930 break;
mbedAustin 11:cada08fc8a70 931 case osTimerStopped:
mbedAustin 11:cada08fc8a70 932 break;
mbedAustin 11:cada08fc8a70 933 default:
mbedAustin 11:cada08fc8a70 934 return osErrorResource;
mbedAustin 11:cada08fc8a70 935 }
mbedAustin 11:cada08fc8a70 936
mbedAustin 11:cada08fc8a70 937 pt->state = osTimerInvalid;
mbedAustin 11:cada08fc8a70 938
mbedAustin 11:cada08fc8a70 939 return osOK;
mbedAustin 11:cada08fc8a70 940 }
mbedAustin 11:cada08fc8a70 941
mbedAustin 11:cada08fc8a70 942 /// Get timer callback parameters
mbedAustin 11:cada08fc8a70 943 os_InRegs osCallback_type svcTimerCall (osTimerId timer_id) {
mbedAustin 11:cada08fc8a70 944 os_timer_cb *pt;
mbedAustin 11:cada08fc8a70 945 osCallback ret;
mbedAustin 11:cada08fc8a70 946
mbedAustin 11:cada08fc8a70 947 pt = rt_id2obj(timer_id);
mbedAustin 11:cada08fc8a70 948 if (pt == NULL) {
mbedAustin 11:cada08fc8a70 949 ret.fp = NULL;
mbedAustin 11:cada08fc8a70 950 ret.arg = NULL;
mbedAustin 11:cada08fc8a70 951 return osCallback_ret;
mbedAustin 11:cada08fc8a70 952 }
mbedAustin 11:cada08fc8a70 953
mbedAustin 11:cada08fc8a70 954 ret.fp = (void *)pt->timer->ptimer;
mbedAustin 11:cada08fc8a70 955 ret.arg = pt->arg;
mbedAustin 11:cada08fc8a70 956
mbedAustin 11:cada08fc8a70 957 return osCallback_ret;
mbedAustin 11:cada08fc8a70 958 }
mbedAustin 11:cada08fc8a70 959
mbedAustin 11:cada08fc8a70 960 static __INLINE osStatus isrMessagePut (osMessageQId queue_id, uint32_t info, uint32_t millisec);
mbedAustin 11:cada08fc8a70 961
mbedAustin 11:cada08fc8a70 962 /// Timer Tick (called each SysTick)
mbedAustin 11:cada08fc8a70 963 void sysTimerTick (void) {
mbedAustin 11:cada08fc8a70 964 os_timer_cb *pt, *p;
mbedAustin 11:cada08fc8a70 965
mbedAustin 11:cada08fc8a70 966 p = os_timer_head;
mbedAustin 11:cada08fc8a70 967 if (p == NULL) return;
mbedAustin 11:cada08fc8a70 968
mbedAustin 11:cada08fc8a70 969 p->tcnt--;
mbedAustin 11:cada08fc8a70 970 while ((p != NULL) && (p->tcnt == 0)) {
mbedAustin 11:cada08fc8a70 971 pt = p;
mbedAustin 11:cada08fc8a70 972 p = p->next;
mbedAustin 11:cada08fc8a70 973 os_timer_head = p;
mbedAustin 11:cada08fc8a70 974 isrMessagePut(osMessageQId_osTimerMessageQ, (uint32_t)pt, 0);
mbedAustin 11:cada08fc8a70 975 if (pt->type == osTimerPeriodic) {
mbedAustin 11:cada08fc8a70 976 rt_timer_insert(pt, pt->icnt);
mbedAustin 11:cada08fc8a70 977 } else {
mbedAustin 11:cada08fc8a70 978 pt->state = osTimerStopped;
mbedAustin 11:cada08fc8a70 979 }
mbedAustin 11:cada08fc8a70 980 }
mbedAustin 11:cada08fc8a70 981 }
mbedAustin 11:cada08fc8a70 982
mbedAustin 11:cada08fc8a70 983
mbedAustin 11:cada08fc8a70 984 // Timer Management Public API
mbedAustin 11:cada08fc8a70 985
mbedAustin 11:cada08fc8a70 986 /// Create timer
mbedAustin 11:cada08fc8a70 987 osTimerId osTimerCreate (osTimerDef_t *timer_def, os_timer_type type, void *argument) {
mbedAustin 11:cada08fc8a70 988 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 989 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 990 // Privileged and not running
mbedAustin 11:cada08fc8a70 991 return svcTimerCreate(timer_def, type, argument);
mbedAustin 11:cada08fc8a70 992 } else {
mbedAustin 11:cada08fc8a70 993 return __svcTimerCreate(timer_def, type, argument);
mbedAustin 11:cada08fc8a70 994 }
mbedAustin 11:cada08fc8a70 995 }
mbedAustin 11:cada08fc8a70 996
mbedAustin 11:cada08fc8a70 997 /// Start or restart timer
mbedAustin 11:cada08fc8a70 998 osStatus osTimerStart (osTimerId timer_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 999 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1000 return __svcTimerStart(timer_id, millisec);
mbedAustin 11:cada08fc8a70 1001 }
mbedAustin 11:cada08fc8a70 1002
mbedAustin 11:cada08fc8a70 1003 /// Stop timer
mbedAustin 11:cada08fc8a70 1004 osStatus osTimerStop (osTimerId timer_id) {
mbedAustin 11:cada08fc8a70 1005 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1006 return __svcTimerStop(timer_id);
mbedAustin 11:cada08fc8a70 1007 }
mbedAustin 11:cada08fc8a70 1008
mbedAustin 11:cada08fc8a70 1009 /// Delete timer
mbedAustin 11:cada08fc8a70 1010 osStatus osTimerDelete (osTimerId timer_id) {
mbedAustin 11:cada08fc8a70 1011 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1012 return __svcTimerDelete(timer_id);
mbedAustin 11:cada08fc8a70 1013 }
mbedAustin 11:cada08fc8a70 1014
mbedAustin 11:cada08fc8a70 1015 /// INTERNAL - Not Public
mbedAustin 11:cada08fc8a70 1016 /// Get timer callback parameters (used by OS Timer Thread)
mbedAustin 11:cada08fc8a70 1017 os_InRegs osCallback osTimerCall (osTimerId timer_id) {
mbedAustin 11:cada08fc8a70 1018 return __svcTimerCall(timer_id);
mbedAustin 11:cada08fc8a70 1019 }
mbedAustin 11:cada08fc8a70 1020
mbedAustin 11:cada08fc8a70 1021
mbedAustin 11:cada08fc8a70 1022 // Timer Thread
mbedAustin 11:cada08fc8a70 1023 __NO_RETURN void osTimerThread (void const *argument) {
mbedAustin 11:cada08fc8a70 1024 osCallback cb;
mbedAustin 11:cada08fc8a70 1025 osEvent evt;
mbedAustin 11:cada08fc8a70 1026
mbedAustin 11:cada08fc8a70 1027 for (;;) {
mbedAustin 11:cada08fc8a70 1028 evt = osMessageGet(osMessageQId_osTimerMessageQ, osWaitForever);
mbedAustin 11:cada08fc8a70 1029 if (evt.status == osEventMessage) {
mbedAustin 11:cada08fc8a70 1030 cb = osTimerCall(evt.value.p);
mbedAustin 11:cada08fc8a70 1031 if (cb.fp != NULL) {
mbedAustin 11:cada08fc8a70 1032 (*(os_ptimer)cb.fp)(cb.arg);
mbedAustin 11:cada08fc8a70 1033 }
mbedAustin 11:cada08fc8a70 1034 }
mbedAustin 11:cada08fc8a70 1035 }
mbedAustin 11:cada08fc8a70 1036 }
mbedAustin 11:cada08fc8a70 1037
mbedAustin 11:cada08fc8a70 1038
mbedAustin 11:cada08fc8a70 1039 // ==== Signal Management ====
mbedAustin 11:cada08fc8a70 1040
mbedAustin 11:cada08fc8a70 1041 // Signal Service Calls declarations
mbedAustin 11:cada08fc8a70 1042 SVC_2_1(svcSignalSet, int32_t, osThreadId, int32_t, RET_int32_t)
mbedAustin 11:cada08fc8a70 1043 SVC_2_1(svcSignalClear, int32_t, osThreadId, int32_t, RET_int32_t)
mbedAustin 11:cada08fc8a70 1044 SVC_1_1(svcSignalGet, int32_t, osThreadId, RET_int32_t)
mbedAustin 11:cada08fc8a70 1045 SVC_2_3(svcSignalWait, os_InRegs osEvent, int32_t, uint32_t, RET_osEvent)
mbedAustin 11:cada08fc8a70 1046
mbedAustin 11:cada08fc8a70 1047 // Signal Service Calls
mbedAustin 11:cada08fc8a70 1048
mbedAustin 11:cada08fc8a70 1049 /// Set the specified Signal Flags of an active thread
mbedAustin 11:cada08fc8a70 1050 int32_t svcSignalSet (osThreadId thread_id, int32_t signals) {
mbedAustin 11:cada08fc8a70 1051 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 1052 int32_t sig;
mbedAustin 11:cada08fc8a70 1053
mbedAustin 11:cada08fc8a70 1054 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 1055 if (ptcb == NULL) return 0x80000000;
mbedAustin 11:cada08fc8a70 1056
mbedAustin 11:cada08fc8a70 1057 if (signals & (0xFFFFFFFF << osFeature_Signals)) return 0x80000000;
mbedAustin 11:cada08fc8a70 1058
mbedAustin 11:cada08fc8a70 1059 sig = ptcb->events; // Previous signal flags
mbedAustin 11:cada08fc8a70 1060
mbedAustin 11:cada08fc8a70 1061 rt_evt_set(signals, ptcb->task_id); // Set event flags
mbedAustin 11:cada08fc8a70 1062
mbedAustin 11:cada08fc8a70 1063 return sig;
mbedAustin 11:cada08fc8a70 1064 }
mbedAustin 11:cada08fc8a70 1065
mbedAustin 11:cada08fc8a70 1066 /// Clear the specified Signal Flags of an active thread
mbedAustin 11:cada08fc8a70 1067 int32_t svcSignalClear (osThreadId thread_id, int32_t signals) {
mbedAustin 11:cada08fc8a70 1068 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 1069 int32_t sig;
mbedAustin 11:cada08fc8a70 1070
mbedAustin 11:cada08fc8a70 1071 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 1072 if (ptcb == NULL) return 0x80000000;
mbedAustin 11:cada08fc8a70 1073
mbedAustin 11:cada08fc8a70 1074 if (signals & (0xFFFFFFFF << osFeature_Signals)) return 0x80000000;
mbedAustin 11:cada08fc8a70 1075
mbedAustin 11:cada08fc8a70 1076 sig = ptcb->events; // Previous signal flags
mbedAustin 11:cada08fc8a70 1077
mbedAustin 11:cada08fc8a70 1078 rt_evt_clr(signals, ptcb->task_id); // Clear event flags
mbedAustin 11:cada08fc8a70 1079
mbedAustin 11:cada08fc8a70 1080 return sig;
mbedAustin 11:cada08fc8a70 1081 }
mbedAustin 11:cada08fc8a70 1082
mbedAustin 11:cada08fc8a70 1083 /// Get Signal Flags status of an active thread
mbedAustin 11:cada08fc8a70 1084 int32_t svcSignalGet (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 1085 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 1086
mbedAustin 11:cada08fc8a70 1087 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 1088 if (ptcb == NULL) return 0x80000000;
mbedAustin 11:cada08fc8a70 1089
mbedAustin 11:cada08fc8a70 1090 return ptcb->events; // Return event flags
mbedAustin 11:cada08fc8a70 1091 }
mbedAustin 11:cada08fc8a70 1092
mbedAustin 11:cada08fc8a70 1093 /// Wait for one or more Signal Flags to become signaled for the current RUNNING thread
mbedAustin 11:cada08fc8a70 1094 os_InRegs osEvent_type svcSignalWait (int32_t signals, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1095 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1096 osEvent ret;
mbedAustin 11:cada08fc8a70 1097
mbedAustin 11:cada08fc8a70 1098 if (signals & (0xFFFFFFFF << osFeature_Signals)) {
mbedAustin 11:cada08fc8a70 1099 ret.status = osErrorValue;
mbedAustin 11:cada08fc8a70 1100 return osEvent_ret_status;
mbedAustin 11:cada08fc8a70 1101 }
mbedAustin 11:cada08fc8a70 1102
mbedAustin 11:cada08fc8a70 1103 if (signals != 0) { // Wait for all specified signals
mbedAustin 11:cada08fc8a70 1104 res = rt_evt_wait(signals, rt_ms2tick(millisec), __TRUE);
mbedAustin 11:cada08fc8a70 1105 } else { // Wait for any signal
mbedAustin 11:cada08fc8a70 1106 res = rt_evt_wait(0xFFFF, rt_ms2tick(millisec), __FALSE);
mbedAustin 11:cada08fc8a70 1107 }
mbedAustin 11:cada08fc8a70 1108
mbedAustin 11:cada08fc8a70 1109 if (res == OS_R_EVT) {
mbedAustin 11:cada08fc8a70 1110 ret.status = osEventSignal;
mbedAustin 11:cada08fc8a70 1111 ret.value.signals = signals ? signals : os_tsk.run->waits;
mbedAustin 11:cada08fc8a70 1112 } else {
mbedAustin 11:cada08fc8a70 1113 ret.status = millisec ? osEventTimeout : osOK;
mbedAustin 11:cada08fc8a70 1114 ret.value.signals = 0;
mbedAustin 11:cada08fc8a70 1115 }
mbedAustin 11:cada08fc8a70 1116
mbedAustin 11:cada08fc8a70 1117 return osEvent_ret_value;
mbedAustin 11:cada08fc8a70 1118 }
mbedAustin 11:cada08fc8a70 1119
mbedAustin 11:cada08fc8a70 1120
mbedAustin 11:cada08fc8a70 1121 // Signal ISR Calls
mbedAustin 11:cada08fc8a70 1122
mbedAustin 11:cada08fc8a70 1123 /// Set the specified Signal Flags of an active thread
mbedAustin 11:cada08fc8a70 1124 static __INLINE int32_t isrSignalSet (osThreadId thread_id, int32_t signals) {
mbedAustin 11:cada08fc8a70 1125 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 1126 int32_t sig;
mbedAustin 11:cada08fc8a70 1127
mbedAustin 11:cada08fc8a70 1128 ptcb = rt_tid2ptcb(thread_id); // Get TCB pointer
mbedAustin 11:cada08fc8a70 1129 if (ptcb == NULL) return 0x80000000;
mbedAustin 11:cada08fc8a70 1130
mbedAustin 11:cada08fc8a70 1131 if (signals & (0xFFFFFFFF << osFeature_Signals)) return 0x80000000;
mbedAustin 11:cada08fc8a70 1132
mbedAustin 11:cada08fc8a70 1133 sig = ptcb->events; // Previous signal flags
mbedAustin 11:cada08fc8a70 1134
mbedAustin 11:cada08fc8a70 1135 isr_evt_set(signals, ptcb->task_id); // Set event flags
mbedAustin 11:cada08fc8a70 1136
mbedAustin 11:cada08fc8a70 1137 return sig;
mbedAustin 11:cada08fc8a70 1138 }
mbedAustin 11:cada08fc8a70 1139
mbedAustin 11:cada08fc8a70 1140
mbedAustin 11:cada08fc8a70 1141 // Signal Public API
mbedAustin 11:cada08fc8a70 1142
mbedAustin 11:cada08fc8a70 1143 /// Set the specified Signal Flags of an active thread
mbedAustin 11:cada08fc8a70 1144 int32_t osSignalSet (osThreadId thread_id, int32_t signals) {
mbedAustin 11:cada08fc8a70 1145 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1146 return isrSignalSet(thread_id, signals);
mbedAustin 11:cada08fc8a70 1147 } else { // in Thread
mbedAustin 11:cada08fc8a70 1148 return __svcSignalSet(thread_id, signals);
mbedAustin 11:cada08fc8a70 1149 }
mbedAustin 11:cada08fc8a70 1150 }
mbedAustin 11:cada08fc8a70 1151
mbedAustin 11:cada08fc8a70 1152 /// Clear the specified Signal Flags of an active thread
mbedAustin 11:cada08fc8a70 1153 int32_t osSignalClear (osThreadId thread_id, int32_t signals) {
mbedAustin 11:cada08fc8a70 1154 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1155 return __svcSignalClear(thread_id, signals);
mbedAustin 11:cada08fc8a70 1156 }
mbedAustin 11:cada08fc8a70 1157
mbedAustin 11:cada08fc8a70 1158 /// Get Signal Flags status of an active thread
mbedAustin 11:cada08fc8a70 1159 int32_t osSignalGet (osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 1160 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1161 return __svcSignalGet(thread_id);
mbedAustin 11:cada08fc8a70 1162 }
mbedAustin 11:cada08fc8a70 1163
mbedAustin 11:cada08fc8a70 1164 /// Wait for one or more Signal Flags to become signaled for the current RUNNING thread
mbedAustin 11:cada08fc8a70 1165 os_InRegs osEvent osSignalWait (int32_t signals, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1166 osEvent ret;
mbedAustin 11:cada08fc8a70 1167
mbedAustin 11:cada08fc8a70 1168 if (__get_IPSR() != 0) { // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1169 ret.status = osErrorISR;
mbedAustin 11:cada08fc8a70 1170 return ret;
mbedAustin 11:cada08fc8a70 1171 }
mbedAustin 11:cada08fc8a70 1172 return __svcSignalWait(signals, millisec);
mbedAustin 11:cada08fc8a70 1173 }
mbedAustin 11:cada08fc8a70 1174
mbedAustin 11:cada08fc8a70 1175
mbedAustin 11:cada08fc8a70 1176 // ==== Mutex Management ====
mbedAustin 11:cada08fc8a70 1177
mbedAustin 11:cada08fc8a70 1178 // Mutex Service Calls declarations
mbedAustin 11:cada08fc8a70 1179 SVC_1_1(svcMutexCreate, osMutexId, osMutexDef_t *, RET_pointer)
mbedAustin 11:cada08fc8a70 1180 SVC_2_1(svcMutexWait, osStatus, osMutexId, uint32_t, RET_osStatus)
mbedAustin 11:cada08fc8a70 1181 SVC_1_1(svcMutexRelease, osStatus, osMutexId, RET_osStatus)
mbedAustin 11:cada08fc8a70 1182 SVC_1_1(svcMutexDelete, osStatus, osMutexId, RET_osStatus)
mbedAustin 11:cada08fc8a70 1183
mbedAustin 11:cada08fc8a70 1184 // Mutex Service Calls
mbedAustin 11:cada08fc8a70 1185
mbedAustin 11:cada08fc8a70 1186 /// Create and Initialize a Mutex object
mbedAustin 11:cada08fc8a70 1187 osMutexId svcMutexCreate (osMutexDef_t *mutex_def) {
mbedAustin 11:cada08fc8a70 1188 OS_ID mut;
mbedAustin 11:cada08fc8a70 1189
mbedAustin 11:cada08fc8a70 1190 if (mutex_def == NULL) {
mbedAustin 11:cada08fc8a70 1191 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1192 return NULL;
mbedAustin 11:cada08fc8a70 1193 }
mbedAustin 11:cada08fc8a70 1194
mbedAustin 11:cada08fc8a70 1195 mut = mutex_def->mutex;
mbedAustin 11:cada08fc8a70 1196 if (mut == NULL) {
mbedAustin 11:cada08fc8a70 1197 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1198 return NULL;
mbedAustin 11:cada08fc8a70 1199 }
mbedAustin 11:cada08fc8a70 1200
mbedAustin 11:cada08fc8a70 1201 if (((P_MUCB)mut)->cb_type != 0) {
mbedAustin 11:cada08fc8a70 1202 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1203 return NULL;
mbedAustin 11:cada08fc8a70 1204 }
mbedAustin 11:cada08fc8a70 1205
mbedAustin 11:cada08fc8a70 1206 rt_mut_init(mut); // Initialize Mutex
mbedAustin 11:cada08fc8a70 1207
mbedAustin 11:cada08fc8a70 1208 return mut;
mbedAustin 11:cada08fc8a70 1209 }
mbedAustin 11:cada08fc8a70 1210
mbedAustin 11:cada08fc8a70 1211 /// Wait until a Mutex becomes available
mbedAustin 11:cada08fc8a70 1212 osStatus svcMutexWait (osMutexId mutex_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1213 OS_ID mut;
mbedAustin 11:cada08fc8a70 1214 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1215
mbedAustin 11:cada08fc8a70 1216 mut = rt_id2obj(mutex_id);
mbedAustin 11:cada08fc8a70 1217 if (mut == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1218
mbedAustin 11:cada08fc8a70 1219 if (((P_MUCB)mut)->cb_type != MUCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1220
mbedAustin 11:cada08fc8a70 1221 res = rt_mut_wait(mut, rt_ms2tick(millisec)); // Wait for Mutex
mbedAustin 11:cada08fc8a70 1222
mbedAustin 11:cada08fc8a70 1223 if (res == OS_R_TMO) {
mbedAustin 11:cada08fc8a70 1224 return (millisec ? osErrorTimeoutResource : osErrorResource);
mbedAustin 11:cada08fc8a70 1225 }
mbedAustin 11:cada08fc8a70 1226
mbedAustin 11:cada08fc8a70 1227 return osOK;
mbedAustin 11:cada08fc8a70 1228 }
mbedAustin 11:cada08fc8a70 1229
mbedAustin 11:cada08fc8a70 1230 /// Release a Mutex that was obtained with osMutexWait
mbedAustin 11:cada08fc8a70 1231 osStatus svcMutexRelease (osMutexId mutex_id) {
mbedAustin 11:cada08fc8a70 1232 OS_ID mut;
mbedAustin 11:cada08fc8a70 1233 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1234
mbedAustin 11:cada08fc8a70 1235 mut = rt_id2obj(mutex_id);
mbedAustin 11:cada08fc8a70 1236 if (mut == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1237
mbedAustin 11:cada08fc8a70 1238 if (((P_MUCB)mut)->cb_type != MUCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1239
mbedAustin 11:cada08fc8a70 1240 res = rt_mut_release(mut); // Release Mutex
mbedAustin 11:cada08fc8a70 1241
mbedAustin 11:cada08fc8a70 1242 if (res == OS_R_NOK) return osErrorResource; // Thread not owner or Zero Counter
mbedAustin 11:cada08fc8a70 1243
mbedAustin 11:cada08fc8a70 1244 return osOK;
mbedAustin 11:cada08fc8a70 1245 }
mbedAustin 11:cada08fc8a70 1246
mbedAustin 11:cada08fc8a70 1247 /// Delete a Mutex that was created by osMutexCreate
mbedAustin 11:cada08fc8a70 1248 osStatus svcMutexDelete (osMutexId mutex_id) {
mbedAustin 11:cada08fc8a70 1249 OS_ID mut;
mbedAustin 11:cada08fc8a70 1250
mbedAustin 11:cada08fc8a70 1251 mut = rt_id2obj(mutex_id);
mbedAustin 11:cada08fc8a70 1252 if (mut == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1253
mbedAustin 11:cada08fc8a70 1254 if (((P_MUCB)mut)->cb_type != MUCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1255
mbedAustin 11:cada08fc8a70 1256 rt_mut_delete(mut); // Release Mutex
mbedAustin 11:cada08fc8a70 1257
mbedAustin 11:cada08fc8a70 1258 return osOK;
mbedAustin 11:cada08fc8a70 1259 }
mbedAustin 11:cada08fc8a70 1260
mbedAustin 11:cada08fc8a70 1261
mbedAustin 11:cada08fc8a70 1262 // Mutex Public API
mbedAustin 11:cada08fc8a70 1263
mbedAustin 11:cada08fc8a70 1264 /// Create and Initialize a Mutex object
mbedAustin 11:cada08fc8a70 1265 osMutexId osMutexCreate (osMutexDef_t *mutex_def) {
mbedAustin 11:cada08fc8a70 1266 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1267 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 1268 // Privileged and not running
mbedAustin 11:cada08fc8a70 1269 return svcMutexCreate(mutex_def);
mbedAustin 11:cada08fc8a70 1270 } else {
mbedAustin 11:cada08fc8a70 1271 return __svcMutexCreate(mutex_def);
mbedAustin 11:cada08fc8a70 1272 }
mbedAustin 11:cada08fc8a70 1273 }
mbedAustin 11:cada08fc8a70 1274
mbedAustin 11:cada08fc8a70 1275 /// Wait until a Mutex becomes available
mbedAustin 11:cada08fc8a70 1276 osStatus osMutexWait (osMutexId mutex_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1277 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1278 return __svcMutexWait(mutex_id, millisec);
mbedAustin 11:cada08fc8a70 1279 }
mbedAustin 11:cada08fc8a70 1280
mbedAustin 11:cada08fc8a70 1281 /// Release a Mutex that was obtained with osMutexWait
mbedAustin 11:cada08fc8a70 1282 osStatus osMutexRelease (osMutexId mutex_id) {
mbedAustin 11:cada08fc8a70 1283 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1284 return __svcMutexRelease(mutex_id);
mbedAustin 11:cada08fc8a70 1285 }
mbedAustin 11:cada08fc8a70 1286
mbedAustin 11:cada08fc8a70 1287 /// Delete a Mutex that was created by osMutexCreate
mbedAustin 11:cada08fc8a70 1288 osStatus osMutexDelete (osMutexId mutex_id) {
mbedAustin 11:cada08fc8a70 1289 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1290 return __svcMutexDelete(mutex_id);
mbedAustin 11:cada08fc8a70 1291 }
mbedAustin 11:cada08fc8a70 1292
mbedAustin 11:cada08fc8a70 1293
mbedAustin 11:cada08fc8a70 1294 // ==== Semaphore Management ====
mbedAustin 11:cada08fc8a70 1295
mbedAustin 11:cada08fc8a70 1296 // Semaphore Service Calls declarations
mbedAustin 11:cada08fc8a70 1297 SVC_2_1(svcSemaphoreCreate, osSemaphoreId, const osSemaphoreDef_t *, int32_t, RET_pointer)
mbedAustin 11:cada08fc8a70 1298 SVC_2_1(svcSemaphoreWait, int32_t, osSemaphoreId, uint32_t, RET_int32_t)
mbedAustin 11:cada08fc8a70 1299 SVC_1_1(svcSemaphoreRelease, osStatus, osSemaphoreId, RET_osStatus)
mbedAustin 11:cada08fc8a70 1300 SVC_1_1(svcSemaphoreDelete, osStatus, osSemaphoreId, RET_osStatus)
mbedAustin 11:cada08fc8a70 1301
mbedAustin 11:cada08fc8a70 1302 // Semaphore Service Calls
mbedAustin 11:cada08fc8a70 1303
mbedAustin 11:cada08fc8a70 1304 /// Create and Initialize a Semaphore object
mbedAustin 11:cada08fc8a70 1305 osSemaphoreId svcSemaphoreCreate (const osSemaphoreDef_t *semaphore_def, int32_t count) {
mbedAustin 11:cada08fc8a70 1306 OS_ID sem;
mbedAustin 11:cada08fc8a70 1307
mbedAustin 11:cada08fc8a70 1308 if (semaphore_def == NULL) {
mbedAustin 11:cada08fc8a70 1309 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1310 return NULL;
mbedAustin 11:cada08fc8a70 1311 }
mbedAustin 11:cada08fc8a70 1312
mbedAustin 11:cada08fc8a70 1313 sem = semaphore_def->semaphore;
mbedAustin 11:cada08fc8a70 1314 if (sem == NULL) {
mbedAustin 11:cada08fc8a70 1315 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1316 return NULL;
mbedAustin 11:cada08fc8a70 1317 }
mbedAustin 11:cada08fc8a70 1318
mbedAustin 11:cada08fc8a70 1319 if (((P_SCB)sem)->cb_type != 0) {
mbedAustin 11:cada08fc8a70 1320 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1321 return NULL;
mbedAustin 11:cada08fc8a70 1322 }
mbedAustin 11:cada08fc8a70 1323
mbedAustin 11:cada08fc8a70 1324 if (count > osFeature_Semaphore) {
mbedAustin 11:cada08fc8a70 1325 sysThreadError(osErrorValue);
mbedAustin 11:cada08fc8a70 1326 return NULL;
mbedAustin 11:cada08fc8a70 1327 }
mbedAustin 11:cada08fc8a70 1328
mbedAustin 11:cada08fc8a70 1329 rt_sem_init(sem, count); // Initialize Semaphore
mbedAustin 11:cada08fc8a70 1330
mbedAustin 11:cada08fc8a70 1331 return sem;
mbedAustin 11:cada08fc8a70 1332 }
mbedAustin 11:cada08fc8a70 1333
mbedAustin 11:cada08fc8a70 1334 /// Wait until a Semaphore becomes available
mbedAustin 11:cada08fc8a70 1335 int32_t svcSemaphoreWait (osSemaphoreId semaphore_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1336 OS_ID sem;
mbedAustin 11:cada08fc8a70 1337 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1338
mbedAustin 11:cada08fc8a70 1339 sem = rt_id2obj(semaphore_id);
mbedAustin 11:cada08fc8a70 1340 if (sem == NULL) return -1;
mbedAustin 11:cada08fc8a70 1341
mbedAustin 11:cada08fc8a70 1342 if (((P_SCB)sem)->cb_type != SCB) return -1;
mbedAustin 11:cada08fc8a70 1343
mbedAustin 11:cada08fc8a70 1344 res = rt_sem_wait(sem, rt_ms2tick(millisec)); // Wait for Semaphore
mbedAustin 11:cada08fc8a70 1345
mbedAustin 11:cada08fc8a70 1346 if (res == OS_R_TMO) return 0; // Timeout
mbedAustin 11:cada08fc8a70 1347
mbedAustin 11:cada08fc8a70 1348 return (((P_SCB)sem)->tokens + 1);
mbedAustin 11:cada08fc8a70 1349 }
mbedAustin 11:cada08fc8a70 1350
mbedAustin 11:cada08fc8a70 1351 /// Release a Semaphore
mbedAustin 11:cada08fc8a70 1352 osStatus svcSemaphoreRelease (osSemaphoreId semaphore_id) {
mbedAustin 11:cada08fc8a70 1353 OS_ID sem;
mbedAustin 11:cada08fc8a70 1354
mbedAustin 11:cada08fc8a70 1355 sem = rt_id2obj(semaphore_id);
mbedAustin 11:cada08fc8a70 1356 if (sem == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1357
mbedAustin 11:cada08fc8a70 1358 if (((P_SCB)sem)->cb_type != SCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1359
mbedAustin 11:cada08fc8a70 1360 if (((P_SCB)sem)->tokens == osFeature_Semaphore) return osErrorResource;
mbedAustin 11:cada08fc8a70 1361
mbedAustin 11:cada08fc8a70 1362 rt_sem_send(sem); // Release Semaphore
mbedAustin 11:cada08fc8a70 1363
mbedAustin 11:cada08fc8a70 1364 return osOK;
mbedAustin 11:cada08fc8a70 1365 }
mbedAustin 11:cada08fc8a70 1366
mbedAustin 11:cada08fc8a70 1367 /// Delete a Semaphore that was created by osSemaphoreCreate
mbedAustin 11:cada08fc8a70 1368 osStatus svcSemaphoreDelete (osSemaphoreId semaphore_id) {
mbedAustin 11:cada08fc8a70 1369 OS_ID sem;
mbedAustin 11:cada08fc8a70 1370
mbedAustin 11:cada08fc8a70 1371 sem = rt_id2obj(semaphore_id);
mbedAustin 11:cada08fc8a70 1372 if (sem == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1373
mbedAustin 11:cada08fc8a70 1374 if (((P_SCB)sem)->cb_type != SCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1375
mbedAustin 11:cada08fc8a70 1376 rt_sem_delete(sem); // Delete Semaphore
mbedAustin 11:cada08fc8a70 1377
mbedAustin 11:cada08fc8a70 1378 return osOK;
mbedAustin 11:cada08fc8a70 1379 }
mbedAustin 11:cada08fc8a70 1380
mbedAustin 11:cada08fc8a70 1381
mbedAustin 11:cada08fc8a70 1382 // Semaphore ISR Calls
mbedAustin 11:cada08fc8a70 1383
mbedAustin 11:cada08fc8a70 1384 /// Release a Semaphore
mbedAustin 11:cada08fc8a70 1385 static __INLINE osStatus isrSemaphoreRelease (osSemaphoreId semaphore_id) {
mbedAustin 11:cada08fc8a70 1386 OS_ID sem;
mbedAustin 11:cada08fc8a70 1387
mbedAustin 11:cada08fc8a70 1388 sem = rt_id2obj(semaphore_id);
mbedAustin 11:cada08fc8a70 1389 if (sem == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1390
mbedAustin 11:cada08fc8a70 1391 if (((P_SCB)sem)->cb_type != SCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1392
mbedAustin 11:cada08fc8a70 1393 if (((P_SCB)sem)->tokens == osFeature_Semaphore) return osErrorResource;
mbedAustin 11:cada08fc8a70 1394
mbedAustin 11:cada08fc8a70 1395 isr_sem_send(sem); // Release Semaphore
mbedAustin 11:cada08fc8a70 1396
mbedAustin 11:cada08fc8a70 1397 return osOK;
mbedAustin 11:cada08fc8a70 1398 }
mbedAustin 11:cada08fc8a70 1399
mbedAustin 11:cada08fc8a70 1400
mbedAustin 11:cada08fc8a70 1401 // Semaphore Public API
mbedAustin 11:cada08fc8a70 1402
mbedAustin 11:cada08fc8a70 1403 /// Create and Initialize a Semaphore object
mbedAustin 11:cada08fc8a70 1404 osSemaphoreId osSemaphoreCreate (osSemaphoreDef_t *semaphore_def, int32_t count) {
mbedAustin 11:cada08fc8a70 1405 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1406 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 1407 // Privileged and not running
mbedAustin 11:cada08fc8a70 1408 return svcSemaphoreCreate(semaphore_def, count);
mbedAustin 11:cada08fc8a70 1409 } else {
mbedAustin 11:cada08fc8a70 1410 return __svcSemaphoreCreate(semaphore_def, count);
mbedAustin 11:cada08fc8a70 1411 }
mbedAustin 11:cada08fc8a70 1412 }
mbedAustin 11:cada08fc8a70 1413
mbedAustin 11:cada08fc8a70 1414 /// Wait until a Semaphore becomes available
mbedAustin 11:cada08fc8a70 1415 int32_t osSemaphoreWait (osSemaphoreId semaphore_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1416 if (__get_IPSR() != 0) return -1; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1417 return __svcSemaphoreWait(semaphore_id, millisec);
mbedAustin 11:cada08fc8a70 1418 }
mbedAustin 11:cada08fc8a70 1419
mbedAustin 11:cada08fc8a70 1420 /// Release a Semaphore
mbedAustin 11:cada08fc8a70 1421 osStatus osSemaphoreRelease (osSemaphoreId semaphore_id) {
mbedAustin 11:cada08fc8a70 1422 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1423 return isrSemaphoreRelease(semaphore_id);
mbedAustin 11:cada08fc8a70 1424 } else { // in Thread
mbedAustin 11:cada08fc8a70 1425 return __svcSemaphoreRelease(semaphore_id);
mbedAustin 11:cada08fc8a70 1426 }
mbedAustin 11:cada08fc8a70 1427 }
mbedAustin 11:cada08fc8a70 1428
mbedAustin 11:cada08fc8a70 1429 /// Delete a Semaphore that was created by osSemaphoreCreate
mbedAustin 11:cada08fc8a70 1430 osStatus osSemaphoreDelete (osSemaphoreId semaphore_id) {
mbedAustin 11:cada08fc8a70 1431 if (__get_IPSR() != 0) return osErrorISR; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1432 return __svcSemaphoreDelete(semaphore_id);
mbedAustin 11:cada08fc8a70 1433 }
mbedAustin 11:cada08fc8a70 1434
mbedAustin 11:cada08fc8a70 1435
mbedAustin 11:cada08fc8a70 1436 // ==== Memory Management Functions ====
mbedAustin 11:cada08fc8a70 1437
mbedAustin 11:cada08fc8a70 1438 // Memory Management Helper Functions
mbedAustin 11:cada08fc8a70 1439
mbedAustin 11:cada08fc8a70 1440 // Clear Memory Box (Zero init)
mbedAustin 11:cada08fc8a70 1441 static void rt_clr_box (void *box_mem, void *box) {
mbedAustin 11:cada08fc8a70 1442 uint32_t *p, n;
mbedAustin 11:cada08fc8a70 1443
mbedAustin 11:cada08fc8a70 1444 if (box) {
mbedAustin 11:cada08fc8a70 1445 p = box;
mbedAustin 11:cada08fc8a70 1446 for (n = ((P_BM)box_mem)->blk_size; n; n -= 4) {
mbedAustin 11:cada08fc8a70 1447 *p++ = 0;
mbedAustin 11:cada08fc8a70 1448 }
mbedAustin 11:cada08fc8a70 1449 }
mbedAustin 11:cada08fc8a70 1450 }
mbedAustin 11:cada08fc8a70 1451
mbedAustin 11:cada08fc8a70 1452 // Memory Management Service Calls declarations
mbedAustin 11:cada08fc8a70 1453 SVC_1_1(svcPoolCreate, osPoolId, const osPoolDef_t *, RET_pointer)
mbedAustin 11:cada08fc8a70 1454 SVC_2_1(sysPoolAlloc, void *, osPoolId, uint32_t, RET_pointer)
mbedAustin 11:cada08fc8a70 1455 SVC_2_1(sysPoolFree, osStatus, osPoolId, void *, RET_osStatus)
mbedAustin 11:cada08fc8a70 1456
mbedAustin 11:cada08fc8a70 1457 // Memory Management Service & ISR Calls
mbedAustin 11:cada08fc8a70 1458
mbedAustin 11:cada08fc8a70 1459 /// Create and Initialize memory pool
mbedAustin 11:cada08fc8a70 1460 osPoolId svcPoolCreate (const osPoolDef_t *pool_def) {
mbedAustin 11:cada08fc8a70 1461 uint32_t blk_sz;
mbedAustin 11:cada08fc8a70 1462
mbedAustin 11:cada08fc8a70 1463 if ((pool_def == NULL) ||
mbedAustin 11:cada08fc8a70 1464 (pool_def->pool_sz == 0) ||
mbedAustin 11:cada08fc8a70 1465 (pool_def->item_sz == 0) ||
mbedAustin 11:cada08fc8a70 1466 (pool_def->pool == NULL)) {
mbedAustin 11:cada08fc8a70 1467 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1468 return NULL;
mbedAustin 11:cada08fc8a70 1469 }
mbedAustin 11:cada08fc8a70 1470
mbedAustin 11:cada08fc8a70 1471 blk_sz = (pool_def->item_sz + 3) & ~3;
mbedAustin 11:cada08fc8a70 1472
mbedAustin 11:cada08fc8a70 1473 _init_box(pool_def->pool, sizeof(struct OS_BM) + pool_def->pool_sz * blk_sz, blk_sz);
mbedAustin 11:cada08fc8a70 1474
mbedAustin 11:cada08fc8a70 1475 return pool_def->pool;
mbedAustin 11:cada08fc8a70 1476 }
mbedAustin 11:cada08fc8a70 1477
mbedAustin 11:cada08fc8a70 1478 /// Allocate a memory block from a memory pool
mbedAustin 11:cada08fc8a70 1479 void *sysPoolAlloc (osPoolId pool_id, uint32_t clr) {
mbedAustin 11:cada08fc8a70 1480 void *ptr;
mbedAustin 11:cada08fc8a70 1481
mbedAustin 11:cada08fc8a70 1482 if (pool_id == NULL) return NULL;
mbedAustin 11:cada08fc8a70 1483
mbedAustin 11:cada08fc8a70 1484 ptr = rt_alloc_box(pool_id);
mbedAustin 11:cada08fc8a70 1485 if (clr) {
mbedAustin 11:cada08fc8a70 1486 rt_clr_box(pool_id, ptr);
mbedAustin 11:cada08fc8a70 1487 }
mbedAustin 11:cada08fc8a70 1488
mbedAustin 11:cada08fc8a70 1489 return ptr;
mbedAustin 11:cada08fc8a70 1490 }
mbedAustin 11:cada08fc8a70 1491
mbedAustin 11:cada08fc8a70 1492 /// Return an allocated memory block back to a specific memory pool
mbedAustin 11:cada08fc8a70 1493 osStatus sysPoolFree (osPoolId pool_id, void *block) {
mbedAustin 11:cada08fc8a70 1494 int32_t res;
mbedAustin 11:cada08fc8a70 1495
mbedAustin 11:cada08fc8a70 1496 if (pool_id == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1497
mbedAustin 11:cada08fc8a70 1498 res = rt_free_box(pool_id, block);
mbedAustin 11:cada08fc8a70 1499 if (res != 0) return osErrorValue;
mbedAustin 11:cada08fc8a70 1500
mbedAustin 11:cada08fc8a70 1501 return osOK;
mbedAustin 11:cada08fc8a70 1502 }
mbedAustin 11:cada08fc8a70 1503
mbedAustin 11:cada08fc8a70 1504
mbedAustin 11:cada08fc8a70 1505 // Memory Management Public API
mbedAustin 11:cada08fc8a70 1506
mbedAustin 11:cada08fc8a70 1507 /// Create and Initialize memory pool
mbedAustin 11:cada08fc8a70 1508 osPoolId osPoolCreate (osPoolDef_t *pool_def) {
mbedAustin 11:cada08fc8a70 1509 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1510 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 1511 // Privileged and not running
mbedAustin 11:cada08fc8a70 1512 return svcPoolCreate(pool_def);
mbedAustin 11:cada08fc8a70 1513 } else {
mbedAustin 11:cada08fc8a70 1514 return __svcPoolCreate(pool_def);
mbedAustin 11:cada08fc8a70 1515 }
mbedAustin 11:cada08fc8a70 1516 }
mbedAustin 11:cada08fc8a70 1517
mbedAustin 11:cada08fc8a70 1518 /// Allocate a memory block from a memory pool
mbedAustin 11:cada08fc8a70 1519 void *osPoolAlloc (osPoolId pool_id) {
mbedAustin 11:cada08fc8a70 1520 if ((__get_IPSR() != 0) || ((__get_CONTROL() & 1) == 0)) { // in ISR or Privileged
mbedAustin 11:cada08fc8a70 1521 return sysPoolAlloc(pool_id, 0);
mbedAustin 11:cada08fc8a70 1522 } else { // in Thread
mbedAustin 11:cada08fc8a70 1523 return __sysPoolAlloc(pool_id, 0);
mbedAustin 11:cada08fc8a70 1524 }
mbedAustin 11:cada08fc8a70 1525 }
mbedAustin 11:cada08fc8a70 1526
mbedAustin 11:cada08fc8a70 1527 /// Allocate a memory block from a memory pool and set memory block to zero
mbedAustin 11:cada08fc8a70 1528 void *osPoolCAlloc (osPoolId pool_id) {
mbedAustin 11:cada08fc8a70 1529 if ((__get_IPSR() != 0) || ((__get_CONTROL() & 1) == 0)) { // in ISR or Privileged
mbedAustin 11:cada08fc8a70 1530 return sysPoolAlloc(pool_id, 1);
mbedAustin 11:cada08fc8a70 1531 } else { // in Thread
mbedAustin 11:cada08fc8a70 1532 return __sysPoolAlloc(pool_id, 1);
mbedAustin 11:cada08fc8a70 1533 }
mbedAustin 11:cada08fc8a70 1534 }
mbedAustin 11:cada08fc8a70 1535
mbedAustin 11:cada08fc8a70 1536 /// Return an allocated memory block back to a specific memory pool
mbedAustin 11:cada08fc8a70 1537 osStatus osPoolFree (osPoolId pool_id, void *block) {
mbedAustin 11:cada08fc8a70 1538 if ((__get_IPSR() != 0) || ((__get_CONTROL() & 1) == 0)) { // in ISR or Privileged
mbedAustin 11:cada08fc8a70 1539 return sysPoolFree(pool_id, block);
mbedAustin 11:cada08fc8a70 1540 } else { // in Thread
mbedAustin 11:cada08fc8a70 1541 return __sysPoolFree(pool_id, block);
mbedAustin 11:cada08fc8a70 1542 }
mbedAustin 11:cada08fc8a70 1543 }
mbedAustin 11:cada08fc8a70 1544
mbedAustin 11:cada08fc8a70 1545
mbedAustin 11:cada08fc8a70 1546 // ==== Message Queue Management Functions ====
mbedAustin 11:cada08fc8a70 1547
mbedAustin 11:cada08fc8a70 1548 // Message Queue Management Service Calls declarations
mbedAustin 11:cada08fc8a70 1549 SVC_2_1(svcMessageCreate, osMessageQId, osMessageQDef_t *, osThreadId, RET_pointer)
mbedAustin 11:cada08fc8a70 1550 SVC_3_1(svcMessagePut, osStatus, osMessageQId, uint32_t, uint32_t, RET_osStatus)
mbedAustin 11:cada08fc8a70 1551 SVC_2_3(svcMessageGet, os_InRegs osEvent, osMessageQId, uint32_t, RET_osEvent)
mbedAustin 11:cada08fc8a70 1552
mbedAustin 11:cada08fc8a70 1553 // Message Queue Service Calls
mbedAustin 11:cada08fc8a70 1554
mbedAustin 11:cada08fc8a70 1555 /// Create and Initialize Message Queue
mbedAustin 11:cada08fc8a70 1556 osMessageQId svcMessageCreate (osMessageQDef_t *queue_def, osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 1557
mbedAustin 11:cada08fc8a70 1558 if ((queue_def == NULL) ||
mbedAustin 11:cada08fc8a70 1559 (queue_def->queue_sz == 0) ||
mbedAustin 11:cada08fc8a70 1560 (queue_def->pool == NULL)) {
mbedAustin 11:cada08fc8a70 1561 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1562 return NULL;
mbedAustin 11:cada08fc8a70 1563 }
mbedAustin 11:cada08fc8a70 1564
mbedAustin 11:cada08fc8a70 1565 if (((P_MCB)queue_def->pool)->cb_type != 0) {
mbedAustin 11:cada08fc8a70 1566 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1567 return NULL;
mbedAustin 11:cada08fc8a70 1568 }
mbedAustin 11:cada08fc8a70 1569
mbedAustin 11:cada08fc8a70 1570 rt_mbx_init(queue_def->pool, 4*(queue_def->queue_sz + 4));
mbedAustin 11:cada08fc8a70 1571
mbedAustin 11:cada08fc8a70 1572 return queue_def->pool;
mbedAustin 11:cada08fc8a70 1573 }
mbedAustin 11:cada08fc8a70 1574
mbedAustin 11:cada08fc8a70 1575 /// Put a Message to a Queue
mbedAustin 11:cada08fc8a70 1576 osStatus svcMessagePut (osMessageQId queue_id, uint32_t info, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1577 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1578
mbedAustin 11:cada08fc8a70 1579 if (queue_id == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1580
mbedAustin 11:cada08fc8a70 1581 if (((P_MCB)queue_id)->cb_type != MCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1582
mbedAustin 11:cada08fc8a70 1583 res = rt_mbx_send(queue_id, (void *)info, rt_ms2tick(millisec));
mbedAustin 11:cada08fc8a70 1584
mbedAustin 11:cada08fc8a70 1585 if (res == OS_R_TMO) {
mbedAustin 11:cada08fc8a70 1586 return (millisec ? osErrorTimeoutResource : osErrorResource);
mbedAustin 11:cada08fc8a70 1587 }
mbedAustin 11:cada08fc8a70 1588
mbedAustin 11:cada08fc8a70 1589 return osOK;
mbedAustin 11:cada08fc8a70 1590 }
mbedAustin 11:cada08fc8a70 1591
mbedAustin 11:cada08fc8a70 1592 /// Get a Message or Wait for a Message from a Queue
mbedAustin 11:cada08fc8a70 1593 os_InRegs osEvent_type svcMessageGet (osMessageQId queue_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1594 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1595 osEvent ret;
mbedAustin 11:cada08fc8a70 1596
mbedAustin 11:cada08fc8a70 1597 if (queue_id == NULL) {
mbedAustin 11:cada08fc8a70 1598 ret.status = osErrorParameter;
mbedAustin 11:cada08fc8a70 1599 return osEvent_ret_status;
mbedAustin 11:cada08fc8a70 1600 }
mbedAustin 11:cada08fc8a70 1601
mbedAustin 11:cada08fc8a70 1602 if (((P_MCB)queue_id)->cb_type != MCB) {
mbedAustin 11:cada08fc8a70 1603 ret.status = osErrorParameter;
mbedAustin 11:cada08fc8a70 1604 return osEvent_ret_status;
mbedAustin 11:cada08fc8a70 1605 }
mbedAustin 11:cada08fc8a70 1606
mbedAustin 11:cada08fc8a70 1607 res = rt_mbx_wait(queue_id, &ret.value.p, rt_ms2tick(millisec));
mbedAustin 11:cada08fc8a70 1608
mbedAustin 11:cada08fc8a70 1609 if (res == OS_R_TMO) {
mbedAustin 11:cada08fc8a70 1610 ret.status = millisec ? osEventTimeout : osOK;
mbedAustin 11:cada08fc8a70 1611 return osEvent_ret_value;
mbedAustin 11:cada08fc8a70 1612 }
mbedAustin 11:cada08fc8a70 1613
mbedAustin 11:cada08fc8a70 1614 ret.status = osEventMessage;
mbedAustin 11:cada08fc8a70 1615
mbedAustin 11:cada08fc8a70 1616 return osEvent_ret_value;
mbedAustin 11:cada08fc8a70 1617 }
mbedAustin 11:cada08fc8a70 1618
mbedAustin 11:cada08fc8a70 1619
mbedAustin 11:cada08fc8a70 1620 // Message Queue ISR Calls
mbedAustin 11:cada08fc8a70 1621
mbedAustin 11:cada08fc8a70 1622 /// Put a Message to a Queue
mbedAustin 11:cada08fc8a70 1623 static __INLINE osStatus isrMessagePut (osMessageQId queue_id, uint32_t info, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1624
mbedAustin 11:cada08fc8a70 1625 if ((queue_id == NULL) || (millisec != 0)) {
mbedAustin 11:cada08fc8a70 1626 return osErrorParameter;
mbedAustin 11:cada08fc8a70 1627 }
mbedAustin 11:cada08fc8a70 1628
mbedAustin 11:cada08fc8a70 1629 if (((P_MCB)queue_id)->cb_type != MCB) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1630
mbedAustin 11:cada08fc8a70 1631 if (rt_mbx_check(queue_id) == 0) { // Check if Queue is full
mbedAustin 11:cada08fc8a70 1632 return osErrorResource;
mbedAustin 11:cada08fc8a70 1633 }
mbedAustin 11:cada08fc8a70 1634
mbedAustin 11:cada08fc8a70 1635 isr_mbx_send(queue_id, (void *)info);
mbedAustin 11:cada08fc8a70 1636
mbedAustin 11:cada08fc8a70 1637 return osOK;
mbedAustin 11:cada08fc8a70 1638 }
mbedAustin 11:cada08fc8a70 1639
mbedAustin 11:cada08fc8a70 1640 /// Get a Message or Wait for a Message from a Queue
mbedAustin 11:cada08fc8a70 1641 static __INLINE os_InRegs osEvent isrMessageGet (osMessageQId queue_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1642 OS_RESULT res;
mbedAustin 11:cada08fc8a70 1643 osEvent ret;
mbedAustin 11:cada08fc8a70 1644
mbedAustin 11:cada08fc8a70 1645 if ((queue_id == NULL) || (millisec != 0)) {
mbedAustin 11:cada08fc8a70 1646 ret.status = osErrorParameter;
mbedAustin 11:cada08fc8a70 1647 return ret;
mbedAustin 11:cada08fc8a70 1648 }
mbedAustin 11:cada08fc8a70 1649
mbedAustin 11:cada08fc8a70 1650 if (((P_MCB)queue_id)->cb_type != MCB) {
mbedAustin 11:cada08fc8a70 1651 ret.status = osErrorParameter;
mbedAustin 11:cada08fc8a70 1652 return ret;
mbedAustin 11:cada08fc8a70 1653 }
mbedAustin 11:cada08fc8a70 1654
mbedAustin 11:cada08fc8a70 1655 res = isr_mbx_receive(queue_id, &ret.value.p);
mbedAustin 11:cada08fc8a70 1656
mbedAustin 11:cada08fc8a70 1657 if (res != OS_R_MBX) {
mbedAustin 11:cada08fc8a70 1658 ret.status = osOK;
mbedAustin 11:cada08fc8a70 1659 return ret;
mbedAustin 11:cada08fc8a70 1660 }
mbedAustin 11:cada08fc8a70 1661
mbedAustin 11:cada08fc8a70 1662 ret.status = osEventMessage;
mbedAustin 11:cada08fc8a70 1663
mbedAustin 11:cada08fc8a70 1664 return ret;
mbedAustin 11:cada08fc8a70 1665 }
mbedAustin 11:cada08fc8a70 1666
mbedAustin 11:cada08fc8a70 1667
mbedAustin 11:cada08fc8a70 1668 // Message Queue Management Public API
mbedAustin 11:cada08fc8a70 1669
mbedAustin 11:cada08fc8a70 1670 /// Create and Initialize Message Queue
mbedAustin 11:cada08fc8a70 1671 osMessageQId osMessageCreate (osMessageQDef_t *queue_def, osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 1672 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1673 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 1674 // Privileged and not running
mbedAustin 11:cada08fc8a70 1675 return svcMessageCreate(queue_def, thread_id);
mbedAustin 11:cada08fc8a70 1676 } else {
mbedAustin 11:cada08fc8a70 1677 return __svcMessageCreate(queue_def, thread_id);
mbedAustin 11:cada08fc8a70 1678 }
mbedAustin 11:cada08fc8a70 1679 }
mbedAustin 11:cada08fc8a70 1680
mbedAustin 11:cada08fc8a70 1681 /// Put a Message to a Queue
mbedAustin 11:cada08fc8a70 1682 osStatus osMessagePut (osMessageQId queue_id, uint32_t info, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1683 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1684 return isrMessagePut(queue_id, info, millisec);
mbedAustin 11:cada08fc8a70 1685 } else { // in Thread
mbedAustin 11:cada08fc8a70 1686 return __svcMessagePut(queue_id, info, millisec);
mbedAustin 11:cada08fc8a70 1687 }
mbedAustin 11:cada08fc8a70 1688 }
mbedAustin 11:cada08fc8a70 1689
mbedAustin 11:cada08fc8a70 1690 /// Get a Message or Wait for a Message from a Queue
mbedAustin 11:cada08fc8a70 1691 os_InRegs osEvent osMessageGet (osMessageQId queue_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1692 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1693 return isrMessageGet(queue_id, millisec);
mbedAustin 11:cada08fc8a70 1694 } else { // in Thread
mbedAustin 11:cada08fc8a70 1695 return __svcMessageGet(queue_id, millisec);
mbedAustin 11:cada08fc8a70 1696 }
mbedAustin 11:cada08fc8a70 1697 }
mbedAustin 11:cada08fc8a70 1698
mbedAustin 11:cada08fc8a70 1699
mbedAustin 11:cada08fc8a70 1700 // ==== Mail Queue Management Functions ====
mbedAustin 11:cada08fc8a70 1701
mbedAustin 11:cada08fc8a70 1702 // Mail Queue Management Service Calls declarations
mbedAustin 11:cada08fc8a70 1703 SVC_2_1(svcMailCreate, osMailQId, osMailQDef_t *, osThreadId, RET_pointer)
mbedAustin 11:cada08fc8a70 1704 SVC_4_1(sysMailAlloc, void *, osMailQId, uint32_t, uint32_t, uint32_t, RET_pointer)
mbedAustin 11:cada08fc8a70 1705 SVC_3_1(sysMailFree, osStatus, osMailQId, void *, uint32_t, RET_osStatus)
mbedAustin 11:cada08fc8a70 1706
mbedAustin 11:cada08fc8a70 1707 // Mail Queue Management Service & ISR Calls
mbedAustin 11:cada08fc8a70 1708
mbedAustin 11:cada08fc8a70 1709 /// Create and Initialize mail queue
mbedAustin 11:cada08fc8a70 1710 osMailQId svcMailCreate (osMailQDef_t *queue_def, osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 1711 uint32_t blk_sz;
mbedAustin 11:cada08fc8a70 1712 P_MCB pmcb;
mbedAustin 11:cada08fc8a70 1713 void *pool;
mbedAustin 11:cada08fc8a70 1714
mbedAustin 11:cada08fc8a70 1715 if ((queue_def == NULL) ||
mbedAustin 11:cada08fc8a70 1716 (queue_def->queue_sz == 0) ||
mbedAustin 11:cada08fc8a70 1717 (queue_def->item_sz == 0) ||
mbedAustin 11:cada08fc8a70 1718 (queue_def->pool == NULL)) {
mbedAustin 11:cada08fc8a70 1719 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1720 return NULL;
mbedAustin 11:cada08fc8a70 1721 }
mbedAustin 11:cada08fc8a70 1722
mbedAustin 11:cada08fc8a70 1723 pmcb = *(((void **)queue_def->pool) + 0);
mbedAustin 11:cada08fc8a70 1724 pool = *(((void **)queue_def->pool) + 1);
mbedAustin 11:cada08fc8a70 1725
mbedAustin 11:cada08fc8a70 1726 if ((pool == NULL) || (pmcb == NULL) || (pmcb->cb_type != 0)) {
mbedAustin 11:cada08fc8a70 1727 sysThreadError(osErrorParameter);
mbedAustin 11:cada08fc8a70 1728 return NULL;
mbedAustin 11:cada08fc8a70 1729 }
mbedAustin 11:cada08fc8a70 1730
mbedAustin 11:cada08fc8a70 1731 blk_sz = (queue_def->item_sz + 3) & ~3;
mbedAustin 11:cada08fc8a70 1732
mbedAustin 11:cada08fc8a70 1733 _init_box(pool, sizeof(struct OS_BM) + queue_def->queue_sz * blk_sz, blk_sz);
mbedAustin 11:cada08fc8a70 1734
mbedAustin 11:cada08fc8a70 1735 rt_mbx_init(pmcb, 4*(queue_def->queue_sz + 4));
mbedAustin 11:cada08fc8a70 1736
mbedAustin 11:cada08fc8a70 1737
mbedAustin 11:cada08fc8a70 1738 return queue_def->pool;
mbedAustin 11:cada08fc8a70 1739 }
mbedAustin 11:cada08fc8a70 1740
mbedAustin 11:cada08fc8a70 1741 /// Allocate a memory block from a mail
mbedAustin 11:cada08fc8a70 1742 void *sysMailAlloc (osMailQId queue_id, uint32_t millisec, uint32_t isr, uint32_t clr) {
mbedAustin 11:cada08fc8a70 1743 P_MCB pmcb;
mbedAustin 11:cada08fc8a70 1744 void *pool;
mbedAustin 11:cada08fc8a70 1745 void *mem;
mbedAustin 11:cada08fc8a70 1746
mbedAustin 11:cada08fc8a70 1747 if (queue_id == NULL) return NULL;
mbedAustin 11:cada08fc8a70 1748
mbedAustin 11:cada08fc8a70 1749 pmcb = *(((void **)queue_id) + 0);
mbedAustin 11:cada08fc8a70 1750 pool = *(((void **)queue_id) + 1);
mbedAustin 11:cada08fc8a70 1751
mbedAustin 11:cada08fc8a70 1752 if ((pool == NULL) || (pmcb == NULL)) return NULL;
mbedAustin 11:cada08fc8a70 1753
mbedAustin 11:cada08fc8a70 1754 if (isr && (millisec != 0)) return NULL;
mbedAustin 11:cada08fc8a70 1755
mbedAustin 11:cada08fc8a70 1756 mem = rt_alloc_box(pool);
mbedAustin 11:cada08fc8a70 1757 if (clr) {
mbedAustin 11:cada08fc8a70 1758 rt_clr_box(pool, mem);
mbedAustin 11:cada08fc8a70 1759 }
mbedAustin 11:cada08fc8a70 1760
mbedAustin 11:cada08fc8a70 1761 if ((mem == NULL) && (millisec != 0)) {
mbedAustin 11:cada08fc8a70 1762 // Put Task to sleep when Memory not available
mbedAustin 11:cada08fc8a70 1763 if (pmcb->p_lnk != NULL) {
mbedAustin 11:cada08fc8a70 1764 rt_put_prio((P_XCB)pmcb, os_tsk.run);
mbedAustin 11:cada08fc8a70 1765 } else {
mbedAustin 11:cada08fc8a70 1766 pmcb->p_lnk = os_tsk.run;
mbedAustin 11:cada08fc8a70 1767 os_tsk.run->p_lnk = NULL;
mbedAustin 11:cada08fc8a70 1768 os_tsk.run->p_rlnk = (P_TCB)pmcb;
mbedAustin 11:cada08fc8a70 1769 // Task is waiting to allocate a message
mbedAustin 11:cada08fc8a70 1770 pmcb->state = 3;
mbedAustin 11:cada08fc8a70 1771 }
mbedAustin 11:cada08fc8a70 1772 rt_block(rt_ms2tick(millisec), WAIT_MBX);
mbedAustin 11:cada08fc8a70 1773 }
mbedAustin 11:cada08fc8a70 1774
mbedAustin 11:cada08fc8a70 1775 return mem;
mbedAustin 11:cada08fc8a70 1776 }
mbedAustin 11:cada08fc8a70 1777
mbedAustin 11:cada08fc8a70 1778 /// Free a memory block from a mail
mbedAustin 11:cada08fc8a70 1779 osStatus sysMailFree (osMailQId queue_id, void *mail, uint32_t isr) {
mbedAustin 11:cada08fc8a70 1780 P_MCB pmcb;
mbedAustin 11:cada08fc8a70 1781 P_TCB ptcb;
mbedAustin 11:cada08fc8a70 1782 void *pool;
mbedAustin 11:cada08fc8a70 1783 void *mem;
mbedAustin 11:cada08fc8a70 1784 int32_t res;
mbedAustin 11:cada08fc8a70 1785
mbedAustin 11:cada08fc8a70 1786 if (queue_id == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1787
mbedAustin 11:cada08fc8a70 1788 pmcb = *(((void **)queue_id) + 0);
mbedAustin 11:cada08fc8a70 1789 pool = *(((void **)queue_id) + 1);
mbedAustin 11:cada08fc8a70 1790
mbedAustin 11:cada08fc8a70 1791 if ((pmcb == NULL) || (pool == NULL)) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1792
mbedAustin 11:cada08fc8a70 1793 res = rt_free_box(pool, mail);
mbedAustin 11:cada08fc8a70 1794
mbedAustin 11:cada08fc8a70 1795 if (res != 0) return osErrorValue;
mbedAustin 11:cada08fc8a70 1796
mbedAustin 11:cada08fc8a70 1797 if (pmcb->state == 3) {
mbedAustin 11:cada08fc8a70 1798 // Task is waiting to allocate a message
mbedAustin 11:cada08fc8a70 1799 if (isr) {
mbedAustin 11:cada08fc8a70 1800 rt_psq_enq (pmcb, (U32)pool);
mbedAustin 11:cada08fc8a70 1801 rt_psh_req ();
mbedAustin 11:cada08fc8a70 1802 } else {
mbedAustin 11:cada08fc8a70 1803 mem = rt_alloc_box(pool);
mbedAustin 11:cada08fc8a70 1804 if (mem != NULL) {
mbedAustin 11:cada08fc8a70 1805 ptcb = rt_get_first((P_XCB)pmcb);
mbedAustin 11:cada08fc8a70 1806 if (pmcb->p_lnk == NULL) {
mbedAustin 11:cada08fc8a70 1807 pmcb->state = 0;
mbedAustin 11:cada08fc8a70 1808 }
mbedAustin 11:cada08fc8a70 1809 rt_ret_val(ptcb, (U32)mem);
mbedAustin 11:cada08fc8a70 1810 rt_rmv_dly(ptcb);
mbedAustin 11:cada08fc8a70 1811 rt_dispatch(ptcb);
mbedAustin 11:cada08fc8a70 1812 }
mbedAustin 11:cada08fc8a70 1813 }
mbedAustin 11:cada08fc8a70 1814 }
mbedAustin 11:cada08fc8a70 1815
mbedAustin 11:cada08fc8a70 1816 return osOK;
mbedAustin 11:cada08fc8a70 1817 }
mbedAustin 11:cada08fc8a70 1818
mbedAustin 11:cada08fc8a70 1819
mbedAustin 11:cada08fc8a70 1820 // Mail Queue Management Public API
mbedAustin 11:cada08fc8a70 1821
mbedAustin 11:cada08fc8a70 1822 /// Create and Initialize mail queue
mbedAustin 11:cada08fc8a70 1823 osMailQId osMailCreate (osMailQDef_t *queue_def, osThreadId thread_id) {
mbedAustin 11:cada08fc8a70 1824 if (__get_IPSR() != 0) return NULL; // Not allowed in ISR
mbedAustin 11:cada08fc8a70 1825 if (((__get_CONTROL() & 1) == 0) && (os_running == 0)) {
mbedAustin 11:cada08fc8a70 1826 // Privileged and not running
mbedAustin 11:cada08fc8a70 1827 return svcMailCreate(queue_def, thread_id);
mbedAustin 11:cada08fc8a70 1828 } else {
mbedAustin 11:cada08fc8a70 1829 return __svcMailCreate(queue_def, thread_id);
mbedAustin 11:cada08fc8a70 1830 }
mbedAustin 11:cada08fc8a70 1831 }
mbedAustin 11:cada08fc8a70 1832
mbedAustin 11:cada08fc8a70 1833 /// Allocate a memory block from a mail
mbedAustin 11:cada08fc8a70 1834 void *osMailAlloc (osMailQId queue_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1835 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1836 return sysMailAlloc(queue_id, millisec, 1, 0);
mbedAustin 11:cada08fc8a70 1837 } else { // in Thread
mbedAustin 11:cada08fc8a70 1838 return __sysMailAlloc(queue_id, millisec, 0, 0);
mbedAustin 11:cada08fc8a70 1839 }
mbedAustin 11:cada08fc8a70 1840 }
mbedAustin 11:cada08fc8a70 1841
mbedAustin 11:cada08fc8a70 1842 /// Allocate a memory block from a mail and set memory block to zero
mbedAustin 11:cada08fc8a70 1843 void *osMailCAlloc (osMailQId queue_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1844 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1845 return sysMailAlloc(queue_id, millisec, 1, 1);
mbedAustin 11:cada08fc8a70 1846 } else { // in Thread
mbedAustin 11:cada08fc8a70 1847 return __sysMailAlloc(queue_id, millisec, 0, 1);
mbedAustin 11:cada08fc8a70 1848 }
mbedAustin 11:cada08fc8a70 1849 }
mbedAustin 11:cada08fc8a70 1850
mbedAustin 11:cada08fc8a70 1851 /// Free a memory block from a mail
mbedAustin 11:cada08fc8a70 1852 osStatus osMailFree (osMailQId queue_id, void *mail) {
mbedAustin 11:cada08fc8a70 1853 if (__get_IPSR() != 0) { // in ISR
mbedAustin 11:cada08fc8a70 1854 return sysMailFree(queue_id, mail, 1);
mbedAustin 11:cada08fc8a70 1855 } else { // in Thread
mbedAustin 11:cada08fc8a70 1856 return __sysMailFree(queue_id, mail, 0);
mbedAustin 11:cada08fc8a70 1857 }
mbedAustin 11:cada08fc8a70 1858 }
mbedAustin 11:cada08fc8a70 1859
mbedAustin 11:cada08fc8a70 1860 /// Put a mail to a queue
mbedAustin 11:cada08fc8a70 1861 osStatus osMailPut (osMailQId queue_id, void *mail) {
mbedAustin 11:cada08fc8a70 1862 if (queue_id == NULL) return osErrorParameter;
mbedAustin 11:cada08fc8a70 1863 if (mail == NULL) return osErrorValue;
mbedAustin 11:cada08fc8a70 1864 return osMessagePut(*((void **)queue_id), (uint32_t)mail, 0);
mbedAustin 11:cada08fc8a70 1865 }
mbedAustin 11:cada08fc8a70 1866
mbedAustin 11:cada08fc8a70 1867 #ifdef __CC_ARM
mbedAustin 11:cada08fc8a70 1868 #pragma push
mbedAustin 11:cada08fc8a70 1869 #pragma Ospace
mbedAustin 11:cada08fc8a70 1870 #endif // __arm__
mbedAustin 11:cada08fc8a70 1871 /// Get a mail from a queue
mbedAustin 11:cada08fc8a70 1872 os_InRegs osEvent osMailGet (osMailQId queue_id, uint32_t millisec) {
mbedAustin 11:cada08fc8a70 1873 osEvent ret;
mbedAustin 11:cada08fc8a70 1874
mbedAustin 11:cada08fc8a70 1875 if (queue_id == NULL) {
mbedAustin 11:cada08fc8a70 1876 ret.status = osErrorParameter;
mbedAustin 11:cada08fc8a70 1877 return ret;
mbedAustin 11:cada08fc8a70 1878 }
mbedAustin 11:cada08fc8a70 1879
mbedAustin 11:cada08fc8a70 1880 ret = osMessageGet(*((void **)queue_id), millisec);
mbedAustin 11:cada08fc8a70 1881 if (ret.status == osEventMessage) ret.status = osEventMail;
mbedAustin 11:cada08fc8a70 1882
mbedAustin 11:cada08fc8a70 1883 return ret;
mbedAustin 11:cada08fc8a70 1884 }
mbedAustin 11:cada08fc8a70 1885 #ifdef __CC_ARM
mbedAustin 11:cada08fc8a70 1886 #pragma pop
mbedAustin 11:cada08fc8a70 1887 #endif // __arm__