add files from nrf52832 bootloader project
This commit is contained in:
hathach
@ -0,0 +1,52 @@
|
||||
/* Copyright (c) 2015 Nordic Semiconductor. All Rights Reserved.
|
||||
*
|
||||
* The information contained herein is property of Nordic Semiconductor ASA.
|
||||
* Terms and conditions of usage are described in detail in NORDIC
|
||||
* SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
|
||||
*
|
||||
* Licensees are granted free, non-transferable use of the information. NO
|
||||
* WARRANTY of ANY KIND is provided. This heading must NOT be removed from
|
||||
* the file.
|
||||
*
|
||||
*/
|
||||
#include <stdint.h>
|
||||
|
||||
void HardFault_Handler(void) __attribute__(( naked ));
|
||||
|
||||
void HardFault_Handler(void)
|
||||
{
|
||||
__asm volatile(
|
||||
" .syntax unified \n"
|
||||
|
||||
" ldr r0, =0xFFFFFFFD \n"
|
||||
" cmp r0, lr \n"
|
||||
" bne HardFault_Handler_ChooseMSP \n"
|
||||
/* Reading PSP into R0 */
|
||||
" mrs r0, PSP \n"
|
||||
" b HardFault_Handler_Continue \n"
|
||||
"HardFault_Handler_ChooseMSP: \n"
|
||||
/* Reading MSP into R0 */
|
||||
" mrs r0, MSP \n"
|
||||
/* -----------------------------------------------------------------
|
||||
* If we have selected MSP check if we may use stack safetly.
|
||||
* If not - reset the stack to the initial value. */
|
||||
" ldr r1, =__StackTop \n"
|
||||
" ldr r2, =__StackLimit \n"
|
||||
|
||||
/* MSP is in the range of <__StackTop, __StackLimit) */
|
||||
" cmp r0, r1 \n"
|
||||
" bhi HardFault_MoveSP \n"
|
||||
" cmp r0, r2 \n"
|
||||
" bhi HardFault_Handler_Continue \n"
|
||||
/* ----------------------------------------------------------------- */
|
||||
"HardFault_MoveSP: \n"
|
||||
" mov SP, r1 \n"
|
||||
" movs r0, #0 \n"
|
||||
|
||||
"HardFault_Handler_Continue: \n"
|
||||
" ldr r3, =HardFault_c_handler \n"
|
||||
" bx r3 \n"
|
||||
|
||||
" .align \n"
|
||||
);
|
||||
}
|
||||
@ -0,0 +1,65 @@
|
||||
/* Copyright (c) 2015 Nordic Semiconductor. All Rights Reserved.
|
||||
*
|
||||
* The information contained herein is property of Nordic Semiconductor ASA.
|
||||
* Terms and conditions of usage are described in detail in NORDIC
|
||||
* SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
|
||||
*
|
||||
* Licensees are granted free, non-transferable use of the information. NO
|
||||
* WARRANTY of ANY KIND is provided. This heading must NOT be removed from
|
||||
* the file.
|
||||
*
|
||||
*/
|
||||
#include <stdint.h>
|
||||
|
||||
#pragma section = "CSTACK"
|
||||
extern void HardFault_c_handler( uint32_t * );
|
||||
|
||||
__stackless void HardFault_Handler(void);
|
||||
|
||||
__stackless void HardFault_Handler(void)
|
||||
{
|
||||
__asm volatile(
|
||||
" ldr r0, 100f \n"
|
||||
" cmp r0, lr \n"
|
||||
" bne 1f \n"
|
||||
/* Reading PSP into R0 */
|
||||
" mrs r0, PSP \n"
|
||||
" b 3f \n"
|
||||
"1: \n"
|
||||
/* Reading MSP into R0 */
|
||||
" mrs r0, MSP \n"
|
||||
/* -----------------------------------------------------------------
|
||||
* If we have selected MSP check if we may use stack safetly.
|
||||
* If not - reset the stack to the initial value. */
|
||||
" ldr r1, 101f \n"
|
||||
" ldr r2, 102f \n"
|
||||
|
||||
/* MSP is in the range of <__StackTop, __StackLimit) */
|
||||
" cmp r0, r1 \n"
|
||||
" bhi 2f \n"
|
||||
" cmp r0, r2 \n"
|
||||
" bhi 3f \n"
|
||||
/* ----------------------------------------------------------------- */
|
||||
"2: \n"
|
||||
" mov SP, r1 \n"
|
||||
" movs r0, #0 \n"
|
||||
|
||||
"3: \n"
|
||||
" ldr r3, 103f \n"
|
||||
" bx r3 \n"
|
||||
|
||||
"100: \n"
|
||||
" DC32 0xFFFFFFFD \n"
|
||||
"101: \n"
|
||||
" DC32 %c0 \n"
|
||||
"102: \n"
|
||||
" DC32 %c1 \n"
|
||||
"103: \n"
|
||||
" DC32 %c2 \n"
|
||||
: /* Outputs */
|
||||
: /* Inputs */
|
||||
"i"(__section_end("CSTACK")),
|
||||
"i"(__section_begin("CSTACK")),
|
||||
"i"(&HardFault_c_handler)
|
||||
);
|
||||
}
|
||||
@ -0,0 +1,61 @@
|
||||
/* Copyright (c) 2015 Nordic Semiconductor. All Rights Reserved.
|
||||
*
|
||||
* The information contained herein is property of Nordic Semiconductor ASA.
|
||||
* Terms and conditions of usage are described in detail in NORDIC
|
||||
* SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
|
||||
*
|
||||
* Licensees are granted free, non-transferable use of the information. NO
|
||||
* WARRANTY of ANY KIND is provided. This heading must NOT be removed from
|
||||
* the file.
|
||||
*
|
||||
*/
|
||||
#include <stdint.h>
|
||||
|
||||
//lint -save -e27 -e10 -e19 -e40
|
||||
extern char STACK$$Base;
|
||||
|
||||
/* This variable should be static but then it cannot be used in assembly code below.
|
||||
* The problem here is that the address of the section can be archived by $$ operator
|
||||
* that is not allowed in assembly code. */
|
||||
char const * HardFault_Handler_stack_bottom = &STACK$$Base;
|
||||
//lint -restore
|
||||
|
||||
__asm void HardFault_Handler(void)
|
||||
{
|
||||
PRESERVE8
|
||||
EXTERN HardFault_c_handler
|
||||
EXTERN __initial_sp
|
||||
EXTERN HardFault_Handler_stack_bottom
|
||||
|
||||
ldr r0, =0xFFFFFFFD
|
||||
cmp r0, lr
|
||||
bne HardFault_Handler_ChooseMSP
|
||||
/* Reading PSP into R0 */
|
||||
mrs r0, PSP
|
||||
b HardFault_Handler_Continue
|
||||
HardFault_Handler_ChooseMSP
|
||||
/* Reading MSP into R0 */
|
||||
mrs r0, MSP
|
||||
/* -----------------------------------------------------------------
|
||||
* If we have selected MSP, check if we may use stack safely.
|
||||
* If not - reset the stack to the initial value. */
|
||||
ldr r1, =__initial_sp
|
||||
ldr r2, =HardFault_Handler_stack_bottom
|
||||
ldr r2, [r2]
|
||||
|
||||
/* MSP is in the range of <__StackTop, __StackLimit) */
|
||||
cmp r0, r1
|
||||
bhi HardFault_MoveSP
|
||||
cmp r0, r2
|
||||
bhi HardFault_Handler_Continue
|
||||
/* ----------------------------------------------------------------- */
|
||||
HardFault_MoveSP
|
||||
mov SP, r1
|
||||
movs r0, #0
|
||||
|
||||
HardFault_Handler_Continue
|
||||
ldr r3, =HardFault_c_handler
|
||||
bx r3
|
||||
|
||||
ALIGN
|
||||
}
|
||||
Reference in New Issue
Block a user