entry_64.S 46.5 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/context_tracking.h>
60
#include <asm/smap.h>
61
#include <linux/err.h>
L
Linus Torvalds 已提交
62

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

72
#ifdef CONFIG_FUNCTION_TRACER
73 74 75 76 77 78 79

#ifdef CC_USING_FENTRY
# define function_hook	__fentry__
#else
# define function_hook	mcount
#endif

80
#ifdef CONFIG_DYNAMIC_FTRACE
81 82

ENTRY(function_hook)
83
	retq
84
END(function_hook)
85

86 87 88 89 90 91 92 93 94 95 96
/* skip is set if stack has been adjusted */
.macro ftrace_caller_setup skip=0
	MCOUNT_SAVE_FRAME \skip

	/* Load the ftrace_ops into the 3rd parameter */
	leaq function_trace_op, %rdx

	/* Load ip into the first parameter */
	movq RIP(%rsp), %rdi
	subq $MCOUNT_INSN_SIZE, %rdi
	/* Load the parent_ip into the second parameter */
97 98 99
#ifdef CC_USING_FENTRY
	movq SS+16(%rsp), %rsi
#else
100
	movq 8(%rbp), %rsi
101
#endif
102
.endm
103 104

ENTRY(ftrace_caller)
105
	/* Check if tracing was disabled (quick check) */
106 107
	cmpl $0, function_trace_stop
	jne  ftrace_stub
108

109 110 111
	ftrace_caller_setup
	/* regs go into 4th parameter (but make it NULL) */
	movq $0, %rcx
112

113
GLOBAL(ftrace_call)
114 115
	call ftrace_stub

116
	MCOUNT_RESTORE_FRAME
117
ftrace_return:
118

119
#ifdef CONFIG_FUNCTION_GRAPH_TRACER
120
GLOBAL(ftrace_graph_call)
121 122
	jmp ftrace_stub
#endif
123

124
GLOBAL(ftrace_stub)
125 126 127
	retq
END(ftrace_caller)

128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169
ENTRY(ftrace_regs_caller)
	/* Save the current flags before compare (in SS location)*/
	pushfq

	/* Check if tracing was disabled (quick check) */
	cmpl $0, function_trace_stop
	jne  ftrace_restore_flags

	/* skip=8 to skip flags saved in SS */
	ftrace_caller_setup 8

	/* Save the rest of pt_regs */
	movq %r15, R15(%rsp)
	movq %r14, R14(%rsp)
	movq %r13, R13(%rsp)
	movq %r12, R12(%rsp)
	movq %r11, R11(%rsp)
	movq %r10, R10(%rsp)
	movq %rbp, RBP(%rsp)
	movq %rbx, RBX(%rsp)
	/* Copy saved flags */
	movq SS(%rsp), %rcx
	movq %rcx, EFLAGS(%rsp)
	/* Kernel segments */
	movq $__KERNEL_DS, %rcx
	movq %rcx, SS(%rsp)
	movq $__KERNEL_CS, %rcx
	movq %rcx, CS(%rsp)
	/* Stack - skipping return address */
	leaq SS+16(%rsp), %rcx
	movq %rcx, RSP(%rsp)

	/* regs go into 4th parameter */
	leaq (%rsp), %rcx

GLOBAL(ftrace_regs_call)
	call ftrace_stub

	/* Copy flags back to SS, to restore them */
	movq EFLAGS(%rsp), %rax
	movq %rax, SS(%rsp)

170 171 172 173
	/* Handlers can change the RIP */
	movq RIP(%rsp), %rax
	movq %rax, SS+8(%rsp)

174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196
	/* restore the rest of pt_regs */
	movq R15(%rsp), %r15
	movq R14(%rsp), %r14
	movq R13(%rsp), %r13
	movq R12(%rsp), %r12
	movq R10(%rsp), %r10
	movq RBP(%rsp), %rbp
	movq RBX(%rsp), %rbx

	/* skip=8 to skip flags saved in SS */
	MCOUNT_RESTORE_FRAME 8

	/* Restore flags */
	popfq

	jmp ftrace_return
ftrace_restore_flags:
	popfq
	jmp  ftrace_stub

END(ftrace_regs_caller)


197
#else /* ! CONFIG_DYNAMIC_FTRACE */
198 199

ENTRY(function_hook)
200 201 202
	cmpl $0, function_trace_stop
	jne  ftrace_stub

203 204
	cmpq $ftrace_stub, ftrace_trace_function
	jnz trace
205 206 207 208

#ifdef CONFIG_FUNCTION_GRAPH_TRACER
	cmpq $ftrace_stub, ftrace_graph_return
	jnz ftrace_graph_caller
209 210 211

	cmpq $ftrace_graph_entry_stub, ftrace_graph_entry
	jnz ftrace_graph_caller
212 213
#endif

214
GLOBAL(ftrace_stub)
215 216 217
	retq

trace:
218
	MCOUNT_SAVE_FRAME
219

220
	movq RIP(%rsp), %rdi
221 222 223
#ifdef CC_USING_FENTRY
	movq SS+16(%rsp), %rsi
#else
224
	movq 8(%rbp), %rsi
225
#endif
226
	subq $MCOUNT_INSN_SIZE, %rdi
227 228 229

	call   *ftrace_trace_function

230
	MCOUNT_RESTORE_FRAME
231 232

	jmp ftrace_stub
233
END(function_hook)
234
#endif /* CONFIG_DYNAMIC_FTRACE */
235
#endif /* CONFIG_FUNCTION_TRACER */
236

237 238
#ifdef CONFIG_FUNCTION_GRAPH_TRACER
ENTRY(ftrace_graph_caller)
239
	MCOUNT_SAVE_FRAME
240

241 242 243 244
#ifdef CC_USING_FENTRY
	leaq SS+16(%rsp), %rdi
	movq $0, %rdx	/* No framepointers needed */
#else
245
	leaq 8(%rbp), %rdi
246
	movq (%rbp), %rdx
247 248
#endif
	movq RIP(%rsp), %rsi
249
	subq $MCOUNT_INSN_SIZE, %rsi
250 251 252

	call	prepare_ftrace_return

253 254
	MCOUNT_RESTORE_FRAME

255 256 257
	retq
END(ftrace_graph_caller)

258
GLOBAL(return_to_handler)
259
	subq  $24, %rsp
260

261
	/* Save the return values */
262
	movq %rax, (%rsp)
263
	movq %rdx, 8(%rsp)
264
	movq %rbp, %rdi
265

266
	call ftrace_return_to_handler
267

268
	movq %rax, %rdi
269
	movq 8(%rsp), %rdx
270
	movq (%rsp), %rax
271 272
	addq $24, %rsp
	jmp *%rdi
273
#endif
274 275


276
#ifndef CONFIG_PREEMPT
L
Linus Torvalds 已提交
277
#define retint_kernel retint_restore_args
278
#endif
279

280
#ifdef CONFIG_PARAVIRT
281
ENTRY(native_usergs_sysret64)
282 283
	swapgs
	sysretq
284
ENDPROC(native_usergs_sysret64)
285 286
#endif /* CONFIG_PARAVIRT */

287 288 289 290 291 292 293 294 295 296

.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

297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334
/*
 * 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 已提交
335
/*
336 337
 * 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 已提交
338 339 340
 * fast path FIXUP_TOP_OF_STACK is needed.
 * RESTORE_TOP_OF_STACK syncs the syscall state after any possible ptregs
 * manipulation.
341 342 343
 */

	/* %rsp:at FRAMEEND */
344
	.macro FIXUP_TOP_OF_STACK tmp offset=0
345
	movq PER_CPU_VAR(old_rsp),\tmp
346 347 348 349 350 351
	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 已提交
352 353
	.endm

354 355
	.macro RESTORE_TOP_OF_STACK tmp offset=0
	movq RSP+\offset(%rsp),\tmp
356
	movq \tmp,PER_CPU_VAR(old_rsp)
357 358
	movq EFLAGS+\offset(%rsp),\tmp
	movq \tmp,R11+\offset(%rsp)
L
Linus Torvalds 已提交
359 360 361 362
	.endm

	.macro FAKE_STACK_FRAME child_rip
	/* push in order ss, rsp, eflags, cs, rip */
363
	xorl %eax, %eax
364
	pushq_cfi $__KERNEL_DS /* ss */
365
	/*CFI_REL_OFFSET	ss,0*/
366
	pushq_cfi %rax /* rsp */
367
	CFI_REL_OFFSET	rsp,0
368
	pushq_cfi $(X86_EFLAGS_IF|X86_EFLAGS_BIT1) /* eflags - interrupts on */
369
	/*CFI_REL_OFFSET	rflags,0*/
370
	pushq_cfi $__KERNEL_CS /* cs */
371
	/*CFI_REL_OFFSET	cs,0*/
372
	pushq_cfi \child_rip /* rip */
373
	CFI_REL_OFFSET	rip,0
374
	pushq_cfi %rax /* orig rax */
L
Linus Torvalds 已提交
375 376 377 378 379 380 381
	.endm

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

382 383 384 385
/*
 * initial frame state for interrupts (and exceptions without error code)
 */
	.macro EMPTY_FRAME start=1 offset=0
386
	.if \start
387
	CFI_STARTPROC simple
388
	CFI_SIGNAL_FRAME
389
	CFI_DEF_CFA rsp,8+\offset
390
	.else
391
	CFI_DEF_CFA_OFFSET 8+\offset
392
	.endif
L
Linus Torvalds 已提交
393
	.endm
394 395

/*
396
 * initial frame state for interrupts (and exceptions without error code)
397
 */
398
	.macro INTR_FRAME start=1 offset=0
399 400 401 402 403 404
	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
405 406 407 408 409 410
	.endm

/*
 * initial frame state for exceptions with error code (and interrupts
 * with vector already pushed)
 */
411
	.macro XCPT_FRAME start=1 offset=0
412
	INTR_FRAME \start, RIP+\offset-ORIG_RAX
413 414 415 416 417 418 419
	/*CFI_REL_OFFSET orig_rax, ORIG_RAX-ORIG_RAX*/
	.endm

/*
 * frame that enables calling into C.
 */
	.macro PARTIAL_FRAME start=1 offset=0
420 421 422 423 424 425 426 427 428 429
	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
430 431 432 433 434 435
	.endm

/*
 * frame that enables passing a complete pt_regs to a C function.
 */
	.macro DEFAULT_FRAME start=1 offset=0
436
	PARTIAL_FRAME \start, R11+\offset-R15
437 438 439 440 441 442 443
	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
444 445

/* save partial stack frame */
446
	.macro SAVE_ARGS_IRQ
447
	cld
448
	/* start from rbp in pt_regs and jump over */
T
Tao Guo 已提交
449 450 451 452 453 454 455 456 457
	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)
458

459 460 461 462 463
	/* Save rbp so that we can unwind from get_irq_regs() */
	movq_cfi rbp, 0

	/* Save previous stack value */
	movq %rsp, %rsi
464 465

	leaq -RBP(%rsp),%rdi	/* arg1 for handler */
466
	testl $3, CS-RBP(%rsi)
467 468 469
	je 1f
	SWAPGS
	/*
470
	 * irq_count is used to check if a CPU is already on an interrupt stack
471 472 473 474
	 * 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)
	 */
475
1:	incl PER_CPU_VAR(irq_count)
476
	cmovzq PER_CPU_VAR(irq_stack_ptr),%rsp
477
	CFI_DEF_CFA_REGISTER	rsi
478

479
	/* Store previous stack value */
480
	pushq %rsi
481 482 483 484 485
	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 */
486 487
	/* We entered an interrupt context - irqs are off: */
	TRACE_IRQS_OFF
488
	.endm
489

490
ENTRY(save_rest)
T
Tao Guo 已提交
491
	PARTIAL_FRAME 1 (REST_SKIP+8)
492 493 494 495 496 497 498 499 500 501 502 503 504
	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)

505
/* save complete stack frame */
506
	.pushsection .kprobes.text, "ax"
507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
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)
535
	.popsection
536

L
Linus Torvalds 已提交
537
/*
538 539 540
 * A newly forked process directly context switches into this address.
 *
 * rdi: prev task we switched from
541
 */
L
Linus Torvalds 已提交
542
ENTRY(ret_from_fork)
543
	DEFAULT_FRAME
544

545 546
	LOCK ; btr $TIF_FORK,TI_flags(%r8)

547
	pushq_cfi $0x0002
548
	popfq_cfi				# reset kernel eflags
549 550 551

	call schedule_tail			# rdi: 'prev' task parameter

L
Linus Torvalds 已提交
552
	GET_THREAD_INFO(%rcx)
553

L
Linus Torvalds 已提交
554
	RESTORE_REST
555 556

	testl $3, CS-ARGOFFSET(%rsp)		# from kernel_thread?
A
Al Viro 已提交
557
	jz   1f
558 559

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

562
	RESTORE_TOP_OF_STACK %rdi, -ARGOFFSET
563 564
	jmp ret_from_sys_call			# go to the SYSRET fastpath

A
Al Viro 已提交
565
1:
566
	subq $REST_SKIP, %rsp	# leave space for volatiles
A
Al Viro 已提交
567 568 569
	CFI_ADJUST_CFA_OFFSET	REST_SKIP
	movq %rbp, %rdi
	call *%rbx
570 571 572
	movl $0, RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
L
Linus Torvalds 已提交
573
	CFI_ENDPROC
574
END(ret_from_fork)
L
Linus Torvalds 已提交
575 576

/*
L
Lucas De Marchi 已提交
577
 * System call entry. Up to 6 arguments in registers are supported.
L
Linus Torvalds 已提交
578 579
 *
 * SYSCALL does not save anything on the stack and does not change the
580 581
 * stack pointer.  However, it does mask the flags register for us, so
 * CLD and CLAC are not needed.
L
Linus Torvalds 已提交
582
 */
583

L
Linus Torvalds 已提交
584
/*
585
 * Register setup:
L
Linus Torvalds 已提交
586 587
 * rax  system call number
 * rdi  arg0
588
 * rcx  return address for syscall/sysret, C arg3
L
Linus Torvalds 已提交
589
 * rsi  arg1
590
 * rdx  arg2
L
Linus Torvalds 已提交
591 592 593 594
 * r10  arg3 	(--> moved to rcx for C)
 * r8   arg4
 * r9   arg5
 * r11  eflags for syscall/sysret, temporary for C
595 596
 * r12-r15,rbp,rbx saved by C code, not touched.
 *
L
Linus Torvalds 已提交
597 598 599 600 601
 * 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.
602 603 604 605
 *
 * 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.
606
 */
L
Linus Torvalds 已提交
607 608

ENTRY(system_call)
609
	CFI_STARTPROC	simple
610
	CFI_SIGNAL_FRAME
611
	CFI_DEF_CFA	rsp,KERNEL_STACK_OFFSET
612 613
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
614 615 616 617 618 619
	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.
	 */
620
GLOBAL(system_call_after_swapgs)
621

622
	movq	%rsp,PER_CPU_VAR(old_rsp)
623
	movq	PER_CPU_VAR(kernel_stack),%rsp
624 625 626 627
	/*
	 * No need to follow this irqs off/on section - it's straight
	 * and short:
	 */
628
	ENABLE_INTERRUPTS(CLBR_NONE)
629
	SAVE_ARGS 8,0
630
	movq  %rax,ORIG_RAX-ARGOFFSET(%rsp)
631 632
	movq  %rcx,RIP-ARGOFFSET(%rsp)
	CFI_REL_OFFSET rip,RIP-ARGOFFSET
633
	testl $_TIF_WORK_SYSCALL_ENTRY,TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET)
L
Linus Torvalds 已提交
634
	jnz tracesys
R
Roland McGrath 已提交
635
system_call_fastpath:
636
#if __SYSCALL_MASK == ~0
L
Linus Torvalds 已提交
637
	cmpq $__NR_syscall_max,%rax
638 639 640 641
#else
	andl $__SYSCALL_MASK,%eax
	cmpl $__NR_syscall_max,%eax
#endif
L
Linus Torvalds 已提交
642 643 644 645 646 647
	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)
648 649
 * Has incomplete stack frame and undefined top of stack.
 */
L
Linus Torvalds 已提交
650
ret_from_sys_call:
651
	movl $_TIF_ALLWORK_MASK,%edi
L
Linus Torvalds 已提交
652
	/* edi:	flagmask */
653
sysret_check:
654
	LOCKDEP_SYS_EXIT
655
	DISABLE_INTERRUPTS(CLBR_NONE)
656
	TRACE_IRQS_OFF
657
	movl TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET),%edx
L
Linus Torvalds 已提交
658
	andl %edi,%edx
659
	jnz  sysret_careful
660
	CFI_REMEMBER_STATE
661 662 663 664
	/*
	 * sysretq will re-enable interrupts:
	 */
	TRACE_IRQS_ON
L
Linus Torvalds 已提交
665
	movq RIP-ARGOFFSET(%rsp),%rcx
666
	CFI_REGISTER	rip,rcx
667
	RESTORE_ARGS 1,-ARG_SKIP,0
668
	/*CFI_REGISTER	rflags,r11*/
669
	movq	PER_CPU_VAR(old_rsp), %rsp
670
	USERGS_SYSRET64
L
Linus Torvalds 已提交
671

672
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
673
	/* Handle reschedules */
674
	/* edx:	work, edi: workmask */
L
Linus Torvalds 已提交
675 676 677
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
678
	TRACE_IRQS_ON
679
	ENABLE_INTERRUPTS(CLBR_NONE)
680
	pushq_cfi %rdi
681
	SCHEDULE_USER
682
	popq_cfi %rdi
L
Linus Torvalds 已提交
683 684
	jmp sysret_check

685
	/* Handle a signal */
L
Linus Torvalds 已提交
686
sysret_signal:
687
	TRACE_IRQS_ON
688
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
689 690 691 692
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
693 694 695 696 697 698 699
	/*
	 * 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
700

701 702 703 704
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

R
Roland McGrath 已提交
705 706 707
#ifdef CONFIG_AUDITSYSCALL
	/*
	 * Fast path for syscall audit without full syscall trace.
708
	 * We just call __audit_syscall_entry() directly, and then
R
Roland McGrath 已提交
709 710 711 712 713 714 715 716 717
	 * 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 */
718
	call __audit_syscall_entry
R
Roland McGrath 已提交
719 720 721 722
	LOAD_ARGS 0		/* reload call-clobbered registers */
	jmp system_call_fastpath

	/*
723
	 * Return fast path for syscall audit.  Call __audit_syscall_exit()
R
Roland McGrath 已提交
724 725 726 727
	 * directly and then jump back to the fast path with TIF_SYSCALL_AUDIT
	 * masked off.
	 */
sysret_audit:
728
	movq RAX-ARGOFFSET(%rsp),%rsi	/* second arg, syscall return value */
729 730
	cmpq $-MAX_ERRNO,%rsi	/* is it < -MAX_ERRNO? */
	setbe %al		/* 1 if so, 0 if not */
R
Roland McGrath 已提交
731
	movzbl %al,%edi		/* zero-extend that into %edi */
732
	call __audit_syscall_exit
R
Roland McGrath 已提交
733 734 735 736
	movl $(_TIF_ALLWORK_MASK & ~_TIF_SYSCALL_AUDIT),%edi
	jmp sysret_check
#endif	/* CONFIG_AUDITSYSCALL */

L
Linus Torvalds 已提交
737
	/* Do syscall tracing */
738
tracesys:
R
Roland McGrath 已提交
739
#ifdef CONFIG_AUDITSYSCALL
740
	testl $(_TIF_WORK_SYSCALL_ENTRY & ~_TIF_SYSCALL_AUDIT),TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET)
R
Roland McGrath 已提交
741 742
	jz auditsys
#endif
L
Linus Torvalds 已提交
743
	SAVE_REST
R
Roland McGrath 已提交
744
	movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
L
Linus Torvalds 已提交
745 746 747
	FIXUP_TOP_OF_STACK %rdi
	movq %rsp,%rdi
	call syscall_trace_enter
748 749 750 751 752 753
	/*
	 * 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 已提交
754
	RESTORE_REST
755
#if __SYSCALL_MASK == ~0
L
Linus Torvalds 已提交
756
	cmpq $__NR_syscall_max,%rax
757 758 759 760
#else
	andl $__SYSCALL_MASK,%eax
	cmpl $__NR_syscall_max,%eax
#endif
R
Roland McGrath 已提交
761
	ja   int_ret_from_sys_call	/* RAX(%rsp) set to -ENOSYS above */
L
Linus Torvalds 已提交
762 763
	movq %r10,%rcx	/* fixup for C */
	call *sys_call_table(,%rax,8)
R
Roland McGrath 已提交
764
	movq %rax,RAX-ARGOFFSET(%rsp)
765
	/* Use IRET because user could have changed frame */
766 767

/*
L
Linus Torvalds 已提交
768 769
 * Syscall return path ending with IRET.
 * Has correct top of stack, but partial stack frame.
770
 */
771
GLOBAL(int_ret_from_sys_call)
772
	DISABLE_INTERRUPTS(CLBR_NONE)
773
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
774 775
	movl $_TIF_ALLWORK_MASK,%edi
	/* edi:	mask to check */
776
GLOBAL(int_with_check)
777
	LOCKDEP_SYS_EXIT_IRQ
L
Linus Torvalds 已提交
778
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
779
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
780 781
	andl %edi,%edx
	jnz   int_careful
G
Glauber Costa 已提交
782
	andl    $~TS_COMPAT,TI_status(%rcx)
L
Linus Torvalds 已提交
783 784 785 786 787 788 789 790
	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
791
	TRACE_IRQS_ON
792
	ENABLE_INTERRUPTS(CLBR_NONE)
793
	pushq_cfi %rdi
794
	SCHEDULE_USER
795
	popq_cfi %rdi
796
	DISABLE_INTERRUPTS(CLBR_NONE)
797
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
798 799 800 801
	jmp int_with_check

	/* handle signals and tracing -- both require a full stack frame */
int_very_careful:
802
	TRACE_IRQS_ON
803
	ENABLE_INTERRUPTS(CLBR_NONE)
804
int_check_syscall_exit_work:
L
Linus Torvalds 已提交
805
	SAVE_REST
806
	/* Check for syscall exit trace */
807
	testl $_TIF_WORK_SYSCALL_EXIT,%edx
L
Linus Torvalds 已提交
808
	jz int_signal
809
	pushq_cfi %rdi
810
	leaq 8(%rsp),%rdi	# &ptregs -> arg1
L
Linus Torvalds 已提交
811
	call syscall_trace_leave
812
	popq_cfi %rdi
813
	andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
L
Linus Torvalds 已提交
814
	jmp int_restore_rest
815

L
Linus Torvalds 已提交
816
int_signal:
P
Peter Zijlstra 已提交
817
	testl $_TIF_DO_NOTIFY_MASK,%edx
L
Linus Torvalds 已提交
818 819 820 821
	jz 1f
	movq %rsp,%rdi		# &ptregs -> arg1
	xorl %esi,%esi		# oldset -> arg2
	call do_notify_resume
R
Roland McGrath 已提交
822
1:	movl $_TIF_WORK_MASK,%edi
L
Linus Torvalds 已提交
823 824
int_restore_rest:
	RESTORE_REST
825
	DISABLE_INTERRUPTS(CLBR_NONE)
826
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
827 828
	jmp int_with_check
	CFI_ENDPROC
829
END(system_call)
830 831

/*
L
Linus Torvalds 已提交
832
 * Certain special system calls that need to save a complete full stack frame.
833
 */
L
Linus Torvalds 已提交
834
	.macro PTREGSCALL label,func,arg
835 836 837 838 839 840 841 842 843 844
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
845
END(\label)
L
Linus Torvalds 已提交
846 847
	.endm

848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866
	.macro FORK_LIKE func
ENTRY(stub_\func)
	CFI_STARTPROC
	popq	%r11			/* save return address */
	PARTIAL_FRAME 0
	SAVE_REST
	pushq	%r11			/* put it back on stack */
	FIXUP_TOP_OF_STACK %r11, 8
	DEFAULT_FRAME 0 8		/* offset 8: return address */
	call sys_\func
	RESTORE_TOP_OF_STACK %r11, 8
	ret $REST_SKIP		/* pop extended registers */
	CFI_ENDPROC
END(stub_\func)
	.endm

	FORK_LIKE  clone
	FORK_LIKE  fork
	FORK_LIKE  vfork
L
Linus Torvalds 已提交
867 868 869
	PTREGSCALL stub_iopl, sys_iopl, %rsi

ENTRY(ptregscall_common)
870 871 872 873 874 875 876 877 878
	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 已提交
879
	CFI_ENDPROC
880
END(ptregscall_common)
881

L
Linus Torvalds 已提交
882 883
ENTRY(stub_execve)
	CFI_STARTPROC
884 885
	addq $8, %rsp
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
886 887 888 889 890 891 892
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
	call sys_execve
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
893
END(stub_execve)
894

L
Linus Torvalds 已提交
895 896 897
/*
 * 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.
898
 */
L
Linus Torvalds 已提交
899 900
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
901
	addq $8, %rsp
902
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
903 904 905 906 907 908 909 910
	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
911
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
912

913 914 915 916 917 918 919 920 921 922 923 924 925 926 927
#ifdef CONFIG_X86_X32_ABI
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 已提交
928 929 930 931 932 933
ENTRY(stub_x32_execve)
	CFI_STARTPROC
	addq $8, %rsp
	PARTIAL_FRAME 0
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
934
	call compat_sys_execve
H
H. Peter Anvin 已提交
935 936 937 938 939 940 941
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
END(stub_x32_execve)

942 943
#endif

944 945 946 947 948 949 950
/*
 * 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 已提交
951
	.section .entry.text
952 953 954 955 956 957 958 959 960
	.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
961
      .if vector <> FIRST_EXTERNAL_VECTOR
962 963
	CFI_ADJUST_CFA_OFFSET -8
      .endif
964
1:	pushq_cfi $(~vector+0x80)	/* Note: always in signed byte range */
965
      .if ((vector-FIRST_EXTERNAL_VECTOR)%7) <> 6
966 967 968 969
	jmp 2f
      .endif
      .previous
	.quad 1b
J
Jiri Olsa 已提交
970
      .section .entry.text
971 972 973 974 975 976 977 978 979 980 981 982
vector=vector+1
    .endif
  .endr
2:	jmp common_interrupt
.endr
	CFI_ENDPROC
END(irq_entries_start)

.previous
END(interrupt)
.previous

983
/*
L
Linus Torvalds 已提交
984 985 986
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
987 988 989
 *
 * Entry runs with interrupts off.
 */
L
Linus Torvalds 已提交
990

991
/* 0(%rsp): ~(interrupt number) */
L
Linus Torvalds 已提交
992
	.macro interrupt func
993 994 995
	/* reserve pt_regs for scratch regs and rbp */
	subq $ORIG_RAX-RBP, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-RBP
996
	SAVE_ARGS_IRQ
L
Linus Torvalds 已提交
997 998 999
	call \func
	.endm

1000 1001 1002 1003
/*
 * Interrupt entry/exit should be protected against kprobes
 */
	.pushsection .kprobes.text, "ax"
1004 1005 1006 1007
	/*
	 * The interrupt stubs push (~vector+0x80) onto the stack and
	 * then jump to common_interrupt.
	 */
1008 1009
	.p2align CONFIG_X86_L1_CACHE_SHIFT
common_interrupt:
1010
	XCPT_FRAME
1011
	ASM_CLAC
1012
	addq $-0x80,(%rsp)		/* Adjust vector to [-256,-1] range */
L
Linus Torvalds 已提交
1013
	interrupt do_IRQ
1014
	/* 0(%rsp): old_rsp-ARGOFFSET */
1015
ret_from_intr:
1016
	DISABLE_INTERRUPTS(CLBR_NONE)
1017
	TRACE_IRQS_OFF
1018
	decl PER_CPU_VAR(irq_count)
1019

1020 1021
	/* Restore saved previous stack */
	popq %rsi
1022
	CFI_DEF_CFA rsi,SS+8-RBP	/* reg/off reset after def_cfa_expr */
1023
	leaq ARGOFFSET-RBP(%rsi), %rsp
1024
	CFI_DEF_CFA_REGISTER	rsp
1025
	CFI_ADJUST_CFA_OFFSET	RBP-ARGOFFSET
1026

1027
exit_intr:
L
Linus Torvalds 已提交
1028 1029 1030
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
1031

L
Linus Torvalds 已提交
1032 1033 1034 1035
	/* Interrupt came from user space */
	/*
	 * Has a correct top of stack, but a partial stack frame
	 * %rcx: thread info. Interrupts off.
1036
	 */
L
Linus Torvalds 已提交
1037 1038
retint_with_reschedule:
	movl $_TIF_WORK_MASK,%edi
1039
retint_check:
1040
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
1041
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
1042
	andl %edi,%edx
1043
	CFI_REMEMBER_STATE
L
Linus Torvalds 已提交
1044
	jnz  retint_careful
1045 1046

retint_swapgs:		/* return to user-space */
1047 1048 1049
	/*
	 * The iretq could re-enable interrupts:
	 */
1050
	DISABLE_INTERRUPTS(CLBR_ANY)
1051
	TRACE_IRQS_IRETQ
1052
	SWAPGS
1053 1054
	jmp restore_args

1055
retint_restore_args:	/* return to kernel space */
1056
	DISABLE_INTERRUPTS(CLBR_ANY)
1057 1058 1059 1060 1061
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
1062
	RESTORE_ARGS 1,8,1
I
Ingo Molnar 已提交
1063

A
Adrian Bunk 已提交
1064
irq_return:
1065
	INTERRUPT_RETURN
1066
	_ASM_EXTABLE(irq_return, bad_iret)
I
Ingo Molnar 已提交
1067 1068

#ifdef CONFIG_PARAVIRT
1069
ENTRY(native_iret)
L
Linus Torvalds 已提交
1070
	iretq
1071
	_ASM_EXTABLE(native_iret, bad_iret)
I
Ingo Molnar 已提交
1072 1073
#endif

L
Linus Torvalds 已提交
1074 1075
	.section .fixup,"ax"
bad_iret:
1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090
	/*
	 * 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

1091 1092
	.previous

1093
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
1094
retint_careful:
1095
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
1096 1097
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
1098
	TRACE_IRQS_ON
1099
	ENABLE_INTERRUPTS(CLBR_NONE)
1100
	pushq_cfi %rdi
1101
	SCHEDULE_USER
1102
	popq_cfi %rdi
L
Linus Torvalds 已提交
1103
	GET_THREAD_INFO(%rcx)
1104
	DISABLE_INTERRUPTS(CLBR_NONE)
1105
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
1106
	jmp retint_check
1107

L
Linus Torvalds 已提交
1108
retint_signal:
P
Peter Zijlstra 已提交
1109
	testl $_TIF_DO_NOTIFY_MASK,%edx
1110
	jz    retint_swapgs
1111
	TRACE_IRQS_ON
1112
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
1113
	SAVE_REST
1114
	movq $-1,ORIG_RAX(%rsp)
1115
	xorl %esi,%esi		# oldset
L
Linus Torvalds 已提交
1116 1117 1118
	movq %rsp,%rdi		# &pt_regs
	call do_notify_resume
	RESTORE_REST
1119
	DISABLE_INTERRUPTS(CLBR_NONE)
1120
	TRACE_IRQS_OFF
1121
	GET_THREAD_INFO(%rcx)
R
Roland McGrath 已提交
1122
	jmp retint_with_reschedule
L
Linus Torvalds 已提交
1123 1124 1125 1126

#ifdef CONFIG_PREEMPT
	/* Returning to kernel space. Check if we need preemption */
	/* rcx:	 threadinfo. interrupts off. */
1127
ENTRY(retint_kernel)
G
Glauber Costa 已提交
1128
	cmpl $0,TI_preempt_count(%rcx)
L
Linus Torvalds 已提交
1129
	jnz  retint_restore_args
G
Glauber Costa 已提交
1130
	bt  $TIF_NEED_RESCHED,TI_flags(%rcx)
L
Linus Torvalds 已提交
1131 1132 1133 1134 1135
	jnc  retint_restore_args
	bt   $9,EFLAGS-ARGOFFSET(%rsp)	/* interrupts off? */
	jnc  retint_restore_args
	call preempt_schedule_irq
	jmp exit_intr
1136
#endif
1137

L
Linus Torvalds 已提交
1138
	CFI_ENDPROC
1139
END(common_interrupt)
1140 1141 1142 1143
/*
 * End of kprobes section
 */
       .popsection
1144

L
Linus Torvalds 已提交
1145 1146
/*
 * APIC interrupts.
1147
 */
1148 1149
.macro apicinterrupt num sym do_sym
ENTRY(\sym)
1150
	INTR_FRAME
1151
	ASM_CLAC
1152
	pushq_cfi $~(\num)
1153
.Lcommon_\sym:
1154
	interrupt \do_sym
L
Linus Torvalds 已提交
1155 1156
	jmp ret_from_intr
	CFI_ENDPROC
1157 1158
END(\sym)
.endm
L
Linus Torvalds 已提交
1159

1160 1161 1162
#ifdef CONFIG_SMP
apicinterrupt IRQ_MOVE_CLEANUP_VECTOR \
	irq_move_cleanup_interrupt smp_irq_move_cleanup_interrupt
1163 1164
apicinterrupt REBOOT_VECTOR \
	reboot_interrupt smp_reboot_interrupt
1165
#endif
L
Linus Torvalds 已提交
1166

N
Nick Piggin 已提交
1167
#ifdef CONFIG_X86_UV
1168
apicinterrupt UV_BAU_MESSAGE \
1169
	uv_bau_message_intr1 uv_bau_message_interrupt
N
Nick Piggin 已提交
1170
#endif
1171 1172
apicinterrupt LOCAL_TIMER_VECTOR \
	apic_timer_interrupt smp_apic_timer_interrupt
1173 1174
apicinterrupt X86_PLATFORM_IPI_VECTOR \
	x86_platform_ipi smp_x86_platform_ipi
1175

1176
apicinterrupt THRESHOLD_APIC_VECTOR \
1177
	threshold_interrupt smp_threshold_interrupt
1178 1179
apicinterrupt THERMAL_APIC_VECTOR \
	thermal_interrupt smp_thermal_interrupt
1180

1181 1182 1183 1184 1185 1186 1187 1188
#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 已提交
1189

1190 1191 1192 1193
apicinterrupt ERROR_APIC_VECTOR \
	error_interrupt smp_error_interrupt
apicinterrupt SPURIOUS_APIC_VECTOR \
	spurious_interrupt smp_spurious_interrupt
1194

1195 1196 1197
#ifdef CONFIG_IRQ_WORK
apicinterrupt IRQ_WORK_VECTOR \
	irq_work_interrupt smp_irq_work_interrupt
I
Ingo Molnar 已提交
1198 1199
#endif

L
Linus Torvalds 已提交
1200 1201
/*
 * Exception entry points.
1202
 */
1203 1204
.macro zeroentry sym do_sym
ENTRY(\sym)
1205
	INTR_FRAME
1206
	ASM_CLAC
1207
	PARAVIRT_ADJUST_EXCEPTION_FRAME
I
Ingo Molnar 已提交
1208
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1209 1210
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1211
	call error_entry
1212
	DEFAULT_FRAME 0
1213 1214
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1215
	call \do_sym
1216
	jmp error_exit		/* %ebx: no swapgs flag */
1217
	CFI_ENDPROC
1218 1219
END(\sym)
.endm
L
Linus Torvalds 已提交
1220

1221
.macro paranoidzeroentry sym do_sym
1222
ENTRY(\sym)
1223
	INTR_FRAME
1224
	ASM_CLAC
1225
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1226 1227 1228
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1229 1230 1231 1232
	call save_paranoid
	TRACE_IRQS_OFF
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1233
	call \do_sym
1234 1235
	jmp paranoid_exit	/* %ebx: no swapgs flag */
	CFI_ENDPROC
1236
END(\sym)
1237
.endm
1238

1239
#define INIT_TSS_IST(x) PER_CPU_VAR(init_tss) + (TSS_ist + ((x) - 1) * 8)
1240
.macro paranoidzeroentry_ist sym do_sym ist
1241
ENTRY(\sym)
1242
	INTR_FRAME
1243
	ASM_CLAC
1244
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1245 1246 1247
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1248
	call save_paranoid
1249
	TRACE_IRQS_OFF_DEBUG
1250 1251
	movq %rsp,%rdi		/* pt_regs pointer */
	xorl %esi,%esi		/* no error code */
1252
	subq $EXCEPTION_STKSZ, INIT_TSS_IST(\ist)
1253
	call \do_sym
1254
	addq $EXCEPTION_STKSZ, INIT_TSS_IST(\ist)
1255 1256
	jmp paranoid_exit	/* %ebx: no swapgs flag */
	CFI_ENDPROC
1257
END(\sym)
1258
.endm
1259

1260
.macro errorentry sym do_sym
1261
ENTRY(\sym)
1262
	XCPT_FRAME
1263
	ASM_CLAC
1264
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1265 1266
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1267
	call error_entry
1268
	DEFAULT_FRAME 0
1269 1270 1271
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1272
	call \do_sym
1273
	jmp error_exit			/* %ebx: no swapgs flag */
1274
	CFI_ENDPROC
1275 1276
END(\sym)
.endm
L
Linus Torvalds 已提交
1277 1278

	/* error code is on the stack already */
1279
.macro paranoiderrorentry sym do_sym
1280
ENTRY(\sym)
1281
	XCPT_FRAME
1282
	ASM_CLAC
1283
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1284 1285
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1286 1287
	call save_paranoid
	DEFAULT_FRAME 0
1288
	TRACE_IRQS_OFF
1289 1290 1291
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1292
	call \do_sym
1293 1294
	jmp paranoid_exit		/* %ebx: no swapgs flag */
	CFI_ENDPROC
1295 1296 1297 1298 1299 1300 1301 1302
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
1303
paranoiderrorentry double_fault do_double_fault
1304 1305 1306 1307 1308 1309 1310
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
1311

1312

1313 1314
	/* Reload gs selector with exception handling */
	/* edi:  new selector */
1315
ENTRY(native_load_gs_index)
1316
	CFI_STARTPROC
1317
	pushfq_cfi
1318
	DISABLE_INTERRUPTS(CLBR_ANY & ~CLBR_RDI)
1319
	SWAPGS
1320
gs_change:
1321
	movl %edi,%gs
L
Linus Torvalds 已提交
1322
2:	mfence		/* workaround */
1323
	SWAPGS
1324
	popfq_cfi
1325
	ret
1326
	CFI_ENDPROC
1327
END(native_load_gs_index)
1328

1329
	_ASM_EXTABLE(gs_change,bad_gs)
1330
	.section .fixup,"ax"
L
Linus Torvalds 已提交
1331
	/* running with kernelgs */
1332
bad_gs:
1333
	SWAPGS			/* switch back to user gs */
L
Linus Torvalds 已提交
1334
	xorl %eax,%eax
1335 1336 1337
	movl %eax,%gs
	jmp  2b
	.previous
1338

1339
/* Call softirq on interrupt stack. Interrupts are off. */
1340
ENTRY(call_softirq)
1341
	CFI_STARTPROC
1342
	pushq_cfi %rbp
1343 1344 1345
	CFI_REL_OFFSET rbp,0
	mov  %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1346
	incl PER_CPU_VAR(irq_count)
1347
	cmove PER_CPU_VAR(irq_stack_ptr),%rsp
1348
	push  %rbp			# backlink for old unwinder
1349
	call __do_softirq
1350
	leaveq
1351
	CFI_RESTORE		rbp
1352
	CFI_DEF_CFA_REGISTER	rsp
1353
	CFI_ADJUST_CFA_OFFSET   -8
1354
	decl PER_CPU_VAR(irq_count)
1355
	ret
1356
	CFI_ENDPROC
1357
END(call_softirq)
1358

1359
#ifdef CONFIG_XEN
1360
zeroentry xen_hypervisor_callback xen_do_hypervisor_callback
1361 1362

/*
1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374
 * 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.
 */
1375 1376
ENTRY(xen_do_hypervisor_callback)   # do_hypervisor_callback(struct *pt_regs)
	CFI_STARTPROC
1377 1378 1379 1380
/*
 * Since we don't modify %rdi, evtchn_do_upall(struct *pt_regs) will
 * see the correct pointer to the pt_regs
 */
1381 1382
	movq %rdi, %rsp            # we don't return, adjust the stack frame
	CFI_ENDPROC
1383
	DEFAULT_FRAME
1384
11:	incl PER_CPU_VAR(irq_count)
1385 1386
	movq %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1387
	cmovzq PER_CPU_VAR(irq_stack_ptr),%rsp
1388 1389 1390 1391
	pushq %rbp			# backlink for old unwinder
	call xen_evtchn_do_upcall
	popq %rsp
	CFI_DEF_CFA_REGISTER rsp
1392
	decl PER_CPU_VAR(irq_count)
1393 1394
	jmp  error_exit
	CFI_ENDPROC
1395
END(xen_do_hypervisor_callback)
1396 1397

/*
1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409
 * 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.
 */
1410
ENTRY(xen_failsafe_callback)
1411 1412 1413 1414 1415 1416 1417
	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
1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
	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 已提交
1438 1439 1440
	pushq_cfi $0	/* RIP */
	pushq_cfi %r11
	pushq_cfi %rcx
1441
	jmp general_protection
1442 1443 1444 1445 1446 1447 1448 1449
	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
1450
	pushq_cfi $-1 /* orig_ax = -1 => not a system call */
1451 1452 1453 1454 1455
	SAVE_ALL
	jmp error_exit
	CFI_ENDPROC
END(xen_failsafe_callback)

1456 1457 1458
apicinterrupt XEN_HVM_EVTCHN_CALLBACK \
	xen_hvm_callback_vector xen_evtchn_do_upcall

1459
#endif /* CONFIG_XEN */
1460 1461 1462 1463 1464 1465 1466 1467 1468

/*
 * 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
1469 1470 1471 1472 1473
#ifdef CONFIG_XEN
zeroentry xen_debug do_debug
zeroentry xen_int3 do_int3
errorentry xen_stack_segment do_stack_segment
#endif
1474 1475
errorentry general_protection do_general_protection
errorentry page_fault do_page_fault
G
Gleb Natapov 已提交
1476 1477 1478
#ifdef CONFIG_KVM_GUEST
errorentry async_page_fault do_async_page_fault
#endif
1479
#ifdef CONFIG_X86_MCE
1480
paranoidzeroentry machine_check *machine_check_vector(%rip)
1481 1482 1483
#endif

	/*
1484 1485
	 * "Paranoid" exit path from exception stack.
	 * Paranoid because this is used by NMIs and cannot take
1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497
	 * 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)
1498
	DEFAULT_FRAME
1499
	DISABLE_INTERRUPTS(CLBR_NONE)
1500
	TRACE_IRQS_OFF_DEBUG
1501 1502 1503 1504 1505 1506 1507
	testl %ebx,%ebx				/* swapgs needed? */
	jnz paranoid_restore
	testl $3,CS(%rsp)
	jnz   paranoid_userspace
paranoid_swapgs:
	TRACE_IRQS_IRETQ 0
	SWAPGS_UNSAFE_STACK
1508 1509
	RESTORE_ALL 8
	jmp irq_return
1510
paranoid_restore:
1511
	TRACE_IRQS_IRETQ_DEBUG 0
1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
	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)
1536
	SCHEDULE_USER
1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587
	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
1588 1589 1590
	movl %ecx,%eax	/* zero extend */
	cmpq %rax,RIP+8(%rsp)
	je bstep_iret
1591
	cmpq $gs_change,RIP+8(%rsp)
1592
	je error_swapgs
1593
	jmp error_sti
1594 1595 1596 1597

bstep_iret:
	/* Fix truncated RIP */
	movq %rcx,RIP+8(%rsp)
B
Brian Gerst 已提交
1598
	jmp error_swapgs
1599
	CFI_ENDPROC
1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621
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)

1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632
/*
 * 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
1633 1634 1635 1636 1637

	/* runs on exception stack */
ENTRY(nmi)
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671
	/*
	 * 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
1672
	CFI_REL_OFFSET rdx, 0
1673

1674 1675 1676 1677
	/*
	 * If %cs was not the kernel segment, then the NMI triggered in user
	 * space, which means it is definitely not nested.
	 */
1678
	cmpl $__KERNEL_CS, 16(%rsp)
1679 1680
	jne first_nmi

1681 1682 1683 1684
	/*
	 * Check the special variable on the stack to see if NMIs are
	 * executing.
	 */
1685
	cmpl $1, -8(%rsp)
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696
	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
1697
	CFI_REMEMBER_STATE
1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713

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 */
1714
	leaq -1*8(%rsp), %rdx
1715
	movq %rdx, %rsp
1716 1717
	CFI_ADJUST_CFA_OFFSET 1*8
	leaq -10*8(%rsp), %rdx
1718 1719 1720 1721 1722 1723 1724
	pushq_cfi $__KERNEL_DS
	pushq_cfi %rdx
	pushfq_cfi
	pushq_cfi $__KERNEL_CS
	pushq_cfi $repeat_nmi

	/* Put stack back */
1725 1726
	addq $(6*8), %rsp
	CFI_ADJUST_CFA_OFFSET -6*8
1727 1728 1729

nested_nmi_out:
	popq_cfi %rdx
1730
	CFI_RESTORE rdx
1731 1732 1733 1734

	/* No need to check faults here */
	INTERRUPT_RETURN

1735
	CFI_RESTORE_STATE
1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757
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  |
	 * +-------------------------+
	 * | copied SS               |
	 * | copied Return RSP       |
	 * | copied RFLAGS           |
	 * | copied CS               |
	 * | copied RIP              |
	 * +-------------------------+
1758 1759 1760 1761 1762 1763
	 * | Saved SS                |
	 * | Saved Return RSP        |
	 * | Saved RFLAGS            |
	 * | Saved CS                |
	 * | Saved RIP               |
	 * +-------------------------+
1764 1765 1766
	 * | pt_regs                 |
	 * +-------------------------+
	 *
1767 1768 1769
	 * 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
1770 1771
	 * is also used by nested NMIs and can not be trusted on exit.
	 */
1772
	/* Do not pop rdx, nested NMIs will corrupt that part of the stack */
1773 1774 1775
	movq (%rsp), %rdx
	CFI_RESTORE rdx

1776 1777 1778
	/* Set the NMI executing variable on the stack. */
	pushq_cfi $1

1779 1780 1781 1782 1783
	/*
	 * Leave room for the "copied" frame
	 */
	subq $(5*8), %rsp

1784 1785
	/* Copy the stack frame to the Saved frame */
	.rept 5
1786
	pushq_cfi 11*8(%rsp)
1787
	.endr
1788 1789
	CFI_DEF_CFA_OFFSET SS+8-RIP

1790 1791
	/* Everything up to here is safe from nested NMIs */

1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806
	/*
	 * 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).
	 */
1807
	movq $1, 10*8(%rsp)
1808 1809

	/* Make another copy, this one may be modified by nested NMIs */
1810 1811
	addq $(10*8), %rsp
	CFI_ADJUST_CFA_OFFSET -10*8
1812
	.rept 5
1813
	pushq_cfi -6*8(%rsp)
1814
	.endr
1815
	subq $(5*8), %rsp
1816 1817
	CFI_DEF_CFA_OFFSET SS+8-RIP
end_repeat_nmi:
1818 1819 1820

	/*
	 * Everything below this point can be preempted by a nested
1821 1822
	 * NMI if the first NMI took an exception and reset our iret stack
	 * so that we repeat another NMI.
1823
	 */
1824
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1825 1826
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1827 1828 1829 1830 1831 1832 1833
	/*
	 * 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.
	 */
1834 1835
	call save_paranoid
	DEFAULT_FRAME 0
1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847

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

1848 1849 1850 1851
	/* paranoidentry do_nmi, 0; without TRACE_IRQS_OFF */
	movq %rsp,%rdi
	movq $-1,%rsi
	call do_nmi
1852 1853 1854 1855 1856 1857 1858 1859

	/* Did the NMI take a page fault? Restore cr2 if it did */
	movq %cr2, %rcx
	cmpq %rcx, %r12
	je 1f
	movq %r12, %cr2
1:
	
1860 1861 1862 1863 1864 1865
	testl %ebx,%ebx				/* swapgs needed? */
	jnz nmi_restore
nmi_swapgs:
	SWAPGS_UNSAFE_STACK
nmi_restore:
	RESTORE_ALL 8
1866 1867 1868 1869

	/* Pop the extra iret frame */
	addq $(5*8), %rsp

1870
	/* Clear the NMI executing stack variable */
1871
	movq $0, 5*8(%rsp)
1872
	jmp irq_return
1873
	CFI_ENDPROC
1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886
END(nmi)

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

/*
 * End of kprobes section
 */
	.popsection