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