Linux Audio

Check our new training course

Loading...
v5.4
   1/* SPDX-License-Identifier: GPL-2.0 */
   2/*
   3 *    S390 low-level entry points.
   4 *
   5 *    Copyright IBM Corp. 1999, 2012
   6 *    Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
   7 *		 Hartmut Penner (hp@de.ibm.com),
   8 *		 Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
   9 *		 Heiko Carstens <heiko.carstens@de.ibm.com>
  10 */
  11
  12#include <linux/init.h>
  13#include <linux/linkage.h>
  14#include <asm/alternative-asm.h>
  15#include <asm/processor.h>
  16#include <asm/cache.h>
  17#include <asm/ctl_reg.h>
  18#include <asm/dwarf.h>
  19#include <asm/errno.h>
  20#include <asm/ptrace.h>
  21#include <asm/thread_info.h>
  22#include <asm/asm-offsets.h>
  23#include <asm/unistd.h>
  24#include <asm/page.h>
  25#include <asm/sigp.h>
  26#include <asm/irq.h>
  27#include <asm/vx-insn.h>
  28#include <asm/setup.h>
  29#include <asm/nmi.h>
  30#include <asm/export.h>
  31#include <asm/nospec-insn.h>
  32
  33__PT_R0      =	__PT_GPRS
  34__PT_R1      =	__PT_GPRS + 8
  35__PT_R2      =	__PT_GPRS + 16
  36__PT_R3      =	__PT_GPRS + 24
  37__PT_R4      =	__PT_GPRS + 32
  38__PT_R5      =	__PT_GPRS + 40
  39__PT_R6      =	__PT_GPRS + 48
  40__PT_R7      =	__PT_GPRS + 56
  41__PT_R8      =	__PT_GPRS + 64
  42__PT_R9      =	__PT_GPRS + 72
  43__PT_R10     =	__PT_GPRS + 80
  44__PT_R11     =	__PT_GPRS + 88
  45__PT_R12     =	__PT_GPRS + 96
  46__PT_R13     =	__PT_GPRS + 104
  47__PT_R14     =	__PT_GPRS + 112
  48__PT_R15     =	__PT_GPRS + 120
  49
  50STACK_SHIFT = PAGE_SHIFT + THREAD_SIZE_ORDER
  51STACK_SIZE  = 1 << STACK_SHIFT
  52STACK_INIT = STACK_SIZE - STACK_FRAME_OVERHEAD - __PT_SIZE
  53
  54_TIF_WORK	= (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
  55		   _TIF_UPROBE | _TIF_GUARDED_STORAGE | _TIF_PATCH_PENDING)
  56_TIF_TRACE	= (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_AUDIT | _TIF_SECCOMP | \
  57		   _TIF_SYSCALL_TRACEPOINT)
  58_CIF_WORK	= (_CIF_MCCK_PENDING | _CIF_ASCE_PRIMARY | \
  59		   _CIF_ASCE_SECONDARY | _CIF_FPU)
  60_PIF_WORK	= (_PIF_PER_TRAP | _PIF_SYSCALL_RESTART)
  61
  62_LPP_OFFSET	= __LC_LPP
  63
  64#define BASED(name) name-cleanup_critical(%r13)
  65
  66	.macro	TRACE_IRQS_ON
  67#ifdef CONFIG_TRACE_IRQFLAGS
  68	basr	%r2,%r0
  69	brasl	%r14,trace_hardirqs_on_caller
  70#endif
  71	.endm
  72
  73	.macro	TRACE_IRQS_OFF
  74#ifdef CONFIG_TRACE_IRQFLAGS
  75	basr	%r2,%r0
  76	brasl	%r14,trace_hardirqs_off_caller
  77#endif
  78	.endm
  79
  80	.macro	LOCKDEP_SYS_EXIT
  81#ifdef CONFIG_LOCKDEP
  82	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
  83	jz	.+10
  84	brasl	%r14,lockdep_sys_exit
  85#endif
  86	.endm
  87
  88	.macro	CHECK_STACK savearea
  89#ifdef CONFIG_CHECK_STACK
  90	tml	%r15,STACK_SIZE - CONFIG_STACK_GUARD
  91	lghi	%r14,\savearea
  92	jz	stack_overflow
  93#endif
  94	.endm
  95
  96	.macro	CHECK_VMAP_STACK savearea,oklabel
  97#ifdef CONFIG_VMAP_STACK
  98	lgr	%r14,%r15
  99	nill	%r14,0x10000 - STACK_SIZE
 100	oill	%r14,STACK_INIT
 101	clg	%r14,__LC_KERNEL_STACK
 102	je	\oklabel
 103	clg	%r14,__LC_ASYNC_STACK
 104	je	\oklabel
 105	clg	%r14,__LC_NODAT_STACK
 106	je	\oklabel
 107	clg	%r14,__LC_RESTART_STACK
 108	je	\oklabel
 109	lghi	%r14,\savearea
 110	j	stack_overflow
 111#else
 112	j	\oklabel
 113#endif
 114	.endm
 115
 116	.macro	SWITCH_ASYNC savearea,timer
 117	tmhh	%r8,0x0001		# interrupting from user ?
 118	jnz	1f
 119	lgr	%r14,%r9
 120	slg	%r14,BASED(.Lcritical_start)
 121	clg	%r14,BASED(.Lcritical_length)
 122	jhe	0f
 123	lghi	%r11,\savearea		# inside critical section, do cleanup
 124	brasl	%r14,cleanup_critical
 125	tmhh	%r8,0x0001		# retest problem state after cleanup
 126	jnz	1f
 1270:	lg	%r14,__LC_ASYNC_STACK	# are we already on the target stack?
 128	slgr	%r14,%r15
 129	srag	%r14,%r14,STACK_SHIFT
 130	jnz	2f
 131	CHECK_STACK \savearea
 132	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 133	j	3f
 1341:	UPDATE_VTIME %r14,%r15,\timer
 135	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
 1362:	lg	%r15,__LC_ASYNC_STACK	# load async stack
 1373:	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 138	.endm
 139
 140	.macro UPDATE_VTIME w1,w2,enter_timer
 141	lg	\w1,__LC_EXIT_TIMER
 142	lg	\w2,__LC_LAST_UPDATE_TIMER
 143	slg	\w1,\enter_timer
 144	slg	\w2,__LC_EXIT_TIMER
 145	alg	\w1,__LC_USER_TIMER
 146	alg	\w2,__LC_SYSTEM_TIMER
 147	stg	\w1,__LC_USER_TIMER
 148	stg	\w2,__LC_SYSTEM_TIMER
 149	mvc	__LC_LAST_UPDATE_TIMER(8),\enter_timer
 150	.endm
 151
 
 
 
 
 
 
 
 
 
 
 
 
 152	.macro REENABLE_IRQS
 153	stg	%r8,__LC_RETURN_PSW
 154	ni	__LC_RETURN_PSW,0xbf
 155	ssm	__LC_RETURN_PSW
 156	.endm
 157
 158	.macro STCK savearea
 159#ifdef CONFIG_HAVE_MARCH_Z9_109_FEATURES
 160	.insn	s,0xb27c0000,\savearea		# store clock fast
 161#else
 162	.insn	s,0xb2050000,\savearea		# store clock
 163#endif
 164	.endm
 165
 166	/*
 167	 * The TSTMSK macro generates a test-under-mask instruction by
 168	 * calculating the memory offset for the specified mask value.
 169	 * Mask value can be any constant.  The macro shifts the mask
 170	 * value to calculate the memory offset for the test-under-mask
 171	 * instruction.
 172	 */
 173	.macro TSTMSK addr, mask, size=8, bytepos=0
 174		.if (\bytepos < \size) && (\mask >> 8)
 175			.if (\mask & 0xff)
 176				.error "Mask exceeds byte boundary"
 177			.endif
 178			TSTMSK \addr, "(\mask >> 8)", \size, "(\bytepos + 1)"
 179			.exitm
 180		.endif
 181		.ifeq \mask
 182			.error "Mask must not be zero"
 183		.endif
 184		off = \size - \bytepos - 1
 185		tm	off+\addr, \mask
 186	.endm
 187
 188	.macro BPOFF
 189	ALTERNATIVE "", ".long 0xb2e8c000", 82
 190	.endm
 191
 192	.macro BPON
 193	ALTERNATIVE "", ".long 0xb2e8d000", 82
 194	.endm
 195
 196	.macro BPENTER tif_ptr,tif_mask
 197	ALTERNATIVE "TSTMSK \tif_ptr,\tif_mask; jz .+8; .long 0xb2e8d000", \
 198		    "", 82
 199	.endm
 200
 201	.macro BPEXIT tif_ptr,tif_mask
 202	TSTMSK	\tif_ptr,\tif_mask
 203	ALTERNATIVE "jz .+8;  .long 0xb2e8c000", \
 204		    "jnz .+8; .long 0xb2e8d000", 82
 205	.endm
 206
 207	GEN_BR_THUNK %r9
 208	GEN_BR_THUNK %r14
 209	GEN_BR_THUNK %r14,%r11
 210
 211	.section .kprobes.text, "ax"
 212.Ldummy:
 213	/*
 214	 * This nop exists only in order to avoid that __switch_to starts at
 215	 * the beginning of the kprobes text section. In that case we would
 216	 * have several symbols at the same address. E.g. objdump would take
 217	 * an arbitrary symbol name when disassembling this code.
 218	 * With the added nop in between the __switch_to symbol is unique
 219	 * again.
 220	 */
 221	nop	0
 222
 223ENTRY(__bpon)
 224	.globl __bpon
 225	BPON
 226	BR_EX	%r14
 227ENDPROC(__bpon)
 228
 229/*
 230 * Scheduler resume function, called by switch_to
 231 *  gpr2 = (task_struct *) prev
 232 *  gpr3 = (task_struct *) next
 233 * Returns:
 234 *  gpr2 = prev
 235 */
 236ENTRY(__switch_to)
 237	stmg	%r6,%r15,__SF_GPRS(%r15)	# store gprs of prev task
 238	lghi	%r4,__TASK_stack
 239	lghi	%r1,__TASK_thread
 240	llill	%r5,STACK_INIT
 241	stg	%r15,__THREAD_ksp(%r1,%r2)	# store kernel stack of prev
 242	lg	%r15,0(%r4,%r3)			# start of kernel stack of next
 243	agr	%r15,%r5			# end of kernel stack of next
 
 
 244	stg	%r3,__LC_CURRENT		# store task struct of next
 245	stg	%r15,__LC_KERNEL_STACK		# store end of kernel stack
 246	lg	%r15,__THREAD_ksp(%r1,%r3)	# load kernel stack of next
 247	aghi	%r3,__TASK_pid
 248	mvc	__LC_CURRENT_PID(4,%r0),0(%r3)	# store pid of next
 
 249	lmg	%r6,%r15,__SF_GPRS(%r15)	# load gprs of next task
 250	ALTERNATIVE "", ".insn s,0xb2800000,_LPP_OFFSET", 40
 251	BR_EX	%r14
 252ENDPROC(__switch_to)
 
 253
 254.L__critical_start:
 255
 256#if IS_ENABLED(CONFIG_KVM)
 257/*
 258 * sie64a calling convention:
 259 * %r2 pointer to sie control block
 260 * %r3 guest register save area
 261 */
 262ENTRY(sie64a)
 263	stmg	%r6,%r14,__SF_GPRS(%r15)	# save kernel registers
 264	lg	%r12,__LC_CURRENT
 265	stg	%r2,__SF_SIE_CONTROL(%r15)	# save control block pointer
 266	stg	%r3,__SF_SIE_SAVEAREA(%r15)	# save guest register save area
 267	xc	__SF_SIE_REASON(8,%r15),__SF_SIE_REASON(%r15) # reason code = 0
 268	mvc	__SF_SIE_FLAGS(8,%r15),__TI_flags(%r12) # copy thread flags
 269	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU		# load guest fp/vx registers ?
 270	jno	.Lsie_load_guest_gprs
 271	brasl	%r14,load_fpu_regs		# load guest fp/vx regs
 272.Lsie_load_guest_gprs:
 273	lmg	%r0,%r13,0(%r3)			# load guest gprs 0-13
 274	lg	%r14,__LC_GMAP			# get gmap pointer
 275	ltgr	%r14,%r14
 276	jz	.Lsie_gmap
 277	lctlg	%c1,%c1,__GMAP_ASCE(%r14)	# load primary asce
 278.Lsie_gmap:
 279	lg	%r14,__SF_SIE_CONTROL(%r15)	# get control block pointer
 280	oi	__SIE_PROG0C+3(%r14),1		# we are going into SIE now
 281	tm	__SIE_PROG20+3(%r14),3		# last exit...
 282	jnz	.Lsie_skip
 283	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 284	jo	.Lsie_skip			# exit if fp/vx regs changed
 285	BPEXIT	__SF_SIE_FLAGS(%r15),(_TIF_ISOLATE_BP|_TIF_ISOLATE_BP_GUEST)
 286.Lsie_entry:
 287	sie	0(%r14)
 288.Lsie_exit:
 289	BPOFF
 290	BPENTER	__SF_SIE_FLAGS(%r15),(_TIF_ISOLATE_BP|_TIF_ISOLATE_BP_GUEST)
 291.Lsie_skip:
 292	ni	__SIE_PROG0C+3(%r14),0xfe	# no longer in SIE
 293	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 294.Lsie_done:
 295# some program checks are suppressing. C code (e.g. do_protection_exception)
 296# will rewind the PSW by the ILC, which is often 4 bytes in case of SIE. There
 297# are some corner cases (e.g. runtime instrumentation) where ILC is unpredictable.
 298# Other instructions between sie64a and .Lsie_done should not cause program
 299# interrupts. So lets use 3 nops as a landing pad for all possible rewinds.
 300# See also .Lcleanup_sie
 301.Lrewind_pad6:
 302	nopr	7
 303.Lrewind_pad4:
 304	nopr	7
 305.Lrewind_pad2:
 306	nopr	7
 307	.globl sie_exit
 308sie_exit:
 309	lg	%r14,__SF_SIE_SAVEAREA(%r15)	# load guest register save area
 310	stmg	%r0,%r13,0(%r14)		# save guest gprs 0-13
 311	xgr	%r0,%r0				# clear guest registers to
 312	xgr	%r1,%r1				# prevent speculative use
 313	xgr	%r2,%r2
 314	xgr	%r3,%r3
 315	xgr	%r4,%r4
 316	xgr	%r5,%r5
 317	lmg	%r6,%r14,__SF_GPRS(%r15)	# restore kernel registers
 318	lg	%r2,__SF_SIE_REASON(%r15)	# return exit reason code
 319	BR_EX	%r14
 320.Lsie_fault:
 321	lghi	%r14,-EFAULT
 322	stg	%r14,__SF_SIE_REASON(%r15)	# set exit reason code
 323	j	sie_exit
 324
 325	EX_TABLE(.Lrewind_pad6,.Lsie_fault)
 326	EX_TABLE(.Lrewind_pad4,.Lsie_fault)
 327	EX_TABLE(.Lrewind_pad2,.Lsie_fault)
 328	EX_TABLE(sie_exit,.Lsie_fault)
 329ENDPROC(sie64a)
 330EXPORT_SYMBOL(sie64a)
 331EXPORT_SYMBOL(sie_exit)
 332#endif
 333
 334/*
 335 * SVC interrupt handler routine. System calls are synchronous events and
 336 * are executed with interrupts enabled.
 337 */
 338
 339ENTRY(system_call)
 340	stpt	__LC_SYNC_ENTER_TIMER
 341.Lsysc_stmg:
 342	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
 343	BPOFF
 344	lg	%r12,__LC_CURRENT
 345	lghi	%r13,__TASK_thread
 346	lghi	%r14,_PIF_SYSCALL
 347.Lsysc_per:
 348	lg	%r15,__LC_KERNEL_STACK
 349	la	%r11,STACK_FRAME_OVERHEAD(%r15)	# pointer to pt_regs
 
 350.Lsysc_vtime:
 351	UPDATE_VTIME %r8,%r9,__LC_SYNC_ENTER_TIMER
 352	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
 353	stmg	%r0,%r7,__PT_R0(%r11)
 354	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
 355	mvc	__PT_PSW(16,%r11),__LC_SVC_OLD_PSW
 356	mvc	__PT_INT_CODE(4,%r11),__LC_SVC_ILC
 357	stg	%r14,__PT_FLAGS(%r11)
 358.Lsysc_do_svc:
 359	# clear user controlled register to prevent speculative use
 360	xgr	%r0,%r0
 361	# load address of system call table
 
 
 
 
 362	lg	%r10,__THREAD_sysc_table(%r13,%r12)
 
 363	llgh	%r8,__PT_INT_CODE+2(%r11)
 364	slag	%r8,%r8,3			# shift and test for svc 0
 365	jnz	.Lsysc_nr_ok
 366	# svc 0: system call number in %r1
 367	llgfr	%r1,%r1				# clear high word in r1
 368	cghi	%r1,NR_syscalls
 369	jnl	.Lsysc_nr_ok
 370	sth	%r1,__PT_INT_CODE+2(%r11)
 371	slag	%r8,%r1,3
 372.Lsysc_nr_ok:
 373	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 374	stg	%r2,__PT_ORIG_GPR2(%r11)
 375	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
 376	lg	%r9,0(%r8,%r10)			# get system call add.
 377	TSTMSK	__TI_flags(%r12),_TIF_TRACE
 378	jnz	.Lsysc_tracesys
 379	BASR_EX	%r14,%r9			# call sys_xxxx
 380	stg	%r2,__PT_R2(%r11)		# store return value
 381
 382.Lsysc_return:
 383#ifdef CONFIG_DEBUG_RSEQ
 384	lgr	%r2,%r11
 385	brasl	%r14,rseq_syscall
 386#endif
 387	LOCKDEP_SYS_EXIT
 388.Lsysc_tif:
 389	TSTMSK	__PT_FLAGS(%r11),_PIF_WORK
 390	jnz	.Lsysc_work
 391	TSTMSK	__TI_flags(%r12),_TIF_WORK
 392	jnz	.Lsysc_work			# check for work
 393	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
 394	jnz	.Lsysc_work
 395	BPEXIT	__TI_flags(%r12),_TIF_ISOLATE_BP
 396.Lsysc_restore:
 397	lg	%r14,__LC_VDSO_PER_CPU
 398	lmg	%r0,%r10,__PT_R0(%r11)
 399	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
 400.Lsysc_exit_timer:
 401	stpt	__LC_EXIT_TIMER
 402	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 403	lmg	%r11,%r15,__PT_R11(%r11)
 404	lpswe	__LC_RETURN_PSW
 405.Lsysc_done:
 406
 407#
 408# One of the work bits is on. Find out which one.
 409#
 410.Lsysc_work:
 411	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 412	jo	.Lsysc_mcck_pending
 413	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 414	jo	.Lsysc_reschedule
 415	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL_RESTART
 416	jo	.Lsysc_syscall_restart
 417#ifdef CONFIG_UPROBES
 418	TSTMSK	__TI_flags(%r12),_TIF_UPROBE
 419	jo	.Lsysc_uprobe_notify
 420#endif
 421	TSTMSK	__TI_flags(%r12),_TIF_GUARDED_STORAGE
 422	jo	.Lsysc_guarded_storage
 423	TSTMSK	__PT_FLAGS(%r11),_PIF_PER_TRAP
 424	jo	.Lsysc_singlestep
 425#ifdef CONFIG_LIVEPATCH
 426	TSTMSK	__TI_flags(%r12),_TIF_PATCH_PENDING
 427	jo	.Lsysc_patch_pending	# handle live patching just before
 428					# signals and possible syscall restart
 429#endif
 430	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL_RESTART
 431	jo	.Lsysc_syscall_restart
 432	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
 433	jo	.Lsysc_sigpending
 434	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
 435	jo	.Lsysc_notify_resume
 436	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 437	jo	.Lsysc_vxrs
 438	TSTMSK	__LC_CPU_FLAGS,(_CIF_ASCE_PRIMARY|_CIF_ASCE_SECONDARY)
 439	jnz	.Lsysc_asce
 440	j	.Lsysc_return		# beware of critical section cleanup
 441
 442#
 443# _TIF_NEED_RESCHED is set, call schedule
 444#
 445.Lsysc_reschedule:
 446	larl	%r14,.Lsysc_return
 447	jg	schedule
 448
 449#
 450# _CIF_MCCK_PENDING is set, call handler
 451#
 452.Lsysc_mcck_pending:
 453	larl	%r14,.Lsysc_return
 454	jg	s390_handle_mcck	# TIF bit will be cleared by handler
 455
 456#
 457# _CIF_ASCE_PRIMARY and/or _CIF_ASCE_SECONDARY set, load user space asce
 458#
 459.Lsysc_asce:
 460	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_SECONDARY
 461	lctlg	%c7,%c7,__LC_VDSO_ASCE		# load secondary asce
 462	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE_PRIMARY
 463	jz	.Lsysc_return
 464#ifndef CONFIG_HAVE_MARCH_Z10_FEATURES
 465	tm	__LC_STFLE_FAC_LIST+3,0x10	# has MVCOS ?
 466	jnz	.Lsysc_set_fs_fixup
 467	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_PRIMARY
 468	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 469	j	.Lsysc_return
 470.Lsysc_set_fs_fixup:
 471#endif
 472	larl	%r14,.Lsysc_return
 473	jg	set_fs_fixup
 474
 475#
 476# CIF_FPU is set, restore floating-point controls and floating-point registers.
 477#
 478.Lsysc_vxrs:
 479	larl	%r14,.Lsysc_return
 480	jg	load_fpu_regs
 481
 482#
 483# _TIF_SIGPENDING is set, call do_signal
 484#
 485.Lsysc_sigpending:
 486	lgr	%r2,%r11		# pass pointer to pt_regs
 487	brasl	%r14,do_signal
 488	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
 489	jno	.Lsysc_return
 490.Lsysc_do_syscall:
 491	lghi	%r13,__TASK_thread
 492	lmg	%r2,%r7,__PT_R2(%r11)	# load svc arguments
 493	lghi	%r1,0			# svc 0 returns -ENOSYS
 494	j	.Lsysc_do_svc
 
 
 
 
 495
 496#
 497# _TIF_NOTIFY_RESUME is set, call do_notify_resume
 498#
 499.Lsysc_notify_resume:
 500	lgr	%r2,%r11		# pass pointer to pt_regs
 501	larl	%r14,.Lsysc_return
 502	jg	do_notify_resume
 503
 504#
 505# _TIF_UPROBE is set, call uprobe_notify_resume
 506#
 507#ifdef CONFIG_UPROBES
 508.Lsysc_uprobe_notify:
 509	lgr	%r2,%r11		# pass pointer to pt_regs
 510	larl	%r14,.Lsysc_return
 511	jg	uprobe_notify_resume
 512#endif
 513
 514#
 515# _TIF_GUARDED_STORAGE is set, call guarded_storage_load
 516#
 517.Lsysc_guarded_storage:
 518	lgr	%r2,%r11		# pass pointer to pt_regs
 519	larl	%r14,.Lsysc_return
 520	jg	gs_load_bc_cb
 521#
 522# _TIF_PATCH_PENDING is set, call klp_update_patch_state
 523#
 524#ifdef CONFIG_LIVEPATCH
 525.Lsysc_patch_pending:
 526	lg	%r2,__LC_CURRENT	# pass pointer to task struct
 527	larl	%r14,.Lsysc_return
 528	jg	klp_update_patch_state
 529#endif
 530
 531#
 532# _PIF_PER_TRAP is set, call do_per_trap
 533#
 534.Lsysc_singlestep:
 535	ni	__PT_FLAGS+7(%r11),255-_PIF_PER_TRAP
 536	lgr	%r2,%r11		# pass pointer to pt_regs
 537	larl	%r14,.Lsysc_return
 538	jg	do_per_trap
 539
 540#
 541# _PIF_SYSCALL_RESTART is set, repeat the current system call
 542#
 543.Lsysc_syscall_restart:
 544	ni	__PT_FLAGS+7(%r11),255-_PIF_SYSCALL_RESTART
 545	lmg	%r1,%r7,__PT_R1(%r11)	# load svc arguments
 546	lg	%r2,__PT_ORIG_GPR2(%r11)
 547	j	.Lsysc_do_svc
 548
 549#
 550# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
 551# and after the system call
 552#
 553.Lsysc_tracesys:
 554	lgr	%r2,%r11		# pass pointer to pt_regs
 555	la	%r3,0
 556	llgh	%r0,__PT_INT_CODE+2(%r11)
 557	stg	%r0,__PT_R2(%r11)
 558	brasl	%r14,do_syscall_trace_enter
 559	lghi	%r0,NR_syscalls
 560	clgr	%r0,%r2
 561	jnh	.Lsysc_tracenogo
 562	sllg	%r8,%r2,3
 563	lg	%r9,0(%r8,%r10)
 564.Lsysc_tracego:
 565	lmg	%r3,%r7,__PT_R3(%r11)
 566	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
 567	lg	%r2,__PT_ORIG_GPR2(%r11)
 568	BASR_EX	%r14,%r9		# call sys_xxx
 569	stg	%r2,__PT_R2(%r11)	# store return value
 570.Lsysc_tracenogo:
 571	TSTMSK	__TI_flags(%r12),_TIF_TRACE
 572	jz	.Lsysc_return
 573	lgr	%r2,%r11		# pass pointer to pt_regs
 574	larl	%r14,.Lsysc_return
 575	jg	do_syscall_trace_exit
 576ENDPROC(system_call)
 577
 578#
 579# a new process exits the kernel with ret_from_fork
 580#
 581ENTRY(ret_from_fork)
 582	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 583	lg	%r12,__LC_CURRENT
 584	brasl	%r14,schedule_tail
 585	TRACE_IRQS_ON
 586	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 587	tm	__PT_PSW+1(%r11),0x01	# forking a kernel thread ?
 588	jne	.Lsysc_tracenogo
 589	# it's a kernel thread
 590	lmg	%r9,%r10,__PT_R9(%r11)	# load gprs
 591	la	%r2,0(%r10)
 592	BASR_EX	%r14,%r9
 593	j	.Lsysc_tracenogo
 594ENDPROC(ret_from_fork)
 595
 596ENTRY(kernel_thread_starter)
 597	la	%r2,0(%r10)
 598	BASR_EX	%r14,%r9
 599	j	.Lsysc_tracenogo
 600ENDPROC(kernel_thread_starter)
 601
 602/*
 603 * Program check handler routine
 604 */
 605
 606ENTRY(pgm_check_handler)
 607	stpt	__LC_SYNC_ENTER_TIMER
 608	BPOFF
 609	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
 610	lg	%r10,__LC_LAST_BREAK
 611	lg	%r12,__LC_CURRENT
 612	lghi	%r11,0
 613	larl	%r13,cleanup_critical
 614	lmg	%r8,%r9,__LC_PGM_OLD_PSW
 615	tmhh	%r8,0x0001		# test problem state bit
 616	jnz	2f			# -> fault in user space
 617#if IS_ENABLED(CONFIG_KVM)
 618	# cleanup critical section for program checks in sie64a
 619	lgr	%r14,%r9
 620	slg	%r14,BASED(.Lsie_critical_start)
 621	clg	%r14,BASED(.Lsie_critical_length)
 622	jhe	0f
 623	lg	%r14,__SF_SIE_CONTROL(%r15)	# get control block pointer
 624	ni	__SIE_PROG0C+3(%r14),0xfe	# no longer in SIE
 625	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 626	larl	%r9,sie_exit			# skip forward to sie_exit
 627	lghi	%r11,_PIF_GUEST_FAULT
 628#endif
 6290:	tmhh	%r8,0x4000		# PER bit set in old PSW ?
 630	jnz	1f			# -> enabled, can't be a double fault
 631	tm	__LC_PGM_ILC+3,0x80	# check for per exception
 632	jnz	.Lpgm_svcper		# -> single stepped svc
 6331:	CHECK_STACK __LC_SAVE_AREA_SYNC
 634	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 635	# CHECK_VMAP_STACK branches to stack_overflow or 4f
 636	CHECK_VMAP_STACK __LC_SAVE_AREA_SYNC,4f
 6372:	UPDATE_VTIME %r14,%r15,__LC_SYNC_ENTER_TIMER
 638	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
 639	lg	%r15,__LC_KERNEL_STACK
 640	lgr	%r14,%r12
 641	aghi	%r14,__TASK_thread	# pointer to thread_struct
 642	lghi	%r13,__LC_PGM_TDB
 643	tm	__LC_PGM_ILC+2,0x02	# check for transaction abort
 644	jz	3f
 645	mvc	__THREAD_trap_tdb(256,%r14),0(%r13)
 6463:	stg	%r10,__THREAD_last_break(%r14)
 6474:	lgr	%r13,%r11
 648	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 649	stmg	%r0,%r7,__PT_R0(%r11)
 650	# clear user controlled registers to prevent speculative use
 651	xgr	%r0,%r0
 652	xgr	%r1,%r1
 653	xgr	%r2,%r2
 654	xgr	%r3,%r3
 655	xgr	%r4,%r4
 656	xgr	%r5,%r5
 657	xgr	%r6,%r6
 658	xgr	%r7,%r7
 659	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
 660	stmg	%r8,%r9,__PT_PSW(%r11)
 661	mvc	__PT_INT_CODE(4,%r11),__LC_PGM_ILC
 662	mvc	__PT_INT_PARM_LONG(8,%r11),__LC_TRANS_EXC_CODE
 663	stg	%r13,__PT_FLAGS(%r11)
 664	stg	%r10,__PT_ARGS(%r11)
 665	tm	__LC_PGM_ILC+3,0x80	# check for per exception
 666	jz	5f
 667	tmhh	%r8,0x0001		# kernel per event ?
 668	jz	.Lpgm_kprobe
 669	oi	__PT_FLAGS+7(%r11),_PIF_PER_TRAP
 670	mvc	__THREAD_per_address(8,%r14),__LC_PER_ADDRESS
 671	mvc	__THREAD_per_cause(2,%r14),__LC_PER_CODE
 672	mvc	__THREAD_per_paid(1,%r14),__LC_PER_ACCESS_ID
 6735:	REENABLE_IRQS
 674	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 675	larl	%r1,pgm_check_table
 676	llgh	%r10,__PT_INT_CODE+2(%r11)
 677	nill	%r10,0x007f
 678	sll	%r10,3
 679	je	.Lpgm_return
 680	lg	%r9,0(%r10,%r1)		# load address of handler routine
 681	lgr	%r2,%r11		# pass pointer to pt_regs
 682	BASR_EX	%r14,%r9		# branch to interrupt-handler
 683.Lpgm_return:
 684	LOCKDEP_SYS_EXIT
 685	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 686	jno	.Lsysc_restore
 687	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
 688	jo	.Lsysc_do_syscall
 689	j	.Lsysc_tif
 690
 691#
 692# PER event in supervisor state, must be kprobes
 693#
 694.Lpgm_kprobe:
 695	REENABLE_IRQS
 696	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 697	lgr	%r2,%r11		# pass pointer to pt_regs
 698	brasl	%r14,do_per_trap
 699	j	.Lpgm_return
 700
 701#
 702# single stepped system call
 703#
 704.Lpgm_svcper:
 705	mvc	__LC_RETURN_PSW(8),__LC_SVC_NEW_PSW
 706	lghi	%r13,__TASK_thread
 707	larl	%r14,.Lsysc_per
 708	stg	%r14,__LC_RETURN_PSW+8
 709	lghi	%r14,_PIF_SYSCALL | _PIF_PER_TRAP
 710	lpswe	__LC_RETURN_PSW		# branch to .Lsysc_per and enable irqs
 711ENDPROC(pgm_check_handler)
 712
 713/*
 714 * IO interrupt handler routine
 715 */
 716ENTRY(io_int_handler)
 717	STCK	__LC_INT_CLOCK
 718	stpt	__LC_ASYNC_ENTER_TIMER
 719	BPOFF
 720	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
 
 721	lg	%r12,__LC_CURRENT
 722	larl	%r13,cleanup_critical
 723	lmg	%r8,%r9,__LC_IO_OLD_PSW
 724	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
 725	stmg	%r0,%r7,__PT_R0(%r11)
 726	# clear user controlled registers to prevent speculative use
 727	xgr	%r0,%r0
 728	xgr	%r1,%r1
 729	xgr	%r2,%r2
 730	xgr	%r3,%r3
 731	xgr	%r4,%r4
 732	xgr	%r5,%r5
 733	xgr	%r6,%r6
 734	xgr	%r7,%r7
 735	xgr	%r10,%r10
 736	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
 737	stmg	%r8,%r9,__PT_PSW(%r11)
 738	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
 739	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 740	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
 741	jo	.Lio_restore
 742	TRACE_IRQS_OFF
 743	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 744.Lio_loop:
 745	lgr	%r2,%r11		# pass pointer to pt_regs
 746	lghi	%r3,IO_INTERRUPT
 747	tm	__PT_INT_CODE+8(%r11),0x80	# adapter interrupt ?
 748	jz	.Lio_call
 749	lghi	%r3,THIN_INTERRUPT
 750.Lio_call:
 751	brasl	%r14,do_IRQ
 752	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPAR
 753	jz	.Lio_return
 754	tpi	0
 755	jz	.Lio_return
 756	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
 757	j	.Lio_loop
 758.Lio_return:
 759	LOCKDEP_SYS_EXIT
 760	TRACE_IRQS_ON
 761.Lio_tif:
 762	TSTMSK	__TI_flags(%r12),_TIF_WORK
 763	jnz	.Lio_work		# there is work to do (signals etc.)
 764	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
 765	jnz	.Lio_work
 766.Lio_restore:
 767	lg	%r14,__LC_VDSO_PER_CPU
 768	lmg	%r0,%r10,__PT_R0(%r11)
 769	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
 770	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 771	jno	.Lio_exit_kernel
 772	BPEXIT	__TI_flags(%r12),_TIF_ISOLATE_BP
 773.Lio_exit_timer:
 774	stpt	__LC_EXIT_TIMER
 775	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 776.Lio_exit_kernel:
 777	lmg	%r11,%r15,__PT_R11(%r11)
 778	lpswe	__LC_RETURN_PSW
 779.Lio_done:
 780
 781#
 782# There is work todo, find out in which context we have been interrupted:
 783# 1) if we return to user space we can do all _TIF_WORK work
 784# 2) if we return to kernel code and kvm is enabled check if we need to
 785#    modify the psw to leave SIE
 786# 3) if we return to kernel code and preemptive scheduling is enabled check
 787#    the preemption counter and if it is zero call preempt_schedule_irq
 788# Before any work can be done, a switch to the kernel stack is required.
 789#
 790.Lio_work:
 791	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 792	jo	.Lio_work_user		# yes -> do resched & signal
 793#ifdef CONFIG_PREEMPT
 794	# check for preemptive scheduling
 795	icm	%r0,15,__LC_PREEMPT_COUNT
 796	jnz	.Lio_restore		# preemption is disabled
 797	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 798	jno	.Lio_restore
 799	# switch to kernel stack
 800	lg	%r1,__PT_R15(%r11)
 801	aghi	%r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 802	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 803	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 804	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 805	lgr	%r15,%r1
 806	# TRACE_IRQS_ON already done at .Lio_return, call
 807	# TRACE_IRQS_OFF to keep things symmetrical
 808	TRACE_IRQS_OFF
 809	brasl	%r14,preempt_schedule_irq
 810	j	.Lio_return
 811#else
 812	j	.Lio_restore
 813#endif
 814
 815#
 816# Need to do work before returning to userspace, switch to kernel stack
 817#
 818.Lio_work_user:
 819	lg	%r1,__LC_KERNEL_STACK
 820	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 821	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 822	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 823	lgr	%r15,%r1
 824
 825#
 826# One of the work bits is on. Find out which one.
 827#
 828.Lio_work_tif:
 829	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 830	jo	.Lio_mcck_pending
 831	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 832	jo	.Lio_reschedule
 833#ifdef CONFIG_LIVEPATCH
 834	TSTMSK	__TI_flags(%r12),_TIF_PATCH_PENDING
 835	jo	.Lio_patch_pending
 836#endif
 837	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
 838	jo	.Lio_sigpending
 839	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
 840	jo	.Lio_notify_resume
 841	TSTMSK	__TI_flags(%r12),_TIF_GUARDED_STORAGE
 842	jo	.Lio_guarded_storage
 843	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 844	jo	.Lio_vxrs
 845	TSTMSK	__LC_CPU_FLAGS,(_CIF_ASCE_PRIMARY|_CIF_ASCE_SECONDARY)
 846	jnz	.Lio_asce
 847	j	.Lio_return		# beware of critical section cleanup
 848
 849#
 850# _CIF_MCCK_PENDING is set, call handler
 851#
 852.Lio_mcck_pending:
 853	# TRACE_IRQS_ON already done at .Lio_return
 854	brasl	%r14,s390_handle_mcck	# TIF bit will be cleared by handler
 855	TRACE_IRQS_OFF
 856	j	.Lio_return
 857
 858#
 859# _CIF_ASCE_PRIMARY and/or CIF_ASCE_SECONDARY set, load user space asce
 860#
 861.Lio_asce:
 862	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_SECONDARY
 863	lctlg	%c7,%c7,__LC_VDSO_ASCE		# load secondary asce
 864	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE_PRIMARY
 865	jz	.Lio_return
 866#ifndef CONFIG_HAVE_MARCH_Z10_FEATURES
 867	tm	__LC_STFLE_FAC_LIST+3,0x10	# has MVCOS ?
 868	jnz	.Lio_set_fs_fixup
 869	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_PRIMARY
 870	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 871	j	.Lio_return
 872.Lio_set_fs_fixup:
 873#endif
 874	larl	%r14,.Lio_return
 875	jg	set_fs_fixup
 876
 877#
 878# CIF_FPU is set, restore floating-point controls and floating-point registers.
 879#
 880.Lio_vxrs:
 881	larl	%r14,.Lio_return
 882	jg	load_fpu_regs
 883
 884#
 885# _TIF_GUARDED_STORAGE is set, call guarded_storage_load
 886#
 887.Lio_guarded_storage:
 888	# TRACE_IRQS_ON already done at .Lio_return
 889	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 890	lgr	%r2,%r11		# pass pointer to pt_regs
 891	brasl	%r14,gs_load_bc_cb
 892	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 893	TRACE_IRQS_OFF
 894	j	.Lio_return
 895
 896#
 897# _TIF_NEED_RESCHED is set, call schedule
 898#
 899.Lio_reschedule:
 900	# TRACE_IRQS_ON already done at .Lio_return
 901	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 902	brasl	%r14,schedule		# call scheduler
 903	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 904	TRACE_IRQS_OFF
 905	j	.Lio_return
 906
 907#
 908# _TIF_PATCH_PENDING is set, call klp_update_patch_state
 909#
 910#ifdef CONFIG_LIVEPATCH
 911.Lio_patch_pending:
 912	lg	%r2,__LC_CURRENT	# pass pointer to task struct
 913	larl	%r14,.Lio_return
 914	jg	klp_update_patch_state
 915#endif
 916
 917#
 918# _TIF_SIGPENDING or is set, call do_signal
 919#
 920.Lio_sigpending:
 921	# TRACE_IRQS_ON already done at .Lio_return
 922	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 923	lgr	%r2,%r11		# pass pointer to pt_regs
 924	brasl	%r14,do_signal
 925	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 926	TRACE_IRQS_OFF
 927	j	.Lio_return
 928
 929#
 930# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
 931#
 932.Lio_notify_resume:
 933	# TRACE_IRQS_ON already done at .Lio_return
 934	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 935	lgr	%r2,%r11		# pass pointer to pt_regs
 936	brasl	%r14,do_notify_resume
 937	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 938	TRACE_IRQS_OFF
 939	j	.Lio_return
 940ENDPROC(io_int_handler)
 941
 942/*
 943 * External interrupt handler routine
 944 */
 945ENTRY(ext_int_handler)
 946	STCK	__LC_INT_CLOCK
 947	stpt	__LC_ASYNC_ENTER_TIMER
 948	BPOFF
 949	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
 
 950	lg	%r12,__LC_CURRENT
 951	larl	%r13,cleanup_critical
 952	lmg	%r8,%r9,__LC_EXT_OLD_PSW
 953	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
 954	stmg	%r0,%r7,__PT_R0(%r11)
 955	# clear user controlled registers to prevent speculative use
 956	xgr	%r0,%r0
 957	xgr	%r1,%r1
 958	xgr	%r2,%r2
 959	xgr	%r3,%r3
 960	xgr	%r4,%r4
 961	xgr	%r5,%r5
 962	xgr	%r6,%r6
 963	xgr	%r7,%r7
 964	xgr	%r10,%r10
 965	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
 966	stmg	%r8,%r9,__PT_PSW(%r11)
 967	lghi	%r1,__LC_EXT_PARAMS2
 968	mvc	__PT_INT_CODE(4,%r11),__LC_EXT_CPU_ADDR
 969	mvc	__PT_INT_PARM(4,%r11),__LC_EXT_PARAMS
 970	mvc	__PT_INT_PARM_LONG(8,%r11),0(%r1)
 971	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 972	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
 973	jo	.Lio_restore
 974	TRACE_IRQS_OFF
 975	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 976	lgr	%r2,%r11		# pass pointer to pt_regs
 977	lghi	%r3,EXT_INTERRUPT
 978	brasl	%r14,do_IRQ
 979	j	.Lio_return
 980ENDPROC(ext_int_handler)
 981
 982/*
 983 * Load idle PSW. The second "half" of this function is in .Lcleanup_idle.
 984 */
 985ENTRY(psw_idle)
 986	stg	%r3,__SF_EMPTY(%r15)
 987	larl	%r1,.Lpsw_idle_lpsw+4
 988	stg	%r1,__SF_EMPTY+8(%r15)
 
 989	larl	%r1,smp_cpu_mtid
 990	llgf	%r1,0(%r1)
 991	ltgr	%r1,%r1
 992	jz	.Lpsw_idle_stcctm
 993	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+16(%r15)
 994.Lpsw_idle_stcctm:
 
 995	oi	__LC_CPU_FLAGS+7,_CIF_ENABLED_WAIT
 996	BPON
 997	STCK	__CLOCK_IDLE_ENTER(%r2)
 998	stpt	__TIMER_IDLE_ENTER(%r2)
 999.Lpsw_idle_lpsw:
1000	lpswe	__SF_EMPTY(%r15)
1001	BR_EX	%r14
1002.Lpsw_idle_end:
1003ENDPROC(psw_idle)
1004
1005/*
1006 * Store floating-point controls and floating-point or vector register
1007 * depending whether the vector facility is available.	A critical section
1008 * cleanup assures that the registers are stored even if interrupted for
1009 * some other work.  The CIF_FPU flag is set to trigger a lazy restore
1010 * of the register contents at return from io or a system call.
1011 */
1012ENTRY(save_fpu_regs)
1013	lg	%r2,__LC_CURRENT
1014	aghi	%r2,__TASK_thread
1015	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
1016	jo	.Lsave_fpu_regs_exit
1017	stfpc	__THREAD_FPU_fpc(%r2)
1018	lg	%r3,__THREAD_FPU_regs(%r2)
1019	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
1020	jz	.Lsave_fpu_regs_fp	  # no -> store FP regs
1021	VSTM	%v0,%v15,0,%r3		  # vstm 0,15,0(3)
1022	VSTM	%v16,%v31,256,%r3	  # vstm 16,31,256(3)
1023	j	.Lsave_fpu_regs_done	  # -> set CIF_FPU flag
1024.Lsave_fpu_regs_fp:
1025	std	0,0(%r3)
1026	std	1,8(%r3)
1027	std	2,16(%r3)
1028	std	3,24(%r3)
1029	std	4,32(%r3)
1030	std	5,40(%r3)
1031	std	6,48(%r3)
1032	std	7,56(%r3)
1033	std	8,64(%r3)
1034	std	9,72(%r3)
1035	std	10,80(%r3)
1036	std	11,88(%r3)
1037	std	12,96(%r3)
1038	std	13,104(%r3)
1039	std	14,112(%r3)
1040	std	15,120(%r3)
1041.Lsave_fpu_regs_done:
1042	oi	__LC_CPU_FLAGS+7,_CIF_FPU
1043.Lsave_fpu_regs_exit:
1044	BR_EX	%r14
1045.Lsave_fpu_regs_end:
1046ENDPROC(save_fpu_regs)
1047EXPORT_SYMBOL(save_fpu_regs)
 
1048
1049/*
1050 * Load floating-point controls and floating-point or vector registers.
1051 * A critical section cleanup assures that the register contents are
1052 * loaded even if interrupted for some other work.
1053 *
1054 * There are special calling conventions to fit into sysc and io return work:
1055 *	%r15:	<kernel stack>
1056 * The function requires:
1057 *	%r4
1058 */
1059load_fpu_regs:
1060	lg	%r4,__LC_CURRENT
1061	aghi	%r4,__TASK_thread
1062	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
1063	jno	.Lload_fpu_regs_exit
1064	lfpc	__THREAD_FPU_fpc(%r4)
1065	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
1066	lg	%r4,__THREAD_FPU_regs(%r4)	# %r4 <- reg save area
1067	jz	.Lload_fpu_regs_fp		# -> no VX, load FP regs
1068	VLM	%v0,%v15,0,%r4
1069	VLM	%v16,%v31,256,%r4
1070	j	.Lload_fpu_regs_done
1071.Lload_fpu_regs_fp:
1072	ld	0,0(%r4)
1073	ld	1,8(%r4)
1074	ld	2,16(%r4)
1075	ld	3,24(%r4)
1076	ld	4,32(%r4)
1077	ld	5,40(%r4)
1078	ld	6,48(%r4)
1079	ld	7,56(%r4)
1080	ld	8,64(%r4)
1081	ld	9,72(%r4)
1082	ld	10,80(%r4)
1083	ld	11,88(%r4)
1084	ld	12,96(%r4)
1085	ld	13,104(%r4)
1086	ld	14,112(%r4)
1087	ld	15,120(%r4)
1088.Lload_fpu_regs_done:
1089	ni	__LC_CPU_FLAGS+7,255-_CIF_FPU
1090.Lload_fpu_regs_exit:
1091	BR_EX	%r14
1092.Lload_fpu_regs_end:
1093ENDPROC(load_fpu_regs)
1094
1095.L__critical_end:
1096
1097/*
1098 * Machine check handler routines
1099 */
1100ENTRY(mcck_int_handler)
1101	STCK	__LC_MCCK_CLOCK
1102	BPOFF
1103	la	%r1,4095		# validate r1
1104	spt	__LC_CPU_TIMER_SAVE_AREA-4095(%r1)	# validate cpu timer
1105	sckc	__LC_CLOCK_COMPARATOR			# validate comparator
1106	lam	%a0,%a15,__LC_AREGS_SAVE_AREA-4095(%r1) # validate acrs
1107	lmg	%r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# validate gprs
1108	lg	%r12,__LC_CURRENT
1109	larl	%r13,cleanup_critical
1110	lmg	%r8,%r9,__LC_MCK_OLD_PSW
1111	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_SYSTEM_DAMAGE
1112	jo	.Lmcck_panic		# yes -> rest of mcck code invalid
1113	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_CR_VALID
1114	jno	.Lmcck_panic		# control registers invalid -> panic
1115	la	%r14,4095
1116	lctlg	%c0,%c15,__LC_CREGS_SAVE_AREA-4095(%r14) # validate ctl regs
1117	ptlb
1118	lg	%r11,__LC_MCESAD-4095(%r14) # extended machine check save area
1119	nill	%r11,0xfc00		# MCESA_ORIGIN_MASK
1120	TSTMSK	__LC_CREGS_SAVE_AREA+16-4095(%r14),CR2_GUARDED_STORAGE
1121	jno	0f
1122	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_GS_VALID
1123	jno	0f
1124	.insn	 rxy,0xe3000000004d,0,__MCESA_GS_SAVE_AREA(%r11) # LGSC
11250:	l	%r14,__LC_FP_CREG_SAVE_AREA-4095(%r14)
1126	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_FC_VALID
1127	jo	0f
1128	sr	%r14,%r14
11290:	sfpc	%r14
1130	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
1131	jo	0f
1132	lghi	%r14,__LC_FPREGS_SAVE_AREA
1133	ld	%f0,0(%r14)
1134	ld	%f1,8(%r14)
1135	ld	%f2,16(%r14)
1136	ld	%f3,24(%r14)
1137	ld	%f4,32(%r14)
1138	ld	%f5,40(%r14)
1139	ld	%f6,48(%r14)
1140	ld	%f7,56(%r14)
1141	ld	%f8,64(%r14)
1142	ld	%f9,72(%r14)
1143	ld	%f10,80(%r14)
1144	ld	%f11,88(%r14)
1145	ld	%f12,96(%r14)
1146	ld	%f13,104(%r14)
1147	ld	%f14,112(%r14)
1148	ld	%f15,120(%r14)
1149	j	1f
11500:	VLM	%v0,%v15,0,%r11
1151	VLM	%v16,%v31,256,%r11
11521:	lghi	%r14,__LC_CPU_TIMER_SAVE_AREA
1153	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
1154	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_CPU_TIMER_VALID
1155	jo	3f
1156	la	%r14,__LC_SYNC_ENTER_TIMER
1157	clc	0(8,%r14),__LC_ASYNC_ENTER_TIMER
1158	jl	0f
1159	la	%r14,__LC_ASYNC_ENTER_TIMER
11600:	clc	0(8,%r14),__LC_EXIT_TIMER
1161	jl	1f
1162	la	%r14,__LC_EXIT_TIMER
11631:	clc	0(8,%r14),__LC_LAST_UPDATE_TIMER
1164	jl	2f
1165	la	%r14,__LC_LAST_UPDATE_TIMER
11662:	spt	0(%r14)
1167	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
11683:	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_PSW_MWP_VALID
1169	jno	.Lmcck_panic
1170	tmhh	%r8,0x0001		# interrupting from user ?
1171	jnz	4f
1172	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_PSW_IA_VALID
1173	jno	.Lmcck_panic
11744:	ssm	__LC_PGM_NEW_PSW	# turn dat on, keep irqs off
1175	SWITCH_ASYNC __LC_GPREGS_SAVE_AREA+64,__LC_MCCK_ENTER_TIMER
1176.Lmcck_skip:
1177	lghi	%r14,__LC_GPREGS_SAVE_AREA+64
1178	stmg	%r0,%r7,__PT_R0(%r11)
1179	# clear user controlled registers to prevent speculative use
1180	xgr	%r0,%r0
1181	xgr	%r1,%r1
1182	xgr	%r2,%r2
1183	xgr	%r3,%r3
1184	xgr	%r4,%r4
1185	xgr	%r5,%r5
1186	xgr	%r6,%r6
1187	xgr	%r7,%r7
1188	xgr	%r10,%r10
1189	mvc	__PT_R8(64,%r11),0(%r14)
1190	stmg	%r8,%r9,__PT_PSW(%r11)
1191	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
1192	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
1193	lgr	%r2,%r11		# pass pointer to pt_regs
1194	brasl	%r14,s390_do_machine_check
1195	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
1196	jno	.Lmcck_return
1197	lg	%r1,__LC_KERNEL_STACK	# switch to kernel stack
1198	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
1199	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
1200	la	%r11,STACK_FRAME_OVERHEAD(%r1)
1201	lgr	%r15,%r1
 
1202	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
1203	jno	.Lmcck_return
1204	TRACE_IRQS_OFF
1205	brasl	%r14,s390_handle_mcck
1206	TRACE_IRQS_ON
1207.Lmcck_return:
1208	lg	%r14,__LC_VDSO_PER_CPU
1209	lmg	%r0,%r10,__PT_R0(%r11)
1210	mvc	__LC_RETURN_MCCK_PSW(16),__PT_PSW(%r11) # move return PSW
1211	tm	__LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
1212	jno	0f
1213	BPEXIT	__TI_flags(%r12),_TIF_ISOLATE_BP
1214	stpt	__LC_EXIT_TIMER
1215	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
12160:	lmg	%r11,%r15,__PT_R11(%r11)
1217	lpswe	__LC_RETURN_MCCK_PSW
1218
1219.Lmcck_panic:
1220	lg	%r15,__LC_NODAT_STACK
1221	la	%r11,STACK_FRAME_OVERHEAD(%r15)
1222	j	.Lmcck_skip
1223ENDPROC(mcck_int_handler)
1224
1225#
1226# PSW restart interrupt handler
1227#
1228ENTRY(restart_int_handler)
1229	ALTERNATIVE "", ".insn s,0xb2800000,_LPP_OFFSET", 40
1230	stg	%r15,__LC_SAVE_AREA_RESTART
 
 
1231	lg	%r15,__LC_RESTART_STACK
1232	xc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r15),STACK_FRAME_OVERHEAD(%r15)
1233	stmg	%r0,%r14,STACK_FRAME_OVERHEAD+__PT_R0(%r15)
1234	mvc	STACK_FRAME_OVERHEAD+__PT_R15(8,%r15),__LC_SAVE_AREA_RESTART
1235	mvc	STACK_FRAME_OVERHEAD+__PT_PSW(16,%r15),__LC_RST_OLD_PSW
 
 
1236	xc	0(STACK_FRAME_OVERHEAD,%r15),0(%r15)
1237	lg	%r1,__LC_RESTART_FN		# load fn, parm & source cpu
1238	lg	%r2,__LC_RESTART_DATA
1239	lg	%r3,__LC_RESTART_SOURCE
1240	ltgr	%r3,%r3				# test source cpu address
1241	jm	1f				# negative -> skip source stop
12420:	sigp	%r4,%r3,SIGP_SENSE		# sigp sense to source cpu
1243	brc	10,0b				# wait for status stored
12441:	basr	%r14,%r1			# call function
1245	stap	__SF_EMPTY(%r15)		# store cpu address
1246	llgh	%r3,__SF_EMPTY(%r15)
12472:	sigp	%r4,%r3,SIGP_STOP		# sigp stop to current cpu
1248	brc	2,2b
12493:	j	3b
1250ENDPROC(restart_int_handler)
1251
1252	.section .kprobes.text, "ax"
1253
1254#if defined(CONFIG_CHECK_STACK) || defined(CONFIG_VMAP_STACK)
1255/*
1256 * The synchronous or the asynchronous stack overflowed. We are dead.
1257 * No need to properly save the registers, we are going to panic anyway.
1258 * Setup a pt_regs so that show_trace can provide a good call trace.
1259 */
1260ENTRY(stack_overflow)
1261	lg	%r15,__LC_NODAT_STACK	# change to panic stack
1262	la	%r11,STACK_FRAME_OVERHEAD(%r15)
1263	stmg	%r0,%r7,__PT_R0(%r11)
1264	stmg	%r8,%r9,__PT_PSW(%r11)
1265	mvc	__PT_R8(64,%r11),0(%r14)
1266	stg	%r10,__PT_ORIG_GPR2(%r11) # store last break to orig_gpr2
1267	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
1268	lgr	%r2,%r11		# pass pointer to pt_regs
1269	jg	kernel_stack_overflow
1270ENDPROC(stack_overflow)
1271#endif
1272
1273ENTRY(cleanup_critical)
1274#if IS_ENABLED(CONFIG_KVM)
1275	clg	%r9,BASED(.Lcleanup_table_sie)	# .Lsie_gmap
1276	jl	0f
1277	clg	%r9,BASED(.Lcleanup_table_sie+8)# .Lsie_done
1278	jl	.Lcleanup_sie
1279#endif
1280	clg	%r9,BASED(.Lcleanup_table)	# system_call
1281	jl	0f
1282	clg	%r9,BASED(.Lcleanup_table+8)	# .Lsysc_do_svc
1283	jl	.Lcleanup_system_call
1284	clg	%r9,BASED(.Lcleanup_table+16)	# .Lsysc_tif
1285	jl	0f
1286	clg	%r9,BASED(.Lcleanup_table+24)	# .Lsysc_restore
1287	jl	.Lcleanup_sysc_tif
1288	clg	%r9,BASED(.Lcleanup_table+32)	# .Lsysc_done
1289	jl	.Lcleanup_sysc_restore
1290	clg	%r9,BASED(.Lcleanup_table+40)	# .Lio_tif
1291	jl	0f
1292	clg	%r9,BASED(.Lcleanup_table+48)	# .Lio_restore
1293	jl	.Lcleanup_io_tif
1294	clg	%r9,BASED(.Lcleanup_table+56)	# .Lio_done
1295	jl	.Lcleanup_io_restore
1296	clg	%r9,BASED(.Lcleanup_table+64)	# psw_idle
1297	jl	0f
1298	clg	%r9,BASED(.Lcleanup_table+72)	# .Lpsw_idle_end
1299	jl	.Lcleanup_idle
1300	clg	%r9,BASED(.Lcleanup_table+80)	# save_fpu_regs
1301	jl	0f
1302	clg	%r9,BASED(.Lcleanup_table+88)	# .Lsave_fpu_regs_end
1303	jl	.Lcleanup_save_fpu_regs
1304	clg	%r9,BASED(.Lcleanup_table+96)	# load_fpu_regs
1305	jl	0f
1306	clg	%r9,BASED(.Lcleanup_table+104)	# .Lload_fpu_regs_end
1307	jl	.Lcleanup_load_fpu_regs
13080:	BR_EX	%r14,%r11
1309ENDPROC(cleanup_critical)
1310
1311	.align	8
1312.Lcleanup_table:
1313	.quad	system_call
1314	.quad	.Lsysc_do_svc
1315	.quad	.Lsysc_tif
1316	.quad	.Lsysc_restore
1317	.quad	.Lsysc_done
1318	.quad	.Lio_tif
1319	.quad	.Lio_restore
1320	.quad	.Lio_done
1321	.quad	psw_idle
1322	.quad	.Lpsw_idle_end
1323	.quad	save_fpu_regs
1324	.quad	.Lsave_fpu_regs_end
1325	.quad	load_fpu_regs
1326	.quad	.Lload_fpu_regs_end
1327
1328#if IS_ENABLED(CONFIG_KVM)
1329.Lcleanup_table_sie:
1330	.quad	.Lsie_gmap
1331	.quad	.Lsie_done
1332
1333.Lcleanup_sie:
1334	cghi    %r11,__LC_SAVE_AREA_ASYNC 	#Is this in normal interrupt?
1335	je      1f
1336	slg     %r9,BASED(.Lsie_crit_mcck_start)
1337	clg     %r9,BASED(.Lsie_crit_mcck_length)
1338	jh      1f
1339	oi      __LC_CPU_FLAGS+7, _CIF_MCCK_GUEST
13401:	BPENTER __SF_SIE_FLAGS(%r15),(_TIF_ISOLATE_BP|_TIF_ISOLATE_BP_GUEST)
1341	lg	%r9,__SF_SIE_CONTROL(%r15)	# get control block pointer
1342	ni	__SIE_PROG0C+3(%r9),0xfe	# no longer in SIE
1343	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
1344	larl	%r9,sie_exit			# skip forward to sie_exit
1345	BR_EX	%r14,%r11
1346#endif
1347
1348.Lcleanup_system_call:
1349	# check if stpt has been executed
1350	clg	%r9,BASED(.Lcleanup_system_call_insn)
1351	jh	0f
1352	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
1353	cghi	%r11,__LC_SAVE_AREA_ASYNC
1354	je	0f
1355	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
13560:	# check if stmg has been executed
1357	clg	%r9,BASED(.Lcleanup_system_call_insn+8)
1358	jh	0f
1359	mvc	__LC_SAVE_AREA_SYNC(64),0(%r11)
13600:	# check if base register setup + TIF bit load has been done
1361	clg	%r9,BASED(.Lcleanup_system_call_insn+16)
1362	jhe	0f
1363	# set up saved register r12 task struct pointer
1364	stg	%r12,32(%r11)
1365	# set up saved register r13 __TASK_thread offset
1366	mvc	40(8,%r11),BASED(.Lcleanup_system_call_const)
13670:	# check if the user time update has been done
1368	clg	%r9,BASED(.Lcleanup_system_call_insn+24)
1369	jh	0f
1370	lg	%r15,__LC_EXIT_TIMER
1371	slg	%r15,__LC_SYNC_ENTER_TIMER
1372	alg	%r15,__LC_USER_TIMER
1373	stg	%r15,__LC_USER_TIMER
13740:	# check if the system time update has been done
1375	clg	%r9,BASED(.Lcleanup_system_call_insn+32)
1376	jh	0f
1377	lg	%r15,__LC_LAST_UPDATE_TIMER
1378	slg	%r15,__LC_EXIT_TIMER
1379	alg	%r15,__LC_SYSTEM_TIMER
1380	stg	%r15,__LC_SYSTEM_TIMER
13810:	# update accounting time stamp
1382	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
1383	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
1384	# set up saved register r11
 
 
 
 
 
 
1385	lg	%r15,__LC_KERNEL_STACK
1386	la	%r9,STACK_FRAME_OVERHEAD(%r15)
1387	stg	%r9,24(%r11)		# r11 pt_regs pointer
1388	# fill pt_regs
1389	mvc	__PT_R8(64,%r9),__LC_SAVE_AREA_SYNC
1390	stmg	%r0,%r7,__PT_R0(%r9)
1391	mvc	__PT_PSW(16,%r9),__LC_SVC_OLD_PSW
1392	mvc	__PT_INT_CODE(4,%r9),__LC_SVC_ILC
1393	xc	__PT_FLAGS(8,%r9),__PT_FLAGS(%r9)
1394	mvi	__PT_FLAGS+7(%r9),_PIF_SYSCALL
1395	# setup saved register r15
1396	stg	%r15,56(%r11)		# r15 stack pointer
1397	# set new psw address and exit
1398	larl	%r9,.Lsysc_do_svc
1399	BR_EX	%r14,%r11
1400.Lcleanup_system_call_insn:
1401	.quad	system_call
1402	.quad	.Lsysc_stmg
1403	.quad	.Lsysc_per
1404	.quad	.Lsysc_vtime+36
1405	.quad	.Lsysc_vtime+42
1406.Lcleanup_system_call_const:
1407	.quad	__TASK_thread
1408
1409.Lcleanup_sysc_tif:
1410	larl	%r9,.Lsysc_tif
1411	BR_EX	%r14,%r11
1412
1413.Lcleanup_sysc_restore:
1414	# check if stpt has been executed
1415	clg	%r9,BASED(.Lcleanup_sysc_restore_insn)
1416	jh	0f
1417	mvc	__LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
1418	cghi	%r11,__LC_SAVE_AREA_ASYNC
1419	je	0f
1420	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
14210:	clg	%r9,BASED(.Lcleanup_sysc_restore_insn+8)
1422	je	1f
1423	lg	%r9,24(%r11)		# get saved pointer to pt_regs
1424	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
1425	mvc	0(64,%r11),__PT_R8(%r9)
1426	lmg	%r0,%r7,__PT_R0(%r9)
14271:	lmg	%r8,%r9,__LC_RETURN_PSW
1428	BR_EX	%r14,%r11
1429.Lcleanup_sysc_restore_insn:
1430	.quad	.Lsysc_exit_timer
1431	.quad	.Lsysc_done - 4
1432
1433.Lcleanup_io_tif:
1434	larl	%r9,.Lio_tif
1435	BR_EX	%r14,%r11
1436
1437.Lcleanup_io_restore:
1438	# check if stpt has been executed
1439	clg	%r9,BASED(.Lcleanup_io_restore_insn)
1440	jh	0f
1441	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
14420:	clg	%r9,BASED(.Lcleanup_io_restore_insn+8)
1443	je	1f
1444	lg	%r9,24(%r11)		# get saved r11 pointer to pt_regs
1445	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
1446	mvc	0(64,%r11),__PT_R8(%r9)
1447	lmg	%r0,%r7,__PT_R0(%r9)
14481:	lmg	%r8,%r9,__LC_RETURN_PSW
1449	BR_EX	%r14,%r11
1450.Lcleanup_io_restore_insn:
1451	.quad	.Lio_exit_timer
1452	.quad	.Lio_done - 4
1453
1454.Lcleanup_idle:
1455	ni	__LC_CPU_FLAGS+7,255-_CIF_ENABLED_WAIT
1456	# copy interrupt clock & cpu timer
1457	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_INT_CLOCK
1458	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_ASYNC_ENTER_TIMER
1459	cghi	%r11,__LC_SAVE_AREA_ASYNC
1460	je	0f
1461	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_MCCK_CLOCK
1462	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_MCCK_ENTER_TIMER
14630:	# check if stck & stpt have been executed
1464	clg	%r9,BASED(.Lcleanup_idle_insn)
1465	jhe	1f
1466	mvc	__CLOCK_IDLE_ENTER(8,%r2),__CLOCK_IDLE_EXIT(%r2)
1467	mvc	__TIMER_IDLE_ENTER(8,%r2),__TIMER_IDLE_EXIT(%r2)
14681:	# calculate idle cycles
 
1469	clg	%r9,BASED(.Lcleanup_idle_insn)
1470	jl	3f
1471	larl	%r1,smp_cpu_mtid
1472	llgf	%r1,0(%r1)
1473	ltgr	%r1,%r1
1474	jz	3f
1475	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+80(%r15)
1476	larl	%r3,mt_cycles
1477	ag	%r3,__LC_PERCPU_OFFSET
1478	la	%r4,__SF_EMPTY+16(%r15)
14792:	lg	%r0,0(%r3)
1480	slg	%r0,0(%r4)
1481	alg	%r0,64(%r4)
1482	stg	%r0,0(%r3)
1483	la	%r3,8(%r3)
1484	la	%r4,8(%r4)
1485	brct	%r1,2b
 
14863:	# account system time going idle
1487	lg	%r9,__LC_STEAL_TIMER
1488	alg	%r9,__CLOCK_IDLE_ENTER(%r2)
1489	slg	%r9,__LC_LAST_UPDATE_CLOCK
1490	stg	%r9,__LC_STEAL_TIMER
1491	mvc	__LC_LAST_UPDATE_CLOCK(8),__CLOCK_IDLE_EXIT(%r2)
1492	lg	%r9,__LC_SYSTEM_TIMER
1493	alg	%r9,__LC_LAST_UPDATE_TIMER
1494	slg	%r9,__TIMER_IDLE_ENTER(%r2)
1495	stg	%r9,__LC_SYSTEM_TIMER
1496	mvc	__LC_LAST_UPDATE_TIMER(8),__TIMER_IDLE_EXIT(%r2)
1497	# prepare return psw
1498	nihh	%r8,0xfcfd		# clear irq & wait state bits
1499	lg	%r9,48(%r11)		# return from psw_idle
1500	BR_EX	%r14,%r11
1501.Lcleanup_idle_insn:
1502	.quad	.Lpsw_idle_lpsw
1503
1504.Lcleanup_save_fpu_regs:
1505	larl	%r9,save_fpu_regs
1506	BR_EX	%r14,%r11
1507
1508.Lcleanup_load_fpu_regs:
1509	larl	%r9,load_fpu_regs
1510	BR_EX	%r14,%r11
1511
1512/*
1513 * Integer constants
1514 */
1515	.align	8
1516.Lcritical_start:
1517	.quad	.L__critical_start
1518.Lcritical_length:
1519	.quad	.L__critical_end - .L__critical_start
1520#if IS_ENABLED(CONFIG_KVM)
1521.Lsie_critical_start:
1522	.quad	.Lsie_gmap
1523.Lsie_critical_length:
1524	.quad	.Lsie_done - .Lsie_gmap
1525.Lsie_crit_mcck_start:
1526	.quad   .Lsie_entry
1527.Lsie_crit_mcck_length:
1528	.quad   .Lsie_skip - .Lsie_entry
1529#endif
 
1530	.section .rodata, "a"
1531#define SYSCALL(esame,emu)	.quad __s390x_ ## esame
1532	.globl	sys_call_table
1533sys_call_table:
1534#include "asm/syscall_table.h"
1535#undef SYSCALL
1536
1537#ifdef CONFIG_COMPAT
1538
1539#define SYSCALL(esame,emu)	.quad __s390_ ## emu
1540	.globl	sys_call_table_emu
1541sys_call_table_emu:
1542#include "asm/syscall_table.h"
1543#undef SYSCALL
1544#endif
v4.10.11
 
   1/*
   2 *    S390 low-level entry points.
   3 *
   4 *    Copyright IBM Corp. 1999, 2012
   5 *    Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
   6 *		 Hartmut Penner (hp@de.ibm.com),
   7 *		 Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
   8 *		 Heiko Carstens <heiko.carstens@de.ibm.com>
   9 */
  10
  11#include <linux/init.h>
  12#include <linux/linkage.h>
 
  13#include <asm/processor.h>
  14#include <asm/cache.h>
 
 
  15#include <asm/errno.h>
  16#include <asm/ptrace.h>
  17#include <asm/thread_info.h>
  18#include <asm/asm-offsets.h>
  19#include <asm/unistd.h>
  20#include <asm/page.h>
  21#include <asm/sigp.h>
  22#include <asm/irq.h>
  23#include <asm/vx-insn.h>
  24#include <asm/setup.h>
  25#include <asm/nmi.h>
  26#include <asm/export.h>
 
  27
  28__PT_R0      =	__PT_GPRS
  29__PT_R1      =	__PT_GPRS + 8
  30__PT_R2      =	__PT_GPRS + 16
  31__PT_R3      =	__PT_GPRS + 24
  32__PT_R4      =	__PT_GPRS + 32
  33__PT_R5      =	__PT_GPRS + 40
  34__PT_R6      =	__PT_GPRS + 48
  35__PT_R7      =	__PT_GPRS + 56
  36__PT_R8      =	__PT_GPRS + 64
  37__PT_R9      =	__PT_GPRS + 72
  38__PT_R10     =	__PT_GPRS + 80
  39__PT_R11     =	__PT_GPRS + 88
  40__PT_R12     =	__PT_GPRS + 96
  41__PT_R13     =	__PT_GPRS + 104
  42__PT_R14     =	__PT_GPRS + 112
  43__PT_R15     =	__PT_GPRS + 120
  44
  45STACK_SHIFT = PAGE_SHIFT + THREAD_SIZE_ORDER
  46STACK_SIZE  = 1 << STACK_SHIFT
  47STACK_INIT = STACK_SIZE - STACK_FRAME_OVERHEAD - __PT_SIZE
  48
  49_TIF_WORK	= (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
  50		   _TIF_UPROBE)
  51_TIF_TRACE	= (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_AUDIT | _TIF_SECCOMP | \
  52		   _TIF_SYSCALL_TRACEPOINT)
  53_CIF_WORK	= (_CIF_MCCK_PENDING | _CIF_ASCE | _CIF_FPU)
  54_PIF_WORK	= (_PIF_PER_TRAP)
 
 
 
  55
  56#define BASED(name) name-cleanup_critical(%r13)
  57
  58	.macro	TRACE_IRQS_ON
  59#ifdef CONFIG_TRACE_IRQFLAGS
  60	basr	%r2,%r0
  61	brasl	%r14,trace_hardirqs_on_caller
  62#endif
  63	.endm
  64
  65	.macro	TRACE_IRQS_OFF
  66#ifdef CONFIG_TRACE_IRQFLAGS
  67	basr	%r2,%r0
  68	brasl	%r14,trace_hardirqs_off_caller
  69#endif
  70	.endm
  71
  72	.macro	LOCKDEP_SYS_EXIT
  73#ifdef CONFIG_LOCKDEP
  74	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
  75	jz	.+10
  76	brasl	%r14,lockdep_sys_exit
  77#endif
  78	.endm
  79
  80	.macro	CHECK_STACK stacksize,savearea
  81#ifdef CONFIG_CHECK_STACK
  82	tml	%r15,\stacksize - CONFIG_STACK_GUARD
  83	lghi	%r14,\savearea
  84	jz	stack_overflow
  85#endif
  86	.endm
  87
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  88	.macro	SWITCH_ASYNC savearea,timer
  89	tmhh	%r8,0x0001		# interrupting from user ?
  90	jnz	1f
  91	lgr	%r14,%r9
  92	slg	%r14,BASED(.Lcritical_start)
  93	clg	%r14,BASED(.Lcritical_length)
  94	jhe	0f
  95	lghi	%r11,\savearea		# inside critical section, do cleanup
  96	brasl	%r14,cleanup_critical
  97	tmhh	%r8,0x0001		# retest problem state after cleanup
  98	jnz	1f
  990:	lg	%r14,__LC_ASYNC_STACK	# are we already on the async stack?
 100	slgr	%r14,%r15
 101	srag	%r14,%r14,STACK_SHIFT
 102	jnz	2f
 103	CHECK_STACK 1<<STACK_SHIFT,\savearea
 104	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 105	j	3f
 1061:	LAST_BREAK %r14
 107	UPDATE_VTIME %r14,%r15,\timer
 1082:	lg	%r15,__LC_ASYNC_STACK	# load async stack
 1093:	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 110	.endm
 111
 112	.macro UPDATE_VTIME w1,w2,enter_timer
 113	lg	\w1,__LC_EXIT_TIMER
 114	lg	\w2,__LC_LAST_UPDATE_TIMER
 115	slg	\w1,\enter_timer
 116	slg	\w2,__LC_EXIT_TIMER
 117	alg	\w1,__LC_USER_TIMER
 118	alg	\w2,__LC_SYSTEM_TIMER
 119	stg	\w1,__LC_USER_TIMER
 120	stg	\w2,__LC_SYSTEM_TIMER
 121	mvc	__LC_LAST_UPDATE_TIMER(8),\enter_timer
 122	.endm
 123
 124	.macro	LAST_BREAK scratch
 125	srag	\scratch,%r10,23
 126#ifdef CONFIG_HAVE_MARCH_Z990_FEATURES
 127	jz	.+10
 128	stg	%r10,__TASK_thread+__THREAD_last_break(%r12)
 129#else
 130	jz	.+14
 131	lghi	\scratch,__TASK_thread
 132	stg	%r10,__THREAD_last_break(\scratch,%r12)
 133#endif
 134	.endm
 135
 136	.macro REENABLE_IRQS
 137	stg	%r8,__LC_RETURN_PSW
 138	ni	__LC_RETURN_PSW,0xbf
 139	ssm	__LC_RETURN_PSW
 140	.endm
 141
 142	.macro STCK savearea
 143#ifdef CONFIG_HAVE_MARCH_Z9_109_FEATURES
 144	.insn	s,0xb27c0000,\savearea		# store clock fast
 145#else
 146	.insn	s,0xb2050000,\savearea		# store clock
 147#endif
 148	.endm
 149
 150	/*
 151	 * The TSTMSK macro generates a test-under-mask instruction by
 152	 * calculating the memory offset for the specified mask value.
 153	 * Mask value can be any constant.  The macro shifts the mask
 154	 * value to calculate the memory offset for the test-under-mask
 155	 * instruction.
 156	 */
 157	.macro TSTMSK addr, mask, size=8, bytepos=0
 158		.if (\bytepos < \size) && (\mask >> 8)
 159			.if (\mask & 0xff)
 160				.error "Mask exceeds byte boundary"
 161			.endif
 162			TSTMSK \addr, "(\mask >> 8)", \size, "(\bytepos + 1)"
 163			.exitm
 164		.endif
 165		.ifeq \mask
 166			.error "Mask must not be zero"
 167		.endif
 168		off = \size - \bytepos - 1
 169		tm	off+\addr, \mask
 170	.endm
 171
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 172	.section .kprobes.text, "ax"
 173.Ldummy:
 174	/*
 175	 * This nop exists only in order to avoid that __switch_to starts at
 176	 * the beginning of the kprobes text section. In that case we would
 177	 * have several symbols at the same address. E.g. objdump would take
 178	 * an arbitrary symbol name when disassembling this code.
 179	 * With the added nop in between the __switch_to symbol is unique
 180	 * again.
 181	 */
 182	nop	0
 183
 
 
 
 
 
 
 184/*
 185 * Scheduler resume function, called by switch_to
 186 *  gpr2 = (task_struct *) prev
 187 *  gpr3 = (task_struct *) next
 188 * Returns:
 189 *  gpr2 = prev
 190 */
 191ENTRY(__switch_to)
 192	stmg	%r6,%r15,__SF_GPRS(%r15)	# store gprs of prev task
 193	lgr	%r1,%r2
 194	aghi	%r1,__TASK_thread		# thread_struct of prev task
 195	lg	%r5,__TASK_stack(%r3)		# start of kernel stack of next
 196	stg	%r15,__THREAD_ksp(%r1)		# store kernel stack of prev
 197	lgr	%r1,%r3
 198	aghi	%r1,__TASK_thread		# thread_struct of next task
 199	lgr	%r15,%r5
 200	aghi	%r15,STACK_INIT			# end of kernel stack of next
 201	stg	%r3,__LC_CURRENT		# store task struct of next
 202	stg	%r15,__LC_KERNEL_STACK		# store end of kernel stack
 203	lg	%r15,__THREAD_ksp(%r1)		# load kernel stack of next
 204	/* c4 is used in guest detection: arch/s390/kernel/perf_cpum_sf.c */
 205	lctl	%c4,%c4,__TASK_pid(%r3)		# load pid to control reg. 4
 206	mvc	__LC_CURRENT_PID(4,%r0),__TASK_pid(%r3) # store pid of next
 207	lmg	%r6,%r15,__SF_GPRS(%r15)	# load gprs of next task
 208	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPP
 209	bzr	%r14
 210	.insn	s,0xb2800000,__LC_LPP		# set program parameter
 211	br	%r14
 212
 213.L__critical_start:
 214
 215#if IS_ENABLED(CONFIG_KVM)
 216/*
 217 * sie64a calling convention:
 218 * %r2 pointer to sie control block
 219 * %r3 guest register save area
 220 */
 221ENTRY(sie64a)
 222	stmg	%r6,%r14,__SF_GPRS(%r15)	# save kernel registers
 223	stg	%r2,__SF_EMPTY(%r15)		# save control block pointer
 224	stg	%r3,__SF_EMPTY+8(%r15)		# save guest register save area
 225	xc	__SF_EMPTY+16(8,%r15),__SF_EMPTY+16(%r15) # reason code = 0
 
 
 226	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU		# load guest fp/vx registers ?
 227	jno	.Lsie_load_guest_gprs
 228	brasl	%r14,load_fpu_regs		# load guest fp/vx regs
 229.Lsie_load_guest_gprs:
 230	lmg	%r0,%r13,0(%r3)			# load guest gprs 0-13
 231	lg	%r14,__LC_GMAP			# get gmap pointer
 232	ltgr	%r14,%r14
 233	jz	.Lsie_gmap
 234	lctlg	%c1,%c1,__GMAP_ASCE(%r14)	# load primary asce
 235.Lsie_gmap:
 236	lg	%r14,__SF_EMPTY(%r15)		# get control block pointer
 237	oi	__SIE_PROG0C+3(%r14),1		# we are going into SIE now
 238	tm	__SIE_PROG20+3(%r14),3		# last exit...
 239	jnz	.Lsie_skip
 240	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 241	jo	.Lsie_skip			# exit if fp/vx regs changed
 
 
 242	sie	0(%r14)
 
 
 
 243.Lsie_skip:
 244	ni	__SIE_PROG0C+3(%r14),0xfe	# no longer in SIE
 245	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 246.Lsie_done:
 247# some program checks are suppressing. C code (e.g. do_protection_exception)
 248# will rewind the PSW by the ILC, which is 4 bytes in case of SIE. Other
 249# instructions between sie64a and .Lsie_done should not cause program
 250# interrupts. So lets use a nop (47 00 00 00) as a landing pad.
 
 251# See also .Lcleanup_sie
 252.Lrewind_pad:
 253	nop	0
 
 
 
 
 254	.globl sie_exit
 255sie_exit:
 256	lg	%r14,__SF_EMPTY+8(%r15)		# load guest register save area
 257	stmg	%r0,%r13,0(%r14)		# save guest gprs 0-13
 
 
 
 
 
 
 258	lmg	%r6,%r14,__SF_GPRS(%r15)	# restore kernel registers
 259	lg	%r2,__SF_EMPTY+16(%r15)		# return exit reason code
 260	br	%r14
 261.Lsie_fault:
 262	lghi	%r14,-EFAULT
 263	stg	%r14,__SF_EMPTY+16(%r15)	# set exit reason code
 264	j	sie_exit
 265
 266	EX_TABLE(.Lrewind_pad,.Lsie_fault)
 
 
 267	EX_TABLE(sie_exit,.Lsie_fault)
 
 268EXPORT_SYMBOL(sie64a)
 269EXPORT_SYMBOL(sie_exit)
 270#endif
 271
 272/*
 273 * SVC interrupt handler routine. System calls are synchronous events and
 274 * are executed with interrupts enabled.
 275 */
 276
 277ENTRY(system_call)
 278	stpt	__LC_SYNC_ENTER_TIMER
 279.Lsysc_stmg:
 280	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
 281	lg	%r10,__LC_LAST_BREAK
 282	lg	%r12,__LC_CURRENT
 
 283	lghi	%r14,_PIF_SYSCALL
 284.Lsysc_per:
 285	lg	%r15,__LC_KERNEL_STACK
 286	la	%r11,STACK_FRAME_OVERHEAD(%r15)	# pointer to pt_regs
 287	LAST_BREAK %r13
 288.Lsysc_vtime:
 289	UPDATE_VTIME %r10,%r13,__LC_SYNC_ENTER_TIMER
 
 290	stmg	%r0,%r7,__PT_R0(%r11)
 291	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
 292	mvc	__PT_PSW(16,%r11),__LC_SVC_OLD_PSW
 293	mvc	__PT_INT_CODE(4,%r11),__LC_SVC_ILC
 294	stg	%r14,__PT_FLAGS(%r11)
 295.Lsysc_do_svc:
 
 
 296	# load address of system call table
 297#ifdef CONFIG_HAVE_MARCH_Z990_FEATURES
 298	lg	%r10,__TASK_thread+__THREAD_sysc_table(%r12)
 299#else
 300	lghi	%r13,__TASK_thread
 301	lg	%r10,__THREAD_sysc_table(%r13,%r12)
 302#endif
 303	llgh	%r8,__PT_INT_CODE+2(%r11)
 304	slag	%r8,%r8,2			# shift and test for svc 0
 305	jnz	.Lsysc_nr_ok
 306	# svc 0: system call number in %r1
 307	llgfr	%r1,%r1				# clear high word in r1
 308	cghi	%r1,NR_syscalls
 309	jnl	.Lsysc_nr_ok
 310	sth	%r1,__PT_INT_CODE+2(%r11)
 311	slag	%r8,%r1,2
 312.Lsysc_nr_ok:
 313	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 314	stg	%r2,__PT_ORIG_GPR2(%r11)
 315	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
 316	lgf	%r9,0(%r8,%r10)			# get system call add.
 317	TSTMSK	__TI_flags(%r12),_TIF_TRACE
 318	jnz	.Lsysc_tracesys
 319	basr	%r14,%r9			# call sys_xxxx
 320	stg	%r2,__PT_R2(%r11)		# store return value
 321
 322.Lsysc_return:
 
 
 
 
 323	LOCKDEP_SYS_EXIT
 324.Lsysc_tif:
 325	TSTMSK	__PT_FLAGS(%r11),_PIF_WORK
 326	jnz	.Lsysc_work
 327	TSTMSK	__TI_flags(%r12),_TIF_WORK
 328	jnz	.Lsysc_work			# check for work
 329	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
 330	jnz	.Lsysc_work
 
 331.Lsysc_restore:
 332	lg	%r14,__LC_VDSO_PER_CPU
 333	lmg	%r0,%r10,__PT_R0(%r11)
 334	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
 
 335	stpt	__LC_EXIT_TIMER
 336	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 337	lmg	%r11,%r15,__PT_R11(%r11)
 338	lpswe	__LC_RETURN_PSW
 339.Lsysc_done:
 340
 341#
 342# One of the work bits is on. Find out which one.
 343#
 344.Lsysc_work:
 345	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 346	jo	.Lsysc_mcck_pending
 347	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 348	jo	.Lsysc_reschedule
 
 
 349#ifdef CONFIG_UPROBES
 350	TSTMSK	__TI_flags(%r12),_TIF_UPROBE
 351	jo	.Lsysc_uprobe_notify
 352#endif
 
 
 353	TSTMSK	__PT_FLAGS(%r11),_PIF_PER_TRAP
 354	jo	.Lsysc_singlestep
 
 
 
 
 
 
 
 355	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
 356	jo	.Lsysc_sigpending
 357	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
 358	jo	.Lsysc_notify_resume
 359	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 360	jo	.Lsysc_vxrs
 361	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE
 362	jo	.Lsysc_uaccess
 363	j	.Lsysc_return		# beware of critical section cleanup
 364
 365#
 366# _TIF_NEED_RESCHED is set, call schedule
 367#
 368.Lsysc_reschedule:
 369	larl	%r14,.Lsysc_return
 370	jg	schedule
 371
 372#
 373# _CIF_MCCK_PENDING is set, call handler
 374#
 375.Lsysc_mcck_pending:
 376	larl	%r14,.Lsysc_return
 377	jg	s390_handle_mcck	# TIF bit will be cleared by handler
 378
 379#
 380# _CIF_ASCE is set, load user space asce
 381#
 382.Lsysc_uaccess:
 383	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE
 
 
 
 
 
 
 
 384	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 385	j	.Lsysc_return
 
 
 
 
 386
 387#
 388# CIF_FPU is set, restore floating-point controls and floating-point registers.
 389#
 390.Lsysc_vxrs:
 391	larl	%r14,.Lsysc_return
 392	jg	load_fpu_regs
 393
 394#
 395# _TIF_SIGPENDING is set, call do_signal
 396#
 397.Lsysc_sigpending:
 398	lgr	%r2,%r11		# pass pointer to pt_regs
 399	brasl	%r14,do_signal
 400	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
 401	jno	.Lsysc_return
 
 
 402	lmg	%r2,%r7,__PT_R2(%r11)	# load svc arguments
 403	lghi	%r8,0			# svc 0 returns -ENOSYS
 404	llgh	%r1,__PT_INT_CODE+2(%r11)	# load new svc number
 405	cghi	%r1,NR_syscalls
 406	jnl	.Lsysc_nr_ok		# invalid svc number -> do svc 0
 407	slag	%r8,%r1,2
 408	j	.Lsysc_nr_ok		# restart svc
 409
 410#
 411# _TIF_NOTIFY_RESUME is set, call do_notify_resume
 412#
 413.Lsysc_notify_resume:
 414	lgr	%r2,%r11		# pass pointer to pt_regs
 415	larl	%r14,.Lsysc_return
 416	jg	do_notify_resume
 417
 418#
 419# _TIF_UPROBE is set, call uprobe_notify_resume
 420#
 421#ifdef CONFIG_UPROBES
 422.Lsysc_uprobe_notify:
 423	lgr	%r2,%r11		# pass pointer to pt_regs
 424	larl	%r14,.Lsysc_return
 425	jg	uprobe_notify_resume
 426#endif
 427
 428#
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 429# _PIF_PER_TRAP is set, call do_per_trap
 430#
 431.Lsysc_singlestep:
 432	ni	__PT_FLAGS+7(%r11),255-_PIF_PER_TRAP
 433	lgr	%r2,%r11		# pass pointer to pt_regs
 434	larl	%r14,.Lsysc_return
 435	jg	do_per_trap
 436
 437#
 
 
 
 
 
 
 
 
 
 438# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
 439# and after the system call
 440#
 441.Lsysc_tracesys:
 442	lgr	%r2,%r11		# pass pointer to pt_regs
 443	la	%r3,0
 444	llgh	%r0,__PT_INT_CODE+2(%r11)
 445	stg	%r0,__PT_R2(%r11)
 446	brasl	%r14,do_syscall_trace_enter
 447	lghi	%r0,NR_syscalls
 448	clgr	%r0,%r2
 449	jnh	.Lsysc_tracenogo
 450	sllg	%r8,%r2,2
 451	lgf	%r9,0(%r8,%r10)
 452.Lsysc_tracego:
 453	lmg	%r3,%r7,__PT_R3(%r11)
 454	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
 455	lg	%r2,__PT_ORIG_GPR2(%r11)
 456	basr	%r14,%r9		# call sys_xxx
 457	stg	%r2,__PT_R2(%r11)	# store return value
 458.Lsysc_tracenogo:
 459	TSTMSK	__TI_flags(%r12),_TIF_TRACE
 460	jz	.Lsysc_return
 461	lgr	%r2,%r11		# pass pointer to pt_regs
 462	larl	%r14,.Lsysc_return
 463	jg	do_syscall_trace_exit
 
 464
 465#
 466# a new process exits the kernel with ret_from_fork
 467#
 468ENTRY(ret_from_fork)
 469	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 470	lg	%r12,__LC_CURRENT
 471	brasl	%r14,schedule_tail
 472	TRACE_IRQS_ON
 473	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 474	tm	__PT_PSW+1(%r11),0x01	# forking a kernel thread ?
 475	jne	.Lsysc_tracenogo
 476	# it's a kernel thread
 477	lmg	%r9,%r10,__PT_R9(%r11)	# load gprs
 
 
 
 
 
 478ENTRY(kernel_thread_starter)
 479	la	%r2,0(%r10)
 480	basr	%r14,%r9
 481	j	.Lsysc_tracenogo
 
 482
 483/*
 484 * Program check handler routine
 485 */
 486
 487ENTRY(pgm_check_handler)
 488	stpt	__LC_SYNC_ENTER_TIMER
 
 489	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
 490	lg	%r10,__LC_LAST_BREAK
 491	lg	%r12,__LC_CURRENT
 
 492	larl	%r13,cleanup_critical
 493	lmg	%r8,%r9,__LC_PGM_OLD_PSW
 494	tmhh	%r8,0x0001		# test problem state bit
 495	jnz	2f			# -> fault in user space
 496#if IS_ENABLED(CONFIG_KVM)
 497	# cleanup critical section for sie64a
 498	lgr	%r14,%r9
 499	slg	%r14,BASED(.Lsie_critical_start)
 500	clg	%r14,BASED(.Lsie_critical_length)
 501	jhe	0f
 502	brasl	%r14,.Lcleanup_sie
 
 
 
 
 503#endif
 5040:	tmhh	%r8,0x4000		# PER bit set in old PSW ?
 505	jnz	1f			# -> enabled, can't be a double fault
 506	tm	__LC_PGM_ILC+3,0x80	# check for per exception
 507	jnz	.Lpgm_svcper		# -> single stepped svc
 5081:	CHECK_STACK STACK_SIZE,__LC_SAVE_AREA_SYNC
 509	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 510	j	3f
 5112:	LAST_BREAK %r14
 512	UPDATE_VTIME %r14,%r15,__LC_SYNC_ENTER_TIMER
 
 513	lg	%r15,__LC_KERNEL_STACK
 514	lgr	%r14,%r12
 515	aghi	%r14,__TASK_thread	# pointer to thread_struct
 516	lghi	%r13,__LC_PGM_TDB
 517	tm	__LC_PGM_ILC+2,0x02	# check for transaction abort
 518	jz	3f
 519	mvc	__THREAD_trap_tdb(256,%r14),0(%r13)
 5203:	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 
 
 521	stmg	%r0,%r7,__PT_R0(%r11)
 
 
 
 
 
 
 
 
 
 522	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
 523	stmg	%r8,%r9,__PT_PSW(%r11)
 524	mvc	__PT_INT_CODE(4,%r11),__LC_PGM_ILC
 525	mvc	__PT_INT_PARM_LONG(8,%r11),__LC_TRANS_EXC_CODE
 526	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 527	stg	%r10,__PT_ARGS(%r11)
 528	tm	__LC_PGM_ILC+3,0x80	# check for per exception
 529	jz	4f
 530	tmhh	%r8,0x0001		# kernel per event ?
 531	jz	.Lpgm_kprobe
 532	oi	__PT_FLAGS+7(%r11),_PIF_PER_TRAP
 533	mvc	__THREAD_per_address(8,%r14),__LC_PER_ADDRESS
 534	mvc	__THREAD_per_cause(2,%r14),__LC_PER_CODE
 535	mvc	__THREAD_per_paid(1,%r14),__LC_PER_ACCESS_ID
 5364:	REENABLE_IRQS
 537	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 538	larl	%r1,pgm_check_table
 539	llgh	%r10,__PT_INT_CODE+2(%r11)
 540	nill	%r10,0x007f
 541	sll	%r10,2
 542	je	.Lpgm_return
 543	lgf	%r1,0(%r10,%r1)		# load address of handler routine
 544	lgr	%r2,%r11		# pass pointer to pt_regs
 545	basr	%r14,%r1		# branch to interrupt-handler
 546.Lpgm_return:
 547	LOCKDEP_SYS_EXIT
 548	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 549	jno	.Lsysc_restore
 
 
 550	j	.Lsysc_tif
 551
 552#
 553# PER event in supervisor state, must be kprobes
 554#
 555.Lpgm_kprobe:
 556	REENABLE_IRQS
 557	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 558	lgr	%r2,%r11		# pass pointer to pt_regs
 559	brasl	%r14,do_per_trap
 560	j	.Lpgm_return
 561
 562#
 563# single stepped system call
 564#
 565.Lpgm_svcper:
 566	mvc	__LC_RETURN_PSW(8),__LC_SVC_NEW_PSW
 
 567	larl	%r14,.Lsysc_per
 568	stg	%r14,__LC_RETURN_PSW+8
 569	lghi	%r14,_PIF_SYSCALL | _PIF_PER_TRAP
 570	lpswe	__LC_RETURN_PSW		# branch to .Lsysc_per and enable irqs
 
 571
 572/*
 573 * IO interrupt handler routine
 574 */
 575ENTRY(io_int_handler)
 576	STCK	__LC_INT_CLOCK
 577	stpt	__LC_ASYNC_ENTER_TIMER
 
 578	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
 579	lg	%r10,__LC_LAST_BREAK
 580	lg	%r12,__LC_CURRENT
 581	larl	%r13,cleanup_critical
 582	lmg	%r8,%r9,__LC_IO_OLD_PSW
 583	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
 584	stmg	%r0,%r7,__PT_R0(%r11)
 
 
 
 
 
 
 
 
 
 
 585	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
 586	stmg	%r8,%r9,__PT_PSW(%r11)
 587	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
 588	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 589	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
 590	jo	.Lio_restore
 591	TRACE_IRQS_OFF
 592	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 593.Lio_loop:
 594	lgr	%r2,%r11		# pass pointer to pt_regs
 595	lghi	%r3,IO_INTERRUPT
 596	tm	__PT_INT_CODE+8(%r11),0x80	# adapter interrupt ?
 597	jz	.Lio_call
 598	lghi	%r3,THIN_INTERRUPT
 599.Lio_call:
 600	brasl	%r14,do_IRQ
 601	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPAR
 602	jz	.Lio_return
 603	tpi	0
 604	jz	.Lio_return
 605	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
 606	j	.Lio_loop
 607.Lio_return:
 608	LOCKDEP_SYS_EXIT
 609	TRACE_IRQS_ON
 610.Lio_tif:
 611	TSTMSK	__TI_flags(%r12),_TIF_WORK
 612	jnz	.Lio_work		# there is work to do (signals etc.)
 613	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
 614	jnz	.Lio_work
 615.Lio_restore:
 616	lg	%r14,__LC_VDSO_PER_CPU
 617	lmg	%r0,%r10,__PT_R0(%r11)
 618	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
 
 
 
 
 619	stpt	__LC_EXIT_TIMER
 620	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 
 621	lmg	%r11,%r15,__PT_R11(%r11)
 622	lpswe	__LC_RETURN_PSW
 623.Lio_done:
 624
 625#
 626# There is work todo, find out in which context we have been interrupted:
 627# 1) if we return to user space we can do all _TIF_WORK work
 628# 2) if we return to kernel code and kvm is enabled check if we need to
 629#    modify the psw to leave SIE
 630# 3) if we return to kernel code and preemptive scheduling is enabled check
 631#    the preemption counter and if it is zero call preempt_schedule_irq
 632# Before any work can be done, a switch to the kernel stack is required.
 633#
 634.Lio_work:
 635	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 636	jo	.Lio_work_user		# yes -> do resched & signal
 637#ifdef CONFIG_PREEMPT
 638	# check for preemptive scheduling
 639	icm	%r0,15,__LC_PREEMPT_COUNT
 640	jnz	.Lio_restore		# preemption is disabled
 641	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 642	jno	.Lio_restore
 643	# switch to kernel stack
 644	lg	%r1,__PT_R15(%r11)
 645	aghi	%r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 646	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 647	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 648	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 649	lgr	%r15,%r1
 650	# TRACE_IRQS_ON already done at .Lio_return, call
 651	# TRACE_IRQS_OFF to keep things symmetrical
 652	TRACE_IRQS_OFF
 653	brasl	%r14,preempt_schedule_irq
 654	j	.Lio_return
 655#else
 656	j	.Lio_restore
 657#endif
 658
 659#
 660# Need to do work before returning to userspace, switch to kernel stack
 661#
 662.Lio_work_user:
 663	lg	%r1,__LC_KERNEL_STACK
 664	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 665	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 666	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 667	lgr	%r15,%r1
 668
 669#
 670# One of the work bits is on. Find out which one.
 671#
 672.Lio_work_tif:
 673	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 674	jo	.Lio_mcck_pending
 675	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 676	jo	.Lio_reschedule
 
 
 
 
 677	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
 678	jo	.Lio_sigpending
 679	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
 680	jo	.Lio_notify_resume
 
 
 681	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 682	jo	.Lio_vxrs
 683	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE
 684	jo	.Lio_uaccess
 685	j	.Lio_return		# beware of critical section cleanup
 686
 687#
 688# _CIF_MCCK_PENDING is set, call handler
 689#
 690.Lio_mcck_pending:
 691	# TRACE_IRQS_ON already done at .Lio_return
 692	brasl	%r14,s390_handle_mcck	# TIF bit will be cleared by handler
 693	TRACE_IRQS_OFF
 694	j	.Lio_return
 695
 696#
 697# _CIF_ASCE is set, load user space asce
 698#
 699.Lio_uaccess:
 700	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE
 
 
 
 
 
 
 
 701	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 702	j	.Lio_return
 
 
 
 
 703
 704#
 705# CIF_FPU is set, restore floating-point controls and floating-point registers.
 706#
 707.Lio_vxrs:
 708	larl	%r14,.Lio_return
 709	jg	load_fpu_regs
 710
 711#
 
 
 
 
 
 
 
 
 
 
 
 
 712# _TIF_NEED_RESCHED is set, call schedule
 713#
 714.Lio_reschedule:
 715	# TRACE_IRQS_ON already done at .Lio_return
 716	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 717	brasl	%r14,schedule		# call scheduler
 718	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 719	TRACE_IRQS_OFF
 720	j	.Lio_return
 721
 722#
 
 
 
 
 
 
 
 
 
 
 723# _TIF_SIGPENDING or is set, call do_signal
 724#
 725.Lio_sigpending:
 726	# TRACE_IRQS_ON already done at .Lio_return
 727	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 728	lgr	%r2,%r11		# pass pointer to pt_regs
 729	brasl	%r14,do_signal
 730	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 731	TRACE_IRQS_OFF
 732	j	.Lio_return
 733
 734#
 735# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
 736#
 737.Lio_notify_resume:
 738	# TRACE_IRQS_ON already done at .Lio_return
 739	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 740	lgr	%r2,%r11		# pass pointer to pt_regs
 741	brasl	%r14,do_notify_resume
 742	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 743	TRACE_IRQS_OFF
 744	j	.Lio_return
 
 745
 746/*
 747 * External interrupt handler routine
 748 */
 749ENTRY(ext_int_handler)
 750	STCK	__LC_INT_CLOCK
 751	stpt	__LC_ASYNC_ENTER_TIMER
 
 752	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
 753	lg	%r10,__LC_LAST_BREAK
 754	lg	%r12,__LC_CURRENT
 755	larl	%r13,cleanup_critical
 756	lmg	%r8,%r9,__LC_EXT_OLD_PSW
 757	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
 758	stmg	%r0,%r7,__PT_R0(%r11)
 
 
 
 
 
 
 
 
 
 
 759	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
 760	stmg	%r8,%r9,__PT_PSW(%r11)
 761	lghi	%r1,__LC_EXT_PARAMS2
 762	mvc	__PT_INT_CODE(4,%r11),__LC_EXT_CPU_ADDR
 763	mvc	__PT_INT_PARM(4,%r11),__LC_EXT_PARAMS
 764	mvc	__PT_INT_PARM_LONG(8,%r11),0(%r1)
 765	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 766	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
 767	jo	.Lio_restore
 768	TRACE_IRQS_OFF
 769	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 770	lgr	%r2,%r11		# pass pointer to pt_regs
 771	lghi	%r3,EXT_INTERRUPT
 772	brasl	%r14,do_IRQ
 773	j	.Lio_return
 
 774
 775/*
 776 * Load idle PSW. The second "half" of this function is in .Lcleanup_idle.
 777 */
 778ENTRY(psw_idle)
 779	stg	%r3,__SF_EMPTY(%r15)
 780	larl	%r1,.Lpsw_idle_lpsw+4
 781	stg	%r1,__SF_EMPTY+8(%r15)
 782#ifdef CONFIG_SMP
 783	larl	%r1,smp_cpu_mtid
 784	llgf	%r1,0(%r1)
 785	ltgr	%r1,%r1
 786	jz	.Lpsw_idle_stcctm
 787	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+16(%r15)
 788.Lpsw_idle_stcctm:
 789#endif
 790	oi	__LC_CPU_FLAGS+7,_CIF_ENABLED_WAIT
 
 791	STCK	__CLOCK_IDLE_ENTER(%r2)
 792	stpt	__TIMER_IDLE_ENTER(%r2)
 793.Lpsw_idle_lpsw:
 794	lpswe	__SF_EMPTY(%r15)
 795	br	%r14
 796.Lpsw_idle_end:
 
 797
 798/*
 799 * Store floating-point controls and floating-point or vector register
 800 * depending whether the vector facility is available.	A critical section
 801 * cleanup assures that the registers are stored even if interrupted for
 802 * some other work.  The CIF_FPU flag is set to trigger a lazy restore
 803 * of the register contents at return from io or a system call.
 804 */
 805ENTRY(save_fpu_regs)
 806	lg	%r2,__LC_CURRENT
 807	aghi	%r2,__TASK_thread
 808	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 809	bor	%r14
 810	stfpc	__THREAD_FPU_fpc(%r2)
 811	lg	%r3,__THREAD_FPU_regs(%r2)
 812	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
 813	jz	.Lsave_fpu_regs_fp	  # no -> store FP regs
 814	VSTM	%v0,%v15,0,%r3		  # vstm 0,15,0(3)
 815	VSTM	%v16,%v31,256,%r3	  # vstm 16,31,256(3)
 816	j	.Lsave_fpu_regs_done	  # -> set CIF_FPU flag
 817.Lsave_fpu_regs_fp:
 818	std	0,0(%r3)
 819	std	1,8(%r3)
 820	std	2,16(%r3)
 821	std	3,24(%r3)
 822	std	4,32(%r3)
 823	std	5,40(%r3)
 824	std	6,48(%r3)
 825	std	7,56(%r3)
 826	std	8,64(%r3)
 827	std	9,72(%r3)
 828	std	10,80(%r3)
 829	std	11,88(%r3)
 830	std	12,96(%r3)
 831	std	13,104(%r3)
 832	std	14,112(%r3)
 833	std	15,120(%r3)
 834.Lsave_fpu_regs_done:
 835	oi	__LC_CPU_FLAGS+7,_CIF_FPU
 836	br	%r14
 
 837.Lsave_fpu_regs_end:
 838#if IS_ENABLED(CONFIG_KVM)
 839EXPORT_SYMBOL(save_fpu_regs)
 840#endif
 841
 842/*
 843 * Load floating-point controls and floating-point or vector registers.
 844 * A critical section cleanup assures that the register contents are
 845 * loaded even if interrupted for some other work.
 846 *
 847 * There are special calling conventions to fit into sysc and io return work:
 848 *	%r15:	<kernel stack>
 849 * The function requires:
 850 *	%r4
 851 */
 852load_fpu_regs:
 853	lg	%r4,__LC_CURRENT
 854	aghi	%r4,__TASK_thread
 855	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 856	bnor	%r14
 857	lfpc	__THREAD_FPU_fpc(%r4)
 858	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
 859	lg	%r4,__THREAD_FPU_regs(%r4)	# %r4 <- reg save area
 860	jz	.Lload_fpu_regs_fp		# -> no VX, load FP regs
 861	VLM	%v0,%v15,0,%r4
 862	VLM	%v16,%v31,256,%r4
 863	j	.Lload_fpu_regs_done
 864.Lload_fpu_regs_fp:
 865	ld	0,0(%r4)
 866	ld	1,8(%r4)
 867	ld	2,16(%r4)
 868	ld	3,24(%r4)
 869	ld	4,32(%r4)
 870	ld	5,40(%r4)
 871	ld	6,48(%r4)
 872	ld	7,56(%r4)
 873	ld	8,64(%r4)
 874	ld	9,72(%r4)
 875	ld	10,80(%r4)
 876	ld	11,88(%r4)
 877	ld	12,96(%r4)
 878	ld	13,104(%r4)
 879	ld	14,112(%r4)
 880	ld	15,120(%r4)
 881.Lload_fpu_regs_done:
 882	ni	__LC_CPU_FLAGS+7,255-_CIF_FPU
 883	br	%r14
 
 884.Lload_fpu_regs_end:
 
 885
 886.L__critical_end:
 887
 888/*
 889 * Machine check handler routines
 890 */
 891ENTRY(mcck_int_handler)
 892	STCK	__LC_MCCK_CLOCK
 893	la	%r1,4095		# revalidate r1
 894	spt	__LC_CPU_TIMER_SAVE_AREA-4095(%r1)	# revalidate cpu timer
 895	lmg	%r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
 896	lg	%r10,__LC_LAST_BREAK
 
 
 897	lg	%r12,__LC_CURRENT
 898	larl	%r13,cleanup_critical
 899	lmg	%r8,%r9,__LC_MCK_OLD_PSW
 900	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_SYSTEM_DAMAGE
 901	jo	.Lmcck_panic		# yes -> rest of mcck code invalid
 902	lghi	%r14,__LC_CPU_TIMER_SAVE_AREA
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 903	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
 904	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_CPU_TIMER_VALID
 905	jo	3f
 906	la	%r14,__LC_SYNC_ENTER_TIMER
 907	clc	0(8,%r14),__LC_ASYNC_ENTER_TIMER
 908	jl	0f
 909	la	%r14,__LC_ASYNC_ENTER_TIMER
 9100:	clc	0(8,%r14),__LC_EXIT_TIMER
 911	jl	1f
 912	la	%r14,__LC_EXIT_TIMER
 9131:	clc	0(8,%r14),__LC_LAST_UPDATE_TIMER
 914	jl	2f
 915	la	%r14,__LC_LAST_UPDATE_TIMER
 9162:	spt	0(%r14)
 917	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
 9183:	TSTMSK	__LC_MCCK_CODE,(MCCK_CODE_PSW_MWP_VALID|MCCK_CODE_PSW_IA_VALID)
 919	jno	.Lmcck_panic		# no -> skip cleanup critical
 
 
 
 
 
 920	SWITCH_ASYNC __LC_GPREGS_SAVE_AREA+64,__LC_MCCK_ENTER_TIMER
 921.Lmcck_skip:
 922	lghi	%r14,__LC_GPREGS_SAVE_AREA+64
 923	stmg	%r0,%r7,__PT_R0(%r11)
 
 
 
 
 
 
 
 
 
 
 924	mvc	__PT_R8(64,%r11),0(%r14)
 925	stmg	%r8,%r9,__PT_PSW(%r11)
 926	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 927	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 928	lgr	%r2,%r11		# pass pointer to pt_regs
 929	brasl	%r14,s390_do_machine_check
 930	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 931	jno	.Lmcck_return
 932	lg	%r1,__LC_KERNEL_STACK	# switch to kernel stack
 933	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 934	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 935	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 936	lgr	%r15,%r1
 937	ssm	__LC_PGM_NEW_PSW	# turn dat on, keep irqs off
 938	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 939	jno	.Lmcck_return
 940	TRACE_IRQS_OFF
 941	brasl	%r14,s390_handle_mcck
 942	TRACE_IRQS_ON
 943.Lmcck_return:
 944	lg	%r14,__LC_VDSO_PER_CPU
 945	lmg	%r0,%r10,__PT_R0(%r11)
 946	mvc	__LC_RETURN_MCCK_PSW(16),__PT_PSW(%r11) # move return PSW
 947	tm	__LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
 948	jno	0f
 
 949	stpt	__LC_EXIT_TIMER
 950	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 9510:	lmg	%r11,%r15,__PT_R11(%r11)
 952	lpswe	__LC_RETURN_MCCK_PSW
 953
 954.Lmcck_panic:
 955	lg	%r15,__LC_PANIC_STACK
 956	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 957	j	.Lmcck_skip
 
 958
 959#
 960# PSW restart interrupt handler
 961#
 962ENTRY(restart_int_handler)
 963	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPP
 964	jz	0f
 965	.insn	s,0xb2800000,__LC_LPP
 9660:	stg	%r15,__LC_SAVE_AREA_RESTART
 967	lg	%r15,__LC_RESTART_STACK
 968	aghi	%r15,-__PT_SIZE			# create pt_regs on stack
 969	xc	0(__PT_SIZE,%r15),0(%r15)
 970	stmg	%r0,%r14,__PT_R0(%r15)
 971	mvc	__PT_R15(8,%r15),__LC_SAVE_AREA_RESTART
 972	mvc	__PT_PSW(16,%r15),__LC_RST_OLD_PSW # store restart old psw
 973	aghi	%r15,-STACK_FRAME_OVERHEAD	# create stack frame on stack
 974	xc	0(STACK_FRAME_OVERHEAD,%r15),0(%r15)
 975	lg	%r1,__LC_RESTART_FN		# load fn, parm & source cpu
 976	lg	%r2,__LC_RESTART_DATA
 977	lg	%r3,__LC_RESTART_SOURCE
 978	ltgr	%r3,%r3				# test source cpu address
 979	jm	1f				# negative -> skip source stop
 9800:	sigp	%r4,%r3,SIGP_SENSE		# sigp sense to source cpu
 981	brc	10,0b				# wait for status stored
 9821:	basr	%r14,%r1			# call function
 983	stap	__SF_EMPTY(%r15)		# store cpu address
 984	llgh	%r3,__SF_EMPTY(%r15)
 9852:	sigp	%r4,%r3,SIGP_STOP		# sigp stop to current cpu
 986	brc	2,2b
 9873:	j	3b
 
 988
 989	.section .kprobes.text, "ax"
 990
 991#ifdef CONFIG_CHECK_STACK
 992/*
 993 * The synchronous or the asynchronous stack overflowed. We are dead.
 994 * No need to properly save the registers, we are going to panic anyway.
 995 * Setup a pt_regs so that show_trace can provide a good call trace.
 996 */
 997stack_overflow:
 998	lg	%r15,__LC_PANIC_STACK	# change to panic stack
 999	la	%r11,STACK_FRAME_OVERHEAD(%r15)
1000	stmg	%r0,%r7,__PT_R0(%r11)
1001	stmg	%r8,%r9,__PT_PSW(%r11)
1002	mvc	__PT_R8(64,%r11),0(%r14)
1003	stg	%r10,__PT_ORIG_GPR2(%r11) # store last break to orig_gpr2
1004	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
1005	lgr	%r2,%r11		# pass pointer to pt_regs
1006	jg	kernel_stack_overflow
 
1007#endif
1008
1009cleanup_critical:
1010#if IS_ENABLED(CONFIG_KVM)
1011	clg	%r9,BASED(.Lcleanup_table_sie)	# .Lsie_gmap
1012	jl	0f
1013	clg	%r9,BASED(.Lcleanup_table_sie+8)# .Lsie_done
1014	jl	.Lcleanup_sie
1015#endif
1016	clg	%r9,BASED(.Lcleanup_table)	# system_call
1017	jl	0f
1018	clg	%r9,BASED(.Lcleanup_table+8)	# .Lsysc_do_svc
1019	jl	.Lcleanup_system_call
1020	clg	%r9,BASED(.Lcleanup_table+16)	# .Lsysc_tif
1021	jl	0f
1022	clg	%r9,BASED(.Lcleanup_table+24)	# .Lsysc_restore
1023	jl	.Lcleanup_sysc_tif
1024	clg	%r9,BASED(.Lcleanup_table+32)	# .Lsysc_done
1025	jl	.Lcleanup_sysc_restore
1026	clg	%r9,BASED(.Lcleanup_table+40)	# .Lio_tif
1027	jl	0f
1028	clg	%r9,BASED(.Lcleanup_table+48)	# .Lio_restore
1029	jl	.Lcleanup_io_tif
1030	clg	%r9,BASED(.Lcleanup_table+56)	# .Lio_done
1031	jl	.Lcleanup_io_restore
1032	clg	%r9,BASED(.Lcleanup_table+64)	# psw_idle
1033	jl	0f
1034	clg	%r9,BASED(.Lcleanup_table+72)	# .Lpsw_idle_end
1035	jl	.Lcleanup_idle
1036	clg	%r9,BASED(.Lcleanup_table+80)	# save_fpu_regs
1037	jl	0f
1038	clg	%r9,BASED(.Lcleanup_table+88)	# .Lsave_fpu_regs_end
1039	jl	.Lcleanup_save_fpu_regs
1040	clg	%r9,BASED(.Lcleanup_table+96)	# load_fpu_regs
1041	jl	0f
1042	clg	%r9,BASED(.Lcleanup_table+104)	# .Lload_fpu_regs_end
1043	jl	.Lcleanup_load_fpu_regs
10440:	br	%r14
 
1045
1046	.align	8
1047.Lcleanup_table:
1048	.quad	system_call
1049	.quad	.Lsysc_do_svc
1050	.quad	.Lsysc_tif
1051	.quad	.Lsysc_restore
1052	.quad	.Lsysc_done
1053	.quad	.Lio_tif
1054	.quad	.Lio_restore
1055	.quad	.Lio_done
1056	.quad	psw_idle
1057	.quad	.Lpsw_idle_end
1058	.quad	save_fpu_regs
1059	.quad	.Lsave_fpu_regs_end
1060	.quad	load_fpu_regs
1061	.quad	.Lload_fpu_regs_end
1062
1063#if IS_ENABLED(CONFIG_KVM)
1064.Lcleanup_table_sie:
1065	.quad	.Lsie_gmap
1066	.quad	.Lsie_done
1067
1068.Lcleanup_sie:
1069	lg	%r9,__SF_EMPTY(%r15)		# get control block pointer
 
 
 
 
 
 
 
1070	ni	__SIE_PROG0C+3(%r9),0xfe	# no longer in SIE
1071	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
1072	larl	%r9,sie_exit			# skip forward to sie_exit
1073	br	%r14
1074#endif
1075
1076.Lcleanup_system_call:
1077	# check if stpt has been executed
1078	clg	%r9,BASED(.Lcleanup_system_call_insn)
1079	jh	0f
1080	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
1081	cghi	%r11,__LC_SAVE_AREA_ASYNC
1082	je	0f
1083	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
10840:	# check if stmg has been executed
1085	clg	%r9,BASED(.Lcleanup_system_call_insn+8)
1086	jh	0f
1087	mvc	__LC_SAVE_AREA_SYNC(64),0(%r11)
10880:	# check if base register setup + TIF bit load has been done
1089	clg	%r9,BASED(.Lcleanup_system_call_insn+16)
1090	jhe	0f
1091	# set up saved registers r10 and r12
1092	stg	%r10,16(%r11)		# r10 last break
1093	stg	%r12,32(%r11)		# r12 task struct pointer
 
10940:	# check if the user time update has been done
1095	clg	%r9,BASED(.Lcleanup_system_call_insn+24)
1096	jh	0f
1097	lg	%r15,__LC_EXIT_TIMER
1098	slg	%r15,__LC_SYNC_ENTER_TIMER
1099	alg	%r15,__LC_USER_TIMER
1100	stg	%r15,__LC_USER_TIMER
11010:	# check if the system time update has been done
1102	clg	%r9,BASED(.Lcleanup_system_call_insn+32)
1103	jh	0f
1104	lg	%r15,__LC_LAST_UPDATE_TIMER
1105	slg	%r15,__LC_EXIT_TIMER
1106	alg	%r15,__LC_SYSTEM_TIMER
1107	stg	%r15,__LC_SYSTEM_TIMER
11080:	# update accounting time stamp
1109	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
1110	# do LAST_BREAK
1111	lg	%r9,16(%r11)
1112	srag	%r9,%r9,23
1113	jz	0f
1114	lgr	%r9,%r12
1115	aghi	%r9,__TASK_thread
1116	mvc	__THREAD_last_break(8,%r9),16(%r11)
11170:	# set up saved register r11
1118	lg	%r15,__LC_KERNEL_STACK
1119	la	%r9,STACK_FRAME_OVERHEAD(%r15)
1120	stg	%r9,24(%r11)		# r11 pt_regs pointer
1121	# fill pt_regs
1122	mvc	__PT_R8(64,%r9),__LC_SAVE_AREA_SYNC
1123	stmg	%r0,%r7,__PT_R0(%r9)
1124	mvc	__PT_PSW(16,%r9),__LC_SVC_OLD_PSW
1125	mvc	__PT_INT_CODE(4,%r9),__LC_SVC_ILC
1126	xc	__PT_FLAGS(8,%r9),__PT_FLAGS(%r9)
1127	mvi	__PT_FLAGS+7(%r9),_PIF_SYSCALL
1128	# setup saved register r15
1129	stg	%r15,56(%r11)		# r15 stack pointer
1130	# set new psw address and exit
1131	larl	%r9,.Lsysc_do_svc
1132	br	%r14
1133.Lcleanup_system_call_insn:
1134	.quad	system_call
1135	.quad	.Lsysc_stmg
1136	.quad	.Lsysc_per
1137	.quad	.Lsysc_vtime+36
1138	.quad	.Lsysc_vtime+42
 
 
1139
1140.Lcleanup_sysc_tif:
1141	larl	%r9,.Lsysc_tif
1142	br	%r14
1143
1144.Lcleanup_sysc_restore:
 
1145	clg	%r9,BASED(.Lcleanup_sysc_restore_insn)
 
 
 
1146	je	0f
 
 
 
1147	lg	%r9,24(%r11)		# get saved pointer to pt_regs
1148	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
1149	mvc	0(64,%r11),__PT_R8(%r9)
1150	lmg	%r0,%r7,__PT_R0(%r9)
11510:	lmg	%r8,%r9,__LC_RETURN_PSW
1152	br	%r14
1153.Lcleanup_sysc_restore_insn:
 
1154	.quad	.Lsysc_done - 4
1155
1156.Lcleanup_io_tif:
1157	larl	%r9,.Lio_tif
1158	br	%r14
1159
1160.Lcleanup_io_restore:
 
1161	clg	%r9,BASED(.Lcleanup_io_restore_insn)
1162	je	0f
 
 
 
1163	lg	%r9,24(%r11)		# get saved r11 pointer to pt_regs
1164	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
1165	mvc	0(64,%r11),__PT_R8(%r9)
1166	lmg	%r0,%r7,__PT_R0(%r9)
11670:	lmg	%r8,%r9,__LC_RETURN_PSW
1168	br	%r14
1169.Lcleanup_io_restore_insn:
 
1170	.quad	.Lio_done - 4
1171
1172.Lcleanup_idle:
1173	ni	__LC_CPU_FLAGS+7,255-_CIF_ENABLED_WAIT
1174	# copy interrupt clock & cpu timer
1175	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_INT_CLOCK
1176	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_ASYNC_ENTER_TIMER
1177	cghi	%r11,__LC_SAVE_AREA_ASYNC
1178	je	0f
1179	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_MCCK_CLOCK
1180	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_MCCK_ENTER_TIMER
11810:	# check if stck & stpt have been executed
1182	clg	%r9,BASED(.Lcleanup_idle_insn)
1183	jhe	1f
1184	mvc	__CLOCK_IDLE_ENTER(8,%r2),__CLOCK_IDLE_EXIT(%r2)
1185	mvc	__TIMER_IDLE_ENTER(8,%r2),__TIMER_IDLE_EXIT(%r2)
11861:	# calculate idle cycles
1187#ifdef CONFIG_SMP
1188	clg	%r9,BASED(.Lcleanup_idle_insn)
1189	jl	3f
1190	larl	%r1,smp_cpu_mtid
1191	llgf	%r1,0(%r1)
1192	ltgr	%r1,%r1
1193	jz	3f
1194	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+80(%r15)
1195	larl	%r3,mt_cycles
1196	ag	%r3,__LC_PERCPU_OFFSET
1197	la	%r4,__SF_EMPTY+16(%r15)
11982:	lg	%r0,0(%r3)
1199	slg	%r0,0(%r4)
1200	alg	%r0,64(%r4)
1201	stg	%r0,0(%r3)
1202	la	%r3,8(%r3)
1203	la	%r4,8(%r4)
1204	brct	%r1,2b
1205#endif
12063:	# account system time going idle
1207	lg	%r9,__LC_STEAL_TIMER
1208	alg	%r9,__CLOCK_IDLE_ENTER(%r2)
1209	slg	%r9,__LC_LAST_UPDATE_CLOCK
1210	stg	%r9,__LC_STEAL_TIMER
1211	mvc	__LC_LAST_UPDATE_CLOCK(8),__CLOCK_IDLE_EXIT(%r2)
1212	lg	%r9,__LC_SYSTEM_TIMER
1213	alg	%r9,__LC_LAST_UPDATE_TIMER
1214	slg	%r9,__TIMER_IDLE_ENTER(%r2)
1215	stg	%r9,__LC_SYSTEM_TIMER
1216	mvc	__LC_LAST_UPDATE_TIMER(8),__TIMER_IDLE_EXIT(%r2)
1217	# prepare return psw
1218	nihh	%r8,0xfcfd		# clear irq & wait state bits
1219	lg	%r9,48(%r11)		# return from psw_idle
1220	br	%r14
1221.Lcleanup_idle_insn:
1222	.quad	.Lpsw_idle_lpsw
1223
1224.Lcleanup_save_fpu_regs:
1225	larl	%r9,save_fpu_regs
1226	br	%r14
1227
1228.Lcleanup_load_fpu_regs:
1229	larl	%r9,load_fpu_regs
1230	br	%r14
1231
1232/*
1233 * Integer constants
1234 */
1235	.align	8
1236.Lcritical_start:
1237	.quad	.L__critical_start
1238.Lcritical_length:
1239	.quad	.L__critical_end - .L__critical_start
1240#if IS_ENABLED(CONFIG_KVM)
1241.Lsie_critical_start:
1242	.quad	.Lsie_gmap
1243.Lsie_critical_length:
1244	.quad	.Lsie_done - .Lsie_gmap
 
 
 
 
1245#endif
1246
1247	.section .rodata, "a"
1248#define SYSCALL(esame,emu)	.long esame
1249	.globl	sys_call_table
1250sys_call_table:
1251#include "syscalls.S"
1252#undef SYSCALL
1253
1254#ifdef CONFIG_COMPAT
1255
1256#define SYSCALL(esame,emu)	.long emu
1257	.globl	sys_call_table_emu
1258sys_call_table_emu:
1259#include "syscalls.S"
1260#undef SYSCALL
1261#endif