| 1 | /*********************************************************************
|
|---|
| 2 | * SEGGER Microcontroller GmbH *
|
|---|
| 3 | * The Embedded Experts *
|
|---|
| 4 | **********************************************************************
|
|---|
| 5 | * *
|
|---|
| 6 | * (c) 2014 - 2024 SEGGER Microcontroller GmbH *
|
|---|
| 7 | * *
|
|---|
| 8 | * www.segger.com Support: support@segger.com *
|
|---|
| 9 | * *
|
|---|
| 10 | **********************************************************************
|
|---|
| 11 | * *
|
|---|
| 12 | * All rights reserved. *
|
|---|
| 13 | * *
|
|---|
| 14 | * Redistribution and use in source and binary forms, with or *
|
|---|
| 15 | * without modification, are permitted provided that the following *
|
|---|
| 16 | * condition is met: *
|
|---|
| 17 | * *
|
|---|
| 18 | * - Redistributions of source code must retain the above copyright *
|
|---|
| 19 | * notice, this condition and the following disclaimer. *
|
|---|
| 20 | * *
|
|---|
| 21 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND *
|
|---|
| 22 | * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, *
|
|---|
| 23 | * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF *
|
|---|
| 24 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE *
|
|---|
| 25 | * DISCLAIMED. IN NO EVENT SHALL SEGGER Microcontroller BE LIABLE FOR *
|
|---|
| 26 | * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR *
|
|---|
| 27 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT *
|
|---|
| 28 | * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; *
|
|---|
| 29 | * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF *
|
|---|
| 30 | * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT *
|
|---|
| 31 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE *
|
|---|
| 32 | * USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH *
|
|---|
| 33 | * DAMAGE. *
|
|---|
| 34 | * *
|
|---|
| 35 | **********************************************************************
|
|---|
| 36 |
|
|---|
| 37 | -------------------------- END-OF-HEADER -----------------------------
|
|---|
| 38 |
|
|---|
| 39 | File : STM32G4xx_Startup.s
|
|---|
| 40 | Purpose : Startup and exception handlers for STM32G4xx devices.
|
|---|
| 41 |
|
|---|
| 42 | Additional information:
|
|---|
| 43 | Preprocessor Definitions
|
|---|
| 44 | __NO_SYSTEM_INIT
|
|---|
| 45 | If defined,
|
|---|
| 46 | SystemInit is not called.
|
|---|
| 47 | If not defined,
|
|---|
| 48 | SystemInit is called.
|
|---|
| 49 | SystemInit is usually supplied by the CMSIS files.
|
|---|
| 50 | This file declares a weak implementation as fallback.
|
|---|
| 51 |
|
|---|
| 52 | __NO_SYSTEM_CLK_UPDATE
|
|---|
| 53 | If defined,
|
|---|
| 54 | SystemCoreClockUpdate is not automatically called.
|
|---|
| 55 | Should be defined if SystemCoreClockUpdate must not be called before main().
|
|---|
| 56 | If not defined,
|
|---|
| 57 | SystemCoreClockUpdate is called before the application entry point.
|
|---|
| 58 |
|
|---|
| 59 | __MEMORY_INIT
|
|---|
| 60 | If defined,
|
|---|
| 61 | MemoryInit is called after SystemInit.
|
|---|
| 62 | void MemoryInit(void) can be implemented to enable external
|
|---|
| 63 | memory controllers.
|
|---|
| 64 |
|
|---|
| 65 | __VECTORS_IN_RAM
|
|---|
| 66 | If defined,
|
|---|
| 67 | the vector table will be copied from Flash to RAM,
|
|---|
| 68 | and the vector table offset register is adjusted.
|
|---|
| 69 |
|
|---|
| 70 | __VTOR_CONFIG
|
|---|
| 71 | If defined,
|
|---|
| 72 | the vector table offset register is set to point to the
|
|---|
| 73 | application's vector table.
|
|---|
| 74 |
|
|---|
| 75 | __NO_FPU_ENABLE
|
|---|
| 76 | If defined, the FPU is explicitly not enabled,
|
|---|
| 77 | even if the compiler could use floating point operations.
|
|---|
| 78 |
|
|---|
| 79 | __SOFTFP__
|
|---|
| 80 | Defined by the build system.
|
|---|
| 81 | If not defined, the FPU is enabled for floating point operations.
|
|---|
| 82 | */
|
|---|
| 83 |
|
|---|
| 84 | .syntax unified
|
|---|
| 85 |
|
|---|
| 86 |
|
|---|
| 87 | /*********************************************************************
|
|---|
| 88 | *
|
|---|
| 89 | * Global functions
|
|---|
| 90 | *
|
|---|
| 91 | **********************************************************************
|
|---|
| 92 | */
|
|---|
| 93 | /*********************************************************************
|
|---|
| 94 | *
|
|---|
| 95 | * Reset_Handler
|
|---|
| 96 | *
|
|---|
| 97 | * Function description
|
|---|
| 98 | * Exception handler for reset.
|
|---|
| 99 | * Generic bringup of a Cortex-M system.
|
|---|
| 100 | *
|
|---|
| 101 | * Additional information
|
|---|
| 102 | * The stack pointer is expected to be initialized by hardware,
|
|---|
| 103 | * i.e. read from vectortable[0].
|
|---|
| 104 | * For manual initialization add
|
|---|
| 105 | * ldr R0, =__stack_end__
|
|---|
| 106 | * mov SP, R0
|
|---|
| 107 | */
|
|---|
| 108 | .global reset_handler
|
|---|
| 109 | .global Reset_Handler
|
|---|
| 110 | .equ reset_handler, Reset_Handler
|
|---|
| 111 | .section .init.Reset_Handler, "ax"
|
|---|
| 112 | .balign 2
|
|---|
| 113 | .thumb_func
|
|---|
| 114 | Reset_Handler:
|
|---|
| 115 | #ifdef __SEGGER_STOP
|
|---|
| 116 | .extern __SEGGER_STOP_Limit_MSP
|
|---|
| 117 | //
|
|---|
| 118 | // Initialize main stack limit to 0 to disable stack checks before runtime init
|
|---|
| 119 | //
|
|---|
| 120 | movs R0, #0
|
|---|
| 121 | ldr R1, =__SEGGER_STOP_Limit_MSP
|
|---|
| 122 | str R0, [R1]
|
|---|
| 123 | #endif
|
|---|
| 124 | #ifndef __NO_SYSTEM_INIT
|
|---|
| 125 | //
|
|---|
| 126 | // Call SystemInit
|
|---|
| 127 | //
|
|---|
| 128 | bl SystemInit
|
|---|
| 129 | #endif
|
|---|
| 130 | #ifdef __MEMORY_INIT
|
|---|
| 131 | //
|
|---|
| 132 | // Call MemoryInit
|
|---|
| 133 | //
|
|---|
| 134 | bl MemoryInit
|
|---|
| 135 | #endif
|
|---|
| 136 | #ifdef __VECTORS_IN_RAM
|
|---|
| 137 | //
|
|---|
| 138 | // Copy vector table (from Flash) to RAM
|
|---|
| 139 | //
|
|---|
| 140 | ldr R0, =__vectors_start__
|
|---|
| 141 | ldr R1, =__vectors_end__
|
|---|
| 142 | ldr R2, =__vectors_ram_start__
|
|---|
| 143 | 1:
|
|---|
| 144 | cmp R0, R1
|
|---|
| 145 | beq 2f
|
|---|
| 146 | ldr R3, [R0]
|
|---|
| 147 | str R3, [R2]
|
|---|
| 148 | adds R0, R0, #4
|
|---|
| 149 | adds R2, R2, #4
|
|---|
| 150 | b 1b
|
|---|
| 151 | 2:
|
|---|
| 152 | #endif
|
|---|
| 153 |
|
|---|
| 154 | #if defined(__VTOR_CONFIG) || defined(__VECTORS_IN_RAM)
|
|---|
| 155 | //
|
|---|
| 156 | // Configure vector table offset register
|
|---|
| 157 | //
|
|---|
| 158 | #ifdef __ARM_ARCH_6M__
|
|---|
| 159 | ldr R0, =0xE000ED08 // VTOR_REG
|
|---|
| 160 | #else
|
|---|
| 161 | movw R0, 0xED08 // VTOR_REG
|
|---|
| 162 | movt R0, 0xE000
|
|---|
| 163 | #endif
|
|---|
| 164 | #ifdef __VECTORS_IN_RAM
|
|---|
| 165 | ldr R1, =_vectors_ram
|
|---|
| 166 | #else
|
|---|
| 167 | ldr R1, =_vectors
|
|---|
| 168 | #endif
|
|---|
| 169 | str R1, [R0]
|
|---|
| 170 | #endif
|
|---|
| 171 | #if !defined(__SOFTFP__) && !defined(__NO_FPU_ENABLE)
|
|---|
| 172 | //
|
|---|
| 173 | // Enable CP11 and CP10 with CPACR |= (0xf<<20)
|
|---|
| 174 | //
|
|---|
| 175 | movw R0, 0xED88 // CPACR
|
|---|
| 176 | movt R0, 0xE000
|
|---|
| 177 | ldr R1, [R0]
|
|---|
| 178 | orrs R1, R1, #(0xf << 20)
|
|---|
| 179 | str R1, [R0]
|
|---|
| 180 | #endif
|
|---|
| 181 | //
|
|---|
| 182 | // Call runtime initialization, which calls main().
|
|---|
| 183 | //
|
|---|
| 184 | bl _start
|
|---|
| 185 |
|
|---|
| 186 | //
|
|---|
| 187 | // Weak only declaration of SystemInit enables Linker to replace bl SystemInit with a NOP,
|
|---|
| 188 | // when there is no strong definition of SystemInit.
|
|---|
| 189 | //
|
|---|
| 190 | .weak SystemInit
|
|---|
| 191 | //
|
|---|
| 192 | // Place SystemCoreClockUpdate in .init_array
|
|---|
| 193 | // to be called after runtime initialization
|
|---|
| 194 | //
|
|---|
| 195 | #if !defined(__NO_SYSTEM_INIT) && !defined(__NO_SYSTEM_CLK_UPDATE)
|
|---|
| 196 | .section .init_array, "aw"
|
|---|
| 197 | .balign 4
|
|---|
| 198 | .word SystemCoreClockUpdate
|
|---|
| 199 | #endif
|
|---|
| 200 |
|
|---|
| 201 | /*********************************************************************
|
|---|
| 202 | *
|
|---|
| 203 | * HardFault_Handler
|
|---|
| 204 | *
|
|---|
| 205 | * Function description
|
|---|
| 206 | * Simple exception handler for HardFault.
|
|---|
| 207 | * In case of a HardFault caused by BKPT instruction without
|
|---|
| 208 | * debugger attached, return execution, otherwise stay in loop.
|
|---|
| 209 | *
|
|---|
| 210 | * Additional information
|
|---|
| 211 | * The stack pointer is expected to be initialized by hardware,
|
|---|
| 212 | * i.e. read from vectortable[0].
|
|---|
| 213 | * For manual initialization add
|
|---|
| 214 | * ldr R0, =__stack_end__
|
|---|
| 215 | * mov SP, R0
|
|---|
| 216 | */
|
|---|
| 217 |
|
|---|
| 218 | #undef L
|
|---|
| 219 | #define L(label) .LHardFault_Handler_##label
|
|---|
| 220 |
|
|---|
| 221 | .weak HardFault_Handler
|
|---|
| 222 | .section .init.HardFault_Handler, "ax"
|
|---|
| 223 | .balign 2
|
|---|
| 224 | .thumb_func
|
|---|
| 225 | HardFault_Handler:
|
|---|
| 226 | //
|
|---|
| 227 | // Check if HardFault is caused by BKPT instruction
|
|---|
| 228 | //
|
|---|
| 229 | ldr R1, =0xE000ED2C // Load NVIC_HFSR
|
|---|
| 230 | ldr R2, [R1]
|
|---|
| 231 | cmp R2, #0 // Check NVIC_HFSR[31]
|
|---|
| 232 |
|
|---|
| 233 | L(hfLoop):
|
|---|
| 234 | bmi L(hfLoop) // Not set? Stay in HardFault Handler.
|
|---|
| 235 | //
|
|---|
| 236 | // Continue execution after BKPT instruction
|
|---|
| 237 | //
|
|---|
| 238 | #if defined(__thumb__) && !defined(__thumb2__)
|
|---|
| 239 | movs R0, #4
|
|---|
| 240 | mov R1, LR
|
|---|
| 241 | tst R0, R1 // Check EXC_RETURN in Link register bit 2.
|
|---|
| 242 | bne L(Uses_PSP)
|
|---|
| 243 | mrs R0, MSP // Stacking was using MSP.
|
|---|
| 244 | b L(Pass_StackPtr)
|
|---|
| 245 | L(Uses_PSP):
|
|---|
| 246 | mrs R0, PSP // Stacking was using PSP.
|
|---|
| 247 | L(Pass_StackPtr):
|
|---|
| 248 | #else
|
|---|
| 249 | tst LR, #4 // Check EXC_RETURN[2] in link register to get the return stack
|
|---|
| 250 | ite eq
|
|---|
| 251 | mrseq R0, MSP // Frame stored on MSP
|
|---|
| 252 | mrsne R0, PSP // Frame stored on PSP
|
|---|
| 253 | #endif
|
|---|
| 254 | //
|
|---|
| 255 | // Reset HardFault Status
|
|---|
| 256 | //
|
|---|
| 257 | #if defined(__thumb__) && !defined(__thumb2__)
|
|---|
| 258 | movs R3, #1
|
|---|
| 259 | lsls R3, R3, #31
|
|---|
| 260 | orrs R2, R3
|
|---|
| 261 | str R2, [R1]
|
|---|
| 262 | #else
|
|---|
| 263 | orr R2, R2, #0x80000000
|
|---|
| 264 | str R2, [R1]
|
|---|
| 265 | #endif
|
|---|
| 266 | //
|
|---|
| 267 | // Adjust return address
|
|---|
| 268 | //
|
|---|
| 269 | ldr R1, [R0, #24] // Get stored PC from stack
|
|---|
| 270 | adds R1, #2 // Adjust PC by 2 to skip current BKPT
|
|---|
| 271 | str R1, [R0, #24] // Write back adjusted PC to stack
|
|---|
| 272 | //
|
|---|
| 273 | bx LR // Return
|
|---|
| 274 |
|
|---|
| 275 | /*************************** End of file ****************************/
|
|---|