blob: ab596a865300f317709cc42dd37e1ccb19dd52a1 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Heiko Carstens54dfe5d2006-02-01 03:06:38 -08002 * arch/s390/kernel/entry64.S
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 * S390 low-level entry points.
4 *
Carsten Ottecd3b70f2010-05-17 10:00:04 +02005 * Copyright (C) IBM Corp. 1999,2010
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
Heiko Carstens25d83cb2006-09-28 16:56:37 +02007 * Hartmut Penner (hp@de.ibm.com),
8 * Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
Heiko Carstens77fa2242005-06-25 14:55:30 -07009 * Heiko Carstens <heiko.carstens@de.ibm.com>
Linus Torvalds1da177e2005-04-16 15:20:36 -070010 */
11
Linus Torvalds1da177e2005-04-16 15:20:36 -070012#include <linux/linkage.h>
Heiko Carstens2bc89b52008-02-05 16:50:40 +010013#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070014#include <asm/cache.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <asm/errno.h>
16#include <asm/ptrace.h>
17#include <asm/thread_info.h>
Sam Ravnborg0013a852005-09-09 20:57:26 +020018#include <asm/asm-offsets.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070019#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 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +020026SP_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 + 8
31SP_R2 = STACK_FRAME_OVERHEAD + __PT_GPRS + 16
32SP_R3 = STACK_FRAME_OVERHEAD + __PT_GPRS + 24
33SP_R4 = STACK_FRAME_OVERHEAD + __PT_GPRS + 32
34SP_R5 = STACK_FRAME_OVERHEAD + __PT_GPRS + 40
35SP_R6 = STACK_FRAME_OVERHEAD + __PT_GPRS + 48
36SP_R7 = STACK_FRAME_OVERHEAD + __PT_GPRS + 56
37SP_R8 = STACK_FRAME_OVERHEAD + __PT_GPRS + 64
38SP_R9 = STACK_FRAME_OVERHEAD + __PT_GPRS + 72
39SP_R10 = STACK_FRAME_OVERHEAD + __PT_GPRS + 80
40SP_R11 = STACK_FRAME_OVERHEAD + __PT_GPRS + 88
41SP_R12 = STACK_FRAME_OVERHEAD + __PT_GPRS + 96
42SP_R13 = STACK_FRAME_OVERHEAD + __PT_GPRS + 104
43SP_R14 = STACK_FRAME_OVERHEAD + __PT_GPRS + 112
44SP_R15 = STACK_FRAME_OVERHEAD + __PT_GPRS + 120
45SP_ORIG_R2 = STACK_FRAME_OVERHEAD + __PT_ORIG_GPR2
46SP_ILC = STACK_FRAME_OVERHEAD + __PT_ILC
Martin Schwidefsky59da2132008-11-27 11:05:55 +010047SP_SVCNR = STACK_FRAME_OVERHEAD + __PT_SVCNR
Heiko Carstens25d83cb2006-09-28 16:56:37 +020048SP_SIZE = STACK_FRAME_OVERHEAD + __PT_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -070049
50STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
51STACK_SIZE = 1 << STACK_SHIFT
52
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +020053_TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +010054 _TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_PER_TRAP )
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +020055_TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
Heiko Carstens54dfe5d2006-02-01 03:06:38 -080056 _TIF_MCCK_PENDING)
Heiko Carstens9bf12262009-06-12 10:26:47 +020057_TIF_SYSCALL = (_TIF_SYSCALL_TRACE>>8 | _TIF_SYSCALL_AUDIT>>8 | \
Josh Stone66700002009-08-24 14:43:11 -070058 _TIF_SECCOMP>>8 | _TIF_SYSCALL_TRACEPOINT>>8)
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020059_TIF_EXIT_SIE = (_TIF_SIGPENDING | _TIF_NEED_RESCHED | _TIF_MCCK_PENDING)
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
61#define BASED(name) name-system_call(%r13)
62
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020063 .macro SPP newpp
64#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
65 tm __LC_MACHINE_FLAGS+6,0x20 # MACHINE_FLAG_SPP
66 jz .+8
67 .insn s,0xb2800000,\newpp
68#endif
69 .endm
70
Carsten Ottecd3b70f2010-05-17 10:00:04 +020071 .macro HANDLE_SIE_INTERCEPT
72#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020073 tm __TI_flags+6(%r12),_TIF_SIE>>8
Carsten Ottecd3b70f2010-05-17 10:00:04 +020074 jz 0f
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020075 SPP __LC_CMF_HPP # set host id
76 clc SP_PSW+8(8,%r15),BASED(.Lsie_loop)
77 jl 0f
78 clc SP_PSW+8(8,%r15),BASED(.Lsie_done)
79 jhe 0f
80 mvc SP_PSW+8(8,%r15),BASED(.Lsie_loop)
Heiko Carstens2ffbb3f2010-05-26 23:26:21 +0200810:
Carsten Ottecd3b70f2010-05-17 10:00:04 +020082#endif
83 .endm
84
Heiko Carstens1f194a42006-07-03 00:24:46 -070085#ifdef CONFIG_TRACE_IRQFLAGS
86 .macro TRACE_IRQS_ON
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +020087 basr %r2,%r0
88 brasl %r14,trace_hardirqs_on_caller
Heiko Carstens1f194a42006-07-03 00:24:46 -070089 .endm
90
91 .macro TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +020092 basr %r2,%r0
93 brasl %r14,trace_hardirqs_off_caller
Heiko Carstens1f194a42006-07-03 00:24:46 -070094 .endm
95#else
96#define TRACE_IRQS_ON
97#define TRACE_IRQS_OFF
Heiko Carstens411788e2007-11-20 11:13:32 +010098#endif
99
100#ifdef CONFIG_LOCKDEP
101 .macro LOCKDEP_SYS_EXIT
102 tm SP_PSW+1(%r15),0x01 # returning to user ?
103 jz 0f
104 brasl %r14,lockdep_sys_exit
1050:
106 .endm
107#else
Heiko Carstens523b44c2007-10-11 22:11:12 +0200108#define LOCKDEP_SYS_EXIT
Heiko Carstens1f194a42006-07-03 00:24:46 -0700109#endif
110
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200111 .macro UPDATE_VTIME lc_from,lc_to,lc_sum
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 lg %r10,\lc_from
113 slg %r10,\lc_to
114 alg %r10,\lc_sum
115 stg %r10,\lc_sum
116 .endm
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
118/*
119 * Register usage in interrupt handlers:
120 * R9 - pointer to current task structure
121 * R13 - pointer to literal pool
122 * R14 - return register for function calls
123 * R15 - kernel stack pointer
124 */
125
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200126 .macro SAVE_ALL_SVC psworg,savearea
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200127 stmg %r11,%r15,\savearea
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200128 lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200129 aghi %r15,-SP_SIZE # make room for registers & psw
130 lg %r11,__LC_LAST_BREAK
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200131 .endm
132
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200133 .macro SAVE_ALL_PGM psworg,savearea
134 stmg %r11,%r15,\savearea
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 tm \psworg+1,0x01 # test problem state bit
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200136#ifdef CONFIG_CHECK_STACK
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200137 jnz 1f
138 tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
139 jnz 2f
140 la %r12,\psworg
141 j stack_overflow
142#else
143 jz 2f
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200144#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001451: lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
1462: aghi %r15,-SP_SIZE # make room for registers & psw
147 larl %r13,system_call
148 lg %r11,__LC_LAST_BREAK
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200149 .endm
150
151 .macro SAVE_ALL_ASYNC psworg,savearea
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200152 stmg %r11,%r15,\savearea
153 larl %r13,system_call
154 lg %r11,__LC_LAST_BREAK
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200155 la %r12,\psworg
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156 tm \psworg+1,0x01 # test problem state bit
157 jnz 1f # from user -> load kernel stack
158 clc \psworg+8(8),BASED(.Lcritical_end)
159 jhe 0f
160 clc \psworg+8(8),BASED(.Lcritical_start)
161 jl 0f
162 brasl %r14,cleanup_critical
Peter Oberparleiter6add9f72005-09-16 19:27:42 -0700163 tm 1(%r12),0x01 # retest problem state after cleanup
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164 jnz 1f
1650: lg %r14,__LC_ASYNC_STACK # are we already on the async. stack ?
166 slgr %r14,%r15
167 srag %r14,%r14,STACK_SHIFT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168#ifdef CONFIG_CHECK_STACK
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200169 jnz 1f
170 tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
171 jnz 2f
172 j stack_overflow
173#else
174 jz 2f
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001761: lg %r15,__LC_ASYNC_STACK # load async stack
1772: aghi %r15,-SP_SIZE # make room for registers & psw
Heiko Carstens77fa2242005-06-25 14:55:30 -0700178 .endm
179
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200180 .macro CREATE_STACK_FRAME savearea
181 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 stg %r2,SP_ORIG_R2(%r15) # store original content of gpr 2
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200183 mvc SP_R11(40,%r15),\savearea # move %r11-%r15 to stack
184 stmg %r0,%r10,SP_R0(%r15) # store gprs %r0-%r10 to kernel stack
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200185 .endm
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700187 .macro RESTORE_ALL psworg,sync
188 mvc \psworg(16),SP_PSW(%r15) # move user PSW to lowcore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 .if !\sync
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700190 ni \psworg+1,0xfd # clear wait state bit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191 .endif
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100192 lg %r14,__LC_VDSO_PER_CPU
193 lmg %r0,%r13,SP_R0(%r15) # load gprs 0-13 of user
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100194 stpt __LC_EXIT_TIMER
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100195 mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
196 lmg %r14,%r15,SP_R14(%r15) # load grps 14-15 of user
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700197 lpswe \psworg # back to caller
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 .endm
199
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200200 .macro LAST_BREAK
201 srag %r10,%r11,23
202 jz 0f
203 stg %r11,__TI_last_break(%r12)
2040:
205 .endm
206
Martin Schwidefsky1e546222010-10-25 16:10:37 +0200207 .macro REENABLE_IRQS
208 mvc __SF_EMPTY(1,%r15),SP_PSW(%r15)
209 ni __SF_EMPTY(%r15),0xbf
210 ssm __SF_EMPTY(%r15)
211 .endm
212
Martin Schwidefsky860dba42011-01-05 12:47:25 +0100213 .section .kprobes.text, "ax"
214
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215/*
216 * Scheduler resume function, called by switch_to
217 * gpr2 = (task_struct *) prev
218 * gpr3 = (task_struct *) next
219 * Returns:
220 * gpr2 = prev
221 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200222 .globl __switch_to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223__switch_to:
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100224 lg %r4,__THREAD_info(%r2) # get thread_info of prev
225 lg %r5,__THREAD_info(%r3) # get thread_info of next
Heiko Carstens77fa2242005-06-25 14:55:30 -0700226 tm __TI_flags+7(%r4),_TIF_MCCK_PENDING # machine check pending?
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100227 jz 0f
228 ni __TI_flags+7(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
229 oi __TI_flags+7(%r5),_TIF_MCCK_PENDING # set it in next
2300: stmg %r6,%r15,__SF_GPRS(%r15) # store gprs of prev task
231 stg %r15,__THREAD_ksp(%r2) # store kernel stack of prev
232 lg %r15,__THREAD_ksp(%r3) # load kernel stack of next
233 lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
234 lmg %r6,%r15,__SF_GPRS(%r15) # load gprs of next task
235 stg %r3,__LC_CURRENT # store task struct of next
Heiko Carstensf2db2e62011-05-23 10:24:34 +0200236 mvc __LC_CURRENT_PID+4(4,%r0),__TASK_pid(%r3) # store pid of next
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100237 stg %r5,__LC_THREAD_INFO # store thread info of next
238 aghi %r5,STACK_SIZE # end of kernel stack of next
239 stg %r5,__LC_KERNEL_STACK # store end of kernel stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 br %r14
241
242__critical_start:
243/*
244 * SVC interrupt handler routine. System calls are synchronous events and
245 * are executed with interrupts enabled.
246 */
247
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200248 .globl system_call
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249system_call:
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100250 stpt __LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251sysc_saveall:
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200252 SAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200253 CREATE_STACK_FRAME __LC_SAVE_AREA
254 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
255 mvc SP_ILC(4,%r15),__LC_SVC_ILC
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200256 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257sysc_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700258 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
259sysc_stime:
260 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
261sysc_update:
262 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200263 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264sysc_do_svc:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200265 llgh %r7,SP_SVCNR(%r15)
266 slag %r7,%r7,2 # shift and test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 jnz sysc_nr_ok
268 # svc 0: system call number in %r1
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200269 llgfr %r1,%r1 # clear high word in r1
270 cghi %r1,NR_syscalls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 jnl sysc_nr_ok
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200272 sth %r1,SP_SVCNR(%r15)
273 slag %r7,%r1,2 # shift and test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274sysc_nr_ok:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200275 larl %r10,sys_call_table
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800276#ifdef CONFIG_COMPAT
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200277 tm __TI_flags+5(%r12),(_TIF_31BIT>>16) # running in 31 bit mode ?
Heiko Carstensc5630772005-09-03 15:58:04 -0700278 jno sysc_noemu
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200279 larl %r10,sys_call_table_emu # use 31 bit emulation system calls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280sysc_noemu:
281#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200282 tm __TI_flags+6(%r12),_TIF_SYSCALL
Martin Schwidefskybaa07152010-10-25 16:10:40 +0200283 mvc SP_ARGS(8,%r15),SP_R7(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200284 lgf %r8,0(%r7,%r10) # load address of system call routine
285 jnz sysc_tracesys
286 basr %r14,%r8 # call sys_xxxx
287 stg %r2,SP_R2(%r15) # store return value (change R2 on stack)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288
289sysc_return:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200290 LOCKDEP_SYS_EXIT
291sysc_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200292 tm __TI_flags+7(%r12),_TIF_WORK_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200293 jnz sysc_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100294sysc_restore:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200295 RESTORE_ALL __LC_RETURN_PSW,1
Heiko Carstens411788e2007-11-20 11:13:32 +0100296sysc_done:
297
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298#
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200299# There is work to do, but first we need to check if we return to userspace.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300#
301sysc_work:
Martin Schwidefsky26889052008-05-07 09:22:52 +0200302 tm SP_PSW+1(%r15),0x01 # returning to user ?
303 jno sysc_restore
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200304
305#
306# One of the work bits is on. Find out which one.
307#
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200308sysc_work_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200309 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700310 jo sysc_mcck_pending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200311 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312 jo sysc_reschedule
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200313 tm __TI_flags+7(%r12),_TIF_SIGPENDING
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200314 jo sysc_sigpending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200315 tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200316 jo sysc_notify_resume
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200317 tm __TI_flags+7(%r12),_TIF_RESTART_SVC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 jo sysc_restart
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100319 tm __TI_flags+7(%r12),_TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 jo sysc_singlestep
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200321 j sysc_return # beware of critical section cleanup
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322
323#
324# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200325#
326sysc_reschedule:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200327 larl %r14,sysc_return
328 jg schedule # return point is sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329
330#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700331# _TIF_MCCK_PENDING is set, call handler
332#
333sysc_mcck_pending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200334 larl %r14,sysc_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200335 jg s390_handle_mcck # TIF bit will be cleared by handler
Heiko Carstens77fa2242005-06-25 14:55:30 -0700336
337#
Roland McGrath02a029b2008-04-30 00:53:08 -0700338# _TIF_SIGPENDING is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200340sysc_sigpending:
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100341 ni __TI_flags+7(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200342 la %r2,SP_PTREGS(%r15) # load pt_regs
343 brasl %r14,do_signal # call do_signal
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200344 tm __TI_flags+7(%r12),_TIF_RESTART_SVC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 jo sysc_restart
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100346 tm __TI_flags+7(%r12),_TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347 jo sysc_singlestep
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200348 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349
350#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200351# _TIF_NOTIFY_RESUME is set, call do_notify_resume
352#
353sysc_notify_resume:
354 la %r2,SP_PTREGS(%r15) # load pt_regs
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200355 larl %r14,sysc_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200356 jg do_notify_resume # call do_notify_resume
357
358#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359# _TIF_RESTART_SVC is set, set up registers and restart svc
360#
361sysc_restart:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200362 ni __TI_flags+7(%r12),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200363 lg %r7,SP_R2(%r15) # load new svc number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364 mvc SP_R2(8,%r15),SP_ORIG_R2(%r15) # restore first argument
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200365 lmg %r2,%r6,SP_R2(%r15) # load svc arguments
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200366 sth %r7,SP_SVCNR(%r15)
367 slag %r7,%r7,2
368 j sysc_nr_ok # restart svc
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369
370#
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100371# _TIF_PER_TRAP is set, call do_per_trap
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372#
373sysc_singlestep:
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100374 ni __TI_flags+7(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100375 xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200377 larl %r14,sysc_return # load adr. of system return
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100378 jg do_per_trap
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200381# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
382# and after the system call
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383#
384sysc_tracesys:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200385 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386 la %r3,0
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200387 llgh %r0,SP_SVCNR(%r15)
388 stg %r0,SP_R2(%r15)
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200389 brasl %r14,do_syscall_trace_enter
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 lghi %r0,NR_syscalls
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200391 clgr %r0,%r2
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 jnh sysc_tracenogo
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100393 sllg %r7,%r2,2 # svc number *4
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394 lgf %r8,0(%r7,%r10)
395sysc_tracego:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200396 lmg %r3,%r6,SP_R3(%r15)
Martin Schwidefskybaa07152010-10-25 16:10:40 +0200397 mvc SP_ARGS(8,%r15),SP_R7(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200398 lg %r2,SP_ORIG_R2(%r15)
399 basr %r14,%r8 # call sys_xxx
400 stg %r2,SP_R2(%r15) # store return value
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401sysc_tracenogo:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200402 tm __TI_flags+6(%r12),_TIF_SYSCALL
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200403 jz sysc_return
404 la %r2,SP_PTREGS(%r15) # load pt_regs
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200405 larl %r14,sysc_return # return point is sysc_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200406 jg do_syscall_trace_exit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
408#
409# a new process exits the kernel with ret_from_fork
410#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200411 .globl ret_from_fork
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412ret_from_fork:
413 lg %r13,__LC_SVC_NEW_PSW+8
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200414 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415 tm SP_PSW+1(%r15),0x01 # forking a kernel thread ?
416 jo 0f
417 stg %r15,SP_R15(%r15) # store stack pointer for new kthread
Heiko Carstens25d83cb2006-09-28 16:56:37 +02004180: brasl %r14,schedule_tail
Heiko Carstens1f194a42006-07-03 00:24:46 -0700419 TRACE_IRQS_ON
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200420 stosm 24(%r15),0x03 # reenable interrupts
Al Viro8f2961c2008-12-25 13:37:58 +0100421 j sysc_tracenogo
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422
423#
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200424# kernel_execve function needs to deal with pt_regs that is not
425# at the usual place
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426#
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200427 .globl kernel_execve
428kernel_execve:
429 stmg %r12,%r15,96(%r15)
430 lgr %r14,%r15
431 aghi %r15,-SP_SIZE
432 stg %r14,__SF_BACKCHAIN(%r15)
433 la %r12,SP_PTREGS(%r15)
434 xc 0(__PT_SIZE,%r12),0(%r12)
435 lgr %r5,%r12
436 brasl %r14,do_execve
437 ltgfr %r2,%r2
438 je 0f
439 aghi %r15,SP_SIZE
440 lmg %r12,%r15,96(%r15)
441 br %r14
442 # execve succeeded.
4430: stnsm __SF_EMPTY(%r15),0xfc # disable interrupts
444 lg %r15,__LC_KERNEL_STACK # load ksp
445 aghi %r15,-SP_SIZE # make room for registers & psw
446 lg %r13,__LC_SVC_NEW_PSW+8
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200447 mvc SP_PTREGS(__PT_SIZE,%r15),0(%r12) # copy pt_regs
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200448 lg %r12,__LC_THREAD_INFO
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200449 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
450 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
451 brasl %r14,execve_tail
452 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700453
454/*
455 * Program check handler routine
456 */
457
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200458 .globl pgm_check_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700459pgm_check_handler:
460/*
461 * First we need to check for a special case:
462 * Single stepping an instruction that disables the PER event mask will
463 * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
464 * For a single stepped SVC the program check handler gets control after
465 * the SVC new PSW has been loaded. But we want to execute the SVC first and
466 * then handle the PER event. Therefore we update the SVC old PSW to point
467 * to the pgm_check_handler and branch to the SVC handler after we checked
468 * if we have to load the kernel stack register.
469 * For every other possible cause for PER event without the PER mask set
470 * we just ignore the PER event (FIXME: is there anything we have to do
471 * for LPSW?).
472 */
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100473 stpt __LC_SYNC_ENTER_TIMER
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200474 tm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
475 jnz pgm_per # got per exception -> special case
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200476 SAVE_ALL_PGM __LC_PGM_OLD_PSW,__LC_SAVE_AREA
477 CREATE_STACK_FRAME __LC_SAVE_AREA
478 xc SP_ILC(4,%r15),SP_ILC(%r15)
479 mvc SP_PSW(16,%r15),__LC_PGM_OLD_PSW
480 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200481 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
483 jz pgm_no_vtime
484 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
485 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
486 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200487 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488pgm_no_vtime:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200489 stg %r11,SP_ARGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200490 lgf %r3,__LC_PGM_ILC # load program interruption code
Martin Schwidefsky1e546222010-10-25 16:10:37 +0200491 lg %r4,__LC_TRANS_EXC_CODE
492 REENABLE_IRQS
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 lghi %r8,0x7f
494 ngr %r8,%r3
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200495 sll %r8,3
496 larl %r1,pgm_check_table
497 lg %r1,0(%r8,%r1) # load address of handler routine
498 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200499 basr %r14,%r1 # branch to interrupt-handler
500pgm_exit:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200501 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502
503#
504# handle per exception
505#
506pgm_per:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200507 tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is on
508 jnz pgm_per_std # ok, normal per event from user space
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509# ok its one of the special cases, now we need to find out which one
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200510 clc __LC_PGM_OLD_PSW(16),__LC_SVC_NEW_PSW
511 je pgm_svcper
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512# no interesting special case, ignore PER event
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200513 lpswe __LC_PGM_OLD_PSW
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514
515#
516# Normal per exception
517#
518pgm_per_std:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200519 SAVE_ALL_PGM __LC_PGM_OLD_PSW,__LC_SAVE_AREA
520 CREATE_STACK_FRAME __LC_SAVE_AREA
521 mvc SP_PSW(16,%r15),__LC_PGM_OLD_PSW
522 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200523 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
525 jz pgm_no_vtime2
526 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
527 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
528 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200529 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530pgm_no_vtime2:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200531 lg %r1,__TI_task(%r12)
Michael Grundy4ba069b2006-09-20 15:58:39 +0200532 tm SP_PSW+1(%r15),0x01 # kernel per event ?
533 jz kernel_per
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100534 mvc __THREAD_per_cause(2,%r1),__LC_PER_CAUSE
535 mvc __THREAD_per_address(8,%r1),__LC_PER_ADDRESS
536 mvc __THREAD_per_paid(1,%r1),__LC_PER_PAID
537 oi __TI_flags+7(%r12),_TIF_PER_TRAP # set TIF_PER_TRAP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200538 lgf %r3,__LC_PGM_ILC # load program interruption code
Martin Schwidefsky1e546222010-10-25 16:10:37 +0200539 lg %r4,__LC_TRANS_EXC_CODE
540 REENABLE_IRQS
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 lghi %r8,0x7f
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200542 ngr %r8,%r3 # clear per-event-bit and ilc
Heiko Carstensf5cdac22010-07-27 19:29:37 +0200543 je pgm_exit2
544 sll %r8,3
545 larl %r1,pgm_check_table
546 lg %r1,0(%r8,%r1) # load address of handler routine
547 la %r2,SP_PTREGS(%r15) # address of register-save area
548 basr %r14,%r1 # branch to interrupt-handler
549pgm_exit2:
Heiko Carstensf5cdac22010-07-27 19:29:37 +0200550 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551
552#
553# it was a single stepped SVC that is causing all the trouble
554#
555pgm_svcper:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200556 SAVE_ALL_PGM __LC_SVC_OLD_PSW,__LC_SAVE_AREA
557 CREATE_STACK_FRAME __LC_SAVE_AREA
558 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
559 mvc SP_ILC(4,%r15),__LC_SVC_ILC
560 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
562 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
563 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200564 LAST_BREAK
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200565 lg %r8,__TI_task(%r12)
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100566 mvc __THREAD_per_cause(2,%r8),__LC_PER_CAUSE
567 mvc __THREAD_per_address(8,%r8),__LC_PER_ADDRESS
568 mvc __THREAD_per_paid(1,%r8),__LC_PER_PAID
569 oi __TI_flags+7(%r12),_TIF_PER_TRAP # set TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200571 lmg %r2,%r6,SP_R2(%r15) # load svc arguments
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 j sysc_do_svc
573
Michael Grundy4ba069b2006-09-20 15:58:39 +0200574#
575# per was called from kernel, must be kprobes
576#
577kernel_per:
Martin Schwidefsky9ec27082010-10-29 16:50:45 +0200578 REENABLE_IRQS
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100579 xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
Michael Grundy4ba069b2006-09-20 15:58:39 +0200580 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100581 brasl %r14,do_per_trap
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200582 j pgm_exit
Michael Grundy4ba069b2006-09-20 15:58:39 +0200583
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584/*
585 * IO interrupt handler routine
586 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200587 .globl io_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700588io_int_handler:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 stck __LC_INT_CLOCK
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100590 stpt __LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200591 SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+40
592 CREATE_STACK_FRAME __LC_SAVE_AREA+40
593 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
594 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200595 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
597 jz io_no_vtime
598 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
599 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
600 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200601 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602io_no_vtime:
Heiko Carstens1f194a42006-07-03 00:24:46 -0700603 TRACE_IRQS_OFF
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200604 la %r2,SP_PTREGS(%r15) # address of register-save area
605 brasl %r14,do_IRQ # call standard irq handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606io_return:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200607 LOCKDEP_SYS_EXIT
608 TRACE_IRQS_ON
609io_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200610 tm __TI_flags+7(%r12),_TIF_WORK_INT
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200611 jnz io_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100612io_restore:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200613 RESTORE_ALL __LC_RETURN_PSW,0
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700614io_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615
Martin Schwidefsky26889052008-05-07 09:22:52 +0200616#
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200617# There is work todo, find out in which context we have been interrupted:
618# 1) if we return to user space we can do all _TIF_WORK_INT work
619# 2) if we return to kernel code and kvm is enabled check if we need to
620# modify the psw to leave SIE
621# 3) if we return to kernel code and preemptive scheduling is enabled check
622# the preemption counter and if it is zero call preempt_schedule_irq
623# Before any work can be done, a switch to the kernel stack is required.
Martin Schwidefsky26889052008-05-07 09:22:52 +0200624#
625io_work:
626 tm SP_PSW+1(%r15),0x01 # returning to user ?
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200627 jo io_work_user # yes -> do resched & signal
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200628#ifdef CONFIG_PREEMPT
Martin Schwidefsky26889052008-05-07 09:22:52 +0200629 # check for preemptive scheduling
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200630 icm %r0,15,__TI_precount(%r12)
Martin Schwidefsky26889052008-05-07 09:22:52 +0200631 jnz io_restore # preemption is disabled
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200632 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
633 jno io_restore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 # switch to kernel stack
635 lg %r1,SP_R15(%r15)
636 aghi %r1,-SP_SIZE
637 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200638 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 lgr %r15,%r1
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200640 # TRACE_IRQS_ON already done at io_return, call
641 # TRACE_IRQS_OFF to keep things symmetrical
642 TRACE_IRQS_OFF
643 brasl %r14,preempt_schedule_irq
644 j io_return
645#else
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200646 j io_restore
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200647#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200649#
650# Need to do work before returning to userspace, switch to kernel stack
651#
Martin Schwidefsky26889052008-05-07 09:22:52 +0200652io_work_user:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653 lg %r1,__LC_KERNEL_STACK
654 aghi %r1,-SP_SIZE
655 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200656 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657 lgr %r15,%r1
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200658
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659#
660# One of the work bits is on. Find out which one.
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200661# Checked are: _TIF_SIGPENDING, _TIF_NOTIFY_RESUME, _TIF_NEED_RESCHED
Heiko Carstens54dfe5d2006-02-01 03:06:38 -0800662# and _TIF_MCCK_PENDING
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663#
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200664io_work_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200665 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700666 jo io_mcck_pending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200667 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668 jo io_reschedule
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200669 tm __TI_flags+7(%r12),_TIF_SIGPENDING
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200670 jo io_sigpending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200671 tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200672 jo io_notify_resume
673 j io_return # beware of critical section cleanup
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200674
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700676# _TIF_MCCK_PENDING is set, call handler
677#
678io_mcck_pending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200679 # TRACE_IRQS_ON already done at io_return
Heiko Carstensb771aea2007-07-27 12:29:18 +0200680 brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200681 TRACE_IRQS_OFF
682 j io_return
Heiko Carstens77fa2242005-06-25 14:55:30 -0700683
684#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200686#
687io_reschedule:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200688 # TRACE_IRQS_ON already done at io_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200689 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
690 brasl %r14,schedule # call scheduler
691 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
Heiko Carstens411788e2007-11-20 11:13:32 +0100692 TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200693 j io_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700694
695#
Roland McGrath02a029b2008-04-30 00:53:08 -0700696# _TIF_SIGPENDING or is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200698io_sigpending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200699 # TRACE_IRQS_ON already done at io_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200700 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
701 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 brasl %r14,do_signal # call do_signal
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200703 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
Heiko Carstens411788e2007-11-20 11:13:32 +0100704 TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200705 j io_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700706
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200707#
708# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
709#
710io_notify_resume:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200711 # TRACE_IRQS_ON already done at io_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200712 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
713 la %r2,SP_PTREGS(%r15) # load pt_regs
714 brasl %r14,do_notify_resume # call do_notify_resume
715 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
716 TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200717 j io_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200718
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719/*
720 * External interrupt handler routine
721 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200722 .globl ext_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723ext_int_handler:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724 stck __LC_INT_CLOCK
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100725 stpt __LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200726 SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+40
727 CREATE_STACK_FRAME __LC_SAVE_AREA+40
728 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
729 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200730 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700731 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
732 jz ext_no_vtime
733 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
734 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
735 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200736 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700737ext_no_vtime:
Heiko Carstens1f194a42006-07-03 00:24:46 -0700738 TRACE_IRQS_OFF
Martin Schwidefskyf6649a72010-10-25 16:10:38 +0200739 lghi %r1,4096
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200740 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefskyf6649a72010-10-25 16:10:38 +0200741 llgf %r3,__LC_CPU_ADDRESS # get cpu address + interruption code
742 llgf %r4,__LC_EXT_PARAMS # get external parameter
743 lg %r5,__LC_EXT_PARAMS2-4096(%r1) # get 64 bit external parameter
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200744 brasl %r14,do_extint
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745 j io_return
746
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700747__critical_end:
748
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749/*
750 * Machine check handler routines
751 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200752 .globl mcck_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753mcck_int_handler:
Martin Schwidefsky63779812010-05-17 10:00:03 +0200754 stck __LC_MCCK_CLOCK
Heiko Carstens77fa2242005-06-25 14:55:30 -0700755 la %r1,4095 # revalidate r1
756 spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200757 lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200758 stmg %r11,%r15,__LC_SAVE_AREA+80
759 larl %r13,system_call
760 lg %r11,__LC_LAST_BREAK
Heiko Carstens77fa2242005-06-25 14:55:30 -0700761 la %r12,__LC_MCK_OLD_PSW
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200762 tm __LC_MCCK_CODE,0x80 # system damage?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700763 jo mcck_int_main # yes -> rest of mcck code invalid
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200764 la %r14,4095
Martin Schwidefsky63779812010-05-17 10:00:03 +0200765 mvc __LC_MCCK_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA-4095(%r14)
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200766 tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
767 jo 1f
768 la %r14,__LC_SYNC_ENTER_TIMER
769 clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
770 jl 0f
771 la %r14,__LC_ASYNC_ENTER_TIMER
7720: clc 0(8,%r14),__LC_EXIT_TIMER
773 jl 0f
774 la %r14,__LC_EXIT_TIMER
7750: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
776 jl 0f
777 la %r14,__LC_LAST_UPDATE_TIMER
7780: spt 0(%r14)
Martin Schwidefsky63779812010-05-17 10:00:03 +0200779 mvc __LC_MCCK_ENTER_TIMER(8),0(%r14)
Martin Schwidefskyc185b782008-12-25 13:39:25 +01007801: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700781 jno mcck_int_main # no -> skip cleanup critical
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200782 tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
Heiko Carstens77fa2242005-06-25 14:55:30 -0700783 jnz mcck_int_main # from user -> load kernel stack
784 clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_end)
785 jhe mcck_int_main
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200786 clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_start)
Heiko Carstens77fa2242005-06-25 14:55:30 -0700787 jl mcck_int_main
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200788 brasl %r14,cleanup_critical
Heiko Carstens77fa2242005-06-25 14:55:30 -0700789mcck_int_main:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200790 lg %r14,__LC_PANIC_STACK # are we already on the panic stack?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700791 slgr %r14,%r15
792 srag %r14,%r14,PAGE_SHIFT
793 jz 0f
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200794 lg %r15,__LC_PANIC_STACK # load panic stack
Martin Schwidefsky86f25522010-05-17 10:00:05 +02007950: aghi %r15,-SP_SIZE # make room for registers & psw
796 CREATE_STACK_FRAME __LC_SAVE_AREA+80
797 mvc SP_PSW(16,%r15),0(%r12)
798 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700799 tm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?
800 jno mcck_no_vtime # no -> no timer update
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200801 HANDLE_SIE_INTERCEPT
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200802 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700803 jz mcck_no_vtime
Martin Schwidefsky63779812010-05-17 10:00:03 +0200804 UPDATE_VTIME __LC_EXIT_TIMER,__LC_MCCK_ENTER_TIMER,__LC_USER_TIMER
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700805 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
Martin Schwidefsky63779812010-05-17 10:00:03 +0200806 mvc __LC_LAST_UPDATE_TIMER(8),__LC_MCCK_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200807 LAST_BREAK
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700808mcck_no_vtime:
Heiko Carstens77fa2242005-06-25 14:55:30 -0700809 la %r2,SP_PTREGS(%r15) # load pt_regs
810 brasl %r14,s390_do_machine_check
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200811 tm SP_PSW+1(%r15),0x01 # returning to user ?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700812 jno mcck_return
813 lg %r1,__LC_KERNEL_STACK # switch to kernel stack
814 aghi %r1,-SP_SIZE
815 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
816 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
817 lgr %r15,%r1
818 stosm __SF_EMPTY(%r15),0x04 # turn dat on
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200819 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700820 jno mcck_return
Heiko Carstens1f194a42006-07-03 00:24:46 -0700821 TRACE_IRQS_OFF
Heiko Carstens77fa2242005-06-25 14:55:30 -0700822 brasl %r14,s390_handle_mcck
Heiko Carstens1f194a42006-07-03 00:24:46 -0700823 TRACE_IRQS_ON
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824mcck_return:
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200825 mvc __LC_RETURN_MCCK_PSW(16),SP_PSW(%r15) # move return PSW
826 ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
827 lmg %r0,%r15,SP_R0(%r15) # load gprs 0-15
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200828 tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
829 jno 0f
830 stpt __LC_EXIT_TIMER
Martin Schwidefskyc185b782008-12-25 13:39:25 +01008310: lpswe __LC_RETURN_MCCK_PSW # back to caller
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200832mcck_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833
Linus Torvalds1da177e2005-04-16 15:20:36 -0700834/*
835 * Restart interruption handler, kick starter for additional CPUs
836 */
Heiko Carstens84b36a82007-06-19 13:10:03 +0200837#ifdef CONFIG_SMP
Heiko Carstens2bc89b52008-02-05 16:50:40 +0100838 __CPUINIT
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200839 .globl restart_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700840restart_int_handler:
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200841 basr %r1,0
842restart_base:
843 spt restart_vtime-restart_base(%r1)
844 stck __LC_LAST_UPDATE_CLOCK
845 mvc __LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
846 mvc __LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200847 lg %r15,__LC_SAVE_AREA+120 # load ksp
848 lghi %r10,__LC_CREGS_SAVE_AREA
849 lctlg %c0,%c15,0(%r10) # get new ctl regs
850 lghi %r10,__LC_AREGS_SAVE_AREA
851 lam %a0,%a15,0(%r10)
852 lmg %r6,%r15,__SF_GPRS(%r15) # load registers from clone
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200853 lg %r1,__LC_THREAD_INFO
854 mvc __LC_USER_TIMER(8),__TI_user_timer(%r1)
855 mvc __LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
856 xc __LC_STEAL_TIMER(8),__LC_STEAL_TIMER
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200857 stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
Michael Holzheu8eb4bd62011-05-10 17:13:39 +0200858 brasl %r14,start_secondary
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200859 .align 8
860restart_vtime:
861 .long 0x7fffffff,0xffffffff
Heiko Carstens84b36a82007-06-19 13:10:03 +0200862 .previous
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863#else
864/*
865 * If we do not run with SMP enabled, let the new CPU crash ...
866 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200867 .globl restart_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868restart_int_handler:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200869 basr %r1,0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870restart_base:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200871 lpswe restart_crash-restart_base(%r1)
872 .align 8
Linus Torvalds1da177e2005-04-16 15:20:36 -0700873restart_crash:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200874 .long 0x000a0000,0x00000000,0x00000000,0x00000000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700875restart_go:
876#endif
877
Martin Schwidefsky860dba42011-01-05 12:47:25 +0100878 .section .kprobes.text, "ax"
879
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880#ifdef CONFIG_CHECK_STACK
881/*
882 * The synchronous or the asynchronous stack overflowed. We are dead.
883 * No need to properly save the registers, we are going to panic anyway.
884 * Setup a pt_regs so that show_trace can provide a good call trace.
885 */
886stack_overflow:
887 lg %r15,__LC_PANIC_STACK # change to panic stack
Heiko Carstens9514e232006-09-20 15:59:22 +0200888 aghi %r15,-SP_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -0700889 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200890 stmg %r0,%r10,SP_R0(%r15) # store gprs %r0-%r10 to kernel stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700891 la %r1,__LC_SAVE_AREA
892 chi %r12,__LC_SVC_OLD_PSW
893 je 0f
894 chi %r12,__LC_PGM_OLD_PSW
895 je 0f
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200896 la %r1,__LC_SAVE_AREA+40
8970: mvc SP_R11(40,%r15),0(%r1) # move %r11-%r15 to stack
Christian Borntraeger9e74a6b82008-04-17 07:46:30 +0200898 mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200899 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # clear back chain
900 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901 jg kernel_stack_overflow
902#endif
903
904cleanup_table_system_call:
905 .quad system_call, sysc_do_svc
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200906cleanup_table_sysc_tif:
907 .quad sysc_tif, sysc_restore
908cleanup_table_sysc_restore:
909 .quad sysc_restore, sysc_done
910cleanup_table_io_tif:
911 .quad io_tif, io_restore
912cleanup_table_io_restore:
913 .quad io_restore, io_done
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914
915cleanup_critical:
916 clc 8(8,%r12),BASED(cleanup_table_system_call)
917 jl 0f
918 clc 8(8,%r12),BASED(cleanup_table_system_call+8)
919 jl cleanup_system_call
9200:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200921 clc 8(8,%r12),BASED(cleanup_table_sysc_tif)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700922 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200923 clc 8(8,%r12),BASED(cleanup_table_sysc_tif+8)
924 jl cleanup_sysc_tif
Linus Torvalds1da177e2005-04-16 15:20:36 -07009250:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200926 clc 8(8,%r12),BASED(cleanup_table_sysc_restore)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700927 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200928 clc 8(8,%r12),BASED(cleanup_table_sysc_restore+8)
929 jl cleanup_sysc_restore
Linus Torvalds1da177e2005-04-16 15:20:36 -07009300:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200931 clc 8(8,%r12),BASED(cleanup_table_io_tif)
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200932 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200933 clc 8(8,%r12),BASED(cleanup_table_io_tif+8)
934 jl cleanup_io_tif
Martin Schwidefsky63b12242006-06-29 14:58:05 +02009350:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200936 clc 8(8,%r12),BASED(cleanup_table_io_restore)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700937 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200938 clc 8(8,%r12),BASED(cleanup_table_io_restore+8)
939 jl cleanup_io_restore
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07009400:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941 br %r14
942
943cleanup_system_call:
944 mvc __LC_RETURN_PSW(16),0(%r12)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700945 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+8)
946 jh 0f
Martin Schwidefsky63779812010-05-17 10:00:03 +0200947 mvc __LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
948 cghi %r12,__LC_MCK_OLD_PSW
949 je 0f
Linus Torvalds1da177e2005-04-16 15:20:36 -0700950 mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
Martin Schwidefsky63779812010-05-17 10:00:03 +02009510: cghi %r12,__LC_MCK_OLD_PSW
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200952 la %r12,__LC_SAVE_AREA+80
Martin Schwidefsky63779812010-05-17 10:00:03 +0200953 je 0f
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200954 la %r12,__LC_SAVE_AREA+40
Linus Torvalds1da177e2005-04-16 15:20:36 -07009550: clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+16)
956 jhe cleanup_vtime
Linus Torvalds1da177e2005-04-16 15:20:36 -0700957 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn)
958 jh 0f
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200959 mvc __LC_SAVE_AREA(40),0(%r12)
9600: lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
961 aghi %r15,-SP_SIZE # make room for registers & psw
962 stg %r15,32(%r12)
963 stg %r11,0(%r12)
964 CREATE_STACK_FRAME __LC_SAVE_AREA
965 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
966 mvc SP_ILC(4,%r15),__LC_SVC_ILC
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200967 mvc 8(8,%r12),__LC_THREAD_INFO
Linus Torvalds1da177e2005-04-16 15:20:36 -0700968cleanup_vtime:
969 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+24)
970 jhe cleanup_stime
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
972cleanup_stime:
973 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+32)
974 jh cleanup_update
975 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
976cleanup_update:
977 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200978 srag %r12,%r11,23
979 lg %r12,__LC_THREAD_INFO
980 jz 0f
981 stg %r11,__TI_last_break(%r12)
9820: mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_system_call+8)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 la %r12,__LC_RETURN_PSW
984 br %r14
985cleanup_system_call_insn:
986 .quad sysc_saveall
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200987 .quad system_call
988 .quad sysc_vtime
989 .quad sysc_stime
990 .quad sysc_update
Linus Torvalds1da177e2005-04-16 15:20:36 -0700991
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200992cleanup_sysc_tif:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 mvc __LC_RETURN_PSW(8),0(%r12)
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200994 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_sysc_tif)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700995 la %r12,__LC_RETURN_PSW
996 br %r14
997
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200998cleanup_sysc_restore:
999 clc 8(8,%r12),BASED(cleanup_sysc_restore_insn)
Martin Schwidefsky63779812010-05-17 10:00:03 +02001000 je 2f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001001 clc 8(8,%r12),BASED(cleanup_sysc_restore_insn+8)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001002 jhe 0f
Martin Schwidefsky63779812010-05-17 10:00:03 +02001003 mvc __LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
1004 cghi %r12,__LC_MCK_OLD_PSW
1005 je 0f
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001006 mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
10070: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001008 cghi %r12,__LC_MCK_OLD_PSW
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001009 la %r12,__LC_SAVE_AREA+80
Martin Schwidefsky63779812010-05-17 10:00:03 +02001010 je 1f
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001011 la %r12,__LC_SAVE_AREA+40
10121: mvc 0(40,%r12),SP_R11(%r15)
1013 lmg %r0,%r10,SP_R0(%r15)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001014 lg %r15,SP_R15(%r15)
Martin Schwidefsky63779812010-05-17 10:00:03 +020010152: la %r12,__LC_RETURN_PSW
Linus Torvalds1da177e2005-04-16 15:20:36 -07001016 br %r14
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001017cleanup_sysc_restore_insn:
Heiko Carstens411788e2007-11-20 11:13:32 +01001018 .quad sysc_done - 4
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001019 .quad sysc_done - 16
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001021cleanup_io_tif:
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001022 mvc __LC_RETURN_PSW(8),0(%r12)
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001023 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_io_tif)
Martin Schwidefsky176b1802010-04-09 13:43:00 +02001024 la %r12,__LC_RETURN_PSW
1025 br %r14
1026
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001027cleanup_io_restore:
1028 clc 8(8,%r12),BASED(cleanup_io_restore_insn)
Martin Schwidefsky63779812010-05-17 10:00:03 +02001029 je 1f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001030 clc 8(8,%r12),BASED(cleanup_io_restore_insn+8)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001031 jhe 0f
Martin Schwidefsky63779812010-05-17 10:00:03 +02001032 mvc __LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
Martin Schwidefskyc742b312008-12-31 15:11:42 +010010330: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001034 mvc __LC_SAVE_AREA+80(40),SP_R11(%r15)
1035 lmg %r0,%r10,SP_R0(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001036 lg %r15,SP_R15(%r15)
Martin Schwidefsky63779812010-05-17 10:00:03 +020010371: la %r12,__LC_RETURN_PSW
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001038 br %r14
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001039cleanup_io_restore_insn:
Heiko Carstens411788e2007-11-20 11:13:32 +01001040 .quad io_done - 4
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001041 .quad io_done - 16
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001042
Linus Torvalds1da177e2005-04-16 15:20:36 -07001043/*
1044 * Integer constants
1045 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001046 .align 4
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047.Lcritical_start:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001048 .quad __critical_start
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049.Lcritical_end:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001050 .quad __critical_end
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051
Martin Schwidefsky603d1a52011-07-24 10:48:18 +02001052#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
1053/*
1054 * sie64a calling convention:
1055 * %r2 pointer to sie control block
1056 * %r3 guest register save area
1057 */
1058 .globl sie64a
1059sie64a:
1060 stmg %r6,%r14,__SF_GPRS(%r15) # save kernel registers
1061 stg %r2,__SF_EMPTY(%r15) # save control block pointer
1062 stg %r3,__SF_EMPTY+8(%r15) # save guest register save area
1063 lmg %r0,%r13,0(%r3) # load guest gprs 0-13
1064 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1065 oi __TI_flags+6(%r14),_TIF_SIE>>8
1066sie_loop:
1067 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1068 tm __TI_flags+7(%r14),_TIF_EXIT_SIE
1069 jnz sie_exit
1070 lg %r14,__SF_EMPTY(%r15) # get control block pointer
1071 SPP __SF_EMPTY(%r15) # set guest id
1072 sie 0(%r14)
1073sie_done:
1074 SPP __LC_CMF_HPP # set host id
1075 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1076sie_exit:
1077 ni __TI_flags+6(%r14),255-(_TIF_SIE>>8)
1078 lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
1079 stmg %r0,%r13,0(%r14) # save guest gprs 0-13
1080 lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
1081 lghi %r2,0
1082 br %r14
1083sie_fault:
1084 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1085 ni __TI_flags+6(%r14),255-(_TIF_SIE>>8)
1086 lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
1087 stmg %r0,%r13,0(%r14) # save guest gprs 0-13
1088 lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
1089 lghi %r2,-EFAULT
1090 br %r14
1091
1092 .align 8
1093.Lsie_loop:
1094 .quad sie_loop
1095.Lsie_done:
1096 .quad sie_done
1097
1098 .section __ex_table,"a"
1099 .quad sie_loop,sie_fault
1100 .previous
1101#endif
1102
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001103 .section .rodata, "a"
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104#define SYSCALL(esa,esame,emu) .long esame
Heiko Carstens9bf12262009-06-12 10:26:47 +02001105 .globl sys_call_table
Linus Torvalds1da177e2005-04-16 15:20:36 -07001106sys_call_table:
1107#include "syscalls.S"
1108#undef SYSCALL
1109
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -08001110#ifdef CONFIG_COMPAT
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111
1112#define SYSCALL(esa,esame,emu) .long emu
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113sys_call_table_emu:
1114#include "syscalls.S"
1115#undef SYSCALL
1116#endif