2 * arch/s390/kernel/entry.S
3 * S390 low-level entry points.
5 * Copyright (C) IBM Corp. 1999,2006
6 * Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
7 * Hartmut Penner (hp@de.ibm.com),
8 * Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
9 * Heiko Carstens <heiko.carstens@de.ibm.com>
12 #include <linux/sys.h>
13 #include <linux/linkage.h>
14 #include <asm/cache.h>
15 #include <asm/lowcore.h>
16 #include <asm/errno.h>
17 #include <asm/ptrace.h>
18 #include <asm/thread_info.h>
19 #include <asm/asm-offsets.h>
20 #include <asm/unistd.h>
24 * Stack layout for the system_call stack entry.
25 * The first few entries are identical to the user_regs_struct.
27 SP_PTREGS = STACK_FRAME_OVERHEAD
28 SP_ARGS = STACK_FRAME_OVERHEAD + __PT_ARGS
29 SP_PSW = STACK_FRAME_OVERHEAD + __PT_PSW
30 SP_R0 = STACK_FRAME_OVERHEAD + __PT_GPRS
31 SP_R1 = STACK_FRAME_OVERHEAD + __PT_GPRS + 4
32 SP_R2 = STACK_FRAME_OVERHEAD + __PT_GPRS + 8
33 SP_R3 = STACK_FRAME_OVERHEAD + __PT_GPRS + 12
34 SP_R4 = STACK_FRAME_OVERHEAD + __PT_GPRS + 16
35 SP_R5 = STACK_FRAME_OVERHEAD + __PT_GPRS + 20
36 SP_R6 = STACK_FRAME_OVERHEAD + __PT_GPRS + 24
37 SP_R7 = STACK_FRAME_OVERHEAD + __PT_GPRS + 28
38 SP_R8 = STACK_FRAME_OVERHEAD + __PT_GPRS + 32
39 SP_R9 = STACK_FRAME_OVERHEAD + __PT_GPRS + 36
40 SP_R10 = STACK_FRAME_OVERHEAD + __PT_GPRS + 40
41 SP_R11 = STACK_FRAME_OVERHEAD + __PT_GPRS + 44
42 SP_R12 = STACK_FRAME_OVERHEAD + __PT_GPRS + 48
43 SP_R13 = STACK_FRAME_OVERHEAD + __PT_GPRS + 52
44 SP_R14 = STACK_FRAME_OVERHEAD + __PT_GPRS + 56
45 SP_R15 = STACK_FRAME_OVERHEAD + __PT_GPRS + 60
46 SP_ORIG_R2 = STACK_FRAME_OVERHEAD + __PT_ORIG_GPR2
47 SP_ILC = STACK_FRAME_OVERHEAD + __PT_ILC
48 SP_TRAP = STACK_FRAME_OVERHEAD + __PT_TRAP
49 SP_SIZE = STACK_FRAME_OVERHEAD + __PT_SIZE
51 _TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK | _TIF_NEED_RESCHED | \
52 _TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_SINGLE_STEP )
53 _TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK | _TIF_NEED_RESCHED | \
56 STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
57 STACK_SIZE = 1 << STACK_SHIFT
59 #define BASED(name) name-system_call(%r13)
62 * Register usage in interrupt handlers:
63 * R9 - pointer to current task structure
64 * R13 - pointer to literal pool
65 * R14 - return register for function calls
66 * R15 - kernel stack pointer
69 .macro STORE_TIMER lc_offset
70 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
75 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
76 .macro UPDATE_VTIME lc_from,lc_to,lc_sum
86 1: stm %r10,%r11,\lc_sum
90 .macro SAVE_ALL_BASE savearea
91 stm %r12,%r15,\savearea
92 l %r13,__LC_SVC_NEW_PSW+4 # load &system_call to %r13
95 .macro SAVE_ALL_SYNC psworg,savearea
97 tm \psworg+1,0x01 # test problem state bit
98 bz BASED(2f) # skip stack setup save
99 l %r15,__LC_KERNEL_STACK # problem state -> load ksp
100 #ifdef CONFIG_CHECK_STACK
102 2: tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
103 bz BASED(stack_overflow)
109 .macro SAVE_ALL_ASYNC psworg,savearea
111 tm \psworg+1,0x01 # test problem state bit
112 bnz BASED(1f) # from user -> load async stack
113 clc \psworg+4(4),BASED(.Lcritical_end)
115 clc \psworg+4(4),BASED(.Lcritical_start)
117 l %r14,BASED(.Lcleanup_critical)
119 tm 1(%r12),0x01 # retest problem state after cleanup
121 0: l %r14,__LC_ASYNC_STACK # are we already on the async stack ?
125 1: l %r15,__LC_ASYNC_STACK
126 #ifdef CONFIG_CHECK_STACK
128 2: tml %r15,STACK_SIZE - CONFIG_STACK_GUARD
129 bz BASED(stack_overflow)
135 .macro CREATE_STACK_FRAME psworg,savearea
136 s %r15,BASED(.Lc_spsize) # make room for registers & psw
137 mvc SP_PSW(8,%r15),0(%r12) # move user PSW to stack
139 st %r2,SP_ORIG_R2(%r15) # store original content of gpr 2
140 icm %r12,12,__LC_SVC_ILC
141 stm %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
143 mvc SP_R12(16,%r15),\savearea # move %r12-%r15 to stack
145 st %r12,__SF_BACKCHAIN(%r15) # clear back chain
148 .macro RESTORE_ALL psworg,sync
149 mvc \psworg(8),SP_PSW(%r15) # move user PSW to lowcore
151 ni \psworg+1,0xfd # clear wait state bit
153 lm %r0,%r15,SP_R0(%r15) # load gprs 0-15 of user
154 STORE_TIMER __LC_EXIT_TIMER
155 lpsw \psworg # back to caller
159 * Scheduler resume function, called by switch_to
160 * gpr2 = (task_struct *) prev
161 * gpr3 = (task_struct *) next
169 tm __THREAD_per(%r3),0xe8 # new process is using per ?
170 bz __switch_to_noper-__switch_to_base(%r1) # if not we're fine
171 stctl %c9,%c11,__SF_EMPTY(%r15) # We are using per stuff
172 clc __THREAD_per(12,%r3),__SF_EMPTY(%r15)
173 be __switch_to_noper-__switch_to_base(%r1) # we got away w/o bashing TLB's
174 lctl %c9,%c11,__THREAD_per(%r3) # Nope we didn't
176 l %r4,__THREAD_info(%r2) # get thread_info of prev
177 tm __TI_flags+3(%r4),_TIF_MCCK_PENDING # machine check pending?
178 bz __switch_to_no_mcck-__switch_to_base(%r1)
179 ni __TI_flags+3(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
180 l %r4,__THREAD_info(%r3) # get thread_info of next
181 oi __TI_flags+3(%r4),_TIF_MCCK_PENDING # set it in next
183 stm %r6,%r15,__SF_GPRS(%r15)# store __switch_to registers of prev task
184 st %r15,__THREAD_ksp(%r2) # store kernel stack to prev->tss.ksp
185 l %r15,__THREAD_ksp(%r3) # load kernel stack from next->tss.ksp
186 lm %r6,%r15,__SF_GPRS(%r15)# load __switch_to registers of next task
187 st %r3,__LC_CURRENT # __LC_CURRENT = current task struct
188 lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
189 l %r3,__THREAD_info(%r3) # load thread_info from task struct
190 st %r3,__LC_THREAD_INFO
192 st %r3,__LC_KERNEL_STACK # __LC_KERNEL_STACK = new kernel stack
197 * SVC interrupt handler routine. System calls are synchronous events and
198 * are executed with interrupts enabled.
203 STORE_TIMER __LC_SYNC_ENTER_TIMER
205 SAVE_ALL_BASE __LC_SAVE_AREA
206 SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
207 CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
208 lh %r7,0x8a # get svc number from lowcore
209 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
211 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
212 bz BASED(sysc_do_svc)
213 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
215 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
217 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
220 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
221 sla %r7,2 # *4 and test for svc 0
222 bnz BASED(sysc_nr_ok) # svc number > 0
223 # svc 0: system call number in %r1
224 cl %r1,BASED(.Lnr_syscalls)
225 bnl BASED(sysc_nr_ok)
226 lr %r7,%r1 # copy svc number to %r7
229 mvc SP_ARGS(4,%r15),SP_R7(%r15)
231 tm __TI_flags+3(%r9),(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT)
232 l %r8,sys_call_table-system_call(%r7,%r13) # get system call addr.
233 bnz BASED(sysc_tracesys)
234 basr %r14,%r8 # call sys_xxxx
235 st %r2,SP_R2(%r15) # store return value (change R2 on stack)
236 # ATTENTION: check sys_execve_glue before
237 # changing anything here !!
240 tm SP_PSW+1(%r15),0x01 # returning to user ?
241 bno BASED(sysc_leave)
242 tm __TI_flags+3(%r9),_TIF_WORK_SVC
243 bnz BASED(sysc_work) # there is work to do (signals etc.)
245 RESTORE_ALL __LC_RETURN_PSW,1
248 # recheck if there is more work to do
251 tm __TI_flags+3(%r9),_TIF_WORK_SVC
252 bz BASED(sysc_leave) # there is no work to do
254 # One of the work bits is on. Find out which one.
257 tm __TI_flags+3(%r9),_TIF_MCCK_PENDING
258 bo BASED(sysc_mcck_pending)
259 tm __TI_flags+3(%r9),_TIF_NEED_RESCHED
260 bo BASED(sysc_reschedule)
261 tm __TI_flags+3(%r9),(_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK)
262 bnz BASED(sysc_sigpending)
263 tm __TI_flags+3(%r9),_TIF_RESTART_SVC
264 bo BASED(sysc_restart)
265 tm __TI_flags+3(%r9),_TIF_SINGLE_STEP
266 bo BASED(sysc_singlestep)
270 # _TIF_NEED_RESCHED is set, call schedule
273 l %r1,BASED(.Lschedule)
274 la %r14,BASED(sysc_work_loop)
275 br %r1 # call scheduler
278 # _TIF_MCCK_PENDING is set, call handler
281 l %r1,BASED(.Ls390_handle_mcck)
282 la %r14,BASED(sysc_work_loop)
283 br %r1 # TIF bit will be cleared by handler
286 # _TIF_SIGPENDING or _TIF_RESTORE_SIGMASK is set, call do_signal
289 ni __TI_flags+3(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
290 la %r2,SP_PTREGS(%r15) # load pt_regs
291 l %r1,BASED(.Ldo_signal)
292 basr %r14,%r1 # call do_signal
293 tm __TI_flags+3(%r9),_TIF_RESTART_SVC
294 bo BASED(sysc_restart)
295 tm __TI_flags+3(%r9),_TIF_SINGLE_STEP
296 bo BASED(sysc_singlestep)
297 b BASED(sysc_work_loop)
300 # _TIF_RESTART_SVC is set, set up registers and restart svc
303 ni __TI_flags+3(%r9),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVC
304 l %r7,SP_R2(%r15) # load new svc number
306 mvc SP_R2(4,%r15),SP_ORIG_R2(%r15) # restore first argument
307 lm %r2,%r6,SP_R2(%r15) # load svc arguments
308 b BASED(sysc_do_restart) # restart svc
311 # _TIF_SINGLE_STEP is set, call do_single_step
314 ni __TI_flags+3(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEP
315 mvi SP_TRAP+1(%r15),0x28 # set trap indication to pgm check
316 la %r2,SP_PTREGS(%r15) # address of register-save area
317 l %r1,BASED(.Lhandle_per) # load adr. of per handler
318 la %r14,BASED(sysc_return) # load adr. of system return
319 br %r1 # branch to do_single_step
322 # call trace before and after sys_call
326 la %r2,SP_PTREGS(%r15) # load pt_regs
331 clc SP_R2(4,%r15),BASED(.Lnr_syscalls)
332 bnl BASED(sysc_tracenogo)
333 l %r7,SP_R2(%r15) # strace might have changed the
334 sll %r7,2 # system call
335 l %r8,sys_call_table-system_call(%r7,%r13)
337 lm %r3,%r6,SP_R3(%r15)
338 l %r2,SP_ORIG_R2(%r15)
339 basr %r14,%r8 # call sys_xxx
340 st %r2,SP_R2(%r15) # store return value
342 tm __TI_flags+3(%r9),(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT)
343 bz BASED(sysc_return)
345 la %r2,SP_PTREGS(%r15) # load pt_regs
347 la %r14,BASED(sysc_return)
351 # a new process exits the kernel with ret_from_fork
355 l %r13,__LC_SVC_NEW_PSW+4
356 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
357 tm SP_PSW+1(%r15),0x01 # forking a kernel thread ?
359 st %r15,SP_R15(%r15) # store stack pointer for new kthread
360 0: l %r1,BASED(.Lschedtail)
362 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
366 # clone, fork, vfork, exec and sigreturn need glue,
367 # because they all expect pt_regs as parameter,
368 # but are called with different parameter.
369 # return-address is set up above
372 la %r2,SP_PTREGS(%r15) # load pt_regs
374 br %r1 # branch to sys_clone
377 la %r2,SP_PTREGS(%r15) # load pt_regs
379 br %r1 # branch to sys_fork
382 la %r2,SP_PTREGS(%r15) # load pt_regs
384 br %r1 # branch to sys_vfork
387 la %r2,SP_PTREGS(%r15) # load pt_regs
388 l %r1,BASED(.Lexecve)
389 lr %r12,%r14 # save return address
390 basr %r14,%r1 # call sys_execve
391 ltr %r2,%r2 # check if execve failed
392 bnz 0(%r12) # it did fail -> store result in gpr2
393 b 4(%r12) # SKIP ST 2,SP_R2(15) after BASR 14,8
394 # in system_call/sysc_tracesys
397 la %r2,SP_PTREGS(%r15) # load pt_regs as parameter
398 l %r1,BASED(.Lsigreturn)
399 br %r1 # branch to sys_sigreturn
401 sys_rt_sigreturn_glue:
402 la %r2,SP_PTREGS(%r15) # load pt_regs as parameter
403 l %r1,BASED(.Lrt_sigreturn)
404 br %r1 # branch to sys_sigreturn
406 sys_sigaltstack_glue:
407 la %r4,SP_PTREGS(%r15) # load pt_regs as parameter
408 l %r1,BASED(.Lsigaltstack)
409 br %r1 # branch to sys_sigreturn
413 * Program check handler routine
416 .globl pgm_check_handler
419 * First we need to check for a special case:
420 * Single stepping an instruction that disables the PER event mask will
421 * cause a PER event AFTER the mask has been set. Example: SVC or LPSW.
422 * For a single stepped SVC the program check handler gets control after
423 * the SVC new PSW has been loaded. But we want to execute the SVC first and
424 * then handle the PER event. Therefore we update the SVC old PSW to point
425 * to the pgm_check_handler and branch to the SVC handler after we checked
426 * if we have to load the kernel stack register.
427 * For every other possible cause for PER event without the PER mask set
428 * we just ignore the PER event (FIXME: is there anything we have to do
431 STORE_TIMER __LC_SYNC_ENTER_TIMER
432 SAVE_ALL_BASE __LC_SAVE_AREA
433 tm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exception
434 bnz BASED(pgm_per) # got per exception -> special case
435 SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
436 CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
437 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
438 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
439 bz BASED(pgm_no_vtime)
440 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
441 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
442 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
445 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
446 l %r3,__LC_PGM_ILC # load program interruption code
450 l %r7,BASED(.Ljump_table)
452 l %r7,0(%r8,%r7) # load address of handler routine
453 la %r2,SP_PTREGS(%r15) # address of register-save area
454 la %r14,BASED(sysc_return)
455 br %r7 # branch to interrupt-handler
458 # handle per exception
461 tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is on
462 bnz BASED(pgm_per_std) # ok, normal per event from user space
463 # ok its one of the special cases, now we need to find out which one
464 clc __LC_PGM_OLD_PSW(8),__LC_SVC_NEW_PSW
466 # no interesting special case, ignore PER event
467 lm %r12,%r15,__LC_SAVE_AREA
471 # Normal per exception
474 SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREA
475 CREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA
476 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
477 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
478 bz BASED(pgm_no_vtime2)
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
484 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
486 mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
487 mvc __THREAD_per+__PER_address(4,%r1),__LC_PER_ADDRESS
488 mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
489 oi __TI_flags+3(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
490 l %r3,__LC_PGM_ILC # load program interruption code
492 nr %r8,%r3 # clear per-event-bit and ilc
493 be BASED(sysc_return) # only per or per+check ?
497 # it was a single stepped SVC that is causing all the trouble
500 SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
501 CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
502 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
503 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
504 bz BASED(pgm_no_vtime3)
505 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
506 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
507 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
510 lh %r7,0x8a # get svc number from lowcore
511 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
513 mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMID
514 mvc __THREAD_per+__PER_address(4,%r1),__LC_PER_ADDRESS
515 mvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_ID
516 oi __TI_flags+3(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEP
517 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
521 * IO interrupt handler routine
524 .globl io_int_handler
526 STORE_TIMER __LC_ASYNC_ENTER_TIMER
528 SAVE_ALL_BASE __LC_SAVE_AREA+16
529 SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+16
530 CREATE_STACK_FRAME __LC_IO_OLD_PSW,__LC_SAVE_AREA+16
531 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
532 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
533 bz BASED(io_no_vtime)
534 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
535 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
536 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
539 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
540 l %r1,BASED(.Ldo_IRQ) # load address of do_IRQ
541 la %r2,SP_PTREGS(%r15) # address of register-save area
542 basr %r14,%r1 # branch to standard irq handler
545 tm SP_PSW+1(%r15),0x01 # returning to user ?
546 #ifdef CONFIG_PREEMPT
547 bno BASED(io_preempt) # no -> check for preemptive scheduling
549 bno BASED(io_leave) # no-> skip resched & signal
551 tm __TI_flags+3(%r9),_TIF_WORK_INT
552 bnz BASED(io_work) # there is work to do (signals etc.)
554 RESTORE_ALL __LC_RETURN_PSW,0
557 #ifdef CONFIG_PREEMPT
559 icm %r0,15,__TI_precount(%r9)
562 s %r1,BASED(.Lc_spsize)
563 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
564 xc __SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chain
567 tm __TI_flags+3(%r9),_TIF_NEED_RESCHED
569 mvc __TI_precount(4,%r9),BASED(.Lc_pactive)
570 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
571 l %r1,BASED(.Lschedule)
572 basr %r14,%r1 # call schedule
573 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
574 xc __TI_precount(4,%r9),__TI_precount(%r9)
575 b BASED(io_resume_loop)
579 # switch to kernel stack, then check the TIF bits
582 l %r1,__LC_KERNEL_STACK
583 s %r1,BASED(.Lc_spsize)
584 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
585 xc __SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chain
588 # One of the work bits is on. Find out which one.
589 # Checked are: _TIF_SIGPENDING, _TIF_RESTORE_SIGMASK, _TIF_NEED_RESCHED
590 # and _TIF_MCCK_PENDING
593 tm __TI_flags+3(%r9),_TIF_MCCK_PENDING
594 bo BASED(io_mcck_pending)
595 tm __TI_flags+3(%r9),_TIF_NEED_RESCHED
596 bo BASED(io_reschedule)
597 tm __TI_flags+3(%r9),(_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK)
598 bnz BASED(io_sigpending)
602 # _TIF_MCCK_PENDING is set, call handler
605 l %r1,BASED(.Ls390_handle_mcck)
606 la %r14,BASED(io_work_loop)
607 br %r1 # TIF bit will be cleared by handler
610 # _TIF_NEED_RESCHED is set, call schedule
613 l %r1,BASED(.Lschedule)
614 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
615 basr %r14,%r1 # call scheduler
616 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
617 tm __TI_flags+3(%r9),_TIF_WORK_INT
618 bz BASED(io_leave) # there is no work to do
619 b BASED(io_work_loop)
622 # _TIF_SIGPENDING or _TIF_RESTORE_SIGMASK is set, call do_signal
625 stosm __SF_EMPTY(%r15),0x03 # reenable interrupts
626 la %r2,SP_PTREGS(%r15) # load pt_regs
627 l %r1,BASED(.Ldo_signal)
628 basr %r14,%r1 # call do_signal
629 stnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interrupts
630 b BASED(io_work_loop)
633 * External interrupt handler routine
636 .globl ext_int_handler
638 STORE_TIMER __LC_ASYNC_ENTER_TIMER
640 SAVE_ALL_BASE __LC_SAVE_AREA+16
641 SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+16
642 CREATE_STACK_FRAME __LC_EXT_OLD_PSW,__LC_SAVE_AREA+16
643 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
644 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
645 bz BASED(ext_no_vtime)
646 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
647 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
648 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
651 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
652 la %r2,SP_PTREGS(%r15) # address of register-save area
653 lh %r3,__LC_EXT_INT_CODE # get interruption code
654 l %r1,BASED(.Ldo_extint)
661 * Machine check handler routines
664 .globl mcck_int_handler
666 spt __LC_CPU_TIMER_SAVE_AREA # revalidate cpu timer
667 lm %r0,%r15,__LC_GPREGS_SAVE_AREA # revalidate gprs
668 SAVE_ALL_BASE __LC_SAVE_AREA+32
669 la %r12,__LC_MCK_OLD_PSW
670 tm __LC_MCCK_CODE,0x80 # system damage?
671 bo BASED(mcck_int_main) # yes -> rest of mcck code invalid
672 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
673 mvc __LC_SAVE_AREA+52(8),__LC_ASYNC_ENTER_TIMER
674 mvc __LC_ASYNC_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREA
675 tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
677 la %r14,__LC_SYNC_ENTER_TIMER
678 clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
680 la %r14,__LC_ASYNC_ENTER_TIMER
681 0: clc 0(8,%r14),__LC_EXIT_TIMER
683 la %r14,__LC_EXIT_TIMER
684 0: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
686 la %r14,__LC_LAST_UPDATE_TIMER
688 mvc __LC_ASYNC_ENTER_TIMER(8),0(%r14)
691 tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
692 bno BASED(mcck_int_main) # no -> skip cleanup critical
693 tm __LC_MCK_OLD_PSW+1,0x01 # test problem state bit
694 bnz BASED(mcck_int_main) # from user -> load async stack
695 clc __LC_MCK_OLD_PSW+4(4),BASED(.Lcritical_end)
696 bhe BASED(mcck_int_main)
697 clc __LC_MCK_OLD_PSW+4(4),BASED(.Lcritical_start)
698 bl BASED(mcck_int_main)
699 l %r14,BASED(.Lcleanup_critical)
702 l %r14,__LC_PANIC_STACK # are we already on the panic stack?
706 l %r15,__LC_PANIC_STACK # load panic stack
707 0: CREATE_STACK_FRAME __LC_MCK_OLD_PSW,__LC_SAVE_AREA+32
708 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
709 tm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?
710 bno BASED(mcck_no_vtime) # no -> skip cleanup critical
711 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
712 bz BASED(mcck_no_vtime)
713 UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMER
714 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
715 mvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMER
718 l %r9,__LC_THREAD_INFO # load pointer to thread_info struct
719 la %r2,SP_PTREGS(%r15) # load pt_regs
720 l %r1,BASED(.Ls390_mcck)
721 basr %r14,%r1 # call machine check handler
722 tm SP_PSW+1(%r15),0x01 # returning to user ?
723 bno BASED(mcck_return)
724 l %r1,__LC_KERNEL_STACK # switch to kernel stack
725 s %r1,BASED(.Lc_spsize)
726 mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)
727 xc __SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chain
729 stosm __SF_EMPTY(%r15),0x04 # turn dat on
730 tm __TI_flags+3(%r9),_TIF_MCCK_PENDING
731 bno BASED(mcck_return)
732 l %r1,BASED(.Ls390_handle_mcck)
733 basr %r14,%r1 # call machine check handler
735 mvc __LC_RETURN_MCCK_PSW(8),SP_PSW(%r15) # move return PSW
736 ni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit
737 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
738 mvc __LC_ASYNC_ENTER_TIMER(8),__LC_SAVE_AREA+52
739 tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
741 lm %r0,%r15,SP_R0(%r15) # load gprs 0-15
743 lpsw __LC_RETURN_MCCK_PSW # back to caller
746 lm %r0,%r15,SP_R0(%r15) # load gprs 0-15
747 lpsw __LC_RETURN_MCCK_PSW # back to caller
749 RESTORE_ALL __LC_RETURN_MCCK_PSW,0
753 * Restart interruption handler, kick starter for additional CPUs
755 .globl restart_int_handler
757 l %r15,__LC_SAVE_AREA+60 # load ksp
758 lctl %c0,%c15,__LC_CREGS_SAVE_AREA # get new ctl regs
759 lam %a0,%a15,__LC_AREGS_SAVE_AREA
760 lm %r6,%r15,__SF_GPRS(%r15) # load registers from clone
761 stosm __SF_EMPTY(%r15),0x04 # now we can turn dat on
763 l %r14,restart_addr-.(%r14)
764 br %r14 # branch to start_secondary
766 .long start_secondary
769 * If we do not run with SMP enabled, let the new CPU crash ...
771 .globl restart_int_handler
775 lpsw restart_crash-restart_base(%r1)
778 .long 0x000a0000,0x00000000
782 #ifdef CONFIG_CHECK_STACK
784 * The synchronous or the asynchronous stack overflowed. We are dead.
785 * No need to properly save the registers, we are going to panic anyway.
786 * Setup a pt_regs so that show_trace can provide a good call trace.
789 l %r15,__LC_PANIC_STACK # change to panic stack
790 sl %r15,BASED(.Lc_spsize)
791 mvc SP_PSW(8,%r15),0(%r12) # move user PSW to stack
792 stm %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stack
793 la %r1,__LC_SAVE_AREA
794 ch %r12,BASED(.L0x020) # old psw addr == __LC_SVC_OLD_PSW ?
796 ch %r12,BASED(.L0x028) # old psw addr == __LC_PGM_OLD_PSW ?
798 la %r1,__LC_SAVE_AREA+16
799 0: mvc SP_R12(16,%r15),0(%r1) # move %r12-%r15 to stack
800 xc __SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15) # clear back chain
801 l %r1,BASED(1f) # branch to kernel_stack_overflow
802 la %r2,SP_PTREGS(%r15) # load pt_regs
804 1: .long kernel_stack_overflow
807 cleanup_table_system_call:
808 .long system_call + 0x80000000, sysc_do_svc + 0x80000000
809 cleanup_table_sysc_return:
810 .long sysc_return + 0x80000000, sysc_leave + 0x80000000
811 cleanup_table_sysc_leave:
812 .long sysc_leave + 0x80000000, sysc_work_loop + 0x80000000
813 cleanup_table_sysc_work_loop:
814 .long sysc_work_loop + 0x80000000, sysc_reschedule + 0x80000000
815 cleanup_table_io_return:
816 .long io_return + 0x80000000, io_leave + 0x80000000
817 cleanup_table_io_leave:
818 .long io_leave + 0x80000000, io_done + 0x80000000
819 cleanup_table_io_work_loop:
820 .long io_work_loop + 0x80000000, io_mcck_pending + 0x80000000
823 clc 4(4,%r12),BASED(cleanup_table_system_call)
825 clc 4(4,%r12),BASED(cleanup_table_system_call+4)
826 bl BASED(cleanup_system_call)
828 clc 4(4,%r12),BASED(cleanup_table_sysc_return)
830 clc 4(4,%r12),BASED(cleanup_table_sysc_return+4)
831 bl BASED(cleanup_sysc_return)
833 clc 4(4,%r12),BASED(cleanup_table_sysc_leave)
835 clc 4(4,%r12),BASED(cleanup_table_sysc_leave+4)
836 bl BASED(cleanup_sysc_leave)
838 clc 4(4,%r12),BASED(cleanup_table_sysc_work_loop)
840 clc 4(4,%r12),BASED(cleanup_table_sysc_work_loop+4)
841 bl BASED(cleanup_sysc_return)
843 clc 4(4,%r12),BASED(cleanup_table_io_return)
845 clc 4(4,%r12),BASED(cleanup_table_io_return+4)
846 bl BASED(cleanup_io_return)
848 clc 4(4,%r12),BASED(cleanup_table_io_leave)
850 clc 4(4,%r12),BASED(cleanup_table_io_leave+4)
851 bl BASED(cleanup_io_leave)
853 clc 4(4,%r12),BASED(cleanup_table_io_work_loop)
855 clc 4(4,%r12),BASED(cleanup_table_io_work_loop+4)
856 bl BASED(cleanup_io_return)
861 mvc __LC_RETURN_PSW(8),0(%r12)
862 c %r12,BASED(.Lmck_old_psw)
864 la %r12,__LC_SAVE_AREA+16
866 0: la %r12,__LC_SAVE_AREA+32
868 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
869 clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+4)
871 mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
872 0: clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+8)
873 bhe BASED(cleanup_vtime)
875 clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn)
877 mvc __LC_SAVE_AREA(16),0(%r12)
879 st %r12,__LC_SAVE_AREA+48 # argh
880 SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREA
881 CREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA
882 l %r12,__LC_SAVE_AREA+48 # argh
885 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
887 clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+12)
888 bhe BASED(cleanup_stime)
889 tm SP_PSW+1(%r15),0x01 # interrupting from user ?
890 bz BASED(cleanup_novtime)
891 UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMER
893 clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+16)
894 bh BASED(cleanup_update)
895 UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMER
897 mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
900 mvc __LC_RETURN_PSW+4(4),BASED(cleanup_table_system_call+4)
901 la %r12,__LC_RETURN_PSW
903 cleanup_system_call_insn:
904 .long sysc_saveall + 0x80000000
905 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
906 .long system_call + 0x80000000
907 .long sysc_vtime + 0x80000000
908 .long sysc_stime + 0x80000000
909 .long sysc_update + 0x80000000
913 mvc __LC_RETURN_PSW(4),0(%r12)
914 mvc __LC_RETURN_PSW+4(4),BASED(cleanup_table_sysc_return)
915 la %r12,__LC_RETURN_PSW
919 clc 4(4,%r12),BASED(cleanup_sysc_leave_insn)
921 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
922 mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
923 clc 4(4,%r12),BASED(cleanup_sysc_leave_insn+4)
926 mvc __LC_RETURN_PSW(8),SP_PSW(%r15)
927 c %r12,BASED(.Lmck_old_psw)
929 mvc __LC_SAVE_AREA+32(16),SP_R12(%r15)
931 0: mvc __LC_SAVE_AREA+16(16),SP_R12(%r15)
932 1: lm %r0,%r11,SP_R0(%r15)
934 2: la %r12,__LC_RETURN_PSW
936 cleanup_sysc_leave_insn:
937 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
938 .long sysc_leave + 14 + 0x80000000
940 .long sysc_leave + 10 + 0x80000000
943 mvc __LC_RETURN_PSW(4),0(%r12)
944 mvc __LC_RETURN_PSW+4(4),BASED(cleanup_table_io_work_loop)
945 la %r12,__LC_RETURN_PSW
949 clc 4(4,%r12),BASED(cleanup_io_leave_insn)
951 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
952 mvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMER
953 clc 4(4,%r12),BASED(cleanup_io_leave_insn+4)
956 mvc __LC_RETURN_PSW(8),SP_PSW(%r15)
957 c %r12,BASED(.Lmck_old_psw)
959 mvc __LC_SAVE_AREA+32(16),SP_R12(%r15)
961 0: mvc __LC_SAVE_AREA+16(16),SP_R12(%r15)
962 1: lm %r0,%r11,SP_R0(%r15)
964 2: la %r12,__LC_RETURN_PSW
966 cleanup_io_leave_insn:
967 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
968 .long io_leave + 18 + 0x80000000
970 .long io_leave + 14 + 0x80000000
976 .Lc_spsize: .long SP_SIZE
977 .Lc_overhead: .long STACK_FRAME_OVERHEAD
978 .Lc_pactive: .long PREEMPT_ACTIVE
979 .Lnr_syscalls: .long NR_syscalls
980 .L0x018: .short 0x018
981 .L0x020: .short 0x020
982 .L0x028: .short 0x028
983 .L0x030: .short 0x030
984 .L0x038: .short 0x038
990 .Ls390_mcck: .long s390_do_machine_check
992 .long s390_handle_mcck
993 .Lmck_old_psw: .long __LC_MCK_OLD_PSW
994 .Ldo_IRQ: .long do_IRQ
995 .Ldo_extint: .long do_extint
996 .Ldo_signal: .long do_signal
997 .Lhandle_per: .long do_single_step
998 .Ljump_table: .long pgm_check_table
999 .Lschedule: .long schedule
1000 .Lclone: .long sys_clone
1001 .Lexecve: .long sys_execve
1002 .Lfork: .long sys_fork
1003 .Lrt_sigreturn:.long sys_rt_sigreturn
1005 .long sys_rt_sigsuspend
1006 .Lsigreturn: .long sys_sigreturn
1007 .Lsigsuspend: .long sys_sigsuspend
1008 .Lsigaltstack: .long sys_sigaltstack
1009 .Ltrace: .long syscall_trace
1010 .Lvfork: .long sys_vfork
1011 .Lschedtail: .long schedule_tail
1014 .long __critical_start + 0x80000000
1016 .long __critical_end + 0x80000000
1018 .long cleanup_critical
1020 #define SYSCALL(esa,esame,emu) .long esa
1022 #include "syscalls.S"