entry_64.S 33.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
/*
 *  linux/arch/x86_64/entry.S
 *
 *  Copyright (C) 1991, 1992  Linus Torvalds
 *  Copyright (C) 2000, 2001, 2002  Andi Kleen SuSE Labs
 *  Copyright (C) 2000  Pavel Machek <pavel@suse.cz>
 */

/*
 * entry.S contains the system-call and fault low-level handling routines.
 *
 * NOTE: This code handles signal-recognition, which happens every time
 * after an interrupt and after each system call.
 * 
 * Normal syscalls and interrupts don't save a full stack frame, this is 
 * only done for syscall tracing, signals or fork/exec et.al.
 * 
 * A note on terminology:	 
 * - top of stack: Architecture defined interrupt frame from SS to RIP 
 * at the top of the kernel process stack.	
 * - partial stack frame: partially saved registers upto R11.
 * - full stack frame: Like partial stack frame, but all register saved. 
23 24 25 26 27 28 29 30 31 32 33 34 35 36 37
 *
 * Some macro usage:
 * - CFI macros are used to generate dwarf2 unwind information for better
 * backtraces. They don't change any code.
 * - SAVE_ALL/RESTORE_ALL - Save/restore all registers
 * - SAVE_ARGS/RESTORE_ARGS - Save/restore registers that C functions modify.
 * There are unfortunately lots of special cases where some registers
 * not touched. The macro is a big mess that should be cleaned up.
 * - SAVE_REST/RESTORE_REST - Handle the registers not saved by SAVE_ARGS.
 * Gives a full stack frame.
 * - ENTRY/END Define functions in the symbol table.
 * - FIXUP_TOP_OF_STACK/RESTORE_TOP_OF_STACK - Fix up the hardware stack
 * frame that is otherwise undefined after a SYSCALL
 * - TRACE_IRQ_* - Trace hard interrupt state for lock debugging.
 * - errorentry/paranoidentry/zeroentry - Define exception entry points.
L
Linus Torvalds 已提交
38 39 40 41 42 43 44 45
 */

#include <linux/linkage.h>
#include <asm/segment.h>
#include <asm/cache.h>
#include <asm/errno.h>
#include <asm/dwarf2.h>
#include <asm/calling.h>
46
#include <asm/asm-offsets.h>
L
Linus Torvalds 已提交
47 48 49 50
#include <asm/msr.h>
#include <asm/unistd.h>
#include <asm/thread_info.h>
#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>
L
Linus Torvalds 已提交
55 56 57

	.code64

58
#ifdef CONFIG_FTRACE
59 60 61 62 63 64 65 66 67 68 69 70 71
#ifdef CONFIG_DYNAMIC_FTRACE
ENTRY(mcount)

	subq $0x38, %rsp
	movq %rax, (%rsp)
	movq %rcx, 8(%rsp)
	movq %rdx, 16(%rsp)
	movq %rsi, 24(%rsp)
	movq %rdi, 32(%rsp)
	movq %r8, 40(%rsp)
	movq %r9, 48(%rsp)

	movq 0x38(%rsp), %rdi
72
	subq $MCOUNT_INSN_SIZE, %rdi
73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103

.globl mcount_call
mcount_call:
	call ftrace_stub

	movq 48(%rsp), %r9
	movq 40(%rsp), %r8
	movq 32(%rsp), %rdi
	movq 24(%rsp), %rsi
	movq 16(%rsp), %rdx
	movq 8(%rsp), %rcx
	movq (%rsp), %rax
	addq $0x38, %rsp

	retq
END(mcount)

ENTRY(ftrace_caller)

	/* taken from glibc */
	subq $0x38, %rsp
	movq %rax, (%rsp)
	movq %rcx, 8(%rsp)
	movq %rdx, 16(%rsp)
	movq %rsi, 24(%rsp)
	movq %rdi, 32(%rsp)
	movq %r8, 40(%rsp)
	movq %r9, 48(%rsp)

	movq 0x38(%rsp), %rdi
	movq 8(%rbp), %rsi
104
	subq $MCOUNT_INSN_SIZE, %rdi
105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124

.globl ftrace_call
ftrace_call:
	call ftrace_stub

	movq 48(%rsp), %r9
	movq 40(%rsp), %r8
	movq 32(%rsp), %rdi
	movq 24(%rsp), %rsi
	movq 16(%rsp), %rdx
	movq 8(%rsp), %rcx
	movq (%rsp), %rax
	addq $0x38, %rsp

.globl ftrace_stub
ftrace_stub:
	retq
END(ftrace_caller)

#else /* ! CONFIG_DYNAMIC_FTRACE */
125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144
ENTRY(mcount)
	cmpq $ftrace_stub, ftrace_trace_function
	jnz trace
.globl ftrace_stub
ftrace_stub:
	retq

trace:
	/* taken from glibc */
	subq $0x38, %rsp
	movq %rax, (%rsp)
	movq %rcx, 8(%rsp)
	movq %rdx, 16(%rsp)
	movq %rsi, 24(%rsp)
	movq %rdi, 32(%rsp)
	movq %r8, 40(%rsp)
	movq %r9, 48(%rsp)

	movq 0x38(%rsp), %rdi
	movq 8(%rbp), %rsi
145
	subq $MCOUNT_INSN_SIZE, %rdi
146 147 148 149 150 151 152 153 154 155 156 157 158 159

	call   *ftrace_trace_function

	movq 48(%rsp), %r9
	movq 40(%rsp), %r8
	movq 32(%rsp), %rdi
	movq 24(%rsp), %rsi
	movq 16(%rsp), %rdx
	movq 8(%rsp), %rcx
	movq (%rsp), %rax
	addq $0x38, %rsp

	jmp ftrace_stub
END(mcount)
160 161
#endif /* CONFIG_DYNAMIC_FTRACE */
#endif /* CONFIG_FTRACE */
162

163
#ifndef CONFIG_PREEMPT
L
Linus Torvalds 已提交
164 165
#define retint_kernel retint_restore_args
#endif	
166

167
#ifdef CONFIG_PARAVIRT
168
ENTRY(native_usergs_sysret64)
169 170 171 172
	swapgs
	sysretq
#endif /* CONFIG_PARAVIRT */

173 174 175 176 177 178 179 180 181 182

.macro TRACE_IRQS_IRETQ offset=ARGOFFSET
#ifdef CONFIG_TRACE_IRQFLAGS
	bt   $9,EFLAGS-\offset(%rsp)	/* interrupts off? */
	jnc  1f
	TRACE_IRQS_ON
1:
#endif
.endm

L
Linus Torvalds 已提交
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210
/*
 * C code is not supposed to know about undefined top of stack. Every time 
 * a C function with an pt_regs argument is called from the SYSCALL based 
 * fast path FIXUP_TOP_OF_STACK is needed.
 * RESTORE_TOP_OF_STACK syncs the syscall state after any possible ptregs
 * manipulation.
 */        	
		
	/* %rsp:at FRAMEEND */ 
	.macro FIXUP_TOP_OF_STACK tmp
	movq	%gs:pda_oldrsp,\tmp
	movq  	\tmp,RSP(%rsp)
	movq    $__USER_DS,SS(%rsp)
	movq    $__USER_CS,CS(%rsp)
	movq 	$-1,RCX(%rsp)
	movq	R11(%rsp),\tmp  /* get eflags */
	movq	\tmp,EFLAGS(%rsp)
	.endm

	.macro RESTORE_TOP_OF_STACK tmp,offset=0
	movq   RSP-\offset(%rsp),\tmp
	movq   \tmp,%gs:pda_oldrsp
	movq   EFLAGS-\offset(%rsp),\tmp
	movq   \tmp,R11-\offset(%rsp)
	.endm

	.macro FAKE_STACK_FRAME child_rip
	/* push in order ss, rsp, eflags, cs, rip */
211
	xorl %eax, %eax
212
	pushq $__KERNEL_DS /* ss */
L
Linus Torvalds 已提交
213
	CFI_ADJUST_CFA_OFFSET	8
214
	/*CFI_REL_OFFSET	ss,0*/
L
Linus Torvalds 已提交
215 216
	pushq %rax /* rsp */
	CFI_ADJUST_CFA_OFFSET	8
217
	CFI_REL_OFFSET	rsp,0
L
Linus Torvalds 已提交
218 219
	pushq $(1<<9) /* eflags - interrupts on */
	CFI_ADJUST_CFA_OFFSET	8
220
	/*CFI_REL_OFFSET	rflags,0*/
L
Linus Torvalds 已提交
221 222
	pushq $__KERNEL_CS /* cs */
	CFI_ADJUST_CFA_OFFSET	8
223
	/*CFI_REL_OFFSET	cs,0*/
L
Linus Torvalds 已提交
224 225
	pushq \child_rip /* rip */
	CFI_ADJUST_CFA_OFFSET	8
226
	CFI_REL_OFFSET	rip,0
L
Linus Torvalds 已提交
227 228 229 230 231 232 233 234 235
	pushq	%rax /* orig rax */
	CFI_ADJUST_CFA_OFFSET	8
	.endm

	.macro UNFAKE_STACK_FRAME
	addq $8*6, %rsp
	CFI_ADJUST_CFA_OFFSET	-(6*8)
	.endm

236 237 238
	.macro	CFI_DEFAULT_STACK start=1
	.if \start
	CFI_STARTPROC	simple
239
	CFI_SIGNAL_FRAME
240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
	CFI_DEF_CFA	rsp,SS+8
	.else
	CFI_DEF_CFA_OFFSET SS+8
	.endif
	CFI_REL_OFFSET	r15,R15
	CFI_REL_OFFSET	r14,R14
	CFI_REL_OFFSET	r13,R13
	CFI_REL_OFFSET	r12,R12
	CFI_REL_OFFSET	rbp,RBP
	CFI_REL_OFFSET	rbx,RBX
	CFI_REL_OFFSET	r11,R11
	CFI_REL_OFFSET	r10,R10
	CFI_REL_OFFSET	r9,R9
	CFI_REL_OFFSET	r8,R8
	CFI_REL_OFFSET	rax,RAX
	CFI_REL_OFFSET	rcx,RCX
	CFI_REL_OFFSET	rdx,RDX
	CFI_REL_OFFSET	rsi,RSI
	CFI_REL_OFFSET	rdi,RDI
	CFI_REL_OFFSET	rip,RIP
	/*CFI_REL_OFFSET	cs,CS*/
	/*CFI_REL_OFFSET	rflags,EFLAGS*/
	CFI_REL_OFFSET	rsp,RSP
	/*CFI_REL_OFFSET	ss,SS*/
L
Linus Torvalds 已提交
264 265 266 267 268 269 270
	.endm
/*
 * A newly forked process directly context switches into this.
 */ 	
/* rdi:	prev */	
ENTRY(ret_from_fork)
	CFI_DEFAULT_STACK
271 272 273 274
	push kernel_eflags(%rip)
	CFI_ADJUST_CFA_OFFSET 4
	popf				# reset kernel eflags
	CFI_ADJUST_CFA_OFFSET -4
L
Linus Torvalds 已提交
275 276
	call schedule_tail
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
277
	testl $(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT),TI_flags(%rcx)
L
Linus Torvalds 已提交
278 279 280 281 282
	jnz rff_trace
rff_action:	
	RESTORE_REST
	testl $3,CS-ARGOFFSET(%rsp)	# from kernel_thread?
	je   int_ret_from_sys_call
G
Glauber Costa 已提交
283
	testl $_TIF_IA32,TI_flags(%rcx)
L
Linus Torvalds 已提交
284 285 286 287 288 289 290 291 292
	jnz  int_ret_from_sys_call
	RESTORE_TOP_OF_STACK %rdi,ARGOFFSET
	jmp ret_from_sys_call
rff_trace:
	movq %rsp,%rdi
	call syscall_trace_leave
	GET_THREAD_INFO(%rcx)	
	jmp rff_action
	CFI_ENDPROC
293
END(ret_from_fork)
L
Linus Torvalds 已提交
294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319

/*
 * System call entry. Upto 6 arguments in registers are supported.
 *
 * SYSCALL does not save anything on the stack and does not change the
 * stack pointer.
 */
		
/*
 * Register setup:	
 * rax  system call number
 * rdi  arg0
 * rcx  return address for syscall/sysret, C arg3 
 * rsi  arg1
 * rdx  arg2	
 * r10  arg3 	(--> moved to rcx for C)
 * r8   arg4
 * r9   arg5
 * r11  eflags for syscall/sysret, temporary for C
 * r12-r15,rbp,rbx saved by C code, not touched. 		
 * 
 * Interrupts are off on entry.
 * Only called from user space.
 *
 * XXX	if we had a free scratch register we could save the RSP into the stack frame
 *      and report it properly in ps. Unfortunately we haven't.
320 321 322 323
 *
 * When user can change the frames always force IRET. That is because
 * it deals with uncanonical addresses better. SYSRET has trouble
 * with them due to bugs in both AMD and Intel CPUs.
L
Linus Torvalds 已提交
324 325 326
 */ 			 		

ENTRY(system_call)
327
	CFI_STARTPROC	simple
328
	CFI_SIGNAL_FRAME
329
	CFI_DEF_CFA	rsp,PDA_STACKOFFSET
330 331
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
332 333 334 335 336 337 338 339
	SWAPGS_UNSAFE_STACK
	/*
	 * A hypervisor implementation might want to use a label
	 * after the swapgs, so that it can do the swapgs
	 * for the guest and jump here on syscall.
	 */
ENTRY(system_call_after_swapgs)

L
Linus Torvalds 已提交
340 341
	movq	%rsp,%gs:pda_oldrsp 
	movq	%gs:pda_kernelstack,%rsp
342 343 344 345
	/*
	 * No need to follow this irqs off/on section - it's straight
	 * and short:
	 */
346
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
347 348
	SAVE_ARGS 8,1
	movq  %rax,ORIG_RAX-ARGOFFSET(%rsp) 
349 350
	movq  %rcx,RIP-ARGOFFSET(%rsp)
	CFI_REL_OFFSET rip,RIP-ARGOFFSET
L
Linus Torvalds 已提交
351
	GET_THREAD_INFO(%rcx)
352
	testl $_TIF_WORK_SYSCALL_ENTRY,TI_flags(%rcx)
L
Linus Torvalds 已提交
353 354 355 356 357 358 359 360 361 362 363
	jnz tracesys
	cmpq $__NR_syscall_max,%rax
	ja badsys
	movq %r10,%rcx
	call *sys_call_table(,%rax,8)  # XXX:	 rip relative
	movq %rax,RAX-ARGOFFSET(%rsp)
/*
 * Syscall return path ending with SYSRET (fast path)
 * Has incomplete stack frame and undefined top of stack. 
 */		
ret_from_sys_call:
364
	movl $_TIF_ALLWORK_MASK,%edi
L
Linus Torvalds 已提交
365 366
	/* edi:	flagmask */
sysret_check:		
367
	LOCKDEP_SYS_EXIT
L
Linus Torvalds 已提交
368
	GET_THREAD_INFO(%rcx)
369
	DISABLE_INTERRUPTS(CLBR_NONE)
370
	TRACE_IRQS_OFF
G
Glauber Costa 已提交
371
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
372 373
	andl %edi,%edx
	jnz  sysret_careful 
374
	CFI_REMEMBER_STATE
375 376 377 378
	/*
	 * sysretq will re-enable interrupts:
	 */
	TRACE_IRQS_ON
L
Linus Torvalds 已提交
379
	movq RIP-ARGOFFSET(%rsp),%rcx
380
	CFI_REGISTER	rip,rcx
L
Linus Torvalds 已提交
381
	RESTORE_ARGS 0,-ARG_SKIP,1
382
	/*CFI_REGISTER	rflags,r11*/
383
	movq	%gs:pda_oldrsp, %rsp
384
	USERGS_SYSRET64
L
Linus Torvalds 已提交
385

386
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
387 388 389 390 391
	/* Handle reschedules */
	/* edx:	work, edi: workmask */	
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
392
	TRACE_IRQS_ON
393
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
394
	pushq %rdi
395
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
396 397
	call schedule
	popq  %rdi
398
	CFI_ADJUST_CFA_OFFSET -8
L
Linus Torvalds 已提交
399 400 401 402
	jmp sysret_check

	/* Handle a signal */ 
sysret_signal:
403
	TRACE_IRQS_ON
404
	ENABLE_INTERRUPTS(CLBR_NONE)
P
Peter Zijlstra 已提交
405
	testl $_TIF_DO_NOTIFY_MASK,%edx
406 407 408 409
	jz    1f

	/* Really a signal */
	/* edx:	work flags (arg3) */
L
Linus Torvalds 已提交
410 411 412 413
	leaq do_notify_resume(%rip),%rax
	leaq -ARGOFFSET(%rsp),%rdi # &pt_regs -> arg1
	xorl %esi,%esi # oldset -> arg2
	call ptregscall_common
R
Roland McGrath 已提交
414
1:	movl $_TIF_WORK_MASK,%edi
415 416
	/* Use IRET because user could have changed frame. This
	   works because ptregscall_common has called FIXUP_TOP_OF_STACK. */
417
	DISABLE_INTERRUPTS(CLBR_NONE)
418
	TRACE_IRQS_OFF
419
	jmp int_with_check
L
Linus Torvalds 已提交
420
	
421 422 423 424
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

L
Linus Torvalds 已提交
425 426 427
	/* Do syscall tracing */
tracesys:			 
	SAVE_REST
R
Roland McGrath 已提交
428
	movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
L
Linus Torvalds 已提交
429 430 431
	FIXUP_TOP_OF_STACK %rdi
	movq %rsp,%rdi
	call syscall_trace_enter
432 433 434 435 436 437
	/*
	 * Reload arg registers from stack in case ptrace changed them.
	 * We don't reload %rax because syscall_trace_enter() returned
	 * the value it wants us to use in the table lookup.
	 */
	LOAD_ARGS ARGOFFSET, 1
L
Linus Torvalds 已提交
438 439
	RESTORE_REST
	cmpq $__NR_syscall_max,%rax
R
Roland McGrath 已提交
440
	ja   int_ret_from_sys_call	/* RAX(%rsp) set to -ENOSYS above */
L
Linus Torvalds 已提交
441 442
	movq %r10,%rcx	/* fixup for C */
	call *sys_call_table(,%rax,8)
R
Roland McGrath 已提交
443
	movq %rax,RAX-ARGOFFSET(%rsp)
444
	/* Use IRET because user could have changed frame */
L
Linus Torvalds 已提交
445 446 447 448
		
/* 
 * Syscall return path ending with IRET.
 * Has correct top of stack, but partial stack frame.
449 450 451
 */
	.globl int_ret_from_sys_call
int_ret_from_sys_call:
452
	DISABLE_INTERRUPTS(CLBR_NONE)
453
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
454 455 456 457 458
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_restore_args
	movl $_TIF_ALLWORK_MASK,%edi
	/* edi:	mask to check */
int_with_check:
459
	LOCKDEP_SYS_EXIT_IRQ
L
Linus Torvalds 已提交
460
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
461
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
462 463
	andl %edi,%edx
	jnz   int_careful
G
Glauber Costa 已提交
464
	andl    $~TS_COMPAT,TI_status(%rcx)
L
Linus Torvalds 已提交
465 466 467 468 469 470 471 472
	jmp   retint_swapgs

	/* Either reschedule or signal or syscall exit tracking needed. */
	/* First do a reschedule test. */
	/* edx:	work, edi: workmask */
int_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc  int_very_careful
473
	TRACE_IRQS_ON
474
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
475
	pushq %rdi
476
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
477 478
	call schedule
	popq %rdi
479
	CFI_ADJUST_CFA_OFFSET -8
480
	DISABLE_INTERRUPTS(CLBR_NONE)
481
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
482 483 484 485
	jmp int_with_check

	/* handle signals and tracing -- both require a full stack frame */
int_very_careful:
486
	TRACE_IRQS_ON
487
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
488 489
	SAVE_REST
	/* Check for syscall exit trace */	
490
	testl $_TIF_WORK_SYSCALL_EXIT,%edx
L
Linus Torvalds 已提交
491 492
	jz int_signal
	pushq %rdi
493
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
494 495 496
	leaq 8(%rsp),%rdi	# &ptregs -> arg1	
	call syscall_trace_leave
	popq %rdi
497
	CFI_ADJUST_CFA_OFFSET -8
498
	andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
L
Linus Torvalds 已提交
499 500 501
	jmp int_restore_rest
	
int_signal:
P
Peter Zijlstra 已提交
502
	testl $_TIF_DO_NOTIFY_MASK,%edx
L
Linus Torvalds 已提交
503 504 505 506
	jz 1f
	movq %rsp,%rdi		# &ptregs -> arg1
	xorl %esi,%esi		# oldset -> arg2
	call do_notify_resume
R
Roland McGrath 已提交
507
1:	movl $_TIF_WORK_MASK,%edi
L
Linus Torvalds 已提交
508 509
int_restore_rest:
	RESTORE_REST
510
	DISABLE_INTERRUPTS(CLBR_NONE)
511
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
512 513
	jmp int_with_check
	CFI_ENDPROC
514
END(system_call)
L
Linus Torvalds 已提交
515 516 517 518 519 520 521 522 523 524 525
		
/* 
 * Certain special system calls that need to save a complete full stack frame.
 */ 								
	
	.macro PTREGSCALL label,func,arg
	.globl \label
\label:
	leaq	\func(%rip),%rax
	leaq    -ARGOFFSET+8(%rsp),\arg /* 8 for return address */
	jmp	ptregscall_common
526
END(\label)
L
Linus Torvalds 已提交
527 528
	.endm

529 530
	CFI_STARTPROC

L
Linus Torvalds 已提交
531 532 533 534 535 536 537 538
	PTREGSCALL stub_clone, sys_clone, %r8
	PTREGSCALL stub_fork, sys_fork, %rdi
	PTREGSCALL stub_vfork, sys_vfork, %rdi
	PTREGSCALL stub_sigaltstack, sys_sigaltstack, %rdx
	PTREGSCALL stub_iopl, sys_iopl, %rsi

ENTRY(ptregscall_common)
	popq %r11
539 540
	CFI_ADJUST_CFA_OFFSET -8
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
541 542
	SAVE_REST
	movq %r11, %r15
543
	CFI_REGISTER rip, r15
L
Linus Torvalds 已提交
544 545 546 547
	FIXUP_TOP_OF_STACK %r11
	call *%rax
	RESTORE_TOP_OF_STACK %r11
	movq %r15, %r11
548
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
549 550
	RESTORE_REST
	pushq %r11
551 552
	CFI_ADJUST_CFA_OFFSET 8
	CFI_REL_OFFSET rip, 0
L
Linus Torvalds 已提交
553 554
	ret
	CFI_ENDPROC
555
END(ptregscall_common)
L
Linus Torvalds 已提交
556 557 558 559
	
ENTRY(stub_execve)
	CFI_STARTPROC
	popq %r11
560 561
	CFI_ADJUST_CFA_OFFSET -8
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
562 563
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
564
	movq %rsp, %rcx
L
Linus Torvalds 已提交
565 566 567 568 569 570
	call sys_execve
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
571
END(stub_execve)
L
Linus Torvalds 已提交
572 573 574 575 576 577 578
	
/*
 * sigreturn is special because it needs to restore all registers on return.
 * This cannot be done with SYSRET, so use the IRET return path instead.
 */                
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
579 580
	addq $8, %rsp
	CFI_ADJUST_CFA_OFFSET	-8
L
Linus Torvalds 已提交
581 582 583 584 585 586 587 588
	SAVE_REST
	movq %rsp,%rdi
	FIXUP_TOP_OF_STACK %r11
	call sys_rt_sigreturn
	movq %rax,RAX(%rsp) # fixme, this could be done at the higher layer
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
589
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
590

591 592 593 594 595
/*
 * initial frame state for interrupts and exceptions
 */
	.macro _frame ref
	CFI_STARTPROC simple
596
	CFI_SIGNAL_FRAME
597 598 599 600 601 602 603 604 605 606 607 608 609 610
	CFI_DEF_CFA rsp,SS+8-\ref
	/*CFI_REL_OFFSET ss,SS-\ref*/
	CFI_REL_OFFSET rsp,RSP-\ref
	/*CFI_REL_OFFSET rflags,EFLAGS-\ref*/
	/*CFI_REL_OFFSET cs,CS-\ref*/
	CFI_REL_OFFSET rip,RIP-\ref
	.endm

/* initial frame state for interrupts (and exceptions without error code) */
#define INTR_FRAME _frame RIP
/* initial frame state for exceptions with error code (and interrupts with
   vector already pushed) */
#define XCPT_FRAME _frame ORIG_RAX

L
Linus Torvalds 已提交
611 612 613 614 615 616 617 618 619 620 621 622 623
/* 
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
 *	
 * Entry runs with interrupts off.	
 */ 

/* 0(%rsp): interrupt number */ 
	.macro interrupt func
	cld
	SAVE_ARGS
	leaq -ARGOFFSET(%rsp),%rdi	# arg1 for handler
624 625 626 627 628
	pushq %rbp
	CFI_ADJUST_CFA_OFFSET	8
	CFI_REL_OFFSET		rbp, 0
	movq %rsp,%rbp
	CFI_DEF_CFA_REGISTER	rbp
L
Linus Torvalds 已提交
629 630
	testl $3,CS(%rdi)
	je 1f
631
	SWAPGS
632 633 634 635 636 637
	/* irqcount is used to check if a CPU is already on an interrupt
	   stack or not. While this is essentially redundant with preempt_count
	   it is a little cheaper to use a separate counter in the PDA
	   (short of moving irq_enter into assembly, which would be too
	    much work) */
1:	incl	%gs:pda_irqcount
638
	cmoveq %gs:pda_irqstackptr,%rsp
639
	push    %rbp			# backlink for old unwinder
640 641 642 643
	/*
	 * We entered an interrupt context - irqs are off:
	 */
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
644 645 646 647
	call \func
	.endm

ENTRY(common_interrupt)
648
	XCPT_FRAME
L
Linus Torvalds 已提交
649 650
	interrupt do_IRQ
	/* 0(%rsp): oldrsp-ARGOFFSET */
651
ret_from_intr:
652
	DISABLE_INTERRUPTS(CLBR_NONE)
653
	TRACE_IRQS_OFF
654
	decl %gs:pda_irqcount
655
	leaveq
656
	CFI_DEF_CFA_REGISTER	rsp
657
	CFI_ADJUST_CFA_OFFSET	-8
658
exit_intr:
L
Linus Torvalds 已提交
659 660 661 662 663 664 665 666 667 668 669
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
	
	/* Interrupt came from user space */
	/*
	 * Has a correct top of stack, but a partial stack frame
	 * %rcx: thread info. Interrupts off.
	 */		
retint_with_reschedule:
	movl $_TIF_WORK_MASK,%edi
670
retint_check:
671
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
672
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
673
	andl %edi,%edx
674
	CFI_REMEMBER_STATE
L
Linus Torvalds 已提交
675
	jnz  retint_careful
676 677

retint_swapgs:		/* return to user-space */
678 679 680
	/*
	 * The iretq could re-enable interrupts:
	 */
681
	DISABLE_INTERRUPTS(CLBR_ANY)
682
	TRACE_IRQS_IRETQ
683
	SWAPGS
684 685
	jmp restore_args

686
retint_restore_args:	/* return to kernel space */
687
	DISABLE_INTERRUPTS(CLBR_ANY)
688 689 690 691 692
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
I
Ingo Molnar 已提交
693 694
	RESTORE_ARGS 0,8,0

A
Adrian Bunk 已提交
695
irq_return:
696
	INTERRUPT_RETURN
I
Ingo Molnar 已提交
697 698 699 700 701 702

	.section __ex_table, "a"
	.quad irq_return, bad_iret
	.previous

#ifdef CONFIG_PARAVIRT
703
ENTRY(native_iret)
L
Linus Torvalds 已提交
704 705 706
	iretq

	.section __ex_table,"a"
707
	.quad native_iret, bad_iret
L
Linus Torvalds 已提交
708
	.previous
I
Ingo Molnar 已提交
709 710
#endif

L
Linus Torvalds 已提交
711 712
	.section .fixup,"ax"
bad_iret:
713 714 715 716 717 718 719 720 721 722 723 724 725 726 727
	/*
	 * The iret traps when the %cs or %ss being restored is bogus.
	 * We've lost the original trap vector and error code.
	 * #GPF is the most likely one to get for an invalid selector.
	 * So pretend we completed the iret and took the #GPF in user mode.
	 *
	 * We are now running with the kernel GS after exception recovery.
	 * But error_entry expects us to have user GS to match the user %cs,
	 * so swap back.
	 */
	pushq $0

	SWAPGS
	jmp general_protection

728 729
	.previous

730
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
731
retint_careful:
732
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
733 734
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
735
	TRACE_IRQS_ON
736
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
737
	pushq %rdi
738
	CFI_ADJUST_CFA_OFFSET	8
L
Linus Torvalds 已提交
739 740
	call  schedule
	popq %rdi		
741
	CFI_ADJUST_CFA_OFFSET	-8
L
Linus Torvalds 已提交
742
	GET_THREAD_INFO(%rcx)
743
	DISABLE_INTERRUPTS(CLBR_NONE)
744
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
745 746 747
	jmp retint_check
	
retint_signal:
P
Peter Zijlstra 已提交
748
	testl $_TIF_DO_NOTIFY_MASK,%edx
749
	jz    retint_swapgs
750
	TRACE_IRQS_ON
751
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
752 753
	SAVE_REST
	movq $-1,ORIG_RAX(%rsp) 			
754
	xorl %esi,%esi		# oldset
L
Linus Torvalds 已提交
755 756 757
	movq %rsp,%rdi		# &pt_regs
	call do_notify_resume
	RESTORE_REST
758
	DISABLE_INTERRUPTS(CLBR_NONE)
759
	TRACE_IRQS_OFF
760
	GET_THREAD_INFO(%rcx)
R
Roland McGrath 已提交
761
	jmp retint_with_reschedule
L
Linus Torvalds 已提交
762 763 764 765

#ifdef CONFIG_PREEMPT
	/* Returning to kernel space. Check if we need preemption */
	/* rcx:	 threadinfo. interrupts off. */
766
ENTRY(retint_kernel)
G
Glauber Costa 已提交
767
	cmpl $0,TI_preempt_count(%rcx)
L
Linus Torvalds 已提交
768
	jnz  retint_restore_args
G
Glauber Costa 已提交
769
	bt  $TIF_NEED_RESCHED,TI_flags(%rcx)
L
Linus Torvalds 已提交
770 771 772 773 774 775
	jnc  retint_restore_args
	bt   $9,EFLAGS-ARGOFFSET(%rsp)	/* interrupts off? */
	jnc  retint_restore_args
	call preempt_schedule_irq
	jmp exit_intr
#endif	
776

L
Linus Torvalds 已提交
777
	CFI_ENDPROC
778
END(common_interrupt)
L
Linus Torvalds 已提交
779 780 781 782 783
	
/*
 * APIC interrupts.
 */		
	.macro apicinterrupt num,func
784
	INTR_FRAME
785
	pushq $~(\num)
786
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
787 788 789 790 791 792 793
	interrupt \func
	jmp ret_from_intr
	CFI_ENDPROC
	.endm

ENTRY(thermal_interrupt)
	apicinterrupt THERMAL_APIC_VECTOR,smp_thermal_interrupt
794
END(thermal_interrupt)
L
Linus Torvalds 已提交
795

796 797
ENTRY(threshold_interrupt)
	apicinterrupt THRESHOLD_APIC_VECTOR,mce_threshold_interrupt
798
END(threshold_interrupt)
799

L
Linus Torvalds 已提交
800 801 802
#ifdef CONFIG_SMP	
ENTRY(reschedule_interrupt)
	apicinterrupt RESCHEDULE_VECTOR,smp_reschedule_interrupt
803
END(reschedule_interrupt)
L
Linus Torvalds 已提交
804

805 806 807
	.macro INVALIDATE_ENTRY num
ENTRY(invalidate_interrupt\num)
	apicinterrupt INVALIDATE_TLB_VECTOR_START+\num,smp_invalidate_interrupt	
808
END(invalidate_interrupt\num)
809 810 811 812 813 814 815 816 817 818
	.endm

	INVALIDATE_ENTRY 0
	INVALIDATE_ENTRY 1
	INVALIDATE_ENTRY 2
	INVALIDATE_ENTRY 3
	INVALIDATE_ENTRY 4
	INVALIDATE_ENTRY 5
	INVALIDATE_ENTRY 6
	INVALIDATE_ENTRY 7
L
Linus Torvalds 已提交
819 820 821

ENTRY(call_function_interrupt)
	apicinterrupt CALL_FUNCTION_VECTOR,smp_call_function_interrupt
822
END(call_function_interrupt)
823 824 825
ENTRY(call_function_single_interrupt)
	apicinterrupt CALL_FUNCTION_SINGLE_VECTOR,smp_call_function_single_interrupt
END(call_function_single_interrupt)
826 827 828
ENTRY(irq_move_cleanup_interrupt)
	apicinterrupt IRQ_MOVE_CLEANUP_VECTOR,smp_irq_move_cleanup_interrupt
END(irq_move_cleanup_interrupt)
L
Linus Torvalds 已提交
829 830 831 832
#endif

ENTRY(apic_timer_interrupt)
	apicinterrupt LOCAL_TIMER_VECTOR,smp_apic_timer_interrupt
833
END(apic_timer_interrupt)
L
Linus Torvalds 已提交
834

835 836 837 838
ENTRY(uv_bau_message_intr1)
	apicinterrupt 220,uv_bau_message_interrupt
END(uv_bau_message_intr1)

L
Linus Torvalds 已提交
839 840
ENTRY(error_interrupt)
	apicinterrupt ERROR_APIC_VECTOR,smp_error_interrupt
841
END(error_interrupt)
L
Linus Torvalds 已提交
842 843 844

ENTRY(spurious_interrupt)
	apicinterrupt SPURIOUS_APIC_VECTOR,smp_spurious_interrupt
845
END(spurious_interrupt)
L
Linus Torvalds 已提交
846 847 848 849 850
				
/*
 * Exception entry points.
 */ 		
	.macro zeroentry sym
851
	INTR_FRAME
852
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
853
	pushq $0	/* push error code/oldrax */ 
854
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
855
	pushq %rax	/* push real oldrax to the rdi slot */ 
856
	CFI_ADJUST_CFA_OFFSET 8
857
	CFI_REL_OFFSET rax,0
L
Linus Torvalds 已提交
858 859
	leaq  \sym(%rip),%rax
	jmp error_entry
860
	CFI_ENDPROC
L
Linus Torvalds 已提交
861 862 863
	.endm	

	.macro errorentry sym
864
	XCPT_FRAME
865
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
866
	pushq %rax
867
	CFI_ADJUST_CFA_OFFSET 8
868
	CFI_REL_OFFSET rax,0
L
Linus Torvalds 已提交
869 870
	leaq  \sym(%rip),%rax
	jmp error_entry
871
	CFI_ENDPROC
L
Linus Torvalds 已提交
872 873 874 875
	.endm

	/* error code is on the stack already */
	/* handle NMI like exceptions that can happen everywhere */
876
	.macro paranoidentry sym, ist=0, irqtrace=1
L
Linus Torvalds 已提交
877 878 879 880 881 882 883
	SAVE_ALL
	cld
	movl $1,%ebx
	movl  $MSR_GS_BASE,%ecx
	rdmsr
	testl %edx,%edx
	js    1f
884
	SWAPGS
L
Linus Torvalds 已提交
885
	xorl  %ebx,%ebx
886 887 888 889 890
1:
	.if \ist
	movq	%gs:pda_data_offset, %rbp
	.endif
	movq %rsp,%rdi
L
Linus Torvalds 已提交
891 892
	movq ORIG_RAX(%rsp),%rsi
	movq $-1,ORIG_RAX(%rsp)
893
	.if \ist
894
	subq	$EXCEPTION_STKSZ, per_cpu__init_tss + TSS_ist + (\ist - 1) * 8(%rbp)
895
	.endif
L
Linus Torvalds 已提交
896
	call \sym
897
	.if \ist
898
	addq	$EXCEPTION_STKSZ, per_cpu__init_tss + TSS_ist + (\ist - 1) * 8(%rbp)
899
	.endif
900
	DISABLE_INTERRUPTS(CLBR_NONE)
901 902 903
	.if \irqtrace
	TRACE_IRQS_OFF
	.endif
L
Linus Torvalds 已提交
904
	.endm
905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925

	/*
 	 * "Paranoid" exit path from exception stack.
  	 * Paranoid because this is used by NMIs and cannot take
	 * any kernel state for granted.
	 * We don't do kernel preemption checks here, because only
	 * NMI should be common and it does not enable IRQs and
	 * cannot get reschedule ticks.
	 *
	 * "trace" is 0 for the NMI handler only, because irq-tracing
	 * is fundamentally NMI-unsafe. (we cannot change the soft and
	 * hard flags at once, atomically)
	 */
	.macro paranoidexit trace=1
	/* ebx:	no swapgs flag */
paranoid_exit\trace:
	testl %ebx,%ebx				/* swapgs needed? */
	jnz paranoid_restore\trace
	testl $3,CS(%rsp)
	jnz   paranoid_userspace\trace
paranoid_swapgs\trace:
926
	.if \trace
927
	TRACE_IRQS_IRETQ 0
928
	.endif
929
	SWAPGS_UNSAFE_STACK
930 931
paranoid_restore\trace:
	RESTORE_ALL 8
I
Ingo Molnar 已提交
932
	jmp irq_return
933 934
paranoid_userspace\trace:
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
935
	movl TI_flags(%rcx),%ebx
936 937 938 939 940 941 942 943 944 945 946
	andl $_TIF_WORK_MASK,%ebx
	jz paranoid_swapgs\trace
	movq %rsp,%rdi			/* &pt_regs */
	call sync_regs
	movq %rax,%rsp			/* switch stack for scheduling */
	testl $_TIF_NEED_RESCHED,%ebx
	jnz paranoid_schedule\trace
	movl %ebx,%edx			/* arg3: thread flags */
	.if \trace
	TRACE_IRQS_ON
	.endif
947
	ENABLE_INTERRUPTS(CLBR_NONE)
948 949 950
	xorl %esi,%esi 			/* arg2: oldset */
	movq %rsp,%rdi 			/* arg1: &pt_regs */
	call do_notify_resume
951
	DISABLE_INTERRUPTS(CLBR_NONE)
952 953 954 955 956 957 958 959
	.if \trace
	TRACE_IRQS_OFF
	.endif
	jmp paranoid_userspace\trace
paranoid_schedule\trace:
	.if \trace
	TRACE_IRQS_ON
	.endif
960
	ENABLE_INTERRUPTS(CLBR_ANY)
961
	call schedule
962
	DISABLE_INTERRUPTS(CLBR_ANY)
963 964 965 966 967 968 969
	.if \trace
	TRACE_IRQS_OFF
	.endif
	jmp paranoid_userspace\trace
	CFI_ENDPROC
	.endm

L
Linus Torvalds 已提交
970 971 972 973
/*
 * Exception entry point. This expects an error code/orig_rax on the stack
 * and the exception handler in %rax.	
 */ 		  				
974
KPROBE_ENTRY(error_entry)
975
	_frame RDI
976
	CFI_REL_OFFSET rax,0
L
Linus Torvalds 已提交
977 978 979 980 981 982 983
	/* rdi slot contains rax, oldrax contains error code */
	cld	
	subq  $14*8,%rsp
	CFI_ADJUST_CFA_OFFSET	(14*8)
	movq %rsi,13*8(%rsp)
	CFI_REL_OFFSET	rsi,RSI
	movq 14*8(%rsp),%rsi	/* load rax from rdi slot */
984
	CFI_REGISTER	rax,rsi
L
Linus Torvalds 已提交
985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
	movq %rdx,12*8(%rsp)
	CFI_REL_OFFSET	rdx,RDX
	movq %rcx,11*8(%rsp)
	CFI_REL_OFFSET	rcx,RCX
	movq %rsi,10*8(%rsp)	/* store rax */ 
	CFI_REL_OFFSET	rax,RAX
	movq %r8, 9*8(%rsp)
	CFI_REL_OFFSET	r8,R8
	movq %r9, 8*8(%rsp)
	CFI_REL_OFFSET	r9,R9
	movq %r10,7*8(%rsp)
	CFI_REL_OFFSET	r10,R10
	movq %r11,6*8(%rsp)
	CFI_REL_OFFSET	r11,R11
	movq %rbx,5*8(%rsp) 
	CFI_REL_OFFSET	rbx,RBX
	movq %rbp,4*8(%rsp) 
	CFI_REL_OFFSET	rbp,RBP
	movq %r12,3*8(%rsp) 
	CFI_REL_OFFSET	r12,R12
	movq %r13,2*8(%rsp) 
	CFI_REL_OFFSET	r13,R13
	movq %r14,1*8(%rsp) 
	CFI_REL_OFFSET	r14,R14
	movq %r15,(%rsp) 
	CFI_REL_OFFSET	r15,R15
	xorl %ebx,%ebx	
	testl $3,CS(%rsp)
	je  error_kernelspace
error_swapgs:	
1015
	SWAPGS
L
Linus Torvalds 已提交
1016 1017
error_sti:	
	movq %rdi,RDI(%rsp) 	
1018
	CFI_REL_OFFSET	rdi,RDI
L
Linus Torvalds 已提交
1019 1020 1021 1022
	movq %rsp,%rdi
	movq ORIG_RAX(%rsp),%rsi	/* get error code */ 
	movq $-1,ORIG_RAX(%rsp)
	call *%rax
1023 1024 1025
	/* ebx:	no swapgs flag (1: don't need swapgs, 0: need it) */
error_exit:
	movl %ebx,%eax
L
Linus Torvalds 已提交
1026
	RESTORE_REST
1027
	DISABLE_INTERRUPTS(CLBR_NONE)
1028
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
1029 1030 1031
	GET_THREAD_INFO(%rcx)	
	testl %eax,%eax
	jne  retint_kernel
1032
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
1033
	movl  TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
1034 1035 1036
	movl  $_TIF_WORK_MASK,%edi
	andl  %edi,%edx
	jnz  retint_careful
1037
	jmp retint_swapgs
L
Linus Torvalds 已提交
1038 1039 1040 1041 1042 1043 1044 1045 1046
	CFI_ENDPROC

error_kernelspace:
	incl %ebx
       /* There are two places in the kernel that can potentially fault with
          usergs. Handle them here. The exception handlers after
	   iret run with kernel gs again, so don't set the user space flag.
	   B stepping K8s sometimes report an truncated RIP for IRET 
	   exceptions returning to compat mode. Check for these here too. */
1047 1048
	leaq irq_return(%rip),%rcx
	cmpq %rcx,RIP(%rsp)
L
Linus Torvalds 已提交
1049
	je   error_swapgs
1050 1051
	movl %ecx,%ecx	/* zero extend */
	cmpq %rcx,RIP(%rsp)
L
Linus Torvalds 已提交
1052 1053 1054 1055
	je   error_swapgs
	cmpq $gs_change,RIP(%rsp)
        je   error_swapgs
	jmp  error_sti
1056
KPROBE_END(error_entry)
L
Linus Torvalds 已提交
1057 1058 1059
	
       /* Reload gs selector with exception handling */
       /* edi:  new selector */ 
1060
ENTRY(native_load_gs_index)
1061
	CFI_STARTPROC
L
Linus Torvalds 已提交
1062
	pushf
1063
	CFI_ADJUST_CFA_OFFSET 8
1064 1065
	DISABLE_INTERRUPTS(CLBR_ANY | ~(CLBR_RDI))
        SWAPGS
L
Linus Torvalds 已提交
1066 1067 1068
gs_change:     
        movl %edi,%gs   
2:	mfence		/* workaround */
1069
	SWAPGS
L
Linus Torvalds 已提交
1070
        popf
1071
	CFI_ADJUST_CFA_OFFSET -8
L
Linus Torvalds 已提交
1072
        ret
1073
	CFI_ENDPROC
1074
ENDPROC(native_load_gs_index)
L
Linus Torvalds 已提交
1075 1076 1077 1078 1079 1080 1081 1082
       
        .section __ex_table,"a"
        .align 8
        .quad gs_change,bad_gs
        .previous
        .section .fixup,"ax"
	/* running with kernelgs */
bad_gs: 
1083
	SWAPGS			/* switch back to user gs */
L
Linus Torvalds 已提交
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127
	xorl %eax,%eax
        movl %eax,%gs
        jmp  2b
        .previous       
	
/*
 * Create a kernel thread.
 *
 * C extern interface:
 *	extern long kernel_thread(int (*fn)(void *), void * arg, unsigned long flags)
 *
 * asm input arguments:
 *	rdi: fn, rsi: arg, rdx: flags
 */
ENTRY(kernel_thread)
	CFI_STARTPROC
	FAKE_STACK_FRAME $child_rip
	SAVE_ALL

	# rdi: flags, rsi: usp, rdx: will be &pt_regs
	movq %rdx,%rdi
	orq  kernel_thread_flags(%rip),%rdi
	movq $-1, %rsi
	movq %rsp, %rdx

	xorl %r8d,%r8d
	xorl %r9d,%r9d
	
	# clone now
	call do_fork
	movq %rax,RAX(%rsp)
	xorl %edi,%edi

	/*
	 * It isn't worth to check for reschedule here,
	 * so internally to the x86_64 port you can rely on kernel_thread()
	 * not to reschedule the child before returning, this avoids the need
	 * of hacks for example to fork off the per-CPU idle tasks.
         * [Hopefully no generic code relies on the reschedule -AK]	
	 */
	RESTORE_ALL
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1128
ENDPROC(kernel_thread)
L
Linus Torvalds 已提交
1129 1130
	
child_rip:
1131 1132
	pushq $0		# fake return address
	CFI_STARTPROC
L
Linus Torvalds 已提交
1133 1134 1135 1136 1137 1138 1139 1140
	/*
	 * Here we are in the child and the registers are set as they were
	 * at kernel_thread() invocation in the parent.
	 */
	movq %rdi, %rax
	movq %rsi, %rdi
	call *%rax
	# exit
1141
	mov %eax, %edi
L
Linus Torvalds 已提交
1142
	call do_exit
1143
	CFI_ENDPROC
1144
ENDPROC(child_rip)
L
Linus Torvalds 已提交
1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155

/*
 * execve(). This function needs to use IRET, not SYSRET, to set up all state properly.
 *
 * C extern interface:
 *	 extern long execve(char *name, char **argv, char **envp)
 *
 * asm input arguments:
 *	rdi: name, rsi: argv, rdx: envp
 *
 * We want to fallback into:
1156
 *	extern long sys_execve(char *name, char **argv,char **envp, struct pt_regs *regs)
L
Linus Torvalds 已提交
1157 1158
 *
 * do_sys_execve asm fallback arguments:
1159
 *	rdi: name, rsi: argv, rdx: envp, rcx: fake frame on the stack
L
Linus Torvalds 已提交
1160
 */
1161
ENTRY(kernel_execve)
L
Linus Torvalds 已提交
1162 1163 1164
	CFI_STARTPROC
	FAKE_STACK_FRAME $0
	SAVE_ALL	
1165
	movq %rsp,%rcx
L
Linus Torvalds 已提交
1166 1167 1168 1169 1170 1171 1172 1173 1174
	call sys_execve
	movq %rax, RAX(%rsp)	
	RESTORE_REST
	testq %rax,%rax
	je int_ret_from_sys_call
	RESTORE_ARGS
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1175
ENDPROC(kernel_execve)
L
Linus Torvalds 已提交
1176

1177
KPROBE_ENTRY(page_fault)
L
Linus Torvalds 已提交
1178
	errorentry do_page_fault
1179
KPROBE_END(page_fault)
L
Linus Torvalds 已提交
1180 1181 1182

ENTRY(coprocessor_error)
	zeroentry do_coprocessor_error
1183
END(coprocessor_error)
L
Linus Torvalds 已提交
1184 1185 1186

ENTRY(simd_coprocessor_error)
	zeroentry do_simd_coprocessor_error	
1187
END(simd_coprocessor_error)
L
Linus Torvalds 已提交
1188 1189 1190

ENTRY(device_not_available)
	zeroentry math_state_restore
1191
END(device_not_available)
L
Linus Torvalds 已提交
1192 1193

	/* runs on exception stack */
1194
KPROBE_ENTRY(debug)
1195
 	INTR_FRAME
1196
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1197 1198
	pushq $0
	CFI_ADJUST_CFA_OFFSET 8		
1199
	paranoidentry do_debug, DEBUG_STACK
1200
	paranoidexit
1201
KPROBE_END(debug)
L
Linus Torvalds 已提交
1202 1203

	/* runs on exception stack */	
1204
KPROBE_ENTRY(nmi)
1205
	INTR_FRAME
1206
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1207
	pushq $-1
1208
	CFI_ADJUST_CFA_OFFSET 8
1209 1210 1211 1212 1213 1214 1215
	paranoidentry do_nmi, 0, 0
#ifdef CONFIG_TRACE_IRQFLAGS
	paranoidexit 0
#else
	jmp paranoid_exit1
 	CFI_ENDPROC
#endif
1216
KPROBE_END(nmi)
1217

1218
KPROBE_ENTRY(int3)
1219
 	INTR_FRAME
1220
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1221 1222
 	pushq $0
 	CFI_ADJUST_CFA_OFFSET 8
1223
 	paranoidentry do_int3, DEBUG_STACK
1224
 	jmp paranoid_exit1
1225
 	CFI_ENDPROC
1226
KPROBE_END(int3)
L
Linus Torvalds 已提交
1227 1228 1229

ENTRY(overflow)
	zeroentry do_overflow
1230
END(overflow)
L
Linus Torvalds 已提交
1231 1232 1233

ENTRY(bounds)
	zeroentry do_bounds
1234
END(bounds)
L
Linus Torvalds 已提交
1235 1236 1237

ENTRY(invalid_op)
	zeroentry do_invalid_op	
1238
END(invalid_op)
L
Linus Torvalds 已提交
1239 1240 1241

ENTRY(coprocessor_segment_overrun)
	zeroentry do_coprocessor_segment_overrun
1242
END(coprocessor_segment_overrun)
L
Linus Torvalds 已提交
1243 1244 1245

	/* runs on exception stack */
ENTRY(double_fault)
1246
	XCPT_FRAME
1247
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1248
	paranoidentry do_double_fault
1249
	jmp paranoid_exit1
L
Linus Torvalds 已提交
1250
	CFI_ENDPROC
1251
END(double_fault)
L
Linus Torvalds 已提交
1252 1253 1254

ENTRY(invalid_TSS)
	errorentry do_invalid_TSS
1255
END(invalid_TSS)
L
Linus Torvalds 已提交
1256 1257 1258

ENTRY(segment_not_present)
	errorentry do_segment_not_present
1259
END(segment_not_present)
L
Linus Torvalds 已提交
1260 1261 1262

	/* runs on exception stack */
ENTRY(stack_segment)
1263
	XCPT_FRAME
1264
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1265
	paranoidentry do_stack_segment
1266
	jmp paranoid_exit1
L
Linus Torvalds 已提交
1267
	CFI_ENDPROC
1268
END(stack_segment)
L
Linus Torvalds 已提交
1269

1270
KPROBE_ENTRY(general_protection)
L
Linus Torvalds 已提交
1271
	errorentry do_general_protection
1272
KPROBE_END(general_protection)
L
Linus Torvalds 已提交
1273 1274 1275

ENTRY(alignment_check)
	errorentry do_alignment_check
1276
END(alignment_check)
L
Linus Torvalds 已提交
1277 1278 1279

ENTRY(divide_error)
	zeroentry do_divide_error
1280
END(divide_error)
L
Linus Torvalds 已提交
1281 1282 1283

ENTRY(spurious_interrupt_bug)
	zeroentry do_spurious_interrupt_bug
1284
END(spurious_interrupt_bug)
L
Linus Torvalds 已提交
1285 1286 1287 1288

#ifdef CONFIG_X86_MCE
	/* runs on exception stack */
ENTRY(machine_check)
1289
	INTR_FRAME
1290
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1291 1292 1293
	pushq $0
	CFI_ADJUST_CFA_OFFSET 8	
	paranoidentry do_machine_check
1294
	jmp paranoid_exit1
L
Linus Torvalds 已提交
1295
	CFI_ENDPROC
1296
END(machine_check)
L
Linus Torvalds 已提交
1297 1298
#endif

1299
/* Call softirq on interrupt stack. Interrupts are off. */
1300
ENTRY(call_softirq)
1301
	CFI_STARTPROC
1302 1303 1304 1305 1306
	push %rbp
	CFI_ADJUST_CFA_OFFSET	8
	CFI_REL_OFFSET rbp,0
	mov  %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1307
	incl %gs:pda_irqcount
1308 1309
	cmove %gs:pda_irqstackptr,%rsp
	push  %rbp			# backlink for old unwinder
1310
	call __do_softirq
1311
	leaveq
1312
	CFI_DEF_CFA_REGISTER	rsp
1313
	CFI_ADJUST_CFA_OFFSET   -8
1314 1315
	decl %gs:pda_irqcount
	ret
1316
	CFI_ENDPROC
1317
ENDPROC(call_softirq)
1318 1319 1320 1321 1322 1323 1324

KPROBE_ENTRY(ignore_sysret)
	CFI_STARTPROC
	mov $-ENOSYS,%eax
	sysret
	CFI_ENDPROC
ENDPROC(ignore_sysret)
1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377

#ifdef CONFIG_XEN
ENTRY(xen_hypervisor_callback)
	zeroentry xen_do_hypervisor_callback
END(xen_hypervisor_callback)

/*
# A note on the "critical region" in our callback handler.
# We want to avoid stacking callback handlers due to events occurring
# during handling of the last event. To do this, we keep events disabled
# until we've done all processing. HOWEVER, we must enable events before
# popping the stack frame (can't be done atomically) and so it would still
# be possible to get enough handler activations to overflow the stack.
# Although unlikely, bugs of that kind are hard to track down, so we'd
# like to avoid the possibility.
# So, on entry to the handler we detect whether we interrupted an
# existing activation in its critical region -- if so, we pop the current
# activation and restart the handler using the previous one.
*/
ENTRY(xen_do_hypervisor_callback)   # do_hypervisor_callback(struct *pt_regs)
	CFI_STARTPROC
/* Since we don't modify %rdi, evtchn_do_upall(struct *pt_regs) will
   see the correct pointer to the pt_regs */
	movq %rdi, %rsp            # we don't return, adjust the stack frame
	CFI_ENDPROC
	CFI_DEFAULT_STACK
11:	incl %gs:pda_irqcount
	movq %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
	cmovzq %gs:pda_irqstackptr,%rsp
	pushq %rbp			# backlink for old unwinder
	call xen_evtchn_do_upcall
	popq %rsp
	CFI_DEF_CFA_REGISTER rsp
	decl %gs:pda_irqcount
	jmp  error_exit
	CFI_ENDPROC
END(do_hypervisor_callback)

/*
# Hypervisor uses this for application faults while it executes.
# We get here for two reasons:
#  1. Fault while reloading DS, ES, FS or GS
#  2. Fault while executing IRET
# Category 1 we do not need to fix up as Xen has already reloaded all segment
# registers that could be reloaded and zeroed the others.
# Category 2 we fix up by killing the current process. We cannot use the
# normal Linux return path in this case because if we use the IRET hypercall
# to pop the stack frame we end up in an infinite loop of failsafe callbacks.
# We distinguish between categories by comparing each saved segment register
# with its current contents: any discrepancy means we in category 1.
*/
ENTRY(xen_failsafe_callback)
1378 1379
	framesz = (RIP-0x30)	/* workaround buggy gas */
	_frame framesz
1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401
	CFI_REL_OFFSET rcx, 0
	CFI_REL_OFFSET r11, 8
	movw %ds,%cx
	cmpw %cx,0x10(%rsp)
	CFI_REMEMBER_STATE
	jne 1f
	movw %es,%cx
	cmpw %cx,0x18(%rsp)
	jne 1f
	movw %fs,%cx
	cmpw %cx,0x20(%rsp)
	jne 1f
	movw %gs,%cx
	cmpw %cx,0x28(%rsp)
	jne 1f
	/* All segments match their saved values => Category 2 (Bad IRET). */
	movq (%rsp),%rcx
	CFI_RESTORE rcx
	movq 8(%rsp),%r11
	CFI_RESTORE r11
	addq $0x30,%rsp
	CFI_ADJUST_CFA_OFFSET -0x30
1402 1403 1404 1405 1406 1407 1408
	pushq $0
	CFI_ADJUST_CFA_OFFSET 8
	pushq %r11
	CFI_ADJUST_CFA_OFFSET 8
	pushq %rcx
	CFI_ADJUST_CFA_OFFSET 8
	jmp general_protection
1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424
	CFI_RESTORE_STATE
1:	/* Segment mismatch => Category 1 (Bad segment). Retry the IRET. */
	movq (%rsp),%rcx
	CFI_RESTORE rcx
	movq 8(%rsp),%r11
	CFI_RESTORE r11
	addq $0x30,%rsp
	CFI_ADJUST_CFA_OFFSET -0x30
	pushq $0
	CFI_ADJUST_CFA_OFFSET 8
	SAVE_ALL
	jmp error_exit
	CFI_ENDPROC
END(xen_failsafe_callback)

#endif /* CONFIG_XEN */