traps.c 5.62 KB
Newer Older
1
2
3
4
5
6
7
/*
 * Copyright (C) 2004-2006 Atmel Corporation
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */
8
9

#include <linux/bug.h>
10
11
#include <linux/init.h>
#include <linux/kallsyms.h>
12
#include <linux/module.h>
13
#include <linux/notifier.h>
14
15
#include <linux/sched.h>
#include <linux/uaccess.h>
16
17
18

#include <asm/addrspace.h>
#include <asm/mmu_context.h>
19
20
21
#include <asm/ocd.h>
#include <asm/sysreg.h>
#include <asm/traps.h>
22
23
24

static DEFINE_SPINLOCK(die_lock);

25
void NORET_TYPE die(const char *str, struct pt_regs *regs, long err)
26
27
28
29
30
31
32
{
	static int die_counter;

	console_verbose();
	spin_lock_irq(&die_lock);
	bust_spinlocks(1);

33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
	printk(KERN_ALERT "Oops: %s, sig: %ld [#%d]\n" KERN_EMERG,
	       str, err, ++die_counter);
#ifdef CONFIG_PREEMPT
	printk("PREEMPT ");
#endif
#ifdef CONFIG_FRAME_POINTER
	printk("FRAME_POINTER ");
#endif
	if (current_cpu_data.features & AVR32_FEATURE_OCD) {
		unsigned long did = __mfdr(DBGREG_DID);
		printk("chip: 0x%03lx:0x%04lx rev %lu\n",
		       (did >> 1) & 0x7ff,
		       (did >> 12) & 0x7fff,
		       (did >> 28) & 0xf);
	} else {
		printk("cpu: arch %u r%u / core %u r%u\n",
		       current_cpu_data.arch_type,
		       current_cpu_data.arch_revision,
		       current_cpu_data.cpu_type,
		       current_cpu_data.cpu_revision);
53
54
	}

55
56
57
	print_modules();
	show_regs_log_lvl(regs, KERN_EMERG);
	show_stack_log_lvl(current, regs->sp, regs, KERN_EMERG);
58
59
	bust_spinlocks(0);
	spin_unlock_irq(&die_lock);
60
61
62
63
64
65
66
67

	if (in_interrupt())
		panic("Fatal exception in interrupt");

	if (panic_on_oops)
		panic("Fatal exception");

	do_exit(err);
68
69
}

70
71
void _exception(long signr, struct pt_regs *regs, int code,
		unsigned long addr)
72
{
73
74
	siginfo_t info;

75
	if (!user_mode(regs))
76
77
78
79
80
81
82
		die("Unhandled exception in kernel mode", regs, signr);

	memset(&info, 0, sizeof(info));
	info.si_signo = signr;
	info.si_code = code;
	info.si_addr = (void __user *)addr;
	force_sig_info(signr, &info, current);
83
84

	/*
85
86
87
88
89
	 * Init gets no signals that it doesn't have a handler for.
	 * That's all very well, but if it has caused a synchronous
	 * exception and we ignore the resulting signal, it will just
	 * generate the same exception over and over again and we get
	 * nowhere.  Better to kill it and let the kernel panic.
90
	 */
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
	if (is_init(current)) {
		__sighandler_t handler;

		spin_lock_irq(&current->sighand->siglock);
		handler = current->sighand->action[signr-1].sa.sa_handler;
		spin_unlock_irq(&current->sighand->siglock);
		if (handler == SIG_DFL) {
			/* init has generated a synchronous exception
			   and it doesn't have a handler for the signal */
			printk(KERN_CRIT "init has generated signal %ld "
			       "but has no handler for it\n", signr);
			do_exit(signr);
		}
	}
}
106

107
108
109
110
111
asmlinkage void do_nmi(unsigned long ecr, struct pt_regs *regs)
{
	printk(KERN_ALERT "Got Non-Maskable Interrupt, dumping regs\n");
	show_regs_log_lvl(regs, KERN_ALERT);
	show_stack_log_lvl(current, regs->sp, regs, KERN_ALERT);
112
113
114
115
}

asmlinkage void do_critical_exception(unsigned long ecr, struct pt_regs *regs)
{
116
	die("Critical exception", regs, SIGKILL);
117
118
119
120
}

asmlinkage void do_address_exception(unsigned long ecr, struct pt_regs *regs)
{
121
	_exception(SIGBUS, regs, BUS_ADRALN, regs->pc);
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
}

/* This way of handling undefined instructions is stolen from ARM */
static LIST_HEAD(undef_hook);
static spinlock_t undef_lock = SPIN_LOCK_UNLOCKED;

void register_undef_hook(struct undef_hook *hook)
{
	spin_lock_irq(&undef_lock);
	list_add(&hook->node, &undef_hook);
	spin_unlock_irq(&undef_lock);
}

void unregister_undef_hook(struct undef_hook *hook)
{
	spin_lock_irq(&undef_lock);
	list_del(&hook->node);
	spin_unlock_irq(&undef_lock);
}

static int do_cop_absent(u32 insn)
{
	int cop_nr;
	u32 cpucr;
146
147

	if ((insn & 0xfdf00000) == 0xf1900000)
148
149
150
151
152
153
154
155
156
157
158
		/* LDC0 */
		cop_nr = 0;
	else
		cop_nr = (insn >> 13) & 0x7;

	/* Try enabling the coprocessor */
	cpucr = sysreg_read(CPUCR);
	cpucr |= (1 << (24 + cop_nr));
	sysreg_write(CPUCR, cpucr);

	cpucr = sysreg_read(CPUCR);
159
160
	if (!(cpucr & (1 << (24 + cop_nr))))
		return -ENODEV;
161
162
163
164

	return 0;
}

165
int is_valid_bugaddr(unsigned long pc)
166
{
167
168
169
170
171
172
	unsigned short opcode;

	if (pc < PAGE_OFFSET)
		return 0;
	if (probe_kernel_address((u16 *)pc, opcode))
		return 0;
173

174
	return opcode == AVR32_BUG_OPCODE;
175
176
177
178
179
180
181
}

asmlinkage void do_illegal_opcode(unsigned long ecr, struct pt_regs *regs)
{
	u32 insn;
	struct undef_hook *hook;
	void __user *pc;
182
	long code;
183

184
185
186
187
188
189
190
191
192
193
194
195
196
197
	if (!user_mode(regs) && (ecr == ECR_ILLEGAL_OPCODE)) {
		enum bug_trap_type type;

		type = report_bug(regs->pc);
		switch (type) {
		case BUG_TRAP_TYPE_NONE:
			break;
		case BUG_TRAP_TYPE_WARN:
			regs->pc += 2;
			return;
		case BUG_TRAP_TYPE_BUG:
			die("Kernel BUG", regs, SIGKILL);
		}
	}
198
199
200

	local_irq_enable();

201
202
203
204
	if (user_mode(regs)) {
		pc = (void __user *)instruction_pointer(regs);
		if (get_user(insn, (u32 __user *)pc))
			goto invalid_area;
205

206
		if (ecr == ECR_COPROC_ABSENT && !do_cop_absent(insn))
207
208
			return;

209
210
211
212
213
214
215
		spin_lock_irq(&undef_lock);
		list_for_each_entry(hook, &undef_hook, node) {
			if ((insn & hook->insn_mask) == hook->insn_val) {
				if (hook->fn(regs, insn) == 0) {
					spin_unlock_irq(&undef_lock);
					return;
				}
216
217
			}
		}
218
		spin_unlock_irq(&undef_lock);
219
220
221
222
	}

	switch (ecr) {
	case ECR_PRIVILEGE_VIOLATION:
223
		code = ILL_PRVOPC;
224
225
		break;
	case ECR_COPROC_ABSENT:
226
		code = ILL_COPROC;
227
228
		break;
	default:
229
230
		code = ILL_ILLOPC;
		break;
231
232
	}

233
	_exception(SIGILL, regs, code, regs->pc);
234
235
	return;

236
237
invalid_area:
	_exception(SIGSEGV, regs, SEGV_MAPERR, regs->pc);
238
239
240
241
}

asmlinkage void do_fpe(unsigned long ecr, struct pt_regs *regs)
{
242
243
	/* We have no FPU yet */
	_exception(SIGILL, regs, ILL_COPROC, regs->pc);
244
245
246
247
248
249
250
}


void __init trap_init(void)
{

}