root / prex-0.9.0 / bsp / hal / arm / arch / trap.c @ 03e9c04a
History | View | Annotate | Download (3.84 KB)
1 |
/*-
|
---|---|
2 |
* Copyright (c) 2005-2009, Kohsuke Ohtani
|
3 |
* All rights reserved.
|
4 |
*
|
5 |
* Redistribution and use in source and binary forms, with or without
|
6 |
* modification, are permitted provided that the following conditions
|
7 |
* are met:
|
8 |
* 1. Redistributions of source code must retain the above copyright
|
9 |
* notice, this list of conditions and the following disclaimer.
|
10 |
* 2. Redistributions in binary form must reproduce the above copyright
|
11 |
* notice, this list of conditions and the following disclaimer in the
|
12 |
* documentation and/or other materials provided with the distribution.
|
13 |
* 3. Neither the name of the author nor the names of any co-contributors
|
14 |
* may be used to endorse or promote products derived from this software
|
15 |
* without specific prior written permission.
|
16 |
*
|
17 |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
18 |
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
19 |
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
20 |
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
21 |
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
22 |
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
23 |
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
24 |
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
25 |
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
26 |
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
27 |
* SUCH DAMAGE.
|
28 |
*/
|
29 |
|
30 |
/*
|
31 |
* trap.c - called from the abort handler when a processor detect abort.
|
32 |
*/
|
33 |
|
34 |
#include <sys/signal.h> |
35 |
#include <kernel.h> |
36 |
#include <task.h> |
37 |
#include <hal.h> |
38 |
#include <exception.h> |
39 |
#include <cpu.h> |
40 |
#include <trap.h> |
41 |
#include <cpufunc.h> |
42 |
#include <context.h> |
43 |
#include <locore.h> |
44 |
|
45 |
#ifdef DEBUG
|
46 |
/*
|
47 |
* Trap name
|
48 |
*/
|
49 |
static char *const trap_name[] = { |
50 |
"Undefined Instruction",
|
51 |
"Prefetch Abort",
|
52 |
"Data Abort"
|
53 |
}; |
54 |
#define MAXTRAP (sizeof(trap_name) / sizeof(void *) - 1) |
55 |
#endif /* !DEBUG */ |
56 |
|
57 |
/*
|
58 |
* abort/exception mapping table.
|
59 |
* ARM exception is translated to the architecture
|
60 |
* independent exception code.
|
61 |
*/
|
62 |
static const int exception_map[] = { |
63 |
SIGILL, /* Undefined instruction */
|
64 |
SIGSEGV, /* Prefech abort */
|
65 |
SIGSEGV, /* Data abort */
|
66 |
}; |
67 |
|
68 |
/*
|
69 |
* Trap handler
|
70 |
* Invoke the exception handler if it is needed.
|
71 |
*/
|
72 |
void
|
73 |
trap_handler(struct cpu_regs *regs)
|
74 |
{ |
75 |
u_long trap_no = regs->r0; |
76 |
|
77 |
if ((regs->cpsr & PSR_MODE) == PSR_SVC_MODE &&
|
78 |
trap_no == TRAP_DATA_ABORT && |
79 |
(regs->pc - 4 == (uint32_t)known_fault1 ||
|
80 |
regs->pc - 4 == (uint32_t)known_fault2 ||
|
81 |
regs->pc - 4 == (uint32_t)known_fault3)) {
|
82 |
DPRINTF(("\n*** Detect Fault! address=%x task=%s ***\n",
|
83 |
get_faultaddress(), curtask->name)); |
84 |
regs->pc = (uint32_t)copy_fault; |
85 |
return;
|
86 |
} |
87 |
#ifdef DEBUG
|
88 |
printf("=============================\n");
|
89 |
printf("Trap %x: %s\n", (u_int)trap_no, trap_name[trap_no]);
|
90 |
if (trap_no == TRAP_DATA_ABORT)
|
91 |
printf(" Fault address=%x\n", get_faultaddress());
|
92 |
else if (trap_no == TRAP_PREFETCH_ABORT) |
93 |
printf(" Fault address=%x\n", regs->pc);
|
94 |
printf("=============================\n");
|
95 |
|
96 |
trap_dump(regs); |
97 |
for (;;) ;
|
98 |
#endif
|
99 |
if ((regs->cpsr & PSR_MODE) != PSR_USR_MODE)
|
100 |
panic("Kernel exception");
|
101 |
|
102 |
exception_mark(exception_map[trap_no]); |
103 |
exception_deliver(); |
104 |
} |
105 |
|
106 |
#ifdef DEBUG
|
107 |
void
|
108 |
trap_dump(struct cpu_regs *r)
|
109 |
{ |
110 |
|
111 |
printf("Trap frame %x\n", r);
|
112 |
printf(" r0 %08x r1 %08x r2 %08x r3 %08x r4 %08x r5 %08x\n",
|
113 |
r->r0, r->r1, r->r2, r->r3, r->r4, r->r5); |
114 |
printf(" r6 %08x r7 %08x r8 %08x r9 %08x r10 %08x r11 %08x\n",
|
115 |
r->r6, r->r7, r->r8, r->r9, r->r10, r->r11); |
116 |
printf(" r12 %08x sp %08x lr %08x pc %08x cpsr %08x\n",
|
117 |
r->r12, r->sp, r->lr, r->pc, r->cpsr); |
118 |
|
119 |
printf(" >> interrupt is %s\n",
|
120 |
(r->cpsr & PSR_INT_MASK) ? "disabled" : "enabled"); |
121 |
|
122 |
printf(" >> task=%s\n", curtask->name);
|
123 |
} |
124 |
#endif /* !DEBUG */ |