[PATCH] i386: Implement smp_processor_id() with the PDA
[pandora-kernel.git] / arch / i386 / kernel / entry.S
1 /*
2  *  linux/arch/i386/entry.S
3  *
4  *  Copyright (C) 1991, 1992  Linus Torvalds
5  */
6
7 /*
8  * entry.S contains the system-call and fault low-level handling routines.
9  * This also contains the timer-interrupt handler, as well as all interrupts
10  * and faults that can result in a task-switch.
11  *
12  * NOTE: This code handles signal-recognition, which happens every time
13  * after a timer-interrupt and after each system call.
14  *
15  * I changed all the .align's to 4 (16 byte alignment), as that's faster
16  * on a 486.
17  *
18  * Stack layout in 'ret_from_system_call':
19  *      ptrace needs to have all regs on the stack.
20  *      if the order here is changed, it needs to be
21  *      updated in fork.c:copy_process, signal.c:do_signal,
22  *      ptrace.c and ptrace.h
23  *
24  *       0(%esp) - %ebx
25  *       4(%esp) - %ecx
26  *       8(%esp) - %edx
27  *       C(%esp) - %esi
28  *      10(%esp) - %edi
29  *      14(%esp) - %ebp
30  *      18(%esp) - %eax
31  *      1C(%esp) - %ds
32  *      20(%esp) - %es
33  *      24(%esp) - %gs
34  *      28(%esp) - orig_eax
35  *      2C(%esp) - %eip
36  *      30(%esp) - %cs
37  *      34(%esp) - %eflags
38  *      38(%esp) - %oldesp
39  *      3C(%esp) - %oldss
40  *
41  * "current" is in register %ebx during any slow entries.
42  */
43
44 #include <linux/linkage.h>
45 #include <asm/thread_info.h>
46 #include <asm/irqflags.h>
47 #include <asm/errno.h>
48 #include <asm/segment.h>
49 #include <asm/smp.h>
50 #include <asm/page.h>
51 #include <asm/desc.h>
52 #include <asm/percpu.h>
53 #include <asm/dwarf2.h>
54 #include "irq_vectors.h"
55
56 #define nr_syscalls ((syscall_table_size)/4)
57
58 CF_MASK         = 0x00000001
59 TF_MASK         = 0x00000100
60 IF_MASK         = 0x00000200
61 DF_MASK         = 0x00000400 
62 NT_MASK         = 0x00004000
63 VM_MASK         = 0x00020000
64
65 /* These are replaces for paravirtualization */
66 #define DISABLE_INTERRUPTS              cli
67 #define ENABLE_INTERRUPTS               sti
68 #define ENABLE_INTERRUPTS_SYSEXIT       sti; sysexit
69 #define INTERRUPT_RETURN                iret
70 #define GET_CR0_INTO_EAX                movl %cr0, %eax
71
72 #ifdef CONFIG_PREEMPT
73 #define preempt_stop            DISABLE_INTERRUPTS; TRACE_IRQS_OFF
74 #else
75 #define preempt_stop
76 #define resume_kernel           restore_nocheck
77 #endif
78
79 .macro TRACE_IRQS_IRET
80 #ifdef CONFIG_TRACE_IRQFLAGS
81         testl $IF_MASK,PT_EFLAGS(%esp)     # interrupts off?
82         jz 1f
83         TRACE_IRQS_ON
84 1:
85 #endif
86 .endm
87
88 #ifdef CONFIG_VM86
89 #define resume_userspace_sig    check_userspace
90 #else
91 #define resume_userspace_sig    resume_userspace
92 #endif
93
94 #define SAVE_ALL \
95         cld; \
96         pushl %gs; \
97         CFI_ADJUST_CFA_OFFSET 4;\
98         /*CFI_REL_OFFSET gs, 0;*/\
99         pushl %es; \
100         CFI_ADJUST_CFA_OFFSET 4;\
101         /*CFI_REL_OFFSET es, 0;*/\
102         pushl %ds; \
103         CFI_ADJUST_CFA_OFFSET 4;\
104         /*CFI_REL_OFFSET ds, 0;*/\
105         pushl %eax; \
106         CFI_ADJUST_CFA_OFFSET 4;\
107         CFI_REL_OFFSET eax, 0;\
108         pushl %ebp; \
109         CFI_ADJUST_CFA_OFFSET 4;\
110         CFI_REL_OFFSET ebp, 0;\
111         pushl %edi; \
112         CFI_ADJUST_CFA_OFFSET 4;\
113         CFI_REL_OFFSET edi, 0;\
114         pushl %esi; \
115         CFI_ADJUST_CFA_OFFSET 4;\
116         CFI_REL_OFFSET esi, 0;\
117         pushl %edx; \
118         CFI_ADJUST_CFA_OFFSET 4;\
119         CFI_REL_OFFSET edx, 0;\
120         pushl %ecx; \
121         CFI_ADJUST_CFA_OFFSET 4;\
122         CFI_REL_OFFSET ecx, 0;\
123         pushl %ebx; \
124         CFI_ADJUST_CFA_OFFSET 4;\
125         CFI_REL_OFFSET ebx, 0;\
126         movl $(__USER_DS), %edx; \
127         movl %edx, %ds; \
128         movl %edx, %es; \
129         movl $(__KERNEL_PDA), %edx; \
130         movl %edx, %gs
131
132 #define RESTORE_INT_REGS \
133         popl %ebx;      \
134         CFI_ADJUST_CFA_OFFSET -4;\
135         CFI_RESTORE ebx;\
136         popl %ecx;      \
137         CFI_ADJUST_CFA_OFFSET -4;\
138         CFI_RESTORE ecx;\
139         popl %edx;      \
140         CFI_ADJUST_CFA_OFFSET -4;\
141         CFI_RESTORE edx;\
142         popl %esi;      \
143         CFI_ADJUST_CFA_OFFSET -4;\
144         CFI_RESTORE esi;\
145         popl %edi;      \
146         CFI_ADJUST_CFA_OFFSET -4;\
147         CFI_RESTORE edi;\
148         popl %ebp;      \
149         CFI_ADJUST_CFA_OFFSET -4;\
150         CFI_RESTORE ebp;\
151         popl %eax;      \
152         CFI_ADJUST_CFA_OFFSET -4;\
153         CFI_RESTORE eax
154
155 #define RESTORE_REGS    \
156         RESTORE_INT_REGS; \
157 1:      popl %ds;       \
158         CFI_ADJUST_CFA_OFFSET -4;\
159         /*CFI_RESTORE ds;*/\
160 2:      popl %es;       \
161         CFI_ADJUST_CFA_OFFSET -4;\
162         /*CFI_RESTORE es;*/\
163 3:      popl %gs;       \
164         CFI_ADJUST_CFA_OFFSET -4;\
165         /*CFI_RESTORE gs;*/\
166 .pushsection .fixup,"ax";       \
167 4:      movl $0,(%esp); \
168         jmp 1b;         \
169 5:      movl $0,(%esp); \
170         jmp 2b;         \
171 6:      movl $0,(%esp); \
172         jmp 3b;         \
173 .section __ex_table,"a";\
174         .align 4;       \
175         .long 1b,4b;    \
176         .long 2b,5b;    \
177         .long 3b,6b;    \
178 .popsection
179
180 #define RING0_INT_FRAME \
181         CFI_STARTPROC simple;\
182         CFI_SIGNAL_FRAME;\
183         CFI_DEF_CFA esp, 3*4;\
184         /*CFI_OFFSET cs, -2*4;*/\
185         CFI_OFFSET eip, -3*4
186
187 #define RING0_EC_FRAME \
188         CFI_STARTPROC simple;\
189         CFI_SIGNAL_FRAME;\
190         CFI_DEF_CFA esp, 4*4;\
191         /*CFI_OFFSET cs, -2*4;*/\
192         CFI_OFFSET eip, -3*4
193
194 #define RING0_PTREGS_FRAME \
195         CFI_STARTPROC simple;\
196         CFI_SIGNAL_FRAME;\
197         CFI_DEF_CFA esp, PT_OLDESP-PT_EBX;\
198         /*CFI_OFFSET cs, PT_CS-PT_OLDESP;*/\
199         CFI_OFFSET eip, PT_EIP-PT_OLDESP;\
200         /*CFI_OFFSET es, PT_ES-PT_OLDESP;*/\
201         /*CFI_OFFSET ds, PT_DS-PT_OLDESP;*/\
202         CFI_OFFSET eax, PT_EAX-PT_OLDESP;\
203         CFI_OFFSET ebp, PT_EBP-PT_OLDESP;\
204         CFI_OFFSET edi, PT_EDI-PT_OLDESP;\
205         CFI_OFFSET esi, PT_ESI-PT_OLDESP;\
206         CFI_OFFSET edx, PT_EDX-PT_OLDESP;\
207         CFI_OFFSET ecx, PT_ECX-PT_OLDESP;\
208         CFI_OFFSET ebx, PT_EBX-PT_OLDESP
209
210 ENTRY(ret_from_fork)
211         CFI_STARTPROC
212         pushl %eax
213         CFI_ADJUST_CFA_OFFSET 4
214         call schedule_tail
215         GET_THREAD_INFO(%ebp)
216         popl %eax
217         CFI_ADJUST_CFA_OFFSET -4
218         pushl $0x0202                   # Reset kernel eflags
219         CFI_ADJUST_CFA_OFFSET 4
220         popfl
221         CFI_ADJUST_CFA_OFFSET -4
222         jmp syscall_exit
223         CFI_ENDPROC
224
225 /*
226  * Return to user mode is not as complex as all this looks,
227  * but we want the default path for a system call return to
228  * go as quickly as possible which is why some of this is
229  * less clear than it otherwise should be.
230  */
231
232         # userspace resumption stub bypassing syscall exit tracing
233         ALIGN
234         RING0_PTREGS_FRAME
235 ret_from_exception:
236         preempt_stop
237 ret_from_intr:
238         GET_THREAD_INFO(%ebp)
239 check_userspace:
240         movl PT_EFLAGS(%esp), %eax      # mix EFLAGS and CS
241         movb PT_CS(%esp), %al
242         andl $(VM_MASK | SEGMENT_RPL_MASK), %eax
243         cmpl $USER_RPL, %eax
244         jb resume_kernel                # not returning to v8086 or userspace
245
246 ENTRY(resume_userspace)
247         DISABLE_INTERRUPTS              # make sure we don't miss an interrupt
248                                         # setting need_resched or sigpending
249                                         # between sampling and the iret
250         movl TI_flags(%ebp), %ecx
251         andl $_TIF_WORK_MASK, %ecx      # is there any work to be done on
252                                         # int/exception return?
253         jne work_pending
254         jmp restore_all
255
256 #ifdef CONFIG_PREEMPT
257 ENTRY(resume_kernel)
258         DISABLE_INTERRUPTS
259         cmpl $0,TI_preempt_count(%ebp)  # non-zero preempt_count ?
260         jnz restore_nocheck
261 need_resched:
262         movl TI_flags(%ebp), %ecx       # need_resched set ?
263         testb $_TIF_NEED_RESCHED, %cl
264         jz restore_all
265         testl $IF_MASK,PT_EFLAGS(%esp)  # interrupts off (exception path) ?
266         jz restore_all
267         call preempt_schedule_irq
268         jmp need_resched
269 #endif
270         CFI_ENDPROC
271
272 /* SYSENTER_RETURN points to after the "sysenter" instruction in
273    the vsyscall page.  See vsyscall-sysentry.S, which defines the symbol.  */
274
275         # sysenter call handler stub
276 ENTRY(sysenter_entry)
277         CFI_STARTPROC simple
278         CFI_SIGNAL_FRAME
279         CFI_DEF_CFA esp, 0
280         CFI_REGISTER esp, ebp
281         movl TSS_sysenter_esp0(%esp),%esp
282 sysenter_past_esp:
283         /*
284          * No need to follow this irqs on/off section: the syscall
285          * disabled irqs and here we enable it straight after entry:
286          */
287         ENABLE_INTERRUPTS
288         pushl $(__USER_DS)
289         CFI_ADJUST_CFA_OFFSET 4
290         /*CFI_REL_OFFSET ss, 0*/
291         pushl %ebp
292         CFI_ADJUST_CFA_OFFSET 4
293         CFI_REL_OFFSET esp, 0
294         pushfl
295         CFI_ADJUST_CFA_OFFSET 4
296         pushl $(__USER_CS)
297         CFI_ADJUST_CFA_OFFSET 4
298         /*CFI_REL_OFFSET cs, 0*/
299         /*
300          * Push current_thread_info()->sysenter_return to the stack.
301          * A tiny bit of offset fixup is necessary - 4*4 means the 4 words
302          * pushed above; +8 corresponds to copy_thread's esp0 setting.
303          */
304         pushl (TI_sysenter_return-THREAD_SIZE+8+4*4)(%esp)
305         CFI_ADJUST_CFA_OFFSET 4
306         CFI_REL_OFFSET eip, 0
307
308 /*
309  * Load the potential sixth argument from user stack.
310  * Careful about security.
311  */
312         cmpl $__PAGE_OFFSET-3,%ebp
313         jae syscall_fault
314 1:      movl (%ebp),%ebp
315 .section __ex_table,"a"
316         .align 4
317         .long 1b,syscall_fault
318 .previous
319
320         pushl %eax
321         CFI_ADJUST_CFA_OFFSET 4
322         SAVE_ALL
323         GET_THREAD_INFO(%ebp)
324
325         /* Note, _TIF_SECCOMP is bit number 8, and so it needs testw and not testb */
326         testw $(_TIF_SYSCALL_EMU|_TIF_SYSCALL_TRACE|_TIF_SECCOMP|_TIF_SYSCALL_AUDIT),TI_flags(%ebp)
327         jnz syscall_trace_entry
328         cmpl $(nr_syscalls), %eax
329         jae syscall_badsys
330         call *sys_call_table(,%eax,4)
331         movl %eax,PT_EAX(%esp)
332         DISABLE_INTERRUPTS
333         TRACE_IRQS_OFF
334         movl TI_flags(%ebp), %ecx
335         testw $_TIF_ALLWORK_MASK, %cx
336         jne syscall_exit_work
337 /* if something modifies registers it must also disable sysexit */
338         movl PT_EIP(%esp), %edx
339         movl PT_OLDESP(%esp), %ecx
340         xorl %ebp,%ebp
341         TRACE_IRQS_ON
342 1:      mov  PT_GS(%esp), %gs
343         ENABLE_INTERRUPTS_SYSEXIT
344         CFI_ENDPROC
345 .pushsection .fixup,"ax"
346 2:      movl $0,PT_GS(%esp)
347         jmp 1b
348 .section __ex_table,"a"
349         .align 4
350         .long 1b,2b
351 .popsection
352
353         # system call handler stub
354 ENTRY(system_call)
355         RING0_INT_FRAME                 # can't unwind into user space anyway
356         pushl %eax                      # save orig_eax
357         CFI_ADJUST_CFA_OFFSET 4
358         SAVE_ALL
359         GET_THREAD_INFO(%ebp)
360         testl $TF_MASK,PT_EFLAGS(%esp)
361         jz no_singlestep
362         orl $_TIF_SINGLESTEP,TI_flags(%ebp)
363 no_singlestep:
364                                         # system call tracing in operation / emulation
365         /* Note, _TIF_SECCOMP is bit number 8, and so it needs testw and not testb */
366         testw $(_TIF_SYSCALL_EMU|_TIF_SYSCALL_TRACE|_TIF_SECCOMP|_TIF_SYSCALL_AUDIT),TI_flags(%ebp)
367         jnz syscall_trace_entry
368         cmpl $(nr_syscalls), %eax
369         jae syscall_badsys
370 syscall_call:
371         call *sys_call_table(,%eax,4)
372         movl %eax,PT_EAX(%esp)          # store the return value
373 syscall_exit:
374         DISABLE_INTERRUPTS              # make sure we don't miss an interrupt
375                                         # setting need_resched or sigpending
376                                         # between sampling and the iret
377         TRACE_IRQS_OFF
378         movl TI_flags(%ebp), %ecx
379         testw $_TIF_ALLWORK_MASK, %cx   # current->work
380         jne syscall_exit_work
381
382 restore_all:
383         movl PT_EFLAGS(%esp), %eax      # mix EFLAGS, SS and CS
384         # Warning: PT_OLDSS(%esp) contains the wrong/random values if we
385         # are returning to the kernel.
386         # See comments in process.c:copy_thread() for details.
387         movb PT_OLDSS(%esp), %ah
388         movb PT_CS(%esp), %al
389         andl $(VM_MASK | (SEGMENT_TI_MASK << 8) | SEGMENT_RPL_MASK), %eax
390         cmpl $((SEGMENT_LDT << 8) | USER_RPL), %eax
391         CFI_REMEMBER_STATE
392         je ldt_ss                       # returning to user-space with LDT SS
393 restore_nocheck:
394         TRACE_IRQS_IRET
395 restore_nocheck_notrace:
396         RESTORE_REGS
397         addl $4, %esp                   # skip orig_eax/error_code
398         CFI_ADJUST_CFA_OFFSET -4
399 1:      INTERRUPT_RETURN
400 .section .fixup,"ax"
401 iret_exc:
402         TRACE_IRQS_ON
403         ENABLE_INTERRUPTS
404         pushl $0                        # no error code
405         pushl $do_iret_error
406         jmp error_code
407 .previous
408 .section __ex_table,"a"
409         .align 4
410         .long 1b,iret_exc
411 .previous
412
413         CFI_RESTORE_STATE
414 ldt_ss:
415         larl PT_OLDSS(%esp), %eax
416         jnz restore_nocheck
417         testl $0x00400000, %eax         # returning to 32bit stack?
418         jnz restore_nocheck             # allright, normal return
419         /* If returning to userspace with 16bit stack,
420          * try to fix the higher word of ESP, as the CPU
421          * won't restore it.
422          * This is an "official" bug of all the x86-compatible
423          * CPUs, which we can try to work around to make
424          * dosemu and wine happy. */
425         movl PT_OLDESP(%esp), %eax
426         movl %esp, %edx
427         call patch_espfix_desc
428         pushl $__ESPFIX_SS
429         CFI_ADJUST_CFA_OFFSET 4
430         pushl %eax
431         CFI_ADJUST_CFA_OFFSET 4
432         DISABLE_INTERRUPTS
433         TRACE_IRQS_OFF
434         lss (%esp), %esp
435         CFI_ADJUST_CFA_OFFSET -8
436         jmp restore_nocheck
437         CFI_ENDPROC
438
439         # perform work that needs to be done immediately before resumption
440         ALIGN
441         RING0_PTREGS_FRAME              # can't unwind into user space anyway
442 work_pending:
443         testb $_TIF_NEED_RESCHED, %cl
444         jz work_notifysig
445 work_resched:
446         call schedule
447         DISABLE_INTERRUPTS              # make sure we don't miss an interrupt
448                                         # setting need_resched or sigpending
449                                         # between sampling and the iret
450         TRACE_IRQS_OFF
451         movl TI_flags(%ebp), %ecx
452         andl $_TIF_WORK_MASK, %ecx      # is there any work to be done other
453                                         # than syscall tracing?
454         jz restore_all
455         testb $_TIF_NEED_RESCHED, %cl
456         jnz work_resched
457
458 work_notifysig:                         # deal with pending signals and
459                                         # notify-resume requests
460         testl $VM_MASK, PT_EFLAGS(%esp)
461         movl %esp, %eax
462         jne work_notifysig_v86          # returning to kernel-space or
463                                         # vm86-space
464         xorl %edx, %edx
465         call do_notify_resume
466         jmp resume_userspace_sig
467
468         ALIGN
469 work_notifysig_v86:
470 #ifdef CONFIG_VM86
471         pushl %ecx                      # save ti_flags for do_notify_resume
472         CFI_ADJUST_CFA_OFFSET 4
473         call save_v86_state             # %eax contains pt_regs pointer
474         popl %ecx
475         CFI_ADJUST_CFA_OFFSET -4
476         movl %eax, %esp
477         xorl %edx, %edx
478         call do_notify_resume
479         jmp resume_userspace_sig
480 #endif
481
482         # perform syscall exit tracing
483         ALIGN
484 syscall_trace_entry:
485         movl $-ENOSYS,PT_EAX(%esp)
486         movl %esp, %eax
487         xorl %edx,%edx
488         call do_syscall_trace
489         cmpl $0, %eax
490         jne resume_userspace            # ret != 0 -> running under PTRACE_SYSEMU,
491                                         # so must skip actual syscall
492         movl PT_ORIG_EAX(%esp), %eax
493         cmpl $(nr_syscalls), %eax
494         jnae syscall_call
495         jmp syscall_exit
496
497         # perform syscall exit tracing
498         ALIGN
499 syscall_exit_work:
500         testb $(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT|_TIF_SINGLESTEP), %cl
501         jz work_pending
502         TRACE_IRQS_ON
503         ENABLE_INTERRUPTS               # could let do_syscall_trace() call
504                                         # schedule() instead
505         movl %esp, %eax
506         movl $1, %edx
507         call do_syscall_trace
508         jmp resume_userspace
509         CFI_ENDPROC
510
511         RING0_INT_FRAME                 # can't unwind into user space anyway
512 syscall_fault:
513         pushl %eax                      # save orig_eax
514         CFI_ADJUST_CFA_OFFSET 4
515         SAVE_ALL
516         GET_THREAD_INFO(%ebp)
517         movl $-EFAULT,PT_EAX(%esp)
518         jmp resume_userspace
519
520 syscall_badsys:
521         movl $-ENOSYS,PT_EAX(%esp)
522         jmp resume_userspace
523         CFI_ENDPROC
524
525 #define FIXUP_ESPFIX_STACK \
526         /* since we are on a wrong stack, we cant make it a C code :( */ \
527         movl %gs:PDA_cpu, %ebx; \
528         PER_CPU(cpu_gdt_descr, %ebx); \
529         movl GDS_address(%ebx), %ebx; \
530         GET_DESC_BASE(GDT_ENTRY_ESPFIX_SS, %ebx, %eax, %ax, %al, %ah); \
531         addl %esp, %eax; \
532         pushl $__KERNEL_DS; \
533         CFI_ADJUST_CFA_OFFSET 4; \
534         pushl %eax; \
535         CFI_ADJUST_CFA_OFFSET 4; \
536         lss (%esp), %esp; \
537         CFI_ADJUST_CFA_OFFSET -8;
538 #define UNWIND_ESPFIX_STACK \
539         movl %ss, %eax; \
540         /* see if on espfix stack */ \
541         cmpw $__ESPFIX_SS, %ax; \
542         jne 27f; \
543         movl $__KERNEL_DS, %eax; \
544         movl %eax, %ds; \
545         movl %eax, %es; \
546         /* switch to normal stack */ \
547         FIXUP_ESPFIX_STACK; \
548 27:;
549
550 /*
551  * Build the entry stubs and pointer table with
552  * some assembler magic.
553  */
554 .data
555 ENTRY(interrupt)
556 .text
557
558 vector=0
559 ENTRY(irq_entries_start)
560         RING0_INT_FRAME
561 .rept NR_IRQS
562         ALIGN
563  .if vector
564         CFI_ADJUST_CFA_OFFSET -4
565  .endif
566 1:      pushl $~(vector)
567         CFI_ADJUST_CFA_OFFSET 4
568         jmp common_interrupt
569 .data
570         .long 1b
571 .text
572 vector=vector+1
573 .endr
574
575 /*
576  * the CPU automatically disables interrupts when executing an IRQ vector,
577  * so IRQ-flags tracing has to follow that:
578  */
579         ALIGN
580 common_interrupt:
581         SAVE_ALL
582         TRACE_IRQS_OFF
583         movl %esp,%eax
584         call do_IRQ
585         jmp ret_from_intr
586         CFI_ENDPROC
587
588 #define BUILD_INTERRUPT(name, nr)       \
589 ENTRY(name)                             \
590         RING0_INT_FRAME;                \
591         pushl $~(nr);                   \
592         CFI_ADJUST_CFA_OFFSET 4;        \
593         SAVE_ALL;                       \
594         TRACE_IRQS_OFF                  \
595         movl %esp,%eax;                 \
596         call smp_/**/name;              \
597         jmp ret_from_intr;              \
598         CFI_ENDPROC
599
600 /* The include is where all of the SMP etc. interrupts come from */
601 #include "entry_arch.h"
602
603 KPROBE_ENTRY(page_fault)
604         RING0_EC_FRAME
605         pushl $do_page_fault
606         CFI_ADJUST_CFA_OFFSET 4
607         ALIGN
608 error_code:
609         /* the function address is in %gs's slot on the stack */
610         pushl %es
611         CFI_ADJUST_CFA_OFFSET 4
612         /*CFI_REL_OFFSET es, 0*/
613         pushl %ds
614         CFI_ADJUST_CFA_OFFSET 4
615         /*CFI_REL_OFFSET ds, 0*/
616         pushl %eax
617         CFI_ADJUST_CFA_OFFSET 4
618         CFI_REL_OFFSET eax, 0
619         pushl %ebp
620         CFI_ADJUST_CFA_OFFSET 4
621         CFI_REL_OFFSET ebp, 0
622         pushl %edi
623         CFI_ADJUST_CFA_OFFSET 4
624         CFI_REL_OFFSET edi, 0
625         pushl %esi
626         CFI_ADJUST_CFA_OFFSET 4
627         CFI_REL_OFFSET esi, 0
628         pushl %edx
629         CFI_ADJUST_CFA_OFFSET 4
630         CFI_REL_OFFSET edx, 0
631         pushl %ecx
632         CFI_ADJUST_CFA_OFFSET 4
633         CFI_REL_OFFSET ecx, 0
634         pushl %ebx
635         CFI_ADJUST_CFA_OFFSET 4
636         CFI_REL_OFFSET ebx, 0
637         cld
638         pushl %gs
639         CFI_ADJUST_CFA_OFFSET 4
640         /*CFI_REL_OFFSET gs, 0*/
641         movl $(__KERNEL_PDA), %ecx
642         movl %ecx, %gs
643         UNWIND_ESPFIX_STACK
644         popl %ecx
645         CFI_ADJUST_CFA_OFFSET -4
646         /*CFI_REGISTER es, ecx*/
647         movl PT_GS(%esp), %edi          # get the function address
648         movl PT_ORIG_EAX(%esp), %edx    # get the error code
649         movl $-1, PT_ORIG_EAX(%esp)     # no syscall to restart
650         mov  %ecx, PT_GS(%esp)
651         /*CFI_REL_OFFSET gs, ES*/
652         movl $(__USER_DS), %ecx
653         movl %ecx, %ds
654         movl %ecx, %es
655         movl %esp,%eax                  # pt_regs pointer
656         call *%edi
657         jmp ret_from_exception
658         CFI_ENDPROC
659 KPROBE_END(page_fault)
660
661 ENTRY(coprocessor_error)
662         RING0_INT_FRAME
663         pushl $0
664         CFI_ADJUST_CFA_OFFSET 4
665         pushl $do_coprocessor_error
666         CFI_ADJUST_CFA_OFFSET 4
667         jmp error_code
668         CFI_ENDPROC
669
670 ENTRY(simd_coprocessor_error)
671         RING0_INT_FRAME
672         pushl $0
673         CFI_ADJUST_CFA_OFFSET 4
674         pushl $do_simd_coprocessor_error
675         CFI_ADJUST_CFA_OFFSET 4
676         jmp error_code
677         CFI_ENDPROC
678
679 ENTRY(device_not_available)
680         RING0_INT_FRAME
681         pushl $-1                       # mark this as an int
682         CFI_ADJUST_CFA_OFFSET 4
683         SAVE_ALL
684         GET_CR0_INTO_EAX
685         testl $0x4, %eax                # EM (math emulation bit)
686         jne device_not_available_emulate
687         preempt_stop
688         call math_state_restore
689         jmp ret_from_exception
690 device_not_available_emulate:
691         pushl $0                        # temporary storage for ORIG_EIP
692         CFI_ADJUST_CFA_OFFSET 4
693         call math_emulate
694         addl $4, %esp
695         CFI_ADJUST_CFA_OFFSET -4
696         jmp ret_from_exception
697         CFI_ENDPROC
698
699 /*
700  * Debug traps and NMI can happen at the one SYSENTER instruction
701  * that sets up the real kernel stack. Check here, since we can't
702  * allow the wrong stack to be used.
703  *
704  * "TSS_sysenter_esp0+12" is because the NMI/debug handler will have
705  * already pushed 3 words if it hits on the sysenter instruction:
706  * eflags, cs and eip.
707  *
708  * We just load the right stack, and push the three (known) values
709  * by hand onto the new stack - while updating the return eip past
710  * the instruction that would have done it for sysenter.
711  */
712 #define FIX_STACK(offset, ok, label)            \
713         cmpw $__KERNEL_CS,4(%esp);              \
714         jne ok;                                 \
715 label:                                          \
716         movl TSS_sysenter_esp0+offset(%esp),%esp;       \
717         CFI_DEF_CFA esp, 0;                     \
718         CFI_UNDEFINED eip;                      \
719         pushfl;                                 \
720         CFI_ADJUST_CFA_OFFSET 4;                \
721         pushl $__KERNEL_CS;                     \
722         CFI_ADJUST_CFA_OFFSET 4;                \
723         pushl $sysenter_past_esp;               \
724         CFI_ADJUST_CFA_OFFSET 4;                \
725         CFI_REL_OFFSET eip, 0
726
727 KPROBE_ENTRY(debug)
728         RING0_INT_FRAME
729         cmpl $sysenter_entry,(%esp)
730         jne debug_stack_correct
731         FIX_STACK(12, debug_stack_correct, debug_esp_fix_insn)
732 debug_stack_correct:
733         pushl $-1                       # mark this as an int
734         CFI_ADJUST_CFA_OFFSET 4
735         SAVE_ALL
736         xorl %edx,%edx                  # error code 0
737         movl %esp,%eax                  # pt_regs pointer
738         call do_debug
739         jmp ret_from_exception
740         CFI_ENDPROC
741 KPROBE_END(debug)
742
743 /*
744  * NMI is doubly nasty. It can happen _while_ we're handling
745  * a debug fault, and the debug fault hasn't yet been able to
746  * clear up the stack. So we first check whether we got  an
747  * NMI on the sysenter entry path, but after that we need to
748  * check whether we got an NMI on the debug path where the debug
749  * fault happened on the sysenter path.
750  */
751 KPROBE_ENTRY(nmi)
752         RING0_INT_FRAME
753         pushl %eax
754         CFI_ADJUST_CFA_OFFSET 4
755         movl %ss, %eax
756         cmpw $__ESPFIX_SS, %ax
757         popl %eax
758         CFI_ADJUST_CFA_OFFSET -4
759         je nmi_espfix_stack
760         cmpl $sysenter_entry,(%esp)
761         je nmi_stack_fixup
762         pushl %eax
763         CFI_ADJUST_CFA_OFFSET 4
764         movl %esp,%eax
765         /* Do not access memory above the end of our stack page,
766          * it might not exist.
767          */
768         andl $(THREAD_SIZE-1),%eax
769         cmpl $(THREAD_SIZE-20),%eax
770         popl %eax
771         CFI_ADJUST_CFA_OFFSET -4
772         jae nmi_stack_correct
773         cmpl $sysenter_entry,12(%esp)
774         je nmi_debug_stack_check
775 nmi_stack_correct:
776         /* We have a RING0_INT_FRAME here */
777         pushl %eax
778         CFI_ADJUST_CFA_OFFSET 4
779         SAVE_ALL
780         xorl %edx,%edx          # zero error code
781         movl %esp,%eax          # pt_regs pointer
782         call do_nmi
783         jmp restore_nocheck_notrace
784         CFI_ENDPROC
785
786 nmi_stack_fixup:
787         RING0_INT_FRAME
788         FIX_STACK(12,nmi_stack_correct, 1)
789         jmp nmi_stack_correct
790
791 nmi_debug_stack_check:
792         /* We have a RING0_INT_FRAME here */
793         cmpw $__KERNEL_CS,16(%esp)
794         jne nmi_stack_correct
795         cmpl $debug,(%esp)
796         jb nmi_stack_correct
797         cmpl $debug_esp_fix_insn,(%esp)
798         ja nmi_stack_correct
799         FIX_STACK(24,nmi_stack_correct, 1)
800         jmp nmi_stack_correct
801
802 nmi_espfix_stack:
803         /* We have a RING0_INT_FRAME here.
804          *
805          * create the pointer to lss back
806          */
807         pushl %ss
808         CFI_ADJUST_CFA_OFFSET 4
809         pushl %esp
810         CFI_ADJUST_CFA_OFFSET 4
811         addw $4, (%esp)
812         /* copy the iret frame of 12 bytes */
813         .rept 3
814         pushl 16(%esp)
815         CFI_ADJUST_CFA_OFFSET 4
816         .endr
817         pushl %eax
818         CFI_ADJUST_CFA_OFFSET 4
819         SAVE_ALL
820         FIXUP_ESPFIX_STACK              # %eax == %esp
821         xorl %edx,%edx                  # zero error code
822         call do_nmi
823         RESTORE_REGS
824         lss 12+4(%esp), %esp            # back to espfix stack
825         CFI_ADJUST_CFA_OFFSET -24
826 1:      INTERRUPT_RETURN
827         CFI_ENDPROC
828 .section __ex_table,"a"
829         .align 4
830         .long 1b,iret_exc
831 .previous
832 KPROBE_END(nmi)
833
834 KPROBE_ENTRY(int3)
835         RING0_INT_FRAME
836         pushl $-1                       # mark this as an int
837         CFI_ADJUST_CFA_OFFSET 4
838         SAVE_ALL
839         xorl %edx,%edx          # zero error code
840         movl %esp,%eax          # pt_regs pointer
841         call do_int3
842         jmp ret_from_exception
843         CFI_ENDPROC
844 KPROBE_END(int3)
845
846 ENTRY(overflow)
847         RING0_INT_FRAME
848         pushl $0
849         CFI_ADJUST_CFA_OFFSET 4
850         pushl $do_overflow
851         CFI_ADJUST_CFA_OFFSET 4
852         jmp error_code
853         CFI_ENDPROC
854
855 ENTRY(bounds)
856         RING0_INT_FRAME
857         pushl $0
858         CFI_ADJUST_CFA_OFFSET 4
859         pushl $do_bounds
860         CFI_ADJUST_CFA_OFFSET 4
861         jmp error_code
862         CFI_ENDPROC
863
864 ENTRY(invalid_op)
865         RING0_INT_FRAME
866         pushl $0
867         CFI_ADJUST_CFA_OFFSET 4
868         pushl $do_invalid_op
869         CFI_ADJUST_CFA_OFFSET 4
870         jmp error_code
871         CFI_ENDPROC
872
873 ENTRY(coprocessor_segment_overrun)
874         RING0_INT_FRAME
875         pushl $0
876         CFI_ADJUST_CFA_OFFSET 4
877         pushl $do_coprocessor_segment_overrun
878         CFI_ADJUST_CFA_OFFSET 4
879         jmp error_code
880         CFI_ENDPROC
881
882 ENTRY(invalid_TSS)
883         RING0_EC_FRAME
884         pushl $do_invalid_TSS
885         CFI_ADJUST_CFA_OFFSET 4
886         jmp error_code
887         CFI_ENDPROC
888
889 ENTRY(segment_not_present)
890         RING0_EC_FRAME
891         pushl $do_segment_not_present
892         CFI_ADJUST_CFA_OFFSET 4
893         jmp error_code
894         CFI_ENDPROC
895
896 ENTRY(stack_segment)
897         RING0_EC_FRAME
898         pushl $do_stack_segment
899         CFI_ADJUST_CFA_OFFSET 4
900         jmp error_code
901         CFI_ENDPROC
902
903 KPROBE_ENTRY(general_protection)
904         RING0_EC_FRAME
905         pushl $do_general_protection
906         CFI_ADJUST_CFA_OFFSET 4
907         jmp error_code
908         CFI_ENDPROC
909 KPROBE_END(general_protection)
910
911 ENTRY(alignment_check)
912         RING0_EC_FRAME
913         pushl $do_alignment_check
914         CFI_ADJUST_CFA_OFFSET 4
915         jmp error_code
916         CFI_ENDPROC
917
918 ENTRY(divide_error)
919         RING0_INT_FRAME
920         pushl $0                        # no error code
921         CFI_ADJUST_CFA_OFFSET 4
922         pushl $do_divide_error
923         CFI_ADJUST_CFA_OFFSET 4
924         jmp error_code
925         CFI_ENDPROC
926
927 #ifdef CONFIG_X86_MCE
928 ENTRY(machine_check)
929         RING0_INT_FRAME
930         pushl $0
931         CFI_ADJUST_CFA_OFFSET 4
932         pushl machine_check_vector
933         CFI_ADJUST_CFA_OFFSET 4
934         jmp error_code
935         CFI_ENDPROC
936 #endif
937
938 ENTRY(spurious_interrupt_bug)
939         RING0_INT_FRAME
940         pushl $0
941         CFI_ADJUST_CFA_OFFSET 4
942         pushl $do_spurious_interrupt_bug
943         CFI_ADJUST_CFA_OFFSET 4
944         jmp error_code
945         CFI_ENDPROC
946
947 #ifdef CONFIG_STACK_UNWIND
948 ENTRY(arch_unwind_init_running)
949         CFI_STARTPROC
950         movl    4(%esp), %edx
951         movl    (%esp), %ecx
952         leal    4(%esp), %eax
953         movl    %ebx, PT_EBX(%edx)
954         xorl    %ebx, %ebx
955         movl    %ebx, PT_ECX(%edx)
956         movl    %ebx, PT_EDX(%edx)
957         movl    %esi, PT_ESI(%edx)
958         movl    %edi, PT_EDI(%edx)
959         movl    %ebp, PT_EBP(%edx)
960         movl    %ebx, PT_EAX(%edx)
961         movl    $__USER_DS, PT_DS(%edx)
962         movl    $__USER_DS, PT_ES(%edx)
963         movl    $0, PT_GS(%edx)
964         movl    %ebx, PT_ORIG_EAX(%edx)
965         movl    %ecx, PT_EIP(%edx)
966         movl    12(%esp), %ecx
967         movl    $__KERNEL_CS, PT_CS(%edx)
968         movl    %ebx, PT_EFLAGS(%edx)
969         movl    %eax, PT_OLDESP(%edx)
970         movl    8(%esp), %eax
971         movl    %ecx, 8(%esp)
972         movl    PT_EBX(%edx), %ebx
973         movl    $__KERNEL_DS, PT_OLDSS(%edx)
974         jmpl    *%eax
975         CFI_ENDPROC
976 ENDPROC(arch_unwind_init_running)
977 #endif
978
979 ENTRY(kernel_thread_helper)
980         pushl $0                # fake return address for unwinder
981         CFI_STARTPROC
982         movl %edx,%eax
983         push %edx
984         CFI_ADJUST_CFA_OFFSET 4
985         call *%ebx
986         push %eax
987         CFI_ADJUST_CFA_OFFSET 4
988         call do_exit
989         CFI_ENDPROC
990 ENDPROC(kernel_thread_helper)
991
992 .section .rodata,"a"
993 #include "syscall_table.S"
994
995 syscall_table_size=(.-sys_call_table)