TeamGyro / mbed-rtos

OS2

Dependents:   GYRO_MPU6050 Bluetooth_Powered_Multimeter_Using_STM32F429_and_RTOS fyp

rtx/TARGET_CORTEX_M/TARGET_M0/TOOLCHAIN_GCC/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 .file "HAL_CM0.S"
guilhemMBED 0:a7c449cd2d5a 36 .syntax unified
guilhemMBED 0:a7c449cd2d5a 37
guilhemMBED 0:a7c449cd2d5a 38 .equ TCB_TSTACK, 44
guilhemMBED 0:a7c449cd2d5a 39
guilhemMBED 0:a7c449cd2d5a 40
guilhemMBED 0:a7c449cd2d5a 41 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 42 * Functions
guilhemMBED 0:a7c449cd2d5a 43 *---------------------------------------------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 44
guilhemMBED 0:a7c449cd2d5a 45 .thumb
guilhemMBED 0:a7c449cd2d5a 46
guilhemMBED 0:a7c449cd2d5a 47 .section ".text"
guilhemMBED 0:a7c449cd2d5a 48 .align 2
guilhemMBED 0:a7c449cd2d5a 49
guilhemMBED 0:a7c449cd2d5a 50
guilhemMBED 0:a7c449cd2d5a 51 /*--------------------------- rt_set_PSP ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 52
guilhemMBED 0:a7c449cd2d5a 53 # void rt_set_PSP (U32 stack);
guilhemMBED 0:a7c449cd2d5a 54
guilhemMBED 0:a7c449cd2d5a 55 .thumb_func
guilhemMBED 0:a7c449cd2d5a 56 .type rt_set_PSP, %function
guilhemMBED 0:a7c449cd2d5a 57 .global rt_set_PSP
guilhemMBED 0:a7c449cd2d5a 58 rt_set_PSP:
guilhemMBED 0:a7c449cd2d5a 59 .fnstart
guilhemMBED 0:a7c449cd2d5a 60 .cantunwind
guilhemMBED 0:a7c449cd2d5a 61
guilhemMBED 0:a7c449cd2d5a 62 MSR PSP,R0
guilhemMBED 0:a7c449cd2d5a 63 BX LR
guilhemMBED 0:a7c449cd2d5a 64
guilhemMBED 0:a7c449cd2d5a 65 .fnend
guilhemMBED 0:a7c449cd2d5a 66 .size rt_set_PSP, .-rt_set_PSP
guilhemMBED 0:a7c449cd2d5a 67
guilhemMBED 0:a7c449cd2d5a 68
guilhemMBED 0:a7c449cd2d5a 69 /*--------------------------- rt_get_PSP ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 70
guilhemMBED 0:a7c449cd2d5a 71 # U32 rt_get_PSP (void);
guilhemMBED 0:a7c449cd2d5a 72
guilhemMBED 0:a7c449cd2d5a 73 .thumb_func
guilhemMBED 0:a7c449cd2d5a 74 .type rt_get_PSP, %function
guilhemMBED 0:a7c449cd2d5a 75 .global rt_get_PSP
guilhemMBED 0:a7c449cd2d5a 76 rt_get_PSP:
guilhemMBED 0:a7c449cd2d5a 77 .fnstart
guilhemMBED 0:a7c449cd2d5a 78 .cantunwind
guilhemMBED 0:a7c449cd2d5a 79
guilhemMBED 0:a7c449cd2d5a 80 MRS R0,PSP
guilhemMBED 0:a7c449cd2d5a 81 BX LR
guilhemMBED 0:a7c449cd2d5a 82
guilhemMBED 0:a7c449cd2d5a 83 .fnend
guilhemMBED 0:a7c449cd2d5a 84 .size rt_get_PSP, .-rt_get_PSP
guilhemMBED 0:a7c449cd2d5a 85
guilhemMBED 0:a7c449cd2d5a 86
guilhemMBED 0:a7c449cd2d5a 87 /*--------------------------- os_set_env ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 88
guilhemMBED 0:a7c449cd2d5a 89 # void os_set_env (void);
guilhemMBED 0:a7c449cd2d5a 90 /* Switch to Unprivileged/Privileged Thread mode, use PSP. */
guilhemMBED 0:a7c449cd2d5a 91
guilhemMBED 0:a7c449cd2d5a 92 .thumb_func
guilhemMBED 0:a7c449cd2d5a 93 .type os_set_env, %function
guilhemMBED 0:a7c449cd2d5a 94 .global os_set_env
guilhemMBED 0:a7c449cd2d5a 95 os_set_env:
guilhemMBED 0:a7c449cd2d5a 96 .fnstart
guilhemMBED 0:a7c449cd2d5a 97 .cantunwind
guilhemMBED 0:a7c449cd2d5a 98
guilhemMBED 0:a7c449cd2d5a 99 MOV R0,SP /* PSP = MSP */
guilhemMBED 0:a7c449cd2d5a 100 MSR PSP,R0
guilhemMBED 0:a7c449cd2d5a 101 LDR R0,=os_flags
guilhemMBED 0:a7c449cd2d5a 102 LDRB R0,[R0]
guilhemMBED 0:a7c449cd2d5a 103 LSLS R0,#31
guilhemMBED 0:a7c449cd2d5a 104 BNE PrivilegedE
guilhemMBED 0:a7c449cd2d5a 105 MOVS R0,#0x03 /* Unprivileged Thread mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 106 MSR CONTROL,R0
guilhemMBED 0:a7c449cd2d5a 107 BX LR
guilhemMBED 0:a7c449cd2d5a 108 PrivilegedE:
guilhemMBED 0:a7c449cd2d5a 109 MOVS R0,#0x02 /* Privileged Thread mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 110 MSR CONTROL,R0
guilhemMBED 0:a7c449cd2d5a 111 BX LR
guilhemMBED 0:a7c449cd2d5a 112
guilhemMBED 0:a7c449cd2d5a 113 .fnend
guilhemMBED 0:a7c449cd2d5a 114 .size os_set_env, .-os_set_env
guilhemMBED 0:a7c449cd2d5a 115
guilhemMBED 0:a7c449cd2d5a 116
guilhemMBED 0:a7c449cd2d5a 117 /*--------------------------- _alloc_box ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 118
guilhemMBED 0:a7c449cd2d5a 119 # void *_alloc_box (void *box_mem);
guilhemMBED 0:a7c449cd2d5a 120 /* Function wrapper for Unprivileged/Privileged mode. */
guilhemMBED 0:a7c449cd2d5a 121
guilhemMBED 0:a7c449cd2d5a 122 .thumb_func
guilhemMBED 0:a7c449cd2d5a 123 .type _alloc_box, %function
guilhemMBED 0:a7c449cd2d5a 124 .global _alloc_box
guilhemMBED 0:a7c449cd2d5a 125 _alloc_box:
guilhemMBED 0:a7c449cd2d5a 126 .fnstart
guilhemMBED 0:a7c449cd2d5a 127 .cantunwind
guilhemMBED 0:a7c449cd2d5a 128
guilhemMBED 0:a7c449cd2d5a 129 LDR R3,=rt_alloc_box
guilhemMBED 0:a7c449cd2d5a 130 MOV R12,R3
guilhemMBED 0:a7c449cd2d5a 131 MRS R3,IPSR
guilhemMBED 0:a7c449cd2d5a 132 LSLS R3,#24
guilhemMBED 0:a7c449cd2d5a 133 BNE PrivilegedA
guilhemMBED 0:a7c449cd2d5a 134 MRS R3,CONTROL
guilhemMBED 0:a7c449cd2d5a 135 LSLS R3,#31
guilhemMBED 0:a7c449cd2d5a 136 BEQ PrivilegedA
guilhemMBED 0:a7c449cd2d5a 137 SVC 0
guilhemMBED 0:a7c449cd2d5a 138 BX LR
guilhemMBED 0:a7c449cd2d5a 139 PrivilegedA:
guilhemMBED 0:a7c449cd2d5a 140 BX R12
guilhemMBED 0:a7c449cd2d5a 141
guilhemMBED 0:a7c449cd2d5a 142 .fnend
guilhemMBED 0:a7c449cd2d5a 143 .size _alloc_box, .-_alloc_box
guilhemMBED 0:a7c449cd2d5a 144
guilhemMBED 0:a7c449cd2d5a 145
guilhemMBED 0:a7c449cd2d5a 146 /*--------------------------- _free_box -------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 147
guilhemMBED 0:a7c449cd2d5a 148 # U32 _free_box (void *box_mem, void *box);
guilhemMBED 0:a7c449cd2d5a 149 /* Function wrapper for Unprivileged/Privileged mode. */
guilhemMBED 0:a7c449cd2d5a 150
guilhemMBED 0:a7c449cd2d5a 151 .thumb_func
guilhemMBED 0:a7c449cd2d5a 152 .type _free_box, %function
guilhemMBED 0:a7c449cd2d5a 153 .global _free_box
guilhemMBED 0:a7c449cd2d5a 154 _free_box:
guilhemMBED 0:a7c449cd2d5a 155 .fnstart
guilhemMBED 0:a7c449cd2d5a 156 .cantunwind
guilhemMBED 0:a7c449cd2d5a 157
guilhemMBED 0:a7c449cd2d5a 158 LDR R3,=rt_free_box
guilhemMBED 0:a7c449cd2d5a 159 MOV R12,R3
guilhemMBED 0:a7c449cd2d5a 160 MRS R3,IPSR
guilhemMBED 0:a7c449cd2d5a 161 LSLS R3,#24
guilhemMBED 0:a7c449cd2d5a 162 BNE PrivilegedF
guilhemMBED 0:a7c449cd2d5a 163 MRS R3,CONTROL
guilhemMBED 0:a7c449cd2d5a 164 LSLS R3,#31
guilhemMBED 0:a7c449cd2d5a 165 BEQ PrivilegedF
guilhemMBED 0:a7c449cd2d5a 166 SVC 0
guilhemMBED 0:a7c449cd2d5a 167 BX LR
guilhemMBED 0:a7c449cd2d5a 168 PrivilegedF:
guilhemMBED 0:a7c449cd2d5a 169 BX R12
guilhemMBED 0:a7c449cd2d5a 170
guilhemMBED 0:a7c449cd2d5a 171 .fnend
guilhemMBED 0:a7c449cd2d5a 172 .size _free_box, .-_free_box
guilhemMBED 0:a7c449cd2d5a 173
guilhemMBED 0:a7c449cd2d5a 174
guilhemMBED 0:a7c449cd2d5a 175 /*-------------------------- SVC_Handler ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 176
guilhemMBED 0:a7c449cd2d5a 177 # void SVC_Handler (void);
guilhemMBED 0:a7c449cd2d5a 178
guilhemMBED 0:a7c449cd2d5a 179 .thumb_func
guilhemMBED 0:a7c449cd2d5a 180 .type SVC_Handler, %function
guilhemMBED 0:a7c449cd2d5a 181 .global SVC_Handler
guilhemMBED 0:a7c449cd2d5a 182 SVC_Handler:
guilhemMBED 0:a7c449cd2d5a 183 .fnstart
guilhemMBED 0:a7c449cd2d5a 184 .cantunwind
guilhemMBED 0:a7c449cd2d5a 185
guilhemMBED 0:a7c449cd2d5a 186 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 187 LDR R1,[R0,#24] /* Read Saved PC from Stack */
guilhemMBED 0:a7c449cd2d5a 188 SUBS R1,R1,#2 /* Point to SVC Instruction */
guilhemMBED 0:a7c449cd2d5a 189 LDRB R1,[R1] /* Load SVC Number */
guilhemMBED 0:a7c449cd2d5a 190 CMP R1,#0
guilhemMBED 0:a7c449cd2d5a 191 BNE SVC_User /* User SVC Number > 0 */
guilhemMBED 0:a7c449cd2d5a 192
guilhemMBED 0:a7c449cd2d5a 193 MOV LR,R4
guilhemMBED 0:a7c449cd2d5a 194 LDMIA R0,{R0-R3,R4} /* Read R0-R3,R12 from stack */
guilhemMBED 0:a7c449cd2d5a 195 MOV R12,R4
guilhemMBED 0:a7c449cd2d5a 196 MOV R4,LR
guilhemMBED 0:a7c449cd2d5a 197 BLX R12 /* Call SVC Function */
guilhemMBED 0:a7c449cd2d5a 198
guilhemMBED 0:a7c449cd2d5a 199 MRS R3,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 200 STMIA R3!,{R0-R2} /* Store return values */
guilhemMBED 0:a7c449cd2d5a 201
guilhemMBED 0:a7c449cd2d5a 202 LDR R3,=os_tsk
guilhemMBED 0:a7c449cd2d5a 203 LDMIA R3!,{R1,R2} /* os_tsk.run, os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 204 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 205 BEQ SVC_Exit /* no task switch */
guilhemMBED 0:a7c449cd2d5a 206
guilhemMBED 0:a7c449cd2d5a 207 SUBS R3,#8
guilhemMBED 0:a7c449cd2d5a 208 CMP R1,#0 /* Runtask deleted? */
guilhemMBED 0:a7c449cd2d5a 209 BEQ SVC_Next
guilhemMBED 0:a7c449cd2d5a 210
guilhemMBED 0:a7c449cd2d5a 211 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 212 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 213 STR R0,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 214 STMIA R0!,{R4-R7} /* Save old context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 215 MOV R4,R8
guilhemMBED 0:a7c449cd2d5a 216 MOV R5,R9
guilhemMBED 0:a7c449cd2d5a 217 MOV R6,R10
guilhemMBED 0:a7c449cd2d5a 218 MOV R7,R11
guilhemMBED 0:a7c449cd2d5a 219 STMIA R0!,{R4-R7} /* Save old context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 220
guilhemMBED 0:a7c449cd2d5a 221 PUSH {R2,R3}
guilhemMBED 0:a7c449cd2d5a 222 BL rt_stk_check /* Check for Stack overflow */
guilhemMBED 0:a7c449cd2d5a 223 POP {R2,R3}
guilhemMBED 0:a7c449cd2d5a 224
guilhemMBED 0:a7c449cd2d5a 225 SVC_Next:
guilhemMBED 0:a7c449cd2d5a 226 STR R2,[R3] /* os_tsk.run = os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 227
guilhemMBED 0:a7c449cd2d5a 228 LDR R0,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 229 ADDS R0,R0,#16 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 230 LDMIA R0!,{R4-R7} /* Restore new Context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 231 MOV R8,R4
guilhemMBED 0:a7c449cd2d5a 232 MOV R9,R5
guilhemMBED 0:a7c449cd2d5a 233 MOV R10,R6
guilhemMBED 0:a7c449cd2d5a 234 MOV R11,R7
guilhemMBED 0:a7c449cd2d5a 235 MSR PSP,R0 /* Write PSP */
guilhemMBED 0:a7c449cd2d5a 236 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 237 LDMIA R0!,{R4-R7} /* Restore new Context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 238
guilhemMBED 0:a7c449cd2d5a 239 SVC_Exit:
guilhemMBED 0:a7c449cd2d5a 240 MOVS R0,#~0xFFFFFFFD /* Set EXC_RETURN value */
guilhemMBED 0:a7c449cd2d5a 241 MVNS R0,R0
guilhemMBED 0:a7c449cd2d5a 242 BX R0 /* RETI to Thread Mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 243
guilhemMBED 0:a7c449cd2d5a 244 /*------------------- User SVC ------------------------------*/
guilhemMBED 0:a7c449cd2d5a 245
guilhemMBED 0:a7c449cd2d5a 246 SVC_User:
guilhemMBED 0:a7c449cd2d5a 247 PUSH {R4,LR} /* Save Registers */
guilhemMBED 0:a7c449cd2d5a 248 LDR R2,=SVC_Count
guilhemMBED 0:a7c449cd2d5a 249 LDR R2,[R2]
guilhemMBED 0:a7c449cd2d5a 250 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 251 BHI SVC_Done /* Overflow */
guilhemMBED 0:a7c449cd2d5a 252
guilhemMBED 0:a7c449cd2d5a 253 LDR R4,=SVC_Table-4
guilhemMBED 0:a7c449cd2d5a 254 LSLS R1,R1,#2
guilhemMBED 0:a7c449cd2d5a 255 LDR R4,[R4,R1] /* Load SVC Function Address */
guilhemMBED 0:a7c449cd2d5a 256 MOV LR,R4
guilhemMBED 0:a7c449cd2d5a 257
guilhemMBED 0:a7c449cd2d5a 258 LDMIA R0,{R0-R3,R4} /* Read R0-R3,R12 from stack */
guilhemMBED 0:a7c449cd2d5a 259 MOV R12,R4
guilhemMBED 0:a7c449cd2d5a 260 BLX LR /* Call SVC Function */
guilhemMBED 0:a7c449cd2d5a 261
guilhemMBED 0:a7c449cd2d5a 262 MRS R4,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 263 STMIA R4!,{R0-R3} /* Function return values */
guilhemMBED 0:a7c449cd2d5a 264 SVC_Done:
guilhemMBED 0:a7c449cd2d5a 265 POP {R4,PC} /* RETI */
guilhemMBED 0:a7c449cd2d5a 266
guilhemMBED 0:a7c449cd2d5a 267 .fnend
guilhemMBED 0:a7c449cd2d5a 268 .size SVC_Handler, .-SVC_Handler
guilhemMBED 0:a7c449cd2d5a 269
guilhemMBED 0:a7c449cd2d5a 270
guilhemMBED 0:a7c449cd2d5a 271 /*-------------------------- PendSV_Handler ---------------------------------*/
guilhemMBED 0:a7c449cd2d5a 272
guilhemMBED 0:a7c449cd2d5a 273 # void PendSV_Handler (void);
guilhemMBED 0:a7c449cd2d5a 274
guilhemMBED 0:a7c449cd2d5a 275 .thumb_func
guilhemMBED 0:a7c449cd2d5a 276 .type PendSV_Handler, %function
guilhemMBED 0:a7c449cd2d5a 277 .global PendSV_Handler
guilhemMBED 0:a7c449cd2d5a 278 .global Sys_Switch
guilhemMBED 0:a7c449cd2d5a 279 PendSV_Handler:
guilhemMBED 0:a7c449cd2d5a 280 .fnstart
guilhemMBED 0:a7c449cd2d5a 281 .cantunwind
guilhemMBED 0:a7c449cd2d5a 282
guilhemMBED 0:a7c449cd2d5a 283 BL rt_pop_req
guilhemMBED 0:a7c449cd2d5a 284
guilhemMBED 0:a7c449cd2d5a 285 Sys_Switch:
guilhemMBED 0:a7c449cd2d5a 286 LDR R3,=os_tsk
guilhemMBED 0:a7c449cd2d5a 287 LDMIA R3!,{R1,R2} /* os_tsk.run, os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 288 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 289 BEQ Sys_Exit /* no task switch */
guilhemMBED 0:a7c449cd2d5a 290
guilhemMBED 0:a7c449cd2d5a 291 SUBS R3,#8
guilhemMBED 0:a7c449cd2d5a 292
guilhemMBED 0:a7c449cd2d5a 293 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 294 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 295 STR R0,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 296 STMIA R0!,{R4-R7} /* Save old context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 297 MOV R4,R8
guilhemMBED 0:a7c449cd2d5a 298 MOV R5,R9
guilhemMBED 0:a7c449cd2d5a 299 MOV R6,R10
guilhemMBED 0:a7c449cd2d5a 300 MOV R7,R11
guilhemMBED 0:a7c449cd2d5a 301 STMIA R0!,{R4-R7} /* Save old context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 302
guilhemMBED 0:a7c449cd2d5a 303 PUSH {R2,R3}
guilhemMBED 0:a7c449cd2d5a 304 BL rt_stk_check /* Check for Stack overflow */
guilhemMBED 0:a7c449cd2d5a 305 POP {R2,R3}
guilhemMBED 0:a7c449cd2d5a 306
guilhemMBED 0:a7c449cd2d5a 307 STR R2,[R3] /* os_tsk.run = os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 308
guilhemMBED 0:a7c449cd2d5a 309 LDR R0,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 310 ADDS R0,R0,#16 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 311 LDMIA R0!,{R4-R7} /* Restore new Context (R8-R11) */
guilhemMBED 0:a7c449cd2d5a 312 MOV R8,R4
guilhemMBED 0:a7c449cd2d5a 313 MOV R9,R5
guilhemMBED 0:a7c449cd2d5a 314 MOV R10,R6
guilhemMBED 0:a7c449cd2d5a 315 MOV R11,R7
guilhemMBED 0:a7c449cd2d5a 316 MSR PSP,R0 /* Write PSP */
guilhemMBED 0:a7c449cd2d5a 317 SUBS R0,R0,#32 /* Adjust Start Address */
guilhemMBED 0:a7c449cd2d5a 318 LDMIA R0!,{R4-R7} /* Restore new Context (R4-R7) */
guilhemMBED 0:a7c449cd2d5a 319
guilhemMBED 0:a7c449cd2d5a 320 Sys_Exit:
guilhemMBED 0:a7c449cd2d5a 321 MOVS R0,#~0xFFFFFFFD /* Set EXC_RETURN value */
guilhemMBED 0:a7c449cd2d5a 322 MVNS R0,R0
guilhemMBED 0:a7c449cd2d5a 323 BX R0 /* RETI to Thread Mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 324
guilhemMBED 0:a7c449cd2d5a 325 .fnend
guilhemMBED 0:a7c449cd2d5a 326 .size PendSV_Handler, .-PendSV_Handler
guilhemMBED 0:a7c449cd2d5a 327
guilhemMBED 0:a7c449cd2d5a 328
guilhemMBED 0:a7c449cd2d5a 329 /*-------------------------- SysTick_Handler --------------------------------*/
guilhemMBED 0:a7c449cd2d5a 330
guilhemMBED 0:a7c449cd2d5a 331 # void SysTick_Handler (void);
guilhemMBED 0:a7c449cd2d5a 332
guilhemMBED 0:a7c449cd2d5a 333 .thumb_func
guilhemMBED 0:a7c449cd2d5a 334 .type SysTick_Handler, %function
guilhemMBED 0:a7c449cd2d5a 335 .global SysTick_Handler
guilhemMBED 0:a7c449cd2d5a 336 SysTick_Handler:
guilhemMBED 0:a7c449cd2d5a 337 .fnstart
guilhemMBED 0:a7c449cd2d5a 338 .cantunwind
guilhemMBED 0:a7c449cd2d5a 339
guilhemMBED 0:a7c449cd2d5a 340 BL rt_systick
guilhemMBED 0:a7c449cd2d5a 341 B Sys_Switch
guilhemMBED 0:a7c449cd2d5a 342
guilhemMBED 0:a7c449cd2d5a 343 .fnend
guilhemMBED 0:a7c449cd2d5a 344 .size SysTick_Handler, .-SysTick_Handler
guilhemMBED 0:a7c449cd2d5a 345
guilhemMBED 0:a7c449cd2d5a 346
guilhemMBED 0:a7c449cd2d5a 347 /*-------------------------- OS_Tick_Handler --------------------------------*/
guilhemMBED 0:a7c449cd2d5a 348
guilhemMBED 0:a7c449cd2d5a 349 # void OS_Tick_Handler (void);
guilhemMBED 0:a7c449cd2d5a 350
guilhemMBED 0:a7c449cd2d5a 351 .thumb_func
guilhemMBED 0:a7c449cd2d5a 352 .type OS_Tick_Handler, %function
guilhemMBED 0:a7c449cd2d5a 353 .global OS_Tick_Handler
guilhemMBED 0:a7c449cd2d5a 354 OS_Tick_Handler:
guilhemMBED 0:a7c449cd2d5a 355 .fnstart
guilhemMBED 0:a7c449cd2d5a 356 .cantunwind
guilhemMBED 0:a7c449cd2d5a 357
guilhemMBED 0:a7c449cd2d5a 358 BL os_tick_irqack
guilhemMBED 0:a7c449cd2d5a 359 BL rt_systick
guilhemMBED 0:a7c449cd2d5a 360 B Sys_Switch
guilhemMBED 0:a7c449cd2d5a 361
guilhemMBED 0:a7c449cd2d5a 362 .fnend
guilhemMBED 0:a7c449cd2d5a 363 .size OS_Tick_Handler, .-OS_Tick_Handler
guilhemMBED 0:a7c449cd2d5a 364
guilhemMBED 0:a7c449cd2d5a 365
guilhemMBED 0:a7c449cd2d5a 366 .end
guilhemMBED 0:a7c449cd2d5a 367
guilhemMBED 0:a7c449cd2d5a 368 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 369 * end of file
guilhemMBED 0:a7c449cd2d5a 370 *---------------------------------------------------------------------------*/