x86: initial changes to unify traps_32.c and traps_64.c
[pandora-kernel.git] / arch / x86 / kernel / traps_64.c
1 /*
2  *  Copyright (C) 1991, 1992  Linus Torvalds
3  *  Copyright (C) 2000, 2001, 2002 Andi Kleen, SuSE Labs
4  *
5  *  Pentium III FXSR, SSE support
6  *      Gareth Hughes <gareth@valinux.com>, May 2000
7  */
8
9 /*
10  * 'Traps.c' handles hardware traps and faults after we have saved some
11  * state in 'entry.S'.
12  */
13 #include <linux/sched.h>
14 #include <linux/kernel.h>
15 #include <linux/string.h>
16 #include <linux/errno.h>
17 #include <linux/ptrace.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/kallsyms.h>
25 #include <linux/module.h>
26 #include <linux/moduleparam.h>
27 #include <linux/nmi.h>
28 #include <linux/kprobes.h>
29 #include <linux/kexec.h>
30 #include <linux/unwind.h>
31 #include <linux/uaccess.h>
32 #include <linux/bug.h>
33 #include <linux/kdebug.h>
34 #include <linux/utsname.h>
35
36 #include <mach_traps.h>
37
38 #if defined(CONFIG_EDAC)
39 #include <linux/edac.h>
40 #endif
41
42 #include <asm/system.h>
43 #include <asm/io.h>
44 #include <asm/atomic.h>
45 #include <asm/debugreg.h>
46 #include <asm/desc.h>
47 #include <asm/i387.h>
48 #include <asm/processor.h>
49 #include <asm/unwind.h>
50 #include <asm/smp.h>
51 #include <asm/pgalloc.h>
52 #include <asm/pda.h>
53 #include <asm/proto.h>
54 #include <asm/nmi.h>
55 #include <asm/stacktrace.h>
56
57 asmlinkage void divide_error(void);
58 asmlinkage void debug(void);
59 asmlinkage void nmi(void);
60 asmlinkage void int3(void);
61 asmlinkage void overflow(void);
62 asmlinkage void bounds(void);
63 asmlinkage void invalid_op(void);
64 asmlinkage void device_not_available(void);
65 asmlinkage void double_fault(void);
66 asmlinkage void coprocessor_segment_overrun(void);
67 asmlinkage void invalid_TSS(void);
68 asmlinkage void segment_not_present(void);
69 asmlinkage void stack_segment(void);
70 asmlinkage void general_protection(void);
71 asmlinkage void page_fault(void);
72 asmlinkage void coprocessor_error(void);
73 asmlinkage void simd_coprocessor_error(void);
74 asmlinkage void alignment_check(void);
75 asmlinkage void machine_check(void);
76 asmlinkage void spurious_interrupt_bug(void);
77
78 int panic_on_unrecovered_nmi;
79 static unsigned int code_bytes = 64;
80 static unsigned ignore_nmis;
81
82 static inline void conditional_sti(struct pt_regs *regs)
83 {
84         if (regs->flags & X86_EFLAGS_IF)
85                 local_irq_enable();
86 }
87
88 static inline void preempt_conditional_sti(struct pt_regs *regs)
89 {
90         inc_preempt_count();
91         if (regs->flags & X86_EFLAGS_IF)
92                 local_irq_enable();
93 }
94
95 static inline void preempt_conditional_cli(struct pt_regs *regs)
96 {
97         if (regs->flags & X86_EFLAGS_IF)
98                 local_irq_disable();
99         /* Make sure to not schedule here because we could be running
100            on an exception stack. */
101         dec_preempt_count();
102 }
103
104 int kstack_depth_to_print = 12;
105
106 void printk_address(unsigned long address, int reliable)
107 {
108 #ifdef CONFIG_KALLSYMS
109         unsigned long offset = 0, symsize;
110         const char *symname;
111         char *modname;
112         char *delim = ":";
113         char namebuf[KSYM_NAME_LEN];
114         char reliab[4] = "";
115
116         symname = kallsyms_lookup(address, &symsize, &offset,
117                                         &modname, namebuf);
118         if (!symname) {
119                 printk(" [<%016lx>]\n", address);
120                 return;
121         }
122         if (!reliable)
123                 strcpy(reliab, "? ");
124
125         if (!modname)
126                 modname = delim = "";
127         printk(" [<%016lx>] %s%s%s%s%s+0x%lx/0x%lx\n",
128                 address, reliab, delim, modname, delim, symname, offset, symsize);
129 #else
130         printk(" [<%016lx>]\n", address);
131 #endif
132 }
133
134 static unsigned long *in_exception_stack(unsigned cpu, unsigned long stack,
135                                         unsigned *usedp, char **idp)
136 {
137         static char ids[][8] = {
138                 [DEBUG_STACK - 1] = "#DB",
139                 [NMI_STACK - 1] = "NMI",
140                 [DOUBLEFAULT_STACK - 1] = "#DF",
141                 [STACKFAULT_STACK - 1] = "#SS",
142                 [MCE_STACK - 1] = "#MC",
143 #if DEBUG_STKSZ > EXCEPTION_STKSZ
144                 [N_EXCEPTION_STACKS ... N_EXCEPTION_STACKS + DEBUG_STKSZ / EXCEPTION_STKSZ - 2] = "#DB[?]"
145 #endif
146         };
147         unsigned k;
148
149         /*
150          * Iterate over all exception stacks, and figure out whether
151          * 'stack' is in one of them:
152          */
153         for (k = 0; k < N_EXCEPTION_STACKS; k++) {
154                 unsigned long end = per_cpu(orig_ist, cpu).ist[k];
155                 /*
156                  * Is 'stack' above this exception frame's end?
157                  * If yes then skip to the next frame.
158                  */
159                 if (stack >= end)
160                         continue;
161                 /*
162                  * Is 'stack' above this exception frame's start address?
163                  * If yes then we found the right frame.
164                  */
165                 if (stack >= end - EXCEPTION_STKSZ) {
166                         /*
167                          * Make sure we only iterate through an exception
168                          * stack once. If it comes up for the second time
169                          * then there's something wrong going on - just
170                          * break out and return NULL:
171                          */
172                         if (*usedp & (1U << k))
173                                 break;
174                         *usedp |= 1U << k;
175                         *idp = ids[k];
176                         return (unsigned long *)end;
177                 }
178                 /*
179                  * If this is a debug stack, and if it has a larger size than
180                  * the usual exception stacks, then 'stack' might still
181                  * be within the lower portion of the debug stack:
182                  */
183 #if DEBUG_STKSZ > EXCEPTION_STKSZ
184                 if (k == DEBUG_STACK - 1 && stack >= end - DEBUG_STKSZ) {
185                         unsigned j = N_EXCEPTION_STACKS - 1;
186
187                         /*
188                          * Black magic. A large debug stack is composed of
189                          * multiple exception stack entries, which we
190                          * iterate through now. Dont look:
191                          */
192                         do {
193                                 ++j;
194                                 end -= EXCEPTION_STKSZ;
195                                 ids[j][4] = '1' + (j - N_EXCEPTION_STACKS);
196                         } while (stack < end - EXCEPTION_STKSZ);
197                         if (*usedp & (1U << j))
198                                 break;
199                         *usedp |= 1U << j;
200                         *idp = ids[j];
201                         return (unsigned long *)end;
202                 }
203 #endif
204         }
205         return NULL;
206 }
207
208 /*
209  * x86-64 can have up to three kernel stacks: 
210  * process stack
211  * interrupt stack
212  * severe exception (double fault, nmi, stack fault, debug, mce) hardware stack
213  */
214
215 static inline int valid_stack_ptr(struct thread_info *tinfo,
216                         void *p, unsigned int size, void *end)
217 {
218         void *t = tinfo;
219         if (end) {
220                 if (p < end && p >= (end-THREAD_SIZE))
221                         return 1;
222                 else
223                         return 0;
224         }
225         return p > t && p < t + THREAD_SIZE - size;
226 }
227
228 /* The form of the top of the frame on the stack */
229 struct stack_frame {
230         struct stack_frame *next_frame;
231         unsigned long return_address;
232 };
233
234 static inline unsigned long
235 print_context_stack(struct thread_info *tinfo,
236                 unsigned long *stack, unsigned long bp,
237                 const struct stacktrace_ops *ops, void *data,
238                 unsigned long *end)
239 {
240         struct stack_frame *frame = (struct stack_frame *)bp;
241
242         while (valid_stack_ptr(tinfo, stack, sizeof(*stack), end)) {
243                 unsigned long addr;
244
245                 addr = *stack;
246                 if (__kernel_text_address(addr)) {
247                         if ((unsigned long) stack == bp + 8) {
248                                 ops->address(data, addr, 1);
249                                 frame = frame->next_frame;
250                                 bp = (unsigned long) frame;
251                         } else {
252                                 ops->address(data, addr, bp == 0);
253                         }
254                 }
255                 stack++;
256         }
257         return bp;
258 }
259
260 void dump_trace(struct task_struct *task, struct pt_regs *regs,
261                 unsigned long *stack, unsigned long bp,
262                 const struct stacktrace_ops *ops, void *data)
263 {
264         const unsigned cpu = get_cpu();
265         unsigned long *irqstack_end = (unsigned long*)cpu_pda(cpu)->irqstackptr;
266         unsigned used = 0;
267         struct thread_info *tinfo;
268
269         if (!task)
270                 task = current;
271         tinfo = task_thread_info(task);
272
273         if (!stack) {
274                 unsigned long dummy;
275                 stack = &dummy;
276                 if (task && task != current)
277                         stack = (unsigned long *)task->thread.sp;
278         }
279
280 #ifdef CONFIG_FRAME_POINTER
281         if (!bp) {
282                 if (task == current) {
283                         /* Grab bp right from our regs */
284                         asm("movq %%rbp, %0" : "=r" (bp) :);
285                 } else {
286                         /* bp is the last reg pushed by switch_to */
287                         bp = *(unsigned long *) task->thread.sp;
288                 }
289         }
290 #endif
291
292         /*
293          * Print function call entries in all stacks, starting at the
294          * current stack address. If the stacks consist of nested
295          * exceptions
296          */
297         for (;;) {
298                 char *id;
299                 unsigned long *estack_end;
300                 estack_end = in_exception_stack(cpu, (unsigned long)stack,
301                                                 &used, &id);
302
303                 if (estack_end) {
304                         if (ops->stack(data, id) < 0)
305                                 break;
306
307                         bp = print_context_stack(tinfo, stack, bp, ops,
308                                                         data, estack_end);
309                         ops->stack(data, "<EOE>");
310                         /*
311                          * We link to the next stack via the
312                          * second-to-last pointer (index -2 to end) in the
313                          * exception stack:
314                          */
315                         stack = (unsigned long *) estack_end[-2];
316                         continue;
317                 }
318                 if (irqstack_end) {
319                         unsigned long *irqstack;
320                         irqstack = irqstack_end -
321                                 (IRQSTACKSIZE - 64) / sizeof(*irqstack);
322
323                         if (stack >= irqstack && stack < irqstack_end) {
324                                 if (ops->stack(data, "IRQ") < 0)
325                                         break;
326                                 bp = print_context_stack(tinfo, stack, bp,
327                                                 ops, data, irqstack_end);
328                                 /*
329                                  * We link to the next stack (which would be
330                                  * the process stack normally) the last
331                                  * pointer (index -1 to end) in the IRQ stack:
332                                  */
333                                 stack = (unsigned long *) (irqstack_end[-1]);
334                                 irqstack_end = NULL;
335                                 ops->stack(data, "EOI");
336                                 continue;
337                         }
338                 }
339                 break;
340         }
341
342         /*
343          * This handles the process stack:
344          */
345         bp = print_context_stack(tinfo, stack, bp, ops, data, NULL);
346         put_cpu();
347 }
348 EXPORT_SYMBOL(dump_trace);
349
350 static void
351 print_trace_warning_symbol(void *data, char *msg, unsigned long symbol)
352 {
353         print_symbol(msg, symbol);
354         printk("\n");
355 }
356
357 static void print_trace_warning(void *data, char *msg)
358 {
359         printk("%s\n", msg);
360 }
361
362 static int print_trace_stack(void *data, char *name)
363 {
364         printk(" <%s> ", name);
365         return 0;
366 }
367
368 static void print_trace_address(void *data, unsigned long addr, int reliable)
369 {
370         touch_nmi_watchdog();
371         printk_address(addr, reliable);
372 }
373
374 static const struct stacktrace_ops print_trace_ops = {
375         .warning = print_trace_warning,
376         .warning_symbol = print_trace_warning_symbol,
377         .stack = print_trace_stack,
378         .address = print_trace_address,
379 };
380
381 void show_trace(struct task_struct *task, struct pt_regs *regs,
382                 unsigned long *stack, unsigned long bp)
383 {
384         printk("\nCall Trace:\n");
385         dump_trace(task, regs, stack, bp, &print_trace_ops, NULL);
386         printk("\n");
387 }
388
389 static void
390 _show_stack(struct task_struct *task, struct pt_regs *regs,
391                 unsigned long *sp, unsigned long bp)
392 {
393         unsigned long *stack;
394         int i;
395         const int cpu = smp_processor_id();
396         unsigned long *irqstack_end = (unsigned long *) (cpu_pda(cpu)->irqstackptr);
397         unsigned long *irqstack = (unsigned long *) (cpu_pda(cpu)->irqstackptr - IRQSTACKSIZE);
398
399         // debugging aid: "show_stack(NULL, NULL);" prints the
400         // back trace for this cpu.
401
402         if (sp == NULL) {
403                 if (task)
404                         sp = (unsigned long *)task->thread.sp;
405                 else
406                         sp = (unsigned long *)&sp;
407         }
408
409         stack = sp;
410         for (i = 0; i < kstack_depth_to_print; i++) {
411                 if (stack >= irqstack && stack <= irqstack_end) {
412                         if (stack == irqstack_end) {
413                                 stack = (unsigned long *) (irqstack_end[-1]);
414                                 printk(" <EOI> ");
415                         }
416                 } else {
417                 if (((long) stack & (THREAD_SIZE-1)) == 0)
418                         break;
419                 }
420                 if (i && ((i % 4) == 0))
421                         printk("\n");
422                 printk(" %016lx", *stack++);
423                 touch_nmi_watchdog();
424         }
425         show_trace(task, regs, sp, bp);
426 }
427
428 void show_stack(struct task_struct *task, unsigned long *sp)
429 {
430         _show_stack(task, NULL, sp, 0);
431 }
432
433 /*
434  * The architecture-independent dump_stack generator
435  */
436 void dump_stack(void)
437 {
438         unsigned long stack;
439         unsigned long bp = 0;
440
441 #ifdef CONFIG_FRAME_POINTER
442         if (!bp)
443                 asm("movq %%rbp, %0" : "=r" (bp):);
444 #endif
445
446         printk("Pid: %d, comm: %.20s %s %s %.*s\n",
447                 current->pid, current->comm, print_tainted(),
448                 init_utsname()->release,
449                 (int)strcspn(init_utsname()->version, " "),
450                 init_utsname()->version);
451         show_trace(NULL, NULL, &stack, bp);
452 }
453
454 EXPORT_SYMBOL(dump_stack);
455
456 void show_registers(struct pt_regs *regs)
457 {
458         int i;
459         unsigned long sp;
460         const int cpu = smp_processor_id();
461         struct task_struct *cur = cpu_pda(cpu)->pcurrent;
462         u8 *ip;
463         unsigned int code_prologue = code_bytes * 43 / 64;
464         unsigned int code_len = code_bytes;
465
466         sp = regs->sp;
467         ip = (u8 *) regs->ip - code_prologue;
468         printk("CPU %d ", cpu);
469         __show_regs(regs);
470         printk("Process %s (pid: %d, threadinfo %p, task %p)\n",
471                 cur->comm, cur->pid, task_thread_info(cur), cur);
472
473         /*
474          * When in-kernel, we also print out the stack and code at the
475          * time of the fault..
476          */
477         if (!user_mode(regs)) {
478                 unsigned char c;
479                 printk("Stack: ");
480                 _show_stack(NULL, regs, (unsigned long *)sp, regs->bp);
481                 printk("\n");
482
483                 printk(KERN_EMERG "Code: ");
484                 if (ip < (u8 *)PAGE_OFFSET || probe_kernel_address(ip, c)) {
485                         /* try starting at RIP */
486                         ip = (u8 *)regs->ip;
487                         code_len = code_len - code_prologue + 1;
488                 }
489                 for (i = 0; i < code_len; i++, ip++) {
490                         if (ip < (u8 *)PAGE_OFFSET ||
491                                         probe_kernel_address(ip, c)) {
492                                 printk(" Bad RIP value.");
493                                 break;
494                         }
495                         if (ip == (u8 *)regs->ip)
496                                 printk("<%02x> ", c);
497                         else
498                                 printk("%02x ", c);
499                 }
500         }
501         printk("\n");
502 }
503
504 int is_valid_bugaddr(unsigned long ip)
505 {
506         unsigned short ud2;
507
508         if (__copy_from_user(&ud2, (const void __user *) ip, sizeof(ud2)))
509                 return 0;
510
511         return ud2 == 0x0b0f;
512 }
513
514 static raw_spinlock_t die_lock = __RAW_SPIN_LOCK_UNLOCKED;
515 static int die_owner = -1;
516 static unsigned int die_nest_count;
517
518 unsigned __kprobes long oops_begin(void)
519 {
520         int cpu;
521         unsigned long flags;
522
523         oops_enter();
524
525         /* racy, but better than risking deadlock. */
526         raw_local_irq_save(flags);
527         cpu = smp_processor_id();
528         if (!__raw_spin_trylock(&die_lock)) {
529                 if (cpu == die_owner) 
530                         /* nested oops. should stop eventually */;
531                 else
532                         __raw_spin_lock(&die_lock);
533         }
534         die_nest_count++;
535         die_owner = cpu;
536         console_verbose();
537         bust_spinlocks(1);
538         return flags;
539 }
540
541 void __kprobes oops_end(unsigned long flags, struct pt_regs *regs, int signr)
542
543         die_owner = -1;
544         bust_spinlocks(0);
545         die_nest_count--;
546         if (!die_nest_count)
547                 /* Nest count reaches zero, release the lock. */
548                 __raw_spin_unlock(&die_lock);
549         raw_local_irq_restore(flags);
550         if (!regs) {
551                 oops_exit();
552                 return;
553         }
554         if (panic_on_oops)
555                 panic("Fatal exception");
556         oops_exit();
557         do_exit(signr);
558 }
559
560 int __kprobes __die(const char * str, struct pt_regs * regs, long err)
561 {
562         static int die_counter;
563         printk(KERN_EMERG "%s: %04lx [%u] ", str, err & 0xffff,++die_counter);
564 #ifdef CONFIG_PREEMPT
565         printk("PREEMPT ");
566 #endif
567 #ifdef CONFIG_SMP
568         printk("SMP ");
569 #endif
570 #ifdef CONFIG_DEBUG_PAGEALLOC
571         printk("DEBUG_PAGEALLOC");
572 #endif
573         printk("\n");
574         if (notify_die(DIE_OOPS, str, regs, err,
575                         current->thread.trap_no, SIGSEGV) == NOTIFY_STOP)
576                 return 1;
577
578         show_registers(regs);
579         add_taint(TAINT_DIE);
580         /* Executive summary in case the oops scrolled away */
581         printk(KERN_ALERT "RIP ");
582         printk_address(regs->ip, 1);
583         printk(" RSP <%016lx>\n", regs->sp);
584         if (kexec_should_crash(current))
585                 crash_kexec(regs);
586         return 0;
587 }
588
589 void die(const char * str, struct pt_regs *regs, long err)
590 {
591         unsigned long flags = oops_begin();
592
593         if (!user_mode(regs))
594                 report_bug(regs->ip, regs);
595
596         if (__die(str, regs, err))
597                 regs = NULL;
598         oops_end(flags, regs, SIGSEGV);
599 }
600
601 notrace __kprobes void
602 die_nmi(char *str, struct pt_regs *regs, int do_panic)
603 {
604         unsigned long flags;
605
606         if (notify_die(DIE_NMIWATCHDOG, str, regs, 0, 2, SIGINT) == NOTIFY_STOP)
607                 return;
608
609         flags = oops_begin();
610         /*
611          * We are in trouble anyway, lets at least try
612          * to get a message out.
613          */
614         printk(KERN_EMERG "%s", str);
615         printk(" on CPU%d, ip %08lx, registers:\n",
616                 smp_processor_id(), regs->ip);
617         show_registers(regs);
618         if (kexec_should_crash(current))
619                 crash_kexec(regs);
620         if (do_panic || panic_on_oops)
621                 panic("Non maskable interrupt");
622         oops_end(flags, NULL, SIGBUS);
623         nmi_exit();
624         local_irq_enable();
625         do_exit(SIGBUS);
626 }
627
628 static void __kprobes
629 do_trap(int trapnr, int signr, char *str, struct pt_regs *regs,
630         long error_code, siginfo_t *info)
631 {
632         struct task_struct *tsk = current;
633
634         if (user_mode(regs)) {
635                 /*
636                  * We want error_code and trap_no set for userspace
637                  * faults and kernelspace faults which result in
638                  * die(), but not kernelspace faults which are fixed
639                  * up.  die() gives the process no chance to handle
640                  * the signal and notice the kernel fault information,
641                  * so that won't result in polluting the information
642                  * about previously queued, but not yet delivered,
643                  * faults.  See also do_general_protection below.
644                  */
645                 tsk->thread.error_code = error_code;
646                 tsk->thread.trap_no = trapnr;
647
648                 if (show_unhandled_signals && unhandled_signal(tsk, signr) &&
649                     printk_ratelimit()) {
650                         printk(KERN_INFO
651                                "%s[%d] trap %s ip:%lx sp:%lx error:%lx",
652                                tsk->comm, tsk->pid, str,
653                                regs->ip, regs->sp, error_code);
654                         print_vma_addr(" in ", regs->ip);
655                         printk("\n");
656                 }
657
658                 if (info)
659                         force_sig_info(signr, info, tsk);
660                 else
661                         force_sig(signr, tsk);
662                 return;
663         }
664
665
666         if (!fixup_exception(regs)) {
667                 tsk->thread.error_code = error_code;
668                 tsk->thread.trap_no = trapnr;
669                 die(str, regs, error_code);
670         }
671         return;
672 }
673
674 #define DO_ERROR(trapnr, signr, str, name) \
675 asmlinkage void do_##name(struct pt_regs * regs, long error_code)       \
676 {                                                                       \
677         if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr)  \
678                                                         == NOTIFY_STOP) \
679                 return;                                                 \
680         conditional_sti(regs);                                          \
681         do_trap(trapnr, signr, str, regs, error_code, NULL);            \
682 }
683
684 #define DO_ERROR_INFO(trapnr, signr, str, name, sicode, siaddr)         \
685 asmlinkage void do_##name(struct pt_regs * regs, long error_code)       \
686 {                                                                       \
687         siginfo_t info;                                                 \
688         info.si_signo = signr;                                          \
689         info.si_errno = 0;                                              \
690         info.si_code = sicode;                                          \
691         info.si_addr = (void __user *)siaddr;                           \
692         trace_hardirqs_fixup();                                         \
693         if (notify_die(DIE_TRAP, str, regs, error_code, trapnr, signr)  \
694                                                         == NOTIFY_STOP) \
695                 return;                                                 \
696         conditional_sti(regs);                                          \
697         do_trap(trapnr, signr, str, regs, error_code, &info);           \
698 }
699
700 DO_ERROR_INFO(0, SIGFPE, "divide error", divide_error, FPE_INTDIV, regs->ip)
701 DO_ERROR(4, SIGSEGV, "overflow", overflow)
702 DO_ERROR(5, SIGSEGV, "bounds", bounds)
703 DO_ERROR_INFO(6, SIGILL, "invalid opcode", invalid_op, ILL_ILLOPN, regs->ip)
704 DO_ERROR(9, SIGFPE, "coprocessor segment overrun", coprocessor_segment_overrun)
705 DO_ERROR(10, SIGSEGV, "invalid TSS", invalid_TSS)
706 DO_ERROR(11, SIGBUS, "segment not present", segment_not_present)
707 DO_ERROR_INFO(17, SIGBUS, "alignment check", alignment_check, BUS_ADRALN, 0)
708
709 /* Runs on IST stack */
710 asmlinkage void do_stack_segment(struct pt_regs *regs, long error_code)
711 {
712         if (notify_die(DIE_TRAP, "stack segment", regs, error_code,
713                         12, SIGBUS) == NOTIFY_STOP)
714                 return;
715         preempt_conditional_sti(regs);
716         do_trap(12, SIGBUS, "stack segment", regs, error_code, NULL);
717         preempt_conditional_cli(regs);
718 }
719
720 asmlinkage void do_double_fault(struct pt_regs * regs, long error_code)
721 {
722         static const char str[] = "double fault";
723         struct task_struct *tsk = current;
724
725         /* Return not checked because double check cannot be ignored */
726         notify_die(DIE_TRAP, str, regs, error_code, 8, SIGSEGV);
727
728         tsk->thread.error_code = error_code;
729         tsk->thread.trap_no = 8;
730
731         /* This is always a kernel trap and never fixable (and thus must
732            never return). */
733         for (;;)
734                 die(str, regs, error_code);
735 }
736
737 asmlinkage void __kprobes do_general_protection(struct pt_regs * regs,
738                                                 long error_code)
739 {
740         struct task_struct *tsk = current;
741
742         conditional_sti(regs);
743
744         if (user_mode(regs)) {
745                 tsk->thread.error_code = error_code;
746                 tsk->thread.trap_no = 13;
747
748                 if (show_unhandled_signals && unhandled_signal(tsk, SIGSEGV) &&
749                     printk_ratelimit()) {
750                         printk(KERN_INFO
751                        "%s[%d] general protection ip:%lx sp:%lx error:%lx",
752                                tsk->comm, tsk->pid,
753                                regs->ip, regs->sp, error_code);
754                         print_vma_addr(" in ", regs->ip);
755                         printk("\n");
756                 }
757
758                 force_sig(SIGSEGV, tsk);
759                 return;
760         } 
761
762         if (fixup_exception(regs))
763                 return;
764
765         tsk->thread.error_code = error_code;
766         tsk->thread.trap_no = 13;
767         if (notify_die(DIE_GPF, "general protection fault", regs,
768                                 error_code, 13, SIGSEGV) == NOTIFY_STOP)
769                 return;
770         die("general protection fault", regs, error_code);
771 }
772
773 static notrace __kprobes void
774 mem_parity_error(unsigned char reason, struct pt_regs *regs)
775 {
776         printk(KERN_EMERG "Uhhuh. NMI received for unknown reason %02x.\n",
777                 reason);
778         printk(KERN_EMERG "You have some hardware problem, likely on the PCI bus.\n");
779
780 #if defined(CONFIG_EDAC)
781         if (edac_handler_set()) {
782                 edac_atomic_assert_error();
783                 return;
784         }
785 #endif
786
787         if (panic_on_unrecovered_nmi)
788                 panic("NMI: Not continuing");
789
790         printk(KERN_EMERG "Dazed and confused, but trying to continue\n");
791
792         /* Clear and disable the memory parity error line. */
793         reason = (reason & 0xf) | 4;
794         outb(reason, 0x61);
795 }
796
797 static notrace __kprobes void
798 io_check_error(unsigned char reason, struct pt_regs *regs)
799 {
800         printk("NMI: IOCK error (debug interrupt?)\n");
801         show_registers(regs);
802
803         /* Re-enable the IOCK line, wait for a few seconds */
804         reason = (reason & 0xf) | 8;
805         outb(reason, 0x61);
806         mdelay(2000);
807         reason &= ~8;
808         outb(reason, 0x61);
809 }
810
811 static notrace __kprobes void
812 unknown_nmi_error(unsigned char reason, struct pt_regs * regs)
813 {
814         if (notify_die(DIE_NMIUNKNOWN, "nmi", regs, reason, 2, SIGINT) == NOTIFY_STOP)
815                 return;
816         printk(KERN_EMERG "Uhhuh. NMI received for unknown reason %02x.\n",
817                 reason);
818         printk(KERN_EMERG "Do you have a strange power saving mode enabled?\n");
819
820         if (panic_on_unrecovered_nmi)
821                 panic("NMI: Not continuing");
822
823         printk(KERN_EMERG "Dazed and confused, but trying to continue\n");
824 }
825
826 /* Runs on IST stack. This code must keep interrupts off all the time.
827    Nested NMIs are prevented by the CPU. */
828 asmlinkage notrace  __kprobes void default_do_nmi(struct pt_regs *regs)
829 {
830         unsigned char reason = 0;
831         int cpu;
832
833         cpu = smp_processor_id();
834
835         /* Only the BSP gets external NMIs from the system. */
836         if (!cpu)
837                 reason = get_nmi_reason();
838
839         if (!(reason & 0xc0)) {
840                 if (notify_die(DIE_NMI_IPI, "nmi_ipi", regs, reason, 2, SIGINT)
841                                                                 == NOTIFY_STOP)
842                         return;
843                 /*
844                  * Ok, so this is none of the documented NMI sources,
845                  * so it must be the NMI watchdog.
846                  */
847                 if (nmi_watchdog_tick(regs, reason))
848                         return;
849                 if (!do_nmi_callback(regs, cpu))
850                         unknown_nmi_error(reason, regs);
851
852                 return;
853         }
854         if (notify_die(DIE_NMI, "nmi", regs, reason, 2, SIGINT) == NOTIFY_STOP)
855                 return;
856
857         /* AK: following checks seem to be broken on modern chipsets. FIXME */
858         if (reason & 0x80)
859                 mem_parity_error(reason, regs);
860         if (reason & 0x40)
861                 io_check_error(reason, regs);
862 }
863
864 asmlinkage notrace __kprobes void
865 do_nmi(struct pt_regs *regs, long error_code)
866 {
867         nmi_enter();
868
869         add_pda(__nmi_count, 1);
870
871         if (!ignore_nmis)
872                 default_do_nmi(regs);
873
874         nmi_exit();
875 }
876
877 void stop_nmi(void)
878 {
879         acpi_nmi_disable();
880         ignore_nmis++;
881 }
882
883 void restart_nmi(void)
884 {
885         ignore_nmis--;
886         acpi_nmi_enable();
887 }
888
889 /* runs on IST stack. */
890 asmlinkage void __kprobes do_int3(struct pt_regs *regs, long error_code)
891 {
892         trace_hardirqs_fixup();
893
894         if (notify_die(DIE_INT3, "int3", regs, error_code, 3, SIGTRAP)
895                         == NOTIFY_STOP)
896                 return;
897
898         preempt_conditional_sti(regs);
899         do_trap(3, SIGTRAP, "int3", regs, error_code, NULL);
900         preempt_conditional_cli(regs);
901 }
902
903 /* Help handler running on IST stack to switch back to user stack
904    for scheduling or signal handling. The actual stack switch is done in
905    entry.S */
906 asmlinkage __kprobes struct pt_regs *sync_regs(struct pt_regs *eregs)
907 {
908         struct pt_regs *regs = eregs;
909         /* Did already sync */
910         if (eregs == (struct pt_regs *)eregs->sp)
911                 ;
912         /* Exception from user space */
913         else if (user_mode(eregs))
914                 regs = task_pt_regs(current);
915         /* Exception from kernel and interrupts are enabled. Move to
916            kernel process stack. */
917         else if (eregs->flags & X86_EFLAGS_IF)
918                 regs = (struct pt_regs *)(eregs->sp -= sizeof(struct pt_regs));
919         if (eregs != regs)
920                 *regs = *eregs;
921         return regs;
922 }
923
924 /* runs on IST stack. */
925 asmlinkage void __kprobes do_debug(struct pt_regs * regs,
926                                    unsigned long error_code)
927 {
928         unsigned long condition;
929         struct task_struct *tsk = current;
930         siginfo_t info;
931
932         trace_hardirqs_fixup();
933
934         get_debugreg(condition, 6);
935
936         /*
937          * The processor cleared BTF, so don't mark that we need it set.
938          */
939         clear_tsk_thread_flag(tsk, TIF_DEBUGCTLMSR);
940         tsk->thread.debugctlmsr = 0;
941
942         if (notify_die(DIE_DEBUG, "debug", regs, condition, error_code,
943                                                 SIGTRAP) == NOTIFY_STOP)
944                 return;
945
946         preempt_conditional_sti(regs);
947
948         /* Mask out spurious debug traps due to lazy DR7 setting */
949         if (condition & (DR_TRAP0|DR_TRAP1|DR_TRAP2|DR_TRAP3)) {
950                 if (!tsk->thread.debugreg7)
951                         goto clear_dr7;
952         }
953
954         tsk->thread.debugreg6 = condition;
955
956         /*
957          * Single-stepping through TF: make sure we ignore any events in
958          * kernel space (but re-enable TF when returning to user mode).
959          */
960         if (condition & DR_STEP) {
961                 if (!user_mode(regs))
962                         goto clear_TF_reenable;
963         }
964
965         /* Ok, finally something we can handle */
966         tsk->thread.trap_no = 1;
967         tsk->thread.error_code = error_code;
968         info.si_signo = SIGTRAP;
969         info.si_errno = 0;
970         info.si_code = TRAP_BRKPT;
971         info.si_addr = user_mode(regs) ? (void __user *)regs->ip : NULL;
972         force_sig_info(SIGTRAP, &info, tsk);
973
974 clear_dr7:
975         set_debugreg(0, 7);
976         preempt_conditional_cli(regs);
977         return;
978
979 clear_TF_reenable:
980         set_tsk_thread_flag(tsk, TIF_SINGLESTEP);
981         regs->flags &= ~X86_EFLAGS_TF;
982         preempt_conditional_cli(regs);
983         return;
984 }
985
986 static int kernel_math_error(struct pt_regs *regs, const char *str, int trapnr)
987 {
988         if (fixup_exception(regs))
989                 return 1;
990
991         notify_die(DIE_GPF, str, regs, 0, trapnr, SIGFPE);
992         /* Illegal floating point operation in the kernel */
993         current->thread.trap_no = trapnr;
994         die(str, regs, 0);
995         return 0;
996 }
997
998 /*
999  * Note that we play around with the 'TS' bit in an attempt to get
1000  * the correct behaviour even in the presence of the asynchronous
1001  * IRQ13 behaviour
1002  */
1003 asmlinkage void do_coprocessor_error(struct pt_regs *regs)
1004 {
1005         void __user *ip = (void __user *)(regs->ip);
1006         struct task_struct *task;
1007         siginfo_t info;
1008         unsigned short cwd, swd;
1009
1010         conditional_sti(regs);
1011         if (!user_mode(regs) &&
1012             kernel_math_error(regs, "kernel x87 math error", 16))
1013                 return;
1014
1015         /*
1016          * Save the info for the exception handler and clear the error.
1017          */
1018         task = current;
1019         save_init_fpu(task);
1020         task->thread.trap_no = 16;
1021         task->thread.error_code = 0;
1022         info.si_signo = SIGFPE;
1023         info.si_errno = 0;
1024         info.si_code = __SI_FAULT;
1025         info.si_addr = ip;
1026         /*
1027          * (~cwd & swd) will mask out exceptions that are not set to unmasked
1028          * status.  0x3f is the exception bits in these regs, 0x200 is the
1029          * C1 reg you need in case of a stack fault, 0x040 is the stack
1030          * fault bit.  We should only be taking one exception at a time,
1031          * so if this combination doesn't produce any single exception,
1032          * then we have a bad program that isn't synchronizing its FPU usage
1033          * and it will suffer the consequences since we won't be able to
1034          * fully reproduce the context of the exception
1035          */
1036         cwd = get_fpu_cwd(task);
1037         swd = get_fpu_swd(task);
1038         switch (swd & ~cwd & 0x3f) {
1039         case 0x000: /* No unmasked exception */
1040         default: /* Multiple exceptions */
1041                 break;
1042         case 0x001: /* Invalid Op */
1043                 /*
1044                  * swd & 0x240 == 0x040: Stack Underflow
1045                  * swd & 0x240 == 0x240: Stack Overflow
1046                  * User must clear the SF bit (0x40) if set
1047                  */
1048                 info.si_code = FPE_FLTINV;
1049                 break;
1050         case 0x002: /* Denormalize */
1051         case 0x010: /* Underflow */
1052                 info.si_code = FPE_FLTUND;
1053                 break;
1054         case 0x004: /* Zero Divide */
1055                 info.si_code = FPE_FLTDIV;
1056                 break;
1057         case 0x008: /* Overflow */
1058                 info.si_code = FPE_FLTOVF;
1059                 break;
1060         case 0x020: /* Precision */
1061                 info.si_code = FPE_FLTRES;
1062                 break;
1063         }
1064         force_sig_info(SIGFPE, &info, task);
1065 }
1066
1067 asmlinkage void bad_intr(void)
1068 {
1069         printk("bad interrupt"); 
1070 }
1071
1072 asmlinkage void do_simd_coprocessor_error(struct pt_regs *regs)
1073 {
1074         void __user *ip = (void __user *)(regs->ip);
1075         struct task_struct *task;
1076         siginfo_t info;
1077         unsigned short mxcsr;
1078
1079         conditional_sti(regs);
1080         if (!user_mode(regs) &&
1081                 kernel_math_error(regs, "kernel simd math error", 19))
1082                 return;
1083
1084         /*
1085          * Save the info for the exception handler and clear the error.
1086          */
1087         task = current;
1088         save_init_fpu(task);
1089         task->thread.trap_no = 19;
1090         task->thread.error_code = 0;
1091         info.si_signo = SIGFPE;
1092         info.si_errno = 0;
1093         info.si_code = __SI_FAULT;
1094         info.si_addr = ip;
1095         /*
1096          * The SIMD FPU exceptions are handled a little differently, as there
1097          * is only a single status/control register.  Thus, to determine which
1098          * unmasked exception was caught we must mask the exception mask bits
1099          * at 0x1f80, and then use these to mask the exception bits at 0x3f.
1100          */
1101         mxcsr = get_fpu_mxcsr(task);
1102         switch (~((mxcsr & 0x1f80) >> 7) & (mxcsr & 0x3f)) {
1103         case 0x000:
1104         default:
1105                 break;
1106         case 0x001: /* Invalid Op */
1107                 info.si_code = FPE_FLTINV;
1108                 break;
1109         case 0x002: /* Denormalize */
1110         case 0x010: /* Underflow */
1111                 info.si_code = FPE_FLTUND;
1112                 break;
1113         case 0x004: /* Zero Divide */
1114                 info.si_code = FPE_FLTDIV;
1115                 break;
1116         case 0x008: /* Overflow */
1117                 info.si_code = FPE_FLTOVF;
1118                 break;
1119         case 0x020: /* Precision */
1120                 info.si_code = FPE_FLTRES;
1121                 break;
1122         }
1123         force_sig_info(SIGFPE, &info, task);
1124 }
1125
1126 asmlinkage void do_spurious_interrupt_bug(struct pt_regs * regs)
1127 {
1128 }
1129
1130 asmlinkage void __attribute__((weak)) smp_thermal_interrupt(void)
1131 {
1132 }
1133
1134 asmlinkage void __attribute__((weak)) mce_threshold_interrupt(void)
1135 {
1136 }
1137
1138 /*
1139  * 'math_state_restore()' saves the current math information in the
1140  * old math state array, and gets the new ones from the current task
1141  *
1142  * Careful.. There are problems with IBM-designed IRQ13 behaviour.
1143  * Don't touch unless you *really* know how it works.
1144  */
1145 asmlinkage void math_state_restore(void)
1146 {
1147         struct task_struct *me = current;
1148
1149         if (!used_math()) {
1150                 local_irq_enable();
1151                 /*
1152                  * does a slab alloc which can sleep
1153                  */
1154                 if (init_fpu(me)) {
1155                         /*
1156                          * ran out of memory!
1157                          */
1158                         do_group_exit(SIGKILL);
1159                         return;
1160                 }
1161                 local_irq_disable();
1162         }
1163
1164         clts();                         /* Allow maths ops (or we recurse) */
1165         restore_fpu_checking(&me->thread.xstate->fxsave);
1166         task_thread_info(me)->status |= TS_USEDFPU;
1167         me->fpu_counter++;
1168 }
1169 EXPORT_SYMBOL_GPL(math_state_restore);
1170
1171 void __init trap_init(void)
1172 {
1173         set_intr_gate(0, &divide_error);
1174         set_intr_gate_ist(1, &debug, DEBUG_STACK);
1175         set_intr_gate_ist(2, &nmi, NMI_STACK);
1176         set_system_gate_ist(3, &int3, DEBUG_STACK); /* int3 can be called from all */
1177         set_system_gate(4, &overflow); /* int4 can be called from all */
1178         set_intr_gate(5, &bounds);
1179         set_intr_gate(6, &invalid_op);
1180         set_intr_gate(7, &device_not_available);
1181         set_intr_gate_ist(8, &double_fault, DOUBLEFAULT_STACK);
1182         set_intr_gate(9, &coprocessor_segment_overrun);
1183         set_intr_gate(10, &invalid_TSS);
1184         set_intr_gate(11, &segment_not_present);
1185         set_intr_gate_ist(12, &stack_segment, STACKFAULT_STACK);
1186         set_intr_gate(13, &general_protection);
1187         set_intr_gate(14, &page_fault);
1188         set_intr_gate(15, &spurious_interrupt_bug);
1189         set_intr_gate(16, &coprocessor_error);
1190         set_intr_gate(17, &alignment_check);
1191 #ifdef CONFIG_X86_MCE
1192         set_intr_gate_ist(18, &machine_check, MCE_STACK);
1193 #endif
1194         set_intr_gate(19, &simd_coprocessor_error);
1195
1196 #ifdef CONFIG_IA32_EMULATION
1197         set_system_gate(IA32_SYSCALL_VECTOR, ia32_syscall);
1198 #endif
1199         /*
1200          * initialize the per thread extended state:
1201          */
1202         init_thread_xstate();
1203         /*
1204          * Should be a barrier for any external CPU state:
1205          */
1206         cpu_init();
1207 }
1208
1209 static int __init oops_setup(char *s)
1210 {
1211         if (!s)
1212                 return -EINVAL;
1213         if (!strcmp(s, "panic"))
1214                 panic_on_oops = 1;
1215         return 0;
1216 }
1217 early_param("oops", oops_setup);
1218
1219 static int __init kstack_setup(char *s)
1220 {
1221         if (!s)
1222                 return -EINVAL;
1223         kstack_depth_to_print = simple_strtoul(s, NULL, 0);
1224         return 0;
1225 }
1226 early_param("kstack", kstack_setup);
1227
1228 static int __init code_bytes_setup(char *s)
1229 {
1230         code_bytes = simple_strtoul(s, NULL, 0);
1231         if (code_bytes > 8192)
1232                 code_bytes = 8192;
1233
1234         return 1;
1235 }
1236 __setup("code_bytes=", code_bytes_setup);