HT-TEAM / Mbed 2 deprecated Test_Mainboard

test

Dependencies:   F7_Ethernet mbed BSP_DISCO_F746NG SDFileSystem RF24

TARGET_ARM7/rt_CMSIS.c@3:1c6da30ca347, 2021-06-08 (annotated)

Committer:
lowlowry
Date:
Tue Jun 08 16:21:16 2021 +0000
Revision:
3:1c6da30ca347
Parent:
0:d984976f1f1c 
test final

Who changed what in which revision?

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