blob: 5f729d627cef21d96072609795481fec24cd6805 [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
Heiko Carstens2bc89b52008-02-05 16:50:40 +010012#include <linux/init.h>
Jan Glauber144d6342011-07-24 10:48:19 +020013#include <linux/linkage.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 */
Jan Glauber144d6342011-07-24 10:48:19 +0200222ENTRY(__switch_to)
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100223 lg %r4,__THREAD_info(%r2) # get thread_info of prev
224 lg %r5,__THREAD_info(%r3) # get thread_info of next
Heiko Carstens77fa2242005-06-25 14:55:30 -0700225 tm __TI_flags+7(%r4),_TIF_MCCK_PENDING # machine check pending?
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100226 jz 0f
227 ni __TI_flags+7(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
228 oi __TI_flags+7(%r5),_TIF_MCCK_PENDING # set it in next
2290: stmg %r6,%r15,__SF_GPRS(%r15) # store gprs of prev task
230 stg %r15,__THREAD_ksp(%r2) # store kernel stack of prev
231 lg %r15,__THREAD_ksp(%r3) # load kernel stack of next
232 lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
233 lmg %r6,%r15,__SF_GPRS(%r15) # load gprs of next task
234 stg %r3,__LC_CURRENT # store task struct of next
Heiko Carstensf2db2e62011-05-23 10:24:34 +0200235 mvc __LC_CURRENT_PID+4(4,%r0),__TASK_pid(%r3) # store pid of next
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100236 stg %r5,__LC_THREAD_INFO # store thread info of next
237 aghi %r5,STACK_SIZE # end of kernel stack of next
238 stg %r5,__LC_KERNEL_STACK # store end of kernel stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 br %r14
240
241__critical_start:
242/*
243 * SVC interrupt handler routine. System calls are synchronous events and
244 * are executed with interrupts enabled.
245 */
246
Jan Glauber144d6342011-07-24 10:48:19 +0200247ENTRY(system_call)
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100248 stpt __LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249sysc_saveall:
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200250 SAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200251 CREATE_STACK_FRAME __LC_SAVE_AREA
252 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
253 mvc SP_ILC(4,%r15),__LC_SVC_ILC
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200254 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255sysc_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
257sysc_stime:
258 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
259sysc_update:
260 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200261 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262sysc_do_svc:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200263 llgh %r7,SP_SVCNR(%r15)
264 slag %r7,%r7,2 # shift and test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 jnz sysc_nr_ok
266 # svc 0: system call number in %r1
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200267 llgfr %r1,%r1 # clear high word in r1
268 cghi %r1,NR_syscalls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 jnl sysc_nr_ok
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200270 sth %r1,SP_SVCNR(%r15)
271 slag %r7,%r1,2 # shift and test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272sysc_nr_ok:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200273 larl %r10,sys_call_table
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800274#ifdef CONFIG_COMPAT
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200275 tm __TI_flags+5(%r12),(_TIF_31BIT>>16) # running in 31 bit mode ?
Heiko Carstensc5630772005-09-03 15:58:04 -0700276 jno sysc_noemu
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200277 larl %r10,sys_call_table_emu # use 31 bit emulation system calls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700278sysc_noemu:
279#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200280 tm __TI_flags+6(%r12),_TIF_SYSCALL
Martin Schwidefskybaa07152010-10-25 16:10:40 +0200281 mvc SP_ARGS(8,%r15),SP_R7(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200282 lgf %r8,0(%r7,%r10) # load address of system call routine
283 jnz sysc_tracesys
284 basr %r14,%r8 # call sys_xxxx
285 stg %r2,SP_R2(%r15) # store return value (change R2 on stack)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700286
287sysc_return:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200288 LOCKDEP_SYS_EXIT
289sysc_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200290 tm __TI_flags+7(%r12),_TIF_WORK_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200291 jnz sysc_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100292sysc_restore:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200293 RESTORE_ALL __LC_RETURN_PSW,1
Heiko Carstens411788e2007-11-20 11:13:32 +0100294sysc_done:
295
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296#
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200297# There is work to do, but first we need to check if we return to userspace.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298#
299sysc_work:
Martin Schwidefsky26889052008-05-07 09:22:52 +0200300 tm SP_PSW+1(%r15),0x01 # returning to user ?
301 jno sysc_restore
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200302
303#
304# One of the work bits is on. Find out which one.
305#
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200306sysc_work_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200307 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700308 jo sysc_mcck_pending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200309 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 jo sysc_reschedule
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200311 tm __TI_flags+7(%r12),_TIF_SIGPENDING
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200312 jo sysc_sigpending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200313 tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200314 jo sysc_notify_resume
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200315 tm __TI_flags+7(%r12),_TIF_RESTART_SVC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 jo sysc_restart
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100317 tm __TI_flags+7(%r12),_TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 jo sysc_singlestep
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200319 j sysc_return # beware of critical section cleanup
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320
321#
322# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200323#
324sysc_reschedule:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200325 larl %r14,sysc_return
326 jg schedule # return point is sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327
328#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700329# _TIF_MCCK_PENDING is set, call handler
330#
331sysc_mcck_pending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200332 larl %r14,sysc_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200333 jg s390_handle_mcck # TIF bit will be cleared by handler
Heiko Carstens77fa2242005-06-25 14:55:30 -0700334
335#
Roland McGrath02a029b2008-04-30 00:53:08 -0700336# _TIF_SIGPENDING is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200338sysc_sigpending:
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100339 ni __TI_flags+7(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200340 la %r2,SP_PTREGS(%r15) # load pt_regs
341 brasl %r14,do_signal # call do_signal
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200342 tm __TI_flags+7(%r12),_TIF_RESTART_SVC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 jo sysc_restart
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100344 tm __TI_flags+7(%r12),_TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 jo sysc_singlestep
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200346 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347
348#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200349# _TIF_NOTIFY_RESUME is set, call do_notify_resume
350#
351sysc_notify_resume:
352 la %r2,SP_PTREGS(%r15) # load pt_regs
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200353 larl %r14,sysc_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200354 jg do_notify_resume # call do_notify_resume
355
356#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357# _TIF_RESTART_SVC is set, set up registers and restart svc
358#
359sysc_restart:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200360 ni __TI_flags+7(%r12),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200361 lg %r7,SP_R2(%r15) # load new svc number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362 mvc SP_R2(8,%r15),SP_ORIG_R2(%r15) # restore first argument
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200363 lmg %r2,%r6,SP_R2(%r15) # load svc arguments
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200364 sth %r7,SP_SVCNR(%r15)
365 slag %r7,%r7,2
366 j sysc_nr_ok # restart svc
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367
368#
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100369# _TIF_PER_TRAP is set, call do_per_trap
Linus Torvalds1da177e2005-04-16 15:20:36 -0700370#
371sysc_singlestep:
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100372 ni __TI_flags+7(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100373 xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200375 larl %r14,sysc_return # load adr. of system return
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100376 jg do_per_trap
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200379# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
380# and after the system call
Linus Torvalds1da177e2005-04-16 15:20:36 -0700381#
382sysc_tracesys:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200383 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 la %r3,0
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200385 llgh %r0,SP_SVCNR(%r15)
386 stg %r0,SP_R2(%r15)
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200387 brasl %r14,do_syscall_trace_enter
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388 lghi %r0,NR_syscalls
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200389 clgr %r0,%r2
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 jnh sysc_tracenogo
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100391 sllg %r7,%r2,2 # svc number *4
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 lgf %r8,0(%r7,%r10)
393sysc_tracego:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200394 lmg %r3,%r6,SP_R3(%r15)
Martin Schwidefskybaa07152010-10-25 16:10:40 +0200395 mvc SP_ARGS(8,%r15),SP_R7(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200396 lg %r2,SP_ORIG_R2(%r15)
397 basr %r14,%r8 # call sys_xxx
398 stg %r2,SP_R2(%r15) # store return value
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399sysc_tracenogo:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200400 tm __TI_flags+6(%r12),_TIF_SYSCALL
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200401 jz sysc_return
402 la %r2,SP_PTREGS(%r15) # load pt_regs
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200403 larl %r14,sysc_return # return point is sysc_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200404 jg do_syscall_trace_exit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405
406#
407# a new process exits the kernel with ret_from_fork
408#
Jan Glauber144d6342011-07-24 10:48:19 +0200409ENTRY(ret_from_fork)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 lg %r13,__LC_SVC_NEW_PSW+8
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200411 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412 tm SP_PSW+1(%r15),0x01 # forking a kernel thread ?
413 jo 0f
414 stg %r15,SP_R15(%r15) # store stack pointer for new kthread
Heiko Carstens25d83cb2006-09-28 16:56:37 +02004150: brasl %r14,schedule_tail
Heiko Carstens1f194a42006-07-03 00:24:46 -0700416 TRACE_IRQS_ON
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200417 stosm 24(%r15),0x03 # reenable interrupts
Al Viro8f2961c2008-12-25 13:37:58 +0100418 j sysc_tracenogo
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419
420#
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200421# kernel_execve function needs to deal with pt_regs that is not
422# at the usual place
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423#
Jan Glauber144d6342011-07-24 10:48:19 +0200424ENTRY(kernel_execve)
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200425 stmg %r12,%r15,96(%r15)
426 lgr %r14,%r15
427 aghi %r15,-SP_SIZE
428 stg %r14,__SF_BACKCHAIN(%r15)
429 la %r12,SP_PTREGS(%r15)
430 xc 0(__PT_SIZE,%r12),0(%r12)
431 lgr %r5,%r12
432 brasl %r14,do_execve
433 ltgfr %r2,%r2
434 je 0f
435 aghi %r15,SP_SIZE
436 lmg %r12,%r15,96(%r15)
437 br %r14
438 # execve succeeded.
4390: stnsm __SF_EMPTY(%r15),0xfc # disable interrupts
440 lg %r15,__LC_KERNEL_STACK # load ksp
441 aghi %r15,-SP_SIZE # make room for registers & psw
442 lg %r13,__LC_SVC_NEW_PSW+8
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200443 mvc SP_PTREGS(__PT_SIZE,%r15),0(%r12) # copy pt_regs
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200444 lg %r12,__LC_THREAD_INFO
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200445 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
446 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
447 brasl %r14,execve_tail
448 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449
450/*
451 * Program check handler routine
452 */
453
Jan Glauber144d6342011-07-24 10:48:19 +0200454ENTRY(pgm_check_handler)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700455/*
456 * First we need to check for a special case:
457 * Single stepping an instruction that disables the PER event mask will
458 * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
459 * For a single stepped SVC the program check handler gets control after
460 * the SVC new PSW has been loaded. But we want to execute the SVC first and
461 * then handle the PER event. Therefore we update the SVC old PSW to point
462 * to the pgm_check_handler and branch to the SVC handler after we checked
463 * if we have to load the kernel stack register.
464 * For every other possible cause for PER event without the PER mask set
465 * we just ignore the PER event (FIXME: is there anything we have to do
466 * for LPSW?).
467 */
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100468 stpt __LC_SYNC_ENTER_TIMER
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200469 tm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
470 jnz pgm_per # got per exception -> special case
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200471 SAVE_ALL_PGM __LC_PGM_OLD_PSW,__LC_SAVE_AREA
472 CREATE_STACK_FRAME __LC_SAVE_AREA
473 xc SP_ILC(4,%r15),SP_ILC(%r15)
474 mvc SP_PSW(16,%r15),__LC_PGM_OLD_PSW
475 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200476 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
478 jz pgm_no_vtime
479 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
480 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
481 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200482 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483pgm_no_vtime:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200484 stg %r11,SP_ARGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200485 lgf %r3,__LC_PGM_ILC # load program interruption code
Martin Schwidefsky1e546222010-10-25 16:10:37 +0200486 lg %r4,__LC_TRANS_EXC_CODE
487 REENABLE_IRQS
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488 lghi %r8,0x7f
489 ngr %r8,%r3
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200490 sll %r8,3
491 larl %r1,pgm_check_table
492 lg %r1,0(%r8,%r1) # load address of handler routine
493 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200494 basr %r14,%r1 # branch to interrupt-handler
495pgm_exit:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200496 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497
498#
499# handle per exception
500#
501pgm_per:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200502 tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is on
503 jnz pgm_per_std # ok, normal per event from user space
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504# ok its one of the special cases, now we need to find out which one
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200505 clc __LC_PGM_OLD_PSW(16),__LC_SVC_NEW_PSW
506 je pgm_svcper
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507# no interesting special case, ignore PER event
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200508 lpswe __LC_PGM_OLD_PSW
Linus Torvalds1da177e2005-04-16 15:20:36 -0700509
510#
511# Normal per exception
512#
513pgm_per_std:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200514 SAVE_ALL_PGM __LC_PGM_OLD_PSW,__LC_SAVE_AREA
515 CREATE_STACK_FRAME __LC_SAVE_AREA
516 mvc SP_PSW(16,%r15),__LC_PGM_OLD_PSW
517 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200518 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700519 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
520 jz pgm_no_vtime2
521 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
522 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
523 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200524 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525pgm_no_vtime2:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200526 lg %r1,__TI_task(%r12)
Michael Grundy4ba069b2006-09-20 15:58:39 +0200527 tm SP_PSW+1(%r15),0x01 # kernel per event ?
528 jz kernel_per
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100529 mvc __THREAD_per_cause(2,%r1),__LC_PER_CAUSE
530 mvc __THREAD_per_address(8,%r1),__LC_PER_ADDRESS
531 mvc __THREAD_per_paid(1,%r1),__LC_PER_PAID
532 oi __TI_flags+7(%r12),_TIF_PER_TRAP # set TIF_PER_TRAP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200533 lgf %r3,__LC_PGM_ILC # load program interruption code
Martin Schwidefsky1e546222010-10-25 16:10:37 +0200534 lg %r4,__LC_TRANS_EXC_CODE
535 REENABLE_IRQS
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 lghi %r8,0x7f
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200537 ngr %r8,%r3 # clear per-event-bit and ilc
Heiko Carstensf5cdac22010-07-27 19:29:37 +0200538 je pgm_exit2
539 sll %r8,3
540 larl %r1,pgm_check_table
541 lg %r1,0(%r8,%r1) # load address of handler routine
542 la %r2,SP_PTREGS(%r15) # address of register-save area
543 basr %r14,%r1 # branch to interrupt-handler
544pgm_exit2:
Heiko Carstensf5cdac22010-07-27 19:29:37 +0200545 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546
547#
548# it was a single stepped SVC that is causing all the trouble
549#
550pgm_svcper:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200551 SAVE_ALL_PGM __LC_SVC_OLD_PSW,__LC_SAVE_AREA
552 CREATE_STACK_FRAME __LC_SAVE_AREA
553 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
554 mvc SP_ILC(4,%r15),__LC_SVC_ILC
555 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
557 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
558 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200559 LAST_BREAK
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200560 lg %r8,__TI_task(%r12)
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100561 mvc __THREAD_per_cause(2,%r8),__LC_PER_CAUSE
562 mvc __THREAD_per_address(8,%r8),__LC_PER_ADDRESS
563 mvc __THREAD_per_paid(1,%r8),__LC_PER_PAID
564 oi __TI_flags+7(%r12),_TIF_PER_TRAP # set TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200566 lmg %r2,%r6,SP_R2(%r15) # load svc arguments
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567 j sysc_do_svc
568
Michael Grundy4ba069b2006-09-20 15:58:39 +0200569#
570# per was called from kernel, must be kprobes
571#
572kernel_per:
Martin Schwidefsky9ec27082010-10-29 16:50:45 +0200573 REENABLE_IRQS
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100574 xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
Michael Grundy4ba069b2006-09-20 15:58:39 +0200575 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100576 brasl %r14,do_per_trap
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200577 j pgm_exit
Michael Grundy4ba069b2006-09-20 15:58:39 +0200578
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579/*
580 * IO interrupt handler routine
581 */
Jan Glauber144d6342011-07-24 10:48:19 +0200582ENTRY(io_int_handler)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 stck __LC_INT_CLOCK
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100584 stpt __LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200585 SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+40
586 CREATE_STACK_FRAME __LC_SAVE_AREA+40
587 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
588 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200589 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
591 jz io_no_vtime
592 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
593 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
594 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200595 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596io_no_vtime:
Heiko Carstens1f194a42006-07-03 00:24:46 -0700597 TRACE_IRQS_OFF
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200598 la %r2,SP_PTREGS(%r15) # address of register-save area
599 brasl %r14,do_IRQ # call standard irq handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600io_return:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200601 LOCKDEP_SYS_EXIT
602 TRACE_IRQS_ON
603io_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200604 tm __TI_flags+7(%r12),_TIF_WORK_INT
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200605 jnz io_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100606io_restore:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200607 RESTORE_ALL __LC_RETURN_PSW,0
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700608io_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
Martin Schwidefsky26889052008-05-07 09:22:52 +0200610#
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200611# There is work todo, find out in which context we have been interrupted:
612# 1) if we return to user space we can do all _TIF_WORK_INT work
613# 2) if we return to kernel code and kvm is enabled check if we need to
614# modify the psw to leave SIE
615# 3) if we return to kernel code and preemptive scheduling is enabled check
616# the preemption counter and if it is zero call preempt_schedule_irq
617# Before any work can be done, a switch to the kernel stack is required.
Martin Schwidefsky26889052008-05-07 09:22:52 +0200618#
619io_work:
620 tm SP_PSW+1(%r15),0x01 # returning to user ?
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200621 jo io_work_user # yes -> do resched & signal
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200622#ifdef CONFIG_PREEMPT
Martin Schwidefsky26889052008-05-07 09:22:52 +0200623 # check for preemptive scheduling
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200624 icm %r0,15,__TI_precount(%r12)
Martin Schwidefsky26889052008-05-07 09:22:52 +0200625 jnz io_restore # preemption is disabled
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200626 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
627 jno io_restore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 # switch to kernel stack
629 lg %r1,SP_R15(%r15)
630 aghi %r1,-SP_SIZE
631 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200632 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633 lgr %r15,%r1
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200634 # TRACE_IRQS_ON already done at io_return, call
635 # TRACE_IRQS_OFF to keep things symmetrical
636 TRACE_IRQS_OFF
637 brasl %r14,preempt_schedule_irq
638 j io_return
639#else
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200640 j io_restore
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200641#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700642
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200643#
644# Need to do work before returning to userspace, switch to kernel stack
645#
Martin Schwidefsky26889052008-05-07 09:22:52 +0200646io_work_user:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647 lg %r1,__LC_KERNEL_STACK
648 aghi %r1,-SP_SIZE
649 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200650 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 lgr %r15,%r1
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200652
Linus Torvalds1da177e2005-04-16 15:20:36 -0700653#
654# One of the work bits is on. Find out which one.
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200655# Checked are: _TIF_SIGPENDING, _TIF_NOTIFY_RESUME, _TIF_NEED_RESCHED
Heiko Carstens54dfe5d2006-02-01 03:06:38 -0800656# and _TIF_MCCK_PENDING
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657#
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200658io_work_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200659 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700660 jo io_mcck_pending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200661 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662 jo io_reschedule
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200663 tm __TI_flags+7(%r12),_TIF_SIGPENDING
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200664 jo io_sigpending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200665 tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200666 jo io_notify_resume
667 j io_return # beware of critical section cleanup
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200668
Linus Torvalds1da177e2005-04-16 15:20:36 -0700669#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700670# _TIF_MCCK_PENDING is set, call handler
671#
672io_mcck_pending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200673 # TRACE_IRQS_ON already done at io_return
Heiko Carstensb771aea2007-07-27 12:29:18 +0200674 brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200675 TRACE_IRQS_OFF
676 j io_return
Heiko Carstens77fa2242005-06-25 14:55:30 -0700677
678#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200680#
681io_reschedule:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200682 # TRACE_IRQS_ON already done at io_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200683 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
684 brasl %r14,schedule # call scheduler
685 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
Heiko Carstens411788e2007-11-20 11:13:32 +0100686 TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200687 j io_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700688
689#
Roland McGrath02a029b2008-04-30 00:53:08 -0700690# _TIF_SIGPENDING or is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200692io_sigpending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200693 # TRACE_IRQS_ON already done at io_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200694 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
695 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 brasl %r14,do_signal # call do_signal
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200697 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
Heiko Carstens411788e2007-11-20 11:13:32 +0100698 TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200699 j io_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200701#
702# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
703#
704io_notify_resume:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200705 # TRACE_IRQS_ON already done at io_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200706 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
707 la %r2,SP_PTREGS(%r15) # load pt_regs
708 brasl %r14,do_notify_resume # call do_notify_resume
709 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
710 TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200711 j io_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200712
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713/*
714 * External interrupt handler routine
715 */
Jan Glauber144d6342011-07-24 10:48:19 +0200716ENTRY(ext_int_handler)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700717 stck __LC_INT_CLOCK
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100718 stpt __LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200719 SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+40
720 CREATE_STACK_FRAME __LC_SAVE_AREA+40
721 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
722 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200723 HANDLE_SIE_INTERCEPT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
725 jz ext_no_vtime
726 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
727 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
728 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200729 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730ext_no_vtime:
Heiko Carstens1f194a42006-07-03 00:24:46 -0700731 TRACE_IRQS_OFF
Martin Schwidefskyf6649a72010-10-25 16:10:38 +0200732 lghi %r1,4096
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200733 la %r2,SP_PTREGS(%r15) # address of register-save area
Martin Schwidefskyf6649a72010-10-25 16:10:38 +0200734 llgf %r3,__LC_CPU_ADDRESS # get cpu address + interruption code
735 llgf %r4,__LC_EXT_PARAMS # get external parameter
736 lg %r5,__LC_EXT_PARAMS2-4096(%r1) # get 64 bit external parameter
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200737 brasl %r14,do_extint
Linus Torvalds1da177e2005-04-16 15:20:36 -0700738 j io_return
739
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700740__critical_end:
741
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742/*
743 * Machine check handler routines
744 */
Jan Glauber144d6342011-07-24 10:48:19 +0200745ENTRY(mcck_int_handler)
Martin Schwidefsky63779812010-05-17 10:00:03 +0200746 stck __LC_MCCK_CLOCK
Heiko Carstens77fa2242005-06-25 14:55:30 -0700747 la %r1,4095 # revalidate r1
748 spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200749 lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200750 stmg %r11,%r15,__LC_SAVE_AREA+80
751 larl %r13,system_call
752 lg %r11,__LC_LAST_BREAK
Heiko Carstens77fa2242005-06-25 14:55:30 -0700753 la %r12,__LC_MCK_OLD_PSW
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200754 tm __LC_MCCK_CODE,0x80 # system damage?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700755 jo mcck_int_main # yes -> rest of mcck code invalid
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200756 la %r14,4095
Martin Schwidefsky63779812010-05-17 10:00:03 +0200757 mvc __LC_MCCK_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA-4095(%r14)
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200758 tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
759 jo 1f
760 la %r14,__LC_SYNC_ENTER_TIMER
761 clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
762 jl 0f
763 la %r14,__LC_ASYNC_ENTER_TIMER
7640: clc 0(8,%r14),__LC_EXIT_TIMER
765 jl 0f
766 la %r14,__LC_EXIT_TIMER
7670: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
768 jl 0f
769 la %r14,__LC_LAST_UPDATE_TIMER
7700: spt 0(%r14)
Martin Schwidefsky63779812010-05-17 10:00:03 +0200771 mvc __LC_MCCK_ENTER_TIMER(8),0(%r14)
Martin Schwidefskyc185b782008-12-25 13:39:25 +01007721: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700773 jno mcck_int_main # no -> skip cleanup critical
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200774 tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
Heiko Carstens77fa2242005-06-25 14:55:30 -0700775 jnz mcck_int_main # from user -> load kernel stack
776 clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_end)
777 jhe mcck_int_main
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200778 clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_start)
Heiko Carstens77fa2242005-06-25 14:55:30 -0700779 jl mcck_int_main
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200780 brasl %r14,cleanup_critical
Heiko Carstens77fa2242005-06-25 14:55:30 -0700781mcck_int_main:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200782 lg %r14,__LC_PANIC_STACK # are we already on the panic stack?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700783 slgr %r14,%r15
784 srag %r14,%r14,PAGE_SHIFT
785 jz 0f
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200786 lg %r15,__LC_PANIC_STACK # load panic stack
Martin Schwidefsky86f25522010-05-17 10:00:05 +02007870: aghi %r15,-SP_SIZE # make room for registers & psw
788 CREATE_STACK_FRAME __LC_SAVE_AREA+80
789 mvc SP_PSW(16,%r15),0(%r12)
790 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700791 tm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?
792 jno mcck_no_vtime # no -> no timer update
Martin Schwidefsky603d1a52011-07-24 10:48:18 +0200793 HANDLE_SIE_INTERCEPT
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200794 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700795 jz mcck_no_vtime
Martin Schwidefsky63779812010-05-17 10:00:03 +0200796 UPDATE_VTIME __LC_EXIT_TIMER,__LC_MCCK_ENTER_TIMER,__LC_USER_TIMER
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700797 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
Martin Schwidefsky63779812010-05-17 10:00:03 +0200798 mvc __LC_LAST_UPDATE_TIMER(8),__LC_MCCK_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200799 LAST_BREAK
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700800mcck_no_vtime:
Heiko Carstens77fa2242005-06-25 14:55:30 -0700801 la %r2,SP_PTREGS(%r15) # load pt_regs
802 brasl %r14,s390_do_machine_check
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200803 tm SP_PSW+1(%r15),0x01 # returning to user ?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700804 jno mcck_return
805 lg %r1,__LC_KERNEL_STACK # switch to kernel stack
806 aghi %r1,-SP_SIZE
807 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
808 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
809 lgr %r15,%r1
810 stosm __SF_EMPTY(%r15),0x04 # turn dat on
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200811 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700812 jno mcck_return
Heiko Carstens1f194a42006-07-03 00:24:46 -0700813 TRACE_IRQS_OFF
Heiko Carstens77fa2242005-06-25 14:55:30 -0700814 brasl %r14,s390_handle_mcck
Heiko Carstens1f194a42006-07-03 00:24:46 -0700815 TRACE_IRQS_ON
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816mcck_return:
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200817 mvc __LC_RETURN_MCCK_PSW(16),SP_PSW(%r15) # move return PSW
818 ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
819 lmg %r0,%r15,SP_R0(%r15) # load gprs 0-15
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200820 tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
821 jno 0f
822 stpt __LC_EXIT_TIMER
Martin Schwidefskyc185b782008-12-25 13:39:25 +01008230: lpswe __LC_RETURN_MCCK_PSW # back to caller
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200824mcck_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700825
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826/*
827 * Restart interruption handler, kick starter for additional CPUs
828 */
Heiko Carstens84b36a82007-06-19 13:10:03 +0200829#ifdef CONFIG_SMP
Heiko Carstens2bc89b52008-02-05 16:50:40 +0100830 __CPUINIT
Jan Glauber144d6342011-07-24 10:48:19 +0200831ENTRY(restart_int_handler)
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200832 basr %r1,0
833restart_base:
834 spt restart_vtime-restart_base(%r1)
835 stck __LC_LAST_UPDATE_CLOCK
836 mvc __LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
837 mvc __LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200838 lg %r15,__LC_SAVE_AREA+120 # load ksp
839 lghi %r10,__LC_CREGS_SAVE_AREA
840 lctlg %c0,%c15,0(%r10) # get new ctl regs
841 lghi %r10,__LC_AREGS_SAVE_AREA
842 lam %a0,%a15,0(%r10)
843 lmg %r6,%r15,__SF_GPRS(%r15) # load registers from clone
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200844 lg %r1,__LC_THREAD_INFO
845 mvc __LC_USER_TIMER(8),__TI_user_timer(%r1)
846 mvc __LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
847 xc __LC_STEAL_TIMER(8),__LC_STEAL_TIMER
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200848 stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
Michael Holzheu8eb4bd62011-05-10 17:13:39 +0200849 brasl %r14,start_secondary
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200850 .align 8
851restart_vtime:
852 .long 0x7fffffff,0xffffffff
Heiko Carstens84b36a82007-06-19 13:10:03 +0200853 .previous
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854#else
855/*
856 * If we do not run with SMP enabled, let the new CPU crash ...
857 */
Jan Glauber144d6342011-07-24 10:48:19 +0200858ENTRY(restart_int_handler)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200859 basr %r1,0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860restart_base:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200861 lpswe restart_crash-restart_base(%r1)
862 .align 8
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863restart_crash:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200864 .long 0x000a0000,0x00000000,0x00000000,0x00000000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700865restart_go:
866#endif
867
Michael Holzheu7dd6b332011-08-03 16:44:19 +0200868#
869# PSW restart interrupt handler
870#
871ENTRY(psw_restart_int_handler)
872 stg %r15,__LC_SAVE_AREA_64(%r0) # save r15
873 larl %r15,restart_stack # load restart stack
874 lg %r15,0(%r15)
875 aghi %r15,-SP_SIZE # make room for pt_regs
876 stmg %r0,%r14,SP_R0(%r15) # store gprs %r0-%r14 to stack
877 mvc SP_R15(8,%r15),__LC_SAVE_AREA_64(%r0)# store saved %r15 to stack
878 mvc SP_PSW(16,%r15),__LC_RST_OLD_PSW(%r0)# store restart old psw
879 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # set backchain to 0
880 brasl %r14,do_restart
881
882 larl %r14,restart_psw_crash # load disabled wait PSW if
883 lpswe 0(%r14) # do_restart returns
884 .align 8
885restart_psw_crash:
886 .quad 0x0002000080000000,0x0000000000000000 + restart_psw_crash
887
Martin Schwidefsky860dba42011-01-05 12:47:25 +0100888 .section .kprobes.text, "ax"
889
Linus Torvalds1da177e2005-04-16 15:20:36 -0700890#ifdef CONFIG_CHECK_STACK
891/*
892 * The synchronous or the asynchronous stack overflowed. We are dead.
893 * No need to properly save the registers, we are going to panic anyway.
894 * Setup a pt_regs so that show_trace can provide a good call trace.
895 */
896stack_overflow:
897 lg %r15,__LC_PANIC_STACK # change to panic stack
Heiko Carstens9514e232006-09-20 15:59:22 +0200898 aghi %r15,-SP_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200900 stmg %r0,%r10,SP_R0(%r15) # store gprs %r0-%r10 to kernel stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700901 la %r1,__LC_SAVE_AREA
902 chi %r12,__LC_SVC_OLD_PSW
903 je 0f
904 chi %r12,__LC_PGM_OLD_PSW
905 je 0f
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200906 la %r1,__LC_SAVE_AREA+40
9070: mvc SP_R11(40,%r15),0(%r1) # move %r11-%r15 to stack
Christian Borntraeger9e74a6b82008-04-17 07:46:30 +0200908 mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200909 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # clear back chain
910 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700911 jg kernel_stack_overflow
912#endif
913
914cleanup_table_system_call:
915 .quad system_call, sysc_do_svc
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200916cleanup_table_sysc_tif:
917 .quad sysc_tif, sysc_restore
918cleanup_table_sysc_restore:
919 .quad sysc_restore, sysc_done
920cleanup_table_io_tif:
921 .quad io_tif, io_restore
922cleanup_table_io_restore:
923 .quad io_restore, io_done
Linus Torvalds1da177e2005-04-16 15:20:36 -0700924
925cleanup_critical:
926 clc 8(8,%r12),BASED(cleanup_table_system_call)
927 jl 0f
928 clc 8(8,%r12),BASED(cleanup_table_system_call+8)
929 jl cleanup_system_call
9300:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200931 clc 8(8,%r12),BASED(cleanup_table_sysc_tif)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200933 clc 8(8,%r12),BASED(cleanup_table_sysc_tif+8)
934 jl cleanup_sysc_tif
Linus Torvalds1da177e2005-04-16 15:20:36 -07009350:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200936 clc 8(8,%r12),BASED(cleanup_table_sysc_restore)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700937 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200938 clc 8(8,%r12),BASED(cleanup_table_sysc_restore+8)
939 jl cleanup_sysc_restore
Linus Torvalds1da177e2005-04-16 15:20:36 -07009400:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200941 clc 8(8,%r12),BASED(cleanup_table_io_tif)
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200942 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200943 clc 8(8,%r12),BASED(cleanup_table_io_tif+8)
944 jl cleanup_io_tif
Martin Schwidefsky63b12242006-06-29 14:58:05 +02009450:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200946 clc 8(8,%r12),BASED(cleanup_table_io_restore)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700947 jl 0f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200948 clc 8(8,%r12),BASED(cleanup_table_io_restore+8)
949 jl cleanup_io_restore
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07009500:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700951 br %r14
952
953cleanup_system_call:
954 mvc __LC_RETURN_PSW(16),0(%r12)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+8)
956 jh 0f
Martin Schwidefsky63779812010-05-17 10:00:03 +0200957 mvc __LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
958 cghi %r12,__LC_MCK_OLD_PSW
959 je 0f
Linus Torvalds1da177e2005-04-16 15:20:36 -0700960 mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
Martin Schwidefsky63779812010-05-17 10:00:03 +02009610: cghi %r12,__LC_MCK_OLD_PSW
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200962 la %r12,__LC_SAVE_AREA+80
Martin Schwidefsky63779812010-05-17 10:00:03 +0200963 je 0f
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200964 la %r12,__LC_SAVE_AREA+40
Linus Torvalds1da177e2005-04-16 15:20:36 -07009650: clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+16)
966 jhe cleanup_vtime
Linus Torvalds1da177e2005-04-16 15:20:36 -0700967 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn)
968 jh 0f
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200969 mvc __LC_SAVE_AREA(40),0(%r12)
9700: lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
971 aghi %r15,-SP_SIZE # make room for registers & psw
972 stg %r15,32(%r12)
973 stg %r11,0(%r12)
974 CREATE_STACK_FRAME __LC_SAVE_AREA
975 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
976 mvc SP_ILC(4,%r15),__LC_SVC_ILC
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200977 mvc 8(8,%r12),__LC_THREAD_INFO
Linus Torvalds1da177e2005-04-16 15:20:36 -0700978cleanup_vtime:
979 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+24)
980 jhe cleanup_stime
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
982cleanup_stime:
983 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+32)
984 jh cleanup_update
985 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
986cleanup_update:
987 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200988 srag %r12,%r11,23
989 lg %r12,__LC_THREAD_INFO
990 jz 0f
991 stg %r11,__TI_last_break(%r12)
9920: mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_system_call+8)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700993 la %r12,__LC_RETURN_PSW
994 br %r14
995cleanup_system_call_insn:
996 .quad sysc_saveall
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200997 .quad system_call
998 .quad sysc_vtime
999 .quad sysc_stime
1000 .quad sysc_update
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001002cleanup_sysc_tif:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001003 mvc __LC_RETURN_PSW(8),0(%r12)
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001004 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_sysc_tif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001005 la %r12,__LC_RETURN_PSW
1006 br %r14
1007
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001008cleanup_sysc_restore:
1009 clc 8(8,%r12),BASED(cleanup_sysc_restore_insn)
Martin Schwidefsky63779812010-05-17 10:00:03 +02001010 je 2f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001011 clc 8(8,%r12),BASED(cleanup_sysc_restore_insn+8)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001012 jhe 0f
Martin Schwidefsky63779812010-05-17 10:00:03 +02001013 mvc __LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
1014 cghi %r12,__LC_MCK_OLD_PSW
1015 je 0f
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001016 mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
10170: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001018 cghi %r12,__LC_MCK_OLD_PSW
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001019 la %r12,__LC_SAVE_AREA+80
Martin Schwidefsky63779812010-05-17 10:00:03 +02001020 je 1f
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001021 la %r12,__LC_SAVE_AREA+40
10221: mvc 0(40,%r12),SP_R11(%r15)
1023 lmg %r0,%r10,SP_R0(%r15)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024 lg %r15,SP_R15(%r15)
Martin Schwidefsky63779812010-05-17 10:00:03 +020010252: la %r12,__LC_RETURN_PSW
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026 br %r14
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001027cleanup_sysc_restore_insn:
Heiko Carstens411788e2007-11-20 11:13:32 +01001028 .quad sysc_done - 4
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001029 .quad sysc_done - 16
Linus Torvalds1da177e2005-04-16 15:20:36 -07001030
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001031cleanup_io_tif:
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001032 mvc __LC_RETURN_PSW(8),0(%r12)
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001033 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_io_tif)
Martin Schwidefsky176b1802010-04-09 13:43:00 +02001034 la %r12,__LC_RETURN_PSW
1035 br %r14
1036
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001037cleanup_io_restore:
1038 clc 8(8,%r12),BASED(cleanup_io_restore_insn)
Martin Schwidefsky63779812010-05-17 10:00:03 +02001039 je 1f
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001040 clc 8(8,%r12),BASED(cleanup_io_restore_insn+8)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001041 jhe 0f
Martin Schwidefsky63779812010-05-17 10:00:03 +02001042 mvc __LC_EXIT_TIMER(8),__LC_MCCK_ENTER_TIMER
Martin Schwidefskyc742b312008-12-31 15:11:42 +010010430: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001044 mvc __LC_SAVE_AREA+80(40),SP_R11(%r15)
1045 lmg %r0,%r10,SP_R0(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001046 lg %r15,SP_R15(%r15)
Martin Schwidefsky63779812010-05-17 10:00:03 +020010471: la %r12,__LC_RETURN_PSW
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001048 br %r14
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +02001049cleanup_io_restore_insn:
Heiko Carstens411788e2007-11-20 11:13:32 +01001050 .quad io_done - 4
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001051 .quad io_done - 16
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001052
Linus Torvalds1da177e2005-04-16 15:20:36 -07001053/*
1054 * Integer constants
1055 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001056 .align 4
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057.Lcritical_start:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001058 .quad __critical_start
Linus Torvalds1da177e2005-04-16 15:20:36 -07001059.Lcritical_end:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001060 .quad __critical_end
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061
Martin Schwidefsky603d1a52011-07-24 10:48:18 +02001062#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
1063/*
1064 * sie64a calling convention:
1065 * %r2 pointer to sie control block
1066 * %r3 guest register save area
1067 */
Jan Glauber144d6342011-07-24 10:48:19 +02001068ENTRY(sie64a)
Martin Schwidefsky603d1a52011-07-24 10:48:18 +02001069 stmg %r6,%r14,__SF_GPRS(%r15) # save kernel registers
1070 stg %r2,__SF_EMPTY(%r15) # save control block pointer
1071 stg %r3,__SF_EMPTY+8(%r15) # save guest register save area
1072 lmg %r0,%r13,0(%r3) # load guest gprs 0-13
1073 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1074 oi __TI_flags+6(%r14),_TIF_SIE>>8
1075sie_loop:
1076 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1077 tm __TI_flags+7(%r14),_TIF_EXIT_SIE
1078 jnz sie_exit
1079 lg %r14,__SF_EMPTY(%r15) # get control block pointer
1080 SPP __SF_EMPTY(%r15) # set guest id
1081 sie 0(%r14)
1082sie_done:
1083 SPP __LC_CMF_HPP # set host id
1084 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1085sie_exit:
1086 ni __TI_flags+6(%r14),255-(_TIF_SIE>>8)
1087 lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
1088 stmg %r0,%r13,0(%r14) # save guest gprs 0-13
1089 lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
1090 lghi %r2,0
1091 br %r14
1092sie_fault:
1093 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1094 ni __TI_flags+6(%r14),255-(_TIF_SIE>>8)
1095 lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
1096 stmg %r0,%r13,0(%r14) # save guest gprs 0-13
1097 lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
1098 lghi %r2,-EFAULT
1099 br %r14
1100
1101 .align 8
1102.Lsie_loop:
1103 .quad sie_loop
1104.Lsie_done:
1105 .quad sie_done
1106
1107 .section __ex_table,"a"
1108 .quad sie_loop,sie_fault
1109 .previous
1110#endif
1111
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001112 .section .rodata, "a"
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113#define SYSCALL(esa,esame,emu) .long esame
Heiko Carstens9bf12262009-06-12 10:26:47 +02001114 .globl sys_call_table
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115sys_call_table:
1116#include "syscalls.S"
1117#undef SYSCALL
1118
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -08001119#ifdef CONFIG_COMPAT
Linus Torvalds1da177e2005-04-16 15:20:36 -07001120
1121#define SYSCALL(esa,esame,emu) .long emu
Linus Torvalds1da177e2005-04-16 15:20:36 -07001122sys_call_table_emu:
1123#include "syscalls.S"
1124#undef SYSCALL
1125#endif