Pull video into test branch
[linux-drm-fsl-dcu.git] / arch / i386 / kernel / traps.c
1 /*
2  *  linux/arch/i386/traps.c
3  *
4  *  Copyright (C) 1991, 1992  Linus Torvalds
5  *
6  *  Pentium III FXSR, SSE support
7  *      Gareth Hughes <gareth@valinux.com>, May 2000
8  */
9
10 /*
11  * 'Traps.c' handles hardware traps and faults after we have saved some
12  * state in 'asm.s'.
13  */
14 #include <linux/sched.h>
15 #include <linux/kernel.h>
16 #include <linux/string.h>
17 #include <linux/errno.h>
18 #include <linux/timer.h>
19 #include <linux/mm.h>
20 #include <linux/init.h>
21 #include <linux/delay.h>
22 #include <linux/spinlock.h>
23 #include <linux/interrupt.h>
24 #include <linux/highmem.h>
25 #include <linux/kallsyms.h>
26 #include <linux/ptrace.h>
27 #include <linux/utsname.h>
28 #include <linux/kprobes.h>
29 #include <linux/kexec.h>
30 #include <linux/unwind.h>
31 #include <linux/uaccess.h>
32 #include <linux/nmi.h>
33 #include <linux/bug.h>
34
35 #ifdef CONFIG_EISA
36 #include <linux/ioport.h>
37 #include <linux/eisa.h>
38 #endif
39
40 #ifdef CONFIG_MCA
41 #include <linux/mca.h>
42 #endif
43
44 #include <asm/processor.h>
45 #include <asm/system.h>
46 #include <asm/io.h>
47 #include <asm/atomic.h>
48 #include <asm/debugreg.h>
49 #include <asm/desc.h>
50 #include <asm/i387.h>
51 #include <asm/nmi.h>
52 #include <asm/unwind.h>
53 #include <asm/smp.h>
54 #include <asm/arch_hooks.h>
55 #include <asm/kdebug.h>
56 #include <asm/stacktrace.h>
57
58 #include <linux/module.h>
59
60 #include "mach_traps.h"
61
62 int panic_on_unrecovered_nmi;
63
64 asmlinkage int system_call(void);
65
66 /* Do we ignore FPU interrupts ? */
67 char ignore_fpu_irq = 0;
68
69 /*
70  * The IDT has to be page-aligned to simplify the Pentium
71  * F0 0F bug workaround.. We have a special link segment
72  * for this.
73  */
74 struct desc_struct idt_table[256] __attribute__((__section__(".data.idt"))) = { {0, 0}, };
75
76 asmlinkage void divide_error(void);
77 asmlinkage void debug(void);
78 asmlinkage void nmi(void);
79 asmlinkage void int3(void);
80 asmlinkage void overflow(void);
81 asmlinkage void bounds(void);
82 asmlinkage void invalid_op(void);
83 asmlinkage void device_not_available(void);
84 asmlinkage void coprocessor_segment_overrun(void);
85 asmlinkage void invalid_TSS(void);
86 asmlinkage void segment_not_present(void);
87 asmlinkage void stack_segment(void);
88 asmlinkage void general_protection(void);
89 asmlinkage void page_fault(void);
90 asmlinkage void coprocessor_error(void);
91 asmlinkage void simd_coprocessor_error(void);
92 asmlinkage void alignment_check(void);
93 asmlinkage void spurious_interrupt_bug(void);
94 asmlinkage void machine_check(void);
95
96 int kstack_depth_to_print = 24;
97 ATOMIC_NOTIFIER_HEAD(i386die_chain);
98
99 int register_die_notifier(struct notifier_block *nb)
100 {
101         vmalloc_sync_all();
102         return atomic_notifier_chain_register(&i386die_chain, nb);
103 }
104 EXPORT_SYMBOL(register_die_notifier); /* used modular by kdb */
105
106 int unregister_die_notifier(struct notifier_block *nb)
107 {
108         return atomic_notifier_chain_unregister(&i386die_chain, nb);
109 }
110 EXPORT_SYMBOL(unregister_die_notifier); /* used modular by kdb */
111
112 static inline int valid_stack_ptr(struct thread_info *tinfo, void *p)
113 {
114         return  p > (void *)tinfo &&
115                 p < (void *)tinfo + THREAD_SIZE - 3;
116 }
117
118 static inline unsigned long print_context_stack(struct thread_info *tinfo,
119                                 unsigned long *stack, unsigned long ebp,
120                                 struct stacktrace_ops *ops, void *data)
121 {
122         unsigned long addr;
123
124 #ifdef  CONFIG_FRAME_POINTER
125         while (valid_stack_ptr(tinfo, (void *)ebp)) {
126                 unsigned long new_ebp;
127                 addr = *(unsigned long *)(ebp + 4);
128                 ops->address(data, addr);
129                 /*
130                  * break out of recursive entries (such as
131                  * end_of_stack_stop_unwind_function). Also,
132                  * we can never allow a frame pointer to
133                  * move downwards!
134                  */
135                 new_ebp = *(unsigned long *)ebp;
136                 if (new_ebp <= ebp)
137                         break;
138                 ebp = new_ebp;
139         }
140 #else
141         while (valid_stack_ptr(tinfo, stack)) {
142                 addr = *stack++;
143                 if (__kernel_text_address(addr))
144                         ops->address(data, addr);
145         }
146 #endif
147         return ebp;
148 }
149
150 #define MSG(msg) ops->warning(data, msg)
151
152 void dump_trace(struct task_struct *task, struct pt_regs *regs,
153                 unsigned long *stack,
154                 struct stacktrace_ops *ops, void *data)
155 {
156         unsigned long ebp = 0;
157
158         if (!task)
159                 task = current;
160
161         if (!stack) {
162                 unsigned long dummy;
163                 stack = &dummy;
164                 if (task && task != current)
165                         stack = (unsigned long *)task->thread.esp;
166         }
167
168 #ifdef CONFIG_FRAME_POINTER
169         if (!ebp) {
170                 if (task == current) {
171                         /* Grab ebp right from our regs */
172                         asm ("movl %%ebp, %0" : "=r" (ebp) : );
173                 } else {
174                         /* ebp is the last reg pushed by switch_to */
175                         ebp = *(unsigned long *) task->thread.esp;
176                 }
177         }
178 #endif
179
180         while (1) {
181                 struct thread_info *context;
182                 context = (struct thread_info *)
183                         ((unsigned long)stack & (~(THREAD_SIZE - 1)));
184                 ebp = print_context_stack(context, stack, ebp, ops, data);
185                 /* Should be after the line below, but somewhere
186                    in early boot context comes out corrupted and we
187                    can't reference it -AK */
188                 if (ops->stack(data, "IRQ") < 0)
189                         break;
190                 stack = (unsigned long*)context->previous_esp;
191                 if (!stack)
192                         break;
193                 touch_nmi_watchdog();
194         }
195 }
196 EXPORT_SYMBOL(dump_trace);
197
198 static void
199 print_trace_warning_symbol(void *data, char *msg, unsigned long symbol)
200 {
201         printk(data);
202         print_symbol(msg, symbol);
203         printk("\n");
204 }
205
206 static void print_trace_warning(void *data, char *msg)
207 {
208         printk("%s%s\n", (char *)data, msg);
209 }
210
211 static int print_trace_stack(void *data, char *name)
212 {
213         return 0;
214 }
215
216 /*
217  * Print one address/symbol entries per line.
218  */
219 static void print_trace_address(void *data, unsigned long addr)
220 {
221         printk("%s [<%08lx>] ", (char *)data, addr);
222         print_symbol("%s\n", addr);
223 }
224
225 static struct stacktrace_ops print_trace_ops = {
226         .warning = print_trace_warning,
227         .warning_symbol = print_trace_warning_symbol,
228         .stack = print_trace_stack,
229         .address = print_trace_address,
230 };
231
232 static void
233 show_trace_log_lvl(struct task_struct *task, struct pt_regs *regs,
234                    unsigned long * stack, char *log_lvl)
235 {
236         dump_trace(task, regs, stack, &print_trace_ops, log_lvl);
237         printk("%s =======================\n", log_lvl);
238 }
239
240 void show_trace(struct task_struct *task, struct pt_regs *regs,
241                 unsigned long * stack)
242 {
243         show_trace_log_lvl(task, regs, stack, "");
244 }
245
246 static void show_stack_log_lvl(struct task_struct *task, struct pt_regs *regs,
247                                unsigned long *esp, char *log_lvl)
248 {
249         unsigned long *stack;
250         int i;
251
252         if (esp == NULL) {
253                 if (task)
254                         esp = (unsigned long*)task->thread.esp;
255                 else
256                         esp = (unsigned long *)&esp;
257         }
258
259         stack = esp;
260         for(i = 0; i < kstack_depth_to_print; i++) {
261                 if (kstack_end(stack))
262                         break;
263                 if (i && ((i % 8) == 0))
264                         printk("\n%s       ", log_lvl);
265                 printk("%08lx ", *stack++);
266         }
267         printk("\n%sCall Trace:\n", log_lvl);
268         show_trace_log_lvl(task, regs, esp, log_lvl);
269 }
270
271 void show_stack(struct task_struct *task, unsigned long *esp)
272 {
273         printk("       ");
274         show_stack_log_lvl(task, NULL, esp, "");
275 }
276
277 /*
278  * The architecture-independent dump_stack generator
279  */
280 void dump_stack(void)
281 {
282         unsigned long stack;
283
284         show_trace(current, NULL, &stack);
285 }
286
287 EXPORT_SYMBOL(dump_stack);
288
289 void show_registers(struct pt_regs *regs)
290 {
291         int i;
292         int in_kernel = 1;
293         unsigned long esp;
294         unsigned short ss;
295
296         esp = (unsigned long) (&regs->esp);
297         savesegment(ss, ss);
298         if (user_mode_vm(regs)) {
299                 in_kernel = 0;
300                 esp = regs->esp;
301                 ss = regs->xss & 0xffff;
302         }
303         print_modules();
304         printk(KERN_EMERG "CPU:    %d\n"
305                 KERN_EMERG "EIP:    %04x:[<%08lx>]    %s VLI\n"
306                 KERN_EMERG "EFLAGS: %08lx   (%s %.*s)\n",
307                 smp_processor_id(), 0xffff & regs->xcs, regs->eip,
308                 print_tainted(), regs->eflags, init_utsname()->release,
309                 (int)strcspn(init_utsname()->version, " "),
310                 init_utsname()->version);
311         print_symbol(KERN_EMERG "EIP is at %s\n", regs->eip);
312         printk(KERN_EMERG "eax: %08lx   ebx: %08lx   ecx: %08lx   edx: %08lx\n",
313                 regs->eax, regs->ebx, regs->ecx, regs->edx);
314         printk(KERN_EMERG "esi: %08lx   edi: %08lx   ebp: %08lx   esp: %08lx\n",
315                 regs->esi, regs->edi, regs->ebp, esp);
316         printk(KERN_EMERG "ds: %04x   es: %04x   ss: %04x\n",
317                 regs->xds & 0xffff, regs->xes & 0xffff, ss);
318         printk(KERN_EMERG "Process %.*s (pid: %d, ti=%p task=%p task.ti=%p)",
319                 TASK_COMM_LEN, current->comm, current->pid,
320                 current_thread_info(), current, current->thread_info);
321         /*
322          * When in-kernel, we also print out the stack and code at the
323          * time of the fault..
324          */
325         if (in_kernel) {
326                 u8 *eip;
327                 int code_bytes = 64;
328                 unsigned char c;
329
330                 printk("\n" KERN_EMERG "Stack: ");
331                 show_stack_log_lvl(NULL, regs, (unsigned long *)esp, KERN_EMERG);
332
333                 printk(KERN_EMERG "Code: ");
334
335                 eip = (u8 *)regs->eip - 43;
336                 if (eip < (u8 *)PAGE_OFFSET ||
337                         probe_kernel_address(eip, c)) {
338                         /* try starting at EIP */
339                         eip = (u8 *)regs->eip;
340                         code_bytes = 32;
341                 }
342                 for (i = 0; i < code_bytes; i++, eip++) {
343                         if (eip < (u8 *)PAGE_OFFSET ||
344                                 probe_kernel_address(eip, c)) {
345                                 printk(" Bad EIP value.");
346                                 break;
347                         }
348                         if (eip == (u8 *)regs->eip)
349                                 printk("<%02x> ", c);
350                         else
351                                 printk("%02x ", c);
352                 }
353         }
354         printk("\n");
355 }       
356
357 int is_valid_bugaddr(unsigned long eip)
358 {
359         unsigned short ud2;
360
361         if (eip < PAGE_OFFSET)
362                 return 0;
363         if (probe_kernel_address((unsigned short *)eip, ud2))
364                 return 0;
365
366         return ud2 == 0x0b0f;
367 }
368
369 /*
370  * This is gone through when something in the kernel has done something bad and
371  * is about to be terminated.
372  */
373 void die(const char * str, struct pt_regs * regs, long err)
374 {
375         static struct {
376                 spinlock_t lock;
377                 u32 lock_owner;
378                 int lock_owner_depth;
379         } die = {
380                 .lock =                 __SPIN_LOCK_UNLOCKED(die.lock),
381                 .lock_owner =           -1,
382                 .lock_owner_depth =     0
383         };
384         static int die_counter;
385         unsigned long flags;
386
387         oops_enter();
388
389         if (die.lock_owner != raw_smp_processor_id()) {
390                 console_verbose();
391                 spin_lock_irqsave(&die.lock, flags);
392                 die.lock_owner = smp_processor_id();
393                 die.lock_owner_depth = 0;
394                 bust_spinlocks(1);
395         }
396         else
397                 local_save_flags(flags);
398
399         if (++die.lock_owner_depth < 3) {
400                 int nl = 0;
401                 unsigned long esp;
402                 unsigned short ss;
403
404                 report_bug(regs->eip);
405
406                 printk(KERN_EMERG "%s: %04lx [#%d]\n", str, err & 0xffff, ++die_counter);
407 #ifdef CONFIG_PREEMPT
408                 printk(KERN_EMERG "PREEMPT ");
409                 nl = 1;
410 #endif
411 #ifdef CONFIG_SMP
412                 if (!nl)
413                         printk(KERN_EMERG);
414                 printk("SMP ");
415                 nl = 1;
416 #endif
417 #ifdef CONFIG_DEBUG_PAGEALLOC
418                 if (!nl)
419                         printk(KERN_EMERG);
420                 printk("DEBUG_PAGEALLOC");
421                 nl = 1;
422 #endif
423                 if (nl)
424                         printk("\n");
425                 if (notify_die(DIE_OOPS, str, regs, err,
426                                         current->thread.trap_no, SIGSEGV) !=
427                                 NOTIFY_STOP) {
428                         show_registers(regs);
429                         /* Executive summary in case the oops scrolled away */
430                         esp = (unsigned long) (&regs->esp);
431                         savesegment(ss, ss);
432                         if (user_mode(regs)) {
433                                 esp = regs->esp;
434                                 ss = regs->xss & 0xffff;
435                         }
436                         printk(KERN_EMERG "EIP: [<%08lx>] ", regs->eip);
437                         print_symbol("%s", regs->eip);
438                         printk(" SS:ESP %04x:%08lx\n", ss, esp);
439                 }
440                 else
441                         regs = NULL;
442         } else
443                 printk(KERN_EMERG "Recursive die() failure, output suppressed\n");
444
445         bust_spinlocks(0);
446         die.lock_owner = -1;
447         spin_unlock_irqrestore(&die.lock, flags);
448
449         if (!regs)
450                 return;
451
452         if (kexec_should_crash(current))
453                 crash_kexec(regs);
454
455         if (in_interrupt())
456                 panic("Fatal exception in interrupt");
457
458         if (panic_on_oops)
459                 panic("Fatal exception");
460
461         oops_exit();
462         do_exit(SIGSEGV);
463 }
464
465 static inline void die_if_kernel(const char * str, struct pt_regs * regs, long err)
466 {
467         if (!user_mode_vm(regs))
468                 die(str, regs, err);
469 }
470
471 static void __kprobes do_trap(int trapnr, int signr, char *str, int vm86,
472                               struct pt_regs * regs, long error_code,
473                               siginfo_t *info)
474 {
475         struct task_struct *tsk = current;
476         tsk->thread.error_code = error_code;
477         tsk->thread.trap_no = trapnr;
478
479         if (regs->eflags & VM_MASK) {
480                 if (vm86)
481                         goto vm86_trap;
482                 goto trap_signal;
483         }
484
485         if (!user_mode(regs))
486                 goto kernel_trap;
487
488         trap_signal: {
489                 if (info)
490                         force_sig_info(signr, info, tsk);
491                 else
492                         force_sig(signr, tsk);
493                 return;
494         }
495
496         kernel_trap: {
497                 if (!fixup_exception(regs))
498                         die(str, regs, error_code);
499                 return;
500         }
501
502         vm86_trap: {
503                 int ret = handle_vm86_trap((struct kernel_vm86_regs *) regs, error_code, trapnr);
504                 if (ret) goto trap_signal;
505                 return;
506         }
507 }
508
509 #define DO_ERROR(trapnr, signr, str, name) \
510 fastcall void do_##name(struct pt_regs * regs, long error_code) \
511 { \
512         if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr) \
513                                                 == NOTIFY_STOP) \
514                 return; \
515         do_trap(trapnr, signr, str, 0, regs, error_code, NULL); \
516 }
517
518 #define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr) \
519 fastcall void do_##name(struct pt_regs * regs, long error_code) \
520 { \
521         siginfo_t info; \
522         info.si_signo = signr; \
523         info.si_errno = 0; \
524         info.si_code = sicode; \
525         info.si_addr = (void __user *)siaddr; \
526         if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr) \
527                                                 == NOTIFY_STOP) \
528                 return; \
529         do_trap(trapnr, signr, str, 0, regs, error_code, &info); \
530 }
531
532 #define DO_VM86_ERROR(trapnr, signr, str, name) \
533 fastcall void do_##name(struct pt_regs * regs, long error_code) \
534 { \
535         if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr) \
536                                                 == NOTIFY_STOP) \
537                 return; \
538         do_trap(trapnr, signr, str, 1, regs, error_code, NULL); \
539 }
540
541 #define DO_VM86_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr) \
542 fastcall void do_##name(struct pt_regs * regs, long error_code) \
543 { \
544         siginfo_t info; \
545         info.si_signo = signr; \
546         info.si_errno = 0; \
547         info.si_code = sicode; \
548         info.si_addr = (void __user *)siaddr; \
549         if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr) \
550                                                 == NOTIFY_STOP) \
551                 return; \
552         do_trap(trapnr, signr, str, 1, regs, error_code, &info); \
553 }
554
555 DO_VM86_ERROR_INFO( 0, SIGFPE,  "divide error", divide_error, FPE_INTDIV, regs->eip)
556 #ifndef CONFIG_KPROBES
557 DO_VM86_ERROR( 3, SIGTRAP, "int3", int3)
558 #endif
559 DO_VM86_ERROR( 4, SIGSEGV, "overflow", overflow)
560 DO_VM86_ERROR( 5, SIGSEGV, "bounds", bounds)
561 DO_ERROR_INFO( 6, SIGILL,  "invalid opcode", invalid_op, ILL_ILLOPN, regs->eip)
562 DO_ERROR( 9, SIGFPE,  "coprocessor segment overrun", coprocessor_segment_overrun)
563 DO_ERROR(10, SIGSEGV, "invalid TSS", invalid_TSS)
564 DO_ERROR(11, SIGBUS,  "segment not present", segment_not_present)
565 DO_ERROR(12, SIGBUS,  "stack segment", stack_segment)
566 DO_ERROR_INFO(17, SIGBUS, "alignment check", alignment_check, BUS_ADRALN, 0)
567 DO_ERROR_INFO(32, SIGSEGV, "iret exception", iret_error, ILL_BADSTK, 0)
568
569 fastcall void __kprobes do_general_protection(struct pt_regs * regs,
570                                               long error_code)
571 {
572         int cpu = get_cpu();
573         struct tss_struct *tss = &per_cpu(init_tss, cpu);
574         struct thread_struct *thread = &current->thread;
575
576         /*
577          * Perform the lazy TSS's I/O bitmap copy. If the TSS has an
578          * invalid offset set (the LAZY one) and the faulting thread has
579          * a valid I/O bitmap pointer, we copy the I/O bitmap in the TSS
580          * and we set the offset field correctly. Then we let the CPU to
581          * restart the faulting instruction.
582          */
583         if (tss->io_bitmap_base == INVALID_IO_BITMAP_OFFSET_LAZY &&
584             thread->io_bitmap_ptr) {
585                 memcpy(tss->io_bitmap, thread->io_bitmap_ptr,
586                        thread->io_bitmap_max);
587                 /*
588                  * If the previously set map was extending to higher ports
589                  * than the current one, pad extra space with 0xff (no access).
590                  */
591                 if (thread->io_bitmap_max < tss->io_bitmap_max)
592                         memset((char *) tss->io_bitmap +
593                                 thread->io_bitmap_max, 0xff,
594                                 tss->io_bitmap_max - thread->io_bitmap_max);
595                 tss->io_bitmap_max = thread->io_bitmap_max;
596                 tss->io_bitmap_base = IO_BITMAP_OFFSET;
597                 tss->io_bitmap_owner = thread;
598                 put_cpu();
599                 return;
600         }
601         put_cpu();
602
603         current->thread.error_code = error_code;
604         current->thread.trap_no = 13;
605
606         if (regs->eflags & VM_MASK)
607                 goto gp_in_vm86;
608
609         if (!user_mode(regs))
610                 goto gp_in_kernel;
611
612         current->thread.error_code = error_code;
613         current->thread.trap_no = 13;
614         force_sig(SIGSEGV, current);
615         return;
616
617 gp_in_vm86:
618         local_irq_enable();
619         handle_vm86_fault((struct kernel_vm86_regs *) regs, error_code);
620         return;
621
622 gp_in_kernel:
623         if (!fixup_exception(regs)) {
624                 if (notify_die(DIE_GPF, "general protection fault", regs,
625                                 error_code, 13, SIGSEGV) == NOTIFY_STOP)
626                         return;
627                 die("general protection fault", regs, error_code);
628         }
629 }
630
631 static __kprobes void
632 mem_parity_error(unsigned char reason, struct pt_regs * regs)
633 {
634         printk(KERN_EMERG "Uhhuh. NMI received for unknown reason %02x on "
635                 "CPU %d.\n", reason, smp_processor_id());
636         printk(KERN_EMERG "You have some hardware problem, likely on the PCI bus.\n");
637         if (panic_on_unrecovered_nmi)
638                 panic("NMI: Not continuing");
639
640         printk(KERN_EMERG "Dazed and confused, but trying to continue\n");
641
642         /* Clear and disable the memory parity error line. */
643         clear_mem_error(reason);
644 }
645
646 static __kprobes void
647 io_check_error(unsigned char reason, struct pt_regs * regs)
648 {
649         unsigned long i;
650
651         printk(KERN_EMERG "NMI: IOCK error (debug interrupt?)\n");
652         show_registers(regs);
653
654         /* Re-enable the IOCK line, wait for a few seconds */
655         reason = (reason & 0xf) | 8;
656         outb(reason, 0x61);
657         i = 2000;
658         while (--i) udelay(1000);
659         reason &= ~8;
660         outb(reason, 0x61);
661 }
662
663 static __kprobes void
664 unknown_nmi_error(unsigned char reason, struct pt_regs * regs)
665 {
666 #ifdef CONFIG_MCA
667         /* Might actually be able to figure out what the guilty party
668         * is. */
669         if( MCA_bus ) {
670                 mca_handle_nmi();
671                 return;
672         }
673 #endif
674         printk(KERN_EMERG "Uhhuh. NMI received for unknown reason %02x on "
675                 "CPU %d.\n", reason, smp_processor_id());
676         printk(KERN_EMERG "Do you have a strange power saving mode enabled?\n");
677         if (panic_on_unrecovered_nmi)
678                 panic("NMI: Not continuing");
679
680         printk(KERN_EMERG "Dazed and confused, but trying to continue\n");
681 }
682
683 static DEFINE_SPINLOCK(nmi_print_lock);
684
685 void __kprobes die_nmi(struct pt_regs *regs, const char *msg)
686 {
687         if (notify_die(DIE_NMIWATCHDOG, msg, regs, 0, 2, SIGINT) ==
688             NOTIFY_STOP)
689                 return;
690
691         spin_lock(&nmi_print_lock);
692         /*
693         * We are in trouble anyway, lets at least try
694         * to get a message out.
695         */
696         bust_spinlocks(1);
697         printk(KERN_EMERG "%s", msg);
698         printk(" on CPU%d, eip %08lx, registers:\n",
699                 smp_processor_id(), regs->eip);
700         show_registers(regs);
701         console_silent();
702         spin_unlock(&nmi_print_lock);
703         bust_spinlocks(0);
704
705         /* If we are in kernel we are probably nested up pretty bad
706          * and might aswell get out now while we still can.
707         */
708         if (!user_mode_vm(regs)) {
709                 current->thread.trap_no = 2;
710                 crash_kexec(regs);
711         }
712
713         do_exit(SIGSEGV);
714 }
715
716 static __kprobes void default_do_nmi(struct pt_regs * regs)
717 {
718         unsigned char reason = 0;
719
720         /* Only the BSP gets external NMIs from the system.  */
721         if (!smp_processor_id())
722                 reason = get_nmi_reason();
723  
724         if (!(reason & 0xc0)) {
725                 if (notify_die(DIE_NMI_IPI, "nmi_ipi", regs, reason, 2, SIGINT)
726                                                         == NOTIFY_STOP)
727                         return;
728 #ifdef CONFIG_X86_LOCAL_APIC
729                 /*
730                  * Ok, so this is none of the documented NMI sources,
731                  * so it must be the NMI watchdog.
732                  */
733                 if (nmi_watchdog_tick(regs, reason))
734                         return;
735                 if (!do_nmi_callback(regs, smp_processor_id()))
736 #endif
737                         unknown_nmi_error(reason, regs);
738
739                 return;
740         }
741         if (notify_die(DIE_NMI, "nmi", regs, reason, 2, SIGINT) == NOTIFY_STOP)
742                 return;
743         if (reason & 0x80)
744                 mem_parity_error(reason, regs);
745         if (reason & 0x40)
746                 io_check_error(reason, regs);
747         /*
748          * Reassert NMI in case it became active meanwhile
749          * as it's edge-triggered.
750          */
751         reassert_nmi();
752 }
753
754 fastcall __kprobes void do_nmi(struct pt_regs * regs, long error_code)
755 {
756         int cpu;
757
758         nmi_enter();
759
760         cpu = smp_processor_id();
761
762         ++nmi_count(cpu);
763
764         default_do_nmi(regs);
765
766         nmi_exit();
767 }
768
769 #ifdef CONFIG_KPROBES
770 fastcall void __kprobes do_int3(struct pt_regs *regs, long error_code)
771 {
772         if (notify_die(DIE_INT3, "int3", regs, error_code, 3, SIGTRAP)
773                         == NOTIFY_STOP)
774                 return;
775         /* This is an interrupt gate, because kprobes wants interrupts
776         disabled.  Normal trap handlers don't. */
777         restore_interrupts(regs);
778         do_trap(3, SIGTRAP, "int3", 1, regs, error_code, NULL);
779 }
780 #endif
781
782 /*
783  * Our handling of the processor debug registers is non-trivial.
784  * We do not clear them on entry and exit from the kernel. Therefore
785  * it is possible to get a watchpoint trap here from inside the kernel.
786  * However, the code in ./ptrace.c has ensured that the user can
787  * only set watchpoints on userspace addresses. Therefore the in-kernel
788  * watchpoint trap can only occur in code which is reading/writing
789  * from user space. Such code must not hold kernel locks (since it
790  * can equally take a page fault), therefore it is safe to call
791  * force_sig_info even though that claims and releases locks.
792  * 
793  * Code in ./signal.c ensures that the debug control register
794  * is restored before we deliver any signal, and therefore that
795  * user code runs with the correct debug control register even though
796  * we clear it here.
797  *
798  * Being careful here means that we don't have to be as careful in a
799  * lot of more complicated places (task switching can be a bit lazy
800  * about restoring all the debug state, and ptrace doesn't have to
801  * find every occurrence of the TF bit that could be saved away even
802  * by user code)
803  */
804 fastcall void __kprobes do_debug(struct pt_regs * regs, long error_code)
805 {
806         unsigned int condition;
807         struct task_struct *tsk = current;
808
809         get_debugreg(condition, 6);
810
811         if (notify_die(DIE_DEBUG, "debug", regs, condition, error_code,
812                                         SIGTRAP) == NOTIFY_STOP)
813                 return;
814         /* It's safe to allow irq's after DR6 has been saved */
815         if (regs->eflags & X86_EFLAGS_IF)
816                 local_irq_enable();
817
818         /* Mask out spurious debug traps due to lazy DR7 setting */
819         if (condition & (DR_TRAP0|DR_TRAP1|DR_TRAP2|DR_TRAP3)) {
820                 if (!tsk->thread.debugreg[7])
821                         goto clear_dr7;
822         }
823
824         if (regs->eflags & VM_MASK)
825                 goto debug_vm86;
826
827         /* Save debug status register where ptrace can see it */
828         tsk->thread.debugreg[6] = condition;
829
830         /*
831          * Single-stepping through TF: make sure we ignore any events in
832          * kernel space (but re-enable TF when returning to user mode).
833          */
834         if (condition & DR_STEP) {
835                 /*
836                  * We already checked v86 mode above, so we can
837                  * check for kernel mode by just checking the CPL
838                  * of CS.
839                  */
840                 if (!user_mode(regs))
841                         goto clear_TF_reenable;
842         }
843
844         /* Ok, finally something we can handle */
845         send_sigtrap(tsk, regs, error_code);
846
847         /* Disable additional traps. They'll be re-enabled when
848          * the signal is delivered.
849          */
850 clear_dr7:
851         set_debugreg(0, 7);
852         return;
853
854 debug_vm86:
855         handle_vm86_trap((struct kernel_vm86_regs *) regs, error_code, 1);
856         return;
857
858 clear_TF_reenable:
859         set_tsk_thread_flag(tsk, TIF_SINGLESTEP);
860         regs->eflags &= ~TF_MASK;
861         return;
862 }
863
864 /*
865  * Note that we play around with the 'TS' bit in an attempt to get
866  * the correct behaviour even in the presence of the asynchronous
867  * IRQ13 behaviour
868  */
869 void math_error(void __user *eip)
870 {
871         struct task_struct * task;
872         siginfo_t info;
873         unsigned short cwd, swd;
874
875         /*
876          * Save the info for the exception handler and clear the error.
877          */
878         task = current;
879         save_init_fpu(task);
880         task->thread.trap_no = 16;
881         task->thread.error_code = 0;
882         info.si_signo = SIGFPE;
883         info.si_errno = 0;
884         info.si_code = __SI_FAULT;
885         info.si_addr = eip;
886         /*
887          * (~cwd & swd) will mask out exceptions that are not set to unmasked
888          * status.  0x3f is the exception bits in these regs, 0x200 is the
889          * C1 reg you need in case of a stack fault, 0x040 is the stack
890          * fault bit.  We should only be taking one exception at a time,
891          * so if this combination doesn't produce any single exception,
892          * then we have a bad program that isn't syncronizing its FPU usage
893          * and it will suffer the consequences since we won't be able to
894          * fully reproduce the context of the exception
895          */
896         cwd = get_fpu_cwd(task);
897         swd = get_fpu_swd(task);
898         switch (swd & ~cwd & 0x3f) {
899                 case 0x000: /* No unmasked exception */
900                         return;
901                 default:    /* Multiple exceptions */
902                         break;
903                 case 0x001: /* Invalid Op */
904                         /*
905                          * swd & 0x240 == 0x040: Stack Underflow
906                          * swd & 0x240 == 0x240: Stack Overflow
907                          * User must clear the SF bit (0x40) if set
908                          */
909                         info.si_code = FPE_FLTINV;
910                         break;
911                 case 0x002: /* Denormalize */
912                 case 0x010: /* Underflow */
913                         info.si_code = FPE_FLTUND;
914                         break;
915                 case 0x004: /* Zero Divide */
916                         info.si_code = FPE_FLTDIV;
917                         break;
918                 case 0x008: /* Overflow */
919                         info.si_code = FPE_FLTOVF;
920                         break;
921                 case 0x020: /* Precision */
922                         info.si_code = FPE_FLTRES;
923                         break;
924         }
925         force_sig_info(SIGFPE, &info, task);
926 }
927
928 fastcall void do_coprocessor_error(struct pt_regs * regs, long error_code)
929 {
930         ignore_fpu_irq = 1;
931         math_error((void __user *)regs->eip);
932 }
933
934 static void simd_math_error(void __user *eip)
935 {
936         struct task_struct * task;
937         siginfo_t info;
938         unsigned short mxcsr;
939
940         /*
941          * Save the info for the exception handler and clear the error.
942          */
943         task = current;
944         save_init_fpu(task);
945         task->thread.trap_no = 19;
946         task->thread.error_code = 0;
947         info.si_signo = SIGFPE;
948         info.si_errno = 0;
949         info.si_code = __SI_FAULT;
950         info.si_addr = eip;
951         /*
952          * The SIMD FPU exceptions are handled a little differently, as there
953          * is only a single status/control register.  Thus, to determine which
954          * unmasked exception was caught we must mask the exception mask bits
955          * at 0x1f80, and then use these to mask the exception bits at 0x3f.
956          */
957         mxcsr = get_fpu_mxcsr(task);
958         switch (~((mxcsr & 0x1f80) >> 7) & (mxcsr & 0x3f)) {
959                 case 0x000:
960                 default:
961                         break;
962                 case 0x001: /* Invalid Op */
963                         info.si_code = FPE_FLTINV;
964                         break;
965                 case 0x002: /* Denormalize */
966                 case 0x010: /* Underflow */
967                         info.si_code = FPE_FLTUND;
968                         break;
969                 case 0x004: /* Zero Divide */
970                         info.si_code = FPE_FLTDIV;
971                         break;
972                 case 0x008: /* Overflow */
973                         info.si_code = FPE_FLTOVF;
974                         break;
975                 case 0x020: /* Precision */
976                         info.si_code = FPE_FLTRES;
977                         break;
978         }
979         force_sig_info(SIGFPE, &info, task);
980 }
981
982 fastcall void do_simd_coprocessor_error(struct pt_regs * regs,
983                                           long error_code)
984 {
985         if (cpu_has_xmm) {
986                 /* Handle SIMD FPU exceptions on PIII+ processors. */
987                 ignore_fpu_irq = 1;
988                 simd_math_error((void __user *)regs->eip);
989         } else {
990                 /*
991                  * Handle strange cache flush from user space exception
992                  * in all other cases.  This is undocumented behaviour.
993                  */
994                 if (regs->eflags & VM_MASK) {
995                         handle_vm86_fault((struct kernel_vm86_regs *)regs,
996                                           error_code);
997                         return;
998                 }
999                 current->thread.trap_no = 19;
1000                 current->thread.error_code = error_code;
1001                 die_if_kernel("cache flush denied", regs, error_code);
1002                 force_sig(SIGSEGV, current);
1003         }
1004 }
1005
1006 fastcall void do_spurious_interrupt_bug(struct pt_regs * regs,
1007                                           long error_code)
1008 {
1009 #if 0
1010         /* No need to warn about this any longer. */
1011         printk("Ignoring P6 Local APIC Spurious Interrupt Bug...\n");
1012 #endif
1013 }
1014
1015 fastcall unsigned long patch_espfix_desc(unsigned long uesp,
1016                                           unsigned long kesp)
1017 {
1018         int cpu = smp_processor_id();
1019         struct Xgt_desc_struct *cpu_gdt_descr = &per_cpu(cpu_gdt_descr, cpu);
1020         struct desc_struct *gdt = (struct desc_struct *)cpu_gdt_descr->address;
1021         unsigned long base = (kesp - uesp) & -THREAD_SIZE;
1022         unsigned long new_kesp = kesp - base;
1023         unsigned long lim_pages = (new_kesp | (THREAD_SIZE - 1)) >> PAGE_SHIFT;
1024         __u64 desc = *(__u64 *)&gdt[GDT_ENTRY_ESPFIX_SS];
1025         /* Set up base for espfix segment */
1026         desc &= 0x00f0ff0000000000ULL;
1027         desc |= ((((__u64)base) << 16) & 0x000000ffffff0000ULL) |
1028                 ((((__u64)base) << 32) & 0xff00000000000000ULL) |
1029                 ((((__u64)lim_pages) << 32) & 0x000f000000000000ULL) |
1030                 (lim_pages & 0xffff);
1031         *(__u64 *)&gdt[GDT_ENTRY_ESPFIX_SS] = desc;
1032         return new_kesp;
1033 }
1034
1035 /*
1036  *  'math_state_restore()' saves the current math information in the
1037  * old math state array, and gets the new ones from the current task
1038  *
1039  * Careful.. There are problems with IBM-designed IRQ13 behaviour.
1040  * Don't touch unless you *really* know how it works.
1041  *
1042  * Must be called with kernel preemption disabled (in this case,
1043  * local interrupts are disabled at the call-site in entry.S).
1044  */
1045 asmlinkage void math_state_restore(void)
1046 {
1047         struct thread_info *thread = current_thread_info();
1048         struct task_struct *tsk = thread->task;
1049
1050         clts();         /* Allow maths ops (or we recurse) */
1051         if (!tsk_used_math(tsk))
1052                 init_fpu(tsk);
1053         restore_fpu(tsk);
1054         thread->status |= TS_USEDFPU;   /* So we fnsave on switch_to() */
1055         tsk->fpu_counter++;
1056 }
1057
1058 #ifndef CONFIG_MATH_EMULATION
1059
1060 asmlinkage void math_emulate(long arg)
1061 {
1062         printk(KERN_EMERG "math-emulation not enabled and no coprocessor found.\n");
1063         printk(KERN_EMERG "killing %s.\n",current->comm);
1064         force_sig(SIGFPE,current);
1065         schedule();
1066 }
1067
1068 #endif /* CONFIG_MATH_EMULATION */
1069
1070 #ifdef CONFIG_X86_F00F_BUG
1071 void __init trap_init_f00f_bug(void)
1072 {
1073         __set_fixmap(FIX_F00F_IDT, __pa(&idt_table), PAGE_KERNEL_RO);
1074
1075         /*
1076          * Update the IDT descriptor and reload the IDT so that
1077          * it uses the read-only mapped virtual address.
1078          */
1079         idt_descr.address = fix_to_virt(FIX_F00F_IDT);
1080         load_idt(&idt_descr);
1081 }
1082 #endif
1083
1084 /*
1085  * This needs to use 'idt_table' rather than 'idt', and
1086  * thus use the _nonmapped_ version of the IDT, as the
1087  * Pentium F0 0F bugfix can have resulted in the mapped
1088  * IDT being write-protected.
1089  */
1090 void set_intr_gate(unsigned int n, void *addr)
1091 {
1092         _set_gate(n, DESCTYPE_INT, addr, __KERNEL_CS);
1093 }
1094
1095 /*
1096  * This routine sets up an interrupt gate at directory privilege level 3.
1097  */
1098 static inline void set_system_intr_gate(unsigned int n, void *addr)
1099 {
1100         _set_gate(n, DESCTYPE_INT | DESCTYPE_DPL3, addr, __KERNEL_CS);
1101 }
1102
1103 static void __init set_trap_gate(unsigned int n, void *addr)
1104 {
1105         _set_gate(n, DESCTYPE_TRAP, addr, __KERNEL_CS);
1106 }
1107
1108 static void __init set_system_gate(unsigned int n, void *addr)
1109 {
1110         _set_gate(n, DESCTYPE_TRAP | DESCTYPE_DPL3, addr, __KERNEL_CS);
1111 }
1112
1113 static void __init set_task_gate(unsigned int n, unsigned int gdt_entry)
1114 {
1115         _set_gate(n, DESCTYPE_TASK, (void *)0, (gdt_entry<<3));
1116 }
1117
1118
1119 void __init trap_init(void)
1120 {
1121 #ifdef CONFIG_EISA
1122         void __iomem *p = ioremap(0x0FFFD9, 4);
1123         if (readl(p) == 'E'+('I'<<8)+('S'<<16)+('A'<<24)) {
1124                 EISA_bus = 1;
1125         }
1126         iounmap(p);
1127 #endif
1128
1129 #ifdef CONFIG_X86_LOCAL_APIC
1130         init_apic_mappings();
1131 #endif
1132
1133         set_trap_gate(0,&divide_error);
1134         set_intr_gate(1,&debug);
1135         set_intr_gate(2,&nmi);
1136         set_system_intr_gate(3, &int3); /* int3/4 can be called from all */
1137         set_system_gate(4,&overflow);
1138         set_trap_gate(5,&bounds);
1139         set_trap_gate(6,&invalid_op);
1140         set_trap_gate(7,&device_not_available);
1141         set_task_gate(8,GDT_ENTRY_DOUBLEFAULT_TSS);
1142         set_trap_gate(9,&coprocessor_segment_overrun);
1143         set_trap_gate(10,&invalid_TSS);
1144         set_trap_gate(11,&segment_not_present);
1145         set_trap_gate(12,&stack_segment);
1146         set_trap_gate(13,&general_protection);
1147         set_intr_gate(14,&page_fault);
1148         set_trap_gate(15,&spurious_interrupt_bug);
1149         set_trap_gate(16,&coprocessor_error);
1150         set_trap_gate(17,&alignment_check);
1151 #ifdef CONFIG_X86_MCE
1152         set_trap_gate(18,&machine_check);
1153 #endif
1154         set_trap_gate(19,&simd_coprocessor_error);
1155
1156         if (cpu_has_fxsr) {
1157                 /*
1158                  * Verify that the FXSAVE/FXRSTOR data will be 16-byte aligned.
1159                  * Generates a compile-time "error: zero width for bit-field" if
1160                  * the alignment is wrong.
1161                  */
1162                 struct fxsrAlignAssert {
1163                         int _:!(offsetof(struct task_struct,
1164                                         thread.i387.fxsave) & 15);
1165                 };
1166
1167                 printk(KERN_INFO "Enabling fast FPU save and restore... ");
1168                 set_in_cr4(X86_CR4_OSFXSR);
1169                 printk("done.\n");
1170         }
1171         if (cpu_has_xmm) {
1172                 printk(KERN_INFO "Enabling unmasked SIMD FPU exception "
1173                                 "support... ");
1174                 set_in_cr4(X86_CR4_OSXMMEXCPT);
1175                 printk("done.\n");
1176         }
1177
1178         set_system_gate(SYSCALL_VECTOR,&system_call);
1179
1180         /*
1181          * Should be a barrier for any external CPU state.
1182          */
1183         cpu_init();
1184
1185         trap_init_hook();
1186 }
1187
1188 static int __init kstack_setup(char *s)
1189 {
1190         kstack_depth_to_print = simple_strtoul(s, NULL, 0);
1191         return 1;
1192 }
1193 __setup("kstack=", kstack_setup);