1 /*
2 * Based on arch/arm/kernel/traps.c
3 *
4 * Copyright (C) 1995-2009 Russell King
5 * Copyright (C) 2012 ARM Ltd.
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 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
18 */
19
20 #include <linux/bug.h>
21 #include <linux/signal.h>
22 #include <linux/personality.h>
23 #include <linux/kallsyms.h>
24 #include <linux/spinlock.h>
25 #include <linux/uaccess.h>
26 #include <linux/hardirq.h>
27 #include <linux/kdebug.h>
28 #include <linux/module.h>
29 #include <linux/kexec.h>
30 #include <linux/delay.h>
31 #include <linux/init.h>
32 #include <linux/sched.h>
33 #include <linux/syscalls.h>
34
35 #include <asm/atomic.h>
36 #include <asm/barrier.h>
37 #include <asm/bug.h>
38 #include <asm/debug-monitors.h>
39 #include <asm/esr.h>
40 #include <asm/insn.h>
41 #include <asm/traps.h>
42 #include <asm/stack_pointer.h>
43 #include <asm/stacktrace.h>
44 #include <asm/exception.h>
45 #include <asm/system_misc.h>
46 #include <asm/sysreg.h>
47
48 static const char *handler[]= {
49 "Synchronous Abort",
50 "IRQ",
51 "FIQ",
52 "Error"
53 };
54
55 int show_unhandled_signals = 0;
56
57 /*
58 * Dump out the contents of some kernel memory nicely...
59 */
dump_mem(const char * lvl,const char * str,unsigned long bottom,unsigned long top)60 static void dump_mem(const char *lvl, const char *str, unsigned long bottom,
61 unsigned long top)
62 {
63 unsigned long first;
64 mm_segment_t fs;
65 int i;
66
67 /*
68 * We need to switch to kernel mode so that we can use __get_user
69 * to safely read from kernel space.
70 */
71 fs = get_fs();
72 set_fs(KERNEL_DS);
73
74 printk("%s%s(0x%016lx to 0x%016lx)\n", lvl, str, bottom, top);
75
76 for (first = bottom & ~31; first < top; first += 32) {
77 unsigned long p;
78 char str[sizeof(" 12345678") * 8 + 1];
79
80 memset(str, ' ', sizeof(str));
81 str[sizeof(str) - 1] = '\0';
82
83 for (p = first, i = 0; i < (32 / 8)
84 && p < top; i++, p += 8) {
85 if (p >= bottom && p < top) {
86 unsigned long val;
87
88 if (__get_user(val, (unsigned long *)p) == 0)
89 sprintf(str + i * 17, " %016lx", val);
90 else
91 sprintf(str + i * 17, " ????????????????");
92 }
93 }
94 printk("%s%04lx:%s\n", lvl, first & 0xffff, str);
95 }
96
97 set_fs(fs);
98 }
99
dump_backtrace_entry(unsigned long where)100 static void dump_backtrace_entry(unsigned long where)
101 {
102 /*
103 * Note that 'where' can have a physical address, but it's not handled.
104 */
105 print_ip_sym(where);
106 }
107
__dump_instr(const char * lvl,struct pt_regs * regs)108 static void __dump_instr(const char *lvl, struct pt_regs *regs)
109 {
110 unsigned long addr = instruction_pointer(regs);
111 char str[sizeof("00000000 ") * 5 + 2 + 1], *p = str;
112 int i;
113
114 for (i = -4; i < 1; i++) {
115 unsigned int val, bad;
116
117 bad = get_user(val, &((u32 *)addr)[i]);
118
119 if (!bad)
120 p += sprintf(p, i == 0 ? "(%08x) " : "%08x ", val);
121 else {
122 p += sprintf(p, "bad PC value");
123 break;
124 }
125 }
126 printk("%sCode: %s\n", lvl, str);
127 }
128
dump_instr(const char * lvl,struct pt_regs * regs)129 static void dump_instr(const char *lvl, struct pt_regs *regs)
130 {
131 if (!user_mode(regs)) {
132 mm_segment_t fs = get_fs();
133 set_fs(KERNEL_DS);
134 __dump_instr(lvl, regs);
135 set_fs(fs);
136 } else {
137 __dump_instr(lvl, regs);
138 }
139 }
140
dump_backtrace(struct pt_regs * regs,struct task_struct * tsk)141 static void dump_backtrace(struct pt_regs *regs, struct task_struct *tsk)
142 {
143 struct stackframe frame;
144 unsigned long irq_stack_ptr;
145 int skip;
146
147 pr_debug("%s(regs = %p tsk = %p)\n", __func__, regs, tsk);
148
149 if (!tsk)
150 tsk = current;
151
152 if (!try_get_task_stack(tsk))
153 return;
154
155 /*
156 * Switching between stacks is valid when tracing current and in
157 * non-preemptible context.
158 */
159 if (tsk == current && !preemptible())
160 irq_stack_ptr = IRQ_STACK_PTR(smp_processor_id());
161 else
162 irq_stack_ptr = 0;
163
164 if (tsk == current) {
165 frame.fp = (unsigned long)__builtin_frame_address(0);
166 frame.sp = current_stack_pointer;
167 frame.pc = (unsigned long)dump_backtrace;
168 } else {
169 /*
170 * task blocked in __switch_to
171 */
172 frame.fp = thread_saved_fp(tsk);
173 frame.sp = thread_saved_sp(tsk);
174 frame.pc = thread_saved_pc(tsk);
175 }
176 #ifdef CONFIG_FUNCTION_GRAPH_TRACER
177 frame.graph = tsk->curr_ret_stack;
178 #endif
179
180 skip = !!regs;
181 printk("Call trace:\n");
182 while (1) {
183 unsigned long where = frame.pc;
184 unsigned long stack;
185 int ret;
186
187 /* skip until specified stack frame */
188 if (!skip) {
189 dump_backtrace_entry(where);
190 } else if (frame.fp == regs->regs[29]) {
191 skip = 0;
192 /*
193 * Mostly, this is the case where this function is
194 * called in panic/abort. As exception handler's
195 * stack frame does not contain the corresponding pc
196 * at which an exception has taken place, use regs->pc
197 * instead.
198 */
199 dump_backtrace_entry(regs->pc);
200 }
201 ret = unwind_frame(tsk, &frame);
202 if (ret < 0)
203 break;
204 stack = frame.sp;
205 if (in_exception_text(where)) {
206 /*
207 * If we switched to the irq_stack before calling this
208 * exception handler, then the pt_regs will be on the
209 * task stack. The easiest way to tell is if the large
210 * pt_regs would overlap with the end of the irq_stack.
211 */
212 if (stack < irq_stack_ptr &&
213 (stack + sizeof(struct pt_regs)) > irq_stack_ptr)
214 stack = IRQ_STACK_TO_TASK_STACK(irq_stack_ptr);
215
216 dump_mem("", "Exception stack", stack,
217 stack + sizeof(struct pt_regs));
218 }
219 }
220
221 put_task_stack(tsk);
222 }
223
show_stack(struct task_struct * tsk,unsigned long * sp)224 void show_stack(struct task_struct *tsk, unsigned long *sp)
225 {
226 dump_backtrace(NULL, tsk);
227 barrier();
228 }
229
230 #ifdef CONFIG_PREEMPT
231 #define S_PREEMPT " PREEMPT"
232 #else
233 #define S_PREEMPT ""
234 #endif
235 #define S_SMP " SMP"
236
__die(const char * str,int err,struct pt_regs * regs)237 static int __die(const char *str, int err, struct pt_regs *regs)
238 {
239 struct task_struct *tsk = current;
240 static int die_counter;
241 int ret;
242
243 pr_emerg("Internal error: %s: %x [#%d]" S_PREEMPT S_SMP "\n",
244 str, err, ++die_counter);
245
246 /* trap and error numbers are mostly meaningless on ARM */
247 ret = notify_die(DIE_OOPS, str, regs, err, 0, SIGSEGV);
248 if (ret == NOTIFY_STOP)
249 return ret;
250
251 print_modules();
252 __show_regs(regs);
253 pr_emerg("Process %.*s (pid: %d, stack limit = 0x%p)\n",
254 TASK_COMM_LEN, tsk->comm, task_pid_nr(tsk),
255 end_of_stack(tsk));
256
257 if (!user_mode(regs)) {
258 dump_mem(KERN_EMERG, "Stack: ", regs->sp,
259 THREAD_SIZE + (unsigned long)task_stack_page(tsk));
260 dump_backtrace(regs, tsk);
261 dump_instr(KERN_EMERG, regs);
262 }
263
264 return ret;
265 }
266
267 static DEFINE_RAW_SPINLOCK(die_lock);
268
269 /*
270 * This function is protected against re-entrancy.
271 */
die(const char * str,struct pt_regs * regs,int err)272 void die(const char *str, struct pt_regs *regs, int err)
273 {
274 int ret;
275
276 oops_enter();
277
278 raw_spin_lock_irq(&die_lock);
279 console_verbose();
280 bust_spinlocks(1);
281 ret = __die(str, err, regs);
282
283 if (regs && kexec_should_crash(current))
284 crash_kexec(regs);
285
286 bust_spinlocks(0);
287 add_taint(TAINT_DIE, LOCKDEP_NOW_UNRELIABLE);
288 raw_spin_unlock_irq(&die_lock);
289 oops_exit();
290
291 if (in_interrupt())
292 panic("Fatal exception in interrupt");
293 if (panic_on_oops)
294 panic("Fatal exception");
295 if (ret != NOTIFY_STOP)
296 do_exit(SIGSEGV);
297 }
298
arm64_notify_die(const char * str,struct pt_regs * regs,struct siginfo * info,int err)299 void arm64_notify_die(const char *str, struct pt_regs *regs,
300 struct siginfo *info, int err)
301 {
302 if (user_mode(regs)) {
303 current->thread.fault_address = 0;
304 current->thread.fault_code = err;
305 force_sig_info(info->si_signo, info, current);
306 } else {
307 die(str, regs, err);
308 }
309 }
310
311 static LIST_HEAD(undef_hook);
312 static DEFINE_RAW_SPINLOCK(undef_lock);
313
register_undef_hook(struct undef_hook * hook)314 void register_undef_hook(struct undef_hook *hook)
315 {
316 unsigned long flags;
317
318 raw_spin_lock_irqsave(&undef_lock, flags);
319 list_add(&hook->node, &undef_hook);
320 raw_spin_unlock_irqrestore(&undef_lock, flags);
321 }
322
unregister_undef_hook(struct undef_hook * hook)323 void unregister_undef_hook(struct undef_hook *hook)
324 {
325 unsigned long flags;
326
327 raw_spin_lock_irqsave(&undef_lock, flags);
328 list_del(&hook->node);
329 raw_spin_unlock_irqrestore(&undef_lock, flags);
330 }
331
call_undef_hook(struct pt_regs * regs)332 static int call_undef_hook(struct pt_regs *regs)
333 {
334 struct undef_hook *hook;
335 unsigned long flags;
336 u32 instr;
337 int (*fn)(struct pt_regs *regs, u32 instr) = NULL;
338 void __user *pc = (void __user *)instruction_pointer(regs);
339
340 if (!user_mode(regs))
341 return 1;
342
343 if (compat_thumb_mode(regs)) {
344 /* 16-bit Thumb instruction */
345 if (get_user(instr, (u16 __user *)pc))
346 goto exit;
347 instr = le16_to_cpu(instr);
348 if (aarch32_insn_is_wide(instr)) {
349 u32 instr2;
350
351 if (get_user(instr2, (u16 __user *)(pc + 2)))
352 goto exit;
353 instr2 = le16_to_cpu(instr2);
354 instr = (instr << 16) | instr2;
355 }
356 } else {
357 /* 32-bit ARM instruction */
358 if (get_user(instr, (u32 __user *)pc))
359 goto exit;
360 instr = le32_to_cpu(instr);
361 }
362
363 raw_spin_lock_irqsave(&undef_lock, flags);
364 list_for_each_entry(hook, &undef_hook, node)
365 if ((instr & hook->instr_mask) == hook->instr_val &&
366 (regs->pstate & hook->pstate_mask) == hook->pstate_val)
367 fn = hook->fn;
368
369 raw_spin_unlock_irqrestore(&undef_lock, flags);
370 exit:
371 return fn ? fn(regs, instr) : 1;
372 }
373
force_signal_inject(int signal,int code,struct pt_regs * regs,unsigned long address)374 static void force_signal_inject(int signal, int code, struct pt_regs *regs,
375 unsigned long address)
376 {
377 siginfo_t info;
378 void __user *pc = (void __user *)instruction_pointer(regs);
379 const char *desc;
380
381 switch (signal) {
382 case SIGILL:
383 desc = "undefined instruction";
384 break;
385 case SIGSEGV:
386 desc = "illegal memory access";
387 break;
388 default:
389 desc = "bad mode";
390 break;
391 }
392
393 if (unhandled_signal(current, signal) &&
394 show_unhandled_signals_ratelimited()) {
395 pr_info("%s[%d]: %s: pc=%p\n",
396 current->comm, task_pid_nr(current), desc, pc);
397 dump_instr(KERN_INFO, regs);
398 }
399
400 info.si_signo = signal;
401 info.si_errno = 0;
402 info.si_code = code;
403 info.si_addr = pc;
404
405 arm64_notify_die(desc, regs, &info, 0);
406 }
407
408 /*
409 * Set up process info to signal segmentation fault - called on access error.
410 */
arm64_notify_segfault(struct pt_regs * regs,unsigned long addr)411 void arm64_notify_segfault(struct pt_regs *regs, unsigned long addr)
412 {
413 int code;
414
415 down_read(¤t->mm->mmap_sem);
416 if (find_vma(current->mm, addr) == NULL)
417 code = SEGV_MAPERR;
418 else
419 code = SEGV_ACCERR;
420 up_read(¤t->mm->mmap_sem);
421
422 force_signal_inject(SIGSEGV, code, regs, addr);
423 }
424
do_undefinstr(struct pt_regs * regs)425 asmlinkage void __exception do_undefinstr(struct pt_regs *regs)
426 {
427 /* check for AArch32 breakpoint instructions */
428 if (!aarch32_break_handler(regs))
429 return;
430
431 if (call_undef_hook(regs) == 0)
432 return;
433
434 force_signal_inject(SIGILL, ILL_ILLOPC, regs, 0);
435 }
436
cpu_enable_cache_maint_trap(void * __unused)437 int cpu_enable_cache_maint_trap(void *__unused)
438 {
439 config_sctlr_el1(SCTLR_EL1_UCI, 0);
440 return 0;
441 }
442
443 #define __user_cache_maint(insn, address, res) \
444 if (address >= user_addr_max()) { \
445 res = -EFAULT; \
446 } else { \
447 uaccess_ttbr0_enable(); \
448 asm volatile ( \
449 "1: " insn ", %1\n" \
450 " mov %w0, #0\n" \
451 "2:\n" \
452 " .pushsection .fixup,\"ax\"\n" \
453 " .align 2\n" \
454 "3: mov %w0, %w2\n" \
455 " b 2b\n" \
456 " .popsection\n" \
457 _ASM_EXTABLE(1b, 3b) \
458 : "=r" (res) \
459 : "r" (address), "i" (-EFAULT)); \
460 uaccess_ttbr0_disable(); \
461 }
462
user_cache_maint_handler(unsigned int esr,struct pt_regs * regs)463 static void user_cache_maint_handler(unsigned int esr, struct pt_regs *regs)
464 {
465 unsigned long address;
466 int rt = (esr & ESR_ELx_SYS64_ISS_RT_MASK) >> ESR_ELx_SYS64_ISS_RT_SHIFT;
467 int crm = (esr & ESR_ELx_SYS64_ISS_CRM_MASK) >> ESR_ELx_SYS64_ISS_CRM_SHIFT;
468 int ret = 0;
469
470 address = (rt == 31) ? 0 : untagged_addr(regs->regs[rt]);
471
472 switch (crm) {
473 case ESR_ELx_SYS64_ISS_CRM_DC_CVAU: /* DC CVAU, gets promoted */
474 __user_cache_maint("dc civac", address, ret);
475 break;
476 case ESR_ELx_SYS64_ISS_CRM_DC_CVAC: /* DC CVAC, gets promoted */
477 __user_cache_maint("dc civac", address, ret);
478 break;
479 case ESR_ELx_SYS64_ISS_CRM_DC_CIVAC: /* DC CIVAC */
480 __user_cache_maint("dc civac", address, ret);
481 break;
482 case ESR_ELx_SYS64_ISS_CRM_IC_IVAU: /* IC IVAU */
483 __user_cache_maint("ic ivau", address, ret);
484 break;
485 default:
486 force_signal_inject(SIGILL, ILL_ILLOPC, regs, 0);
487 return;
488 }
489
490 if (ret)
491 arm64_notify_segfault(regs, address);
492 else
493 regs->pc += 4;
494 }
495
ctr_read_handler(unsigned int esr,struct pt_regs * regs)496 static void ctr_read_handler(unsigned int esr, struct pt_regs *regs)
497 {
498 int rt = (esr & ESR_ELx_SYS64_ISS_RT_MASK) >> ESR_ELx_SYS64_ISS_RT_SHIFT;
499
500 regs->regs[rt] = arm64_ftr_reg_ctrel0.sys_val;
501 regs->pc += 4;
502 }
503
cntvct_read_handler(unsigned int esr,struct pt_regs * regs)504 static void cntvct_read_handler(unsigned int esr, struct pt_regs *regs)
505 {
506 int rt = (esr & ESR_ELx_SYS64_ISS_RT_MASK) >> ESR_ELx_SYS64_ISS_RT_SHIFT;
507
508 isb();
509 if (rt != 31)
510 regs->regs[rt] = arch_counter_get_cntvct();
511 regs->pc += 4;
512 }
513
cntfrq_read_handler(unsigned int esr,struct pt_regs * regs)514 static void cntfrq_read_handler(unsigned int esr, struct pt_regs *regs)
515 {
516 int rt = (esr & ESR_ELx_SYS64_ISS_RT_MASK) >> ESR_ELx_SYS64_ISS_RT_SHIFT;
517
518 if (rt != 31)
519 regs->regs[rt] = read_sysreg(cntfrq_el0);
520 regs->pc += 4;
521 }
522
523 struct sys64_hook {
524 unsigned int esr_mask;
525 unsigned int esr_val;
526 void (*handler)(unsigned int esr, struct pt_regs *regs);
527 };
528
529 static struct sys64_hook sys64_hooks[] = {
530 {
531 .esr_mask = ESR_ELx_SYS64_ISS_EL0_CACHE_OP_MASK,
532 .esr_val = ESR_ELx_SYS64_ISS_EL0_CACHE_OP_VAL,
533 .handler = user_cache_maint_handler,
534 },
535 {
536 /* Trap read access to CTR_EL0 */
537 .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK,
538 .esr_val = ESR_ELx_SYS64_ISS_SYS_CTR_READ,
539 .handler = ctr_read_handler,
540 },
541 {
542 /* Trap read access to CNTVCT_EL0 */
543 .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK,
544 .esr_val = ESR_ELx_SYS64_ISS_SYS_CNTVCT,
545 .handler = cntvct_read_handler,
546 },
547 {
548 /* Trap read access to CNTFRQ_EL0 */
549 .esr_mask = ESR_ELx_SYS64_ISS_SYS_OP_MASK,
550 .esr_val = ESR_ELx_SYS64_ISS_SYS_CNTFRQ,
551 .handler = cntfrq_read_handler,
552 },
553 {},
554 };
555
do_sysinstr(unsigned int esr,struct pt_regs * regs)556 asmlinkage void __exception do_sysinstr(unsigned int esr, struct pt_regs *regs)
557 {
558 struct sys64_hook *hook;
559
560 for (hook = sys64_hooks; hook->handler; hook++)
561 if ((hook->esr_mask & esr) == hook->esr_val) {
562 hook->handler(esr, regs);
563 return;
564 }
565
566 force_signal_inject(SIGILL, ILL_ILLOPC, regs, 0);
567 }
568
569 long compat_arm_syscall(struct pt_regs *regs);
570
do_ni_syscall(struct pt_regs * regs)571 asmlinkage long do_ni_syscall(struct pt_regs *regs)
572 {
573 #ifdef CONFIG_COMPAT
574 long ret;
575 if (is_compat_task()) {
576 ret = compat_arm_syscall(regs);
577 if (ret != -ENOSYS)
578 return ret;
579 }
580 #endif
581
582 if (show_unhandled_signals_ratelimited()) {
583 pr_info("%s[%d]: syscall %d\n", current->comm,
584 task_pid_nr(current), (int)regs->syscallno);
585 dump_instr("", regs);
586 if (user_mode(regs))
587 __show_regs(regs);
588 }
589
590 return sys_ni_syscall();
591 }
592
593 static const char *esr_class_str[] = {
594 [0 ... ESR_ELx_EC_MAX] = "UNRECOGNIZED EC",
595 [ESR_ELx_EC_UNKNOWN] = "Unknown/Uncategorized",
596 [ESR_ELx_EC_WFx] = "WFI/WFE",
597 [ESR_ELx_EC_CP15_32] = "CP15 MCR/MRC",
598 [ESR_ELx_EC_CP15_64] = "CP15 MCRR/MRRC",
599 [ESR_ELx_EC_CP14_MR] = "CP14 MCR/MRC",
600 [ESR_ELx_EC_CP14_LS] = "CP14 LDC/STC",
601 [ESR_ELx_EC_FP_ASIMD] = "ASIMD",
602 [ESR_ELx_EC_CP10_ID] = "CP10 MRC/VMRS",
603 [ESR_ELx_EC_CP14_64] = "CP14 MCRR/MRRC",
604 [ESR_ELx_EC_ILL] = "PSTATE.IL",
605 [ESR_ELx_EC_SVC32] = "SVC (AArch32)",
606 [ESR_ELx_EC_HVC32] = "HVC (AArch32)",
607 [ESR_ELx_EC_SMC32] = "SMC (AArch32)",
608 [ESR_ELx_EC_SVC64] = "SVC (AArch64)",
609 [ESR_ELx_EC_HVC64] = "HVC (AArch64)",
610 [ESR_ELx_EC_SMC64] = "SMC (AArch64)",
611 [ESR_ELx_EC_SYS64] = "MSR/MRS (AArch64)",
612 [ESR_ELx_EC_IMP_DEF] = "EL3 IMP DEF",
613 [ESR_ELx_EC_IABT_LOW] = "IABT (lower EL)",
614 [ESR_ELx_EC_IABT_CUR] = "IABT (current EL)",
615 [ESR_ELx_EC_PC_ALIGN] = "PC Alignment",
616 [ESR_ELx_EC_DABT_LOW] = "DABT (lower EL)",
617 [ESR_ELx_EC_DABT_CUR] = "DABT (current EL)",
618 [ESR_ELx_EC_SP_ALIGN] = "SP Alignment",
619 [ESR_ELx_EC_FP_EXC32] = "FP (AArch32)",
620 [ESR_ELx_EC_FP_EXC64] = "FP (AArch64)",
621 [ESR_ELx_EC_SERROR] = "SError",
622 [ESR_ELx_EC_BREAKPT_LOW] = "Breakpoint (lower EL)",
623 [ESR_ELx_EC_BREAKPT_CUR] = "Breakpoint (current EL)",
624 [ESR_ELx_EC_SOFTSTP_LOW] = "Software Step (lower EL)",
625 [ESR_ELx_EC_SOFTSTP_CUR] = "Software Step (current EL)",
626 [ESR_ELx_EC_WATCHPT_LOW] = "Watchpoint (lower EL)",
627 [ESR_ELx_EC_WATCHPT_CUR] = "Watchpoint (current EL)",
628 [ESR_ELx_EC_BKPT32] = "BKPT (AArch32)",
629 [ESR_ELx_EC_VECTOR32] = "Vector catch (AArch32)",
630 [ESR_ELx_EC_BRK64] = "BRK (AArch64)",
631 };
632
esr_get_class_string(u32 esr)633 const char *esr_get_class_string(u32 esr)
634 {
635 return esr_class_str[ESR_ELx_EC(esr)];
636 }
637
638 /*
639 * bad_mode handles the impossible case in the exception vector. This is always
640 * fatal.
641 */
bad_mode(struct pt_regs * regs,int reason,unsigned int esr)642 asmlinkage void bad_mode(struct pt_regs *regs, int reason, unsigned int esr)
643 {
644 console_verbose();
645
646 pr_crit("Bad mode in %s handler detected on CPU%d, code 0x%08x -- %s\n",
647 handler[reason], smp_processor_id(), esr,
648 esr_get_class_string(esr));
649
650 die("Oops - bad mode", regs, 0);
651 local_irq_disable();
652 panic("bad mode");
653 }
654
655 /*
656 * bad_el0_sync handles unexpected, but potentially recoverable synchronous
657 * exceptions taken from EL0. Unlike bad_mode, this returns.
658 */
bad_el0_sync(struct pt_regs * regs,int reason,unsigned int esr)659 asmlinkage void bad_el0_sync(struct pt_regs *regs, int reason, unsigned int esr)
660 {
661 siginfo_t info;
662 void __user *pc = (void __user *)instruction_pointer(regs);
663 console_verbose();
664
665 pr_crit("Bad EL0 synchronous exception detected on CPU%d, code 0x%08x -- %s\n",
666 smp_processor_id(), esr, esr_get_class_string(esr));
667 __show_regs(regs);
668
669 info.si_signo = SIGILL;
670 info.si_errno = 0;
671 info.si_code = ILL_ILLOPC;
672 info.si_addr = pc;
673
674 current->thread.fault_address = 0;
675 current->thread.fault_code = 0;
676
677 force_sig_info(info.si_signo, &info, current);
678 }
679
__pte_error(const char * file,int line,unsigned long val)680 void __pte_error(const char *file, int line, unsigned long val)
681 {
682 pr_err("%s:%d: bad pte %016lx.\n", file, line, val);
683 }
684
__pmd_error(const char * file,int line,unsigned long val)685 void __pmd_error(const char *file, int line, unsigned long val)
686 {
687 pr_err("%s:%d: bad pmd %016lx.\n", file, line, val);
688 }
689
__pud_error(const char * file,int line,unsigned long val)690 void __pud_error(const char *file, int line, unsigned long val)
691 {
692 pr_err("%s:%d: bad pud %016lx.\n", file, line, val);
693 }
694
__pgd_error(const char * file,int line,unsigned long val)695 void __pgd_error(const char *file, int line, unsigned long val)
696 {
697 pr_err("%s:%d: bad pgd %016lx.\n", file, line, val);
698 }
699
700 /* GENERIC_BUG traps */
701
is_valid_bugaddr(unsigned long addr)702 int is_valid_bugaddr(unsigned long addr)
703 {
704 /*
705 * bug_handler() only called for BRK #BUG_BRK_IMM.
706 * So the answer is trivial -- any spurious instances with no
707 * bug table entry will be rejected by report_bug() and passed
708 * back to the debug-monitors code and handled as a fatal
709 * unexpected debug exception.
710 */
711 return 1;
712 }
713
bug_handler(struct pt_regs * regs,unsigned int esr)714 static int bug_handler(struct pt_regs *regs, unsigned int esr)
715 {
716 if (user_mode(regs))
717 return DBG_HOOK_ERROR;
718
719 switch (report_bug(regs->pc, regs)) {
720 case BUG_TRAP_TYPE_BUG:
721 die("Oops - BUG", regs, 0);
722 break;
723
724 case BUG_TRAP_TYPE_WARN:
725 /* Ideally, report_bug() should backtrace for us... but no. */
726 dump_backtrace(regs, NULL);
727 break;
728
729 default:
730 /* unknown/unrecognised bug trap type */
731 return DBG_HOOK_ERROR;
732 }
733
734 /* If thread survives, skip over the BUG instruction and continue: */
735 regs->pc += AARCH64_INSN_SIZE; /* skip BRK and resume */
736 return DBG_HOOK_HANDLED;
737 }
738
739 static struct break_hook bug_break_hook = {
740 .esr_val = 0xf2000000 | BUG_BRK_IMM,
741 .esr_mask = 0xffffffff,
742 .fn = bug_handler,
743 };
744
745 /*
746 * Initial handler for AArch64 BRK exceptions
747 * This handler only used until debug_traps_init().
748 */
early_brk64(unsigned long addr,unsigned int esr,struct pt_regs * regs)749 int __init early_brk64(unsigned long addr, unsigned int esr,
750 struct pt_regs *regs)
751 {
752 return bug_handler(regs, esr) != DBG_HOOK_HANDLED;
753 }
754
755 /* This registration must happen early, before debug_traps_init(). */
trap_init(void)756 void __init trap_init(void)
757 {
758 register_break_hook(&bug_break_hook);
759 }
760