TeamGyro / mbed-rtos

OS2

Dependents:   GYRO_MPU6050 Bluetooth_Powered_Multimeter_Using_STM32F429_and_RTOS fyp

rtx/TARGET_CORTEX_M/TARGET_RTOS_M4_M7/TOOLCHAIN_IAR/HAL_CM4.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_CM4.S
guilhemMBED 0:a7c449cd2d5a 5 * Purpose: Hardware Abstraction Layer for Cortex-M4
guilhemMBED 0:a7c449cd2d5a 6 * Rev.: V4.79
guilhemMBED 0:a7c449cd2d5a 7 *----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 8 *
guilhemMBED 0:a7c449cd2d5a 9 * Copyright (c) 1999-2009 KEIL, 2009-2015 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_CM4.S
guilhemMBED 0:a7c449cd2d5a 36
guilhemMBED 0:a7c449cd2d5a 37 #define TCB_STACKF 37
guilhemMBED 0:a7c449cd2d5a 38 #define TCB_TSTACK 44
guilhemMBED 0:a7c449cd2d5a 39
guilhemMBED 0:a7c449cd2d5a 40 EXTERN os_flags
guilhemMBED 0:a7c449cd2d5a 41 EXTERN os_tsk
guilhemMBED 0:a7c449cd2d5a 42 EXTERN rt_alloc_box
guilhemMBED 0:a7c449cd2d5a 43 EXTERN rt_free_box
guilhemMBED 0:a7c449cd2d5a 44 EXTERN rt_stk_check
guilhemMBED 0:a7c449cd2d5a 45 EXTERN rt_pop_req
guilhemMBED 0:a7c449cd2d5a 46 EXTERN rt_systick
guilhemMBED 0:a7c449cd2d5a 47 EXTERN os_tick_irqack
guilhemMBED 0:a7c449cd2d5a 48 EXTERN SVC_Table
guilhemMBED 0:a7c449cd2d5a 49 EXTERN SVC_Count
guilhemMBED 0:a7c449cd2d5a 50
guilhemMBED 0:a7c449cd2d5a 51 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 52 * Functions
guilhemMBED 0:a7c449cd2d5a 53 *---------------------------------------------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 54
guilhemMBED 0:a7c449cd2d5a 55 SECTION .text:CODE:NOROOT(2)
guilhemMBED 0:a7c449cd2d5a 56 THUMB
guilhemMBED 0:a7c449cd2d5a 57
guilhemMBED 0:a7c449cd2d5a 58 /*--------------------------- rt_set_PSP ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 59
guilhemMBED 0:a7c449cd2d5a 60 ; void rt_set_PSP (U32 stack);
guilhemMBED 0:a7c449cd2d5a 61
guilhemMBED 0:a7c449cd2d5a 62 PUBLIC rt_set_PSP
guilhemMBED 0:a7c449cd2d5a 63 rt_set_PSP:
guilhemMBED 0:a7c449cd2d5a 64
guilhemMBED 0:a7c449cd2d5a 65 MSR PSP,R0
guilhemMBED 0:a7c449cd2d5a 66 BX LR
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 PUBLIC rt_get_PSP
guilhemMBED 0:a7c449cd2d5a 74 rt_get_PSP:
guilhemMBED 0:a7c449cd2d5a 75
guilhemMBED 0:a7c449cd2d5a 76 MRS R0,PSP
guilhemMBED 0:a7c449cd2d5a 77 BX LR
guilhemMBED 0:a7c449cd2d5a 78
guilhemMBED 0:a7c449cd2d5a 79
guilhemMBED 0:a7c449cd2d5a 80 /*--------------------------- os_set_env ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 81
guilhemMBED 0:a7c449cd2d5a 82 ; void os_set_env (void);
guilhemMBED 0:a7c449cd2d5a 83 /* Switch to Unprivileged/Privileged Thread mode, use PSP. */
guilhemMBED 0:a7c449cd2d5a 84
guilhemMBED 0:a7c449cd2d5a 85 PUBLIC os_set_env
guilhemMBED 0:a7c449cd2d5a 86 os_set_env:
guilhemMBED 0:a7c449cd2d5a 87
guilhemMBED 0:a7c449cd2d5a 88 MOV R0,SP /* PSP = MSP */
guilhemMBED 0:a7c449cd2d5a 89 MSR PSP,R0
guilhemMBED 0:a7c449cd2d5a 90 LDR R0,=os_flags
guilhemMBED 0:a7c449cd2d5a 91 LDRB R0,[R0]
guilhemMBED 0:a7c449cd2d5a 92 LSLS R0,#31
guilhemMBED 0:a7c449cd2d5a 93 ITE NE
guilhemMBED 0:a7c449cd2d5a 94 MOVNE R0,#0x02 /* Privileged Thread mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 95 MOVEQ R0,#0x03 /* Unprivileged Thread mode, use PSP */
guilhemMBED 0:a7c449cd2d5a 96 MSR CONTROL,R0
guilhemMBED 0:a7c449cd2d5a 97 BX LR
guilhemMBED 0:a7c449cd2d5a 98
guilhemMBED 0:a7c449cd2d5a 99
guilhemMBED 0:a7c449cd2d5a 100 /*--------------------------- _alloc_box ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 101
guilhemMBED 0:a7c449cd2d5a 102 ; void *_alloc_box (void *box_mem);
guilhemMBED 0:a7c449cd2d5a 103 /* Function wrapper for Unprivileged/Privileged mode. */
guilhemMBED 0:a7c449cd2d5a 104
guilhemMBED 0:a7c449cd2d5a 105 PUBLIC _alloc_box
guilhemMBED 0:a7c449cd2d5a 106 _alloc_box:
guilhemMBED 0:a7c449cd2d5a 107
guilhemMBED 0:a7c449cd2d5a 108 LDR R12,=rt_alloc_box
guilhemMBED 0:a7c449cd2d5a 109 MRS R3,IPSR
guilhemMBED 0:a7c449cd2d5a 110 LSLS R3,#24
guilhemMBED 0:a7c449cd2d5a 111 IT NE
guilhemMBED 0:a7c449cd2d5a 112 BXNE R12
guilhemMBED 0:a7c449cd2d5a 113 MRS R3,CONTROL
guilhemMBED 0:a7c449cd2d5a 114 LSLS R3,#31
guilhemMBED 0:a7c449cd2d5a 115 IT EQ
guilhemMBED 0:a7c449cd2d5a 116 BXEQ R12
guilhemMBED 0:a7c449cd2d5a 117 SVC 0
guilhemMBED 0:a7c449cd2d5a 118 BX LR
guilhemMBED 0:a7c449cd2d5a 119
guilhemMBED 0:a7c449cd2d5a 120
guilhemMBED 0:a7c449cd2d5a 121 /*--------------------------- _free_box -------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 122
guilhemMBED 0:a7c449cd2d5a 123 ; U32 _free_box (void *box_mem, void *box);
guilhemMBED 0:a7c449cd2d5a 124 /* Function wrapper for Unprivileged/Privileged mode. */
guilhemMBED 0:a7c449cd2d5a 125
guilhemMBED 0:a7c449cd2d5a 126 PUBLIC _free_box
guilhemMBED 0:a7c449cd2d5a 127 _free_box:
guilhemMBED 0:a7c449cd2d5a 128
guilhemMBED 0:a7c449cd2d5a 129 LDR R12,=rt_free_box
guilhemMBED 0:a7c449cd2d5a 130 MRS R3,IPSR
guilhemMBED 0:a7c449cd2d5a 131 LSLS R3,#24
guilhemMBED 0:a7c449cd2d5a 132 IT NE
guilhemMBED 0:a7c449cd2d5a 133 BXNE R12
guilhemMBED 0:a7c449cd2d5a 134 MRS R3,CONTROL
guilhemMBED 0:a7c449cd2d5a 135 LSLS R3,#31
guilhemMBED 0:a7c449cd2d5a 136 IT EQ
guilhemMBED 0:a7c449cd2d5a 137 BXEQ R12
guilhemMBED 0:a7c449cd2d5a 138 SVC 0
guilhemMBED 0:a7c449cd2d5a 139 BX LR
guilhemMBED 0:a7c449cd2d5a 140
guilhemMBED 0:a7c449cd2d5a 141
guilhemMBED 0:a7c449cd2d5a 142 /*-------------------------- SVC_Handler ------------------------------------*/
guilhemMBED 0:a7c449cd2d5a 143
guilhemMBED 0:a7c449cd2d5a 144 ; void SVC_Handler (void);
guilhemMBED 0:a7c449cd2d5a 145
guilhemMBED 0:a7c449cd2d5a 146 PUBLIC SVC_Handler
guilhemMBED 0:a7c449cd2d5a 147 SVC_Handler:
guilhemMBED 0:a7c449cd2d5a 148
guilhemMBED 0:a7c449cd2d5a 149 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 150 PUBLIC SVC_Handler_Veneer
guilhemMBED 0:a7c449cd2d5a 151 SVC_Handler_Veneer:
guilhemMBED 0:a7c449cd2d5a 152 #endif
guilhemMBED 0:a7c449cd2d5a 153
guilhemMBED 0:a7c449cd2d5a 154 MRS R0,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 155 LDR R1,[R0,#24] /* Read Saved PC from Stack */
guilhemMBED 0:a7c449cd2d5a 156 LDRB R1,[R1,#-2] /* Load SVC Number */
guilhemMBED 0:a7c449cd2d5a 157 CBNZ R1,SVC_User
guilhemMBED 0:a7c449cd2d5a 158
guilhemMBED 0:a7c449cd2d5a 159 LDM R0,{R0-R3,R12} /* Read R0-R3,R12 from stack */
guilhemMBED 0:a7c449cd2d5a 160 PUSH {R4,LR} /* Save EXC_RETURN */
guilhemMBED 0:a7c449cd2d5a 161 BLX R12 /* Call SVC Function */
guilhemMBED 0:a7c449cd2d5a 162 POP {R4,LR} /* Restore EXC_RETURN */
guilhemMBED 0:a7c449cd2d5a 163
guilhemMBED 0:a7c449cd2d5a 164 MRS R12,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 165 STM R12,{R0-R2} /* Store return values */
guilhemMBED 0:a7c449cd2d5a 166
guilhemMBED 0:a7c449cd2d5a 167 LDR R3,=os_tsk
guilhemMBED 0:a7c449cd2d5a 168 LDM R3,{R1,R2} /* os_tsk.run, os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 169 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 170 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 171 ITT EQ
guilhemMBED 0:a7c449cd2d5a 172 PUSHEQ {LR}
guilhemMBED 0:a7c449cd2d5a 173 POPEQ {PC}
guilhemMBED 0:a7c449cd2d5a 174 #else
guilhemMBED 0:a7c449cd2d5a 175 IT EQ
guilhemMBED 0:a7c449cd2d5a 176 BXEQ LR /* RETI, no task switch */
guilhemMBED 0:a7c449cd2d5a 177 #endif
guilhemMBED 0:a7c449cd2d5a 178
guilhemMBED 0:a7c449cd2d5a 179 CBNZ R1,SVC_ContextSave /* Runtask not deleted? */
guilhemMBED 0:a7c449cd2d5a 180
guilhemMBED 0:a7c449cd2d5a 181 TST LR,#0x10 /* is it extended frame? */
guilhemMBED 0:a7c449cd2d5a 182 BNE SVC_ContextRestore
guilhemMBED 0:a7c449cd2d5a 183 LDR R1,=0xE000EF34
guilhemMBED 0:a7c449cd2d5a 184 LDR R0,[R1] /* Load FPCCR */
guilhemMBED 0:a7c449cd2d5a 185 BIC R0,R0,#1 /* Clear LSPACT (Lazy state) */
guilhemMBED 0:a7c449cd2d5a 186 STR R0,[R1] /* Store FPCCR */
guilhemMBED 0:a7c449cd2d5a 187 B SVC_ContextRestore
guilhemMBED 0:a7c449cd2d5a 188
guilhemMBED 0:a7c449cd2d5a 189 SVC_ContextSave:
guilhemMBED 0:a7c449cd2d5a 190 TST LR,#0x10 /* is it extended frame? */
guilhemMBED 0:a7c449cd2d5a 191 #if (__FPU_PRESENT == 1)
guilhemMBED 0:a7c449cd2d5a 192 ITTE EQ
guilhemMBED 0:a7c449cd2d5a 193 VSTMDBEQ R12!,{S16-S31} /* yes, stack also VFP hi-regs */
guilhemMBED 0:a7c449cd2d5a 194 #else
guilhemMBED 0:a7c449cd2d5a 195 ITE EQ
guilhemMBED 0:a7c449cd2d5a 196 #endif
guilhemMBED 0:a7c449cd2d5a 197 MOVEQ R0,#0x01 /* os_tsk->stack_frame val */
guilhemMBED 0:a7c449cd2d5a 198 MOVNE R0,#0x00
guilhemMBED 0:a7c449cd2d5a 199 STRB R0,[R1,#TCB_STACKF] /* os_tsk.run->stack_frame = val */
guilhemMBED 0:a7c449cd2d5a 200 STMDB R12!,{R4-R11} /* Save Old context */
guilhemMBED 0:a7c449cd2d5a 201 STR R12,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 202
guilhemMBED 0:a7c449cd2d5a 203 PUSH {R2,R3}
guilhemMBED 0:a7c449cd2d5a 204 BL rt_stk_check /* Check for Stack overflow */
guilhemMBED 0:a7c449cd2d5a 205 POP {R2,R3}
guilhemMBED 0:a7c449cd2d5a 206
guilhemMBED 0:a7c449cd2d5a 207 SVC_ContextRestore:
guilhemMBED 0:a7c449cd2d5a 208 STR R2,[R3] /* os_tsk.run = os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 209
guilhemMBED 0:a7c449cd2d5a 210 LDR R12,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 211 LDMIA R12!,{R4-R11} /* Restore New Context */
guilhemMBED 0:a7c449cd2d5a 212 LDRB R0,[R2,#TCB_STACKF] /* Stack Frame */
guilhemMBED 0:a7c449cd2d5a 213 CMP R0,#0 /* Basic/Extended Stack Frame */
guilhemMBED 0:a7c449cd2d5a 214 #if (__FPU_PRESENT == 1)
guilhemMBED 0:a7c449cd2d5a 215 ITEE EQ
guilhemMBED 0:a7c449cd2d5a 216 #else
guilhemMBED 0:a7c449cd2d5a 217 ITE EQ
guilhemMBED 0:a7c449cd2d5a 218 #endif
guilhemMBED 0:a7c449cd2d5a 219 MVNEQ LR,#~0xFFFFFFFD /* set EXC_RETURN value */
guilhemMBED 0:a7c449cd2d5a 220 MVNNE LR,#~0xFFFFFFED
guilhemMBED 0:a7c449cd2d5a 221 #if (__FPU_PRESENT == 1)
guilhemMBED 0:a7c449cd2d5a 222 VLDMIANE R12!,{S16-S31} /* restore VFP hi-registers */
guilhemMBED 0:a7c449cd2d5a 223 #endif
guilhemMBED 0:a7c449cd2d5a 224 MSR PSP,R12 /* Write PSP */
guilhemMBED 0:a7c449cd2d5a 225
guilhemMBED 0:a7c449cd2d5a 226 SVC_Exit:
guilhemMBED 0:a7c449cd2d5a 227 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 228 PUSH {LR}
guilhemMBED 0:a7c449cd2d5a 229 POP {PC}
guilhemMBED 0:a7c449cd2d5a 230 #else
guilhemMBED 0:a7c449cd2d5a 231 BX LR
guilhemMBED 0:a7c449cd2d5a 232 #endif
guilhemMBED 0:a7c449cd2d5a 233
guilhemMBED 0:a7c449cd2d5a 234 /*------------------- User SVC ------------------------------*/
guilhemMBED 0:a7c449cd2d5a 235
guilhemMBED 0:a7c449cd2d5a 236 SVC_User:
guilhemMBED 0:a7c449cd2d5a 237 PUSH {R4,LR} /* Save Registers */
guilhemMBED 0:a7c449cd2d5a 238 LDR R2,=SVC_Count
guilhemMBED 0:a7c449cd2d5a 239 LDR R2,[R2]
guilhemMBED 0:a7c449cd2d5a 240 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 241 BHI SVC_Done /* Overflow */
guilhemMBED 0:a7c449cd2d5a 242
guilhemMBED 0:a7c449cd2d5a 243 LDR R4,=SVC_Table-4
guilhemMBED 0:a7c449cd2d5a 244 LDR R4,[R4,R1,LSL #2] /* Load SVC Function Address */
guilhemMBED 0:a7c449cd2d5a 245
guilhemMBED 0:a7c449cd2d5a 246 LDM R0,{R0-R3,R12} /* Read R0-R3,R12 from stack */
guilhemMBED 0:a7c449cd2d5a 247 BLX R4 /* Call SVC Function */
guilhemMBED 0:a7c449cd2d5a 248
guilhemMBED 0:a7c449cd2d5a 249 MRS R12,PSP
guilhemMBED 0:a7c449cd2d5a 250 STM R12,{R0-R3} /* Function return values */
guilhemMBED 0:a7c449cd2d5a 251 SVC_Done:
guilhemMBED 0:a7c449cd2d5a 252 POP {R4,PC} /* RETI */
guilhemMBED 0:a7c449cd2d5a 253
guilhemMBED 0:a7c449cd2d5a 254
guilhemMBED 0:a7c449cd2d5a 255 /*-------------------------- PendSV_Handler ---------------------------------*/
guilhemMBED 0:a7c449cd2d5a 256
guilhemMBED 0:a7c449cd2d5a 257 ; void PendSV_Handler (void);
guilhemMBED 0:a7c449cd2d5a 258
guilhemMBED 0:a7c449cd2d5a 259 PUBLIC PendSV_Handler
guilhemMBED 0:a7c449cd2d5a 260 PendSV_Handler:
guilhemMBED 0:a7c449cd2d5a 261
guilhemMBED 0:a7c449cd2d5a 262 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 263 PUBLIC PendSV_Handler_Veneer
guilhemMBED 0:a7c449cd2d5a 264 PendSV_Handler_Veneer:
guilhemMBED 0:a7c449cd2d5a 265 #endif
guilhemMBED 0:a7c449cd2d5a 266
guilhemMBED 0:a7c449cd2d5a 267 PUSH {R4,LR} /* Save EXC_RETURN */
guilhemMBED 0:a7c449cd2d5a 268 BL rt_pop_req
guilhemMBED 0:a7c449cd2d5a 269
guilhemMBED 0:a7c449cd2d5a 270 Sys_Switch:
guilhemMBED 0:a7c449cd2d5a 271 POP {R4,LR} /* Restore EXC_RETURN */
guilhemMBED 0:a7c449cd2d5a 272
guilhemMBED 0:a7c449cd2d5a 273 LDR R3,=os_tsk
guilhemMBED 0:a7c449cd2d5a 274 LDM R3,{R1,R2} /* os_tsk.run, os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 275 CMP R1,R2
guilhemMBED 0:a7c449cd2d5a 276 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 277 ITT EQ
guilhemMBED 0:a7c449cd2d5a 278 PUSHEQ {LR}
guilhemMBED 0:a7c449cd2d5a 279 POPEQ {PC}
guilhemMBED 0:a7c449cd2d5a 280 #else
guilhemMBED 0:a7c449cd2d5a 281 IT EQ
guilhemMBED 0:a7c449cd2d5a 282 BXEQ LR /* RETI, no task switch */
guilhemMBED 0:a7c449cd2d5a 283 #endif
guilhemMBED 0:a7c449cd2d5a 284
guilhemMBED 0:a7c449cd2d5a 285 MRS R12,PSP /* Read PSP */
guilhemMBED 0:a7c449cd2d5a 286 TST LR,#0x10 /* is it extended frame? */
guilhemMBED 0:a7c449cd2d5a 287 #if (__FPU_PRESENT == 1)
guilhemMBED 0:a7c449cd2d5a 288 ITTE EQ
guilhemMBED 0:a7c449cd2d5a 289 VSTMDBEQ R12!,{S16-S31} /* yes, stack also VFP hi-regs */
guilhemMBED 0:a7c449cd2d5a 290 #else
guilhemMBED 0:a7c449cd2d5a 291 ITE EQ
guilhemMBED 0:a7c449cd2d5a 292 #endif
guilhemMBED 0:a7c449cd2d5a 293 MOVEQ R0,#0x01 /* os_tsk->stack_frame val */
guilhemMBED 0:a7c449cd2d5a 294 MOVNE R0,#0x00
guilhemMBED 0:a7c449cd2d5a 295 STRB R0,[R1,#TCB_STACKF] /* os_tsk.run->stack_frame = val */
guilhemMBED 0:a7c449cd2d5a 296 STMDB R12!,{R4-R11} /* Save Old context */
guilhemMBED 0:a7c449cd2d5a 297 STR R12,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 298
guilhemMBED 0:a7c449cd2d5a 299 PUSH {R2,R3}
guilhemMBED 0:a7c449cd2d5a 300 BL rt_stk_check /* Check for Stack overflow */
guilhemMBED 0:a7c449cd2d5a 301 POP {R2,R3}
guilhemMBED 0:a7c449cd2d5a 302
guilhemMBED 0:a7c449cd2d5a 303 STR R2,[R3] /* os_tsk.run = os_tsk.new */
guilhemMBED 0:a7c449cd2d5a 304
guilhemMBED 0:a7c449cd2d5a 305 LDR R12,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
guilhemMBED 0:a7c449cd2d5a 306 LDMIA R12!,{R4-R11} /* Restore New Context */
guilhemMBED 0:a7c449cd2d5a 307 LDRB R0,[R2,#TCB_STACKF] /* Stack Frame */
guilhemMBED 0:a7c449cd2d5a 308 CMP R0,#0 /* Basic/Extended Stack Frame */
guilhemMBED 0:a7c449cd2d5a 309 #if (__FPU_PRESENT == 1)
guilhemMBED 0:a7c449cd2d5a 310 ITEE EQ
guilhemMBED 0:a7c449cd2d5a 311 #else
guilhemMBED 0:a7c449cd2d5a 312 ITE EQ
guilhemMBED 0:a7c449cd2d5a 313 #endif
guilhemMBED 0:a7c449cd2d5a 314 MVNEQ LR,#~0xFFFFFFFD /* set EXC_RETURN value */
guilhemMBED 0:a7c449cd2d5a 315 MVNNE LR,#~0xFFFFFFED
guilhemMBED 0:a7c449cd2d5a 316 #if (__FPU_PRESENT == 1)
guilhemMBED 0:a7c449cd2d5a 317 VLDMIANE R12!,{S16-S31} /* restore VFP hi-registers */
guilhemMBED 0:a7c449cd2d5a 318 #endif
guilhemMBED 0:a7c449cd2d5a 319 MSR PSP,R12 /* Write PSP */
guilhemMBED 0:a7c449cd2d5a 320
guilhemMBED 0:a7c449cd2d5a 321 Sys_Exit:
guilhemMBED 0:a7c449cd2d5a 322 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 323 PUSH {LR}
guilhemMBED 0:a7c449cd2d5a 324 POP {PC}
guilhemMBED 0:a7c449cd2d5a 325 #else
guilhemMBED 0:a7c449cd2d5a 326 BX LR /* Return to Thread Mode */
guilhemMBED 0:a7c449cd2d5a 327 #endif
guilhemMBED 0:a7c449cd2d5a 328
guilhemMBED 0:a7c449cd2d5a 329
guilhemMBED 0:a7c449cd2d5a 330 /*-------------------------- SysTick_Handler --------------------------------*/
guilhemMBED 0:a7c449cd2d5a 331
guilhemMBED 0:a7c449cd2d5a 332 ; void SysTick_Handler (void);
guilhemMBED 0:a7c449cd2d5a 333
guilhemMBED 0:a7c449cd2d5a 334 PUBLIC SysTick_Handler
guilhemMBED 0:a7c449cd2d5a 335 SysTick_Handler:
guilhemMBED 0:a7c449cd2d5a 336 #ifdef IFX_XMC4XXX
guilhemMBED 0:a7c449cd2d5a 337 PUBLIC SysTick_Handler_Veneer
guilhemMBED 0:a7c449cd2d5a 338 SysTick_Handler_Veneer:
guilhemMBED 0:a7c449cd2d5a 339 #endif
guilhemMBED 0:a7c449cd2d5a 340
guilhemMBED 0:a7c449cd2d5a 341 PUSH {R4,LR} /* Save EXC_RETURN */
guilhemMBED 0:a7c449cd2d5a 342 BL rt_systick
guilhemMBED 0:a7c449cd2d5a 343 B Sys_Switch
guilhemMBED 0:a7c449cd2d5a 344
guilhemMBED 0:a7c449cd2d5a 345
guilhemMBED 0:a7c449cd2d5a 346 /*-------------------------- OS_Tick_Handler --------------------------------*/
guilhemMBED 0:a7c449cd2d5a 347
guilhemMBED 0:a7c449cd2d5a 348 ; void OS_Tick_Handler (void);
guilhemMBED 0:a7c449cd2d5a 349
guilhemMBED 0:a7c449cd2d5a 350 PUBLIC OS_Tick_Handler
guilhemMBED 0:a7c449cd2d5a 351 OS_Tick_Handler:
guilhemMBED 0:a7c449cd2d5a 352
guilhemMBED 0:a7c449cd2d5a 353 PUSH {R4,LR} /* Save EXC_RETURN */
guilhemMBED 0:a7c449cd2d5a 354 BL os_tick_irqack
guilhemMBED 0:a7c449cd2d5a 355 BL rt_systick
guilhemMBED 0:a7c449cd2d5a 356 B Sys_Switch
guilhemMBED 0:a7c449cd2d5a 357
guilhemMBED 0:a7c449cd2d5a 358
guilhemMBED 0:a7c449cd2d5a 359 END
guilhemMBED 0:a7c449cd2d5a 360
guilhemMBED 0:a7c449cd2d5a 361 /*----------------------------------------------------------------------------
guilhemMBED 0:a7c449cd2d5a 362 * end of file
guilhemMBED 0:a7c449cd2d5a 363 *---------------------------------------------------------------------------*/