1
2
3
4
5
6
7
8
9
10
11#include <linux/module.h>
12#include <linux/ptrace.h>
13#include <linux/sched/debug.h>
14#include <linux/kallsyms.h>
15#include <linux/bug.h>
16
17#include <asm/soc.h>
18#include <asm/special_insns.h>
19#include <asm/traps.h>
20
21int (*c6x_nmi_handler)(struct pt_regs *regs);
22
23void __init trap_init(void)
24{
25 ack_exception(EXCEPT_TYPE_NXF);
26 ack_exception(EXCEPT_TYPE_EXC);
27 ack_exception(EXCEPT_TYPE_IXF);
28 ack_exception(EXCEPT_TYPE_SXF);
29 enable_exception();
30}
31
32void show_regs(struct pt_regs *regs)
33{
34 pr_err("\n");
35 show_regs_print_info(KERN_ERR);
36 pr_err("PC: %08lx SP: %08lx\n", regs->pc, regs->sp);
37 pr_err("Status: %08lx ORIG_A4: %08lx\n", regs->csr, regs->orig_a4);
38 pr_err("A0: %08lx B0: %08lx\n", regs->a0, regs->b0);
39 pr_err("A1: %08lx B1: %08lx\n", regs->a1, regs->b1);
40 pr_err("A2: %08lx B2: %08lx\n", regs->a2, regs->b2);
41 pr_err("A3: %08lx B3: %08lx\n", regs->a3, regs->b3);
42 pr_err("A4: %08lx B4: %08lx\n", regs->a4, regs->b4);
43 pr_err("A5: %08lx B5: %08lx\n", regs->a5, regs->b5);
44 pr_err("A6: %08lx B6: %08lx\n", regs->a6, regs->b6);
45 pr_err("A7: %08lx B7: %08lx\n", regs->a7, regs->b7);
46 pr_err("A8: %08lx B8: %08lx\n", regs->a8, regs->b8);
47 pr_err("A9: %08lx B9: %08lx\n", regs->a9, regs->b9);
48 pr_err("A10: %08lx B10: %08lx\n", regs->a10, regs->b10);
49 pr_err("A11: %08lx B11: %08lx\n", regs->a11, regs->b11);
50 pr_err("A12: %08lx B12: %08lx\n", regs->a12, regs->b12);
51 pr_err("A13: %08lx B13: %08lx\n", regs->a13, regs->b13);
52 pr_err("A14: %08lx B14: %08lx\n", regs->a14, regs->dp);
53 pr_err("A15: %08lx B15: %08lx\n", regs->a15, regs->sp);
54 pr_err("A16: %08lx B16: %08lx\n", regs->a16, regs->b16);
55 pr_err("A17: %08lx B17: %08lx\n", regs->a17, regs->b17);
56 pr_err("A18: %08lx B18: %08lx\n", regs->a18, regs->b18);
57 pr_err("A19: %08lx B19: %08lx\n", regs->a19, regs->b19);
58 pr_err("A20: %08lx B20: %08lx\n", regs->a20, regs->b20);
59 pr_err("A21: %08lx B21: %08lx\n", regs->a21, regs->b21);
60 pr_err("A22: %08lx B22: %08lx\n", regs->a22, regs->b22);
61 pr_err("A23: %08lx B23: %08lx\n", regs->a23, regs->b23);
62 pr_err("A24: %08lx B24: %08lx\n", regs->a24, regs->b24);
63 pr_err("A25: %08lx B25: %08lx\n", regs->a25, regs->b25);
64 pr_err("A26: %08lx B26: %08lx\n", regs->a26, regs->b26);
65 pr_err("A27: %08lx B27: %08lx\n", regs->a27, regs->b27);
66 pr_err("A28: %08lx B28: %08lx\n", regs->a28, regs->b28);
67 pr_err("A29: %08lx B29: %08lx\n", regs->a29, regs->b29);
68 pr_err("A30: %08lx B30: %08lx\n", regs->a30, regs->b30);
69 pr_err("A31: %08lx B31: %08lx\n", regs->a31, regs->b31);
70}
71
72void die(char *str, struct pt_regs *fp, int nr)
73{
74 console_verbose();
75 pr_err("%s: %08x\n", str, nr);
76 show_regs(fp);
77
78 pr_err("Process %s (pid: %d, stackpage=%08lx)\n",
79 current->comm, current->pid, (PAGE_SIZE +
80 (unsigned long) current));
81
82 dump_stack();
83 while (1)
84 ;
85}
86
87static void die_if_kernel(char *str, struct pt_regs *fp, int nr)
88{
89 if (user_mode(fp))
90 return;
91
92 die(str, fp, nr);
93}
94
95
96
97static struct exception_info iexcept_table[10] = {
98 { "Oops - instruction fetch", SIGBUS, BUS_ADRERR },
99 { "Oops - fetch packet", SIGBUS, BUS_ADRERR },
100 { "Oops - execute packet", SIGILL, ILL_ILLOPC },
101 { "Oops - undefined instruction", SIGILL, ILL_ILLOPC },
102 { "Oops - resource conflict", SIGILL, ILL_ILLOPC },
103 { "Oops - resource access", SIGILL, ILL_PRVREG },
104 { "Oops - privilege", SIGILL, ILL_PRVOPC },
105 { "Oops - loops buffer", SIGILL, ILL_ILLOPC },
106 { "Oops - software exception", SIGILL, ILL_ILLTRP },
107 { "Oops - unknown exception", SIGILL, ILL_ILLOPC }
108};
109
110
111static struct exception_info eexcept_table[128] = {
112 { "Oops - external exception", SIGBUS, BUS_ADRERR },
113 { "Oops - external exception", SIGBUS, BUS_ADRERR },
114 { "Oops - external exception", SIGBUS, BUS_ADRERR },
115 { "Oops - external exception", SIGBUS, BUS_ADRERR },
116 { "Oops - external exception", SIGBUS, BUS_ADRERR },
117 { "Oops - external exception", SIGBUS, BUS_ADRERR },
118 { "Oops - external exception", SIGBUS, BUS_ADRERR },
119 { "Oops - external exception", SIGBUS, BUS_ADRERR },
120 { "Oops - external exception", SIGBUS, BUS_ADRERR },
121 { "Oops - external exception", SIGBUS, BUS_ADRERR },
122 { "Oops - external exception", SIGBUS, BUS_ADRERR },
123 { "Oops - external exception", SIGBUS, BUS_ADRERR },
124 { "Oops - external exception", SIGBUS, BUS_ADRERR },
125 { "Oops - external exception", SIGBUS, BUS_ADRERR },
126 { "Oops - external exception", SIGBUS, BUS_ADRERR },
127 { "Oops - external exception", SIGBUS, BUS_ADRERR },
128 { "Oops - external exception", SIGBUS, BUS_ADRERR },
129 { "Oops - external exception", SIGBUS, BUS_ADRERR },
130 { "Oops - external exception", SIGBUS, BUS_ADRERR },
131 { "Oops - external exception", SIGBUS, BUS_ADRERR },
132 { "Oops - external exception", SIGBUS, BUS_ADRERR },
133 { "Oops - external exception", SIGBUS, BUS_ADRERR },
134 { "Oops - external exception", SIGBUS, BUS_ADRERR },
135 { "Oops - external exception", SIGBUS, BUS_ADRERR },
136 { "Oops - external exception", SIGBUS, BUS_ADRERR },
137 { "Oops - external exception", SIGBUS, BUS_ADRERR },
138 { "Oops - external exception", SIGBUS, BUS_ADRERR },
139 { "Oops - external exception", SIGBUS, BUS_ADRERR },
140 { "Oops - external exception", SIGBUS, BUS_ADRERR },
141 { "Oops - external exception", SIGBUS, BUS_ADRERR },
142 { "Oops - external exception", SIGBUS, BUS_ADRERR },
143 { "Oops - external exception", SIGBUS, BUS_ADRERR },
144
145 { "Oops - external exception", SIGBUS, BUS_ADRERR },
146 { "Oops - external exception", SIGBUS, BUS_ADRERR },
147 { "Oops - external exception", SIGBUS, BUS_ADRERR },
148 { "Oops - external exception", SIGBUS, BUS_ADRERR },
149 { "Oops - external exception", SIGBUS, BUS_ADRERR },
150 { "Oops - external exception", SIGBUS, BUS_ADRERR },
151 { "Oops - external exception", SIGBUS, BUS_ADRERR },
152 { "Oops - external exception", SIGBUS, BUS_ADRERR },
153 { "Oops - external exception", SIGBUS, BUS_ADRERR },
154 { "Oops - external exception", SIGBUS, BUS_ADRERR },
155 { "Oops - external exception", SIGBUS, BUS_ADRERR },
156 { "Oops - external exception", SIGBUS, BUS_ADRERR },
157 { "Oops - external exception", SIGBUS, BUS_ADRERR },
158 { "Oops - external exception", SIGBUS, BUS_ADRERR },
159 { "Oops - external exception", SIGBUS, BUS_ADRERR },
160 { "Oops - external exception", SIGBUS, BUS_ADRERR },
161 { "Oops - external exception", SIGBUS, BUS_ADRERR },
162 { "Oops - external exception", SIGBUS, BUS_ADRERR },
163 { "Oops - external exception", SIGBUS, BUS_ADRERR },
164 { "Oops - external exception", SIGBUS, BUS_ADRERR },
165 { "Oops - external exception", SIGBUS, BUS_ADRERR },
166 { "Oops - external exception", SIGBUS, BUS_ADRERR },
167 { "Oops - external exception", SIGBUS, BUS_ADRERR },
168 { "Oops - external exception", SIGBUS, BUS_ADRERR },
169 { "Oops - external exception", SIGBUS, BUS_ADRERR },
170 { "Oops - external exception", SIGBUS, BUS_ADRERR },
171 { "Oops - external exception", SIGBUS, BUS_ADRERR },
172 { "Oops - external exception", SIGBUS, BUS_ADRERR },
173 { "Oops - external exception", SIGBUS, BUS_ADRERR },
174 { "Oops - external exception", SIGBUS, BUS_ADRERR },
175 { "Oops - external exception", SIGBUS, BUS_ADRERR },
176 { "Oops - external exception", SIGBUS, BUS_ADRERR },
177
178 { "Oops - external exception", SIGBUS, BUS_ADRERR },
179 { "Oops - external exception", SIGBUS, BUS_ADRERR },
180 { "Oops - external exception", SIGBUS, BUS_ADRERR },
181 { "Oops - external exception", SIGBUS, BUS_ADRERR },
182 { "Oops - external exception", SIGBUS, BUS_ADRERR },
183 { "Oops - external exception", SIGBUS, BUS_ADRERR },
184 { "Oops - external exception", SIGBUS, BUS_ADRERR },
185 { "Oops - external exception", SIGBUS, BUS_ADRERR },
186 { "Oops - external exception", SIGBUS, BUS_ADRERR },
187 { "Oops - external exception", SIGBUS, BUS_ADRERR },
188 { "Oops - external exception", SIGBUS, BUS_ADRERR },
189 { "Oops - external exception", SIGBUS, BUS_ADRERR },
190 { "Oops - external exception", SIGBUS, BUS_ADRERR },
191 { "Oops - external exception", SIGBUS, BUS_ADRERR },
192 { "Oops - external exception", SIGBUS, BUS_ADRERR },
193 { "Oops - external exception", SIGBUS, BUS_ADRERR },
194 { "Oops - external exception", SIGBUS, BUS_ADRERR },
195 { "Oops - external exception", SIGBUS, BUS_ADRERR },
196 { "Oops - external exception", SIGBUS, BUS_ADRERR },
197 { "Oops - external exception", SIGBUS, BUS_ADRERR },
198 { "Oops - external exception", SIGBUS, BUS_ADRERR },
199 { "Oops - external exception", SIGBUS, BUS_ADRERR },
200 { "Oops - external exception", SIGBUS, BUS_ADRERR },
201 { "Oops - external exception", SIGBUS, BUS_ADRERR },
202 { "Oops - external exception", SIGBUS, BUS_ADRERR },
203 { "Oops - external exception", SIGBUS, BUS_ADRERR },
204 { "Oops - external exception", SIGBUS, BUS_ADRERR },
205 { "Oops - external exception", SIGBUS, BUS_ADRERR },
206 { "Oops - external exception", SIGBUS, BUS_ADRERR },
207 { "Oops - external exception", SIGBUS, BUS_ADRERR },
208 { "Oops - external exception", SIGBUS, BUS_ADRERR },
209 { "Oops - external exception", SIGBUS, BUS_ADRERR },
210
211 { "Oops - external exception", SIGBUS, BUS_ADRERR },
212 { "Oops - external exception", SIGBUS, BUS_ADRERR },
213 { "Oops - external exception", SIGBUS, BUS_ADRERR },
214 { "Oops - external exception", SIGBUS, BUS_ADRERR },
215 { "Oops - external exception", SIGBUS, BUS_ADRERR },
216 { "Oops - external exception", SIGBUS, BUS_ADRERR },
217 { "Oops - external exception", SIGBUS, BUS_ADRERR },
218 { "Oops - external exception", SIGBUS, BUS_ADRERR },
219 { "Oops - external exception", SIGBUS, BUS_ADRERR },
220 { "Oops - external exception", SIGBUS, BUS_ADRERR },
221 { "Oops - external exception", SIGBUS, BUS_ADRERR },
222 { "Oops - external exception", SIGBUS, BUS_ADRERR },
223 { "Oops - external exception", SIGBUS, BUS_ADRERR },
224 { "Oops - external exception", SIGBUS, BUS_ADRERR },
225 { "Oops - external exception", SIGBUS, BUS_ADRERR },
226 { "Oops - external exception", SIGBUS, BUS_ADRERR },
227 { "Oops - external exception", SIGBUS, BUS_ADRERR },
228 { "Oops - external exception", SIGBUS, BUS_ADRERR },
229 { "Oops - external exception", SIGBUS, BUS_ADRERR },
230 { "Oops - external exception", SIGBUS, BUS_ADRERR },
231 { "Oops - external exception", SIGBUS, BUS_ADRERR },
232 { "Oops - external exception", SIGBUS, BUS_ADRERR },
233 { "Oops - external exception", SIGBUS, BUS_ADRERR },
234 { "Oops - CPU memory protection fault", SIGSEGV, SEGV_ACCERR },
235 { "Oops - CPU memory protection fault in L1P", SIGSEGV, SEGV_ACCERR },
236 { "Oops - DMA memory protection fault in L1P", SIGSEGV, SEGV_ACCERR },
237 { "Oops - CPU memory protection fault in L1D", SIGSEGV, SEGV_ACCERR },
238 { "Oops - DMA memory protection fault in L1D", SIGSEGV, SEGV_ACCERR },
239 { "Oops - CPU memory protection fault in L2", SIGSEGV, SEGV_ACCERR },
240 { "Oops - DMA memory protection fault in L2", SIGSEGV, SEGV_ACCERR },
241 { "Oops - EMC CPU memory protection fault", SIGSEGV, SEGV_ACCERR },
242 { "Oops - EMC bus error", SIGBUS, BUS_ADRERR }
243};
244
245static void do_trap(struct exception_info *except_info, struct pt_regs *regs)
246{
247 unsigned long addr = instruction_pointer(regs);
248 siginfo_t info;
249
250 if (except_info->code != TRAP_BRKPT)
251 pr_err("TRAP: %s PC[0x%lx] signo[%d] code[%d]\n",
252 except_info->kernel_str, regs->pc,
253 except_info->signo, except_info->code);
254
255 die_if_kernel(except_info->kernel_str, regs, addr);
256
257 info.si_signo = except_info->signo;
258 info.si_errno = 0;
259 info.si_code = except_info->code;
260 info.si_addr = (void __user *)addr;
261
262 force_sig_info(except_info->signo, &info, current);
263}
264
265
266
267
268static int process_iexcept(struct pt_regs *regs)
269{
270 unsigned int iexcept_report = get_iexcept();
271 unsigned int iexcept_num;
272
273 ack_exception(EXCEPT_TYPE_IXF);
274
275 pr_err("IEXCEPT: PC[0x%lx]\n", regs->pc);
276
277 while (iexcept_report) {
278 iexcept_num = __ffs(iexcept_report);
279 iexcept_report &= ~(1 << iexcept_num);
280 set_iexcept(iexcept_report);
281 if (*(unsigned int *)regs->pc == BKPT_OPCODE) {
282
283 struct exception_info bkpt_exception = {
284 "Oops - undefined instruction",
285 SIGTRAP, TRAP_BRKPT
286 };
287 do_trap(&bkpt_exception, regs);
288 iexcept_report &= ~(0xFF);
289 set_iexcept(iexcept_report);
290 continue;
291 }
292
293 do_trap(&iexcept_table[iexcept_num], regs);
294 }
295 return 0;
296}
297
298
299
300
301static void process_eexcept(struct pt_regs *regs)
302{
303 int evt;
304
305 pr_err("EEXCEPT: PC[0x%lx]\n", regs->pc);
306
307 while ((evt = soc_get_exception()) >= 0)
308 do_trap(&eexcept_table[evt], regs);
309
310 ack_exception(EXCEPT_TYPE_EXC);
311}
312
313
314
315
316asmlinkage int process_exception(struct pt_regs *regs)
317{
318 unsigned int type;
319 unsigned int type_num;
320 unsigned int ie_num = 9;
321
322 while ((type = get_except_type()) != 0) {
323 type_num = fls(type) - 1;
324
325 switch (type_num) {
326 case EXCEPT_TYPE_NXF:
327 ack_exception(EXCEPT_TYPE_NXF);
328 if (c6x_nmi_handler)
329 (c6x_nmi_handler)(regs);
330 else
331 pr_alert("NMI interrupt!\n");
332 break;
333
334 case EXCEPT_TYPE_IXF:
335 if (process_iexcept(regs))
336 return 1;
337 break;
338
339 case EXCEPT_TYPE_EXC:
340 process_eexcept(regs);
341 break;
342
343 case EXCEPT_TYPE_SXF:
344 ie_num = 8;
345 default:
346 ack_exception(type_num);
347 do_trap(&iexcept_table[ie_num], regs);
348 break;
349 }
350 }
351 return 0;
352}
353
354static int kstack_depth_to_print = 48;
355
356static void show_trace(unsigned long *stack, unsigned long *endstack)
357{
358 unsigned long addr;
359 int i;
360
361 pr_debug("Call trace:");
362 i = 0;
363 while (stack + 1 <= endstack) {
364 addr = *stack++;
365
366
367
368
369
370
371
372
373 if (__kernel_text_address(addr)) {
374#ifndef CONFIG_KALLSYMS
375 if (i % 5 == 0)
376 pr_debug("\n ");
377#endif
378 pr_debug(" [<%08lx>]", addr);
379 print_symbol(" %s\n", addr);
380 i++;
381 }
382 }
383 pr_debug("\n");
384}
385
386void show_stack(struct task_struct *task, unsigned long *stack)
387{
388 unsigned long *p, *endstack;
389 int i;
390
391 if (!stack) {
392 if (task && task != current)
393
394
395 stack = (unsigned long *)thread_saved_ksp(task);
396 else
397 stack = (unsigned long *)&stack;
398 }
399 endstack = (unsigned long *)(((unsigned long)stack + THREAD_SIZE - 1)
400 & -THREAD_SIZE);
401
402 pr_debug("Stack from %08lx:", (unsigned long)stack);
403 for (i = 0, p = stack; i < kstack_depth_to_print; i++) {
404 if (p + 1 > endstack)
405 break;
406 if (i % 8 == 0)
407 pr_cont("\n ");
408 pr_cont(" %08lx", *p++);
409 }
410 pr_cont("\n");
411 show_trace(stack, endstack);
412}
413
414int is_valid_bugaddr(unsigned long addr)
415{
416 return __kernel_text_address(addr);
417}
418