entry_64.S 36.0 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.h>
52
#include <asm/irqflags.h>
53
#include <asm/paravirt.h>
54
#include <asm/ftrace.h>
L
Linus Torvalds 已提交
55

R
Roland McGrath 已提交
56 57 58 59 60 61
/* 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 已提交
62
	.code64
63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
/*
 * Some macro's to hide the most frequently occuring CFI annotations.
 */
	.macro CFI_PUSHQ reg
	pushq \reg
	CFI_ADJUST_CFA_OFFSET 8
	.endm

	.macro CFI_POPQ reg
	popq \reg
	CFI_ADJUST_CFA_OFFSET -8
	.endm

	.macro CFI_MOVQ reg offset=0
	movq %\reg, \offset(%rsp)
	CFI_REL_OFFSET \reg, \offset
	.endm
L
Linus Torvalds 已提交
80

81
#ifdef CONFIG_FUNCTION_TRACER
82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100
#ifdef CONFIG_DYNAMIC_FTRACE
ENTRY(mcount)
	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
101
	subq $MCOUNT_INSN_SIZE, %rdi
102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121

.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 */
122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
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
142
	subq $MCOUNT_INSN_SIZE, %rdi
143 144 145 146 147 148 149 150 151 152 153 154 155 156

	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)
157
#endif /* CONFIG_DYNAMIC_FTRACE */
158
#endif /* CONFIG_FUNCTION_TRACER */
159

160
#ifndef CONFIG_PREEMPT
L
Linus Torvalds 已提交
161
#define retint_kernel retint_restore_args
162
#endif
163

164
#ifdef CONFIG_PARAVIRT
165
ENTRY(native_usergs_sysret64)
166 167 168 169
	swapgs
	sysretq
#endif /* CONFIG_PARAVIRT */

170 171 172 173 174 175 176 177 178 179

.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 已提交
180
/*
181 182
 * 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 已提交
183 184 185
 * fast path FIXUP_TOP_OF_STACK is needed.
 * RESTORE_TOP_OF_STACK syncs the syscall state after any possible ptregs
 * manipulation.
186 187 188
 */

	/* %rsp:at FRAMEEND */
L
Linus Torvalds 已提交
189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207
	.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 */
208
	xorl %eax, %eax
209
	pushq $__KERNEL_DS /* ss */
L
Linus Torvalds 已提交
210
	CFI_ADJUST_CFA_OFFSET	8
211
	/*CFI_REL_OFFSET	ss,0*/
L
Linus Torvalds 已提交
212 213
	pushq %rax /* rsp */
	CFI_ADJUST_CFA_OFFSET	8
214
	CFI_REL_OFFSET	rsp,0
L
Linus Torvalds 已提交
215 216
	pushq $(1<<9) /* eflags - interrupts on */
	CFI_ADJUST_CFA_OFFSET	8
217
	/*CFI_REL_OFFSET	rflags,0*/
L
Linus Torvalds 已提交
218 219
	pushq $__KERNEL_CS /* cs */
	CFI_ADJUST_CFA_OFFSET	8
220
	/*CFI_REL_OFFSET	cs,0*/
L
Linus Torvalds 已提交
221 222
	pushq \child_rip /* rip */
	CFI_ADJUST_CFA_OFFSET	8
223
	CFI_REL_OFFSET	rip,0
L
Linus Torvalds 已提交
224 225 226 227 228 229 230 231 232
	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

233 234 235 236
/*
 * initial frame state for interrupts (and exceptions without error code)
 */
	.macro EMPTY_FRAME start=1 offset=0
237
	.if \start
238
	CFI_STARTPROC simple
239
	CFI_SIGNAL_FRAME
240
	CFI_DEF_CFA rsp,8+\offset
241
	.else
242
	CFI_DEF_CFA_OFFSET 8+\offset
243
	.endif
L
Linus Torvalds 已提交
244
	.endm
245 246

/*
247
 * initial frame state for interrupts (and exceptions without error code)
248
 */
249
	.macro INTR_FRAME start=1 offset=0
250 251 252 253 254 255
	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
256 257 258 259 260 261
	.endm

/*
 * initial frame state for exceptions with error code (and interrupts
 * with vector already pushed)
 */
262
	.macro XCPT_FRAME start=1 offset=0
263
	INTR_FRAME \start, RIP+\offset-ORIG_RAX
264 265 266 267 268 269 270
	/*CFI_REL_OFFSET orig_rax, ORIG_RAX-ORIG_RAX*/
	.endm

/*
 * frame that enables calling into C.
 */
	.macro PARTIAL_FRAME start=1 offset=0
271 272 273 274 275 276 277 278 279 280
	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
281 282 283 284 285 286
	.endm

/*
 * frame that enables passing a complete pt_regs to a C function.
 */
	.macro DEFAULT_FRAME start=1 offset=0
287
	PARTIAL_FRAME \start, R11+\offset-R15
288 289 290 291 292 293 294
	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
295 296 297 298 299

/* save partial stack frame */
ENTRY(save_args)
	XCPT_FRAME
	cld
300 301 302 303 304 305 306 307 308
	CFI_MOVQ rdi, RDI+16-ARGOFFSET
	CFI_MOVQ rsi, RSI+16-ARGOFFSET
	CFI_MOVQ rdx, RDX+16-ARGOFFSET
	CFI_MOVQ rcx, RCX+16-ARGOFFSET
	CFI_MOVQ rax, RAX+16-ARGOFFSET
	CFI_MOVQ r8, R8+16-ARGOFFSET
	CFI_MOVQ r9, R9+16-ARGOFFSET
	CFI_MOVQ r10, R10+16-ARGOFFSET
	CFI_MOVQ r11, R11+16-ARGOFFSET
309
	leaq -ARGOFFSET+16(%rsp),%rdi	/* arg1 for handler */
310
	CFI_MOVQ rbp, 8		/* push %rbp */
311 312 313 314 315 316 317 318 319 320 321 322
	leaq 8(%rsp), %rbp		/* mov %rsp, %ebp */
	testl $3, CS(%rdi)
	je 1f
	SWAPGS
	/*
	 * 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
	jne 2f
323
	CFI_POPQ %rax			/* move return address... */
324
	mov %gs:pda_irqstackptr,%rsp
325 326
	EMPTY_FRAME 0
	CFI_PUSHQ %rax			/* ... to the new stack */
327 328 329 330 331 332 333 334
	/*
	 * We entered an interrupt context - irqs are off:
	 */
2:	TRACE_IRQS_OFF
	ret
	CFI_ENDPROC
END(save_args)

L
Linus Torvalds 已提交
335 336
/*
 * A newly forked process directly context switches into this.
337 338
 */
/* rdi:	prev */
L
Linus Torvalds 已提交
339
ENTRY(ret_from_fork)
340
	DEFAULT_FRAME
341
	push kernel_eflags(%rip)
342
	CFI_ADJUST_CFA_OFFSET 8
343
	popf				# reset kernel eflags
344
	CFI_ADJUST_CFA_OFFSET -8
L
Linus Torvalds 已提交
345 346
	call schedule_tail
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
347
	testl $(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT),TI_flags(%rcx)
L
Linus Torvalds 已提交
348
	jnz rff_trace
349
rff_action:
L
Linus Torvalds 已提交
350 351 352
	RESTORE_REST
	testl $3,CS-ARGOFFSET(%rsp)	# from kernel_thread?
	je   int_ret_from_sys_call
G
Glauber Costa 已提交
353
	testl $_TIF_IA32,TI_flags(%rcx)
L
Linus Torvalds 已提交
354 355 356 357 358 359
	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
360
	GET_THREAD_INFO(%rcx)
L
Linus Torvalds 已提交
361 362
	jmp rff_action
	CFI_ENDPROC
363
END(ret_from_fork)
L
Linus Torvalds 已提交
364 365 366 367 368 369 370

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

L
Linus Torvalds 已提交
372
/*
373
 * Register setup:
L
Linus Torvalds 已提交
374 375
 * rax  system call number
 * rdi  arg0
376
 * rcx  return address for syscall/sysret, C arg3
L
Linus Torvalds 已提交
377
 * rsi  arg1
378
 * rdx  arg2
L
Linus Torvalds 已提交
379 380 381 382
 * r10  arg3 	(--> moved to rcx for C)
 * r8   arg4
 * r9   arg5
 * r11  eflags for syscall/sysret, temporary for C
383 384
 * r12-r15,rbp,rbx saved by C code, not touched.
 *
L
Linus Torvalds 已提交
385 386 387 388 389
 * 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.
390 391 392 393
 *
 * 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.
394
 */
L
Linus Torvalds 已提交
395 396

ENTRY(system_call)
397
	CFI_STARTPROC	simple
398
	CFI_SIGNAL_FRAME
399
	CFI_DEF_CFA	rsp,PDA_STACKOFFSET
400 401
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
402 403 404 405 406 407 408 409
	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)

410
	movq	%rsp,%gs:pda_oldrsp
L
Linus Torvalds 已提交
411
	movq	%gs:pda_kernelstack,%rsp
412 413 414 415
	/*
	 * No need to follow this irqs off/on section - it's straight
	 * and short:
	 */
416
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
417
	SAVE_ARGS 8,1
418
	movq  %rax,ORIG_RAX-ARGOFFSET(%rsp)
419 420
	movq  %rcx,RIP-ARGOFFSET(%rsp)
	CFI_REL_OFFSET rip,RIP-ARGOFFSET
L
Linus Torvalds 已提交
421
	GET_THREAD_INFO(%rcx)
422
	testl $_TIF_WORK_SYSCALL_ENTRY,TI_flags(%rcx)
L
Linus Torvalds 已提交
423
	jnz tracesys
R
Roland McGrath 已提交
424
system_call_fastpath:
L
Linus Torvalds 已提交
425 426 427 428 429 430 431
	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)
432 433
 * Has incomplete stack frame and undefined top of stack.
 */
L
Linus Torvalds 已提交
434
ret_from_sys_call:
435
	movl $_TIF_ALLWORK_MASK,%edi
L
Linus Torvalds 已提交
436
	/* edi:	flagmask */
437
sysret_check:
438
	LOCKDEP_SYS_EXIT
L
Linus Torvalds 已提交
439
	GET_THREAD_INFO(%rcx)
440
	DISABLE_INTERRUPTS(CLBR_NONE)
441
	TRACE_IRQS_OFF
G
Glauber Costa 已提交
442
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
443
	andl %edi,%edx
444
	jnz  sysret_careful
445
	CFI_REMEMBER_STATE
446 447 448 449
	/*
	 * sysretq will re-enable interrupts:
	 */
	TRACE_IRQS_ON
L
Linus Torvalds 已提交
450
	movq RIP-ARGOFFSET(%rsp),%rcx
451
	CFI_REGISTER	rip,rcx
L
Linus Torvalds 已提交
452
	RESTORE_ARGS 0,-ARG_SKIP,1
453
	/*CFI_REGISTER	rflags,r11*/
454
	movq	%gs:pda_oldrsp, %rsp
455
	USERGS_SYSRET64
L
Linus Torvalds 已提交
456

457
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
458
	/* Handle reschedules */
459
	/* edx:	work, edi: workmask */
L
Linus Torvalds 已提交
460 461 462
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
463
	TRACE_IRQS_ON
464
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
465
	pushq %rdi
466
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
467 468
	call schedule
	popq  %rdi
469
	CFI_ADJUST_CFA_OFFSET -8
L
Linus Torvalds 已提交
470 471
	jmp sysret_check

472
	/* Handle a signal */
L
Linus Torvalds 已提交
473
sysret_signal:
474
	TRACE_IRQS_ON
475
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
476 477 478 479
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
480
	/* edx:	work flags (arg3) */
L
Linus Torvalds 已提交
481 482 483 484
	leaq do_notify_resume(%rip),%rax
	leaq -ARGOFFSET(%rsp),%rdi # &pt_regs -> arg1
	xorl %esi,%esi # oldset -> arg2
	call ptregscall_common
485
	movl $_TIF_WORK_MASK,%edi
486 487
	/* Use IRET because user could have changed frame. This
	   works because ptregscall_common has called FIXUP_TOP_OF_STACK. */
488
	DISABLE_INTERRUPTS(CLBR_NONE)
489
	TRACE_IRQS_OFF
490
	jmp int_with_check
491

492 493 494 495
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

R
Roland McGrath 已提交
496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
#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 已提交
529
	/* Do syscall tracing */
530
tracesys:
R
Roland McGrath 已提交
531 532 533 534
#ifdef CONFIG_AUDITSYSCALL
	testl $(_TIF_WORK_SYSCALL_ENTRY & ~_TIF_SYSCALL_AUDIT),TI_flags(%rcx)
	jz auditsys
#endif
L
Linus Torvalds 已提交
535
	SAVE_REST
R
Roland McGrath 已提交
536
	movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
L
Linus Torvalds 已提交
537 538 539
	FIXUP_TOP_OF_STACK %rdi
	movq %rsp,%rdi
	call syscall_trace_enter
540 541 542 543 544 545
	/*
	 * 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 已提交
546 547
	RESTORE_REST
	cmpq $__NR_syscall_max,%rax
R
Roland McGrath 已提交
548
	ja   int_ret_from_sys_call	/* RAX(%rsp) set to -ENOSYS above */
L
Linus Torvalds 已提交
549 550
	movq %r10,%rcx	/* fixup for C */
	call *sys_call_table(,%rax,8)
R
Roland McGrath 已提交
551
	movq %rax,RAX-ARGOFFSET(%rsp)
552
	/* Use IRET because user could have changed frame */
553 554

/*
L
Linus Torvalds 已提交
555 556
 * Syscall return path ending with IRET.
 * Has correct top of stack, but partial stack frame.
557 558
 */
	.globl int_ret_from_sys_call
559
	.globl int_with_check
560
int_ret_from_sys_call:
561
	DISABLE_INTERRUPTS(CLBR_NONE)
562
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
563 564 565 566 567
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_restore_args
	movl $_TIF_ALLWORK_MASK,%edi
	/* edi:	mask to check */
int_with_check:
568
	LOCKDEP_SYS_EXIT_IRQ
L
Linus Torvalds 已提交
569
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
570
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
571 572
	andl %edi,%edx
	jnz   int_careful
G
Glauber Costa 已提交
573
	andl    $~TS_COMPAT,TI_status(%rcx)
L
Linus Torvalds 已提交
574 575 576 577 578 579 580 581
	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
582
	TRACE_IRQS_ON
583
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
584
	pushq %rdi
585
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
586 587
	call schedule
	popq %rdi
588
	CFI_ADJUST_CFA_OFFSET -8
589
	DISABLE_INTERRUPTS(CLBR_NONE)
590
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
591 592 593 594
	jmp int_with_check

	/* handle signals and tracing -- both require a full stack frame */
int_very_careful:
595
	TRACE_IRQS_ON
596
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
597
	SAVE_REST
598
	/* Check for syscall exit trace */
599
	testl $_TIF_WORK_SYSCALL_EXIT,%edx
L
Linus Torvalds 已提交
600 601
	jz int_signal
	pushq %rdi
602
	CFI_ADJUST_CFA_OFFSET 8
603
	leaq 8(%rsp),%rdi	# &ptregs -> arg1
L
Linus Torvalds 已提交
604 605
	call syscall_trace_leave
	popq %rdi
606
	CFI_ADJUST_CFA_OFFSET -8
607
	andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
L
Linus Torvalds 已提交
608
	jmp int_restore_rest
609

L
Linus Torvalds 已提交
610
int_signal:
P
Peter Zijlstra 已提交
611
	testl $_TIF_DO_NOTIFY_MASK,%edx
L
Linus Torvalds 已提交
612 613 614 615
	jz 1f
	movq %rsp,%rdi		# &ptregs -> arg1
	xorl %esi,%esi		# oldset -> arg2
	call do_notify_resume
R
Roland McGrath 已提交
616
1:	movl $_TIF_WORK_MASK,%edi
L
Linus Torvalds 已提交
617 618
int_restore_rest:
	RESTORE_REST
619
	DISABLE_INTERRUPTS(CLBR_NONE)
620
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
621 622
	jmp int_with_check
	CFI_ENDPROC
623
END(system_call)
624 625

/*
L
Linus Torvalds 已提交
626
 * Certain special system calls that need to save a complete full stack frame.
627 628
 */

L
Linus Torvalds 已提交
629 630 631 632 633 634
	.macro PTREGSCALL label,func,arg
	.globl \label
\label:
	leaq	\func(%rip),%rax
	leaq    -ARGOFFSET+8(%rsp),\arg /* 8 for return address */
	jmp	ptregscall_common
635
END(\label)
L
Linus Torvalds 已提交
636 637
	.endm

638 639
	CFI_STARTPROC

L
Linus Torvalds 已提交
640 641 642 643 644 645 646 647
	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
648 649
	CFI_ADJUST_CFA_OFFSET -8
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
650 651
	SAVE_REST
	movq %r11, %r15
652
	CFI_REGISTER rip, r15
L
Linus Torvalds 已提交
653 654 655 656
	FIXUP_TOP_OF_STACK %r11
	call *%rax
	RESTORE_TOP_OF_STACK %r11
	movq %r15, %r11
657
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
658 659
	RESTORE_REST
	pushq %r11
660 661
	CFI_ADJUST_CFA_OFFSET 8
	CFI_REL_OFFSET rip, 0
L
Linus Torvalds 已提交
662 663
	ret
	CFI_ENDPROC
664
END(ptregscall_common)
665

L
Linus Torvalds 已提交
666 667 668
ENTRY(stub_execve)
	CFI_STARTPROC
	popq %r11
669 670
	CFI_ADJUST_CFA_OFFSET -8
	CFI_REGISTER rip, r11
L
Linus Torvalds 已提交
671 672
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
673
	movq %rsp, %rcx
L
Linus Torvalds 已提交
674 675 676 677 678 679
	call sys_execve
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
680
END(stub_execve)
681

L
Linus Torvalds 已提交
682 683 684
/*
 * 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.
685
 */
L
Linus Torvalds 已提交
686 687
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
688 689
	addq $8, %rsp
	CFI_ADJUST_CFA_OFFSET	-8
L
Linus Torvalds 已提交
690 691 692 693 694 695 696 697
	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
698
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
699

700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716
/*
 * 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
717
      .if vector <> FIRST_EXTERNAL_VECTOR
718 719 720 721
	CFI_ADJUST_CFA_OFFSET -8
      .endif
1:	pushq $(~vector+0x80)	/* Note: always in signed byte range */
	CFI_ADJUST_CFA_OFFSET 8
722
      .if ((vector-FIRST_EXTERNAL_VECTOR)%7) <> 6
723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739
	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

740
/*
L
Linus Torvalds 已提交
741 742 743
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
744 745 746
 *
 * Entry runs with interrupts off.
 */
L
Linus Torvalds 已提交
747

748
/* 0(%rsp): ~(interrupt number) */
L
Linus Torvalds 已提交
749
	.macro interrupt func
750 751 752
	subq $10*8, %rsp
	CFI_ADJUST_CFA_OFFSET 10*8
	call save_args
753
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
754 755 756
	call \func
	.endm

757 758 759 760
	/*
	 * The interrupt stubs push (~vector+0x80) onto the stack and
	 * then jump to common_interrupt.
	 */
761 762
	.p2align CONFIG_X86_L1_CACHE_SHIFT
common_interrupt:
763
	XCPT_FRAME
764
	addq $-0x80,(%rsp)		/* Adjust vector to [-256,-1] range */
L
Linus Torvalds 已提交
765 766
	interrupt do_IRQ
	/* 0(%rsp): oldrsp-ARGOFFSET */
767
ret_from_intr:
768
	DISABLE_INTERRUPTS(CLBR_NONE)
769
	TRACE_IRQS_OFF
770
	decl %gs:pda_irqcount
771
	leaveq
772
	CFI_DEF_CFA_REGISTER	rsp
773
	CFI_ADJUST_CFA_OFFSET	-8
774
exit_intr:
L
Linus Torvalds 已提交
775 776 777
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
778

L
Linus Torvalds 已提交
779 780 781 782
	/* Interrupt came from user space */
	/*
	 * Has a correct top of stack, but a partial stack frame
	 * %rcx: thread info. Interrupts off.
783
	 */
L
Linus Torvalds 已提交
784 785
retint_with_reschedule:
	movl $_TIF_WORK_MASK,%edi
786
retint_check:
787
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
788
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
789
	andl %edi,%edx
790
	CFI_REMEMBER_STATE
L
Linus Torvalds 已提交
791
	jnz  retint_careful
792 793

retint_swapgs:		/* return to user-space */
794 795 796
	/*
	 * The iretq could re-enable interrupts:
	 */
797
	DISABLE_INTERRUPTS(CLBR_ANY)
798
	TRACE_IRQS_IRETQ
799
	SWAPGS
800 801
	jmp restore_args

802
retint_restore_args:	/* return to kernel space */
803
	DISABLE_INTERRUPTS(CLBR_ANY)
804 805 806 807 808
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
I
Ingo Molnar 已提交
809 810
	RESTORE_ARGS 0,8,0

A
Adrian Bunk 已提交
811
irq_return:
812
	INTERRUPT_RETURN
I
Ingo Molnar 已提交
813 814 815 816 817 818

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

#ifdef CONFIG_PARAVIRT
819
ENTRY(native_iret)
L
Linus Torvalds 已提交
820 821 822
	iretq

	.section __ex_table,"a"
823
	.quad native_iret, bad_iret
L
Linus Torvalds 已提交
824
	.previous
I
Ingo Molnar 已提交
825 826
#endif

L
Linus Torvalds 已提交
827 828
	.section .fixup,"ax"
bad_iret:
829 830 831 832 833 834 835 836 837 838 839 840 841 842 843
	/*
	 * 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

844 845
	.previous

846
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
847
retint_careful:
848
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
849 850
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
851
	TRACE_IRQS_ON
852
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
853
	pushq %rdi
854
	CFI_ADJUST_CFA_OFFSET	8
L
Linus Torvalds 已提交
855
	call  schedule
856
	popq %rdi
857
	CFI_ADJUST_CFA_OFFSET	-8
L
Linus Torvalds 已提交
858
	GET_THREAD_INFO(%rcx)
859
	DISABLE_INTERRUPTS(CLBR_NONE)
860
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
861
	jmp retint_check
862

L
Linus Torvalds 已提交
863
retint_signal:
P
Peter Zijlstra 已提交
864
	testl $_TIF_DO_NOTIFY_MASK,%edx
865
	jz    retint_swapgs
866
	TRACE_IRQS_ON
867
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
868
	SAVE_REST
869
	movq $-1,ORIG_RAX(%rsp)
870
	xorl %esi,%esi		# oldset
L
Linus Torvalds 已提交
871 872 873
	movq %rsp,%rdi		# &pt_regs
	call do_notify_resume
	RESTORE_REST
874
	DISABLE_INTERRUPTS(CLBR_NONE)
875
	TRACE_IRQS_OFF
876
	GET_THREAD_INFO(%rcx)
R
Roland McGrath 已提交
877
	jmp retint_with_reschedule
L
Linus Torvalds 已提交
878 879 880 881

#ifdef CONFIG_PREEMPT
	/* Returning to kernel space. Check if we need preemption */
	/* rcx:	 threadinfo. interrupts off. */
882
ENTRY(retint_kernel)
G
Glauber Costa 已提交
883
	cmpl $0,TI_preempt_count(%rcx)
L
Linus Torvalds 已提交
884
	jnz  retint_restore_args
G
Glauber Costa 已提交
885
	bt  $TIF_NEED_RESCHED,TI_flags(%rcx)
L
Linus Torvalds 已提交
886 887 888 889 890
	jnc  retint_restore_args
	bt   $9,EFLAGS-ARGOFFSET(%rsp)	/* interrupts off? */
	jnc  retint_restore_args
	call preempt_schedule_irq
	jmp exit_intr
891
#endif
892

L
Linus Torvalds 已提交
893
	CFI_ENDPROC
894
END(common_interrupt)
895

L
Linus Torvalds 已提交
896 897
/*
 * APIC interrupts.
898
 */
899 900
	.p2align 5

L
Linus Torvalds 已提交
901
	.macro apicinterrupt num,func
902
	INTR_FRAME
903
	pushq $~(\num)
904
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
905 906 907 908 909 910 911
	interrupt \func
	jmp ret_from_intr
	CFI_ENDPROC
	.endm

ENTRY(thermal_interrupt)
	apicinterrupt THERMAL_APIC_VECTOR,smp_thermal_interrupt
912
END(thermal_interrupt)
L
Linus Torvalds 已提交
913

914 915
ENTRY(threshold_interrupt)
	apicinterrupt THRESHOLD_APIC_VECTOR,mce_threshold_interrupt
916
END(threshold_interrupt)
917

918
#ifdef CONFIG_SMP
L
Linus Torvalds 已提交
919 920
ENTRY(reschedule_interrupt)
	apicinterrupt RESCHEDULE_VECTOR,smp_reschedule_interrupt
921
END(reschedule_interrupt)
L
Linus Torvalds 已提交
922

923 924
	.macro INVALIDATE_ENTRY num
ENTRY(invalidate_interrupt\num)
925
	apicinterrupt INVALIDATE_TLB_VECTOR_START+\num,smp_invalidate_interrupt
926
END(invalidate_interrupt\num)
927 928 929 930 931 932 933 934 935 936
	.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 已提交
937 938 939

ENTRY(call_function_interrupt)
	apicinterrupt CALL_FUNCTION_VECTOR,smp_call_function_interrupt
940
END(call_function_interrupt)
941 942 943
ENTRY(call_function_single_interrupt)
	apicinterrupt CALL_FUNCTION_SINGLE_VECTOR,smp_call_function_single_interrupt
END(call_function_single_interrupt)
944 945 946
ENTRY(irq_move_cleanup_interrupt)
	apicinterrupt IRQ_MOVE_CLEANUP_VECTOR,smp_irq_move_cleanup_interrupt
END(irq_move_cleanup_interrupt)
L
Linus Torvalds 已提交
947 948 949 950
#endif

ENTRY(apic_timer_interrupt)
	apicinterrupt LOCAL_TIMER_VECTOR,smp_apic_timer_interrupt
951
END(apic_timer_interrupt)
L
Linus Torvalds 已提交
952

953 954 955 956
ENTRY(uv_bau_message_intr1)
	apicinterrupt 220,uv_bau_message_interrupt
END(uv_bau_message_intr1)

L
Linus Torvalds 已提交
957 958
ENTRY(error_interrupt)
	apicinterrupt ERROR_APIC_VECTOR,smp_error_interrupt
959
END(error_interrupt)
L
Linus Torvalds 已提交
960 961 962

ENTRY(spurious_interrupt)
	apicinterrupt SPURIOUS_APIC_VECTOR,smp_spurious_interrupt
963
END(spurious_interrupt)
964

L
Linus Torvalds 已提交
965 966
/*
 * Exception entry points.
967
 */
L
Linus Torvalds 已提交
968
	.macro zeroentry sym
969
	INTR_FRAME
970
	PARAVIRT_ADJUST_EXCEPTION_FRAME
971
	CFI_PUSHQ $-1		/* ORIG_RAX: no syscall to restart */
972 973 974
	subq $15*8,%rsp
	CFI_ADJUST_CFA_OFFSET 15*8
	call error_entry
975
	DEFAULT_FRAME 0
976 977 978 979
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
	call \sym
	jmp error_exit		/* %ebx: no swapgs flag */
980
	CFI_ENDPROC
981
	.endm
L
Linus Torvalds 已提交
982 983

	.macro errorentry sym
984
	XCPT_FRAME
985
	PARAVIRT_ADJUST_EXCEPTION_FRAME
986 987 988
	subq $15*8,%rsp
	CFI_ADJUST_CFA_OFFSET 15*8
	call error_entry
989
	DEFAULT_FRAME 0
990 991 992 993 994
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
	call \sym
	jmp error_exit			/* %ebx: no swapgs flag */
995
	CFI_ENDPROC
L
Linus Torvalds 已提交
996 997 998 999
	.endm

	/* error code is on the stack already */
	/* handle NMI like exceptions that can happen everywhere */
1000
	.macro paranoidentry sym, ist=0, irqtrace=1
L
Linus Torvalds 已提交
1001 1002 1003 1004 1005 1006 1007
	SAVE_ALL
	cld
	movl $1,%ebx
	movl  $MSR_GS_BASE,%ecx
	rdmsr
	testl %edx,%edx
	js    1f
1008
	SWAPGS
L
Linus Torvalds 已提交
1009
	xorl  %ebx,%ebx
1010 1011 1012 1013
1:
	.if \ist
	movq	%gs:pda_data_offset, %rbp
	.endif
1014 1015 1016
	.if \irqtrace
	TRACE_IRQS_OFF
	.endif
1017
	movq %rsp,%rdi
L
Linus Torvalds 已提交
1018 1019
	movq ORIG_RAX(%rsp),%rsi
	movq $-1,ORIG_RAX(%rsp)
1020
	.if \ist
1021
	subq	$EXCEPTION_STKSZ, per_cpu__init_tss + TSS_ist + (\ist - 1) * 8(%rbp)
1022
	.endif
L
Linus Torvalds 已提交
1023
	call \sym
1024
	.if \ist
1025
	addq	$EXCEPTION_STKSZ, per_cpu__init_tss + TSS_ist + (\ist - 1) * 8(%rbp)
1026
	.endif
1027
	DISABLE_INTERRUPTS(CLBR_NONE)
1028 1029 1030
	.if \irqtrace
	TRACE_IRQS_OFF
	.endif
L
Linus Torvalds 已提交
1031
	.endm
1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052

	/*
 	 * "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:
1053
	.if \trace
1054
	TRACE_IRQS_IRETQ 0
1055
	.endif
1056
	SWAPGS_UNSAFE_STACK
1057 1058
paranoid_restore\trace:
	RESTORE_ALL 8
I
Ingo Molnar 已提交
1059
	jmp irq_return
1060 1061
paranoid_userspace\trace:
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
1062
	movl TI_flags(%rcx),%ebx
1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073
	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
1074
	ENABLE_INTERRUPTS(CLBR_NONE)
1075 1076 1077
	xorl %esi,%esi 			/* arg2: oldset */
	movq %rsp,%rdi 			/* arg1: &pt_regs */
	call do_notify_resume
1078
	DISABLE_INTERRUPTS(CLBR_NONE)
1079 1080 1081 1082 1083 1084 1085 1086
	.if \trace
	TRACE_IRQS_OFF
	.endif
	jmp paranoid_userspace\trace
paranoid_schedule\trace:
	.if \trace
	TRACE_IRQS_ON
	.endif
1087
	ENABLE_INTERRUPTS(CLBR_ANY)
1088
	call schedule
1089
	DISABLE_INTERRUPTS(CLBR_ANY)
1090 1091 1092 1093 1094 1095 1096
	.if \trace
	TRACE_IRQS_OFF
	.endif
	jmp paranoid_userspace\trace
	CFI_ENDPROC
	.endm

L
Linus Torvalds 已提交
1097
/*
1098 1099
 * Exception entry point. This expects an error code/orig_rax on the stack.
 * returns in "no swapgs flag" in %ebx.
1100
 */
1101
KPROBE_ENTRY(error_entry)
1102
	XCPT_FRAME
1103 1104
	CFI_ADJUST_CFA_OFFSET 15*8
	/* oldrax contains error code */
1105
	cld
1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120
	CFI_MOVQ rdi, RDI+8
	CFI_MOVQ rsi, RSI+8
	CFI_MOVQ rdx, RDX+8
	CFI_MOVQ rcx, RCX+8
	CFI_MOVQ rax, RAX+8
	CFI_MOVQ r8, R8+8
	CFI_MOVQ r9, R9+8
	CFI_MOVQ r10, R10+8
	CFI_MOVQ r11, R11+8
	CFI_MOVQ rbx, RBX+8
	CFI_MOVQ rbp, RBP+8
	CFI_MOVQ r12, R12+8
	CFI_MOVQ r13, R13+8
	CFI_MOVQ r14, R14+8
	CFI_MOVQ r15, R15+8
1121
	xorl %ebx,%ebx
1122 1123
	testl $3,CS+8(%rsp)
	je error_kernelspace
1124
error_swapgs:
1125
	SWAPGS
1126 1127
error_sti:
	TRACE_IRQS_OFF
1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153
	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)
        je error_swapgs
	jmp error_sti
KPROBE_END(error_entry)


/* ebx:	no swapgs flag (1: don't need swapgs, 0: need it) */
KPROBE_ENTRY(error_exit)
1154
	DEFAULT_FRAME
1155
	movl %ebx,%eax
L
Linus Torvalds 已提交
1156
	RESTORE_REST
1157
	DISABLE_INTERRUPTS(CLBR_NONE)
1158
	TRACE_IRQS_OFF
1159
	GET_THREAD_INFO(%rcx)
L
Linus Torvalds 已提交
1160
	testl %eax,%eax
1161
	jne retint_kernel
1162
	LOCKDEP_SYS_EXIT_IRQ
1163 1164 1165 1166
	movl TI_flags(%rcx),%edx
	movl $_TIF_WORK_MASK,%edi
	andl %edi,%edx
	jnz retint_careful
1167
	jmp retint_swapgs
L
Linus Torvalds 已提交
1168
	CFI_ENDPROC
1169
KPROBE_END(error_exit)
1170

L
Linus Torvalds 已提交
1171
       /* Reload gs selector with exception handling */
1172
       /* edi:  new selector */
1173
ENTRY(native_load_gs_index)
1174
	CFI_STARTPROC
L
Linus Torvalds 已提交
1175
	pushf
1176
	CFI_ADJUST_CFA_OFFSET 8
1177 1178
	DISABLE_INTERRUPTS(CLBR_ANY | ~(CLBR_RDI))
        SWAPGS
1179 1180
gs_change:
        movl %edi,%gs
L
Linus Torvalds 已提交
1181
2:	mfence		/* workaround */
1182
	SWAPGS
L
Linus Torvalds 已提交
1183
        popf
1184
	CFI_ADJUST_CFA_OFFSET -8
L
Linus Torvalds 已提交
1185
        ret
1186
	CFI_ENDPROC
1187
ENDPROC(native_load_gs_index)
1188

L
Linus Torvalds 已提交
1189 1190 1191 1192 1193 1194
        .section __ex_table,"a"
        .align 8
        .quad gs_change,bad_gs
        .previous
        .section .fixup,"ax"
	/* running with kernelgs */
1195
bad_gs:
1196
	SWAPGS			/* switch back to user gs */
L
Linus Torvalds 已提交
1197 1198 1199
	xorl %eax,%eax
        movl %eax,%gs
        jmp  2b
1200 1201
        .previous

L
Linus Torvalds 已提交
1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223
/*
 * 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
1224

L
Linus Torvalds 已提交
1225 1226 1227 1228 1229 1230 1231 1232 1233 1234
	# 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.
1235
         * [Hopefully no generic code relies on the reschedule -AK]
L
Linus Torvalds 已提交
1236 1237 1238 1239 1240
	 */
	RESTORE_ALL
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1241
ENDPROC(kernel_thread)
1242

L
Linus Torvalds 已提交
1243
child_rip:
1244 1245
	pushq $0		# fake return address
	CFI_STARTPROC
L
Linus Torvalds 已提交
1246 1247 1248 1249 1250 1251 1252 1253
	/*
	 * 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
1254
	mov %eax, %edi
L
Linus Torvalds 已提交
1255
	call do_exit
1256
	CFI_ENDPROC
1257
ENDPROC(child_rip)
L
Linus Torvalds 已提交
1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268

/*
 * 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:
1269
 *	extern long sys_execve(char *name, char **argv,char **envp, struct pt_regs *regs)
L
Linus Torvalds 已提交
1270 1271
 *
 * do_sys_execve asm fallback arguments:
1272
 *	rdi: name, rsi: argv, rdx: envp, rcx: fake frame on the stack
L
Linus Torvalds 已提交
1273
 */
1274
ENTRY(kernel_execve)
L
Linus Torvalds 已提交
1275 1276
	CFI_STARTPROC
	FAKE_STACK_FRAME $0
1277
	SAVE_ALL
1278
	movq %rsp,%rcx
L
Linus Torvalds 已提交
1279
	call sys_execve
1280
	movq %rax, RAX(%rsp)
L
Linus Torvalds 已提交
1281 1282 1283 1284 1285 1286 1287
	RESTORE_REST
	testq %rax,%rax
	je int_ret_from_sys_call
	RESTORE_ARGS
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1288
ENDPROC(kernel_execve)
L
Linus Torvalds 已提交
1289

1290
KPROBE_ENTRY(page_fault)
L
Linus Torvalds 已提交
1291
	errorentry do_page_fault
1292
KPROBE_END(page_fault)
L
Linus Torvalds 已提交
1293 1294 1295

ENTRY(coprocessor_error)
	zeroentry do_coprocessor_error
1296
END(coprocessor_error)
L
Linus Torvalds 已提交
1297 1298

ENTRY(simd_coprocessor_error)
1299
	zeroentry do_simd_coprocessor_error
1300
END(simd_coprocessor_error)
L
Linus Torvalds 已提交
1301 1302

ENTRY(device_not_available)
1303
	zeroentry do_device_not_available
1304
END(device_not_available)
L
Linus Torvalds 已提交
1305 1306

	/* runs on exception stack */
1307
KPROBE_ENTRY(debug)
1308
 	INTR_FRAME
1309
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1310
	pushq $0
1311
	CFI_ADJUST_CFA_OFFSET 8
1312
	paranoidentry do_debug, DEBUG_STACK
1313
	paranoidexit
1314
KPROBE_END(debug)
L
Linus Torvalds 已提交
1315

1316
	/* runs on exception stack */
1317
KPROBE_ENTRY(nmi)
1318
	INTR_FRAME
1319
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1320
	pushq $-1
1321
	CFI_ADJUST_CFA_OFFSET 8
1322 1323 1324 1325 1326 1327 1328
	paranoidentry do_nmi, 0, 0
#ifdef CONFIG_TRACE_IRQFLAGS
	paranoidexit 0
#else
	jmp paranoid_exit1
 	CFI_ENDPROC
#endif
1329
KPROBE_END(nmi)
1330

1331
KPROBE_ENTRY(int3)
1332
 	INTR_FRAME
1333
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1334 1335
 	pushq $0
 	CFI_ADJUST_CFA_OFFSET 8
1336
 	paranoidentry do_int3, DEBUG_STACK
1337
 	jmp paranoid_exit1
1338
 	CFI_ENDPROC
1339
KPROBE_END(int3)
L
Linus Torvalds 已提交
1340 1341 1342

ENTRY(overflow)
	zeroentry do_overflow
1343
END(overflow)
L
Linus Torvalds 已提交
1344 1345 1346

ENTRY(bounds)
	zeroentry do_bounds
1347
END(bounds)
L
Linus Torvalds 已提交
1348 1349

ENTRY(invalid_op)
1350
	zeroentry do_invalid_op
1351
END(invalid_op)
L
Linus Torvalds 已提交
1352 1353 1354

ENTRY(coprocessor_segment_overrun)
	zeroentry do_coprocessor_segment_overrun
1355
END(coprocessor_segment_overrun)
L
Linus Torvalds 已提交
1356 1357 1358

	/* runs on exception stack */
ENTRY(double_fault)
1359
	XCPT_FRAME
1360
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1361
	paranoidentry do_double_fault
1362
	jmp paranoid_exit1
L
Linus Torvalds 已提交
1363
	CFI_ENDPROC
1364
END(double_fault)
L
Linus Torvalds 已提交
1365 1366 1367

ENTRY(invalid_TSS)
	errorentry do_invalid_TSS
1368
END(invalid_TSS)
L
Linus Torvalds 已提交
1369 1370 1371

ENTRY(segment_not_present)
	errorentry do_segment_not_present
1372
END(segment_not_present)
L
Linus Torvalds 已提交
1373 1374 1375

	/* runs on exception stack */
ENTRY(stack_segment)
1376
	XCPT_FRAME
1377
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1378
	paranoidentry do_stack_segment
1379
	jmp paranoid_exit1
L
Linus Torvalds 已提交
1380
	CFI_ENDPROC
1381
END(stack_segment)
L
Linus Torvalds 已提交
1382

1383
KPROBE_ENTRY(general_protection)
L
Linus Torvalds 已提交
1384
	errorentry do_general_protection
1385
KPROBE_END(general_protection)
L
Linus Torvalds 已提交
1386 1387 1388

ENTRY(alignment_check)
	errorentry do_alignment_check
1389
END(alignment_check)
L
Linus Torvalds 已提交
1390 1391 1392

ENTRY(divide_error)
	zeroentry do_divide_error
1393
END(divide_error)
L
Linus Torvalds 已提交
1394 1395 1396

ENTRY(spurious_interrupt_bug)
	zeroentry do_spurious_interrupt_bug
1397
END(spurious_interrupt_bug)
L
Linus Torvalds 已提交
1398 1399 1400 1401

#ifdef CONFIG_X86_MCE
	/* runs on exception stack */
ENTRY(machine_check)
1402
	INTR_FRAME
1403
	PARAVIRT_ADJUST_EXCEPTION_FRAME
L
Linus Torvalds 已提交
1404
	pushq $0
1405
	CFI_ADJUST_CFA_OFFSET 8
L
Linus Torvalds 已提交
1406
	paranoidentry do_machine_check
1407
	jmp paranoid_exit1
L
Linus Torvalds 已提交
1408
	CFI_ENDPROC
1409
END(machine_check)
L
Linus Torvalds 已提交
1410 1411
#endif

1412
/* Call softirq on interrupt stack. Interrupts are off. */
1413
ENTRY(call_softirq)
1414
	CFI_STARTPROC
1415 1416 1417 1418 1419
	push %rbp
	CFI_ADJUST_CFA_OFFSET	8
	CFI_REL_OFFSET rbp,0
	mov  %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1420
	incl %gs:pda_irqcount
1421 1422
	cmove %gs:pda_irqstackptr,%rsp
	push  %rbp			# backlink for old unwinder
1423
	call __do_softirq
1424
	leaveq
1425
	CFI_DEF_CFA_REGISTER	rsp
1426
	CFI_ADJUST_CFA_OFFSET   -8
1427 1428
	decl %gs:pda_irqcount
	ret
1429
	CFI_ENDPROC
1430
ENDPROC(call_softirq)
1431 1432 1433 1434 1435 1436 1437

KPROBE_ENTRY(ignore_sysret)
	CFI_STARTPROC
	mov $-ENOSYS,%eax
	sysret
	CFI_ENDPROC
ENDPROC(ignore_sysret)
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

#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
1463
	DEFAULT_FRAME
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
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)
1491 1492 1493 1494 1495 1496 1497
	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
1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
	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
1518 1519 1520
	CFI_PUSHQ $0	/* RIP */
	CFI_PUSHQ %r11
	CFI_PUSHQ %rcx
1521
	jmp general_protection
1522 1523 1524 1525 1526 1527 1528 1529
	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
1530
	CFI_PUSHQ $0
1531 1532 1533 1534 1535 1536
	SAVE_ALL
	jmp error_exit
	CFI_ENDPROC
END(xen_failsafe_callback)

#endif /* CONFIG_XEN */