-
Notifications
You must be signed in to change notification settings - Fork 48
/
CrashCatcher_armv7m.S
115 lines (92 loc) · 3.9 KB
/
CrashCatcher_armv7m.S
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
/* Copyright (C) 2019 Adam Green (https://github.com/adamgreen)
Licensed under the Apache License, Version 2.0 (the "License");
you may not use this file except in compliance with the License.
You may obtain a copy of the License at
http://www.apache.org/licenses/LICENSE-2.0
Unless required by applicable law or agreed to in writing, software
distributed under the License is distributed on an "AS IS" BASIS,
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
See the License for the specific language governing permissions and
limitations under the License.
*/
#include "CrashCatcherPriv.h"
/* Implementation of ARMv7-M assembly language code to trap exceptions and call CrashCatcher_Entry(). */
.text
.syntax unified
.arch armv7-m
/* Called on Hard Fault exception. Stacks important registers and calls CrashCatcher_Entry().
extern "C" void HardFault_Handler(void);
*/
.global HardFault_Handler
.type HardFault_Handler, %function
.thumb_func
HardFault_Handler:
/* Push the following onto the stack (see CrashCatcherExceptionRegisters structure). The g_crashCatcherStack buffer
is reserved for use as the stack while CrashCatcher is running.
msp
psp
exceptionPSR
r4
r5
r6
r7
r8
r9
r10
r11
exceptionLR */
mrs r3, xpsr
mrs r2, psp
mrs r1, msp
ldr sp, =(g_crashCatcherStack + 4 * CRASH_CATCHER_STACK_WORD_COUNT)
push.w {r1-r11,lr}
// Call CrashCatcher_Entry with first argument pointing to registers that were just stacked.
mov r0, sp
bl CrashCatcher_Entry
// Only make it back here when CrashCatcher_DumpEnd() returns CRASH_CATCHER_EXIT to indicate that it would like
// execution to be restored back to the faulting code (typically a hard coded breakpoint).
// Restore non-volatile registers and SP to values they had upon entry to fault handler before resuming execution
// at point of fault.
pop.w {r1-r11,lr}
mov sp, r1
bx lr
// Let assembler know that we have hit the end of the HardFault_Handler function.
.pool
.size HardFault_Handler, .-HardFault_Handler
/* Called from CrashCatcher core to copy all floating point registers to supplied buffer. The supplied buffer must
be large enough to contain 33 32-bit values (S0-S31 & FPSCR).
void CrashCatcher_CopyAllFloatingPointRegisters(uint32_t* pBuffer);
*/
.global CrashCatcher_CopyAllFloatingPointRegisters
.type CrashCatcher_CopyAllFloatingPointRegisters, %function
.thumb_func
CrashCatcher_CopyAllFloatingPointRegisters:
#if CRASH_CATCHER_WITH_FPU
// Grab a copy of FPSCR before issuing any other FP instructions.
vmrs r1, fpscr
// Move s0 - s31 to pBuffer.
vstmia.32 r0!, {s0 - s31}
// Move fpscr to pBuffer.
str r1, [r0]
#endif
// Return to caller.
bx lr
.pool
.size CrashCatcher_CopyAllFloatingPointRegisters, .-CrashCatcher_CopyAllFloatingPointRegisters
/* Called from CrashCatcher core to copy upper 16 floating point registers to supplied buffer. The supplied buffer
must be large enough to contain 16 32-bit values (S16-S31).
void CrashCatcher_CopyUpperFloatingPointRegisters(uint32_t* pBuffer);
*/
.global CrashCatcher_CopyUpperFloatingPointRegisters
.type CrashCatcher_CopyUpperFloatingPointRegisters, %function
.thumb_func
CrashCatcher_CopyUpperFloatingPointRegisters:
#if CRASH_CATCHER_WITH_FPU
// Move s16 - s31 to pBuffer.
vstmia.32 r0!, {s16 - s31}
#endif
// Return to caller.
bx lr
.pool
.size CrashCatcher_CopyUpperFloatingPointRegisters, .-CrashCatcher_CopyUpperFloatingPointRegisters
.end