entry_64.S 43.8 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?
A
Al Viro 已提交
453
	jz   1f
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

A
Al Viro 已提交
461
1:
462
	subq $REST_SKIP, %rsp	# leave space for volatiles
A
Al Viro 已提交
463 464 465
	CFI_ADJUST_CFA_OFFSET	REST_SKIP
	movq %rbp, %rdi
	call *%rbx
466 467 468
	movl $0, RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
L
Linus Torvalds 已提交
469
	CFI_ENDPROC
470
END(ret_from_fork)
L
Linus Torvalds 已提交
471 472

/*
L
Lucas De Marchi 已提交
473
 * System call entry. Up to 6 arguments in registers are supported.
L
Linus Torvalds 已提交
474 475 476 477
 *
 * SYSCALL does not save anything on the stack and does not change the
 * stack pointer.
 */
478

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

ENTRY(system_call)
504
	CFI_STARTPROC	simple
505
	CFI_SIGNAL_FRAME
506
	CFI_DEF_CFA	rsp,KERNEL_STACK_OFFSET
507 508
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
509 510 511 512 513 514
	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.
	 */
515
GLOBAL(system_call_after_swapgs)
516

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

567
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
568
	/* Handle reschedules */
569
	/* edx:	work, edi: workmask */
L
Linus Torvalds 已提交
570 571 572
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
573
	TRACE_IRQS_ON
574
	ENABLE_INTERRUPTS(CLBR_NONE)
575
	pushq_cfi %rdi
L
Linus Torvalds 已提交
576
	call schedule
577
	popq_cfi %rdi
L
Linus Torvalds 已提交
578 579
	jmp sysret_check

580
	/* Handle a signal */
L
Linus Torvalds 已提交
581
sysret_signal:
582
	TRACE_IRQS_ON
583
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
584 585 586 587
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
588 589 590 591 592 593 594
	/*
	 * 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
595

596 597 598 599
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

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

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

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

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

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

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

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

L
Linus Torvalds 已提交
762 763
ENTRY(stub_execve)
	CFI_STARTPROC
764 765
	addq $8, %rsp
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
766 767 768 769 770 771 772 773
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
	call sys_execve
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
774
END(stub_execve)
775

L
Linus Torvalds 已提交
776 777 778
/*
 * 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.
779
 */
L
Linus Torvalds 已提交
780 781
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
782
	addq $8, %rsp
783
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
784 785 786 787 788 789 790 791
	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
792
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
793

794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810
#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 已提交
811 812 813 814 815 816
ENTRY(stub_x32_execve)
	CFI_STARTPROC
	addq $8, %rsp
	PARTIAL_FRAME 0
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
817
	call compat_sys_execve
H
H. Peter Anvin 已提交
818 819 820 821 822 823 824
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
END(stub_x32_execve)

825 826
#endif

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

.previous
END(interrupt)
.previous

866
/*
L
Linus Torvalds 已提交
867 868 869
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
870 871 872
 *
 * Entry runs with interrupts off.
 */
L
Linus Torvalds 已提交
873

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

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

902 903
	/* Restore saved previous stack */
	popq %rsi
904
	CFI_DEF_CFA rsi,SS+8-RBP	/* reg/off reset after def_cfa_expr */
905
	leaq ARGOFFSET-RBP(%rsi), %rsp
906
	CFI_DEF_CFA_REGISTER	rsp
907
	CFI_ADJUST_CFA_OFFSET	RBP-ARGOFFSET
908

909
exit_intr:
L
Linus Torvalds 已提交
910 911 912
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
913

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

retint_swapgs:		/* return to user-space */
929 930 931
	/*
	 * The iretq could re-enable interrupts:
	 */
932
	DISABLE_INTERRUPTS(CLBR_ANY)
933
	TRACE_IRQS_IRETQ
934
	SWAPGS
935 936
	jmp restore_args

937
retint_restore_args:	/* return to kernel space */
938
	DISABLE_INTERRUPTS(CLBR_ANY)
939 940 941 942 943
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
944
	RESTORE_ARGS 1,8,1
I
Ingo Molnar 已提交
945

A
Adrian Bunk 已提交
946
irq_return:
947
	INTERRUPT_RETURN
948
	_ASM_EXTABLE(irq_return, bad_iret)
I
Ingo Molnar 已提交
949 950

#ifdef CONFIG_PARAVIRT
951
ENTRY(native_iret)
L
Linus Torvalds 已提交
952
	iretq
953
	_ASM_EXTABLE(native_iret, bad_iret)
I
Ingo Molnar 已提交
954 955
#endif

L
Linus Torvalds 已提交
956 957
	.section .fixup,"ax"
bad_iret:
958 959 960 961 962 963 964 965 966 967 968 969 970 971 972
	/*
	 * 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

973 974
	.previous

975
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
976
retint_careful:
977
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
978 979
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
980
	TRACE_IRQS_ON
981
	ENABLE_INTERRUPTS(CLBR_NONE)
982
	pushq_cfi %rdi
L
Linus Torvalds 已提交
983
	call  schedule
984
	popq_cfi %rdi
L
Linus Torvalds 已提交
985
	GET_THREAD_INFO(%rcx)
986
	DISABLE_INTERRUPTS(CLBR_NONE)
987
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
988
	jmp retint_check
989

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

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

L
Linus Torvalds 已提交
1020
	CFI_ENDPROC
1021
END(common_interrupt)
1022 1023 1024 1025
/*
 * End of kprobes section
 */
       .popsection
1026

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

1041 1042 1043
#ifdef CONFIG_SMP
apicinterrupt IRQ_MOVE_CLEANUP_VECTOR \
	irq_move_cleanup_interrupt smp_irq_move_cleanup_interrupt
1044 1045
apicinterrupt REBOOT_VECTOR \
	reboot_interrupt smp_reboot_interrupt
1046
#endif
L
Linus Torvalds 已提交
1047

N
Nick Piggin 已提交
1048
#ifdef CONFIG_X86_UV
1049
apicinterrupt UV_BAU_MESSAGE \
1050
	uv_bau_message_intr1 uv_bau_message_interrupt
N
Nick Piggin 已提交
1051
#endif
1052 1053
apicinterrupt LOCAL_TIMER_VECTOR \
	apic_timer_interrupt smp_apic_timer_interrupt
1054 1055
apicinterrupt X86_PLATFORM_IPI_VECTOR \
	x86_platform_ipi smp_x86_platform_ipi
1056

1057
apicinterrupt THRESHOLD_APIC_VECTOR \
1058
	threshold_interrupt smp_threshold_interrupt
1059 1060
apicinterrupt THERMAL_APIC_VECTOR \
	thermal_interrupt smp_thermal_interrupt
1061

1062 1063 1064 1065 1066 1067 1068 1069
#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 已提交
1070

1071 1072 1073 1074
apicinterrupt ERROR_APIC_VECTOR \
	error_interrupt smp_error_interrupt
apicinterrupt SPURIOUS_APIC_VECTOR \
	spurious_interrupt smp_spurious_interrupt
1075

1076 1077 1078
#ifdef CONFIG_IRQ_WORK
apicinterrupt IRQ_WORK_VECTOR \
	irq_work_interrupt smp_irq_work_interrupt
I
Ingo Molnar 已提交
1079 1080
#endif

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

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

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

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

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

1188

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

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

1215
/* Call softirq on interrupt stack. Interrupts are off. */
1216
ENTRY(call_softirq)
1217
	CFI_STARTPROC
1218
	pushq_cfi %rbp
1219 1220 1221
	CFI_REL_OFFSET rbp,0
	mov  %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1222
	incl PER_CPU_VAR(irq_count)
1223
	cmove PER_CPU_VAR(irq_stack_ptr),%rsp
1224
	push  %rbp			# backlink for old unwinder
1225
	call __do_softirq
1226
	leaveq
1227
	CFI_RESTORE		rbp
1228
	CFI_DEF_CFA_REGISTER	rsp
1229
	CFI_ADJUST_CFA_OFFSET   -8
1230
	decl PER_CPU_VAR(irq_count)
1231
	ret
1232
	CFI_ENDPROC
1233
END(call_softirq)
1234

1235
#ifdef CONFIG_XEN
1236
zeroentry xen_hypervisor_callback xen_do_hypervisor_callback
1237 1238

/*
1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250
 * 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.
 */
1251 1252
ENTRY(xen_do_hypervisor_callback)   # do_hypervisor_callback(struct *pt_regs)
	CFI_STARTPROC
1253 1254 1255 1256
/*
 * Since we don't modify %rdi, evtchn_do_upall(struct *pt_regs) will
 * see the correct pointer to the pt_regs
 */
1257 1258
	movq %rdi, %rsp            # we don't return, adjust the stack frame
	CFI_ENDPROC
1259
	DEFAULT_FRAME
1260
11:	incl PER_CPU_VAR(irq_count)
1261 1262
	movq %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1263
	cmovzq PER_CPU_VAR(irq_stack_ptr),%rsp
1264 1265 1266 1267
	pushq %rbp			# backlink for old unwinder
	call xen_evtchn_do_upcall
	popq %rsp
	CFI_DEF_CFA_REGISTER rsp
1268
	decl PER_CPU_VAR(irq_count)
1269 1270
	jmp  error_exit
	CFI_ENDPROC
1271
END(xen_do_hypervisor_callback)
1272 1273

/*
1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285
 * 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.
 */
1286
ENTRY(xen_failsafe_callback)
1287 1288 1289 1290 1291 1292 1293
	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
1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313
	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 已提交
1314 1315 1316
	pushq_cfi $0	/* RIP */
	pushq_cfi %r11
	pushq_cfi %rcx
1317
	jmp general_protection
1318 1319 1320 1321 1322 1323 1324 1325
	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 已提交
1326
	pushq_cfi $0
1327 1328 1329 1330 1331
	SAVE_ALL
	jmp error_exit
	CFI_ENDPROC
END(xen_failsafe_callback)

1332 1333 1334
apicinterrupt XEN_HVM_EVTCHN_CALLBACK \
	xen_hvm_callback_vector xen_evtchn_do_upcall

1335
#endif /* CONFIG_XEN */
1336 1337 1338 1339 1340 1341 1342 1343 1344

/*
 * 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
1345 1346 1347 1348 1349
#ifdef CONFIG_XEN
zeroentry xen_debug do_debug
zeroentry xen_int3 do_int3
errorentry xen_stack_segment do_stack_segment
#endif
1350 1351
errorentry general_protection do_general_protection
errorentry page_fault do_page_fault
G
Gleb Natapov 已提交
1352 1353 1354
#ifdef CONFIG_KVM_GUEST
errorentry async_page_fault do_async_page_fault
#endif
1355
#ifdef CONFIG_X86_MCE
1356
paranoidzeroentry machine_check *machine_check_vector(%rip)
1357 1358 1359
#endif

	/*
1360 1361
	 * "Paranoid" exit path from exception stack.
	 * Paranoid because this is used by NMIs and cannot take
1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
	 * 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)
1374
	DEFAULT_FRAME
1375
	DISABLE_INTERRUPTS(CLBR_NONE)
1376
	TRACE_IRQS_OFF_DEBUG
1377 1378 1379 1380 1381 1382 1383
	testl %ebx,%ebx				/* swapgs needed? */
	jnz paranoid_restore
	testl $3,CS(%rsp)
	jnz   paranoid_userspace
paranoid_swapgs:
	TRACE_IRQS_IRETQ 0
	SWAPGS_UNSAFE_STACK
1384 1385
	RESTORE_ALL 8
	jmp irq_return
1386
paranoid_restore:
1387
	TRACE_IRQS_IRETQ_DEBUG 0
1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463
	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
1464 1465 1466
	movl %ecx,%eax	/* zero extend */
	cmpq %rax,RIP+8(%rsp)
	je bstep_iret
1467
	cmpq $gs_change,RIP+8(%rsp)
1468
	je error_swapgs
1469
	jmp error_sti
1470 1471 1472 1473

bstep_iret:
	/* Fix truncated RIP */
	movq %rcx,RIP+8(%rsp)
B
Brian Gerst 已提交
1474
	jmp error_swapgs
1475
	CFI_ENDPROC
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497
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)

1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508
/*
 * 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
1509 1510 1511 1512 1513

	/* runs on exception stack */
ENTRY(nmi)
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547
	/*
	 * 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
1548
	CFI_REL_OFFSET rdx, 0
1549

1550 1551 1552 1553
	/*
	 * If %cs was not the kernel segment, then the NMI triggered in user
	 * space, which means it is definitely not nested.
	 */
1554
	cmpl $__KERNEL_CS, 16(%rsp)
1555 1556
	jne first_nmi

1557 1558 1559 1560
	/*
	 * Check the special variable on the stack to see if NMIs are
	 * executing.
	 */
1561
	cmpl $1, -8(%rsp)
1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572
	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
1573
	CFI_REMEMBER_STATE
1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604

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
1605
	CFI_RESTORE rdx
1606 1607 1608 1609

	/* No need to check faults here */
	INTERRUPT_RETURN

1610
	CFI_RESTORE_STATE
1611 1612 1613 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
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                 |
	 * +-------------------------+
	 *
1642 1643 1644
	 * 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
1645 1646
	 * is also used by nested NMIs and can not be trusted on exit.
	 */
1647
	/* Do not pop rdx, nested NMIs will corrupt that part of the stack */
1648 1649 1650
	movq (%rsp), %rdx
	CFI_RESTORE rdx

1651 1652 1653 1654 1655 1656 1657
	/* 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
1658 1659
	CFI_DEF_CFA_OFFSET SS+8-RIP

1660 1661
	/* Everything up to here is safe from nested NMIs */

1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677
	/*
	 * 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)
1678 1679 1680 1681 1682

	/* Make another copy, this one may be modified by nested NMIs */
	.rept 5
	pushq_cfi 4*8(%rsp)
	.endr
1683 1684
	CFI_DEF_CFA_OFFSET SS+8-RIP
end_repeat_nmi:
1685 1686 1687

	/*
	 * Everything below this point can be preempted by a nested
1688 1689
	 * NMI if the first NMI took an exception and reset our iret stack
	 * so that we repeat another NMI.
1690
	 */
1691
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1692 1693
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1694 1695 1696 1697 1698 1699 1700
	/*
	 * 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.
	 */
1701 1702
	call save_paranoid
	DEFAULT_FRAME 0
1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714

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

1715 1716 1717 1718
	/* paranoidentry do_nmi, 0; without TRACE_IRQS_OFF */
	movq %rsp,%rdi
	movq $-1,%rsi
	call do_nmi
1719 1720 1721 1722 1723 1724 1725 1726

	/* Did the NMI take a page fault? Restore cr2 if it did */
	movq %cr2, %rcx
	cmpq %rcx, %r12
	je 1f
	movq %r12, %cr2
1:
	
1727 1728 1729 1730 1731 1732
	testl %ebx,%ebx				/* swapgs needed? */
	jnz nmi_restore
nmi_swapgs:
	SWAPGS_UNSAFE_STACK
nmi_restore:
	RESTORE_ALL 8
1733 1734
	/* Clear the NMI executing stack variable */
	movq $0, 10*8(%rsp)
1735
	jmp irq_return
1736
	CFI_ENDPROC
1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749
END(nmi)

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

/*
 * End of kprobes section
 */
	.popsection