xref: /openbmc/linux/arch/s390/kernel/entry.S (revision 07a63cbe8bcb6ba72fb989dcab1ec55ec6c36c7e)
14bfc86ceSHeiko Carstens/*
24bfc86ceSHeiko Carstens *    S390 low-level entry points.
34bfc86ceSHeiko Carstens *
44bfc86ceSHeiko Carstens *    Copyright IBM Corp. 1999, 2012
54bfc86ceSHeiko Carstens *    Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
64bfc86ceSHeiko Carstens *		 Hartmut Penner (hp@de.ibm.com),
74bfc86ceSHeiko Carstens *		 Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
84bfc86ceSHeiko Carstens *		 Heiko Carstens <heiko.carstens@de.ibm.com>
94bfc86ceSHeiko Carstens */
104bfc86ceSHeiko Carstens
114bfc86ceSHeiko Carstens#include <linux/init.h>
124bfc86ceSHeiko Carstens#include <linux/linkage.h>
134bfc86ceSHeiko Carstens#include <asm/processor.h>
144bfc86ceSHeiko Carstens#include <asm/cache.h>
154bfc86ceSHeiko Carstens#include <asm/errno.h>
164bfc86ceSHeiko Carstens#include <asm/ptrace.h>
174bfc86ceSHeiko Carstens#include <asm/thread_info.h>
184bfc86ceSHeiko Carstens#include <asm/asm-offsets.h>
194bfc86ceSHeiko Carstens#include <asm/unistd.h>
204bfc86ceSHeiko Carstens#include <asm/page.h>
214bfc86ceSHeiko Carstens#include <asm/sigp.h>
224bfc86ceSHeiko Carstens#include <asm/irq.h>
239977e886SHendrik Brueckner#include <asm/vx-insn.h>
2483abeffbSHendrik Brueckner#include <asm/setup.h>
2583abeffbSHendrik Brueckner#include <asm/nmi.h>
26711f5df7SAl Viro#include <asm/export.h>
274bfc86ceSHeiko Carstens
284bfc86ceSHeiko Carstens__PT_R0      =	__PT_GPRS
294bfc86ceSHeiko Carstens__PT_R1      =	__PT_GPRS + 8
304bfc86ceSHeiko Carstens__PT_R2      =	__PT_GPRS + 16
314bfc86ceSHeiko Carstens__PT_R3      =	__PT_GPRS + 24
324bfc86ceSHeiko Carstens__PT_R4      =	__PT_GPRS + 32
334bfc86ceSHeiko Carstens__PT_R5      =	__PT_GPRS + 40
344bfc86ceSHeiko Carstens__PT_R6      =	__PT_GPRS + 48
354bfc86ceSHeiko Carstens__PT_R7      =	__PT_GPRS + 56
364bfc86ceSHeiko Carstens__PT_R8      =	__PT_GPRS + 64
374bfc86ceSHeiko Carstens__PT_R9      =	__PT_GPRS + 72
384bfc86ceSHeiko Carstens__PT_R10     =	__PT_GPRS + 80
394bfc86ceSHeiko Carstens__PT_R11     =	__PT_GPRS + 88
404bfc86ceSHeiko Carstens__PT_R12     =	__PT_GPRS + 96
414bfc86ceSHeiko Carstens__PT_R13     =	__PT_GPRS + 104
424bfc86ceSHeiko Carstens__PT_R14     =	__PT_GPRS + 112
434bfc86ceSHeiko Carstens__PT_R15     =	__PT_GPRS + 120
444bfc86ceSHeiko Carstens
453a890380SHeiko CarstensSTACK_SHIFT = PAGE_SHIFT + THREAD_SIZE_ORDER
464bfc86ceSHeiko CarstensSTACK_SIZE  = 1 << STACK_SHIFT
474bfc86ceSHeiko CarstensSTACK_INIT = STACK_SIZE - STACK_FRAME_OVERHEAD - __PT_SIZE
484bfc86ceSHeiko Carstens
494bfc86ceSHeiko Carstens_TIF_WORK	= (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
5076f1948aSLinus Torvalds		   _TIF_UPROBE | _TIF_GUARDED_STORAGE | _TIF_PATCH_PENDING)
514bfc86ceSHeiko Carstens_TIF_TRACE	= (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_AUDIT | _TIF_SECCOMP | \
524bfc86ceSHeiko Carstens		   _TIF_SYSCALL_TRACEPOINT)
53b5a882fcSHeiko Carstens_CIF_WORK	= (_CIF_MCCK_PENDING | _CIF_ASCE_PRIMARY | \
54b5a882fcSHeiko Carstens		   _CIF_ASCE_SECONDARY | _CIF_FPU)
554bfc86ceSHeiko Carstens_PIF_WORK	= (_PIF_PER_TRAP)
564bfc86ceSHeiko Carstens
579977e886SHendrik Brueckner#define BASED(name) name-cleanup_critical(%r13)
584bfc86ceSHeiko Carstens
594bfc86ceSHeiko Carstens	.macro	TRACE_IRQS_ON
604bfc86ceSHeiko Carstens#ifdef CONFIG_TRACE_IRQFLAGS
614bfc86ceSHeiko Carstens	basr	%r2,%r0
624bfc86ceSHeiko Carstens	brasl	%r14,trace_hardirqs_on_caller
634bfc86ceSHeiko Carstens#endif
644bfc86ceSHeiko Carstens	.endm
654bfc86ceSHeiko Carstens
664bfc86ceSHeiko Carstens	.macro	TRACE_IRQS_OFF
674bfc86ceSHeiko Carstens#ifdef CONFIG_TRACE_IRQFLAGS
684bfc86ceSHeiko Carstens	basr	%r2,%r0
694bfc86ceSHeiko Carstens	brasl	%r14,trace_hardirqs_off_caller
704bfc86ceSHeiko Carstens#endif
714bfc86ceSHeiko Carstens	.endm
724bfc86ceSHeiko Carstens
734bfc86ceSHeiko Carstens	.macro	LOCKDEP_SYS_EXIT
744bfc86ceSHeiko Carstens#ifdef CONFIG_LOCKDEP
754bfc86ceSHeiko Carstens	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
764bfc86ceSHeiko Carstens	jz	.+10
774bfc86ceSHeiko Carstens	brasl	%r14,lockdep_sys_exit
784bfc86ceSHeiko Carstens#endif
794bfc86ceSHeiko Carstens	.endm
804bfc86ceSHeiko Carstens
814bfc86ceSHeiko Carstens	.macro	CHECK_STACK stacksize,savearea
824bfc86ceSHeiko Carstens#ifdef CONFIG_CHECK_STACK
834bfc86ceSHeiko Carstens	tml	%r15,\stacksize - CONFIG_STACK_GUARD
844bfc86ceSHeiko Carstens	lghi	%r14,\savearea
854bfc86ceSHeiko Carstens	jz	stack_overflow
864bfc86ceSHeiko Carstens#endif
874bfc86ceSHeiko Carstens	.endm
884bfc86ceSHeiko Carstens
892acb94f4SMartin Schwidefsky	.macro	SWITCH_ASYNC savearea,timer
904bfc86ceSHeiko Carstens	tmhh	%r8,0x0001		# interrupting from user ?
914bfc86ceSHeiko Carstens	jnz	1f
924bfc86ceSHeiko Carstens	lgr	%r14,%r9
934bfc86ceSHeiko Carstens	slg	%r14,BASED(.Lcritical_start)
944bfc86ceSHeiko Carstens	clg	%r14,BASED(.Lcritical_length)
954bfc86ceSHeiko Carstens	jhe	0f
964bfc86ceSHeiko Carstens	lghi	%r11,\savearea		# inside critical section, do cleanup
974bfc86ceSHeiko Carstens	brasl	%r14,cleanup_critical
984bfc86ceSHeiko Carstens	tmhh	%r8,0x0001		# retest problem state after cleanup
994bfc86ceSHeiko Carstens	jnz	1f
1002acb94f4SMartin Schwidefsky0:	lg	%r14,__LC_ASYNC_STACK	# are we already on the async stack?
1014bfc86ceSHeiko Carstens	slgr	%r14,%r15
1022acb94f4SMartin Schwidefsky	srag	%r14,%r14,STACK_SHIFT
103a359bb11SMartin Schwidefsky	jnz	2f
1042acb94f4SMartin Schwidefsky	CHECK_STACK 1<<STACK_SHIFT,\savearea
1054bfc86ceSHeiko Carstens	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
106a359bb11SMartin Schwidefsky	j	3f
10734525e1fSMartin Schwidefsky1:	UPDATE_VTIME %r14,%r15,\timer
1082acb94f4SMartin Schwidefsky2:	lg	%r15,__LC_ASYNC_STACK	# load async stack
109a359bb11SMartin Schwidefsky3:	la	%r11,STACK_FRAME_OVERHEAD(%r15)
1104bfc86ceSHeiko Carstens	.endm
1114bfc86ceSHeiko Carstens
112a359bb11SMartin Schwidefsky	.macro UPDATE_VTIME w1,w2,enter_timer
113a359bb11SMartin Schwidefsky	lg	\w1,__LC_EXIT_TIMER
114a359bb11SMartin Schwidefsky	lg	\w2,__LC_LAST_UPDATE_TIMER
115a359bb11SMartin Schwidefsky	slg	\w1,\enter_timer
116a359bb11SMartin Schwidefsky	slg	\w2,__LC_EXIT_TIMER
117a359bb11SMartin Schwidefsky	alg	\w1,__LC_USER_TIMER
118a359bb11SMartin Schwidefsky	alg	\w2,__LC_SYSTEM_TIMER
119a359bb11SMartin Schwidefsky	stg	\w1,__LC_USER_TIMER
120a359bb11SMartin Schwidefsky	stg	\w2,__LC_SYSTEM_TIMER
1214bfc86ceSHeiko Carstens	mvc	__LC_LAST_UPDATE_TIMER(8),\enter_timer
1224bfc86ceSHeiko Carstens	.endm
1234bfc86ceSHeiko Carstens
1244bfc86ceSHeiko Carstens	.macro REENABLE_IRQS
1254bfc86ceSHeiko Carstens	stg	%r8,__LC_RETURN_PSW
1264bfc86ceSHeiko Carstens	ni	__LC_RETURN_PSW,0xbf
1274bfc86ceSHeiko Carstens	ssm	__LC_RETURN_PSW
1284bfc86ceSHeiko Carstens	.endm
1294bfc86ceSHeiko Carstens
1304bfc86ceSHeiko Carstens	.macro STCK savearea
1314bfc86ceSHeiko Carstens#ifdef CONFIG_HAVE_MARCH_Z9_109_FEATURES
1324bfc86ceSHeiko Carstens	.insn	s,0xb27c0000,\savearea		# store clock fast
1334bfc86ceSHeiko Carstens#else
1344bfc86ceSHeiko Carstens	.insn	s,0xb2050000,\savearea		# store clock
1354bfc86ceSHeiko Carstens#endif
1364bfc86ceSHeiko Carstens	.endm
1374bfc86ceSHeiko Carstens
13883abeffbSHendrik Brueckner	/*
13983abeffbSHendrik Brueckner	 * The TSTMSK macro generates a test-under-mask instruction by
14083abeffbSHendrik Brueckner	 * calculating the memory offset for the specified mask value.
14183abeffbSHendrik Brueckner	 * Mask value can be any constant.  The macro shifts the mask
14283abeffbSHendrik Brueckner	 * value to calculate the memory offset for the test-under-mask
14383abeffbSHendrik Brueckner	 * instruction.
14483abeffbSHendrik Brueckner	 */
14583abeffbSHendrik Brueckner	.macro TSTMSK addr, mask, size=8, bytepos=0
14683abeffbSHendrik Brueckner		.if (\bytepos < \size) && (\mask >> 8)
14783abeffbSHendrik Brueckner			.if (\mask & 0xff)
14883abeffbSHendrik Brueckner				.error "Mask exceeds byte boundary"
14983abeffbSHendrik Brueckner			.endif
15083abeffbSHendrik Brueckner			TSTMSK \addr, "(\mask >> 8)", \size, "(\bytepos + 1)"
15183abeffbSHendrik Brueckner			.exitm
15283abeffbSHendrik Brueckner		.endif
15383abeffbSHendrik Brueckner		.ifeq \mask
15483abeffbSHendrik Brueckner			.error "Mask must not be zero"
15583abeffbSHendrik Brueckner		.endif
15683abeffbSHendrik Brueckner		off = \size - \bytepos - 1
15783abeffbSHendrik Brueckner		tm	off+\addr, \mask
15883abeffbSHendrik Brueckner	.endm
15983abeffbSHendrik Brueckner
1604bfc86ceSHeiko Carstens	.section .kprobes.text, "ax"
16146210c44SHeiko Carstens.Ldummy:
16246210c44SHeiko Carstens	/*
16346210c44SHeiko Carstens	 * This nop exists only in order to avoid that __switch_to starts at
16446210c44SHeiko Carstens	 * the beginning of the kprobes text section. In that case we would
16546210c44SHeiko Carstens	 * have several symbols at the same address. E.g. objdump would take
16646210c44SHeiko Carstens	 * an arbitrary symbol name when disassembling this code.
16746210c44SHeiko Carstens	 * With the added nop in between the __switch_to symbol is unique
16846210c44SHeiko Carstens	 * again.
16946210c44SHeiko Carstens	 */
17046210c44SHeiko Carstens	nop	0
1714bfc86ceSHeiko Carstens
1724bfc86ceSHeiko Carstens/*
1734bfc86ceSHeiko Carstens * Scheduler resume function, called by switch_to
1744bfc86ceSHeiko Carstens *  gpr2 = (task_struct *) prev
1754bfc86ceSHeiko Carstens *  gpr3 = (task_struct *) next
1764bfc86ceSHeiko Carstens * Returns:
1774bfc86ceSHeiko Carstens *  gpr2 = prev
1784bfc86ceSHeiko Carstens */
1794bfc86ceSHeiko CarstensENTRY(__switch_to)
1804bfc86ceSHeiko Carstens	stmg	%r6,%r15,__SF_GPRS(%r15)	# store gprs of prev task
1813827ec3dSMartin Schwidefsky	lgr	%r1,%r2
1823827ec3dSMartin Schwidefsky	aghi	%r1,__TASK_thread		# thread_struct of prev task
183d5c352cdSHeiko Carstens	lg	%r5,__TASK_stack(%r3)		# start of kernel stack of next
1843827ec3dSMartin Schwidefsky	stg	%r15,__THREAD_ksp(%r1)		# store kernel stack of prev
1853827ec3dSMartin Schwidefsky	lgr	%r1,%r3
1863827ec3dSMartin Schwidefsky	aghi	%r1,__TASK_thread		# thread_struct of next task
1874bfc86ceSHeiko Carstens	lgr	%r15,%r5
1884bfc86ceSHeiko Carstens	aghi	%r15,STACK_INIT			# end of kernel stack of next
1894bfc86ceSHeiko Carstens	stg	%r3,__LC_CURRENT		# store task struct of next
1904bfc86ceSHeiko Carstens	stg	%r15,__LC_KERNEL_STACK		# store end of kernel stack
1913827ec3dSMartin Schwidefsky	lg	%r15,__THREAD_ksp(%r1)		# load kernel stack of next
192e22cf8caSChristian Borntraeger	mvc	__LC_CURRENT_PID(4,%r0),__TASK_pid(%r3) # store pid of next
1934bfc86ceSHeiko Carstens	lmg	%r6,%r15,__SF_GPRS(%r15)	# load gprs of next task
194e22cf8caSChristian Borntraeger	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPP
195e22cf8caSChristian Borntraeger	bzr	%r14
196e22cf8caSChristian Borntraeger	.insn	s,0xb2800000,__LC_LPP		# set program parameter
1974bfc86ceSHeiko Carstens	br	%r14
1984bfc86ceSHeiko Carstens
1994bfc86ceSHeiko Carstens.L__critical_start:
200d0fc4107SMartin Schwidefsky
201d0fc4107SMartin Schwidefsky#if IS_ENABLED(CONFIG_KVM)
202d0fc4107SMartin Schwidefsky/*
203d0fc4107SMartin Schwidefsky * sie64a calling convention:
204d0fc4107SMartin Schwidefsky * %r2 pointer to sie control block
205d0fc4107SMartin Schwidefsky * %r3 guest register save area
206d0fc4107SMartin Schwidefsky */
207d0fc4107SMartin SchwidefskyENTRY(sie64a)
208d0fc4107SMartin Schwidefsky	stmg	%r6,%r14,__SF_GPRS(%r15)	# save kernel registers
209d0fc4107SMartin Schwidefsky	stg	%r2,__SF_EMPTY(%r15)		# save control block pointer
210d0fc4107SMartin Schwidefsky	stg	%r3,__SF_EMPTY+8(%r15)		# save guest register save area
211e22cf8caSChristian Borntraeger	xc	__SF_EMPTY+16(8,%r15),__SF_EMPTY+16(%r15) # reason code = 0
21283abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU		# load guest fp/vx registers ?
213d0fc4107SMartin Schwidefsky	jno	.Lsie_load_guest_gprs
214d0fc4107SMartin Schwidefsky	brasl	%r14,load_fpu_regs		# load guest fp/vx regs
215d0fc4107SMartin Schwidefsky.Lsie_load_guest_gprs:
216d0fc4107SMartin Schwidefsky	lmg	%r0,%r13,0(%r3)			# load guest gprs 0-13
217d0fc4107SMartin Schwidefsky	lg	%r14,__LC_GMAP			# get gmap pointer
218d0fc4107SMartin Schwidefsky	ltgr	%r14,%r14
219d0fc4107SMartin Schwidefsky	jz	.Lsie_gmap
220d0fc4107SMartin Schwidefsky	lctlg	%c1,%c1,__GMAP_ASCE(%r14)	# load primary asce
221d0fc4107SMartin Schwidefsky.Lsie_gmap:
222d0fc4107SMartin Schwidefsky	lg	%r14,__SF_EMPTY(%r15)		# get control block pointer
223d0fc4107SMartin Schwidefsky	oi	__SIE_PROG0C+3(%r14),1		# we are going into SIE now
224d0fc4107SMartin Schwidefsky	tm	__SIE_PROG20+3(%r14),3		# last exit...
225d0fc4107SMartin Schwidefsky	jnz	.Lsie_skip
22683abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
227d0fc4107SMartin Schwidefsky	jo	.Lsie_skip			# exit if fp/vx regs changed
228d0fc4107SMartin Schwidefsky	sie	0(%r14)
229d0fc4107SMartin Schwidefsky.Lsie_skip:
230d0fc4107SMartin Schwidefsky	ni	__SIE_PROG0C+3(%r14),0xfe	# no longer in SIE
231d0fc4107SMartin Schwidefsky	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
232d0fc4107SMartin Schwidefsky.Lsie_done:
233d0fc4107SMartin Schwidefsky# some program checks are suppressing. C code (e.g. do_protection_exception)
234d0fc4107SMartin Schwidefsky# will rewind the PSW by the ILC, which is 4 bytes in case of SIE. Other
235d0fc4107SMartin Schwidefsky# instructions between sie64a and .Lsie_done should not cause program
236d0fc4107SMartin Schwidefsky# interrupts. So lets use a nop (47 00 00 00) as a landing pad.
237d0fc4107SMartin Schwidefsky# See also .Lcleanup_sie
238d0fc4107SMartin Schwidefsky.Lrewind_pad:
239d0fc4107SMartin Schwidefsky	nop	0
240d0fc4107SMartin Schwidefsky	.globl sie_exit
241d0fc4107SMartin Schwidefskysie_exit:
242d0fc4107SMartin Schwidefsky	lg	%r14,__SF_EMPTY+8(%r15)		# load guest register save area
243d0fc4107SMartin Schwidefsky	stmg	%r0,%r13,0(%r14)		# save guest gprs 0-13
244d0fc4107SMartin Schwidefsky	lmg	%r6,%r14,__SF_GPRS(%r15)	# restore kernel registers
245e22cf8caSChristian Borntraeger	lg	%r2,__SF_EMPTY+16(%r15)		# return exit reason code
246d0fc4107SMartin Schwidefsky	br	%r14
247d0fc4107SMartin Schwidefsky.Lsie_fault:
248d0fc4107SMartin Schwidefsky	lghi	%r14,-EFAULT
249e22cf8caSChristian Borntraeger	stg	%r14,__SF_EMPTY+16(%r15)	# set exit reason code
250d0fc4107SMartin Schwidefsky	j	sie_exit
251d0fc4107SMartin Schwidefsky
252d0fc4107SMartin Schwidefsky	EX_TABLE(.Lrewind_pad,.Lsie_fault)
253d0fc4107SMartin Schwidefsky	EX_TABLE(sie_exit,.Lsie_fault)
254711f5df7SAl ViroEXPORT_SYMBOL(sie64a)
255711f5df7SAl ViroEXPORT_SYMBOL(sie_exit)
256d0fc4107SMartin Schwidefsky#endif
257d0fc4107SMartin Schwidefsky
2584bfc86ceSHeiko Carstens/*
2594bfc86ceSHeiko Carstens * SVC interrupt handler routine. System calls are synchronous events and
2604bfc86ceSHeiko Carstens * are executed with interrupts enabled.
2614bfc86ceSHeiko Carstens */
2624bfc86ceSHeiko Carstens
2634bfc86ceSHeiko CarstensENTRY(system_call)
2644bfc86ceSHeiko Carstens	stpt	__LC_SYNC_ENTER_TIMER
2654bfc86ceSHeiko Carstens.Lsysc_stmg:
2664bfc86ceSHeiko Carstens	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
267d5c352cdSHeiko Carstens	lg	%r12,__LC_CURRENT
26834525e1fSMartin Schwidefsky	lghi	%r13,__TASK_thread
2694bfc86ceSHeiko Carstens	lghi	%r14,_PIF_SYSCALL
2704bfc86ceSHeiko Carstens.Lsysc_per:
2714bfc86ceSHeiko Carstens	lg	%r15,__LC_KERNEL_STACK
2724bfc86ceSHeiko Carstens	la	%r11,STACK_FRAME_OVERHEAD(%r15)	# pointer to pt_regs
273a359bb11SMartin Schwidefsky.Lsysc_vtime:
27434525e1fSMartin Schwidefsky	UPDATE_VTIME %r8,%r9,__LC_SYNC_ENTER_TIMER
2754bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r11)
2764bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
2774bfc86ceSHeiko Carstens	mvc	__PT_PSW(16,%r11),__LC_SVC_OLD_PSW
2784bfc86ceSHeiko Carstens	mvc	__PT_INT_CODE(4,%r11),__LC_SVC_ILC
2794bfc86ceSHeiko Carstens	stg	%r14,__PT_FLAGS(%r11)
2804bfc86ceSHeiko Carstens.Lsysc_do_svc:
281ef280c85SMartin Schwidefsky	# load address of system call table
282ef280c85SMartin Schwidefsky	lg	%r10,__THREAD_sysc_table(%r13,%r12)
2834bfc86ceSHeiko Carstens	llgh	%r8,__PT_INT_CODE+2(%r11)
2844bfc86ceSHeiko Carstens	slag	%r8,%r8,2			# shift and test for svc 0
2854bfc86ceSHeiko Carstens	jnz	.Lsysc_nr_ok
2864bfc86ceSHeiko Carstens	# svc 0: system call number in %r1
2874bfc86ceSHeiko Carstens	llgfr	%r1,%r1				# clear high word in r1
2884bfc86ceSHeiko Carstens	cghi	%r1,NR_syscalls
2894bfc86ceSHeiko Carstens	jnl	.Lsysc_nr_ok
2904bfc86ceSHeiko Carstens	sth	%r1,__PT_INT_CODE+2(%r11)
2914bfc86ceSHeiko Carstens	slag	%r8,%r1,2
2924bfc86ceSHeiko Carstens.Lsysc_nr_ok:
2934bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
2944bfc86ceSHeiko Carstens	stg	%r2,__PT_ORIG_GPR2(%r11)
2954bfc86ceSHeiko Carstens	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
2964bfc86ceSHeiko Carstens	lgf	%r9,0(%r8,%r10)			# get system call add.
29783abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_TRACE
2984bfc86ceSHeiko Carstens	jnz	.Lsysc_tracesys
2994bfc86ceSHeiko Carstens	basr	%r14,%r9			# call sys_xxxx
3004bfc86ceSHeiko Carstens	stg	%r2,__PT_R2(%r11)		# store return value
3014bfc86ceSHeiko Carstens
3024bfc86ceSHeiko Carstens.Lsysc_return:
3034bfc86ceSHeiko Carstens	LOCKDEP_SYS_EXIT
3044bfc86ceSHeiko Carstens.Lsysc_tif:
30583abeffbSHendrik Brueckner	TSTMSK	__PT_FLAGS(%r11),_PIF_WORK
3064bfc86ceSHeiko Carstens	jnz	.Lsysc_work
30783abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_WORK
3084bfc86ceSHeiko Carstens	jnz	.Lsysc_work			# check for work
30983abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
3104bfc86ceSHeiko Carstens	jnz	.Lsysc_work
3114bfc86ceSHeiko Carstens.Lsysc_restore:
3124bfc86ceSHeiko Carstens	lg	%r14,__LC_VDSO_PER_CPU
3134bfc86ceSHeiko Carstens	lmg	%r0,%r10,__PT_R0(%r11)
3144bfc86ceSHeiko Carstens	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
315*07a63cbeSMartin Schwidefsky.Lsysc_exit_timer:
3164bfc86ceSHeiko Carstens	stpt	__LC_EXIT_TIMER
3174bfc86ceSHeiko Carstens	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
3184bfc86ceSHeiko Carstens	lmg	%r11,%r15,__PT_R11(%r11)
3194bfc86ceSHeiko Carstens	lpswe	__LC_RETURN_PSW
3204bfc86ceSHeiko Carstens.Lsysc_done:
3214bfc86ceSHeiko Carstens
3224bfc86ceSHeiko Carstens#
3234bfc86ceSHeiko Carstens# One of the work bits is on. Find out which one.
3244bfc86ceSHeiko Carstens#
3254bfc86ceSHeiko Carstens.Lsysc_work:
32683abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
3274bfc86ceSHeiko Carstens	jo	.Lsysc_mcck_pending
32883abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
3294bfc86ceSHeiko Carstens	jo	.Lsysc_reschedule
3304bfc86ceSHeiko Carstens#ifdef CONFIG_UPROBES
33183abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_UPROBE
3324bfc86ceSHeiko Carstens	jo	.Lsysc_uprobe_notify
3334bfc86ceSHeiko Carstens#endif
334916cda1aSMartin Schwidefsky	TSTMSK	__TI_flags(%r12),_TIF_GUARDED_STORAGE
335916cda1aSMartin Schwidefsky	jo	.Lsysc_guarded_storage
33683abeffbSHendrik Brueckner	TSTMSK	__PT_FLAGS(%r11),_PIF_PER_TRAP
3374bfc86ceSHeiko Carstens	jo	.Lsysc_singlestep
3382f09ca60SMiroslav Benes#ifdef CONFIG_LIVEPATCH
3392f09ca60SMiroslav Benes	TSTMSK	__TI_flags(%r12),_TIF_PATCH_PENDING
3402f09ca60SMiroslav Benes	jo	.Lsysc_patch_pending	# handle live patching just before
3412f09ca60SMiroslav Benes					# signals and possible syscall restart
3422f09ca60SMiroslav Benes#endif
34383abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
3444bfc86ceSHeiko Carstens	jo	.Lsysc_sigpending
34583abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
3464bfc86ceSHeiko Carstens	jo	.Lsysc_notify_resume
34783abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
3489977e886SHendrik Brueckner	jo	.Lsysc_vxrs
349b5a882fcSHeiko Carstens	TSTMSK	__LC_CPU_FLAGS,(_CIF_ASCE_PRIMARY|_CIF_ASCE_SECONDARY)
350b5a882fcSHeiko Carstens	jnz	.Lsysc_asce
3514bfc86ceSHeiko Carstens	j	.Lsysc_return		# beware of critical section cleanup
3524bfc86ceSHeiko Carstens
3534bfc86ceSHeiko Carstens#
3544bfc86ceSHeiko Carstens# _TIF_NEED_RESCHED is set, call schedule
3554bfc86ceSHeiko Carstens#
3564bfc86ceSHeiko Carstens.Lsysc_reschedule:
3574bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_return
3584bfc86ceSHeiko Carstens	jg	schedule
3594bfc86ceSHeiko Carstens
3604bfc86ceSHeiko Carstens#
3614bfc86ceSHeiko Carstens# _CIF_MCCK_PENDING is set, call handler
3624bfc86ceSHeiko Carstens#
3634bfc86ceSHeiko Carstens.Lsysc_mcck_pending:
3644bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_return
3654bfc86ceSHeiko Carstens	jg	s390_handle_mcck	# TIF bit will be cleared by handler
3664bfc86ceSHeiko Carstens
3674bfc86ceSHeiko Carstens#
368b5a882fcSHeiko Carstens# _CIF_ASCE_PRIMARY and/or CIF_ASCE_SECONDARY set, load user space asce
3694bfc86ceSHeiko Carstens#
370b5a882fcSHeiko Carstens.Lsysc_asce:
371606aa4aaSHeiko Carstens	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_PRIMARY
3724bfc86ceSHeiko Carstens	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
373b5a882fcSHeiko Carstens	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE_SECONDARY
374b5a882fcSHeiko Carstens	jz	.Lsysc_return
375b5a882fcSHeiko Carstens	larl	%r14,.Lsysc_return
376b5a882fcSHeiko Carstens	jg	set_fs_fixup
3774bfc86ceSHeiko Carstens
3784bfc86ceSHeiko Carstens#
3799977e886SHendrik Brueckner# CIF_FPU is set, restore floating-point controls and floating-point registers.
3809977e886SHendrik Brueckner#
3819977e886SHendrik Brueckner.Lsysc_vxrs:
3829977e886SHendrik Brueckner	larl	%r14,.Lsysc_return
3839977e886SHendrik Brueckner	jg	load_fpu_regs
3849977e886SHendrik Brueckner
3859977e886SHendrik Brueckner#
3864bfc86ceSHeiko Carstens# _TIF_SIGPENDING is set, call do_signal
3874bfc86ceSHeiko Carstens#
3884bfc86ceSHeiko Carstens.Lsysc_sigpending:
3894bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
3904bfc86ceSHeiko Carstens	brasl	%r14,do_signal
39183abeffbSHendrik Brueckner	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
3924bfc86ceSHeiko Carstens	jno	.Lsysc_return
39357d7f939SMartin Schwidefsky.Lsysc_do_syscall:
39457d7f939SMartin Schwidefsky	lghi	%r13,__TASK_thread
3954bfc86ceSHeiko Carstens	lmg	%r2,%r7,__PT_R2(%r11)	# load svc arguments
39657d7f939SMartin Schwidefsky	lghi	%r1,0			# svc 0 returns -ENOSYS
39757d7f939SMartin Schwidefsky	j	.Lsysc_do_svc
3984bfc86ceSHeiko Carstens
3994bfc86ceSHeiko Carstens#
4004bfc86ceSHeiko Carstens# _TIF_NOTIFY_RESUME is set, call do_notify_resume
4014bfc86ceSHeiko Carstens#
4024bfc86ceSHeiko Carstens.Lsysc_notify_resume:
4034bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
4044bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_return
4054bfc86ceSHeiko Carstens	jg	do_notify_resume
4064bfc86ceSHeiko Carstens
4074bfc86ceSHeiko Carstens#
4084bfc86ceSHeiko Carstens# _TIF_UPROBE is set, call uprobe_notify_resume
4094bfc86ceSHeiko Carstens#
4104bfc86ceSHeiko Carstens#ifdef CONFIG_UPROBES
4114bfc86ceSHeiko Carstens.Lsysc_uprobe_notify:
4124bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
4134bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_return
4144bfc86ceSHeiko Carstens	jg	uprobe_notify_resume
4154bfc86ceSHeiko Carstens#endif
4164bfc86ceSHeiko Carstens
4174bfc86ceSHeiko Carstens#
418916cda1aSMartin Schwidefsky# _TIF_GUARDED_STORAGE is set, call guarded_storage_load
419916cda1aSMartin Schwidefsky#
420916cda1aSMartin Schwidefsky.Lsysc_guarded_storage:
421916cda1aSMartin Schwidefsky	lgr	%r2,%r11		# pass pointer to pt_regs
422916cda1aSMartin Schwidefsky	larl	%r14,.Lsysc_return
423916cda1aSMartin Schwidefsky	jg	gs_load_bc_cb
42476f1948aSLinus Torvalds#
4252f09ca60SMiroslav Benes# _TIF_PATCH_PENDING is set, call klp_update_patch_state
4262f09ca60SMiroslav Benes#
4272f09ca60SMiroslav Benes#ifdef CONFIG_LIVEPATCH
4282f09ca60SMiroslav Benes.Lsysc_patch_pending:
4292f09ca60SMiroslav Benes	lg	%r2,__LC_CURRENT	# pass pointer to task struct
4302f09ca60SMiroslav Benes	larl	%r14,.Lsysc_return
4312f09ca60SMiroslav Benes	jg	klp_update_patch_state
4322f09ca60SMiroslav Benes#endif
433916cda1aSMartin Schwidefsky
434916cda1aSMartin Schwidefsky#
4354bfc86ceSHeiko Carstens# _PIF_PER_TRAP is set, call do_per_trap
4364bfc86ceSHeiko Carstens#
4374bfc86ceSHeiko Carstens.Lsysc_singlestep:
4384bfc86ceSHeiko Carstens	ni	__PT_FLAGS+7(%r11),255-_PIF_PER_TRAP
4394bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
4404bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_return
4414bfc86ceSHeiko Carstens	jg	do_per_trap
4424bfc86ceSHeiko Carstens
4434bfc86ceSHeiko Carstens#
4444bfc86ceSHeiko Carstens# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
4454bfc86ceSHeiko Carstens# and after the system call
4464bfc86ceSHeiko Carstens#
4474bfc86ceSHeiko Carstens.Lsysc_tracesys:
4484bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
4494bfc86ceSHeiko Carstens	la	%r3,0
4504bfc86ceSHeiko Carstens	llgh	%r0,__PT_INT_CODE+2(%r11)
4514bfc86ceSHeiko Carstens	stg	%r0,__PT_R2(%r11)
4524bfc86ceSHeiko Carstens	brasl	%r14,do_syscall_trace_enter
4534bfc86ceSHeiko Carstens	lghi	%r0,NR_syscalls
4544bfc86ceSHeiko Carstens	clgr	%r0,%r2
4554bfc86ceSHeiko Carstens	jnh	.Lsysc_tracenogo
4564bfc86ceSHeiko Carstens	sllg	%r8,%r2,2
4574bfc86ceSHeiko Carstens	lgf	%r9,0(%r8,%r10)
4584bfc86ceSHeiko Carstens.Lsysc_tracego:
4594bfc86ceSHeiko Carstens	lmg	%r3,%r7,__PT_R3(%r11)
4604bfc86ceSHeiko Carstens	stg	%r7,STACK_FRAME_OVERHEAD(%r15)
4614bfc86ceSHeiko Carstens	lg	%r2,__PT_ORIG_GPR2(%r11)
4624bfc86ceSHeiko Carstens	basr	%r14,%r9		# call sys_xxx
4634bfc86ceSHeiko Carstens	stg	%r2,__PT_R2(%r11)	# store return value
4644bfc86ceSHeiko Carstens.Lsysc_tracenogo:
46583abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_TRACE
4664bfc86ceSHeiko Carstens	jz	.Lsysc_return
4674bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
4684bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_return
4694bfc86ceSHeiko Carstens	jg	do_syscall_trace_exit
4704bfc86ceSHeiko Carstens
4714bfc86ceSHeiko Carstens#
4724bfc86ceSHeiko Carstens# a new process exits the kernel with ret_from_fork
4734bfc86ceSHeiko Carstens#
4744bfc86ceSHeiko CarstensENTRY(ret_from_fork)
4754bfc86ceSHeiko Carstens	la	%r11,STACK_FRAME_OVERHEAD(%r15)
476d5c352cdSHeiko Carstens	lg	%r12,__LC_CURRENT
4774bfc86ceSHeiko Carstens	brasl	%r14,schedule_tail
4784bfc86ceSHeiko Carstens	TRACE_IRQS_ON
4794bfc86ceSHeiko Carstens	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
4804bfc86ceSHeiko Carstens	tm	__PT_PSW+1(%r11),0x01	# forking a kernel thread ?
4814bfc86ceSHeiko Carstens	jne	.Lsysc_tracenogo
4824bfc86ceSHeiko Carstens	# it's a kernel thread
4834bfc86ceSHeiko Carstens	lmg	%r9,%r10,__PT_R9(%r11)	# load gprs
4844bfc86ceSHeiko CarstensENTRY(kernel_thread_starter)
4854bfc86ceSHeiko Carstens	la	%r2,0(%r10)
4864bfc86ceSHeiko Carstens	basr	%r14,%r9
4874bfc86ceSHeiko Carstens	j	.Lsysc_tracenogo
4884bfc86ceSHeiko Carstens
4894bfc86ceSHeiko Carstens/*
4904bfc86ceSHeiko Carstens * Program check handler routine
4914bfc86ceSHeiko Carstens */
4924bfc86ceSHeiko Carstens
4934bfc86ceSHeiko CarstensENTRY(pgm_check_handler)
4944bfc86ceSHeiko Carstens	stpt	__LC_SYNC_ENTER_TIMER
4954bfc86ceSHeiko Carstens	stmg	%r8,%r15,__LC_SAVE_AREA_SYNC
4964bfc86ceSHeiko Carstens	lg	%r10,__LC_LAST_BREAK
497d5c352cdSHeiko Carstens	lg	%r12,__LC_CURRENT
4989977e886SHendrik Brueckner	larl	%r13,cleanup_critical
4994bfc86ceSHeiko Carstens	lmg	%r8,%r9,__LC_PGM_OLD_PSW
5004bfc86ceSHeiko Carstens	tmhh	%r8,0x0001		# test problem state bit
501d0fc4107SMartin Schwidefsky	jnz	2f			# -> fault in user space
502d0fc4107SMartin Schwidefsky#if IS_ENABLED(CONFIG_KVM)
503d0fc4107SMartin Schwidefsky	# cleanup critical section for sie64a
504d0fc4107SMartin Schwidefsky	lgr	%r14,%r9
505d0fc4107SMartin Schwidefsky	slg	%r14,BASED(.Lsie_critical_start)
506d0fc4107SMartin Schwidefsky	clg	%r14,BASED(.Lsie_critical_length)
507d0fc4107SMartin Schwidefsky	jhe	0f
508d0fc4107SMartin Schwidefsky	brasl	%r14,.Lcleanup_sie
509d0fc4107SMartin Schwidefsky#endif
510d0fc4107SMartin Schwidefsky0:	tmhh	%r8,0x4000		# PER bit set in old PSW ?
511d0fc4107SMartin Schwidefsky	jnz	1f			# -> enabled, can't be a double fault
5124bfc86ceSHeiko Carstens	tm	__LC_PGM_ILC+3,0x80	# check for per exception
5134bfc86ceSHeiko Carstens	jnz	.Lpgm_svcper		# -> single stepped svc
514d0fc4107SMartin Schwidefsky1:	CHECK_STACK STACK_SIZE,__LC_SAVE_AREA_SYNC
5154bfc86ceSHeiko Carstens	aghi	%r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
516d9fcf2a1SMartin Schwidefsky	j	4f
51734525e1fSMartin Schwidefsky2:	UPDATE_VTIME %r14,%r15,__LC_SYNC_ENTER_TIMER
5184bfc86ceSHeiko Carstens	lg	%r15,__LC_KERNEL_STACK
519d5c352cdSHeiko Carstens	lgr	%r14,%r12
5203827ec3dSMartin Schwidefsky	aghi	%r14,__TASK_thread	# pointer to thread_struct
5214bfc86ceSHeiko Carstens	lghi	%r13,__LC_PGM_TDB
5224bfc86ceSHeiko Carstens	tm	__LC_PGM_ILC+2,0x02	# check for transaction abort
523d0fc4107SMartin Schwidefsky	jz	3f
5244bfc86ceSHeiko Carstens	mvc	__THREAD_trap_tdb(256,%r14),0(%r13)
525d9fcf2a1SMartin Schwidefsky3:	stg	%r10,__THREAD_last_break(%r14)
526d9fcf2a1SMartin Schwidefsky4:	la	%r11,STACK_FRAME_OVERHEAD(%r15)
5274bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r11)
5284bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
5294bfc86ceSHeiko Carstens	stmg	%r8,%r9,__PT_PSW(%r11)
5304bfc86ceSHeiko Carstens	mvc	__PT_INT_CODE(4,%r11),__LC_PGM_ILC
5314bfc86ceSHeiko Carstens	mvc	__PT_INT_PARM_LONG(8,%r11),__LC_TRANS_EXC_CODE
5324bfc86ceSHeiko Carstens	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
5334bfc86ceSHeiko Carstens	stg	%r10,__PT_ARGS(%r11)
5344bfc86ceSHeiko Carstens	tm	__LC_PGM_ILC+3,0x80	# check for per exception
535d9fcf2a1SMartin Schwidefsky	jz	5f
5364bfc86ceSHeiko Carstens	tmhh	%r8,0x0001		# kernel per event ?
5374bfc86ceSHeiko Carstens	jz	.Lpgm_kprobe
5384bfc86ceSHeiko Carstens	oi	__PT_FLAGS+7(%r11),_PIF_PER_TRAP
5394bfc86ceSHeiko Carstens	mvc	__THREAD_per_address(8,%r14),__LC_PER_ADDRESS
5404bfc86ceSHeiko Carstens	mvc	__THREAD_per_cause(2,%r14),__LC_PER_CODE
5414bfc86ceSHeiko Carstens	mvc	__THREAD_per_paid(1,%r14),__LC_PER_ACCESS_ID
542d9fcf2a1SMartin Schwidefsky5:	REENABLE_IRQS
5434bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
5444bfc86ceSHeiko Carstens	larl	%r1,pgm_check_table
5454bfc86ceSHeiko Carstens	llgh	%r10,__PT_INT_CODE+2(%r11)
5464bfc86ceSHeiko Carstens	nill	%r10,0x007f
5474bfc86ceSHeiko Carstens	sll	%r10,2
548a359bb11SMartin Schwidefsky	je	.Lpgm_return
5494bfc86ceSHeiko Carstens	lgf	%r1,0(%r10,%r1)		# load address of handler routine
5504bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
5514bfc86ceSHeiko Carstens	basr	%r14,%r1		# branch to interrupt-handler
552a359bb11SMartin Schwidefsky.Lpgm_return:
553a359bb11SMartin Schwidefsky	LOCKDEP_SYS_EXIT
554a359bb11SMartin Schwidefsky	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
555a359bb11SMartin Schwidefsky	jno	.Lsysc_restore
55657d7f939SMartin Schwidefsky	TSTMSK	__PT_FLAGS(%r11),_PIF_SYSCALL
55757d7f939SMartin Schwidefsky	jo	.Lsysc_do_syscall
558a359bb11SMartin Schwidefsky	j	.Lsysc_tif
5594bfc86ceSHeiko Carstens
5604bfc86ceSHeiko Carstens#
5614bfc86ceSHeiko Carstens# PER event in supervisor state, must be kprobes
5624bfc86ceSHeiko Carstens#
5634bfc86ceSHeiko Carstens.Lpgm_kprobe:
5644bfc86ceSHeiko Carstens	REENABLE_IRQS
5654bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
5664bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
5674bfc86ceSHeiko Carstens	brasl	%r14,do_per_trap
568a359bb11SMartin Schwidefsky	j	.Lpgm_return
5694bfc86ceSHeiko Carstens
5704bfc86ceSHeiko Carstens#
5714bfc86ceSHeiko Carstens# single stepped system call
5724bfc86ceSHeiko Carstens#
5734bfc86ceSHeiko Carstens.Lpgm_svcper:
5744bfc86ceSHeiko Carstens	mvc	__LC_RETURN_PSW(8),__LC_SVC_NEW_PSW
575d24b98e3SMartin Schwidefsky	lghi	%r13,__TASK_thread
5764bfc86ceSHeiko Carstens	larl	%r14,.Lsysc_per
5774bfc86ceSHeiko Carstens	stg	%r14,__LC_RETURN_PSW+8
5784bfc86ceSHeiko Carstens	lghi	%r14,_PIF_SYSCALL | _PIF_PER_TRAP
5794bfc86ceSHeiko Carstens	lpswe	__LC_RETURN_PSW		# branch to .Lsysc_per and enable irqs
5804bfc86ceSHeiko Carstens
5814bfc86ceSHeiko Carstens/*
5824bfc86ceSHeiko Carstens * IO interrupt handler routine
5834bfc86ceSHeiko Carstens */
5844bfc86ceSHeiko CarstensENTRY(io_int_handler)
5854bfc86ceSHeiko Carstens	STCK	__LC_INT_CLOCK
5864bfc86ceSHeiko Carstens	stpt	__LC_ASYNC_ENTER_TIMER
5874bfc86ceSHeiko Carstens	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
588d5c352cdSHeiko Carstens	lg	%r12,__LC_CURRENT
5899977e886SHendrik Brueckner	larl	%r13,cleanup_critical
5904bfc86ceSHeiko Carstens	lmg	%r8,%r9,__LC_IO_OLD_PSW
5912acb94f4SMartin Schwidefsky	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
5924bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r11)
5934bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
5944bfc86ceSHeiko Carstens	stmg	%r8,%r9,__PT_PSW(%r11)
5954bfc86ceSHeiko Carstens	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
5964bfc86ceSHeiko Carstens	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
597db7e007fSHeiko Carstens	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
598db7e007fSHeiko Carstens	jo	.Lio_restore
5994bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
6004bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
6014bfc86ceSHeiko Carstens.Lio_loop:
6024bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
6034bfc86ceSHeiko Carstens	lghi	%r3,IO_INTERRUPT
6044bfc86ceSHeiko Carstens	tm	__PT_INT_CODE+8(%r11),0x80	# adapter interrupt ?
6054bfc86ceSHeiko Carstens	jz	.Lio_call
6064bfc86ceSHeiko Carstens	lghi	%r3,THIN_INTERRUPT
6074bfc86ceSHeiko Carstens.Lio_call:
6084bfc86ceSHeiko Carstens	brasl	%r14,do_IRQ
60983abeffbSHendrik Brueckner	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPAR
6104bfc86ceSHeiko Carstens	jz	.Lio_return
6114bfc86ceSHeiko Carstens	tpi	0
6124bfc86ceSHeiko Carstens	jz	.Lio_return
6134bfc86ceSHeiko Carstens	mvc	__PT_INT_CODE(12,%r11),__LC_SUBCHANNEL_ID
6144bfc86ceSHeiko Carstens	j	.Lio_loop
6154bfc86ceSHeiko Carstens.Lio_return:
6164bfc86ceSHeiko Carstens	LOCKDEP_SYS_EXIT
6174bfc86ceSHeiko Carstens	TRACE_IRQS_ON
6184bfc86ceSHeiko Carstens.Lio_tif:
61983abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_WORK
6204bfc86ceSHeiko Carstens	jnz	.Lio_work		# there is work to do (signals etc.)
62183abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_WORK
6224bfc86ceSHeiko Carstens	jnz	.Lio_work
6234bfc86ceSHeiko Carstens.Lio_restore:
6244bfc86ceSHeiko Carstens	lg	%r14,__LC_VDSO_PER_CPU
6254bfc86ceSHeiko Carstens	lmg	%r0,%r10,__PT_R0(%r11)
6264bfc86ceSHeiko Carstens	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r11)
627*07a63cbeSMartin Schwidefsky.Lio_exit_timer:
6284bfc86ceSHeiko Carstens	stpt	__LC_EXIT_TIMER
6294bfc86ceSHeiko Carstens	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
6304bfc86ceSHeiko Carstens	lmg	%r11,%r15,__PT_R11(%r11)
6314bfc86ceSHeiko Carstens	lpswe	__LC_RETURN_PSW
6324bfc86ceSHeiko Carstens.Lio_done:
6334bfc86ceSHeiko Carstens
6344bfc86ceSHeiko Carstens#
6354bfc86ceSHeiko Carstens# There is work todo, find out in which context we have been interrupted:
6364bfc86ceSHeiko Carstens# 1) if we return to user space we can do all _TIF_WORK work
6374bfc86ceSHeiko Carstens# 2) if we return to kernel code and kvm is enabled check if we need to
6384bfc86ceSHeiko Carstens#    modify the psw to leave SIE
6394bfc86ceSHeiko Carstens# 3) if we return to kernel code and preemptive scheduling is enabled check
6404bfc86ceSHeiko Carstens#    the preemption counter and if it is zero call preempt_schedule_irq
6414bfc86ceSHeiko Carstens# Before any work can be done, a switch to the kernel stack is required.
6424bfc86ceSHeiko Carstens#
6434bfc86ceSHeiko Carstens.Lio_work:
6444bfc86ceSHeiko Carstens	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
6454bfc86ceSHeiko Carstens	jo	.Lio_work_user		# yes -> do resched & signal
6464bfc86ceSHeiko Carstens#ifdef CONFIG_PREEMPT
6474bfc86ceSHeiko Carstens	# check for preemptive scheduling
648c360192bSMartin Schwidefsky	icm	%r0,15,__LC_PREEMPT_COUNT
6494bfc86ceSHeiko Carstens	jnz	.Lio_restore		# preemption is disabled
65083abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
6514bfc86ceSHeiko Carstens	jno	.Lio_restore
6524bfc86ceSHeiko Carstens	# switch to kernel stack
6534bfc86ceSHeiko Carstens	lg	%r1,__PT_R15(%r11)
6544bfc86ceSHeiko Carstens	aghi	%r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
6554bfc86ceSHeiko Carstens	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
6564bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
6574bfc86ceSHeiko Carstens	la	%r11,STACK_FRAME_OVERHEAD(%r1)
6584bfc86ceSHeiko Carstens	lgr	%r15,%r1
6594bfc86ceSHeiko Carstens	# TRACE_IRQS_ON already done at .Lio_return, call
6604bfc86ceSHeiko Carstens	# TRACE_IRQS_OFF to keep things symmetrical
6614bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
6624bfc86ceSHeiko Carstens	brasl	%r14,preempt_schedule_irq
6634bfc86ceSHeiko Carstens	j	.Lio_return
6644bfc86ceSHeiko Carstens#else
6654bfc86ceSHeiko Carstens	j	.Lio_restore
6664bfc86ceSHeiko Carstens#endif
6674bfc86ceSHeiko Carstens
6684bfc86ceSHeiko Carstens#
6694bfc86ceSHeiko Carstens# Need to do work before returning to userspace, switch to kernel stack
6704bfc86ceSHeiko Carstens#
6714bfc86ceSHeiko Carstens.Lio_work_user:
6724bfc86ceSHeiko Carstens	lg	%r1,__LC_KERNEL_STACK
6734bfc86ceSHeiko Carstens	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
6744bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
6754bfc86ceSHeiko Carstens	la	%r11,STACK_FRAME_OVERHEAD(%r1)
6764bfc86ceSHeiko Carstens	lgr	%r15,%r1
6774bfc86ceSHeiko Carstens
6784bfc86ceSHeiko Carstens#
6794bfc86ceSHeiko Carstens# One of the work bits is on. Find out which one.
6804bfc86ceSHeiko Carstens#
6814bfc86ceSHeiko Carstens.Lio_work_tif:
68283abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
6834bfc86ceSHeiko Carstens	jo	.Lio_mcck_pending
68483abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_NEED_RESCHED
6854bfc86ceSHeiko Carstens	jo	.Lio_reschedule
6862f09ca60SMiroslav Benes#ifdef CONFIG_LIVEPATCH
6872f09ca60SMiroslav Benes	TSTMSK	__TI_flags(%r12),_TIF_PATCH_PENDING
6882f09ca60SMiroslav Benes	jo	.Lio_patch_pending
6892f09ca60SMiroslav Benes#endif
69083abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_SIGPENDING
6914bfc86ceSHeiko Carstens	jo	.Lio_sigpending
69283abeffbSHendrik Brueckner	TSTMSK	__TI_flags(%r12),_TIF_NOTIFY_RESUME
6934bfc86ceSHeiko Carstens	jo	.Lio_notify_resume
694916cda1aSMartin Schwidefsky	TSTMSK	__TI_flags(%r12),_TIF_GUARDED_STORAGE
695916cda1aSMartin Schwidefsky	jo	.Lio_guarded_storage
69683abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
6979977e886SHendrik Brueckner	jo	.Lio_vxrs
698b5a882fcSHeiko Carstens	TSTMSK	__LC_CPU_FLAGS,(_CIF_ASCE_PRIMARY|_CIF_ASCE_SECONDARY)
699b5a882fcSHeiko Carstens	jnz	.Lio_asce
7004bfc86ceSHeiko Carstens	j	.Lio_return		# beware of critical section cleanup
7014bfc86ceSHeiko Carstens
7024bfc86ceSHeiko Carstens#
7034bfc86ceSHeiko Carstens# _CIF_MCCK_PENDING is set, call handler
7044bfc86ceSHeiko Carstens#
7054bfc86ceSHeiko Carstens.Lio_mcck_pending:
7064bfc86ceSHeiko Carstens	# TRACE_IRQS_ON already done at .Lio_return
7074bfc86ceSHeiko Carstens	brasl	%r14,s390_handle_mcck	# TIF bit will be cleared by handler
7084bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
7094bfc86ceSHeiko Carstens	j	.Lio_return
7104bfc86ceSHeiko Carstens
7114bfc86ceSHeiko Carstens#
712b5a882fcSHeiko Carstens# _CIF_ASCE_PRIMARY and/or CIF_ASCE_SECONDARY set, load user space asce
7134bfc86ceSHeiko Carstens#
714b5a882fcSHeiko Carstens.Lio_asce:
715606aa4aaSHeiko Carstens	ni	__LC_CPU_FLAGS+7,255-_CIF_ASCE_PRIMARY
7164bfc86ceSHeiko Carstens	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
717b5a882fcSHeiko Carstens	TSTMSK	__LC_CPU_FLAGS,_CIF_ASCE_SECONDARY
718b5a882fcSHeiko Carstens	jz	.Lio_return
719b5a882fcSHeiko Carstens	larl	%r14,.Lio_return
720b5a882fcSHeiko Carstens	jg	set_fs_fixup
7214bfc86ceSHeiko Carstens
7224bfc86ceSHeiko Carstens#
7239977e886SHendrik Brueckner# CIF_FPU is set, restore floating-point controls and floating-point registers.
7249977e886SHendrik Brueckner#
7259977e886SHendrik Brueckner.Lio_vxrs:
7269977e886SHendrik Brueckner	larl	%r14,.Lio_return
7279977e886SHendrik Brueckner	jg	load_fpu_regs
7289977e886SHendrik Brueckner
7299977e886SHendrik Brueckner#
730916cda1aSMartin Schwidefsky# _TIF_GUARDED_STORAGE is set, call guarded_storage_load
731916cda1aSMartin Schwidefsky#
732916cda1aSMartin Schwidefsky.Lio_guarded_storage:
733916cda1aSMartin Schwidefsky	# TRACE_IRQS_ON already done at .Lio_return
734916cda1aSMartin Schwidefsky	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
735916cda1aSMartin Schwidefsky	lgr	%r2,%r11		# pass pointer to pt_regs
736916cda1aSMartin Schwidefsky	brasl	%r14,gs_load_bc_cb
737916cda1aSMartin Schwidefsky	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
738916cda1aSMartin Schwidefsky	TRACE_IRQS_OFF
739916cda1aSMartin Schwidefsky	j	.Lio_return
740916cda1aSMartin Schwidefsky
741916cda1aSMartin Schwidefsky#
7424bfc86ceSHeiko Carstens# _TIF_NEED_RESCHED is set, call schedule
7434bfc86ceSHeiko Carstens#
7444bfc86ceSHeiko Carstens.Lio_reschedule:
7454bfc86ceSHeiko Carstens	# TRACE_IRQS_ON already done at .Lio_return
7464bfc86ceSHeiko Carstens	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
7474bfc86ceSHeiko Carstens	brasl	%r14,schedule		# call scheduler
7484bfc86ceSHeiko Carstens	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
7494bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
7504bfc86ceSHeiko Carstens	j	.Lio_return
7514bfc86ceSHeiko Carstens
7524bfc86ceSHeiko Carstens#
7532f09ca60SMiroslav Benes# _TIF_PATCH_PENDING is set, call klp_update_patch_state
7542f09ca60SMiroslav Benes#
7552f09ca60SMiroslav Benes#ifdef CONFIG_LIVEPATCH
7562f09ca60SMiroslav Benes.Lio_patch_pending:
7572f09ca60SMiroslav Benes	lg	%r2,__LC_CURRENT	# pass pointer to task struct
7582f09ca60SMiroslav Benes	larl	%r14,.Lio_return
7592f09ca60SMiroslav Benes	jg	klp_update_patch_state
7602f09ca60SMiroslav Benes#endif
7612f09ca60SMiroslav Benes
7622f09ca60SMiroslav Benes#
7634bfc86ceSHeiko Carstens# _TIF_SIGPENDING or is set, call do_signal
7644bfc86ceSHeiko Carstens#
7654bfc86ceSHeiko Carstens.Lio_sigpending:
7664bfc86ceSHeiko Carstens	# TRACE_IRQS_ON already done at .Lio_return
7674bfc86ceSHeiko Carstens	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
7684bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
7694bfc86ceSHeiko Carstens	brasl	%r14,do_signal
7704bfc86ceSHeiko Carstens	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
7714bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
7724bfc86ceSHeiko Carstens	j	.Lio_return
7734bfc86ceSHeiko Carstens
7744bfc86ceSHeiko Carstens#
7754bfc86ceSHeiko Carstens# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
7764bfc86ceSHeiko Carstens#
7774bfc86ceSHeiko Carstens.Lio_notify_resume:
7784bfc86ceSHeiko Carstens	# TRACE_IRQS_ON already done at .Lio_return
7794bfc86ceSHeiko Carstens	ssm	__LC_SVC_NEW_PSW	# reenable interrupts
7804bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
7814bfc86ceSHeiko Carstens	brasl	%r14,do_notify_resume
7824bfc86ceSHeiko Carstens	ssm	__LC_PGM_NEW_PSW	# disable I/O and ext. interrupts
7834bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
7844bfc86ceSHeiko Carstens	j	.Lio_return
7854bfc86ceSHeiko Carstens
7864bfc86ceSHeiko Carstens/*
7874bfc86ceSHeiko Carstens * External interrupt handler routine
7884bfc86ceSHeiko Carstens */
7894bfc86ceSHeiko CarstensENTRY(ext_int_handler)
7904bfc86ceSHeiko Carstens	STCK	__LC_INT_CLOCK
7914bfc86ceSHeiko Carstens	stpt	__LC_ASYNC_ENTER_TIMER
7924bfc86ceSHeiko Carstens	stmg	%r8,%r15,__LC_SAVE_AREA_ASYNC
793d5c352cdSHeiko Carstens	lg	%r12,__LC_CURRENT
7949977e886SHendrik Brueckner	larl	%r13,cleanup_critical
7954bfc86ceSHeiko Carstens	lmg	%r8,%r9,__LC_EXT_OLD_PSW
7962acb94f4SMartin Schwidefsky	SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_ENTER_TIMER
7974bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r11)
7984bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
7994bfc86ceSHeiko Carstens	stmg	%r8,%r9,__PT_PSW(%r11)
8004bfc86ceSHeiko Carstens	lghi	%r1,__LC_EXT_PARAMS2
8014bfc86ceSHeiko Carstens	mvc	__PT_INT_CODE(4,%r11),__LC_EXT_CPU_ADDR
8024bfc86ceSHeiko Carstens	mvc	__PT_INT_PARM(4,%r11),__LC_EXT_PARAMS
8034bfc86ceSHeiko Carstens	mvc	__PT_INT_PARM_LONG(8,%r11),0(%r1)
8044bfc86ceSHeiko Carstens	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
805db7e007fSHeiko Carstens	TSTMSK	__LC_CPU_FLAGS,_CIF_IGNORE_IRQ
806db7e007fSHeiko Carstens	jo	.Lio_restore
8074bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
8084bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
8094bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
8104bfc86ceSHeiko Carstens	lghi	%r3,EXT_INTERRUPT
8114bfc86ceSHeiko Carstens	brasl	%r14,do_IRQ
8124bfc86ceSHeiko Carstens	j	.Lio_return
8134bfc86ceSHeiko Carstens
8144bfc86ceSHeiko Carstens/*
8154bfc86ceSHeiko Carstens * Load idle PSW. The second "half" of this function is in .Lcleanup_idle.
8164bfc86ceSHeiko Carstens */
8174bfc86ceSHeiko CarstensENTRY(psw_idle)
8184bfc86ceSHeiko Carstens	stg	%r3,__SF_EMPTY(%r15)
8194bfc86ceSHeiko Carstens	larl	%r1,.Lpsw_idle_lpsw+4
8204bfc86ceSHeiko Carstens	stg	%r1,__SF_EMPTY+8(%r15)
82172d38b19SMartin Schwidefsky#ifdef CONFIG_SMP
82272d38b19SMartin Schwidefsky	larl	%r1,smp_cpu_mtid
82372d38b19SMartin Schwidefsky	llgf	%r1,0(%r1)
82472d38b19SMartin Schwidefsky	ltgr	%r1,%r1
82572d38b19SMartin Schwidefsky	jz	.Lpsw_idle_stcctm
82672d38b19SMartin Schwidefsky	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+16(%r15)
82772d38b19SMartin Schwidefsky.Lpsw_idle_stcctm:
82872d38b19SMartin Schwidefsky#endif
829419123f9SMartin Schwidefsky	oi	__LC_CPU_FLAGS+7,_CIF_ENABLED_WAIT
8304bfc86ceSHeiko Carstens	STCK	__CLOCK_IDLE_ENTER(%r2)
8314bfc86ceSHeiko Carstens	stpt	__TIMER_IDLE_ENTER(%r2)
8324bfc86ceSHeiko Carstens.Lpsw_idle_lpsw:
8334bfc86ceSHeiko Carstens	lpswe	__SF_EMPTY(%r15)
8344bfc86ceSHeiko Carstens	br	%r14
8354bfc86ceSHeiko Carstens.Lpsw_idle_end:
8364bfc86ceSHeiko Carstens
837b5510d9bSHendrik Brueckner/*
838b5510d9bSHendrik Brueckner * Store floating-point controls and floating-point or vector register
839b5510d9bSHendrik Brueckner * depending whether the vector facility is available.	A critical section
840b5510d9bSHendrik Brueckner * cleanup assures that the registers are stored even if interrupted for
841b5510d9bSHendrik Brueckner * some other work.  The CIF_FPU flag is set to trigger a lazy restore
842b5510d9bSHendrik Brueckner * of the register contents at return from io or a system call.
8439977e886SHendrik Brueckner */
8449977e886SHendrik BruecknerENTRY(save_fpu_regs)
845d0164ee2SHendrik Brueckner	lg	%r2,__LC_CURRENT
846d0164ee2SHendrik Brueckner	aghi	%r2,__TASK_thread
84783abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
8489977e886SHendrik Brueckner	bor	%r14
849d0164ee2SHendrik Brueckner	stfpc	__THREAD_FPU_fpc(%r2)
850d0164ee2SHendrik Brueckner	lg	%r3,__THREAD_FPU_regs(%r2)
85183abeffbSHendrik Brueckner	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
8529977e886SHendrik Brueckner	jz	.Lsave_fpu_regs_fp	  # no -> store FP regs
8539977e886SHendrik Brueckner	VSTM	%v0,%v15,0,%r3		  # vstm 0,15,0(3)
8549977e886SHendrik Brueckner	VSTM	%v16,%v31,256,%r3	  # vstm 16,31,256(3)
8559977e886SHendrik Brueckner	j	.Lsave_fpu_regs_done	  # -> set CIF_FPU flag
8569977e886SHendrik Brueckner.Lsave_fpu_regs_fp:
8579977e886SHendrik Brueckner	std	0,0(%r3)
8589977e886SHendrik Brueckner	std	1,8(%r3)
8599977e886SHendrik Brueckner	std	2,16(%r3)
8609977e886SHendrik Brueckner	std	3,24(%r3)
8619977e886SHendrik Brueckner	std	4,32(%r3)
8629977e886SHendrik Brueckner	std	5,40(%r3)
8639977e886SHendrik Brueckner	std	6,48(%r3)
8649977e886SHendrik Brueckner	std	7,56(%r3)
8659977e886SHendrik Brueckner	std	8,64(%r3)
8669977e886SHendrik Brueckner	std	9,72(%r3)
8679977e886SHendrik Brueckner	std	10,80(%r3)
8689977e886SHendrik Brueckner	std	11,88(%r3)
8699977e886SHendrik Brueckner	std	12,96(%r3)
8709977e886SHendrik Brueckner	std	13,104(%r3)
8719977e886SHendrik Brueckner	std	14,112(%r3)
8729977e886SHendrik Brueckner	std	15,120(%r3)
8739977e886SHendrik Brueckner.Lsave_fpu_regs_done:
8749977e886SHendrik Brueckner	oi	__LC_CPU_FLAGS+7,_CIF_FPU
8759977e886SHendrik Brueckner	br	%r14
8769977e886SHendrik Brueckner.Lsave_fpu_regs_end:
877711f5df7SAl Viro#if IS_ENABLED(CONFIG_KVM)
878711f5df7SAl ViroEXPORT_SYMBOL(save_fpu_regs)
879711f5df7SAl Viro#endif
8809977e886SHendrik Brueckner
881b5510d9bSHendrik Brueckner/*
882b5510d9bSHendrik Brueckner * Load floating-point controls and floating-point or vector registers.
883b5510d9bSHendrik Brueckner * A critical section cleanup assures that the register contents are
884b5510d9bSHendrik Brueckner * loaded even if interrupted for some other work.
8859977e886SHendrik Brueckner *
8869977e886SHendrik Brueckner * There are special calling conventions to fit into sysc and io return work:
8879977e886SHendrik Brueckner *	%r15:	<kernel stack>
8889977e886SHendrik Brueckner * The function requires:
889b5510d9bSHendrik Brueckner *	%r4
8909977e886SHendrik Brueckner */
8919977e886SHendrik Bruecknerload_fpu_regs:
892d0164ee2SHendrik Brueckner	lg	%r4,__LC_CURRENT
893d0164ee2SHendrik Brueckner	aghi	%r4,__TASK_thread
89483abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_FPU
8959977e886SHendrik Brueckner	bnor	%r14
896d0164ee2SHendrik Brueckner	lfpc	__THREAD_FPU_fpc(%r4)
89783abeffbSHendrik Brueckner	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_VX
898d0164ee2SHendrik Brueckner	lg	%r4,__THREAD_FPU_regs(%r4)	# %r4 <- reg save area
899b5510d9bSHendrik Brueckner	jz	.Lload_fpu_regs_fp		# -> no VX, load FP regs
9009977e886SHendrik Brueckner	VLM	%v0,%v15,0,%r4
9019977e886SHendrik Brueckner	VLM	%v16,%v31,256,%r4
9029977e886SHendrik Brueckner	j	.Lload_fpu_regs_done
9039977e886SHendrik Brueckner.Lload_fpu_regs_fp:
9049977e886SHendrik Brueckner	ld	0,0(%r4)
9059977e886SHendrik Brueckner	ld	1,8(%r4)
9069977e886SHendrik Brueckner	ld	2,16(%r4)
9079977e886SHendrik Brueckner	ld	3,24(%r4)
9089977e886SHendrik Brueckner	ld	4,32(%r4)
9099977e886SHendrik Brueckner	ld	5,40(%r4)
9109977e886SHendrik Brueckner	ld	6,48(%r4)
9119977e886SHendrik Brueckner	ld	7,56(%r4)
9129977e886SHendrik Brueckner	ld	8,64(%r4)
9139977e886SHendrik Brueckner	ld	9,72(%r4)
9149977e886SHendrik Brueckner	ld	10,80(%r4)
9159977e886SHendrik Brueckner	ld	11,88(%r4)
9169977e886SHendrik Brueckner	ld	12,96(%r4)
9179977e886SHendrik Brueckner	ld	13,104(%r4)
9189977e886SHendrik Brueckner	ld	14,112(%r4)
9199977e886SHendrik Brueckner	ld	15,120(%r4)
9209977e886SHendrik Brueckner.Lload_fpu_regs_done:
9219977e886SHendrik Brueckner	ni	__LC_CPU_FLAGS+7,255-_CIF_FPU
9229977e886SHendrik Brueckner	br	%r14
9239977e886SHendrik Brueckner.Lload_fpu_regs_end:
9249977e886SHendrik Brueckner
9254bfc86ceSHeiko Carstens.L__critical_end:
9264bfc86ceSHeiko Carstens
9274bfc86ceSHeiko Carstens/*
9284bfc86ceSHeiko Carstens * Machine check handler routines
9294bfc86ceSHeiko Carstens */
9304bfc86ceSHeiko CarstensENTRY(mcck_int_handler)
9314bfc86ceSHeiko Carstens	STCK	__LC_MCCK_CLOCK
9324bfc86ceSHeiko Carstens	la	%r1,4095		# revalidate r1
9334bfc86ceSHeiko Carstens	spt	__LC_CPU_TIMER_SAVE_AREA-4095(%r1)	# revalidate cpu timer
9344bfc86ceSHeiko Carstens	lmg	%r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
935d5c352cdSHeiko Carstens	lg	%r12,__LC_CURRENT
9369977e886SHendrik Brueckner	larl	%r13,cleanup_critical
9374bfc86ceSHeiko Carstens	lmg	%r8,%r9,__LC_MCK_OLD_PSW
93883abeffbSHendrik Brueckner	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_SYSTEM_DAMAGE
9394bfc86ceSHeiko Carstens	jo	.Lmcck_panic		# yes -> rest of mcck code invalid
9404bfc86ceSHeiko Carstens	lghi	%r14,__LC_CPU_TIMER_SAVE_AREA
9414bfc86ceSHeiko Carstens	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
94283abeffbSHendrik Brueckner	TSTMSK	__LC_MCCK_CODE,MCCK_CODE_CPU_TIMER_VALID
9434bfc86ceSHeiko Carstens	jo	3f
9444bfc86ceSHeiko Carstens	la	%r14,__LC_SYNC_ENTER_TIMER
9454bfc86ceSHeiko Carstens	clc	0(8,%r14),__LC_ASYNC_ENTER_TIMER
9464bfc86ceSHeiko Carstens	jl	0f
9474bfc86ceSHeiko Carstens	la	%r14,__LC_ASYNC_ENTER_TIMER
9484bfc86ceSHeiko Carstens0:	clc	0(8,%r14),__LC_EXIT_TIMER
9494bfc86ceSHeiko Carstens	jl	1f
9504bfc86ceSHeiko Carstens	la	%r14,__LC_EXIT_TIMER
9514bfc86ceSHeiko Carstens1:	clc	0(8,%r14),__LC_LAST_UPDATE_TIMER
9524bfc86ceSHeiko Carstens	jl	2f
9534bfc86ceSHeiko Carstens	la	%r14,__LC_LAST_UPDATE_TIMER
9544bfc86ceSHeiko Carstens2:	spt	0(%r14)
9554bfc86ceSHeiko Carstens	mvc	__LC_MCCK_ENTER_TIMER(8),0(%r14)
95683abeffbSHendrik Brueckner3:	TSTMSK	__LC_MCCK_CODE,(MCCK_CODE_PSW_MWP_VALID|MCCK_CODE_PSW_IA_VALID)
9574bfc86ceSHeiko Carstens	jno	.Lmcck_panic		# no -> skip cleanup critical
9582acb94f4SMartin Schwidefsky	SWITCH_ASYNC __LC_GPREGS_SAVE_AREA+64,__LC_MCCK_ENTER_TIMER
9594bfc86ceSHeiko Carstens.Lmcck_skip:
9604bfc86ceSHeiko Carstens	lghi	%r14,__LC_GPREGS_SAVE_AREA+64
9614bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r11)
9624bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r11),0(%r14)
9634bfc86ceSHeiko Carstens	stmg	%r8,%r9,__PT_PSW(%r11)
9644bfc86ceSHeiko Carstens	xc	__PT_FLAGS(8,%r11),__PT_FLAGS(%r11)
9654bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
9664bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
9674bfc86ceSHeiko Carstens	brasl	%r14,s390_do_machine_check
9684bfc86ceSHeiko Carstens	tm	__PT_PSW+1(%r11),0x01	# returning to user ?
9694bfc86ceSHeiko Carstens	jno	.Lmcck_return
9704bfc86ceSHeiko Carstens	lg	%r1,__LC_KERNEL_STACK	# switch to kernel stack
9714bfc86ceSHeiko Carstens	mvc	STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
9724bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
9734bfc86ceSHeiko Carstens	la	%r11,STACK_FRAME_OVERHEAD(%r1)
9744bfc86ceSHeiko Carstens	lgr	%r15,%r1
9754bfc86ceSHeiko Carstens	ssm	__LC_PGM_NEW_PSW	# turn dat on, keep irqs off
97683abeffbSHendrik Brueckner	TSTMSK	__LC_CPU_FLAGS,_CIF_MCCK_PENDING
9774bfc86ceSHeiko Carstens	jno	.Lmcck_return
9784bfc86ceSHeiko Carstens	TRACE_IRQS_OFF
9794bfc86ceSHeiko Carstens	brasl	%r14,s390_handle_mcck
9804bfc86ceSHeiko Carstens	TRACE_IRQS_ON
9814bfc86ceSHeiko Carstens.Lmcck_return:
9824bfc86ceSHeiko Carstens	lg	%r14,__LC_VDSO_PER_CPU
9834bfc86ceSHeiko Carstens	lmg	%r0,%r10,__PT_R0(%r11)
9844bfc86ceSHeiko Carstens	mvc	__LC_RETURN_MCCK_PSW(16),__PT_PSW(%r11) # move return PSW
9854bfc86ceSHeiko Carstens	tm	__LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
9864bfc86ceSHeiko Carstens	jno	0f
9874bfc86ceSHeiko Carstens	stpt	__LC_EXIT_TIMER
9884bfc86ceSHeiko Carstens	mvc	__VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
9894bfc86ceSHeiko Carstens0:	lmg	%r11,%r15,__PT_R11(%r11)
9904bfc86ceSHeiko Carstens	lpswe	__LC_RETURN_MCCK_PSW
9914bfc86ceSHeiko Carstens
9924bfc86ceSHeiko Carstens.Lmcck_panic:
9934bfc86ceSHeiko Carstens	lg	%r15,__LC_PANIC_STACK
994ce4dda3fSMartin Schwidefsky	la	%r11,STACK_FRAME_OVERHEAD(%r15)
9954bfc86ceSHeiko Carstens	j	.Lmcck_skip
9964bfc86ceSHeiko Carstens
9974bfc86ceSHeiko Carstens#
9984bfc86ceSHeiko Carstens# PSW restart interrupt handler
9994bfc86ceSHeiko Carstens#
10004bfc86ceSHeiko CarstensENTRY(restart_int_handler)
1001e22cf8caSChristian Borntraeger	TSTMSK	__LC_MACHINE_FLAGS,MACHINE_FLAG_LPP
1002e22cf8caSChristian Borntraeger	jz	0f
1003e22cf8caSChristian Borntraeger	.insn	s,0xb2800000,__LC_LPP
1004e22cf8caSChristian Borntraeger0:	stg	%r15,__LC_SAVE_AREA_RESTART
10054bfc86ceSHeiko Carstens	lg	%r15,__LC_RESTART_STACK
10064bfc86ceSHeiko Carstens	aghi	%r15,-__PT_SIZE			# create pt_regs on stack
10074bfc86ceSHeiko Carstens	xc	0(__PT_SIZE,%r15),0(%r15)
10084bfc86ceSHeiko Carstens	stmg	%r0,%r14,__PT_R0(%r15)
10094bfc86ceSHeiko Carstens	mvc	__PT_R15(8,%r15),__LC_SAVE_AREA_RESTART
10104bfc86ceSHeiko Carstens	mvc	__PT_PSW(16,%r15),__LC_RST_OLD_PSW # store restart old psw
10114bfc86ceSHeiko Carstens	aghi	%r15,-STACK_FRAME_OVERHEAD	# create stack frame on stack
10124bfc86ceSHeiko Carstens	xc	0(STACK_FRAME_OVERHEAD,%r15),0(%r15)
10134bfc86ceSHeiko Carstens	lg	%r1,__LC_RESTART_FN		# load fn, parm & source cpu
10144bfc86ceSHeiko Carstens	lg	%r2,__LC_RESTART_DATA
10154bfc86ceSHeiko Carstens	lg	%r3,__LC_RESTART_SOURCE
10164bfc86ceSHeiko Carstens	ltgr	%r3,%r3				# test source cpu address
10174bfc86ceSHeiko Carstens	jm	1f				# negative -> skip source stop
10184bfc86ceSHeiko Carstens0:	sigp	%r4,%r3,SIGP_SENSE		# sigp sense to source cpu
10194bfc86ceSHeiko Carstens	brc	10,0b				# wait for status stored
10204bfc86ceSHeiko Carstens1:	basr	%r14,%r1			# call function
10214bfc86ceSHeiko Carstens	stap	__SF_EMPTY(%r15)		# store cpu address
10224bfc86ceSHeiko Carstens	llgh	%r3,__SF_EMPTY(%r15)
10234bfc86ceSHeiko Carstens2:	sigp	%r4,%r3,SIGP_STOP		# sigp stop to current cpu
10244bfc86ceSHeiko Carstens	brc	2,2b
10254bfc86ceSHeiko Carstens3:	j	3b
10264bfc86ceSHeiko Carstens
10274bfc86ceSHeiko Carstens	.section .kprobes.text, "ax"
10284bfc86ceSHeiko Carstens
10294bfc86ceSHeiko Carstens#ifdef CONFIG_CHECK_STACK
10304bfc86ceSHeiko Carstens/*
10314bfc86ceSHeiko Carstens * The synchronous or the asynchronous stack overflowed. We are dead.
10324bfc86ceSHeiko Carstens * No need to properly save the registers, we are going to panic anyway.
10334bfc86ceSHeiko Carstens * Setup a pt_regs so that show_trace can provide a good call trace.
10344bfc86ceSHeiko Carstens */
10354bfc86ceSHeiko Carstensstack_overflow:
10364bfc86ceSHeiko Carstens	lg	%r15,__LC_PANIC_STACK	# change to panic stack
10374bfc86ceSHeiko Carstens	la	%r11,STACK_FRAME_OVERHEAD(%r15)
10384bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r11)
10394bfc86ceSHeiko Carstens	stmg	%r8,%r9,__PT_PSW(%r11)
10404bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r11),0(%r14)
10414bfc86ceSHeiko Carstens	stg	%r10,__PT_ORIG_GPR2(%r11) # store last break to orig_gpr2
10424bfc86ceSHeiko Carstens	xc	__SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
10434bfc86ceSHeiko Carstens	lgr	%r2,%r11		# pass pointer to pt_regs
10444bfc86ceSHeiko Carstens	jg	kernel_stack_overflow
10454bfc86ceSHeiko Carstens#endif
10464bfc86ceSHeiko Carstens
10474bfc86ceSHeiko Carstenscleanup_critical:
1048d0fc4107SMartin Schwidefsky#if IS_ENABLED(CONFIG_KVM)
1049d0fc4107SMartin Schwidefsky	clg	%r9,BASED(.Lcleanup_table_sie)	# .Lsie_gmap
1050d0fc4107SMartin Schwidefsky	jl	0f
1051d0fc4107SMartin Schwidefsky	clg	%r9,BASED(.Lcleanup_table_sie+8)# .Lsie_done
1052d0fc4107SMartin Schwidefsky	jl	.Lcleanup_sie
1053d0fc4107SMartin Schwidefsky#endif
10544bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table)	# system_call
10554bfc86ceSHeiko Carstens	jl	0f
10564bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+8)	# .Lsysc_do_svc
10574bfc86ceSHeiko Carstens	jl	.Lcleanup_system_call
10584bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+16)	# .Lsysc_tif
10594bfc86ceSHeiko Carstens	jl	0f
10604bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+24)	# .Lsysc_restore
10614bfc86ceSHeiko Carstens	jl	.Lcleanup_sysc_tif
10624bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+32)	# .Lsysc_done
10634bfc86ceSHeiko Carstens	jl	.Lcleanup_sysc_restore
10644bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+40)	# .Lio_tif
10654bfc86ceSHeiko Carstens	jl	0f
10664bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+48)	# .Lio_restore
10674bfc86ceSHeiko Carstens	jl	.Lcleanup_io_tif
10684bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+56)	# .Lio_done
10694bfc86ceSHeiko Carstens	jl	.Lcleanup_io_restore
10704bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+64)	# psw_idle
10714bfc86ceSHeiko Carstens	jl	0f
10724bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_table+72)	# .Lpsw_idle_end
10734bfc86ceSHeiko Carstens	jl	.Lcleanup_idle
10749977e886SHendrik Brueckner	clg	%r9,BASED(.Lcleanup_table+80)	# save_fpu_regs
10759977e886SHendrik Brueckner	jl	0f
10769977e886SHendrik Brueckner	clg	%r9,BASED(.Lcleanup_table+88)	# .Lsave_fpu_regs_end
10779977e886SHendrik Brueckner	jl	.Lcleanup_save_fpu_regs
10789977e886SHendrik Brueckner	clg	%r9,BASED(.Lcleanup_table+96)	# load_fpu_regs
10799977e886SHendrik Brueckner	jl	0f
10809977e886SHendrik Brueckner	clg	%r9,BASED(.Lcleanup_table+104)	# .Lload_fpu_regs_end
10819977e886SHendrik Brueckner	jl	.Lcleanup_load_fpu_regs
10824bfc86ceSHeiko Carstens0:	br	%r14
10834bfc86ceSHeiko Carstens
1084d0fc4107SMartin Schwidefsky	.align	8
1085d0fc4107SMartin Schwidefsky.Lcleanup_table:
1086d0fc4107SMartin Schwidefsky	.quad	system_call
1087d0fc4107SMartin Schwidefsky	.quad	.Lsysc_do_svc
1088d0fc4107SMartin Schwidefsky	.quad	.Lsysc_tif
1089d0fc4107SMartin Schwidefsky	.quad	.Lsysc_restore
1090d0fc4107SMartin Schwidefsky	.quad	.Lsysc_done
1091d0fc4107SMartin Schwidefsky	.quad	.Lio_tif
1092d0fc4107SMartin Schwidefsky	.quad	.Lio_restore
1093d0fc4107SMartin Schwidefsky	.quad	.Lio_done
1094d0fc4107SMartin Schwidefsky	.quad	psw_idle
1095d0fc4107SMartin Schwidefsky	.quad	.Lpsw_idle_end
1096d0fc4107SMartin Schwidefsky	.quad	save_fpu_regs
1097d0fc4107SMartin Schwidefsky	.quad	.Lsave_fpu_regs_end
1098d0fc4107SMartin Schwidefsky	.quad	load_fpu_regs
1099d0fc4107SMartin Schwidefsky	.quad	.Lload_fpu_regs_end
1100d0fc4107SMartin Schwidefsky
1101d0fc4107SMartin Schwidefsky#if IS_ENABLED(CONFIG_KVM)
1102d0fc4107SMartin Schwidefsky.Lcleanup_table_sie:
1103d0fc4107SMartin Schwidefsky	.quad	.Lsie_gmap
1104d0fc4107SMartin Schwidefsky	.quad	.Lsie_done
1105d0fc4107SMartin Schwidefsky
1106d0fc4107SMartin Schwidefsky.Lcleanup_sie:
1107d0fc4107SMartin Schwidefsky	lg	%r9,__SF_EMPTY(%r15)		# get control block pointer
1108e22cf8caSChristian Borntraeger	ni	__SIE_PROG0C+3(%r9),0xfe	# no longer in SIE
1109d0fc4107SMartin Schwidefsky	lctlg	%c1,%c1,__LC_USER_ASCE		# load primary asce
1110d0fc4107SMartin Schwidefsky	larl	%r9,sie_exit			# skip forward to sie_exit
1111d0fc4107SMartin Schwidefsky	br	%r14
1112d0fc4107SMartin Schwidefsky#endif
11134bfc86ceSHeiko Carstens
11144bfc86ceSHeiko Carstens.Lcleanup_system_call:
11154bfc86ceSHeiko Carstens	# check if stpt has been executed
11164bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_system_call_insn)
11174bfc86ceSHeiko Carstens	jh	0f
11184bfc86ceSHeiko Carstens	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
11194bfc86ceSHeiko Carstens	cghi	%r11,__LC_SAVE_AREA_ASYNC
11204bfc86ceSHeiko Carstens	je	0f
11214bfc86ceSHeiko Carstens	mvc	__LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
11224bfc86ceSHeiko Carstens0:	# check if stmg has been executed
11234bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_system_call_insn+8)
11244bfc86ceSHeiko Carstens	jh	0f
11254bfc86ceSHeiko Carstens	mvc	__LC_SAVE_AREA_SYNC(64),0(%r11)
11264bfc86ceSHeiko Carstens0:	# check if base register setup + TIF bit load has been done
11274bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_system_call_insn+16)
11284bfc86ceSHeiko Carstens	jhe	0f
112934525e1fSMartin Schwidefsky	# set up saved register r12 task struct pointer
113034525e1fSMartin Schwidefsky	stg	%r12,32(%r11)
113134525e1fSMartin Schwidefsky	# set up saved register r13 __TASK_thread offset
113234525e1fSMartin Schwidefsky	mvc	40(8,%r11),BASED(.Lcleanup_system_call_const)
11334bfc86ceSHeiko Carstens0:	# check if the user time update has been done
11344bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_system_call_insn+24)
11354bfc86ceSHeiko Carstens	jh	0f
11364bfc86ceSHeiko Carstens	lg	%r15,__LC_EXIT_TIMER
11374bfc86ceSHeiko Carstens	slg	%r15,__LC_SYNC_ENTER_TIMER
11384bfc86ceSHeiko Carstens	alg	%r15,__LC_USER_TIMER
11394bfc86ceSHeiko Carstens	stg	%r15,__LC_USER_TIMER
11404bfc86ceSHeiko Carstens0:	# check if the system time update has been done
11414bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_system_call_insn+32)
11424bfc86ceSHeiko Carstens	jh	0f
11434bfc86ceSHeiko Carstens	lg	%r15,__LC_LAST_UPDATE_TIMER
11444bfc86ceSHeiko Carstens	slg	%r15,__LC_EXIT_TIMER
11454bfc86ceSHeiko Carstens	alg	%r15,__LC_SYSTEM_TIMER
11464bfc86ceSHeiko Carstens	stg	%r15,__LC_SYSTEM_TIMER
11474bfc86ceSHeiko Carstens0:	# update accounting time stamp
11484bfc86ceSHeiko Carstens	mvc	__LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
114934525e1fSMartin Schwidefsky	# set up saved register r11
11504bfc86ceSHeiko Carstens	lg	%r15,__LC_KERNEL_STACK
11514bfc86ceSHeiko Carstens	la	%r9,STACK_FRAME_OVERHEAD(%r15)
11524bfc86ceSHeiko Carstens	stg	%r9,24(%r11)		# r11 pt_regs pointer
11534bfc86ceSHeiko Carstens	# fill pt_regs
11544bfc86ceSHeiko Carstens	mvc	__PT_R8(64,%r9),__LC_SAVE_AREA_SYNC
11554bfc86ceSHeiko Carstens	stmg	%r0,%r7,__PT_R0(%r9)
11564bfc86ceSHeiko Carstens	mvc	__PT_PSW(16,%r9),__LC_SVC_OLD_PSW
11574bfc86ceSHeiko Carstens	mvc	__PT_INT_CODE(4,%r9),__LC_SVC_ILC
11584bfc86ceSHeiko Carstens	xc	__PT_FLAGS(8,%r9),__PT_FLAGS(%r9)
11594bfc86ceSHeiko Carstens	mvi	__PT_FLAGS+7(%r9),_PIF_SYSCALL
11604bfc86ceSHeiko Carstens	# setup saved register r15
11614bfc86ceSHeiko Carstens	stg	%r15,56(%r11)		# r15 stack pointer
11624bfc86ceSHeiko Carstens	# set new psw address and exit
11634bfc86ceSHeiko Carstens	larl	%r9,.Lsysc_do_svc
11644bfc86ceSHeiko Carstens	br	%r14
11654bfc86ceSHeiko Carstens.Lcleanup_system_call_insn:
11664bfc86ceSHeiko Carstens	.quad	system_call
11674bfc86ceSHeiko Carstens	.quad	.Lsysc_stmg
11684bfc86ceSHeiko Carstens	.quad	.Lsysc_per
1169a359bb11SMartin Schwidefsky	.quad	.Lsysc_vtime+36
11704bfc86ceSHeiko Carstens	.quad	.Lsysc_vtime+42
117134525e1fSMartin Schwidefsky.Lcleanup_system_call_const:
117234525e1fSMartin Schwidefsky	.quad	__TASK_thread
11734bfc86ceSHeiko Carstens
11744bfc86ceSHeiko Carstens.Lcleanup_sysc_tif:
11754bfc86ceSHeiko Carstens	larl	%r9,.Lsysc_tif
11764bfc86ceSHeiko Carstens	br	%r14
11774bfc86ceSHeiko Carstens
11784bfc86ceSHeiko Carstens.Lcleanup_sysc_restore:
1179*07a63cbeSMartin Schwidefsky	# check if stpt has been executed
11804bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_sysc_restore_insn)
1181*07a63cbeSMartin Schwidefsky	jh	0f
1182*07a63cbeSMartin Schwidefsky	mvc	__LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
1183*07a63cbeSMartin Schwidefsky	cghi	%r11,__LC_SAVE_AREA_ASYNC
11844bfc86ceSHeiko Carstens	je	0f
1185*07a63cbeSMartin Schwidefsky	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
1186*07a63cbeSMartin Schwidefsky0:	clg	%r9,BASED(.Lcleanup_sysc_restore_insn+8)
1187*07a63cbeSMartin Schwidefsky	je	1f
11884bfc86ceSHeiko Carstens	lg	%r9,24(%r11)		# get saved pointer to pt_regs
11894bfc86ceSHeiko Carstens	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
11904bfc86ceSHeiko Carstens	mvc	0(64,%r11),__PT_R8(%r9)
11914bfc86ceSHeiko Carstens	lmg	%r0,%r7,__PT_R0(%r9)
1192*07a63cbeSMartin Schwidefsky1:	lmg	%r8,%r9,__LC_RETURN_PSW
11934bfc86ceSHeiko Carstens	br	%r14
11944bfc86ceSHeiko Carstens.Lcleanup_sysc_restore_insn:
1195*07a63cbeSMartin Schwidefsky	.quad	.Lsysc_exit_timer
11964bfc86ceSHeiko Carstens	.quad	.Lsysc_done - 4
11974bfc86ceSHeiko Carstens
11984bfc86ceSHeiko Carstens.Lcleanup_io_tif:
11994bfc86ceSHeiko Carstens	larl	%r9,.Lio_tif
12004bfc86ceSHeiko Carstens	br	%r14
12014bfc86ceSHeiko Carstens
12024bfc86ceSHeiko Carstens.Lcleanup_io_restore:
1203*07a63cbeSMartin Schwidefsky	# check if stpt has been executed
12044bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_io_restore_insn)
1205*07a63cbeSMartin Schwidefsky	jh	0f
1206*07a63cbeSMartin Schwidefsky	mvc	__LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
1207*07a63cbeSMartin Schwidefsky0:	clg	%r9,BASED(.Lcleanup_io_restore_insn+8)
1208*07a63cbeSMartin Schwidefsky	je	1f
12094bfc86ceSHeiko Carstens	lg	%r9,24(%r11)		# get saved r11 pointer to pt_regs
12104bfc86ceSHeiko Carstens	mvc	__LC_RETURN_PSW(16),__PT_PSW(%r9)
12114bfc86ceSHeiko Carstens	mvc	0(64,%r11),__PT_R8(%r9)
12124bfc86ceSHeiko Carstens	lmg	%r0,%r7,__PT_R0(%r9)
1213*07a63cbeSMartin Schwidefsky1:	lmg	%r8,%r9,__LC_RETURN_PSW
12144bfc86ceSHeiko Carstens	br	%r14
12154bfc86ceSHeiko Carstens.Lcleanup_io_restore_insn:
1216*07a63cbeSMartin Schwidefsky	.quad	.Lio_exit_timer
12174bfc86ceSHeiko Carstens	.quad	.Lio_done - 4
12184bfc86ceSHeiko Carstens
12194bfc86ceSHeiko Carstens.Lcleanup_idle:
1220419123f9SMartin Schwidefsky	ni	__LC_CPU_FLAGS+7,255-_CIF_ENABLED_WAIT
12214bfc86ceSHeiko Carstens	# copy interrupt clock & cpu timer
12224bfc86ceSHeiko Carstens	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_INT_CLOCK
12234bfc86ceSHeiko Carstens	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_ASYNC_ENTER_TIMER
12244bfc86ceSHeiko Carstens	cghi	%r11,__LC_SAVE_AREA_ASYNC
12254bfc86ceSHeiko Carstens	je	0f
12264bfc86ceSHeiko Carstens	mvc	__CLOCK_IDLE_EXIT(8,%r2),__LC_MCCK_CLOCK
12274bfc86ceSHeiko Carstens	mvc	__TIMER_IDLE_EXIT(8,%r2),__LC_MCCK_ENTER_TIMER
12284bfc86ceSHeiko Carstens0:	# check if stck & stpt have been executed
12294bfc86ceSHeiko Carstens	clg	%r9,BASED(.Lcleanup_idle_insn)
12304bfc86ceSHeiko Carstens	jhe	1f
12314bfc86ceSHeiko Carstens	mvc	__CLOCK_IDLE_ENTER(8,%r2),__CLOCK_IDLE_EXIT(%r2)
12324bfc86ceSHeiko Carstens	mvc	__TIMER_IDLE_ENTER(8,%r2),__TIMER_IDLE_EXIT(%r2)
123372d38b19SMartin Schwidefsky1:	# calculate idle cycles
123472d38b19SMartin Schwidefsky#ifdef CONFIG_SMP
123572d38b19SMartin Schwidefsky	clg	%r9,BASED(.Lcleanup_idle_insn)
123672d38b19SMartin Schwidefsky	jl	3f
123772d38b19SMartin Schwidefsky	larl	%r1,smp_cpu_mtid
123872d38b19SMartin Schwidefsky	llgf	%r1,0(%r1)
123972d38b19SMartin Schwidefsky	ltgr	%r1,%r1
124072d38b19SMartin Schwidefsky	jz	3f
124172d38b19SMartin Schwidefsky	.insn	rsy,0xeb0000000017,%r1,5,__SF_EMPTY+80(%r15)
124272d38b19SMartin Schwidefsky	larl	%r3,mt_cycles
124372d38b19SMartin Schwidefsky	ag	%r3,__LC_PERCPU_OFFSET
124472d38b19SMartin Schwidefsky	la	%r4,__SF_EMPTY+16(%r15)
124572d38b19SMartin Schwidefsky2:	lg	%r0,0(%r3)
124672d38b19SMartin Schwidefsky	slg	%r0,0(%r4)
124772d38b19SMartin Schwidefsky	alg	%r0,64(%r4)
124872d38b19SMartin Schwidefsky	stg	%r0,0(%r3)
124972d38b19SMartin Schwidefsky	la	%r3,8(%r3)
125072d38b19SMartin Schwidefsky	la	%r4,8(%r4)
125172d38b19SMartin Schwidefsky	brct	%r1,2b
125272d38b19SMartin Schwidefsky#endif
125372d38b19SMartin Schwidefsky3:	# account system time going idle
12544bfc86ceSHeiko Carstens	lg	%r9,__LC_STEAL_TIMER
12554bfc86ceSHeiko Carstens	alg	%r9,__CLOCK_IDLE_ENTER(%r2)
12564bfc86ceSHeiko Carstens	slg	%r9,__LC_LAST_UPDATE_CLOCK
12574bfc86ceSHeiko Carstens	stg	%r9,__LC_STEAL_TIMER
12584bfc86ceSHeiko Carstens	mvc	__LC_LAST_UPDATE_CLOCK(8),__CLOCK_IDLE_EXIT(%r2)
12594bfc86ceSHeiko Carstens	lg	%r9,__LC_SYSTEM_TIMER
12604bfc86ceSHeiko Carstens	alg	%r9,__LC_LAST_UPDATE_TIMER
12614bfc86ceSHeiko Carstens	slg	%r9,__TIMER_IDLE_ENTER(%r2)
12624bfc86ceSHeiko Carstens	stg	%r9,__LC_SYSTEM_TIMER
12634bfc86ceSHeiko Carstens	mvc	__LC_LAST_UPDATE_TIMER(8),__TIMER_IDLE_EXIT(%r2)
12644bfc86ceSHeiko Carstens	# prepare return psw
12654bfc86ceSHeiko Carstens	nihh	%r8,0xfcfd		# clear irq & wait state bits
12664bfc86ceSHeiko Carstens	lg	%r9,48(%r11)		# return from psw_idle
12674bfc86ceSHeiko Carstens	br	%r14
12684bfc86ceSHeiko Carstens.Lcleanup_idle_insn:
12694bfc86ceSHeiko Carstens	.quad	.Lpsw_idle_lpsw
12704bfc86ceSHeiko Carstens
12719977e886SHendrik Brueckner.Lcleanup_save_fpu_regs:
1272e370e476SMartin Schwidefsky	larl	%r9,save_fpu_regs
12739977e886SHendrik Brueckner	br	%r14
12749977e886SHendrik Brueckner
12759977e886SHendrik Brueckner.Lcleanup_load_fpu_regs:
1276e370e476SMartin Schwidefsky	larl	%r9,load_fpu_regs
12779977e886SHendrik Brueckner	br	%r14
12789977e886SHendrik Brueckner
12794bfc86ceSHeiko Carstens/*
12804bfc86ceSHeiko Carstens * Integer constants
12814bfc86ceSHeiko Carstens */
12824bfc86ceSHeiko Carstens	.align	8
12834bfc86ceSHeiko Carstens.Lcritical_start:
12844bfc86ceSHeiko Carstens	.quad	.L__critical_start
12854bfc86ceSHeiko Carstens.Lcritical_length:
12864bfc86ceSHeiko Carstens	.quad	.L__critical_end - .L__critical_start
12874bfc86ceSHeiko Carstens#if IS_ENABLED(CONFIG_KVM)
1288d0fc4107SMartin Schwidefsky.Lsie_critical_start:
12894bfc86ceSHeiko Carstens	.quad	.Lsie_gmap
12904bfc86ceSHeiko Carstens.Lsie_critical_length:
12914bfc86ceSHeiko Carstens	.quad	.Lsie_done - .Lsie_gmap
12924bfc86ceSHeiko Carstens#endif
12934bfc86ceSHeiko Carstens
12944bfc86ceSHeiko Carstens	.section .rodata, "a"
1295a876cb3fSHeiko Carstens#define SYSCALL(esame,emu)	.long esame
12964bfc86ceSHeiko Carstens	.globl	sys_call_table
12974bfc86ceSHeiko Carstenssys_call_table:
12984bfc86ceSHeiko Carstens#include "syscalls.S"
12994bfc86ceSHeiko Carstens#undef SYSCALL
13004bfc86ceSHeiko Carstens
13014bfc86ceSHeiko Carstens#ifdef CONFIG_COMPAT
13024bfc86ceSHeiko Carstens
1303a876cb3fSHeiko Carstens#define SYSCALL(esame,emu)	.long emu
13044bfc86ceSHeiko Carstens	.globl	sys_call_table_emu
13054bfc86ceSHeiko Carstenssys_call_table_emu:
13064bfc86ceSHeiko Carstens#include "syscalls.S"
13074bfc86ceSHeiko Carstens#undef SYSCALL
13084bfc86ceSHeiko Carstens#endif
1309