Arlindo Montagnoli / Mbed 2 deprecated ProjetoBB

ProjetoBB

Dependencies:   F7_Ethernet WebSocketClient mbed mcp3008

Fork of Nucleo_F746ZG_Ethernet by Dieter Graef

mbed-rtos/rtx/TARGET_CORTEX_M/TARGET_RTOS_M4_M7/TOOLCHAIN_IAR/HAL_CM4.S@0:f9b6112278fe, 2016-06-18 (annotated)

Committer:
DieterGraef
Date:
Sat Jun 18 10:49:12 2016 +0000
Revision:
0:f9b6112278fe
Ethernet for the NUCLEO STM32F746 Board Testprogram uses DHCP and NTP to set the clock

Who changed what in which revision?

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