|
|
|
@ -46,21 +46,23 @@ __attribute__((optimize("O0")))
|
|
|
|
|
__attribute__( ( naked ) )
|
|
|
|
|
void Reset_Handler( void )
|
|
|
|
|
{
|
|
|
|
|
// set stack pointer
|
|
|
|
|
/* set stack pointer */
|
|
|
|
|
__asm volatile ( "ldr r0, =_estack" );
|
|
|
|
|
__asm volatile ( "mov sp, r0" );
|
|
|
|
|
// copy .data section from flash to RAM
|
|
|
|
|
|
|
|
|
|
/* copy .data section from flash to RAM */
|
|
|
|
|
for( uint32_t * src = &_sidata, * dest = &_sdata; dest < &_edata; )
|
|
|
|
|
{
|
|
|
|
|
*dest++ = *src++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// zero out .bss section
|
|
|
|
|
/* zero out .bss section */
|
|
|
|
|
for( uint32_t * dest = &_sbss; dest < &_ebss; )
|
|
|
|
|
{
|
|
|
|
|
*dest++ = 0;
|
|
|
|
|
}
|
|
|
|
|
// jump to board initialisation
|
|
|
|
|
|
|
|
|
|
/* jump to board initialisation */
|
|
|
|
|
void _start( void );
|
|
|
|
|
_start();
|
|
|
|
|
}
|
|
|
|
@ -68,9 +70,9 @@ void Reset_Handler(void)
|
|
|
|
|
void prvGetRegistersFromStack( uint32_t * pulFaultStackAddress )
|
|
|
|
|
{
|
|
|
|
|
/* These are volatile to try and prevent the compiler/linker optimising them
|
|
|
|
|
away as the variables never actually get used. If the debugger won't show the
|
|
|
|
|
values of the variables, make them global my moving their declaration outside
|
|
|
|
|
of this function. */
|
|
|
|
|
* away as the variables never actually get used. If the debugger won't show the
|
|
|
|
|
* values of the variables, make them global my moving their declaration outside
|
|
|
|
|
* of this function. */
|
|
|
|
|
volatile uint32_t r0;
|
|
|
|
|
volatile uint32_t r1;
|
|
|
|
|
volatile uint32_t r2;
|
|
|
|
@ -91,7 +93,9 @@ of this function. */
|
|
|
|
|
psr = pulFaultStackAddress[ 7 ];
|
|
|
|
|
|
|
|
|
|
/* When the following line is hit, the variables contain the register values. */
|
|
|
|
|
for( ;; );
|
|
|
|
|
for( ; ; )
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void Default_Handler( void ) __attribute__( ( naked ) );
|
|
|
|
@ -113,7 +117,6 @@ void Default_Handler(void)
|
|
|
|
|
static void HardFault_Handler( void ) __attribute__( ( naked ) );
|
|
|
|
|
void Default_Handler2( void )
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
__asm volatile
|
|
|
|
|
(
|
|
|
|
|
" tst lr, #4 \n"
|
|
|
|
@ -129,56 +132,64 @@ void Default_Handler2(void)
|
|
|
|
|
|
|
|
|
|
void Default_Handler3( void )
|
|
|
|
|
{
|
|
|
|
|
for (;;) { }
|
|
|
|
|
for( ; ; )
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void Default_Handler4( void )
|
|
|
|
|
{
|
|
|
|
|
for (;;) { }
|
|
|
|
|
for( ; ; )
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void Default_Handler5( void )
|
|
|
|
|
{
|
|
|
|
|
for (;;) { }
|
|
|
|
|
for( ; ; )
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void Default_Handler6( void )
|
|
|
|
|
{
|
|
|
|
|
for (;;) { }
|
|
|
|
|
for( ; ; )
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
const uint32_t * isr_vector[] __attribute__( ( section( ".isr_vector" ) ) ) =
|
|
|
|
|
{
|
|
|
|
|
( uint32_t * ) &_estack,
|
|
|
|
|
(uint32_t*)&Reset_Handler, // Reset -15
|
|
|
|
|
(uint32_t*)&Default_Handler, // NMI_Handler -14
|
|
|
|
|
(uint32_t*)&Default_Handler2, // HardFault_Handler -13
|
|
|
|
|
(uint32_t*)&Default_Handler3, // MemManage_Handler -12
|
|
|
|
|
(uint32_t*)&Default_Handler4, // BusFault_Handler -11
|
|
|
|
|
(uint32_t*)&Default_Handler5, // UsageFault_Handler -10
|
|
|
|
|
0, // reserved
|
|
|
|
|
0, // reserved
|
|
|
|
|
0, // reserved
|
|
|
|
|
0, // reserved -6
|
|
|
|
|
(uint32_t*)&vPortSVCHandler, // SVC_Handler -5
|
|
|
|
|
(uint32_t*)&Default_Handler6, // DebugMon_Handler -4
|
|
|
|
|
0, // reserved
|
|
|
|
|
(uint32_t*)&xPortPendSVHandler, // PendSV handler -2
|
|
|
|
|
(uint32_t*)&xPortSysTickHandler, // SysTick_Handler -1
|
|
|
|
|
0, // uart0 receive 0
|
|
|
|
|
0, // uart0 transmit
|
|
|
|
|
0, // uart1 receive
|
|
|
|
|
0, // uart1 transmit
|
|
|
|
|
0, // uart 2 receive
|
|
|
|
|
0, // uart 2 transmit
|
|
|
|
|
0, // GPIO 0 combined interrupt
|
|
|
|
|
0, // GPIO 2 combined interrupt
|
|
|
|
|
0, // Timer 0
|
|
|
|
|
0, // Timer 1
|
|
|
|
|
0, // Dial Timer
|
|
|
|
|
0, // SPI0 SPI1
|
|
|
|
|
0, // uart overflow 1 2,3 12
|
|
|
|
|
(uint32_t*)&EthernetISR, // Ethernet 13
|
|
|
|
|
( uint32_t * ) &Reset_Handler, /* Reset -15 */
|
|
|
|
|
( uint32_t * ) &Default_Handler, /* NMI_Handler -14 */
|
|
|
|
|
( uint32_t * ) &Default_Handler2, /* HardFault_Handler -13 */
|
|
|
|
|
( uint32_t * ) &Default_Handler3, /* MemManage_Handler -12 */
|
|
|
|
|
( uint32_t * ) &Default_Handler4, /* BusFault_Handler -11 */
|
|
|
|
|
( uint32_t * ) &Default_Handler5, /* UsageFault_Handler -10 */
|
|
|
|
|
0, /* reserved */
|
|
|
|
|
0, /* reserved */
|
|
|
|
|
0, /* reserved */
|
|
|
|
|
0, /* reserved -6 */
|
|
|
|
|
( uint32_t * ) &vPortSVCHandler, /* SVC_Handler -5 */
|
|
|
|
|
( uint32_t * ) &Default_Handler6, /* DebugMon_Handler -4 */
|
|
|
|
|
0, /* reserved */
|
|
|
|
|
( uint32_t * ) &xPortPendSVHandler, /* PendSV handler -2 */
|
|
|
|
|
( uint32_t * ) &xPortSysTickHandler, /* SysTick_Handler -1 */
|
|
|
|
|
0, /* uart0 receive 0 */
|
|
|
|
|
0, /* uart0 transmit */
|
|
|
|
|
0, /* uart1 receive */
|
|
|
|
|
0, /* uart1 transmit */
|
|
|
|
|
0, /* uart 2 receive */
|
|
|
|
|
0, /* uart 2 transmit */
|
|
|
|
|
0, /* GPIO 0 combined interrupt */
|
|
|
|
|
0, /* GPIO 2 combined interrupt */
|
|
|
|
|
0, /* Timer 0 */
|
|
|
|
|
0, /* Timer 1 */
|
|
|
|
|
0, /* Dial Timer */
|
|
|
|
|
0, /* SPI0 SPI1 */
|
|
|
|
|
0, /* uart overflow 1 2,3 12 */
|
|
|
|
|
( uint32_t * ) &EthernetISR, /* Ethernet 13 */
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
void _start( void )
|
|
|
|
@ -190,16 +201,15 @@ void _start(void)
|
|
|
|
|
|
|
|
|
|
__attribute__( ( naked ) ) void exit( int status )
|
|
|
|
|
{
|
|
|
|
|
// Force qemu to exit using ARM Semihosting
|
|
|
|
|
/* Force qemu to exit using ARM Semihosting */
|
|
|
|
|
__asm volatile (
|
|
|
|
|
"mov r1, r0\n"
|
|
|
|
|
"cmp r1, #0\n"
|
|
|
|
|
"bne .notclean\n"
|
|
|
|
|
"ldr r1, =0x20026\n" // ADP_Stopped_ApplicationExit, a clean exit
|
|
|
|
|
"ldr r1, =0x20026\n" /* ADP_Stopped_ApplicationExit, a clean exit */
|
|
|
|
|
".notclean:\n"
|
|
|
|
|
"movs r0, #0x18\n" // SYS_EXIT
|
|
|
|
|
"movs r0, #0x18\n" /* SYS_EXIT */
|
|
|
|
|
"bkpt 0xab\n"
|
|
|
|
|
"end: b end\n"
|
|
|
|
|
);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|