ProjetoBB

Dependencies:   F7_Ethernet WebSocketClient mbed mcp3008

Fork of Nucleo_F746ZG_Ethernet by Dieter Graef

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