TeamGyro / mbed-rtos

OS2

Dependents:   GYRO_MPU6050 Bluetooth_Powered_Multimeter_Using_STM32F429_and_RTOS fyp

rtx/TARGET_CORTEX_M/TARGET_M0/TOOLCHAIN_IAR/HAL_CM0.S@0:a7c449cd2d5a, 2020-02-03 (annotated)

Committer:
guilhemMBED
Date:
Mon Feb 03 13:41:14 2020 +0000
Revision:
0:a7c449cd2d5a
previous version;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
guilhemMBED 0:a7c449cd2d5a 1 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 2 * CMSIS-RTOS - RTX
guilhemMBED 0:a7c449cd2d5a 3 *----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 4 * Name: HAL_CM0.S
guilhemMBED 0:a7c449cd2d5a 5 * Purpose: Hardware Abstraction Layer for Cortex-M0
guilhemMBED 0:a7c449cd2d5a 6 * Rev.: V4.70
guilhemMBED 0:a7c449cd2d5a 7 *----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 8 *
guilhemMBED 0:a7c449cd2d5a 9 * Copyright (c) 1999-2009 KEIL, 2009-2013 ARM Germany GmbH
guilhemMBED 0:a7c449cd2d5a 10 * All rights reserved.
guilhemMBED 0:a7c449cd2d5a 11 * Redistribution and use in source and binary forms, with or without
guilhemMBED 0:a7c449cd2d5a 12 * modification, are permitted provided that the following conditions are met:
guilhemMBED 0:a7c449cd2d5a 13 * - Redistributions of source code must retain the above copyright
guilhemMBED 0:a7c449cd2d5a 14 * notice, this list of conditions and the following disclaimer.
guilhemMBED 0:a7c449cd2d5a 15 * - Redistributions in binary form must reproduce the above copyright
guilhemMBED 0:a7c449cd2d5a 16 * notice, this list of conditions and the following disclaimer in the
guilhemMBED 0:a7c449cd2d5a 17 * documentation and/or other materials provided with the distribution.
guilhemMBED 0:a7c449cd2d5a 18 * - Neither the name of ARM nor the names of its contributors may be used
guilhemMBED 0:a7c449cd2d5a 19 * to endorse or promote products derived from this software without
guilhemMBED 0:a7c449cd2d5a 20 * specific prior written permission.
guilhemMBED 0:a7c449cd2d5a 21 *
guilhemMBED 0:a7c449cd2d5a 22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
guilhemMBED 0:a7c449cd2d5a 23 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
guilhemMBED 0:a7c449cd2d5a 24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
guilhemMBED 0:a7c449cd2d5a 25 * ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
guilhemMBED 0:a7c449cd2d5a 26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
guilhemMBED 0:a7c449cd2d5a 27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
guilhemMBED 0:a7c449cd2d5a 28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
guilhemMBED 0:a7c449cd2d5a 29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
guilhemMBED 0:a7c449cd2d5a 30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
guilhemMBED 0:a7c449cd2d5a 31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
guilhemMBED 0:a7c449cd2d5a 32 * POSSIBILITY OF SUCH DAMAGE.
guilhemMBED 0:a7c449cd2d5a 33 *---------------------------------------------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 34
guilhemMBED 0:a7c449cd2d5a 35 NAME HAL_CM0.S
guilhemMBED 0:a7c449cd2d5a 36
guilhemMBED 0:a7c449cd2d5a 37 #define TCB_TSTACK 44
guilhemMBED 0:a7c449cd2d5a 38
guilhemMBED 0:a7c449cd2d5a 39 EXTERN os_flags
guilhemMBED 0:a7c449cd2d5a 40 EXTERN os_tsk
guilhemMBED 0:a7c449cd2d5a 41 EXTERN rt_alloc_box
guilhemMBED 0:a7c449cd2d5a 42 EXTERN rt_free_box
guilhemMBED 0:a7c449cd2d5a 43 EXTERN rt_stk_check
guilhemMBED 0:a7c449cd2d5a 44 EXTERN rt_pop_req
guilhemMBED 0:a7c449cd2d5a 45 EXTERN rt_systick
guilhemMBED 0:a7c449cd2d5a 46 EXTERN os_tick_irqack
guilhemMBED 0:a7c449cd2d5a 47 EXTERN SVC_Table
guilhemMBED 0:a7c449cd2d5a 48 EXTERN SVC_Count
guilhemMBED 0:a7c449cd2d5a 49
guilhemMBED 0:a7c449cd2d5a 50 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 51 * Functions
guilhemMBED 0:a7c449cd2d5a 52 *---------------------------------------------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 53
guilhemMBED 0:a7c449cd2d5a 54 SECTION .text:CODE:NOROOT(2)
guilhemMBED 0:a7c449cd2d5a 55 THUMB
guilhemMBED 0:a7c449cd2d5a 56
guilhemMBED 0:a7c449cd2d5a 57 /*--------------------------- rt_set_PSP ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 58
guilhemMBED 0:a7c449cd2d5a 59 ; void rt_set_PSP (U32 stack);
guilhemMBED 0:a7c449cd2d5a 60
guilhemMBED 0:a7c449cd2d5a 61 PUBLIC rt_set_PSP
guilhemMBED 0:a7c449cd2d5a 62 rt_set_PSP:
guilhemMBED 0:a7c449cd2d5a 63
guilhemMBED 0:a7c449cd2d5a 64 MSR PSP,R0
guilhemMBED 0:a7c449cd2d5a 65 BX LR
guilhemMBED 0:a7c449cd2d5a 66
guilhemMBED 0:a7c449cd2d5a 67
guilhemMBED 0:a7c449cd2d5a 68 /*--------------------------- rt_get_PSP ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 69
guilhemMBED 0:a7c449cd2d5a 70 ; U32 rt_get_PSP (void);
guilhemMBED 0:a7c449cd2d5a 71
guilhemMBED 0:a7c449cd2d5a 72 PUBLIC rt_get_PSP
guilhemMBED 0:a7c449cd2d5a 73 rt_get_PSP:
guilhemMBED 0:a7c449cd2d5a 74
guilhemMBED 0:a7c449cd2d5a 75 MRS R0,PSP
guilhemMBED 0:a7c449cd2d5a 76 BX LR
guilhemMBED 0:a7c449cd2d5a 77
guilhemMBED 0:a7c449cd2d5a 78
guilhemMBED 0:a7c449cd2d5a 79 /*--------------------------- os_set_env ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 80
guilhemMBED 0:a7c449cd2d5a 81 ; void os_set_env (void);
guilhemMBED 0:a7c449cd2d5a 82 /* Switch to Unprivileged/Privileged Thread mode, use PSP. */
guilhemMBED 0:a7c449cd2d5a 83
guilhemMBED 0:a7c449cd2d5a 84 PUBLIC os_set_env
guilhemMBED 0:a7c449cd2d5a 85 os_set_env:
guilhemMBED 0:a7c449cd2d5a 86
guilhemMBED 0:a7c449cd2d5a 87 MOV R0,SP /* PSP = MSP */
guilhemMBED 0:a7c449cd2d5a 88 MSR PSP,R0
guilhemMBED 0:a7c449cd2d5a 89 LDR R0,=os_flags
guilhemMBED 0:a7c449cd2d5a 90 LDRB R0,[R0]
guilhemMBED 0:a7c449cd2d5a 91 LSLS R0,#31
guilhemMBED 0:a7c449cd2d5a 92 BNE PrivilegedE
guilhemMBED 0:a7c449cd2d5a 93 MOVS R0,#0x03 /* Unprivileged Thread mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 94 MSR CONTROL,R0
guilhemMBED 0:a7c449cd2d5a 95 BX LR
guilhemMBED 0:a7c449cd2d5a 96 PrivilegedE:
guilhemMBED 0:a7c449cd2d5a 97 MOVS R0,#0x02 /* Privileged Thread mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 98 MSR CONTROL,R0
guilhemMBED 0:a7c449cd2d5a 99 BX LR
guilhemMBED 0:a7c449cd2d5a 100
guilhemMBED 0:a7c449cd2d5a 101
guilhemMBED 0:a7c449cd2d5a 102 /*--------------------------- _alloc_box ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 103
guilhemMBED 0:a7c449cd2d5a 104 ; void *_alloc_box (void *box_mem);
guilhemMBED 0:a7c449cd2d5a 105 /* Function wrapper for Unprivileged/Privileged mode. */
guilhemMBED 0:a7c449cd2d5a 106
guilhemMBED 0:a7c449cd2d5a 107 PUBLIC _alloc_box
guilhemMBED 0:a7c449cd2d5a 108 _alloc_box:
guilhemMBED 0:a7c449cd2d5a 109
guilhemMBED 0:a7c449cd2d5a 110 LDR R3,=rt_alloc_box
guilhemMBED 0:a7c449cd2d5a 111 MOV R12,R3
guilhemMBED 0:a7c449cd2d5a 112 MRS R3,IPSR
guilhemMBED 0:a7c449cd2d5a 113 LSLS R3,#24
guilhemMBED 0:a7c449cd2d5a 114 BNE PrivilegedA
guilhemMBED 0:a7c449cd2d5a 115 MRS R3,CONTROL
guilhemMBED 0:a7c449cd2d5a 116 LSLS R3,#31
guilhemMBED 0:a7c449cd2d5a 117 BEQ PrivilegedA
guilhemMBED 0:a7c449cd2d5a 118 SVC 0
guilhemMBED 0:a7c449cd2d5a 119 BX LR
guilhemMBED 0:a7c449cd2d5a 120 PrivilegedA:
guilhemMBED 0:a7c449cd2d5a 121 BX R12
guilhemMBED 0:a7c449cd2d5a 122
guilhemMBED 0:a7c449cd2d5a 123
guilhemMBED 0:a7c449cd2d5a 124 /*--------------------------- _free_box -------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 125
guilhemMBED 0:a7c449cd2d5a 126 ; U32 _free_box (void *box_mem, void *box);
guilhemMBED 0:a7c449cd2d5a 127 /* Function wrapper for Unprivileged/Privileged mode. */
guilhemMBED 0:a7c449cd2d5a 128
guilhemMBED 0:a7c449cd2d5a 129 PUBLIC _free_box
guilhemMBED 0:a7c449cd2d5a 130 _free_box:
guilhemMBED 0:a7c449cd2d5a 131
guilhemMBED 0:a7c449cd2d5a 132 LDR R3,=rt_free_box
guilhemMBED 0:a7c449cd2d5a 133 MOV R12,R3
guilhemMBED 0:a7c449cd2d5a 134 MRS R3,IPSR
guilhemMBED 0:a7c449cd2d5a 135 LSLS R3,#24
guilhemMBED 0:a7c449cd2d5a 136 BNE PrivilegedF
guilhemMBED 0:a7c449cd2d5a 137 MRS R3,CONTROL
guilhemMBED 0:a7c449cd2d5a 138 LSLS R3,#31
guilhemMBED 0:a7c449cd2d5a 139 BEQ PrivilegedF
guilhemMBED 0:a7c449cd2d5a 140 SVC 0
guilhemMBED 0:a7c449cd2d5a 141 BX LR
guilhemMBED 0:a7c449cd2d5a 142 PrivilegedF:
guilhemMBED 0:a7c449cd2d5a 143 BX R12
guilhemMBED 0:a7c449cd2d5a 144
guilhemMBED 0:a7c449cd2d5a 145
guilhemMBED 0:a7c449cd2d5a 146 /*-------------------------- SVC_Handler ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 147
guilhemMBED 0:a7c449cd2d5a 148 ; void SVC_Handler (void);
guilhemMBED 0:a7c449cd2d5a 149
guilhemMBED 0:a7c449cd2d5a 150 PUBLIC SVC_Handler
guilhemMBED 0:a7c449cd2d5a 151 SVC_Handler:
guilhemMBED 0:a7c449cd2d5a 152
guilhemMBED 0:a7c449cd2d5a 153 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 154 LDR R1,[R0,#24] /* Read Saved PC from Stack */
guilhemMBED 0:a7c449cd2d5a 155 SUBS R1,R1,#2 /* Point to SVC Instruction */
guilhemMBED 0:a7c449cd2d5a 156 LDRB R1,[R1] /* Load SVC Number */
guilhemMBED 0:a7c449cd2d5a 157 CMP R1,#0
guilhemMBED 0:a7c449cd2d5a 158 BNE SVC_User /* User SVC Number > 0 */
guilhemMBED 0:a7c449cd2d5a 159
guilhemMBED 0:a7c449cd2d5a 160 MOV LR,R4
guilhemMBED 0:a7c449cd2d5a 161 LDMIA R0,{R0-R3,R4} /* Read R0-R3,R12 from stack */
guilhemMBED 0:a7c449cd2d5a 162 MOV R12,R4
guilhemMBED 0:a7c449cd2d5a 163 MOV R4,LR
guilhemMBED 0:a7c449cd2d5a 164 BLX R12 /* Call SVC Function */
guilhemMBED 0:a7c449cd2d5a 165
guilhemMBED 0:a7c449cd2d5a 166 MRS R3,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 167 STMIA R3!,{R0-R2} /* Store return values */
guilhemMBED 0:a7c449cd2d5a 168
guilhemMBED 0:a7c449cd2d5a 169 LDR R3,=os_tsk
guilhemMBED 0:a7c449cd2d5a 170 LDMIA R3!,{R1,R2} /* os_tsk.run, os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 171 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 172 BEQ SVC_Exit /* no task switch */
guilhemMBED 0:a7c449cd2d5a 173
guilhemMBED 0:a7c449cd2d5a 174 SUBS R3,#8
guilhemMBED 0:a7c449cd2d5a 175 CMP R1,#0 /* Runtask deleted? */
guilhemMBED 0:a7c449cd2d5a 176 BEQ SVC_Next
guilhemMBED 0:a7c449cd2d5a 177
guilhemMBED 0:a7c449cd2d5a 178 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 179 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 180 STR R0,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 181 STMIA R0!,{R4-R7} /* Save old context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 182 MOV R4,R8
guilhemMBED 0:a7c449cd2d5a 183 MOV R5,R9
guilhemMBED 0:a7c449cd2d5a 184 MOV R6,R10
guilhemMBED 0:a7c449cd2d5a 185 MOV R7,R11
guilhemMBED 0:a7c449cd2d5a 186 STMIA R0!,{R4-R7} /* Save old context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 187
guilhemMBED 0:a7c449cd2d5a 188 PUSH {R2,R3}
guilhemMBED 0:a7c449cd2d5a 189 BL rt_stk_check /* Check for Stack overflow */
guilhemMBED 0:a7c449cd2d5a 190 POP {R2,R3}
guilhemMBED 0:a7c449cd2d5a 191
guilhemMBED 0:a7c449cd2d5a 192 SVC_Next:
guilhemMBED 0:a7c449cd2d5a 193 STR R2,[R3] /* os_tsk.run = os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 194
guilhemMBED 0:a7c449cd2d5a 195 LDR R0,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 196 ADDS R0,R0,#16 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 197 LDMIA R0!,{R4-R7} /* Restore new Context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 198 MOV R8,R4
guilhemMBED 0:a7c449cd2d5a 199 MOV R9,R5
guilhemMBED 0:a7c449cd2d5a 200 MOV R10,R6
guilhemMBED 0:a7c449cd2d5a 201 MOV R11,R7
guilhemMBED 0:a7c449cd2d5a 202 MSR PSP,R0 /* Write PSP */
guilhemMBED 0:a7c449cd2d5a 203 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 204 LDMIA R0!,{R4-R7} /* Restore new Context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 205
guilhemMBED 0:a7c449cd2d5a 206 SVC_Exit:
guilhemMBED 0:a7c449cd2d5a 207 MOVS R0,#~0xFFFFFFFD /* Set EXC_RETURN value */
guilhemMBED 0:a7c449cd2d5a 208 MVNS R0,R0
guilhemMBED 0:a7c449cd2d5a 209 BX R0 /* RETI to Thread Mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 210
guilhemMBED 0:a7c449cd2d5a 211 /*------------------- User SVC ------------------------------*/
guilhemMBED 0:a7c449cd2d5a 212
guilhemMBED 0:a7c449cd2d5a 213 SVC_User:
guilhemMBED 0:a7c449cd2d5a 214 PUSH {R4,LR} /* Save Registers */
guilhemMBED 0:a7c449cd2d5a 215 LDR R2,=SVC_Count
guilhemMBED 0:a7c449cd2d5a 216 LDR R2,[R2]
guilhemMBED 0:a7c449cd2d5a 217 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 218 BHI SVC_Done /* Overflow */
guilhemMBED 0:a7c449cd2d5a 219
guilhemMBED 0:a7c449cd2d5a 220 LDR R4,=SVC_Table-4
guilhemMBED 0:a7c449cd2d5a 221 LSLS R1,R1,#2
guilhemMBED 0:a7c449cd2d5a 222 LDR R4,[R4,R1] /* Load SVC Function Address */
guilhemMBED 0:a7c449cd2d5a 223 MOV LR,R4
guilhemMBED 0:a7c449cd2d5a 224
guilhemMBED 0:a7c449cd2d5a 225 LDMIA R0,{R0-R3,R4} /* Read R0-R3,R12 from stack */
guilhemMBED 0:a7c449cd2d5a 226 MOV R12,R4
guilhemMBED 0:a7c449cd2d5a 227 BLX LR /* Call SVC Function */
guilhemMBED 0:a7c449cd2d5a 228
guilhemMBED 0:a7c449cd2d5a 229 MRS R4,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 230 STMIA R4!,{R0-R3} /* Function return values */
guilhemMBED 0:a7c449cd2d5a 231 SVC_Done:
guilhemMBED 0:a7c449cd2d5a 232 POP {R4,PC} /* RETI */
guilhemMBED 0:a7c449cd2d5a 233
guilhemMBED 0:a7c449cd2d5a 234
guilhemMBED 0:a7c449cd2d5a 235 /*-------------------------- PendSV_Handler ---------------------------------*/
guilhemMBED 0:a7c449cd2d5a 236
guilhemMBED 0:a7c449cd2d5a 237 ; void PendSV_Handler (void);
guilhemMBED 0:a7c449cd2d5a 238
guilhemMBED 0:a7c449cd2d5a 239 PUBLIC PendSV_Handler
guilhemMBED 0:a7c449cd2d5a 240 PendSV_Handler:
guilhemMBED 0:a7c449cd2d5a 241
guilhemMBED 0:a7c449cd2d5a 242 BL rt_pop_req
guilhemMBED 0:a7c449cd2d5a 243
guilhemMBED 0:a7c449cd2d5a 244 Sys_Switch:
guilhemMBED 0:a7c449cd2d5a 245 LDR R3,=os_tsk
guilhemMBED 0:a7c449cd2d5a 246 LDMIA R3!,{R1,R2} /* os_tsk.run, os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 247 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 248 BEQ Sys_Exit /* no task switch */
guilhemMBED 0:a7c449cd2d5a 249
guilhemMBED 0:a7c449cd2d5a 250 SUBS R3,#8
guilhemMBED 0:a7c449cd2d5a 251
guilhemMBED 0:a7c449cd2d5a 252 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 253 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 254 STR R0,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 255 STMIA R0!,{R4-R7} /* Save old context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 256 MOV R4,R8
guilhemMBED 0:a7c449cd2d5a 257 MOV R5,R9
guilhemMBED 0:a7c449cd2d5a 258 MOV R6,R10
guilhemMBED 0:a7c449cd2d5a 259 MOV R7,R11
guilhemMBED 0:a7c449cd2d5a 260 STMIA R0!,{R4-R7} /* Save old context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 261
guilhemMBED 0:a7c449cd2d5a 262 PUSH {R2,R3}
guilhemMBED 0:a7c449cd2d5a 263 BL rt_stk_check /* Check for Stack overflow */
guilhemMBED 0:a7c449cd2d5a 264 POP {R2,R3}
guilhemMBED 0:a7c449cd2d5a 265
guilhemMBED 0:a7c449cd2d5a 266 STR R2,[R3] /* os_tsk.run = os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 267
guilhemMBED 0:a7c449cd2d5a 268 LDR R0,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 269 ADDS R0,R0,#16 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 270 LDMIA R0!,{R4-R7} /* Restore new Context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 271 MOV R8,R4
guilhemMBED 0:a7c449cd2d5a 272 MOV R9,R5
guilhemMBED 0:a7c449cd2d5a 273 MOV R10,R6
guilhemMBED 0:a7c449cd2d5a 274 MOV R11,R7
guilhemMBED 0:a7c449cd2d5a 275 MSR PSP,R0 /* Write PSP */
guilhemMBED 0:a7c449cd2d5a 276 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 277 LDMIA R0!,{R4-R7} /* Restore new Context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 278
guilhemMBED 0:a7c449cd2d5a 279 Sys_Exit:
guilhemMBED 0:a7c449cd2d5a 280 MOVS R0,#~0xFFFFFFFD /* Set EXC_RETURN value */
guilhemMBED 0:a7c449cd2d5a 281 MVNS R0,R0
guilhemMBED 0:a7c449cd2d5a 282 BX R0 /* RETI to Thread Mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 283
guilhemMBED 0:a7c449cd2d5a 284
guilhemMBED 0:a7c449cd2d5a 285 /*-------------------------- SysTick_Handler --------------------------------*/
guilhemMBED 0:a7c449cd2d5a 286
guilhemMBED 0:a7c449cd2d5a 287 ; void SysTick_Handler (void);
guilhemMBED 0:a7c449cd2d5a 288
guilhemMBED 0:a7c449cd2d5a 289 PUBLIC SysTick_Handler
guilhemMBED 0:a7c449cd2d5a 290 SysTick_Handler:
guilhemMBED 0:a7c449cd2d5a 291
guilhemMBED 0:a7c449cd2d5a 292 BL rt_systick
guilhemMBED 0:a7c449cd2d5a 293 B Sys_Switch
guilhemMBED 0:a7c449cd2d5a 294
guilhemMBED 0:a7c449cd2d5a 295
guilhemMBED 0:a7c449cd2d5a 296 /*-------------------------- OS_Tick_Handler --------------------------------*/
guilhemMBED 0:a7c449cd2d5a 297
guilhemMBED 0:a7c449cd2d5a 298 ; void OS_Tick_Handler (void);
guilhemMBED 0:a7c449cd2d5a 299
guilhemMBED 0:a7c449cd2d5a 300 PUBLIC OS_Tick_Handler
guilhemMBED 0:a7c449cd2d5a 301 OS_Tick_Handler:
guilhemMBED 0:a7c449cd2d5a 302
guilhemMBED 0:a7c449cd2d5a 303 BL os_tick_irqack
guilhemMBED 0:a7c449cd2d5a 304 BL rt_systick
guilhemMBED 0:a7c449cd2d5a 305 B Sys_Switch
guilhemMBED 0:a7c449cd2d5a 306
guilhemMBED 0:a7c449cd2d5a 307
guilhemMBED 0:a7c449cd2d5a 308 END
guilhemMBED 0:a7c449cd2d5a 309
guilhemMBED 0:a7c449cd2d5a 310 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 311 * end of file
guilhemMBED 0:a7c449cd2d5a 312 *---------------------------------------------------------------------------*/