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_M3/TOOLCHAIN_IAR/HAL_CM3.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_CM3.S
DieterGraef 0:f9b6112278fe 5 * Purpose: Hardware Abstraction Layer for Cortex-M3
DieterGraef 0:f9b6112278fe 6 * Rev.: V4.70
DieterGraef 0:f9b6112278fe 7 *----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 8 *
DieterGraef 0:f9b6112278fe 9 * Copyright (c) 1999-2009 KEIL, 2009-2013 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_CM3.S
DieterGraef 0:f9b6112278fe 36
DieterGraef 0:f9b6112278fe 37 #define TCB_TSTACK 44
DieterGraef 0:f9b6112278fe 38
DieterGraef 0:f9b6112278fe 39 EXTERN os_flags
DieterGraef 0:f9b6112278fe 40 EXTERN os_tsk
DieterGraef 0:f9b6112278fe 41 EXTERN rt_alloc_box
DieterGraef 0:f9b6112278fe 42 EXTERN rt_free_box
DieterGraef 0:f9b6112278fe 43 EXTERN rt_stk_check
DieterGraef 0:f9b6112278fe 44 EXTERN rt_pop_req
DieterGraef 0:f9b6112278fe 45 EXTERN rt_systick
DieterGraef 0:f9b6112278fe 46 EXTERN os_tick_irqack
DieterGraef 0:f9b6112278fe 47 EXTERN SVC_Table
DieterGraef 0:f9b6112278fe 48 EXTERN SVC_Count
DieterGraef 0:f9b6112278fe 49
DieterGraef 0:f9b6112278fe 50 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 51 * Functions
DieterGraef 0:f9b6112278fe 52 *---------------------------------------------------------------------------*/
DieterGraef 0:f9b6112278fe 53
DieterGraef 0:f9b6112278fe 54 SECTION .text:CODE:NOROOT(2)
DieterGraef 0:f9b6112278fe 55 THUMB
DieterGraef 0:f9b6112278fe 56
DieterGraef 0:f9b6112278fe 57 /*--------------------------- rt_set_PSP ------------------------------------*/
DieterGraef 0:f9b6112278fe 58
DieterGraef 0:f9b6112278fe 59 ; void rt_set_PSP (U32 stack);
DieterGraef 0:f9b6112278fe 60
DieterGraef 0:f9b6112278fe 61 PUBLIC rt_set_PSP
DieterGraef 0:f9b6112278fe 62 rt_set_PSP:
DieterGraef 0:f9b6112278fe 63
DieterGraef 0:f9b6112278fe 64 MSR PSP,R0
DieterGraef 0:f9b6112278fe 65 BX LR
DieterGraef 0:f9b6112278fe 66
DieterGraef 0:f9b6112278fe 67
DieterGraef 0:f9b6112278fe 68 /*--------------------------- rt_get_PSP ------------------------------------*/
DieterGraef 0:f9b6112278fe 69
DieterGraef 0:f9b6112278fe 70 ; U32 rt_get_PSP (void);
DieterGraef 0:f9b6112278fe 71
DieterGraef 0:f9b6112278fe 72 PUBLIC rt_get_PSP
DieterGraef 0:f9b6112278fe 73 rt_get_PSP:
DieterGraef 0:f9b6112278fe 74
DieterGraef 0:f9b6112278fe 75 MRS R0,PSP
DieterGraef 0:f9b6112278fe 76 BX LR
DieterGraef 0:f9b6112278fe 77
DieterGraef 0:f9b6112278fe 78
DieterGraef 0:f9b6112278fe 79 /*--------------------------- os_set_env ------------------------------------*/
DieterGraef 0:f9b6112278fe 80
DieterGraef 0:f9b6112278fe 81 ; void os_set_env (void);
DieterGraef 0:f9b6112278fe 82 /* Switch to Unprivileged/Privileged Thread mode, use PSP. */
DieterGraef 0:f9b6112278fe 83
DieterGraef 0:f9b6112278fe 84 PUBLIC os_set_env
DieterGraef 0:f9b6112278fe 85 os_set_env:
DieterGraef 0:f9b6112278fe 86
DieterGraef 0:f9b6112278fe 87 MOV R0,SP /* PSP = MSP */
DieterGraef 0:f9b6112278fe 88 MSR PSP,R0
DieterGraef 0:f9b6112278fe 89 LDR R0,=os_flags
DieterGraef 0:f9b6112278fe 90 LDRB R0,[R0]
DieterGraef 0:f9b6112278fe 91 LSLS R0,#31
DieterGraef 0:f9b6112278fe 92 ITE NE
DieterGraef 0:f9b6112278fe 93 MOVNE R0,#0x02 /* Privileged Thread mode, use PSP */
DieterGraef 0:f9b6112278fe 94 MOVEQ R0,#0x03 /* Unprivileged Thread mode, use PSP */
DieterGraef 0:f9b6112278fe 95 MSR CONTROL,R0
DieterGraef 0:f9b6112278fe 96 BX LR
DieterGraef 0:f9b6112278fe 97
DieterGraef 0:f9b6112278fe 98
DieterGraef 0:f9b6112278fe 99 /*--------------------------- _alloc_box ------------------------------------*/
DieterGraef 0:f9b6112278fe 100
DieterGraef 0:f9b6112278fe 101 ; void *_alloc_box (void *box_mem);
DieterGraef 0:f9b6112278fe 102 /* Function wrapper for Unprivileged/Privileged mode. */
DieterGraef 0:f9b6112278fe 103
DieterGraef 0:f9b6112278fe 104 PUBLIC _alloc_box
DieterGraef 0:f9b6112278fe 105 _alloc_box:
DieterGraef 0:f9b6112278fe 106
DieterGraef 0:f9b6112278fe 107 LDR R12,=rt_alloc_box
DieterGraef 0:f9b6112278fe 108 MRS R3,IPSR
DieterGraef 0:f9b6112278fe 109 LSLS R3,#24
DieterGraef 0:f9b6112278fe 110 IT NE
DieterGraef 0:f9b6112278fe 111 BXNE R12
DieterGraef 0:f9b6112278fe 112 MRS R3,CONTROL
DieterGraef 0:f9b6112278fe 113 LSLS R3,#31
DieterGraef 0:f9b6112278fe 114 IT EQ
DieterGraef 0:f9b6112278fe 115 BXEQ R12
DieterGraef 0:f9b6112278fe 116 SVC 0
DieterGraef 0:f9b6112278fe 117 BX LR
DieterGraef 0:f9b6112278fe 118
DieterGraef 0:f9b6112278fe 119
DieterGraef 0:f9b6112278fe 120 /*--------------------------- _free_box -------------------------------------*/
DieterGraef 0:f9b6112278fe 121
DieterGraef 0:f9b6112278fe 122 ; U32 _free_box (void *box_mem, void *box);
DieterGraef 0:f9b6112278fe 123 /* Function wrapper for Unprivileged/Privileged mode. */
DieterGraef 0:f9b6112278fe 124
DieterGraef 0:f9b6112278fe 125 PUBLIC _free_box
DieterGraef 0:f9b6112278fe 126 _free_box:
DieterGraef 0:f9b6112278fe 127
DieterGraef 0:f9b6112278fe 128 LDR R12,=rt_free_box
DieterGraef 0:f9b6112278fe 129 MRS R3,IPSR
DieterGraef 0:f9b6112278fe 130 LSLS R3,#24
DieterGraef 0:f9b6112278fe 131 IT NE
DieterGraef 0:f9b6112278fe 132 BXNE R12
DieterGraef 0:f9b6112278fe 133 MRS R3,CONTROL
DieterGraef 0:f9b6112278fe 134 LSLS R3,#31
DieterGraef 0:f9b6112278fe 135 IT EQ
DieterGraef 0:f9b6112278fe 136 BXEQ R12
DieterGraef 0:f9b6112278fe 137 SVC 0
DieterGraef 0:f9b6112278fe 138 BX LR
DieterGraef 0:f9b6112278fe 139
DieterGraef 0:f9b6112278fe 140
DieterGraef 0:f9b6112278fe 141 /*-------------------------- SVC_Handler ------------------------------------*/
DieterGraef 0:f9b6112278fe 142
DieterGraef 0:f9b6112278fe 143 ; void SVC_Handler (void);
DieterGraef 0:f9b6112278fe 144
DieterGraef 0:f9b6112278fe 145 PUBLIC SVC_Handler
DieterGraef 0:f9b6112278fe 146 SVC_Handler:
DieterGraef 0:f9b6112278fe 147
DieterGraef 0:f9b6112278fe 148 MRS R0,PSP /* Read PSP */
DieterGraef 0:f9b6112278fe 149 LDR R1,[R0,#24] /* Read Saved PC from Stack */
DieterGraef 0:f9b6112278fe 150 LDRB R1,[R1,#-2] /* Load SVC Number */
DieterGraef 0:f9b6112278fe 151 CBNZ R1,SVC_User
DieterGraef 0:f9b6112278fe 152
DieterGraef 0:f9b6112278fe 153 LDM R0,{R0-R3,R12} /* Read R0-R3,R12 from stack */
DieterGraef 0:f9b6112278fe 154 BLX R12 /* Call SVC Function */
DieterGraef 0:f9b6112278fe 155
DieterGraef 0:f9b6112278fe 156 MRS R12,PSP /* Read PSP */
DieterGraef 0:f9b6112278fe 157 STM R12,{R0-R2} /* Store return values */
DieterGraef 0:f9b6112278fe 158
DieterGraef 0:f9b6112278fe 159 LDR R3,=os_tsk
DieterGraef 0:f9b6112278fe 160 LDM R3,{R1,R2} /* os_tsk.run, os_tsk.new */
DieterGraef 0:f9b6112278fe 161 CMP R1,R2
DieterGraef 0:f9b6112278fe 162 BEQ SVC_Exit /* no task switch */
DieterGraef 0:f9b6112278fe 163
DieterGraef 0:f9b6112278fe 164 CBZ R1,SVC_Next /* Runtask deleted? */
DieterGraef 0:f9b6112278fe 165 STMDB R12!,{R4-R11} /* Save Old context */
DieterGraef 0:f9b6112278fe 166 STR R12,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
DieterGraef 0:f9b6112278fe 167
DieterGraef 0:f9b6112278fe 168 PUSH {R2,R3}
DieterGraef 0:f9b6112278fe 169 BL rt_stk_check /* Check for Stack overflow */
DieterGraef 0:f9b6112278fe 170 POP {R2,R3}
DieterGraef 0:f9b6112278fe 171
DieterGraef 0:f9b6112278fe 172 SVC_Next:
DieterGraef 0:f9b6112278fe 173 STR R2,[R3] /* os_tsk.run = os_tsk.new */
DieterGraef 0:f9b6112278fe 174
DieterGraef 0:f9b6112278fe 175 LDR R12,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
DieterGraef 0:f9b6112278fe 176 LDMIA R12!,{R4-R11} /* Restore New Context */
DieterGraef 0:f9b6112278fe 177 MSR PSP,R12 /* Write PSP */
DieterGraef 0:f9b6112278fe 178
DieterGraef 0:f9b6112278fe 179 SVC_Exit:
DieterGraef 0:f9b6112278fe 180 MVN LR,#~0xFFFFFFFD /* set EXC_RETURN value */
DieterGraef 0:f9b6112278fe 181 BX LR
DieterGraef 0:f9b6112278fe 182
DieterGraef 0:f9b6112278fe 183 /*------------------- User SVC ------------------------------*/
DieterGraef 0:f9b6112278fe 184
DieterGraef 0:f9b6112278fe 185 SVC_User:
DieterGraef 0:f9b6112278fe 186 PUSH {R4,LR} /* Save Registers */
DieterGraef 0:f9b6112278fe 187 LDR R2,=SVC_Count
DieterGraef 0:f9b6112278fe 188 LDR R2,[R2]
DieterGraef 0:f9b6112278fe 189 CMP R1,R2
DieterGraef 0:f9b6112278fe 190 BHI SVC_Done /* Overflow */
DieterGraef 0:f9b6112278fe 191
DieterGraef 0:f9b6112278fe 192 LDR R4,=SVC_Table-4
DieterGraef 0:f9b6112278fe 193 LDR R4,[R4,R1,LSL #2] /* Load SVC Function Address */
DieterGraef 0:f9b6112278fe 194
DieterGraef 0:f9b6112278fe 195 LDM R0,{R0-R3,R12} /* Read R0-R3,R12 from stack */
DieterGraef 0:f9b6112278fe 196 BLX R4 /* Call SVC Function */
DieterGraef 0:f9b6112278fe 197
DieterGraef 0:f9b6112278fe 198 MRS R12,PSP
DieterGraef 0:f9b6112278fe 199 STM R12,{R0-R3} /* Function return values */
DieterGraef 0:f9b6112278fe 200 SVC_Done:
DieterGraef 0:f9b6112278fe 201 POP {R4,PC} /* RETI */
DieterGraef 0:f9b6112278fe 202
DieterGraef 0:f9b6112278fe 203
DieterGraef 0:f9b6112278fe 204 /*-------------------------- PendSV_Handler ---------------------------------*/
DieterGraef 0:f9b6112278fe 205
DieterGraef 0:f9b6112278fe 206 ; void PendSV_Handler (void);
DieterGraef 0:f9b6112278fe 207
DieterGraef 0:f9b6112278fe 208 PUBLIC PendSV_Handler
DieterGraef 0:f9b6112278fe 209 PendSV_Handler:
DieterGraef 0:f9b6112278fe 210
DieterGraef 0:f9b6112278fe 211 BL rt_pop_req
DieterGraef 0:f9b6112278fe 212
DieterGraef 0:f9b6112278fe 213 Sys_Switch:
DieterGraef 0:f9b6112278fe 214 LDR R3,=os_tsk
DieterGraef 0:f9b6112278fe 215 LDM R3,{R1,R2} /* os_tsk.run, os_tsk.new */
DieterGraef 0:f9b6112278fe 216 CMP R1,R2
DieterGraef 0:f9b6112278fe 217 BEQ Sys_Exit
DieterGraef 0:f9b6112278fe 218
DieterGraef 0:f9b6112278fe 219 MRS R12,PSP /* Read PSP */
DieterGraef 0:f9b6112278fe 220 STMDB R12!,{R4-R11} /* Save Old context */
DieterGraef 0:f9b6112278fe 221 STR R12,[R1,#TCB_TSTACK] /* Update os_tsk.run->tsk_stack */
DieterGraef 0:f9b6112278fe 222
DieterGraef 0:f9b6112278fe 223 PUSH {R2,R3}
DieterGraef 0:f9b6112278fe 224 BL rt_stk_check /* Check for Stack overflow */
DieterGraef 0:f9b6112278fe 225 POP {R2,R3}
DieterGraef 0:f9b6112278fe 226
DieterGraef 0:f9b6112278fe 227 STR R2,[R3] /* os_tsk.run = os_tsk.new */
DieterGraef 0:f9b6112278fe 228
DieterGraef 0:f9b6112278fe 229 LDR R12,[R2,#TCB_TSTACK] /* os_tsk.new->tsk_stack */
DieterGraef 0:f9b6112278fe 230 LDMIA R12!,{R4-R11} /* Restore New Context */
DieterGraef 0:f9b6112278fe 231 MSR PSP,R12 /* Write PSP */
DieterGraef 0:f9b6112278fe 232
DieterGraef 0:f9b6112278fe 233 Sys_Exit:
DieterGraef 0:f9b6112278fe 234 MVN LR,#~0xFFFFFFFD /* set EXC_RETURN value */
DieterGraef 0:f9b6112278fe 235 BX LR /* Return to Thread Mode */
DieterGraef 0:f9b6112278fe 236
DieterGraef 0:f9b6112278fe 237
DieterGraef 0:f9b6112278fe 238 /*-------------------------- SysTick_Handler --------------------------------*/
DieterGraef 0:f9b6112278fe 239
DieterGraef 0:f9b6112278fe 240 ; void SysTick_Handler (void);
DieterGraef 0:f9b6112278fe 241
DieterGraef 0:f9b6112278fe 242 PUBLIC SysTick_Handler
DieterGraef 0:f9b6112278fe 243 SysTick_Handler:
DieterGraef 0:f9b6112278fe 244
DieterGraef 0:f9b6112278fe 245 BL rt_systick
DieterGraef 0:f9b6112278fe 246 B Sys_Switch
DieterGraef 0:f9b6112278fe 247
DieterGraef 0:f9b6112278fe 248
DieterGraef 0:f9b6112278fe 249 /*-------------------------- OS_Tick_Handler --------------------------------*/
DieterGraef 0:f9b6112278fe 250
DieterGraef 0:f9b6112278fe 251 ; void OS_Tick_Handler (void);
DieterGraef 0:f9b6112278fe 252
DieterGraef 0:f9b6112278fe 253 PUBLIC OS_Tick_Handler
DieterGraef 0:f9b6112278fe 254 OS_Tick_Handler:
DieterGraef 0:f9b6112278fe 255
DieterGraef 0:f9b6112278fe 256 BL os_tick_irqack
DieterGraef 0:f9b6112278fe 257 BL rt_systick
DieterGraef 0:f9b6112278fe 258 B Sys_Switch
DieterGraef 0:f9b6112278fe 259
DieterGraef 0:f9b6112278fe 260
DieterGraef 0:f9b6112278fe 261 END
DieterGraef 0:f9b6112278fe 262
DieterGraef 0:f9b6112278fe 263 /*----------------------------------------------------------------------------
DieterGraef 0:f9b6112278fe 264 * end of file
DieterGraef 0:f9b6112278fe 265 *---------------------------------------------------------------------------*/