URL
https://opencores.org/ocsvn/test_project/test_project/trunk
Subversion Repositories test_project
[/] [test_project/] [trunk/] [linux_sd_driver/] [arch/] [s390/] [kernel/] [entry.S] - Rev 63
Compare with Previous | Blame | View Log
/** arch/s390/kernel/entry.S* S390 low-level entry points.** Copyright (C) IBM Corp. 1999,2006* Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),* Hartmut Penner (hp@de.ibm.com),* Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),* Heiko Carstens <heiko.carstens@de.ibm.com>*/#include <linux/sys.h>#include <linux/linkage.h>#include <asm/cache.h>#include <asm/lowcore.h>#include <asm/errno.h>#include <asm/ptrace.h>#include <asm/thread_info.h>#include <asm/asm-offsets.h>#include <asm/unistd.h>#include <asm/page.h>/** Stack layout for the system_call stack entry.* The first few entries are identical to the user_regs_struct.*/SP_PTREGS = STACK_FRAME_OVERHEADSP_ARGS = STACK_FRAME_OVERHEAD + __PT_ARGSSP_PSW = STACK_FRAME_OVERHEAD + __PT_PSWSP_R0 = STACK_FRAME_OVERHEAD + __PT_GPRSSP_R1 = STACK_FRAME_OVERHEAD + __PT_GPRS + 4SP_R2 = STACK_FRAME_OVERHEAD + __PT_GPRS + 8SP_R3 = STACK_FRAME_OVERHEAD + __PT_GPRS + 12SP_R4 = STACK_FRAME_OVERHEAD + __PT_GPRS + 16SP_R5 = STACK_FRAME_OVERHEAD + __PT_GPRS + 20SP_R6 = STACK_FRAME_OVERHEAD + __PT_GPRS + 24SP_R7 = STACK_FRAME_OVERHEAD + __PT_GPRS + 28SP_R8 = STACK_FRAME_OVERHEAD + __PT_GPRS + 32SP_R9 = STACK_FRAME_OVERHEAD + __PT_GPRS + 36SP_R10 = STACK_FRAME_OVERHEAD + __PT_GPRS + 40SP_R11 = STACK_FRAME_OVERHEAD + __PT_GPRS + 44SP_R12 = STACK_FRAME_OVERHEAD + __PT_GPRS + 48SP_R13 = STACK_FRAME_OVERHEAD + __PT_GPRS + 52SP_R14 = STACK_FRAME_OVERHEAD + __PT_GPRS + 56SP_R15 = STACK_FRAME_OVERHEAD + __PT_GPRS + 60SP_ORIG_R2 = STACK_FRAME_OVERHEAD + __PT_ORIG_GPR2SP_ILC = STACK_FRAME_OVERHEAD + __PT_ILCSP_TRAP = STACK_FRAME_OVERHEAD + __PT_TRAPSP_SIZE = STACK_FRAME_OVERHEAD + __PT_SIZE_TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK | _TIF_NEED_RESCHED | \_TIF_MCCK_PENDING | _TIF_RESTART_SVC | _TIF_SINGLE_STEP )_TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK | _TIF_NEED_RESCHED | \_TIF_MCCK_PENDING)STACK_SHIFT = PAGE_SHIFT + THREAD_ORDERSTACK_SIZE = 1 << STACK_SHIFT#define BASED(name) name-system_call(%r13)#ifdef CONFIG_TRACE_IRQFLAGS.macro TRACE_IRQS_ONl %r1,BASED(.Ltrace_irq_on)basr %r14,%r1.endm.macro TRACE_IRQS_OFFl %r1,BASED(.Ltrace_irq_off)basr %r14,%r1.endm.macro TRACE_IRQS_CHECKtm SP_PSW(%r15),0x03 # irqs enabled?jz 0fl %r1,BASED(.Ltrace_irq_on)basr %r14,%r1j 1f0: l %r1,BASED(.Ltrace_irq_off)basr %r14,%r11:.endm#else#define TRACE_IRQS_ON#define TRACE_IRQS_OFF#define TRACE_IRQS_CHECK#endif#ifdef CONFIG_LOCKDEP.macro LOCKDEP_SYS_EXITtm SP_PSW+1(%r15),0x01 # returning to user ?jz 0fl %r1,BASED(.Llockdep_sys_exit)basr %r14,%r10:.endm#else#define LOCKDEP_SYS_EXIT#endif/** Register usage in interrupt handlers:* R9 - pointer to current task structure* R13 - pointer to literal pool* R14 - return register for function calls* R15 - kernel stack pointer*/.macro STORE_TIMER lc_offset#ifdef CONFIG_VIRT_CPU_ACCOUNTINGstpt \lc_offset#endif.endm#ifdef CONFIG_VIRT_CPU_ACCOUNTING.macro UPDATE_VTIME lc_from,lc_to,lc_sumlm %r10,%r11,\lc_fromsl %r10,\lc_tosl %r11,\lc_to+4bc 3,BASED(0f)sl %r10,BASED(.Lc_1)0: al %r10,\lc_sumal %r11,\lc_sum+4bc 12,BASED(1f)al %r10,BASED(.Lc_1)1: stm %r10,%r11,\lc_sum.endm#endif.macro SAVE_ALL_BASE saveareastm %r12,%r15,\saveareal %r13,__LC_SVC_NEW_PSW+4 # load &system_call to %r13.endm.macro SAVE_ALL_SVC psworg,saveareala %r12,\psworgl %r15,__LC_KERNEL_STACK # problem state -> load ksp.endm.macro SAVE_ALL_SYNC psworg,saveareala %r12,\psworgtm \psworg+1,0x01 # test problem state bitbz BASED(2f) # skip stack setup savel %r15,__LC_KERNEL_STACK # problem state -> load ksp#ifdef CONFIG_CHECK_STACKb BASED(3f)2: tml %r15,STACK_SIZE - CONFIG_STACK_GUARDbz BASED(stack_overflow)3:#endif2:.endm.macro SAVE_ALL_ASYNC psworg,saveareala %r12,\psworgtm \psworg+1,0x01 # test problem state bitbnz BASED(1f) # from user -> load async stackclc \psworg+4(4),BASED(.Lcritical_end)bhe BASED(0f)clc \psworg+4(4),BASED(.Lcritical_start)bl BASED(0f)l %r14,BASED(.Lcleanup_critical)basr %r14,%r14tm 1(%r12),0x01 # retest problem state after cleanupbnz BASED(1f)0: l %r14,__LC_ASYNC_STACK # are we already on the async stack ?slr %r14,%r15sra %r14,STACK_SHIFTbe BASED(2f)1: l %r15,__LC_ASYNC_STACK#ifdef CONFIG_CHECK_STACKb BASED(3f)2: tml %r15,STACK_SIZE - CONFIG_STACK_GUARDbz BASED(stack_overflow)3:#endif2:.endm.macro CREATE_STACK_FRAME psworg,saveareas %r15,BASED(.Lc_spsize) # make room for registers & pswmvc SP_PSW(8,%r15),0(%r12) # move user PSW to stackla %r12,\psworgst %r2,SP_ORIG_R2(%r15) # store original content of gpr 2icm %r12,12,__LC_SVC_ILCstm %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stackst %r12,SP_ILC(%r15)mvc SP_R12(16,%r15),\savearea # move %r12-%r15 to stackla %r12,0st %r12,__SF_BACKCHAIN(%r15) # clear back chain.endm.macro RESTORE_ALL psworg,syncmvc \psworg(8),SP_PSW(%r15) # move user PSW to lowcore.if !\syncni \psworg+1,0xfd # clear wait state bit.endiflm %r0,%r15,SP_R0(%r15) # load gprs 0-15 of userSTORE_TIMER __LC_EXIT_TIMERlpsw \psworg # back to caller.endm/** Scheduler resume function, called by switch_to* gpr2 = (task_struct *) prev* gpr3 = (task_struct *) next* Returns:* gpr2 = prev*/.globl __switch_to__switch_to:basr %r1,0__switch_to_base:tm __THREAD_per(%r3),0xe8 # new process is using per ?bz __switch_to_noper-__switch_to_base(%r1) # if not we're finestctl %c9,%c11,__SF_EMPTY(%r15) # We are using per stuffclc __THREAD_per(12,%r3),__SF_EMPTY(%r15)be __switch_to_noper-__switch_to_base(%r1) # we got away w/o bashing TLB'slctl %c9,%c11,__THREAD_per(%r3) # Nope we didn't__switch_to_noper:l %r4,__THREAD_info(%r2) # get thread_info of prevtm __TI_flags+3(%r4),_TIF_MCCK_PENDING # machine check pending?bz __switch_to_no_mcck-__switch_to_base(%r1)ni __TI_flags+3(%r4),255-_TIF_MCCK_PENDING # clear flag in prevl %r4,__THREAD_info(%r3) # get thread_info of nextoi __TI_flags+3(%r4),_TIF_MCCK_PENDING # set it in next__switch_to_no_mcck:stm %r6,%r15,__SF_GPRS(%r15)# store __switch_to registers of prev taskst %r15,__THREAD_ksp(%r2) # store kernel stack to prev->tss.kspl %r15,__THREAD_ksp(%r3) # load kernel stack from next->tss.ksplm %r6,%r15,__SF_GPRS(%r15)# load __switch_to registers of next taskst %r3,__LC_CURRENT # __LC_CURRENT = current task structlctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4l %r3,__THREAD_info(%r3) # load thread_info from task structst %r3,__LC_THREAD_INFOahi %r3,STACK_SIZEst %r3,__LC_KERNEL_STACK # __LC_KERNEL_STACK = new kernel stackbr %r14__critical_start:/** SVC interrupt handler routine. System calls are synchronous events and* are executed with interrupts enabled.*/.globl system_callsystem_call:STORE_TIMER __LC_SYNC_ENTER_TIMERsysc_saveall:SAVE_ALL_BASE __LC_SAVE_AREASAVE_ALL_SVC __LC_SVC_OLD_PSW,__LC_SAVE_AREACREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREAlh %r7,0x8a # get svc number from lowcore#ifdef CONFIG_VIRT_CPU_ACCOUNTINGsysc_vtime:UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMERsysc_stime:UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERsysc_update:mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER#endifsysc_do_svc:l %r9,__LC_THREAD_INFO # load pointer to thread_info structsla %r7,2 # *4 and test for svc 0bnz BASED(sysc_nr_ok) # svc number > 0# svc 0: system call number in %r1cl %r1,BASED(.Lnr_syscalls)bnl BASED(sysc_nr_ok)lr %r7,%r1 # copy svc number to %r7sla %r7,2 # *4sysc_nr_ok:mvc SP_ARGS(4,%r15),SP_R7(%r15)sysc_do_restart:l %r8,BASED(.Lsysc_table)tm __TI_flags+3(%r9),(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT)l %r8,0(%r7,%r8) # get system call addr.bnz BASED(sysc_tracesys)basr %r14,%r8 # call sys_xxxxst %r2,SP_R2(%r15) # store return value (change R2 on stack)sysc_return:tm SP_PSW+1(%r15),0x01 # returning to user ?bno BASED(sysc_restore)tm __TI_flags+3(%r9),_TIF_WORK_SVCbnz BASED(sysc_work) # there is work to do (signals etc.)sysc_restore:#ifdef CONFIG_TRACE_IRQFLAGSla %r1,BASED(sysc_restore_trace_psw)lpsw 0(%r1)sysc_restore_trace:TRACE_IRQS_CHECKLOCKDEP_SYS_EXIT#endifsysc_leave:RESTORE_ALL __LC_RETURN_PSW,1sysc_done:#ifdef CONFIG_TRACE_IRQFLAGS.align 8.globl sysc_restore_trace_pswsysc_restore_trace_psw:.long 0, sysc_restore_trace + 0x80000000#endif## recheck if there is more work to do#sysc_work_loop:tm __TI_flags+3(%r9),_TIF_WORK_SVCbz BASED(sysc_restore) # there is no work to do## One of the work bits is on. Find out which one.#sysc_work:tm __TI_flags+3(%r9),_TIF_MCCK_PENDINGbo BASED(sysc_mcck_pending)tm __TI_flags+3(%r9),_TIF_NEED_RESCHEDbo BASED(sysc_reschedule)tm __TI_flags+3(%r9),(_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK)bnz BASED(sysc_sigpending)tm __TI_flags+3(%r9),_TIF_RESTART_SVCbo BASED(sysc_restart)tm __TI_flags+3(%r9),_TIF_SINGLE_STEPbo BASED(sysc_singlestep)b BASED(sysc_restore)sysc_work_done:## _TIF_NEED_RESCHED is set, call schedule#sysc_reschedule:l %r1,BASED(.Lschedule)la %r14,BASED(sysc_work_loop)br %r1 # call scheduler## _TIF_MCCK_PENDING is set, call handler#sysc_mcck_pending:l %r1,BASED(.Ls390_handle_mcck)la %r14,BASED(sysc_work_loop)br %r1 # TIF bit will be cleared by handler## _TIF_SIGPENDING or _TIF_RESTORE_SIGMASK is set, call do_signal#sysc_sigpending:ni __TI_flags+3(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEPla %r2,SP_PTREGS(%r15) # load pt_regsl %r1,BASED(.Ldo_signal)basr %r14,%r1 # call do_signaltm __TI_flags+3(%r9),_TIF_RESTART_SVCbo BASED(sysc_restart)tm __TI_flags+3(%r9),_TIF_SINGLE_STEPbo BASED(sysc_singlestep)b BASED(sysc_work_loop)## _TIF_RESTART_SVC is set, set up registers and restart svc#sysc_restart:ni __TI_flags+3(%r9),255-_TIF_RESTART_SVC # clear TIF_RESTART_SVCl %r7,SP_R2(%r15) # load new svc numbersla %r7,2mvc SP_R2(4,%r15),SP_ORIG_R2(%r15) # restore first argumentlm %r2,%r6,SP_R2(%r15) # load svc argumentsb BASED(sysc_do_restart) # restart svc## _TIF_SINGLE_STEP is set, call do_single_step#sysc_singlestep:ni __TI_flags+3(%r9),255-_TIF_SINGLE_STEP # clear TIF_SINGLE_STEPmvi SP_TRAP+1(%r15),0x28 # set trap indication to pgm checkla %r2,SP_PTREGS(%r15) # address of register-save areal %r1,BASED(.Lhandle_per) # load adr. of per handlerla %r14,BASED(sysc_return) # load adr. of system returnbr %r1 # branch to do_single_step## call trace before and after sys_call#sysc_tracesys:l %r1,BASED(.Ltrace)la %r2,SP_PTREGS(%r15) # load pt_regsla %r3,0srl %r7,2st %r7,SP_R2(%r15)basr %r14,%r1clc SP_R2(4,%r15),BASED(.Lnr_syscalls)bnl BASED(sysc_tracenogo)l %r8,BASED(.Lsysc_table)l %r7,SP_R2(%r15) # strace might have changed thesll %r7,2 # system calll %r8,0(%r7,%r8)sysc_tracego:lm %r3,%r6,SP_R3(%r15)l %r2,SP_ORIG_R2(%r15)basr %r14,%r8 # call sys_xxxst %r2,SP_R2(%r15) # store return valuesysc_tracenogo:tm __TI_flags+3(%r9),(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT)bz BASED(sysc_return)l %r1,BASED(.Ltrace)la %r2,SP_PTREGS(%r15) # load pt_regsla %r3,1la %r14,BASED(sysc_return)br %r1## a new process exits the kernel with ret_from_fork#.globl ret_from_forkret_from_fork:l %r13,__LC_SVC_NEW_PSW+4l %r9,__LC_THREAD_INFO # load pointer to thread_info structtm SP_PSW+1(%r15),0x01 # forking a kernel thread ?bo BASED(0f)st %r15,SP_R15(%r15) # store stack pointer for new kthread0: l %r1,BASED(.Lschedtail)basr %r14,%r1TRACE_IRQS_ONstosm __SF_EMPTY(%r15),0x03 # reenable interruptsb BASED(sysc_return)## kernel_execve function needs to deal with pt_regs that is not# at the usual place#.globl kernel_execvekernel_execve:stm %r12,%r15,48(%r15)lr %r14,%r15l %r13,__LC_SVC_NEW_PSW+4s %r15,BASED(.Lc_spsize)st %r14,__SF_BACKCHAIN(%r15)la %r12,SP_PTREGS(%r15)xc 0(__PT_SIZE,%r12),0(%r12)l %r1,BASED(.Ldo_execve)lr %r5,%r12basr %r14,%r1ltr %r2,%r2be BASED(0f)a %r15,BASED(.Lc_spsize)lm %r12,%r15,48(%r15)br %r14# execve succeeded.0: stnsm __SF_EMPTY(%r15),0xfc # disable interruptsl %r15,__LC_KERNEL_STACK # load ksps %r15,BASED(.Lc_spsize) # make room for registers & pswl %r9,__LC_THREAD_INFOmvc SP_PTREGS(__PT_SIZE,%r15),0(%r12) # copy pt_regsxc __SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15)stosm __SF_EMPTY(%r15),0x03 # reenable interruptsl %r1,BASED(.Lexecve_tail)basr %r14,%r1b BASED(sysc_return)/** Program check handler routine*/.globl pgm_check_handlerpgm_check_handler:/** First we need to check for a special case:* Single stepping an instruction that disables the PER event mask will* cause a PER event AFTER the mask has been set. Example: SVC or LPSW.* For a single stepped SVC the program check handler gets control after* the SVC new PSW has been loaded. But we want to execute the SVC first and* then handle the PER event. Therefore we update the SVC old PSW to point* to the pgm_check_handler and branch to the SVC handler after we checked* if we have to load the kernel stack register.* For every other possible cause for PER event without the PER mask set* we just ignore the PER event (FIXME: is there anything we have to do* for LPSW?).*/STORE_TIMER __LC_SYNC_ENTER_TIMERSAVE_ALL_BASE __LC_SAVE_AREAtm __LC_PGM_INT_CODE+1,0x80 # check whether we got a per exceptionbnz BASED(pgm_per) # got per exception -> special caseSAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREACREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA#ifdef CONFIG_VIRT_CPU_ACCOUNTINGtm SP_PSW+1(%r15),0x01 # interrupting from user ?bz BASED(pgm_no_vtime)UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMERUPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERmvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMERpgm_no_vtime:#endifl %r9,__LC_THREAD_INFO # load pointer to thread_info structTRACE_IRQS_OFFl %r3,__LC_PGM_ILC # load program interruption codela %r8,0x7fnr %r8,%r3pgm_do_call:l %r7,BASED(.Ljump_table)sll %r8,2l %r7,0(%r8,%r7) # load address of handler routinela %r2,SP_PTREGS(%r15) # address of register-save areala %r14,BASED(sysc_return)br %r7 # branch to interrupt-handler## handle per exception#pgm_per:tm __LC_PGM_OLD_PSW,0x40 # test if per event recording is onbnz BASED(pgm_per_std) # ok, normal per event from user space# ok its one of the special cases, now we need to find out which oneclc __LC_PGM_OLD_PSW(8),__LC_SVC_NEW_PSWbe BASED(pgm_svcper)# no interesting special case, ignore PER eventlm %r12,%r15,__LC_SAVE_AREAlpsw 0x28## Normal per exception#pgm_per_std:SAVE_ALL_SYNC __LC_PGM_OLD_PSW,__LC_SAVE_AREACREATE_STACK_FRAME __LC_PGM_OLD_PSW,__LC_SAVE_AREA#ifdef CONFIG_VIRT_CPU_ACCOUNTINGtm SP_PSW+1(%r15),0x01 # interrupting from user ?bz BASED(pgm_no_vtime2)UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMERUPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERmvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMERpgm_no_vtime2:#endifl %r9,__LC_THREAD_INFO # load pointer to thread_info structTRACE_IRQS_OFFl %r1,__TI_task(%r9)mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMIDmvc __THREAD_per+__PER_address(4,%r1),__LC_PER_ADDRESSmvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_IDoi __TI_flags+3(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEPtm SP_PSW+1(%r15),0x01 # kernel per event ?bz BASED(kernel_per)l %r3,__LC_PGM_ILC # load program interruption codela %r8,0x7fnr %r8,%r3 # clear per-event-bit and ilcbe BASED(sysc_return) # only per or per+check ?b BASED(pgm_do_call)## it was a single stepped SVC that is causing all the trouble#pgm_svcper:SAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREACREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREA#ifdef CONFIG_VIRT_CPU_ACCOUNTINGUPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMERUPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERmvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER#endiflh %r7,0x8a # get svc number from lowcorel %r9,__LC_THREAD_INFO # load pointer to thread_info structTRACE_IRQS_OFFl %r1,__TI_task(%r9)mvc __THREAD_per+__PER_atmid(2,%r1),__LC_PER_ATMIDmvc __THREAD_per+__PER_address(4,%r1),__LC_PER_ADDRESSmvc __THREAD_per+__PER_access_id(1,%r1),__LC_PER_ACCESS_IDoi __TI_flags+3(%r9),_TIF_SINGLE_STEP # set TIF_SINGLE_STEPTRACE_IRQS_ONstosm __SF_EMPTY(%r15),0x03 # reenable interruptsb BASED(sysc_do_svc)## per was called from kernel, must be kprobes#kernel_per:mvi SP_TRAP+1(%r15),0x28 # set trap indication to pgm checkla %r2,SP_PTREGS(%r15) # address of register-save areal %r1,BASED(.Lhandle_per) # load adr. of per handlerla %r14,BASED(sysc_restore)# load adr. of system returnbr %r1 # branch to do_single_step/** IO interrupt handler routine*/.globl io_int_handlerio_int_handler:STORE_TIMER __LC_ASYNC_ENTER_TIMERstck __LC_INT_CLOCKSAVE_ALL_BASE __LC_SAVE_AREA+16SAVE_ALL_ASYNC __LC_IO_OLD_PSW,__LC_SAVE_AREA+16CREATE_STACK_FRAME __LC_IO_OLD_PSW,__LC_SAVE_AREA+16#ifdef CONFIG_VIRT_CPU_ACCOUNTINGtm SP_PSW+1(%r15),0x01 # interrupting from user ?bz BASED(io_no_vtime)UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMERUPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERmvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMERio_no_vtime:#endifl %r9,__LC_THREAD_INFO # load pointer to thread_info structTRACE_IRQS_OFFl %r1,BASED(.Ldo_IRQ) # load address of do_IRQla %r2,SP_PTREGS(%r15) # address of register-save areabasr %r14,%r1 # branch to standard irq handlerio_return:tm SP_PSW+1(%r15),0x01 # returning to user ?#ifdef CONFIG_PREEMPTbno BASED(io_preempt) # no -> check for preemptive scheduling#elsebno BASED(io_restore) # no-> skip resched & signal#endiftm __TI_flags+3(%r9),_TIF_WORK_INTbnz BASED(io_work) # there is work to do (signals etc.)io_restore:#ifdef CONFIG_TRACE_IRQFLAGSla %r1,BASED(io_restore_trace_psw)lpsw 0(%r1)io_restore_trace:TRACE_IRQS_CHECKLOCKDEP_SYS_EXIT#endifio_leave:RESTORE_ALL __LC_RETURN_PSW,0io_done:#ifdef CONFIG_TRACE_IRQFLAGS.align 8.globl io_restore_trace_pswio_restore_trace_psw:.long 0, io_restore_trace + 0x80000000#endif#ifdef CONFIG_PREEMPTio_preempt:icm %r0,15,__TI_precount(%r9)bnz BASED(io_restore)l %r1,SP_R15(%r15)s %r1,BASED(.Lc_spsize)mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)xc __SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chainlr %r15,%r1io_resume_loop:tm __TI_flags+3(%r9),_TIF_NEED_RESCHEDbno BASED(io_restore)l %r1,BASED(.Lpreempt_schedule_irq)la %r14,BASED(io_resume_loop)br %r1 # call schedule#endif## switch to kernel stack, then check the TIF bits#io_work:l %r1,__LC_KERNEL_STACKs %r1,BASED(.Lc_spsize)mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)xc __SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chainlr %r15,%r1## One of the work bits is on. Find out which one.# Checked are: _TIF_SIGPENDING, _TIF_RESTORE_SIGMASK, _TIF_NEED_RESCHED# and _TIF_MCCK_PENDING#io_work_loop:tm __TI_flags+3(%r9),_TIF_MCCK_PENDINGbo BASED(io_mcck_pending)tm __TI_flags+3(%r9),_TIF_NEED_RESCHEDbo BASED(io_reschedule)tm __TI_flags+3(%r9),(_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK)bnz BASED(io_sigpending)b BASED(io_restore)io_work_done:## _TIF_MCCK_PENDING is set, call handler#io_mcck_pending:l %r1,BASED(.Ls390_handle_mcck)basr %r14,%r1 # TIF bit will be cleared by handlerb BASED(io_work_loop)## _TIF_NEED_RESCHED is set, call schedule#io_reschedule:TRACE_IRQS_ONl %r1,BASED(.Lschedule)stosm __SF_EMPTY(%r15),0x03 # reenable interruptsbasr %r14,%r1 # call schedulerstnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interruptsTRACE_IRQS_OFFtm __TI_flags+3(%r9),_TIF_WORK_INTbz BASED(io_restore) # there is no work to dob BASED(io_work_loop)## _TIF_SIGPENDING or _TIF_RESTORE_SIGMASK is set, call do_signal#io_sigpending:TRACE_IRQS_ONstosm __SF_EMPTY(%r15),0x03 # reenable interruptsla %r2,SP_PTREGS(%r15) # load pt_regsl %r1,BASED(.Ldo_signal)basr %r14,%r1 # call do_signalstnsm __SF_EMPTY(%r15),0xfc # disable I/O and ext. interruptsTRACE_IRQS_OFFb BASED(io_work_loop)/** External interrupt handler routine*/.globl ext_int_handlerext_int_handler:STORE_TIMER __LC_ASYNC_ENTER_TIMERstck __LC_INT_CLOCKSAVE_ALL_BASE __LC_SAVE_AREA+16SAVE_ALL_ASYNC __LC_EXT_OLD_PSW,__LC_SAVE_AREA+16CREATE_STACK_FRAME __LC_EXT_OLD_PSW,__LC_SAVE_AREA+16#ifdef CONFIG_VIRT_CPU_ACCOUNTINGtm SP_PSW+1(%r15),0x01 # interrupting from user ?bz BASED(ext_no_vtime)UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMERUPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERmvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMERext_no_vtime:#endifl %r9,__LC_THREAD_INFO # load pointer to thread_info structTRACE_IRQS_OFFla %r2,SP_PTREGS(%r15) # address of register-save arealh %r3,__LC_EXT_INT_CODE # get interruption codel %r1,BASED(.Ldo_extint)basr %r14,%r1b BASED(io_return)__critical_end:/** Machine check handler routines*/.globl mcck_int_handlermcck_int_handler:spt __LC_CPU_TIMER_SAVE_AREA # revalidate cpu timerlm %r0,%r15,__LC_GPREGS_SAVE_AREA # revalidate gprsSAVE_ALL_BASE __LC_SAVE_AREA+32la %r12,__LC_MCK_OLD_PSWtm __LC_MCCK_CODE,0x80 # system damage?bo BASED(mcck_int_main) # yes -> rest of mcck code invalid#ifdef CONFIG_VIRT_CPU_ACCOUNTINGmvc __LC_SAVE_AREA+52(8),__LC_ASYNC_ENTER_TIMERmvc __LC_ASYNC_ENTER_TIMER(8),__LC_CPU_TIMER_SAVE_AREAtm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?bo BASED(1f)la %r14,__LC_SYNC_ENTER_TIMERclc 0(8,%r14),__LC_ASYNC_ENTER_TIMERbl BASED(0f)la %r14,__LC_ASYNC_ENTER_TIMER0: clc 0(8,%r14),__LC_EXIT_TIMERbl BASED(0f)la %r14,__LC_EXIT_TIMER0: clc 0(8,%r14),__LC_LAST_UPDATE_TIMERbl BASED(0f)la %r14,__LC_LAST_UPDATE_TIMER0: spt 0(%r14)mvc __LC_ASYNC_ENTER_TIMER(8),0(%r14)1:#endiftm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?bno BASED(mcck_int_main) # no -> skip cleanup criticaltm __LC_MCK_OLD_PSW+1,0x01 # test problem state bitbnz BASED(mcck_int_main) # from user -> load async stackclc __LC_MCK_OLD_PSW+4(4),BASED(.Lcritical_end)bhe BASED(mcck_int_main)clc __LC_MCK_OLD_PSW+4(4),BASED(.Lcritical_start)bl BASED(mcck_int_main)l %r14,BASED(.Lcleanup_critical)basr %r14,%r14mcck_int_main:l %r14,__LC_PANIC_STACK # are we already on the panic stack?slr %r14,%r15sra %r14,PAGE_SHIFTbe BASED(0f)l %r15,__LC_PANIC_STACK # load panic stack0: CREATE_STACK_FRAME __LC_MCK_OLD_PSW,__LC_SAVE_AREA+32#ifdef CONFIG_VIRT_CPU_ACCOUNTINGtm __LC_MCCK_CODE+2,0x08 # mwp of old psw valid?bno BASED(mcck_no_vtime) # no -> skip cleanup criticaltm SP_PSW+1(%r15),0x01 # interrupting from user ?bz BASED(mcck_no_vtime)UPDATE_VTIME __LC_EXIT_TIMER,__LC_ASYNC_ENTER_TIMER,__LC_USER_TIMERUPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERmvc __LC_LAST_UPDATE_TIMER(8),__LC_ASYNC_ENTER_TIMERmcck_no_vtime:#endifl %r9,__LC_THREAD_INFO # load pointer to thread_info structla %r2,SP_PTREGS(%r15) # load pt_regsl %r1,BASED(.Ls390_mcck)basr %r14,%r1 # call machine check handlertm SP_PSW+1(%r15),0x01 # returning to user ?bno BASED(mcck_return)l %r1,__LC_KERNEL_STACK # switch to kernel stacks %r1,BASED(.Lc_spsize)mvc SP_PTREGS(__PT_SIZE,%r1),SP_PTREGS(%r15)xc __SF_BACKCHAIN(4,%r1),__SF_BACKCHAIN(%r1) # clear back chainlr %r15,%r1stosm __SF_EMPTY(%r15),0x04 # turn dat ontm __TI_flags+3(%r9),_TIF_MCCK_PENDINGbno BASED(mcck_return)TRACE_IRQS_OFFl %r1,BASED(.Ls390_handle_mcck)basr %r14,%r1 # call machine check handlerTRACE_IRQS_ONmcck_return:mvc __LC_RETURN_MCCK_PSW(8),SP_PSW(%r15) # move return PSWni __LC_RETURN_MCCK_PSW+1,0xfd # clear wait state bit#ifdef CONFIG_VIRT_CPU_ACCOUNTINGmvc __LC_ASYNC_ENTER_TIMER(8),__LC_SAVE_AREA+52tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?bno BASED(0f)lm %r0,%r15,SP_R0(%r15) # load gprs 0-15stpt __LC_EXIT_TIMERlpsw __LC_RETURN_MCCK_PSW # back to caller0:#endiflm %r0,%r15,SP_R0(%r15) # load gprs 0-15lpsw __LC_RETURN_MCCK_PSW # back to callerRESTORE_ALL __LC_RETURN_MCCK_PSW,0/** Restart interruption handler, kick starter for additional CPUs*/#ifdef CONFIG_SMP#ifndef CONFIG_HOTPLUG_CPU.section .init.text,"ax"#endif.globl restart_int_handlerrestart_int_handler:l %r15,__LC_SAVE_AREA+60 # load ksplctl %c0,%c15,__LC_CREGS_SAVE_AREA # get new ctl regslam %a0,%a15,__LC_AREGS_SAVE_AREAlm %r6,%r15,__SF_GPRS(%r15) # load registers from clonestosm __SF_EMPTY(%r15),0x04 # now we can turn dat onbasr %r14,0l %r14,restart_addr-.(%r14)br %r14 # branch to start_secondaryrestart_addr:.long start_secondary#ifndef CONFIG_HOTPLUG_CPU.previous#endif#else/** If we do not run with SMP enabled, let the new CPU crash ...*/.globl restart_int_handlerrestart_int_handler:basr %r1,0restart_base:lpsw restart_crash-restart_base(%r1).align 8restart_crash:.long 0x000a0000,0x00000000restart_go:#endif#ifdef CONFIG_CHECK_STACK/** The synchronous or the asynchronous stack overflowed. We are dead.* No need to properly save the registers, we are going to panic anyway.* Setup a pt_regs so that show_trace can provide a good call trace.*/stack_overflow:l %r15,__LC_PANIC_STACK # change to panic stacksl %r15,BASED(.Lc_spsize)mvc SP_PSW(8,%r15),0(%r12) # move user PSW to stackstm %r0,%r11,SP_R0(%r15) # store gprs %r0-%r11 to kernel stackla %r1,__LC_SAVE_AREAch %r12,BASED(.L0x020) # old psw addr == __LC_SVC_OLD_PSW ?be BASED(0f)ch %r12,BASED(.L0x028) # old psw addr == __LC_PGM_OLD_PSW ?be BASED(0f)la %r1,__LC_SAVE_AREA+160: mvc SP_R12(16,%r15),0(%r1) # move %r12-%r15 to stackxc __SF_BACKCHAIN(4,%r15),__SF_BACKCHAIN(%r15) # clear back chainl %r1,BASED(1f) # branch to kernel_stack_overflowla %r2,SP_PTREGS(%r15) # load pt_regsbr %r11: .long kernel_stack_overflow#endifcleanup_table_system_call:.long system_call + 0x80000000, sysc_do_svc + 0x80000000cleanup_table_sysc_return:.long sysc_return + 0x80000000, sysc_leave + 0x80000000cleanup_table_sysc_leave:.long sysc_leave + 0x80000000, sysc_done + 0x80000000cleanup_table_sysc_work_loop:.long sysc_work_loop + 0x80000000, sysc_work_done + 0x80000000cleanup_table_io_return:.long io_return + 0x80000000, io_leave + 0x80000000cleanup_table_io_leave:.long io_leave + 0x80000000, io_done + 0x80000000cleanup_table_io_work_loop:.long io_work_loop + 0x80000000, io_work_done + 0x80000000cleanup_critical:clc 4(4,%r12),BASED(cleanup_table_system_call)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_system_call+4)bl BASED(cleanup_system_call)0:clc 4(4,%r12),BASED(cleanup_table_sysc_return)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_sysc_return+4)bl BASED(cleanup_sysc_return)0:clc 4(4,%r12),BASED(cleanup_table_sysc_leave)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_sysc_leave+4)bl BASED(cleanup_sysc_leave)0:clc 4(4,%r12),BASED(cleanup_table_sysc_work_loop)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_sysc_work_loop+4)bl BASED(cleanup_sysc_return)0:clc 4(4,%r12),BASED(cleanup_table_io_return)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_io_return+4)bl BASED(cleanup_io_return)0:clc 4(4,%r12),BASED(cleanup_table_io_leave)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_io_leave+4)bl BASED(cleanup_io_leave)0:clc 4(4,%r12),BASED(cleanup_table_io_work_loop)bl BASED(0f)clc 4(4,%r12),BASED(cleanup_table_io_work_loop+4)bl BASED(cleanup_io_return)0:br %r14cleanup_system_call:mvc __LC_RETURN_PSW(8),0(%r12)c %r12,BASED(.Lmck_old_psw)be BASED(0f)la %r12,__LC_SAVE_AREA+16b BASED(1f)0: la %r12,__LC_SAVE_AREA+321:#ifdef CONFIG_VIRT_CPU_ACCOUNTINGclc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+4)bh BASED(0f)mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER0: clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+8)bhe BASED(cleanup_vtime)#endifclc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn)bh BASED(0f)mvc __LC_SAVE_AREA(16),0(%r12)0: st %r13,4(%r12)st %r12,__LC_SAVE_AREA+48 # arghSAVE_ALL_SYNC __LC_SVC_OLD_PSW,__LC_SAVE_AREACREATE_STACK_FRAME __LC_SVC_OLD_PSW,__LC_SAVE_AREAl %r12,__LC_SAVE_AREA+48 # arghst %r15,12(%r12)lh %r7,0x8a#ifdef CONFIG_VIRT_CPU_ACCOUNTINGcleanup_vtime:clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+12)bhe BASED(cleanup_stime)UPDATE_VTIME __LC_EXIT_TIMER,__LC_SYNC_ENTER_TIMER,__LC_USER_TIMERcleanup_stime:clc __LC_RETURN_PSW+4(4),BASED(cleanup_system_call_insn+16)bh BASED(cleanup_update)UPDATE_VTIME __LC_LAST_UPDATE_TIMER,__LC_EXIT_TIMER,__LC_SYSTEM_TIMERcleanup_update:mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER#endifmvc __LC_RETURN_PSW+4(4),BASED(cleanup_table_system_call+4)la %r12,__LC_RETURN_PSWbr %r14cleanup_system_call_insn:.long sysc_saveall + 0x80000000#ifdef CONFIG_VIRT_CPU_ACCOUNTING.long system_call + 0x80000000.long sysc_vtime + 0x80000000.long sysc_stime + 0x80000000.long sysc_update + 0x80000000#endifcleanup_sysc_return:mvc __LC_RETURN_PSW(4),0(%r12)mvc __LC_RETURN_PSW+4(4),BASED(cleanup_table_sysc_return)la %r12,__LC_RETURN_PSWbr %r14cleanup_sysc_leave:clc 4(4,%r12),BASED(cleanup_sysc_leave_insn)be BASED(2f)#ifdef CONFIG_VIRT_CPU_ACCOUNTINGmvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMERclc 4(4,%r12),BASED(cleanup_sysc_leave_insn+4)be BASED(2f)#endifmvc __LC_RETURN_PSW(8),SP_PSW(%r15)c %r12,BASED(.Lmck_old_psw)bne BASED(0f)mvc __LC_SAVE_AREA+32(16),SP_R12(%r15)b BASED(1f)0: mvc __LC_SAVE_AREA+16(16),SP_R12(%r15)1: lm %r0,%r11,SP_R0(%r15)l %r15,SP_R15(%r15)2: la %r12,__LC_RETURN_PSWbr %r14cleanup_sysc_leave_insn:.long sysc_done - 4 + 0x80000000#ifdef CONFIG_VIRT_CPU_ACCOUNTING.long sysc_done - 8 + 0x80000000#endifcleanup_io_return:mvc __LC_RETURN_PSW(4),0(%r12)mvc __LC_RETURN_PSW+4(4),BASED(cleanup_table_io_work_loop)la %r12,__LC_RETURN_PSWbr %r14cleanup_io_leave:clc 4(4,%r12),BASED(cleanup_io_leave_insn)be BASED(2f)#ifdef CONFIG_VIRT_CPU_ACCOUNTINGmvc __LC_EXIT_TIMER(8),__LC_ASYNC_ENTER_TIMERclc 4(4,%r12),BASED(cleanup_io_leave_insn+4)be BASED(2f)#endifmvc __LC_RETURN_PSW(8),SP_PSW(%r15)c %r12,BASED(.Lmck_old_psw)bne BASED(0f)mvc __LC_SAVE_AREA+32(16),SP_R12(%r15)b BASED(1f)0: mvc __LC_SAVE_AREA+16(16),SP_R12(%r15)1: lm %r0,%r11,SP_R0(%r15)l %r15,SP_R15(%r15)2: la %r12,__LC_RETURN_PSWbr %r14cleanup_io_leave_insn:.long io_done - 4 + 0x80000000#ifdef CONFIG_VIRT_CPU_ACCOUNTING.long io_done - 8 + 0x80000000#endif/** Integer constants*/.align 4.Lc_spsize: .long SP_SIZE.Lc_overhead: .long STACK_FRAME_OVERHEAD.Lnr_syscalls: .long NR_syscalls.L0x018: .short 0x018.L0x020: .short 0x020.L0x028: .short 0x028.L0x030: .short 0x030.L0x038: .short 0x038.Lc_1: .long 1/** Symbol constants*/.Ls390_mcck: .long s390_do_machine_check.Ls390_handle_mcck:.long s390_handle_mcck.Lmck_old_psw: .long __LC_MCK_OLD_PSW.Ldo_IRQ: .long do_IRQ.Ldo_extint: .long do_extint.Ldo_signal: .long do_signal.Lhandle_per: .long do_single_step.Ldo_execve: .long do_execve.Lexecve_tail: .long execve_tail.Ljump_table: .long pgm_check_table.Lschedule: .long schedule#ifdef CONFIG_PREEMPT.Lpreempt_schedule_irq:.long preempt_schedule_irq#endif.Ltrace: .long syscall_trace.Lschedtail: .long schedule_tail.Lsysc_table: .long sys_call_table#ifdef CONFIG_TRACE_IRQFLAGS.Ltrace_irq_on: .long trace_hardirqs_on.Ltrace_irq_off:.long trace_hardirqs_off.Llockdep_sys_exit:.long lockdep_sys_exit#endif.Lcritical_start:.long __critical_start + 0x80000000.Lcritical_end:.long __critical_end + 0x80000000.Lcleanup_critical:.long cleanup_critical.section .rodata, "a"#define SYSCALL(esa,esame,emu) .long esasys_call_table:#include "syscalls.S"#undef SYSCALL
