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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
|
/*
ChibiOS - Copyright (C) 2006..2019 Giovanni Di Sirio.
This file is part of ChibiOS.
ChibiOS is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 3 of the License, or
(at your option) any later version.
ChibiOS is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
/**
* @file sb/sbexc.S
* @brief Exception handlers for sandbox.
*
* @defgroup ARMV7M_SANDBOX_EXCEPTIONS SandBox Exception Vectors
* @{
*/
/*===========================================================================*/
/* Module constants. */
/*===========================================================================*/
#define FPU 0xE000EF30
/*===========================================================================*/
/* Module pre-compile time settings. */
/*===========================================================================*/
/*===========================================================================*/
/* Code section. */
/*===========================================================================*/
#if !defined(__DOXYGEN__)
.syntax unified
.cpu cortex-m3
.thumb
.text
.align 2
.thumb_func
.global port_syscall
port_syscall:
ldr r3, =sb_syscalls
ldr.w r3, [r3, r1, lsl #2]
blx r3
svc 0
.zombies1: b .zombies1
.align 2
.thumb_func
.global HardFault_Handler
HardFault_Handler:
tst.w lr, #8
beq.n .normal_hf
mrs r3, CONTROL
tst.w r3, #1
bne.w .exit_thd
.normal_hf: ldr r3, =HardFault_Handler_SB
bx r3
.align 2
.thumb_func
.global MemManage_Handler
MemManage_Handler:
tst.w lr, #8
beq.n .normal_mm
mrs r3, CONTROL
tst.w r3, #1
bne.w .exit_thd
.normal_mm: ldr r3, =MemManage_Handler_SB
bx r3
.align 2
.thumb_func
.global BusFault_Handler
BusFault_Handler:
tst.w lr, #8
beq.n .normal_bf
mrs r3, CONTROL
tst.w r3, #1
bne.w .exit_thd
.normal_bf: ldr r3, =BusFault_Handler_SB
bx r3
.align 2
.thumb_func
.global UsageFault_Handler
UsageFault_Handler:
tst.w lr, #8
beq.n .normal_uf
mrs r3, CONTROL
tst.w r3, #1
bne.w .exit_thd
.normal_uf: ldr r3, =UsageFault_Handler_SB
bx r3
/*
* Common thread-exit handler on exception.
* Makes the current exception return on chThdExit() with the PSR
* value as exit message.
*/
.exit_thd:
mov.w r4, lr
/* This thread is going to die so going back on
S-PSP and working safely from there.*/
bl port_get_s_psp
#if CORTEX_USE_FPU
sub.w r0, r0, #104
#else
sub.w r0, r0, #32
msr PSP, r0
#endif
/* Forcing return on exit syscall code with PSR
value as exit message.*/
mrs r2, PSR
str r2, [r0, #0]
ldr r2, =.do_exit
str r2, [r0, #24]
ldr r2, =0x01000000
str r2, [r0, #28]
#if CORTEX_USE_FPU
ldr r2, =FPU
ldr r2, [r2, #12] /* FPDSCR*/
str r2, [r0, #96] /* port_extctx.fpscr */
#endif
/* Back to privileged mode.*/
mrs r3, CONTROL
bic.w r3, #1
msr CONTROL, r3
/* Making sure there are no chained exceptions or interrupts
in the way, we need to exit this one atomically.*/
bl port_syslock_noinline
bx r4
/* Exception exit point.*/
.do_exit:
bl chThdExitS
.zombies2: b .zombies2
.align 2
.thumb_func
.weak HardFault_Handler_SB
.weak MemManage_Handler_SB
.weak BusFault_Handler_SB
.weak UsageFault_Handler_SB
HardFault_Handler_SB:
MemManage_Handler_SB:
BusFault_Handler_SB:
UsageFault_Handler_SB:
ldr r3, =_unhandled_exception
bx r3
#endif /* !defined(__DOXYGEN__) */
/** @} */
|
