blob: 66fad23012216e86cb2f91bdfff053f0e080f208 [file] [log] [blame]
Michal Simekc4df4bc2009-03-27 14:25:13 +01001/*
2 * HW exception handling
3 *
4 * Copyright (C) 2008-2009 Michal Simek <monstr@monstr.eu>
5 * Copyright (C) 2008 PetaLogix
6 *
7 * This file is subject to the terms and conditions of the GNU General
8 * Public License. See the file COPYING in the main directory of this
9 * archive for more details.
10 */
11
12/*
13 * This file handles the architecture-dependent parts of hardware exceptions
14 */
15
16#include <linux/kernel.h>
17#include <linux/signal.h>
18#include <linux/sched.h>
19#include <linux/kallsyms.h>
20#include <linux/module.h>
21
22#include <asm/exceptions.h>
23#include <asm/entry.h> /* For KM CPU var */
Michal Simek4bb73c32009-05-26 16:30:24 +020024#include <linux/uaccess.h>
25#include <linux/errno.h>
26#include <linux/ptrace.h>
Michal Simekc4df4bc2009-03-27 14:25:13 +010027#include <asm/current.h>
Michal Simek17b93142010-11-12 14:27:10 +010028#include <asm/cacheflush.h>
Michal Simekc4df4bc2009-03-27 14:25:13 +010029
30#define MICROBLAZE_ILL_OPCODE_EXCEPTION 0x02
31#define MICROBLAZE_IBUS_EXCEPTION 0x03
32#define MICROBLAZE_DBUS_EXCEPTION 0x04
33#define MICROBLAZE_DIV_ZERO_EXCEPTION 0x05
34#define MICROBLAZE_FPU_EXCEPTION 0x06
Michal Simek4bb73c32009-05-26 16:30:24 +020035#define MICROBLAZE_PRIVILEGED_EXCEPTION 0x07
Michal Simekc4df4bc2009-03-27 14:25:13 +010036
37static DEFINE_SPINLOCK(die_lock);
38
39void die(const char *str, struct pt_regs *fp, long err)
40{
41 console_verbose();
42 spin_lock_irq(&die_lock);
43 printk(KERN_WARNING "Oops: %s, sig: %ld\n", str, err);
44 show_regs(fp);
45 spin_unlock_irq(&die_lock);
46 /* do_exit() should take care of panic'ing from an interrupt
47 * context so we don't handle it here
48 */
49 do_exit(err);
50}
51
Michal Simek751f1602010-08-03 11:26:51 +020052/* for user application debugging */
Michal Simekf6999802011-02-07 11:36:25 +010053asmlinkage void sw_exception(struct pt_regs *regs)
Michal Simek751f1602010-08-03 11:26:51 +020054{
55 _exception(SIGTRAP, regs, TRAP_BRKPT, regs->r16);
Michal Simek17b93142010-11-12 14:27:10 +010056 flush_dcache_range(regs->r16, regs->r16 + 0x4);
57 flush_icache_range(regs->r16, regs->r16 + 0x4);
Michal Simek751f1602010-08-03 11:26:51 +020058}
59
Michal Simekc4df4bc2009-03-27 14:25:13 +010060void _exception(int signr, struct pt_regs *regs, int code, unsigned long addr)
61{
62 siginfo_t info;
63
64 if (kernel_mode(regs)) {
Michal Simekc4df4bc2009-03-27 14:25:13 +010065 die("Exception in kernel mode", regs, signr);
66 }
67 info.si_signo = signr;
68 info.si_errno = 0;
69 info.si_code = code;
70 info.si_addr = (void __user *) addr;
71 force_sig_info(signr, &info, current);
72}
73
74asmlinkage void full_exception(struct pt_regs *regs, unsigned int type,
75 int fsr, int addr)
76{
Michal Simek4bb73c32009-05-26 16:30:24 +020077#ifdef CONFIG_MMU
Michal Simek4bb73c32009-05-26 16:30:24 +020078 addr = regs->pc;
79#endif
80
Michal Simekc4df4bc2009-03-27 14:25:13 +010081#if 0
Michal Simekbfc32ad2009-09-15 09:49:53 +020082 printk(KERN_WARNING "Exception %02x in %s mode, FSR=%08x PC=%08x " \
83 "ESR=%08x\n",
Michal Simekc4df4bc2009-03-27 14:25:13 +010084 type, user_mode(regs) ? "user" : "kernel", fsr,
85 (unsigned int) regs->pc, (unsigned int) regs->esr);
86#endif
87
88 switch (type & 0x1F) {
89 case MICROBLAZE_ILL_OPCODE_EXCEPTION:
Michal Simek4bb73c32009-05-26 16:30:24 +020090 if (user_mode(regs)) {
Joe Perchesc4554c32010-09-11 22:10:51 -070091 pr_debug("Illegal opcode exception in user mode\n");
Michal Simek4bb73c32009-05-26 16:30:24 +020092 _exception(SIGILL, regs, ILL_ILLOPC, addr);
93 return;
94 }
Michal Simekbfc32ad2009-09-15 09:49:53 +020095 printk(KERN_WARNING "Illegal opcode exception " \
96 "in kernel mode.\n");
Michal Simek4bb73c32009-05-26 16:30:24 +020097 die("opcode exception", regs, SIGBUS);
Michal Simekc4df4bc2009-03-27 14:25:13 +010098 break;
99 case MICROBLAZE_IBUS_EXCEPTION:
100 if (user_mode(regs)) {
Joe Perchesc4554c32010-09-11 22:10:51 -0700101 pr_debug("Instruction bus error exception in user mode\n");
Michal Simekc4df4bc2009-03-27 14:25:13 +0100102 _exception(SIGBUS, regs, BUS_ADRERR, addr);
103 return;
104 }
Michal Simekbfc32ad2009-09-15 09:49:53 +0200105 printk(KERN_WARNING "Instruction bus error exception " \
106 "in kernel mode.\n");
Michal Simekc4df4bc2009-03-27 14:25:13 +0100107 die("bus exception", regs, SIGBUS);
108 break;
109 case MICROBLAZE_DBUS_EXCEPTION:
110 if (user_mode(regs)) {
Joe Perchesc4554c32010-09-11 22:10:51 -0700111 pr_debug("Data bus error exception in user mode\n");
Michal Simekc4df4bc2009-03-27 14:25:13 +0100112 _exception(SIGBUS, regs, BUS_ADRERR, addr);
113 return;
114 }
Michal Simekbfc32ad2009-09-15 09:49:53 +0200115 printk(KERN_WARNING "Data bus error exception " \
116 "in kernel mode.\n");
Michal Simekc4df4bc2009-03-27 14:25:13 +0100117 die("bus exception", regs, SIGBUS);
118 break;
119 case MICROBLAZE_DIV_ZERO_EXCEPTION:
Michal Simek4bb73c32009-05-26 16:30:24 +0200120 if (user_mode(regs)) {
Joe Perchesc4554c32010-09-11 22:10:51 -0700121 pr_debug("Divide by zero exception in user mode\n");
Michal Simek23902d92009-09-22 08:58:47 +0200122 _exception(SIGILL, regs, FPE_INTDIV, addr);
Michal Simek4bb73c32009-05-26 16:30:24 +0200123 return;
124 }
Michal Simekbfc32ad2009-09-15 09:49:53 +0200125 printk(KERN_WARNING "Divide by zero exception " \
126 "in kernel mode.\n");
Randy Dunlapf3ff8212010-04-21 14:11:34 -0700127 die("Divide by zero exception", regs, SIGBUS);
Michal Simekc4df4bc2009-03-27 14:25:13 +0100128 break;
Michal Simekc4df4bc2009-03-27 14:25:13 +0100129 case MICROBLAZE_FPU_EXCEPTION:
Joe Perchesc4554c32010-09-11 22:10:51 -0700130 pr_debug("FPU exception\n");
Michal Simekc4df4bc2009-03-27 14:25:13 +0100131 /* IEEE FP exception */
132 /* I removed fsr variable and use code var for storing fsr */
133 if (fsr & FSR_IO)
134 fsr = FPE_FLTINV;
135 else if (fsr & FSR_OF)
136 fsr = FPE_FLTOVF;
137 else if (fsr & FSR_UF)
138 fsr = FPE_FLTUND;
139 else if (fsr & FSR_DZ)
140 fsr = FPE_FLTDIV;
141 else if (fsr & FSR_DO)
142 fsr = FPE_FLTRES;
143 _exception(SIGFPE, regs, fsr, addr);
144 break;
145
Michal Simek4bb73c32009-05-26 16:30:24 +0200146#ifdef CONFIG_MMU
147 case MICROBLAZE_PRIVILEGED_EXCEPTION:
Joe Perchesc4554c32010-09-11 22:10:51 -0700148 pr_debug("Privileged exception\n");
Michal Simek04256092010-08-03 11:32:20 +0200149 _exception(SIGILL, regs, ILL_PRVOPC, addr);
Michal Simek4bb73c32009-05-26 16:30:24 +0200150 break;
151#endif
Michal Simekc4df4bc2009-03-27 14:25:13 +0100152 default:
Michal Simek4bb73c32009-05-26 16:30:24 +0200153 /* FIXME what to do in unexpected exception */
Michal Simekc4df4bc2009-03-27 14:25:13 +0100154 printk(KERN_WARNING "Unexpected exception %02x "
155 "PC=%08x in %s mode\n", type, (unsigned int) addr,
156 kernel_mode(regs) ? "kernel" : "user");
157 }
158 return;
159}