2 * Hardware exception handling
4 * Copyright (C) 2010 Tobias Klauser <tklauser@distanz.ch>
5 * Copyright (C) 2004 Microtronix Datacom Ltd.
6 * Copyright (C) 2001 Vic Phillips
8 * This file is subject to the terms and conditions of the GNU General
9 * Public License. See the file COPYING in the main directory of this
10 * archive for more details.
13 #include <linux/sched.h>
14 #include <linux/kernel.h>
15 #include <linux/signal.h>
16 #include <linux/export.h>
18 #include <linux/ptrace.h>
20 #include <asm/traps.h>
21 #include <asm/sections.h>
22 #include <asm/uaccess.h>
24 static DEFINE_SPINLOCK(die_lock
);
26 static void _send_sig(int signo
, int code
, unsigned long addr
)
30 info
.si_signo
= signo
;
33 info
.si_addr
= (void __user
*) addr
;
34 force_sig_info(signo
, &info
, current
);
37 void die(const char *str
, struct pt_regs
*regs
, long err
)
40 spin_lock_irq(&die_lock
);
41 pr_warn("Oops: %s, sig: %ld\n", str
, err
);
43 spin_unlock_irq(&die_lock
);
45 * do_exit() should take care of panic'ing from an interrupt
46 * context so we don't handle it here
51 void _exception(int signo
, struct pt_regs
*regs
, int code
, unsigned long addr
)
54 die("Exception in kernel mode", regs
, signo
);
56 _send_sig(signo
, code
, addr
);
60 * The show_stack is an external API which we do not use ourselves.
63 int kstack_depth_to_print
= 48;
65 void show_stack(struct task_struct
*task
, unsigned long *stack
)
67 unsigned long *endstack
, addr
;
72 stack
= (unsigned long *)task
->thread
.ksp
;
74 stack
= (unsigned long *)&stack
;
77 addr
= (unsigned long) stack
;
78 endstack
= (unsigned long *) PAGE_ALIGN(addr
);
80 pr_emerg("Stack from %08lx:", (unsigned long)stack
);
81 for (i
= 0; i
< kstack_depth_to_print
; i
++) {
82 if (stack
+ 1 > endstack
)
86 pr_emerg(" %08lx", *stack
++);
89 pr_emerg("\nCall Trace:");
91 while (stack
+ 1 <= endstack
) {
94 * If the address is either in the text segment of the
95 * kernel, or in the region which contains vmalloc'ed
96 * memory, it *may* be the address of a calling
97 * routine; if so, print it so that someone tracing
98 * down the cause of the crash will be able to figure
99 * out the call path that was taken.
101 if (((addr
>= (unsigned long) _stext
) &&
102 (addr
<= (unsigned long) _etext
))) {
105 pr_emerg(" [<%08lx>]", addr
);
112 void __init
trap_init(void)
114 /* Nothing to do here */
117 /* Breakpoint handler */
118 asmlinkage
void breakpoint_c(struct pt_regs
*fp
)
121 * The breakpoint entry code has moved the PC on by 4 bytes, so we must
122 * move it back. This could be done on the host but we do it here
123 * because monitor.S of JTAG gdbserver does it too.
126 _exception(SIGTRAP
, fp
, TRAP_BRKPT
, fp
->ea
);
129 #ifndef CONFIG_NIOS2_ALIGNMENT_TRAP
130 /* Alignment exception handler */
131 asmlinkage
void handle_unaligned_c(struct pt_regs
*fp
, int cause
)
133 unsigned long addr
= RDCTL(CTL_BADADDR
);
138 if (fixup_exception(fp
))
141 if (!user_mode(fp
)) {
142 pr_alert("Unaligned access from kernel mode, this might be a hardware\n");
143 pr_alert("problem, dump registers and restart the instruction\n");
144 pr_alert(" BADADDR 0x%08lx\n", addr
);
145 pr_alert(" cause %d\n", cause
);
146 pr_alert(" op-code 0x%08lx\n", *(unsigned long *)(fp
->ea
));
151 _exception(SIGBUS
, fp
, BUS_ADRALN
, addr
);
153 #endif /* CONFIG_NIOS2_ALIGNMENT_TRAP */
155 /* Illegal instruction handler */
156 asmlinkage
void handle_illegal_c(struct pt_regs
*fp
)
159 _exception(SIGILL
, fp
, ILL_ILLOPC
, fp
->ea
);
162 /* Supervisor instruction handler */
163 asmlinkage
void handle_supervisor_instr(struct pt_regs
*fp
)
166 _exception(SIGILL
, fp
, ILL_PRVOPC
, fp
->ea
);
169 /* Division error handler */
170 asmlinkage
void handle_diverror_c(struct pt_regs
*fp
)
173 _exception(SIGFPE
, fp
, FPE_INTDIV
, fp
->ea
);
176 /* Unhandled exception handler */
177 asmlinkage
void unhandled_exception(struct pt_regs
*regs
, int cause
)
179 unsigned long addr
= RDCTL(CTL_BADADDR
);
183 pr_emerg("Unhandled exception #%d in %s mode (badaddr=0x%08lx)\n",
184 cause
, user_mode(regs
) ? "user" : "kernel", addr
);
189 pr_emerg("opcode: 0x%08lx\n", *(unsigned long *)(regs
->ea
));
192 asmlinkage
void handle_trap_1_c(struct pt_regs
*fp
)
194 _send_sig(SIGUSR1
, 0, fp
->ea
);
197 asmlinkage
void handle_trap_2_c(struct pt_regs
*fp
)
199 _send_sig(SIGUSR2
, 0, fp
->ea
);
202 asmlinkage
void handle_trap_3_c(struct pt_regs
*fp
)
204 _send_sig(SIGILL
, ILL_ILLTRP
, fp
->ea
);