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 <asm/rcu.h>
60
#include <linux/err.h>
L
Linus Torvalds 已提交
61

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

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

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

81
	MCOUNT_SAVE_FRAME
82 83 84

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

87
GLOBAL(ftrace_call)
88 89
	call ftrace_stub

90
	MCOUNT_RESTORE_FRAME
91

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

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

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

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

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

	cmpq $ftrace_graph_entry_stub, ftrace_graph_entry
	jnz ftrace_graph_caller
115 116
#endif

117
GLOBAL(ftrace_stub)
118 119 120
	retq

trace:
121
	MCOUNT_SAVE_FRAME
122 123 124

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

	call   *ftrace_trace_function

129
	MCOUNT_RESTORE_FRAME
130 131 132

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

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

141
	MCOUNT_SAVE_FRAME
142 143 144

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

	call	prepare_ftrace_return

150 151
	MCOUNT_RESTORE_FRAME

152 153 154
	retq
END(ftrace_graph_caller)

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

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

163
	call ftrace_return_to_handler
164

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


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

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

184 185 186 187 188 189 190 191 192 193

.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

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

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

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

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

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

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

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

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

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

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

/* save partial stack frame */
343
	.macro SAVE_ARGS_IRQ
344
	cld
345 346 347 348 349 350 351 352 353 354 355
	/* 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

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

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

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

376
	/* Store previous stack value */
377
	pushq %rsi
378 379 380 381 382
	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 */
383 384
	/* We entered an interrupt context - irqs are off: */
	TRACE_IRQS_OFF
385
	.endm
386

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

402
/* save complete stack frame */
403
	.pushsection .kprobes.text, "ax"
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 431
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)
432
	.popsection
433

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

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

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

	call schedule_tail			# rdi: 'prev' task parameter

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

L
Linus Torvalds 已提交
451
	RESTORE_REST
452 453

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

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

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

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

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

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

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

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

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

573
	/* Handle a signal */
L
Linus Torvalds 已提交
574
sysret_signal:
575
	TRACE_IRQS_ON
576
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
577 578 579 580
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
581 582 583 584 585 586 587
	/*
	 * 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
588

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

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

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

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

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

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

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

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

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

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

788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804
#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 已提交
805 806 807 808 809 810 811 812 813 814 815 816 817 818 819
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)

820 821
#endif

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

.previous
END(interrupt)
.previous

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

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

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

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

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

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

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

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

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

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

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

968 969
	.previous

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

1183

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

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

B
Brian Gerst 已提交
1210
ENTRY(kernel_thread_helper)
1211 1212
	pushq $0		# fake return address
	CFI_STARTPROC
L
Linus Torvalds 已提交
1213 1214 1215 1216
	/*
	 * Here we are in the child and the registers are set as they were
	 * at kernel_thread() invocation in the parent.
	 */
B
Brian Gerst 已提交
1217
	call *%rsi
L
Linus Torvalds 已提交
1218
	# exit
1219
	mov %eax, %edi
L
Linus Torvalds 已提交
1220
	call do_exit
1221
	ud2			# padding for call trace
1222
	CFI_ENDPROC
B
Brian Gerst 已提交
1223
END(kernel_thread_helper)
L
Linus Torvalds 已提交
1224 1225 1226 1227 1228

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

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

1276
#ifdef CONFIG_XEN
1277
zeroentry xen_hypervisor_callback xen_do_hypervisor_callback
1278 1279

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

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

1373 1374 1375
apicinterrupt XEN_HVM_EVTCHN_CALLBACK \
	xen_hvm_callback_vector xen_evtchn_do_upcall

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

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

	/*
1401 1402
	 * "Paranoid" exit path from exception stack.
	 * Paranoid because this is used by NMIs and cannot take
1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414
	 * 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)
1415
	DEFAULT_FRAME
1416
	DISABLE_INTERRUPTS(CLBR_NONE)
1417
	TRACE_IRQS_OFF_DEBUG
1418 1419 1420 1421 1422 1423 1424
	testl %ebx,%ebx				/* swapgs needed? */
	jnz paranoid_restore
	testl $3,CS(%rsp)
	jnz   paranoid_userspace
paranoid_swapgs:
	TRACE_IRQS_IRETQ 0
	SWAPGS_UNSAFE_STACK
1425 1426
	RESTORE_ALL 8
	jmp irq_return
1427
paranoid_restore:
1428
	TRACE_IRQS_IRETQ_DEBUG 0
1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452
	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)
1453
	SCHEDULE_USER
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 1504
	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
1505 1506 1507
	movl %ecx,%eax	/* zero extend */
	cmpq %rax,RIP+8(%rsp)
	je bstep_iret
1508
	cmpq $gs_change,RIP+8(%rsp)
1509
	je error_swapgs
1510
	jmp error_sti
1511 1512 1513 1514

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

1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549
/*
 * 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
1550 1551 1552 1553 1554

	/* runs on exception stack */
ENTRY(nmi)
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
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 1588
	/*
	 * 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
1589
	CFI_REL_OFFSET rdx, 0
1590

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

1598 1599 1600 1601
	/*
	 * Check the special variable on the stack to see if NMIs are
	 * executing.
	 */
1602
	cmpl $1, -8(%rsp)
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613
	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
1614
	CFI_REMEMBER_STATE
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 1645

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
1646
	CFI_RESTORE rdx
1647 1648 1649 1650

	/* No need to check faults here */
	INTERRUPT_RETURN

1651
	CFI_RESTORE_STATE
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 1682
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                 |
	 * +-------------------------+
	 *
1683 1684 1685
	 * 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
1686 1687
	 * is also used by nested NMIs and can not be trusted on exit.
	 */
1688
	/* Do not pop rdx, nested NMIs will corrupt that part of the stack */
1689 1690 1691
	movq (%rsp), %rdx
	CFI_RESTORE rdx

1692 1693 1694 1695 1696 1697 1698
	/* 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
1699 1700
	CFI_DEF_CFA_OFFSET SS+8-RIP

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

1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718
	/*
	 * 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)
1719 1720 1721 1722 1723

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

	/*
	 * Everything below this point can be preempted by a nested
1729 1730
	 * NMI if the first NMI took an exception and reset our iret stack
	 * so that we repeat another NMI.
1731
	 */
1732
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1733 1734
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1735 1736 1737 1738 1739 1740 1741
	/*
	 * 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.
	 */
1742 1743
	call save_paranoid
	DEFAULT_FRAME 0
1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755

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

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

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

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

/*
 * End of kprobes section
 */
	.popsection