[AVR32] NMI debugging
[linux-2.6.git] / arch / avr32 / kernel / traps.c
1 /*
2  * Copyright (C) 2004-2006 Atmel Corporation
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  */
8
9 #include <linux/bug.h>
10 #include <linux/init.h>
11 #include <linux/kallsyms.h>
12 #include <linux/kdebug.h>
13 #include <linux/module.h>
14 #include <linux/notifier.h>
15 #include <linux/sched.h>
16 #include <linux/uaccess.h>
17
18 #include <asm/addrspace.h>
19 #include <asm/mmu_context.h>
20 #include <asm/ocd.h>
21 #include <asm/sysreg.h>
22 #include <asm/traps.h>
23
24 static DEFINE_SPINLOCK(die_lock);
25
26 void NORET_TYPE die(const char *str, struct pt_regs *regs, long err)
27 {
28         static int die_counter;
29
30         console_verbose();
31         spin_lock_irq(&die_lock);
32         bust_spinlocks(1);
33
34         printk(KERN_ALERT "Oops: %s, sig: %ld [#%d]\n" KERN_EMERG,
35                str, err, ++die_counter);
36 #ifdef CONFIG_PREEMPT
37         printk("PREEMPT ");
38 #endif
39 #ifdef CONFIG_FRAME_POINTER
40         printk("FRAME_POINTER ");
41 #endif
42         if (current_cpu_data.features & AVR32_FEATURE_OCD) {
43                 unsigned long did = ocd_read(DID);
44                 printk("chip: 0x%03lx:0x%04lx rev %lu\n",
45                        (did >> 1) & 0x7ff,
46                        (did >> 12) & 0x7fff,
47                        (did >> 28) & 0xf);
48         } else {
49                 printk("cpu: arch %u r%u / core %u r%u\n",
50                        current_cpu_data.arch_type,
51                        current_cpu_data.arch_revision,
52                        current_cpu_data.cpu_type,
53                        current_cpu_data.cpu_revision);
54         }
55
56         print_modules();
57         show_regs_log_lvl(regs, KERN_EMERG);
58         show_stack_log_lvl(current, regs->sp, regs, KERN_EMERG);
59         bust_spinlocks(0);
60         add_taint(TAINT_DIE);
61         spin_unlock_irq(&die_lock);
62
63         if (in_interrupt())
64                 panic("Fatal exception in interrupt");
65
66         if (panic_on_oops)
67                 panic("Fatal exception");
68
69         do_exit(err);
70 }
71
72 void _exception(long signr, struct pt_regs *regs, int code,
73                 unsigned long addr)
74 {
75         siginfo_t info;
76
77         if (!user_mode(regs))
78                 die("Unhandled exception in kernel mode", regs, signr);
79
80         memset(&info, 0, sizeof(info));
81         info.si_signo = signr;
82         info.si_code = code;
83         info.si_addr = (void __user *)addr;
84         force_sig_info(signr, &info, current);
85
86         /*
87          * Init gets no signals that it doesn't have a handler for.
88          * That's all very well, but if it has caused a synchronous
89          * exception and we ignore the resulting signal, it will just
90          * generate the same exception over and over again and we get
91          * nowhere.  Better to kill it and let the kernel panic.
92          */
93         if (is_global_init(current)) {
94                 __sighandler_t handler;
95
96                 spin_lock_irq(&current->sighand->siglock);
97                 handler = current->sighand->action[signr-1].sa.sa_handler;
98                 spin_unlock_irq(&current->sighand->siglock);
99                 if (handler == SIG_DFL) {
100                         /* init has generated a synchronous exception
101                            and it doesn't have a handler for the signal */
102                         printk(KERN_CRIT "init has generated signal %ld "
103                                "but has no handler for it\n", signr);
104                         do_exit(signr);
105                 }
106         }
107 }
108
109 asmlinkage void do_nmi(unsigned long ecr, struct pt_regs *regs)
110 {
111         int ret;
112
113         nmi_enter();
114
115         ret = notify_die(DIE_NMI, "NMI", regs, 0, ecr, SIGINT);
116         switch (ret) {
117         case NOTIFY_OK:
118         case NOTIFY_STOP:
119                 return;
120         case NOTIFY_BAD:
121                 die("Fatal Non-Maskable Interrupt", regs, SIGINT);
122         default:
123                 break;
124         }
125
126         printk(KERN_ALERT "Got NMI, but nobody cared. Disabling...\n");
127         nmi_disable();
128 }
129
130 asmlinkage void do_critical_exception(unsigned long ecr, struct pt_regs *regs)
131 {
132         die("Critical exception", regs, SIGKILL);
133 }
134
135 asmlinkage void do_address_exception(unsigned long ecr, struct pt_regs *regs)
136 {
137         _exception(SIGBUS, regs, BUS_ADRALN, regs->pc);
138 }
139
140 /* This way of handling undefined instructions is stolen from ARM */
141 static LIST_HEAD(undef_hook);
142 static DEFINE_SPINLOCK(undef_lock);
143
144 void register_undef_hook(struct undef_hook *hook)
145 {
146         spin_lock_irq(&undef_lock);
147         list_add(&hook->node, &undef_hook);
148         spin_unlock_irq(&undef_lock);
149 }
150
151 void unregister_undef_hook(struct undef_hook *hook)
152 {
153         spin_lock_irq(&undef_lock);
154         list_del(&hook->node);
155         spin_unlock_irq(&undef_lock);
156 }
157
158 static int do_cop_absent(u32 insn)
159 {
160         int cop_nr;
161         u32 cpucr;
162
163         if ((insn & 0xfdf00000) == 0xf1900000)
164                 /* LDC0 */
165                 cop_nr = 0;
166         else
167                 cop_nr = (insn >> 13) & 0x7;
168
169         /* Try enabling the coprocessor */
170         cpucr = sysreg_read(CPUCR);
171         cpucr |= (1 << (24 + cop_nr));
172         sysreg_write(CPUCR, cpucr);
173
174         cpucr = sysreg_read(CPUCR);
175         if (!(cpucr & (1 << (24 + cop_nr))))
176                 return -ENODEV;
177
178         return 0;
179 }
180
181 int is_valid_bugaddr(unsigned long pc)
182 {
183         unsigned short opcode;
184
185         if (pc < PAGE_OFFSET)
186                 return 0;
187         if (probe_kernel_address((u16 *)pc, opcode))
188                 return 0;
189
190         return opcode == AVR32_BUG_OPCODE;
191 }
192
193 asmlinkage void do_illegal_opcode(unsigned long ecr, struct pt_regs *regs)
194 {
195         u32 insn;
196         struct undef_hook *hook;
197         void __user *pc;
198         long code;
199
200         if (!user_mode(regs) && (ecr == ECR_ILLEGAL_OPCODE)) {
201                 enum bug_trap_type type;
202
203                 type = report_bug(regs->pc, regs);
204                 switch (type) {
205                 case BUG_TRAP_TYPE_NONE:
206                         break;
207                 case BUG_TRAP_TYPE_WARN:
208                         regs->pc += 2;
209                         return;
210                 case BUG_TRAP_TYPE_BUG:
211                         die("Kernel BUG", regs, SIGKILL);
212                 }
213         }
214
215         local_irq_enable();
216
217         if (user_mode(regs)) {
218                 pc = (void __user *)instruction_pointer(regs);
219                 if (get_user(insn, (u32 __user *)pc))
220                         goto invalid_area;
221
222                 if (ecr == ECR_COPROC_ABSENT && !do_cop_absent(insn))
223                         return;
224
225                 spin_lock_irq(&undef_lock);
226                 list_for_each_entry(hook, &undef_hook, node) {
227                         if ((insn & hook->insn_mask) == hook->insn_val) {
228                                 if (hook->fn(regs, insn) == 0) {
229                                         spin_unlock_irq(&undef_lock);
230                                         return;
231                                 }
232                         }
233                 }
234                 spin_unlock_irq(&undef_lock);
235         }
236
237         switch (ecr) {
238         case ECR_PRIVILEGE_VIOLATION:
239                 code = ILL_PRVOPC;
240                 break;
241         case ECR_COPROC_ABSENT:
242                 code = ILL_COPROC;
243                 break;
244         default:
245                 code = ILL_ILLOPC;
246                 break;
247         }
248
249         _exception(SIGILL, regs, code, regs->pc);
250         return;
251
252 invalid_area:
253         _exception(SIGSEGV, regs, SEGV_MAPERR, regs->pc);
254 }
255
256 asmlinkage void do_fpe(unsigned long ecr, struct pt_regs *regs)
257 {
258         /* We have no FPU yet */
259         _exception(SIGILL, regs, ILL_COPROC, regs->pc);
260 }
261
262
263 void __init trap_init(void)
264 {
265
266 }