RUBEN ELISEO VAZQUEZ / Mbed 2 deprecated ds1302-bluetooth

the program have one sensor acs712 and moduleds1302

Dependencies:   FATFileSystem mbed

rtx/TARGET_ARM7/rt_CMSIS.c@0:b82abca089ac, 2017-06-08 (annotated)

Committer:
RUBENTEC
Date:
Thu Jun 08 20:17:34 2017 +0000
Revision:
0:b82abca089ac
ds1302-bluetooth-acs712

Who changed what in which revision?

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