blob: 7ff07d3a29c16f152f43e1b29adabeefea3c8ff7 [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
Martin Schwidefsky20b40a72011-10-30 15:16:47 +010046SP_SVC_CODE = STACK_FRAME_OVERHEAD + __PT_SVC_CODE
Heiko Carstens25d83cb2006-09-28 16:56:37 +020047SP_SIZE = STACK_FRAME_OVERHEAD + __PT_SIZE
Linus Torvalds1da177e2005-04-16 15:20:36 -070048
49STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
50STACK_SIZE = 1 << STACK_SHIFT
51
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +020052_TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +010053 _TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_PER_TRAP )
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +020054_TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
Heiko Carstens54dfe5d2006-02-01 03:06:38 -080055 _TIF_MCCK_PENDING)
Heiko Carstens9bf12262009-06-12 10:26:47 +020056_TIF_SYSCALL = (_TIF_SYSCALL_TRACE>>8 | _TIF_SYSCALL_AUDIT>>8 | \
Josh Stone66700002009-08-24 14:43:11 -070057 _TIF_SECCOMP>>8 | _TIF_SYSCALL_TRACEPOINT>>8)
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020058_TIF_EXIT_SIE = (_TIF_SIGPENDING | _TIF_NEED_RESCHED | _TIF_MCCK_PENDING)
Linus Torvalds1da177e2005-04-16 15:20:36 -070059
60#define BASED(name) name-system_call(%r13)
61
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020062 .macro SPP newpp
63#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
64 tm __LC_MACHINE_FLAGS+6,0x20 # MACHINE_FLAG_SPP
65 jz .+8
66 .insn s,0xb2800000,\newpp
67#endif
68 .endm
69
Carsten Ottecd3b70f2010-05-17 10:00:04 +020070 .macro HANDLE_SIE_INTERCEPT
71#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020072 tm __TI_flags+6(%r12),_TIF_SIE>>8
Carsten Ottecd3b70f2010-05-17 10:00:04 +020073 jz 0f
Martin Schwidefsky603d1a52011-07-24 10:48:18 +020074 SPP __LC_CMF_HPP # set host id
75 clc SP_PSW+8(8,%r15),BASED(.Lsie_loop)
76 jl 0f
77 clc SP_PSW+8(8,%r15),BASED(.Lsie_done)
78 jhe 0f
79 mvc SP_PSW+8(8,%r15),BASED(.Lsie_loop)
Heiko Carstens2ffbb3f2010-05-26 23:26:21 +0200800:
Carsten Ottecd3b70f2010-05-17 10:00:04 +020081#endif
82 .endm
83
Heiko Carstens1f194a42006-07-03 00:24:46 -070084#ifdef CONFIG_TRACE_IRQFLAGS
85 .macro TRACE_IRQS_ON
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +020086 basr %r2,%r0
87 brasl %r14,trace_hardirqs_on_caller
Heiko Carstens1f194a42006-07-03 00:24:46 -070088 .endm
89
90 .macro TRACE_IRQS_OFF
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +020091 basr %r2,%r0
92 brasl %r14,trace_hardirqs_off_caller
Heiko Carstens1f194a42006-07-03 00:24:46 -070093 .endm
94#else
95#define TRACE_IRQS_ON
96#define TRACE_IRQS_OFF
Heiko Carstens411788e2007-11-20 11:13:32 +010097#endif
98
99#ifdef CONFIG_LOCKDEP
100 .macro LOCKDEP_SYS_EXIT
101 tm SP_PSW+1(%r15),0x01 # returning to user ?
102 jz 0f
103 brasl %r14,lockdep_sys_exit
1040:
105 .endm
106#else
Heiko Carstens523b44c2007-10-11 22:11:12 +0200107#define LOCKDEP_SYS_EXIT
Heiko Carstens1f194a42006-07-03 00:24:46 -0700108#endif
109
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200110 .macro UPDATE_VTIME lc_from,lc_to,lc_sum
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 lg %r10,\lc_from
112 slg %r10,\lc_to
113 alg %r10,\lc_sum
114 stg %r10,\lc_sum
115 .endm
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116
117/*
118 * Register usage in interrupt handlers:
119 * R9 - pointer to current task structure
120 * R13 - pointer to literal pool
121 * R14 - return register for function calls
122 * R15 - kernel stack pointer
123 */
124
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200125 .macro SAVE_ALL_SVC psworg,savearea
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200126 stmg %r11,%r15,\savearea
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200127 lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200128 aghi %r15,-SP_SIZE # make room for registers & psw
129 lg %r11,__LC_LAST_BREAK
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200130 .endm
131
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200132 .macro SAVE_ALL_PGM psworg,savearea
133 stmg %r11,%r15,\savearea
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134 tm \psworg+1,0x01 # test problem state bit
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200135#ifdef CONFIG_CHECK_STACK
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200136 jnz 1f
137 tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
138 jnz 2f
139 la %r12,\psworg
140 j stack_overflow
141#else
142 jz 2f
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200143#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001441: lg %r15,__LC_KERNEL_STACK # problem state -> load ksp
1452: aghi %r15,-SP_SIZE # make room for registers & psw
146 larl %r13,system_call
147 lg %r11,__LC_LAST_BREAK
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200148 .endm
149
150 .macro SAVE_ALL_ASYNC psworg,savearea
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200151 stmg %r11,%r15,\savearea
152 larl %r13,system_call
153 lg %r11,__LC_LAST_BREAK
Martin Schwidefsky63b12242006-06-29 14:58:05 +0200154 la %r12,\psworg
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155 tm \psworg+1,0x01 # test problem state bit
156 jnz 1f # from user -> load kernel stack
157 clc \psworg+8(8),BASED(.Lcritical_end)
158 jhe 0f
159 clc \psworg+8(8),BASED(.Lcritical_start)
160 jl 0f
161 brasl %r14,cleanup_critical
Peter Oberparleiter6add9f72005-09-16 19:27:42 -0700162 tm 1(%r12),0x01 # retest problem state after cleanup
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163 jnz 1f
1640: lg %r14,__LC_ASYNC_STACK # are we already on the async. stack ?
165 slgr %r14,%r15
166 srag %r14,%r14,STACK_SHIFT
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167#ifdef CONFIG_CHECK_STACK
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200168 jnz 1f
169 tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
170 jnz 2f
171 j stack_overflow
172#else
173 jz 2f
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +02001751: lg %r15,__LC_ASYNC_STACK # load async stack
1762: aghi %r15,-SP_SIZE # make room for registers & psw
Heiko Carstens77fa2242005-06-25 14:55:30 -0700177 .endm
178
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200179 .macro CREATE_STACK_FRAME savearea
180 xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181 stg %r2,SP_ORIG_R2(%r15) # store original content of gpr 2
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200182 mvc SP_R11(40,%r15),\savearea # move %r11-%r15 to stack
183 stmg %r0,%r10,SP_R0(%r15) # store gprs %r0-%r10 to kernel stack
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200184 .endm
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700186 .macro RESTORE_ALL psworg,sync
187 mvc \psworg(16),SP_PSW(%r15) # move user PSW to lowcore
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188 .if !\sync
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700189 ni \psworg+1,0xfd # clear wait state bit
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 .endif
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100191 lg %r14,__LC_VDSO_PER_CPU
192 lmg %r0,%r13,SP_R0(%r15) # load gprs 0-13 of user
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100193 stpt __LC_EXIT_TIMER
Martin Schwidefskyc742b312008-12-31 15:11:42 +0100194 mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
195 lmg %r14,%r15,SP_R14(%r15) # load grps 14-15 of user
Martin Schwidefskyae6aa2e2005-09-03 15:57:56 -0700196 lpswe \psworg # back to caller
Linus Torvalds1da177e2005-04-16 15:20:36 -0700197 .endm
198
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200199 .macro LAST_BREAK
200 srag %r10,%r11,23
201 jz 0f
202 stg %r11,__TI_last_break(%r12)
2030:
204 .endm
205
Martin Schwidefsky1e546222010-10-25 16:10:37 +0200206 .macro REENABLE_IRQS
207 mvc __SF_EMPTY(1,%r15),SP_PSW(%r15)
208 ni __SF_EMPTY(%r15),0xbf
209 ssm __SF_EMPTY(%r15)
210 .endm
211
Martin Schwidefsky860dba42011-01-05 12:47:25 +0100212 .section .kprobes.text, "ax"
213
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214/*
215 * Scheduler resume function, called by switch_to
216 * gpr2 = (task_struct *) prev
217 * gpr3 = (task_struct *) next
218 * Returns:
219 * gpr2 = prev
220 */
Jan Glauber144d6342011-07-24 10:48:19 +0200221ENTRY(__switch_to)
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100222 lg %r4,__THREAD_info(%r2) # get thread_info of prev
223 lg %r5,__THREAD_info(%r3) # get thread_info of next
Heiko Carstens77fa2242005-06-25 14:55:30 -0700224 tm __TI_flags+7(%r4),_TIF_MCCK_PENDING # machine check pending?
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100225 jz 0f
226 ni __TI_flags+7(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
227 oi __TI_flags+7(%r5),_TIF_MCCK_PENDING # set it in next
2280: stmg %r6,%r15,__SF_GPRS(%r15) # store gprs of prev task
229 stg %r15,__THREAD_ksp(%r2) # store kernel stack of prev
230 lg %r15,__THREAD_ksp(%r3) # load kernel stack of next
231 lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
232 lmg %r6,%r15,__SF_GPRS(%r15) # load gprs of next task
233 stg %r3,__LC_CURRENT # store task struct of next
Heiko Carstensf2db2e62011-05-23 10:24:34 +0200234 mvc __LC_CURRENT_PID+4(4,%r0),__TASK_pid(%r3) # store pid of next
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100235 stg %r5,__LC_THREAD_INFO # store thread info of next
236 aghi %r5,STACK_SIZE # end of kernel stack of next
237 stg %r5,__LC_KERNEL_STACK # store end of kernel stack
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238 br %r14
239
240__critical_start:
241/*
242 * SVC interrupt handler routine. System calls are synchronous events and
243 * are executed with interrupts enabled.
244 */
245
Jan Glauber144d6342011-07-24 10:48:19 +0200246ENTRY(system_call)
Martin Schwidefskyc185b782008-12-25 13:39:25 +0100247 stpt __LC_SYNC_ENTER_TIMER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248sysc_saveall:
Martin Schwidefsky987ad702007-07-10 11:24:18 +0200249 SAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200250 CREATE_STACK_FRAME __LC_SAVE_AREA
251 mvc SP_PSW(16,%r15),__LC_SVC_OLD_PSW
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100252 mvc SP_SVC_CODE(4,%r15),__LC_SVC_ILC
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200253 lg %r12,__LC_THREAD_INFO # load pointer to thread_info struct
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254sysc_vtime:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
256sysc_stime:
257 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
258sysc_update:
259 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200260 LAST_BREAK
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261sysc_do_svc:
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100262 llgh %r7,SP_SVC_CODE+2(%r15)
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200263 slag %r7,%r7,2 # shift and test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 jnz sysc_nr_ok
265 # svc 0: system call number in %r1
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200266 llgfr %r1,%r1 # clear high word in r1
267 cghi %r1,NR_syscalls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268 jnl sysc_nr_ok
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100269 sth %r1,SP_SVC_CODE+2(%r15)
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200270 slag %r7,%r1,2 # shift and test for svc 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271sysc_nr_ok:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200272 larl %r10,sys_call_table
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -0800273#ifdef CONFIG_COMPAT
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200274 tm __TI_flags+5(%r12),(_TIF_31BIT>>16) # running in 31 bit mode ?
Heiko Carstensc5630772005-09-03 15:58:04 -0700275 jno sysc_noemu
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200276 larl %r10,sys_call_table_emu # use 31 bit emulation system calls
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277sysc_noemu:
278#endif
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200279 tm __TI_flags+6(%r12),_TIF_SYSCALL
Martin Schwidefskybaa07152010-10-25 16:10:40 +0200280 mvc SP_ARGS(8,%r15),SP_R7(%r15)
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200281 lgf %r8,0(%r7,%r10) # load address of system call routine
282 jnz sysc_tracesys
283 basr %r14,%r8 # call sys_xxxx
284 stg %r2,SP_R2(%r15) # store return value (change R2 on stack)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285
286sysc_return:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200287 LOCKDEP_SYS_EXIT
288sysc_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200289 tm __TI_flags+7(%r12),_TIF_WORK_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200290 jnz sysc_work # there is work to do (signals etc.)
Heiko Carstens411788e2007-11-20 11:13:32 +0100291sysc_restore:
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200292 RESTORE_ALL __LC_RETURN_PSW,1
Heiko Carstens411788e2007-11-20 11:13:32 +0100293sysc_done:
294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295#
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200296# There is work to do, but first we need to check if we return to userspace.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297#
298sysc_work:
Martin Schwidefsky26889052008-05-07 09:22:52 +0200299 tm SP_PSW+1(%r15),0x01 # returning to user ?
300 jno sysc_restore
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200301
302#
303# One of the work bits is on. Find out which one.
304#
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200305sysc_work_tif:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200306 tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
Heiko Carstens77fa2242005-06-25 14:55:30 -0700307 jo sysc_mcck_pending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200308 tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 jo sysc_reschedule
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200310 tm __TI_flags+7(%r12),_TIF_SIGPENDING
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200311 jo sysc_sigpending
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200312 tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200313 jo sysc_notify_resume
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200314 tm __TI_flags+7(%r12),_TIF_RESTART_SVC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315 jo sysc_restart
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100316 tm __TI_flags+7(%r12),_TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317 jo sysc_singlestep
Martin Schwidefsky43d399d2010-05-17 10:00:01 +0200318 j sysc_return # beware of critical section cleanup
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319
320#
321# _TIF_NEED_RESCHED is set, call schedule
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200322#
323sysc_reschedule:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200324 larl %r14,sysc_return
325 jg schedule # return point is sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326
327#
Heiko Carstens77fa2242005-06-25 14:55:30 -0700328# _TIF_MCCK_PENDING is set, call handler
329#
330sysc_mcck_pending:
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200331 larl %r14,sysc_return
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200332 jg s390_handle_mcck # TIF bit will be cleared by handler
Heiko Carstens77fa2242005-06-25 14:55:30 -0700333
334#
Roland McGrath02a029b2008-04-30 00:53:08 -0700335# _TIF_SIGPENDING is set, call do_signal
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336#
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200337sysc_sigpending:
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100338 ni __TI_flags+7(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200339 la %r2,SP_PTREGS(%r15) # load pt_regs
340 brasl %r14,do_signal # call do_signal
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200341 tm __TI_flags+7(%r12),_TIF_RESTART_SVC
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 jo sysc_restart
Martin Schwidefsky5e9a2692011-01-05 12:48:10 +0100343 tm __TI_flags+7(%r12),_TIF_PER_TRAP
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 jo sysc_singlestep
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200345 j sysc_return
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346
347#
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200348# _TIF_NOTIFY_RESUME is set, call do_notify_resume
349#
350sysc_notify_resume:
351 la %r2,SP_PTREGS(%r15) # load pt_regs
Martin Schwidefsky6a2df3a2010-05-17 10:00:02 +0200352 larl %r14,sysc_return
Martin Schwidefsky753c4dd2008-10-10 21:33:20 +0200353 jg do_notify_resume # call do_notify_resume
354
355#
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356# _TIF_RESTART_SVC is set, set up registers and restart svc
357#
358sysc_restart:
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200359 ni __TI_flags+7(%r12),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
Heiko Carstens25d83cb2006-09-28 16:56:37 +0200360 lmg %r2,%r6,SP_R2(%r15) # load svc arguments
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100361 lghi %r7,0 # svc 0 returns -ENOSYS
362 lh %r1,SP_SVC_CODE+2(%r15) # load new svc number
363 cghi %r1,NR_syscalls
364 jnl sysc_nr_ok # invalid svc number -> do svc 0
365 slag %r7,%r1,2
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200366 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 Schwidefsky20b40a72011-10-30 15:16:47 +0100373 xc SP_SVC_CODE(4,%r15),SP_SVC_CODE(%r15) # clear svc code
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 Schwidefsky20b40a72011-10-30 15:16:47 +0100385 llgh %r0,SP_SVC_CODE+2(%r15)
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200386 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
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100473 xc SP_SVC_CODE(4,%r15),SP_SVC_CODE(%r15)
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200474 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
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100554 mvc SP_SVC_CODE(4,%r15),__LC_SVC_ILC
Martin Schwidefsky86f25522010-05-17 10:00:05 +0200555 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 Schwidefsky20b40a72011-10-30 15:16:47 +0100574 xc SP_SVC_CODE(4,%r15),SP_SVC_CODE(%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)
Martin Schwidefsky0edc8fa2011-10-30 15:16:45 +0100872 stg %r15,__LC_SAVE_AREA+120(%r0) # save r15
Michael Holzheu7dd6b332011-08-03 16:44:19 +0200873 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
Martin Schwidefsky0edc8fa2011-10-30 15:16:45 +0100877 mvc SP_R15(8,%r15),__LC_SAVE_AREA+120(%r0)# store saved %r15 to stack
Michael Holzheu7dd6b332011-08-03 16:44:19 +0200878 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
Martin Schwidefsky20b40a72011-10-30 15:16:47 +0100976 mvc SP_SVC_CODE(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
Christian Borntraeger480e5922011-09-20 17:07:28 +02001079 lg %r14,__LC_GMAP # get gmap pointer
1080 ltgr %r14,%r14
1081 jz sie_gmap
1082 lctlg %c1,%c1,__GMAP_ASCE(%r14) # load primary asce
1083sie_gmap:
Martin Schwidefsky603d1a52011-07-24 10:48:18 +02001084 lg %r14,__SF_EMPTY(%r15) # get control block pointer
1085 SPP __SF_EMPTY(%r15) # set guest id
1086 sie 0(%r14)
1087sie_done:
1088 SPP __LC_CMF_HPP # set host id
1089 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1090sie_exit:
Christian Borntraeger480e5922011-09-20 17:07:28 +02001091 lctlg %c1,%c1,__LC_USER_ASCE # load primary asce
Martin Schwidefsky603d1a52011-07-24 10:48:18 +02001092 ni __TI_flags+6(%r14),255-(_TIF_SIE>>8)
1093 lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
1094 stmg %r0,%r13,0(%r14) # save guest gprs 0-13
1095 lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
1096 lghi %r2,0
1097 br %r14
1098sie_fault:
1099 lg %r14,__LC_THREAD_INFO # pointer thread_info struct
1100 ni __TI_flags+6(%r14),255-(_TIF_SIE>>8)
1101 lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
1102 stmg %r0,%r13,0(%r14) # save guest gprs 0-13
1103 lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
1104 lghi %r2,-EFAULT
1105 br %r14
1106
1107 .align 8
1108.Lsie_loop:
1109 .quad sie_loop
1110.Lsie_done:
1111 .quad sie_done
1112
1113 .section __ex_table,"a"
1114 .quad sie_loop,sie_fault
1115 .previous
1116#endif
1117
Heiko Carstens25d83cb2006-09-28 16:56:37 +02001118 .section .rodata, "a"
Linus Torvalds1da177e2005-04-16 15:20:36 -07001119#define SYSCALL(esa,esame,emu) .long esame
Heiko Carstens9bf12262009-06-12 10:26:47 +02001120 .globl sys_call_table
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121sys_call_table:
1122#include "syscalls.S"
1123#undef SYSCALL
1124
Martin Schwidefsky347a8dc2006-01-06 00:19:28 -08001125#ifdef CONFIG_COMPAT
Linus Torvalds1da177e2005-04-16 15:20:36 -07001126
1127#define SYSCALL(esa,esame,emu) .long emu
Linus Torvalds1da177e2005-04-16 15:20:36 -07001128sys_call_table_emu:
1129#include "syscalls.S"
1130#undef SYSCALL
1131#endif