entry_64.S 38.2 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13
/*
 *  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.
14 15
 *
 * Normal syscalls and interrupts don't save a full stack frame, this is
L
Linus Torvalds 已提交
16
 * only done for syscall tracing, signals or fork/exec et.al.
17 18 19 20
 *
 * A note on terminology:
 * - top of stack: Architecture defined interrupt frame from SS to RIP
 * at the top of the kernel process stack.
L
Linus Torvalds 已提交
21
 * - partial stack frame: partially saved registers upto R11.
22
 * - 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_types.h>
52
#include <asm/irqflags.h>
53
#include <asm/paravirt.h>
54
#include <asm/ftrace.h>
55
#include <asm/percpu.h>
L
Linus Torvalds 已提交
56

R
Roland McGrath 已提交
57 58 59 60 61 62
/* Avoid __ASSEMBLER__'ifying <linux/audit.h> just for this.  */
#include <linux/elf-em.h>
#define AUDIT_ARCH_X86_64	(EM_X86_64|__AUDIT_ARCH_64BIT|__AUDIT_ARCH_LE)
#define __AUDIT_ARCH_64BIT 0x80000000
#define __AUDIT_ARCH_LE	   0x40000000

L
Linus Torvalds 已提交
63
	.code64
64
#ifdef CONFIG_FUNCTION_TRACER
65 66 67 68 69 70
#ifdef CONFIG_DYNAMIC_FTRACE
ENTRY(mcount)
	retq
END(mcount)

ENTRY(ftrace_caller)
71 72
	cmpl $0, function_trace_stop
	jne  ftrace_stub
73

74
	MCOUNT_SAVE_FRAME
75 76 77

	movq 0x38(%rsp), %rdi
	movq 8(%rbp), %rsi
78
	subq $MCOUNT_INSN_SIZE, %rdi
79

80
GLOBAL(ftrace_call)
81 82
	call ftrace_stub

83
	MCOUNT_RESTORE_FRAME
84

85
#ifdef CONFIG_FUNCTION_GRAPH_TRACER
86
GLOBAL(ftrace_graph_call)
87 88
	jmp ftrace_stub
#endif
89

90
GLOBAL(ftrace_stub)
91 92 93 94
	retq
END(ftrace_caller)

#else /* ! CONFIG_DYNAMIC_FTRACE */
95
ENTRY(mcount)
96 97 98
	cmpl $0, function_trace_stop
	jne  ftrace_stub

99 100
	cmpq $ftrace_stub, ftrace_trace_function
	jnz trace
101 102 103 104

#ifdef CONFIG_FUNCTION_GRAPH_TRACER
	cmpq $ftrace_stub, ftrace_graph_return
	jnz ftrace_graph_caller
105 106 107

	cmpq $ftrace_graph_entry_stub, ftrace_graph_entry
	jnz ftrace_graph_caller
108 109
#endif

110
GLOBAL(ftrace_stub)
111 112 113
	retq

trace:
114
	MCOUNT_SAVE_FRAME
115 116 117

	movq 0x38(%rsp), %rdi
	movq 8(%rbp), %rsi
118
	subq $MCOUNT_INSN_SIZE, %rdi
119 120 121

	call   *ftrace_trace_function

122
	MCOUNT_RESTORE_FRAME
123 124 125

	jmp ftrace_stub
END(mcount)
126
#endif /* CONFIG_DYNAMIC_FTRACE */
127
#endif /* CONFIG_FUNCTION_TRACER */
128

129 130 131 132 133
#ifdef CONFIG_FUNCTION_GRAPH_TRACER
ENTRY(ftrace_graph_caller)
	cmpl $0, function_trace_stop
	jne ftrace_stub

134
	MCOUNT_SAVE_FRAME
135 136 137

	leaq 8(%rbp), %rdi
	movq 0x38(%rsp), %rsi
138
	subq $MCOUNT_INSN_SIZE, %rsi
139 140 141

	call	prepare_ftrace_return

142 143
	MCOUNT_RESTORE_FRAME

144 145 146
	retq
END(ftrace_graph_caller)

147
GLOBAL(return_to_handler)
148 149
	subq  $80, %rsp

150 151 152 153 154 155 156
	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)
157 158
	movq %r10, 56(%rsp)
	movq %r11, 64(%rsp)
159

160
	call ftrace_return_to_handler
161

162 163 164
	movq %rax, 72(%rsp)
	movq 64(%rsp), %r11
	movq 56(%rsp), %r10
165 166 167 168 169 170 171
	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
172 173 174
	addq $72, %rsp
	retq
#endif
175 176


177
#ifndef CONFIG_PREEMPT
L
Linus Torvalds 已提交
178
#define retint_kernel retint_restore_args
179
#endif
180

181
#ifdef CONFIG_PARAVIRT
182
ENTRY(native_usergs_sysret64)
183 184
	swapgs
	sysretq
185
ENDPROC(native_usergs_sysret64)
186 187
#endif /* CONFIG_PARAVIRT */

188 189 190 191 192 193 194 195 196 197

.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 已提交
198
/*
199 200
 * 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
L
Linus Torvalds 已提交
201 202 203
 * fast path FIXUP_TOP_OF_STACK is needed.
 * RESTORE_TOP_OF_STACK syncs the syscall state after any possible ptregs
 * manipulation.
204 205 206
 */

	/* %rsp:at FRAMEEND */
207
	.macro FIXUP_TOP_OF_STACK tmp offset=0
208
	movq PER_CPU_VAR(old_rsp),\tmp
209 210 211 212 213 214
	movq \tmp,RSP+\offset(%rsp)
	movq $__USER_DS,SS+\offset(%rsp)
	movq $__USER_CS,CS+\offset(%rsp)
	movq $-1,RCX+\offset(%rsp)
	movq R11+\offset(%rsp),\tmp  /* get eflags */
	movq \tmp,EFLAGS+\offset(%rsp)
L
Linus Torvalds 已提交
215 216
	.endm

217 218
	.macro RESTORE_TOP_OF_STACK tmp offset=0
	movq RSP+\offset(%rsp),\tmp
219
	movq \tmp,PER_CPU_VAR(old_rsp)
220 221
	movq EFLAGS+\offset(%rsp),\tmp
	movq \tmp,R11+\offset(%rsp)
L
Linus Torvalds 已提交
222 223 224 225
	.endm

	.macro FAKE_STACK_FRAME child_rip
	/* push in order ss, rsp, eflags, cs, rip */
226
	xorl %eax, %eax
227
	pushq $__KERNEL_DS /* ss */
L
Linus Torvalds 已提交
228
	CFI_ADJUST_CFA_OFFSET	8
229
	/*CFI_REL_OFFSET	ss,0*/
L
Linus Torvalds 已提交
230 231
	pushq %rax /* rsp */
	CFI_ADJUST_CFA_OFFSET	8
232
	CFI_REL_OFFSET	rsp,0
233
	pushq $X86_EFLAGS_IF /* eflags - interrupts on */
L
Linus Torvalds 已提交
234
	CFI_ADJUST_CFA_OFFSET	8
235
	/*CFI_REL_OFFSET	rflags,0*/
L
Linus Torvalds 已提交
236 237
	pushq $__KERNEL_CS /* cs */
	CFI_ADJUST_CFA_OFFSET	8
238
	/*CFI_REL_OFFSET	cs,0*/
L
Linus Torvalds 已提交
239 240
	pushq \child_rip /* rip */
	CFI_ADJUST_CFA_OFFSET	8
241
	CFI_REL_OFFSET	rip,0
L
Linus Torvalds 已提交
242 243 244 245 246 247 248 249 250
	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

251 252 253 254
/*
 * initial frame state for interrupts (and exceptions without error code)
 */
	.macro EMPTY_FRAME start=1 offset=0
255
	.if \start
256
	CFI_STARTPROC simple
257
	CFI_SIGNAL_FRAME
258
	CFI_DEF_CFA rsp,8+\offset
259
	.else
260
	CFI_DEF_CFA_OFFSET 8+\offset
261
	.endif
L
Linus Torvalds 已提交
262
	.endm
263 264

/*
265
 * initial frame state for interrupts (and exceptions without error code)
266
 */
267
	.macro INTR_FRAME start=1 offset=0
268 269 270 271 272 273
	EMPTY_FRAME \start, SS+8+\offset-RIP
	/*CFI_REL_OFFSET ss, SS+\offset-RIP*/
	CFI_REL_OFFSET rsp, RSP+\offset-RIP
	/*CFI_REL_OFFSET rflags, EFLAGS+\offset-RIP*/
	/*CFI_REL_OFFSET cs, CS+\offset-RIP*/
	CFI_REL_OFFSET rip, RIP+\offset-RIP
274 275 276 277 278 279
	.endm

/*
 * initial frame state for exceptions with error code (and interrupts
 * with vector already pushed)
 */
280
	.macro XCPT_FRAME start=1 offset=0
281
	INTR_FRAME \start, RIP+\offset-ORIG_RAX
282 283 284 285 286 287 288
	/*CFI_REL_OFFSET orig_rax, ORIG_RAX-ORIG_RAX*/
	.endm

/*
 * frame that enables calling into C.
 */
	.macro PARTIAL_FRAME start=1 offset=0
289 290 291 292 293 294 295 296 297 298
	XCPT_FRAME \start, ORIG_RAX+\offset-ARGOFFSET
	CFI_REL_OFFSET rdi, RDI+\offset-ARGOFFSET
	CFI_REL_OFFSET rsi, RSI+\offset-ARGOFFSET
	CFI_REL_OFFSET rdx, RDX+\offset-ARGOFFSET
	CFI_REL_OFFSET rcx, RCX+\offset-ARGOFFSET
	CFI_REL_OFFSET rax, RAX+\offset-ARGOFFSET
	CFI_REL_OFFSET r8, R8+\offset-ARGOFFSET
	CFI_REL_OFFSET r9, R9+\offset-ARGOFFSET
	CFI_REL_OFFSET r10, R10+\offset-ARGOFFSET
	CFI_REL_OFFSET r11, R11+\offset-ARGOFFSET
299 300 301 302 303 304
	.endm

/*
 * frame that enables passing a complete pt_regs to a C function.
 */
	.macro DEFAULT_FRAME start=1 offset=0
305
	PARTIAL_FRAME \start, R11+\offset-R15
306 307 308 309 310 311 312
	CFI_REL_OFFSET rbx, RBX+\offset
	CFI_REL_OFFSET rbp, RBP+\offset
	CFI_REL_OFFSET r12, R12+\offset
	CFI_REL_OFFSET r13, R13+\offset
	CFI_REL_OFFSET r14, R14+\offset
	CFI_REL_OFFSET r15, R15+\offset
	.endm
313 314 315 316 317

/* save partial stack frame */
ENTRY(save_args)
	XCPT_FRAME
	cld
I
Ingo Molnar 已提交
318 319 320 321 322 323 324 325 326 327
	movq_cfi rdi, RDI+16-ARGOFFSET
	movq_cfi rsi, RSI+16-ARGOFFSET
	movq_cfi rdx, RDX+16-ARGOFFSET
	movq_cfi rcx, RCX+16-ARGOFFSET
	movq_cfi rax, RAX+16-ARGOFFSET
	movq_cfi  r8,  R8+16-ARGOFFSET
	movq_cfi  r9,  R9+16-ARGOFFSET
	movq_cfi r10, R10+16-ARGOFFSET
	movq_cfi r11, R11+16-ARGOFFSET

328
	leaq -ARGOFFSET+16(%rsp),%rdi	/* arg1 for handler */
I
Ingo Molnar 已提交
329
	movq_cfi rbp, 8		/* push %rbp */
330 331 332 333 334
	leaq 8(%rsp), %rbp		/* mov %rsp, %ebp */
	testl $3, CS(%rdi)
	je 1f
	SWAPGS
	/*
335
	 * irq_count is used to check if a CPU is already on an interrupt stack
336 337 338 339
	 * 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)
	 */
340
1:	incl PER_CPU_VAR(irq_count)
341
	jne 2f
I
Ingo Molnar 已提交
342
	popq_cfi %rax			/* move return address... */
343
	mov PER_CPU_VAR(irq_stack_ptr),%rsp
344
	EMPTY_FRAME 0
345
	pushq_cfi %rbp			/* backlink for unwinder */
I
Ingo Molnar 已提交
346
	pushq_cfi %rax			/* ... to the new stack */
347 348 349 350 351 352 353 354
	/*
	 * We entered an interrupt context - irqs are off:
	 */
2:	TRACE_IRQS_OFF
	ret
	CFI_ENDPROC
END(save_args)

355 356 357 358 359 360 361 362 363 364 365 366 367 368 369
ENTRY(save_rest)
	PARTIAL_FRAME 1 REST_SKIP+8
	movq 5*8+16(%rsp), %r11	/* save return address */
	movq_cfi rbx, RBX+16
	movq_cfi rbp, RBP+16
	movq_cfi r12, R12+16
	movq_cfi r13, R13+16
	movq_cfi r14, R14+16
	movq_cfi r15, R15+16
	movq %r11, 8(%rsp)	/* return address */
	FIXUP_TOP_OF_STACK %r11, 16
	ret
	CFI_ENDPROC
END(save_rest)

370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
/* save complete stack frame */
ENTRY(save_paranoid)
	XCPT_FRAME 1 RDI+8
	cld
	movq_cfi rdi, RDI+8
	movq_cfi rsi, RSI+8
	movq_cfi rdx, RDX+8
	movq_cfi rcx, RCX+8
	movq_cfi rax, RAX+8
	movq_cfi r8, R8+8
	movq_cfi r9, R9+8
	movq_cfi r10, R10+8
	movq_cfi r11, R11+8
	movq_cfi rbx, RBX+8
	movq_cfi rbp, RBP+8
	movq_cfi r12, R12+8
	movq_cfi r13, R13+8
	movq_cfi r14, R14+8
	movq_cfi r15, R15+8
	movl $1,%ebx
	movl $MSR_GS_BASE,%ecx
	rdmsr
	testl %edx,%edx
	js 1f	/* negative -> in kernel */
	SWAPGS
	xorl %ebx,%ebx
1:	ret
	CFI_ENDPROC
END(save_paranoid)

L
Linus Torvalds 已提交
400
/*
401 402 403
 * A newly forked process directly context switches into this address.
 *
 * rdi: prev task we switched from
404
 */
L
Linus Torvalds 已提交
405
ENTRY(ret_from_fork)
406
	DEFAULT_FRAME
407

408 409
	LOCK ; btr $TIF_FORK,TI_flags(%r8)

410
	push kernel_eflags(%rip)
411
	CFI_ADJUST_CFA_OFFSET 8
412
	popf					# reset kernel eflags
413
	CFI_ADJUST_CFA_OFFSET -8
414 415 416

	call schedule_tail			# rdi: 'prev' task parameter

L
Linus Torvalds 已提交
417
	GET_THREAD_INFO(%rcx)
418

L
Linus Torvalds 已提交
419
	RESTORE_REST
420 421

	testl $3, CS-ARGOFFSET(%rsp)		# from kernel_thread?
L
Linus Torvalds 已提交
422
	je   int_ret_from_sys_call
423 424

	testl $_TIF_IA32, TI_flags(%rcx)	# 32-bit compat task needs IRET
L
Linus Torvalds 已提交
425
	jnz  int_ret_from_sys_call
426

427
	RESTORE_TOP_OF_STACK %rdi, -ARGOFFSET
428 429
	jmp ret_from_sys_call			# go to the SYSRET fastpath

L
Linus Torvalds 已提交
430
	CFI_ENDPROC
431
END(ret_from_fork)
L
Linus Torvalds 已提交
432 433 434 435 436 437 438

/*
 * 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.
 */
439

L
Linus Torvalds 已提交
440
/*
441
 * Register setup:
L
Linus Torvalds 已提交
442 443
 * rax  system call number
 * rdi  arg0
444
 * rcx  return address for syscall/sysret, C arg3
L
Linus Torvalds 已提交
445
 * rsi  arg1
446
 * rdx  arg2
L
Linus Torvalds 已提交
447 448 449 450
 * r10  arg3 	(--> moved to rcx for C)
 * r8   arg4
 * r9   arg5
 * r11  eflags for syscall/sysret, temporary for C
451 452
 * r12-r15,rbp,rbx saved by C code, not touched.
 *
L
Linus Torvalds 已提交
453 454 455 456 457
 * 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.
458 459 460 461
 *
 * 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.
462
 */
L
Linus Torvalds 已提交
463 464

ENTRY(system_call)
465
	CFI_STARTPROC	simple
466
	CFI_SIGNAL_FRAME
467
	CFI_DEF_CFA	rsp,KERNEL_STACK_OFFSET
468 469
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
470 471 472 473 474 475 476 477
	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)

478
	movq	%rsp,PER_CPU_VAR(old_rsp)
479
	movq	PER_CPU_VAR(kernel_stack),%rsp
480 481 482 483
	/*
	 * No need to follow this irqs off/on section - it's straight
	 * and short:
	 */
484
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
485
	SAVE_ARGS 8,1
486
	movq  %rax,ORIG_RAX-ARGOFFSET(%rsp)
487 488
	movq  %rcx,RIP-ARGOFFSET(%rsp)
	CFI_REL_OFFSET rip,RIP-ARGOFFSET
L
Linus Torvalds 已提交
489
	GET_THREAD_INFO(%rcx)
490
	testl $_TIF_WORK_SYSCALL_ENTRY,TI_flags(%rcx)
L
Linus Torvalds 已提交
491
	jnz tracesys
R
Roland McGrath 已提交
492
system_call_fastpath:
L
Linus Torvalds 已提交
493 494 495 496 497 498 499
	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)
500 501
 * Has incomplete stack frame and undefined top of stack.
 */
L
Linus Torvalds 已提交
502
ret_from_sys_call:
503
	movl $_TIF_ALLWORK_MASK,%edi
L
Linus Torvalds 已提交
504
	/* edi:	flagmask */
505
sysret_check:
506
	LOCKDEP_SYS_EXIT
L
Linus Torvalds 已提交
507
	GET_THREAD_INFO(%rcx)
508
	DISABLE_INTERRUPTS(CLBR_NONE)
509
	TRACE_IRQS_OFF
G
Glauber Costa 已提交
510
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
511
	andl %edi,%edx
512
	jnz  sysret_careful
513
	CFI_REMEMBER_STATE
514 515 516 517
	/*
	 * sysretq will re-enable interrupts:
	 */
	TRACE_IRQS_ON
L
Linus Torvalds 已提交
518
	movq RIP-ARGOFFSET(%rsp),%rcx
519
	CFI_REGISTER	rip,rcx
L
Linus Torvalds 已提交
520
	RESTORE_ARGS 0,-ARG_SKIP,1
521
	/*CFI_REGISTER	rflags,r11*/
522
	movq	PER_CPU_VAR(old_rsp), %rsp
523
	USERGS_SYSRET64
L
Linus Torvalds 已提交
524

525
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
526
	/* Handle reschedules */
527
	/* edx:	work, edi: workmask */
L
Linus Torvalds 已提交
528 529 530
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
531
	TRACE_IRQS_ON
532
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
533
	pushq %rdi
534
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
535 536
	call schedule
	popq  %rdi
537
	CFI_ADJUST_CFA_OFFSET -8
L
Linus Torvalds 已提交
538 539
	jmp sysret_check

540
	/* Handle a signal */
L
Linus Torvalds 已提交
541
sysret_signal:
542
	TRACE_IRQS_ON
543
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
544 545 546 547
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
548
	/* edx:	work flags (arg3) */
L
Linus Torvalds 已提交
549 550
	leaq -ARGOFFSET(%rsp),%rdi # &pt_regs -> arg1
	xorl %esi,%esi # oldset -> arg2
551 552 553 554 555
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
	call do_notify_resume
	RESTORE_TOP_OF_STACK %r11
	RESTORE_REST
556
	movl $_TIF_WORK_MASK,%edi
557 558
	/* Use IRET because user could have changed frame. This
	   works because ptregscall_common has called FIXUP_TOP_OF_STACK. */
559
	DISABLE_INTERRUPTS(CLBR_NONE)
560
	TRACE_IRQS_OFF
561
	jmp int_with_check
562

563 564 565 566
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

R
Roland McGrath 已提交
567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599
#ifdef CONFIG_AUDITSYSCALL
	/*
	 * Fast path for syscall audit without full syscall trace.
	 * We just call audit_syscall_entry() directly, and then
	 * jump back to the normal fast path.
	 */
auditsys:
	movq %r10,%r9			/* 6th arg: 4th syscall arg */
	movq %rdx,%r8			/* 5th arg: 3rd syscall arg */
	movq %rsi,%rcx			/* 4th arg: 2nd syscall arg */
	movq %rdi,%rdx			/* 3rd arg: 1st syscall arg */
	movq %rax,%rsi			/* 2nd arg: syscall number */
	movl $AUDIT_ARCH_X86_64,%edi	/* 1st arg: audit arch */
	call audit_syscall_entry
	LOAD_ARGS 0		/* reload call-clobbered registers */
	jmp system_call_fastpath

	/*
	 * Return fast path for syscall audit.  Call audit_syscall_exit()
	 * directly and then jump back to the fast path with TIF_SYSCALL_AUDIT
	 * masked off.
	 */
sysret_audit:
	movq %rax,%rsi		/* second arg, syscall return value */
	cmpq $0,%rax		/* is it < 0? */
	setl %al		/* 1 if so, 0 if not */
	movzbl %al,%edi		/* zero-extend that into %edi */
	inc %edi /* first arg, 0->1(AUDITSC_SUCCESS), 1->2(AUDITSC_FAILURE) */
	call audit_syscall_exit
	movl $(_TIF_ALLWORK_MASK & ~_TIF_SYSCALL_AUDIT),%edi
	jmp sysret_check
#endif	/* CONFIG_AUDITSYSCALL */

L
Linus Torvalds 已提交
600
	/* Do syscall tracing */
601
tracesys:
R
Roland McGrath 已提交
602 603 604 605
#ifdef CONFIG_AUDITSYSCALL
	testl $(_TIF_WORK_SYSCALL_ENTRY & ~_TIF_SYSCALL_AUDIT),TI_flags(%rcx)
	jz auditsys
#endif
L
Linus Torvalds 已提交
606
	SAVE_REST
R
Roland McGrath 已提交
607
	movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
L
Linus Torvalds 已提交
608 609 610
	FIXUP_TOP_OF_STACK %rdi
	movq %rsp,%rdi
	call syscall_trace_enter
611 612 613 614 615 616
	/*
	 * 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 已提交
617 618
	RESTORE_REST
	cmpq $__NR_syscall_max,%rax
R
Roland McGrath 已提交
619
	ja   int_ret_from_sys_call	/* RAX(%rsp) set to -ENOSYS above */
L
Linus Torvalds 已提交
620 621
	movq %r10,%rcx	/* fixup for C */
	call *sys_call_table(,%rax,8)
R
Roland McGrath 已提交
622
	movq %rax,RAX-ARGOFFSET(%rsp)
623
	/* Use IRET because user could have changed frame */
624 625

/*
L
Linus Torvalds 已提交
626 627
 * Syscall return path ending with IRET.
 * Has correct top of stack, but partial stack frame.
628
 */
629
GLOBAL(int_ret_from_sys_call)
630
	DISABLE_INTERRUPTS(CLBR_NONE)
631
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
632 633 634 635
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_restore_args
	movl $_TIF_ALLWORK_MASK,%edi
	/* edi:	mask to check */
636
GLOBAL(int_with_check)
637
	LOCKDEP_SYS_EXIT_IRQ
L
Linus Torvalds 已提交
638
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
639
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
640 641
	andl %edi,%edx
	jnz   int_careful
G
Glauber Costa 已提交
642
	andl    $~TS_COMPAT,TI_status(%rcx)
L
Linus Torvalds 已提交
643 644 645 646 647 648 649 650
	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
651
	TRACE_IRQS_ON
652
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
653
	pushq %rdi
654
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
655 656
	call schedule
	popq %rdi
657
	CFI_ADJUST_CFA_OFFSET -8
658
	DISABLE_INTERRUPTS(CLBR_NONE)
659
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
660 661 662 663
	jmp int_with_check

	/* handle signals and tracing -- both require a full stack frame */
int_very_careful:
664
	TRACE_IRQS_ON
665
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
666
	SAVE_REST
667
	/* Check for syscall exit trace */
668
	testl $_TIF_WORK_SYSCALL_EXIT,%edx
L
Linus Torvalds 已提交
669 670
	jz int_signal
	pushq %rdi
671
	CFI_ADJUST_CFA_OFFSET 8
672
	leaq 8(%rsp),%rdi	# &ptregs -> arg1
L
Linus Torvalds 已提交
673 674
	call syscall_trace_leave
	popq %rdi
675
	CFI_ADJUST_CFA_OFFSET -8
676
	andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
L
Linus Torvalds 已提交
677
	jmp int_restore_rest
678

L
Linus Torvalds 已提交
679
int_signal:
P
Peter Zijlstra 已提交
680
	testl $_TIF_DO_NOTIFY_MASK,%edx
L
Linus Torvalds 已提交
681 682 683 684
	jz 1f
	movq %rsp,%rdi		# &ptregs -> arg1
	xorl %esi,%esi		# oldset -> arg2
	call do_notify_resume
R
Roland McGrath 已提交
685
1:	movl $_TIF_WORK_MASK,%edi
L
Linus Torvalds 已提交
686 687
int_restore_rest:
	RESTORE_REST
688
	DISABLE_INTERRUPTS(CLBR_NONE)
689
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
690 691
	jmp int_with_check
	CFI_ENDPROC
692
END(system_call)
693 694

/*
L
Linus Torvalds 已提交
695
 * Certain special system calls that need to save a complete full stack frame.
696
 */
L
Linus Torvalds 已提交
697
	.macro PTREGSCALL label,func,arg
698 699 700 701 702 703 704 705 706 707
ENTRY(\label)
	PARTIAL_FRAME 1 8		/* offset 8: return address */
	subq $REST_SKIP, %rsp
	CFI_ADJUST_CFA_OFFSET REST_SKIP
	call save_rest
	DEFAULT_FRAME 0 8		/* offset 8: return address */
	leaq 8(%rsp), \arg	/* pt_regs pointer */
	call \func
	jmp ptregscall_common
	CFI_ENDPROC
708
END(\label)
L
Linus Torvalds 已提交
709 710 711 712 713 714 715 716 717
	.endm

	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)
718 719 720 721 722 723 724 725 726
	DEFAULT_FRAME 1 8	/* offset 8: return address */
	RESTORE_TOP_OF_STACK %r11, 8
	movq_cfi_restore R15+8, r15
	movq_cfi_restore R14+8, r14
	movq_cfi_restore R13+8, r13
	movq_cfi_restore R12+8, r12
	movq_cfi_restore RBP+8, rbp
	movq_cfi_restore RBX+8, rbx
	ret $REST_SKIP		/* pop extended registers */
L
Linus Torvalds 已提交
727
	CFI_ENDPROC
728
END(ptregscall_common)
729

L
Linus Torvalds 已提交
730 731 732
ENTRY(stub_execve)
	CFI_STARTPROC
	popq %r11
733 734
	CFI_ADJUST_CFA_OFFSET -8
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
735 736
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
737
	movq %rsp, %rcx
L
Linus Torvalds 已提交
738 739 740 741 742 743
	call sys_execve
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
744
END(stub_execve)
745

L
Linus Torvalds 已提交
746 747 748
/*
 * 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.
749
 */
L
Linus Torvalds 已提交
750 751
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
752 753
	addq $8, %rsp
	CFI_ADJUST_CFA_OFFSET	-8
L
Linus Torvalds 已提交
754 755 756 757 758 759 760 761
	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
762
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
763

764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780
/*
 * Build the entry stubs and pointer table with some assembler magic.
 * We pack 7 stubs into a single 32-byte chunk, which will fit in a
 * single cache line on all modern x86 implementations.
 */
	.section .init.rodata,"a"
ENTRY(interrupt)
	.text
	.p2align 5
	.p2align CONFIG_X86_L1_CACHE_SHIFT
ENTRY(irq_entries_start)
	INTR_FRAME
vector=FIRST_EXTERNAL_VECTOR
.rept (NR_VECTORS-FIRST_EXTERNAL_VECTOR+6)/7
	.balign 32
  .rept	7
    .if vector < NR_VECTORS
781
      .if vector <> FIRST_EXTERNAL_VECTOR
782 783 784 785
	CFI_ADJUST_CFA_OFFSET -8
      .endif
1:	pushq $(~vector+0x80)	/* Note: always in signed byte range */
	CFI_ADJUST_CFA_OFFSET 8
786
      .if ((vector-FIRST_EXTERNAL_VECTOR)%7) <> 6
787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803
	jmp 2f
      .endif
      .previous
	.quad 1b
      .text
vector=vector+1
    .endif
  .endr
2:	jmp common_interrupt
.endr
	CFI_ENDPROC
END(irq_entries_start)

.previous
END(interrupt)
.previous

804
/*
L
Linus Torvalds 已提交
805 806 807
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
808 809 810
 *
 * Entry runs with interrupts off.
 */
L
Linus Torvalds 已提交
811

812
/* 0(%rsp): ~(interrupt number) */
L
Linus Torvalds 已提交
813
	.macro interrupt func
814 815 816
	subq $10*8, %rsp
	CFI_ADJUST_CFA_OFFSET 10*8
	call save_args
817
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
818 819 820
	call \func
	.endm

821 822 823 824
	/*
	 * The interrupt stubs push (~vector+0x80) onto the stack and
	 * then jump to common_interrupt.
	 */
825 826
	.p2align CONFIG_X86_L1_CACHE_SHIFT
common_interrupt:
827
	XCPT_FRAME
828
	addq $-0x80,(%rsp)		/* Adjust vector to [-256,-1] range */
L
Linus Torvalds 已提交
829
	interrupt do_IRQ
830
	/* 0(%rsp): old_rsp-ARGOFFSET */
831
ret_from_intr:
832
	DISABLE_INTERRUPTS(CLBR_NONE)
833
	TRACE_IRQS_OFF
834
	decl PER_CPU_VAR(irq_count)
835
	leaveq
836
	CFI_DEF_CFA_REGISTER	rsp
837
	CFI_ADJUST_CFA_OFFSET	-8
838
exit_intr:
L
Linus Torvalds 已提交
839 840 841
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
842

L
Linus Torvalds 已提交
843 844 845 846
	/* Interrupt came from user space */
	/*
	 * Has a correct top of stack, but a partial stack frame
	 * %rcx: thread info. Interrupts off.
847
	 */
L
Linus Torvalds 已提交
848 849
retint_with_reschedule:
	movl $_TIF_WORK_MASK,%edi
850
retint_check:
851
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
852
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
853
	andl %edi,%edx
854
	CFI_REMEMBER_STATE
L
Linus Torvalds 已提交
855
	jnz  retint_careful
856 857

retint_swapgs:		/* return to user-space */
858 859 860
	/*
	 * The iretq could re-enable interrupts:
	 */
861
	DISABLE_INTERRUPTS(CLBR_ANY)
862
	TRACE_IRQS_IRETQ
863
	SWAPGS
864 865
	jmp restore_args

866
retint_restore_args:	/* return to kernel space */
867
	DISABLE_INTERRUPTS(CLBR_ANY)
868 869 870 871 872
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
I
Ingo Molnar 已提交
873 874
	RESTORE_ARGS 0,8,0

A
Adrian Bunk 已提交
875
irq_return:
876
	INTERRUPT_RETURN
I
Ingo Molnar 已提交
877 878 879 880 881 882

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

#ifdef CONFIG_PARAVIRT
883
ENTRY(native_iret)
L
Linus Torvalds 已提交
884 885 886
	iretq

	.section __ex_table,"a"
887
	.quad native_iret, bad_iret
L
Linus Torvalds 已提交
888
	.previous
I
Ingo Molnar 已提交
889 890
#endif

L
Linus Torvalds 已提交
891 892
	.section .fixup,"ax"
bad_iret:
893 894 895 896 897 898 899 900 901 902 903 904 905 906 907
	/*
	 * 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

908 909
	.previous

910
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
911
retint_careful:
912
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
913 914
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
915
	TRACE_IRQS_ON
916
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
917
	pushq %rdi
918
	CFI_ADJUST_CFA_OFFSET	8
L
Linus Torvalds 已提交
919
	call  schedule
920
	popq %rdi
921
	CFI_ADJUST_CFA_OFFSET	-8
L
Linus Torvalds 已提交
922
	GET_THREAD_INFO(%rcx)
923
	DISABLE_INTERRUPTS(CLBR_NONE)
924
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
925
	jmp retint_check
926

L
Linus Torvalds 已提交
927
retint_signal:
P
Peter Zijlstra 已提交
928
	testl $_TIF_DO_NOTIFY_MASK,%edx
929
	jz    retint_swapgs
930
	TRACE_IRQS_ON
931
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
932
	SAVE_REST
933
	movq $-1,ORIG_RAX(%rsp)
934
	xorl %esi,%esi		# oldset
L
Linus Torvalds 已提交
935 936 937
	movq %rsp,%rdi		# &pt_regs
	call do_notify_resume
	RESTORE_REST
938
	DISABLE_INTERRUPTS(CLBR_NONE)
939
	TRACE_IRQS_OFF
940
	GET_THREAD_INFO(%rcx)
R
Roland McGrath 已提交
941
	jmp retint_with_reschedule
L
Linus Torvalds 已提交
942 943 944 945

#ifdef CONFIG_PREEMPT
	/* Returning to kernel space. Check if we need preemption */
	/* rcx:	 threadinfo. interrupts off. */
946
ENTRY(retint_kernel)
G
Glauber Costa 已提交
947
	cmpl $0,TI_preempt_count(%rcx)
L
Linus Torvalds 已提交
948
	jnz  retint_restore_args
G
Glauber Costa 已提交
949
	bt  $TIF_NEED_RESCHED,TI_flags(%rcx)
L
Linus Torvalds 已提交
950 951 952 953 954
	jnc  retint_restore_args
	bt   $9,EFLAGS-ARGOFFSET(%rsp)	/* interrupts off? */
	jnc  retint_restore_args
	call preempt_schedule_irq
	jmp exit_intr
955
#endif
956

L
Linus Torvalds 已提交
957
	CFI_ENDPROC
958
END(common_interrupt)
959

L
Linus Torvalds 已提交
960 961
/*
 * APIC interrupts.
962
 */
963 964
.macro apicinterrupt num sym do_sym
ENTRY(\sym)
965
	INTR_FRAME
966
	pushq $~(\num)
967
	CFI_ADJUST_CFA_OFFSET 8
968
	interrupt \do_sym
L
Linus Torvalds 已提交
969 970
	jmp ret_from_intr
	CFI_ENDPROC
971 972
END(\sym)
.endm
L
Linus Torvalds 已提交
973

974 975 976 977
#ifdef CONFIG_SMP
apicinterrupt IRQ_MOVE_CLEANUP_VECTOR \
	irq_move_cleanup_interrupt smp_irq_move_cleanup_interrupt
#endif
L
Linus Torvalds 已提交
978

N
Nick Piggin 已提交
979
#ifdef CONFIG_X86_UV
980
apicinterrupt UV_BAU_MESSAGE \
981
	uv_bau_message_intr1 uv_bau_message_interrupt
N
Nick Piggin 已提交
982
#endif
983 984
apicinterrupt LOCAL_TIMER_VECTOR \
	apic_timer_interrupt smp_apic_timer_interrupt
985 986
apicinterrupt GENERIC_INTERRUPT_VECTOR \
	generic_interrupt smp_generic_interrupt
987

988
#ifdef CONFIG_SMP
989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
apicinterrupt INVALIDATE_TLB_VECTOR_START+0 \
	invalidate_interrupt0 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+1 \
	invalidate_interrupt1 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+2 \
	invalidate_interrupt2 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+3 \
	invalidate_interrupt3 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+4 \
	invalidate_interrupt4 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+5 \
	invalidate_interrupt5 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+6 \
	invalidate_interrupt6 smp_invalidate_interrupt
apicinterrupt INVALIDATE_TLB_VECTOR_START+7 \
	invalidate_interrupt7 smp_invalidate_interrupt
L
Linus Torvalds 已提交
1005 1006
#endif

1007 1008 1009 1010
apicinterrupt THRESHOLD_APIC_VECTOR \
	threshold_interrupt mce_threshold_interrupt
apicinterrupt THERMAL_APIC_VECTOR \
	thermal_interrupt smp_thermal_interrupt
1011

1012 1013 1014 1015 1016 1017 1018 1019
#ifdef CONFIG_SMP
apicinterrupt CALL_FUNCTION_SINGLE_VECTOR \
	call_function_single_interrupt smp_call_function_single_interrupt
apicinterrupt CALL_FUNCTION_VECTOR \
	call_function_interrupt smp_call_function_interrupt
apicinterrupt RESCHEDULE_VECTOR \
	reschedule_interrupt smp_reschedule_interrupt
#endif
L
Linus Torvalds 已提交
1020

1021 1022 1023 1024
apicinterrupt ERROR_APIC_VECTOR \
	error_interrupt smp_error_interrupt
apicinterrupt SPURIOUS_APIC_VECTOR \
	spurious_interrupt smp_spurious_interrupt
1025

L
Linus Torvalds 已提交
1026 1027
/*
 * Exception entry points.
1028
 */
1029 1030
.macro zeroentry sym do_sym
ENTRY(\sym)
1031
	INTR_FRAME
1032
	PARAVIRT_ADJUST_EXCEPTION_FRAME
I
Ingo Molnar 已提交
1033
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1034 1035 1036
	subq $15*8,%rsp
	CFI_ADJUST_CFA_OFFSET 15*8
	call error_entry
1037
	DEFAULT_FRAME 0
1038 1039
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1040
	call \do_sym
1041
	jmp error_exit		/* %ebx: no swapgs flag */
1042
	CFI_ENDPROC
1043 1044
END(\sym)
.endm
L
Linus Torvalds 已提交
1045

1046
.macro paranoidzeroentry sym do_sym
1047
ENTRY(\sym)
1048 1049 1050 1051 1052 1053 1054 1055 1056
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
	pushq $-1		/* ORIG_RAX: no syscall to restart */
	CFI_ADJUST_CFA_OFFSET 8
	subq $15*8, %rsp
	call save_paranoid
	TRACE_IRQS_OFF
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1057
	call \do_sym
1058 1059
	jmp paranoid_exit	/* %ebx: no swapgs flag */
	CFI_ENDPROC
1060
END(\sym)
1061
.endm
1062

1063
.macro paranoidzeroentry_ist sym do_sym ist
1064
ENTRY(\sym)
1065
	INTR_FRAME
1066 1067 1068 1069 1070 1071 1072 1073
	PARAVIRT_ADJUST_EXCEPTION_FRAME
	pushq $-1		/* ORIG_RAX: no syscall to restart */
	CFI_ADJUST_CFA_OFFSET 8
	subq $15*8, %rsp
	call save_paranoid
	TRACE_IRQS_OFF
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1074 1075
	PER_CPU(init_tss, %rbp)
	subq $EXCEPTION_STKSZ, TSS_ist + (\ist - 1) * 8(%rbp)
1076
	call \do_sym
1077
	addq $EXCEPTION_STKSZ, TSS_ist + (\ist - 1) * 8(%rbp)
1078 1079
	jmp paranoid_exit	/* %ebx: no swapgs flag */
	CFI_ENDPROC
1080
END(\sym)
1081
.endm
1082

1083
.macro errorentry sym do_sym
1084
ENTRY(\sym)
1085
	XCPT_FRAME
1086
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1087 1088 1089
	subq $15*8,%rsp
	CFI_ADJUST_CFA_OFFSET 15*8
	call error_entry
1090
	DEFAULT_FRAME 0
1091 1092 1093
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1094
	call \do_sym
1095
	jmp error_exit			/* %ebx: no swapgs flag */
1096
	CFI_ENDPROC
1097 1098
END(\sym)
.endm
L
Linus Torvalds 已提交
1099 1100

	/* error code is on the stack already */
1101
.macro paranoiderrorentry sym do_sym
1102
ENTRY(\sym)
1103 1104 1105
	XCPT_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
	subq $15*8,%rsp
1106 1107 1108
	CFI_ADJUST_CFA_OFFSET 15*8
	call save_paranoid
	DEFAULT_FRAME 0
1109
	TRACE_IRQS_OFF
1110 1111 1112
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1113
	call \do_sym
1114 1115
	jmp paranoid_exit		/* %ebx: no swapgs flag */
	CFI_ENDPROC
1116 1117 1118 1119 1120 1121 1122 1123
END(\sym)
.endm

zeroentry divide_error do_divide_error
zeroentry overflow do_overflow
zeroentry bounds do_bounds
zeroentry invalid_op do_invalid_op
zeroentry device_not_available do_device_not_available
1124
paranoiderrorentry double_fault do_double_fault
1125 1126 1127 1128 1129 1130 1131
zeroentry coprocessor_segment_overrun do_coprocessor_segment_overrun
errorentry invalid_TSS do_invalid_TSS
errorentry segment_not_present do_segment_not_present
zeroentry spurious_interrupt_bug do_spurious_interrupt_bug
zeroentry coprocessor_error do_coprocessor_error
errorentry alignment_check do_alignment_check
zeroentry simd_coprocessor_error do_simd_coprocessor_error
1132

1133 1134
	/* Reload gs selector with exception handling */
	/* edi:  new selector */
1135
ENTRY(native_load_gs_index)
1136
	CFI_STARTPROC
L
Linus Torvalds 已提交
1137
	pushf
1138
	CFI_ADJUST_CFA_OFFSET 8
1139
	DISABLE_INTERRUPTS(CLBR_ANY & ~CLBR_RDI)
1140
	SWAPGS
1141
gs_change:
1142
	movl %edi,%gs
L
Linus Torvalds 已提交
1143
2:	mfence		/* workaround */
1144
	SWAPGS
1145
	popf
1146
	CFI_ADJUST_CFA_OFFSET -8
1147
	ret
1148
	CFI_ENDPROC
1149
END(native_load_gs_index)
1150

1151 1152 1153 1154 1155
	.section __ex_table,"a"
	.align 8
	.quad gs_change,bad_gs
	.previous
	.section .fixup,"ax"
L
Linus Torvalds 已提交
1156
	/* running with kernelgs */
1157
bad_gs:
1158
	SWAPGS			/* switch back to user gs */
L
Linus Torvalds 已提交
1159
	xorl %eax,%eax
1160 1161 1162
	movl %eax,%gs
	jmp  2b
	.previous
1163

L
Linus Torvalds 已提交
1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185
/*
 * 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
1186

L
Linus Torvalds 已提交
1187 1188 1189 1190 1191 1192 1193 1194 1195 1196
	# 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.
1197
	 * [Hopefully no generic code relies on the reschedule -AK]
L
Linus Torvalds 已提交
1198 1199 1200 1201 1202
	 */
	RESTORE_ALL
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1203
END(kernel_thread)
1204

1205
ENTRY(child_rip)
1206 1207
	pushq $0		# fake return address
	CFI_STARTPROC
L
Linus Torvalds 已提交
1208 1209 1210 1211 1212 1213 1214 1215
	/*
	 * 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
1216
	mov %eax, %edi
L
Linus Torvalds 已提交
1217
	call do_exit
1218
	ud2			# padding for call trace
1219
	CFI_ENDPROC
1220
END(child_rip)
L
Linus Torvalds 已提交
1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231

/*
 * 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:
1232
 *	extern long sys_execve(char *name, char **argv,char **envp, struct pt_regs *regs)
L
Linus Torvalds 已提交
1233 1234
 *
 * do_sys_execve asm fallback arguments:
1235
 *	rdi: name, rsi: argv, rdx: envp, rcx: fake frame on the stack
L
Linus Torvalds 已提交
1236
 */
1237
ENTRY(kernel_execve)
L
Linus Torvalds 已提交
1238 1239
	CFI_STARTPROC
	FAKE_STACK_FRAME $0
1240
	SAVE_ALL
1241
	movq %rsp,%rcx
L
Linus Torvalds 已提交
1242
	call sys_execve
1243
	movq %rax, RAX(%rsp)
L
Linus Torvalds 已提交
1244 1245 1246 1247 1248 1249 1250
	RESTORE_REST
	testq %rax,%rax
	je int_ret_from_sys_call
	RESTORE_ARGS
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1251
END(kernel_execve)
L
Linus Torvalds 已提交
1252

1253
/* Call softirq on interrupt stack. Interrupts are off. */
1254
ENTRY(call_softirq)
1255
	CFI_STARTPROC
1256 1257 1258 1259 1260
	push %rbp
	CFI_ADJUST_CFA_OFFSET	8
	CFI_REL_OFFSET rbp,0
	mov  %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1261
	incl PER_CPU_VAR(irq_count)
1262
	cmove PER_CPU_VAR(irq_stack_ptr),%rsp
1263
	push  %rbp			# backlink for old unwinder
1264
	call __do_softirq
1265
	leaveq
1266
	CFI_DEF_CFA_REGISTER	rsp
1267
	CFI_ADJUST_CFA_OFFSET   -8
1268
	decl PER_CPU_VAR(irq_count)
1269
	ret
1270
	CFI_ENDPROC
1271
END(call_softirq)
1272

1273
#ifdef CONFIG_XEN
1274
zeroentry xen_hypervisor_callback xen_do_hypervisor_callback
1275 1276

/*
1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288
 * 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.
 */
1289 1290
ENTRY(xen_do_hypervisor_callback)   # do_hypervisor_callback(struct *pt_regs)
	CFI_STARTPROC
1291 1292 1293 1294
/*
 * Since we don't modify %rdi, evtchn_do_upall(struct *pt_regs) will
 * see the correct pointer to the pt_regs
 */
1295 1296
	movq %rdi, %rsp            # we don't return, adjust the stack frame
	CFI_ENDPROC
1297
	DEFAULT_FRAME
1298
11:	incl PER_CPU_VAR(irq_count)
1299 1300
	movq %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1301
	cmovzq PER_CPU_VAR(irq_stack_ptr),%rsp
1302 1303 1304 1305
	pushq %rbp			# backlink for old unwinder
	call xen_evtchn_do_upcall
	popq %rsp
	CFI_DEF_CFA_REGISTER rsp
1306
	decl PER_CPU_VAR(irq_count)
1307 1308 1309 1310 1311
	jmp  error_exit
	CFI_ENDPROC
END(do_hypervisor_callback)

/*
1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323
 * 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.
 */
1324
ENTRY(xen_failsafe_callback)
1325 1326 1327 1328 1329 1330 1331
	INTR_FRAME 1 (6*8)
	/*CFI_REL_OFFSET gs,GS*/
	/*CFI_REL_OFFSET fs,FS*/
	/*CFI_REL_OFFSET es,ES*/
	/*CFI_REL_OFFSET ds,DS*/
	CFI_REL_OFFSET r11,8
	CFI_REL_OFFSET rcx,0
1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351
	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
I
Ingo Molnar 已提交
1352 1353 1354
	pushq_cfi $0	/* RIP */
	pushq_cfi %r11
	pushq_cfi %rcx
1355
	jmp general_protection
1356 1357 1358 1359 1360 1361 1362 1363
	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
I
Ingo Molnar 已提交
1364
	pushq_cfi $0
1365 1366 1367 1368 1369 1370
	SAVE_ALL
	jmp error_exit
	CFI_ENDPROC
END(xen_failsafe_callback)

#endif /* CONFIG_XEN */
1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386

/*
 * Some functions should be protected against kprobes
 */
	.pushsection .kprobes.text, "ax"

paranoidzeroentry_ist debug do_debug DEBUG_STACK
paranoidzeroentry_ist int3 do_int3 DEBUG_STACK
paranoiderrorentry stack_segment do_stack_segment
errorentry general_protection do_general_protection
errorentry page_fault do_page_fault
#ifdef CONFIG_X86_MCE
paranoidzeroentry machine_check do_machine_check
#endif

	/*
1387 1388
	 * "Paranoid" exit path from exception stack.
	 * Paranoid because this is used by NMIs and cannot take
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492
	 * 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)
	 */

	/* ebx:	no swapgs flag */
ENTRY(paranoid_exit)
	INTR_FRAME
	DISABLE_INTERRUPTS(CLBR_NONE)
	TRACE_IRQS_OFF
	testl %ebx,%ebx				/* swapgs needed? */
	jnz paranoid_restore
	testl $3,CS(%rsp)
	jnz   paranoid_userspace
paranoid_swapgs:
	TRACE_IRQS_IRETQ 0
	SWAPGS_UNSAFE_STACK
paranoid_restore:
	RESTORE_ALL 8
	jmp irq_return
paranoid_userspace:
	GET_THREAD_INFO(%rcx)
	movl TI_flags(%rcx),%ebx
	andl $_TIF_WORK_MASK,%ebx
	jz paranoid_swapgs
	movq %rsp,%rdi			/* &pt_regs */
	call sync_regs
	movq %rax,%rsp			/* switch stack for scheduling */
	testl $_TIF_NEED_RESCHED,%ebx
	jnz paranoid_schedule
	movl %ebx,%edx			/* arg3: thread flags */
	TRACE_IRQS_ON
	ENABLE_INTERRUPTS(CLBR_NONE)
	xorl %esi,%esi 			/* arg2: oldset */
	movq %rsp,%rdi 			/* arg1: &pt_regs */
	call do_notify_resume
	DISABLE_INTERRUPTS(CLBR_NONE)
	TRACE_IRQS_OFF
	jmp paranoid_userspace
paranoid_schedule:
	TRACE_IRQS_ON
	ENABLE_INTERRUPTS(CLBR_ANY)
	call schedule
	DISABLE_INTERRUPTS(CLBR_ANY)
	TRACE_IRQS_OFF
	jmp paranoid_userspace
	CFI_ENDPROC
END(paranoid_exit)

/*
 * Exception entry point. This expects an error code/orig_rax on the stack.
 * returns in "no swapgs flag" in %ebx.
 */
ENTRY(error_entry)
	XCPT_FRAME
	CFI_ADJUST_CFA_OFFSET 15*8
	/* oldrax contains error code */
	cld
	movq_cfi rdi, RDI+8
	movq_cfi rsi, RSI+8
	movq_cfi rdx, RDX+8
	movq_cfi rcx, RCX+8
	movq_cfi rax, RAX+8
	movq_cfi  r8,  R8+8
	movq_cfi  r9,  R9+8
	movq_cfi r10, R10+8
	movq_cfi r11, R11+8
	movq_cfi rbx, RBX+8
	movq_cfi rbp, RBP+8
	movq_cfi r12, R12+8
	movq_cfi r13, R13+8
	movq_cfi r14, R14+8
	movq_cfi r15, R15+8
	xorl %ebx,%ebx
	testl $3,CS+8(%rsp)
	je error_kernelspace
error_swapgs:
	SWAPGS
error_sti:
	TRACE_IRQS_OFF
	ret
	CFI_ENDPROC

/*
 * 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.
 */
error_kernelspace:
	incl %ebx
	leaq irq_return(%rip),%rcx
	cmpq %rcx,RIP+8(%rsp)
	je error_swapgs
	movl %ecx,%ecx	/* zero extend */
	cmpq %rcx,RIP+8(%rsp)
	je error_swapgs
	cmpq $gs_change,RIP+8(%rsp)
1493
	je error_swapgs
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568
	jmp error_sti
END(error_entry)


/* ebx:	no swapgs flag (1: don't need swapgs, 0: need it) */
ENTRY(error_exit)
	DEFAULT_FRAME
	movl %ebx,%eax
	RESTORE_REST
	DISABLE_INTERRUPTS(CLBR_NONE)
	TRACE_IRQS_OFF
	GET_THREAD_INFO(%rcx)
	testl %eax,%eax
	jne retint_kernel
	LOCKDEP_SYS_EXIT_IRQ
	movl TI_flags(%rcx),%edx
	movl $_TIF_WORK_MASK,%edi
	andl %edi,%edx
	jnz retint_careful
	jmp retint_swapgs
	CFI_ENDPROC
END(error_exit)


	/* runs on exception stack */
ENTRY(nmi)
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
	pushq_cfi $-1
	subq $15*8, %rsp
	CFI_ADJUST_CFA_OFFSET 15*8
	call save_paranoid
	DEFAULT_FRAME 0
	/* paranoidentry do_nmi, 0; without TRACE_IRQS_OFF */
	movq %rsp,%rdi
	movq $-1,%rsi
	call do_nmi
#ifdef CONFIG_TRACE_IRQFLAGS
	/* paranoidexit; without TRACE_IRQS_OFF */
	/* ebx:	no swapgs flag */
	DISABLE_INTERRUPTS(CLBR_NONE)
	testl %ebx,%ebx				/* swapgs needed? */
	jnz nmi_restore
	testl $3,CS(%rsp)
	jnz nmi_userspace
nmi_swapgs:
	SWAPGS_UNSAFE_STACK
nmi_restore:
	RESTORE_ALL 8
	jmp irq_return
nmi_userspace:
	GET_THREAD_INFO(%rcx)
	movl TI_flags(%rcx),%ebx
	andl $_TIF_WORK_MASK,%ebx
	jz nmi_swapgs
	movq %rsp,%rdi			/* &pt_regs */
	call sync_regs
	movq %rax,%rsp			/* switch stack for scheduling */
	testl $_TIF_NEED_RESCHED,%ebx
	jnz nmi_schedule
	movl %ebx,%edx			/* arg3: thread flags */
	ENABLE_INTERRUPTS(CLBR_NONE)
	xorl %esi,%esi 			/* arg2: oldset */
	movq %rsp,%rdi 			/* arg1: &pt_regs */
	call do_notify_resume
	DISABLE_INTERRUPTS(CLBR_NONE)
	jmp nmi_userspace
nmi_schedule:
	ENABLE_INTERRUPTS(CLBR_ANY)
	call schedule
	DISABLE_INTERRUPTS(CLBR_ANY)
	jmp nmi_userspace
	CFI_ENDPROC
#else
	jmp paranoid_exit
1569
	CFI_ENDPROC
1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583
#endif
END(nmi)

ENTRY(ignore_sysret)
	CFI_STARTPROC
	mov $-ENOSYS,%eax
	sysret
	CFI_ENDPROC
END(ignore_sysret)

/*
 * End of kprobes section
 */
	.popsection