Linux Audio

Check our new training course

Loading...
v4.17
   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 stacksize,savearea
  89#ifdef CONFIG_CHECK_STACK
  90	tml	%r15,\stacksize - CONFIG_STACK_GUARD
  91	lghi	%r14,\savearea
  92	jz	stack_overflow
  93#endif
  94	.endm
  95
  96	.macro	SWITCH_ASYNC savearea,timer
  97	tmhh	%r8,0x0001		# interrupting from user ?
  98	jnz	1f
  99	lgr	%r14,%r9
 100	slg	%r14,BASED(.Lcritical_start)
 101	clg	%r14,BASED(.Lcritical_length)
 102	jhe	0f
 103	lghi	%r11,\savearea		# inside critical section, do cleanup
 104	brasl	%r14,cleanup_critical
 105	tmhh	%r8,0x0001		# retest problem state after cleanup
 106	jnz	1f
 1070:	lg	%r14,__LC_ASYNC_STACK	# are we already on the async stack?
 108	slgr	%r14,%r15
 109	srag	%r14,%r14,STACK_SHIFT
 110	jnz	2f
 111	CHECK_STACK 1<<STACK_SHIFT,\savearea
 112	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 113	j	3f
 1141:	UPDATE_VTIME %r14,%r15,\timer
 115	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
 1162:	lg	%r15,__LC_ASYNC_STACK	# load async stack
 1173:	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 118	.endm
 119
 120	.macro UPDATE_VTIME w1,w2,enter_timer
 121	lg	\w1,__LC_EXIT_TIMER
 122	lg	\w2,__LC_LAST_UPDATE_TIMER
 123	slg	\w1,\enter_timer
 124	slg	\w2,__LC_EXIT_TIMER
 125	alg	\w1,__LC_USER_TIMER
 126	alg	\w2,__LC_SYSTEM_TIMER
 127	stg	\w1,__LC_USER_TIMER
 128	stg	\w2,__LC_SYSTEM_TIMER
 129	mvc	__LC_LAST_UPDATE_TIMER(8),\enter_timer
 130	.endm
 131
 132	.macro REENABLE_IRQS
 133	stg	%r8,__LC_RETURN_PSW
 134	ni	__LC_RETURN_PSW,0xbf
 135	ssm	__LC_RETURN_PSW
 136	.endm
 137
 138	.macro STCK savearea
 139#ifdef CONFIG_HAVE_MARCH_Z9_109_FEATURES
 140	.insn	s,0xb27c0000,\savearea		# store clock fast
 
 
 
 
 
 141#else
 142	.insn	s,0xb2050000,\savearea		# store clock
 143#endif
 
 
 144	.endm
 145
 146	/*
 147	 * The TSTMSK macro generates a test-under-mask instruction by
 148	 * calculating the memory offset for the specified mask value.
 149	 * Mask value can be any constant.  The macro shifts the mask
 150	 * value to calculate the memory offset for the test-under-mask
 151	 * instruction.
 152	 */
 153	.macro TSTMSK addr, mask, size=8, bytepos=0
 154		.if (\bytepos < \size) && (\mask >> 8)
 155			.if (\mask & 0xff)
 156				.error "Mask exceeds byte boundary"
 157			.endif
 158			TSTMSK \addr, "(\mask >> 8)", \size, "(\bytepos + 1)"
 159			.exitm
 160		.endif
 161		.ifeq \mask
 162			.error "Mask must not be zero"
 163		.endif
 164		off = \size - \bytepos - 1
 165		tm	off+\addr, \mask
 166	.endm
 167
 168	.macro BPOFF
 169	ALTERNATIVE "", ".long 0xb2e8c000", 82
 
 
 
 170	.endm
 171
 172	.macro BPON
 173	ALTERNATIVE "", ".long 0xb2e8d000", 82
 
 
 
 174	.endm
 175
 176	.macro BPENTER tif_ptr,tif_mask
 177	ALTERNATIVE "TSTMSK \tif_ptr,\tif_mask; jz .+8; .long 0xb2e8d000", \
 178		    "", 82
 
 
 
 
 
 179	.endm
 180
 181	.macro BPEXIT tif_ptr,tif_mask
 182	TSTMSK	\tif_ptr,\tif_mask
 183	ALTERNATIVE "jz .+8;  .long 0xb2e8c000", \
 184		    "jnz .+8; .long 0xb2e8d000", 82
 185	.endm
 186
 187	GEN_BR_THUNK %r9
 188	GEN_BR_THUNK %r14
 189	GEN_BR_THUNK %r14,%r11
 190
 191	.section .kprobes.text, "ax"
 192.Ldummy:
 193	/*
 194	 * This nop exists only in order to avoid that __switch_to starts at
 195	 * the beginning of the kprobes text section. In that case we would
 196	 * have several symbols at the same address. E.g. objdump would take
 197	 * an arbitrary symbol name when disassembling this code.
 198	 * With the added nop in between the __switch_to symbol is unique
 199	 * again.
 200	 */
 201	nop	0
 202
 203ENTRY(__bpon)
 204	.globl __bpon
 205	BPON
 206	BR_EX	%r14
 207
 208/*
 209 * Scheduler resume function, called by switch_to
 210 *  gpr2 = (task_struct *) prev
 211 *  gpr3 = (task_struct *) next
 212 * Returns:
 213 *  gpr2 = prev
 214 */
 215ENTRY(__switch_to)
 216	stmg	%r6,%r15,__SF_GPRS(%r15)	# store gprs of prev task
 217	lghi	%r4,__TASK_stack
 218	lghi	%r1,__TASK_thread
 219	lg	%r5,0(%r4,%r3)			# start of kernel stack of next
 220	stg	%r15,__THREAD_ksp(%r1,%r2)	# store kernel stack of prev
 221	lgr	%r15,%r5
 222	aghi	%r15,STACK_INIT			# end of kernel stack of next
 223	stg	%r3,__LC_CURRENT		# store task struct of next
 224	stg	%r15,__LC_KERNEL_STACK		# store end of kernel stack
 225	lg	%r15,__THREAD_ksp(%r1,%r3)	# load kernel stack of next
 226	aghi	%r3,__TASK_pid
 227	mvc	__LC_CURRENT_PID(4,%r0),0(%r3)	# store pid of next
 228	lmg	%r6,%r15,__SF_GPRS(%r15)	# load gprs of next task
 229	ALTERNATIVE "", ".insn s,0xb2800000,_LPP_OFFSET", 40
 230	BR_EX	%r14
 231
 232.L__critical_start:
 233
 234#if IS_ENABLED(CONFIG_KVM)
 235/*
 236 * sie64a calling convention:
 237 * %r2 pointer to sie control block
 238 * %r3 guest register save area
 239 */
 240ENTRY(sie64a)
 241	stmg	%r6,%r14,__SF_GPRS(%r15)	# save kernel registers
 242	lg	%r12,__LC_CURRENT
 243	stg	%r2,__SF_SIE_CONTROL(%r15)	# save control block pointer
 244	stg	%r3,__SF_SIE_SAVEAREA(%r15)	# save guest register save area
 245	xc	__SF_SIE_REASON(8,%r15),__SF_SIE_REASON(%r15) # reason code = 0
 246	mvc	__SF_SIE_FLAGS(8,%r15),__TI_flags(%r12) # copy thread flags
 247	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU		# load guest fp/vx registers ?
 248	jno	.Lsie_load_guest_gprs
 249	brasl	%r14,load_fpu_regs		# load guest fp/vx regs
 250.Lsie_load_guest_gprs:
 251	lmg	%r0,%r13,0(%r3)			# load guest gprs 0-13
 252	lg	%r14,__LC_GMAP			# get gmap pointer
 253	ltgr	%r14,%r14
 254	jz	.Lsie_gmap
 255	lctlg	%c1,%c1,__GMAP_ASCE(%r14)	# load primary asce
 256.Lsie_gmap:
 257	lg	%r14,__SF_SIE_CONTROL(%r15)	# get control block pointer
 258	oi	__SIE_PROG0C+3(%r14),1		# we are going into SIE now
 259	tm	__SIE_PROG20+3(%r14),3		# last exit...
 260	jnz	.Lsie_skip
 261	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 262	jo	.Lsie_skip			# exit if fp/vx regs changed
 263	BPEXIT	__SF_SIE_FLAGS(%r15),(_TIF_ISOLATE_BP|_TIF_ISOLATE_BP_GUEST)
 264.Lsie_entry:
 265	sie	0(%r14)
 266.Lsie_exit:
 267	BPOFF
 268	BPENTER	__SF_SIE_FLAGS(%r15),(_TIF_ISOLATE_BP|_TIF_ISOLATE_BP_GUEST)
 269.Lsie_skip:
 270	ni	__SIE_PROG0C+3(%r14),0xfe	# no longer in SIE
 271	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 272.Lsie_done:
 273# some program checks are suppressing. C code (e.g. do_protection_exception)
 274# will rewind the PSW by the ILC, which is often 4 bytes in case of SIE. There
 275# are some corner cases (e.g. runtime instrumentation) where ILC is unpredictable.
 276# Other instructions between sie64a and .Lsie_done should not cause program
 277# interrupts. So lets use 3 nops as a landing pad for all possible rewinds.
 278# See also .Lcleanup_sie
 279.Lrewind_pad6:
 280	nopr	7
 281.Lrewind_pad4:
 282	nopr	7
 283.Lrewind_pad2:
 284	nopr	7
 285	.globl sie_exit
 286sie_exit:
 287	lg	%r14,__SF_SIE_SAVEAREA(%r15)	# load guest register save area
 288	stmg	%r0,%r13,0(%r14)		# save guest gprs 0-13
 289	xgr	%r0,%r0				# clear guest registers to
 290	xgr	%r1,%r1				# prevent speculative use
 291	xgr	%r2,%r2
 292	xgr	%r3,%r3
 293	xgr	%r4,%r4
 294	xgr	%r5,%r5
 295	lmg	%r6,%r14,__SF_GPRS(%r15)	# restore kernel registers
 296	lg	%r2,__SF_SIE_REASON(%r15)	# return exit reason code
 297	BR_EX	%r14
 298.Lsie_fault:
 299	lghi	%r14,-EFAULT
 300	stg	%r14,__SF_SIE_REASON(%r15)	# set exit reason code
 301	j	sie_exit
 302
 303	EX_TABLE(.Lrewind_pad6,.Lsie_fault)
 304	EX_TABLE(.Lrewind_pad4,.Lsie_fault)
 305	EX_TABLE(.Lrewind_pad2,.Lsie_fault)
 306	EX_TABLE(sie_exit,.Lsie_fault)
 307EXPORT_SYMBOL(sie64a)
 308EXPORT_SYMBOL(sie_exit)
 309#endif
 310
 
 311/*
 312 * SVC interrupt handler routine. System calls are synchronous events and
 313 * are executed with interrupts enabled.
 314 */
 315
 316ENTRY(system_call)
 317	stpt	__LC_SYNC_ENTER_TIMER
 318.Lsysc_stmg:
 319	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
 320	BPOFF
 321	lg	%r12,__LC_CURRENT
 322	lghi	%r13,__TASK_thread
 323	lghi	%r14,_PIF_SYSCALL
 324.Lsysc_per:
 325	lg	%r15,__LC_KERNEL_STACK
 326	la	%r11,STACK_FRAME_OVERHEAD(%r15)	# pointer to pt_regs
 327.Lsysc_vtime:
 328	UPDATE_VTIME %r8,%r9,__LC_SYNC_ENTER_TIMER
 329	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
 330	stmg	%r0,%r7,__PT_R0(%r11)
 331	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
 332	mvc	__PT_PSW(16,%r11),__LC_SVC_OLD_PSW
 333	mvc	__PT_INT_CODE(4,%r11),__LC_SVC_ILC
 334	stg	%r14,__PT_FLAGS(%r11)
 335.Lsysc_do_svc:
 336	# clear user controlled register to prevent speculative use
 337	xgr	%r0,%r0
 338	# load address of system call table
 339	lg	%r10,__THREAD_sysc_table(%r13,%r12)
 340	llgh	%r8,__PT_INT_CODE+2(%r11)
 341	slag	%r8,%r8,2			# shift and test for svc 0
 342	jnz	.Lsysc_nr_ok
 343	# svc 0: system call number in %r1
 344	llgfr	%r1,%r1				# clear high word in r1
 345	cghi	%r1,NR_syscalls
 346	jnl	.Lsysc_nr_ok
 347	sth	%r1,__PT_INT_CODE+2(%r11)
 348	slag	%r8,%r1,2
 349.Lsysc_nr_ok:
 350	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 351	stg	%r2,__PT_ORIG_GPR2(%r11)
 352	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
 353	lgf	%r9,0(%r8,%r10)			# get system call add.
 354	TSTMSK	__TI_flags(%r12),_TIF_TRACE
 355	jnz	.Lsysc_tracesys
 356	BASR_EX	%r14,%r9			# call sys_xxxx
 357	stg	%r2,__PT_R2(%r11)		# store return value
 358
 359.Lsysc_return:
 360	LOCKDEP_SYS_EXIT
 361.Lsysc_tif:
 362	TSTMSK	__PT_FLAGS(%r11),_PIF_WORK
 363	jnz	.Lsysc_work
 364	TSTMSK	__TI_flags(%r12),_TIF_WORK
 365	jnz	.Lsysc_work			# check for work
 366	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
 367	jnz	.Lsysc_work
 368	BPEXIT	__TI_flags(%r12),_TIF_ISOLATE_BP
 369.Lsysc_restore:
 370	lg	%r14,__LC_VDSO_PER_CPU
 371	lmg	%r0,%r10,__PT_R0(%r11)
 372	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
 373.Lsysc_exit_timer:
 374	stpt	__LC_EXIT_TIMER
 375	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 376	lmg	%r11,%r15,__PT_R11(%r11)
 377	lpswe	__LC_RETURN_PSW
 378.Lsysc_done:
 379
 380#
 381# One of the work bits is on. Find out which one.
 382#
 383.Lsysc_work:
 384	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 385	jo	.Lsysc_mcck_pending
 386	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 387	jo	.Lsysc_reschedule
 388	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL_RESTART
 389	jo	.Lsysc_syscall_restart
 390#ifdef CONFIG_UPROBES
 391	TSTMSK	__TI_flags(%r12),_TIF_UPROBE
 392	jo	.Lsysc_uprobe_notify
 393#endif
 394	TSTMSK	__TI_flags(%r12),_TIF_GUARDED_STORAGE
 395	jo	.Lsysc_guarded_storage
 396	TSTMSK	__PT_FLAGS(%r11),_PIF_PER_TRAP
 397	jo	.Lsysc_singlestep
 398#ifdef CONFIG_LIVEPATCH
 399	TSTMSK	__TI_flags(%r12),_TIF_PATCH_PENDING
 400	jo	.Lsysc_patch_pending	# handle live patching just before
 401					# signals and possible syscall restart
 402#endif
 403	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL_RESTART
 404	jo	.Lsysc_syscall_restart
 405	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
 406	jo	.Lsysc_sigpending
 407	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
 408	jo	.Lsysc_notify_resume
 409	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 410	jo	.Lsysc_vxrs
 411	TSTMSK	__LC_CPU_FLAGS,(_CIF_ASCE_PRIMARY|_CIF_ASCE_SECONDARY)
 412	jnz	.Lsysc_asce
 413	j	.Lsysc_return		# beware of critical section cleanup
 414
 415#
 416# _TIF_NEED_RESCHED is set, call schedule
 417#
 418.Lsysc_reschedule:
 419	larl	%r14,.Lsysc_return
 420	jg	schedule
 421
 422#
 423# _CIF_MCCK_PENDING is set, call handler
 424#
 425.Lsysc_mcck_pending:
 426	larl	%r14,.Lsysc_return
 427	jg	s390_handle_mcck	# TIF bit will be cleared by handler
 428
 429#
 430# _CIF_ASCE_PRIMARY and/or _CIF_ASCE_SECONDARY set, load user space asce
 431#
 432.Lsysc_asce:
 433	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_SECONDARY
 434	lctlg	%c7,%c7,__LC_VDSO_ASCE		# load secondary asce
 435	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE_PRIMARY
 436	jz	.Lsysc_return
 437#ifndef CONFIG_HAVE_MARCH_Z10_FEATURES
 438	tm	__LC_STFLE_FAC_LIST+3,0x10	# has MVCOS ?
 439	jnz	.Lsysc_set_fs_fixup
 440	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_PRIMARY
 441	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 442	j	.Lsysc_return
 443.Lsysc_set_fs_fixup:
 444#endif
 445	larl	%r14,.Lsysc_return
 446	jg	set_fs_fixup
 447
 448#
 449# CIF_FPU is set, restore floating-point controls and floating-point registers.
 450#
 451.Lsysc_vxrs:
 452	larl	%r14,.Lsysc_return
 453	jg	load_fpu_regs
 
 454
 455#
 456# _TIF_SIGPENDING is set, call do_signal
 457#
 458.Lsysc_sigpending:
 459	lgr	%r2,%r11		# pass pointer to pt_regs
 460	brasl	%r14,do_signal
 461	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
 462	jno	.Lsysc_return
 463.Lsysc_do_syscall:
 464	lghi	%r13,__TASK_thread
 465	lmg	%r2,%r7,__PT_R2(%r11)	# load svc arguments
 466	lghi	%r1,0			# svc 0 returns -ENOSYS
 467	j	.Lsysc_do_svc
 468
 469#
 470# _TIF_NOTIFY_RESUME is set, call do_notify_resume
 471#
 472.Lsysc_notify_resume:
 473	lgr	%r2,%r11		# pass pointer to pt_regs
 474	larl	%r14,.Lsysc_return
 475	jg	do_notify_resume
 
 476
 477#
 478# _TIF_UPROBE is set, call uprobe_notify_resume
 479#
 480#ifdef CONFIG_UPROBES
 481.Lsysc_uprobe_notify:
 482	lgr	%r2,%r11		# pass pointer to pt_regs
 483	larl	%r14,.Lsysc_return
 484	jg	uprobe_notify_resume
 485#endif
 486
 487#
 488# _TIF_GUARDED_STORAGE is set, call guarded_storage_load
 489#
 490.Lsysc_guarded_storage:
 491	lgr	%r2,%r11		# pass pointer to pt_regs
 492	larl	%r14,.Lsysc_return
 493	jg	gs_load_bc_cb
 494#
 495# _TIF_PATCH_PENDING is set, call klp_update_patch_state
 496#
 497#ifdef CONFIG_LIVEPATCH
 498.Lsysc_patch_pending:
 499	lg	%r2,__LC_CURRENT	# pass pointer to task struct
 500	larl	%r14,.Lsysc_return
 501	jg	klp_update_patch_state
 502#endif
 503
 504#
 505# _PIF_PER_TRAP is set, call do_per_trap
 506#
 507.Lsysc_singlestep:
 508	ni	__PT_FLAGS+7(%r11),255-_PIF_PER_TRAP
 509	lgr	%r2,%r11		# pass pointer to pt_regs
 510	larl	%r14,.Lsysc_return
 511	jg	do_per_trap
 512
 513#
 514# _PIF_SYSCALL_RESTART is set, repeat the current system call
 515#
 516.Lsysc_syscall_restart:
 517	ni	__PT_FLAGS+7(%r11),255-_PIF_SYSCALL_RESTART
 518	lmg	%r1,%r7,__PT_R1(%r11)	# load svc arguments
 519	lg	%r2,__PT_ORIG_GPR2(%r11)
 520	j	.Lsysc_do_svc
 521
 522#
 523# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
 524# and after the system call
 525#
 526.Lsysc_tracesys:
 527	lgr	%r2,%r11		# pass pointer to pt_regs
 
 528	la	%r3,0
 529	llgh	%r0,__PT_INT_CODE+2(%r11)
 530	stg	%r0,__PT_R2(%r11)
 531	brasl	%r14,do_syscall_trace_enter
 532	lghi	%r0,NR_syscalls
 533	clgr	%r0,%r2
 534	jnh	.Lsysc_tracenogo
 535	sllg	%r8,%r2,2
 536	lgf	%r9,0(%r8,%r10)
 537.Lsysc_tracego:
 538	lmg	%r3,%r7,__PT_R3(%r11)
 539	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
 540	lg	%r2,__PT_ORIG_GPR2(%r11)
 541	BASR_EX	%r14,%r9		# call sys_xxx
 542	stg	%r2,__PT_R2(%r11)	# store return value
 543.Lsysc_tracenogo:
 544	TSTMSK	__TI_flags(%r12),_TIF_TRACE
 545	jz	.Lsysc_return
 546	lgr	%r2,%r11		# pass pointer to pt_regs
 547	larl	%r14,.Lsysc_return
 548	jg	do_syscall_trace_exit
 
 
 549
 550#
 551# a new process exits the kernel with ret_from_fork
 552#
 553ENTRY(ret_from_fork)
 554	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 555	lg	%r12,__LC_CURRENT
 556	brasl	%r14,schedule_tail
 
 
 
 
 557	TRACE_IRQS_ON
 558	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 559	tm	__PT_PSW+1(%r11),0x01	# forking a kernel thread ?
 560	jne	.Lsysc_tracenogo
 561	# it's a kernel thread
 562	lmg	%r9,%r10,__PT_R9(%r11)	# load gprs
 563ENTRY(kernel_thread_starter)
 564	la	%r2,0(%r10)
 565	BASR_EX	%r14,%r9
 566	j	.Lsysc_tracenogo
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 567
 568/*
 569 * Program check handler routine
 570 */
 571
 572ENTRY(pgm_check_handler)
 
 
 
 
 
 
 
 
 
 
 
 
 
 573	stpt	__LC_SYNC_ENTER_TIMER
 574	BPOFF
 575	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
 576	lg	%r10,__LC_LAST_BREAK
 577	lg	%r12,__LC_CURRENT
 578	lghi	%r11,0
 579	larl	%r13,cleanup_critical
 580	lmg	%r8,%r9,__LC_PGM_OLD_PSW
 581	tmhh	%r8,0x0001		# test problem state bit
 582	jnz	2f			# -> fault in user space
 583#if IS_ENABLED(CONFIG_KVM)
 584	# cleanup critical section for program checks in sie64a
 585	lgr	%r14,%r9
 586	slg	%r14,BASED(.Lsie_critical_start)
 587	clg	%r14,BASED(.Lsie_critical_length)
 588	jhe	0f
 589	lg	%r14,__SF_SIE_CONTROL(%r15)	# get control block pointer
 590	ni	__SIE_PROG0C+3(%r14),0xfe	# no longer in SIE
 591	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 592	larl	%r9,sie_exit			# skip forward to sie_exit
 593	lghi	%r11,_PIF_GUEST_FAULT
 594#endif
 5950:	tmhh	%r8,0x4000		# PER bit set in old PSW ?
 596	jnz	1f			# -> enabled, can't be a double fault
 597	tm	__LC_PGM_ILC+3,0x80	# check for per exception
 598	jnz	.Lpgm_svcper		# -> single stepped svc
 5991:	CHECK_STACK STACK_SIZE,__LC_SAVE_AREA_SYNC
 600	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 601	j	4f
 6022:	UPDATE_VTIME %r14,%r15,__LC_SYNC_ENTER_TIMER
 603	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
 604	lg	%r15,__LC_KERNEL_STACK
 605	lgr	%r14,%r12
 606	aghi	%r14,__TASK_thread	# pointer to thread_struct
 607	lghi	%r13,__LC_PGM_TDB
 608	tm	__LC_PGM_ILC+2,0x02	# check for transaction abort
 609	jz	3f
 610	mvc	__THREAD_trap_tdb(256,%r14),0(%r13)
 6113:	stg	%r10,__THREAD_last_break(%r14)
 6124:	lgr	%r13,%r11
 613	la	%r11,STACK_FRAME_OVERHEAD(%r15)
 614	stmg	%r0,%r7,__PT_R0(%r11)
 615	# clear user controlled registers to prevent speculative use
 616	xgr	%r0,%r0
 617	xgr	%r1,%r1
 618	xgr	%r2,%r2
 619	xgr	%r3,%r3
 620	xgr	%r4,%r4
 621	xgr	%r5,%r5
 622	xgr	%r6,%r6
 623	xgr	%r7,%r7
 624	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
 625	stmg	%r8,%r9,__PT_PSW(%r11)
 626	mvc	__PT_INT_CODE(4,%r11),__LC_PGM_ILC
 627	mvc	__PT_INT_PARM_LONG(8,%r11),__LC_TRANS_EXC_CODE
 628	stg	%r13,__PT_FLAGS(%r11)
 629	stg	%r10,__PT_ARGS(%r11)
 630	tm	__LC_PGM_ILC+3,0x80	# check for per exception
 631	jz	5f
 632	tmhh	%r8,0x0001		# kernel per event ?
 633	jz	.Lpgm_kprobe
 634	oi	__PT_FLAGS+7(%r11),_PIF_PER_TRAP
 635	mvc	__THREAD_per_address(8,%r14),__LC_PER_ADDRESS
 636	mvc	__THREAD_per_cause(2,%r14),__LC_PER_CODE
 637	mvc	__THREAD_per_paid(1,%r14),__LC_PER_ACCESS_ID
 6385:	REENABLE_IRQS
 639	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 640	larl	%r1,pgm_check_table
 641	llgh	%r10,__PT_INT_CODE+2(%r11)
 642	nill	%r10,0x007f
 643	sll	%r10,2
 644	je	.Lpgm_return
 645	lgf	%r9,0(%r10,%r1)		# load address of handler routine
 646	lgr	%r2,%r11		# pass pointer to pt_regs
 647	BASR_EX	%r14,%r9		# branch to interrupt-handler
 648.Lpgm_return:
 649	LOCKDEP_SYS_EXIT
 650	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 651	jno	.Lsysc_restore
 652	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
 653	jo	.Lsysc_do_syscall
 654	j	.Lsysc_tif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 655
 656#
 657# PER event in supervisor state, must be kprobes
 658#
 659.Lpgm_kprobe:
 660	REENABLE_IRQS
 661	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 662	lgr	%r2,%r11		# pass pointer to pt_regs
 663	brasl	%r14,do_per_trap
 664	j	.Lpgm_return
 665
 666#
 667# single stepped system call
 668#
 669.Lpgm_svcper:
 670	mvc	__LC_RETURN_PSW(8),__LC_SVC_NEW_PSW
 671	lghi	%r13,__TASK_thread
 672	larl	%r14,.Lsysc_per
 673	stg	%r14,__LC_RETURN_PSW+8
 674	lghi	%r14,_PIF_SYSCALL | _PIF_PER_TRAP
 675	lpswe	__LC_RETURN_PSW		# branch to .Lsysc_per and enable irqs
 676
 677/*
 678 * IO interrupt handler routine
 679 */
 
 680ENTRY(io_int_handler)
 681	STCK	__LC_INT_CLOCK
 682	stpt	__LC_ASYNC_ENTER_TIMER
 683	BPOFF
 684	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
 685	lg	%r12,__LC_CURRENT
 686	larl	%r13,cleanup_critical
 687	lmg	%r8,%r9,__LC_IO_OLD_PSW
 688	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
 689	stmg	%r0,%r7,__PT_R0(%r11)
 690	# clear user controlled registers to prevent speculative use
 691	xgr	%r0,%r0
 692	xgr	%r1,%r1
 693	xgr	%r2,%r2
 694	xgr	%r3,%r3
 695	xgr	%r4,%r4
 696	xgr	%r5,%r5
 697	xgr	%r6,%r6
 698	xgr	%r7,%r7
 699	xgr	%r10,%r10
 700	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
 701	stmg	%r8,%r9,__PT_PSW(%r11)
 702	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
 703	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 704	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
 705	jo	.Lio_restore
 706	TRACE_IRQS_OFF
 707	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 708.Lio_loop:
 709	lgr	%r2,%r11		# pass pointer to pt_regs
 710	lghi	%r3,IO_INTERRUPT
 711	tm	__PT_INT_CODE+8(%r11),0x80	# adapter interrupt ?
 712	jz	.Lio_call
 713	lghi	%r3,THIN_INTERRUPT
 714.Lio_call:
 715	brasl	%r14,do_IRQ
 716	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPAR
 717	jz	.Lio_return
 718	tpi	0
 719	jz	.Lio_return
 720	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
 721	j	.Lio_loop
 722.Lio_return:
 723	LOCKDEP_SYS_EXIT
 724	TRACE_IRQS_ON
 725.Lio_tif:
 726	TSTMSK	__TI_flags(%r12),_TIF_WORK
 727	jnz	.Lio_work		# there is work to do (signals etc.)
 728	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
 729	jnz	.Lio_work
 730.Lio_restore:
 731	lg	%r14,__LC_VDSO_PER_CPU
 732	lmg	%r0,%r10,__PT_R0(%r11)
 733	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
 734	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 735	jno	.Lio_exit_kernel
 736	BPEXIT	__TI_flags(%r12),_TIF_ISOLATE_BP
 737.Lio_exit_timer:
 738	stpt	__LC_EXIT_TIMER
 739	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
 740.Lio_exit_kernel:
 741	lmg	%r11,%r15,__PT_R11(%r11)
 742	lpswe	__LC_RETURN_PSW
 743.Lio_done:
 744
 745#
 746# There is work todo, find out in which context we have been interrupted:
 747# 1) if we return to user space we can do all _TIF_WORK work
 748# 2) if we return to kernel code and kvm is enabled check if we need to
 749#    modify the psw to leave SIE
 750# 3) if we return to kernel code and preemptive scheduling is enabled check
 751#    the preemption counter and if it is zero call preempt_schedule_irq
 752# Before any work can be done, a switch to the kernel stack is required.
 753#
 754.Lio_work:
 755	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
 756	jo	.Lio_work_user		# yes -> do resched & signal
 757#ifdef CONFIG_PREEMPT
 758	# check for preemptive scheduling
 759	icm	%r0,15,__LC_PREEMPT_COUNT
 760	jnz	.Lio_restore		# preemption is disabled
 761	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 762	jno	.Lio_restore
 763	# switch to kernel stack
 764	lg	%r1,__PT_R15(%r11)
 765	aghi	%r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
 766	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 767	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 768	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 769	lgr	%r15,%r1
 770	# TRACE_IRQS_ON already done at .Lio_return, call
 771	# TRACE_IRQS_OFF to keep things symmetrical
 772	TRACE_IRQS_OFF
 773	brasl	%r14,preempt_schedule_irq
 774	j	.Lio_return
 
 775#else
 776	j	.Lio_restore
 777#endif
 778
 779#
 780# Need to do work before returning to userspace, switch to kernel stack
 781#
 782.Lio_work_user:
 783	lg	%r1,__LC_KERNEL_STACK
 784	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
 785	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
 786	la	%r11,STACK_FRAME_OVERHEAD(%r1)
 787	lgr	%r15,%r1
 788
 789#
 790# One of the work bits is on. Find out which one.
 
 
 791#
 792.Lio_work_tif:
 793	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
 794	jo	.Lio_mcck_pending
 795	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
 796	jo	.Lio_reschedule
 797#ifdef CONFIG_LIVEPATCH
 798	TSTMSK	__TI_flags(%r12),_TIF_PATCH_PENDING
 799	jo	.Lio_patch_pending
 800#endif
 801	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
 802	jo	.Lio_sigpending
 803	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
 804	jo	.Lio_notify_resume
 805	TSTMSK	__TI_flags(%r12),_TIF_GUARDED_STORAGE
 806	jo	.Lio_guarded_storage
 807	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 808	jo	.Lio_vxrs
 809	TSTMSK	__LC_CPU_FLAGS,(_CIF_ASCE_PRIMARY|_CIF_ASCE_SECONDARY)
 810	jnz	.Lio_asce
 811	j	.Lio_return		# beware of critical section cleanup
 812
 813#
 814# _CIF_MCCK_PENDING is set, call handler
 815#
 816.Lio_mcck_pending:
 817	# TRACE_IRQS_ON already done at .Lio_return
 818	brasl	%r14,s390_handle_mcck	# TIF bit will be cleared by handler
 819	TRACE_IRQS_OFF
 820	j	.Lio_return
 821
 822#
 823# _CIF_ASCE_PRIMARY and/or CIF_ASCE_SECONDARY set, load user space asce
 824#
 825.Lio_asce:
 826	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_SECONDARY
 827	lctlg	%c7,%c7,__LC_VDSO_ASCE		# load secondary asce
 828	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE_PRIMARY
 829	jz	.Lio_return
 830#ifndef CONFIG_HAVE_MARCH_Z10_FEATURES
 831	tm	__LC_STFLE_FAC_LIST+3,0x10	# has MVCOS ?
 832	jnz	.Lio_set_fs_fixup
 833	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_PRIMARY
 834	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
 835	j	.Lio_return
 836.Lio_set_fs_fixup:
 837#endif
 838	larl	%r14,.Lio_return
 839	jg	set_fs_fixup
 840
 841#
 842# CIF_FPU is set, restore floating-point controls and floating-point registers.
 843#
 844.Lio_vxrs:
 845	larl	%r14,.Lio_return
 846	jg	load_fpu_regs
 847
 848#
 849# _TIF_GUARDED_STORAGE is set, call guarded_storage_load
 850#
 851.Lio_guarded_storage:
 852	# TRACE_IRQS_ON already done at .Lio_return
 853	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 854	lgr	%r2,%r11		# pass pointer to pt_regs
 855	brasl	%r14,gs_load_bc_cb
 856	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 857	TRACE_IRQS_OFF
 858	j	.Lio_return
 859
 860#
 861# _TIF_NEED_RESCHED is set, call schedule
 862#
 863.Lio_reschedule:
 864	# TRACE_IRQS_ON already done at .Lio_return
 865	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 866	brasl	%r14,schedule		# call scheduler
 867	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 
 868	TRACE_IRQS_OFF
 869	j	.Lio_return
 870
 871#
 872# _TIF_PATCH_PENDING is set, call klp_update_patch_state
 873#
 874#ifdef CONFIG_LIVEPATCH
 875.Lio_patch_pending:
 876	lg	%r2,__LC_CURRENT	# pass pointer to task struct
 877	larl	%r14,.Lio_return
 878	jg	klp_update_patch_state
 879#endif
 880
 881#
 882# _TIF_SIGPENDING or is set, call do_signal
 883#
 884.Lio_sigpending:
 885	# TRACE_IRQS_ON already done at .Lio_return
 886	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 887	lgr	%r2,%r11		# pass pointer to pt_regs
 888	brasl	%r14,do_signal
 889	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 
 890	TRACE_IRQS_OFF
 891	j	.Lio_return
 892
 893#
 894# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
 895#
 896.Lio_notify_resume:
 897	# TRACE_IRQS_ON already done at .Lio_return
 898	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
 899	lgr	%r2,%r11		# pass pointer to pt_regs
 900	brasl	%r14,do_notify_resume
 901	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
 
 902	TRACE_IRQS_OFF
 903	j	.Lio_return
 904
 905/*
 906 * External interrupt handler routine
 907 */
 
 908ENTRY(ext_int_handler)
 909	STCK	__LC_INT_CLOCK
 910	stpt	__LC_ASYNC_ENTER_TIMER
 911	BPOFF
 912	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
 913	lg	%r12,__LC_CURRENT
 914	larl	%r13,cleanup_critical
 915	lmg	%r8,%r9,__LC_EXT_OLD_PSW
 916	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
 917	stmg	%r0,%r7,__PT_R0(%r11)
 918	# clear user controlled registers to prevent speculative use
 919	xgr	%r0,%r0
 920	xgr	%r1,%r1
 921	xgr	%r2,%r2
 922	xgr	%r3,%r3
 923	xgr	%r4,%r4
 924	xgr	%r5,%r5
 925	xgr	%r6,%r6
 926	xgr	%r7,%r7
 927	xgr	%r10,%r10
 928	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
 929	stmg	%r8,%r9,__PT_PSW(%r11)
 930	lghi	%r1,__LC_EXT_PARAMS2
 931	mvc	__PT_INT_CODE(4,%r11),__LC_EXT_CPU_ADDR
 932	mvc	__PT_INT_PARM(4,%r11),__LC_EXT_PARAMS
 933	mvc	__PT_INT_PARM_LONG(8,%r11),0(%r1)
 934	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
 935	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
 936	jo	.Lio_restore
 937	TRACE_IRQS_OFF
 938	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
 939	lgr	%r2,%r11		# pass pointer to pt_regs
 940	lghi	%r3,EXT_INTERRUPT
 941	brasl	%r14,do_IRQ
 942	j	.Lio_return
 943
 944/*
 945 * Load idle PSW. The second "half" of this function is in .Lcleanup_idle.
 946 */
 947ENTRY(psw_idle)
 948	stg	%r3,__SF_EMPTY(%r15)
 949	larl	%r1,.Lpsw_idle_lpsw+4
 950	stg	%r1,__SF_EMPTY+8(%r15)
 951#ifdef CONFIG_SMP
 952	larl	%r1,smp_cpu_mtid
 953	llgf	%r1,0(%r1)
 954	ltgr	%r1,%r1
 955	jz	.Lpsw_idle_stcctm
 956	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+16(%r15)
 957.Lpsw_idle_stcctm:
 958#endif
 959	oi	__LC_CPU_FLAGS+7,_CIF_ENABLED_WAIT
 960	BPON
 961	STCK	__CLOCK_IDLE_ENTER(%r2)
 962	stpt	__TIMER_IDLE_ENTER(%r2)
 963.Lpsw_idle_lpsw:
 964	lpswe	__SF_EMPTY(%r15)
 965	BR_EX	%r14
 966.Lpsw_idle_end:
 967
 968/*
 969 * Store floating-point controls and floating-point or vector register
 970 * depending whether the vector facility is available.	A critical section
 971 * cleanup assures that the registers are stored even if interrupted for
 972 * some other work.  The CIF_FPU flag is set to trigger a lazy restore
 973 * of the register contents at return from io or a system call.
 974 */
 975ENTRY(save_fpu_regs)
 976	lg	%r2,__LC_CURRENT
 977	aghi	%r2,__TASK_thread
 978	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
 979	jo	.Lsave_fpu_regs_exit
 980	stfpc	__THREAD_FPU_fpc(%r2)
 981	lg	%r3,__THREAD_FPU_regs(%r2)
 982	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
 983	jz	.Lsave_fpu_regs_fp	  # no -> store FP regs
 984	VSTM	%v0,%v15,0,%r3		  # vstm 0,15,0(3)
 985	VSTM	%v16,%v31,256,%r3	  # vstm 16,31,256(3)
 986	j	.Lsave_fpu_regs_done	  # -> set CIF_FPU flag
 987.Lsave_fpu_regs_fp:
 988	std	0,0(%r3)
 989	std	1,8(%r3)
 990	std	2,16(%r3)
 991	std	3,24(%r3)
 992	std	4,32(%r3)
 993	std	5,40(%r3)
 994	std	6,48(%r3)
 995	std	7,56(%r3)
 996	std	8,64(%r3)
 997	std	9,72(%r3)
 998	std	10,80(%r3)
 999	std	11,88(%r3)
1000	std	12,96(%r3)
1001	std	13,104(%r3)
1002	std	14,112(%r3)
1003	std	15,120(%r3)
1004.Lsave_fpu_regs_done:
1005	oi	__LC_CPU_FLAGS+7,_CIF_FPU
1006.Lsave_fpu_regs_exit:
1007	BR_EX	%r14
1008.Lsave_fpu_regs_end:
1009EXPORT_SYMBOL(save_fpu_regs)
1010
1011/*
1012 * Load floating-point controls and floating-point or vector registers.
1013 * A critical section cleanup assures that the register contents are
1014 * loaded even if interrupted for some other work.
1015 *
1016 * There are special calling conventions to fit into sysc and io return work:
1017 *	%r15:	<kernel stack>
1018 * The function requires:
1019 *	%r4
1020 */
1021load_fpu_regs:
1022	lg	%r4,__LC_CURRENT
1023	aghi	%r4,__TASK_thread
1024	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
1025	jno	.Lload_fpu_regs_exit
1026	lfpc	__THREAD_FPU_fpc(%r4)
1027	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
1028	lg	%r4,__THREAD_FPU_regs(%r4)	# %r4 <- reg save area
1029	jz	.Lload_fpu_regs_fp		# -> no VX, load FP regs
1030	VLM	%v0,%v15,0,%r4
1031	VLM	%v16,%v31,256,%r4
1032	j	.Lload_fpu_regs_done
1033.Lload_fpu_regs_fp:
1034	ld	0,0(%r4)
1035	ld	1,8(%r4)
1036	ld	2,16(%r4)
1037	ld	3,24(%r4)
1038	ld	4,32(%r4)
1039	ld	5,40(%r4)
1040	ld	6,48(%r4)
1041	ld	7,56(%r4)
1042	ld	8,64(%r4)
1043	ld	9,72(%r4)
1044	ld	10,80(%r4)
1045	ld	11,88(%r4)
1046	ld	12,96(%r4)
1047	ld	13,104(%r4)
1048	ld	14,112(%r4)
1049	ld	15,120(%r4)
1050.Lload_fpu_regs_done:
1051	ni	__LC_CPU_FLAGS+7,255-_CIF_FPU
1052.Lload_fpu_regs_exit:
1053	BR_EX	%r14
1054.Lload_fpu_regs_end:
1055
1056.L__critical_end:
1057
1058/*
1059 * Machine check handler routines
1060 */
 
1061ENTRY(mcck_int_handler)
1062	STCK	__LC_MCCK_CLOCK
1063	BPOFF
1064	la	%r1,4095		# validate r1
1065	spt	__LC_CPU_TIMER_SAVE_AREA-4095(%r1)	# validate cpu timer
1066	sckc	__LC_CLOCK_COMPARATOR			# validate comparator
1067	lam	%a0,%a15,__LC_AREGS_SAVE_AREA-4095(%r1) # validate acrs
1068	lmg	%r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# validate gprs
1069	lg	%r12,__LC_CURRENT
1070	larl	%r13,cleanup_critical
1071	lmg	%r8,%r9,__LC_MCK_OLD_PSW
1072	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_SYSTEM_DAMAGE
1073	jo	.Lmcck_panic		# yes -> rest of mcck code invalid
1074	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_CR_VALID
1075	jno	.Lmcck_panic		# control registers invalid -> panic
1076	la	%r14,4095
1077	lctlg	%c0,%c15,__LC_CREGS_SAVE_AREA-4095(%r14) # validate ctl regs
1078	ptlb
1079	lg	%r11,__LC_MCESAD-4095(%r14) # extended machine check save area
1080	nill	%r11,0xfc00		# MCESA_ORIGIN_MASK
1081	TSTMSK	__LC_CREGS_SAVE_AREA+16-4095(%r14),CR2_GUARDED_STORAGE
1082	jno	0f
1083	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_GS_VALID
1084	jno	0f
1085	.insn	 rxy,0xe3000000004d,0,__MCESA_GS_SAVE_AREA(%r11) # LGSC
10860:	l	%r14,__LC_FP_CREG_SAVE_AREA-4095(%r14)
1087	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_FC_VALID
1088	jo	0f
1089	sr	%r14,%r14
10900:	sfpc	%r14
1091	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
1092	jo	0f
1093	lghi	%r14,__LC_FPREGS_SAVE_AREA
1094	ld	%f0,0(%r14)
1095	ld	%f1,8(%r14)
1096	ld	%f2,16(%r14)
1097	ld	%f3,24(%r14)
1098	ld	%f4,32(%r14)
1099	ld	%f5,40(%r14)
1100	ld	%f6,48(%r14)
1101	ld	%f7,56(%r14)
1102	ld	%f8,64(%r14)
1103	ld	%f9,72(%r14)
1104	ld	%f10,80(%r14)
1105	ld	%f11,88(%r14)
1106	ld	%f12,96(%r14)
1107	ld	%f13,104(%r14)
1108	ld	%f14,112(%r14)
1109	ld	%f15,120(%r14)
1110	j	1f
11110:	VLM	%v0,%v15,0,%r11
1112	VLM	%v16,%v31,256,%r11
11131:	lghi	%r14,__LC_CPU_TIMER_SAVE_AREA
1114	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
1115	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_CPU_TIMER_VALID
1116	jo	3f
1117	la	%r14,__LC_SYNC_ENTER_TIMER
1118	clc	0(8,%r14),__LC_ASYNC_ENTER_TIMER
1119	jl	0f
1120	la	%r14,__LC_ASYNC_ENTER_TIMER
11210:	clc	0(8,%r14),__LC_EXIT_TIMER
1122	jl	1f
1123	la	%r14,__LC_EXIT_TIMER
11241:	clc	0(8,%r14),__LC_LAST_UPDATE_TIMER
1125	jl	2f
1126	la	%r14,__LC_LAST_UPDATE_TIMER
11272:	spt	0(%r14)
1128	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
11293:	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_PSW_MWP_VALID
1130	jno	.Lmcck_panic
1131	tmhh	%r8,0x0001		# interrupting from user ?
1132	jnz	4f
1133	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_PSW_IA_VALID
1134	jno	.Lmcck_panic
11354:	SWITCH_ASYNC __LC_GPREGS_SAVE_AREA+64,__LC_MCCK_ENTER_TIMER
1136.Lmcck_skip:
1137	lghi	%r14,__LC_GPREGS_SAVE_AREA+64
1138	stmg	%r0,%r7,__PT_R0(%r11)
1139	# clear user controlled registers to prevent speculative use
1140	xgr	%r0,%r0
1141	xgr	%r1,%r1
1142	xgr	%r2,%r2
1143	xgr	%r3,%r3
1144	xgr	%r4,%r4
1145	xgr	%r5,%r5
1146	xgr	%r6,%r6
1147	xgr	%r7,%r7
1148	xgr	%r10,%r10
1149	mvc	__PT_R8(64,%r11),0(%r14)
1150	stmg	%r8,%r9,__PT_PSW(%r11)
1151	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
1152	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
1153	lgr	%r2,%r11		# pass pointer to pt_regs
1154	brasl	%r14,s390_do_machine_check
1155	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
1156	jno	.Lmcck_return
1157	lg	%r1,__LC_KERNEL_STACK	# switch to kernel stack
1158	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
1159	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
1160	la	%r11,STACK_FRAME_OVERHEAD(%r1)
1161	lgr	%r15,%r1
1162	ssm	__LC_PGM_NEW_PSW	# turn dat on, keep irqs off
1163	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
1164	jno	.Lmcck_return
 
 
 
 
 
1165	TRACE_IRQS_OFF
1166	brasl	%r14,s390_handle_mcck
 
1167	TRACE_IRQS_ON
1168.Lmcck_return:
1169	lg	%r14,__LC_VDSO_PER_CPU
1170	lmg	%r0,%r10,__PT_R0(%r11)
1171	mvc	__LC_RETURN_MCCK_PSW(16),__PT_PSW(%r11) # move return PSW
1172	tm	__LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
1173	jno	0f
1174	BPEXIT	__TI_flags(%r12),_TIF_ISOLATE_BP
1175	stpt	__LC_EXIT_TIMER
1176	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
11770:	lmg	%r11,%r15,__PT_R11(%r11)
1178	lpswe	__LC_RETURN_MCCK_PSW
1179
1180.Lmcck_panic:
1181	lg	%r15,__LC_PANIC_STACK
1182	la	%r11,STACK_FRAME_OVERHEAD(%r15)
1183	j	.Lmcck_skip
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1184
1185#
1186# PSW restart interrupt handler
1187#
1188ENTRY(restart_int_handler)
1189	ALTERNATIVE "", ".insn s,0xb2800000,_LPP_OFFSET", 40
1190	stg	%r15,__LC_SAVE_AREA_RESTART
1191	lg	%r15,__LC_RESTART_STACK
1192	aghi	%r15,-__PT_SIZE			# create pt_regs on stack
1193	xc	0(__PT_SIZE,%r15),0(%r15)
1194	stmg	%r0,%r14,__PT_R0(%r15)
1195	mvc	__PT_R15(8,%r15),__LC_SAVE_AREA_RESTART
1196	mvc	__PT_PSW(16,%r15),__LC_RST_OLD_PSW # store restart old psw
1197	aghi	%r15,-STACK_FRAME_OVERHEAD	# create stack frame on stack
1198	xc	0(STACK_FRAME_OVERHEAD,%r15),0(%r15)
1199	lg	%r1,__LC_RESTART_FN		# load fn, parm & source cpu
1200	lg	%r2,__LC_RESTART_DATA
1201	lg	%r3,__LC_RESTART_SOURCE
1202	ltgr	%r3,%r3				# test source cpu address
1203	jm	1f				# negative -> skip source stop
12040:	sigp	%r4,%r3,SIGP_SENSE		# sigp sense to source cpu
1205	brc	10,0b				# wait for status stored
12061:	basr	%r14,%r1			# call function
1207	stap	__SF_EMPTY(%r15)		# store cpu address
1208	llgh	%r3,__SF_EMPTY(%r15)
12092:	sigp	%r4,%r3,SIGP_STOP		# sigp stop to current cpu
1210	brc	2,2b
12113:	j	3b
1212
1213	.section .kprobes.text, "ax"
1214
1215#ifdef CONFIG_CHECK_STACK
1216/*
1217 * The synchronous or the asynchronous stack overflowed. We are dead.
1218 * No need to properly save the registers, we are going to panic anyway.
1219 * Setup a pt_regs so that show_trace can provide a good call trace.
1220 */
1221stack_overflow:
1222	lg	%r15,__LC_PANIC_STACK	# change to panic stack
1223	la	%r11,STACK_FRAME_OVERHEAD(%r15)
1224	stmg	%r0,%r7,__PT_R0(%r11)
1225	stmg	%r8,%r9,__PT_PSW(%r11)
1226	mvc	__PT_R8(64,%r11),0(%r14)
1227	stg	%r10,__PT_ORIG_GPR2(%r11) # store last break to orig_gpr2
1228	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
1229	lgr	%r2,%r11		# pass pointer to pt_regs
1230	jg	kernel_stack_overflow
1231#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1232
1233cleanup_critical:
1234#if IS_ENABLED(CONFIG_KVM)
1235	clg	%r9,BASED(.Lcleanup_table_sie)	# .Lsie_gmap
1236	jl	0f
1237	clg	%r9,BASED(.Lcleanup_table_sie+8)# .Lsie_done
1238	jl	.Lcleanup_sie
1239#endif
1240	clg	%r9,BASED(.Lcleanup_table)	# system_call
1241	jl	0f
1242	clg	%r9,BASED(.Lcleanup_table+8)	# .Lsysc_do_svc
1243	jl	.Lcleanup_system_call
1244	clg	%r9,BASED(.Lcleanup_table+16)	# .Lsysc_tif
1245	jl	0f
1246	clg	%r9,BASED(.Lcleanup_table+24)	# .Lsysc_restore
1247	jl	.Lcleanup_sysc_tif
1248	clg	%r9,BASED(.Lcleanup_table+32)	# .Lsysc_done
1249	jl	.Lcleanup_sysc_restore
1250	clg	%r9,BASED(.Lcleanup_table+40)	# .Lio_tif
1251	jl	0f
1252	clg	%r9,BASED(.Lcleanup_table+48)	# .Lio_restore
1253	jl	.Lcleanup_io_tif
1254	clg	%r9,BASED(.Lcleanup_table+56)	# .Lio_done
1255	jl	.Lcleanup_io_restore
1256	clg	%r9,BASED(.Lcleanup_table+64)	# psw_idle
1257	jl	0f
1258	clg	%r9,BASED(.Lcleanup_table+72)	# .Lpsw_idle_end
1259	jl	.Lcleanup_idle
1260	clg	%r9,BASED(.Lcleanup_table+80)	# save_fpu_regs
1261	jl	0f
1262	clg	%r9,BASED(.Lcleanup_table+88)	# .Lsave_fpu_regs_end
1263	jl	.Lcleanup_save_fpu_regs
1264	clg	%r9,BASED(.Lcleanup_table+96)	# load_fpu_regs
1265	jl	0f
1266	clg	%r9,BASED(.Lcleanup_table+104)	# .Lload_fpu_regs_end
1267	jl	.Lcleanup_load_fpu_regs
12680:	BR_EX	%r14
1269
1270	.align	8
1271.Lcleanup_table:
1272	.quad	system_call
1273	.quad	.Lsysc_do_svc
1274	.quad	.Lsysc_tif
1275	.quad	.Lsysc_restore
1276	.quad	.Lsysc_done
1277	.quad	.Lio_tif
1278	.quad	.Lio_restore
1279	.quad	.Lio_done
1280	.quad	psw_idle
1281	.quad	.Lpsw_idle_end
1282	.quad	save_fpu_regs
1283	.quad	.Lsave_fpu_regs_end
1284	.quad	load_fpu_regs
1285	.quad	.Lload_fpu_regs_end
1286
1287#if IS_ENABLED(CONFIG_KVM)
1288.Lcleanup_table_sie:
1289	.quad	.Lsie_gmap
1290	.quad	.Lsie_done
1291
1292.Lcleanup_sie:
1293	cghi    %r11,__LC_SAVE_AREA_ASYNC 	#Is this in normal interrupt?
1294	je      1f
1295	slg     %r9,BASED(.Lsie_crit_mcck_start)
1296	clg     %r9,BASED(.Lsie_crit_mcck_length)
1297	jh      1f
1298	oi      __LC_CPU_FLAGS+7, _CIF_MCCK_GUEST
12991:	BPENTER __SF_SIE_FLAGS(%r15),(_TIF_ISOLATE_BP|_TIF_ISOLATE_BP_GUEST)
1300	lg	%r9,__SF_SIE_CONTROL(%r15)	# get control block pointer
1301	ni	__SIE_PROG0C+3(%r9),0xfe	# no longer in SIE
1302	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
1303	larl	%r9,sie_exit			# skip forward to sie_exit
1304	BR_EX	%r14
1305#endif
1306
1307.Lcleanup_system_call:
1308	# check if stpt has been executed
1309	clg	%r9,BASED(.Lcleanup_system_call_insn)
1310	jh	0f
1311	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
1312	cghi	%r11,__LC_SAVE_AREA_ASYNC
1313	je	0f
1314	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
13150:	# check if stmg has been executed
1316	clg	%r9,BASED(.Lcleanup_system_call_insn+8)
1317	jh	0f
1318	mvc	__LC_SAVE_AREA_SYNC(64),0(%r11)
13190:	# check if base register setup + TIF bit load has been done
1320	clg	%r9,BASED(.Lcleanup_system_call_insn+16)
1321	jhe	0f
1322	# set up saved register r12 task struct pointer
1323	stg	%r12,32(%r11)
1324	# set up saved register r13 __TASK_thread offset
1325	mvc	40(8,%r11),BASED(.Lcleanup_system_call_const)
13260:	# check if the user time update has been done
1327	clg	%r9,BASED(.Lcleanup_system_call_insn+24)
1328	jh	0f
1329	lg	%r15,__LC_EXIT_TIMER
1330	slg	%r15,__LC_SYNC_ENTER_TIMER
1331	alg	%r15,__LC_USER_TIMER
1332	stg	%r15,__LC_USER_TIMER
13330:	# check if the system time update has been done
1334	clg	%r9,BASED(.Lcleanup_system_call_insn+32)
1335	jh	0f
1336	lg	%r15,__LC_LAST_UPDATE_TIMER
1337	slg	%r15,__LC_EXIT_TIMER
1338	alg	%r15,__LC_SYSTEM_TIMER
1339	stg	%r15,__LC_SYSTEM_TIMER
13400:	# update accounting time stamp
 
 
 
1341	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
1342	BPENTER __TI_flags(%r12),_TIF_ISOLATE_BP
1343	# set up saved register r11
1344	lg	%r15,__LC_KERNEL_STACK
1345	la	%r9,STACK_FRAME_OVERHEAD(%r15)
1346	stg	%r9,24(%r11)		# r11 pt_regs pointer
1347	# fill pt_regs
1348	mvc	__PT_R8(64,%r9),__LC_SAVE_AREA_SYNC
1349	stmg	%r0,%r7,__PT_R0(%r9)
1350	mvc	__PT_PSW(16,%r9),__LC_SVC_OLD_PSW
1351	mvc	__PT_INT_CODE(4,%r9),__LC_SVC_ILC
1352	xc	__PT_FLAGS(8,%r9),__PT_FLAGS(%r9)
1353	mvi	__PT_FLAGS+7(%r9),_PIF_SYSCALL
1354	# setup saved register r15
1355	stg	%r15,56(%r11)		# r15 stack pointer
1356	# set new psw address and exit
1357	larl	%r9,.Lsysc_do_svc
1358	BR_EX	%r14,%r11
1359.Lcleanup_system_call_insn:
1360	.quad	system_call
1361	.quad	.Lsysc_stmg
1362	.quad	.Lsysc_per
1363	.quad	.Lsysc_vtime+36
1364	.quad	.Lsysc_vtime+42
1365.Lcleanup_system_call_const:
1366	.quad	__TASK_thread
1367
1368.Lcleanup_sysc_tif:
1369	larl	%r9,.Lsysc_tif
1370	BR_EX	%r14,%r11
1371
1372.Lcleanup_sysc_restore:
1373	# check if stpt has been executed
1374	clg	%r9,BASED(.Lcleanup_sysc_restore_insn)
1375	jh	0f
1376	mvc	__LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
1377	cghi	%r11,__LC_SAVE_AREA_ASYNC
1378	je	0f
1379	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
13800:	clg	%r9,BASED(.Lcleanup_sysc_restore_insn+8)
1381	je	1f
1382	lg	%r9,24(%r11)		# get saved pointer to pt_regs
1383	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
1384	mvc	0(64,%r11),__PT_R8(%r9)
1385	lmg	%r0,%r7,__PT_R0(%r9)
13861:	lmg	%r8,%r9,__LC_RETURN_PSW
1387	BR_EX	%r14,%r11
1388.Lcleanup_sysc_restore_insn:
1389	.quad	.Lsysc_exit_timer
1390	.quad	.Lsysc_done - 4
1391
1392.Lcleanup_io_tif:
1393	larl	%r9,.Lio_tif
1394	BR_EX	%r14,%r11
1395
1396.Lcleanup_io_restore:
1397	# check if stpt has been executed
1398	clg	%r9,BASED(.Lcleanup_io_restore_insn)
1399	jh	0f
 
 
 
 
 
 
 
 
1400	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
14010:	clg	%r9,BASED(.Lcleanup_io_restore_insn+8)
1402	je	1f
1403	lg	%r9,24(%r11)		# get saved r11 pointer to pt_regs
1404	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
1405	mvc	0(64,%r11),__PT_R8(%r9)
1406	lmg	%r0,%r7,__PT_R0(%r9)
14071:	lmg	%r8,%r9,__LC_RETURN_PSW
1408	BR_EX	%r14,%r11
1409.Lcleanup_io_restore_insn:
1410	.quad	.Lio_exit_timer
1411	.quad	.Lio_done - 4
1412
1413.Lcleanup_idle:
1414	ni	__LC_CPU_FLAGS+7,255-_CIF_ENABLED_WAIT
1415	# copy interrupt clock & cpu timer
1416	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_INT_CLOCK
1417	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_ASYNC_ENTER_TIMER
1418	cghi	%r11,__LC_SAVE_AREA_ASYNC
1419	je	0f
1420	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_MCCK_CLOCK
1421	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_MCCK_ENTER_TIMER
14220:	# check if stck & stpt have been executed
1423	clg	%r9,BASED(.Lcleanup_idle_insn)
1424	jhe	1f
1425	mvc	__CLOCK_IDLE_ENTER(8,%r2),__CLOCK_IDLE_EXIT(%r2)
1426	mvc	__TIMER_IDLE_ENTER(8,%r2),__TIMER_IDLE_EXIT(%r2)
14271:	# calculate idle cycles
1428#ifdef CONFIG_SMP
1429	clg	%r9,BASED(.Lcleanup_idle_insn)
1430	jl	3f
1431	larl	%r1,smp_cpu_mtid
1432	llgf	%r1,0(%r1)
1433	ltgr	%r1,%r1
1434	jz	3f
1435	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+80(%r15)
1436	larl	%r3,mt_cycles
1437	ag	%r3,__LC_PERCPU_OFFSET
1438	la	%r4,__SF_EMPTY+16(%r15)
14392:	lg	%r0,0(%r3)
1440	slg	%r0,0(%r4)
1441	alg	%r0,64(%r4)
1442	stg	%r0,0(%r3)
1443	la	%r3,8(%r3)
1444	la	%r4,8(%r4)
1445	brct	%r1,2b
1446#endif
14473:	# account system time going idle
1448	lg	%r9,__LC_STEAL_TIMER
1449	alg	%r9,__CLOCK_IDLE_ENTER(%r2)
1450	slg	%r9,__LC_LAST_UPDATE_CLOCK
1451	stg	%r9,__LC_STEAL_TIMER
1452	mvc	__LC_LAST_UPDATE_CLOCK(8),__CLOCK_IDLE_EXIT(%r2)
1453	lg	%r9,__LC_SYSTEM_TIMER
1454	alg	%r9,__LC_LAST_UPDATE_TIMER
1455	slg	%r9,__TIMER_IDLE_ENTER(%r2)
1456	stg	%r9,__LC_SYSTEM_TIMER
1457	mvc	__LC_LAST_UPDATE_TIMER(8),__TIMER_IDLE_EXIT(%r2)
1458	# prepare return psw
1459	nihh	%r8,0xfcfd		# clear irq & wait state bits
1460	lg	%r9,48(%r11)		# return from psw_idle
1461	BR_EX	%r14,%r11
1462.Lcleanup_idle_insn:
1463	.quad	.Lpsw_idle_lpsw
1464
1465.Lcleanup_save_fpu_regs:
1466	larl	%r9,save_fpu_regs
1467	BR_EX	%r14,%r11
1468
1469.Lcleanup_load_fpu_regs:
1470	larl	%r9,load_fpu_regs
1471	BR_EX	%r14,%r11
1472
1473/*
1474 * Integer constants
1475 */
1476	.align	8
1477.Lcritical_start:
1478	.quad	.L__critical_start
1479.Lcritical_length:
1480	.quad	.L__critical_end - .L__critical_start
1481#if IS_ENABLED(CONFIG_KVM)
1482.Lsie_critical_start:
1483	.quad	.Lsie_gmap
1484.Lsie_critical_length:
1485	.quad	.Lsie_done - .Lsie_gmap
1486.Lsie_crit_mcck_start:
1487	.quad   .Lsie_entry
1488.Lsie_crit_mcck_length:
1489	.quad   .Lsie_skip - .Lsie_entry
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1490#endif
1491	.section .rodata, "a"
1492#define SYSCALL(esame,emu)	.long esame
 
 
 
 
 
 
 
 
 
 
 
1493	.globl	sys_call_table
1494sys_call_table:
1495#include "asm/syscall_table.h"
1496#undef SYSCALL
1497
1498#ifdef CONFIG_COMPAT
1499
1500#define SYSCALL(esame,emu)	.long emu
1501	.globl	sys_call_table_emu
1502sys_call_table_emu:
1503#include "asm/syscall_table.h"
1504#undef SYSCALL
1505#endif
v3.1
 
   1/*
   2 *  arch/s390/kernel/entry.S
   3 *    S390 low-level entry points.
   4 *
   5 *    Copyright (C) IBM Corp. 1999,2006
   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/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
  22/*
  23 * Stack layout for the system_call stack entry.
  24 * The first few entries are identical to the user_regs_struct.
  25 */
  26SP_PTREGS    =	STACK_FRAME_OVERHEAD
  27SP_ARGS      =	STACK_FRAME_OVERHEAD + __PT_ARGS
  28SP_PSW	     =	STACK_FRAME_OVERHEAD + __PT_PSW
  29SP_R0	     =	STACK_FRAME_OVERHEAD + __PT_GPRS
  30SP_R1	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 4
  31SP_R2	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 8
  32SP_R3	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 12
  33SP_R4	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 16
  34SP_R5	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 20
  35SP_R6	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 24
  36SP_R7	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 28
  37SP_R8	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 32
  38SP_R9	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 36
  39SP_R10	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 40
  40SP_R11	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 44
  41SP_R12	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 48
  42SP_R13	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 52
  43SP_R14	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 56
  44SP_R15	     =	STACK_FRAME_OVERHEAD + __PT_GPRS + 60
  45SP_ORIG_R2   =	STACK_FRAME_OVERHEAD + __PT_ORIG_GPR2
  46SP_ILC	     =	STACK_FRAME_OVERHEAD + __PT_ILC
  47SP_SVCNR     =	STACK_FRAME_OVERHEAD + __PT_SVCNR
  48SP_SIZE      =	STACK_FRAME_OVERHEAD + __PT_SIZE
  49
  50_TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
  51		 _TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_PER_TRAP )
  52_TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
  53		 _TIF_MCCK_PENDING)
  54_TIF_SYSCALL = (_TIF_SYSCALL_TRACE>>8 | _TIF_SYSCALL_AUDIT>>8 | \
  55		_TIF_SECCOMP>>8 | _TIF_SYSCALL_TRACEPOINT>>8)
  56
  57STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
  58STACK_SIZE  = 1 << STACK_SHIFT
  59
  60#define BASED(name) name-system_call(%r13)
  61
 
  62#ifdef CONFIG_TRACE_IRQFLAGS
  63	.macro	TRACE_IRQS_ON
  64	basr	%r2,%r0
  65	l	%r1,BASED(.Ltrace_irq_on_caller)
  66	basr	%r14,%r1
  67	.endm
  68
  69	.macro	TRACE_IRQS_OFF
 
  70	basr	%r2,%r0
  71	l	%r1,BASED(.Ltrace_irq_off_caller)
  72	basr	%r14,%r1
  73	.endm
  74#else
  75#define TRACE_IRQS_ON
  76#define TRACE_IRQS_OFF
  77#endif
  78
 
  79#ifdef CONFIG_LOCKDEP
  80	.macro	LOCKDEP_SYS_EXIT
  81	tm	SP_PSW+1(%r15),0x01	# returning to user ?
  82	jz	0f
  83	l	%r1,BASED(.Llockdep_sys_exit)
  84	basr	%r14,%r1
  850:
  86	.endm
  87#else
  88#define LOCKDEP_SYS_EXIT
 
 
 
 
  89#endif
 
  90
  91/*
  92 * Register usage in interrupt handlers:
  93 *    R9  - pointer to current task structure
  94 *    R13 - pointer to literal pool
  95 *    R14 - return register for function calls
  96 *    R15 - kernel stack pointer
  97 */
  98
  99	.macro	UPDATE_VTIME lc_from,lc_to,lc_sum
 100	lm	%r10,%r11,\lc_from
 101	sl	%r10,\lc_to
 102	sl	%r11,\lc_to+4
 103	bc	3,BASED(0f)
 104	sl	%r10,BASED(.Lc_1)
 1050:	al	%r10,\lc_sum
 106	al	%r11,\lc_sum+4
 107	bc	12,BASED(1f)
 108	al	%r10,BASED(.Lc_1)
 1091:	stm	%r10,%r11,\lc_sum
 
 
 
 110	.endm
 111
 112	.macro	SAVE_ALL_SVC psworg,savearea
 113	stm	%r12,%r15,\savearea
 114	l	%r13,__LC_SVC_NEW_PSW+4	# load &system_call to %r13
 115	l	%r15,__LC_KERNEL_STACK	# problem state -> load ksp
 116	s	%r15,BASED(.Lc_spsize)	# make room for registers & psw
 
 
 
 
 
 117	.endm
 118
 119	.macro	SAVE_ALL_BASE savearea
 120	stm	%r12,%r15,\savearea
 121	l	%r13,__LC_SVC_NEW_PSW+4	# load &system_call to %r13
 
 122	.endm
 123
 124	.macro	SAVE_ALL_PGM psworg,savearea
 125	tm	\psworg+1,0x01		# test problem state bit
 126#ifdef CONFIG_CHECK_STACK
 127	bnz	BASED(1f)
 128	tml	%r15,STACK_SIZE - CONFIG_STACK_GUARD
 129	bnz	BASED(2f)
 130	la	%r12,\psworg
 131	b	BASED(stack_overflow)
 132#else
 133	bz	BASED(2f)
 134#endif
 1351:	l	%r15,__LC_KERNEL_STACK	# problem state -> load ksp
 1362:	s	%r15,BASED(.Lc_spsize)	# make room for registers & psw
 137	.endm
 138
 139	.macro	SAVE_ALL_ASYNC psworg,savearea
 140	stm	%r12,%r15,\savearea
 141	l	%r13,__LC_SVC_NEW_PSW+4	# load &system_call to %r13
 142	la	%r12,\psworg
 143	tm	\psworg+1,0x01		# test problem state bit
 144	bnz	BASED(1f)		# from user -> load async stack
 145	clc	\psworg+4(4),BASED(.Lcritical_end)
 146	bhe	BASED(0f)
 147	clc	\psworg+4(4),BASED(.Lcritical_start)
 148	bl	BASED(0f)
 149	l	%r14,BASED(.Lcleanup_critical)
 150	basr	%r14,%r14
 151	tm	1(%r12),0x01		# retest problem state after cleanup
 152	bnz	BASED(1f)
 1530:	l	%r14,__LC_ASYNC_STACK	# are we already on the async stack ?
 154	slr	%r14,%r15
 155	sra	%r14,STACK_SHIFT
 156#ifdef CONFIG_CHECK_STACK
 157	bnz	BASED(1f)
 158	tml	%r15,STACK_SIZE - CONFIG_STACK_GUARD
 159	bnz	BASED(2f)
 160	b	BASED(stack_overflow)
 161#else
 162	bz	BASED(2f)
 163#endif
 1641:	l	%r15,__LC_ASYNC_STACK
 1652:	s	%r15,BASED(.Lc_spsize)	# make room for registers & psw
 166	.endm
 167
 168	.macro	CREATE_STACK_FRAME savearea
 169	xc	__SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15)
 170	st	%r2,SP_ORIG_R2(%r15)	# store original content of gpr 2
 171	mvc	SP_R12(16,%r15),\savearea # move %r12-%r15 to stack
 172	stm	%r0,%r11,SP_R0(%r15)	# store gprs %r0-%r11 to kernel stack
 173	.endm
 174
 175	.macro	RESTORE_ALL psworg,sync
 176	mvc	\psworg(8),SP_PSW(%r15) # move user PSW to lowcore
 177	.if !\sync
 178	ni	\psworg+1,0xfd		# clear wait state bit
 179	.endif
 180	lm	%r0,%r15,SP_R0(%r15)	# load gprs 0-15 of user
 181	stpt	__LC_EXIT_TIMER
 182	lpsw	\psworg			# back to caller
 183	.endm
 184
 185	.macro REENABLE_IRQS
 186	mvc	__SF_EMPTY(1,%r15),SP_PSW(%r15)
 187	ni	__SF_EMPTY(%r15),0xbf
 188	ssm	__SF_EMPTY(%r15)
 189	.endm
 190
 
 
 
 
 191	.section .kprobes.text, "ax"
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 192
 193/*
 194 * Scheduler resume function, called by switch_to
 195 *  gpr2 = (task_struct *) prev
 196 *  gpr3 = (task_struct *) next
 197 * Returns:
 198 *  gpr2 = prev
 199 */
 200ENTRY(__switch_to)
 201	basr	%r1,0
 2020:	l	%r4,__THREAD_info(%r2)		# get thread_info of prev
 203	l	%r5,__THREAD_info(%r3)		# get thread_info of next
 204	tm	__TI_flags+3(%r4),_TIF_MCCK_PENDING # machine check pending?
 205	bz	1f-0b(%r1)
 206	ni	__TI_flags+3(%r4),255-_TIF_MCCK_PENDING	# clear flag in prev
 207	oi	__TI_flags+3(%r5),_TIF_MCCK_PENDING	# set it in next
 2081:	stm	%r6,%r15,__SF_GPRS(%r15)	# store gprs of prev task
 209	st	%r15,__THREAD_ksp(%r2)		# store kernel stack of prev
 210	l	%r15,__THREAD_ksp(%r3)		# load kernel stack of next
 211	lctl	%c4,%c4,__TASK_pid(%r3)		# load pid to control reg. 4
 212	lm	%r6,%r15,__SF_GPRS(%r15)	# load gprs of next task
 213	st	%r3,__LC_CURRENT		# store task struct of next
 214	mvc	__LC_CURRENT_PID(4,%r0),__TASK_pid(%r3)	# store pid of next
 215	st	%r5,__LC_THREAD_INFO		# store thread info of next
 216	ahi	%r5,STACK_SIZE			# end of kernel stack of next
 217	st	%r5,__LC_KERNEL_STACK		# store end of kernel stack
 218	br	%r14
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 219
 220__critical_start:
 221/*
 222 * SVC interrupt handler routine. System calls are synchronous events and
 223 * are executed with interrupts enabled.
 224 */
 225
 226ENTRY(system_call)
 227	stpt	__LC_SYNC_ENTER_TIMER
 228sysc_saveall:
 229	SAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
 230	CREATE_STACK_FRAME __LC_SAVE_AREA
 231	mvc	SP_PSW(8,%r15),__LC_SVC_OLD_PSW
 232	mvc	SP_ILC(4,%r15),__LC_SVC_ILC
 233	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 234sysc_vtime:
 235	UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
 236sysc_stime:
 237	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 238sysc_update:
 239	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
 240sysc_do_svc:
 241	xr	%r7,%r7
 242	icm	%r7,3,SP_SVCNR(%r15)	# load svc number and test for svc 0
 243	bnz	BASED(sysc_nr_ok)	# svc number > 0
 
 
 
 
 
 
 
 
 
 244	# svc 0: system call number in %r1
 245	cl	%r1,BASED(.Lnr_syscalls)
 246	bnl	BASED(sysc_nr_ok)
 247	sth	%r1,SP_SVCNR(%r15)
 248	lr	%r7,%r1 	  # copy svc number to %r7
 249sysc_nr_ok:
 250	sll	%r7,2		  # svc number *4
 251	l	%r10,BASED(.Lsysc_table)
 252	tm	__TI_flags+2(%r12),_TIF_SYSCALL
 253	mvc	SP_ARGS(4,%r15),SP_R7(%r15)
 254	l	%r8,0(%r7,%r10)	  # get system call addr.
 255	bnz	BASED(sysc_tracesys)
 256	basr	%r14,%r8	  # call sys_xxxx
 257	st	%r2,SP_R2(%r15)   # store return value (change R2 on stack)
 
 258
 259sysc_return:
 260	LOCKDEP_SYS_EXIT
 261sysc_tif:
 262	tm	__TI_flags+3(%r12),_TIF_WORK_SVC
 263	bnz	BASED(sysc_work)  # there is work to do (signals etc.)
 264sysc_restore:
 265	RESTORE_ALL __LC_RETURN_PSW,1
 266sysc_done:
 267
 268#
 269# There is work to do, but first we need to check if we return to userspace.
 270#
 271sysc_work:
 272	tm	SP_PSW+1(%r15),0x01	# returning to user ?
 273	bno	BASED(sysc_restore)
 
 
 
 
 
 274
 275#
 276# One of the work bits is on. Find out which one.
 277#
 278sysc_work_tif:
 279	tm	__TI_flags+3(%r12),_TIF_MCCK_PENDING
 280	bo	BASED(sysc_mcck_pending)
 281	tm	__TI_flags+3(%r12),_TIF_NEED_RESCHED
 282	bo	BASED(sysc_reschedule)
 283	tm	__TI_flags+3(%r12),_TIF_SIGPENDING
 284	bo	BASED(sysc_sigpending)
 285	tm	__TI_flags+3(%r12),_TIF_NOTIFY_RESUME
 286	bo	BASED(sysc_notify_resume)
 287	tm	__TI_flags+3(%r12),_TIF_RESTART_SVC
 288	bo	BASED(sysc_restart)
 289	tm	__TI_flags+3(%r12),_TIF_PER_TRAP
 290	bo	BASED(sysc_singlestep)
 291	b	BASED(sysc_return)	# beware of critical section cleanup
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 292
 293#
 294# _TIF_NEED_RESCHED is set, call schedule
 295#
 296sysc_reschedule:
 297	l	%r1,BASED(.Lschedule)
 298	la	%r14,BASED(sysc_return)
 299	br	%r1			# call scheduler
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 300
 301#
 302# _TIF_MCCK_PENDING is set, call handler
 303#
 304sysc_mcck_pending:
 305	l	%r1,BASED(.Ls390_handle_mcck)
 306	la	%r14,BASED(sysc_return)
 307	br	%r1			# TIF bit will be cleared by handler
 308
 309#
 310# _TIF_SIGPENDING is set, call do_signal
 311#
 312sysc_sigpending:
 313	ni	__TI_flags+3(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
 314	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 315	l	%r1,BASED(.Ldo_signal)
 316	basr	%r14,%r1		# call do_signal
 317	tm	__TI_flags+3(%r12),_TIF_RESTART_SVC
 318	bo	BASED(sysc_restart)
 319	tm	__TI_flags+3(%r12),_TIF_PER_TRAP
 320	bo	BASED(sysc_singlestep)
 321	b	BASED(sysc_return)
 322
 323#
 324# _TIF_NOTIFY_RESUME is set, call do_notify_resume
 325#
 326sysc_notify_resume:
 327	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 328	l	%r1,BASED(.Ldo_notify_resume)
 329	la	%r14,BASED(sysc_return)
 330	br	%r1			# call do_notify_resume
 331
 
 
 
 
 
 
 
 
 
 332
 333#
 334# _TIF_RESTART_SVC is set, set up registers and restart svc
 335#
 336sysc_restart:
 337	ni	__TI_flags+3(%r12),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
 338	l	%r7,SP_R2(%r15) 	# load new svc number
 339	mvc	SP_R2(4,%r15),SP_ORIG_R2(%r15) # restore first argument
 340	lm	%r2,%r6,SP_R2(%r15)	# load svc arguments
 341	sth	%r7,SP_SVCNR(%r15)
 342	b	BASED(sysc_nr_ok)	# restart svc
 343
 344#
 345# _TIF_PER_TRAP is set, call do_per_trap
 346#
 347sysc_singlestep:
 348	ni	__TI_flags+3(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
 349	xc	SP_SVCNR(2,%r15),SP_SVCNR(%r15)		# clear svc number
 350	la	%r2,SP_PTREGS(%r15)	# address of register-save area
 351	l	%r1,BASED(.Lhandle_per)	# load adr. of per handler
 352	la	%r14,BASED(sysc_return)	# load adr. of system return
 353	br	%r1			# branch to do_per_trap
 
 
 
 
 
 
 
 
 
 
 
 
 
 354
 355#
 356# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
 357# and after the system call
 358#
 359sysc_tracesys:
 360	l	%r1,BASED(.Ltrace_entry)
 361	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 362	la	%r3,0
 363	xr	%r0,%r0
 364	icm	%r0,3,SP_SVCNR(%r15)
 365	st	%r0,SP_R2(%r15)
 366	basr	%r14,%r1
 367	cl	%r2,BASED(.Lnr_syscalls)
 368	bnl	BASED(sysc_tracenogo)
 369	lr	%r7,%r2
 370	sll	%r7,2			# svc number *4
 371	l	%r8,0(%r7,%r10)
 372sysc_tracego:
 373	lm	%r3,%r6,SP_R3(%r15)
 374	mvc	SP_ARGS(4,%r15),SP_R7(%r15)
 375	l	%r2,SP_ORIG_R2(%r15)
 376	basr	%r14,%r8		# call sys_xxx
 377	st	%r2,SP_R2(%r15)		# store return value
 378sysc_tracenogo:
 379	tm	__TI_flags+2(%r12),_TIF_SYSCALL
 380	bz	BASED(sysc_return)
 381	l	%r1,BASED(.Ltrace_exit)
 382	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 383	la	%r14,BASED(sysc_return)
 384	br	%r1
 385
 386#
 387# a new process exits the kernel with ret_from_fork
 388#
 389ENTRY(ret_from_fork)
 390	l	%r13,__LC_SVC_NEW_PSW+4
 391	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 392	tm	SP_PSW+1(%r15),0x01	# forking a kernel thread ?
 393	bo	BASED(0f)
 394	st	%r15,SP_R15(%r15)	# store stack pointer for new kthread
 3950:	l	%r1,BASED(.Lschedtail)
 396	basr	%r14,%r1
 397	TRACE_IRQS_ON
 398	stosm	__SF_EMPTY(%r15),0x03	# reenable interrupts
 399	b	BASED(sysc_tracenogo)
 400
 401#
 402# kernel_execve function needs to deal with pt_regs that is not
 403# at the usual place
 404#
 405ENTRY(kernel_execve)
 406	stm	%r12,%r15,48(%r15)
 407	lr	%r14,%r15
 408	l	%r13,__LC_SVC_NEW_PSW+4
 409	s	%r15,BASED(.Lc_spsize)
 410	st	%r14,__SF_BACKCHAIN(%r15)
 411	la	%r12,SP_PTREGS(%r15)
 412	xc	0(__PT_SIZE,%r12),0(%r12)
 413	l	%r1,BASED(.Ldo_execve)
 414	lr	%r5,%r12
 415	basr	%r14,%r1
 416	ltr	%r2,%r2
 417	be	BASED(0f)
 418	a	%r15,BASED(.Lc_spsize)
 419	lm	%r12,%r15,48(%r15)
 420	br	%r14
 421	# execve succeeded.
 4220:	stnsm	__SF_EMPTY(%r15),0xfc	# disable interrupts
 423	l	%r15,__LC_KERNEL_STACK	# load ksp
 424	s	%r15,BASED(.Lc_spsize)	# make room for registers & psw
 425	mvc	SP_PTREGS(__PT_SIZE,%r15),0(%r12)	# copy pt_regs
 426	l	%r12,__LC_THREAD_INFO
 427	xc	__SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15)
 428	stosm	__SF_EMPTY(%r15),0x03	# reenable interrupts
 429	l	%r1,BASED(.Lexecve_tail)
 430	basr	%r14,%r1
 431	b	BASED(sysc_return)
 432
 433/*
 434 * Program check handler routine
 435 */
 436
 437ENTRY(pgm_check_handler)
 438/*
 439 * First we need to check for a special case:
 440 * Single stepping an instruction that disables the PER event mask will
 441 * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
 442 * For a single stepped SVC the program check handler gets control after
 443 * the SVC new PSW has been loaded. But we want to execute the SVC first and
 444 * then handle the PER event. Therefore we update the SVC old PSW to point
 445 * to the pgm_check_handler and branch to the SVC handler after we checked
 446 * if we have to load the kernel stack register.
 447 * For every other possible cause for PER event without the PER mask set
 448 * we just ignore the PER event (FIXME: is there anything we have to do
 449 * for LPSW?).
 450 */
 451	stpt	__LC_SYNC_ENTER_TIMER
 452	SAVE_ALL_BASE __LC_SAVE_AREA
 453	tm	__LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
 454	bnz	BASED(pgm_per)		# got per exception -> special case
 455	SAVE_ALL_PGM __LC_PGM_OLD_PSW,__LC_SAVE_AREA
 456	CREATE_STACK_FRAME __LC_SAVE_AREA
 457	xc	SP_ILC(4,%r15),SP_ILC(%r15)
 458	mvc	SP_PSW(8,%r15),__LC_PGM_OLD_PSW
 459	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 460	tm	SP_PSW+1(%r15),0x01	# interrupting from user ?
 461	bz	BASED(pgm_no_vtime)
 462	UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
 463	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 464	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
 465pgm_no_vtime:
 466	l	%r3,__LC_PGM_ILC	# load program interruption code
 467	l	%r4,__LC_TRANS_EXC_CODE
 468	REENABLE_IRQS
 469	la	%r8,0x7f
 470	nr	%r8,%r3
 471	sll	%r8,2
 472	l	%r1,BASED(.Ljump_table)
 473	l	%r1,0(%r8,%r1)		# load address of handler routine
 474	la	%r2,SP_PTREGS(%r15)	# address of register-save area
 475	basr	%r14,%r1		# branch to interrupt-handler
 476pgm_exit:
 477	b	BASED(sysc_return)
 478
 479#
 480# handle per exception
 481#
 482pgm_per:
 483	tm	__LC_PGM_OLD_PSW,0x40	# test if per event recording is on
 484	bnz	BASED(pgm_per_std)	# ok, normal per event from user space
 485# ok its one of the special cases, now we need to find out which one
 486	clc	__LC_PGM_OLD_PSW(8),__LC_SVC_NEW_PSW
 487	be	BASED(pgm_svcper)
 488# no interesting special case, ignore PER event
 489	lm	%r12,%r15,__LC_SAVE_AREA
 490	lpsw	0x28
 491
 492#
 493# Normal per exception
 494#
 495pgm_per_std:
 496	SAVE_ALL_PGM __LC_PGM_OLD_PSW,__LC_SAVE_AREA
 497	CREATE_STACK_FRAME __LC_SAVE_AREA
 498	mvc	SP_PSW(8,%r15),__LC_PGM_OLD_PSW
 499	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 500	tm	SP_PSW+1(%r15),0x01	# interrupting from user ?
 501	bz	BASED(pgm_no_vtime2)
 502	UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
 503	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 504	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
 505pgm_no_vtime2:
 506	l	%r1,__TI_task(%r12)
 507	tm	SP_PSW+1(%r15),0x01	# kernel per event ?
 508	bz	BASED(kernel_per)
 509	mvc	__THREAD_per_cause(2,%r1),__LC_PER_CAUSE
 510	mvc	__THREAD_per_address(4,%r1),__LC_PER_ADDRESS
 511	mvc	__THREAD_per_paid(1,%r1),__LC_PER_PAID
 512	oi	__TI_flags+3(%r12),_TIF_PER_TRAP # set TIF_PER_TRAP
 513	l	%r3,__LC_PGM_ILC	# load program interruption code
 514	l	%r4,__LC_TRANS_EXC_CODE
 515	REENABLE_IRQS
 516	la	%r8,0x7f
 517	nr	%r8,%r3 		# clear per-event-bit and ilc
 518	be	BASED(pgm_exit2)	# only per or per+check ?
 519	sll	%r8,2
 520	l	%r1,BASED(.Ljump_table)
 521	l	%r1,0(%r8,%r1)		# load address of handler routine
 522	la	%r2,SP_PTREGS(%r15)	# address of register-save area
 523	basr	%r14,%r1		# branch to interrupt-handler
 524pgm_exit2:
 525	b	BASED(sysc_return)
 526
 527#
 528# it was a single stepped SVC that is causing all the trouble
 529#
 530pgm_svcper:
 531	SAVE_ALL_PGM __LC_SVC_OLD_PSW,__LC_SAVE_AREA
 532	CREATE_STACK_FRAME __LC_SAVE_AREA
 533	mvc	SP_PSW(8,%r15),__LC_SVC_OLD_PSW
 534	mvc	SP_ILC(4,%r15),__LC_SVC_ILC
 535	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 536	UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
 537	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 538	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
 539	l	%r8,__TI_task(%r12)
 540	mvc	__THREAD_per_cause(2,%r8),__LC_PER_CAUSE
 541	mvc	__THREAD_per_address(4,%r8),__LC_PER_ADDRESS
 542	mvc	__THREAD_per_paid(1,%r8),__LC_PER_PAID
 543	oi	__TI_flags+3(%r12),_TIF_PER_TRAP # set TIF_PER_TRAP
 544	stosm	__SF_EMPTY(%r15),0x03	# reenable interrupts
 545	lm	%r2,%r6,SP_R2(%r15)	# load svc arguments
 546	b	BASED(sysc_do_svc)
 547
 548#
 549# per was called from kernel, must be kprobes
 550#
 551kernel_per:
 552	REENABLE_IRQS
 553	xc	SP_SVCNR(2,%r15),SP_SVCNR(%r15)
 554	la	%r2,SP_PTREGS(%r15)	# address of register-save area
 555	l	%r1,BASED(.Lhandle_per)	# load adr. of per handler
 556	basr	%r14,%r1		# branch to do_single_step
 557	b	BASED(pgm_exit)
 
 
 
 
 
 
 
 
 
 
 558
 559/*
 560 * IO interrupt handler routine
 561 */
 562
 563ENTRY(io_int_handler)
 564	stck	__LC_INT_CLOCK
 565	stpt	__LC_ASYNC_ENTER_TIMER
 566	SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+16
 567	CREATE_STACK_FRAME __LC_SAVE_AREA+16
 568	mvc	SP_PSW(8,%r15),0(%r12)	# move user PSW to stack
 569	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 570	tm	SP_PSW+1(%r15),0x01	# interrupting from user ?
 571	bz	BASED(io_no_vtime)
 572	UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
 573	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 574	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
 575io_no_vtime:
 
 
 
 
 
 
 
 
 
 
 
 
 
 576	TRACE_IRQS_OFF
 577	l	%r1,BASED(.Ldo_IRQ)	# load address of do_IRQ
 578	la	%r2,SP_PTREGS(%r15)	# address of register-save area
 579	basr	%r14,%r1		# branch to standard irq handler
 580io_return:
 
 
 
 
 
 
 
 
 
 
 
 
 581	LOCKDEP_SYS_EXIT
 582	TRACE_IRQS_ON
 583io_tif:
 584	tm	__TI_flags+3(%r12),_TIF_WORK_INT
 585	bnz	BASED(io_work)		# there is work to do (signals etc.)
 586io_restore:
 587	RESTORE_ALL __LC_RETURN_PSW,0
 588io_done:
 
 
 
 
 
 
 
 
 
 
 
 
 
 589
 590#
 591# There is work todo, find out in which context we have been interrupted:
 592# 1) if we return to user space we can do all _TIF_WORK_INT work
 593# 2) if we return to kernel code and preemptive scheduling is enabled check
 
 
 594#    the preemption counter and if it is zero call preempt_schedule_irq
 595# Before any work can be done, a switch to the kernel stack is required.
 596#
 597io_work:
 598	tm	SP_PSW+1(%r15),0x01	# returning to user ?
 599	bo	BASED(io_work_user)	# yes -> do resched & signal
 600#ifdef CONFIG_PREEMPT
 601	# check for preemptive scheduling
 602	icm	%r0,15,__TI_precount(%r12)
 603	bnz	BASED(io_restore)	# preemption disabled
 604	tm	__TI_flags+3(%r12),_TIF_NEED_RESCHED
 605	bno	BASED(io_restore)
 606	# switch to kernel stack
 607	l	%r1,SP_R15(%r15)
 608	s	%r1,BASED(.Lc_spsize)
 609	mvc	SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
 610	xc	__SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chain
 611	lr	%r15,%r1
 612	# TRACE_IRQS_ON already done at io_return, call
 
 613	# TRACE_IRQS_OFF to keep things symmetrical
 614	TRACE_IRQS_OFF
 615	l	%r1,BASED(.Lpreempt_schedule_irq)
 616	basr	%r14,%r1		# call preempt_schedule_irq
 617	b	BASED(io_return)
 618#else
 619	b	BASED(io_restore)
 620#endif
 621
 622#
 623# Need to do work before returning to userspace, switch to kernel stack
 624#
 625io_work_user:
 626	l	%r1,__LC_KERNEL_STACK
 627	s	%r1,BASED(.Lc_spsize)
 628	mvc	SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
 629	xc	__SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chain
 630	lr	%r15,%r1
 631
 632#
 633# One of the work bits is on. Find out which one.
 634# Checked are: _TIF_SIGPENDING, _TIF_NOTIFY_RESUME, _TIF_NEED_RESCHED
 635#		and _TIF_MCCK_PENDING
 636#
 637io_work_tif:
 638	tm	__TI_flags+3(%r12),_TIF_MCCK_PENDING
 639	bo	BASED(io_mcck_pending)
 640	tm	__TI_flags+3(%r12),_TIF_NEED_RESCHED
 641	bo	BASED(io_reschedule)
 642	tm	__TI_flags+3(%r12),_TIF_SIGPENDING
 643	bo	BASED(io_sigpending)
 644	tm	__TI_flags+3(%r12),_TIF_NOTIFY_RESUME
 645	bo	BASED(io_notify_resume)
 646	b	BASED(io_return)	# beware of critical section cleanup
 647
 648#
 649# _TIF_MCCK_PENDING is set, call handler
 650#
 651io_mcck_pending:
 652	# TRACE_IRQS_ON already done at io_return
 653	l	%r1,BASED(.Ls390_handle_mcck)
 654	basr	%r14,%r1		# TIF bit will be cleared by handler
 
 
 
 
 
 
 
 
 
 655	TRACE_IRQS_OFF
 656	b	BASED(io_return)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 657
 658#
 659# _TIF_NEED_RESCHED is set, call schedule
 660#
 661io_reschedule:
 662	# TRACE_IRQS_ON already done at io_return
 663	l	%r1,BASED(.Lschedule)
 664	stosm	__SF_EMPTY(%r15),0x03	# reenable interrupts
 665	basr	%r14,%r1		# call scheduler
 666	stnsm	__SF_EMPTY(%r15),0xfc	# disable I/O and ext. interrupts
 667	TRACE_IRQS_OFF
 668	b	BASED(io_return)
 
 
 
 
 
 
 
 
 
 
 669
 670#
 671# _TIF_SIGPENDING is set, call do_signal
 672#
 673io_sigpending:
 674	# TRACE_IRQS_ON already done at io_return
 675	stosm	__SF_EMPTY(%r15),0x03	# reenable interrupts
 676	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 677	l	%r1,BASED(.Ldo_signal)
 678	basr	%r14,%r1		# call do_signal
 679	stnsm	__SF_EMPTY(%r15),0xfc	# disable I/O and ext. interrupts
 680	TRACE_IRQS_OFF
 681	b	BASED(io_return)
 682
 683#
 684# _TIF_SIGPENDING is set, call do_signal
 685#
 686io_notify_resume:
 687	# TRACE_IRQS_ON already done at io_return
 688	stosm	__SF_EMPTY(%r15),0x03	# reenable interrupts
 689	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 690	l	%r1,BASED(.Ldo_notify_resume)
 691	basr	%r14,%r1		# call do_signal
 692	stnsm	__SF_EMPTY(%r15),0xfc	# disable I/O and ext. interrupts
 693	TRACE_IRQS_OFF
 694	b	BASED(io_return)
 695
 696/*
 697 * External interrupt handler routine
 698 */
 699
 700ENTRY(ext_int_handler)
 701	stck	__LC_INT_CLOCK
 702	stpt	__LC_ASYNC_ENTER_TIMER
 703	SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+16
 704	CREATE_STACK_FRAME __LC_SAVE_AREA+16
 705	mvc	SP_PSW(8,%r15),0(%r12)	# move user PSW to stack
 706	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 707	tm	SP_PSW+1(%r15),0x01	# interrupting from user ?
 708	bz	BASED(ext_no_vtime)
 709	UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
 710	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 711	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
 712ext_no_vtime:
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 713	TRACE_IRQS_OFF
 714	la	%r2,SP_PTREGS(%r15)	# address of register-save area
 715	l	%r3,__LC_CPU_ADDRESS	# get cpu address + interruption code
 716	l	%r4,__LC_EXT_PARAMS	# get external parameters
 717	l	%r1,BASED(.Ldo_extint)
 718	basr	%r14,%r1
 719	b	BASED(io_return)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 720
 721__critical_end:
 722
 723/*
 724 * Machine check handler routines
 725 */
 726
 727ENTRY(mcck_int_handler)
 728	stck	__LC_MCCK_CLOCK
 729	spt	__LC_CPU_TIMER_SAVE_AREA	# revalidate cpu timer
 730	lm	%r0,%r15,__LC_GPREGS_SAVE_AREA	# revalidate gprs
 731	SAVE_ALL_BASE __LC_SAVE_AREA+32
 732	la	%r12,__LC_MCK_OLD_PSW
 733	tm	__LC_MCCK_CODE,0x80	# system damage?
 734	bo	BASED(mcck_int_main)	# yes -> rest of mcck code invalid
 735	mvc	__LC_MCCK_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA
 736	tm	__LC_MCCK_CODE+5,0x02	# stored cpu timer value valid?
 737	bo	BASED(1f)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 738	la	%r14,__LC_SYNC_ENTER_TIMER
 739	clc	0(8,%r14),__LC_ASYNC_ENTER_TIMER
 740	bl	BASED(0f)
 741	la	%r14,__LC_ASYNC_ENTER_TIMER
 7420:	clc	0(8,%r14),__LC_EXIT_TIMER
 743	bl	BASED(0f)
 744	la	%r14,__LC_EXIT_TIMER
 7450:	clc	0(8,%r14),__LC_LAST_UPDATE_TIMER
 746	bl	BASED(0f)
 747	la	%r14,__LC_LAST_UPDATE_TIMER
 7480:	spt	0(%r14)
 749	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
 7501:	tm	__LC_MCCK_CODE+2,0x09	# mwp + ia of old psw valid?
 751	bno	BASED(mcck_int_main)	# no -> skip cleanup critical
 752	tm	__LC_MCK_OLD_PSW+1,0x01	# test problem state bit
 753	bnz	BASED(mcck_int_main)	# from user -> load async stack
 754	clc	__LC_MCK_OLD_PSW+4(4),BASED(.Lcritical_end)
 755	bhe	BASED(mcck_int_main)
 756	clc	__LC_MCK_OLD_PSW+4(4),BASED(.Lcritical_start)
 757	bl	BASED(mcck_int_main)
 758	l	%r14,BASED(.Lcleanup_critical)
 759	basr	%r14,%r14
 760mcck_int_main:
 761	l	%r14,__LC_PANIC_STACK	# are we already on the panic stack?
 762	slr	%r14,%r15
 763	sra	%r14,PAGE_SHIFT
 764	be	BASED(0f)
 765	l	%r15,__LC_PANIC_STACK	# load panic stack
 7660:	s	%r15,BASED(.Lc_spsize)	# make room for registers & psw
 767	CREATE_STACK_FRAME __LC_SAVE_AREA+32
 768	mvc	SP_PSW(8,%r15),0(%r12)
 769	l	%r12,__LC_THREAD_INFO	# load pointer to thread_info struct
 770	tm	__LC_MCCK_CODE+2,0x08	# mwp of old psw valid?
 771	bno	BASED(mcck_no_vtime)	# no -> skip cleanup critical
 772	tm	SP_PSW+1(%r15),0x01	# interrupting from user ?
 773	bz	BASED(mcck_no_vtime)
 774	UPDATE_VTIME __LC_EXIT_TIMER,__LC_MCCK_ENTER_TIMER,__LC_USER_TIMER
 775	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 776	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_MCCK_ENTER_TIMER
 777mcck_no_vtime:
 778	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 779	l	%r1,BASED(.Ls390_mcck)
 780	basr	%r14,%r1		# call machine check handler
 781	tm	SP_PSW+1(%r15),0x01	# returning to user ?
 782	bno	BASED(mcck_return)
 783	l	%r1,__LC_KERNEL_STACK	# switch to kernel stack
 784	s	%r1,BASED(.Lc_spsize)
 785	mvc	SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
 786	xc	__SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chain
 787	lr	%r15,%r1
 788	stosm	__SF_EMPTY(%r15),0x04	# turn dat on
 789	tm	__TI_flags+3(%r12),_TIF_MCCK_PENDING
 790	bno	BASED(mcck_return)
 791	TRACE_IRQS_OFF
 792	l	%r1,BASED(.Ls390_handle_mcck)
 793	basr	%r14,%r1		# call machine check handler
 794	TRACE_IRQS_ON
 795mcck_return:
 796	mvc	__LC_RETURN_MCCK_PSW(8),SP_PSW(%r15) # move return PSW
 797	ni	__LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
 
 798	tm	__LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
 799	bno	BASED(0f)
 800	lm	%r0,%r15,SP_R0(%r15)	# load gprs 0-15
 801	stpt	__LC_EXIT_TIMER
 802	lpsw	__LC_RETURN_MCCK_PSW	# back to caller
 8030:	lm	%r0,%r15,SP_R0(%r15)	# load gprs 0-15
 804	lpsw	__LC_RETURN_MCCK_PSW	# back to caller
 805
 806	RESTORE_ALL __LC_RETURN_MCCK_PSW,0
 807
 808/*
 809 * Restart interruption handler, kick starter for additional CPUs
 810 */
 811#ifdef CONFIG_SMP
 812	__CPUINIT
 813ENTRY(restart_int_handler)
 814	basr	%r1,0
 815restart_base:
 816	spt	restart_vtime-restart_base(%r1)
 817	stck	__LC_LAST_UPDATE_CLOCK
 818	mvc	__LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
 819	mvc	__LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
 820	l	%r15,__LC_SAVE_AREA+60	# load ksp
 821	lctl	%c0,%c15,__LC_CREGS_SAVE_AREA # get new ctl regs
 822	lam	%a0,%a15,__LC_AREGS_SAVE_AREA
 823	lm	%r6,%r15,__SF_GPRS(%r15) # load registers from clone
 824	l	%r1,__LC_THREAD_INFO
 825	mvc	__LC_USER_TIMER(8),__TI_user_timer(%r1)
 826	mvc	__LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
 827	xc	__LC_STEAL_TIMER(8),__LC_STEAL_TIMER
 828	stosm	__SF_EMPTY(%r15),0x04	# now we can turn dat on
 829	basr	%r14,0
 830	l	%r14,restart_addr-.(%r14)
 831	basr	%r14,%r14		# branch to start_secondary
 832restart_addr:
 833	.long	start_secondary
 834	.align	8
 835restart_vtime:
 836	.long	0x7fffffff,0xffffffff
 837	.previous
 838#else
 839/*
 840 * If we do not run with SMP enabled, let the new CPU crash ...
 841 */
 842ENTRY(restart_int_handler)
 843	basr	%r1,0
 844restart_base:
 845	lpsw	restart_crash-restart_base(%r1)
 846	.align	8
 847restart_crash:
 848	.long	0x000a0000,0x00000000
 849restart_go:
 850#endif
 851
 852#
 853# PSW restart interrupt handler
 854#
 855ENTRY(psw_restart_int_handler)
 856	st	%r15,__LC_SAVE_AREA_64(%r0)	# save r15
 857	basr	%r15,0
 8580:	l	%r15,.Lrestart_stack-0b(%r15)	# load restart stack
 859	l	%r15,0(%r15)
 860	ahi	%r15,-SP_SIZE			# make room for pt_regs
 861	stm	%r0,%r14,SP_R0(%r15)		# store gprs %r0-%r14 to stack
 862	mvc	SP_R15(4,%r15),__LC_SAVE_AREA_64(%r0)# store saved %r15 to stack
 863	mvc	SP_PSW(8,%r15),__LC_RST_OLD_PSW(%r0) # store restart old psw
 864	xc	__SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15) # set backchain to 0
 865	basr	%r14,0
 8661:	l	%r14,.Ldo_restart-1b(%r14)
 867	basr	%r14,%r14
 868
 869	basr	%r14,0				# load disabled wait PSW if
 8702:	lpsw	restart_psw_crash-2b(%r14)	# do_restart returns
 871	.align 4
 872.Ldo_restart:
 873	.long	do_restart
 874.Lrestart_stack:
 875	.long	restart_stack
 876	.align 8
 877restart_psw_crash:
 878	.long	0x000a0000,0x00000000 + restart_psw_crash
 879
 880	.section .kprobes.text, "ax"
 881
 882#ifdef CONFIG_CHECK_STACK
 883/*
 884 * The synchronous or the asynchronous stack overflowed. We are dead.
 885 * No need to properly save the registers, we are going to panic anyway.
 886 * Setup a pt_regs so that show_trace can provide a good call trace.
 887 */
 888stack_overflow:
 889	l	%r15,__LC_PANIC_STACK	# change to panic stack
 890	sl	%r15,BASED(.Lc_spsize)
 891	mvc	SP_PSW(8,%r15),0(%r12)	# move user PSW to stack
 892	stm	%r0,%r11,SP_R0(%r15)	# store gprs %r0-%r11 to kernel stack
 893	la	%r1,__LC_SAVE_AREA
 894	ch	%r12,BASED(.L0x020)	# old psw addr == __LC_SVC_OLD_PSW ?
 895	be	BASED(0f)
 896	ch	%r12,BASED(.L0x028)	# old psw addr == __LC_PGM_OLD_PSW ?
 897	be	BASED(0f)
 898	la	%r1,__LC_SAVE_AREA+16
 8990:	mvc	SP_R12(16,%r15),0(%r1)	# move %r12-%r15 to stack
 900	xc	__SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15) # clear back chain
 901	l	%r1,BASED(1f)		# branch to kernel_stack_overflow
 902	la	%r2,SP_PTREGS(%r15)	# load pt_regs
 903	br	%r1
 9041:	.long	kernel_stack_overflow
 905#endif
 906
 907cleanup_table_system_call:
 908	.long	system_call + 0x80000000, sysc_do_svc + 0x80000000
 909cleanup_table_sysc_tif:
 910	.long	sysc_tif + 0x80000000, sysc_restore + 0x80000000
 911cleanup_table_sysc_restore:
 912	.long	sysc_restore + 0x80000000, sysc_done + 0x80000000
 913cleanup_table_io_tif:
 914	.long	io_tif + 0x80000000, io_restore + 0x80000000
 915cleanup_table_io_restore:
 916	.long	io_restore + 0x80000000, io_done + 0x80000000
 917
 918cleanup_critical:
 919	clc	4(4,%r12),BASED(cleanup_table_system_call)
 920	bl	BASED(0f)
 921	clc	4(4,%r12),BASED(cleanup_table_system_call+4)
 922	bl	BASED(cleanup_system_call)
 9230:
 924	clc	4(4,%r12),BASED(cleanup_table_sysc_tif)
 925	bl	BASED(0f)
 926	clc	4(4,%r12),BASED(cleanup_table_sysc_tif+4)
 927	bl	BASED(cleanup_sysc_tif)
 9280:
 929	clc	4(4,%r12),BASED(cleanup_table_sysc_restore)
 930	bl	BASED(0f)
 931	clc	4(4,%r12),BASED(cleanup_table_sysc_restore+4)
 932	bl	BASED(cleanup_sysc_restore)
 9330:
 934	clc	4(4,%r12),BASED(cleanup_table_io_tif)
 935	bl	BASED(0f)
 936	clc	4(4,%r12),BASED(cleanup_table_io_tif+4)
 937	bl	BASED(cleanup_io_tif)
 9380:
 939	clc	4(4,%r12),BASED(cleanup_table_io_restore)
 940	bl	BASED(0f)
 941	clc	4(4,%r12),BASED(cleanup_table_io_restore+4)
 942	bl	BASED(cleanup_io_restore)
 9430:
 944	br	%r14
 945
 946cleanup_system_call:
 947	mvc	__LC_RETURN_PSW(8),0(%r12)
 948	clc	__LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+4)
 949	bh	BASED(0f)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 950	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
 951	c	%r12,BASED(.Lmck_old_psw)
 952	be	BASED(0f)
 953	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
 9540:	c	%r12,BASED(.Lmck_old_psw)
 955	la	%r12,__LC_SAVE_AREA+32
 956	be	BASED(0f)
 957	la	%r12,__LC_SAVE_AREA+16
 9580:	clc	__LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+8)
 959	bhe	BASED(cleanup_vtime)
 960	clc	__LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn)
 961	bh	BASED(0f)
 962	mvc	__LC_SAVE_AREA(16),0(%r12)
 9630:	st	%r13,4(%r12)
 964	l	%r15,__LC_KERNEL_STACK	# problem state -> load ksp
 965	s	%r15,BASED(.Lc_spsize)	# make room for registers & psw
 966	st	%r15,12(%r12)
 967	CREATE_STACK_FRAME __LC_SAVE_AREA
 968	mvc	SP_PSW(8,%r15),__LC_SVC_OLD_PSW
 969	mvc	SP_ILC(4,%r15),__LC_SVC_ILC
 970	mvc	0(4,%r12),__LC_THREAD_INFO
 971cleanup_vtime:
 972	clc	__LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+12)
 973	bhe	BASED(cleanup_stime)
 974	UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
 975cleanup_stime:
 976	clc	__LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+16)
 977	bh	BASED(cleanup_update)
 978	UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
 979cleanup_update:
 980	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
 981	mvc	__LC_RETURN_PSW+4(4),BASED(cleanup_table_system_call+4)
 982	la	%r12,__LC_RETURN_PSW
 983	br	%r14
 984cleanup_system_call_insn:
 985	.long	sysc_saveall + 0x80000000
 986	.long	system_call + 0x80000000
 987	.long	sysc_vtime + 0x80000000
 988	.long	sysc_stime + 0x80000000
 989	.long	sysc_update + 0x80000000
 990
 991cleanup_sysc_tif:
 992	mvc	__LC_RETURN_PSW(4),0(%r12)
 993	mvc	__LC_RETURN_PSW+4(4),BASED(cleanup_table_sysc_tif)
 994	la	%r12,__LC_RETURN_PSW
 995	br	%r14
 996
 997cleanup_sysc_restore:
 998	clc	4(4,%r12),BASED(cleanup_sysc_restore_insn)
 999	be	BASED(2f)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1000	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
1001	c	%r12,BASED(.Lmck_old_psw)
1002	be	BASED(0f)
1003	mvc	__LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
10040:	clc	4(4,%r12),BASED(cleanup_sysc_restore_insn+4)
1005	be	BASED(2f)
1006	mvc	__LC_RETURN_PSW(8),SP_PSW(%r15)
1007	c	%r12,BASED(.Lmck_old_psw)
1008	la	%r12,__LC_SAVE_AREA+32
1009	be	BASED(1f)
1010	la	%r12,__LC_SAVE_AREA+16
10111:	mvc	0(16,%r12),SP_R12(%r15)
1012	lm	%r0,%r11,SP_R0(%r15)
1013	l	%r15,SP_R15(%r15)
10142:	la	%r12,__LC_RETURN_PSW
1015	br	%r14
1016cleanup_sysc_restore_insn:
1017	.long	sysc_done - 4 + 0x80000000
1018	.long	sysc_done - 8 + 0x80000000
1019
1020cleanup_io_tif:
1021	mvc	__LC_RETURN_PSW(4),0(%r12)
1022	mvc	__LC_RETURN_PSW+4(4),BASED(cleanup_table_io_tif)
1023	la	%r12,__LC_RETURN_PSW
1024	br	%r14
1025
1026cleanup_io_restore:
1027	clc	4(4,%r12),BASED(cleanup_io_restore_insn)
1028	be	BASED(1f)
1029	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
1030	clc	4(4,%r12),BASED(cleanup_io_restore_insn+4)
1031	be	BASED(1f)
1032	mvc	__LC_RETURN_PSW(8),SP_PSW(%r15)
1033	mvc	__LC_SAVE_AREA+32(16),SP_R12(%r15)
1034	lm	%r0,%r11,SP_R0(%r15)
1035	l	%r15,SP_R15(%r15)
10361:	la	%r12,__LC_RETURN_PSW
1037	br	%r14
1038cleanup_io_restore_insn:
1039	.long	io_done - 4 + 0x80000000
1040	.long	io_done - 8 + 0x80000000
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1041
1042/*
1043 * Integer constants
1044 */
1045		.align	4
1046.Lc_spsize:	.long	SP_SIZE
1047.Lc_overhead:	.long	STACK_FRAME_OVERHEAD
1048.Lnr_syscalls:	.long	NR_syscalls
1049.L0x018:	.short	0x018
1050.L0x020:	.short	0x020
1051.L0x028:	.short	0x028
1052.L0x030:	.short	0x030
1053.L0x038:	.short	0x038
1054.Lc_1:		.long	1
1055
1056/*
1057 * Symbol constants
1058 */
1059.Ls390_mcck:	.long	s390_do_machine_check
1060.Ls390_handle_mcck:
1061		.long	s390_handle_mcck
1062.Lmck_old_psw:	.long	__LC_MCK_OLD_PSW
1063.Ldo_IRQ:	.long	do_IRQ
1064.Ldo_extint:	.long	do_extint
1065.Ldo_signal:	.long	do_signal
1066.Ldo_notify_resume:
1067		.long	do_notify_resume
1068.Lhandle_per:	.long	do_per_trap
1069.Ldo_execve:	.long	do_execve
1070.Lexecve_tail:	.long	execve_tail
1071.Ljump_table:	.long	pgm_check_table
1072.Lschedule:	.long	schedule
1073#ifdef CONFIG_PREEMPT
1074.Lpreempt_schedule_irq:
1075		.long	preempt_schedule_irq
1076#endif
1077.Ltrace_entry:	.long	do_syscall_trace_enter
1078.Ltrace_exit:	.long	do_syscall_trace_exit
1079.Lschedtail:	.long	schedule_tail
1080.Lsysc_table:	.long	sys_call_table
1081#ifdef CONFIG_TRACE_IRQFLAGS
1082.Ltrace_irq_on_caller:
1083		.long	trace_hardirqs_on_caller
1084.Ltrace_irq_off_caller:
1085		.long	trace_hardirqs_off_caller
1086#endif
1087#ifdef CONFIG_LOCKDEP
1088.Llockdep_sys_exit:
1089		.long	lockdep_sys_exit
1090#endif
1091.Lcritical_start:
1092		.long	__critical_start + 0x80000000
1093.Lcritical_end:
1094		.long	__critical_end + 0x80000000
1095.Lcleanup_critical:
1096		.long	cleanup_critical
1097
1098		.section .rodata, "a"
1099#define SYSCALL(esa,esame,emu)	.long esa
1100	.globl	sys_call_table
1101sys_call_table:
1102#include "syscalls.S"
1103#undef SYSCALL