entry_64.S 44.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11
/*
 *  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.
 *
12 13
 * Some of this is documented in Documentation/x86/entry_64.txt
 *
L
Linus Torvalds 已提交
14 15
 * NOTE: This code handles signal-recognition, which happens every time
 * after an interrupt and after each system call.
16 17
 *
 * Normal syscalls and interrupts don't save a full stack frame, this is
L
Linus Torvalds 已提交
18
 * only done for syscall tracing, signals or fork/exec et.al.
19 20 21 22
 *
 * A note on terminology:
 * - top of stack: Architecture defined interrupt frame from SS to RIP
 * at the top of the kernel process stack.
L
Lucas De Marchi 已提交
23
 * - partial stack frame: partially saved registers up to R11.
24
 * - full stack frame: Like partial stack frame, but all register saved.
25 26 27 28 29 30 31 32 33 34 35 36 37 38 39
 *
 * 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 已提交
40 41 42 43 44 45 46 47
 */

#include <linux/linkage.h>
#include <asm/segment.h>
#include <asm/cache.h>
#include <asm/errno.h>
#include <asm/dwarf2.h>
#include <asm/calling.h>
48
#include <asm/asm-offsets.h>
L
Linus Torvalds 已提交
49 50 51 52
#include <asm/msr.h>
#include <asm/unistd.h>
#include <asm/thread_info.h>
#include <asm/hw_irq.h>
53
#include <asm/page_types.h>
54
#include <asm/irqflags.h>
55
#include <asm/paravirt.h>
56
#include <asm/ftrace.h>
57
#include <asm/percpu.h>
58
#include <asm/asm.h>
59
#include <linux/err.h>
L
Linus Torvalds 已提交
60

R
Roland McGrath 已提交
61 62 63 64 65 66
/* 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 已提交
67
	.code64
J
Jiri Olsa 已提交
68 69
	.section .entry.text, "ax"

70
#ifdef CONFIG_FUNCTION_TRACER
71 72 73 74 75 76
#ifdef CONFIG_DYNAMIC_FTRACE
ENTRY(mcount)
	retq
END(mcount)

ENTRY(ftrace_caller)
77 78
	cmpl $0, function_trace_stop
	jne  ftrace_stub
79

80
	MCOUNT_SAVE_FRAME
81 82 83

	movq 0x38(%rsp), %rdi
	movq 8(%rbp), %rsi
84
	subq $MCOUNT_INSN_SIZE, %rdi
85

86
GLOBAL(ftrace_call)
87 88
	call ftrace_stub

89
	MCOUNT_RESTORE_FRAME
90

91
#ifdef CONFIG_FUNCTION_GRAPH_TRACER
92
GLOBAL(ftrace_graph_call)
93 94
	jmp ftrace_stub
#endif
95

96
GLOBAL(ftrace_stub)
97 98 99 100
	retq
END(ftrace_caller)

#else /* ! CONFIG_DYNAMIC_FTRACE */
101
ENTRY(mcount)
102 103 104
	cmpl $0, function_trace_stop
	jne  ftrace_stub

105 106
	cmpq $ftrace_stub, ftrace_trace_function
	jnz trace
107 108 109 110

#ifdef CONFIG_FUNCTION_GRAPH_TRACER
	cmpq $ftrace_stub, ftrace_graph_return
	jnz ftrace_graph_caller
111 112 113

	cmpq $ftrace_graph_entry_stub, ftrace_graph_entry
	jnz ftrace_graph_caller
114 115
#endif

116
GLOBAL(ftrace_stub)
117 118 119
	retq

trace:
120
	MCOUNT_SAVE_FRAME
121 122 123

	movq 0x38(%rsp), %rdi
	movq 8(%rbp), %rsi
124
	subq $MCOUNT_INSN_SIZE, %rdi
125 126 127

	call   *ftrace_trace_function

128
	MCOUNT_RESTORE_FRAME
129 130 131

	jmp ftrace_stub
END(mcount)
132
#endif /* CONFIG_DYNAMIC_FTRACE */
133
#endif /* CONFIG_FUNCTION_TRACER */
134

135 136 137 138 139
#ifdef CONFIG_FUNCTION_GRAPH_TRACER
ENTRY(ftrace_graph_caller)
	cmpl $0, function_trace_stop
	jne ftrace_stub

140
	MCOUNT_SAVE_FRAME
141 142 143

	leaq 8(%rbp), %rdi
	movq 0x38(%rsp), %rsi
144
	movq (%rbp), %rdx
145
	subq $MCOUNT_INSN_SIZE, %rsi
146 147 148

	call	prepare_ftrace_return

149 150
	MCOUNT_RESTORE_FRAME

151 152 153
	retq
END(ftrace_graph_caller)

154
GLOBAL(return_to_handler)
155
	subq  $24, %rsp
156

157
	/* Save the return values */
158
	movq %rax, (%rsp)
159
	movq %rdx, 8(%rsp)
160
	movq %rbp, %rdi
161

162
	call ftrace_return_to_handler
163

164
	movq %rax, %rdi
165
	movq 8(%rsp), %rdx
166
	movq (%rsp), %rax
167 168
	addq $24, %rsp
	jmp *%rdi
169
#endif
170 171


172
#ifndef CONFIG_PREEMPT
L
Linus Torvalds 已提交
173
#define retint_kernel retint_restore_args
174
#endif
175

176
#ifdef CONFIG_PARAVIRT
177
ENTRY(native_usergs_sysret64)
178 179
	swapgs
	sysretq
180
ENDPROC(native_usergs_sysret64)
181 182
#endif /* CONFIG_PARAVIRT */

183 184 185 186 187 188 189 190 191 192

.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

193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
/*
 * When dynamic function tracer is enabled it will add a breakpoint
 * to all locations that it is about to modify, sync CPUs, update
 * all the code, sync CPUs, then remove the breakpoints. In this time
 * if lockdep is enabled, it might jump back into the debug handler
 * outside the updating of the IST protection. (TRACE_IRQS_ON/OFF).
 *
 * We need to change the IDT table before calling TRACE_IRQS_ON/OFF to
 * make sure the stack pointer does not get reset back to the top
 * of the debug stack, and instead just reuses the current stack.
 */
#if defined(CONFIG_DYNAMIC_FTRACE) && defined(CONFIG_TRACE_IRQFLAGS)

.macro TRACE_IRQS_OFF_DEBUG
	call debug_stack_set_zero
	TRACE_IRQS_OFF
	call debug_stack_reset
.endm

.macro TRACE_IRQS_ON_DEBUG
	call debug_stack_set_zero
	TRACE_IRQS_ON
	call debug_stack_reset
.endm

.macro TRACE_IRQS_IRETQ_DEBUG offset=ARGOFFSET
	bt   $9,EFLAGS-\offset(%rsp)	/* interrupts off? */
	jnc  1f
	TRACE_IRQS_ON_DEBUG
1:
.endm

#else
# define TRACE_IRQS_OFF_DEBUG		TRACE_IRQS_OFF
# define TRACE_IRQS_ON_DEBUG		TRACE_IRQS_ON
# define TRACE_IRQS_IRETQ_DEBUG		TRACE_IRQS_IRETQ
#endif

L
Linus Torvalds 已提交
231
/*
232 233
 * 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 已提交
234 235 236
 * fast path FIXUP_TOP_OF_STACK is needed.
 * RESTORE_TOP_OF_STACK syncs the syscall state after any possible ptregs
 * manipulation.
237 238 239
 */

	/* %rsp:at FRAMEEND */
240
	.macro FIXUP_TOP_OF_STACK tmp offset=0
241
	movq PER_CPU_VAR(old_rsp),\tmp
242 243 244 245 246 247
	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 已提交
248 249
	.endm

250 251
	.macro RESTORE_TOP_OF_STACK tmp offset=0
	movq RSP+\offset(%rsp),\tmp
252
	movq \tmp,PER_CPU_VAR(old_rsp)
253 254
	movq EFLAGS+\offset(%rsp),\tmp
	movq \tmp,R11+\offset(%rsp)
L
Linus Torvalds 已提交
255 256 257 258
	.endm

	.macro FAKE_STACK_FRAME child_rip
	/* push in order ss, rsp, eflags, cs, rip */
259
	xorl %eax, %eax
260
	pushq_cfi $__KERNEL_DS /* ss */
261
	/*CFI_REL_OFFSET	ss,0*/
262
	pushq_cfi %rax /* rsp */
263
	CFI_REL_OFFSET	rsp,0
264
	pushq_cfi $(X86_EFLAGS_IF|X86_EFLAGS_BIT1) /* eflags - interrupts on */
265
	/*CFI_REL_OFFSET	rflags,0*/
266
	pushq_cfi $__KERNEL_CS /* cs */
267
	/*CFI_REL_OFFSET	cs,0*/
268
	pushq_cfi \child_rip /* rip */
269
	CFI_REL_OFFSET	rip,0
270
	pushq_cfi %rax /* orig rax */
L
Linus Torvalds 已提交
271 272 273 274 275 276 277
	.endm

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

278 279 280 281
/*
 * initial frame state for interrupts (and exceptions without error code)
 */
	.macro EMPTY_FRAME start=1 offset=0
282
	.if \start
283
	CFI_STARTPROC simple
284
	CFI_SIGNAL_FRAME
285
	CFI_DEF_CFA rsp,8+\offset
286
	.else
287
	CFI_DEF_CFA_OFFSET 8+\offset
288
	.endif
L
Linus Torvalds 已提交
289
	.endm
290 291

/*
292
 * initial frame state for interrupts (and exceptions without error code)
293
 */
294
	.macro INTR_FRAME start=1 offset=0
295 296 297 298 299 300
	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
301 302 303 304 305 306
	.endm

/*
 * initial frame state for exceptions with error code (and interrupts
 * with vector already pushed)
 */
307
	.macro XCPT_FRAME start=1 offset=0
308
	INTR_FRAME \start, RIP+\offset-ORIG_RAX
309 310 311 312 313 314 315
	/*CFI_REL_OFFSET orig_rax, ORIG_RAX-ORIG_RAX*/
	.endm

/*
 * frame that enables calling into C.
 */
	.macro PARTIAL_FRAME start=1 offset=0
316 317 318 319 320 321 322 323 324 325
	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
326 327 328 329 330 331
	.endm

/*
 * frame that enables passing a complete pt_regs to a C function.
 */
	.macro DEFAULT_FRAME start=1 offset=0
332
	PARTIAL_FRAME \start, R11+\offset-R15
333 334 335 336 337 338 339
	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
340 341

/* save partial stack frame */
342
	.macro SAVE_ARGS_IRQ
343
	cld
344 345 346 347 348 349 350 351 352 353 354
	/* start from rbp in pt_regs and jump over */
	movq_cfi rdi, RDI-RBP
	movq_cfi rsi, RSI-RBP
	movq_cfi rdx, RDX-RBP
	movq_cfi rcx, RCX-RBP
	movq_cfi rax, RAX-RBP
	movq_cfi  r8,  R8-RBP
	movq_cfi  r9,  R9-RBP
	movq_cfi r10, R10-RBP
	movq_cfi r11, R11-RBP

355 356 357 358 359
	/* Save rbp so that we can unwind from get_irq_regs() */
	movq_cfi rbp, 0

	/* Save previous stack value */
	movq %rsp, %rsi
360 361

	leaq -RBP(%rsp),%rdi	/* arg1 for handler */
362
	testl $3, CS-RBP(%rsi)
363 364 365
	je 1f
	SWAPGS
	/*
366
	 * irq_count is used to check if a CPU is already on an interrupt stack
367 368 369 370
	 * 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)
	 */
371
1:	incl PER_CPU_VAR(irq_count)
372
	cmovzq PER_CPU_VAR(irq_stack_ptr),%rsp
373
	CFI_DEF_CFA_REGISTER	rsi
374

375
	/* Store previous stack value */
376
	pushq %rsi
377 378 379 380 381
	CFI_ESCAPE	0x0f /* DW_CFA_def_cfa_expression */, 6, \
			0x77 /* DW_OP_breg7 */, 0, \
			0x06 /* DW_OP_deref */, \
			0x08 /* DW_OP_const1u */, SS+8-RBP, \
			0x22 /* DW_OP_plus */
382 383
	/* We entered an interrupt context - irqs are off: */
	TRACE_IRQS_OFF
384
	.endm
385

386 387 388 389 390 391 392 393 394 395 396 397 398 399 400
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)

401
/* save complete stack frame */
402
	.pushsection .kprobes.text, "ax"
403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430
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)
431
	.popsection
432

L
Linus Torvalds 已提交
433
/*
434 435 436
 * A newly forked process directly context switches into this address.
 *
 * rdi: prev task we switched from
437
 */
L
Linus Torvalds 已提交
438
ENTRY(ret_from_fork)
439
	DEFAULT_FRAME
440

441 442
	LOCK ; btr $TIF_FORK,TI_flags(%r8)

443 444
	pushq_cfi kernel_eflags(%rip)
	popfq_cfi				# reset kernel eflags
445 446 447

	call schedule_tail			# rdi: 'prev' task parameter

L
Linus Torvalds 已提交
448
	GET_THREAD_INFO(%rcx)
449

L
Linus Torvalds 已提交
450
	RESTORE_REST
451 452

	testl $3, CS-ARGOFFSET(%rsp)		# from kernel_thread?
453
	jz   retint_restore_args
454 455

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

458
	RESTORE_TOP_OF_STACK %rdi, -ARGOFFSET
459 460
	jmp ret_from_sys_call			# go to the SYSRET fastpath

L
Linus Torvalds 已提交
461
	CFI_ENDPROC
462
END(ret_from_fork)
L
Linus Torvalds 已提交
463 464

/*
L
Lucas De Marchi 已提交
465
 * System call entry. Up to 6 arguments in registers are supported.
L
Linus Torvalds 已提交
466 467 468 469
 *
 * SYSCALL does not save anything on the stack and does not change the
 * stack pointer.
 */
470

L
Linus Torvalds 已提交
471
/*
472
 * Register setup:
L
Linus Torvalds 已提交
473 474
 * rax  system call number
 * rdi  arg0
475
 * rcx  return address for syscall/sysret, C arg3
L
Linus Torvalds 已提交
476
 * rsi  arg1
477
 * rdx  arg2
L
Linus Torvalds 已提交
478 479 480 481
 * r10  arg3 	(--> moved to rcx for C)
 * r8   arg4
 * r9   arg5
 * r11  eflags for syscall/sysret, temporary for C
482 483
 * r12-r15,rbp,rbx saved by C code, not touched.
 *
L
Linus Torvalds 已提交
484 485 486 487 488
 * 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.
489 490 491 492
 *
 * 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.
493
 */
L
Linus Torvalds 已提交
494 495

ENTRY(system_call)
496
	CFI_STARTPROC	simple
497
	CFI_SIGNAL_FRAME
498
	CFI_DEF_CFA	rsp,KERNEL_STACK_OFFSET
499 500
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
501 502 503 504 505 506
	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.
	 */
507
GLOBAL(system_call_after_swapgs)
508

509
	movq	%rsp,PER_CPU_VAR(old_rsp)
510
	movq	PER_CPU_VAR(kernel_stack),%rsp
511 512 513 514
	/*
	 * No need to follow this irqs off/on section - it's straight
	 * and short:
	 */
515
	ENABLE_INTERRUPTS(CLBR_NONE)
516
	SAVE_ARGS 8,0
517
	movq  %rax,ORIG_RAX-ARGOFFSET(%rsp)
518 519
	movq  %rcx,RIP-ARGOFFSET(%rsp)
	CFI_REL_OFFSET rip,RIP-ARGOFFSET
520
	testl $_TIF_WORK_SYSCALL_ENTRY,TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET)
L
Linus Torvalds 已提交
521
	jnz tracesys
R
Roland McGrath 已提交
522
system_call_fastpath:
523
#if __SYSCALL_MASK == ~0
L
Linus Torvalds 已提交
524
	cmpq $__NR_syscall_max,%rax
525 526 527 528
#else
	andl $__SYSCALL_MASK,%eax
	cmpl $__NR_syscall_max,%eax
#endif
L
Linus Torvalds 已提交
529 530 531 532 533 534
	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)
535 536
 * Has incomplete stack frame and undefined top of stack.
 */
L
Linus Torvalds 已提交
537
ret_from_sys_call:
538
	movl $_TIF_ALLWORK_MASK,%edi
L
Linus Torvalds 已提交
539
	/* edi:	flagmask */
540
sysret_check:
541
	LOCKDEP_SYS_EXIT
542
	DISABLE_INTERRUPTS(CLBR_NONE)
543
	TRACE_IRQS_OFF
544
	movl TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET),%edx
L
Linus Torvalds 已提交
545
	andl %edi,%edx
546
	jnz  sysret_careful
547
	CFI_REMEMBER_STATE
548 549 550 551
	/*
	 * sysretq will re-enable interrupts:
	 */
	TRACE_IRQS_ON
L
Linus Torvalds 已提交
552
	movq RIP-ARGOFFSET(%rsp),%rcx
553
	CFI_REGISTER	rip,rcx
554
	RESTORE_ARGS 1,-ARG_SKIP,0
555
	/*CFI_REGISTER	rflags,r11*/
556
	movq	PER_CPU_VAR(old_rsp), %rsp
557
	USERGS_SYSRET64
L
Linus Torvalds 已提交
558

559
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
560
	/* Handle reschedules */
561
	/* edx:	work, edi: workmask */
L
Linus Torvalds 已提交
562 563 564
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
565
	TRACE_IRQS_ON
566
	ENABLE_INTERRUPTS(CLBR_NONE)
567
	pushq_cfi %rdi
L
Linus Torvalds 已提交
568
	call schedule
569
	popq_cfi %rdi
L
Linus Torvalds 已提交
570 571
	jmp sysret_check

572
	/* Handle a signal */
L
Linus Torvalds 已提交
573
sysret_signal:
574
	TRACE_IRQS_ON
575
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
576 577 578 579
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
580 581 582 583 584 585 586
	/*
	 * We have a signal, or exit tracing or single-step.
	 * These all wind up with the iret return path anyway,
	 * so just join that path right now.
	 */
	FIXUP_TOP_OF_STACK %r11, -ARGOFFSET
	jmp int_check_syscall_exit_work
587

588 589 590 591
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

R
Roland McGrath 已提交
592 593 594
#ifdef CONFIG_AUDITSYSCALL
	/*
	 * Fast path for syscall audit without full syscall trace.
595
	 * We just call __audit_syscall_entry() directly, and then
R
Roland McGrath 已提交
596 597 598 599 600 601 602 603 604
	 * 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 */
605
	call __audit_syscall_entry
R
Roland McGrath 已提交
606 607 608 609
	LOAD_ARGS 0		/* reload call-clobbered registers */
	jmp system_call_fastpath

	/*
610
	 * Return fast path for syscall audit.  Call __audit_syscall_exit()
R
Roland McGrath 已提交
611 612 613 614
	 * directly and then jump back to the fast path with TIF_SYSCALL_AUDIT
	 * masked off.
	 */
sysret_audit:
615
	movq RAX-ARGOFFSET(%rsp),%rsi	/* second arg, syscall return value */
616 617
	cmpq $-MAX_ERRNO,%rsi	/* is it < -MAX_ERRNO? */
	setbe %al		/* 1 if so, 0 if not */
R
Roland McGrath 已提交
618
	movzbl %al,%edi		/* zero-extend that into %edi */
619
	call __audit_syscall_exit
R
Roland McGrath 已提交
620 621 622 623
	movl $(_TIF_ALLWORK_MASK & ~_TIF_SYSCALL_AUDIT),%edi
	jmp sysret_check
#endif	/* CONFIG_AUDITSYSCALL */

L
Linus Torvalds 已提交
624
	/* Do syscall tracing */
625
tracesys:
R
Roland McGrath 已提交
626
#ifdef CONFIG_AUDITSYSCALL
627
	testl $(_TIF_WORK_SYSCALL_ENTRY & ~_TIF_SYSCALL_AUDIT),TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET)
R
Roland McGrath 已提交
628 629
	jz auditsys
#endif
L
Linus Torvalds 已提交
630
	SAVE_REST
R
Roland McGrath 已提交
631
	movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
L
Linus Torvalds 已提交
632 633 634
	FIXUP_TOP_OF_STACK %rdi
	movq %rsp,%rdi
	call syscall_trace_enter
635 636 637 638 639 640
	/*
	 * 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 已提交
641
	RESTORE_REST
642
#if __SYSCALL_MASK == ~0
L
Linus Torvalds 已提交
643
	cmpq $__NR_syscall_max,%rax
644 645 646 647
#else
	andl $__SYSCALL_MASK,%eax
	cmpl $__NR_syscall_max,%eax
#endif
R
Roland McGrath 已提交
648
	ja   int_ret_from_sys_call	/* RAX(%rsp) set to -ENOSYS above */
L
Linus Torvalds 已提交
649 650
	movq %r10,%rcx	/* fixup for C */
	call *sys_call_table(,%rax,8)
R
Roland McGrath 已提交
651
	movq %rax,RAX-ARGOFFSET(%rsp)
652
	/* Use IRET because user could have changed frame */
653 654

/*
L
Linus Torvalds 已提交
655 656
 * Syscall return path ending with IRET.
 * Has correct top of stack, but partial stack frame.
657
 */
658
GLOBAL(int_ret_from_sys_call)
659
	DISABLE_INTERRUPTS(CLBR_NONE)
660
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
661 662
	movl $_TIF_ALLWORK_MASK,%edi
	/* edi:	mask to check */
663
GLOBAL(int_with_check)
664
	LOCKDEP_SYS_EXIT_IRQ
L
Linus Torvalds 已提交
665
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
666
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
667 668
	andl %edi,%edx
	jnz   int_careful
G
Glauber Costa 已提交
669
	andl    $~TS_COMPAT,TI_status(%rcx)
L
Linus Torvalds 已提交
670 671 672 673 674 675 676 677
	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
678
	TRACE_IRQS_ON
679
	ENABLE_INTERRUPTS(CLBR_NONE)
680
	pushq_cfi %rdi
L
Linus Torvalds 已提交
681
	call schedule
682
	popq_cfi %rdi
683
	DISABLE_INTERRUPTS(CLBR_NONE)
684
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
685 686 687 688
	jmp int_with_check

	/* handle signals and tracing -- both require a full stack frame */
int_very_careful:
689
	TRACE_IRQS_ON
690
	ENABLE_INTERRUPTS(CLBR_NONE)
691
int_check_syscall_exit_work:
L
Linus Torvalds 已提交
692
	SAVE_REST
693
	/* Check for syscall exit trace */
694
	testl $_TIF_WORK_SYSCALL_EXIT,%edx
L
Linus Torvalds 已提交
695
	jz int_signal
696
	pushq_cfi %rdi
697
	leaq 8(%rsp),%rdi	# &ptregs -> arg1
L
Linus Torvalds 已提交
698
	call syscall_trace_leave
699
	popq_cfi %rdi
700
	andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
L
Linus Torvalds 已提交
701
	jmp int_restore_rest
702

L
Linus Torvalds 已提交
703
int_signal:
P
Peter Zijlstra 已提交
704
	testl $_TIF_DO_NOTIFY_MASK,%edx
L
Linus Torvalds 已提交
705 706 707 708
	jz 1f
	movq %rsp,%rdi		# &ptregs -> arg1
	xorl %esi,%esi		# oldset -> arg2
	call do_notify_resume
R
Roland McGrath 已提交
709
1:	movl $_TIF_WORK_MASK,%edi
L
Linus Torvalds 已提交
710 711
int_restore_rest:
	RESTORE_REST
712
	DISABLE_INTERRUPTS(CLBR_NONE)
713
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
714 715
	jmp int_with_check
	CFI_ENDPROC
716
END(system_call)
717 718

/*
L
Linus Torvalds 已提交
719
 * Certain special system calls that need to save a complete full stack frame.
720
 */
L
Linus Torvalds 已提交
721
	.macro PTREGSCALL label,func,arg
722 723 724 725 726 727 728 729 730 731
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
732
END(\label)
L
Linus Torvalds 已提交
733 734 735 736 737 738 739 740 741
	.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)
742 743 744 745 746 747 748 749 750
	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 已提交
751
	CFI_ENDPROC
752
END(ptregscall_common)
753

L
Linus Torvalds 已提交
754 755
ENTRY(stub_execve)
	CFI_STARTPROC
756 757
	addq $8, %rsp
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
758 759
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
760
	movq %rsp, %rcx
L
Linus Torvalds 已提交
761 762 763 764 765 766
	call sys_execve
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
767
END(stub_execve)
768

L
Linus Torvalds 已提交
769 770 771
/*
 * 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.
772
 */
L
Linus Torvalds 已提交
773 774
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
775
	addq $8, %rsp
776
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
777 778 779 780 781 782 783 784
	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
785
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
786

787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803
#ifdef CONFIG_X86_X32_ABI
	PTREGSCALL stub_x32_sigaltstack, sys32_sigaltstack, %rdx

ENTRY(stub_x32_rt_sigreturn)
	CFI_STARTPROC
	addq $8, %rsp
	PARTIAL_FRAME 0
	SAVE_REST
	movq %rsp,%rdi
	FIXUP_TOP_OF_STACK %r11
	call sys32_x32_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
END(stub_x32_rt_sigreturn)

H
H. Peter Anvin 已提交
804 805 806 807 808 809 810 811 812 813 814 815 816 817 818
ENTRY(stub_x32_execve)
	CFI_STARTPROC
	addq $8, %rsp
	PARTIAL_FRAME 0
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
	movq %rsp, %rcx
	call sys32_execve
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
END(stub_x32_execve)

819 820
#endif

821 822 823 824 825 826 827
/*
 * 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)
J
Jiri Olsa 已提交
828
	.section .entry.text
829 830 831 832 833 834 835 836 837
	.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
838
      .if vector <> FIRST_EXTERNAL_VECTOR
839 840
	CFI_ADJUST_CFA_OFFSET -8
      .endif
841
1:	pushq_cfi $(~vector+0x80)	/* Note: always in signed byte range */
842
      .if ((vector-FIRST_EXTERNAL_VECTOR)%7) <> 6
843 844 845 846
	jmp 2f
      .endif
      .previous
	.quad 1b
J
Jiri Olsa 已提交
847
      .section .entry.text
848 849 850 851 852 853 854 855 856 857 858 859
vector=vector+1
    .endif
  .endr
2:	jmp common_interrupt
.endr
	CFI_ENDPROC
END(irq_entries_start)

.previous
END(interrupt)
.previous

860
/*
L
Linus Torvalds 已提交
861 862 863
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
864 865 866
 *
 * Entry runs with interrupts off.
 */
L
Linus Torvalds 已提交
867

868
/* 0(%rsp): ~(interrupt number) */
L
Linus Torvalds 已提交
869
	.macro interrupt func
870 871 872
	/* reserve pt_regs for scratch regs and rbp */
	subq $ORIG_RAX-RBP, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-RBP
873
	SAVE_ARGS_IRQ
L
Linus Torvalds 已提交
874 875 876
	call \func
	.endm

877 878 879 880
/*
 * Interrupt entry/exit should be protected against kprobes
 */
	.pushsection .kprobes.text, "ax"
881 882 883 884
	/*
	 * The interrupt stubs push (~vector+0x80) onto the stack and
	 * then jump to common_interrupt.
	 */
885 886
	.p2align CONFIG_X86_L1_CACHE_SHIFT
common_interrupt:
887
	XCPT_FRAME
888
	addq $-0x80,(%rsp)		/* Adjust vector to [-256,-1] range */
L
Linus Torvalds 已提交
889
	interrupt do_IRQ
890
	/* 0(%rsp): old_rsp-ARGOFFSET */
891
ret_from_intr:
892
	DISABLE_INTERRUPTS(CLBR_NONE)
893
	TRACE_IRQS_OFF
894
	decl PER_CPU_VAR(irq_count)
895

896 897
	/* Restore saved previous stack */
	popq %rsi
898
	CFI_DEF_CFA rsi,SS+8-RBP	/* reg/off reset after def_cfa_expr */
899
	leaq ARGOFFSET-RBP(%rsi), %rsp
900
	CFI_DEF_CFA_REGISTER	rsp
901
	CFI_ADJUST_CFA_OFFSET	RBP-ARGOFFSET
902

903
exit_intr:
L
Linus Torvalds 已提交
904 905 906
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
907

L
Linus Torvalds 已提交
908 909 910 911
	/* Interrupt came from user space */
	/*
	 * Has a correct top of stack, but a partial stack frame
	 * %rcx: thread info. Interrupts off.
912
	 */
L
Linus Torvalds 已提交
913 914
retint_with_reschedule:
	movl $_TIF_WORK_MASK,%edi
915
retint_check:
916
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
917
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
918
	andl %edi,%edx
919
	CFI_REMEMBER_STATE
L
Linus Torvalds 已提交
920
	jnz  retint_careful
921 922

retint_swapgs:		/* return to user-space */
923 924 925
	/*
	 * The iretq could re-enable interrupts:
	 */
926
	DISABLE_INTERRUPTS(CLBR_ANY)
927
	TRACE_IRQS_IRETQ
928
	SWAPGS
929 930
	jmp restore_args

931
retint_restore_args:	/* return to kernel space */
932
	DISABLE_INTERRUPTS(CLBR_ANY)
933 934 935 936 937
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
938
	RESTORE_ARGS 1,8,1
I
Ingo Molnar 已提交
939

A
Adrian Bunk 已提交
940
irq_return:
941
	INTERRUPT_RETURN
942
	_ASM_EXTABLE(irq_return, bad_iret)
I
Ingo Molnar 已提交
943 944

#ifdef CONFIG_PARAVIRT
945
ENTRY(native_iret)
L
Linus Torvalds 已提交
946
	iretq
947
	_ASM_EXTABLE(native_iret, bad_iret)
I
Ingo Molnar 已提交
948 949
#endif

L
Linus Torvalds 已提交
950 951
	.section .fixup,"ax"
bad_iret:
952 953 954 955 956 957 958 959 960 961 962 963 964 965 966
	/*
	 * 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

967 968
	.previous

969
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
970
retint_careful:
971
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
972 973
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
974
	TRACE_IRQS_ON
975
	ENABLE_INTERRUPTS(CLBR_NONE)
976
	pushq_cfi %rdi
L
Linus Torvalds 已提交
977
	call  schedule
978
	popq_cfi %rdi
L
Linus Torvalds 已提交
979
	GET_THREAD_INFO(%rcx)
980
	DISABLE_INTERRUPTS(CLBR_NONE)
981
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
982
	jmp retint_check
983

L
Linus Torvalds 已提交
984
retint_signal:
P
Peter Zijlstra 已提交
985
	testl $_TIF_DO_NOTIFY_MASK,%edx
986
	jz    retint_swapgs
987
	TRACE_IRQS_ON
988
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
989
	SAVE_REST
990
	movq $-1,ORIG_RAX(%rsp)
991
	xorl %esi,%esi		# oldset
L
Linus Torvalds 已提交
992 993 994
	movq %rsp,%rdi		# &pt_regs
	call do_notify_resume
	RESTORE_REST
995
	DISABLE_INTERRUPTS(CLBR_NONE)
996
	TRACE_IRQS_OFF
997
	GET_THREAD_INFO(%rcx)
R
Roland McGrath 已提交
998
	jmp retint_with_reschedule
L
Linus Torvalds 已提交
999 1000 1001 1002

#ifdef CONFIG_PREEMPT
	/* Returning to kernel space. Check if we need preemption */
	/* rcx:	 threadinfo. interrupts off. */
1003
ENTRY(retint_kernel)
G
Glauber Costa 已提交
1004
	cmpl $0,TI_preempt_count(%rcx)
L
Linus Torvalds 已提交
1005
	jnz  retint_restore_args
G
Glauber Costa 已提交
1006
	bt  $TIF_NEED_RESCHED,TI_flags(%rcx)
L
Linus Torvalds 已提交
1007 1008 1009 1010 1011
	jnc  retint_restore_args
	bt   $9,EFLAGS-ARGOFFSET(%rsp)	/* interrupts off? */
	jnc  retint_restore_args
	call preempt_schedule_irq
	jmp exit_intr
1012
#endif
1013

L
Linus Torvalds 已提交
1014
	CFI_ENDPROC
1015
END(common_interrupt)
1016 1017 1018 1019
/*
 * End of kprobes section
 */
       .popsection
1020

L
Linus Torvalds 已提交
1021 1022
/*
 * APIC interrupts.
1023
 */
1024 1025
.macro apicinterrupt num sym do_sym
ENTRY(\sym)
1026
	INTR_FRAME
1027
	pushq_cfi $~(\num)
1028
.Lcommon_\sym:
1029
	interrupt \do_sym
L
Linus Torvalds 已提交
1030 1031
	jmp ret_from_intr
	CFI_ENDPROC
1032 1033
END(\sym)
.endm
L
Linus Torvalds 已提交
1034

1035 1036 1037
#ifdef CONFIG_SMP
apicinterrupt IRQ_MOVE_CLEANUP_VECTOR \
	irq_move_cleanup_interrupt smp_irq_move_cleanup_interrupt
1038 1039
apicinterrupt REBOOT_VECTOR \
	reboot_interrupt smp_reboot_interrupt
1040
#endif
L
Linus Torvalds 已提交
1041

N
Nick Piggin 已提交
1042
#ifdef CONFIG_X86_UV
1043
apicinterrupt UV_BAU_MESSAGE \
1044
	uv_bau_message_intr1 uv_bau_message_interrupt
N
Nick Piggin 已提交
1045
#endif
1046 1047
apicinterrupt LOCAL_TIMER_VECTOR \
	apic_timer_interrupt smp_apic_timer_interrupt
1048 1049
apicinterrupt X86_PLATFORM_IPI_VECTOR \
	x86_platform_ipi smp_x86_platform_ipi
1050

1051
apicinterrupt THRESHOLD_APIC_VECTOR \
1052
	threshold_interrupt smp_threshold_interrupt
1053 1054
apicinterrupt THERMAL_APIC_VECTOR \
	thermal_interrupt smp_thermal_interrupt
1055

1056 1057 1058 1059 1060 1061 1062 1063
#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 已提交
1064

1065 1066 1067 1068
apicinterrupt ERROR_APIC_VECTOR \
	error_interrupt smp_error_interrupt
apicinterrupt SPURIOUS_APIC_VECTOR \
	spurious_interrupt smp_spurious_interrupt
1069

1070 1071 1072
#ifdef CONFIG_IRQ_WORK
apicinterrupt IRQ_WORK_VECTOR \
	irq_work_interrupt smp_irq_work_interrupt
I
Ingo Molnar 已提交
1073 1074
#endif

L
Linus Torvalds 已提交
1075 1076
/*
 * Exception entry points.
1077
 */
1078 1079
.macro zeroentry sym do_sym
ENTRY(\sym)
1080
	INTR_FRAME
1081
	PARAVIRT_ADJUST_EXCEPTION_FRAME
I
Ingo Molnar 已提交
1082
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1083 1084
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1085
	call error_entry
1086
	DEFAULT_FRAME 0
1087 1088
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1089
	call \do_sym
1090
	jmp error_exit		/* %ebx: no swapgs flag */
1091
	CFI_ENDPROC
1092 1093
END(\sym)
.endm
L
Linus Torvalds 已提交
1094

1095
.macro paranoidzeroentry sym do_sym
1096
ENTRY(\sym)
1097 1098
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1099 1100 1101
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1102 1103 1104 1105
	call save_paranoid
	TRACE_IRQS_OFF
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1106
	call \do_sym
1107 1108
	jmp paranoid_exit	/* %ebx: no swapgs flag */
	CFI_ENDPROC
1109
END(\sym)
1110
.endm
1111

1112
#define INIT_TSS_IST(x) PER_CPU_VAR(init_tss) + (TSS_ist + ((x) - 1) * 8)
1113
.macro paranoidzeroentry_ist sym do_sym ist
1114
ENTRY(\sym)
1115
	INTR_FRAME
1116
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1117 1118 1119
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1120
	call save_paranoid
1121
	TRACE_IRQS_OFF_DEBUG
1122 1123
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1124
	subq $EXCEPTION_STKSZ, INIT_TSS_IST(\ist)
1125
	call \do_sym
1126
	addq $EXCEPTION_STKSZ, INIT_TSS_IST(\ist)
1127 1128
	jmp paranoid_exit	/* %ebx: no swapgs flag */
	CFI_ENDPROC
1129
END(\sym)
1130
.endm
1131

1132
.macro errorentry sym do_sym
1133
ENTRY(\sym)
1134
	XCPT_FRAME
1135
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1136 1137
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1138
	call error_entry
1139
	DEFAULT_FRAME 0
1140 1141 1142
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1143
	call \do_sym
1144
	jmp error_exit			/* %ebx: no swapgs flag */
1145
	CFI_ENDPROC
1146 1147
END(\sym)
.endm
L
Linus Torvalds 已提交
1148 1149

	/* error code is on the stack already */
1150
.macro paranoiderrorentry sym do_sym
1151
ENTRY(\sym)
1152 1153
	XCPT_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1154 1155
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1156 1157
	call save_paranoid
	DEFAULT_FRAME 0
1158
	TRACE_IRQS_OFF
1159 1160 1161
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1162
	call \do_sym
1163 1164
	jmp paranoid_exit		/* %ebx: no swapgs flag */
	CFI_ENDPROC
1165 1166 1167 1168 1169 1170 1171 1172
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
1173
paranoiderrorentry double_fault do_double_fault
1174 1175 1176 1177 1178 1179 1180
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
1181

1182

1183 1184
	/* Reload gs selector with exception handling */
	/* edi:  new selector */
1185
ENTRY(native_load_gs_index)
1186
	CFI_STARTPROC
1187
	pushfq_cfi
1188
	DISABLE_INTERRUPTS(CLBR_ANY & ~CLBR_RDI)
1189
	SWAPGS
1190
gs_change:
1191
	movl %edi,%gs
L
Linus Torvalds 已提交
1192
2:	mfence		/* workaround */
1193
	SWAPGS
1194
	popfq_cfi
1195
	ret
1196
	CFI_ENDPROC
1197
END(native_load_gs_index)
1198

1199
	_ASM_EXTABLE(gs_change,bad_gs)
1200
	.section .fixup,"ax"
L
Linus Torvalds 已提交
1201
	/* running with kernelgs */
1202
bad_gs:
1203
	SWAPGS			/* switch back to user gs */
L
Linus Torvalds 已提交
1204
	xorl %eax,%eax
1205 1206 1207
	movl %eax,%gs
	jmp  2b
	.previous
1208

B
Brian Gerst 已提交
1209
ENTRY(kernel_thread_helper)
1210 1211
	pushq $0		# fake return address
	CFI_STARTPROC
L
Linus Torvalds 已提交
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.
	 */
B
Brian Gerst 已提交
1216
	call *%rsi
L
Linus Torvalds 已提交
1217
	# exit
1218
	mov %eax, %edi
L
Linus Torvalds 已提交
1219
	call do_exit
1220
	ud2			# padding for call trace
1221
	CFI_ENDPROC
B
Brian Gerst 已提交
1222
END(kernel_thread_helper)
L
Linus Torvalds 已提交
1223 1224 1225 1226 1227

/*
 * execve(). This function needs to use IRET, not SYSRET, to set up all state properly.
 *
 * C extern interface:
1228
 *	 extern long execve(const char *name, char **argv, char **envp)
L
Linus Torvalds 已提交
1229 1230 1231 1232 1233
 *
 * asm input arguments:
 *	rdi: name, rsi: argv, rdx: envp
 *
 * We want to fallback into:
1234
 *	extern long sys_execve(const char *name, char **argv,char **envp, struct pt_regs *regs)
L
Linus Torvalds 已提交
1235 1236
 *
 * do_sys_execve asm fallback arguments:
1237
 *	rdi: name, rsi: argv, rdx: envp, rcx: fake frame on the stack
L
Linus Torvalds 已提交
1238
 */
1239
ENTRY(kernel_execve)
L
Linus Torvalds 已提交
1240 1241
	CFI_STARTPROC
	FAKE_STACK_FRAME $0
1242
	SAVE_ALL
1243
	movq %rsp,%rcx
L
Linus Torvalds 已提交
1244
	call sys_execve
1245
	movq %rax, RAX(%rsp)
L
Linus Torvalds 已提交
1246 1247 1248 1249 1250 1251 1252
	RESTORE_REST
	testq %rax,%rax
	je int_ret_from_sys_call
	RESTORE_ARGS
	UNFAKE_STACK_FRAME
	ret
	CFI_ENDPROC
1253
END(kernel_execve)
L
Linus Torvalds 已提交
1254

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

1275
#ifdef CONFIG_XEN
1276
zeroentry xen_hypervisor_callback xen_do_hypervisor_callback
1277 1278

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

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

1372 1373 1374
apicinterrupt XEN_HVM_EVTCHN_CALLBACK \
	xen_hvm_callback_vector xen_evtchn_do_upcall

1375
#endif /* CONFIG_XEN */
1376 1377 1378 1379 1380 1381 1382 1383 1384

/*
 * 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
1385 1386 1387 1388 1389
#ifdef CONFIG_XEN
zeroentry xen_debug do_debug
zeroentry xen_int3 do_int3
errorentry xen_stack_segment do_stack_segment
#endif
1390 1391
errorentry general_protection do_general_protection
errorentry page_fault do_page_fault
G
Gleb Natapov 已提交
1392 1393 1394
#ifdef CONFIG_KVM_GUEST
errorentry async_page_fault do_async_page_fault
#endif
1395
#ifdef CONFIG_X86_MCE
1396
paranoidzeroentry machine_check *machine_check_vector(%rip)
1397 1398 1399
#endif

	/*
1400 1401
	 * "Paranoid" exit path from exception stack.
	 * Paranoid because this is used by NMIs and cannot take
1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413
	 * 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)
1414
	DEFAULT_FRAME
1415
	DISABLE_INTERRUPTS(CLBR_NONE)
1416
	TRACE_IRQS_OFF_DEBUG
1417 1418 1419 1420 1421 1422 1423
	testl %ebx,%ebx				/* swapgs needed? */
	jnz paranoid_restore
	testl $3,CS(%rsp)
	jnz   paranoid_userspace
paranoid_swapgs:
	TRACE_IRQS_IRETQ 0
	SWAPGS_UNSAFE_STACK
1424 1425
	RESTORE_ALL 8
	jmp irq_return
1426
paranoid_restore:
1427
	TRACE_IRQS_IRETQ_DEBUG 0
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 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503
	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

/*
 * 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
1504 1505 1506
	movl %ecx,%eax	/* zero extend */
	cmpq %rax,RIP+8(%rsp)
	je bstep_iret
1507
	cmpq $gs_change,RIP+8(%rsp)
1508
	je error_swapgs
1509
	jmp error_sti
1510 1511 1512 1513

bstep_iret:
	/* Fix truncated RIP */
	movq %rcx,RIP+8(%rsp)
B
Brian Gerst 已提交
1514
	jmp error_swapgs
1515
	CFI_ENDPROC
1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537
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)

1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548
/*
 * Test if a given stack is an NMI stack or not.
 */
	.macro test_in_nmi reg stack nmi_ret normal_ret
	cmpq %\reg, \stack
	ja \normal_ret
	subq $EXCEPTION_STKSZ, %\reg
	cmpq %\reg, \stack
	jb \normal_ret
	jmp \nmi_ret
	.endm
1549 1550 1551 1552 1553

	/* runs on exception stack */
ENTRY(nmi)
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587
	/*
	 * We allow breakpoints in NMIs. If a breakpoint occurs, then
	 * the iretq it performs will take us out of NMI context.
	 * This means that we can have nested NMIs where the next
	 * NMI is using the top of the stack of the previous NMI. We
	 * can't let it execute because the nested NMI will corrupt the
	 * stack of the previous NMI. NMI handlers are not re-entrant
	 * anyway.
	 *
	 * To handle this case we do the following:
	 *  Check the a special location on the stack that contains
	 *  a variable that is set when NMIs are executing.
	 *  The interrupted task's stack is also checked to see if it
	 *  is an NMI stack.
	 *  If the variable is not set and the stack is not the NMI
	 *  stack then:
	 *    o Set the special variable on the stack
	 *    o Copy the interrupt frame into a "saved" location on the stack
	 *    o Copy the interrupt frame into a "copy" location on the stack
	 *    o Continue processing the NMI
	 *  If the variable is set or the previous stack is the NMI stack:
	 *    o Modify the "copy" location to jump to the repeate_nmi
	 *    o return back to the first NMI
	 *
	 * Now on exit of the first NMI, we first clear the stack variable
	 * The NMI stack will tell any nested NMIs at that point that it is
	 * nested. Then we pop the stack normally with iret, and if there was
	 * a nested NMI that updated the copy interrupt stack frame, a
	 * jump will be made to the repeat_nmi code that will handle the second
	 * NMI.
	 */

	/* Use %rdx as out temp variable throughout */
	pushq_cfi %rdx
1588
	CFI_REL_OFFSET rdx, 0
1589

1590 1591 1592 1593
	/*
	 * If %cs was not the kernel segment, then the NMI triggered in user
	 * space, which means it is definitely not nested.
	 */
1594
	cmpl $__KERNEL_CS, 16(%rsp)
1595 1596
	jne first_nmi

1597 1598 1599 1600
	/*
	 * Check the special variable on the stack to see if NMIs are
	 * executing.
	 */
1601
	cmpl $1, -8(%rsp)
1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612
	je nested_nmi

	/*
	 * Now test if the previous stack was an NMI stack.
	 * We need the double check. We check the NMI stack to satisfy the
	 * race when the first NMI clears the variable before returning.
	 * We check the variable because the first NMI could be in a
	 * breakpoint routine using a breakpoint stack.
	 */
	lea 6*8(%rsp), %rdx
	test_in_nmi rdx, 4*8(%rsp), nested_nmi, first_nmi
1613
	CFI_REMEMBER_STATE
1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644

nested_nmi:
	/*
	 * Do nothing if we interrupted the fixup in repeat_nmi.
	 * It's about to repeat the NMI handler, so we are fine
	 * with ignoring this one.
	 */
	movq $repeat_nmi, %rdx
	cmpq 8(%rsp), %rdx
	ja 1f
	movq $end_repeat_nmi, %rdx
	cmpq 8(%rsp), %rdx
	ja nested_nmi_out

1:
	/* Set up the interrupted NMIs stack to jump to repeat_nmi */
	leaq -6*8(%rsp), %rdx
	movq %rdx, %rsp
	CFI_ADJUST_CFA_OFFSET 6*8
	pushq_cfi $__KERNEL_DS
	pushq_cfi %rdx
	pushfq_cfi
	pushq_cfi $__KERNEL_CS
	pushq_cfi $repeat_nmi

	/* Put stack back */
	addq $(11*8), %rsp
	CFI_ADJUST_CFA_OFFSET -11*8

nested_nmi_out:
	popq_cfi %rdx
1645
	CFI_RESTORE rdx
1646 1647 1648 1649

	/* No need to check faults here */
	INTERRUPT_RETURN

1650
	CFI_RESTORE_STATE
1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681
first_nmi:
	/*
	 * Because nested NMIs will use the pushed location that we
	 * stored in rdx, we must keep that space available.
	 * Here's what our stack frame will look like:
	 * +-------------------------+
	 * | original SS             |
	 * | original Return RSP     |
	 * | original RFLAGS         |
	 * | original CS             |
	 * | original RIP            |
	 * +-------------------------+
	 * | temp storage for rdx    |
	 * +-------------------------+
	 * | NMI executing variable  |
	 * +-------------------------+
	 * | Saved SS                |
	 * | Saved Return RSP        |
	 * | Saved RFLAGS            |
	 * | Saved CS                |
	 * | Saved RIP               |
	 * +-------------------------+
	 * | copied SS               |
	 * | copied Return RSP       |
	 * | copied RFLAGS           |
	 * | copied CS               |
	 * | copied RIP              |
	 * +-------------------------+
	 * | pt_regs                 |
	 * +-------------------------+
	 *
1682 1683 1684
	 * The saved stack frame is used to fix up the copied stack frame
	 * that a nested NMI may change to make the interrupted NMI iret jump
	 * to the repeat_nmi. The original stack frame and the temp storage
1685 1686
	 * is also used by nested NMIs and can not be trusted on exit.
	 */
1687
	/* Do not pop rdx, nested NMIs will corrupt that part of the stack */
1688 1689 1690
	movq (%rsp), %rdx
	CFI_RESTORE rdx

1691 1692 1693 1694 1695 1696 1697
	/* Set the NMI executing variable on the stack. */
	pushq_cfi $1

	/* Copy the stack frame to the Saved frame */
	.rept 5
	pushq_cfi 6*8(%rsp)
	.endr
1698 1699
	CFI_DEF_CFA_OFFSET SS+8-RIP

1700 1701
	/* Everything up to here is safe from nested NMIs */

1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717
	/*
	 * If there was a nested NMI, the first NMI's iret will return
	 * here. But NMIs are still enabled and we can take another
	 * nested NMI. The nested NMI checks the interrupted RIP to see
	 * if it is between repeat_nmi and end_repeat_nmi, and if so
	 * it will just return, as we are about to repeat an NMI anyway.
	 * This makes it safe to copy to the stack frame that a nested
	 * NMI will update.
	 */
repeat_nmi:
	/*
	 * Update the stack variable to say we are still in NMI (the update
	 * is benign for the non-repeat case, where 1 was pushed just above
	 * to this very stack slot).
	 */
	movq $1, 5*8(%rsp)
1718 1719 1720 1721 1722

	/* Make another copy, this one may be modified by nested NMIs */
	.rept 5
	pushq_cfi 4*8(%rsp)
	.endr
1723 1724
	CFI_DEF_CFA_OFFSET SS+8-RIP
end_repeat_nmi:
1725 1726 1727

	/*
	 * Everything below this point can be preempted by a nested
1728 1729
	 * NMI if the first NMI took an exception and reset our iret stack
	 * so that we repeat another NMI.
1730
	 */
1731
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1732 1733
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1734 1735 1736 1737 1738 1739 1740
	/*
	 * Use save_paranoid to handle SWAPGS, but no need to use paranoid_exit
	 * as we should not be calling schedule in NMI context.
	 * Even with normal interrupts enabled. An NMI should not be
	 * setting NEED_RESCHED or anything that normal interrupts and
	 * exceptions might do.
	 */
1741 1742
	call save_paranoid
	DEFAULT_FRAME 0
1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754

	/*
	 * Save off the CR2 register. If we take a page fault in the NMI then
	 * it could corrupt the CR2 value. If the NMI preempts a page fault
	 * handler before it was able to read the CR2 register, and then the
	 * NMI itself takes a page fault, the page fault that was preempted
	 * will read the information from the NMI page fault and not the
	 * origin fault. Save it off and restore it if it changes.
	 * Use the r12 callee-saved register.
	 */
	movq %cr2, %r12

1755 1756 1757 1758
	/* paranoidentry do_nmi, 0; without TRACE_IRQS_OFF */
	movq %rsp,%rdi
	movq $-1,%rsi
	call do_nmi
1759 1760 1761 1762 1763 1764 1765 1766

	/* Did the NMI take a page fault? Restore cr2 if it did */
	movq %cr2, %rcx
	cmpq %rcx, %r12
	je 1f
	movq %r12, %cr2
1:
	
1767 1768 1769 1770 1771 1772
	testl %ebx,%ebx				/* swapgs needed? */
	jnz nmi_restore
nmi_swapgs:
	SWAPGS_UNSAFE_STACK
nmi_restore:
	RESTORE_ALL 8
1773 1774
	/* Clear the NMI executing stack variable */
	movq $0, 10*8(%rsp)
1775
	jmp irq_return
1776
	CFI_ENDPROC
1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789
END(nmi)

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

/*
 * End of kprobes section
 */
	.popsection