traps.c 25.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 *  Copyright (C) 1991, 1992  Linus Torvalds
3
 *  Copyright (C) 2000, 2001, 2002 Andi Kleen, SuSE Labs
L
Linus Torvalds 已提交
4 5 6 7 8 9
 *
 *  Pentium III FXSR, SSE support
 *	Gareth Hughes <gareth@valinux.com>, May 2000
 */

/*
10
 * Handle hardware traps and faults.
L
Linus Torvalds 已提交
11
 */
I
Ingo Molnar 已提交
12 13 14 15 16 17 18
#include <linux/interrupt.h>
#include <linux/kallsyms.h>
#include <linux/spinlock.h>
#include <linux/kprobes.h>
#include <linux/uaccess.h>
#include <linux/utsname.h>
#include <linux/kdebug.h>
L
Linus Torvalds 已提交
19
#include <linux/kernel.h>
I
Ingo Molnar 已提交
20 21
#include <linux/module.h>
#include <linux/ptrace.h>
L
Linus Torvalds 已提交
22
#include <linux/string.h>
I
Ingo Molnar 已提交
23
#include <linux/delay.h>
L
Linus Torvalds 已提交
24
#include <linux/errno.h>
I
Ingo Molnar 已提交
25 26
#include <linux/kexec.h>
#include <linux/sched.h>
L
Linus Torvalds 已提交
27 28
#include <linux/timer.h>
#include <linux/init.h>
J
Jeremy Fitzhardinge 已提交
29
#include <linux/bug.h>
I
Ingo Molnar 已提交
30 31
#include <linux/nmi.h>
#include <linux/mm.h>
32 33
#include <linux/smp.h>
#include <linux/io.h>
L
Linus Torvalds 已提交
34 35 36 37 38 39 40 41 42 43

#ifdef CONFIG_EISA
#include <linux/ioport.h>
#include <linux/eisa.h>
#endif

#ifdef CONFIG_MCA
#include <linux/mca.h>
#endif

D
Dave Jiang 已提交
44 45 46 47
#if defined(CONFIG_EDAC)
#include <linux/edac.h>
#endif

I
Ingo Molnar 已提交
48
#include <asm/stacktrace.h>
L
Linus Torvalds 已提交
49 50
#include <asm/processor.h>
#include <asm/debugreg.h>
I
Ingo Molnar 已提交
51 52
#include <asm/atomic.h>
#include <asm/system.h>
53
#include <asm/traps.h>
L
Linus Torvalds 已提交
54 55
#include <asm/desc.h>
#include <asm/i387.h>
56 57 58

#include <mach_traps.h>

59 60 61 62 63
#ifdef CONFIG_X86_64
#include <asm/pgalloc.h>
#include <asm/proto.h>
#include <asm/pda.h>
#else
64 65
#include <asm/processor-flags.h>
#include <asm/arch_hooks.h>
66
#include <asm/traps.h>
L
Linus Torvalds 已提交
67

68
#include "cpu/mcheck/mce.h"
L
Linus Torvalds 已提交
69 70 71 72

asmlinkage int system_call(void);

/* Do we ignore FPU interrupts ? */
I
Ingo Molnar 已提交
73
char ignore_fpu_irq;
L
Linus Torvalds 已提交
74 75 76 77 78 79

/*
 * The IDT has to be page-aligned to simplify the Pentium
 * F0 0F bug workaround.. We have a special link segment
 * for this.
 */
80
gate_desc idt_table[256]
81
	__attribute__((__section__(".data.idt"))) = { { { { 0, 0 } } }, };
82
#endif
L
Linus Torvalds 已提交
83

84 85 86
DECLARE_BITMAP(used_vectors, NR_VECTORS);
EXPORT_SYMBOL_GPL(used_vectors);

87
static int ignore_nmis;
88

89 90 91 92 93 94
static inline void conditional_sti(struct pt_regs *regs)
{
	if (regs->flags & X86_EFLAGS_IF)
		local_irq_enable();
}

95 96 97 98 99 100 101 102 103 104 105 106 107 108
static inline void preempt_conditional_sti(struct pt_regs *regs)
{
	inc_preempt_count();
	if (regs->flags & X86_EFLAGS_IF)
		local_irq_enable();
}

static inline void preempt_conditional_cli(struct pt_regs *regs)
{
	if (regs->flags & X86_EFLAGS_IF)
		local_irq_disable();
	dec_preempt_count();
}

109
#ifdef CONFIG_X86_32
I
Ingo Molnar 已提交
110 111
static inline void
die_if_kernel(const char *str, struct pt_regs *regs, long err)
L
Linus Torvalds 已提交
112
{
113
	if (!user_mode_vm(regs))
L
Linus Torvalds 已提交
114 115 116
		die(str, regs, err);
}

117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156
/*
 * Perform the lazy TSS's I/O bitmap copy. If the TSS has an
 * invalid offset set (the LAZY one) and the faulting thread has
 * a valid I/O bitmap pointer, we copy the I/O bitmap in the TSS,
 * we set the offset field correctly and return 1.
 */
static int lazy_iobitmap_copy(void)
{
	struct thread_struct *thread;
	struct tss_struct *tss;
	int cpu;

	cpu = get_cpu();
	tss = &per_cpu(init_tss, cpu);
	thread = &current->thread;

	if (tss->x86_tss.io_bitmap_base == INVALID_IO_BITMAP_OFFSET_LAZY &&
	    thread->io_bitmap_ptr) {
		memcpy(tss->io_bitmap, thread->io_bitmap_ptr,
		       thread->io_bitmap_max);
		/*
		 * If the previously set map was extending to higher ports
		 * than the current one, pad extra space with 0xff (no access).
		 */
		if (thread->io_bitmap_max < tss->io_bitmap_max) {
			memset((char *) tss->io_bitmap +
				thread->io_bitmap_max, 0xff,
				tss->io_bitmap_max - thread->io_bitmap_max);
		}
		tss->io_bitmap_max = thread->io_bitmap_max;
		tss->x86_tss.io_bitmap_base = IO_BITMAP_OFFSET;
		tss->io_bitmap_owner = thread;
		put_cpu();

		return 1;
	}
	put_cpu();

	return 0;
}
157
#endif
158

I
Ingo Molnar 已提交
159
static void __kprobes
160
do_trap(int trapnr, int signr, char *str, struct pt_regs *regs,
I
Ingo Molnar 已提交
161
	long error_code, siginfo_t *info)
L
Linus Torvalds 已提交
162
{
163 164
	struct task_struct *tsk = current;

165
#ifdef CONFIG_X86_32
166
	if (regs->flags & X86_VM_MASK) {
167 168 169 170 171
		/*
		 * traps 0, 1, 3, 4, and 5 should be forwarded to vm86.
		 * On nmi (interrupt 2), do_trap should not be called.
		 */
		if (trapnr < 6)
L
Linus Torvalds 已提交
172 173 174
			goto vm86_trap;
		goto trap_signal;
	}
175
#endif
L
Linus Torvalds 已提交
176

177
	if (!user_mode(regs))
L
Linus Torvalds 已提交
178 179
		goto kernel_trap;

180
#ifdef CONFIG_X86_32
I
Ingo Molnar 已提交
181
trap_signal:
182
#endif
I
Ingo Molnar 已提交
183 184 185 186 187 188 189 190 191 192 193
	/*
	 * We want error_code and trap_no set for userspace faults and
	 * kernelspace faults which result in die(), but not
	 * kernelspace faults which are fixed up.  die() gives the
	 * process no chance to handle the signal and notice the
	 * kernel fault information, so that won't result in polluting
	 * the information about previously queued, but not yet
	 * delivered, faults.  See also do_general_protection below.
	 */
	tsk->thread.error_code = error_code;
	tsk->thread.trap_no = trapnr;
194

195 196 197 198 199 200 201 202 203 204 205 206
#ifdef CONFIG_X86_64
	if (show_unhandled_signals && unhandled_signal(tsk, signr) &&
	    printk_ratelimit()) {
		printk(KERN_INFO
		       "%s[%d] trap %s ip:%lx sp:%lx error:%lx",
		       tsk->comm, tsk->pid, str,
		       regs->ip, regs->sp, error_code);
		print_vma_addr(" in ", regs->ip);
		printk("\n");
	}
#endif

I
Ingo Molnar 已提交
207 208 209 210 211
	if (info)
		force_sig_info(signr, info, tsk);
	else
		force_sig(signr, tsk);
	return;
L
Linus Torvalds 已提交
212

I
Ingo Molnar 已提交
213 214 215 216 217
kernel_trap:
	if (!fixup_exception(regs)) {
		tsk->thread.error_code = error_code;
		tsk->thread.trap_no = trapnr;
		die(str, regs, error_code);
L
Linus Torvalds 已提交
218
	}
I
Ingo Molnar 已提交
219
	return;
L
Linus Torvalds 已提交
220

221
#ifdef CONFIG_X86_32
I
Ingo Molnar 已提交
222 223 224 225 226
vm86_trap:
	if (handle_vm86_trap((struct kernel_vm86_regs *) regs,
						error_code, trapnr))
		goto trap_signal;
	return;
227
#endif
L
Linus Torvalds 已提交
228 229
}

I
Ingo Molnar 已提交
230
#define DO_ERROR(trapnr, signr, str, name)				\
231
dotraplinkage void do_##name(struct pt_regs *regs, long error_code)	\
I
Ingo Molnar 已提交
232 233
{									\
	if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr)	\
234
							== NOTIFY_STOP)	\
I
Ingo Molnar 已提交
235
		return;							\
236
	conditional_sti(regs);						\
237
	do_trap(trapnr, signr, str, regs, error_code, NULL);		\
L
Linus Torvalds 已提交
238 239
}

240
#define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr)		\
241
dotraplinkage void do_##name(struct pt_regs *regs, long error_code)	\
I
Ingo Molnar 已提交
242 243 244 245 246 247 248
{									\
	siginfo_t info;							\
	info.si_signo = signr;						\
	info.si_errno = 0;						\
	info.si_code = sicode;						\
	info.si_addr = (void __user *)siaddr;				\
	if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr)	\
249
							== NOTIFY_STOP)	\
I
Ingo Molnar 已提交
250
		return;							\
251
	conditional_sti(regs);						\
252
	do_trap(trapnr, signr, str, regs, error_code, &info);		\
L
Linus Torvalds 已提交
253 254
}

255 256 257 258
DO_ERROR_INFO(0, SIGFPE, "divide error", divide_error, FPE_INTDIV, regs->ip)
DO_ERROR(4, SIGSEGV, "overflow", overflow)
DO_ERROR(5, SIGSEGV, "bounds", bounds)
DO_ERROR_INFO(6, SIGILL, "invalid opcode", invalid_op, ILL_ILLOPN, regs->ip)
259
DO_ERROR(9, SIGFPE, "coprocessor segment overrun", coprocessor_segment_overrun)
260
DO_ERROR(10, SIGSEGV, "invalid TSS", invalid_TSS)
261
DO_ERROR(11, SIGBUS, "segment not present", segment_not_present)
262
#ifdef CONFIG_X86_32
263
DO_ERROR(12, SIGBUS, "stack segment", stack_segment)
264
#endif
265
DO_ERROR_INFO(17, SIGBUS, "alignment check", alignment_check, BUS_ADRALN, 0)
L
Linus Torvalds 已提交
266

267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289
#ifdef CONFIG_X86_64
/* Runs on IST stack */
dotraplinkage void do_stack_segment(struct pt_regs *regs, long error_code)
{
	if (notify_die(DIE_TRAP, "stack segment", regs, error_code,
			12, SIGBUS) == NOTIFY_STOP)
		return;
	preempt_conditional_sti(regs);
	do_trap(12, SIGBUS, "stack segment", regs, error_code, NULL);
	preempt_conditional_cli(regs);
}

dotraplinkage void do_double_fault(struct pt_regs *regs, long error_code)
{
	static const char str[] = "double fault";
	struct task_struct *tsk = current;

	/* Return not checked because double check cannot be ignored */
	notify_die(DIE_TRAP, str, regs, error_code, 8, SIGSEGV);

	tsk->thread.error_code = error_code;
	tsk->thread.trap_no = 8;

290 291 292 293
	/*
	 * This is always a kernel trap and never fixable (and thus must
	 * never return).
	 */
294 295 296 297 298
	for (;;)
		die(str, regs, error_code);
}
#endif

299
dotraplinkage void __kprobes
300
do_general_protection(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
301
{
302
	struct task_struct *tsk;
I
Ingo Molnar 已提交
303

304 305
	conditional_sti(regs);

306
#ifdef CONFIG_X86_32
307 308
	if (lazy_iobitmap_copy()) {
		/* restart the faulting instruction */
L
Linus Torvalds 已提交
309 310 311
		return;
	}

312
	if (regs->flags & X86_VM_MASK)
L
Linus Torvalds 已提交
313
		goto gp_in_vm86;
314
#endif
L
Linus Torvalds 已提交
315

316
	tsk = current;
317
	if (!user_mode(regs))
L
Linus Torvalds 已提交
318 319
		goto gp_in_kernel;

320 321
	tsk->thread.error_code = error_code;
	tsk->thread.trap_no = 13;
I
Ingo Molnar 已提交
322

323 324
	if (show_unhandled_signals && unhandled_signal(tsk, SIGSEGV) &&
			printk_ratelimit()) {
325
		printk(KERN_INFO
326 327 328
			"%s[%d] general protection ip:%lx sp:%lx error:%lx",
			tsk->comm, task_pid_nr(tsk),
			regs->ip, regs->sp, error_code);
329 330 331
		print_vma_addr(" in ", regs->ip);
		printk("\n");
	}
332

333
	force_sig(SIGSEGV, tsk);
L
Linus Torvalds 已提交
334 335
	return;

336
#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
337 338 339 340
gp_in_vm86:
	local_irq_enable();
	handle_vm86_fault((struct kernel_vm86_regs *) regs, error_code);
	return;
341
#endif
L
Linus Torvalds 已提交
342 343

gp_in_kernel:
344 345 346 347 348 349
	if (fixup_exception(regs))
		return;

	tsk->thread.error_code = error_code;
	tsk->thread.trap_no = 13;
	if (notify_die(DIE_GPF, "general protection fault", regs,
L
Linus Torvalds 已提交
350
				error_code, 13, SIGSEGV) == NOTIFY_STOP)
351 352
		return;
	die("general protection fault", regs, error_code);
L
Linus Torvalds 已提交
353 354
}

355
static notrace __kprobes void
I
Ingo Molnar 已提交
356
mem_parity_error(unsigned char reason, struct pt_regs *regs)
L
Linus Torvalds 已提交
357
{
I
Ingo Molnar 已提交
358 359 360 361 362 363
	printk(KERN_EMERG
		"Uhhuh. NMI received for unknown reason %02x on CPU %d.\n",
			reason, smp_processor_id());

	printk(KERN_EMERG
		"You have some hardware problem, likely on the PCI bus.\n");
D
Dave Jiang 已提交
364 365

#if defined(CONFIG_EDAC)
I
Ingo Molnar 已提交
366
	if (edac_handler_set()) {
D
Dave Jiang 已提交
367 368 369 370 371
		edac_atomic_assert_error();
		return;
	}
#endif

372
	if (panic_on_unrecovered_nmi)
I
Ingo Molnar 已提交
373
		panic("NMI: Not continuing");
L
Linus Torvalds 已提交
374

375
	printk(KERN_EMERG "Dazed and confused, but trying to continue\n");
L
Linus Torvalds 已提交
376 377

	/* Clear and disable the memory parity error line. */
378 379
	reason = (reason & 0xf) | 4;
	outb(reason, 0x61);
L
Linus Torvalds 已提交
380 381
}

382
static notrace __kprobes void
I
Ingo Molnar 已提交
383
io_check_error(unsigned char reason, struct pt_regs *regs)
L
Linus Torvalds 已提交
384 385 386
{
	unsigned long i;

387
	printk(KERN_EMERG "NMI: IOCK error (debug interrupt?)\n");
L
Linus Torvalds 已提交
388 389 390 391 392
	show_registers(regs);

	/* Re-enable the IOCK line, wait for a few seconds */
	reason = (reason & 0xf) | 8;
	outb(reason, 0x61);
I
Ingo Molnar 已提交
393

L
Linus Torvalds 已提交
394
	i = 2000;
I
Ingo Molnar 已提交
395 396 397
	while (--i)
		udelay(1000);

L
Linus Torvalds 已提交
398 399 400 401
	reason &= ~8;
	outb(reason, 0x61);
}

402
static notrace __kprobes void
I
Ingo Molnar 已提交
403
unknown_nmi_error(unsigned char reason, struct pt_regs *regs)
L
Linus Torvalds 已提交
404
{
405 406
	if (notify_die(DIE_NMIUNKNOWN, "nmi", regs, reason, 2, SIGINT) ==
			NOTIFY_STOP)
J
Jason Wessel 已提交
407
		return;
L
Linus Torvalds 已提交
408
#ifdef CONFIG_MCA
I
Ingo Molnar 已提交
409 410 411 412 413
	/*
	 * Might actually be able to figure out what the guilty party
	 * is:
	 */
	if (MCA_bus) {
L
Linus Torvalds 已提交
414 415 416 417
		mca_handle_nmi();
		return;
	}
#endif
I
Ingo Molnar 已提交
418 419 420 421
	printk(KERN_EMERG
		"Uhhuh. NMI received for unknown reason %02x on CPU %d.\n",
			reason, smp_processor_id());

422
	printk(KERN_EMERG "Do you have a strange power saving mode enabled?\n");
423
	if (panic_on_unrecovered_nmi)
I
Ingo Molnar 已提交
424
		panic("NMI: Not continuing");
425

426
	printk(KERN_EMERG "Dazed and confused, but trying to continue\n");
L
Linus Torvalds 已提交
427 428
}

429
static notrace __kprobes void default_do_nmi(struct pt_regs *regs)
L
Linus Torvalds 已提交
430 431
{
	unsigned char reason = 0;
432 433 434
	int cpu;

	cpu = smp_processor_id();
L
Linus Torvalds 已提交
435

436 437
	/* Only the BSP gets external NMIs from the system. */
	if (!cpu)
L
Linus Torvalds 已提交
438
		reason = get_nmi_reason();
I
Ingo Molnar 已提交
439

L
Linus Torvalds 已提交
440
	if (!(reason & 0xc0)) {
441
		if (notify_die(DIE_NMI_IPI, "nmi_ipi", regs, reason, 2, SIGINT)
442
								== NOTIFY_STOP)
L
Linus Torvalds 已提交
443 444 445 446 447 448
			return;
#ifdef CONFIG_X86_LOCAL_APIC
		/*
		 * Ok, so this is none of the documented NMI sources,
		 * so it must be the NMI watchdog.
		 */
449
		if (nmi_watchdog_tick(regs, reason))
L
Linus Torvalds 已提交
450
			return;
451
		if (!do_nmi_callback(regs, cpu))
452
			unknown_nmi_error(reason, regs);
I
Ingo Molnar 已提交
453 454 455
#else
		unknown_nmi_error(reason, regs);
#endif
456

L
Linus Torvalds 已提交
457 458
		return;
	}
459
	if (notify_die(DIE_NMI, "nmi", regs, reason, 2, SIGINT) == NOTIFY_STOP)
L
Linus Torvalds 已提交
460
		return;
461 462

	/* AK: following checks seem to be broken on modern chipsets. FIXME */
L
Linus Torvalds 已提交
463 464 465 466
	if (reason & 0x80)
		mem_parity_error(reason, regs);
	if (reason & 0x40)
		io_check_error(reason, regs);
467
#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
468 469
	/*
	 * Reassert NMI in case it became active meanwhile
I
Ingo Molnar 已提交
470
	 * as it's edge-triggered:
L
Linus Torvalds 已提交
471 472
	 */
	reassert_nmi();
473
#endif
L
Linus Torvalds 已提交
474 475
}

476 477
dotraplinkage notrace __kprobes void
do_nmi(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
478 479 480
{
	nmi_enter();

481
	inc_irq_stat(__nmi_count);
L
Linus Torvalds 已提交
482

483 484
	if (!ignore_nmis)
		default_do_nmi(regs);
L
Linus Torvalds 已提交
485 486 487 488

	nmi_exit();
}

489 490 491 492 493 494 495 496 497 498 499 500
void stop_nmi(void)
{
	acpi_nmi_disable();
	ignore_nmis++;
}

void restart_nmi(void)
{
	ignore_nmis--;
	acpi_nmi_enable();
}

501
/* May run on IST stack. */
502
dotraplinkage void __kprobes do_int3(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
503
{
504
#ifdef CONFIG_KPROBES
L
Linus Torvalds 已提交
505 506
	if (notify_die(DIE_INT3, "int3", regs, error_code, 3, SIGTRAP)
			== NOTIFY_STOP)
507
		return;
508 509 510 511 512
#else
	if (notify_die(DIE_TRAP, "int3", regs, error_code, 3, SIGTRAP)
			== NOTIFY_STOP)
		return;
#endif
I
Ingo Molnar 已提交
513

514
	preempt_conditional_sti(regs);
515
	do_trap(3, SIGTRAP, "int3", regs, error_code, NULL);
516
	preempt_conditional_cli(regs);
L
Linus Torvalds 已提交
517 518
}

519
#ifdef CONFIG_X86_64
520 521 522 523 524
/*
 * Help handler running on IST stack to switch back to user stack
 * for scheduling or signal handling. The actual stack switch is done in
 * entry.S
 */
525 526 527 528 529 530 531 532 533
asmlinkage __kprobes struct pt_regs *sync_regs(struct pt_regs *eregs)
{
	struct pt_regs *regs = eregs;
	/* Did already sync */
	if (eregs == (struct pt_regs *)eregs->sp)
		;
	/* Exception from user space */
	else if (user_mode(eregs))
		regs = task_pt_regs(current);
534 535 536 537
	/*
	 * Exception from kernel and interrupts are enabled. Move to
	 * kernel process stack.
	 */
538 539 540 541 542 543 544 545
	else if (eregs->flags & X86_EFLAGS_IF)
		regs = (struct pt_regs *)(eregs->sp -= sizeof(struct pt_regs));
	if (eregs != regs)
		*regs = *eregs;
	return regs;
}
#endif

L
Linus Torvalds 已提交
546 547 548 549 550 551 552 553 554 555
/*
 * Our handling of the processor debug registers is non-trivial.
 * We do not clear them on entry and exit from the kernel. Therefore
 * it is possible to get a watchpoint trap here from inside the kernel.
 * However, the code in ./ptrace.c has ensured that the user can
 * only set watchpoints on userspace addresses. Therefore the in-kernel
 * watchpoint trap can only occur in code which is reading/writing
 * from user space. Such code must not hold kernel locks (since it
 * can equally take a page fault), therefore it is safe to call
 * force_sig_info even though that claims and releases locks.
I
Ingo Molnar 已提交
556
 *
L
Linus Torvalds 已提交
557 558 559 560 561 562 563 564 565 566
 * Code in ./signal.c ensures that the debug control register
 * is restored before we deliver any signal, and therefore that
 * user code runs with the correct debug control register even though
 * we clear it here.
 *
 * Being careful here means that we don't have to be as careful in a
 * lot of more complicated places (task switching can be a bit lazy
 * about restoring all the debug state, and ptrace doesn't have to
 * find every occurrence of the TF bit that could be saved away even
 * by user code)
567 568
 *
 * May run on IST stack.
L
Linus Torvalds 已提交
569
 */
570
dotraplinkage void __kprobes do_debug(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
571 572
{
	struct task_struct *tsk = current;
573
	unsigned long condition;
574
	int si_code;
L
Linus Torvalds 已提交
575

576
	get_debugreg(condition, 6);
L
Linus Torvalds 已提交
577

578 579 580 581 582 583
	/*
	 * The processor cleared BTF, so don't mark that we need it set.
	 */
	clear_tsk_thread_flag(tsk, TIF_DEBUGCTLMSR);
	tsk->thread.debugctlmsr = 0;

L
Linus Torvalds 已提交
584
	if (notify_die(DIE_DEBUG, "debug", regs, condition, error_code,
585
						SIGTRAP) == NOTIFY_STOP)
L
Linus Torvalds 已提交
586
		return;
587

L
Linus Torvalds 已提交
588
	/* It's safe to allow irq's after DR6 has been saved */
589
	preempt_conditional_sti(regs);
L
Linus Torvalds 已提交
590 591 592

	/* Mask out spurious debug traps due to lazy DR7 setting */
	if (condition & (DR_TRAP0|DR_TRAP1|DR_TRAP2|DR_TRAP3)) {
593
		if (!tsk->thread.debugreg7)
L
Linus Torvalds 已提交
594 595 596
			goto clear_dr7;
	}

597
#ifdef CONFIG_X86_32
598
	if (regs->flags & X86_VM_MASK)
L
Linus Torvalds 已提交
599
		goto debug_vm86;
600
#endif
L
Linus Torvalds 已提交
601 602

	/* Save debug status register where ptrace can see it */
603
	tsk->thread.debugreg6 = condition;
L
Linus Torvalds 已提交
604 605 606 607 608 609

	/*
	 * Single-stepping through TF: make sure we ignore any events in
	 * kernel space (but re-enable TF when returning to user mode).
	 */
	if (condition & DR_STEP) {
610
		if (!user_mode(regs))
L
Linus Torvalds 已提交
611 612 613
			goto clear_TF_reenable;
	}

614
	si_code = get_si_code(condition);
L
Linus Torvalds 已提交
615
	/* Ok, finally something we can handle */
616
	send_sigtrap(tsk, regs, error_code, si_code);
L
Linus Torvalds 已提交
617

I
Ingo Molnar 已提交
618 619
	/*
	 * Disable additional traps. They'll be re-enabled when
L
Linus Torvalds 已提交
620 621 622
	 * the signal is delivered.
	 */
clear_dr7:
623
	set_debugreg(0, 7);
624
	preempt_conditional_cli(regs);
L
Linus Torvalds 已提交
625 626
	return;

627
#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
628 629
debug_vm86:
	handle_vm86_trap((struct kernel_vm86_regs *) regs, error_code, 1);
630
	preempt_conditional_cli(regs);
L
Linus Torvalds 已提交
631
	return;
632
#endif
L
Linus Torvalds 已提交
633 634 635

clear_TF_reenable:
	set_tsk_thread_flag(tsk, TIF_SINGLESTEP);
636
	regs->flags &= ~X86_EFLAGS_TF;
637
	preempt_conditional_cli(regs);
L
Linus Torvalds 已提交
638 639 640
	return;
}

641 642 643 644 645 646 647 648 649 650 651 652 653 654
#ifdef CONFIG_X86_64
static int kernel_math_error(struct pt_regs *regs, const char *str, int trapnr)
{
	if (fixup_exception(regs))
		return 1;

	notify_die(DIE_GPF, str, regs, 0, trapnr, SIGFPE);
	/* Illegal floating point operation in the kernel */
	current->thread.trap_no = trapnr;
	die(str, regs, 0);
	return 0;
}
#endif

L
Linus Torvalds 已提交
655 656 657 658 659
/*
 * Note that we play around with the 'TS' bit in an attempt to get
 * the correct behaviour even in the presence of the asynchronous
 * IRQ13 behaviour
 */
660
void math_error(void __user *ip)
L
Linus Torvalds 已提交
661
{
I
Ingo Molnar 已提交
662
	struct task_struct *task;
L
Linus Torvalds 已提交
663
	siginfo_t info;
664
	unsigned short cwd, swd, err;
L
Linus Torvalds 已提交
665 666 667 668 669 670 671 672 673 674

	/*
	 * Save the info for the exception handler and clear the error.
	 */
	task = current;
	save_init_fpu(task);
	task->thread.trap_no = 16;
	task->thread.error_code = 0;
	info.si_signo = SIGFPE;
	info.si_errno = 0;
675
	info.si_addr = ip;
L
Linus Torvalds 已提交
676 677 678 679 680 681
	/*
	 * (~cwd & swd) will mask out exceptions that are not set to unmasked
	 * status.  0x3f is the exception bits in these regs, 0x200 is the
	 * C1 reg you need in case of a stack fault, 0x040 is the stack
	 * fault bit.  We should only be taking one exception at a time,
	 * so if this combination doesn't produce any single exception,
682
	 * then we have a bad program that isn't synchronizing its FPU usage
L
Linus Torvalds 已提交
683 684 685 686 687
	 * and it will suffer the consequences since we won't be able to
	 * fully reproduce the context of the exception
	 */
	cwd = get_fpu_cwd(task);
	swd = get_fpu_swd(task);
688

689
	err = swd & ~cwd;
690 691

	if (err & 0x001) {	/* Invalid op */
I
Ingo Molnar 已提交
692 693 694 695 696 697
		/*
		 * swd & 0x240 == 0x040: Stack Underflow
		 * swd & 0x240 == 0x240: Stack Overflow
		 * User must clear the SF bit (0x40) if set
		 */
		info.si_code = FPE_FLTINV;
698
	} else if (err & 0x004) { /* Divide by Zero */
I
Ingo Molnar 已提交
699
		info.si_code = FPE_FLTDIV;
700
	} else if (err & 0x008) { /* Overflow */
I
Ingo Molnar 已提交
701
		info.si_code = FPE_FLTOVF;
702 703 704
	} else if (err & 0x012) { /* Denormal, Underflow */
		info.si_code = FPE_FLTUND;
	} else if (err & 0x020) { /* Precision */
I
Ingo Molnar 已提交
705
		info.si_code = FPE_FLTRES;
706
	} else {
707 708 709 710
		/*
		 * If we're using IRQ 13, or supposedly even some trap 16
		 * implementations, it's possible we get a spurious trap...
		 */
711
		return;		/* Spurious trap, no error */
L
Linus Torvalds 已提交
712 713 714 715
	}
	force_sig_info(SIGFPE, &info, task);
}

716
dotraplinkage void do_coprocessor_error(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
717
{
718
	conditional_sti(regs);
719 720

#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
721
	ignore_fpu_irq = 1;
722 723 724 725 726 727
#else
	if (!user_mode(regs) &&
	    kernel_math_error(regs, "kernel x87 math error", 16))
		return;
#endif

728
	math_error((void __user *)regs->ip);
L
Linus Torvalds 已提交
729 730
}

731
static void simd_math_error(void __user *ip)
L
Linus Torvalds 已提交
732
{
I
Ingo Molnar 已提交
733 734
	struct task_struct *task;
	siginfo_t info;
735
	unsigned short mxcsr;
L
Linus Torvalds 已提交
736 737 738 739 740 741 742 743 744 745 746

	/*
	 * Save the info for the exception handler and clear the error.
	 */
	task = current;
	save_init_fpu(task);
	task->thread.trap_no = 19;
	task->thread.error_code = 0;
	info.si_signo = SIGFPE;
	info.si_errno = 0;
	info.si_code = __SI_FAULT;
747
	info.si_addr = ip;
L
Linus Torvalds 已提交
748 749 750 751 752 753 754 755
	/*
	 * The SIMD FPU exceptions are handled a little differently, as there
	 * is only a single status/control register.  Thus, to determine which
	 * unmasked exception was caught we must mask the exception mask bits
	 * at 0x1f80, and then use these to mask the exception bits at 0x3f.
	 */
	mxcsr = get_fpu_mxcsr(task);
	switch (~((mxcsr & 0x1f80) >> 7) & (mxcsr & 0x3f)) {
I
Ingo Molnar 已提交
756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774
	case 0x000:
	default:
		break;
	case 0x001: /* Invalid Op */
		info.si_code = FPE_FLTINV;
		break;
	case 0x002: /* Denormalize */
	case 0x010: /* Underflow */
		info.si_code = FPE_FLTUND;
		break;
	case 0x004: /* Zero Divide */
		info.si_code = FPE_FLTDIV;
		break;
	case 0x008: /* Overflow */
		info.si_code = FPE_FLTOVF;
		break;
	case 0x020: /* Precision */
		info.si_code = FPE_FLTRES;
		break;
L
Linus Torvalds 已提交
775 776 777 778
	}
	force_sig_info(SIGFPE, &info, task);
}

779 780
dotraplinkage void
do_simd_coprocessor_error(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
781
{
782 783
	conditional_sti(regs);

784
#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
785 786 787
	if (cpu_has_xmm) {
		/* Handle SIMD FPU exceptions on PIII+ processors. */
		ignore_fpu_irq = 1;
788
		simd_math_error((void __user *)regs->ip);
I
Ingo Molnar 已提交
789 790 791 792 793 794
		return;
	}
	/*
	 * Handle strange cache flush from user space exception
	 * in all other cases.  This is undocumented behaviour.
	 */
795
	if (regs->flags & X86_VM_MASK) {
I
Ingo Molnar 已提交
796 797
		handle_vm86_fault((struct kernel_vm86_regs *)regs, error_code);
		return;
L
Linus Torvalds 已提交
798
	}
I
Ingo Molnar 已提交
799 800 801 802
	current->thread.trap_no = 19;
	current->thread.error_code = error_code;
	die_if_kernel("cache flush denied", regs, error_code);
	force_sig(SIGSEGV, current);
803 804 805 806 807 808
#else
	if (!user_mode(regs) &&
			kernel_math_error(regs, "kernel simd math error", 19))
		return;
	simd_math_error((void __user *)regs->ip);
#endif
L
Linus Torvalds 已提交
809 810
}

811 812
dotraplinkage void
do_spurious_interrupt_bug(struct pt_regs *regs, long error_code)
L
Linus Torvalds 已提交
813
{
814
	conditional_sti(regs);
L
Linus Torvalds 已提交
815 816
#if 0
	/* No need to warn about this any longer. */
I
Ingo Molnar 已提交
817
	printk(KERN_INFO "Ignoring P6 Local APIC Spurious Interrupt Bug...\n");
L
Linus Torvalds 已提交
818 819 820
#endif
}

821
#ifdef CONFIG_X86_32
I
Ingo Molnar 已提交
822
unsigned long patch_espfix_desc(unsigned long uesp, unsigned long kesp)
L
Linus Torvalds 已提交
823
{
G
Glauber Costa 已提交
824
	struct desc_struct *gdt = get_cpu_gdt_table(smp_processor_id());
S
Stas Sergeev 已提交
825 826 827 828
	unsigned long base = (kesp - uesp) & -THREAD_SIZE;
	unsigned long new_kesp = kesp - base;
	unsigned long lim_pages = (new_kesp | (THREAD_SIZE - 1)) >> PAGE_SHIFT;
	__u64 desc = *(__u64 *)&gdt[GDT_ENTRY_ESPFIX_SS];
I
Ingo Molnar 已提交
829

S
Stas Sergeev 已提交
830
	/* Set up base for espfix segment */
I
Ingo Molnar 已提交
831 832
	desc &= 0x00f0ff0000000000ULL;
	desc |=	((((__u64)base) << 16) & 0x000000ffffff0000ULL) |
S
Stas Sergeev 已提交
833 834 835 836
		((((__u64)base) << 32) & 0xff00000000000000ULL) |
		((((__u64)lim_pages) << 32) & 0x000f000000000000ULL) |
		(lim_pages & 0xffff);
	*(__u64 *)&gdt[GDT_ENTRY_ESPFIX_SS] = desc;
I
Ingo Molnar 已提交
837

S
Stas Sergeev 已提交
838
	return new_kesp;
L
Linus Torvalds 已提交
839
}
840 841 842 843 844 845 846 847 848
#else
asmlinkage void __attribute__((weak)) smp_thermal_interrupt(void)
{
}

asmlinkage void __attribute__((weak)) mce_threshold_interrupt(void)
{
}
#endif
L
Linus Torvalds 已提交
849 850

/*
I
Ingo Molnar 已提交
851
 * 'math_state_restore()' saves the current math information in the
L
Linus Torvalds 已提交
852 853 854 855 856 857 858 859
 * old math state array, and gets the new ones from the current task
 *
 * Careful.. There are problems with IBM-designed IRQ13 behaviour.
 * Don't touch unless you *really* know how it works.
 *
 * Must be called with kernel preemption disabled (in this case,
 * local interrupts are disabled at the call-site in entry.S).
 */
860
asmlinkage void math_state_restore(void)
L
Linus Torvalds 已提交
861 862 863 864
{
	struct thread_info *thread = current_thread_info();
	struct task_struct *tsk = thread->task;

865 866 867 868 869 870 871 872 873 874 875 876 877 878 879
	if (!tsk_used_math(tsk)) {
		local_irq_enable();
		/*
		 * does a slab alloc which can sleep
		 */
		if (init_fpu(tsk)) {
			/*
			 * ran out of memory!
			 */
			do_group_exit(SIGKILL);
			return;
		}
		local_irq_disable();
	}

I
Ingo Molnar 已提交
880
	clts();				/* Allow maths ops (or we recurse) */
881
#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
882
	restore_fpu(tsk);
883 884 885 886 887 888 889 890 891 892
#else
	/*
	 * Paranoid restore. send a SIGSEGV if we fail to restore the state.
	 */
	if (unlikely(restore_fpu_checking(tsk))) {
		stts();
		force_sig(SIGSEGV, tsk);
		return;
	}
#endif
L
Linus Torvalds 已提交
893
	thread->status |= TS_USEDFPU;	/* So we fnsave on switch_to() */
894
	tsk->fpu_counter++;
L
Linus Torvalds 已提交
895
}
896
EXPORT_SYMBOL_GPL(math_state_restore);
L
Linus Torvalds 已提交
897 898 899 900

#ifndef CONFIG_MATH_EMULATION
asmlinkage void math_emulate(long arg)
{
I
Ingo Molnar 已提交
901 902 903 904
	printk(KERN_EMERG
		"math-emulation not enabled and no coprocessor found.\n");
	printk(KERN_EMERG "killing %s.\n", current->comm);
	force_sig(SIGFPE, current);
L
Linus Torvalds 已提交
905 906 907 908
	schedule();
}
#endif /* CONFIG_MATH_EMULATION */

909 910
dotraplinkage void __kprobes
do_device_not_available(struct pt_regs *regs, long error)
911
{
912
#ifdef CONFIG_X86_32
913 914 915 916 917 918 919
	if (read_cr0() & X86_CR0_EM) {
		conditional_sti(regs);
		math_emulate(0);
	} else {
		math_state_restore(); /* interrupts still off */
		conditional_sti(regs);
	}
920 921 922
#else
	math_state_restore();
#endif
923 924
}

925
#ifdef CONFIG_X86_32
926
dotraplinkage void do_iret_error(struct pt_regs *regs, long error_code)
927 928 929 930 931 932 933 934 935 936 937
{
	siginfo_t info;
	local_irq_enable();

	info.si_signo = SIGILL;
	info.si_errno = 0;
	info.si_code = ILL_BADSTK;
	info.si_addr = 0;
	if (notify_die(DIE_TRAP, "iret exception",
			regs, error_code, 32, SIGILL) == NOTIFY_STOP)
		return;
938
	do_trap(32, SIGILL, "iret exception", regs, error_code, &info);
939
}
940
#endif
941

L
Linus Torvalds 已提交
942 943
void __init trap_init(void)
{
944 945
	int i;

L
Linus Torvalds 已提交
946
#ifdef CONFIG_EISA
I
Ingo Molnar 已提交
947
	void __iomem *p = early_ioremap(0x0FFFD9, 4);
I
Ingo Molnar 已提交
948 949

	if (readl(p) == 'E' + ('I'<<8) + ('S'<<16) + ('A'<<24))
L
Linus Torvalds 已提交
950
		EISA_bus = 1;
I
Ingo Molnar 已提交
951
	early_iounmap(p, 4);
L
Linus Torvalds 已提交
952 953
#endif

954
	set_intr_gate(0, &divide_error);
955 956 957 958 959 960
	set_intr_gate_ist(1, &debug, DEBUG_STACK);
	set_intr_gate_ist(2, &nmi, NMI_STACK);
	/* int3 can be called from all */
	set_system_intr_gate_ist(3, &int3, DEBUG_STACK);
	/* int4 can be called from all */
	set_system_intr_gate(4, &overflow);
961
	set_intr_gate(5, &bounds);
962
	set_intr_gate(6, &invalid_op);
963
	set_intr_gate(7, &device_not_available);
964
#ifdef CONFIG_X86_32
965
	set_task_gate(8, GDT_ENTRY_DOUBLEFAULT_TSS);
966 967 968
#else
	set_intr_gate_ist(8, &double_fault, DOUBLEFAULT_STACK);
#endif
969
	set_intr_gate(9, &coprocessor_segment_overrun);
970
	set_intr_gate(10, &invalid_TSS);
971
	set_intr_gate(11, &segment_not_present);
972
	set_intr_gate_ist(12, &stack_segment, STACKFAULT_STACK);
973
	set_intr_gate(13, &general_protection);
I
Ingo Molnar 已提交
974
	set_intr_gate(14, &page_fault);
975
	set_intr_gate(15, &spurious_interrupt_bug);
976
	set_intr_gate(16, &coprocessor_error);
977
	set_intr_gate(17, &alignment_check);
L
Linus Torvalds 已提交
978
#ifdef CONFIG_X86_MCE
979
	set_intr_gate_ist(18, &machine_check, MCE_STACK);
L
Linus Torvalds 已提交
980
#endif
981
	set_intr_gate(19, &simd_coprocessor_error);
L
Linus Torvalds 已提交
982

983 984 985 986 987
#ifdef CONFIG_IA32_EMULATION
	set_system_intr_gate(IA32_SYSCALL_VECTOR, ia32_syscall);
#endif

#ifdef CONFIG_X86_32
988 989 990 991 992 993
	if (cpu_has_fxsr) {
		printk(KERN_INFO "Enabling fast FPU save and restore... ");
		set_in_cr4(X86_CR4_OSFXSR);
		printk("done.\n");
	}
	if (cpu_has_xmm) {
I
Ingo Molnar 已提交
994 995
		printk(KERN_INFO
			"Enabling unmasked SIMD FPU exception support... ");
996 997 998 999
		set_in_cr4(X86_CR4_OSXMMEXCPT);
		printk("done.\n");
	}

1000
	set_system_trap_gate(SYSCALL_VECTOR, &system_call);
1001
#endif
L
Linus Torvalds 已提交
1002

I
Ingo Molnar 已提交
1003
	/* Reserve all the builtin and the syscall vector: */
1004 1005
	for (i = 0; i < FIRST_EXTERNAL_VECTOR; i++)
		set_bit(i, used_vectors);
I
Ingo Molnar 已提交
1006

1007 1008 1009
#ifdef CONFIG_X86_64
	set_bit(IA32_SYSCALL_VECTOR, used_vectors);
#else
1010
	set_bit(SYSCALL_VECTOR, used_vectors);
1011
#endif
L
Linus Torvalds 已提交
1012
	/*
I
Ingo Molnar 已提交
1013
	 * Should be a barrier for any external CPU state:
L
Linus Torvalds 已提交
1014 1015 1016
	 */
	cpu_init();

1017
#ifdef CONFIG_X86_32
L
Linus Torvalds 已提交
1018
	trap_init_hook();
1019
#endif
L
Linus Torvalds 已提交
1020
}