blob: 009ca6175db955f29565e5959b629f2773e7f899 [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 *
Heiko Carstens54dfe5d2006-02-01 03:06:38 -08005 * Copyright (C) IBM Corp. 1999,2006
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
12#include <linux/sys.h>
13#include <linux/linkage.h>
Heiko Carstens2bc89b52008-02-05 16:50:40 +010014#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <asm/cache.h>
16#include <asm/lowcore.h>
17#include <asm/errno.h>
18#include <asm/ptrace.h>
19#include <asm/thread_info.h>
Sam Ravnborg0013a852005-09-09 20:57:26 +020020#include <asm/asm-offsets.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <asm/unistd.h>
22#include <asm/page.h>
23
24/*
25 * Stack layout for the system_call stack entry.
26 * The first few entries are identical to the user_regs_struct.
27 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +020028SP_PTREGS = STACK_FRAME_OVERHEAD
29SP_ARGS = STACK_FRAME_OVERHEAD + __PT_ARGS
30SP_PSW = STACK_FRAME_OVERHEAD + __PT_PSW
31SP_R0 = STACK_FRAME_OVERHEAD + __PT_GPRS
32SP_R1 = STACK_FRAME_OVERHEAD + __PT_GPRS + 8
33SP_R2 = STACK_FRAME_OVERHEAD + __PT_GPRS + 16
34SP_R3 = STACK_FRAME_OVERHEAD + __PT_GPRS + 24
35SP_R4 = STACK_FRAME_OVERHEAD + __PT_GPRS + 32
36SP_R5 = STACK_FRAME_OVERHEAD + __PT_GPRS + 40
37SP_R6 = STACK_FRAME_OVERHEAD + __PT_GPRS + 48
38SP_R7 = STACK_FRAME_OVERHEAD + __PT_GPRS + 56
39SP_R8 = STACK_FRAME_OVERHEAD + __PT_GPRS + 64
40SP_R9 = STACK_FRAME_OVERHEAD + __PT_GPRS + 72
41SP_R10 = STACK_FRAME_OVERHEAD + __PT_GPRS + 80
42SP_R11 = STACK_FRAME_OVERHEAD + __PT_GPRS + 88
43SP_R12 = STACK_FRAME_OVERHEAD + __PT_GPRS + 96
44SP_R13 = STACK_FRAME_OVERHEAD + __PT_GPRS + 104
45SP_R14 = STACK_FRAME_OVERHEAD + __PT_GPRS + 112
46SP_R15 = STACK_FRAME_OVERHEAD + __PT_GPRS + 120
47SP_ORIG_R2 = STACK_FRAME_OVERHEAD + __PT_ORIG_GPR2
48SP_ILC = STACK_FRAME_OVERHEAD + __PT_ILC
Martin Schwidefsky59da2132008-11-27 11:05:55 +010049SP_SVCNR = STACK_FRAME_OVERHEAD + __PT_SVCNR
Heiko Carstens25d83cb2006-09-28 16:56:37 +020050SP_SIZE = STACK_FRAME_OVERHEAD + __PT_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
52STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
53STACK_SIZE = 1 << STACK_SHIFT
54
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +020055_TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
Heiko Carstens54dfe5d2006-02-01 03:06:38 -080056 _TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_SINGLE_STEP )
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +020057_TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
Heiko Carstens54dfe5d2006-02-01 03:06:38 -080058 _TIF_MCCK_PENDING)
Heiko Carstens9bf12262009-06-12 10:26:47 +020059_TIF_SYSCALL = (_TIF_SYSCALL_TRACE>>8 | _TIF_SYSCALL_AUDIT>>8 | \
60 _TIF_SECCOMP>>8 | _TIF_SYSCALL_FTRACE>>8)
Linus Torvalds1da177e2005-04-16 15:20:36 -070061
62#define BASED(name) name-system_call(%r13)
63
Heiko Carstens1f194a42006-07-03 00:24:46 -070064#ifdef CONFIG_TRACE_IRQFLAGS
65 .macro TRACE_IRQS_ON
Heiko Carstens50bec4c2008-11-14 18:18:05 +010066 basr %r2,%r0
67 brasl %r14,trace_hardirqs_on_caller
Heiko Carstens1f194a42006-07-03 00:24:46 -070068 .endm
69
70 .macro TRACE_IRQS_OFF
Heiko Carstens50bec4c2008-11-14 18:18:05 +010071 basr %r2,%r0
72 brasl %r14,trace_hardirqs_off_caller
Heiko Carstens1f194a42006-07-03 00:24:46 -070073 .endm
Heiko Carstens523b44c2007-10-11 22:11:12 +020074
Heiko Carstens411788e2007-11-20 11:13:32 +010075 .macro TRACE_IRQS_CHECK
Heiko Carstens50bec4c2008-11-14 18:18:05 +010076 basr %r2,%r0
Heiko Carstens411788e2007-11-20 11:13:32 +010077 tm SP_PSW(%r15),0x03 # irqs enabled?
78 jz 0f
Heiko Carstens50bec4c2008-11-14 18:18:05 +010079 brasl %r14,trace_hardirqs_on_caller
Heiko Carstens411788e2007-11-20 11:13:32 +010080 j 1f
Heiko Carstens50bec4c2008-11-14 18:18:05 +0100810: brasl %r14,trace_hardirqs_off_caller
Heiko Carstens411788e2007-11-20 11:13:32 +0100821:
Heiko Carstens523b44c2007-10-11 22:11:12 +020083 .endm
Heiko Carstens1f194a42006-07-03 00:24:46 -070084#else
85#define TRACE_IRQS_ON
86#define TRACE_IRQS_OFF
Heiko Carstens411788e2007-11-20 11:13:32 +010087#define TRACE_IRQS_CHECK
88#endif
89
90#ifdef CONFIG_LOCKDEP
91 .macro LOCKDEP_SYS_EXIT
92 tm SP_PSW+1(%r15),0x01 # returning to user ?
93 jz 0f
94 brasl %r14,lockdep_sys_exit
950:
96 .endm
97#else
Heiko Carstens523b44c2007-10-11 22:11:12 +020098#define LOCKDEP_SYS_EXIT
Heiko Carstens1f194a42006-07-03 00:24:46 -070099#endif
100
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200101 .macro UPDATE_VTIME lc_from,lc_to,lc_sum
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 lg %r10,\lc_from
103 slg %r10,\lc_to
104 alg %r10,\lc_sum
105 stg %r10,\lc_sum
106 .endm
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107
108/*
109 * Register usage in interrupt handlers:
110 * R9 - pointer to current task structure
111 * R13 - pointer to literal pool
112 * R14 - return register for function calls
113 * R15 - kernel stack pointer
114 */
115
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200116 .macro SAVE_ALL_BASE savearea
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117 stmg %r12,%r15,\savearea
118 larl %r13,system_call
119 .endm
120
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200121 .macro SAVE_ALL_SVC psworg,savearea
122 la %r12,\psworg
123 lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
124 .endm
125
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200126 .macro SAVE_ALL_SYNC psworg,savearea
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 la %r12,\psworg
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 tm \psworg+1,0x01 # test problem state bit
129 jz 2f # skip stack setup save
130 lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200131#ifdef CONFIG_CHECK_STACK
132 j 3f
1332: tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
134 jz stack_overflow
1353:
136#endif
1372:
138 .endm
139
140 .macro SAVE_ALL_ASYNC psworg,savearea
141 la %r12,\psworg
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142 tm \psworg+1,0x01 # test problem state bit
143 jnz 1f # from user -> load kernel stack
144 clc \psworg+8(8),BASED(.Lcritical_end)
145 jhe 0f
146 clc \psworg+8(8),BASED(.Lcritical_start)
147 jl 0f
148 brasl %r14,cleanup_critical
Peter Oberparleiter6add9f72005-09-16 19:27:42 -0700149 tm 1(%r12),0x01 # retest problem state after cleanup
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150 jnz 1f
1510: lg %r14,__LC_ASYNC_STACK # are we already on the async. stack ?
152 slgr %r14,%r15
153 srag %r14,%r14,STACK_SHIFT
154 jz 2f
1551: lg %r15,__LC_ASYNC_STACK # load async stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156#ifdef CONFIG_CHECK_STACK
157 j 3f
1582: tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
159 jz stack_overflow
1603:
161#endif
Heiko Carstens77fa2242005-06-25 14:55:30 -07001622:
163 .endm
164
165 .macro CREATE_STACK_FRAME psworg,savearea
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200166 aghi %r15,-SP_SIZE # make room for registers & psw
167 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700168 stg %r2,SP_ORIG_R2(%r15) # store original content of gpr 2
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100169 icm %r12,3,__LC_SVC_ILC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 stmg %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100171 st %r12,SP_SVCNR(%r15)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 mvc SP_R12(32,%r15),\savearea # move %r12-%r15 to stack
173 la %r12,0
174 stg %r12,__SF_BACKCHAIN(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200175 .endm
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700177 .macro RESTORE_ALL psworg,sync
178 mvc \psworg(16),SP_PSW(%r15) # move user PSW to lowcore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179 .if !\sync
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700180 ni \psworg+1,0xfd # clear wait state bit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181 .endif
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100182 lg %r14,__LC_VDSO_PER_CPU
183 lmg %r0,%r13,SP_R0(%r15) # load gprs 0-13 of user
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100184 stpt __LC_EXIT_TIMER
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100185 mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
186 lmg %r14,%r15,SP_R14(%r15) # load grps 14-15 of user
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700187 lpswe \psworg # back to caller
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188 .endm
189
190/*
191 * Scheduler resume function, called by switch_to
192 * gpr2 = (task_struct *) prev
193 * gpr3 = (task_struct *) next
194 * Returns:
195 * gpr2 = prev
196 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200197 .globl __switch_to
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198__switch_to:
199 tm __THREAD_per+4(%r3),0xe8 # is the new process using per ?
200 jz __switch_to_noper # if not we're fine
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200201 stctg %c9,%c11,__SF_EMPTY(%r15)# We are using per stuff
202 clc __THREAD_per(24,%r3),__SF_EMPTY(%r15)
203 je __switch_to_noper # we got away without bashing TLB's
204 lctlg %c9,%c11,__THREAD_per(%r3) # Nope we didn't
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205__switch_to_noper:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200206 lg %r4,__THREAD_info(%r2) # get thread_info of prev
Heiko Carstens77fa2242005-06-25 14:55:30 -0700207 tm __TI_flags+7(%r4),_TIF_MCCK_PENDING # machine check pending?
208 jz __switch_to_no_mcck
209 ni __TI_flags+7(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
210 lg %r4,__THREAD_info(%r3) # get thread_info of next
211 oi __TI_flags+7(%r4),_TIF_MCCK_PENDING # set it in next
212__switch_to_no_mcck:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200213 stmg %r6,%r15,__SF_GPRS(%r15)# store __switch_to registers of prev task
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 stg %r15,__THREAD_ksp(%r2) # store kernel stack to prev->tss.ksp
215 lg %r15,__THREAD_ksp(%r3) # load kernel stack from next->tss.ksp
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200216 lmg %r6,%r15,__SF_GPRS(%r15)# load __switch_to registers of next task
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217 stg %r3,__LC_CURRENT # __LC_CURRENT = current task struct
218 lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200219 lg %r3,__THREAD_info(%r3) # load thread_info from task struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220 stg %r3,__LC_THREAD_INFO
221 aghi %r3,STACK_SIZE
222 stg %r3,__LC_KERNEL_STACK # __LC_KERNEL_STACK = new kernel stack
223 br %r14
224
225__critical_start:
226/*
227 * SVC interrupt handler routine. System calls are synchronous events and
228 * are executed with interrupts enabled.
229 */
230
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200231 .globl system_call
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232system_call:
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100233 stpt __LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234sysc_saveall:
235 SAVE_ALL_BASE __LC_SAVE_AREA
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200236 SAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200237 CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
238 llgh %r7,__LC_SVC_INT_CODE # get svc number from lowcore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239sysc_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
241sysc_stime:
242 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
243sysc_update:
244 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245sysc_do_svc:
246 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100247 ltgr %r7,%r7 # test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248 jnz sysc_nr_ok
249 # svc 0: system call number in %r1
250 cl %r1,BASED(.Lnr_syscalls)
251 jnl sysc_nr_ok
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200252 lgfr %r7,%r1 # clear high word in r1
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253sysc_nr_ok:
254 mvc SP_ARGS(8,%r15),SP_R7(%r15)
255sysc_do_restart:
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100256 sth %r7,SP_SVCNR(%r15)
257 sllg %r7,%r7,2 # svc number * 4
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200258 larl %r10,sys_call_table
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800259#ifdef CONFIG_COMPAT
Heiko Carstensc5630772005-09-03 15:58:04 -0700260 tm __TI_flags+5(%r9),(_TIF_31BIT>>16) # running in 31 bit mode ?
261 jno sysc_noemu
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200262 larl %r10,sys_call_table_emu # use 31 bit emulation system calls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700263sysc_noemu:
264#endif
Heiko Carstensbcf5cef2009-06-12 10:26:26 +0200265 tm __TI_flags+6(%r9),_TIF_SYSCALL
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200266 lgf %r8,0(%r7,%r10) # load address of system call routine
267 jnz sysc_tracesys
268 basr %r14,%r8 # call sys_xxxx
269 stg %r2,SP_R2(%r15) # store return value (change R2 on stack)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270
271sysc_return:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 tm __TI_flags+7(%r9),_TIF_WORK_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200273 jnz sysc_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100274sysc_restore:
275#ifdef CONFIG_TRACE_IRQFLAGS
276 larl %r1,sysc_restore_trace_psw
277 lpswe 0(%r1)
278sysc_restore_trace:
279 TRACE_IRQS_CHECK
Heiko Carstens523b44c2007-10-11 22:11:12 +0200280 LOCKDEP_SYS_EXIT
Heiko Carstens411788e2007-11-20 11:13:32 +0100281#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282sysc_leave:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200283 RESTORE_ALL __LC_RETURN_PSW,1
Heiko Carstens411788e2007-11-20 11:13:32 +0100284sysc_done:
285
286#ifdef CONFIG_TRACE_IRQFLAGS
Hendrik Bruecknera8c3cb42009-09-11 10:28:42 +0200287 .section .data,"aw",@progbits
Heiko Carstens411788e2007-11-20 11:13:32 +0100288 .align 8
289 .globl sysc_restore_trace_psw
290sysc_restore_trace_psw:
291 .quad 0, sysc_restore_trace
Hendrik Bruecknera8c3cb42009-09-11 10:28:42 +0200292 .previous
Heiko Carstens411788e2007-11-20 11:13:32 +0100293#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294
295#
296# recheck if there is more work to do
297#
298sysc_work_loop:
299 tm __TI_flags+7(%r9),_TIF_WORK_SVC
Heiko Carstens411788e2007-11-20 11:13:32 +0100300 jz sysc_restore # there is no work to do
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301#
302# One of the work bits is on. Find out which one.
303#
304sysc_work:
Martin Schwidefsky26889052008-05-07 09:22:52 +0200305 tm SP_PSW+1(%r15),0x01 # returning to user ?
306 jno sysc_restore
Heiko Carstens77fa2242005-06-25 14:55:30 -0700307 tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
308 jo sysc_mcck_pending
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
310 jo sysc_reschedule
Roland McGrath02a029b2008-04-30 00:53:08 -0700311 tm __TI_flags+7(%r9),_TIF_SIGPENDING
Heiko Carstens54dfe5d2006-02-01 03:06:38 -0800312 jnz sysc_sigpending
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200313 tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
314 jnz sysc_notify_resume
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315 tm __TI_flags+7(%r9),_TIF_RESTART_SVC
316 jo sysc_restart
317 tm __TI_flags+7(%r9),_TIF_SINGLE_STEP
318 jo sysc_singlestep
Heiko Carstens411788e2007-11-20 11:13:32 +0100319 j sysc_restore
320sysc_work_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700321
322#
323# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200324#
325sysc_reschedule:
326 larl %r14,sysc_work_loop
327 jg schedule # return point is sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700328
329#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700330# _TIF_MCCK_PENDING is set, call handler
331#
332sysc_mcck_pending:
333 larl %r14,sysc_work_loop
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200334 jg s390_handle_mcck # TIF bit will be cleared by handler
Heiko Carstens77fa2242005-06-25 14:55:30 -0700335
336#
Roland McGrath02a029b2008-04-30 00:53:08 -0700337# _TIF_SIGPENDING is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700338#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200339sysc_sigpending:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340 ni __TI_flags+7(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200341 la %r2,SP_PTREGS(%r15) # load pt_regs
342 brasl %r14,do_signal # call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 tm __TI_flags+7(%r9),_TIF_RESTART_SVC
344 jo sysc_restart
345 tm __TI_flags+7(%r9),_TIF_SINGLE_STEP
346 jo sysc_singlestep
Heiko Carstense1c3ad92005-11-07 00:59:02 -0800347 j sysc_work_loop
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348
349#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200350# _TIF_NOTIFY_RESUME is set, call do_notify_resume
351#
352sysc_notify_resume:
353 la %r2,SP_PTREGS(%r15) # load pt_regs
354 larl %r14,sysc_work_loop
355 jg do_notify_resume # call do_notify_resume
356
357#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358# _TIF_RESTART_SVC is set, set up registers and restart svc
359#
360sysc_restart:
361 ni __TI_flags+7(%r9),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200362 lg %r7,SP_R2(%r15) # load new svc number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 mvc SP_R2(8,%r15),SP_ORIG_R2(%r15) # restore first argument
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200364 lmg %r2,%r6,SP_R2(%r15) # load svc arguments
365 j sysc_do_restart # restart svc
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366
367#
368# _TIF_SINGLE_STEP is set, call do_single_step
369#
370sysc_singlestep:
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100371 ni __TI_flags+7(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
372 xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 la %r2,SP_PTREGS(%r15) # address of register-save area
374 larl %r14,sysc_return # load adr. of system return
375 jg do_single_step # branch to do_sigtrap
376
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200378# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
379# and after the system call
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380#
381sysc_tracesys:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200382 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383 la %r3,0
384 srl %r7,2
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200385 stg %r7,SP_R2(%r15)
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200386 brasl %r14,do_syscall_trace_enter
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 lghi %r0,NR_syscalls
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200388 clgr %r0,%r2
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389 jnh sysc_tracenogo
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100390 sllg %r7,%r2,2 # svc number *4
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391 lgf %r8,0(%r7,%r10)
392sysc_tracego:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200393 lmg %r3,%r6,SP_R3(%r15)
394 lg %r2,SP_ORIG_R2(%r15)
395 basr %r14,%r8 # call sys_xxx
396 stg %r2,SP_R2(%r15) # store return value
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397sysc_tracenogo:
Heiko Carstensbcf5cef2009-06-12 10:26:26 +0200398 tm __TI_flags+6(%r9),_TIF_SYSCALL
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200399 jz sysc_return
400 la %r2,SP_PTREGS(%r15) # load pt_regs
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200401 larl %r14,sysc_return # return point is sysc_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200402 jg do_syscall_trace_exit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403
404#
405# a new process exits the kernel with ret_from_fork
406#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200407 .globl ret_from_fork
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408ret_from_fork:
409 lg %r13,__LC_SVC_NEW_PSW+8
410 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
411 tm SP_PSW+1(%r15),0x01 # forking a kernel thread ?
412 jo 0f
413 stg %r15,SP_R15(%r15) # store stack pointer for new kthread
Heiko Carstens25d83cb2006-09-28 16:56:37 +02004140: brasl %r14,schedule_tail
Heiko Carstens1f194a42006-07-03 00:24:46 -0700415 TRACE_IRQS_ON
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200416 stosm 24(%r15),0x03 # reenable interrupts
Al Viro8f2961c2008-12-25 13:37:58 +0100417 j sysc_tracenogo
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418
419#
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200420# kernel_execve function needs to deal with pt_regs that is not
421# at the usual place
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422#
Martin Schwidefsky03ff9a22007-04-27 16:01:40 +0200423 .globl kernel_execve
424kernel_execve:
425 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
443 lg %r9,__LC_THREAD_INFO
444 mvc SP_PTREGS(__PT_SIZE,%r15),0(%r12) # copy pt_regs
445 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
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200454 .globl pgm_check_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700455pgm_check_handler:
456/*
457 * First we need to check for a special case:
458 * Single stepping an instruction that disables the PER event mask will
459 * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
460 * For a single stepped SVC the program check handler gets control after
461 * the SVC new PSW has been loaded. But we want to execute the SVC first and
462 * then handle the PER event. Therefore we update the SVC old PSW to point
463 * to the pgm_check_handler and branch to the SVC handler after we checked
464 * if we have to load the kernel stack register.
465 * For every other possible cause for PER event without the PER mask set
466 * we just ignore the PER event (FIXME: is there anything we have to do
467 * for LPSW?).
468 */
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100469 stpt __LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700470 SAVE_ALL_BASE __LC_SAVE_AREA
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200471 tm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
472 jnz pgm_per # got per exception -> special case
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200473 SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
Heiko Carstens77fa2242005-06-25 14:55:30 -0700474 CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
476 jz pgm_no_vtime
477 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
478 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
479 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
480pgm_no_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
Christian Borntraeger9e74a6b82008-04-17 07:46:30 +0200482 mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
Heiko Carstens411788e2007-11-20 11:13:32 +0100483 TRACE_IRQS_OFF
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200484 lgf %r3,__LC_PGM_ILC # load program interruption code
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 lghi %r8,0x7f
486 ngr %r8,%r3
487pgm_do_call:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200488 sll %r8,3
489 larl %r1,pgm_check_table
490 lg %r1,0(%r8,%r1) # load address of handler routine
491 la %r2,SP_PTREGS(%r15) # address of register-save area
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492 larl %r14,sysc_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200493 br %r1 # branch to interrupt-handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494
495#
496# handle per exception
497#
498pgm_per:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200499 tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is on
500 jnz pgm_per_std # ok, normal per event from user space
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501# ok its one of the special cases, now we need to find out which one
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200502 clc __LC_PGM_OLD_PSW(16),__LC_SVC_NEW_PSW
503 je pgm_svcper
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504# no interesting special case, ignore PER event
505 lmg %r12,%r15,__LC_SAVE_AREA
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200506 lpswe __LC_PGM_OLD_PSW
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507
508#
509# Normal per exception
510#
511pgm_per_std:
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200512 SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
Heiko Carstens77fa2242005-06-25 14:55:30 -0700513 CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
515 jz pgm_no_vtime2
516 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
517 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
518 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
519pgm_no_vtime2:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
Heiko Carstens411788e2007-11-20 11:13:32 +0100521 TRACE_IRQS_OFF
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 lg %r1,__TI_task(%r9)
Michael Grundy4ba069b2006-09-20 15:58:39 +0200523 tm SP_PSW+1(%r15),0x01 # kernel per event ?
524 jz kernel_per
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525 mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
526 mvc __THREAD_per+__PER_address(8,%r1),__LC_PER_ADDRESS
527 mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
528 oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200529 lgf %r3,__LC_PGM_ILC # load program interruption code
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530 lghi %r8,0x7f
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200531 ngr %r8,%r3 # clear per-event-bit and ilc
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 je sysc_return
533 j pgm_do_call
534
535#
536# it was a single stepped SVC that is causing all the trouble
537#
538pgm_svcper:
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200539 SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Heiko Carstens77fa2242005-06-25 14:55:30 -0700540 CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
542 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
543 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200544 llgh %r7,__LC_SVC_INT_CODE # get svc number from lowcore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
546 lg %r1,__TI_task(%r9)
547 mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
548 mvc __THREAD_per+__PER_address(8,%r1),__LC_PER_ADDRESS
549 mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
550 oi __TI_flags+7(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
Heiko Carstens1f194a42006-07-03 00:24:46 -0700551 TRACE_IRQS_ON
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
553 j sysc_do_svc
554
Michael Grundy4ba069b2006-09-20 15:58:39 +0200555#
556# per was called from kernel, must be kprobes
557#
558kernel_per:
Martin Schwidefsky59da2132008-11-27 11:05:55 +0100559 xc SP_SVCNR(2,%r15),SP_SVCNR(%r15) # clear svc number
Michael Grundy4ba069b2006-09-20 15:58:39 +0200560 la %r2,SP_PTREGS(%r15) # address of register-save area
Heiko Carstens411788e2007-11-20 11:13:32 +0100561 larl %r14,sysc_restore # load adr. of system ret, no work
Michael Grundy4ba069b2006-09-20 15:58:39 +0200562 jg do_single_step # branch to do_single_step
563
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564/*
565 * IO interrupt handler routine
566 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200567 .globl io_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568io_int_handler:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700569 stck __LC_INT_CLOCK
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100570 stpt __LC_ASYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571 SAVE_ALL_BASE __LC_SAVE_AREA+32
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200572 SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
Heiko Carstens77fa2242005-06-25 14:55:30 -0700573 CREATE_STACK_FRAME __LC_IO_OLD_PSW,__LC_SAVE_AREA+32
Linus Torvalds1da177e2005-04-16 15:20:36 -0700574 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
575 jz io_no_vtime
576 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
577 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
578 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
579io_no_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
Heiko Carstens1f194a42006-07-03 00:24:46 -0700581 TRACE_IRQS_OFF
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200582 la %r2,SP_PTREGS(%r15) # address of register-save area
583 brasl %r14,do_IRQ # call standard irq handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584io_return:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 tm __TI_flags+7(%r9),_TIF_WORK_INT
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200586 jnz io_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100587io_restore:
588#ifdef CONFIG_TRACE_IRQFLAGS
589 larl %r1,io_restore_trace_psw
590 lpswe 0(%r1)
591io_restore_trace:
592 TRACE_IRQS_CHECK
Heiko Carstens523b44c2007-10-11 22:11:12 +0200593 LOCKDEP_SYS_EXIT
Heiko Carstens411788e2007-11-20 11:13:32 +0100594#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595io_leave:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200596 RESTORE_ALL __LC_RETURN_PSW,0
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700597io_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700598
Heiko Carstens411788e2007-11-20 11:13:32 +0100599#ifdef CONFIG_TRACE_IRQFLAGS
Hendrik Bruecknera8c3cb42009-09-11 10:28:42 +0200600 .section .data,"aw",@progbits
Heiko Carstens411788e2007-11-20 11:13:32 +0100601 .align 8
602 .globl io_restore_trace_psw
603io_restore_trace_psw:
604 .quad 0, io_restore_trace
Hendrik Bruecknera8c3cb42009-09-11 10:28:42 +0200605 .previous
Heiko Carstens411788e2007-11-20 11:13:32 +0100606#endif
607
Martin Schwidefsky26889052008-05-07 09:22:52 +0200608#
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200609# There is work todo, we need to check if we return to userspace, then
610# check, if we are in SIE, if yes leave it
Martin Schwidefsky26889052008-05-07 09:22:52 +0200611#
612io_work:
613 tm SP_PSW+1(%r15),0x01 # returning to user ?
614#ifndef CONFIG_PREEMPT
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200615#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
616 jnz io_work_user # yes -> no need to check for SIE
617 la %r1, BASED(sie_opcode) # we return to kernel here
618 lg %r2, SP_PSW+8(%r15)
619 clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
620 jne io_restore # no-> return to kernel
621 lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
622 aghi %r1, 4
623 stg %r1, SP_PSW+8(%r15)
624 j io_restore # return to kernel
625#else
Martin Schwidefsky26889052008-05-07 09:22:52 +0200626 jno io_restore # no-> skip resched & signal
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200627#endif
Martin Schwidefsky26889052008-05-07 09:22:52 +0200628#else
629 jnz io_work_user # yes -> do resched & signal
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200630#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
631 la %r1, BASED(sie_opcode)
632 lg %r2, SP_PSW+8(%r15)
633 clc 0(2,%r1), 0(%r2) # is current instruction = SIE?
634 jne 0f # no -> leave PSW alone
635 lg %r1, SP_PSW+8(%r15) # yes-> add 4 bytes to leave SIE
636 aghi %r1, 4
637 stg %r1, SP_PSW+8(%r15)
6380:
639#endif
Martin Schwidefsky26889052008-05-07 09:22:52 +0200640 # check for preemptive scheduling
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200641 icm %r0,15,__TI_precount(%r9)
Martin Schwidefsky26889052008-05-07 09:22:52 +0200642 jnz io_restore # preemption is disabled
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643 # switch to kernel stack
644 lg %r1,SP_R15(%r15)
645 aghi %r1,-SP_SIZE
646 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200647 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 lgr %r15,%r1
649io_resume_loop:
650 tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
Heiko Carstens411788e2007-11-20 11:13:32 +0100651 jno io_restore
Heiko Carstensb8e7a542007-11-20 11:13:35 +0100652 larl %r14,io_resume_loop
653 jg preempt_schedule_irq
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654#endif
655
Martin Schwidefsky26889052008-05-07 09:22:52 +0200656io_work_user:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700657 lg %r1,__LC_KERNEL_STACK
658 aghi %r1,-SP_SIZE
659 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200660 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661 lgr %r15,%r1
662#
663# One of the work bits is on. Find out which one.
Heiko Carstens54dfe5d2006-02-01 03:06:38 -0800664# Checked are: _TIF_SIGPENDING, _TIF_RESTORE_SIGPENDING, _TIF_NEED_RESCHED
665# and _TIF_MCCK_PENDING
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666#
667io_work_loop:
Heiko Carstens77fa2242005-06-25 14:55:30 -0700668 tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
669 jo io_mcck_pending
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 tm __TI_flags+7(%r9),_TIF_NEED_RESCHED
671 jo io_reschedule
Roland McGrath02a029b2008-04-30 00:53:08 -0700672 tm __TI_flags+7(%r9),_TIF_SIGPENDING
Heiko Carstens54dfe5d2006-02-01 03:06:38 -0800673 jnz io_sigpending
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200674 tm __TI_flags+7(%r9),_TIF_NOTIFY_RESUME
675 jnz io_notify_resume
Heiko Carstens411788e2007-11-20 11:13:32 +0100676 j io_restore
677io_work_done:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678
Christian Borntraeger0eaeafa2008-05-07 09:22:53 +0200679#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
680sie_opcode:
681 .long 0xb2140000
682#endif
683
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700685# _TIF_MCCK_PENDING is set, call handler
686#
687io_mcck_pending:
Heiko Carstensb771aea2007-07-27 12:29:18 +0200688 brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
Heiko Carstensb771aea2007-07-27 12:29:18 +0200689 j io_work_loop
Heiko Carstens77fa2242005-06-25 14:55:30 -0700690
691#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200693#
694io_reschedule:
Heiko Carstens411788e2007-11-20 11:13:32 +0100695 TRACE_IRQS_ON
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200696 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
697 brasl %r14,schedule # call scheduler
698 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
Heiko Carstens411788e2007-11-20 11:13:32 +0100699 TRACE_IRQS_OFF
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700 tm __TI_flags+7(%r9),_TIF_WORK_INT
Heiko Carstens411788e2007-11-20 11:13:32 +0100701 jz io_restore # there is no work to do
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 j io_work_loop
703
704#
Roland McGrath02a029b2008-04-30 00:53:08 -0700705# _TIF_SIGPENDING or is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700706#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200707io_sigpending:
Heiko Carstens411788e2007-11-20 11:13:32 +0100708 TRACE_IRQS_ON
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200709 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
710 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711 brasl %r14,do_signal # call do_signal
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200712 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
Heiko Carstens411788e2007-11-20 11:13:32 +0100713 TRACE_IRQS_OFF
Heiko Carstense1c3ad92005-11-07 00:59:02 -0800714 j io_work_loop
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200716#
717# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
718#
719io_notify_resume:
720 TRACE_IRQS_ON
721 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
722 la %r2,SP_PTREGS(%r15) # load pt_regs
723 brasl %r14,do_notify_resume # call do_notify_resume
724 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
725 TRACE_IRQS_OFF
726 j io_work_loop
727
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728/*
729 * External interrupt handler routine
730 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200731 .globl ext_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732ext_int_handler:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700733 stck __LC_INT_CLOCK
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100734 stpt __LC_ASYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 SAVE_ALL_BASE __LC_SAVE_AREA+32
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200736 SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
Heiko Carstens77fa2242005-06-25 14:55:30 -0700737 CREATE_STACK_FRAME __LC_EXT_OLD_PSW,__LC_SAVE_AREA+32
Linus Torvalds1da177e2005-04-16 15:20:36 -0700738 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
739 jz ext_no_vtime
740 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
741 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
742 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
743ext_no_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
Heiko Carstens1f194a42006-07-03 00:24:46 -0700745 TRACE_IRQS_OFF
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200746 la %r2,SP_PTREGS(%r15) # address of register-save area
747 llgh %r3,__LC_EXT_INT_CODE # get interruption code
748 brasl %r14,do_extint
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749 j io_return
750
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700751__critical_end:
752
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753/*
754 * Machine check handler routines
755 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200756 .globl mcck_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700757mcck_int_handler:
Martin Schwidefsky9cfb9b32008-12-31 15:11:41 +0100758 stck __LC_INT_CLOCK
Heiko Carstens77fa2242005-06-25 14:55:30 -0700759 la %r1,4095 # revalidate r1
760 spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200761 lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 SAVE_ALL_BASE __LC_SAVE_AREA+64
Heiko Carstens77fa2242005-06-25 14:55:30 -0700763 la %r12,__LC_MCK_OLD_PSW
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200764 tm __LC_MCCK_CODE,0x80 # system damage?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700765 jo mcck_int_main # yes -> rest of mcck code invalid
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200766 la %r14,4095
767 mvc __LC_SAVE_AREA+104(8),__LC_ASYNC_ENTER_TIMER
768 mvc __LC_ASYNC_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA-4095(%r14)
769 tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
770 jo 1f
771 la %r14,__LC_SYNC_ENTER_TIMER
772 clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
773 jl 0f
774 la %r14,__LC_ASYNC_ENTER_TIMER
7750: clc 0(8,%r14),__LC_EXIT_TIMER
776 jl 0f
777 la %r14,__LC_EXIT_TIMER
7780: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
779 jl 0f
780 la %r14,__LC_LAST_UPDATE_TIMER
7810: spt 0(%r14)
782 mvc __LC_ASYNC_ENTER_TIMER(8),0(%r14)
Martin Schwidefskyc185b782008-12-25 13:39:25 +01007831: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700784 jno mcck_int_main # no -> skip cleanup critical
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200785 tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
Heiko Carstens77fa2242005-06-25 14:55:30 -0700786 jnz mcck_int_main # from user -> load kernel stack
787 clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_end)
788 jhe mcck_int_main
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200789 clc __LC_MCK_OLD_PSW+8(8),BASED(.Lcritical_start)
Heiko Carstens77fa2242005-06-25 14:55:30 -0700790 jl mcck_int_main
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200791 brasl %r14,cleanup_critical
Heiko Carstens77fa2242005-06-25 14:55:30 -0700792mcck_int_main:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200793 lg %r14,__LC_PANIC_STACK # are we already on the panic stack?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700794 slgr %r14,%r15
795 srag %r14,%r14,PAGE_SHIFT
796 jz 0f
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200797 lg %r15,__LC_PANIC_STACK # load panic stack
Heiko Carstens77fa2242005-06-25 14:55:30 -07007980: CREATE_STACK_FRAME __LC_MCK_OLD_PSW,__LC_SAVE_AREA+64
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 Schwidefsky63b12242006-06-29 14:58:05 +0200801 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700802 jz mcck_no_vtime
803 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
804 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
805 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
806mcck_no_vtime:
Heiko Carstens77fa2242005-06-25 14:55:30 -0700807 lg %r9,__LC_THREAD_INFO # load pointer to thread_info struct
808 la %r2,SP_PTREGS(%r15) # load pt_regs
809 brasl %r14,s390_do_machine_check
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200810 tm SP_PSW+1(%r15),0x01 # returning to user ?
Heiko Carstens77fa2242005-06-25 14:55:30 -0700811 jno mcck_return
812 lg %r1,__LC_KERNEL_STACK # switch to kernel stack
813 aghi %r1,-SP_SIZE
814 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
815 xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1) # clear back chain
816 lgr %r15,%r1
817 stosm __SF_EMPTY(%r15),0x04 # turn dat on
818 tm __TI_flags+7(%r9),_TIF_MCCK_PENDING
819 jno mcck_return
Heiko Carstens1f194a42006-07-03 00:24:46 -0700820 TRACE_IRQS_OFF
Heiko Carstens77fa2242005-06-25 14:55:30 -0700821 brasl %r14,s390_handle_mcck
Heiko Carstens1f194a42006-07-03 00:24:46 -0700822 TRACE_IRQS_ON
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823mcck_return:
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200824 mvc __LC_RETURN_MCCK_PSW(16),SP_PSW(%r15) # move return PSW
825 ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
826 lmg %r0,%r15,SP_R0(%r15) # load gprs 0-15
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200827 mvc __LC_ASYNC_ENTER_TIMER(8),__LC_SAVE_AREA+104
828 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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833/*
834 * Restart interruption handler, kick starter for additional CPUs
835 */
Heiko Carstens84b36a82007-06-19 13:10:03 +0200836#ifdef CONFIG_SMP
Heiko Carstens2bc89b52008-02-05 16:50:40 +0100837 __CPUINIT
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200838 .globl restart_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839restart_int_handler:
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200840 basr %r1,0
841restart_base:
842 spt restart_vtime-restart_base(%r1)
843 stck __LC_LAST_UPDATE_CLOCK
844 mvc __LC_LAST_UPDATE_TIMER(8),restart_vtime-restart_base(%r1)
845 mvc __LC_EXIT_TIMER(8),restart_vtime-restart_base(%r1)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200846 lg %r15,__LC_SAVE_AREA+120 # load ksp
847 lghi %r10,__LC_CREGS_SAVE_AREA
848 lctlg %c0,%c15,0(%r10) # get new ctl regs
849 lghi %r10,__LC_AREGS_SAVE_AREA
850 lam %a0,%a15,0(%r10)
851 lmg %r6,%r15,__SF_GPRS(%r15) # load registers from clone
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200852 lg %r1,__LC_THREAD_INFO
853 mvc __LC_USER_TIMER(8),__TI_user_timer(%r1)
854 mvc __LC_SYSTEM_TIMER(8),__TI_system_timer(%r1)
855 xc __LC_STEAL_TIMER(8),__LC_STEAL_TIMER
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200856 stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
857 jg start_secondary
Martin Schwidefsky5b409ed2009-04-14 15:36:27 +0200858 .align 8
859restart_vtime:
860 .long 0x7fffffff,0xffffffff
Heiko Carstens84b36a82007-06-19 13:10:03 +0200861 .previous
Linus Torvalds1da177e2005-04-16 15:20:36 -0700862#else
863/*
864 * If we do not run with SMP enabled, let the new CPU crash ...
865 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200866 .globl restart_int_handler
Linus Torvalds1da177e2005-04-16 15:20:36 -0700867restart_int_handler:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200868 basr %r1,0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700869restart_base:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200870 lpswe restart_crash-restart_base(%r1)
871 .align 8
Linus Torvalds1da177e2005-04-16 15:20:36 -0700872restart_crash:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200873 .long 0x000a0000,0x00000000,0x00000000,0x00000000
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874restart_go:
875#endif
876
877#ifdef CONFIG_CHECK_STACK
878/*
879 * The synchronous or the asynchronous stack overflowed. We are dead.
880 * No need to properly save the registers, we are going to panic anyway.
881 * Setup a pt_regs so that show_trace can provide a good call trace.
882 */
883stack_overflow:
884 lg %r15,__LC_PANIC_STACK # change to panic stack
Heiko Carstens9514e232006-09-20 15:59:22 +0200885 aghi %r15,-SP_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -0700886 mvc SP_PSW(16,%r15),0(%r12) # move user PSW to stack
887 stmg %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
888 la %r1,__LC_SAVE_AREA
889 chi %r12,__LC_SVC_OLD_PSW
890 je 0f
891 chi %r12,__LC_PGM_OLD_PSW
892 je 0f
Heiko Carstens9514e232006-09-20 15:59:22 +0200893 la %r1,__LC_SAVE_AREA+32
Heiko Carstens25d83cb2006-09-28 16:56:37 +02008940: mvc SP_R12(32,%r15),0(%r1) # move %r12-%r15 to stack
Christian Borntraeger9e74a6b82008-04-17 07:46:30 +0200895 mvc SP_ARGS(8,%r15),__LC_LAST_BREAK
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200896 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15) # clear back chain
897 la %r2,SP_PTREGS(%r15) # load pt_regs
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898 jg kernel_stack_overflow
899#endif
900
901cleanup_table_system_call:
902 .quad system_call, sysc_do_svc
903cleanup_table_sysc_return:
904 .quad sysc_return, sysc_leave
905cleanup_table_sysc_leave:
Heiko Carstens411788e2007-11-20 11:13:32 +0100906 .quad sysc_leave, sysc_done
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907cleanup_table_sysc_work_loop:
Heiko Carstens411788e2007-11-20 11:13:32 +0100908 .quad sysc_work_loop, sysc_work_done
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200909cleanup_table_io_return:
910 .quad io_return, io_leave
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700911cleanup_table_io_leave:
912 .quad io_leave, io_done
913cleanup_table_io_work_loop:
Heiko Carstens411788e2007-11-20 11:13:32 +0100914 .quad io_work_loop, io_work_done
Linus Torvalds1da177e2005-04-16 15:20:36 -0700915
916cleanup_critical:
917 clc 8(8,%r12),BASED(cleanup_table_system_call)
918 jl 0f
919 clc 8(8,%r12),BASED(cleanup_table_system_call+8)
920 jl cleanup_system_call
9210:
922 clc 8(8,%r12),BASED(cleanup_table_sysc_return)
923 jl 0f
924 clc 8(8,%r12),BASED(cleanup_table_sysc_return+8)
925 jl cleanup_sysc_return
9260:
927 clc 8(8,%r12),BASED(cleanup_table_sysc_leave)
928 jl 0f
929 clc 8(8,%r12),BASED(cleanup_table_sysc_leave+8)
930 jl cleanup_sysc_leave
9310:
932 clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop)
933 jl 0f
934 clc 8(8,%r12),BASED(cleanup_table_sysc_work_loop+8)
Heiko Carstens77fa2242005-06-25 14:55:30 -0700935 jl cleanup_sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -07009360:
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200937 clc 8(8,%r12),BASED(cleanup_table_io_return)
938 jl 0f
939 clc 8(8,%r12),BASED(cleanup_table_io_return+8)
940 jl cleanup_io_return
9410:
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700942 clc 8(8,%r12),BASED(cleanup_table_io_leave)
943 jl 0f
944 clc 8(8,%r12),BASED(cleanup_table_io_leave+8)
945 jl cleanup_io_leave
9460:
947 clc 8(8,%r12),BASED(cleanup_table_io_work_loop)
948 jl 0f
949 clc 8(8,%r12),BASED(cleanup_table_io_work_loop+8)
950 jl cleanup_io_return
9510:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952 br %r14
953
954cleanup_system_call:
955 mvc __LC_RETURN_PSW(16),0(%r12)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700956 cghi %r12,__LC_MCK_OLD_PSW
957 je 0f
958 la %r12,__LC_SAVE_AREA+32
959 j 1f
9600: la %r12,__LC_SAVE_AREA+64
9611:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700962 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+8)
963 jh 0f
964 mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
9650: 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 Schwidefskyae6aa2e2005-09-03 15:57:56 -0700969 mvc __LC_SAVE_AREA(32),0(%r12)
9700: stg %r13,8(%r12)
971 stg %r12,__LC_SAVE_AREA+96 # argh
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200972 SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Heiko Carstens77fa2242005-06-25 14:55:30 -0700973 CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700974 lg %r12,__LC_SAVE_AREA+96 # argh
975 stg %r15,24(%r12)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700976 llgh %r7,__LC_SVC_INT_CODE
Linus Torvalds1da177e2005-04-16 15:20:36 -0700977cleanup_vtime:
978 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+24)
979 jhe cleanup_stime
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
981cleanup_stime:
982 clc __LC_RETURN_PSW+8(8),BASED(cleanup_system_call_insn+32)
983 jh cleanup_update
984 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
985cleanup_update:
986 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700987 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_system_call+8)
988 la %r12,__LC_RETURN_PSW
989 br %r14
990cleanup_system_call_insn:
991 .quad sysc_saveall
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200992 .quad system_call
993 .quad sysc_vtime
994 .quad sysc_stime
995 .quad sysc_update
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996
997cleanup_sysc_return:
998 mvc __LC_RETURN_PSW(8),0(%r12)
999 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_sysc_return)
1000 la %r12,__LC_RETURN_PSW
1001 br %r14
1002
1003cleanup_sysc_leave:
1004 clc 8(8,%r12),BASED(cleanup_sysc_leave_insn)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001005 je 3f
Linus Torvalds1da177e2005-04-16 15:20:36 -07001006 clc 8(8,%r12),BASED(cleanup_sysc_leave_insn+8)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001007 jhe 0f
1008 mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
10090: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001010 cghi %r12,__LC_MCK_OLD_PSW
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001011 jne 1f
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001012 mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001013 j 2f
10141: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
10152: lmg %r0,%r11,SP_R0(%r15)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001016 lg %r15,SP_R15(%r15)
Martin Schwidefskyc742b312008-12-31 15:11:42 +010010173: la %r12,__LC_RETURN_PSW
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018 br %r14
1019cleanup_sysc_leave_insn:
Heiko Carstens411788e2007-11-20 11:13:32 +01001020 .quad sysc_done - 4
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001021 .quad sysc_done - 16
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001023cleanup_io_return:
1024 mvc __LC_RETURN_PSW(8),0(%r12)
1025 mvc __LC_RETURN_PSW+8(8),BASED(cleanup_table_io_work_loop)
1026 la %r12,__LC_RETURN_PSW
1027 br %r14
1028
1029cleanup_io_leave:
1030 clc 8(8,%r12),BASED(cleanup_io_leave_insn)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001031 je 3f
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001032 clc 8(8,%r12),BASED(cleanup_io_leave_insn+8)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001033 jhe 0f
1034 mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
10350: mvc __LC_RETURN_PSW(16),SP_PSW(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001036 cghi %r12,__LC_MCK_OLD_PSW
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001037 jne 1f
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001038 mvc __LC_SAVE_AREA+64(32),SP_R12(%r15)
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001039 j 2f
10401: mvc __LC_SAVE_AREA+32(32),SP_R12(%r15)
10412: lmg %r0,%r11,SP_R0(%r15)
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001042 lg %r15,SP_R15(%r15)
Martin Schwidefskyc742b312008-12-31 15:11:42 +010010433: la %r12,__LC_RETURN_PSW
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001044 br %r14
1045cleanup_io_leave_insn:
Heiko Carstens411788e2007-11-20 11:13:32 +01001046 .quad io_done - 4
Martin Schwidefskyc742b312008-12-31 15:11:42 +01001047 .quad io_done - 16
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -07001048
Linus Torvalds1da177e2005-04-16 15:20:36 -07001049/*
1050 * Integer constants
1051 */
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001052 .align 4
Linus Torvalds1da177e2005-04-16 15:20:36 -07001053.Lconst:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001054.Lnr_syscalls: .long NR_syscalls
1055.L0x0130: .short 0x130
1056.L0x0140: .short 0x140
1057.L0x0150: .short 0x150
1058.L0x0160: .short 0x160
1059.L0x0170: .short 0x170
Linus Torvalds1da177e2005-04-16 15:20:36 -07001060.Lcritical_start:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001061 .quad __critical_start
Linus Torvalds1da177e2005-04-16 15:20:36 -07001062.Lcritical_end:
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001063 .quad __critical_end
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001065 .section .rodata, "a"
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066#define SYSCALL(esa,esame,emu) .long esame
Heiko Carstens9bf12262009-06-12 10:26:47 +02001067 .globl sys_call_table
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068sys_call_table:
1069#include "syscalls.S"
1070#undef SYSCALL
1071
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -08001072#ifdef CONFIG_COMPAT
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073
1074#define SYSCALL(esa,esame,emu) .long emu
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075sys_call_table_emu:
1076#include "syscalls.S"
1077#undef SYSCALL
1078#endif