2005-04-17 06:20:36 +08:00
|
|
|
/*
|
2006-02-01 19:06:38 +08:00
|
|
|
* arch/s390/kernel/entry64.S
|
2005-04-17 06:20:36 +08:00
|
|
|
* S390 low-level entry points.
|
|
|
|
*
|
2012-03-11 23:59:26 +08:00
|
|
|
* Copyright (C) IBM Corp. 1999,2012
|
2005-04-17 06:20:36 +08:00
|
|
|
* Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
|
2006-09-28 22:56:37 +08:00
|
|
|
* Hartmut Penner (hp@de.ibm.com),
|
|
|
|
* Denis Joseph Barrow (djbarrow@de.ibm.com,barrow_dj@yahoo.com),
|
2005-06-26 05:55:30 +08:00
|
|
|
* Heiko Carstens <heiko.carstens@de.ibm.com>
|
2005-04-17 06:20:36 +08:00
|
|
|
*/
|
|
|
|
|
2008-02-05 23:50:40 +08:00
|
|
|
#include <linux/init.h>
|
2011-07-24 16:48:19 +08:00
|
|
|
#include <linux/linkage.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <asm/cache.h>
|
|
|
|
#include <asm/errno.h>
|
|
|
|
#include <asm/ptrace.h>
|
|
|
|
#include <asm/thread_info.h>
|
2005-09-10 02:57:26 +08:00
|
|
|
#include <asm/asm-offsets.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <asm/unistd.h>
|
|
|
|
#include <asm/page.h>
|
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
__PT_R0 = __PT_GPRS
|
|
|
|
__PT_R1 = __PT_GPRS + 8
|
|
|
|
__PT_R2 = __PT_GPRS + 16
|
|
|
|
__PT_R3 = __PT_GPRS + 24
|
|
|
|
__PT_R4 = __PT_GPRS + 32
|
|
|
|
__PT_R5 = __PT_GPRS + 40
|
|
|
|
__PT_R6 = __PT_GPRS + 48
|
|
|
|
__PT_R7 = __PT_GPRS + 56
|
|
|
|
__PT_R8 = __PT_GPRS + 64
|
|
|
|
__PT_R9 = __PT_GPRS + 72
|
|
|
|
__PT_R10 = __PT_GPRS + 80
|
|
|
|
__PT_R11 = __PT_GPRS + 88
|
|
|
|
__PT_R12 = __PT_GPRS + 96
|
|
|
|
__PT_R13 = __PT_GPRS + 104
|
|
|
|
__PT_R14 = __PT_GPRS + 112
|
|
|
|
__PT_R15 = __PT_GPRS + 120
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
STACK_SHIFT = PAGE_SHIFT + THREAD_ORDER
|
|
|
|
STACK_SIZE = 1 << STACK_SHIFT
|
|
|
|
|
2008-10-11 03:33:20 +08:00
|
|
|
_TIF_WORK_SVC = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
|
2011-10-30 22:16:49 +08:00
|
|
|
_TIF_MCCK_PENDING | _TIF_PER_TRAP )
|
2008-10-11 03:33:20 +08:00
|
|
|
_TIF_WORK_INT = (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED | \
|
2006-02-01 19:06:38 +08:00
|
|
|
_TIF_MCCK_PENDING)
|
2011-10-30 22:16:49 +08:00
|
|
|
_TIF_TRACE = (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_AUDIT | _TIF_SECCOMP | \
|
|
|
|
_TIF_SYSCALL_TRACEPOINT)
|
2011-07-24 16:48:18 +08:00
|
|
|
_TIF_EXIT_SIE = (_TIF_SIGPENDING | _TIF_NEED_RESCHED | _TIF_MCCK_PENDING)
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#define BASED(name) name-system_call(%r13)
|
|
|
|
|
2006-07-03 15:24:46 +08:00
|
|
|
.macro TRACE_IRQS_ON
|
2011-12-27 18:27:15 +08:00
|
|
|
#ifdef CONFIG_TRACE_IRQFLAGS
|
2010-05-17 16:00:02 +08:00
|
|
|
basr %r2,%r0
|
|
|
|
brasl %r14,trace_hardirqs_on_caller
|
2011-12-27 18:27:15 +08:00
|
|
|
#endif
|
2006-07-03 15:24:46 +08:00
|
|
|
.endm
|
|
|
|
|
|
|
|
.macro TRACE_IRQS_OFF
|
2011-12-27 18:27:15 +08:00
|
|
|
#ifdef CONFIG_TRACE_IRQFLAGS
|
2010-05-17 16:00:02 +08:00
|
|
|
basr %r2,%r0
|
|
|
|
brasl %r14,trace_hardirqs_off_caller
|
2007-11-20 18:13:32 +08:00
|
|
|
#endif
|
2011-12-27 18:27:15 +08:00
|
|
|
.endm
|
2007-11-20 18:13:32 +08:00
|
|
|
|
|
|
|
.macro LOCKDEP_SYS_EXIT
|
2011-12-27 18:27:15 +08:00
|
|
|
#ifdef CONFIG_LOCKDEP
|
|
|
|
tm __PT_PSW+1(%r11),0x01 # returning to user ?
|
|
|
|
jz .+10
|
2007-11-20 18:13:32 +08:00
|
|
|
brasl %r14,lockdep_sys_exit
|
2006-07-03 15:24:46 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
.endm
|
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.macro SPP newpp
|
|
|
|
#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
|
|
|
|
tm __LC_MACHINE_FLAGS+6,0x20 # MACHINE_FLAG_SPP
|
|
|
|
jz .+8
|
|
|
|
.insn s,0xb2800000,\newpp
|
|
|
|
#endif
|
|
|
|
.endm
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.macro HANDLE_SIE_INTERCEPT scratch
|
|
|
|
#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
|
2012-05-09 22:27:36 +08:00
|
|
|
tmhh %r8,0x0001 # interrupting from user ?
|
|
|
|
jnz .+42
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr \scratch,%r9
|
|
|
|
slg \scratch,BASED(.Lsie_loop)
|
|
|
|
clg \scratch,BASED(.Lsie_length)
|
2012-05-09 22:27:36 +08:00
|
|
|
jhe .+22
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r9,BASED(.Lsie_loop)
|
2012-05-14 16:09:43 +08:00
|
|
|
SPP BASED(.Lhost_id) # set host id
|
2011-12-27 18:27:15 +08:00
|
|
|
#endif
|
2007-07-10 17:24:18 +08:00
|
|
|
.endm
|
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.macro CHECK_STACK stacksize,savearea
|
2006-06-29 20:58:05 +08:00
|
|
|
#ifdef CONFIG_CHECK_STACK
|
2011-12-27 18:27:15 +08:00
|
|
|
tml %r15,\stacksize - CONFIG_STACK_GUARD
|
|
|
|
lghi %r14,\savearea
|
|
|
|
jz stack_overflow
|
2006-06-29 20:58:05 +08:00
|
|
|
#endif
|
|
|
|
.endm
|
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.macro SWITCH_ASYNC savearea,stack,shift
|
|
|
|
tmhh %r8,0x0001 # interrupting from user ?
|
|
|
|
jnz 1f
|
|
|
|
lgr %r14,%r9
|
|
|
|
slg %r14,BASED(.Lcritical_start)
|
|
|
|
clg %r14,BASED(.Lcritical_length)
|
2005-04-17 06:20:36 +08:00
|
|
|
jhe 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
lghi %r11,\savearea # inside critical section, do cleanup
|
2005-04-17 06:20:36 +08:00
|
|
|
brasl %r14,cleanup_critical
|
2011-12-27 18:27:15 +08:00
|
|
|
tmhh %r8,0x0001 # retest problem state after cleanup
|
2005-04-17 06:20:36 +08:00
|
|
|
jnz 1f
|
2011-12-27 18:27:15 +08:00
|
|
|
0: lg %r14,\stack # are we already on the target stack?
|
2005-04-17 06:20:36 +08:00
|
|
|
slgr %r14,%r15
|
2011-12-27 18:27:15 +08:00
|
|
|
srag %r14,%r14,\shift
|
2010-05-17 16:00:05 +08:00
|
|
|
jnz 1f
|
2011-12-27 18:27:15 +08:00
|
|
|
CHECK_STACK 1<<\shift,\savearea
|
|
|
|
j 2f
|
|
|
|
1: lg %r15,\stack # load target stack
|
|
|
|
2: aghi %r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r15)
|
2006-09-28 22:56:37 +08:00
|
|
|
.endm
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.macro UPDATE_VTIME scratch,enter_timer
|
|
|
|
lg \scratch,__LC_EXIT_TIMER
|
|
|
|
slg \scratch,\enter_timer
|
|
|
|
alg \scratch,__LC_USER_TIMER
|
|
|
|
stg \scratch,__LC_USER_TIMER
|
|
|
|
lg \scratch,__LC_LAST_UPDATE_TIMER
|
|
|
|
slg \scratch,__LC_EXIT_TIMER
|
|
|
|
alg \scratch,__LC_SYSTEM_TIMER
|
|
|
|
stg \scratch,__LC_SYSTEM_TIMER
|
|
|
|
mvc __LC_LAST_UPDATE_TIMER(8),\enter_timer
|
2005-04-17 06:20:36 +08:00
|
|
|
.endm
|
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.macro LAST_BREAK scratch
|
|
|
|
srag \scratch,%r10,23
|
|
|
|
jz .+10
|
|
|
|
stg %r10,__TI_last_break(%r12)
|
2010-05-17 16:00:05 +08:00
|
|
|
.endm
|
|
|
|
|
2010-10-25 22:10:37 +08:00
|
|
|
.macro REENABLE_IRQS
|
2011-12-27 18:27:15 +08:00
|
|
|
stg %r8,__LC_RETURN_PSW
|
|
|
|
ni __LC_RETURN_PSW,0xbf
|
|
|
|
ssm __LC_RETURN_PSW
|
2010-10-25 22:10:37 +08:00
|
|
|
.endm
|
|
|
|
|
2012-05-09 22:27:39 +08:00
|
|
|
.macro STCK savearea
|
2012-05-14 16:35:22 +08:00
|
|
|
#ifdef CONFIG_HAVE_MARCH_Z9_109_FEATURES
|
2012-05-09 22:27:39 +08:00
|
|
|
.insn s,0xb27c0000,\savearea # store clock fast
|
|
|
|
#else
|
|
|
|
.insn s,0xb2050000,\savearea # store clock
|
|
|
|
#endif
|
|
|
|
.endm
|
|
|
|
|
2011-01-05 19:47:25 +08:00
|
|
|
.section .kprobes.text, "ax"
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Scheduler resume function, called by switch_to
|
|
|
|
* gpr2 = (task_struct *) prev
|
|
|
|
* gpr3 = (task_struct *) next
|
|
|
|
* Returns:
|
|
|
|
* gpr2 = prev
|
|
|
|
*/
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(__switch_to)
|
2012-05-15 15:20:06 +08:00
|
|
|
stmg %r6,%r15,__SF_GPRS(%r15) # store gprs of prev task
|
|
|
|
stg %r15,__THREAD_ksp(%r2) # store kernel stack of prev
|
2011-01-05 19:48:10 +08:00
|
|
|
lg %r4,__THREAD_info(%r2) # get thread_info of prev
|
|
|
|
lg %r5,__THREAD_info(%r3) # get thread_info of next
|
2012-05-15 15:20:06 +08:00
|
|
|
lgr %r15,%r5
|
|
|
|
aghi %r15,STACK_SIZE # end of kernel stack of next
|
|
|
|
stg %r3,__LC_CURRENT # store task struct of next
|
|
|
|
stg %r5,__LC_THREAD_INFO # store thread info of next
|
|
|
|
stg %r15,__LC_KERNEL_STACK # store end of kernel stack
|
|
|
|
lctl %c4,%c4,__TASK_pid(%r3) # load pid to control reg. 4
|
|
|
|
mvc __LC_CURRENT_PID+4(4,%r0),__TASK_pid(%r3) # store pid of next
|
|
|
|
lg %r15,__THREAD_ksp(%r3) # load kernel stack of next
|
2005-06-26 05:55:30 +08:00
|
|
|
tm __TI_flags+7(%r4),_TIF_MCCK_PENDING # machine check pending?
|
2011-01-05 19:48:10 +08:00
|
|
|
jz 0f
|
|
|
|
ni __TI_flags+7(%r4),255-_TIF_MCCK_PENDING # clear flag in prev
|
|
|
|
oi __TI_flags+7(%r5),_TIF_MCCK_PENDING # set it in next
|
2012-05-15 15:20:06 +08:00
|
|
|
0: lmg %r6,%r15,__SF_GPRS(%r15) # load gprs of next task
|
2005-04-17 06:20:36 +08:00
|
|
|
br %r14
|
|
|
|
|
|
|
|
__critical_start:
|
|
|
|
/*
|
|
|
|
* SVC interrupt handler routine. System calls are synchronous events and
|
|
|
|
* are executed with interrupts enabled.
|
|
|
|
*/
|
|
|
|
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(system_call)
|
2008-12-25 20:39:25 +08:00
|
|
|
stpt __LC_SYNC_ENTER_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
sysc_stmg:
|
|
|
|
stmg %r8,%r15,__LC_SAVE_AREA_SYNC
|
|
|
|
lg %r10,__LC_LAST_BREAK
|
|
|
|
lg %r12,__LC_THREAD_INFO
|
|
|
|
larl %r13,system_call
|
|
|
|
sysc_per:
|
|
|
|
lg %r15,__LC_KERNEL_STACK
|
|
|
|
aghi %r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r15) # pointer to pt_regs
|
2005-04-17 06:20:36 +08:00
|
|
|
sysc_vtime:
|
2011-12-27 18:27:15 +08:00
|
|
|
UPDATE_VTIME %r13,__LC_SYNC_ENTER_TIMER
|
|
|
|
LAST_BREAK %r13
|
|
|
|
stmg %r0,%r7,__PT_R0(%r11)
|
|
|
|
mvc __PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
|
|
|
|
mvc __PT_PSW(16,%r11),__LC_SVC_OLD_PSW
|
2011-12-27 18:27:18 +08:00
|
|
|
mvc __PT_INT_CODE(4,%r11),__LC_SVC_ILC
|
2005-04-17 06:20:36 +08:00
|
|
|
sysc_do_svc:
|
2011-12-27 18:27:15 +08:00
|
|
|
oi __TI_flags+7(%r12),_TIF_SYSCALL
|
2011-12-27 18:27:18 +08:00
|
|
|
llgh %r8,__PT_INT_CODE+2(%r11)
|
2011-12-27 18:27:15 +08:00
|
|
|
slag %r8,%r8,2 # shift and test for svc 0
|
2005-04-17 06:20:36 +08:00
|
|
|
jnz sysc_nr_ok
|
|
|
|
# svc 0: system call number in %r1
|
2011-12-27 18:27:15 +08:00
|
|
|
llgfr %r1,%r1 # clear high word in r1
|
2010-05-17 16:00:05 +08:00
|
|
|
cghi %r1,NR_syscalls
|
2005-04-17 06:20:36 +08:00
|
|
|
jnl sysc_nr_ok
|
2011-12-27 18:27:18 +08:00
|
|
|
sth %r1,__PT_INT_CODE+2(%r11)
|
2011-12-27 18:27:15 +08:00
|
|
|
slag %r8,%r1,2
|
2005-04-17 06:20:36 +08:00
|
|
|
sysc_nr_ok:
|
2011-12-27 18:27:15 +08:00
|
|
|
larl %r10,sys_call_table # 64 bit system call table
|
2006-01-06 16:19:28 +08:00
|
|
|
#ifdef CONFIG_COMPAT
|
2011-12-27 18:27:15 +08:00
|
|
|
tm __TI_flags+5(%r12),(_TIF_31BIT>>16)
|
2005-09-04 06:58:04 +08:00
|
|
|
jno sysc_noemu
|
2011-12-27 18:27:15 +08:00
|
|
|
larl %r10,sys_call_table_emu # 31 bit system call table
|
2005-04-17 06:20:36 +08:00
|
|
|
sysc_noemu:
|
|
|
|
#endif
|
2011-12-27 18:27:15 +08:00
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
|
|
|
stg %r2,__PT_ORIG_GPR2(%r11)
|
|
|
|
stg %r7,STACK_FRAME_OVERHEAD(%r15)
|
|
|
|
lgf %r9,0(%r8,%r10) # get system call add.
|
2011-10-30 22:16:49 +08:00
|
|
|
tm __TI_flags+6(%r12),_TIF_TRACE >> 8
|
2006-09-28 22:56:37 +08:00
|
|
|
jnz sysc_tracesys
|
2011-12-27 18:27:15 +08:00
|
|
|
basr %r14,%r9 # call sys_xxxx
|
|
|
|
stg %r2,__PT_R2(%r11) # store return value
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
sysc_return:
|
2010-05-17 16:00:02 +08:00
|
|
|
LOCKDEP_SYS_EXIT
|
|
|
|
sysc_tif:
|
2011-12-27 18:27:15 +08:00
|
|
|
tm __PT_PSW+1(%r11),0x01 # returning to user ?
|
2011-10-30 22:16:49 +08:00
|
|
|
jno sysc_restore
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_WORK_SVC
|
2011-12-27 18:27:15 +08:00
|
|
|
jnz sysc_work # check for work
|
2011-10-30 22:16:49 +08:00
|
|
|
ni __TI_flags+7(%r12),255-_TIF_SYSCALL
|
2007-11-20 18:13:32 +08:00
|
|
|
sysc_restore:
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r14,__LC_VDSO_PER_CPU
|
|
|
|
lmg %r0,%r10,__PT_R0(%r11)
|
|
|
|
mvc __LC_RETURN_PSW(16),__PT_PSW(%r11)
|
|
|
|
stpt __LC_EXIT_TIMER
|
|
|
|
mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
|
|
|
|
lmg %r11,%r15,__PT_R11(%r11)
|
|
|
|
lpswe __LC_RETURN_PSW
|
2007-11-20 18:13:32 +08:00
|
|
|
sysc_done:
|
|
|
|
|
2010-05-17 16:00:01 +08:00
|
|
|
#
|
|
|
|
# One of the work bits is on. Find out which one.
|
|
|
|
#
|
2011-10-30 22:16:49 +08:00
|
|
|
sysc_work:
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
|
2005-06-26 05:55:30 +08:00
|
|
|
jo sysc_mcck_pending
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
|
2005-04-17 06:20:36 +08:00
|
|
|
jo sysc_reschedule
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_SIGPENDING
|
2010-05-17 16:00:01 +08:00
|
|
|
jo sysc_sigpending
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
|
2010-05-17 16:00:01 +08:00
|
|
|
jo sysc_notify_resume
|
2011-01-05 19:48:10 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_PER_TRAP
|
2005-04-17 06:20:36 +08:00
|
|
|
jo sysc_singlestep
|
2010-05-17 16:00:01 +08:00
|
|
|
j sysc_return # beware of critical section cleanup
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#
|
|
|
|
# _TIF_NEED_RESCHED is set, call schedule
|
2006-09-28 22:56:37 +08:00
|
|
|
#
|
|
|
|
sysc_reschedule:
|
2010-05-17 16:00:02 +08:00
|
|
|
larl %r14,sysc_return
|
2011-12-27 18:27:15 +08:00
|
|
|
jg schedule
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2005-06-26 05:55:30 +08:00
|
|
|
#
|
|
|
|
# _TIF_MCCK_PENDING is set, call handler
|
|
|
|
#
|
|
|
|
sysc_mcck_pending:
|
2010-05-17 16:00:02 +08:00
|
|
|
larl %r14,sysc_return
|
2006-09-28 22:56:37 +08:00
|
|
|
jg s390_handle_mcck # TIF bit will be cleared by handler
|
2005-06-26 05:55:30 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2008-04-30 15:53:08 +08:00
|
|
|
# _TIF_SIGPENDING is set, call do_signal
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2006-09-28 22:56:37 +08:00
|
|
|
sysc_sigpending:
|
2011-01-05 19:48:10 +08:00
|
|
|
ni __TI_flags+7(%r12),255-_TIF_PER_TRAP # clear TIF_PER_TRAP
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
brasl %r14,do_signal
|
2011-10-30 22:16:49 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_SYSCALL
|
|
|
|
jno sysc_return
|
2011-12-27 18:27:15 +08:00
|
|
|
lmg %r2,%r7,__PT_R2(%r11) # load svc arguments
|
|
|
|
lghi %r8,0 # svc 0 returns -ENOSYS
|
2011-12-27 18:27:18 +08:00
|
|
|
lh %r1,__PT_INT_CODE+2(%r11) # load new svc number
|
2011-10-30 22:16:49 +08:00
|
|
|
cghi %r1,NR_syscalls
|
|
|
|
jnl sysc_nr_ok # invalid svc number -> do svc 0
|
2011-12-27 18:27:15 +08:00
|
|
|
slag %r8,%r1,2
|
2011-10-30 22:16:49 +08:00
|
|
|
j sysc_nr_ok # restart svc
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-10-11 03:33:20 +08:00
|
|
|
#
|
|
|
|
# _TIF_NOTIFY_RESUME is set, call do_notify_resume
|
|
|
|
#
|
|
|
|
sysc_notify_resume:
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
2010-05-17 16:00:02 +08:00
|
|
|
larl %r14,sysc_return
|
2011-12-27 18:27:15 +08:00
|
|
|
jg do_notify_resume
|
2008-10-11 03:33:20 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2011-01-05 19:48:10 +08:00
|
|
|
# _TIF_PER_TRAP is set, call do_per_trap
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
|
|
|
sysc_singlestep:
|
2011-10-30 22:16:49 +08:00
|
|
|
ni __TI_flags+7(%r12),255-(_TIF_SYSCALL | _TIF_PER_TRAP)
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
larl %r14,sysc_return
|
2011-01-05 19:48:10 +08:00
|
|
|
jg do_per_trap
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#
|
2008-10-11 03:33:20 +08:00
|
|
|
# call tracehook_report_syscall_entry/tracehook_report_syscall_exit before
|
|
|
|
# and after the system call
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
|
|
|
sysc_tracesys:
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
2005-04-17 06:20:36 +08:00
|
|
|
la %r3,0
|
2011-12-27 18:27:18 +08:00
|
|
|
llgh %r0,__PT_INT_CODE+2(%r11)
|
2011-12-27 18:27:15 +08:00
|
|
|
stg %r0,__PT_R2(%r11)
|
2008-10-11 03:33:20 +08:00
|
|
|
brasl %r14,do_syscall_trace_enter
|
2005-04-17 06:20:36 +08:00
|
|
|
lghi %r0,NR_syscalls
|
2008-10-11 03:33:20 +08:00
|
|
|
clgr %r0,%r2
|
2005-04-17 06:20:36 +08:00
|
|
|
jnh sysc_tracenogo
|
2011-12-27 18:27:15 +08:00
|
|
|
sllg %r8,%r2,2
|
|
|
|
lgf %r9,0(%r8,%r10)
|
2005-04-17 06:20:36 +08:00
|
|
|
sysc_tracego:
|
2011-12-27 18:27:15 +08:00
|
|
|
lmg %r3,%r7,__PT_R3(%r11)
|
|
|
|
stg %r7,STACK_FRAME_OVERHEAD(%r15)
|
|
|
|
lg %r2,__PT_ORIG_GPR2(%r11)
|
|
|
|
basr %r14,%r9 # call sys_xxx
|
|
|
|
stg %r2,__PT_R2(%r11) # store return value
|
2005-04-17 06:20:36 +08:00
|
|
|
sysc_tracenogo:
|
2011-10-30 22:16:49 +08:00
|
|
|
tm __TI_flags+6(%r12),_TIF_TRACE >> 8
|
2006-09-28 22:56:37 +08:00
|
|
|
jz sysc_return
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
larl %r14,sysc_return
|
2008-10-11 03:33:20 +08:00
|
|
|
jg do_syscall_trace_exit
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#
|
|
|
|
# a new process exits the kernel with ret_from_fork
|
|
|
|
#
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(ret_from_fork)
|
2011-12-27 18:27:15 +08:00
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r15)
|
|
|
|
lg %r12,__LC_THREAD_INFO
|
|
|
|
tm __PT_PSW+1(%r11),0x01 # forking a kernel thread ?
|
2005-04-17 06:20:36 +08:00
|
|
|
jo 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
stg %r15,__PT_R15(%r11) # store stack pointer for new kthread
|
2006-09-28 22:56:37 +08:00
|
|
|
0: brasl %r14,schedule_tail
|
2006-07-03 15:24:46 +08:00
|
|
|
TRACE_IRQS_ON
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_SVC_NEW_PSW # reenable interrupts
|
[S390] audit: get s390 ret_from_fork in sync with other architectures
On s390 we have ret_from_fork jump not to the "do all work we
normally do on return from syscall" as on x86, ppc, etc., but to the
"do all such work except audit". Historical reasons - the codepath
triggered when we have AUDIT process flag set is separated from the
normall one and they converge at sysc_return, which is the common
part of post-syscall work. And does not include calling audit_syscall_exit() -
that's done in the end of sysc_tracesys path, just before that path jumps
to sysc_return.
IOW, the child returning from fork()/clone()/vfork() doesn't
call audit_syscall_exit() at all, so no matter what we do with its
audit context, we are not going to see the audit entry.
The fix is simple: have ret_from_fork go to the point just past
the call of sys_.... in the 'we have AUDIT flag set' path. There we
have (64bit variant; for 31bit the situation is the same):
sysc_tracenogo:
tm __TI_flags+7(%r9),(_TIF_SYSCALL_TRACE|_TIF_SYSCALL_AUDIT)
jz sysc_return
la %r2,SP_PTREGS(%r15) # load pt_regs
larl %r14,sysc_return # return point is sysc_return
jg do_syscall_trace_exit
which is precisely what we need - check the flag, bugger off to sysc_return
if not set, otherwise call do_syscall_trace_exit() and bugger off to
sysc_return. r9 has just been properly set by ret_from_fork itself,
so we are fine.
Tested on s390x, seems to work fine. WARNING: it's been about
16 years since my last contact with 3X0 assembler[1], so additional
review would be very welcome. I don't think I've managed to screw it
up, but...
[1] that *was* in another country and besides, the box is dead...
Signed-off-by: Al Viro <viro@zeniv.linux.org.uk>
Signed-off-by: Heiko Carstens <heiko.carstens@de.ibm.com>
Signed-off-by: Martin Schwidefsky <schwidefsky@de.ibm.com>
2008-12-25 20:37:58 +08:00
|
|
|
j sysc_tracenogo
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#
|
2007-04-27 22:01:40 +08:00
|
|
|
# kernel_execve function needs to deal with pt_regs that is not
|
|
|
|
# at the usual place
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(kernel_execve)
|
2007-04-27 22:01:40 +08:00
|
|
|
stmg %r12,%r15,96(%r15)
|
|
|
|
lgr %r14,%r15
|
2011-12-27 18:27:15 +08:00
|
|
|
aghi %r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
2007-04-27 22:01:40 +08:00
|
|
|
stg %r14,__SF_BACKCHAIN(%r15)
|
2011-12-27 18:27:15 +08:00
|
|
|
la %r12,STACK_FRAME_OVERHEAD(%r15)
|
2007-04-27 22:01:40 +08:00
|
|
|
xc 0(__PT_SIZE,%r12),0(%r12)
|
|
|
|
lgr %r5,%r12
|
|
|
|
brasl %r14,do_execve
|
|
|
|
ltgfr %r2,%r2
|
|
|
|
je 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
aghi %r15,(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
2007-04-27 22:01:40 +08:00
|
|
|
lmg %r12,%r15,96(%r15)
|
|
|
|
br %r14
|
|
|
|
# execve succeeded.
|
2011-12-27 18:27:15 +08:00
|
|
|
0: ssm __LC_PGM_NEW_PSW # disable I/O and ext. interrupts
|
2007-04-27 22:01:40 +08:00
|
|
|
lg %r15,__LC_KERNEL_STACK # load ksp
|
2011-12-27 18:27:15 +08:00
|
|
|
aghi %r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r15)
|
|
|
|
mvc 0(__PT_SIZE,%r11),0(%r12) # copy pt_regs
|
2010-05-17 16:00:05 +08:00
|
|
|
lg %r12,__LC_THREAD_INFO
|
2007-04-27 22:01:40 +08:00
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_SVC_NEW_PSW # reenable interrupts
|
2007-04-27 22:01:40 +08:00
|
|
|
brasl %r14,execve_tail
|
|
|
|
j sysc_return
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Program check handler routine
|
|
|
|
*/
|
|
|
|
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(pgm_check_handler)
|
2008-12-25 20:39:25 +08:00
|
|
|
stpt __LC_SYNC_ENTER_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
stmg %r8,%r15,__LC_SAVE_AREA_SYNC
|
|
|
|
lg %r10,__LC_LAST_BREAK
|
|
|
|
lg %r12,__LC_THREAD_INFO
|
|
|
|
larl %r13,system_call
|
|
|
|
lmg %r8,%r9,__LC_PGM_OLD_PSW
|
|
|
|
HANDLE_SIE_INTERCEPT %r14
|
|
|
|
tmhh %r8,0x0001 # test problem state bit
|
|
|
|
jnz 1f # -> fault in user space
|
|
|
|
tmhh %r8,0x4000 # PER bit set in old PSW ?
|
|
|
|
jnz 0f # -> enabled, can't be a double fault
|
|
|
|
tm __LC_PGM_ILC+3,0x80 # check for per exception
|
|
|
|
jnz pgm_svcper # -> single stepped svc
|
|
|
|
0: CHECK_STACK STACK_SIZE,__LC_SAVE_AREA_SYNC
|
|
|
|
j 2f
|
|
|
|
1: UPDATE_VTIME %r14,__LC_SYNC_ENTER_TIMER
|
|
|
|
LAST_BREAK %r14
|
|
|
|
lg %r15,__LC_KERNEL_STACK
|
|
|
|
2: aghi %r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r15)
|
|
|
|
stmg %r0,%r7,__PT_R0(%r11)
|
|
|
|
mvc __PT_R8(64,%r11),__LC_SAVE_AREA_SYNC
|
|
|
|
stmg %r8,%r9,__PT_PSW(%r11)
|
2011-12-27 18:27:18 +08:00
|
|
|
mvc __PT_INT_CODE(4,%r11),__LC_PGM_ILC
|
|
|
|
mvc __PT_INT_PARM_LONG(8,%r11),__LC_TRANS_EXC_CODE
|
2011-12-27 18:27:15 +08:00
|
|
|
stg %r10,__PT_ARGS(%r11)
|
|
|
|
tm __LC_PGM_ILC+3,0x80 # check for per exception
|
|
|
|
jz 0f
|
2010-05-17 16:00:05 +08:00
|
|
|
lg %r1,__TI_task(%r12)
|
2011-12-27 18:27:15 +08:00
|
|
|
tmhh %r8,0x0001 # kernel per event ?
|
|
|
|
jz pgm_kprobe
|
|
|
|
oi __TI_flags+7(%r12),_TIF_PER_TRAP
|
2011-01-05 19:48:10 +08:00
|
|
|
mvc __THREAD_per_address(8,%r1),__LC_PER_ADDRESS
|
2011-12-27 18:27:15 +08:00
|
|
|
mvc __THREAD_per_cause(2,%r1),__LC_PER_CAUSE
|
2011-01-05 19:48:10 +08:00
|
|
|
mvc __THREAD_per_paid(1,%r1),__LC_PER_PAID
|
2011-12-27 18:27:18 +08:00
|
|
|
0: REENABLE_IRQS
|
2011-12-27 18:27:15 +08:00
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
2010-07-28 01:29:37 +08:00
|
|
|
larl %r1,pgm_check_table
|
2011-12-27 18:27:18 +08:00
|
|
|
llgh %r10,__PT_INT_CODE+2(%r11)
|
|
|
|
nill %r10,0x007f
|
|
|
|
sll %r10,3
|
|
|
|
je sysc_return
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r1,0(%r10,%r1) # load address of handler routine
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
2010-07-28 01:29:37 +08:00
|
|
|
basr %r14,%r1 # branch to interrupt-handler
|
|
|
|
j sysc_return
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#
|
2011-12-27 18:27:15 +08:00
|
|
|
# PER event in supervisor state, must be kprobes
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2011-12-27 18:27:15 +08:00
|
|
|
pgm_kprobe:
|
|
|
|
REENABLE_IRQS
|
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
brasl %r14,do_per_trap
|
|
|
|
j sysc_return
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2006-09-20 21:58:39 +08:00
|
|
|
#
|
2011-12-27 18:27:15 +08:00
|
|
|
# single stepped system call
|
2006-09-20 21:58:39 +08:00
|
|
|
#
|
2011-12-27 18:27:15 +08:00
|
|
|
pgm_svcper:
|
|
|
|
oi __TI_flags+7(%r12),_TIF_PER_TRAP
|
|
|
|
mvc __LC_RETURN_PSW(8),__LC_SVC_NEW_PSW
|
|
|
|
larl %r14,sysc_per
|
|
|
|
stg %r14,__LC_RETURN_PSW+8
|
|
|
|
lpswe __LC_RETURN_PSW # branch to sysc_per and enable irqs
|
2006-09-20 21:58:39 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* IO interrupt handler routine
|
|
|
|
*/
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(io_int_handler)
|
2012-05-09 22:27:39 +08:00
|
|
|
STCK __LC_INT_CLOCK
|
2008-12-31 22:11:41 +08:00
|
|
|
stpt __LC_ASYNC_ENTER_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
stmg %r8,%r15,__LC_SAVE_AREA_ASYNC
|
|
|
|
lg %r10,__LC_LAST_BREAK
|
|
|
|
lg %r12,__LC_THREAD_INFO
|
|
|
|
larl %r13,system_call
|
|
|
|
lmg %r8,%r9,__LC_IO_OLD_PSW
|
|
|
|
HANDLE_SIE_INTERCEPT %r14
|
|
|
|
SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_STACK,STACK_SHIFT
|
|
|
|
tmhh %r8,0x0001 # interrupting from user?
|
|
|
|
jz io_skip
|
|
|
|
UPDATE_VTIME %r14,__LC_ASYNC_ENTER_TIMER
|
|
|
|
LAST_BREAK %r14
|
|
|
|
io_skip:
|
|
|
|
stmg %r0,%r7,__PT_R0(%r11)
|
|
|
|
mvc __PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
|
|
|
|
stmg %r8,%r9,__PT_PSW(%r11)
|
2006-07-03 15:24:46 +08:00
|
|
|
TRACE_IRQS_OFF
|
2011-12-27 18:27:15 +08:00
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
brasl %r14,do_IRQ
|
2005-04-17 06:20:36 +08:00
|
|
|
io_return:
|
2010-05-17 16:00:02 +08:00
|
|
|
LOCKDEP_SYS_EXIT
|
|
|
|
TRACE_IRQS_ON
|
|
|
|
io_tif:
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_WORK_INT
|
2006-09-28 22:56:37 +08:00
|
|
|
jnz io_work # there is work to do (signals etc.)
|
2007-11-20 18:13:32 +08:00
|
|
|
io_restore:
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r14,__LC_VDSO_PER_CPU
|
|
|
|
lmg %r0,%r10,__PT_R0(%r11)
|
|
|
|
mvc __LC_RETURN_PSW(16),__PT_PSW(%r11)
|
|
|
|
stpt __LC_EXIT_TIMER
|
|
|
|
mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
|
|
|
|
lmg %r11,%r15,__PT_R11(%r11)
|
|
|
|
lpswe __LC_RETURN_PSW
|
2005-09-04 06:57:56 +08:00
|
|
|
io_done:
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-05-07 15:22:52 +08:00
|
|
|
#
|
2010-05-17 16:00:01 +08:00
|
|
|
# There is work todo, find out in which context we have been interrupted:
|
|
|
|
# 1) if we return to user space we can do all _TIF_WORK_INT work
|
|
|
|
# 2) if we return to kernel code and kvm is enabled check if we need to
|
|
|
|
# modify the psw to leave SIE
|
|
|
|
# 3) if we return to kernel code and preemptive scheduling is enabled check
|
|
|
|
# the preemption counter and if it is zero call preempt_schedule_irq
|
|
|
|
# Before any work can be done, a switch to the kernel stack is required.
|
2008-05-07 15:22:52 +08:00
|
|
|
#
|
|
|
|
io_work:
|
2011-12-27 18:27:15 +08:00
|
|
|
tm __PT_PSW+1(%r11),0x01 # returning to user ?
|
2010-05-17 16:00:01 +08:00
|
|
|
jo io_work_user # yes -> do resched & signal
|
|
|
|
#ifdef CONFIG_PREEMPT
|
2008-05-07 15:22:52 +08:00
|
|
|
# check for preemptive scheduling
|
2010-05-17 16:00:05 +08:00
|
|
|
icm %r0,15,__TI_precount(%r12)
|
2008-05-07 15:22:52 +08:00
|
|
|
jnz io_restore # preemption is disabled
|
2010-05-17 16:00:02 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
|
|
|
|
jno io_restore
|
2005-04-17 06:20:36 +08:00
|
|
|
# switch to kernel stack
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r1,__PT_R15(%r11)
|
|
|
|
aghi %r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
mvc STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
|
|
|
|
xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r1)
|
2005-04-17 06:20:36 +08:00
|
|
|
lgr %r15,%r1
|
2010-05-17 16:00:02 +08:00
|
|
|
# TRACE_IRQS_ON already done at io_return, call
|
|
|
|
# TRACE_IRQS_OFF to keep things symmetrical
|
|
|
|
TRACE_IRQS_OFF
|
|
|
|
brasl %r14,preempt_schedule_irq
|
|
|
|
j io_return
|
|
|
|
#else
|
2010-05-17 16:00:01 +08:00
|
|
|
j io_restore
|
2010-05-17 16:00:02 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-05-17 16:00:01 +08:00
|
|
|
#
|
|
|
|
# Need to do work before returning to userspace, switch to kernel stack
|
|
|
|
#
|
2008-05-07 15:22:52 +08:00
|
|
|
io_work_user:
|
2005-04-17 06:20:36 +08:00
|
|
|
lg %r1,__LC_KERNEL_STACK
|
2011-12-27 18:27:15 +08:00
|
|
|
aghi %r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
mvc STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
|
|
|
|
xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r1)
|
2005-04-17 06:20:36 +08:00
|
|
|
lgr %r15,%r1
|
2010-05-17 16:00:01 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
|
|
|
# One of the work bits is on. Find out which one.
|
2010-05-17 16:00:01 +08:00
|
|
|
# Checked are: _TIF_SIGPENDING, _TIF_NOTIFY_RESUME, _TIF_NEED_RESCHED
|
2006-02-01 19:06:38 +08:00
|
|
|
# and _TIF_MCCK_PENDING
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2010-05-17 16:00:02 +08:00
|
|
|
io_work_tif:
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
|
2005-06-26 05:55:30 +08:00
|
|
|
jo io_mcck_pending
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_NEED_RESCHED
|
2005-04-17 06:20:36 +08:00
|
|
|
jo io_reschedule
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_SIGPENDING
|
2010-05-17 16:00:01 +08:00
|
|
|
jo io_sigpending
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_NOTIFY_RESUME
|
2010-05-17 16:00:01 +08:00
|
|
|
jo io_notify_resume
|
|
|
|
j io_return # beware of critical section cleanup
|
2008-05-07 15:22:53 +08:00
|
|
|
|
2005-06-26 05:55:30 +08:00
|
|
|
#
|
|
|
|
# _TIF_MCCK_PENDING is set, call handler
|
|
|
|
#
|
|
|
|
io_mcck_pending:
|
2010-05-17 16:00:02 +08:00
|
|
|
# TRACE_IRQS_ON already done at io_return
|
2007-07-27 18:29:18 +08:00
|
|
|
brasl %r14,s390_handle_mcck # TIF bit will be cleared by handler
|
2010-05-17 16:00:02 +08:00
|
|
|
TRACE_IRQS_OFF
|
|
|
|
j io_return
|
2005-06-26 05:55:30 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
|
|
|
# _TIF_NEED_RESCHED is set, call schedule
|
2006-09-28 22:56:37 +08:00
|
|
|
#
|
|
|
|
io_reschedule:
|
2010-05-17 16:00:02 +08:00
|
|
|
# TRACE_IRQS_ON already done at io_return
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_SVC_NEW_PSW # reenable interrupts
|
2006-09-28 22:56:37 +08:00
|
|
|
brasl %r14,schedule # call scheduler
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_PGM_NEW_PSW # disable I/O and ext. interrupts
|
2007-11-20 18:13:32 +08:00
|
|
|
TRACE_IRQS_OFF
|
2010-05-17 16:00:02 +08:00
|
|
|
j io_return
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#
|
2008-04-30 15:53:08 +08:00
|
|
|
# _TIF_SIGPENDING or is set, call do_signal
|
2005-04-17 06:20:36 +08:00
|
|
|
#
|
2006-09-28 22:56:37 +08:00
|
|
|
io_sigpending:
|
2010-05-17 16:00:02 +08:00
|
|
|
# TRACE_IRQS_ON already done at io_return
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_SVC_NEW_PSW # reenable interrupts
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
brasl %r14,do_signal
|
|
|
|
ssm __LC_PGM_NEW_PSW # disable I/O and ext. interrupts
|
2007-11-20 18:13:32 +08:00
|
|
|
TRACE_IRQS_OFF
|
2010-05-17 16:00:02 +08:00
|
|
|
j io_return
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2008-10-11 03:33:20 +08:00
|
|
|
#
|
|
|
|
# _TIF_NOTIFY_RESUME or is set, call do_notify_resume
|
|
|
|
#
|
|
|
|
io_notify_resume:
|
2010-05-17 16:00:02 +08:00
|
|
|
# TRACE_IRQS_ON already done at io_return
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_SVC_NEW_PSW # reenable interrupts
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
|
|
|
brasl %r14,do_notify_resume
|
|
|
|
ssm __LC_PGM_NEW_PSW # disable I/O and ext. interrupts
|
2008-10-11 03:33:20 +08:00
|
|
|
TRACE_IRQS_OFF
|
2010-05-17 16:00:02 +08:00
|
|
|
j io_return
|
2008-10-11 03:33:20 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* External interrupt handler routine
|
|
|
|
*/
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(ext_int_handler)
|
2012-05-09 22:27:39 +08:00
|
|
|
STCK __LC_INT_CLOCK
|
2008-12-31 22:11:41 +08:00
|
|
|
stpt __LC_ASYNC_ENTER_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
stmg %r8,%r15,__LC_SAVE_AREA_ASYNC
|
|
|
|
lg %r10,__LC_LAST_BREAK
|
|
|
|
lg %r12,__LC_THREAD_INFO
|
|
|
|
larl %r13,system_call
|
|
|
|
lmg %r8,%r9,__LC_EXT_OLD_PSW
|
|
|
|
HANDLE_SIE_INTERCEPT %r14
|
|
|
|
SWITCH_ASYNC __LC_SAVE_AREA_ASYNC,__LC_ASYNC_STACK,STACK_SHIFT
|
|
|
|
tmhh %r8,0x0001 # interrupting from user ?
|
|
|
|
jz ext_skip
|
|
|
|
UPDATE_VTIME %r14,__LC_ASYNC_ENTER_TIMER
|
|
|
|
LAST_BREAK %r14
|
|
|
|
ext_skip:
|
|
|
|
stmg %r0,%r7,__PT_R0(%r11)
|
|
|
|
mvc __PT_R8(64,%r11),__LC_SAVE_AREA_ASYNC
|
|
|
|
stmg %r8,%r9,__PT_PSW(%r11)
|
2006-07-03 15:24:46 +08:00
|
|
|
TRACE_IRQS_OFF
|
2012-05-09 22:27:35 +08:00
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
2010-10-25 22:10:38 +08:00
|
|
|
lghi %r1,4096
|
2011-12-27 18:27:15 +08:00
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
2012-03-11 23:59:25 +08:00
|
|
|
llgf %r3,__LC_EXT_CPU_ADDR # get cpu address + interruption code
|
2010-10-25 22:10:38 +08:00
|
|
|
llgf %r4,__LC_EXT_PARAMS # get external parameter
|
|
|
|
lg %r5,__LC_EXT_PARAMS2-4096(%r1) # get 64 bit external parameter
|
2006-09-28 22:56:37 +08:00
|
|
|
brasl %r14,do_extint
|
2005-04-17 06:20:36 +08:00
|
|
|
j io_return
|
|
|
|
|
2012-03-11 23:59:27 +08:00
|
|
|
/*
|
|
|
|
* Load idle PSW. The second "half" of this function is in cleanup_idle.
|
|
|
|
*/
|
|
|
|
ENTRY(psw_idle)
|
|
|
|
stg %r4,__SF_EMPTY(%r15)
|
|
|
|
larl %r1,psw_idle_lpsw+4
|
|
|
|
stg %r1,__SF_EMPTY+8(%r15)
|
|
|
|
larl %r1,.Lvtimer_max
|
2012-05-09 22:27:39 +08:00
|
|
|
STCK __IDLE_ENTER(%r2)
|
2012-03-11 23:59:27 +08:00
|
|
|
ltr %r5,%r5
|
|
|
|
stpt __VQ_IDLE_ENTER(%r3)
|
|
|
|
jz psw_idle_lpsw
|
|
|
|
spt 0(%r1)
|
|
|
|
psw_idle_lpsw:
|
|
|
|
lpswe __SF_EMPTY(%r15)
|
|
|
|
br %r14
|
|
|
|
psw_idle_end:
|
|
|
|
|
2005-09-04 06:57:56 +08:00
|
|
|
__critical_end:
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Machine check handler routines
|
|
|
|
*/
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(mcck_int_handler)
|
2012-05-09 22:27:39 +08:00
|
|
|
STCK __LC_MCCK_CLOCK
|
2005-06-26 05:55:30 +08:00
|
|
|
la %r1,4095 # revalidate r1
|
|
|
|
spt __LC_CPU_TIMER_SAVE_AREA-4095(%r1) # revalidate cpu timer
|
2006-09-28 22:56:37 +08:00
|
|
|
lmg %r0,%r15,__LC_GPREGS_SAVE_AREA-4095(%r1)# revalidate gprs
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r10,__LC_LAST_BREAK
|
|
|
|
lg %r12,__LC_THREAD_INFO
|
2010-05-17 16:00:05 +08:00
|
|
|
larl %r13,system_call
|
2011-12-27 18:27:15 +08:00
|
|
|
lmg %r8,%r9,__LC_MCK_OLD_PSW
|
|
|
|
HANDLE_SIE_INTERCEPT %r14
|
2006-09-28 22:56:37 +08:00
|
|
|
tm __LC_MCCK_CODE,0x80 # system damage?
|
2011-12-27 18:27:15 +08:00
|
|
|
jo mcck_panic # yes -> rest of mcck code invalid
|
|
|
|
lghi %r14,__LC_CPU_TIMER_SAVE_AREA
|
|
|
|
mvc __LC_MCCK_ENTER_TIMER(8),0(%r14)
|
2006-06-29 20:58:05 +08:00
|
|
|
tm __LC_MCCK_CODE+5,0x02 # stored cpu timer value valid?
|
2011-12-27 18:27:15 +08:00
|
|
|
jo 3f
|
2006-06-29 20:58:05 +08:00
|
|
|
la %r14,__LC_SYNC_ENTER_TIMER
|
|
|
|
clc 0(8,%r14),__LC_ASYNC_ENTER_TIMER
|
|
|
|
jl 0f
|
|
|
|
la %r14,__LC_ASYNC_ENTER_TIMER
|
|
|
|
0: clc 0(8,%r14),__LC_EXIT_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
jl 1f
|
2006-06-29 20:58:05 +08:00
|
|
|
la %r14,__LC_EXIT_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
1: clc 0(8,%r14),__LC_LAST_UPDATE_TIMER
|
|
|
|
jl 2f
|
2006-06-29 20:58:05 +08:00
|
|
|
la %r14,__LC_LAST_UPDATE_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
2: spt 0(%r14)
|
2010-05-17 16:00:03 +08:00
|
|
|
mvc __LC_MCCK_ENTER_TIMER(8),0(%r14)
|
2011-12-27 18:27:15 +08:00
|
|
|
3: tm __LC_MCCK_CODE+2,0x09 # mwp + ia of old psw valid?
|
|
|
|
jno mcck_panic # no -> skip cleanup critical
|
|
|
|
SWITCH_ASYNC __LC_GPREGS_SAVE_AREA+64,__LC_PANIC_STACK,PAGE_SHIFT
|
|
|
|
tm %r8,0x0001 # interrupting from user ?
|
|
|
|
jz mcck_skip
|
|
|
|
UPDATE_VTIME %r14,__LC_MCCK_ENTER_TIMER
|
|
|
|
LAST_BREAK %r14
|
|
|
|
mcck_skip:
|
|
|
|
lghi %r14,__LC_GPREGS_SAVE_AREA
|
|
|
|
mvc __PT_R0(128,%r11),0(%r14)
|
|
|
|
stmg %r8,%r9,__PT_PSW(%r11)
|
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
2005-06-26 05:55:30 +08:00
|
|
|
brasl %r14,s390_do_machine_check
|
2011-12-27 18:27:15 +08:00
|
|
|
tm __PT_PSW+1(%r11),0x01 # returning to user ?
|
2005-06-26 05:55:30 +08:00
|
|
|
jno mcck_return
|
|
|
|
lg %r1,__LC_KERNEL_STACK # switch to kernel stack
|
2011-12-27 18:27:15 +08:00
|
|
|
aghi %r1,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
mvc STACK_FRAME_OVERHEAD(__PT_SIZE,%r1),0(%r11)
|
|
|
|
xc __SF_BACKCHAIN(8,%r1),__SF_BACKCHAIN(%r1)
|
|
|
|
la %r11,STACK_FRAME_OVERHEAD(%r1)
|
2005-06-26 05:55:30 +08:00
|
|
|
lgr %r15,%r1
|
2011-12-27 18:27:15 +08:00
|
|
|
ssm __LC_PGM_NEW_PSW # turn dat on, keep irqs off
|
2010-05-17 16:00:05 +08:00
|
|
|
tm __TI_flags+7(%r12),_TIF_MCCK_PENDING
|
2005-06-26 05:55:30 +08:00
|
|
|
jno mcck_return
|
2006-07-03 15:24:46 +08:00
|
|
|
TRACE_IRQS_OFF
|
2005-06-26 05:55:30 +08:00
|
|
|
brasl %r14,s390_handle_mcck
|
2006-07-03 15:24:46 +08:00
|
|
|
TRACE_IRQS_ON
|
2005-04-17 06:20:36 +08:00
|
|
|
mcck_return:
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r14,__LC_VDSO_PER_CPU
|
|
|
|
lmg %r0,%r10,__PT_R0(%r11)
|
|
|
|
mvc __LC_RETURN_MCCK_PSW(16),__PT_PSW(%r11) # move return PSW
|
2006-06-29 20:58:05 +08:00
|
|
|
tm __LC_RETURN_MCCK_PSW+1,0x01 # returning to user ?
|
|
|
|
jno 0f
|
|
|
|
stpt __LC_EXIT_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
mvc __VDSO_ECTG_BASE(16,%r14),__LC_EXIT_TIMER
|
|
|
|
0: lmg %r11,%r15,__PT_R11(%r11)
|
|
|
|
lpswe __LC_RETURN_MCCK_PSW
|
|
|
|
|
|
|
|
mcck_panic:
|
|
|
|
lg %r14,__LC_PANIC_STACK
|
|
|
|
slgr %r14,%r15
|
|
|
|
srag %r14,%r14,PAGE_SHIFT
|
|
|
|
jz 0f
|
|
|
|
lg %r15,__LC_PANIC_STACK
|
|
|
|
0: aghi %r15,-(STACK_FRAME_OVERHEAD + __PT_SIZE)
|
|
|
|
j mcck_skip
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-08-03 22:44:19 +08:00
|
|
|
#
|
|
|
|
# PSW restart interrupt handler
|
|
|
|
#
|
2012-03-11 23:59:26 +08:00
|
|
|
ENTRY(restart_int_handler)
|
2011-12-27 18:27:15 +08:00
|
|
|
stg %r15,__LC_SAVE_AREA_RESTART
|
2012-03-11 23:59:26 +08:00
|
|
|
lg %r15,__LC_RESTART_STACK
|
2011-12-27 18:27:15 +08:00
|
|
|
aghi %r15,-__PT_SIZE # create pt_regs on stack
|
2012-03-11 23:59:26 +08:00
|
|
|
xc 0(__PT_SIZE,%r15),0(%r15)
|
2011-12-27 18:27:15 +08:00
|
|
|
stmg %r0,%r14,__PT_R0(%r15)
|
|
|
|
mvc __PT_R15(8,%r15),__LC_SAVE_AREA_RESTART
|
|
|
|
mvc __PT_PSW(16,%r15),__LC_RST_OLD_PSW # store restart old psw
|
2012-03-11 23:59:26 +08:00
|
|
|
aghi %r15,-STACK_FRAME_OVERHEAD # create stack frame on stack
|
|
|
|
xc 0(STACK_FRAME_OVERHEAD,%r15),0(%r15)
|
|
|
|
lmg %r1,%r3,__LC_RESTART_FN # load fn, parm & source cpu
|
|
|
|
ltgr %r3,%r3 # test source cpu address
|
|
|
|
jm 1f # negative -> skip source stop
|
|
|
|
0: sigp %r4,%r3,1 # sigp sense to source cpu
|
|
|
|
brc 10,0b # wait for status stored
|
|
|
|
1: basr %r14,%r1 # call function
|
|
|
|
stap __SF_EMPTY(%r15) # store cpu address
|
|
|
|
llgh %r3,__SF_EMPTY(%r15)
|
|
|
|
2: sigp %r4,%r3,5 # sigp stop to current cpu
|
|
|
|
brc 2,2b
|
|
|
|
3: j 3b
|
2011-08-03 22:44:19 +08:00
|
|
|
|
2011-01-05 19:47:25 +08:00
|
|
|
.section .kprobes.text, "ax"
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
#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:
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r11,__LC_PANIC_STACK # change to panic stack
|
|
|
|
aghi %r11,-__PT_SIZE # create pt_regs
|
|
|
|
stmg %r0,%r7,__PT_R0(%r11)
|
|
|
|
stmg %r8,%r9,__PT_PSW(%r11)
|
|
|
|
mvc __PT_R8(64,%r11),0(%r14)
|
|
|
|
stg %r10,__PT_ORIG_GPR2(%r11) # store last break to orig_gpr2
|
|
|
|
lgr %r15,%r11
|
|
|
|
aghi %r15,-STACK_FRAME_OVERHEAD
|
|
|
|
xc __SF_BACKCHAIN(8,%r15),__SF_BACKCHAIN(%r15)
|
|
|
|
lgr %r2,%r11 # pass pointer to pt_regs
|
2005-04-17 06:20:36 +08:00
|
|
|
jg kernel_stack_overflow
|
|
|
|
#endif
|
|
|
|
|
2011-12-27 18:27:15 +08:00
|
|
|
.align 8
|
|
|
|
cleanup_table:
|
|
|
|
.quad system_call
|
|
|
|
.quad sysc_do_svc
|
|
|
|
.quad sysc_tif
|
|
|
|
.quad sysc_restore
|
|
|
|
.quad sysc_done
|
|
|
|
.quad io_tif
|
|
|
|
.quad io_restore
|
|
|
|
.quad io_done
|
2012-03-11 23:59:27 +08:00
|
|
|
.quad psw_idle
|
|
|
|
.quad psw_idle_end
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
cleanup_critical:
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table) # system_call
|
2005-04-17 06:20:36 +08:00
|
|
|
jl 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+8) # sysc_do_svc
|
2005-04-17 06:20:36 +08:00
|
|
|
jl cleanup_system_call
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+16) # sysc_tif
|
2005-04-17 06:20:36 +08:00
|
|
|
jl 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+24) # sysc_restore
|
2010-05-17 16:00:02 +08:00
|
|
|
jl cleanup_sysc_tif
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+32) # sysc_done
|
2010-05-17 16:00:02 +08:00
|
|
|
jl cleanup_sysc_restore
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+40) # io_tif
|
2006-06-29 20:58:05 +08:00
|
|
|
jl 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+48) # io_restore
|
2010-05-17 16:00:02 +08:00
|
|
|
jl cleanup_io_tif
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_table+56) # io_done
|
2010-05-17 16:00:02 +08:00
|
|
|
jl cleanup_io_restore
|
2012-03-11 23:59:27 +08:00
|
|
|
clg %r9,BASED(cleanup_table+64) # psw_idle
|
|
|
|
jl 0f
|
|
|
|
clg %r9,BASED(cleanup_table+72) # psw_idle_end
|
|
|
|
jl cleanup_idle
|
2011-12-27 18:27:15 +08:00
|
|
|
0: br %r14
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
cleanup_system_call:
|
2011-12-27 18:27:15 +08:00
|
|
|
# check if stpt has been executed
|
|
|
|
clg %r9,BASED(cleanup_system_call_insn)
|
2005-04-17 06:20:36 +08:00
|
|
|
jh 0f
|
|
|
|
mvc __LC_SYNC_ENTER_TIMER(8),__LC_ASYNC_ENTER_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
cghi %r11,__LC_SAVE_AREA_ASYNC
|
2010-05-17 16:00:03 +08:00
|
|
|
je 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
mvc __LC_SYNC_ENTER_TIMER(8),__LC_MCCK_ENTER_TIMER
|
|
|
|
0: # check if stmg has been executed
|
|
|
|
clg %r9,BASED(cleanup_system_call_insn+8)
|
2005-04-17 06:20:36 +08:00
|
|
|
jh 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
mvc __LC_SAVE_AREA_SYNC(64),0(%r11)
|
|
|
|
0: # check if base register setup + TIF bit load has been done
|
|
|
|
clg %r9,BASED(cleanup_system_call_insn+16)
|
|
|
|
jhe 0f
|
|
|
|
# set up saved registers r10 and r12
|
|
|
|
stg %r10,16(%r11) # r10 last break
|
|
|
|
stg %r12,32(%r11) # r12 thread-info pointer
|
|
|
|
0: # check if the user time update has been done
|
|
|
|
clg %r9,BASED(cleanup_system_call_insn+24)
|
|
|
|
jh 0f
|
|
|
|
lg %r15,__LC_EXIT_TIMER
|
|
|
|
slg %r15,__LC_SYNC_ENTER_TIMER
|
|
|
|
alg %r15,__LC_USER_TIMER
|
|
|
|
stg %r15,__LC_USER_TIMER
|
|
|
|
0: # check if the system time update has been done
|
|
|
|
clg %r9,BASED(cleanup_system_call_insn+32)
|
|
|
|
jh 0f
|
|
|
|
lg %r15,__LC_LAST_UPDATE_TIMER
|
|
|
|
slg %r15,__LC_EXIT_TIMER
|
|
|
|
alg %r15,__LC_SYSTEM_TIMER
|
|
|
|
stg %r15,__LC_SYSTEM_TIMER
|
|
|
|
0: # update accounting time stamp
|
2005-04-17 06:20:36 +08:00
|
|
|
mvc __LC_LAST_UPDATE_TIMER(8),__LC_SYNC_ENTER_TIMER
|
2011-12-27 18:27:15 +08:00
|
|
|
# do LAST_BREAK
|
|
|
|
lg %r9,16(%r11)
|
|
|
|
srag %r9,%r9,23
|
2010-05-17 16:00:05 +08:00
|
|
|
jz 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
mvc __TI_last_break(8,%r12),16(%r11)
|
|
|
|
0: # set up saved register r11
|
|
|
|
lg %r15,__LC_KERNEL_STACK
|
|
|
|
aghi %r15,-__PT_SIZE
|
|
|
|
stg %r15,24(%r11) # r11 pt_regs pointer
|
|
|
|
# fill pt_regs
|
|
|
|
mvc __PT_R8(64,%r15),__LC_SAVE_AREA_SYNC
|
|
|
|
stmg %r0,%r7,__PT_R0(%r15)
|
|
|
|
mvc __PT_PSW(16,%r15),__LC_SVC_OLD_PSW
|
2011-12-27 18:27:18 +08:00
|
|
|
mvc __PT_INT_CODE(4,%r15),__LC_SVC_ILC
|
2011-12-27 18:27:15 +08:00
|
|
|
# setup saved register r15
|
|
|
|
aghi %r15,-STACK_FRAME_OVERHEAD
|
|
|
|
stg %r15,56(%r11) # r15 stack pointer
|
|
|
|
# set new psw address and exit
|
|
|
|
larl %r9,sysc_do_svc
|
2005-04-17 06:20:36 +08:00
|
|
|
br %r14
|
|
|
|
cleanup_system_call_insn:
|
2006-09-28 22:56:37 +08:00
|
|
|
.quad system_call
|
2011-12-27 18:27:15 +08:00
|
|
|
.quad sysc_stmg
|
|
|
|
.quad sysc_per
|
|
|
|
.quad sysc_vtime+18
|
|
|
|
.quad sysc_vtime+42
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-05-17 16:00:02 +08:00
|
|
|
cleanup_sysc_tif:
|
2011-12-27 18:27:15 +08:00
|
|
|
larl %r9,sysc_tif
|
2005-04-17 06:20:36 +08:00
|
|
|
br %r14
|
|
|
|
|
2010-05-17 16:00:02 +08:00
|
|
|
cleanup_sysc_restore:
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_sysc_restore_insn)
|
2010-05-17 16:00:03 +08:00
|
|
|
je 0f
|
2011-12-27 18:27:15 +08:00
|
|
|
lg %r9,24(%r11) # get saved pointer to pt_regs
|
|
|
|
mvc __LC_RETURN_PSW(16),__PT_PSW(%r9)
|
|
|
|
mvc 0(64,%r11),__PT_R8(%r9)
|
|
|
|
lmg %r0,%r7,__PT_R0(%r9)
|
|
|
|
0: lmg %r8,%r9,__LC_RETURN_PSW
|
2005-04-17 06:20:36 +08:00
|
|
|
br %r14
|
2010-05-17 16:00:02 +08:00
|
|
|
cleanup_sysc_restore_insn:
|
2007-11-20 18:13:32 +08:00
|
|
|
.quad sysc_done - 4
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2010-05-17 16:00:02 +08:00
|
|
|
cleanup_io_tif:
|
2011-12-27 18:27:15 +08:00
|
|
|
larl %r9,io_tif
|
2010-04-09 19:43:00 +08:00
|
|
|
br %r14
|
|
|
|
|
2010-05-17 16:00:02 +08:00
|
|
|
cleanup_io_restore:
|
2011-12-27 18:27:15 +08:00
|
|
|
clg %r9,BASED(cleanup_io_restore_insn)
|
|
|
|
je 0f
|
|
|
|
lg %r9,24(%r11) # get saved r11 pointer to pt_regs
|
|
|
|
mvc __LC_RETURN_PSW(16),__PT_PSW(%r9)
|
|
|
|
mvc 0(64,%r11),__PT_R8(%r9)
|
|
|
|
lmg %r0,%r7,__PT_R0(%r9)
|
|
|
|
0: lmg %r8,%r9,__LC_RETURN_PSW
|
2005-09-04 06:57:56 +08:00
|
|
|
br %r14
|
2010-05-17 16:00:02 +08:00
|
|
|
cleanup_io_restore_insn:
|
2007-11-20 18:13:32 +08:00
|
|
|
.quad io_done - 4
|
2005-09-04 06:57:56 +08:00
|
|
|
|
2012-03-11 23:59:27 +08:00
|
|
|
cleanup_idle:
|
|
|
|
# copy interrupt clock & cpu timer
|
|
|
|
mvc __IDLE_EXIT(8,%r2),__LC_INT_CLOCK
|
|
|
|
mvc __VQ_IDLE_EXIT(8,%r3),__LC_ASYNC_ENTER_TIMER
|
|
|
|
cghi %r11,__LC_SAVE_AREA_ASYNC
|
|
|
|
je 0f
|
|
|
|
mvc __IDLE_EXIT(8,%r2),__LC_MCCK_CLOCK
|
|
|
|
mvc __VQ_IDLE_EXIT(8,%r3),__LC_MCCK_ENTER_TIMER
|
|
|
|
0: # check if stck & stpt have been executed
|
|
|
|
clg %r9,BASED(cleanup_idle_insn)
|
|
|
|
jhe 1f
|
|
|
|
mvc __IDLE_ENTER(8,%r2),__IDLE_EXIT(%r2)
|
|
|
|
mvc __VQ_IDLE_ENTER(8,%r3),__VQ_IDLE_EXIT(%r3)
|
|
|
|
j 2f
|
|
|
|
1: # check if the cpu timer has been reprogrammed
|
|
|
|
ltr %r5,%r5
|
|
|
|
jz 2f
|
|
|
|
spt __VQ_IDLE_ENTER(%r3)
|
|
|
|
2: # account system time going idle
|
|
|
|
lg %r9,__LC_STEAL_TIMER
|
|
|
|
alg %r9,__IDLE_ENTER(%r2)
|
|
|
|
slg %r9,__LC_LAST_UPDATE_CLOCK
|
|
|
|
stg %r9,__LC_STEAL_TIMER
|
|
|
|
mvc __LC_LAST_UPDATE_CLOCK(8),__IDLE_EXIT(%r2)
|
|
|
|
lg %r9,__LC_SYSTEM_TIMER
|
|
|
|
alg %r9,__LC_LAST_UPDATE_TIMER
|
|
|
|
slg %r9,__VQ_IDLE_ENTER(%r3)
|
|
|
|
stg %r9,__LC_SYSTEM_TIMER
|
|
|
|
mvc __LC_LAST_UPDATE_TIMER(8),__VQ_IDLE_EXIT(%r3)
|
|
|
|
# prepare return psw
|
|
|
|
nihh %r8,0xfffd # clear wait state bit
|
|
|
|
lg %r9,48(%r11) # return from psw_idle
|
|
|
|
br %r14
|
|
|
|
cleanup_idle_insn:
|
|
|
|
.quad psw_idle_lpsw
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Integer constants
|
|
|
|
*/
|
2011-12-27 18:27:15 +08:00
|
|
|
.align 8
|
2005-04-17 06:20:36 +08:00
|
|
|
.Lcritical_start:
|
2011-12-27 18:27:15 +08:00
|
|
|
.quad __critical_start
|
|
|
|
.Lcritical_length:
|
|
|
|
.quad __critical_end - __critical_start
|
2012-03-11 23:59:27 +08:00
|
|
|
.Lvtimer_max:
|
|
|
|
.quad 0x7fffffffffffffff
|
2011-12-27 18:27:15 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2011-07-24 16:48:18 +08:00
|
|
|
#if defined(CONFIG_KVM) || defined(CONFIG_KVM_MODULE)
|
|
|
|
/*
|
|
|
|
* sie64a calling convention:
|
|
|
|
* %r2 pointer to sie control block
|
|
|
|
* %r3 guest register save area
|
|
|
|
*/
|
2011-07-24 16:48:19 +08:00
|
|
|
ENTRY(sie64a)
|
2011-07-24 16:48:18 +08:00
|
|
|
stmg %r6,%r14,__SF_GPRS(%r15) # save kernel registers
|
|
|
|
stg %r2,__SF_EMPTY(%r15) # save control block pointer
|
|
|
|
stg %r3,__SF_EMPTY+8(%r15) # save guest register save area
|
2011-12-27 18:27:13 +08:00
|
|
|
xc __SF_EMPTY+16(8,%r15),__SF_EMPTY+16(%r15) # host id == 0
|
2011-07-24 16:48:18 +08:00
|
|
|
lmg %r0,%r13,0(%r3) # load guest gprs 0-13
|
|
|
|
lg %r14,__LC_THREAD_INFO # pointer thread_info struct
|
|
|
|
sie_loop:
|
|
|
|
lg %r14,__LC_THREAD_INFO # pointer thread_info struct
|
|
|
|
tm __TI_flags+7(%r14),_TIF_EXIT_SIE
|
|
|
|
jnz sie_exit
|
2011-09-20 23:07:28 +08:00
|
|
|
lg %r14,__LC_GMAP # get gmap pointer
|
|
|
|
ltgr %r14,%r14
|
|
|
|
jz sie_gmap
|
|
|
|
lctlg %c1,%c1,__GMAP_ASCE(%r14) # load primary asce
|
|
|
|
sie_gmap:
|
2011-07-24 16:48:18 +08:00
|
|
|
lg %r14,__SF_EMPTY(%r15) # get control block pointer
|
|
|
|
SPP __SF_EMPTY(%r15) # set guest id
|
|
|
|
sie 0(%r14)
|
|
|
|
sie_done:
|
2011-12-27 18:27:13 +08:00
|
|
|
SPP __SF_EMPTY+16(%r15) # set host id
|
2011-07-24 16:48:18 +08:00
|
|
|
lg %r14,__LC_THREAD_INFO # pointer thread_info struct
|
|
|
|
sie_exit:
|
2011-09-20 23:07:28 +08:00
|
|
|
lctlg %c1,%c1,__LC_USER_ASCE # load primary asce
|
2011-07-24 16:48:18 +08:00
|
|
|
lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
|
|
|
|
stmg %r0,%r13,0(%r14) # save guest gprs 0-13
|
|
|
|
lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
|
|
|
|
lghi %r2,0
|
|
|
|
br %r14
|
|
|
|
sie_fault:
|
2011-10-30 22:16:59 +08:00
|
|
|
lctlg %c1,%c1,__LC_USER_ASCE # load primary asce
|
2011-07-24 16:48:18 +08:00
|
|
|
lg %r14,__LC_THREAD_INFO # pointer thread_info struct
|
|
|
|
lg %r14,__SF_EMPTY+8(%r15) # load guest register save area
|
|
|
|
stmg %r0,%r13,0(%r14) # save guest gprs 0-13
|
|
|
|
lmg %r6,%r14,__SF_GPRS(%r15) # restore kernel registers
|
|
|
|
lghi %r2,-EFAULT
|
|
|
|
br %r14
|
|
|
|
|
|
|
|
.align 8
|
|
|
|
.Lsie_loop:
|
|
|
|
.quad sie_loop
|
2011-12-27 18:27:15 +08:00
|
|
|
.Lsie_length:
|
|
|
|
.quad sie_done - sie_loop
|
2011-12-27 18:27:13 +08:00
|
|
|
.Lhost_id:
|
|
|
|
.quad 0
|
2011-07-24 16:48:18 +08:00
|
|
|
|
|
|
|
.section __ex_table,"a"
|
|
|
|
.quad sie_loop,sie_fault
|
|
|
|
.previous
|
|
|
|
#endif
|
|
|
|
|
2006-09-28 22:56:37 +08:00
|
|
|
.section .rodata, "a"
|
2005-04-17 06:20:36 +08:00
|
|
|
#define SYSCALL(esa,esame,emu) .long esame
|
2009-06-12 16:26:47 +08:00
|
|
|
.globl sys_call_table
|
2005-04-17 06:20:36 +08:00
|
|
|
sys_call_table:
|
|
|
|
#include "syscalls.S"
|
|
|
|
#undef SYSCALL
|
|
|
|
|
2006-01-06 16:19:28 +08:00
|
|
|
#ifdef CONFIG_COMPAT
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
#define SYSCALL(esa,esame,emu) .long emu
|
|
|
|
sys_call_table_emu:
|
|
|
|
#include "syscalls.S"
|
|
|
|
#undef SYSCALL
|
|
|
|
#endif
|