x86: set bp field in pt_regs properly
[pandora-kernel.git] / arch / x86 / kernel / entry_64.S
1 /*
2  *  linux/arch/x86_64/entry.S
3  *
4  *  Copyright (C) 1991, 1992  Linus Torvalds
5  *  Copyright (C) 2000, 2001, 2002  Andi Kleen SuSE Labs
6  *  Copyright (C) 2000  Pavel Machek <pavel@suse.cz>
7  */
8
9 /*
10  * entry.S contains the system-call and fault low-level handling routines.
11  *
12  * NOTE: This code handles signal-recognition, which happens every time
13  * after an interrupt and after each system call.
14  * 
15  * Normal syscalls and interrupts don't save a full stack frame, this is 
16  * only done for syscall tracing, signals or fork/exec et.al.
17  * 
18  * A note on terminology:        
19  * - top of stack: Architecture defined interrupt frame from SS to RIP 
20  * at the top of the kernel process stack.      
21  * - partial stack frame: partially saved registers upto R11.
22  * - full stack frame: Like partial stack frame, but all register saved. 
23  *
24  * Some macro usage:
25  * - CFI macros are used to generate dwarf2 unwind information for better
26  * backtraces. They don't change any code.
27  * - SAVE_ALL/RESTORE_ALL - Save/restore all registers
28  * - SAVE_ARGS/RESTORE_ARGS - Save/restore registers that C functions modify.
29  * There are unfortunately lots of special cases where some registers
30  * not touched. The macro is a big mess that should be cleaned up.
31  * - SAVE_REST/RESTORE_REST - Handle the registers not saved by SAVE_ARGS.
32  * Gives a full stack frame.
33  * - ENTRY/END Define functions in the symbol table.
34  * - FIXUP_TOP_OF_STACK/RESTORE_TOP_OF_STACK - Fix up the hardware stack
35  * frame that is otherwise undefined after a SYSCALL
36  * - TRACE_IRQ_* - Trace hard interrupt state for lock debugging.
37  * - errorentry/paranoidentry/zeroentry - Define exception entry points.
38  */
39
40 #include <linux/linkage.h>
41 #include <asm/segment.h>
42 #include <asm/cache.h>
43 #include <asm/errno.h>
44 #include <asm/dwarf2.h>
45 #include <asm/calling.h>
46 #include <asm/asm-offsets.h>
47 #include <asm/msr.h>
48 #include <asm/unistd.h>
49 #include <asm/thread_info.h>
50 #include <asm/hw_irq.h>
51 #include <asm/page.h>
52 #include <asm/irqflags.h>
53 #include <asm/paravirt.h>
54 #include <asm/ftrace.h>
55
56 /* Avoid __ASSEMBLER__'ifying <linux/audit.h> just for this.  */
57 #include <linux/elf-em.h>
58 #define AUDIT_ARCH_X86_64       (EM_X86_64|__AUDIT_ARCH_64BIT|__AUDIT_ARCH_LE)
59 #define __AUDIT_ARCH_64BIT 0x80000000
60 #define __AUDIT_ARCH_LE    0x40000000
61
62         .code64
63
64 #ifdef CONFIG_FTRACE
65 #ifdef CONFIG_DYNAMIC_FTRACE
66 ENTRY(mcount)
67
68         subq $0x38, %rsp
69         movq %rax, (%rsp)
70         movq %rcx, 8(%rsp)
71         movq %rdx, 16(%rsp)
72         movq %rsi, 24(%rsp)
73         movq %rdi, 32(%rsp)
74         movq %r8, 40(%rsp)
75         movq %r9, 48(%rsp)
76
77         movq 0x38(%rsp), %rdi
78         subq $MCOUNT_INSN_SIZE, %rdi
79
80 .globl mcount_call
81 mcount_call:
82         call ftrace_stub
83
84         movq 48(%rsp), %r9
85         movq 40(%rsp), %r8
86         movq 32(%rsp), %rdi
87         movq 24(%rsp), %rsi
88         movq 16(%rsp), %rdx
89         movq 8(%rsp), %rcx
90         movq (%rsp), %rax
91         addq $0x38, %rsp
92
93         retq
94 END(mcount)
95
96 ENTRY(ftrace_caller)
97
98         /* taken from glibc */
99         subq $0x38, %rsp
100         movq %rax, (%rsp)
101         movq %rcx, 8(%rsp)
102         movq %rdx, 16(%rsp)
103         movq %rsi, 24(%rsp)
104         movq %rdi, 32(%rsp)
105         movq %r8, 40(%rsp)
106         movq %r9, 48(%rsp)
107
108         movq 0x38(%rsp), %rdi
109         movq 8(%rbp), %rsi
110         subq $MCOUNT_INSN_SIZE, %rdi
111
112 .globl ftrace_call
113 ftrace_call:
114         call ftrace_stub
115
116         movq 48(%rsp), %r9
117         movq 40(%rsp), %r8
118         movq 32(%rsp), %rdi
119         movq 24(%rsp), %rsi
120         movq 16(%rsp), %rdx
121         movq 8(%rsp), %rcx
122         movq (%rsp), %rax
123         addq $0x38, %rsp
124
125 .globl ftrace_stub
126 ftrace_stub:
127         retq
128 END(ftrace_caller)
129
130 #else /* ! CONFIG_DYNAMIC_FTRACE */
131 ENTRY(mcount)
132         cmpq $ftrace_stub, ftrace_trace_function
133         jnz trace
134 .globl ftrace_stub
135 ftrace_stub:
136         retq
137
138 trace:
139         /* taken from glibc */
140         subq $0x38, %rsp
141         movq %rax, (%rsp)
142         movq %rcx, 8(%rsp)
143         movq %rdx, 16(%rsp)
144         movq %rsi, 24(%rsp)
145         movq %rdi, 32(%rsp)
146         movq %r8, 40(%rsp)
147         movq %r9, 48(%rsp)
148
149         movq 0x38(%rsp), %rdi
150         movq 8(%rbp), %rsi
151         subq $MCOUNT_INSN_SIZE, %rdi
152
153         call   *ftrace_trace_function
154
155         movq 48(%rsp), %r9
156         movq 40(%rsp), %r8
157         movq 32(%rsp), %rdi
158         movq 24(%rsp), %rsi
159         movq 16(%rsp), %rdx
160         movq 8(%rsp), %rcx
161         movq (%rsp), %rax
162         addq $0x38, %rsp
163
164         jmp ftrace_stub
165 END(mcount)
166 #endif /* CONFIG_DYNAMIC_FTRACE */
167 #endif /* CONFIG_FTRACE */
168
169 #ifndef CONFIG_PREEMPT
170 #define retint_kernel retint_restore_args
171 #endif  
172
173 #ifdef CONFIG_PARAVIRT
174 ENTRY(native_usergs_sysret64)
175         swapgs
176         sysretq
177 #endif /* CONFIG_PARAVIRT */
178
179
180 .macro TRACE_IRQS_IRETQ offset=ARGOFFSET
181 #ifdef CONFIG_TRACE_IRQFLAGS
182         bt   $9,EFLAGS-\offset(%rsp)    /* interrupts off? */
183         jnc  1f
184         TRACE_IRQS_ON
185 1:
186 #endif
187 .endm
188
189 /*
190  * C code is not supposed to know about undefined top of stack. Every time 
191  * a C function with an pt_regs argument is called from the SYSCALL based 
192  * fast path FIXUP_TOP_OF_STACK is needed.
193  * RESTORE_TOP_OF_STACK syncs the syscall state after any possible ptregs
194  * manipulation.
195  */             
196                 
197         /* %rsp:at FRAMEEND */ 
198         .macro FIXUP_TOP_OF_STACK tmp
199         movq    %gs:pda_oldrsp,\tmp
200         movq    \tmp,RSP(%rsp)
201         movq    $__USER_DS,SS(%rsp)
202         movq    $__USER_CS,CS(%rsp)
203         movq    $-1,RCX(%rsp)
204         movq    R11(%rsp),\tmp  /* get eflags */
205         movq    \tmp,EFLAGS(%rsp)
206         .endm
207
208         .macro RESTORE_TOP_OF_STACK tmp,offset=0
209         movq   RSP-\offset(%rsp),\tmp
210         movq   \tmp,%gs:pda_oldrsp
211         movq   EFLAGS-\offset(%rsp),\tmp
212         movq   \tmp,R11-\offset(%rsp)
213         .endm
214
215         .macro FAKE_STACK_FRAME child_rip
216         /* push in order ss, rsp, eflags, cs, rip */
217         xorl %eax, %eax
218         pushq $__KERNEL_DS /* ss */
219         CFI_ADJUST_CFA_OFFSET   8
220         /*CFI_REL_OFFSET        ss,0*/
221         pushq %rax /* rsp */
222         CFI_ADJUST_CFA_OFFSET   8
223         CFI_REL_OFFSET  rsp,0
224         pushq $(1<<9) /* eflags - interrupts on */
225         CFI_ADJUST_CFA_OFFSET   8
226         /*CFI_REL_OFFSET        rflags,0*/
227         pushq $__KERNEL_CS /* cs */
228         CFI_ADJUST_CFA_OFFSET   8
229         /*CFI_REL_OFFSET        cs,0*/
230         pushq \child_rip /* rip */
231         CFI_ADJUST_CFA_OFFSET   8
232         CFI_REL_OFFSET  rip,0
233         pushq   %rax /* orig rax */
234         CFI_ADJUST_CFA_OFFSET   8
235         .endm
236
237         .macro UNFAKE_STACK_FRAME
238         addq $8*6, %rsp
239         CFI_ADJUST_CFA_OFFSET   -(6*8)
240         .endm
241
242         .macro  CFI_DEFAULT_STACK start=1
243         .if \start
244         CFI_STARTPROC   simple
245         CFI_SIGNAL_FRAME
246         CFI_DEF_CFA     rsp,SS+8
247         .else
248         CFI_DEF_CFA_OFFSET SS+8
249         .endif
250         CFI_REL_OFFSET  r15,R15
251         CFI_REL_OFFSET  r14,R14
252         CFI_REL_OFFSET  r13,R13
253         CFI_REL_OFFSET  r12,R12
254         CFI_REL_OFFSET  rbp,RBP
255         CFI_REL_OFFSET  rbx,RBX
256         CFI_REL_OFFSET  r11,R11
257         CFI_REL_OFFSET  r10,R10
258         CFI_REL_OFFSET  r9,R9
259         CFI_REL_OFFSET  r8,R8
260         CFI_REL_OFFSET  rax,RAX
261         CFI_REL_OFFSET  rcx,RCX
262         CFI_REL_OFFSET  rdx,RDX
263         CFI_REL_OFFSET  rsi,RSI
264         CFI_REL_OFFSET  rdi,RDI
265         CFI_REL_OFFSET  rip,RIP
266         /*CFI_REL_OFFSET        cs,CS*/
267         /*CFI_REL_OFFSET        rflags,EFLAGS*/
268         CFI_REL_OFFSET  rsp,RSP
269         /*CFI_REL_OFFSET        ss,SS*/
270         .endm
271 /*
272  * A newly forked process directly context switches into this.
273  */     
274 /* rdi: prev */ 
275 ENTRY(ret_from_fork)
276         CFI_DEFAULT_STACK
277         push kernel_eflags(%rip)
278         CFI_ADJUST_CFA_OFFSET 8
279         popf                            # reset kernel eflags
280         CFI_ADJUST_CFA_OFFSET -8
281         call schedule_tail
282         GET_THREAD_INFO(%rcx)
283         testl $(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT),TI_flags(%rcx)
284         jnz rff_trace
285 rff_action:     
286         RESTORE_REST
287         testl $3,CS-ARGOFFSET(%rsp)     # from kernel_thread?
288         je   int_ret_from_sys_call
289         testl $_TIF_IA32,TI_flags(%rcx)
290         jnz  int_ret_from_sys_call
291         RESTORE_TOP_OF_STACK %rdi,ARGOFFSET
292         jmp ret_from_sys_call
293 rff_trace:
294         movq %rsp,%rdi
295         call syscall_trace_leave
296         GET_THREAD_INFO(%rcx)   
297         jmp rff_action
298         CFI_ENDPROC
299 END(ret_from_fork)
300
301 /*
302  * System call entry. Upto 6 arguments in registers are supported.
303  *
304  * SYSCALL does not save anything on the stack and does not change the
305  * stack pointer.
306  */
307                 
308 /*
309  * Register setup:      
310  * rax  system call number
311  * rdi  arg0
312  * rcx  return address for syscall/sysret, C arg3 
313  * rsi  arg1
314  * rdx  arg2    
315  * r10  arg3    (--> moved to rcx for C)
316  * r8   arg4
317  * r9   arg5
318  * r11  eflags for syscall/sysret, temporary for C
319  * r12-r15,rbp,rbx saved by C code, not touched.                
320  * 
321  * Interrupts are off on entry.
322  * Only called from user space.
323  *
324  * XXX  if we had a free scratch register we could save the RSP into the stack frame
325  *      and report it properly in ps. Unfortunately we haven't.
326  *
327  * When user can change the frames always force IRET. That is because
328  * it deals with uncanonical addresses better. SYSRET has trouble
329  * with them due to bugs in both AMD and Intel CPUs.
330  */                                     
331
332 ENTRY(system_call)
333         CFI_STARTPROC   simple
334         CFI_SIGNAL_FRAME
335         CFI_DEF_CFA     rsp,PDA_STACKOFFSET
336         CFI_REGISTER    rip,rcx
337         /*CFI_REGISTER  rflags,r11*/
338         SWAPGS_UNSAFE_STACK
339         /*
340          * A hypervisor implementation might want to use a label
341          * after the swapgs, so that it can do the swapgs
342          * for the guest and jump here on syscall.
343          */
344 ENTRY(system_call_after_swapgs)
345
346         movq    %rsp,%gs:pda_oldrsp 
347         movq    %gs:pda_kernelstack,%rsp
348         /*
349          * No need to follow this irqs off/on section - it's straight
350          * and short:
351          */
352         ENABLE_INTERRUPTS(CLBR_NONE)
353         SAVE_ARGS 8,1
354         movq  %rax,ORIG_RAX-ARGOFFSET(%rsp) 
355         movq  %rcx,RIP-ARGOFFSET(%rsp)
356         CFI_REL_OFFSET rip,RIP-ARGOFFSET
357         GET_THREAD_INFO(%rcx)
358         testl $_TIF_WORK_SYSCALL_ENTRY,TI_flags(%rcx)
359         jnz tracesys
360 system_call_fastpath:
361         cmpq $__NR_syscall_max,%rax
362         ja badsys
363         movq %r10,%rcx
364         call *sys_call_table(,%rax,8)  # XXX:    rip relative
365         movq %rax,RAX-ARGOFFSET(%rsp)
366 /*
367  * Syscall return path ending with SYSRET (fast path)
368  * Has incomplete stack frame and undefined top of stack. 
369  */             
370 ret_from_sys_call:
371         movl $_TIF_ALLWORK_MASK,%edi
372         /* edi: flagmask */
373 sysret_check:           
374         LOCKDEP_SYS_EXIT
375         GET_THREAD_INFO(%rcx)
376         DISABLE_INTERRUPTS(CLBR_NONE)
377         TRACE_IRQS_OFF
378         movl TI_flags(%rcx),%edx
379         andl %edi,%edx
380         jnz  sysret_careful 
381         CFI_REMEMBER_STATE
382         /*
383          * sysretq will re-enable interrupts:
384          */
385         TRACE_IRQS_ON
386         movq RIP-ARGOFFSET(%rsp),%rcx
387         CFI_REGISTER    rip,rcx
388         RESTORE_ARGS 0,-ARG_SKIP,1
389         /*CFI_REGISTER  rflags,r11*/
390         movq    %gs:pda_oldrsp, %rsp
391         USERGS_SYSRET64
392
393         CFI_RESTORE_STATE
394         /* Handle reschedules */
395         /* edx: work, edi: workmask */  
396 sysret_careful:
397         bt $TIF_NEED_RESCHED,%edx
398         jnc sysret_signal
399         TRACE_IRQS_ON
400         ENABLE_INTERRUPTS(CLBR_NONE)
401         pushq %rdi
402         CFI_ADJUST_CFA_OFFSET 8
403         call schedule
404         popq  %rdi
405         CFI_ADJUST_CFA_OFFSET -8
406         jmp sysret_check
407
408         /* Handle a signal */ 
409 sysret_signal:
410         TRACE_IRQS_ON
411         ENABLE_INTERRUPTS(CLBR_NONE)
412 #ifdef CONFIG_AUDITSYSCALL
413         bt $TIF_SYSCALL_AUDIT,%edx
414         jc sysret_audit
415 #endif
416         /* edx: work flags (arg3) */
417         leaq do_notify_resume(%rip),%rax
418         leaq -ARGOFFSET(%rsp),%rdi # &pt_regs -> arg1
419         xorl %esi,%esi # oldset -> arg2
420         call ptregscall_common
421         movl $_TIF_WORK_MASK,%edi
422         /* Use IRET because user could have changed frame. This
423            works because ptregscall_common has called FIXUP_TOP_OF_STACK. */
424         DISABLE_INTERRUPTS(CLBR_NONE)
425         TRACE_IRQS_OFF
426         jmp int_with_check
427         
428 badsys:
429         movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
430         jmp ret_from_sys_call
431
432 #ifdef CONFIG_AUDITSYSCALL
433         /*
434          * Fast path for syscall audit without full syscall trace.
435          * We just call audit_syscall_entry() directly, and then
436          * jump back to the normal fast path.
437          */
438 auditsys:
439         movq %r10,%r9                   /* 6th arg: 4th syscall arg */
440         movq %rdx,%r8                   /* 5th arg: 3rd syscall arg */
441         movq %rsi,%rcx                  /* 4th arg: 2nd syscall arg */
442         movq %rdi,%rdx                  /* 3rd arg: 1st syscall arg */
443         movq %rax,%rsi                  /* 2nd arg: syscall number */
444         movl $AUDIT_ARCH_X86_64,%edi    /* 1st arg: audit arch */
445         call audit_syscall_entry
446         LOAD_ARGS 0             /* reload call-clobbered registers */
447         jmp system_call_fastpath
448
449         /*
450          * Return fast path for syscall audit.  Call audit_syscall_exit()
451          * directly and then jump back to the fast path with TIF_SYSCALL_AUDIT
452          * masked off.
453          */
454 sysret_audit:
455         movq %rax,%rsi          /* second arg, syscall return value */
456         cmpq $0,%rax            /* is it < 0? */
457         setl %al                /* 1 if so, 0 if not */
458         movzbl %al,%edi         /* zero-extend that into %edi */
459         inc %edi /* first arg, 0->1(AUDITSC_SUCCESS), 1->2(AUDITSC_FAILURE) */
460         call audit_syscall_exit
461         movl $(_TIF_ALLWORK_MASK & ~_TIF_SYSCALL_AUDIT),%edi
462         jmp sysret_check
463 #endif  /* CONFIG_AUDITSYSCALL */
464
465         /* Do syscall tracing */
466 tracesys:                        
467 #ifdef CONFIG_AUDITSYSCALL
468         testl $(_TIF_WORK_SYSCALL_ENTRY & ~_TIF_SYSCALL_AUDIT),TI_flags(%rcx)
469         jz auditsys
470 #endif
471         SAVE_REST
472         movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
473         FIXUP_TOP_OF_STACK %rdi
474         movq %rsp,%rdi
475         call syscall_trace_enter
476         /*
477          * Reload arg registers from stack in case ptrace changed them.
478          * We don't reload %rax because syscall_trace_enter() returned
479          * the value it wants us to use in the table lookup.
480          */
481         LOAD_ARGS ARGOFFSET, 1
482         RESTORE_REST
483         cmpq $__NR_syscall_max,%rax
484         ja   int_ret_from_sys_call      /* RAX(%rsp) set to -ENOSYS above */
485         movq %r10,%rcx  /* fixup for C */
486         call *sys_call_table(,%rax,8)
487         movq %rax,RAX-ARGOFFSET(%rsp)
488         /* Use IRET because user could have changed frame */
489                 
490 /* 
491  * Syscall return path ending with IRET.
492  * Has correct top of stack, but partial stack frame.
493  */
494         .globl int_ret_from_sys_call
495         .globl int_with_check
496 int_ret_from_sys_call:
497         DISABLE_INTERRUPTS(CLBR_NONE)
498         TRACE_IRQS_OFF
499         testl $3,CS-ARGOFFSET(%rsp)
500         je retint_restore_args
501         movl $_TIF_ALLWORK_MASK,%edi
502         /* edi: mask to check */
503 int_with_check:
504         LOCKDEP_SYS_EXIT_IRQ
505         GET_THREAD_INFO(%rcx)
506         movl TI_flags(%rcx),%edx
507         andl %edi,%edx
508         jnz   int_careful
509         andl    $~TS_COMPAT,TI_status(%rcx)
510         jmp   retint_swapgs
511
512         /* Either reschedule or signal or syscall exit tracking needed. */
513         /* First do a reschedule test. */
514         /* edx: work, edi: workmask */
515 int_careful:
516         bt $TIF_NEED_RESCHED,%edx
517         jnc  int_very_careful
518         TRACE_IRQS_ON
519         ENABLE_INTERRUPTS(CLBR_NONE)
520         pushq %rdi
521         CFI_ADJUST_CFA_OFFSET 8
522         call schedule
523         popq %rdi
524         CFI_ADJUST_CFA_OFFSET -8
525         DISABLE_INTERRUPTS(CLBR_NONE)
526         TRACE_IRQS_OFF
527         jmp int_with_check
528
529         /* handle signals and tracing -- both require a full stack frame */
530 int_very_careful:
531         TRACE_IRQS_ON
532         ENABLE_INTERRUPTS(CLBR_NONE)
533         SAVE_REST
534         /* Check for syscall exit trace */      
535         testl $_TIF_WORK_SYSCALL_EXIT,%edx
536         jz int_signal
537         pushq %rdi
538         CFI_ADJUST_CFA_OFFSET 8
539         leaq 8(%rsp),%rdi       # &ptregs -> arg1       
540         call syscall_trace_leave
541         popq %rdi
542         CFI_ADJUST_CFA_OFFSET -8
543         andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
544         jmp int_restore_rest
545         
546 int_signal:
547         testl $_TIF_DO_NOTIFY_MASK,%edx
548         jz 1f
549         movq %rsp,%rdi          # &ptregs -> arg1
550         xorl %esi,%esi          # oldset -> arg2
551         call do_notify_resume
552 1:      movl $_TIF_WORK_MASK,%edi
553 int_restore_rest:
554         RESTORE_REST
555         DISABLE_INTERRUPTS(CLBR_NONE)
556         TRACE_IRQS_OFF
557         jmp int_with_check
558         CFI_ENDPROC
559 END(system_call)
560                 
561 /* 
562  * Certain special system calls that need to save a complete full stack frame.
563  */                                                             
564         
565         .macro PTREGSCALL label,func,arg
566         .globl \label
567 \label:
568         leaq    \func(%rip),%rax
569         leaq    -ARGOFFSET+8(%rsp),\arg /* 8 for return address */
570         jmp     ptregscall_common
571 END(\label)
572         .endm
573
574         CFI_STARTPROC
575
576         PTREGSCALL stub_clone, sys_clone, %r8
577         PTREGSCALL stub_fork, sys_fork, %rdi
578         PTREGSCALL stub_vfork, sys_vfork, %rdi
579         PTREGSCALL stub_sigaltstack, sys_sigaltstack, %rdx
580         PTREGSCALL stub_iopl, sys_iopl, %rsi
581
582 ENTRY(ptregscall_common)
583         popq %r11
584         CFI_ADJUST_CFA_OFFSET -8
585         CFI_REGISTER rip, r11
586         SAVE_REST
587         movq %r11, %r15
588         CFI_REGISTER rip, r15
589         FIXUP_TOP_OF_STACK %r11
590         call *%rax
591         RESTORE_TOP_OF_STACK %r11
592         movq %r15, %r11
593         CFI_REGISTER rip, r11
594         RESTORE_REST
595         pushq %r11
596         CFI_ADJUST_CFA_OFFSET 8
597         CFI_REL_OFFSET rip, 0
598         ret
599         CFI_ENDPROC
600 END(ptregscall_common)
601         
602 ENTRY(stub_execve)
603         CFI_STARTPROC
604         popq %r11
605         CFI_ADJUST_CFA_OFFSET -8
606         CFI_REGISTER rip, r11
607         SAVE_REST
608         FIXUP_TOP_OF_STACK %r11
609         movq %rsp, %rcx
610         call sys_execve
611         RESTORE_TOP_OF_STACK %r11
612         movq %rax,RAX(%rsp)
613         RESTORE_REST
614         jmp int_ret_from_sys_call
615         CFI_ENDPROC
616 END(stub_execve)
617         
618 /*
619  * sigreturn is special because it needs to restore all registers on return.
620  * This cannot be done with SYSRET, so use the IRET return path instead.
621  */                
622 ENTRY(stub_rt_sigreturn)
623         CFI_STARTPROC
624         addq $8, %rsp
625         CFI_ADJUST_CFA_OFFSET   -8
626         SAVE_REST
627         movq %rsp,%rdi
628         FIXUP_TOP_OF_STACK %r11
629         call sys_rt_sigreturn
630         movq %rax,RAX(%rsp) # fixme, this could be done at the higher layer
631         RESTORE_REST
632         jmp int_ret_from_sys_call
633         CFI_ENDPROC
634 END(stub_rt_sigreturn)
635
636 /*
637  * initial frame state for interrupts and exceptions
638  */
639         .macro _frame ref
640         CFI_STARTPROC simple
641         CFI_SIGNAL_FRAME
642         CFI_DEF_CFA rsp,SS+8-\ref
643         /*CFI_REL_OFFSET ss,SS-\ref*/
644         CFI_REL_OFFSET rsp,RSP-\ref
645         /*CFI_REL_OFFSET rflags,EFLAGS-\ref*/
646         /*CFI_REL_OFFSET cs,CS-\ref*/
647         CFI_REL_OFFSET rip,RIP-\ref
648         .endm
649
650 /* initial frame state for interrupts (and exceptions without error code) */
651 #define INTR_FRAME _frame RIP
652 /* initial frame state for exceptions with error code (and interrupts with
653    vector already pushed) */
654 #define XCPT_FRAME _frame ORIG_RAX
655
656 /* 
657  * Interrupt entry/exit.
658  *
659  * Interrupt entry points save only callee clobbered registers in fast path.
660  *      
661  * Entry runs with interrupts off.      
662  */ 
663
664 /* 0(%rsp): interrupt number */ 
665         .macro interrupt func
666         cld
667         SAVE_ARGS
668         leaq -ARGOFFSET(%rsp),%rdi      # arg1 for handler
669         pushq %rbp
670         /*
671          * Save rbp twice: One is for marking the stack frame, as usual, and the
672          * other, to fill pt_regs properly. This is because bx comes right
673          * before the last saved register in that structure, and not bp. If the
674          * base pointer were in the place bx is today, this would not be needed.
675          */
676         movq %rbp, -8(%rsp)
677         CFI_ADJUST_CFA_OFFSET   8
678         CFI_REL_OFFSET          rbp, 0
679         movq %rsp,%rbp
680         CFI_DEF_CFA_REGISTER    rbp
681         testl $3,CS(%rdi)
682         je 1f
683         SWAPGS
684         /* irqcount is used to check if a CPU is already on an interrupt
685            stack or not. While this is essentially redundant with preempt_count
686            it is a little cheaper to use a separate counter in the PDA
687            (short of moving irq_enter into assembly, which would be too
688             much work) */
689 1:      incl    %gs:pda_irqcount
690         cmoveq %gs:pda_irqstackptr,%rsp
691         push    %rbp                    # backlink for old unwinder
692         /*
693          * We entered an interrupt context - irqs are off:
694          */
695         TRACE_IRQS_OFF
696         call \func
697         .endm
698
699 ENTRY(common_interrupt)
700         XCPT_FRAME
701         interrupt do_IRQ
702         /* 0(%rsp): oldrsp-ARGOFFSET */
703 ret_from_intr:
704         DISABLE_INTERRUPTS(CLBR_NONE)
705         TRACE_IRQS_OFF
706         decl %gs:pda_irqcount
707         leaveq
708         CFI_DEF_CFA_REGISTER    rsp
709         CFI_ADJUST_CFA_OFFSET   -8
710 exit_intr:
711         GET_THREAD_INFO(%rcx)
712         testl $3,CS-ARGOFFSET(%rsp)
713         je retint_kernel
714         
715         /* Interrupt came from user space */
716         /*
717          * Has a correct top of stack, but a partial stack frame
718          * %rcx: thread info. Interrupts off.
719          */             
720 retint_with_reschedule:
721         movl $_TIF_WORK_MASK,%edi
722 retint_check:
723         LOCKDEP_SYS_EXIT_IRQ
724         movl TI_flags(%rcx),%edx
725         andl %edi,%edx
726         CFI_REMEMBER_STATE
727         jnz  retint_careful
728
729 retint_swapgs:          /* return to user-space */
730         /*
731          * The iretq could re-enable interrupts:
732          */
733         DISABLE_INTERRUPTS(CLBR_ANY)
734         TRACE_IRQS_IRETQ
735         SWAPGS
736         jmp restore_args
737
738 retint_restore_args:    /* return to kernel space */
739         DISABLE_INTERRUPTS(CLBR_ANY)
740         /*
741          * The iretq could re-enable interrupts:
742          */
743         TRACE_IRQS_IRETQ
744 restore_args:
745         RESTORE_ARGS 0,8,0
746
747 irq_return:
748         INTERRUPT_RETURN
749
750         .section __ex_table, "a"
751         .quad irq_return, bad_iret
752         .previous
753
754 #ifdef CONFIG_PARAVIRT
755 ENTRY(native_iret)
756         iretq
757
758         .section __ex_table,"a"
759         .quad native_iret, bad_iret
760         .previous
761 #endif
762
763         .section .fixup,"ax"
764 bad_iret:
765         /*
766          * The iret traps when the %cs or %ss being restored is bogus.
767          * We've lost the original trap vector and error code.
768          * #GPF is the most likely one to get for an invalid selector.
769          * So pretend we completed the iret and took the #GPF in user mode.
770          *
771          * We are now running with the kernel GS after exception recovery.
772          * But error_entry expects us to have user GS to match the user %cs,
773          * so swap back.
774          */
775         pushq $0
776
777         SWAPGS
778         jmp general_protection
779
780         .previous
781
782         /* edi: workmask, edx: work */
783 retint_careful:
784         CFI_RESTORE_STATE
785         bt    $TIF_NEED_RESCHED,%edx
786         jnc   retint_signal
787         TRACE_IRQS_ON
788         ENABLE_INTERRUPTS(CLBR_NONE)
789         pushq %rdi
790         CFI_ADJUST_CFA_OFFSET   8
791         call  schedule
792         popq %rdi               
793         CFI_ADJUST_CFA_OFFSET   -8
794         GET_THREAD_INFO(%rcx)
795         DISABLE_INTERRUPTS(CLBR_NONE)
796         TRACE_IRQS_OFF
797         jmp retint_check
798         
799 retint_signal:
800         testl $_TIF_DO_NOTIFY_MASK,%edx
801         jz    retint_swapgs
802         TRACE_IRQS_ON
803         ENABLE_INTERRUPTS(CLBR_NONE)
804         SAVE_REST
805         movq $-1,ORIG_RAX(%rsp)                         
806         xorl %esi,%esi          # oldset
807         movq %rsp,%rdi          # &pt_regs
808         call do_notify_resume
809         RESTORE_REST
810         DISABLE_INTERRUPTS(CLBR_NONE)
811         TRACE_IRQS_OFF
812         GET_THREAD_INFO(%rcx)
813         jmp retint_with_reschedule
814
815 #ifdef CONFIG_PREEMPT
816         /* Returning to kernel space. Check if we need preemption */
817         /* rcx:  threadinfo. interrupts off. */
818 ENTRY(retint_kernel)
819         cmpl $0,TI_preempt_count(%rcx)
820         jnz  retint_restore_args
821         bt  $TIF_NEED_RESCHED,TI_flags(%rcx)
822         jnc  retint_restore_args
823         bt   $9,EFLAGS-ARGOFFSET(%rsp)  /* interrupts off? */
824         jnc  retint_restore_args
825         call preempt_schedule_irq
826         jmp exit_intr
827 #endif  
828
829         CFI_ENDPROC
830 END(common_interrupt)
831         
832 /*
833  * APIC interrupts.
834  */             
835         .macro apicinterrupt num,func
836         INTR_FRAME
837         pushq $~(\num)
838         CFI_ADJUST_CFA_OFFSET 8
839         interrupt \func
840         jmp ret_from_intr
841         CFI_ENDPROC
842         .endm
843
844 ENTRY(thermal_interrupt)
845         apicinterrupt THERMAL_APIC_VECTOR,smp_thermal_interrupt
846 END(thermal_interrupt)
847
848 ENTRY(threshold_interrupt)
849         apicinterrupt THRESHOLD_APIC_VECTOR,mce_threshold_interrupt
850 END(threshold_interrupt)
851
852 #ifdef CONFIG_SMP       
853 ENTRY(reschedule_interrupt)
854         apicinterrupt RESCHEDULE_VECTOR,smp_reschedule_interrupt
855 END(reschedule_interrupt)
856
857         .macro INVALIDATE_ENTRY num
858 ENTRY(invalidate_interrupt\num)
859         apicinterrupt INVALIDATE_TLB_VECTOR_START+\num,smp_invalidate_interrupt 
860 END(invalidate_interrupt\num)
861         .endm
862
863         INVALIDATE_ENTRY 0
864         INVALIDATE_ENTRY 1
865         INVALIDATE_ENTRY 2
866         INVALIDATE_ENTRY 3
867         INVALIDATE_ENTRY 4
868         INVALIDATE_ENTRY 5
869         INVALIDATE_ENTRY 6
870         INVALIDATE_ENTRY 7
871
872 ENTRY(call_function_interrupt)
873         apicinterrupt CALL_FUNCTION_VECTOR,smp_call_function_interrupt
874 END(call_function_interrupt)
875 ENTRY(call_function_single_interrupt)
876         apicinterrupt CALL_FUNCTION_SINGLE_VECTOR,smp_call_function_single_interrupt
877 END(call_function_single_interrupt)
878 ENTRY(irq_move_cleanup_interrupt)
879         apicinterrupt IRQ_MOVE_CLEANUP_VECTOR,smp_irq_move_cleanup_interrupt
880 END(irq_move_cleanup_interrupt)
881 #endif
882
883 ENTRY(apic_timer_interrupt)
884         apicinterrupt LOCAL_TIMER_VECTOR,smp_apic_timer_interrupt
885 END(apic_timer_interrupt)
886
887 ENTRY(uv_bau_message_intr1)
888         apicinterrupt 220,uv_bau_message_interrupt
889 END(uv_bau_message_intr1)
890
891 ENTRY(error_interrupt)
892         apicinterrupt ERROR_APIC_VECTOR,smp_error_interrupt
893 END(error_interrupt)
894
895 ENTRY(spurious_interrupt)
896         apicinterrupt SPURIOUS_APIC_VECTOR,smp_spurious_interrupt
897 END(spurious_interrupt)
898                                 
899 /*
900  * Exception entry points.
901  */             
902         .macro zeroentry sym
903         INTR_FRAME
904         PARAVIRT_ADJUST_EXCEPTION_FRAME
905         pushq $0        /* push error code/oldrax */ 
906         CFI_ADJUST_CFA_OFFSET 8
907         pushq %rax      /* push real oldrax to the rdi slot */ 
908         CFI_ADJUST_CFA_OFFSET 8
909         CFI_REL_OFFSET rax,0
910         leaq  \sym(%rip),%rax
911         jmp error_entry
912         CFI_ENDPROC
913         .endm   
914
915         .macro errorentry sym
916         XCPT_FRAME
917         PARAVIRT_ADJUST_EXCEPTION_FRAME
918         pushq %rax
919         CFI_ADJUST_CFA_OFFSET 8
920         CFI_REL_OFFSET rax,0
921         leaq  \sym(%rip),%rax
922         jmp error_entry
923         CFI_ENDPROC
924         .endm
925
926         /* error code is on the stack already */
927         /* handle NMI like exceptions that can happen everywhere */
928         .macro paranoidentry sym, ist=0, irqtrace=1
929         SAVE_ALL
930         cld
931         movl $1,%ebx
932         movl  $MSR_GS_BASE,%ecx
933         rdmsr
934         testl %edx,%edx
935         js    1f
936         SWAPGS
937         xorl  %ebx,%ebx
938 1:
939         .if \ist
940         movq    %gs:pda_data_offset, %rbp
941         .endif
942         movq %rsp,%rdi
943         movq ORIG_RAX(%rsp),%rsi
944         movq $-1,ORIG_RAX(%rsp)
945         .if \ist
946         subq    $EXCEPTION_STKSZ, per_cpu__init_tss + TSS_ist + (\ist - 1) * 8(%rbp)
947         .endif
948         call \sym
949         .if \ist
950         addq    $EXCEPTION_STKSZ, per_cpu__init_tss + TSS_ist + (\ist - 1) * 8(%rbp)
951         .endif
952         DISABLE_INTERRUPTS(CLBR_NONE)
953         .if \irqtrace
954         TRACE_IRQS_OFF
955         .endif
956         .endm
957
958         /*
959          * "Paranoid" exit path from exception stack.
960          * Paranoid because this is used by NMIs and cannot take
961          * any kernel state for granted.
962          * We don't do kernel preemption checks here, because only
963          * NMI should be common and it does not enable IRQs and
964          * cannot get reschedule ticks.
965          *
966          * "trace" is 0 for the NMI handler only, because irq-tracing
967          * is fundamentally NMI-unsafe. (we cannot change the soft and
968          * hard flags at once, atomically)
969          */
970         .macro paranoidexit trace=1
971         /* ebx: no swapgs flag */
972 paranoid_exit\trace:
973         testl %ebx,%ebx                         /* swapgs needed? */
974         jnz paranoid_restore\trace
975         testl $3,CS(%rsp)
976         jnz   paranoid_userspace\trace
977 paranoid_swapgs\trace:
978         .if \trace
979         TRACE_IRQS_IRETQ 0
980         .endif
981         SWAPGS_UNSAFE_STACK
982 paranoid_restore\trace:
983         RESTORE_ALL 8
984         jmp irq_return
985 paranoid_userspace\trace:
986         GET_THREAD_INFO(%rcx)
987         movl TI_flags(%rcx),%ebx
988         andl $_TIF_WORK_MASK,%ebx
989         jz paranoid_swapgs\trace
990         movq %rsp,%rdi                  /* &pt_regs */
991         call sync_regs
992         movq %rax,%rsp                  /* switch stack for scheduling */
993         testl $_TIF_NEED_RESCHED,%ebx
994         jnz paranoid_schedule\trace
995         movl %ebx,%edx                  /* arg3: thread flags */
996         .if \trace
997         TRACE_IRQS_ON
998         .endif
999         ENABLE_INTERRUPTS(CLBR_NONE)
1000         xorl %esi,%esi                  /* arg2: oldset */
1001         movq %rsp,%rdi                  /* arg1: &pt_regs */
1002         call do_notify_resume
1003         DISABLE_INTERRUPTS(CLBR_NONE)
1004         .if \trace
1005         TRACE_IRQS_OFF
1006         .endif
1007         jmp paranoid_userspace\trace
1008 paranoid_schedule\trace:
1009         .if \trace
1010         TRACE_IRQS_ON
1011         .endif
1012         ENABLE_INTERRUPTS(CLBR_ANY)
1013         call schedule
1014         DISABLE_INTERRUPTS(CLBR_ANY)
1015         .if \trace
1016         TRACE_IRQS_OFF
1017         .endif
1018         jmp paranoid_userspace\trace
1019         CFI_ENDPROC
1020         .endm
1021
1022 /*
1023  * Exception entry point. This expects an error code/orig_rax on the stack
1024  * and the exception handler in %rax.   
1025  */                                             
1026 KPROBE_ENTRY(error_entry)
1027         _frame RDI
1028         CFI_REL_OFFSET rax,0
1029         /* rdi slot contains rax, oldrax contains error code */
1030         cld     
1031         subq  $14*8,%rsp
1032         CFI_ADJUST_CFA_OFFSET   (14*8)
1033         movq %rsi,13*8(%rsp)
1034         CFI_REL_OFFSET  rsi,RSI
1035         movq 14*8(%rsp),%rsi    /* load rax from rdi slot */
1036         CFI_REGISTER    rax,rsi
1037         movq %rdx,12*8(%rsp)
1038         CFI_REL_OFFSET  rdx,RDX
1039         movq %rcx,11*8(%rsp)
1040         CFI_REL_OFFSET  rcx,RCX
1041         movq %rsi,10*8(%rsp)    /* store rax */ 
1042         CFI_REL_OFFSET  rax,RAX
1043         movq %r8, 9*8(%rsp)
1044         CFI_REL_OFFSET  r8,R8
1045         movq %r9, 8*8(%rsp)
1046         CFI_REL_OFFSET  r9,R9
1047         movq %r10,7*8(%rsp)
1048         CFI_REL_OFFSET  r10,R10
1049         movq %r11,6*8(%rsp)
1050         CFI_REL_OFFSET  r11,R11
1051         movq %rbx,5*8(%rsp) 
1052         CFI_REL_OFFSET  rbx,RBX
1053         movq %rbp,4*8(%rsp) 
1054         CFI_REL_OFFSET  rbp,RBP
1055         movq %r12,3*8(%rsp) 
1056         CFI_REL_OFFSET  r12,R12
1057         movq %r13,2*8(%rsp) 
1058         CFI_REL_OFFSET  r13,R13
1059         movq %r14,1*8(%rsp) 
1060         CFI_REL_OFFSET  r14,R14
1061         movq %r15,(%rsp) 
1062         CFI_REL_OFFSET  r15,R15
1063         xorl %ebx,%ebx  
1064         testl $3,CS(%rsp)
1065         je  error_kernelspace
1066 error_swapgs:   
1067         SWAPGS
1068 error_sti:      
1069         movq %rdi,RDI(%rsp)     
1070         CFI_REL_OFFSET  rdi,RDI
1071         movq %rsp,%rdi
1072         movq ORIG_RAX(%rsp),%rsi        /* get error code */ 
1073         movq $-1,ORIG_RAX(%rsp)
1074         call *%rax
1075         /* ebx: no swapgs flag (1: don't need swapgs, 0: need it) */
1076 error_exit:
1077         movl %ebx,%eax
1078         RESTORE_REST
1079         DISABLE_INTERRUPTS(CLBR_NONE)
1080         TRACE_IRQS_OFF
1081         GET_THREAD_INFO(%rcx)   
1082         testl %eax,%eax
1083         jne  retint_kernel
1084         LOCKDEP_SYS_EXIT_IRQ
1085         movl  TI_flags(%rcx),%edx
1086         movl  $_TIF_WORK_MASK,%edi
1087         andl  %edi,%edx
1088         jnz  retint_careful
1089         jmp retint_swapgs
1090         CFI_ENDPROC
1091
1092 error_kernelspace:
1093         incl %ebx
1094        /* There are two places in the kernel that can potentially fault with
1095           usergs. Handle them here. The exception handlers after
1096            iret run with kernel gs again, so don't set the user space flag.
1097            B stepping K8s sometimes report an truncated RIP for IRET 
1098            exceptions returning to compat mode. Check for these here too. */
1099         leaq irq_return(%rip),%rcx
1100         cmpq %rcx,RIP(%rsp)
1101         je   error_swapgs
1102         movl %ecx,%ecx  /* zero extend */
1103         cmpq %rcx,RIP(%rsp)
1104         je   error_swapgs
1105         cmpq $gs_change,RIP(%rsp)
1106         je   error_swapgs
1107         jmp  error_sti
1108 KPROBE_END(error_entry)
1109         
1110        /* Reload gs selector with exception handling */
1111        /* edi:  new selector */ 
1112 ENTRY(native_load_gs_index)
1113         CFI_STARTPROC
1114         pushf
1115         CFI_ADJUST_CFA_OFFSET 8
1116         DISABLE_INTERRUPTS(CLBR_ANY | ~(CLBR_RDI))
1117         SWAPGS
1118 gs_change:     
1119         movl %edi,%gs   
1120 2:      mfence          /* workaround */
1121         SWAPGS
1122         popf
1123         CFI_ADJUST_CFA_OFFSET -8
1124         ret
1125         CFI_ENDPROC
1126 ENDPROC(native_load_gs_index)
1127        
1128         .section __ex_table,"a"
1129         .align 8
1130         .quad gs_change,bad_gs
1131         .previous
1132         .section .fixup,"ax"
1133         /* running with kernelgs */
1134 bad_gs: 
1135         SWAPGS                  /* switch back to user gs */
1136         xorl %eax,%eax
1137         movl %eax,%gs
1138         jmp  2b
1139         .previous       
1140         
1141 /*
1142  * Create a kernel thread.
1143  *
1144  * C extern interface:
1145  *      extern long kernel_thread(int (*fn)(void *), void * arg, unsigned long flags)
1146  *
1147  * asm input arguments:
1148  *      rdi: fn, rsi: arg, rdx: flags
1149  */
1150 ENTRY(kernel_thread)
1151         CFI_STARTPROC
1152         FAKE_STACK_FRAME $child_rip
1153         SAVE_ALL
1154
1155         # rdi: flags, rsi: usp, rdx: will be &pt_regs
1156         movq %rdx,%rdi
1157         orq  kernel_thread_flags(%rip),%rdi
1158         movq $-1, %rsi
1159         movq %rsp, %rdx
1160
1161         xorl %r8d,%r8d
1162         xorl %r9d,%r9d
1163         
1164         # clone now
1165         call do_fork
1166         movq %rax,RAX(%rsp)
1167         xorl %edi,%edi
1168
1169         /*
1170          * It isn't worth to check for reschedule here,
1171          * so internally to the x86_64 port you can rely on kernel_thread()
1172          * not to reschedule the child before returning, this avoids the need
1173          * of hacks for example to fork off the per-CPU idle tasks.
1174          * [Hopefully no generic code relies on the reschedule -AK]     
1175          */
1176         RESTORE_ALL
1177         UNFAKE_STACK_FRAME
1178         ret
1179         CFI_ENDPROC
1180 ENDPROC(kernel_thread)
1181         
1182 child_rip:
1183         pushq $0                # fake return address
1184         CFI_STARTPROC
1185         /*
1186          * Here we are in the child and the registers are set as they were
1187          * at kernel_thread() invocation in the parent.
1188          */
1189         movq %rdi, %rax
1190         movq %rsi, %rdi
1191         call *%rax
1192         # exit
1193         mov %eax, %edi
1194         call do_exit
1195         CFI_ENDPROC
1196 ENDPROC(child_rip)
1197
1198 /*
1199  * execve(). This function needs to use IRET, not SYSRET, to set up all state properly.
1200  *
1201  * C extern interface:
1202  *       extern long execve(char *name, char **argv, char **envp)
1203  *
1204  * asm input arguments:
1205  *      rdi: name, rsi: argv, rdx: envp
1206  *
1207  * We want to fallback into:
1208  *      extern long sys_execve(char *name, char **argv,char **envp, struct pt_regs *regs)
1209  *
1210  * do_sys_execve asm fallback arguments:
1211  *      rdi: name, rsi: argv, rdx: envp, rcx: fake frame on the stack
1212  */
1213 ENTRY(kernel_execve)
1214         CFI_STARTPROC
1215         FAKE_STACK_FRAME $0
1216         SAVE_ALL        
1217         movq %rsp,%rcx
1218         call sys_execve
1219         movq %rax, RAX(%rsp)    
1220         RESTORE_REST
1221         testq %rax,%rax
1222         je int_ret_from_sys_call
1223         RESTORE_ARGS
1224         UNFAKE_STACK_FRAME
1225         ret
1226         CFI_ENDPROC
1227 ENDPROC(kernel_execve)
1228
1229 KPROBE_ENTRY(page_fault)
1230         errorentry do_page_fault
1231 KPROBE_END(page_fault)
1232
1233 ENTRY(coprocessor_error)
1234         zeroentry do_coprocessor_error
1235 END(coprocessor_error)
1236
1237 ENTRY(simd_coprocessor_error)
1238         zeroentry do_simd_coprocessor_error     
1239 END(simd_coprocessor_error)
1240
1241 ENTRY(device_not_available)
1242         zeroentry math_state_restore
1243 END(device_not_available)
1244
1245         /* runs on exception stack */
1246 KPROBE_ENTRY(debug)
1247         INTR_FRAME
1248         PARAVIRT_ADJUST_EXCEPTION_FRAME
1249         pushq $0
1250         CFI_ADJUST_CFA_OFFSET 8         
1251         paranoidentry do_debug, DEBUG_STACK
1252         paranoidexit
1253 KPROBE_END(debug)
1254
1255         /* runs on exception stack */   
1256 KPROBE_ENTRY(nmi)
1257         INTR_FRAME
1258         PARAVIRT_ADJUST_EXCEPTION_FRAME
1259         pushq $-1
1260         CFI_ADJUST_CFA_OFFSET 8
1261         paranoidentry do_nmi, 0, 0
1262 #ifdef CONFIG_TRACE_IRQFLAGS
1263         paranoidexit 0
1264 #else
1265         jmp paranoid_exit1
1266         CFI_ENDPROC
1267 #endif
1268 KPROBE_END(nmi)
1269
1270 KPROBE_ENTRY(int3)
1271         INTR_FRAME
1272         PARAVIRT_ADJUST_EXCEPTION_FRAME
1273         pushq $0
1274         CFI_ADJUST_CFA_OFFSET 8
1275         paranoidentry do_int3, DEBUG_STACK
1276         jmp paranoid_exit1
1277         CFI_ENDPROC
1278 KPROBE_END(int3)
1279
1280 ENTRY(overflow)
1281         zeroentry do_overflow
1282 END(overflow)
1283
1284 ENTRY(bounds)
1285         zeroentry do_bounds
1286 END(bounds)
1287
1288 ENTRY(invalid_op)
1289         zeroentry do_invalid_op 
1290 END(invalid_op)
1291
1292 ENTRY(coprocessor_segment_overrun)
1293         zeroentry do_coprocessor_segment_overrun
1294 END(coprocessor_segment_overrun)
1295
1296         /* runs on exception stack */
1297 ENTRY(double_fault)
1298         XCPT_FRAME
1299         PARAVIRT_ADJUST_EXCEPTION_FRAME
1300         paranoidentry do_double_fault
1301         jmp paranoid_exit1
1302         CFI_ENDPROC
1303 END(double_fault)
1304
1305 ENTRY(invalid_TSS)
1306         errorentry do_invalid_TSS
1307 END(invalid_TSS)
1308
1309 ENTRY(segment_not_present)
1310         errorentry do_segment_not_present
1311 END(segment_not_present)
1312
1313         /* runs on exception stack */
1314 ENTRY(stack_segment)
1315         XCPT_FRAME
1316         PARAVIRT_ADJUST_EXCEPTION_FRAME
1317         paranoidentry do_stack_segment
1318         jmp paranoid_exit1
1319         CFI_ENDPROC
1320 END(stack_segment)
1321
1322 KPROBE_ENTRY(general_protection)
1323         errorentry do_general_protection
1324 KPROBE_END(general_protection)
1325
1326 ENTRY(alignment_check)
1327         errorentry do_alignment_check
1328 END(alignment_check)
1329
1330 ENTRY(divide_error)
1331         zeroentry do_divide_error
1332 END(divide_error)
1333
1334 ENTRY(spurious_interrupt_bug)
1335         zeroentry do_spurious_interrupt_bug
1336 END(spurious_interrupt_bug)
1337
1338 #ifdef CONFIG_X86_MCE
1339         /* runs on exception stack */
1340 ENTRY(machine_check)
1341         INTR_FRAME
1342         PARAVIRT_ADJUST_EXCEPTION_FRAME
1343         pushq $0
1344         CFI_ADJUST_CFA_OFFSET 8 
1345         paranoidentry do_machine_check
1346         jmp paranoid_exit1
1347         CFI_ENDPROC
1348 END(machine_check)
1349 #endif
1350
1351 /* Call softirq on interrupt stack. Interrupts are off. */
1352 ENTRY(call_softirq)
1353         CFI_STARTPROC
1354         push %rbp
1355         CFI_ADJUST_CFA_OFFSET   8
1356         CFI_REL_OFFSET rbp,0
1357         mov  %rsp,%rbp
1358         CFI_DEF_CFA_REGISTER rbp
1359         incl %gs:pda_irqcount
1360         cmove %gs:pda_irqstackptr,%rsp
1361         push  %rbp                      # backlink for old unwinder
1362         call __do_softirq
1363         leaveq
1364         CFI_DEF_CFA_REGISTER    rsp
1365         CFI_ADJUST_CFA_OFFSET   -8
1366         decl %gs:pda_irqcount
1367         ret
1368         CFI_ENDPROC
1369 ENDPROC(call_softirq)
1370
1371 KPROBE_ENTRY(ignore_sysret)
1372         CFI_STARTPROC
1373         mov $-ENOSYS,%eax
1374         sysret
1375         CFI_ENDPROC
1376 ENDPROC(ignore_sysret)
1377
1378 #ifdef CONFIG_XEN
1379 ENTRY(xen_hypervisor_callback)
1380         zeroentry xen_do_hypervisor_callback
1381 END(xen_hypervisor_callback)
1382
1383 /*
1384 # A note on the "critical region" in our callback handler.
1385 # We want to avoid stacking callback handlers due to events occurring
1386 # during handling of the last event. To do this, we keep events disabled
1387 # until we've done all processing. HOWEVER, we must enable events before
1388 # popping the stack frame (can't be done atomically) and so it would still
1389 # be possible to get enough handler activations to overflow the stack.
1390 # Although unlikely, bugs of that kind are hard to track down, so we'd
1391 # like to avoid the possibility.
1392 # So, on entry to the handler we detect whether we interrupted an
1393 # existing activation in its critical region -- if so, we pop the current
1394 # activation and restart the handler using the previous one.
1395 */
1396 ENTRY(xen_do_hypervisor_callback)   # do_hypervisor_callback(struct *pt_regs)
1397         CFI_STARTPROC
1398 /* Since we don't modify %rdi, evtchn_do_upall(struct *pt_regs) will
1399    see the correct pointer to the pt_regs */
1400         movq %rdi, %rsp            # we don't return, adjust the stack frame
1401         CFI_ENDPROC
1402         CFI_DEFAULT_STACK
1403 11:     incl %gs:pda_irqcount
1404         movq %rsp,%rbp
1405         CFI_DEF_CFA_REGISTER rbp
1406         cmovzq %gs:pda_irqstackptr,%rsp
1407         pushq %rbp                      # backlink for old unwinder
1408         call xen_evtchn_do_upcall
1409         popq %rsp
1410         CFI_DEF_CFA_REGISTER rsp
1411         decl %gs:pda_irqcount
1412         jmp  error_exit
1413         CFI_ENDPROC
1414 END(do_hypervisor_callback)
1415
1416 /*
1417 # Hypervisor uses this for application faults while it executes.
1418 # We get here for two reasons:
1419 #  1. Fault while reloading DS, ES, FS or GS
1420 #  2. Fault while executing IRET
1421 # Category 1 we do not need to fix up as Xen has already reloaded all segment
1422 # registers that could be reloaded and zeroed the others.
1423 # Category 2 we fix up by killing the current process. We cannot use the
1424 # normal Linux return path in this case because if we use the IRET hypercall
1425 # to pop the stack frame we end up in an infinite loop of failsafe callbacks.
1426 # We distinguish between categories by comparing each saved segment register
1427 # with its current contents: any discrepancy means we in category 1.
1428 */
1429 ENTRY(xen_failsafe_callback)
1430         framesz = (RIP-0x30)    /* workaround buggy gas */
1431         _frame framesz
1432         CFI_REL_OFFSET rcx, 0
1433         CFI_REL_OFFSET r11, 8
1434         movw %ds,%cx
1435         cmpw %cx,0x10(%rsp)
1436         CFI_REMEMBER_STATE
1437         jne 1f
1438         movw %es,%cx
1439         cmpw %cx,0x18(%rsp)
1440         jne 1f
1441         movw %fs,%cx
1442         cmpw %cx,0x20(%rsp)
1443         jne 1f
1444         movw %gs,%cx
1445         cmpw %cx,0x28(%rsp)
1446         jne 1f
1447         /* All segments match their saved values => Category 2 (Bad IRET). */
1448         movq (%rsp),%rcx
1449         CFI_RESTORE rcx
1450         movq 8(%rsp),%r11
1451         CFI_RESTORE r11
1452         addq $0x30,%rsp
1453         CFI_ADJUST_CFA_OFFSET -0x30
1454         pushq $0
1455         CFI_ADJUST_CFA_OFFSET 8
1456         pushq %r11
1457         CFI_ADJUST_CFA_OFFSET 8
1458         pushq %rcx
1459         CFI_ADJUST_CFA_OFFSET 8
1460         jmp general_protection
1461         CFI_RESTORE_STATE
1462 1:      /* Segment mismatch => Category 1 (Bad segment). Retry the IRET. */
1463         movq (%rsp),%rcx
1464         CFI_RESTORE rcx
1465         movq 8(%rsp),%r11
1466         CFI_RESTORE r11
1467         addq $0x30,%rsp
1468         CFI_ADJUST_CFA_OFFSET -0x30
1469         pushq $0
1470         CFI_ADJUST_CFA_OFFSET 8
1471         SAVE_ALL
1472         jmp error_exit
1473         CFI_ENDPROC
1474 END(xen_failsafe_callback)
1475
1476 #endif /* CONFIG_XEN */