traps.c 20.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/*
 *  arch/s390/kernel/traps.c
 *
 *  S390 version
 *    Copyright (C) 1999,2000 IBM Deutschland Entwicklung GmbH, IBM Corporation
 *    Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
 *               Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
 *
 *  Derived from "arch/i386/kernel/traps.c"
 *    Copyright (C) 1991, 1992 Linus Torvalds
 */

/*
 * 'Traps.c' handles hardware traps and faults after we have saved some
 * state in 'asm.s'.
 */
#include <linux/sched.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/errno.h>
21
#include <linux/tracehook.h>
L
Linus Torvalds 已提交
22 23 24 25 26
#include <linux/timer.h>
#include <linux/mm.h>
#include <linux/smp.h>
#include <linux/init.h>
#include <linux/interrupt.h>
27
#include <linux/seq_file.h>
L
Linus Torvalds 已提交
28 29
#include <linux/delay.h>
#include <linux/module.h>
30
#include <linux/kdebug.h>
L
Linus Torvalds 已提交
31
#include <linux/kallsyms.h>
32
#include <linux/reboot.h>
M
Michael Grundy 已提交
33
#include <linux/kprobes.h>
H
Heiko Carstens 已提交
34
#include <linux/bug.h>
35
#include <linux/utsname.h>
L
Linus Torvalds 已提交
36 37 38 39 40 41 42 43
#include <asm/system.h>
#include <asm/uaccess.h>
#include <asm/io.h>
#include <asm/atomic.h>
#include <asm/mathemu.h>
#include <asm/cpcmd.h>
#include <asm/lowcore.h>
#include <asm/debug.h>
44
#include "entry.h"
L
Linus Torvalds 已提交
45 46 47

pgm_check_handler_t *pgm_check_table[128];

48
int show_unhandled_signals;
L
Linus Torvalds 已提交
49 50 51

extern pgm_check_handler_t do_protection_exception;
extern pgm_check_handler_t do_dat_exception;
M
Martin Schwidefsky 已提交
52
extern pgm_check_handler_t do_asce_exception;
L
Linus Torvalds 已提交
53 54 55

#define stack_pointer ({ void **sp; asm("la %0,0(15)" : "=&d" (sp)); sp; })

56
#ifndef CONFIG_64BIT
57
#define LONG "%08lx "
L
Linus Torvalds 已提交
58 59
#define FOURLONG "%08lx %08lx %08lx %08lx\n"
static int kstack_depth_to_print = 12;
60
#else /* CONFIG_64BIT */
61
#define LONG "%016lx "
L
Linus Torvalds 已提交
62 63
#define FOURLONG "%016lx %016lx %016lx %016lx\n"
static int kstack_depth_to_print = 20;
64
#endif /* CONFIG_64BIT */
L
Linus Torvalds 已提交
65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110

/*
 * For show_trace we have tree different stack to consider:
 *   - the panic stack which is used if the kernel stack has overflown
 *   - the asynchronous interrupt stack (cpu related)
 *   - the synchronous kernel stack (process related)
 * The stack trace can start at any of the three stack and can potentially
 * touch all of them. The order is: panic stack, async stack, sync stack.
 */
static unsigned long
__show_trace(unsigned long sp, unsigned long low, unsigned long high)
{
	struct stack_frame *sf;
	struct pt_regs *regs;

	while (1) {
		sp = sp & PSW_ADDR_INSN;
		if (sp < low || sp > high - sizeof(*sf))
			return sp;
		sf = (struct stack_frame *) sp;
		printk("([<%016lx>] ", sf->gprs[8] & PSW_ADDR_INSN);
		print_symbol("%s)\n", sf->gprs[8] & PSW_ADDR_INSN);
		/* Follow the backchain. */
		while (1) {
			low = sp;
			sp = sf->back_chain & PSW_ADDR_INSN;
			if (!sp)
				break;
			if (sp <= low || sp > high - sizeof(*sf))
				return sp;
			sf = (struct stack_frame *) sp;
			printk(" [<%016lx>] ", sf->gprs[8] & PSW_ADDR_INSN);
			print_symbol("%s\n", sf->gprs[8] & PSW_ADDR_INSN);
		}
		/* Zero backchain detected, check for interrupt frame. */
		sp = (unsigned long) (sf + 1);
		if (sp <= low || sp > high - sizeof(*regs))
			return sp;
		regs = (struct pt_regs *) sp;
		printk(" [<%016lx>] ", regs->psw.addr & PSW_ADDR_INSN);
		print_symbol("%s\n", regs->psw.addr & PSW_ADDR_INSN);
		low = sp;
		sp = regs->gprs[15];
	}
}

111
static void show_trace(struct task_struct *task, unsigned long *stack)
L
Linus Torvalds 已提交
112 113 114 115 116 117 118 119 120 121 122 123 124 125 126
{
	register unsigned long __r15 asm ("15");
	unsigned long sp;

	sp = (unsigned long) stack;
	if (!sp)
		sp = task ? task->thread.ksp : __r15;
	printk("Call Trace:\n");
#ifdef CONFIG_CHECK_STACK
	sp = __show_trace(sp, S390_lowcore.panic_stack - 4096,
			  S390_lowcore.panic_stack);
#endif
	sp = __show_trace(sp, S390_lowcore.async_stack - ASYNC_SIZE,
			  S390_lowcore.async_stack);
	if (task)
A
Al Viro 已提交
127 128
		__show_trace(sp, (unsigned long) task_stack_page(task),
			     (unsigned long) task_stack_page(task) + THREAD_SIZE);
L
Linus Torvalds 已提交
129 130 131
	else
		__show_trace(sp, S390_lowcore.thread_info,
			     S390_lowcore.thread_info + THREAD_SIZE);
132 133 134
	if (!task)
		task = current;
	debug_show_held_locks(task);
L
Linus Torvalds 已提交
135 136 137 138 139 140 141 142 143
}

void show_stack(struct task_struct *task, unsigned long *sp)
{
	register unsigned long * __r15 asm ("15");
	unsigned long *stack;
	int i;

	if (!sp)
H
Heiko Carstens 已提交
144 145 146
		stack = task ? (unsigned long *) task->thread.ksp : __r15;
	else
		stack = sp;
L
Linus Torvalds 已提交
147 148 149 150 151 152

	for (i = 0; i < kstack_depth_to_print; i++) {
		if (((addr_t) stack & (THREAD_SIZE-1)) == 0)
			break;
		if (i && ((i * sizeof (long) % 32) == 0))
			printk("\n       ");
153
		printk(LONG, *stack++);
L
Linus Torvalds 已提交
154 155 156 157 158
	}
	printk("\n");
	show_trace(task, sp);
}

159
static void show_last_breaking_event(struct pt_regs *regs)
160
{
161
#ifdef CONFIG_64BIT
162 163 164 165
	printk("Last Breaking-Event-Address:\n");
	printk(" [<%016lx>] ", regs->args[0] & PSW_ADDR_INSN);
	print_symbol("%s\n", regs->args[0] & PSW_ADDR_INSN);
#endif
166
}
167

L
Linus Torvalds 已提交
168 169 170 171 172
/*
 * The architecture-independent dump_stack generator
 */
void dump_stack(void)
{
173 174 175 176 177 178 179 180
	printk("CPU: %d %s %s %.*s\n",
	       task_thread_info(current)->cpu, print_tainted(),
	       init_utsname()->release,
	       (int)strcspn(init_utsname()->version, " "),
	       init_utsname()->version);
	printk("Process %s (pid: %d, task: %p, ksp: %p)\n",
	       current->comm, current->pid, current,
	       (void *) current->thread.ksp);
H
Heiko Carstens 已提交
181
	show_stack(NULL, NULL);
L
Linus Torvalds 已提交
182 183 184
}
EXPORT_SYMBOL(dump_stack);

185 186 187 188 189
static inline int mask_bits(struct pt_regs *regs, unsigned long bits)
{
	return (regs->psw.mask & bits) / ((~bits + 1) & bits);
}

L
Linus Torvalds 已提交
190 191 192 193 194 195 196 197 198
void show_registers(struct pt_regs *regs)
{
	char *mode;

	mode = (regs->psw.mask & PSW_MASK_PSTATE) ? "User" : "Krnl";
	printk("%s PSW : %p %p",
	       mode, (void *) regs->psw.mask,
	       (void *) regs->psw.addr);
	print_symbol(" (%s)\n", regs->psw.addr & PSW_ADDR_INSN);
199 200 201 202 203 204 205 206 207 208 209
	printk("           R:%x T:%x IO:%x EX:%x Key:%x M:%x W:%x "
	       "P:%x AS:%x CC:%x PM:%x", mask_bits(regs, PSW_MASK_PER),
	       mask_bits(regs, PSW_MASK_DAT), mask_bits(regs, PSW_MASK_IO),
	       mask_bits(regs, PSW_MASK_EXT), mask_bits(regs, PSW_MASK_KEY),
	       mask_bits(regs, PSW_MASK_MCHECK), mask_bits(regs, PSW_MASK_WAIT),
	       mask_bits(regs, PSW_MASK_PSTATE), mask_bits(regs, PSW_MASK_ASC),
	       mask_bits(regs, PSW_MASK_CC), mask_bits(regs, PSW_MASK_PM));
#ifdef CONFIG_64BIT
	printk(" EA:%x", mask_bits(regs, PSW_BASE_BITS));
#endif
	printk("\n%s GPRS: " FOURLONG, mode,
L
Linus Torvalds 已提交
210 211 212 213 214 215 216 217
	       regs->gprs[0], regs->gprs[1], regs->gprs[2], regs->gprs[3]);
	printk("           " FOURLONG,
	       regs->gprs[4], regs->gprs[5], regs->gprs[6], regs->gprs[7]);
	printk("           " FOURLONG,
	       regs->gprs[8], regs->gprs[9], regs->gprs[10], regs->gprs[11]);
	printk("           " FOURLONG,
	       regs->gprs[12], regs->gprs[13], regs->gprs[14], regs->gprs[15]);

218
	show_code(regs);
L
Linus Torvalds 已提交
219 220
}	

221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
void show_regs(struct pt_regs *regs)
{
	print_modules();
	printk("CPU: %d %s %s %.*s\n",
	       task_thread_info(current)->cpu, print_tainted(),
	       init_utsname()->release,
	       (int)strcspn(init_utsname()->version, " "),
	       init_utsname()->version);
	printk("Process %s (pid: %d, task: %p, ksp: %p)\n",
	       current->comm, current->pid, current,
	       (void *) current->thread.ksp);
	show_registers(regs);
	/* Show stack backtrace if pt_regs is from kernel mode */
	if (!(regs->psw.mask & PSW_MASK_PSTATE))
		show_trace(NULL, (unsigned long *) regs->gprs[15]);
	show_last_breaking_event(regs);
}

239
static DEFINE_SPINLOCK(die_lock);
L
Linus Torvalds 已提交
240 241 242 243 244

void die(const char * str, struct pt_regs * regs, long err)
{
	static int die_counter;

245
	oops_enter();
L
Linus Torvalds 已提交
246 247 248 249
	debug_stop_all();
	console_verbose();
	spin_lock_irq(&die_lock);
	bust_spinlocks(1);
250 251 252 253 254
	printk("%s: %04lx [#%d] ", str, err & 0xffff, ++die_counter);
#ifdef CONFIG_PREEMPT
	printk("PREEMPT ");
#endif
#ifdef CONFIG_SMP
255 256 257 258
	printk("SMP ");
#endif
#ifdef CONFIG_DEBUG_PAGEALLOC
	printk("DEBUG_PAGEALLOC");
259 260
#endif
	printk("\n");
261
	notify_die(DIE_OOPS, str, regs, err, current->thread.trap_no, SIGSEGV);
262
	show_regs(regs);
L
Linus Torvalds 已提交
263
	bust_spinlocks(0);
264
	add_taint(TAINT_DIE);
265
	spin_unlock_irq(&die_lock);
L
Linus Torvalds 已提交
266 267 268 269
	if (in_interrupt())
		panic("Fatal exception in interrupt");
	if (panic_on_oops)
		panic("Fatal exception: panic_on_oops");
270 271
	oops_exit();
	do_exit(SIGSEGV);
L
Linus Torvalds 已提交
272 273
}

274 275
static void inline report_user_fault(struct pt_regs *regs, long int_code,
				     int signr)
L
Linus Torvalds 已提交
276
{
277
	if ((task_pid_nr(current) > 1) && !show_unhandled_signals)
L
Linus Torvalds 已提交
278
		return;
279 280 281 282 283 284 285
	if (!unhandled_signal(current, signr))
		return;
	if (!printk_ratelimit())
		return;
	printk("User process fault: interruption code 0x%lX ", int_code);
	print_vma_addr("in ", regs->psw.addr & PSW_ADDR_INSN);
	printk("\n");
L
Linus Torvalds 已提交
286 287 288
	show_regs(regs);
}

H
Heiko Carstens 已提交
289 290 291 292 293
int is_valid_bugaddr(unsigned long addr)
{
	return 1;
}

294 295
static inline void __kprobes do_trap(long pgm_int_code, int signr, char *str,
				     struct pt_regs *regs, siginfo_t *info)
L
Linus Torvalds 已提交
296
{
297 298
	if (notify_die(DIE_TRAP, str, regs, pgm_int_code,
		       pgm_int_code, signr) == NOTIFY_STOP)
M
Michael Grundy 已提交
299 300
		return;

L
Linus Torvalds 已提交
301 302 303
        if (regs->psw.mask & PSW_MASK_PSTATE) {
                struct task_struct *tsk = current;

304
		tsk->thread.trap_no = pgm_int_code & 0xffff;
L
Linus Torvalds 已提交
305
		force_sig_info(signr, info, tsk);
306
		report_user_fault(regs, pgm_int_code, signr);
L
Linus Torvalds 已提交
307 308 309 310 311
        } else {
                const struct exception_table_entry *fixup;
                fixup = search_exception_tables(regs->psw.addr & PSW_ADDR_INSN);
                if (fixup)
                        regs->psw.addr = fixup->fixup | PSW_ADDR_AMODE;
H
Heiko Carstens 已提交
312 313 314
		else {
			enum bug_trap_type btt;

315
			btt = report_bug(regs->psw.addr & PSW_ADDR_INSN, regs);
H
Heiko Carstens 已提交
316 317
			if (btt == BUG_TRAP_TYPE_WARN)
				return;
318
			die(str, regs, pgm_int_code);
H
Heiko Carstens 已提交
319
		}
L
Linus Torvalds 已提交
320 321 322
        }
}

323 324
static inline void __user *get_psw_address(struct pt_regs *regs,
					   long pgm_int_code)
L
Linus Torvalds 已提交
325
{
326 327
	return (void __user *)
		((regs->psw.addr - (pgm_int_code >> 16)) & PSW_ADDR_INSN);
L
Linus Torvalds 已提交
328 329
}

M
Martin Schwidefsky 已提交
330
void __kprobes do_per_trap(struct pt_regs *regs)
L
Linus Torvalds 已提交
331
{
M
Martin Schwidefsky 已提交
332
	if (notify_die(DIE_SSTEP, "sstep", regs, 0, 0, SIGTRAP) == NOTIFY_STOP)
M
Michael Grundy 已提交
333
		return;
T
Tejun Heo 已提交
334
	if (current->ptrace)
L
Linus Torvalds 已提交
335 336 337
		force_sig(SIGTRAP, current);
}

338 339
static void default_trap_handler(struct pt_regs *regs, long pgm_int_code,
				 unsigned long trans_exc_code)
L
Linus Torvalds 已提交
340 341
{
        if (regs->psw.mask & PSW_MASK_PSTATE) {
342
		report_user_fault(regs, pgm_int_code, SIGSEGV);
343
		do_exit(SIGSEGV);
L
Linus Torvalds 已提交
344
	} else
345
		die("Unknown program exception", regs, pgm_int_code);
L
Linus Torvalds 已提交
346 347
}

348 349 350
#define DO_ERROR_INFO(name, signr, sicode, str) \
static void name(struct pt_regs *regs, long pgm_int_code, \
		 unsigned long trans_exc_code) \
L
Linus Torvalds 已提交
351 352 353 354 355
{ \
        siginfo_t info; \
        info.si_signo = signr; \
        info.si_errno = 0; \
        info.si_code = sicode; \
356 357
	info.si_addr = get_psw_address(regs, pgm_int_code); \
	do_trap(pgm_int_code, signr, str, regs, &info);	    \
L
Linus Torvalds 已提交
358 359
}

360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388
DO_ERROR_INFO(addressing_exception, SIGILL, ILL_ILLADR,
	      "addressing exception")
DO_ERROR_INFO(execute_exception, SIGILL, ILL_ILLOPN,
	      "execute exception")
DO_ERROR_INFO(divide_exception, SIGFPE, FPE_INTDIV,
	      "fixpoint divide exception")
DO_ERROR_INFO(overflow_exception, SIGFPE, FPE_INTOVF,
	      "fixpoint overflow exception")
DO_ERROR_INFO(hfp_overflow_exception, SIGFPE, FPE_FLTOVF,
	      "HFP overflow exception")
DO_ERROR_INFO(hfp_underflow_exception, SIGFPE, FPE_FLTUND,
	      "HFP underflow exception")
DO_ERROR_INFO(hfp_significance_exception, SIGFPE, FPE_FLTRES,
	      "HFP significance exception")
DO_ERROR_INFO(hfp_divide_exception, SIGFPE, FPE_FLTDIV,
	      "HFP divide exception")
DO_ERROR_INFO(hfp_sqrt_exception, SIGFPE, FPE_FLTINV,
	      "HFP square root exception")
DO_ERROR_INFO(operand_exception, SIGILL, ILL_ILLOPN,
	      "operand exception")
DO_ERROR_INFO(privileged_op, SIGILL, ILL_PRVOPC,
	      "privileged operation")
DO_ERROR_INFO(special_op_exception, SIGILL, ILL_ILLOPN,
	      "special operation exception")
DO_ERROR_INFO(translation_exception, SIGILL, ILL_ILLOPN,
	      "translation exception")

static inline void do_fp_trap(struct pt_regs *regs, void __user *location,
			      int fpc, long pgm_int_code)
L
Linus Torvalds 已提交
389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409
{
	siginfo_t si;

	si.si_signo = SIGFPE;
	si.si_errno = 0;
	si.si_addr = location;
	si.si_code = 0;
	/* FPC[2] is Data Exception Code */
	if ((fpc & 0x00000300) == 0) {
		/* bits 6 and 7 of DXC are 0 iff IEEE exception */
		if (fpc & 0x8000) /* invalid fp operation */
			si.si_code = FPE_FLTINV;
		else if (fpc & 0x4000) /* div by 0 */
			si.si_code = FPE_FLTDIV;
		else if (fpc & 0x2000) /* overflow */
			si.si_code = FPE_FLTOVF;
		else if (fpc & 0x1000) /* underflow */
			si.si_code = FPE_FLTUND;
		else if (fpc & 0x0800) /* inexact */
			si.si_code = FPE_FLTRES;
	}
410
	do_trap(pgm_int_code, SIGFPE,
L
Linus Torvalds 已提交
411 412 413
		"floating point exception", regs, &si);
}

414 415
static void __kprobes illegal_op(struct pt_regs *regs, long pgm_int_code,
				 unsigned long trans_exc_code)
L
Linus Torvalds 已提交
416 417 418
{
	siginfo_t info;
        __u8 opcode[6];
H
Heiko Carstens 已提交
419
	__u16 __user *location;
L
Linus Torvalds 已提交
420 421
	int signal = 0;

422
	location = get_psw_address(regs, pgm_int_code);
L
Linus Torvalds 已提交
423 424

	if (regs->psw.mask & PSW_MASK_PSTATE) {
H
Heiko Carstens 已提交
425 426
		if (get_user(*((__u16 *) opcode), (__u16 __user *) location))
			return;
L
Linus Torvalds 已提交
427
		if (*((__u16 *) opcode) == S390_BREAKPOINT_U16) {
T
Tejun Heo 已提交
428
			if (current->ptrace)
L
Linus Torvalds 已提交
429 430 431 432 433
				force_sig(SIGTRAP, current);
			else
				signal = SIGILL;
#ifdef CONFIG_MATHEMU
		} else if (opcode[0] == 0xb3) {
H
Heiko Carstens 已提交
434 435
			if (get_user(*((__u16 *) (opcode+2)), location+1))
				return;
L
Linus Torvalds 已提交
436 437
			signal = math_emu_b3(opcode, regs);
                } else if (opcode[0] == 0xed) {
H
Heiko Carstens 已提交
438 439 440
			if (get_user(*((__u32 *) (opcode+2)),
				     (__u32 __user *)(location+1)))
				return;
L
Linus Torvalds 已提交
441 442
			signal = math_emu_ed(opcode, regs);
		} else if (*((__u16 *) opcode) == 0xb299) {
H
Heiko Carstens 已提交
443 444
			if (get_user(*((__u16 *) (opcode+2)), location+1))
				return;
L
Linus Torvalds 已提交
445 446
			signal = math_emu_srnm(opcode, regs);
		} else if (*((__u16 *) opcode) == 0xb29c) {
H
Heiko Carstens 已提交
447 448
			if (get_user(*((__u16 *) (opcode+2)), location+1))
				return;
L
Linus Torvalds 已提交
449 450
			signal = math_emu_stfpc(opcode, regs);
		} else if (*((__u16 *) opcode) == 0xb29d) {
H
Heiko Carstens 已提交
451 452
			if (get_user(*((__u16 *) (opcode+2)), location+1))
				return;
L
Linus Torvalds 已提交
453 454 455 456
			signal = math_emu_lfpc(opcode, regs);
#endif
		} else
			signal = SIGILL;
457 458 459 460 461
	} else {
		/*
		 * If we get an illegal op in kernel mode, send it through the
		 * kprobes notifier. If kprobes doesn't pick it up, SIGILL
		 */
462
		if (notify_die(DIE_BPT, "bpt", regs, pgm_int_code,
463 464 465
			       3, SIGTRAP) != NOTIFY_STOP)
			signal = SIGILL;
	}
L
Linus Torvalds 已提交
466 467 468 469

#ifdef CONFIG_MATHEMU
        if (signal == SIGFPE)
		do_fp_trap(regs, location,
470
			   current->thread.fp_regs.fpc, pgm_int_code);
L
Linus Torvalds 已提交
471 472 473 474
        else if (signal == SIGSEGV) {
		info.si_signo = signal;
		info.si_errno = 0;
		info.si_code = SEGV_MAPERR;
A
Al Viro 已提交
475
		info.si_addr = (void __user *) location;
476
		do_trap(pgm_int_code, signal,
L
Linus Torvalds 已提交
477 478 479 480 481 482 483
			"user address fault", regs, &info);
	} else
#endif
        if (signal) {
		info.si_signo = signal;
		info.si_errno = 0;
		info.si_code = ILL_ILLOPC;
A
Al Viro 已提交
484
		info.si_addr = (void __user *) location;
485
		do_trap(pgm_int_code, signal,
L
Linus Torvalds 已提交
486 487 488 489 490 491
			"illegal operation", regs, &info);
	}
}


#ifdef CONFIG_MATHEMU
492 493 494
asmlinkage void specification_exception(struct pt_regs *regs,
					long pgm_int_code,
					unsigned long trans_exc_code)
L
Linus Torvalds 已提交
495 496
{
        __u8 opcode[6];
A
Al Viro 已提交
497
	__u16 __user *location = NULL;
L
Linus Torvalds 已提交
498 499
	int signal = 0;

500
	location = (__u16 __user *) get_psw_address(regs, pgm_int_code);
L
Linus Torvalds 已提交
501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535

        if (regs->psw.mask & PSW_MASK_PSTATE) {
		get_user(*((__u16 *) opcode), location);
		switch (opcode[0]) {
		case 0x28: /* LDR Rx,Ry   */
			signal = math_emu_ldr(opcode);
			break;
		case 0x38: /* LER Rx,Ry   */
			signal = math_emu_ler(opcode);
			break;
		case 0x60: /* STD R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_std(opcode, regs);
			break;
		case 0x68: /* LD R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_ld(opcode, regs);
			break;
		case 0x70: /* STE R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_ste(opcode, regs);
			break;
		case 0x78: /* LE R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_le(opcode, regs);
			break;
		default:
			signal = SIGILL;
			break;
                }
        } else
		signal = SIGILL;

        if (signal == SIGFPE)
		do_fp_trap(regs, location,
536
			   current->thread.fp_regs.fpc, pgm_int_code);
L
Linus Torvalds 已提交
537 538 539 540 541 542
        else if (signal) {
		siginfo_t info;
		info.si_signo = signal;
		info.si_errno = 0;
		info.si_code = ILL_ILLOPN;
		info.si_addr = location;
543
		do_trap(pgm_int_code, signal,
L
Linus Torvalds 已提交
544 545 546 547
			"specification exception", regs, &info);
	}
}
#else
548 549
DO_ERROR_INFO(specification_exception, SIGILL, ILL_ILLOPN,
	      "specification exception");
L
Linus Torvalds 已提交
550 551
#endif

552 553
static void data_exception(struct pt_regs *regs, long pgm_int_code,
			   unsigned long trans_exc_code)
L
Linus Torvalds 已提交
554
{
H
Heiko Carstens 已提交
555
	__u16 __user *location;
L
Linus Torvalds 已提交
556 557
	int signal = 0;

558
	location = get_psw_address(regs, pgm_int_code);
L
Linus Torvalds 已提交
559 560

	if (MACHINE_HAS_IEEE)
561
		asm volatile("stfpc %0" : "=m" (current->thread.fp_regs.fpc));
L
Linus Torvalds 已提交
562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595

#ifdef CONFIG_MATHEMU
        else if (regs->psw.mask & PSW_MASK_PSTATE) {
        	__u8 opcode[6];
		get_user(*((__u16 *) opcode), location);
		switch (opcode[0]) {
		case 0x28: /* LDR Rx,Ry   */
			signal = math_emu_ldr(opcode);
			break;
		case 0x38: /* LER Rx,Ry   */
			signal = math_emu_ler(opcode);
			break;
		case 0x60: /* STD R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_std(opcode, regs);
			break;
		case 0x68: /* LD R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_ld(opcode, regs);
			break;
		case 0x70: /* STE R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_ste(opcode, regs);
			break;
		case 0x78: /* LE R,D(X,B) */
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_le(opcode, regs);
			break;
		case 0xb3:
			get_user(*((__u16 *) (opcode+2)), location+1);
			signal = math_emu_b3(opcode, regs);
			break;
                case 0xed:
			get_user(*((__u32 *) (opcode+2)),
A
Al Viro 已提交
596
				 (__u32 __user *)(location+1));
L
Linus Torvalds 已提交
597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623
			signal = math_emu_ed(opcode, regs);
			break;
	        case 0xb2:
			if (opcode[1] == 0x99) {
				get_user(*((__u16 *) (opcode+2)), location+1);
				signal = math_emu_srnm(opcode, regs);
			} else if (opcode[1] == 0x9c) {
				get_user(*((__u16 *) (opcode+2)), location+1);
				signal = math_emu_stfpc(opcode, regs);
			} else if (opcode[1] == 0x9d) {
				get_user(*((__u16 *) (opcode+2)), location+1);
				signal = math_emu_lfpc(opcode, regs);
			} else
				signal = SIGILL;
			break;
		default:
			signal = SIGILL;
			break;
                }
        }
#endif 
	if (current->thread.fp_regs.fpc & FPC_DXC_MASK)
		signal = SIGFPE;
	else
		signal = SIGILL;
        if (signal == SIGFPE)
		do_fp_trap(regs, location,
624
			   current->thread.fp_regs.fpc, pgm_int_code);
L
Linus Torvalds 已提交
625 626 627 628 629 630
        else if (signal) {
		siginfo_t info;
		info.si_signo = signal;
		info.si_errno = 0;
		info.si_code = ILL_ILLOPN;
		info.si_addr = location;
631
		do_trap(pgm_int_code, signal, "data exception", regs, &info);
L
Linus Torvalds 已提交
632 633 634
	}
}

635 636
static void space_switch_exception(struct pt_regs *regs, long pgm_int_code,
				   unsigned long trans_exc_code)
L
Linus Torvalds 已提交
637 638 639 640 641 642 643 644 645 646
{
        siginfo_t info;

	/* Set user psw back to home space mode. */
	if (regs->psw.mask & PSW_MASK_PSTATE)
		regs->psw.mask |= PSW_ASC_HOME;
	/* Send SIGILL. */
        info.si_signo = SIGILL;
        info.si_errno = 0;
        info.si_code = ILL_PRVOPC;
647 648
	info.si_addr = get_psw_address(regs, pgm_int_code);
	do_trap(pgm_int_code, SIGILL, "space switch event", regs, &info);
L
Linus Torvalds 已提交
649 650
}

651
asmlinkage void __kprobes kernel_stack_overflow(struct pt_regs * regs)
L
Linus Torvalds 已提交
652
{
653 654 655 656
	bust_spinlocks(1);
	printk("Kernel stack overflow.\n");
	show_regs(regs);
	bust_spinlocks(0);
L
Linus Torvalds 已提交
657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
	panic("Corrupt kernel stack, can't continue.");
}

/* init is done in lowcore.S and head.S */

void __init trap_init(void)
{
        int i;

        for (i = 0; i < 128; i++)
          pgm_check_table[i] = &default_trap_handler;
        pgm_check_table[1] = &illegal_op;
        pgm_check_table[2] = &privileged_op;
        pgm_check_table[3] = &execute_exception;
        pgm_check_table[4] = &do_protection_exception;
        pgm_check_table[5] = &addressing_exception;
        pgm_check_table[6] = &specification_exception;
        pgm_check_table[7] = &data_exception;
        pgm_check_table[8] = &overflow_exception;
        pgm_check_table[9] = &divide_exception;
        pgm_check_table[0x0A] = &overflow_exception;
        pgm_check_table[0x0B] = &divide_exception;
        pgm_check_table[0x0C] = &hfp_overflow_exception;
        pgm_check_table[0x0D] = &hfp_underflow_exception;
        pgm_check_table[0x0E] = &hfp_significance_exception;
        pgm_check_table[0x0F] = &hfp_divide_exception;
        pgm_check_table[0x10] = &do_dat_exception;
        pgm_check_table[0x11] = &do_dat_exception;
        pgm_check_table[0x12] = &translation_exception;
        pgm_check_table[0x13] = &special_op_exception;
687
#ifdef CONFIG_64BIT
M
Martin Schwidefsky 已提交
688
	pgm_check_table[0x38] = &do_asce_exception;
L
Linus Torvalds 已提交
689 690 691
	pgm_check_table[0x39] = &do_dat_exception;
	pgm_check_table[0x3A] = &do_dat_exception;
        pgm_check_table[0x3B] = &do_dat_exception;
692
#endif /* CONFIG_64BIT */
L
Linus Torvalds 已提交
693 694 695
        pgm_check_table[0x15] = &operand_exception;
        pgm_check_table[0x1C] = &space_switch_exception;
        pgm_check_table[0x1D] = &hfp_sqrt_exception;
696 697
	/* Enable machine checks early. */
	local_mcck_enable();
L
Linus Torvalds 已提交
698
}