arm64: Modify stack trace and dump for use with irq_stack
[firefly-linux-kernel-4.4.55.git] / arch / arm64 / kernel / traps.c
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/bug.h>
37 #include <asm/debug-monitors.h>
38 #include <asm/esr.h>
39 #include <asm/insn.h>
40 #include <asm/traps.h>
41 #include <asm/stacktrace.h>
42 #include <asm/exception.h>
43 #include <asm/system_misc.h>
44
45 static const char *handler[]= {
46         "Synchronous Abort",
47         "IRQ",
48         "FIQ",
49         "Error"
50 };
51
52 int show_unhandled_signals = 1;
53
54 /*
55  * Dump out the contents of some memory nicely...
56  */
57 static void dump_mem(const char *lvl, const char *str, unsigned long bottom,
58                      unsigned long top, bool compat)
59 {
60         unsigned long first;
61         mm_segment_t fs;
62         int i;
63         unsigned int width = compat ? 4 : 8;
64
65         /*
66          * We need to switch to kernel mode so that we can use __get_user
67          * to safely read from kernel space.  Note that we now dump the
68          * code first, just in case the backtrace kills us.
69          */
70         fs = get_fs();
71         set_fs(KERNEL_DS);
72
73         printk("%s%s(0x%016lx to 0x%016lx)\n", lvl, str, bottom, top);
74
75         for (first = bottom & ~31; first < top; first += 32) {
76                 unsigned long p;
77                 char str[sizeof(" 12345678") * 8 + 1];
78
79                 memset(str, ' ', sizeof(str));
80                 str[sizeof(str) - 1] = '\0';
81
82                 for (p = first, i = 0; i < (32 / width)
83                                         && p < top; i++, p += width) {
84                         if (p >= bottom && p < top) {
85                                 unsigned long val;
86
87                                 if (width == 8) {
88                                         if (__get_user(val, (unsigned long *)p) == 0)
89                                                 sprintf(str + i * 17, " %016lx", val);
90                                         else
91                                                 sprintf(str + i * 17, " ????????????????");
92                                 } else {
93                                         if (__get_user(val, (unsigned int *)p) == 0)
94                                                 sprintf(str + i * 9, " %08lx", val);
95                                         else
96                                                 sprintf(str + i * 9, " ????????");
97                                 }
98                         }
99                 }
100                 printk("%s%04lx:%s\n", lvl, first & 0xffff, str);
101         }
102
103         set_fs(fs);
104 }
105
106 static void dump_backtrace_entry(unsigned long where)
107 {
108         /*
109          * Note that 'where' can have a physical address, but it's not handled.
110          */
111         print_ip_sym(where);
112 }
113
114 static void dump_instr(const char *lvl, struct pt_regs *regs)
115 {
116         unsigned long addr = instruction_pointer(regs);
117         mm_segment_t fs;
118         char str[sizeof("00000000 ") * 5 + 2 + 1], *p = str;
119         int i;
120
121         /*
122          * We need to switch to kernel mode so that we can use __get_user
123          * to safely read from kernel space.  Note that we now dump the
124          * code first, just in case the backtrace kills us.
125          */
126         fs = get_fs();
127         set_fs(KERNEL_DS);
128
129         for (i = -4; i < 1; i++) {
130                 unsigned int val, bad;
131
132                 bad = __get_user(val, &((u32 *)addr)[i]);
133
134                 if (!bad)
135                         p += sprintf(p, i == 0 ? "(%08x) " : "%08x ", val);
136                 else {
137                         p += sprintf(p, "bad PC value");
138                         break;
139                 }
140         }
141         printk("%sCode: %s\n", lvl, str);
142
143         set_fs(fs);
144 }
145
146 static void dump_backtrace(struct pt_regs *regs, struct task_struct *tsk)
147 {
148         struct stackframe frame;
149         unsigned long irq_stack_ptr = IRQ_STACK_PTR(smp_processor_id());
150
151         pr_debug("%s(regs = %p tsk = %p)\n", __func__, regs, tsk);
152
153         if (!tsk)
154                 tsk = current;
155
156         if (regs) {
157                 frame.fp = regs->regs[29];
158                 frame.sp = regs->sp;
159                 frame.pc = regs->pc;
160         } else if (tsk == current) {
161                 frame.fp = (unsigned long)__builtin_frame_address(0);
162                 frame.sp = current_stack_pointer;
163                 frame.pc = (unsigned long)dump_backtrace;
164         } else {
165                 /*
166                  * task blocked in __switch_to
167                  */
168                 frame.fp = thread_saved_fp(tsk);
169                 frame.sp = thread_saved_sp(tsk);
170                 frame.pc = thread_saved_pc(tsk);
171         }
172
173         pr_emerg("Call trace:\n");
174         while (1) {
175                 unsigned long where = frame.pc;
176                 unsigned long stack;
177                 int ret;
178
179                 dump_backtrace_entry(where);
180                 ret = unwind_frame(&frame);
181                 if (ret < 0)
182                         break;
183                 stack = frame.sp;
184                 if (in_exception_text(where)) {
185                         /*
186                          * If we switched to the irq_stack before calling this
187                          * exception handler, then the pt_regs will be on the
188                          * task stack. The easiest way to tell is if the large
189                          * pt_regs would overlap with the end of the irq_stack.
190                          */
191                         if (stack < irq_stack_ptr &&
192                             (stack + sizeof(struct pt_regs)) > irq_stack_ptr)
193                                 stack = IRQ_STACK_TO_TASK_STACK(irq_stack_ptr);
194
195                         dump_mem("", "Exception stack", stack,
196                                  stack + sizeof(struct pt_regs), false);
197                 }
198         }
199 }
200
201 void show_stack(struct task_struct *tsk, unsigned long *sp)
202 {
203         dump_backtrace(NULL, tsk);
204         barrier();
205 }
206
207 #ifdef CONFIG_PREEMPT
208 #define S_PREEMPT " PREEMPT"
209 #else
210 #define S_PREEMPT ""
211 #endif
212 #define S_SMP " SMP"
213
214 static int __die(const char *str, int err, struct thread_info *thread,
215                  struct pt_regs *regs)
216 {
217         struct task_struct *tsk = thread->task;
218         static int die_counter;
219         int ret;
220
221         pr_emerg("Internal error: %s: %x [#%d]" S_PREEMPT S_SMP "\n",
222                  str, err, ++die_counter);
223
224         /* trap and error numbers are mostly meaningless on ARM */
225         ret = notify_die(DIE_OOPS, str, regs, err, 0, SIGSEGV);
226         if (ret == NOTIFY_STOP)
227                 return ret;
228
229         print_modules();
230         __show_regs(regs);
231         pr_emerg("Process %.*s (pid: %d, stack limit = 0x%p)\n",
232                  TASK_COMM_LEN, tsk->comm, task_pid_nr(tsk), thread + 1);
233
234         if (!user_mode(regs) || in_interrupt()) {
235                 dump_mem(KERN_EMERG, "Stack: ", regs->sp,
236                          THREAD_SIZE + (unsigned long)task_stack_page(tsk),
237                          compat_user_mode(regs));
238                 dump_backtrace(regs, tsk);
239                 dump_instr(KERN_EMERG, regs);
240         }
241
242         return ret;
243 }
244
245 static DEFINE_RAW_SPINLOCK(die_lock);
246
247 /*
248  * This function is protected against re-entrancy.
249  */
250 void die(const char *str, struct pt_regs *regs, int err)
251 {
252         struct thread_info *thread = current_thread_info();
253         int ret;
254
255         oops_enter();
256
257         raw_spin_lock_irq(&die_lock);
258         console_verbose();
259         bust_spinlocks(1);
260         ret = __die(str, err, thread, regs);
261
262         if (regs && kexec_should_crash(thread->task))
263                 crash_kexec(regs);
264
265         bust_spinlocks(0);
266         add_taint(TAINT_DIE, LOCKDEP_NOW_UNRELIABLE);
267         raw_spin_unlock_irq(&die_lock);
268         oops_exit();
269
270         if (in_interrupt())
271                 panic("Fatal exception in interrupt");
272         if (panic_on_oops)
273                 panic("Fatal exception");
274         if (ret != NOTIFY_STOP)
275                 do_exit(SIGSEGV);
276 }
277
278 void arm64_notify_die(const char *str, struct pt_regs *regs,
279                       struct siginfo *info, int err)
280 {
281         if (user_mode(regs)) {
282                 current->thread.fault_address = 0;
283                 current->thread.fault_code = err;
284                 force_sig_info(info->si_signo, info, current);
285         } else {
286                 die(str, regs, err);
287         }
288 }
289
290 static LIST_HEAD(undef_hook);
291 static DEFINE_RAW_SPINLOCK(undef_lock);
292
293 void register_undef_hook(struct undef_hook *hook)
294 {
295         unsigned long flags;
296
297         raw_spin_lock_irqsave(&undef_lock, flags);
298         list_add(&hook->node, &undef_hook);
299         raw_spin_unlock_irqrestore(&undef_lock, flags);
300 }
301
302 void unregister_undef_hook(struct undef_hook *hook)
303 {
304         unsigned long flags;
305
306         raw_spin_lock_irqsave(&undef_lock, flags);
307         list_del(&hook->node);
308         raw_spin_unlock_irqrestore(&undef_lock, flags);
309 }
310
311 static int call_undef_hook(struct pt_regs *regs)
312 {
313         struct undef_hook *hook;
314         unsigned long flags;
315         u32 instr;
316         int (*fn)(struct pt_regs *regs, u32 instr) = NULL;
317         void __user *pc = (void __user *)instruction_pointer(regs);
318
319         if (!user_mode(regs))
320                 return 1;
321
322         if (compat_thumb_mode(regs)) {
323                 /* 16-bit Thumb instruction */
324                 if (get_user(instr, (u16 __user *)pc))
325                         goto exit;
326                 instr = le16_to_cpu(instr);
327                 if (aarch32_insn_is_wide(instr)) {
328                         u32 instr2;
329
330                         if (get_user(instr2, (u16 __user *)(pc + 2)))
331                                 goto exit;
332                         instr2 = le16_to_cpu(instr2);
333                         instr = (instr << 16) | instr2;
334                 }
335         } else {
336                 /* 32-bit ARM instruction */
337                 if (get_user(instr, (u32 __user *)pc))
338                         goto exit;
339                 instr = le32_to_cpu(instr);
340         }
341
342         raw_spin_lock_irqsave(&undef_lock, flags);
343         list_for_each_entry(hook, &undef_hook, node)
344                 if ((instr & hook->instr_mask) == hook->instr_val &&
345                         (regs->pstate & hook->pstate_mask) == hook->pstate_val)
346                         fn = hook->fn;
347
348         raw_spin_unlock_irqrestore(&undef_lock, flags);
349 exit:
350         return fn ? fn(regs, instr) : 1;
351 }
352
353 asmlinkage void __exception do_undefinstr(struct pt_regs *regs)
354 {
355         siginfo_t info;
356         void __user *pc = (void __user *)instruction_pointer(regs);
357
358         /* check for AArch32 breakpoint instructions */
359         if (!aarch32_break_handler(regs))
360                 return;
361
362         if (call_undef_hook(regs) == 0)
363                 return;
364
365         if (unhandled_signal(current, SIGILL) && show_unhandled_signals_ratelimited()) {
366                 pr_info("%s[%d]: undefined instruction: pc=%p\n",
367                         current->comm, task_pid_nr(current), pc);
368                 dump_instr(KERN_INFO, regs);
369         }
370
371         info.si_signo = SIGILL;
372         info.si_errno = 0;
373         info.si_code  = ILL_ILLOPC;
374         info.si_addr  = pc;
375
376         arm64_notify_die("Oops - undefined instruction", regs, &info, 0);
377 }
378
379 long compat_arm_syscall(struct pt_regs *regs);
380
381 asmlinkage long do_ni_syscall(struct pt_regs *regs)
382 {
383 #ifdef CONFIG_COMPAT
384         long ret;
385         if (is_compat_task()) {
386                 ret = compat_arm_syscall(regs);
387                 if (ret != -ENOSYS)
388                         return ret;
389         }
390 #endif
391
392         if (show_unhandled_signals_ratelimited()) {
393                 pr_info("%s[%d]: syscall %d\n", current->comm,
394                         task_pid_nr(current), (int)regs->syscallno);
395                 dump_instr("", regs);
396                 if (user_mode(regs))
397                         __show_regs(regs);
398         }
399
400         return sys_ni_syscall();
401 }
402
403 static const char *esr_class_str[] = {
404         [0 ... ESR_ELx_EC_MAX]          = "UNRECOGNIZED EC",
405         [ESR_ELx_EC_UNKNOWN]            = "Unknown/Uncategorized",
406         [ESR_ELx_EC_WFx]                = "WFI/WFE",
407         [ESR_ELx_EC_CP15_32]            = "CP15 MCR/MRC",
408         [ESR_ELx_EC_CP15_64]            = "CP15 MCRR/MRRC",
409         [ESR_ELx_EC_CP14_MR]            = "CP14 MCR/MRC",
410         [ESR_ELx_EC_CP14_LS]            = "CP14 LDC/STC",
411         [ESR_ELx_EC_FP_ASIMD]           = "ASIMD",
412         [ESR_ELx_EC_CP10_ID]            = "CP10 MRC/VMRS",
413         [ESR_ELx_EC_CP14_64]            = "CP14 MCRR/MRRC",
414         [ESR_ELx_EC_ILL]                = "PSTATE.IL",
415         [ESR_ELx_EC_SVC32]              = "SVC (AArch32)",
416         [ESR_ELx_EC_HVC32]              = "HVC (AArch32)",
417         [ESR_ELx_EC_SMC32]              = "SMC (AArch32)",
418         [ESR_ELx_EC_SVC64]              = "SVC (AArch64)",
419         [ESR_ELx_EC_HVC64]              = "HVC (AArch64)",
420         [ESR_ELx_EC_SMC64]              = "SMC (AArch64)",
421         [ESR_ELx_EC_SYS64]              = "MSR/MRS (AArch64)",
422         [ESR_ELx_EC_IMP_DEF]            = "EL3 IMP DEF",
423         [ESR_ELx_EC_IABT_LOW]           = "IABT (lower EL)",
424         [ESR_ELx_EC_IABT_CUR]           = "IABT (current EL)",
425         [ESR_ELx_EC_PC_ALIGN]           = "PC Alignment",
426         [ESR_ELx_EC_DABT_LOW]           = "DABT (lower EL)",
427         [ESR_ELx_EC_DABT_CUR]           = "DABT (current EL)",
428         [ESR_ELx_EC_SP_ALIGN]           = "SP Alignment",
429         [ESR_ELx_EC_FP_EXC32]           = "FP (AArch32)",
430         [ESR_ELx_EC_FP_EXC64]           = "FP (AArch64)",
431         [ESR_ELx_EC_SERROR]             = "SError",
432         [ESR_ELx_EC_BREAKPT_LOW]        = "Breakpoint (lower EL)",
433         [ESR_ELx_EC_BREAKPT_CUR]        = "Breakpoint (current EL)",
434         [ESR_ELx_EC_SOFTSTP_LOW]        = "Software Step (lower EL)",
435         [ESR_ELx_EC_SOFTSTP_CUR]        = "Software Step (current EL)",
436         [ESR_ELx_EC_WATCHPT_LOW]        = "Watchpoint (lower EL)",
437         [ESR_ELx_EC_WATCHPT_CUR]        = "Watchpoint (current EL)",
438         [ESR_ELx_EC_BKPT32]             = "BKPT (AArch32)",
439         [ESR_ELx_EC_VECTOR32]           = "Vector catch (AArch32)",
440         [ESR_ELx_EC_BRK64]              = "BRK (AArch64)",
441 };
442
443 const char *esr_get_class_string(u32 esr)
444 {
445         return esr_class_str[esr >> ESR_ELx_EC_SHIFT];
446 }
447
448 /*
449  * bad_mode handles the impossible case in the exception vector.
450  */
451 asmlinkage void bad_mode(struct pt_regs *regs, int reason, unsigned int esr)
452 {
453         siginfo_t info;
454         void __user *pc = (void __user *)instruction_pointer(regs);
455         console_verbose();
456
457         pr_crit("Bad mode in %s handler detected, code 0x%08x -- %s\n",
458                 handler[reason], esr, esr_get_class_string(esr));
459         __show_regs(regs);
460
461         info.si_signo = SIGILL;
462         info.si_errno = 0;
463         info.si_code  = ILL_ILLOPC;
464         info.si_addr  = pc;
465
466         arm64_notify_die("Oops - bad mode", regs, &info, 0);
467 }
468
469 void __pte_error(const char *file, int line, unsigned long val)
470 {
471         pr_crit("%s:%d: bad pte %016lx.\n", file, line, val);
472 }
473
474 void __pmd_error(const char *file, int line, unsigned long val)
475 {
476         pr_crit("%s:%d: bad pmd %016lx.\n", file, line, val);
477 }
478
479 void __pud_error(const char *file, int line, unsigned long val)
480 {
481         pr_crit("%s:%d: bad pud %016lx.\n", file, line, val);
482 }
483
484 void __pgd_error(const char *file, int line, unsigned long val)
485 {
486         pr_crit("%s:%d: bad pgd %016lx.\n", file, line, val);
487 }
488
489 /* GENERIC_BUG traps */
490
491 int is_valid_bugaddr(unsigned long addr)
492 {
493         /*
494          * bug_handler() only called for BRK #BUG_BRK_IMM.
495          * So the answer is trivial -- any spurious instances with no
496          * bug table entry will be rejected by report_bug() and passed
497          * back to the debug-monitors code and handled as a fatal
498          * unexpected debug exception.
499          */
500         return 1;
501 }
502
503 static int bug_handler(struct pt_regs *regs, unsigned int esr)
504 {
505         if (user_mode(regs))
506                 return DBG_HOOK_ERROR;
507
508         switch (report_bug(regs->pc, regs)) {
509         case BUG_TRAP_TYPE_BUG:
510                 die("Oops - BUG", regs, 0);
511                 break;
512
513         case BUG_TRAP_TYPE_WARN:
514                 /* Ideally, report_bug() should backtrace for us... but no. */
515                 dump_backtrace(regs, NULL);
516                 break;
517
518         default:
519                 /* unknown/unrecognised bug trap type */
520                 return DBG_HOOK_ERROR;
521         }
522
523         /* If thread survives, skip over the BUG instruction and continue: */
524         regs->pc += AARCH64_INSN_SIZE;  /* skip BRK and resume */
525         return DBG_HOOK_HANDLED;
526 }
527
528 static struct break_hook bug_break_hook = {
529         .esr_val = 0xf2000000 | BUG_BRK_IMM,
530         .esr_mask = 0xffffffff,
531         .fn = bug_handler,
532 };
533
534 /*
535  * Initial handler for AArch64 BRK exceptions
536  * This handler only used until debug_traps_init().
537  */
538 int __init early_brk64(unsigned long addr, unsigned int esr,
539                 struct pt_regs *regs)
540 {
541         return bug_handler(regs, esr) != DBG_HOOK_HANDLED;
542 }
543
544 /* This registration must happen early, before debug_traps_init(). */
545 void __init trap_init(void)
546 {
547         register_break_hook(&bug_break_hook);
548 }