Fork of official mbed Real Time Operating System based on the RTX implementation of the CMSIS-RTOS API open standard.
Dependents: Final_Coffee_Roaster
Fork of mbed-rtos by
rtx/RTX_CM_lib.h@6:350b53afb889, 2012-11-23 (annotated)
- Committer:
- emilmont
- Date:
- Fri Nov 23 09:57:31 2012 +0000
- Revision:
- 6:350b53afb889
- Child:
- 9:53e6cccd8782
Merge RTOS C++ API and RTX under the same library; Update RTX to version 4.60; Add proper Thread destructor;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
emilmont | 6:350b53afb889 | 1 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 2 | * RL-ARM - RTX |
emilmont | 6:350b53afb889 | 3 | *---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 4 | * Name: RTX_CM_LIB.H |
emilmont | 6:350b53afb889 | 5 | * Purpose: RTX Kernel System Configuration |
emilmont | 6:350b53afb889 | 6 | * Rev.: V4.60 |
emilmont | 6:350b53afb889 | 7 | *---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 8 | * |
emilmont | 6:350b53afb889 | 9 | * Copyright (c) 1999-2009 KEIL, 2009-2012 ARM Germany GmbH |
emilmont | 6:350b53afb889 | 10 | * All rights reserved. |
emilmont | 6:350b53afb889 | 11 | * Redistribution and use in source and binary forms, with or without |
emilmont | 6:350b53afb889 | 12 | * modification, are permitted provided that the following conditions are met: |
emilmont | 6:350b53afb889 | 13 | * - Redistributions of source code must retain the above copyright |
emilmont | 6:350b53afb889 | 14 | * notice, this list of conditions and the following disclaimer. |
emilmont | 6:350b53afb889 | 15 | * - Redistributions in binary form must reproduce the above copyright |
emilmont | 6:350b53afb889 | 16 | * notice, this list of conditions and the following disclaimer in the |
emilmont | 6:350b53afb889 | 17 | * documentation and/or other materials provided with the distribution. |
emilmont | 6:350b53afb889 | 18 | * - Neither the name of ARM nor the names of its contributors may be used |
emilmont | 6:350b53afb889 | 19 | * to endorse or promote products derived from this software without |
emilmont | 6:350b53afb889 | 20 | * specific prior written permission. |
emilmont | 6:350b53afb889 | 21 | * |
emilmont | 6:350b53afb889 | 22 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
emilmont | 6:350b53afb889 | 23 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
emilmont | 6:350b53afb889 | 24 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
emilmont | 6:350b53afb889 | 25 | * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE |
emilmont | 6:350b53afb889 | 26 | * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
emilmont | 6:350b53afb889 | 27 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
emilmont | 6:350b53afb889 | 28 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
emilmont | 6:350b53afb889 | 29 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
emilmont | 6:350b53afb889 | 30 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
emilmont | 6:350b53afb889 | 31 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
emilmont | 6:350b53afb889 | 32 | * POSSIBILITY OF SUCH DAMAGE. |
emilmont | 6:350b53afb889 | 33 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 34 | |
emilmont | 6:350b53afb889 | 35 | #if defined (__CC_ARM) |
emilmont | 6:350b53afb889 | 36 | #pragma O3 |
emilmont | 6:350b53afb889 | 37 | #define __USED __attribute__((used)) |
emilmont | 6:350b53afb889 | 38 | #elif defined (__GNUC__) |
emilmont | 6:350b53afb889 | 39 | #pragma GCC optimize ("O3") |
emilmont | 6:350b53afb889 | 40 | #define __USED __attribute__((used)) |
emilmont | 6:350b53afb889 | 41 | #elif defined (__ICCARM__) |
emilmont | 6:350b53afb889 | 42 | #define __USED __root |
emilmont | 6:350b53afb889 | 43 | #endif |
emilmont | 6:350b53afb889 | 44 | |
emilmont | 6:350b53afb889 | 45 | |
emilmont | 6:350b53afb889 | 46 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 47 | * Definitions |
emilmont | 6:350b53afb889 | 48 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 49 | |
emilmont | 6:350b53afb889 | 50 | #define _declare_box(pool,size,cnt) uint32_t pool[(((size)+3)/4)*(cnt) + 3] |
emilmont | 6:350b53afb889 | 51 | #define _declare_box8(pool,size,cnt) uint64_t pool[(((size)+7)/8)*(cnt) + 2] |
emilmont | 6:350b53afb889 | 52 | |
emilmont | 6:350b53afb889 | 53 | #define OS_TCB_SIZE 48 |
emilmont | 6:350b53afb889 | 54 | #define OS_TMR_SIZE 8 |
emilmont | 6:350b53afb889 | 55 | |
emilmont | 6:350b53afb889 | 56 | #if defined (__CC_ARM) && !defined (__MICROLIB) |
emilmont | 6:350b53afb889 | 57 | |
emilmont | 6:350b53afb889 | 58 | typedef void *OS_ID; |
emilmont | 6:350b53afb889 | 59 | typedef uint32_t OS_TID; |
emilmont | 6:350b53afb889 | 60 | typedef uint32_t OS_MUT[3]; |
emilmont | 6:350b53afb889 | 61 | typedef uint32_t OS_RESULT; |
emilmont | 6:350b53afb889 | 62 | |
emilmont | 6:350b53afb889 | 63 | #define runtask_id() rt_tsk_self() |
emilmont | 6:350b53afb889 | 64 | #define mutex_init(m) rt_mut_init(m) |
emilmont | 6:350b53afb889 | 65 | #define mutex_wait(m) os_mut_wait(m,0xFFFF) |
emilmont | 6:350b53afb889 | 66 | #define mutex_rel(m) os_mut_release(m) |
emilmont | 6:350b53afb889 | 67 | |
emilmont | 6:350b53afb889 | 68 | extern OS_TID rt_tsk_self (void); |
emilmont | 6:350b53afb889 | 69 | extern void rt_mut_init (OS_ID mutex); |
emilmont | 6:350b53afb889 | 70 | extern OS_RESULT rt_mut_release (OS_ID mutex); |
emilmont | 6:350b53afb889 | 71 | extern OS_RESULT rt_mut_wait (OS_ID mutex, uint16_t timeout); |
emilmont | 6:350b53afb889 | 72 | |
emilmont | 6:350b53afb889 | 73 | #define os_mut_wait(mutex,timeout) _os_mut_wait((uint32_t)rt_mut_wait,mutex,timeout) |
emilmont | 6:350b53afb889 | 74 | #define os_mut_release(mutex) _os_mut_release((uint32_t)rt_mut_release,mutex) |
emilmont | 6:350b53afb889 | 75 | |
emilmont | 6:350b53afb889 | 76 | OS_RESULT _os_mut_release (uint32_t p, OS_ID mutex) __svc_indirect(0); |
emilmont | 6:350b53afb889 | 77 | OS_RESULT _os_mut_wait (uint32_t p, OS_ID mutex, uint16_t timeout) __svc_indirect(0); |
emilmont | 6:350b53afb889 | 78 | |
emilmont | 6:350b53afb889 | 79 | #endif |
emilmont | 6:350b53afb889 | 80 | |
emilmont | 6:350b53afb889 | 81 | |
emilmont | 6:350b53afb889 | 82 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 83 | * Global Variables |
emilmont | 6:350b53afb889 | 84 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 85 | |
emilmont | 6:350b53afb889 | 86 | #if (OS_TIMERS != 0) |
emilmont | 6:350b53afb889 | 87 | #define OS_TASK_CNT (OS_TASKCNT + 1) |
emilmont | 6:350b53afb889 | 88 | #else |
emilmont | 6:350b53afb889 | 89 | #define OS_TASK_CNT OS_TASKCNT |
emilmont | 6:350b53afb889 | 90 | #endif |
emilmont | 6:350b53afb889 | 91 | |
emilmont | 6:350b53afb889 | 92 | uint16_t const os_maxtaskrun = OS_TASK_CNT; |
emilmont | 6:350b53afb889 | 93 | uint32_t const os_rrobin = (OS_ROBIN << 16) | OS_ROBINTOUT; |
emilmont | 6:350b53afb889 | 94 | uint32_t const os_trv = OS_TRV; |
emilmont | 6:350b53afb889 | 95 | uint8_t const os_flags = OS_RUNPRIV; |
emilmont | 6:350b53afb889 | 96 | |
emilmont | 6:350b53afb889 | 97 | /* Export following defines to uVision debugger. */ |
emilmont | 6:350b53afb889 | 98 | __USED uint32_t const os_clockrate = OS_TICK; |
emilmont | 6:350b53afb889 | 99 | __USED uint32_t const os_timernum = 0; |
emilmont | 6:350b53afb889 | 100 | |
emilmont | 6:350b53afb889 | 101 | /* Stack for the os_idle_demon */ |
emilmont | 6:350b53afb889 | 102 | unsigned int idle_task_stack[OS_IDLESTKSIZE]; |
emilmont | 6:350b53afb889 | 103 | unsigned short const idle_task_stack_size = OS_IDLESTKSIZE; |
emilmont | 6:350b53afb889 | 104 | |
emilmont | 6:350b53afb889 | 105 | #ifndef OS_FIFOSZ |
emilmont | 6:350b53afb889 | 106 | #define OS_FIFOSZ 16 |
emilmont | 6:350b53afb889 | 107 | #endif |
emilmont | 6:350b53afb889 | 108 | |
emilmont | 6:350b53afb889 | 109 | /* Fifo Queue buffer for ISR requests.*/ |
emilmont | 6:350b53afb889 | 110 | uint32_t os_fifo[OS_FIFOSZ*2+1]; |
emilmont | 6:350b53afb889 | 111 | uint8_t const os_fifo_size = OS_FIFOSZ; |
emilmont | 6:350b53afb889 | 112 | |
emilmont | 6:350b53afb889 | 113 | /* An array of Active task pointers. */ |
emilmont | 6:350b53afb889 | 114 | void *os_active_TCB[OS_TASK_CNT]; |
emilmont | 6:350b53afb889 | 115 | |
emilmont | 6:350b53afb889 | 116 | /* User Timers Resources */ |
emilmont | 6:350b53afb889 | 117 | #if (OS_TIMERS != 0) |
emilmont | 6:350b53afb889 | 118 | extern void osTimerThread (void const *argument); |
emilmont | 6:350b53afb889 | 119 | osThreadDef(osTimerThread, (osPriority)(OS_TIMERPRIO-3), 4*OS_TIMERSTKSZ); |
emilmont | 6:350b53afb889 | 120 | osThreadId osThreadId_osTimerThread; |
emilmont | 6:350b53afb889 | 121 | osMessageQDef(osTimerMessageQ, OS_TIMERCBQS, void *); |
emilmont | 6:350b53afb889 | 122 | osMessageQId osMessageQId_osTimerMessageQ; |
emilmont | 6:350b53afb889 | 123 | #else |
emilmont | 6:350b53afb889 | 124 | osThreadDef_t os_thread_def_osTimerThread = { NULL }; |
emilmont | 6:350b53afb889 | 125 | osThreadId osThreadId_osTimerThread; |
emilmont | 6:350b53afb889 | 126 | osMessageQDef(osTimerMessageQ, 0, void *); |
emilmont | 6:350b53afb889 | 127 | osMessageQId osMessageQId_osTimerMessageQ; |
emilmont | 6:350b53afb889 | 128 | #endif |
emilmont | 6:350b53afb889 | 129 | |
emilmont | 6:350b53afb889 | 130 | |
emilmont | 6:350b53afb889 | 131 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 132 | * RTX Optimizations (empty functions) |
emilmont | 6:350b53afb889 | 133 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 134 | |
emilmont | 6:350b53afb889 | 135 | #if OS_ROBIN == 0 |
emilmont | 6:350b53afb889 | 136 | void rt_init_robin (void) {;} |
emilmont | 6:350b53afb889 | 137 | void rt_chk_robin (void) {;} |
emilmont | 6:350b53afb889 | 138 | #endif |
emilmont | 6:350b53afb889 | 139 | |
emilmont | 6:350b53afb889 | 140 | #if OS_STKCHECK == 0 |
emilmont | 6:350b53afb889 | 141 | void rt_stk_check (void) {;} |
emilmont | 6:350b53afb889 | 142 | #endif |
emilmont | 6:350b53afb889 | 143 | |
emilmont | 6:350b53afb889 | 144 | |
emilmont | 6:350b53afb889 | 145 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 146 | * Standard Library multithreading interface |
emilmont | 6:350b53afb889 | 147 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 148 | |
emilmont | 6:350b53afb889 | 149 | #if defined (__CC_ARM) && !defined (__MICROLIB) |
emilmont | 6:350b53afb889 | 150 | static OS_MUT std_libmutex[OS_MUTEXCNT]; |
emilmont | 6:350b53afb889 | 151 | static uint32_t nr_mutex; |
emilmont | 6:350b53afb889 | 152 | |
emilmont | 6:350b53afb889 | 153 | /*--------------------------- _mutex_initialize -----------------------------*/ |
emilmont | 6:350b53afb889 | 154 | |
emilmont | 6:350b53afb889 | 155 | int _mutex_initialize (OS_ID *mutex) { |
emilmont | 6:350b53afb889 | 156 | /* Allocate and initialize a system mutex. */ |
emilmont | 6:350b53afb889 | 157 | |
emilmont | 6:350b53afb889 | 158 | if (nr_mutex >= OS_MUTEXCNT) { |
emilmont | 6:350b53afb889 | 159 | /* If you are here, you need to increase the number OS_MUTEXCNT. */ |
emilmont | 6:350b53afb889 | 160 | for (;;); |
emilmont | 6:350b53afb889 | 161 | } |
emilmont | 6:350b53afb889 | 162 | *mutex = &std_libmutex[nr_mutex++]; |
emilmont | 6:350b53afb889 | 163 | mutex_init (*mutex); |
emilmont | 6:350b53afb889 | 164 | return (1); |
emilmont | 6:350b53afb889 | 165 | } |
emilmont | 6:350b53afb889 | 166 | |
emilmont | 6:350b53afb889 | 167 | |
emilmont | 6:350b53afb889 | 168 | /*--------------------------- _mutex_acquire --------------------------------*/ |
emilmont | 6:350b53afb889 | 169 | |
emilmont | 6:350b53afb889 | 170 | __attribute__((used)) void _mutex_acquire (OS_ID *mutex) { |
emilmont | 6:350b53afb889 | 171 | /* Acquire a system mutex, lock stdlib resources. */ |
emilmont | 6:350b53afb889 | 172 | if (runtask_id ()) { |
emilmont | 6:350b53afb889 | 173 | /* RTX running, acquire a mutex. */ |
emilmont | 6:350b53afb889 | 174 | mutex_wait (*mutex); |
emilmont | 6:350b53afb889 | 175 | } |
emilmont | 6:350b53afb889 | 176 | } |
emilmont | 6:350b53afb889 | 177 | |
emilmont | 6:350b53afb889 | 178 | |
emilmont | 6:350b53afb889 | 179 | /*--------------------------- _mutex_release --------------------------------*/ |
emilmont | 6:350b53afb889 | 180 | |
emilmont | 6:350b53afb889 | 181 | __attribute__((used)) void _mutex_release (OS_ID *mutex) { |
emilmont | 6:350b53afb889 | 182 | /* Release a system mutex, unlock stdlib resources. */ |
emilmont | 6:350b53afb889 | 183 | if (runtask_id ()) { |
emilmont | 6:350b53afb889 | 184 | /* RTX running, release a mutex. */ |
emilmont | 6:350b53afb889 | 185 | mutex_rel (*mutex); |
emilmont | 6:350b53afb889 | 186 | } |
emilmont | 6:350b53afb889 | 187 | } |
emilmont | 6:350b53afb889 | 188 | |
emilmont | 6:350b53afb889 | 189 | #endif |
emilmont | 6:350b53afb889 | 190 | |
emilmont | 6:350b53afb889 | 191 | |
emilmont | 6:350b53afb889 | 192 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 193 | * RTX Startup |
emilmont | 6:350b53afb889 | 194 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 195 | |
emilmont | 6:350b53afb889 | 196 | /* Main Thread definition */ |
emilmont | 6:350b53afb889 | 197 | extern int main (void); |
emilmont | 6:350b53afb889 | 198 | osThreadDef_t os_thread_def_main = {(os_pthread)main, osPriorityNormal, 0, NULL}; |
emilmont | 6:350b53afb889 | 199 | |
emilmont | 6:350b53afb889 | 200 | #if defined (__CC_ARM) |
emilmont | 6:350b53afb889 | 201 | |
emilmont | 6:350b53afb889 | 202 | // This define should be probably moved to the CMSIS layer |
emilmont | 6:350b53afb889 | 203 | #ifdef TARGET_LPC1768 |
emilmont | 6:350b53afb889 | 204 | #define INITIAL_SP (0x10008000UL) |
emilmont | 6:350b53afb889 | 205 | |
emilmont | 6:350b53afb889 | 206 | #elif TARGET_LPC11U24 |
emilmont | 6:350b53afb889 | 207 | #define INITIAL_SP (0x10001000UL) |
emilmont | 6:350b53afb889 | 208 | |
emilmont | 6:350b53afb889 | 209 | #endif |
emilmont | 6:350b53afb889 | 210 | |
emilmont | 6:350b53afb889 | 211 | extern unsigned char Image$$RW_IRAM1$$ZI$$Limit[]; |
emilmont | 6:350b53afb889 | 212 | |
emilmont | 6:350b53afb889 | 213 | void set_main_stack(void) { |
emilmont | 6:350b53afb889 | 214 | // Leave OS_SCHEDULERSTKSIZE words for the scheduler and interrupts |
emilmont | 6:350b53afb889 | 215 | os_thread_def_main.stack_pointer = Image$$RW_IRAM1$$ZI$$Limit; |
emilmont | 6:350b53afb889 | 216 | os_thread_def_main.stacksize = (INITIAL_SP - (unsigned int)Image$$RW_IRAM1$$ZI$$Limit) - (OS_SCHEDULERSTKSIZE * 4); |
emilmont | 6:350b53afb889 | 217 | } |
emilmont | 6:350b53afb889 | 218 | |
emilmont | 6:350b53afb889 | 219 | #ifdef __MICROLIB |
emilmont | 6:350b53afb889 | 220 | void _main_init (void) __attribute__((section(".ARM.Collect$$$$000000FF"))); |
emilmont | 6:350b53afb889 | 221 | void _main_init (void) { |
emilmont | 6:350b53afb889 | 222 | osKernelInitialize(); |
emilmont | 6:350b53afb889 | 223 | set_main_stack(); |
emilmont | 6:350b53afb889 | 224 | osThreadCreate(&os_thread_def_main, NULL); |
emilmont | 6:350b53afb889 | 225 | osKernelStart(); |
emilmont | 6:350b53afb889 | 226 | for (;;); |
emilmont | 6:350b53afb889 | 227 | } |
emilmont | 6:350b53afb889 | 228 | #else |
emilmont | 6:350b53afb889 | 229 | |
emilmont | 6:350b53afb889 | 230 | /* The single memory model is checking for stack collision at run time, verifing |
emilmont | 6:350b53afb889 | 231 | that the heap pointer is underneath the stack pointer. |
emilmont | 6:350b53afb889 | 232 | |
emilmont | 6:350b53afb889 | 233 | With the RTOS there is not only one stack above the heap, there are multiple |
emilmont | 6:350b53afb889 | 234 | stacks and some of them are underneath the heap pointer. |
emilmont | 6:350b53afb889 | 235 | */ |
emilmont | 6:350b53afb889 | 236 | #pragma import(__use_two_region_memory) |
emilmont | 6:350b53afb889 | 237 | |
emilmont | 6:350b53afb889 | 238 | __asm void __rt_entry (void) { |
emilmont | 6:350b53afb889 | 239 | |
emilmont | 6:350b53afb889 | 240 | IMPORT __user_setup_stackheap |
emilmont | 6:350b53afb889 | 241 | IMPORT __rt_lib_init |
emilmont | 6:350b53afb889 | 242 | IMPORT os_thread_def_main |
emilmont | 6:350b53afb889 | 243 | IMPORT osKernelInitialize |
emilmont | 6:350b53afb889 | 244 | IMPORT set_main_stack |
emilmont | 6:350b53afb889 | 245 | IMPORT osKernelStart |
emilmont | 6:350b53afb889 | 246 | IMPORT osThreadCreate |
emilmont | 6:350b53afb889 | 247 | IMPORT exit |
emilmont | 6:350b53afb889 | 248 | |
emilmont | 6:350b53afb889 | 249 | BL __user_setup_stackheap |
emilmont | 6:350b53afb889 | 250 | MOV R1,R2 |
emilmont | 6:350b53afb889 | 251 | BL __rt_lib_init |
emilmont | 6:350b53afb889 | 252 | BL osKernelInitialize |
emilmont | 6:350b53afb889 | 253 | BL set_main_stack |
emilmont | 6:350b53afb889 | 254 | LDR R0,=os_thread_def_main |
emilmont | 6:350b53afb889 | 255 | MOVS R1,#0 |
emilmont | 6:350b53afb889 | 256 | BL osThreadCreate |
emilmont | 6:350b53afb889 | 257 | BL osKernelStart |
emilmont | 6:350b53afb889 | 258 | BL exit |
emilmont | 6:350b53afb889 | 259 | |
emilmont | 6:350b53afb889 | 260 | ALIGN |
emilmont | 6:350b53afb889 | 261 | } |
emilmont | 6:350b53afb889 | 262 | #endif |
emilmont | 6:350b53afb889 | 263 | |
emilmont | 6:350b53afb889 | 264 | #elif defined (__GNUC__) |
emilmont | 6:350b53afb889 | 265 | |
emilmont | 6:350b53afb889 | 266 | #ifdef __CS3__ |
emilmont | 6:350b53afb889 | 267 | |
emilmont | 6:350b53afb889 | 268 | /* CS3 start_c routine. |
emilmont | 6:350b53afb889 | 269 | * |
emilmont | 6:350b53afb889 | 270 | * Copyright (c) 2006, 2007 CodeSourcery Inc |
emilmont | 6:350b53afb889 | 271 | * |
emilmont | 6:350b53afb889 | 272 | * The authors hereby grant permission to use, copy, modify, distribute, |
emilmont | 6:350b53afb889 | 273 | * and license this software and its documentation for any purpose, provided |
emilmont | 6:350b53afb889 | 274 | * that existing copyright notices are retained in all copies and that this |
emilmont | 6:350b53afb889 | 275 | * notice is included verbatim in any distributions. No written agreement, |
emilmont | 6:350b53afb889 | 276 | * license, or royalty fee is required for any of the authorized uses. |
emilmont | 6:350b53afb889 | 277 | * Modifications to this software may be copyrighted by their authors |
emilmont | 6:350b53afb889 | 278 | * and need not follow the licensing terms described here, provided that |
emilmont | 6:350b53afb889 | 279 | * the new terms are clearly indicated on the first page of each file where |
emilmont | 6:350b53afb889 | 280 | * they apply. |
emilmont | 6:350b53afb889 | 281 | */ |
emilmont | 6:350b53afb889 | 282 | |
emilmont | 6:350b53afb889 | 283 | #include "cs3.h" |
emilmont | 6:350b53afb889 | 284 | |
emilmont | 6:350b53afb889 | 285 | extern void __libc_init_array (void); |
emilmont | 6:350b53afb889 | 286 | |
emilmont | 6:350b53afb889 | 287 | __attribute ((noreturn)) void __cs3_start_c (void){ |
emilmont | 6:350b53afb889 | 288 | unsigned regions = __cs3_region_num; |
emilmont | 6:350b53afb889 | 289 | const struct __cs3_region *rptr = __cs3_regions; |
emilmont | 6:350b53afb889 | 290 | |
emilmont | 6:350b53afb889 | 291 | /* Initialize memory */ |
emilmont | 6:350b53afb889 | 292 | for (regions = __cs3_region_num, rptr = __cs3_regions; regions--; rptr++) { |
emilmont | 6:350b53afb889 | 293 | long long *src = (long long *)rptr->init; |
emilmont | 6:350b53afb889 | 294 | long long *dst = (long long *)rptr->data; |
emilmont | 6:350b53afb889 | 295 | unsigned limit = rptr->init_size; |
emilmont | 6:350b53afb889 | 296 | unsigned count; |
emilmont | 6:350b53afb889 | 297 | |
emilmont | 6:350b53afb889 | 298 | if (src != dst) |
emilmont | 6:350b53afb889 | 299 | for (count = 0; count != limit; count += sizeof (long long)) |
emilmont | 6:350b53afb889 | 300 | *dst++ = *src++; |
emilmont | 6:350b53afb889 | 301 | else |
emilmont | 6:350b53afb889 | 302 | dst = (long long *)((char *)dst + limit); |
emilmont | 6:350b53afb889 | 303 | limit = rptr->zero_size; |
emilmont | 6:350b53afb889 | 304 | for (count = 0; count != limit; count += sizeof (long long)) |
emilmont | 6:350b53afb889 | 305 | *dst++ = 0; |
emilmont | 6:350b53afb889 | 306 | } |
emilmont | 6:350b53afb889 | 307 | |
emilmont | 6:350b53afb889 | 308 | /* Run initializers. */ |
emilmont | 6:350b53afb889 | 309 | __libc_init_array (); |
emilmont | 6:350b53afb889 | 310 | |
emilmont | 6:350b53afb889 | 311 | osKernelInitialize(); |
emilmont | 6:350b53afb889 | 312 | osThreadCreate(&os_thread_def_main, NULL); |
emilmont | 6:350b53afb889 | 313 | osKernelStart(); |
emilmont | 6:350b53afb889 | 314 | for (;;); |
emilmont | 6:350b53afb889 | 315 | } |
emilmont | 6:350b53afb889 | 316 | |
emilmont | 6:350b53afb889 | 317 | #else |
emilmont | 6:350b53afb889 | 318 | |
emilmont | 6:350b53afb889 | 319 | __attribute__((naked)) void software_init_hook (void) { |
emilmont | 6:350b53afb889 | 320 | __asm ( |
emilmont | 6:350b53afb889 | 321 | ".syntax unified\n" |
emilmont | 6:350b53afb889 | 322 | ".thumb\n" |
emilmont | 6:350b53afb889 | 323 | "movs r0,#0\n" |
emilmont | 6:350b53afb889 | 324 | "movs r1,#0\n" |
emilmont | 6:350b53afb889 | 325 | "mov r4,r0\n" |
emilmont | 6:350b53afb889 | 326 | "mov r5,r1\n" |
emilmont | 6:350b53afb889 | 327 | "ldr r0,= __libc_fini_array\n" |
emilmont | 6:350b53afb889 | 328 | "bl atexit\n" |
emilmont | 6:350b53afb889 | 329 | "bl __libc_init_array\n" |
emilmont | 6:350b53afb889 | 330 | "mov r0,r4\n" |
emilmont | 6:350b53afb889 | 331 | "mov r1,r5\n" |
emilmont | 6:350b53afb889 | 332 | "bl osKernelInitialize\n" |
emilmont | 6:350b53afb889 | 333 | "ldr r0,=os_thread_def_main\n" |
emilmont | 6:350b53afb889 | 334 | "movs r1,#0\n" |
emilmont | 6:350b53afb889 | 335 | "bl osThreadCreate\n" |
emilmont | 6:350b53afb889 | 336 | "bl osKernelStart\n" |
emilmont | 6:350b53afb889 | 337 | "bl exit\n" |
emilmont | 6:350b53afb889 | 338 | ); |
emilmont | 6:350b53afb889 | 339 | } |
emilmont | 6:350b53afb889 | 340 | |
emilmont | 6:350b53afb889 | 341 | #endif |
emilmont | 6:350b53afb889 | 342 | |
emilmont | 6:350b53afb889 | 343 | #elif defined (__ICCARM__) |
emilmont | 6:350b53afb889 | 344 | |
emilmont | 6:350b53afb889 | 345 | extern int __low_level_init(void); |
emilmont | 6:350b53afb889 | 346 | extern void __iar_data_init3(void); |
emilmont | 6:350b53afb889 | 347 | extern void exit(int arg); |
emilmont | 6:350b53afb889 | 348 | |
emilmont | 6:350b53afb889 | 349 | __noreturn __stackless void __cmain(void) { |
emilmont | 6:350b53afb889 | 350 | int a; |
emilmont | 6:350b53afb889 | 351 | |
emilmont | 6:350b53afb889 | 352 | if (__low_level_init() != 0) { |
emilmont | 6:350b53afb889 | 353 | __iar_data_init3(); |
emilmont | 6:350b53afb889 | 354 | } |
emilmont | 6:350b53afb889 | 355 | osKernelInitialize(); |
emilmont | 6:350b53afb889 | 356 | osThreadCreate(&os_thread_def_main, NULL); |
emilmont | 6:350b53afb889 | 357 | a = osKernelStart(); |
emilmont | 6:350b53afb889 | 358 | exit(a); |
emilmont | 6:350b53afb889 | 359 | } |
emilmont | 6:350b53afb889 | 360 | |
emilmont | 6:350b53afb889 | 361 | #endif |
emilmont | 6:350b53afb889 | 362 | |
emilmont | 6:350b53afb889 | 363 | |
emilmont | 6:350b53afb889 | 364 | /*---------------------------------------------------------------------------- |
emilmont | 6:350b53afb889 | 365 | * end of file |
emilmont | 6:350b53afb889 | 366 | *---------------------------------------------------------------------------*/ |
emilmont | 6:350b53afb889 | 367 |