]>
Commit | Line | Data |
---|---|---|
6bc9a396 CL |
1 | /* |
2 | * arch/score/kernel/traps.c | |
3 | * | |
4 | * Score Processor version. | |
5 | * | |
6 | * Copyright (C) 2009 Sunplus Core Technology Co., Ltd. | |
7 | * Chen Liqin <liqin.chen@sunplusct.com> | |
8 | * Lennox Wu <lennox.wu@sunplusct.com> | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License as published by | |
12 | * the Free Software Foundation; either version 2 of the License, or | |
13 | * (at your option) any later version. | |
14 | * | |
15 | * This program is distributed in the hope that it will be useful, | |
16 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | * GNU General Public License for more details. | |
19 | * | |
20 | * You should have received a copy of the GNU General Public License | |
21 | * along with this program; if not, see the file COPYING, or write | |
22 | * to the Free Software Foundation, Inc., | |
23 | * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA | |
24 | */ | |
25 | ||
0f296af8 | 26 | #include <linux/extable.h> |
0acf6119 | 27 | #include <linux/ptrace.h> |
68e21be2 | 28 | #include <linux/sched/mm.h> |
3f07c014 | 29 | #include <linux/sched/signal.h> |
b17b0153 | 30 | #include <linux/sched/debug.h> |
589ee628 | 31 | #include <linux/mm_types.h> |
6bc9a396 CL |
32 | |
33 | #include <asm/cacheflush.h> | |
34 | #include <asm/irq.h> | |
35 | #include <asm/irq_regs.h> | |
7c0f6ba6 | 36 | #include <linux/uaccess.h> |
6bc9a396 CL |
37 | |
38 | unsigned long exception_handlers[32]; | |
39 | ||
40 | /* | |
41 | * The architecture-independent show_stack generator | |
42 | */ | |
43 | void show_stack(struct task_struct *task, unsigned long *sp) | |
44 | { | |
45 | int i; | |
46 | long stackdata; | |
47 | ||
48 | sp = sp ? sp : (unsigned long *)&sp; | |
49 | ||
50 | printk(KERN_NOTICE "Stack: "); | |
51 | i = 1; | |
52 | while ((long) sp & (PAGE_SIZE - 1)) { | |
53 | if (i && ((i % 8) == 0)) | |
54 | printk(KERN_NOTICE "\n"); | |
55 | if (i > 40) { | |
56 | printk(KERN_NOTICE " ..."); | |
57 | break; | |
58 | } | |
59 | ||
60 | if (__get_user(stackdata, sp++)) { | |
61 | printk(KERN_NOTICE " (Bad stack address)"); | |
62 | break; | |
63 | } | |
64 | ||
65 | printk(KERN_NOTICE " %08lx", stackdata); | |
66 | i++; | |
67 | } | |
68 | printk(KERN_NOTICE "\n"); | |
69 | } | |
70 | ||
71 | static void show_trace(long *sp) | |
72 | { | |
73 | int i; | |
74 | long addr; | |
75 | ||
76 | sp = sp ? sp : (long *) &sp; | |
77 | ||
78 | printk(KERN_NOTICE "Call Trace: "); | |
79 | i = 1; | |
80 | while ((long) sp & (PAGE_SIZE - 1)) { | |
81 | if (__get_user(addr, sp++)) { | |
82 | if (i && ((i % 6) == 0)) | |
83 | printk(KERN_NOTICE "\n"); | |
84 | printk(KERN_NOTICE " (Bad stack address)\n"); | |
85 | break; | |
86 | } | |
87 | ||
88 | if (kernel_text_address(addr)) { | |
89 | if (i && ((i % 6) == 0)) | |
90 | printk(KERN_NOTICE "\n"); | |
91 | if (i > 40) { | |
92 | printk(KERN_NOTICE " ..."); | |
93 | break; | |
94 | } | |
95 | ||
96 | printk(KERN_NOTICE " [<%08lx>]", addr); | |
97 | i++; | |
98 | } | |
99 | } | |
100 | printk(KERN_NOTICE "\n"); | |
101 | } | |
102 | ||
103 | static void show_code(unsigned int *pc) | |
104 | { | |
105 | long i; | |
106 | ||
107 | printk(KERN_NOTICE "\nCode:"); | |
108 | ||
109 | for (i = -3; i < 6; i++) { | |
110 | unsigned long insn; | |
111 | if (__get_user(insn, pc + i)) { | |
112 | printk(KERN_NOTICE " (Bad address in epc)\n"); | |
113 | break; | |
114 | } | |
115 | printk(KERN_NOTICE "%c%08lx%c", (i ? ' ' : '<'), | |
116 | insn, (i ? ' ' : '>')); | |
117 | } | |
118 | } | |
119 | ||
120 | /* | |
121 | * FIXME: really the generic show_regs should take a const pointer argument. | |
122 | */ | |
123 | void show_regs(struct pt_regs *regs) | |
124 | { | |
a43cb95d TH |
125 | show_regs_print_info(KERN_DEFAULT); |
126 | ||
6bc9a396 CL |
127 | printk("r0 : %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n", |
128 | regs->regs[0], regs->regs[1], regs->regs[2], regs->regs[3], | |
129 | regs->regs[4], regs->regs[5], regs->regs[6], regs->regs[7]); | |
130 | printk("r8 : %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n", | |
131 | regs->regs[8], regs->regs[9], regs->regs[10], regs->regs[11], | |
132 | regs->regs[12], regs->regs[13], regs->regs[14], regs->regs[15]); | |
133 | printk("r16: %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n", | |
134 | regs->regs[16], regs->regs[17], regs->regs[18], regs->regs[19], | |
135 | regs->regs[20], regs->regs[21], regs->regs[22], regs->regs[23]); | |
136 | printk("r24: %08lx %08lx %08lx %08lx %08lx %08lx %08lx %08lx\n", | |
137 | regs->regs[24], regs->regs[25], regs->regs[26], regs->regs[27], | |
138 | regs->regs[28], regs->regs[29], regs->regs[30], regs->regs[31]); | |
139 | ||
140 | printk("CEH : %08lx\n", regs->ceh); | |
141 | printk("CEL : %08lx\n", regs->cel); | |
142 | ||
143 | printk("EMA:%08lx, epc:%08lx %s\nPSR: %08lx\nECR:%08lx\nCondition : %08lx\n", | |
144 | regs->cp0_ema, regs->cp0_epc, print_tainted(), regs->cp0_psr, | |
145 | regs->cp0_ecr, regs->cp0_condition); | |
146 | } | |
147 | ||
148 | static void show_registers(struct pt_regs *regs) | |
149 | { | |
150 | show_regs(regs); | |
151 | printk(KERN_NOTICE "Process %s (pid: %d, stackpage=%08lx)\n", | |
152 | current->comm, current->pid, (unsigned long) current); | |
153 | show_stack(current_thread_info()->task, (long *) regs->regs[0]); | |
154 | show_trace((long *) regs->regs[0]); | |
155 | show_code((unsigned int *) regs->cp0_epc); | |
156 | printk(KERN_NOTICE "\n"); | |
157 | } | |
158 | ||
6bc9a396 CL |
159 | void __die(const char *str, struct pt_regs *regs, const char *file, |
160 | const char *func, unsigned long line) | |
161 | { | |
162 | console_verbose(); | |
163 | printk("%s", str); | |
164 | if (file && func) | |
165 | printk(" in %s:%s, line %ld", file, func, line); | |
166 | printk(":\n"); | |
167 | show_registers(regs); | |
168 | do_exit(SIGSEGV); | |
169 | } | |
170 | ||
171 | void __die_if_kernel(const char *str, struct pt_regs *regs, | |
172 | const char *file, const char *func, unsigned long line) | |
173 | { | |
174 | if (!user_mode(regs)) | |
175 | __die(str, regs, file, func, line); | |
176 | } | |
177 | ||
178 | asmlinkage void do_adelinsn(struct pt_regs *regs) | |
179 | { | |
180 | printk("do_ADE-linsn:ema:0x%08lx:epc:0x%08lx\n", | |
181 | regs->cp0_ema, regs->cp0_epc); | |
182 | die_if_kernel("do_ade execution Exception\n", regs); | |
183 | force_sig(SIGBUS, current); | |
184 | } | |
185 | ||
186 | asmlinkage void do_adedata(struct pt_regs *regs) | |
187 | { | |
188 | const struct exception_table_entry *fixup; | |
189 | fixup = search_exception_tables(regs->cp0_epc); | |
190 | if (fixup) { | |
191 | regs->cp0_epc = fixup->fixup; | |
192 | return; | |
193 | } | |
194 | printk("do_ADE-data:ema:0x%08lx:epc:0x%08lx\n", | |
195 | regs->cp0_ema, regs->cp0_epc); | |
196 | die_if_kernel("do_ade execution Exception\n", regs); | |
197 | force_sig(SIGBUS, current); | |
198 | } | |
199 | ||
200 | asmlinkage void do_pel(struct pt_regs *regs) | |
201 | { | |
202 | die_if_kernel("do_pel execution Exception", regs); | |
203 | force_sig(SIGFPE, current); | |
204 | } | |
205 | ||
206 | asmlinkage void do_cee(struct pt_regs *regs) | |
207 | { | |
208 | die_if_kernel("do_cee execution Exception", regs); | |
209 | force_sig(SIGFPE, current); | |
210 | } | |
211 | ||
212 | asmlinkage void do_cpe(struct pt_regs *regs) | |
213 | { | |
214 | die_if_kernel("do_cpe execution Exception", regs); | |
215 | force_sig(SIGFPE, current); | |
216 | } | |
217 | ||
218 | asmlinkage void do_be(struct pt_regs *regs) | |
219 | { | |
220 | die_if_kernel("do_be execution Exception", regs); | |
221 | force_sig(SIGBUS, current); | |
222 | } | |
223 | ||
224 | asmlinkage void do_ov(struct pt_regs *regs) | |
225 | { | |
226 | siginfo_t info; | |
227 | ||
228 | die_if_kernel("do_ov execution Exception", regs); | |
229 | ||
230 | info.si_code = FPE_INTOVF; | |
231 | info.si_signo = SIGFPE; | |
232 | info.si_errno = 0; | |
233 | info.si_addr = (void *)regs->cp0_epc; | |
234 | force_sig_info(SIGFPE, &info, current); | |
235 | } | |
236 | ||
237 | asmlinkage void do_tr(struct pt_regs *regs) | |
238 | { | |
239 | die_if_kernel("do_tr execution Exception", regs); | |
240 | force_sig(SIGTRAP, current); | |
241 | } | |
242 | ||
243 | asmlinkage void do_ri(struct pt_regs *regs) | |
244 | { | |
245 | unsigned long epc_insn; | |
246 | unsigned long epc = regs->cp0_epc; | |
247 | ||
248 | read_tsk_long(current, epc, &epc_insn); | |
249 | if (current->thread.single_step == 1) { | |
250 | if ((epc == current->thread.addr1) || | |
251 | (epc == current->thread.addr2)) { | |
0402c91a | 252 | user_disable_single_step(current); |
6bc9a396 CL |
253 | force_sig(SIGTRAP, current); |
254 | return; | |
255 | } else | |
256 | BUG(); | |
257 | } else if ((epc_insn == BREAKPOINT32_INSN) || | |
258 | ((epc_insn & 0x0000FFFF) == 0x7002) || | |
259 | ((epc_insn & 0xFFFF0000) == 0x70020000)) { | |
260 | force_sig(SIGTRAP, current); | |
261 | return; | |
262 | } else { | |
263 | die_if_kernel("do_ri execution Exception", regs); | |
264 | force_sig(SIGILL, current); | |
265 | } | |
266 | } | |
267 | ||
268 | asmlinkage void do_ccu(struct pt_regs *regs) | |
269 | { | |
270 | die_if_kernel("do_ccu execution Exception", regs); | |
271 | force_sig(SIGILL, current); | |
272 | } | |
273 | ||
274 | asmlinkage void do_reserved(struct pt_regs *regs) | |
275 | { | |
276 | /* | |
277 | * Game over - no way to handle this if it ever occurs. Most probably | |
278 | * caused by a new unknown cpu type or after another deadly | |
279 | * hard/software error. | |
280 | */ | |
281 | die_if_kernel("do_reserved execution Exception", regs); | |
282 | show_regs(regs); | |
283 | panic("Caught reserved exception - should not happen."); | |
284 | } | |
285 | ||
286 | /* | |
287 | * NMI exception handler. | |
288 | */ | |
289 | void nmi_exception_handler(struct pt_regs *regs) | |
290 | { | |
291 | die_if_kernel("nmi_exception_handler execution Exception", regs); | |
292 | die("NMI", regs); | |
293 | } | |
294 | ||
295 | /* Install CPU exception handler */ | |
296 | void *set_except_vector(int n, void *addr) | |
297 | { | |
298 | unsigned long handler = (unsigned long) addr; | |
299 | unsigned long old_handler = exception_handlers[n]; | |
300 | ||
301 | exception_handlers[n] = handler; | |
302 | return (void *)old_handler; | |
303 | } | |
304 | ||
305 | void __init trap_init(void) | |
306 | { | |
307 | int i; | |
308 | ||
309 | pgd_current = (unsigned long)init_mm.pgd; | |
310 | /* DEBUG EXCEPTION */ | |
311 | memcpy((void *)DEBUG_VECTOR_BASE_ADDR, | |
312 | &debug_exception_vector, DEBUG_VECTOR_SIZE); | |
313 | /* NMI EXCEPTION */ | |
314 | memcpy((void *)GENERAL_VECTOR_BASE_ADDR, | |
315 | &general_exception_vector, GENERAL_VECTOR_SIZE); | |
316 | ||
317 | /* | |
318 | * Initialise exception handlers | |
319 | */ | |
320 | for (i = 0; i <= 31; i++) | |
321 | set_except_vector(i, handle_reserved); | |
322 | ||
323 | set_except_vector(1, handle_nmi); | |
324 | set_except_vector(2, handle_adelinsn); | |
325 | set_except_vector(3, handle_tlb_refill); | |
326 | set_except_vector(4, handle_tlb_invaild); | |
327 | set_except_vector(5, handle_ibe); | |
328 | set_except_vector(6, handle_pel); | |
329 | set_except_vector(7, handle_sys); | |
330 | set_except_vector(8, handle_ccu); | |
331 | set_except_vector(9, handle_ri); | |
332 | set_except_vector(10, handle_tr); | |
333 | set_except_vector(11, handle_adedata); | |
334 | set_except_vector(12, handle_adedata); | |
335 | set_except_vector(13, handle_tlb_refill); | |
336 | set_except_vector(14, handle_tlb_invaild); | |
337 | set_except_vector(15, handle_mod); | |
338 | set_except_vector(16, handle_cee); | |
339 | set_except_vector(17, handle_cpe); | |
340 | set_except_vector(18, handle_dbe); | |
341 | flush_icache_range(DEBUG_VECTOR_BASE_ADDR, IRQ_VECTOR_BASE_ADDR); | |
342 | ||
f1f10076 | 343 | mmgrab(&init_mm); |
6bc9a396 CL |
344 | current->active_mm = &init_mm; |
345 | cpu_cache_init(); | |
346 | } |