OP-1156 fix path logic to not deviate from correct altitude too much
[librepilot.git] / flight / pios / stm32f10x / startup_stm32f10x_HD.S
blobafb4b5b0b0275b2a49be79048ac3aed16b53e800
1 /**
2   ******************************************************************************
3   * @file      startup_stm32f10x_hd.s
4   * @author    MCD Application Team / David Ankers: Vector table for FreeRTOS
5   * @version   V3.1.2
6   * @date      09/28/2009
7   * @brief     STM32F10x High Density Devices vector table for RIDE7 toolchain. 
8   *            This module performs:
9   *                - Set the initial SP
10   *                - Set the initial PC == Reset_Handler,
11   *                - Set the vector table entries with the exceptions ISR address,
12   *                - Configure external SRAM mounted on STM3210E-EVAL board
13   *                  to be used as data memory (optional, to be enabled by user)
14   *                - Branches to main in the C library (which eventually
15   *                  calls main()).
16   *            After Reset the Cortex-M3 processor is in Thread mode,
17   *            priority is Privileged, and the Stack is set to Main.
18   ******************************************************************************
19   * @copy
20   *
21   * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
22   * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
23   * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY
24   * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
25   * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
26   * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
27   *
28   * <h2><center>&copy; COPYRIGHT 2009 STMicroelectronics</center></h2>
29   */  
30     
31     .syntax unified
32   .cpu cortex-m3
33   .fpu softvfp
34   .thumb
36 .global  g_pfnVectors
37 .global  SystemInit_ExtMemCtl_Dummy
38 .global  Default_Handler
40 /* start address for the initialization values of the .data section. 
41 defined in linker script */
42 .word  _sidata
43 /* start address for the .data section. defined in linker script */  
44 .word  _sdata
45 /* end address for the .data section. defined in linker script */
46 .word  _edata
47 /* start address for the .bss section. defined in linker script */
48 .word  _sbss
49 /* end address for the .bss section. defined in linker script */
50 .word  _ebss
51 /* stack used for SystemInit_ExtMemCtl; always internal RAM used */
53 .equ  Initial_spTop,  0x20000400 
54 .equ  BootRAM,        0xF1E0F85F
55 /**
56  * @brief  This is the code that gets called when the processor first
57  *          starts execution following a reset event. Only the absolutely
58  *          necessary set is performed, after which the application
59  *          supplied main() routine is called. 
60  * @param  None
61  * @retval : None
64     .section  .text.Reset_Handler
65   .weak  Reset_Handler
66   .type  Reset_Handler, %function
67 Reset_Handler:  
69 /* Copy the data segment initializers from flash to SRAM */  
70   movs  r1, #0
71   b  LoopCopyDataInit
73 CopyDataInit:
74   ldr  r3, =_sidata
75   ldr  r3, [r3, r1]
76   str  r3, [r0, r1]
77   adds  r1, r1, #4
78     
79 LoopCopyDataInit:
80   ldr  r0, =_sdata
81   ldr  r3, =_edata
82   adds  r2, r0, r1
83   cmp  r2, r3
84   bcc  CopyDataInit
85   ldr  r2, =_sbss
86   b  LoopFillZerobss
87 /* Zero fill the bss segment. */  
88 FillZerobss:
89   movs  r3, #0
90   str  r3, [r2], #4
91     
92 LoopFillZerobss:
93   ldr  r3, = _ebss
94   cmp  r2, r3
95   bcc  FillZerobss
96 /* Call the application's entry point.*/
97   bl  main
98   bx  lr    
99 .size  Reset_Handler, .-Reset_Handler
102  * @brief  Dummy SystemInit_ExtMemCtl function 
103  * @param  None     
104  * @retval : None       
106   .section  .text.SystemInit_ExtMemCtl_Dummy,"ax",%progbits
107 SystemInit_ExtMemCtl_Dummy:
108   bx  lr
109   .size  SystemInit_ExtMemCtl_Dummy, .-SystemInit_ExtMemCtl_Dummy
112  * @brief  This is the code that gets called when the processor receives an 
113  *         unexpected interrupt.  This simply enters an infinite loop, preserving
114  *         the system state for examination by a debugger.
116  * @param  None     
117  * @retval : None       
119     .section  .text.Default_Handler,"ax",%progbits
120 Default_Handler:
121 Infinite_Loop:
122   b  Infinite_Loop
123   .size  Default_Handler, .-Default_Handler
124 /******************************************************************************
126 * The minimal vector table for a Cortex M3.  Note that the proper constructs
127 * must be placed on this to ensure that it ends up at physical address
128 * 0x0000.0000.
130 ******************************************************************************/    
131    .section  .isr_vector,"a",%progbits
132   .type  g_pfnVectors, %object
133   .size  g_pfnVectors, .-g_pfnVectors
134     
135     
136 g_pfnVectors:
137   .word  _estack
138   .word  Reset_Handler
139   .word  NMI_Handler
140   .word  HardFault_Handler
141   .word  MemManage_Handler
142   .word  BusFault_Handler
143   .word  UsageFault_Handler
144   .word  0
145   .word  0
146   .word  0
147   .word  0
148   .word  SVC_Handler
149   .word  DebugMon_Handler
150   .word  0
151   .word  PendSV_Handler
152   .word  SysTick_Handler
153   .word  WWDG_IRQHandler
154   .word  PVD_IRQHandler
155   .word  TAMPER_IRQHandler
156   .word  RTC_IRQHandler
157   .word  FLASH_IRQHandler
158   .word  RCC_IRQHandler
159   .word  EXTI0_IRQHandler
160   .word  EXTI1_IRQHandler
161   .word  EXTI2_IRQHandler
162   .word  EXTI3_IRQHandler
163   .word  EXTI4_IRQHandler
164   .word  DMA1_Channel1_IRQHandler
165   .word  DMA1_Channel2_IRQHandler
166   .word  DMA1_Channel3_IRQHandler
167   .word  DMA1_Channel4_IRQHandler
168   .word  DMA1_Channel5_IRQHandler
169   .word  DMA1_Channel6_IRQHandler
170   .word  DMA1_Channel7_IRQHandler
171   .word  ADC1_2_IRQHandler
172   .word  USB_HP_CAN1_TX_IRQHandler
173   .word  USB_LP_CAN1_RX0_IRQHandler
174   .word  CAN1_RX1_IRQHandler
175   .word  CAN1_SCE_IRQHandler
176   .word  EXTI9_5_IRQHandler
177   .word  TIM1_BRK_IRQHandler
178   .word  TIM1_UP_IRQHandler
179   .word  TIM1_TRG_COM_IRQHandler
180   .word  TIM1_CC_IRQHandler
181   .word  TIM2_IRQHandler
182   .word  TIM3_IRQHandler
183   .word  TIM4_IRQHandler
184   .word  I2C1_EV_IRQHandler
185   .word  I2C1_ER_IRQHandler
186   .word  I2C2_EV_IRQHandler
187   .word  I2C2_ER_IRQHandler
188   .word  SPI1_IRQHandler
189   .word  SPI2_IRQHandler
190   .word  USART1_IRQHandler
191   .word  USART2_IRQHandler
192   .word  USART3_IRQHandler
193   .word  EXTI15_10_IRQHandler
194   .word  RTCAlarm_IRQHandler
195   .word  USBWakeUp_IRQHandler
196   .word  TIM8_BRK_IRQHandler
197   .word  TIM8_UP_IRQHandler
198   .word  TIM8_TRG_COM_IRQHandler
199   .word  TIM8_CC_IRQHandler
200   .word  ADC3_IRQHandler
201   .word  FSMC_IRQHandler
202   .word  SDIO_IRQHandler
203   .word  TIM5_IRQHandler
204   .word  SPI3_IRQHandler
205   .word  UART4_IRQHandler
206   .word  UART5_IRQHandler
207   .word  TIM6_IRQHandler
208   .word  TIM7_IRQHandler
209   .word  DMA2_Channel1_IRQHandler
210   .word  DMA2_Channel2_IRQHandler
211   .word  DMA2_Channel3_IRQHandler
212   .word  DMA2_Channel4_5_IRQHandler
213   .word  0
214   .word  0
215   .word  0
216   .word  0
217   .word  0
218   .word  0
219   .word  0
220   .word  0
221   .word  0
222   .word  0
223   .word  0
224   .word  0
225   .word  0
226   .word  0
227   .word  0
228   .word  0
229   .word  0
230   .word  0
231   .word  0
232   .word  0
233   .word  0
234   .word  0
235   .word  0
236   .word  0
237   .word  0
238   .word  0
239   .word  0
240   .word  0
241   .word  0
242   .word  0
243   .word  0
244   .word  0
245   .word  0
246   .word  0
247   .word  0
248   .word  0
249   .word  0
250   .word  0
251   .word  0
252   .word  0
253   .word  0
254   .word  0
255   .word  0
256   .word  0
257   .word  BootRAM       /* @0x1E0. This is for boot in RAM mode for 
258                          STM32F10x High Density devices. */
259    
260 /*******************************************************************************
262 * Provide weak aliases for each Exception handler to the Default_Handler. 
263 * As they are weak aliases, any function with the same name will override 
264 * this definition.
266 *******************************************************************************/
267     
268   .weak  NMI_Handler
269   .thumb_set NMI_Handler,Default_Handler
270   
271   .weak  HardFault_Handler
272   .thumb_set HardFault_Handler,Default_Handler
273   
274   .weak  MemManage_Handler
275   .thumb_set MemManage_Handler,Default_Handler
276   
277   .weak  BusFault_Handler
278   .thumb_set BusFault_Handler,Default_Handler
280   .weak  UsageFault_Handler
281   .thumb_set UsageFault_Handler,Default_Handler
283   .weak  SVC_Handler
284   .thumb_set SVC_Handler,Default_Handler
286   .weak  DebugMon_Handler
287   .thumb_set DebugMon_Handler,Default_Handler
289   .weak  PendSV_Handler
290   .thumb_set PendSV_Handler,Default_Handler
292   .weak  SysTick_Handler
293   .thumb_set SysTick_Handler,Default_Handler
295   .weak  WWDG_IRQHandler
296   .thumb_set WWDG_IRQHandler,Default_Handler
298   .weak  PVD_IRQHandler
299   .thumb_set PVD_IRQHandler,Default_Handler
301   .weak  TAMPER_IRQHandler
302   .thumb_set TAMPER_IRQHandler,Default_Handler
304   .weak  RTC_IRQHandler
305   .thumb_set RTC_IRQHandler,Default_Handler
307   .weak  FLASH_IRQHandler
308   .thumb_set FLASH_IRQHandler,Default_Handler
310   .weak  RCC_IRQHandler
311   .thumb_set RCC_IRQHandler,Default_Handler
313   .weak  EXTI0_IRQHandler
314   .thumb_set EXTI0_IRQHandler,Default_Handler
316   .weak  EXTI1_IRQHandler
317   .thumb_set EXTI1_IRQHandler,Default_Handler
319   .weak  EXTI2_IRQHandler
320   .thumb_set EXTI2_IRQHandler,Default_Handler
322   .weak  EXTI3_IRQHandler
323   .thumb_set EXTI3_IRQHandler,Default_Handler
325   .weak  EXTI4_IRQHandler
326   .thumb_set EXTI4_IRQHandler,Default_Handler
328   .weak  DMA1_Channel1_IRQHandler
329   .thumb_set DMA1_Channel1_IRQHandler,Default_Handler
331   .weak  DMA1_Channel2_IRQHandler
332   .thumb_set DMA1_Channel2_IRQHandler,Default_Handler
334   .weak  DMA1_Channel3_IRQHandler
335   .thumb_set DMA1_Channel3_IRQHandler,Default_Handler
337   .weak  DMA1_Channel4_IRQHandler
338   .thumb_set DMA1_Channel4_IRQHandler,Default_Handler
340   .weak  DMA1_Channel5_IRQHandler
341   .thumb_set DMA1_Channel5_IRQHandler,Default_Handler
343   .weak  DMA1_Channel6_IRQHandler
344   .thumb_set DMA1_Channel6_IRQHandler,Default_Handler
346   .weak  DMA1_Channel7_IRQHandler
347   .thumb_set DMA1_Channel7_IRQHandler,Default_Handler
349   .weak  ADC1_2_IRQHandler
350   .thumb_set ADC1_2_IRQHandler,Default_Handler
352   .weak  USB_HP_CAN1_TX_IRQHandler
353   .thumb_set USB_HP_CAN1_TX_IRQHandler,Default_Handler
355   .weak  USB_LP_CAN1_RX0_IRQHandler
356   .thumb_set USB_LP_CAN1_RX0_IRQHandler,Default_Handler
358   .weak  CAN1_RX1_IRQHandler
359   .thumb_set CAN1_RX1_IRQHandler,Default_Handler
361   .weak  CAN1_SCE_IRQHandler
362   .thumb_set CAN1_SCE_IRQHandler,Default_Handler
364   .weak  EXTI9_5_IRQHandler
365   .thumb_set EXTI9_5_IRQHandler,Default_Handler
367   .weak  TIM1_BRK_IRQHandler
368   .thumb_set TIM1_BRK_IRQHandler,Default_Handler
370   .weak  TIM1_UP_IRQHandler
371   .thumb_set TIM1_UP_IRQHandler,Default_Handler
373   .weak  TIM1_TRG_COM_IRQHandler
374   .thumb_set TIM1_TRG_COM_IRQHandler,Default_Handler
376   .weak  TIM1_CC_IRQHandler
377   .thumb_set TIM1_CC_IRQHandler,Default_Handler
379   .weak  TIM2_IRQHandler
380   .thumb_set TIM2_IRQHandler,Default_Handler
382   .weak  TIM3_IRQHandler
383   .thumb_set TIM3_IRQHandler,Default_Handler
385   .weak  TIM4_IRQHandler
386   .thumb_set TIM4_IRQHandler,Default_Handler
388   .weak  I2C1_EV_IRQHandler
389   .thumb_set I2C1_EV_IRQHandler,Default_Handler
391   .weak  I2C1_ER_IRQHandler
392   .thumb_set I2C1_ER_IRQHandler,Default_Handler
394   .weak  I2C2_EV_IRQHandler
395   .thumb_set I2C2_EV_IRQHandler,Default_Handler
397   .weak  I2C2_ER_IRQHandler
398   .thumb_set I2C2_ER_IRQHandler,Default_Handler
400   .weak  SPI1_IRQHandler
401   .thumb_set SPI1_IRQHandler,Default_Handler
403   .weak  SPI2_IRQHandler
404   .thumb_set SPI2_IRQHandler,Default_Handler
406   .weak  USART1_IRQHandler
407   .thumb_set USART1_IRQHandler,Default_Handler
409   .weak  USART2_IRQHandler
410   .thumb_set USART2_IRQHandler,Default_Handler
412   .weak  USART3_IRQHandler
413   .thumb_set USART3_IRQHandler,Default_Handler
415   .weak  EXTI15_10_IRQHandler
416   .thumb_set EXTI15_10_IRQHandler,Default_Handler
418   .weak  RTCAlarm_IRQHandler
419   .thumb_set RTCAlarm_IRQHandler,Default_Handler
421   .weak  USBWakeUp_IRQHandler
422   .thumb_set USBWakeUp_IRQHandler,Default_Handler
424   .weak  TIM8_BRK_IRQHandler
425   .thumb_set TIM8_BRK_IRQHandler,Default_Handler
427   .weak  TIM8_UP_IRQHandler
428   .thumb_set TIM8_UP_IRQHandler,Default_Handler
430   .weak  TIM8_TRG_COM_IRQHandler
431   .thumb_set TIM8_TRG_COM_IRQHandler,Default_Handler
433   .weak  TIM8_CC_IRQHandler
434   .thumb_set TIM8_CC_IRQHandler,Default_Handler
436   .weak  ADC3_IRQHandler
437   .thumb_set ADC3_IRQHandler,Default_Handler
439   .weak  FSMC_IRQHandler
440   .thumb_set FSMC_IRQHandler,Default_Handler
442   .weak  SDIO_IRQHandler
443   .thumb_set SDIO_IRQHandler,Default_Handler
445   .weak  TIM5_IRQHandler
446   .thumb_set TIM5_IRQHandler,Default_Handler
448   .weak  SPI3_IRQHandler
449   .thumb_set SPI3_IRQHandler,Default_Handler
451   .weak  UART4_IRQHandler
452   .thumb_set UART4_IRQHandler,Default_Handler
454   .weak  UART5_IRQHandler
455   .thumb_set UART5_IRQHandler,Default_Handler
457   .weak  TIM6_IRQHandler
458   .thumb_set TIM6_IRQHandler,Default_Handler
460   .weak  TIM7_IRQHandler
461   .thumb_set TIM7_IRQHandler,Default_Handler
463   .weak  DMA2_Channel1_IRQHandler
464   .thumb_set DMA2_Channel1_IRQHandler,Default_Handler
466   .weak  DMA2_Channel2_IRQHandler
467   .thumb_set DMA2_Channel2_IRQHandler,Default_Handler
469   .weak  DMA2_Channel3_IRQHandler
470   .thumb_set DMA2_Channel3_IRQHandler,Default_Handler
472   .weak  DMA2_Channel4_5_IRQHandler
473   .thumb_set DMA2_Channel4_5_IRQHandler,Default_Handler
475   .weak  SystemInit_ExtMemCtl
476   .thumb_set SystemInit_ExtMemCtl,SystemInit_ExtMemCtl_Dummy