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