1 /*
2  *  Port on Texas Instruments TMS320C6x architecture
3  *
4  *  Copyright (C) 2004, 2006, 2009, 2010, 2011 Texas Instruments Incorporated
5  *  Author: Aurelien Jacquiot (aurelien.jacquiot@jaluna.com)
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License version 2 as
9  *  published by the Free Software Foundation.
10  */
11 #include <linux/module.h>
12 #include <linux/ptrace.h>
13 #include <linux/sched/debug.h>
14 #include <linux/bug.h>
15 
16 #include <asm/soc.h>
17 #include <asm/special_insns.h>
18 #include <asm/traps.h>
19 
20 int (*c6x_nmi_handler)(struct pt_regs *regs);
21 
trap_init(void)22 void __init trap_init(void)
23 {
24 	ack_exception(EXCEPT_TYPE_NXF);
25 	ack_exception(EXCEPT_TYPE_EXC);
26 	ack_exception(EXCEPT_TYPE_IXF);
27 	ack_exception(EXCEPT_TYPE_SXF);
28 	enable_exception();
29 }
30 
show_regs(struct pt_regs * regs)31 void show_regs(struct pt_regs *regs)
32 {
33 	pr_err("\n");
34 	show_regs_print_info(KERN_ERR);
35 	pr_err("PC: %08lx SP: %08lx\n", regs->pc, regs->sp);
36 	pr_err("Status: %08lx ORIG_A4: %08lx\n", regs->csr, regs->orig_a4);
37 	pr_err("A0: %08lx  B0: %08lx\n", regs->a0, regs->b0);
38 	pr_err("A1: %08lx  B1: %08lx\n", regs->a1, regs->b1);
39 	pr_err("A2: %08lx  B2: %08lx\n", regs->a2, regs->b2);
40 	pr_err("A3: %08lx  B3: %08lx\n", regs->a3, regs->b3);
41 	pr_err("A4: %08lx  B4: %08lx\n", regs->a4, regs->b4);
42 	pr_err("A5: %08lx  B5: %08lx\n", regs->a5, regs->b5);
43 	pr_err("A6: %08lx  B6: %08lx\n", regs->a6, regs->b6);
44 	pr_err("A7: %08lx  B7: %08lx\n", regs->a7, regs->b7);
45 	pr_err("A8: %08lx  B8: %08lx\n", regs->a8, regs->b8);
46 	pr_err("A9: %08lx  B9: %08lx\n", regs->a9, regs->b9);
47 	pr_err("A10: %08lx  B10: %08lx\n", regs->a10, regs->b10);
48 	pr_err("A11: %08lx  B11: %08lx\n", regs->a11, regs->b11);
49 	pr_err("A12: %08lx  B12: %08lx\n", regs->a12, regs->b12);
50 	pr_err("A13: %08lx  B13: %08lx\n", regs->a13, regs->b13);
51 	pr_err("A14: %08lx  B14: %08lx\n", regs->a14, regs->dp);
52 	pr_err("A15: %08lx  B15: %08lx\n", regs->a15, regs->sp);
53 	pr_err("A16: %08lx  B16: %08lx\n", regs->a16, regs->b16);
54 	pr_err("A17: %08lx  B17: %08lx\n", regs->a17, regs->b17);
55 	pr_err("A18: %08lx  B18: %08lx\n", regs->a18, regs->b18);
56 	pr_err("A19: %08lx  B19: %08lx\n", regs->a19, regs->b19);
57 	pr_err("A20: %08lx  B20: %08lx\n", regs->a20, regs->b20);
58 	pr_err("A21: %08lx  B21: %08lx\n", regs->a21, regs->b21);
59 	pr_err("A22: %08lx  B22: %08lx\n", regs->a22, regs->b22);
60 	pr_err("A23: %08lx  B23: %08lx\n", regs->a23, regs->b23);
61 	pr_err("A24: %08lx  B24: %08lx\n", regs->a24, regs->b24);
62 	pr_err("A25: %08lx  B25: %08lx\n", regs->a25, regs->b25);
63 	pr_err("A26: %08lx  B26: %08lx\n", regs->a26, regs->b26);
64 	pr_err("A27: %08lx  B27: %08lx\n", regs->a27, regs->b27);
65 	pr_err("A28: %08lx  B28: %08lx\n", regs->a28, regs->b28);
66 	pr_err("A29: %08lx  B29: %08lx\n", regs->a29, regs->b29);
67 	pr_err("A30: %08lx  B30: %08lx\n", regs->a30, regs->b30);
68 	pr_err("A31: %08lx  B31: %08lx\n", regs->a31, regs->b31);
69 }
70 
die(char * str,struct pt_regs * fp,int nr)71 void die(char *str, struct pt_regs *fp, int nr)
72 {
73 	console_verbose();
74 	pr_err("%s: %08x\n", str, nr);
75 	show_regs(fp);
76 
77 	pr_err("Process %s (pid: %d, stackpage=%08lx)\n",
78 	       current->comm, current->pid, (PAGE_SIZE +
79 					     (unsigned long) current));
80 
81 	dump_stack();
82 	while (1)
83 		;
84 }
85 
die_if_kernel(char * str,struct pt_regs * fp,int nr)86 static void die_if_kernel(char *str, struct pt_regs *fp, int nr)
87 {
88 	if (user_mode(fp))
89 		return;
90 
91 	die(str, fp, nr);
92 }
93 
94 
95 /* Internal exceptions */
96 static struct exception_info iexcept_table[10] = {
97 	{ "Oops - instruction fetch", SIGBUS, BUS_ADRERR },
98 	{ "Oops - fetch packet", SIGBUS, BUS_ADRERR },
99 	{ "Oops - execute packet", SIGILL, ILL_ILLOPC },
100 	{ "Oops - undefined instruction", SIGILL, ILL_ILLOPC },
101 	{ "Oops - resource conflict", SIGILL, ILL_ILLOPC },
102 	{ "Oops - resource access", SIGILL, ILL_PRVREG },
103 	{ "Oops - privilege", SIGILL, ILL_PRVOPC },
104 	{ "Oops - loops buffer", SIGILL, ILL_ILLOPC },
105 	{ "Oops - software exception", SIGILL, ILL_ILLTRP },
106 	{ "Oops - unknown exception", SIGILL, ILL_ILLOPC }
107 };
108 
109 /* External exceptions */
110 static struct exception_info eexcept_table[128] = {
111 	{ "Oops - external exception", SIGBUS, BUS_ADRERR },
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 
144 	{ "Oops - external exception", SIGBUS, BUS_ADRERR },
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 
177 	{ "Oops - external exception", SIGBUS, BUS_ADRERR },
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 
210 	{ "Oops - external exception", SIGBUS, BUS_ADRERR },
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 - CPU memory protection fault", SIGSEGV, SEGV_ACCERR },
234 	{ "Oops - CPU memory protection fault in L1P", SIGSEGV, SEGV_ACCERR },
235 	{ "Oops - DMA memory protection fault in L1P", SIGSEGV, SEGV_ACCERR },
236 	{ "Oops - CPU memory protection fault in L1D", SIGSEGV, SEGV_ACCERR },
237 	{ "Oops - DMA memory protection fault in L1D", SIGSEGV, SEGV_ACCERR },
238 	{ "Oops - CPU memory protection fault in L2", SIGSEGV, SEGV_ACCERR },
239 	{ "Oops - DMA memory protection fault in L2", SIGSEGV, SEGV_ACCERR },
240 	{ "Oops - EMC CPU memory protection fault", SIGSEGV, SEGV_ACCERR },
241 	{ "Oops - EMC bus error", SIGBUS, BUS_ADRERR }
242 };
243 
do_trap(struct exception_info * except_info,struct pt_regs * regs)244 static void do_trap(struct exception_info *except_info, struct pt_regs *regs)
245 {
246 	unsigned long addr = instruction_pointer(regs);
247 
248 	if (except_info->code != TRAP_BRKPT)
249 		pr_err("TRAP: %s PC[0x%lx] signo[%d] code[%d]\n",
250 		       except_info->kernel_str, regs->pc,
251 		       except_info->signo, except_info->code);
252 
253 	die_if_kernel(except_info->kernel_str, regs, addr);
254 
255 	force_sig_fault(except_info->signo, except_info->code,
256 			(void __user *)addr, current);
257 }
258 
259 /*
260  * Process an internal exception (non maskable)
261  */
process_iexcept(struct pt_regs * regs)262 static int process_iexcept(struct pt_regs *regs)
263 {
264 	unsigned int iexcept_report = get_iexcept();
265 	unsigned int iexcept_num;
266 
267 	ack_exception(EXCEPT_TYPE_IXF);
268 
269 	pr_err("IEXCEPT: PC[0x%lx]\n", regs->pc);
270 
271 	while (iexcept_report) {
272 		iexcept_num = __ffs(iexcept_report);
273 		iexcept_report &= ~(1 << iexcept_num);
274 		set_iexcept(iexcept_report);
275 		if (*(unsigned int *)regs->pc == BKPT_OPCODE) {
276 			/* This is a breakpoint */
277 			struct exception_info bkpt_exception = {
278 				"Oops - undefined instruction",
279 				  SIGTRAP, TRAP_BRKPT
280 			};
281 			do_trap(&bkpt_exception, regs);
282 			iexcept_report &= ~(0xFF);
283 			set_iexcept(iexcept_report);
284 			continue;
285 		}
286 
287 		do_trap(&iexcept_table[iexcept_num], regs);
288 	}
289 	return 0;
290 }
291 
292 /*
293  * Process an external exception (maskable)
294  */
process_eexcept(struct pt_regs * regs)295 static void process_eexcept(struct pt_regs *regs)
296 {
297 	int evt;
298 
299 	pr_err("EEXCEPT: PC[0x%lx]\n", regs->pc);
300 
301 	while ((evt = soc_get_exception()) >= 0)
302 		do_trap(&eexcept_table[evt], regs);
303 
304 	ack_exception(EXCEPT_TYPE_EXC);
305 }
306 
307 /*
308  * Main exception processing
309  */
process_exception(struct pt_regs * regs)310 asmlinkage int process_exception(struct pt_regs *regs)
311 {
312 	unsigned int type;
313 	unsigned int type_num;
314 	unsigned int ie_num = 9; /* default is unknown exception */
315 
316 	while ((type = get_except_type()) != 0) {
317 		type_num = fls(type) - 1;
318 
319 		switch (type_num) {
320 		case EXCEPT_TYPE_NXF:
321 			ack_exception(EXCEPT_TYPE_NXF);
322 			if (c6x_nmi_handler)
323 				(c6x_nmi_handler)(regs);
324 			else
325 				pr_alert("NMI interrupt!\n");
326 			break;
327 
328 		case EXCEPT_TYPE_IXF:
329 			if (process_iexcept(regs))
330 				return 1;
331 			break;
332 
333 		case EXCEPT_TYPE_EXC:
334 			process_eexcept(regs);
335 			break;
336 
337 		case EXCEPT_TYPE_SXF:
338 			ie_num = 8;
339 		default:
340 			ack_exception(type_num);
341 			do_trap(&iexcept_table[ie_num], regs);
342 			break;
343 		}
344 	}
345 	return 0;
346 }
347 
348 static int kstack_depth_to_print = 48;
349 
show_trace(unsigned long * stack,unsigned long * endstack)350 static void show_trace(unsigned long *stack, unsigned long *endstack)
351 {
352 	unsigned long addr;
353 	int i;
354 
355 	pr_debug("Call trace:");
356 	i = 0;
357 	while (stack + 1 <= endstack) {
358 		addr = *stack++;
359 		/*
360 		 * If the address is either in the text segment of the
361 		 * kernel, or in the region which contains vmalloc'ed
362 		 * memory, it *may* be the address of a calling
363 		 * routine; if so, print it so that someone tracing
364 		 * down the cause of the crash will be able to figure
365 		 * out the call path that was taken.
366 		 */
367 		if (__kernel_text_address(addr)) {
368 #ifndef CONFIG_KALLSYMS
369 			if (i % 5 == 0)
370 				pr_debug("\n	    ");
371 #endif
372 			pr_debug(" [<%08lx>] %pS\n", addr, (void *)addr);
373 			i++;
374 		}
375 	}
376 	pr_debug("\n");
377 }
378 
show_stack(struct task_struct * task,unsigned long * stack)379 void show_stack(struct task_struct *task, unsigned long *stack)
380 {
381 	unsigned long *p, *endstack;
382 	int i;
383 
384 	if (!stack) {
385 		if (task && task != current)
386 			/* We know this is a kernel stack,
387 			   so this is the start/end */
388 			stack = (unsigned long *)thread_saved_ksp(task);
389 		else
390 			stack = (unsigned long *)&stack;
391 	}
392 	endstack = (unsigned long *)(((unsigned long)stack + THREAD_SIZE - 1)
393 				     & -THREAD_SIZE);
394 
395 	pr_debug("Stack from %08lx:", (unsigned long)stack);
396 	for (i = 0, p = stack; i < kstack_depth_to_print; i++) {
397 		if (p + 1 > endstack)
398 			break;
399 		if (i % 8 == 0)
400 			pr_cont("\n	    ");
401 		pr_cont(" %08lx", *p++);
402 	}
403 	pr_cont("\n");
404 	show_trace(stack, endstack);
405 }
406 
is_valid_bugaddr(unsigned long addr)407 int is_valid_bugaddr(unsigned long addr)
408 {
409 	return __kernel_text_address(addr);
410 }
411