321 lines
9.5 KiB
C
321 lines
9.5 KiB
C
/*
|
|
* Emulation of Linux signals
|
|
*
|
|
* Copyright (c) 2003 Fabrice Bellard
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
#include "qemu/osdep.h"
|
|
#include "qemu.h"
|
|
#include "signal-common.h"
|
|
#include "linux-user/trace.h"
|
|
|
|
#define __NUM_GPRS 16
|
|
#define __NUM_FPRS 16
|
|
#define __NUM_ACRS 16
|
|
|
|
#define S390_SYSCALL_SIZE 2
|
|
#define __SIGNAL_FRAMESIZE 160 /* FIXME: 31-bit mode -> 96 */
|
|
|
|
#define _SIGCONTEXT_NSIG 64
|
|
#define _SIGCONTEXT_NSIG_BPW 64 /* FIXME: 31-bit mode -> 32 */
|
|
#define _SIGCONTEXT_NSIG_WORDS (_SIGCONTEXT_NSIG / _SIGCONTEXT_NSIG_BPW)
|
|
#define _SIGMASK_COPY_SIZE (sizeof(unsigned long)*_SIGCONTEXT_NSIG_WORDS)
|
|
#define PSW_ADDR_AMODE 0x0000000000000000UL /* 0x80000000UL for 31-bit */
|
|
#define S390_SYSCALL_OPCODE ((uint16_t)0x0a00)
|
|
|
|
typedef struct {
|
|
target_psw_t psw;
|
|
target_ulong gprs[__NUM_GPRS];
|
|
unsigned int acrs[__NUM_ACRS];
|
|
} target_s390_regs_common;
|
|
|
|
typedef struct {
|
|
unsigned int fpc;
|
|
double fprs[__NUM_FPRS];
|
|
} target_s390_fp_regs;
|
|
|
|
typedef struct {
|
|
target_s390_regs_common regs;
|
|
target_s390_fp_regs fpregs;
|
|
} target_sigregs;
|
|
|
|
struct target_sigcontext {
|
|
target_ulong oldmask[_SIGCONTEXT_NSIG_WORDS];
|
|
target_sigregs *sregs;
|
|
};
|
|
|
|
typedef struct {
|
|
uint8_t callee_used_stack[__SIGNAL_FRAMESIZE];
|
|
struct target_sigcontext sc;
|
|
target_sigregs sregs;
|
|
int signo;
|
|
uint8_t retcode[S390_SYSCALL_SIZE];
|
|
} sigframe;
|
|
|
|
struct target_ucontext {
|
|
target_ulong tuc_flags;
|
|
struct target_ucontext *tuc_link;
|
|
target_stack_t tuc_stack;
|
|
target_sigregs tuc_mcontext;
|
|
target_sigset_t tuc_sigmask; /* mask last for extensibility */
|
|
};
|
|
|
|
typedef struct {
|
|
uint8_t callee_used_stack[__SIGNAL_FRAMESIZE];
|
|
uint8_t retcode[S390_SYSCALL_SIZE];
|
|
struct target_siginfo info;
|
|
struct target_ucontext uc;
|
|
} rt_sigframe;
|
|
|
|
static inline abi_ulong
|
|
get_sigframe(struct target_sigaction *ka, CPUS390XState *env, size_t frame_size)
|
|
{
|
|
abi_ulong sp;
|
|
|
|
/* Default to using normal stack */
|
|
sp = get_sp_from_cpustate(env);
|
|
|
|
/* This is the X/Open sanctioned signal stack switching. */
|
|
if (ka->sa_flags & TARGET_SA_ONSTACK) {
|
|
sp = target_sigsp(sp, ka);
|
|
}
|
|
|
|
/* This is the legacy signal stack switching. */
|
|
else if (/* FIXME !user_mode(regs) */ 0 &&
|
|
!(ka->sa_flags & TARGET_SA_RESTORER) &&
|
|
ka->sa_restorer) {
|
|
sp = (abi_ulong) ka->sa_restorer;
|
|
}
|
|
|
|
return (sp - frame_size) & -8ul;
|
|
}
|
|
|
|
static void save_sigregs(CPUS390XState *env, target_sigregs *sregs)
|
|
{
|
|
int i;
|
|
//save_access_regs(current->thread.acrs); FIXME
|
|
|
|
/* Copy a 'clean' PSW mask to the user to avoid leaking
|
|
information about whether PER is currently on. */
|
|
__put_user(env->psw.mask, &sregs->regs.psw.mask);
|
|
__put_user(env->psw.addr, &sregs->regs.psw.addr);
|
|
for (i = 0; i < 16; i++) {
|
|
__put_user(env->regs[i], &sregs->regs.gprs[i]);
|
|
}
|
|
for (i = 0; i < 16; i++) {
|
|
__put_user(env->aregs[i], &sregs->regs.acrs[i]);
|
|
}
|
|
/*
|
|
* We have to store the fp registers to current->thread.fp_regs
|
|
* to merge them with the emulated registers.
|
|
*/
|
|
//save_fp_regs(¤t->thread.fp_regs); FIXME
|
|
for (i = 0; i < 16; i++) {
|
|
__put_user(get_freg(env, i)->ll, &sregs->fpregs.fprs[i]);
|
|
}
|
|
}
|
|
|
|
void setup_frame(int sig, struct target_sigaction *ka,
|
|
target_sigset_t *set, CPUS390XState *env)
|
|
{
|
|
sigframe *frame;
|
|
abi_ulong frame_addr;
|
|
|
|
frame_addr = get_sigframe(ka, env, sizeof(*frame));
|
|
trace_user_setup_frame(env, frame_addr);
|
|
if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
|
|
goto give_sigsegv;
|
|
}
|
|
|
|
__put_user(set->sig[0], &frame->sc.oldmask[0]);
|
|
|
|
save_sigregs(env, &frame->sregs);
|
|
|
|
__put_user((abi_ulong)(unsigned long)&frame->sregs,
|
|
(abi_ulong *)&frame->sc.sregs);
|
|
|
|
/* Set up to return from userspace. If provided, use a stub
|
|
already in userspace. */
|
|
if (ka->sa_flags & TARGET_SA_RESTORER) {
|
|
env->regs[14] = (unsigned long)
|
|
ka->sa_restorer | PSW_ADDR_AMODE;
|
|
} else {
|
|
env->regs[14] = (frame_addr + offsetof(sigframe, retcode))
|
|
| PSW_ADDR_AMODE;
|
|
__put_user(S390_SYSCALL_OPCODE | TARGET_NR_sigreturn,
|
|
(uint16_t *)(frame->retcode));
|
|
}
|
|
|
|
/* Set up backchain. */
|
|
__put_user(env->regs[15], (abi_ulong *) frame);
|
|
|
|
/* Set up registers for signal handler */
|
|
env->regs[15] = frame_addr;
|
|
env->psw.addr = (target_ulong) ka->_sa_handler | PSW_ADDR_AMODE;
|
|
|
|
env->regs[2] = sig; //map_signal(sig);
|
|
env->regs[3] = frame_addr += offsetof(typeof(*frame), sc);
|
|
|
|
/* We forgot to include these in the sigcontext.
|
|
To avoid breaking binary compatibility, they are passed as args. */
|
|
env->regs[4] = 0; // FIXME: no clue... current->thread.trap_no;
|
|
env->regs[5] = 0; // FIXME: no clue... current->thread.prot_addr;
|
|
|
|
/* Place signal number on stack to allow backtrace from handler. */
|
|
__put_user(env->regs[2], &frame->signo);
|
|
unlock_user_struct(frame, frame_addr, 1);
|
|
return;
|
|
|
|
give_sigsegv:
|
|
force_sigsegv(sig);
|
|
}
|
|
|
|
void setup_rt_frame(int sig, struct target_sigaction *ka,
|
|
target_siginfo_t *info,
|
|
target_sigset_t *set, CPUS390XState *env)
|
|
{
|
|
int i;
|
|
rt_sigframe *frame;
|
|
abi_ulong frame_addr;
|
|
|
|
frame_addr = get_sigframe(ka, env, sizeof *frame);
|
|
trace_user_setup_rt_frame(env, frame_addr);
|
|
if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
|
|
goto give_sigsegv;
|
|
}
|
|
|
|
tswap_siginfo(&frame->info, info);
|
|
|
|
/* Create the ucontext. */
|
|
__put_user(0, &frame->uc.tuc_flags);
|
|
__put_user((abi_ulong)0, (abi_ulong *)&frame->uc.tuc_link);
|
|
target_save_altstack(&frame->uc.tuc_stack, env);
|
|
save_sigregs(env, &frame->uc.tuc_mcontext);
|
|
for (i = 0; i < TARGET_NSIG_WORDS; i++) {
|
|
__put_user((abi_ulong)set->sig[i],
|
|
(abi_ulong *)&frame->uc.tuc_sigmask.sig[i]);
|
|
}
|
|
|
|
/* Set up to return from userspace. If provided, use a stub
|
|
already in userspace. */
|
|
if (ka->sa_flags & TARGET_SA_RESTORER) {
|
|
env->regs[14] = (unsigned long) ka->sa_restorer | PSW_ADDR_AMODE;
|
|
} else {
|
|
env->regs[14] = (unsigned long) frame->retcode | PSW_ADDR_AMODE;
|
|
__put_user(S390_SYSCALL_OPCODE | TARGET_NR_rt_sigreturn,
|
|
(uint16_t *)(frame->retcode));
|
|
}
|
|
|
|
/* Set up backchain. */
|
|
__put_user(env->regs[15], (abi_ulong *) frame);
|
|
|
|
/* Set up registers for signal handler */
|
|
env->regs[15] = frame_addr;
|
|
env->psw.addr = (target_ulong) ka->_sa_handler | PSW_ADDR_AMODE;
|
|
|
|
env->regs[2] = sig; //map_signal(sig);
|
|
env->regs[3] = frame_addr + offsetof(typeof(*frame), info);
|
|
env->regs[4] = frame_addr + offsetof(typeof(*frame), uc);
|
|
return;
|
|
|
|
give_sigsegv:
|
|
force_sigsegv(sig);
|
|
}
|
|
|
|
static int
|
|
restore_sigregs(CPUS390XState *env, target_sigregs *sc)
|
|
{
|
|
int err = 0;
|
|
int i;
|
|
|
|
for (i = 0; i < 16; i++) {
|
|
__get_user(env->regs[i], &sc->regs.gprs[i]);
|
|
}
|
|
|
|
__get_user(env->psw.mask, &sc->regs.psw.mask);
|
|
trace_user_s390x_restore_sigregs(env, (unsigned long long)sc->regs.psw.addr,
|
|
(unsigned long long)env->psw.addr);
|
|
__get_user(env->psw.addr, &sc->regs.psw.addr);
|
|
/* FIXME: 31-bit -> | PSW_ADDR_AMODE */
|
|
|
|
for (i = 0; i < 16; i++) {
|
|
__get_user(env->aregs[i], &sc->regs.acrs[i]);
|
|
}
|
|
for (i = 0; i < 16; i++) {
|
|
__get_user(get_freg(env, i)->ll, &sc->fpregs.fprs[i]);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
long do_sigreturn(CPUS390XState *env)
|
|
{
|
|
sigframe *frame;
|
|
abi_ulong frame_addr = env->regs[15];
|
|
target_sigset_t target_set;
|
|
sigset_t set;
|
|
|
|
trace_user_do_sigreturn(env, frame_addr);
|
|
if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
|
|
goto badframe;
|
|
}
|
|
__get_user(target_set.sig[0], &frame->sc.oldmask[0]);
|
|
|
|
target_to_host_sigset_internal(&set, &target_set);
|
|
set_sigmask(&set); /* ~_BLOCKABLE? */
|
|
|
|
if (restore_sigregs(env, &frame->sregs)) {
|
|
goto badframe;
|
|
}
|
|
|
|
unlock_user_struct(frame, frame_addr, 0);
|
|
return -TARGET_QEMU_ESIGRETURN;
|
|
|
|
badframe:
|
|
force_sig(TARGET_SIGSEGV);
|
|
return -TARGET_QEMU_ESIGRETURN;
|
|
}
|
|
|
|
long do_rt_sigreturn(CPUS390XState *env)
|
|
{
|
|
rt_sigframe *frame;
|
|
abi_ulong frame_addr = env->regs[15];
|
|
sigset_t set;
|
|
|
|
trace_user_do_rt_sigreturn(env, frame_addr);
|
|
if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
|
|
goto badframe;
|
|
}
|
|
target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
|
|
|
|
set_sigmask(&set); /* ~_BLOCKABLE? */
|
|
|
|
if (restore_sigregs(env, &frame->uc.tuc_mcontext)) {
|
|
goto badframe;
|
|
}
|
|
|
|
if (do_sigaltstack(frame_addr + offsetof(rt_sigframe, uc.tuc_stack), 0,
|
|
get_sp_from_cpustate(env)) == -EFAULT) {
|
|
goto badframe;
|
|
}
|
|
unlock_user_struct(frame, frame_addr, 0);
|
|
return -TARGET_QEMU_ESIGRETURN;
|
|
|
|
badframe:
|
|
unlock_user_struct(frame, frame_addr, 0);
|
|
force_sig(TARGET_SIGSEGV);
|
|
return -TARGET_QEMU_ESIGRETURN;
|
|
}
|