entry_64.S 46.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 <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
/* 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 */
91
	movq function_trace_op(%rip), %rdx
92 93 94 95 96

	/* 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_FIXED) /* 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
/* save complete stack frame */
491
	.pushsection .kprobes.text, "ax"
492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
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)
520
	.popsection
521

L
Linus Torvalds 已提交
522
/*
523 524 525
 * A newly forked process directly context switches into this address.
 *
 * rdi: prev task we switched from
526
 */
L
Linus Torvalds 已提交
527
ENTRY(ret_from_fork)
528
	DEFAULT_FRAME
529

530 531
	LOCK ; btr $TIF_FORK,TI_flags(%r8)

532
	pushq_cfi $0x0002
533
	popfq_cfi				# reset kernel eflags
534 535 536

	call schedule_tail			# rdi: 'prev' task parameter

L
Linus Torvalds 已提交
537
	GET_THREAD_INFO(%rcx)
538

L
Linus Torvalds 已提交
539
	RESTORE_REST
540 541

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

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

547
	RESTORE_TOP_OF_STACK %rdi, -ARGOFFSET
548 549
	jmp ret_from_sys_call			# go to the SYSRET fastpath

A
Al Viro 已提交
550
1:
551
	subq $REST_SKIP, %rsp	# leave space for volatiles
A
Al Viro 已提交
552 553 554
	CFI_ADJUST_CFA_OFFSET	REST_SKIP
	movq %rbp, %rdi
	call *%rbx
555 556 557
	movl $0, RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
L
Linus Torvalds 已提交
558
	CFI_ENDPROC
559
END(ret_from_fork)
L
Linus Torvalds 已提交
560 561

/*
L
Lucas De Marchi 已提交
562
 * System call entry. Up to 6 arguments in registers are supported.
L
Linus Torvalds 已提交
563 564
 *
 * SYSCALL does not save anything on the stack and does not change the
565 566
 * stack pointer.  However, it does mask the flags register for us, so
 * CLD and CLAC are not needed.
L
Linus Torvalds 已提交
567
 */
568

L
Linus Torvalds 已提交
569
/*
570
 * Register setup:
L
Linus Torvalds 已提交
571 572
 * rax  system call number
 * rdi  arg0
573
 * rcx  return address for syscall/sysret, C arg3
L
Linus Torvalds 已提交
574
 * rsi  arg1
575
 * rdx  arg2
L
Linus Torvalds 已提交
576 577 578 579
 * r10  arg3 	(--> moved to rcx for C)
 * r8   arg4
 * r9   arg5
 * r11  eflags for syscall/sysret, temporary for C
580 581
 * r12-r15,rbp,rbx saved by C code, not touched.
 *
L
Linus Torvalds 已提交
582 583 584 585 586
 * 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.
587 588 589 590
 *
 * 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.
591
 */
L
Linus Torvalds 已提交
592 593

ENTRY(system_call)
594
	CFI_STARTPROC	simple
595
	CFI_SIGNAL_FRAME
596
	CFI_DEF_CFA	rsp,KERNEL_STACK_OFFSET
597 598
	CFI_REGISTER	rip,rcx
	/*CFI_REGISTER	rflags,r11*/
599 600 601 602 603 604
	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.
	 */
605
GLOBAL(system_call_after_swapgs)
606

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

657
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
658
	/* Handle reschedules */
659
	/* edx:	work, edi: workmask */
L
Linus Torvalds 已提交
660 661 662
sysret_careful:
	bt $TIF_NEED_RESCHED,%edx
	jnc sysret_signal
663
	TRACE_IRQS_ON
664
	ENABLE_INTERRUPTS(CLBR_NONE)
665
	pushq_cfi %rdi
666
	SCHEDULE_USER
667
	popq_cfi %rdi
L
Linus Torvalds 已提交
668 669
	jmp sysret_check

670
	/* Handle a signal */
L
Linus Torvalds 已提交
671
sysret_signal:
672
	TRACE_IRQS_ON
673
	ENABLE_INTERRUPTS(CLBR_NONE)
R
Roland McGrath 已提交
674 675 676 677
#ifdef CONFIG_AUDITSYSCALL
	bt $TIF_SYSCALL_AUDIT,%edx
	jc sysret_audit
#endif
678 679 680 681 682 683 684
	/*
	 * 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
685

686 687 688 689
badsys:
	movq $-ENOSYS,RAX-ARGOFFSET(%rsp)
	jmp ret_from_sys_call

R
Roland McGrath 已提交
690 691 692
#ifdef CONFIG_AUDITSYSCALL
	/*
	 * Fast path for syscall audit without full syscall trace.
693
	 * We just call __audit_syscall_entry() directly, and then
R
Roland McGrath 已提交
694 695 696 697 698 699 700 701 702
	 * 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 */
703
	call __audit_syscall_entry
R
Roland McGrath 已提交
704 705 706 707
	LOAD_ARGS 0		/* reload call-clobbered registers */
	jmp system_call_fastpath

	/*
708
	 * Return fast path for syscall audit.  Call __audit_syscall_exit()
R
Roland McGrath 已提交
709 710 711 712
	 * directly and then jump back to the fast path with TIF_SYSCALL_AUDIT
	 * masked off.
	 */
sysret_audit:
713
	movq RAX-ARGOFFSET(%rsp),%rsi	/* second arg, syscall return value */
714 715
	cmpq $-MAX_ERRNO,%rsi	/* is it < -MAX_ERRNO? */
	setbe %al		/* 1 if so, 0 if not */
R
Roland McGrath 已提交
716
	movzbl %al,%edi		/* zero-extend that into %edi */
717
	call __audit_syscall_exit
R
Roland McGrath 已提交
718 719 720 721
	movl $(_TIF_ALLWORK_MASK & ~_TIF_SYSCALL_AUDIT),%edi
	jmp sysret_check
#endif	/* CONFIG_AUDITSYSCALL */

L
Linus Torvalds 已提交
722
	/* Do syscall tracing */
723
tracesys:
R
Roland McGrath 已提交
724
#ifdef CONFIG_AUDITSYSCALL
725
	testl $(_TIF_WORK_SYSCALL_ENTRY & ~_TIF_SYSCALL_AUDIT),TI_flags+THREAD_INFO(%rsp,RIP-ARGOFFSET)
R
Roland McGrath 已提交
726 727
	jz auditsys
#endif
L
Linus Torvalds 已提交
728
	SAVE_REST
R
Roland McGrath 已提交
729
	movq $-ENOSYS,RAX(%rsp) /* ptrace can change this for a bad syscall */
L
Linus Torvalds 已提交
730 731 732
	FIXUP_TOP_OF_STACK %rdi
	movq %rsp,%rdi
	call syscall_trace_enter
733 734 735 736 737 738
	/*
	 * 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 已提交
739
	RESTORE_REST
740
#if __SYSCALL_MASK == ~0
L
Linus Torvalds 已提交
741
	cmpq $__NR_syscall_max,%rax
742 743 744 745
#else
	andl $__SYSCALL_MASK,%eax
	cmpl $__NR_syscall_max,%eax
#endif
R
Roland McGrath 已提交
746
	ja   int_ret_from_sys_call	/* RAX(%rsp) set to -ENOSYS above */
L
Linus Torvalds 已提交
747 748
	movq %r10,%rcx	/* fixup for C */
	call *sys_call_table(,%rax,8)
R
Roland McGrath 已提交
749
	movq %rax,RAX-ARGOFFSET(%rsp)
750
	/* Use IRET because user could have changed frame */
751 752

/*
L
Linus Torvalds 已提交
753 754
 * Syscall return path ending with IRET.
 * Has correct top of stack, but partial stack frame.
755
 */
756
GLOBAL(int_ret_from_sys_call)
757
	DISABLE_INTERRUPTS(CLBR_NONE)
758
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
759 760
	movl $_TIF_ALLWORK_MASK,%edi
	/* edi:	mask to check */
761
GLOBAL(int_with_check)
762
	LOCKDEP_SYS_EXIT_IRQ
L
Linus Torvalds 已提交
763
	GET_THREAD_INFO(%rcx)
G
Glauber Costa 已提交
764
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
765 766
	andl %edi,%edx
	jnz   int_careful
G
Glauber Costa 已提交
767
	andl    $~TS_COMPAT,TI_status(%rcx)
L
Linus Torvalds 已提交
768 769 770 771 772 773 774 775
	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
776
	TRACE_IRQS_ON
777
	ENABLE_INTERRUPTS(CLBR_NONE)
778
	pushq_cfi %rdi
779
	SCHEDULE_USER
780
	popq_cfi %rdi
781
	DISABLE_INTERRUPTS(CLBR_NONE)
782
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
783 784 785 786
	jmp int_with_check

	/* handle signals and tracing -- both require a full stack frame */
int_very_careful:
787
	TRACE_IRQS_ON
788
	ENABLE_INTERRUPTS(CLBR_NONE)
789
int_check_syscall_exit_work:
L
Linus Torvalds 已提交
790
	SAVE_REST
791
	/* Check for syscall exit trace */
792
	testl $_TIF_WORK_SYSCALL_EXIT,%edx
L
Linus Torvalds 已提交
793
	jz int_signal
794
	pushq_cfi %rdi
795
	leaq 8(%rsp),%rdi	# &ptregs -> arg1
L
Linus Torvalds 已提交
796
	call syscall_trace_leave
797
	popq_cfi %rdi
798
	andl $~(_TIF_WORK_SYSCALL_EXIT|_TIF_SYSCALL_EMU),%edi
L
Linus Torvalds 已提交
799
	jmp int_restore_rest
800

L
Linus Torvalds 已提交
801
int_signal:
P
Peter Zijlstra 已提交
802
	testl $_TIF_DO_NOTIFY_MASK,%edx
L
Linus Torvalds 已提交
803 804 805 806
	jz 1f
	movq %rsp,%rdi		# &ptregs -> arg1
	xorl %esi,%esi		# oldset -> arg2
	call do_notify_resume
R
Roland McGrath 已提交
807
1:	movl $_TIF_WORK_MASK,%edi
L
Linus Torvalds 已提交
808 809
int_restore_rest:
	RESTORE_REST
810
	DISABLE_INTERRUPTS(CLBR_NONE)
811
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
812 813
	jmp int_with_check
	CFI_ENDPROC
814
END(system_call)
815

816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831
	.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

832 833 834 835 836 837 838 839 840 841 842 843
	.macro FIXED_FRAME label,func
ENTRY(\label)
	CFI_STARTPROC
	PARTIAL_FRAME 0 8		/* offset 8: return address */
	FIXUP_TOP_OF_STACK %r11, 8-ARGOFFSET
	call \func
	RESTORE_TOP_OF_STACK %r11, 8-ARGOFFSET
	ret
	CFI_ENDPROC
END(\label)
	.endm

844 845 846
	FORK_LIKE  clone
	FORK_LIKE  fork
	FORK_LIKE  vfork
847
	FIXED_FRAME stub_iopl, sys_iopl
L
Linus Torvalds 已提交
848 849

ENTRY(ptregscall_common)
850 851 852 853 854 855 856 857 858
	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 已提交
859
	CFI_ENDPROC
860
END(ptregscall_common)
861

L
Linus Torvalds 已提交
862 863
ENTRY(stub_execve)
	CFI_STARTPROC
864 865
	addq $8, %rsp
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
866 867 868 869 870 871 872
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
	call sys_execve
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
873
END(stub_execve)
874

L
Linus Torvalds 已提交
875 876 877
/*
 * 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.
878
 */
L
Linus Torvalds 已提交
879 880
ENTRY(stub_rt_sigreturn)
	CFI_STARTPROC
881
	addq $8, %rsp
882
	PARTIAL_FRAME 0
L
Linus Torvalds 已提交
883 884 885 886 887 888 889
	SAVE_REST
	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
890
END(stub_rt_sigreturn)
L
Linus Torvalds 已提交
891

892 893 894 895 896 897 898 899 900 901 902 903 904 905
#ifdef CONFIG_X86_X32_ABI
ENTRY(stub_x32_rt_sigreturn)
	CFI_STARTPROC
	addq $8, %rsp
	PARTIAL_FRAME 0
	SAVE_REST
	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 已提交
906 907 908 909 910 911
ENTRY(stub_x32_execve)
	CFI_STARTPROC
	addq $8, %rsp
	PARTIAL_FRAME 0
	SAVE_REST
	FIXUP_TOP_OF_STACK %r11
912
	call compat_sys_execve
H
H. Peter Anvin 已提交
913 914 915 916 917 918 919
	RESTORE_TOP_OF_STACK %r11
	movq %rax,RAX(%rsp)
	RESTORE_REST
	jmp int_ret_from_sys_call
	CFI_ENDPROC
END(stub_x32_execve)

920 921
#endif

922 923 924 925 926 927 928
/*
 * 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 已提交
929
	.section .entry.text
930 931 932 933 934 935 936 937 938
	.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
939
      .if vector <> FIRST_EXTERNAL_VECTOR
940 941
	CFI_ADJUST_CFA_OFFSET -8
      .endif
942
1:	pushq_cfi $(~vector+0x80)	/* Note: always in signed byte range */
943
      .if ((vector-FIRST_EXTERNAL_VECTOR)%7) <> 6
944 945 946 947
	jmp 2f
      .endif
      .previous
	.quad 1b
J
Jiri Olsa 已提交
948
      .section .entry.text
949 950 951 952 953 954 955 956 957 958 959 960
vector=vector+1
    .endif
  .endr
2:	jmp common_interrupt
.endr
	CFI_ENDPROC
END(irq_entries_start)

.previous
END(interrupt)
.previous

961
/*
L
Linus Torvalds 已提交
962 963 964
 * Interrupt entry/exit.
 *
 * Interrupt entry points save only callee clobbered registers in fast path.
965 966 967
 *
 * Entry runs with interrupts off.
 */
L
Linus Torvalds 已提交
968

969
/* 0(%rsp): ~(interrupt number) */
L
Linus Torvalds 已提交
970
	.macro interrupt func
971 972 973
	/* reserve pt_regs for scratch regs and rbp */
	subq $ORIG_RAX-RBP, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-RBP
974
	SAVE_ARGS_IRQ
L
Linus Torvalds 已提交
975 976 977
	call \func
	.endm

978 979 980 981
/*
 * Interrupt entry/exit should be protected against kprobes
 */
	.pushsection .kprobes.text, "ax"
982 983 984 985
	/*
	 * The interrupt stubs push (~vector+0x80) onto the stack and
	 * then jump to common_interrupt.
	 */
986 987
	.p2align CONFIG_X86_L1_CACHE_SHIFT
common_interrupt:
988
	XCPT_FRAME
989
	ASM_CLAC
990
	addq $-0x80,(%rsp)		/* Adjust vector to [-256,-1] range */
L
Linus Torvalds 已提交
991
	interrupt do_IRQ
992
	/* 0(%rsp): old_rsp-ARGOFFSET */
993
ret_from_intr:
994
	DISABLE_INTERRUPTS(CLBR_NONE)
995
	TRACE_IRQS_OFF
996
	decl PER_CPU_VAR(irq_count)
997

998 999
	/* Restore saved previous stack */
	popq %rsi
1000
	CFI_DEF_CFA rsi,SS+8-RBP	/* reg/off reset after def_cfa_expr */
1001
	leaq ARGOFFSET-RBP(%rsi), %rsp
1002
	CFI_DEF_CFA_REGISTER	rsp
1003
	CFI_ADJUST_CFA_OFFSET	RBP-ARGOFFSET
1004

1005
exit_intr:
L
Linus Torvalds 已提交
1006 1007 1008
	GET_THREAD_INFO(%rcx)
	testl $3,CS-ARGOFFSET(%rsp)
	je retint_kernel
1009

L
Linus Torvalds 已提交
1010 1011 1012 1013
	/* Interrupt came from user space */
	/*
	 * Has a correct top of stack, but a partial stack frame
	 * %rcx: thread info. Interrupts off.
1014
	 */
L
Linus Torvalds 已提交
1015 1016
retint_with_reschedule:
	movl $_TIF_WORK_MASK,%edi
1017
retint_check:
1018
	LOCKDEP_SYS_EXIT_IRQ
G
Glauber Costa 已提交
1019
	movl TI_flags(%rcx),%edx
L
Linus Torvalds 已提交
1020
	andl %edi,%edx
1021
	CFI_REMEMBER_STATE
L
Linus Torvalds 已提交
1022
	jnz  retint_careful
1023 1024

retint_swapgs:		/* return to user-space */
1025 1026 1027
	/*
	 * The iretq could re-enable interrupts:
	 */
1028
	DISABLE_INTERRUPTS(CLBR_ANY)
1029
	TRACE_IRQS_IRETQ
1030
	SWAPGS
1031 1032
	jmp restore_args

1033
retint_restore_args:	/* return to kernel space */
1034
	DISABLE_INTERRUPTS(CLBR_ANY)
1035 1036 1037 1038 1039
	/*
	 * The iretq could re-enable interrupts:
	 */
	TRACE_IRQS_IRETQ
restore_args:
1040
	RESTORE_ARGS 1,8,1
I
Ingo Molnar 已提交
1041

A
Adrian Bunk 已提交
1042
irq_return:
1043
	INTERRUPT_RETURN
1044
	_ASM_EXTABLE(irq_return, bad_iret)
I
Ingo Molnar 已提交
1045 1046

#ifdef CONFIG_PARAVIRT
1047
ENTRY(native_iret)
L
Linus Torvalds 已提交
1048
	iretq
1049
	_ASM_EXTABLE(native_iret, bad_iret)
I
Ingo Molnar 已提交
1050 1051
#endif

L
Linus Torvalds 已提交
1052 1053
	.section .fixup,"ax"
bad_iret:
1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068
	/*
	 * 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

1069 1070
	.previous

1071
	/* edi: workmask, edx: work */
L
Linus Torvalds 已提交
1072
retint_careful:
1073
	CFI_RESTORE_STATE
L
Linus Torvalds 已提交
1074 1075
	bt    $TIF_NEED_RESCHED,%edx
	jnc   retint_signal
1076
	TRACE_IRQS_ON
1077
	ENABLE_INTERRUPTS(CLBR_NONE)
1078
	pushq_cfi %rdi
1079
	SCHEDULE_USER
1080
	popq_cfi %rdi
L
Linus Torvalds 已提交
1081
	GET_THREAD_INFO(%rcx)
1082
	DISABLE_INTERRUPTS(CLBR_NONE)
1083
	TRACE_IRQS_OFF
L
Linus Torvalds 已提交
1084
	jmp retint_check
1085

L
Linus Torvalds 已提交
1086
retint_signal:
P
Peter Zijlstra 已提交
1087
	testl $_TIF_DO_NOTIFY_MASK,%edx
1088
	jz    retint_swapgs
1089
	TRACE_IRQS_ON
1090
	ENABLE_INTERRUPTS(CLBR_NONE)
L
Linus Torvalds 已提交
1091
	SAVE_REST
1092
	movq $-1,ORIG_RAX(%rsp)
1093
	xorl %esi,%esi		# oldset
L
Linus Torvalds 已提交
1094 1095 1096
	movq %rsp,%rdi		# &pt_regs
	call do_notify_resume
	RESTORE_REST
1097
	DISABLE_INTERRUPTS(CLBR_NONE)
1098
	TRACE_IRQS_OFF
1099
	GET_THREAD_INFO(%rcx)
R
Roland McGrath 已提交
1100
	jmp retint_with_reschedule
L
Linus Torvalds 已提交
1101 1102 1103 1104

#ifdef CONFIG_PREEMPT
	/* Returning to kernel space. Check if we need preemption */
	/* rcx:	 threadinfo. interrupts off. */
1105
ENTRY(retint_kernel)
1106
	cmpl $0,PER_CPU_VAR(__preempt_count)
L
Linus Torvalds 已提交
1107 1108 1109 1110 1111
	jnz  retint_restore_args
	bt   $9,EFLAGS-ARGOFFSET(%rsp)	/* interrupts off? */
	jnc  retint_restore_args
	call preempt_schedule_irq
	jmp exit_intr
1112
#endif
1113

L
Linus Torvalds 已提交
1114
	CFI_ENDPROC
1115
END(common_interrupt)
1116 1117 1118 1119
/*
 * End of kprobes section
 */
       .popsection
1120

L
Linus Torvalds 已提交
1121 1122
/*
 * APIC interrupts.
1123
 */
1124
.macro apicinterrupt3 num sym do_sym
1125
ENTRY(\sym)
1126
	INTR_FRAME
1127
	ASM_CLAC
1128
	pushq_cfi $~(\num)
1129
.Lcommon_\sym:
1130
	interrupt \do_sym
L
Linus Torvalds 已提交
1131 1132
	jmp ret_from_intr
	CFI_ENDPROC
1133 1134
END(\sym)
.endm
L
Linus Torvalds 已提交
1135

1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
#ifdef CONFIG_TRACING
#define trace(sym) trace_##sym
#define smp_trace(sym) smp_trace_##sym

.macro trace_apicinterrupt num sym
apicinterrupt3 \num trace(\sym) smp_trace(\sym)
.endm
#else
.macro trace_apicinterrupt num sym do_sym
.endm
#endif

.macro apicinterrupt num sym do_sym
apicinterrupt3 \num \sym \do_sym
trace_apicinterrupt \num \sym
.endm

1153
#ifdef CONFIG_SMP
1154
apicinterrupt3 IRQ_MOVE_CLEANUP_VECTOR \
1155
	irq_move_cleanup_interrupt smp_irq_move_cleanup_interrupt
1156
apicinterrupt3 REBOOT_VECTOR \
1157
	reboot_interrupt smp_reboot_interrupt
1158
#endif
L
Linus Torvalds 已提交
1159

N
Nick Piggin 已提交
1160
#ifdef CONFIG_X86_UV
1161
apicinterrupt3 UV_BAU_MESSAGE \
1162
	uv_bau_message_intr1 uv_bau_message_interrupt
N
Nick Piggin 已提交
1163
#endif
1164 1165
apicinterrupt LOCAL_TIMER_VECTOR \
	apic_timer_interrupt smp_apic_timer_interrupt
1166 1167
apicinterrupt X86_PLATFORM_IPI_VECTOR \
	x86_platform_ipi smp_x86_platform_ipi
1168

1169
#ifdef CONFIG_HAVE_KVM
1170
apicinterrupt3 POSTED_INTR_VECTOR \
1171 1172 1173
	kvm_posted_intr_ipi smp_kvm_posted_intr_ipi
#endif

1174
#ifdef CONFIG_X86_MCE_THRESHOLD
1175
apicinterrupt THRESHOLD_APIC_VECTOR \
1176
	threshold_interrupt smp_threshold_interrupt
1177 1178 1179
#endif

#ifdef CONFIG_X86_THERMAL_VECTOR
1180 1181
apicinterrupt THERMAL_APIC_VECTOR \
	thermal_interrupt smp_thermal_interrupt
1182
#endif
1183

1184 1185 1186 1187 1188 1189 1190 1191
#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 已提交
1192

1193 1194 1195 1196
apicinterrupt ERROR_APIC_VECTOR \
	error_interrupt smp_error_interrupt
apicinterrupt SPURIOUS_APIC_VECTOR \
	spurious_interrupt smp_spurious_interrupt
1197

1198 1199 1200
#ifdef CONFIG_IRQ_WORK
apicinterrupt IRQ_WORK_VECTOR \
	irq_work_interrupt smp_irq_work_interrupt
I
Ingo Molnar 已提交
1201 1202
#endif

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

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

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

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

1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291
#ifdef CONFIG_TRACING
.macro trace_errorentry sym do_sym
errorentry trace(\sym) trace(\do_sym)
errorentry \sym \do_sym
.endm
#else
.macro trace_errorentry sym do_sym
errorentry \sym \do_sym
.endm
#endif

L
Linus Torvalds 已提交
1292
	/* error code is on the stack already */
1293
.macro paranoiderrorentry sym do_sym
1294
ENTRY(\sym)
1295
	XCPT_FRAME
1296
	ASM_CLAC
1297
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1298 1299
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1300 1301
	call save_paranoid
	DEFAULT_FRAME 0
1302
	TRACE_IRQS_OFF
1303 1304 1305
	movq %rsp,%rdi			/* pt_regs pointer */
	movq ORIG_RAX(%rsp),%rsi	/* get error code */
	movq $-1,ORIG_RAX(%rsp)		/* no syscall to restart */
1306
	call \do_sym
1307 1308
	jmp paranoid_exit		/* %ebx: no swapgs flag */
	CFI_ENDPROC
1309 1310 1311 1312 1313 1314 1315 1316
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
1317
paranoiderrorentry double_fault do_double_fault
1318 1319 1320 1321 1322 1323 1324
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
1325

1326

1327 1328
	/* Reload gs selector with exception handling */
	/* edi:  new selector */
1329
ENTRY(native_load_gs_index)
1330
	CFI_STARTPROC
1331
	pushfq_cfi
1332
	DISABLE_INTERRUPTS(CLBR_ANY & ~CLBR_RDI)
1333
	SWAPGS
1334
gs_change:
1335
	movl %edi,%gs
L
Linus Torvalds 已提交
1336
2:	mfence		/* workaround */
1337
	SWAPGS
1338
	popfq_cfi
1339
	ret
1340
	CFI_ENDPROC
1341
END(native_load_gs_index)
1342

1343
	_ASM_EXTABLE(gs_change,bad_gs)
1344
	.section .fixup,"ax"
L
Linus Torvalds 已提交
1345
	/* running with kernelgs */
1346
bad_gs:
1347
	SWAPGS			/* switch back to user gs */
L
Linus Torvalds 已提交
1348
	xorl %eax,%eax
1349 1350 1351
	movl %eax,%gs
	jmp  2b
	.previous
1352

1353
/* Call softirq on interrupt stack. Interrupts are off. */
1354
ENTRY(do_softirq_own_stack)
1355
	CFI_STARTPROC
1356
	pushq_cfi %rbp
1357 1358 1359
	CFI_REL_OFFSET rbp,0
	mov  %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1360
	incl PER_CPU_VAR(irq_count)
1361
	cmove PER_CPU_VAR(irq_stack_ptr),%rsp
1362
	push  %rbp			# backlink for old unwinder
1363
	call __do_softirq
1364
	leaveq
1365
	CFI_RESTORE		rbp
1366
	CFI_DEF_CFA_REGISTER	rsp
1367
	CFI_ADJUST_CFA_OFFSET   -8
1368
	decl PER_CPU_VAR(irq_count)
1369
	ret
1370
	CFI_ENDPROC
1371
END(do_softirq_own_stack)
1372

1373
#ifdef CONFIG_XEN
1374
zeroentry xen_hypervisor_callback xen_do_hypervisor_callback
1375 1376

/*
1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388
 * 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.
 */
1389 1390
ENTRY(xen_do_hypervisor_callback)   # do_hypervisor_callback(struct *pt_regs)
	CFI_STARTPROC
1391 1392 1393 1394
/*
 * Since we don't modify %rdi, evtchn_do_upall(struct *pt_regs) will
 * see the correct pointer to the pt_regs
 */
1395 1396
	movq %rdi, %rsp            # we don't return, adjust the stack frame
	CFI_ENDPROC
1397
	DEFAULT_FRAME
1398
11:	incl PER_CPU_VAR(irq_count)
1399 1400
	movq %rsp,%rbp
	CFI_DEF_CFA_REGISTER rbp
1401
	cmovzq PER_CPU_VAR(irq_stack_ptr),%rsp
1402 1403 1404 1405
	pushq %rbp			# backlink for old unwinder
	call xen_evtchn_do_upcall
	popq %rsp
	CFI_DEF_CFA_REGISTER rsp
1406
	decl PER_CPU_VAR(irq_count)
1407 1408
	jmp  error_exit
	CFI_ENDPROC
1409
END(xen_do_hypervisor_callback)
1410 1411

/*
1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
 * 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.
 */
1424
ENTRY(xen_failsafe_callback)
1425 1426 1427 1428 1429 1430 1431
	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
1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451
	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 已提交
1452 1453 1454
	pushq_cfi $0	/* RIP */
	pushq_cfi %r11
	pushq_cfi %rcx
1455
	jmp general_protection
1456 1457 1458 1459 1460 1461 1462 1463
	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
1464
	pushq_cfi $-1 /* orig_ax = -1 => not a system call */
1465 1466 1467 1468 1469
	SAVE_ALL
	jmp error_exit
	CFI_ENDPROC
END(xen_failsafe_callback)

1470
apicinterrupt3 HYPERVISOR_CALLBACK_VECTOR \
1471 1472
	xen_hvm_callback_vector xen_evtchn_do_upcall

1473
#endif /* CONFIG_XEN */
1474

1475
#if IS_ENABLED(CONFIG_HYPERV)
1476
apicinterrupt3 HYPERVISOR_CALLBACK_VECTOR \
1477 1478 1479
	hyperv_callback_vector hyperv_vector_handler
#endif /* CONFIG_HYPERV */

1480 1481 1482 1483 1484 1485 1486 1487
/*
 * 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
1488 1489 1490 1491 1492
#ifdef CONFIG_XEN
zeroentry xen_debug do_debug
zeroentry xen_int3 do_int3
errorentry xen_stack_segment do_stack_segment
#endif
1493
errorentry general_protection do_general_protection
1494
trace_errorentry page_fault do_page_fault
G
Gleb Natapov 已提交
1495 1496 1497
#ifdef CONFIG_KVM_GUEST
errorentry async_page_fault do_async_page_fault
#endif
1498
#ifdef CONFIG_X86_MCE
1499
paranoidzeroentry machine_check *machine_check_vector(%rip)
1500 1501 1502
#endif

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

bstep_iret:
	/* Fix truncated RIP */
	movq %rcx,RIP+8(%rsp)
B
Brian Gerst 已提交
1617
	jmp error_swapgs
1618
	CFI_ENDPROC
1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640
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)

1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651
/*
 * 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
1652 1653 1654 1655 1656

	/* runs on exception stack */
ENTRY(nmi)
	INTR_FRAME
	PARAVIRT_ADJUST_EXCEPTION_FRAME
1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690
	/*
	 * 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
1691
	CFI_REL_OFFSET rdx, 0
1692

1693 1694 1695 1696
	/*
	 * If %cs was not the kernel segment, then the NMI triggered in user
	 * space, which means it is definitely not nested.
	 */
1697
	cmpl $__KERNEL_CS, 16(%rsp)
1698 1699
	jne first_nmi

1700 1701 1702 1703
	/*
	 * Check the special variable on the stack to see if NMIs are
	 * executing.
	 */
1704
	cmpl $1, -8(%rsp)
1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715
	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
1716
	CFI_REMEMBER_STATE
1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732

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 */
1733
	leaq -1*8(%rsp), %rdx
1734
	movq %rdx, %rsp
1735 1736
	CFI_ADJUST_CFA_OFFSET 1*8
	leaq -10*8(%rsp), %rdx
1737 1738 1739 1740 1741 1742 1743
	pushq_cfi $__KERNEL_DS
	pushq_cfi %rdx
	pushfq_cfi
	pushq_cfi $__KERNEL_CS
	pushq_cfi $repeat_nmi

	/* Put stack back */
1744 1745
	addq $(6*8), %rsp
	CFI_ADJUST_CFA_OFFSET -6*8
1746 1747 1748

nested_nmi_out:
	popq_cfi %rdx
1749
	CFI_RESTORE rdx
1750 1751 1752 1753

	/* No need to check faults here */
	INTERRUPT_RETURN

1754
	CFI_RESTORE_STATE
1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776
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              |
	 * +-------------------------+
1777 1778 1779 1780 1781 1782
	 * | Saved SS                |
	 * | Saved Return RSP        |
	 * | Saved RFLAGS            |
	 * | Saved CS                |
	 * | Saved RIP               |
	 * +-------------------------+
1783 1784 1785
	 * | pt_regs                 |
	 * +-------------------------+
	 *
1786 1787 1788
	 * 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
1789 1790
	 * is also used by nested NMIs and can not be trusted on exit.
	 */
1791
	/* Do not pop rdx, nested NMIs will corrupt that part of the stack */
1792 1793 1794
	movq (%rsp), %rdx
	CFI_RESTORE rdx

1795 1796 1797
	/* Set the NMI executing variable on the stack. */
	pushq_cfi $1

1798 1799 1800 1801
	/*
	 * Leave room for the "copied" frame
	 */
	subq $(5*8), %rsp
1802
	CFI_ADJUST_CFA_OFFSET 5*8
1803

1804 1805
	/* Copy the stack frame to the Saved frame */
	.rept 5
1806
	pushq_cfi 11*8(%rsp)
1807
	.endr
1808 1809
	CFI_DEF_CFA_OFFSET SS+8-RIP

1810 1811
	/* Everything up to here is safe from nested NMIs */

1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826
	/*
	 * 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).
	 */
1827
	movq $1, 10*8(%rsp)
1828 1829

	/* Make another copy, this one may be modified by nested NMIs */
1830 1831
	addq $(10*8), %rsp
	CFI_ADJUST_CFA_OFFSET -10*8
1832
	.rept 5
1833
	pushq_cfi -6*8(%rsp)
1834
	.endr
1835
	subq $(5*8), %rsp
1836 1837
	CFI_DEF_CFA_OFFSET SS+8-RIP
end_repeat_nmi:
1838 1839 1840

	/*
	 * Everything below this point can be preempted by a nested
1841 1842
	 * NMI if the first NMI took an exception and reset our iret stack
	 * so that we repeat another NMI.
1843
	 */
1844
	pushq_cfi $-1		/* ORIG_RAX: no syscall to restart */
1845 1846
	subq $ORIG_RAX-R15, %rsp
	CFI_ADJUST_CFA_OFFSET ORIG_RAX-R15
1847 1848 1849 1850 1851 1852 1853
	/*
	 * 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.
	 */
1854 1855
	call save_paranoid
	DEFAULT_FRAME 0
1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867

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

1868 1869 1870 1871
	/* paranoidentry do_nmi, 0; without TRACE_IRQS_OFF */
	movq %rsp,%rdi
	movq $-1,%rsi
	call do_nmi
1872 1873 1874 1875 1876 1877 1878 1879

	/* Did the NMI take a page fault? Restore cr2 if it did */
	movq %cr2, %rcx
	cmpq %rcx, %r12
	je 1f
	movq %r12, %cr2
1:
	
1880 1881 1882 1883 1884
	testl %ebx,%ebx				/* swapgs needed? */
	jnz nmi_restore
nmi_swapgs:
	SWAPGS_UNSAFE_STACK
nmi_restore:
1885 1886
	/* Pop the extra iret frame at once */
	RESTORE_ALL 6*8
1887

1888
	/* Clear the NMI executing stack variable */
1889
	movq $0, 5*8(%rsp)
1890
	jmp irq_return
1891
	CFI_ENDPROC
1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904
END(nmi)

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

/*
 * End of kprobes section
 */
	.popsection