signal.c 171.9 KB
Newer Older
1
/*
B
bellard 已提交
2
 *  Emulation of Linux signals
3
 *
4 5 6 7 8 9 10 11 12 13 14 15 16
 *  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
17
 *  along with this program; if not, see <http://www.gnu.org/licenses/>.
18
 */
P
Peter Maydell 已提交
19
#include "qemu/osdep.h"
20
#include <sys/ucontext.h>
21
#include <sys/resource.h>
22

B
bellard 已提交
23
#include "qemu.h"
B
blueswir1 已提交
24
#include "qemu-common.h"
25
#include "target_signal.h"
26
#include "trace.h"
B
bellard 已提交
27

B
blueswir1 已提交
28
static struct target_sigaltstack target_sigaltstack_used = {
29 30 31 32 33
    .ss_sp = 0,
    .ss_size = 0,
    .ss_flags = TARGET_SS_DISABLE,
};

P
pbrook 已提交
34
static struct target_sigaction sigact_table[TARGET_NSIG];
35

36
static void host_signal_handler(int host_signum, siginfo_t *info,
B
bellard 已提交
37 38
                                void *puc);

39
static uint8_t host_to_target_signal_table[_NSIG] = {
B
bellard 已提交
40 41 42 43 44 45
    [SIGHUP] = TARGET_SIGHUP,
    [SIGINT] = TARGET_SIGINT,
    [SIGQUIT] = TARGET_SIGQUIT,
    [SIGILL] = TARGET_SIGILL,
    [SIGTRAP] = TARGET_SIGTRAP,
    [SIGABRT] = TARGET_SIGABRT,
B
bellard 已提交
46
/*    [SIGIOT] = TARGET_SIGIOT,*/
B
bellard 已提交
47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74
    [SIGBUS] = TARGET_SIGBUS,
    [SIGFPE] = TARGET_SIGFPE,
    [SIGKILL] = TARGET_SIGKILL,
    [SIGUSR1] = TARGET_SIGUSR1,
    [SIGSEGV] = TARGET_SIGSEGV,
    [SIGUSR2] = TARGET_SIGUSR2,
    [SIGPIPE] = TARGET_SIGPIPE,
    [SIGALRM] = TARGET_SIGALRM,
    [SIGTERM] = TARGET_SIGTERM,
#ifdef SIGSTKFLT
    [SIGSTKFLT] = TARGET_SIGSTKFLT,
#endif
    [SIGCHLD] = TARGET_SIGCHLD,
    [SIGCONT] = TARGET_SIGCONT,
    [SIGSTOP] = TARGET_SIGSTOP,
    [SIGTSTP] = TARGET_SIGTSTP,
    [SIGTTIN] = TARGET_SIGTTIN,
    [SIGTTOU] = TARGET_SIGTTOU,
    [SIGURG] = TARGET_SIGURG,
    [SIGXCPU] = TARGET_SIGXCPU,
    [SIGXFSZ] = TARGET_SIGXFSZ,
    [SIGVTALRM] = TARGET_SIGVTALRM,
    [SIGPROF] = TARGET_SIGPROF,
    [SIGWINCH] = TARGET_SIGWINCH,
    [SIGIO] = TARGET_SIGIO,
    [SIGPWR] = TARGET_SIGPWR,
    [SIGSYS] = TARGET_SIGSYS,
    /* next signals stay the same */
P
pbrook 已提交
75
    /* Nasty hack: Reverse SIGRTMIN and SIGRTMAX to avoid overlap with
76
       host libpthread signals.  This assumes no one actually uses SIGRTMAX :-/
P
pbrook 已提交
77 78 79 80
       To fix this properly we need to do manual signal delivery multiplexed
       over a single host signal.  */
    [__SIGRTMIN] = __SIGRTMAX,
    [__SIGRTMAX] = __SIGRTMIN,
B
bellard 已提交
81
};
82
static uint8_t target_to_host_signal_table[_NSIG];
B
bellard 已提交
83

84 85 86 87 88 89 90 91 92 93 94 95
static inline int on_sig_stack(unsigned long sp)
{
    return (sp - target_sigaltstack_used.ss_sp
            < target_sigaltstack_used.ss_size);
}

static inline int sas_ss_flags(unsigned long sp)
{
    return (target_sigaltstack_used.ss_size == 0 ? SS_DISABLE
            : on_sig_stack(sp) ? SS_ONSTACK : 0);
}

P
pbrook 已提交
96
int host_to_target_signal(int sig)
97
{
98
    if (sig < 0 || sig >= _NSIG)
99
        return sig;
B
bellard 已提交
100
    return host_to_target_signal_table[sig];
101 102
}

103
int target_to_host_signal(int sig)
104
{
105
    if (sig < 0 || sig >= _NSIG)
106
        return sig;
B
bellard 已提交
107
    return target_to_host_signal_table[sig];
108 109
}

A
Anthony Liguori 已提交
110
static inline void target_sigemptyset(target_sigset_t *set)
111 112 113 114
{
    memset(set, 0, sizeof(*set));
}

A
Anthony Liguori 已提交
115
static inline void target_sigaddset(target_sigset_t *set, int signum)
116 117 118 119 120 121
{
    signum--;
    abi_ulong mask = (abi_ulong)1 << (signum % TARGET_NSIG_BPW);
    set->sig[signum / TARGET_NSIG_BPW] |= mask;
}

A
Anthony Liguori 已提交
122
static inline int target_sigismember(const target_sigset_t *set, int signum)
123 124 125 126 127 128
{
    signum--;
    abi_ulong mask = (abi_ulong)1 << (signum % TARGET_NSIG_BPW);
    return ((set->sig[signum / TARGET_NSIG_BPW] & mask) != 0);
}

A
Anthony Liguori 已提交
129
static void host_to_target_sigset_internal(target_sigset_t *d,
130
                                           const sigset_t *s)
B
bellard 已提交
131 132
{
    int i;
133 134 135 136 137
    target_sigemptyset(d);
    for (i = 1; i <= TARGET_NSIG; i++) {
        if (sigismember(s, i)) {
            target_sigaddset(d, host_to_target_signal(i));
        }
B
bellard 已提交
138 139 140
    }
}

A
Anthony Liguori 已提交
141
void host_to_target_sigset(target_sigset_t *d, const sigset_t *s)
142
{
A
Anthony Liguori 已提交
143
    target_sigset_t d1;
144 145 146 147
    int i;

    host_to_target_sigset_internal(&d1, s);
    for(i = 0;i < TARGET_NSIG_WORDS; i++)
148
        d->sig[i] = tswapal(d1.sig[i]);
149 150
}

151
static void target_to_host_sigset_internal(sigset_t *d,
A
Anthony Liguori 已提交
152
                                           const target_sigset_t *s)
B
bellard 已提交
153 154
{
    int i;
155 156 157 158 159
    sigemptyset(d);
    for (i = 1; i <= TARGET_NSIG; i++) {
        if (target_sigismember(s, i)) {
            sigaddset(d, target_to_host_signal(i));
        }
160
    }
B
bellard 已提交
161 162
}

A
Anthony Liguori 已提交
163
void target_to_host_sigset(sigset_t *d, const target_sigset_t *s)
164
{
A
Anthony Liguori 已提交
165
    target_sigset_t s1;
166 167 168
    int i;

    for(i = 0;i < TARGET_NSIG_WORDS; i++)
169
        s1.sig[i] = tswapal(s->sig[i]);
170 171
    target_to_host_sigset_internal(d, &s1);
}
172

173
void host_to_target_old_sigset(abi_ulong *old_sigset,
B
bellard 已提交
174 175
                               const sigset_t *sigset)
{
A
Anthony Liguori 已提交
176
    target_sigset_t d;
B
bellard 已提交
177 178
    host_to_target_sigset(&d, sigset);
    *old_sigset = d.sig[0];
B
bellard 已提交
179 180
}

181
void target_to_host_old_sigset(sigset_t *sigset,
182
                               const abi_ulong *old_sigset)
B
bellard 已提交
183
{
A
Anthony Liguori 已提交
184
    target_sigset_t d;
B
bellard 已提交
185 186 187 188 189 190
    int i;

    d.sig[0] = *old_sigset;
    for(i = 1;i < TARGET_NSIG_WORDS; i++)
        d.sig[i] = 0;
    target_to_host_sigset(sigset, &d);
B
bellard 已提交
191 192
}

193 194 195 196 197 198 199
/* Wrapper for sigprocmask function
 * Emulates a sigprocmask in a safe way for the guest. Note that set and oldset
 * are host signal set, not guest ones. This wraps the sigprocmask host calls
 * that should be protected (calls originated from guest)
 */
int do_sigprocmask(int how, const sigset_t *set, sigset_t *oldset)
{
200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
    int ret;
    sigset_t val;
    sigset_t *temp = NULL;
    CPUState *cpu = thread_cpu;
    TaskState *ts = (TaskState *)cpu->opaque;
    bool segv_was_blocked = ts->sigsegv_blocked;

    if (set) {
        bool has_sigsegv = sigismember(set, SIGSEGV);
        val = *set;
        temp = &val;

        sigdelset(temp, SIGSEGV);

        switch (how) {
        case SIG_BLOCK:
            if (has_sigsegv) {
                ts->sigsegv_blocked = true;
            }
            break;
        case SIG_UNBLOCK:
            if (has_sigsegv) {
                ts->sigsegv_blocked = false;
            }
            break;
        case SIG_SETMASK:
            ts->sigsegv_blocked = has_sigsegv;
            break;
        default:
            g_assert_not_reached();
        }
    }

    ret = sigprocmask(how, temp, oldset);

    if (oldset && segv_was_blocked) {
        sigaddset(oldset, SIGSEGV);
    }

    return ret;
240 241
}

B
bellard 已提交
242 243
/* siginfo conversion */

A
Anthony Liguori 已提交
244
static inline void host_to_target_siginfo_noswap(target_siginfo_t *tinfo,
B
bellard 已提交
245
                                                 const siginfo_t *info)
B
bellard 已提交
246
{
247
    int sig = host_to_target_signal(info->si_signo);
B
bellard 已提交
248 249
    tinfo->si_signo = sig;
    tinfo->si_errno = 0;
P
pbrook 已提交
250
    tinfo->si_code = info->si_code;
251 252

    if (sig == TARGET_SIGILL || sig == TARGET_SIGFPE || sig == TARGET_SIGSEGV
253
            || sig == TARGET_SIGBUS || sig == TARGET_SIGTRAP) {
254 255
        /* Should never come here, but who knows. The information for
           the target is irrelevant.  */
B
bellard 已提交
256
        tinfo->_sifields._sigfault._addr = 0;
257 258
    } else if (sig == TARGET_SIGIO) {
        tinfo->_sifields._sigpoll._band = info->si_band;
259
        tinfo->_sifields._sigpoll._fd = info->si_fd;
260 261 262 263
    } else if (sig == TARGET_SIGCHLD) {
        tinfo->_sifields._sigchld._pid = info->si_pid;
        tinfo->_sifields._sigchld._uid = info->si_uid;
        tinfo->_sifields._sigchld._status
264
                = host_to_target_waitstatus(info->si_status);
265 266
        tinfo->_sifields._sigchld._utime = info->si_utime;
        tinfo->_sifields._sigchld._stime = info->si_stime;
B
bellard 已提交
267 268 269 270
    } else if (sig >= TARGET_SIGRTMIN) {
        tinfo->_sifields._rt._pid = info->si_pid;
        tinfo->_sifields._rt._uid = info->si_uid;
        /* XXX: potential problem if 64 bit */
271
        tinfo->_sifields._rt._sigval.sival_ptr
272
                = (abi_ulong)(unsigned long)info->si_value.sival_ptr;
B
bellard 已提交
273 274 275
    }
}

A
Anthony Liguori 已提交
276 277
static void tswap_siginfo(target_siginfo_t *tinfo,
                          const target_siginfo_t *info)
B
bellard 已提交
278
{
279
    int sig = info->si_signo;
B
bellard 已提交
280
    tinfo->si_signo = tswap32(sig);
B
bellard 已提交
281 282
    tinfo->si_errno = tswap32(info->si_errno);
    tinfo->si_code = tswap32(info->si_code);
283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302

    if (sig == TARGET_SIGILL || sig == TARGET_SIGFPE || sig == TARGET_SIGSEGV
        || sig == TARGET_SIGBUS || sig == TARGET_SIGTRAP) {
        tinfo->_sifields._sigfault._addr
            = tswapal(info->_sifields._sigfault._addr);
    } else if (sig == TARGET_SIGIO) {
        tinfo->_sifields._sigpoll._band
            = tswap32(info->_sifields._sigpoll._band);
        tinfo->_sifields._sigpoll._fd = tswap32(info->_sifields._sigpoll._fd);
    } else if (sig == TARGET_SIGCHLD) {
        tinfo->_sifields._sigchld._pid
            = tswap32(info->_sifields._sigchld._pid);
        tinfo->_sifields._sigchld._uid
            = tswap32(info->_sifields._sigchld._uid);
        tinfo->_sifields._sigchld._status
            = tswap32(info->_sifields._sigchld._status);
        tinfo->_sifields._sigchld._utime
            = tswapal(info->_sifields._sigchld._utime);
        tinfo->_sifields._sigchld._stime
            = tswapal(info->_sifields._sigchld._stime);
B
bellard 已提交
303 304 305
    } else if (sig >= TARGET_SIGRTMIN) {
        tinfo->_sifields._rt._pid = tswap32(info->_sifields._rt._pid);
        tinfo->_sifields._rt._uid = tswap32(info->_sifields._rt._uid);
306 307
        tinfo->_sifields._rt._sigval.sival_ptr
            = tswapal(info->_sifields._rt._sigval.sival_ptr);
B
bellard 已提交
308 309 310 311
    }
}


A
Anthony Liguori 已提交
312
void host_to_target_siginfo(target_siginfo_t *tinfo, const siginfo_t *info)
B
bellard 已提交
313 314 315
{
    host_to_target_siginfo_noswap(tinfo, info);
    tswap_siginfo(tinfo, tinfo);
B
bellard 已提交
316 317
}

B
bellard 已提交
318
/* XXX: we support only POSIX RT signals are used. */
T
ths 已提交
319
/* XXX: find a solution for 64 bit (additional malloced data is needed) */
A
Anthony Liguori 已提交
320
void target_to_host_siginfo(siginfo_t *info, const target_siginfo_t *tinfo)
B
bellard 已提交
321 322 323 324
{
    info->si_signo = tswap32(tinfo->si_signo);
    info->si_errno = tswap32(tinfo->si_errno);
    info->si_code = tswap32(tinfo->si_code);
B
bellard 已提交
325 326
    info->si_pid = tswap32(tinfo->_sifields._rt._pid);
    info->si_uid = tswap32(tinfo->_sifields._rt._uid);
327
    info->si_value.sival_ptr =
328
            (void *)(long)tswapal(tinfo->_sifields._rt._sigval.sival_ptr);
B
bellard 已提交
329 330
}

331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350
static int fatal_signal (int sig)
{
    switch (sig) {
    case TARGET_SIGCHLD:
    case TARGET_SIGURG:
    case TARGET_SIGWINCH:
        /* Ignored by default.  */
        return 0;
    case TARGET_SIGCONT:
    case TARGET_SIGSTOP:
    case TARGET_SIGTSTP:
    case TARGET_SIGTTIN:
    case TARGET_SIGTTOU:
        /* Job control signals.  */
        return 0;
    default:
        return 1;
    }
}

351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367
/* returns 1 if given signal should dump core if not handled */
static int core_dump_signal(int sig)
{
    switch (sig) {
    case TARGET_SIGABRT:
    case TARGET_SIGFPE:
    case TARGET_SIGILL:
    case TARGET_SIGQUIT:
    case TARGET_SIGSEGV:
    case TARGET_SIGTRAP:
    case TARGET_SIGBUS:
        return (1);
    default:
        return (0);
    }
}

368 369 370
void signal_init(void)
{
    struct sigaction act;
P
pbrook 已提交
371
    struct sigaction oact;
B
bellard 已提交
372
    int i, j;
P
pbrook 已提交
373
    int host_sig;
374

B
bellard 已提交
375
    /* generate signal conversion tables */
376
    for(i = 1; i < _NSIG; i++) {
B
bellard 已提交
377 378 379
        if (host_to_target_signal_table[i] == 0)
            host_to_target_signal_table[i] = i;
    }
380
    for(i = 1; i < _NSIG; i++) {
B
bellard 已提交
381 382 383
        j = host_to_target_signal_table[i];
        target_to_host_signal_table[j] = i;
    }
384

B
bellard 已提交
385 386
    /* set all host signal handlers. ALL signals are blocked during
       the handlers to serialize them. */
P
pbrook 已提交
387 388
    memset(sigact_table, 0, sizeof(sigact_table));

B
bellard 已提交
389
    sigfillset(&act.sa_mask);
390 391
    act.sa_flags = SA_SIGINFO;
    act.sa_sigaction = host_signal_handler;
P
pbrook 已提交
392 393 394 395 396 397 398 399 400 401
    for(i = 1; i <= TARGET_NSIG; i++) {
        host_sig = target_to_host_signal(i);
        sigaction(host_sig, NULL, &oact);
        if (oact.sa_sigaction == (void *)SIG_IGN) {
            sigact_table[i - 1]._sa_handler = TARGET_SIG_IGN;
        } else if (oact.sa_sigaction == (void *)SIG_DFL) {
            sigact_table[i - 1]._sa_handler = TARGET_SIG_DFL;
        }
        /* If there's already a handler installed then something has
           gone horribly wrong, so don't even try to handle that case.  */
402 403 404 405 406
        /* Install some handlers for our own use.  We need at least
           SIGSEGV and SIGBUS, to detect exceptions.  We can not just
           trap all signals because it affects syscall interrupt
           behavior.  But do trap all default-fatal signals.  */
        if (fatal_signal (i))
P
pbrook 已提交
407
            sigaction(host_sig, &act, NULL);
408
    }
B
bellard 已提交
409 410 411 412
}

/* signal queue handling */

413
static inline struct sigqueue *alloc_sigqueue(CPUArchState *env)
B
bellard 已提交
414
{
415 416
    CPUState *cpu = ENV_GET_CPU(env);
    TaskState *ts = cpu->opaque;
P
pbrook 已提交
417
    struct sigqueue *q = ts->first_free;
B
bellard 已提交
418 419
    if (!q)
        return NULL;
P
pbrook 已提交
420
    ts->first_free = q->next;
B
bellard 已提交
421
    return q;
422 423
}

424
static inline void free_sigqueue(CPUArchState *env, struct sigqueue *q)
B
bellard 已提交
425
{
426 427 428
    CPUState *cpu = ENV_GET_CPU(env);
    TaskState *ts = cpu->opaque;

P
pbrook 已提交
429 430
    q->next = ts->first_free;
    ts->first_free = q;
B
bellard 已提交
431 432
}

B
bellard 已提交
433
/* abort execution with signal */
434
static void QEMU_NORETURN force_sig(int target_sig)
B
bellard 已提交
435
{
436 437 438
    CPUState *cpu = thread_cpu;
    CPUArchState *env = cpu->env_ptr;
    TaskState *ts = (TaskState *)cpu->opaque;
439
    int host_sig, core_dumped = 0;
440
    struct sigaction act;
441

442
    host_sig = target_to_host_signal(target_sig);
443
    trace_user_force_sig(env, target_sig, host_sig);
444
    gdb_signalled(env, target_sig);
445

446
    /* dump core if supported by target binary format */
447
    if (core_dump_signal(target_sig) && (ts->bprm->core_dump != NULL)) {
448 449
        stop_all_tasks();
        core_dumped =
450
            ((*ts->bprm->core_dump)(target_sig, env) == 0);
451 452 453 454 455 456 457 458 459
    }
    if (core_dumped) {
        /* we already dumped the core of target process, we don't want
         * a coredump of qemu itself */
        struct rlimit nodump;
        getrlimit(RLIMIT_CORE, &nodump);
        nodump.rlim_cur=0;
        setrlimit(RLIMIT_CORE, &nodump);
        (void) fprintf(stderr, "qemu: uncaught target signal %d (%s) - %s\n",
460
            target_sig, strsignal(host_sig), "core dumped" );
461 462
    }

463
    /* The proper exit code for dying from an uncaught signal is
464 465 466 467 468 469 470
     * -<signal>.  The kernel doesn't allow exit() or _exit() to pass
     * a negative value.  To get the proper exit code we need to
     * actually die from an uncaught signal.  Here the default signal
     * handler is installed, we send ourself a signal and we wait for
     * it to arrive. */
    sigfillset(&act.sa_mask);
    act.sa_handler = SIG_DFL;
471
    act.sa_flags = 0;
472 473 474 475 476 477 478 479 480 481 482 483
    sigaction(host_sig, &act, NULL);

    /* For some reason raise(host_sig) doesn't send the signal when
     * statically linked on x86-64. */
    kill(getpid(), host_sig);

    /* Make sure the signal isn't masked (just reuse the mask inside
    of act) */
    sigdelset(&act.sa_mask, host_sig);
    sigsuspend(&act.sa_mask);

    /* unreachable */
B
Blue Swirl 已提交
484
    abort();
B
bellard 已提交
485 486
}

B
bellard 已提交
487 488
/* queue a signal so that it will be send to the virtual CPU as soon
   as possible */
489
int queue_signal(CPUArchState *env, int sig, target_siginfo_t *info)
490
{
491 492
    CPUState *cpu = ENV_GET_CPU(env);
    TaskState *ts = cpu->opaque;
P
pbrook 已提交
493
    struct emulated_sigtable *k;
B
bellard 已提交
494
    struct sigqueue *q, **pq;
495
    abi_ulong handler;
496
    int queue;
B
bellard 已提交
497

498
    trace_user_queue_signal(env, sig);
P
pbrook 已提交
499
    k = &ts->sigtab[sig - 1];
500
    queue = gdb_queuesig ();
P
pbrook 已提交
501
    handler = sigact_table[sig - 1]._sa_handler;
502 503 504 505 506 507 508 509 510 511 512 513 514

    if (ts->sigsegv_blocked && sig == TARGET_SIGSEGV) {
        /* Guest has blocked SIGSEGV but we got one anyway. Assume this
         * is a forced SIGSEGV (ie one the kernel handles via force_sig_info
         * because it got a real MMU fault). A blocked SIGSEGV in that
         * situation is treated as if using the default handler. This is
         * not correct if some other process has randomly sent us a SIGSEGV
         * via kill(), but that is not easy to distinguish at this point,
         * so we assume it doesn't happen.
         */
        handler = TARGET_SIG_DFL;
    }

515
    if (!queue && handler == TARGET_SIG_DFL) {
516 517 518 519
        if (sig == TARGET_SIGTSTP || sig == TARGET_SIGTTIN || sig == TARGET_SIGTTOU) {
            kill(getpid(),SIGSTOP);
            return 0;
        } else
B
bellard 已提交
520
        /* default handler : ignore some signal. The other are fatal */
521 522
        if (sig != TARGET_SIGCHLD &&
            sig != TARGET_SIGURG &&
523 524
            sig != TARGET_SIGWINCH &&
            sig != TARGET_SIGCONT) {
B
bellard 已提交
525
            force_sig(sig);
B
bellard 已提交
526 527
        } else {
            return 0; /* indicate ignored */
B
bellard 已提交
528
        }
529
    } else if (!queue && handler == TARGET_SIG_IGN) {
B
bellard 已提交
530
        /* ignore signal */
B
bellard 已提交
531
        return 0;
532
    } else if (!queue && handler == TARGET_SIG_ERR) {
B
bellard 已提交
533 534
        force_sig(sig);
    } else {
B
bellard 已提交
535 536 537 538 539 540 541 542 543 544 545 546
        pq = &k->first;
        if (sig < TARGET_SIGRTMIN) {
            /* if non real time signal, we queue exactly one signal */
            if (!k->pending)
                q = &k->info;
            else
                return 0;
        } else {
            if (!k->pending) {
                /* first signal */
                q = &k->info;
            } else {
P
pbrook 已提交
547
                q = alloc_sigqueue(env);
B
bellard 已提交
548 549 550 551 552 553 554 555 556 557 558
                if (!q)
                    return -EAGAIN;
                while (*pq != NULL)
                    pq = &(*pq)->next;
            }
        }
        *pq = q;
        q->info = *info;
        q->next = NULL;
        k->pending = 1;
        /* signal that a new signal is pending */
P
pbrook 已提交
559
        ts->signal_pending = 1;
B
bellard 已提交
560 561 562 563
        return 1; /* indicates that the signal was queued */
    }
}

564
static void host_signal_handler(int host_signum, siginfo_t *info,
B
bellard 已提交
565 566
                                void *puc)
{
567
    CPUArchState *env = thread_cpu->env_ptr;
B
bellard 已提交
568
    int sig;
A
Anthony Liguori 已提交
569
    target_siginfo_t tinfo;
B
bellard 已提交
570 571

    /* the CPU emulator uses some host signals to detect exceptions,
572
       we forward to it some signals */
573
    if ((host_signum == SIGSEGV || host_signum == SIGBUS)
574
        && info->si_code > 0) {
B
bellard 已提交
575
        if (cpu_signal_handler(host_signum, info, puc))
B
bellard 已提交
576 577 578 579 580 581 582
            return;
    }

    /* get target signal number */
    sig = host_to_target_signal(host_signum);
    if (sig < 1 || sig > TARGET_NSIG)
        return;
583
    trace_user_host_signal(env, host_signum, sig);
B
bellard 已提交
584
    host_to_target_siginfo_noswap(&tinfo, info);
585
    if (queue_signal(env, sig, &tinfo) == 1) {
B
bellard 已提交
586
        /* interrupt the virtual CPU as soon as possible */
587
        cpu_exit(thread_cpu);
B
bellard 已提交
588 589 590
    }
}

591
/* do_sigaltstack() returns target values and errnos. */
592 593
/* compare linux/kernel/signal.c:do_sigaltstack() */
abi_long do_sigaltstack(abi_ulong uss_addr, abi_ulong uoss_addr, abi_ulong sp)
594 595 596 597 598
{
    int ret;
    struct target_sigaltstack oss;

    /* XXX: test errors */
599
    if(uoss_addr)
600 601 602 603 604 605
    {
        __put_user(target_sigaltstack_used.ss_sp, &oss.ss_sp);
        __put_user(target_sigaltstack_used.ss_size, &oss.ss_size);
        __put_user(sas_ss_flags(sp), &oss.ss_flags);
    }

606
    if(uss_addr)
607
    {
608 609
        struct target_sigaltstack *uss;
        struct target_sigaltstack ss;
610 611 612 613 614 615 616 617 618
        size_t minstacksize = TARGET_MINSIGSTKSZ;

#if defined(TARGET_PPC64)
        /* ELF V2 for PPC64 has a 4K minimum stack size for signal handlers */
        struct image_info *image = ((TaskState *)thread_cpu->opaque)->info;
        if (get_ppc64_abi(image) > 1) {
            minstacksize = 4096;
        }
#endif
619

620
	ret = -TARGET_EFAULT;
621
        if (!lock_user_struct(VERIFY_READ, uss, uss_addr, 1)) {
622
            goto out;
623 624 625 626
        }
        __get_user(ss.ss_sp, &uss->ss_sp);
        __get_user(ss.ss_size, &uss->ss_size);
        __get_user(ss.ss_flags, &uss->ss_flags);
627
        unlock_user_struct(uss, uss_addr, 0);
628

629
	ret = -TARGET_EPERM;
630 631 632
	if (on_sig_stack(sp))
            goto out;

633
	ret = -TARGET_EINVAL;
634 635 636 637 638 639 640 641 642
	if (ss.ss_flags != TARGET_SS_DISABLE
            && ss.ss_flags != TARGET_SS_ONSTACK
            && ss.ss_flags != 0)
            goto out;

	if (ss.ss_flags == TARGET_SS_DISABLE) {
            ss.ss_size = 0;
            ss.ss_sp = 0;
	} else {
643
            ret = -TARGET_ENOMEM;
644
            if (ss.ss_size < minstacksize) {
645
                goto out;
646
            }
647 648 649 650 651 652
	}

        target_sigaltstack_used.ss_sp = ss.ss_sp;
        target_sigaltstack_used.ss_size = ss.ss_size;
    }

653
    if (uoss_addr) {
654
        ret = -TARGET_EFAULT;
655
        if (copy_to_user(uoss_addr, &oss, sizeof(oss)))
656 657 658 659 660 661 662 663
            goto out;
    }

    ret = 0;
out:
    return ret;
}

664
/* do_sigaction() return host values and errnos */
B
bellard 已提交
665 666 667
int do_sigaction(int sig, const struct target_sigaction *act,
                 struct target_sigaction *oact)
{
P
pbrook 已提交
668
    struct target_sigaction *k;
669 670
    struct sigaction act1;
    int host_sig;
671
    int ret = 0;
B
bellard 已提交
672

T
ths 已提交
673
    if (sig < 1 || sig > TARGET_NSIG || sig == TARGET_SIGKILL || sig == TARGET_SIGSTOP)
B
bellard 已提交
674 675 676
        return -EINVAL;
    k = &sigact_table[sig - 1];
    if (oact) {
677 678
        __put_user(k->_sa_handler, &oact->_sa_handler);
        __put_user(k->sa_flags, &oact->sa_flags);
T
ths 已提交
679
#if !defined(TARGET_MIPS)
680
        __put_user(k->sa_restorer, &oact->sa_restorer);
T
ths 已提交
681
#endif
682
        /* Not swapped.  */
P
pbrook 已提交
683
        oact->sa_mask = k->sa_mask;
B
bellard 已提交
684 685
    }
    if (act) {
P
pbrook 已提交
686
        /* FIXME: This is not threadsafe.  */
687 688
        __get_user(k->_sa_handler, &act->_sa_handler);
        __get_user(k->sa_flags, &act->sa_flags);
T
ths 已提交
689
#if !defined(TARGET_MIPS)
690
        __get_user(k->sa_restorer, &act->sa_restorer);
T
ths 已提交
691
#endif
692
        /* To be swapped in target_to_host_sigset.  */
P
pbrook 已提交
693
        k->sa_mask = act->sa_mask;
694 695 696 697 698 699

        /* we update the host linux signal state */
        host_sig = target_to_host_signal(sig);
        if (host_sig != SIGSEGV && host_sig != SIGBUS) {
            sigfillset(&act1.sa_mask);
            act1.sa_flags = SA_SIGINFO;
P
pbrook 已提交
700
            if (k->sa_flags & TARGET_SA_RESTART)
701 702 703 704
                act1.sa_flags |= SA_RESTART;
            /* NOTE: it is important to update the host kernel signal
               ignore state to avoid getting unexpected interrupted
               syscalls */
P
pbrook 已提交
705
            if (k->_sa_handler == TARGET_SIG_IGN) {
706
                act1.sa_sigaction = (void *)SIG_IGN;
P
pbrook 已提交
707
            } else if (k->_sa_handler == TARGET_SIG_DFL) {
708 709 710 711
                if (fatal_signal (sig))
                    act1.sa_sigaction = host_signal_handler;
                else
                    act1.sa_sigaction = (void *)SIG_DFL;
712 713 714
            } else {
                act1.sa_sigaction = host_signal_handler;
            }
715
            ret = sigaction(host_sig, &act1, NULL);
716
        }
B
bellard 已提交
717
    }
718
    return ret;
B
bellard 已提交
719 720
}

721
#if defined(TARGET_I386) && TARGET_ABI_BITS == 32
B
bellard 已提交
722 723 724 725

/* from the Linux kernel */

struct target_fpreg {
726 727
    uint16_t significand[4];
    uint16_t exponent;
B
bellard 已提交
728 729 730
};

struct target_fpxreg {
731 732 733
    uint16_t significand[4];
    uint16_t exponent;
    uint16_t padding[3];
B
bellard 已提交
734 735 736
};

struct target_xmmreg {
737
    abi_ulong element[4];
B
bellard 已提交
738 739 740
};

struct target_fpstate {
741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759
    /* Regular FPU environment */
    abi_ulong cw;
    abi_ulong sw;
    abi_ulong tag;
    abi_ulong ipoff;
    abi_ulong cssel;
    abi_ulong dataoff;
    abi_ulong datasel;
    struct target_fpreg _st[8];
    uint16_t  status;
    uint16_t  magic;          /* 0xffff = regular FPU data only */

    /* FXSR FPU environment */
    abi_ulong _fxsr_env[6];   /* FXSR FPU env is ignored */
    abi_ulong mxcsr;
    abi_ulong reserved;
    struct target_fpxreg _fxsr_st[8]; /* FXSR FPU reg data is ignored */
    struct target_xmmreg _xmm[8];
    abi_ulong padding[56];
B
bellard 已提交
760 761 762 763 764
};

#define X86_FXSR_MAGIC		0x0000

struct target_sigcontext {
765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786
    uint16_t gs, __gsh;
    uint16_t fs, __fsh;
    uint16_t es, __esh;
    uint16_t ds, __dsh;
    abi_ulong edi;
    abi_ulong esi;
    abi_ulong ebp;
    abi_ulong esp;
    abi_ulong ebx;
    abi_ulong edx;
    abi_ulong ecx;
    abi_ulong eax;
    abi_ulong trapno;
    abi_ulong err;
    abi_ulong eip;
    uint16_t cs, __csh;
    abi_ulong eflags;
    abi_ulong esp_at_signal;
    uint16_t ss, __ssh;
    abi_ulong fpstate; /* pointer */
    abi_ulong oldmask;
    abi_ulong cr2;
B
bellard 已提交
787 788 789
};

struct target_ucontext {
790 791 792 793 794
    abi_ulong         tuc_flags;
    abi_ulong         tuc_link;
    target_stack_t    tuc_stack;
    struct target_sigcontext tuc_mcontext;
    target_sigset_t   tuc_sigmask;  /* mask last for extensibility */
B
bellard 已提交
795 796 797 798
};

struct sigframe
{
799
    abi_ulong pretcode;
B
bellard 已提交
800 801 802
    int sig;
    struct target_sigcontext sc;
    struct target_fpstate fpstate;
803
    abi_ulong extramask[TARGET_NSIG_WORDS-1];
B
bellard 已提交
804 805 806 807 808
    char retcode[8];
};

struct rt_sigframe
{
809
    abi_ulong pretcode;
B
bellard 已提交
810
    int sig;
811 812
    abi_ulong pinfo;
    abi_ulong puc;
B
bellard 已提交
813 814 815 816 817 818 819 820 821 822 823
    struct target_siginfo info;
    struct target_ucontext uc;
    struct target_fpstate fpstate;
    char retcode[8];
};

/*
 * Set up a signal frame.
 */

/* XXX: save x87 state */
824 825 826
static void setup_sigcontext(struct target_sigcontext *sc,
        struct target_fpstate *fpstate, CPUX86State *env, abi_ulong mask,
        abi_ulong fpstate_addr)
B
bellard 已提交
827
{
828 829
    CPUState *cs = CPU(x86_env_get_cpu(env));
    uint16_t magic;
B
bellard 已提交
830

831
    /* already locked in setup_frame() */
832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
    __put_user(env->segs[R_GS].selector, (unsigned int *)&sc->gs);
    __put_user(env->segs[R_FS].selector, (unsigned int *)&sc->fs);
    __put_user(env->segs[R_ES].selector, (unsigned int *)&sc->es);
    __put_user(env->segs[R_DS].selector, (unsigned int *)&sc->ds);
    __put_user(env->regs[R_EDI], &sc->edi);
    __put_user(env->regs[R_ESI], &sc->esi);
    __put_user(env->regs[R_EBP], &sc->ebp);
    __put_user(env->regs[R_ESP], &sc->esp);
    __put_user(env->regs[R_EBX], &sc->ebx);
    __put_user(env->regs[R_EDX], &sc->edx);
    __put_user(env->regs[R_ECX], &sc->ecx);
    __put_user(env->regs[R_EAX], &sc->eax);
    __put_user(cs->exception_index, &sc->trapno);
    __put_user(env->error_code, &sc->err);
    __put_user(env->eip, &sc->eip);
    __put_user(env->segs[R_CS].selector, (unsigned int *)&sc->cs);
    __put_user(env->eflags, &sc->eflags);
    __put_user(env->regs[R_ESP], &sc->esp_at_signal);
    __put_user(env->segs[R_SS].selector, (unsigned int *)&sc->ss);
B
bellard 已提交
851

852 853 854
    cpu_x86_fsave(env, fpstate_addr, 1);
    fpstate->status = fpstate->sw;
    magic = 0xffff;
855 856
    __put_user(magic, &fpstate->magic);
    __put_user(fpstate_addr, &sc->fpstate);
B
bellard 已提交
857

858
    /* non-iBCS2 extensions.. */
859 860
    __put_user(mask, &sc->oldmask);
    __put_user(env->cr[2], &sc->cr2);
861 862
}

B
bellard 已提交
863 864 865
/*
 * Determine which stack to use..
 */
866

867
static inline abi_ulong
P
pbrook 已提交
868
get_sigframe(struct target_sigaction *ka, CPUX86State *env, size_t frame_size)
869
{
870
    unsigned long esp;
B
bellard 已提交
871

872 873 874 875 876 877
    /* Default to using normal stack */
    esp = env->regs[R_ESP];
    /* This is the X/Open sanctioned signal stack switching.  */
    if (ka->sa_flags & TARGET_SA_ONSTACK) {
        if (sas_ss_flags(esp) == 0) {
            esp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
878
        }
879
    } else {
B
bellard 已提交
880

881
        /* This is the legacy signal stack switching. */
882
        if ((env->segs[R_SS].selector & 0xffff) != __USER_DS &&
883 884
                !(ka->sa_flags & TARGET_SA_RESTORER) &&
                ka->sa_restorer) {
P
pbrook 已提交
885
            esp = (unsigned long) ka->sa_restorer;
886 887 888
        }
    }
    return (esp - frame_size) & -8ul;
B
bellard 已提交
889 890
}

891
/* compare linux/arch/i386/kernel/signal.c:setup_frame() */
P
pbrook 已提交
892
static void setup_frame(int sig, struct target_sigaction *ka,
893
                        target_sigset_t *set, CPUX86State *env)
B
bellard 已提交
894
{
895 896 897
    abi_ulong frame_addr;
    struct sigframe *frame;
    int i;
B
bellard 已提交
898

899 900
    frame_addr = get_sigframe(ka, env, sizeof(*frame));
    trace_user_setup_frame(env, frame_addr);
B
bellard 已提交
901

902 903
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
        goto give_sigsegv;
904

905
    __put_user(sig, &frame->sig);
B
bellard 已提交
906

907 908
    setup_sigcontext(&frame->sc, &frame->fpstate, env, set->sig[0],
            frame_addr + offsetof(struct sigframe, fpstate));
B
bellard 已提交
909

910 911 912
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &frame->extramask[i - 1]);
    }
B
bellard 已提交
913

914 915 916
    /* Set up to return from userspace.  If provided, use a stub
       already in userspace.  */
    if (ka->sa_flags & TARGET_SA_RESTORER) {
917
        __put_user(ka->sa_restorer, &frame->pretcode);
918 919 920 921
    } else {
        uint16_t val16;
        abi_ulong retcode_addr;
        retcode_addr = frame_addr + offsetof(struct sigframe, retcode);
922
        __put_user(retcode_addr, &frame->pretcode);
923 924
        /* This is popl %eax ; movl $,%eax ; int $0x80 */
        val16 = 0xb858;
925 926
        __put_user(val16, (uint16_t *)(frame->retcode+0));
        __put_user(TARGET_NR_sigreturn, (int *)(frame->retcode+2));
927
        val16 = 0x80cd;
928
        __put_user(val16, (uint16_t *)(frame->retcode+6));
929
    }
B
bellard 已提交
930 931


932 933 934
    /* Set up registers for signal handler */
    env->regs[R_ESP] = frame_addr;
    env->eip = ka->_sa_handler;
B
bellard 已提交
935

936 937 938 939 940
    cpu_x86_load_seg(env, R_DS, __USER_DS);
    cpu_x86_load_seg(env, R_ES, __USER_DS);
    cpu_x86_load_seg(env, R_SS, __USER_DS);
    cpu_x86_load_seg(env, R_CS, __USER_CS);
    env->eflags &= ~TF_MASK;
B
bellard 已提交
941

942
    unlock_user_struct(frame, frame_addr, 1);
943

944
    return;
B
bellard 已提交
945 946

give_sigsegv:
947 948 949 950
    if (sig == TARGET_SIGSEGV) {
        ka->_sa_handler = TARGET_SIG_DFL;
    }
    force_sig(TARGET_SIGSEGV /* , current */);
B
bellard 已提交
951 952
}

953
/* compare linux/arch/i386/kernel/signal.c:setup_rt_frame() */
P
pbrook 已提交
954
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
955
                           target_siginfo_t *info,
956
                           target_sigset_t *set, CPUX86State *env)
B
bellard 已提交
957
{
958 959 960
    abi_ulong frame_addr, addr;
    struct rt_sigframe *frame;
    int i;
B
bellard 已提交
961

962 963
    frame_addr = get_sigframe(ka, env, sizeof(*frame));
    trace_user_setup_rt_frame(env, frame_addr);
B
bellard 已提交
964

965 966
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
        goto give_sigsegv;
B
bellard 已提交
967

968
    __put_user(sig, &frame->sig);
969
    addr = frame_addr + offsetof(struct rt_sigframe, info);
970
    __put_user(addr, &frame->pinfo);
971
    addr = frame_addr + offsetof(struct rt_sigframe, uc);
972
    __put_user(addr, &frame->puc);
973
    tswap_siginfo(&frame->info, info);
974

975
    /* Create the ucontext.  */
976 977 978 979 980 981 982
    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, &frame->uc.tuc_link);
    __put_user(target_sigaltstack_used.ss_sp, &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
               &frame->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size,
               &frame->uc.tuc_stack.ss_size);
983 984 985
    setup_sigcontext(&frame->uc.tuc_mcontext, &frame->fpstate, env,
            set->sig[0], frame_addr + offsetof(struct rt_sigframe, fpstate));

986 987 988
    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
    }
989

990 991 992
    /* Set up to return from userspace.  If provided, use a stub
       already in userspace.  */
    if (ka->sa_flags & TARGET_SA_RESTORER) {
993
        __put_user(ka->sa_restorer, &frame->pretcode);
994 995 996
    } else {
        uint16_t val16;
        addr = frame_addr + offsetof(struct rt_sigframe, retcode);
997
        __put_user(addr, &frame->pretcode);
998
        /* This is movl $,%eax ; int $0x80 */
999 1000
        __put_user(0xb8, (char *)(frame->retcode+0));
        __put_user(TARGET_NR_rt_sigreturn, (int *)(frame->retcode+1));
1001
        val16 = 0x80cd;
1002
        __put_user(val16, (uint16_t *)(frame->retcode+5));
1003
    }
B
bellard 已提交
1004

1005 1006 1007
    /* Set up registers for signal handler */
    env->regs[R_ESP] = frame_addr;
    env->eip = ka->_sa_handler;
B
bellard 已提交
1008

1009 1010 1011 1012 1013
    cpu_x86_load_seg(env, R_DS, __USER_DS);
    cpu_x86_load_seg(env, R_ES, __USER_DS);
    cpu_x86_load_seg(env, R_SS, __USER_DS);
    cpu_x86_load_seg(env, R_CS, __USER_CS);
    env->eflags &= ~TF_MASK;
B
bellard 已提交
1014

1015
    unlock_user_struct(frame, frame_addr, 1);
1016

1017
    return;
B
bellard 已提交
1018 1019

give_sigsegv:
1020 1021 1022 1023
    if (sig == TARGET_SIGSEGV) {
        ka->_sa_handler = TARGET_SIG_DFL;
    }
    force_sig(TARGET_SIGSEGV /* , current */);
B
bellard 已提交
1024 1025 1026
}

static int
1027
restore_sigcontext(CPUX86State *env, struct target_sigcontext *sc)
B
bellard 已提交
1028
{
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
    unsigned int err = 0;
    abi_ulong fpstate_addr;
    unsigned int tmpflags;

    cpu_x86_load_seg(env, R_GS, tswap16(sc->gs));
    cpu_x86_load_seg(env, R_FS, tswap16(sc->fs));
    cpu_x86_load_seg(env, R_ES, tswap16(sc->es));
    cpu_x86_load_seg(env, R_DS, tswap16(sc->ds));

    env->regs[R_EDI] = tswapl(sc->edi);
    env->regs[R_ESI] = tswapl(sc->esi);
    env->regs[R_EBP] = tswapl(sc->ebp);
    env->regs[R_ESP] = tswapl(sc->esp);
    env->regs[R_EBX] = tswapl(sc->ebx);
    env->regs[R_EDX] = tswapl(sc->edx);
    env->regs[R_ECX] = tswapl(sc->ecx);
1045
    env->regs[R_EAX] = tswapl(sc->eax);
1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061
    env->eip = tswapl(sc->eip);

    cpu_x86_load_seg(env, R_CS, lduw_p(&sc->cs) | 3);
    cpu_x86_load_seg(env, R_SS, lduw_p(&sc->ss) | 3);

    tmpflags = tswapl(sc->eflags);
    env->eflags = (env->eflags & ~0x40DD5) | (tmpflags & 0x40DD5);
    //		regs->orig_eax = -1;		/* disable syscall checks */

    fpstate_addr = tswapl(sc->fpstate);
    if (fpstate_addr != 0) {
        if (!access_ok(VERIFY_READ, fpstate_addr,
                       sizeof(struct target_fpstate)))
            goto badframe;
        cpu_x86_frstor(env, fpstate_addr, 1);
    }
B
bellard 已提交
1062

1063
    return err;
B
bellard 已提交
1064
badframe:
1065
    return 1;
B
bellard 已提交
1066 1067 1068 1069
}

long do_sigreturn(CPUX86State *env)
{
1070 1071
    struct sigframe *frame;
    abi_ulong frame_addr = env->regs[R_ESP] - 8;
A
Anthony Liguori 已提交
1072
    target_sigset_t target_set;
B
bellard 已提交
1073
    sigset_t set;
1074
    int i;
B
bellard 已提交
1075

1076
    trace_user_do_sigreturn(env, frame_addr);
1077 1078
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
        goto badframe;
B
bellard 已提交
1079
    /* set blocked signals */
1080
    __get_user(target_set.sig[0], &frame->sc.oldmask);
1081
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1082
        __get_user(target_set.sig[i], &frame->extramask[i - 1]);
1083
    }
B
bellard 已提交
1084

1085
    target_to_host_sigset_internal(&set, &target_set);
1086
    do_sigprocmask(SIG_SETMASK, &set, NULL);
1087

B
bellard 已提交
1088
    /* restore registers */
1089
    if (restore_sigcontext(env, &frame->sc))
B
bellard 已提交
1090
        goto badframe;
1091
    unlock_user_struct(frame, frame_addr, 0);
1092
    return -TARGET_QEMU_ESIGRETURN;
B
bellard 已提交
1093 1094

badframe:
1095
    unlock_user_struct(frame, frame_addr, 0);
B
bellard 已提交
1096 1097 1098 1099 1100 1101
    force_sig(TARGET_SIGSEGV);
    return 0;
}

long do_rt_sigreturn(CPUX86State *env)
{
1102 1103 1104
    abi_ulong frame_addr;
    struct rt_sigframe *frame;
    sigset_t set;
B
bellard 已提交
1105

1106 1107 1108 1109 1110 1111
    frame_addr = env->regs[R_ESP] - 4;
    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);
    do_sigprocmask(SIG_SETMASK, &set, NULL);
1112

1113
    if (restore_sigcontext(env, &frame->uc.tuc_mcontext)) {
1114 1115
        goto badframe;
    }
B
bellard 已提交
1116

1117 1118 1119 1120
    if (do_sigaltstack(frame_addr + offsetof(struct rt_sigframe, uc.tuc_stack), 0,
                       get_sp_from_cpustate(env)) == -EFAULT) {
        goto badframe;
    }
1121

1122
    unlock_user_struct(frame, frame_addr, 0);
1123
    return -TARGET_QEMU_ESIGRETURN;
B
bellard 已提交
1124 1125

badframe:
1126 1127 1128
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
    return 0;
B
bellard 已提交
1129 1130
}

1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209
#elif defined(TARGET_AARCH64)

struct target_sigcontext {
    uint64_t fault_address;
    /* AArch64 registers */
    uint64_t regs[31];
    uint64_t sp;
    uint64_t pc;
    uint64_t pstate;
    /* 4K reserved for FP/SIMD state and future expansion */
    char __reserved[4096] __attribute__((__aligned__(16)));
};

struct target_ucontext {
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
    target_stack_t tuc_stack;
    target_sigset_t tuc_sigmask;
    /* glibc uses a 1024-bit sigset_t */
    char __unused[1024 / 8 - sizeof(target_sigset_t)];
    /* last for future expansion */
    struct target_sigcontext tuc_mcontext;
};

/*
 * Header to be used at the beginning of structures extending the user
 * context. Such structures must be placed after the rt_sigframe on the stack
 * and be 16-byte aligned. The last structure must be a dummy one with the
 * magic and size set to 0.
 */
struct target_aarch64_ctx {
    uint32_t magic;
    uint32_t size;
};

#define TARGET_FPSIMD_MAGIC 0x46508001

struct target_fpsimd_context {
    struct target_aarch64_ctx head;
    uint32_t fpsr;
    uint32_t fpcr;
    uint64_t vregs[32 * 2]; /* really uint128_t vregs[32] */
};

/*
 * Auxiliary context saved in the sigcontext.__reserved array. Not exported to
 * user space as it will change with the addition of new context. User space
 * should check the magic/size information.
 */
struct target_aux_context {
    struct target_fpsimd_context fpsimd;
    /* additional context to be added before "end" */
    struct target_aarch64_ctx end;
};

struct target_rt_sigframe {
    struct target_siginfo info;
    struct target_ucontext uc;
    uint64_t fp;
    uint64_t lr;
    uint32_t tramp[2];
};

static int target_setup_sigframe(struct target_rt_sigframe *sf,
                                 CPUARMState *env, target_sigset_t *set)
{
    int i;
    struct target_aux_context *aux =
        (struct target_aux_context *)sf->uc.tuc_mcontext.__reserved;

    /* set up the stack frame for unwinding */
    __put_user(env->xregs[29], &sf->fp);
    __put_user(env->xregs[30], &sf->lr);

    for (i = 0; i < 31; i++) {
        __put_user(env->xregs[i], &sf->uc.tuc_mcontext.regs[i]);
    }
    __put_user(env->xregs[31], &sf->uc.tuc_mcontext.sp);
    __put_user(env->pc, &sf->uc.tuc_mcontext.pc);
1210
    __put_user(pstate_read(env), &sf->uc.tuc_mcontext.pstate);
1211

1212
    __put_user(env->exception.vaddress, &sf->uc.tuc_mcontext.fault_address);
1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226

    for (i = 0; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &sf->uc.tuc_sigmask.sig[i]);
    }

    for (i = 0; i < 32; i++) {
#ifdef TARGET_WORDS_BIGENDIAN
        __put_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2 + 1]);
        __put_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2]);
#else
        __put_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2]);
        __put_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2 + 1]);
#endif
    }
1227 1228
    __put_user(vfp_get_fpsr(env), &aux->fpsimd.fpsr);
    __put_user(vfp_get_fpcr(env), &aux->fpsimd.fpcr);
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246
    __put_user(TARGET_FPSIMD_MAGIC, &aux->fpsimd.head.magic);
    __put_user(sizeof(struct target_fpsimd_context),
            &aux->fpsimd.head.size);

    /* set the "end" magic */
    __put_user(0, &aux->end.magic);
    __put_user(0, &aux->end.size);

    return 0;
}

static int target_restore_sigframe(CPUARMState *env,
                                   struct target_rt_sigframe *sf)
{
    sigset_t set;
    int i;
    struct target_aux_context *aux =
        (struct target_aux_context *)sf->uc.tuc_mcontext.__reserved;
1247
    uint32_t magic, size, fpsr, fpcr;
1248
    uint64_t pstate;
1249 1250

    target_to_host_sigset(&set, &sf->uc.tuc_sigmask);
1251
    do_sigprocmask(SIG_SETMASK, &set, NULL);
1252 1253 1254 1255 1256 1257 1258

    for (i = 0; i < 31; i++) {
        __get_user(env->xregs[i], &sf->uc.tuc_mcontext.regs[i]);
    }

    __get_user(env->xregs[31], &sf->uc.tuc_mcontext.sp);
    __get_user(env->pc, &sf->uc.tuc_mcontext.pc);
1259 1260
    __get_user(pstate, &sf->uc.tuc_mcontext.pstate);
    pstate_write(env, pstate);
1261 1262 1263 1264 1265 1266 1267 1268 1269

    __get_user(magic, &aux->fpsimd.head.magic);
    __get_user(size, &aux->fpsimd.head.size);

    if (magic != TARGET_FPSIMD_MAGIC
        || size != sizeof(struct target_fpsimd_context)) {
        return 1;
    }

1270 1271 1272 1273 1274 1275 1276 1277
    for (i = 0; i < 32; i++) {
#ifdef TARGET_WORDS_BIGENDIAN
        __get_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2 + 1]);
        __get_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2]);
#else
        __get_user(env->vfp.regs[i * 2], &aux->fpsimd.vregs[i * 2]);
        __get_user(env->vfp.regs[i * 2 + 1], &aux->fpsimd.vregs[i * 2 + 1]);
#endif
1278
    }
1279 1280 1281 1282
    __get_user(fpsr, &aux->fpsimd.fpsr);
    vfp_set_fpsr(env, fpsr);
    __get_user(fpcr, &aux->fpsimd.fpcr);
    vfp_set_fpcr(env, fpcr);
1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295

    return 0;
}

static abi_ulong get_sigframe(struct target_sigaction *ka, CPUARMState *env)
{
    abi_ulong sp;

    sp = env->xregs[31];

    /*
     * This is the X/Open sanctioned signal stack switching.
     */
1296
    if ((ka->sa_flags & TARGET_SA_ONSTACK) && !sas_ss_flags(sp)) {
1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }

    sp = (sp - sizeof(struct target_rt_sigframe)) & ~15;

    return sp;
}

static void target_setup_frame(int usig, struct target_sigaction *ka,
                               target_siginfo_t *info, target_sigset_t *set,
                               CPUARMState *env)
{
    struct target_rt_sigframe *frame;
1310
    abi_ulong frame_addr, return_addr;
1311 1312

    frame_addr = get_sigframe(ka, env);
1313
    trace_user_setup_frame(env, frame_addr);
1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }

    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, &frame->uc.tuc_link);

    __put_user(target_sigaltstack_used.ss_sp,
                      &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(env->xregs[31]),
                      &frame->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size,
                      &frame->uc.tuc_stack.ss_size);
    target_setup_sigframe(frame, env, set);
1328 1329 1330 1331 1332 1333 1334 1335
    if (ka->sa_flags & TARGET_SA_RESTORER) {
        return_addr = ka->sa_restorer;
    } else {
        /* mov x8,#__NR_rt_sigreturn; svc #0 */
        __put_user(0xd2801168, &frame->tramp[0]);
        __put_user(0xd4000001, &frame->tramp[1]);
        return_addr = frame_addr + offsetof(struct target_rt_sigframe, tramp);
    }
1336 1337 1338 1339
    env->xregs[0] = usig;
    env->xregs[31] = frame_addr;
    env->xregs[29] = env->xregs[31] + offsetof(struct target_rt_sigframe, fp);
    env->pc = ka->_sa_handler;
1340
    env->xregs[30] = return_addr;
1341
    if (info) {
1342
        tswap_siginfo(&frame->info, info);
1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369
        env->xregs[1] = frame_addr + offsetof(struct target_rt_sigframe, info);
        env->xregs[2] = frame_addr + offsetof(struct target_rt_sigframe, uc);
    }

    unlock_user_struct(frame, frame_addr, 1);
    return;

 give_sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
    force_sig(TARGET_SIGSEGV);
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
                           target_siginfo_t *info, target_sigset_t *set,
                           CPUARMState *env)
{
    target_setup_frame(sig, ka, info, set, env);
}

static void setup_frame(int sig, struct target_sigaction *ka,
                        target_sigset_t *set, CPUARMState *env)
{
    target_setup_frame(sig, ka, 0, set, env);
}

long do_rt_sigreturn(CPUARMState *env)
{
1370
    struct target_rt_sigframe *frame = NULL;
1371 1372
    abi_ulong frame_addr = env->xregs[31];

1373
    trace_user_do_rt_sigreturn(env, frame_addr);
1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392
    if (frame_addr & 15) {
        goto badframe;
    }

    if  (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }

    if (target_restore_sigframe(env, frame)) {
        goto badframe;
    }

    if (do_sigaltstack(frame_addr +
            offsetof(struct target_rt_sigframe, uc.tuc_stack),
            0, get_sp_from_cpustate(env)) == -EFAULT) {
        goto badframe;
    }

    unlock_user_struct(frame, frame_addr, 0);
1393
    return -TARGET_QEMU_ESIGRETURN;
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405

 badframe:
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
    return 0;
}

long do_sigreturn(CPUARMState *env)
{
    return do_rt_sigreturn(env);
}

B
bellard 已提交
1406 1407 1408
#elif defined(TARGET_ARM)

struct target_sigcontext {
1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429
    abi_ulong trap_no;
    abi_ulong error_code;
    abi_ulong oldmask;
    abi_ulong arm_r0;
    abi_ulong arm_r1;
    abi_ulong arm_r2;
    abi_ulong arm_r3;
    abi_ulong arm_r4;
    abi_ulong arm_r5;
    abi_ulong arm_r6;
    abi_ulong arm_r7;
    abi_ulong arm_r8;
    abi_ulong arm_r9;
    abi_ulong arm_r10;
    abi_ulong arm_fp;
    abi_ulong arm_ip;
    abi_ulong arm_sp;
    abi_ulong arm_lr;
    abi_ulong arm_pc;
    abi_ulong arm_cpsr;
    abi_ulong fault_address;
B
bellard 已提交
1430 1431
};

P
pbrook 已提交
1432 1433 1434
struct target_ucontext_v1 {
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
A
Anthony Liguori 已提交
1435
    target_stack_t tuc_stack;
P
pbrook 已提交
1436
    struct target_sigcontext tuc_mcontext;
A
Anthony Liguori 已提交
1437
    target_sigset_t  tuc_sigmask;	/* mask last for extensibility */
P
pbrook 已提交
1438 1439 1440
};

struct target_ucontext_v2 {
1441 1442
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
A
Anthony Liguori 已提交
1443
    target_stack_t tuc_stack;
B
bellard 已提交
1444
    struct target_sigcontext tuc_mcontext;
A
Anthony Liguori 已提交
1445
    target_sigset_t  tuc_sigmask;	/* mask last for extensibility */
1446
    char __unused[128 - sizeof(target_sigset_t)];
P
pbrook 已提交
1447
    abi_ulong tuc_regspace[128] __attribute__((__aligned__(8)));
B
bellard 已提交
1448 1449
};

1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
struct target_user_vfp {
    uint64_t fpregs[32];
    abi_ulong fpscr;
};

struct target_user_vfp_exc {
    abi_ulong fpexc;
    abi_ulong fpinst;
    abi_ulong fpinst2;
};

struct target_vfp_sigframe {
    abi_ulong magic;
    abi_ulong size;
    struct target_user_vfp ufp;
    struct target_user_vfp_exc ufp_exc;
} __attribute__((__aligned__(8)));

1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480
struct target_iwmmxt_sigframe {
    abi_ulong magic;
    abi_ulong size;
    uint64_t regs[16];
    /* Note that not all the coprocessor control registers are stored here */
    uint32_t wcssf;
    uint32_t wcasf;
    uint32_t wcgr0;
    uint32_t wcgr1;
    uint32_t wcgr2;
    uint32_t wcgr3;
} __attribute__((__aligned__(8)));

1481
#define TARGET_VFP_MAGIC 0x56465001
1482
#define TARGET_IWMMXT_MAGIC 0x12ef842a
1483

P
pbrook 已提交
1484
struct sigframe_v1
B
bellard 已提交
1485 1486
{
    struct target_sigcontext sc;
1487 1488
    abi_ulong extramask[TARGET_NSIG_WORDS-1];
    abi_ulong retcode;
B
bellard 已提交
1489 1490
};

P
pbrook 已提交
1491 1492 1493 1494 1495 1496
struct sigframe_v2
{
    struct target_ucontext_v2 uc;
    abi_ulong retcode;
};

P
pbrook 已提交
1497
struct rt_sigframe_v1
B
bellard 已提交
1498
{
B
bellard 已提交
1499 1500
    abi_ulong pinfo;
    abi_ulong puc;
B
bellard 已提交
1501
    struct target_siginfo info;
P
pbrook 已提交
1502 1503 1504 1505 1506 1507 1508 1509
    struct target_ucontext_v1 uc;
    abi_ulong retcode;
};

struct rt_sigframe_v2
{
    struct target_siginfo info;
    struct target_ucontext_v2 uc;
1510
    abi_ulong retcode;
B
bellard 已提交
1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527
};

#define TARGET_CONFIG_CPU_32 1

/*
 * For ARM syscalls, we encode the syscall number into the instruction.
 */
#define SWI_SYS_SIGRETURN	(0xef000000|(TARGET_NR_sigreturn + ARM_SYSCALL_BASE))
#define SWI_SYS_RT_SIGRETURN	(0xef000000|(TARGET_NR_rt_sigreturn + ARM_SYSCALL_BASE))

/*
 * For Thumb syscalls, we pass the syscall number via r7.  We therefore
 * need two 16-bit instructions.
 */
#define SWI_THUMB_SIGRETURN	(0xdf00 << 16 | 0x2700 | (TARGET_NR_sigreturn))
#define SWI_THUMB_RT_SIGRETURN	(0xdf00 << 16 | 0x2700 | (TARGET_NR_rt_sigreturn))

1528
static const abi_ulong retcodes[4] = {
B
bellard 已提交
1529 1530 1531 1532 1533
	SWI_SYS_SIGRETURN,	SWI_THUMB_SIGRETURN,
	SWI_SYS_RT_SIGRETURN,	SWI_THUMB_RT_SIGRETURN
};


1534
static inline int valid_user_regs(CPUARMState *regs)
B
bellard 已提交
1535 1536 1537 1538
{
    return 1;
}

P
pbrook 已提交
1539
static void
B
bellard 已提交
1540
setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1541
                 CPUARMState *env, abi_ulong mask)
B
bellard 已提交
1542
{
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558
    __put_user(env->regs[0], &sc->arm_r0);
    __put_user(env->regs[1], &sc->arm_r1);
    __put_user(env->regs[2], &sc->arm_r2);
    __put_user(env->regs[3], &sc->arm_r3);
    __put_user(env->regs[4], &sc->arm_r4);
    __put_user(env->regs[5], &sc->arm_r5);
    __put_user(env->regs[6], &sc->arm_r6);
    __put_user(env->regs[7], &sc->arm_r7);
    __put_user(env->regs[8], &sc->arm_r8);
    __put_user(env->regs[9], &sc->arm_r9);
    __put_user(env->regs[10], &sc->arm_r10);
    __put_user(env->regs[11], &sc->arm_fp);
    __put_user(env->regs[12], &sc->arm_ip);
    __put_user(env->regs[13], &sc->arm_sp);
    __put_user(env->regs[14], &sc->arm_lr);
    __put_user(env->regs[15], &sc->arm_pc);
B
bellard 已提交
1559
#ifdef TARGET_CONFIG_CPU_32
1560
    __put_user(cpsr_read(env), &sc->arm_cpsr);
B
bellard 已提交
1561 1562
#endif

1563 1564 1565 1566
    __put_user(/* current->thread.trap_no */ 0, &sc->trap_no);
    __put_user(/* current->thread.error_code */ 0, &sc->error_code);
    __put_user(/* current->thread.address */ 0, &sc->fault_address);
    __put_user(mask, &sc->oldmask);
B
bellard 已提交
1567 1568
}

1569
static inline abi_ulong
1570
get_sigframe(struct target_sigaction *ka, CPUARMState *regs, int framesize)
B
bellard 已提交
1571
{
1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583
    unsigned long sp = regs->regs[13];

    /*
     * This is the X/Open sanctioned signal stack switching.
     */
    if ((ka->sa_flags & TARGET_SA_ONSTACK) && !sas_ss_flags(sp)) {
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }
    /*
     * ATPCS B01 mandates 8-byte alignment
     */
    return (sp - framesize) & ~7;
B
bellard 已提交
1584 1585
}

1586
static void
1587
setup_return(CPUARMState *env, struct target_sigaction *ka,
1588
             abi_ulong *rc, abi_ulong frame_addr, int usig, abi_ulong rc_addr)
B
bellard 已提交
1589
{
1590 1591 1592 1593
    abi_ulong handler = ka->_sa_handler;
    abi_ulong retcode;
    int thumb = handler & 1;
    uint32_t cpsr = cpsr_read(env);
B
bellard 已提交
1594

1595 1596 1597 1598 1599 1600
    cpsr &= ~CPSR_IT;
    if (thumb) {
        cpsr |= CPSR_T;
    } else {
        cpsr &= ~CPSR_T;
    }
B
bellard 已提交
1601

1602 1603 1604 1605 1606 1607 1608 1609
    if (ka->sa_flags & TARGET_SA_RESTORER) {
        retcode = ka->sa_restorer;
    } else {
        unsigned int idx = thumb;

        if (ka->sa_flags & TARGET_SA_SIGINFO) {
            idx += 2;
        }
B
bellard 已提交
1610

1611
        __put_user(retcodes[idx], rc);
S
Stefan Weil 已提交
1612

1613 1614
        retcode = rc_addr + thumb;
    }
B
bellard 已提交
1615

1616 1617 1618 1619 1620
    env->regs[0] = usig;
    env->regs[13] = frame_addr;
    env->regs[14] = retcode;
    env->regs[15] = handler & (thumb ? ~1 : ~3);
    cpsr_write(env, cpsr, CPSR_IT | CPSR_T, CPSRWriteByInstr);
B
bellard 已提交
1621 1622
}

1623
static abi_ulong *setup_sigframe_v2_vfp(abi_ulong *regspace, CPUARMState *env)
1624 1625 1626 1627 1628 1629 1630
{
    int i;
    struct target_vfp_sigframe *vfpframe;
    vfpframe = (struct target_vfp_sigframe *)regspace;
    __put_user(TARGET_VFP_MAGIC, &vfpframe->magic);
    __put_user(sizeof(*vfpframe), &vfpframe->size);
    for (i = 0; i < 32; i++) {
1631
        __put_user(float64_val(env->vfp.regs[i]), &vfpframe->ufp.fpregs[i]);
1632 1633 1634 1635 1636 1637 1638 1639
    }
    __put_user(vfp_get_fpscr(env), &vfpframe->ufp.fpscr);
    __put_user(env->vfp.xregs[ARM_VFP_FPEXC], &vfpframe->ufp_exc.fpexc);
    __put_user(env->vfp.xregs[ARM_VFP_FPINST], &vfpframe->ufp_exc.fpinst);
    __put_user(env->vfp.xregs[ARM_VFP_FPINST2], &vfpframe->ufp_exc.fpinst2);
    return (abi_ulong*)(vfpframe+1);
}

1640 1641
static abi_ulong *setup_sigframe_v2_iwmmxt(abi_ulong *regspace,
                                           CPUARMState *env)
1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659
{
    int i;
    struct target_iwmmxt_sigframe *iwmmxtframe;
    iwmmxtframe = (struct target_iwmmxt_sigframe *)regspace;
    __put_user(TARGET_IWMMXT_MAGIC, &iwmmxtframe->magic);
    __put_user(sizeof(*iwmmxtframe), &iwmmxtframe->size);
    for (i = 0; i < 16; i++) {
        __put_user(env->iwmmxt.regs[i], &iwmmxtframe->regs[i]);
    }
    __put_user(env->vfp.xregs[ARM_IWMMXT_wCSSF], &iwmmxtframe->wcssf);
    __put_user(env->vfp.xregs[ARM_IWMMXT_wCASF], &iwmmxtframe->wcssf);
    __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR0], &iwmmxtframe->wcgr0);
    __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR1], &iwmmxtframe->wcgr1);
    __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR2], &iwmmxtframe->wcgr2);
    __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR3], &iwmmxtframe->wcgr3);
    return (abi_ulong*)(iwmmxtframe+1);
}

P
pbrook 已提交
1660
static void setup_sigframe_v2(struct target_ucontext_v2 *uc,
1661
                              target_sigset_t *set, CPUARMState *env)
P
pbrook 已提交
1662 1663 1664
{
    struct target_sigaltstack stack;
    int i;
1665
    abi_ulong *regspace;
P
pbrook 已提交
1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676

    /* Clear all the bits of the ucontext we don't use.  */
    memset(uc, 0, offsetof(struct target_ucontext_v2, tuc_mcontext));

    memset(&stack, 0, sizeof(stack));
    __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
    __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
    __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
    memcpy(&uc->tuc_stack, &stack, sizeof(stack));

    setup_sigcontext(&uc->tuc_mcontext, env, set->sig[0]);
1677 1678 1679 1680 1681
    /* Save coprocessor signal frame.  */
    regspace = uc->tuc_regspace;
    if (arm_feature(env, ARM_FEATURE_VFP)) {
        regspace = setup_sigframe_v2_vfp(regspace, env);
    }
1682 1683 1684 1685
    if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
        regspace = setup_sigframe_v2_iwmmxt(regspace, env);
    }

1686 1687 1688
    /* Write terminating magic word */
    __put_user(0, regspace);

P
pbrook 已提交
1689 1690 1691 1692 1693
    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &uc->tuc_sigmask.sig[i]);
    }
}

1694
/* compare linux/arch/arm/kernel/signal.c:setup_frame() */
P
pbrook 已提交
1695
static void setup_frame_v1(int usig, struct target_sigaction *ka,
1696
                           target_sigset_t *set, CPUARMState *regs)
B
bellard 已提交
1697
{
1698 1699 1700
    struct sigframe_v1 *frame;
    abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
    int i;
B
bellard 已提交
1701

1702 1703 1704 1705
    trace_user_setup_frame(regs, frame_addr);
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        return;
    }
1706

1707
    setup_sigcontext(&frame->sc, regs, set->sig[0]);
B
bellard 已提交
1708

1709 1710 1711
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &frame->extramask[i - 1]);
    }
B
bellard 已提交
1712

1713 1714
    setup_return(regs, ka, &frame->retcode, frame_addr, usig,
                 frame_addr + offsetof(struct sigframe_v1, retcode));
1715

1716
    unlock_user_struct(frame, frame_addr, 1);
P
pbrook 已提交
1717 1718
}

P
pbrook 已提交
1719
static void setup_frame_v2(int usig, struct target_sigaction *ka,
1720
                           target_sigset_t *set, CPUARMState *regs)
P
pbrook 已提交
1721
{
1722 1723
    struct sigframe_v2 *frame;
    abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
P
pbrook 已提交
1724

1725 1726 1727 1728
    trace_user_setup_frame(regs, frame_addr);
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        return;
    }
P
pbrook 已提交
1729

1730
    setup_sigframe_v2(&frame->uc, set, regs);
P
pbrook 已提交
1731

1732 1733
    setup_return(regs, ka, &frame->retcode, frame_addr, usig,
                 frame_addr + offsetof(struct sigframe_v2, retcode));
P
pbrook 已提交
1734

1735
    unlock_user_struct(frame, frame_addr, 1);
P
pbrook 已提交
1736 1737
}

P
pbrook 已提交
1738
static void setup_frame(int usig, struct target_sigaction *ka,
1739
                        target_sigset_t *set, CPUARMState *regs)
P
pbrook 已提交
1740 1741 1742 1743 1744 1745
{
    if (get_osversion() >= 0x020612) {
        setup_frame_v2(usig, ka, set, regs);
    } else {
        setup_frame_v1(usig, ka, set, regs);
    }
B
bellard 已提交
1746 1747
}

1748
/* compare linux/arch/arm/kernel/signal.c:setup_rt_frame() */
P
pbrook 已提交
1749
static void setup_rt_frame_v1(int usig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
1750
                              target_siginfo_t *info,
1751
                              target_sigset_t *set, CPUARMState *env)
B
bellard 已提交
1752
{
1753 1754 1755 1756 1757
    struct rt_sigframe_v1 *frame;
    abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
    struct target_sigaltstack stack;
    int i;
    abi_ulong info_addr, uc_addr;
B
bellard 已提交
1758

1759 1760 1761 1762
    trace_user_setup_rt_frame(env, frame_addr);
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        return /* 1 */;
    }
1763

1764 1765 1766 1767 1768
    info_addr = frame_addr + offsetof(struct rt_sigframe_v1, info);
    __put_user(info_addr, &frame->pinfo);
    uc_addr = frame_addr + offsetof(struct rt_sigframe_v1, uc);
    __put_user(uc_addr, &frame->puc);
    tswap_siginfo(&frame->info, info);
B
bellard 已提交
1769

1770 1771
    /* Clear all the bits of the ucontext we don't use.  */
    memset(&frame->uc, 0, offsetof(struct target_ucontext_v1, tuc_mcontext));
B
bellard 已提交
1772

1773 1774 1775 1776 1777
    memset(&stack, 0, sizeof(stack));
    __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
    __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
    __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
    memcpy(&frame->uc.tuc_stack, &stack, sizeof(stack));
1778

1779 1780 1781 1782
    setup_sigcontext(&frame->uc.tuc_mcontext, env, set->sig[0]);
    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
    }
B
bellard 已提交
1783

1784 1785
    setup_return(env, ka, &frame->retcode, frame_addr, usig,
                 frame_addr + offsetof(struct rt_sigframe_v1, retcode));
P
pbrook 已提交
1786

1787 1788
    env->regs[1] = info_addr;
    env->regs[2] = uc_addr;
P
pbrook 已提交
1789

1790
    unlock_user_struct(frame, frame_addr, 1);
P
pbrook 已提交
1791 1792
}

P
pbrook 已提交
1793
static void setup_rt_frame_v2(int usig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
1794
                              target_siginfo_t *info,
1795
                              target_sigset_t *set, CPUARMState *env)
P
pbrook 已提交
1796
{
1797 1798 1799
    struct rt_sigframe_v2 *frame;
    abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
    abi_ulong info_addr, uc_addr;
P
pbrook 已提交
1800

1801 1802 1803 1804
    trace_user_setup_rt_frame(env, frame_addr);
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        return /* 1 */;
    }
P
pbrook 已提交
1805

1806 1807 1808
    info_addr = frame_addr + offsetof(struct rt_sigframe_v2, info);
    uc_addr = frame_addr + offsetof(struct rt_sigframe_v2, uc);
    tswap_siginfo(&frame->info, info);
P
pbrook 已提交
1809

1810
    setup_sigframe_v2(&frame->uc, set, env);
P
pbrook 已提交
1811

1812 1813
    setup_return(env, ka, &frame->retcode, frame_addr, usig,
                 frame_addr + offsetof(struct rt_sigframe_v2, retcode));
P
pbrook 已提交
1814

1815 1816
    env->regs[1] = info_addr;
    env->regs[2] = uc_addr;
B
bellard 已提交
1817

1818
    unlock_user_struct(frame, frame_addr, 1);
B
bellard 已提交
1819 1820
}

P
pbrook 已提交
1821
static void setup_rt_frame(int usig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
1822
                           target_siginfo_t *info,
1823
                           target_sigset_t *set, CPUARMState *env)
P
pbrook 已提交
1824 1825 1826 1827 1828 1829 1830 1831
{
    if (get_osversion() >= 0x020612) {
        setup_rt_frame_v2(usig, ka, info, set, env);
    } else {
        setup_rt_frame_v1(usig, ka, info, set, env);
    }
}

B
bellard 已提交
1832
static int
1833
restore_sigcontext(CPUARMState *env, struct target_sigcontext *sc)
B
bellard 已提交
1834
{
1835 1836
    int err = 0;
    uint32_t cpsr;
B
bellard 已提交
1837

1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853
    __get_user(env->regs[0], &sc->arm_r0);
    __get_user(env->regs[1], &sc->arm_r1);
    __get_user(env->regs[2], &sc->arm_r2);
    __get_user(env->regs[3], &sc->arm_r3);
    __get_user(env->regs[4], &sc->arm_r4);
    __get_user(env->regs[5], &sc->arm_r5);
    __get_user(env->regs[6], &sc->arm_r6);
    __get_user(env->regs[7], &sc->arm_r7);
    __get_user(env->regs[8], &sc->arm_r8);
    __get_user(env->regs[9], &sc->arm_r9);
    __get_user(env->regs[10], &sc->arm_r10);
    __get_user(env->regs[11], &sc->arm_fp);
    __get_user(env->regs[12], &sc->arm_ip);
    __get_user(env->regs[13], &sc->arm_sp);
    __get_user(env->regs[14], &sc->arm_lr);
    __get_user(env->regs[15], &sc->arm_pc);
B
bellard 已提交
1854
#ifdef TARGET_CONFIG_CPU_32
1855
    __get_user(cpsr, &sc->arm_cpsr);
1856
    cpsr_write(env, cpsr, CPSR_USER | CPSR_EXEC, CPSRWriteByInstr);
B
bellard 已提交
1857 1858
#endif

1859
    err |= !valid_user_regs(env);
B
bellard 已提交
1860

1861
    return err;
B
bellard 已提交
1862 1863
}

1864
static long do_sigreturn_v1(CPUARMState *env)
B
bellard 已提交
1865
{
1866 1867 1868 1869 1870
    abi_ulong frame_addr;
    struct sigframe_v1 *frame = NULL;
    target_sigset_t set;
    sigset_t host_set;
    int i;
1871

1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885
    /*
     * Since we stacked the signal on a 64-bit boundary,
     * then 'sp' should be word aligned here.  If it's
     * not, then the user is trying to mess with us.
     */
    frame_addr = env->regs[13];
    trace_user_do_sigreturn(env, frame_addr);
    if (frame_addr & 7) {
        goto badframe;
    }

    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
B
bellard 已提交
1886

1887 1888 1889 1890
    __get_user(set.sig[0], &frame->sc.oldmask);
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
        __get_user(set.sig[i], &frame->extramask[i - 1]);
    }
B
bellard 已提交
1891

1892 1893
    target_to_host_sigset_internal(&host_set, &set);
    do_sigprocmask(SIG_SETMASK, &host_set, NULL);
B
bellard 已提交
1894

1895 1896 1897
    if (restore_sigcontext(env, &frame->sc)) {
        goto badframe;
    }
B
bellard 已提交
1898 1899

#if 0
1900 1901 1902
    /* Send SIGTRAP if we're single-stepping */
    if (ptrace_cancel_bpt(current))
        send_sig(SIGTRAP, current, 1);
B
bellard 已提交
1903
#endif
1904
    unlock_user_struct(frame, frame_addr, 0);
1905
    return -TARGET_QEMU_ESIGRETURN;
B
bellard 已提交
1906 1907

badframe:
1908 1909
    force_sig(TARGET_SIGSEGV /* , current */);
    return 0;
B
bellard 已提交
1910 1911
}

1912
static abi_ulong *restore_sigframe_v2_vfp(CPUARMState *env, abi_ulong *regspace)
1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925
{
    int i;
    abi_ulong magic, sz;
    uint32_t fpscr, fpexc;
    struct target_vfp_sigframe *vfpframe;
    vfpframe = (struct target_vfp_sigframe *)regspace;

    __get_user(magic, &vfpframe->magic);
    __get_user(sz, &vfpframe->size);
    if (magic != TARGET_VFP_MAGIC || sz != sizeof(*vfpframe)) {
        return 0;
    }
    for (i = 0; i < 32; i++) {
1926
        __get_user(float64_val(env->vfp.regs[i]), &vfpframe->ufp.fpregs[i]);
1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941
    }
    __get_user(fpscr, &vfpframe->ufp.fpscr);
    vfp_set_fpscr(env, fpscr);
    __get_user(fpexc, &vfpframe->ufp_exc.fpexc);
    /* Sanitise FPEXC: ensure VFP is enabled, FPINST2 is invalid
     * and the exception flag is cleared
     */
    fpexc |= (1 << 30);
    fpexc &= ~((1 << 31) | (1 << 28));
    env->vfp.xregs[ARM_VFP_FPEXC] = fpexc;
    __get_user(env->vfp.xregs[ARM_VFP_FPINST], &vfpframe->ufp_exc.fpinst);
    __get_user(env->vfp.xregs[ARM_VFP_FPINST2], &vfpframe->ufp_exc.fpinst2);
    return (abi_ulong*)(vfpframe + 1);
}

1942 1943
static abi_ulong *restore_sigframe_v2_iwmmxt(CPUARMState *env,
                                             abi_ulong *regspace)
1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966
{
    int i;
    abi_ulong magic, sz;
    struct target_iwmmxt_sigframe *iwmmxtframe;
    iwmmxtframe = (struct target_iwmmxt_sigframe *)regspace;

    __get_user(magic, &iwmmxtframe->magic);
    __get_user(sz, &iwmmxtframe->size);
    if (magic != TARGET_IWMMXT_MAGIC || sz != sizeof(*iwmmxtframe)) {
        return 0;
    }
    for (i = 0; i < 16; i++) {
        __get_user(env->iwmmxt.regs[i], &iwmmxtframe->regs[i]);
    }
    __get_user(env->vfp.xregs[ARM_IWMMXT_wCSSF], &iwmmxtframe->wcssf);
    __get_user(env->vfp.xregs[ARM_IWMMXT_wCASF], &iwmmxtframe->wcssf);
    __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR0], &iwmmxtframe->wcgr0);
    __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR1], &iwmmxtframe->wcgr1);
    __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR2], &iwmmxtframe->wcgr2);
    __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR3], &iwmmxtframe->wcgr3);
    return (abi_ulong*)(iwmmxtframe + 1);
}

1967
static int do_sigframe_return_v2(CPUARMState *env, target_ulong frame_addr,
P
pbrook 已提交
1968 1969 1970
                                 struct target_ucontext_v2 *uc)
{
    sigset_t host_set;
1971
    abi_ulong *regspace;
P
pbrook 已提交
1972 1973

    target_to_host_sigset(&host_set, &uc->tuc_sigmask);
1974
    do_sigprocmask(SIG_SETMASK, &host_set, NULL);
P
pbrook 已提交
1975 1976 1977 1978

    if (restore_sigcontext(env, &uc->tuc_mcontext))
        return 1;

1979 1980 1981 1982 1983 1984 1985 1986
    /* Restore coprocessor signal frame */
    regspace = uc->tuc_regspace;
    if (arm_feature(env, ARM_FEATURE_VFP)) {
        regspace = restore_sigframe_v2_vfp(env, regspace);
        if (!regspace) {
            return 1;
        }
    }
1987 1988 1989 1990 1991 1992
    if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
        regspace = restore_sigframe_v2_iwmmxt(env, regspace);
        if (!regspace) {
            return 1;
        }
    }
1993

P
pbrook 已提交
1994 1995 1996 1997 1998 1999
    if (do_sigaltstack(frame_addr + offsetof(struct target_ucontext_v2, tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
        return 1;

#if 0
    /* Send SIGTRAP if we're single-stepping */
    if (ptrace_cancel_bpt(current))
2000
        send_sig(SIGTRAP, current, 1);
P
pbrook 已提交
2001 2002 2003 2004 2005
#endif

    return 0;
}

2006
static long do_sigreturn_v2(CPUARMState *env)
P
pbrook 已提交
2007
{
2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020
    abi_ulong frame_addr;
    struct sigframe_v2 *frame = NULL;

    /*
     * Since we stacked the signal on a 64-bit boundary,
     * then 'sp' should be word aligned here.  If it's
     * not, then the user is trying to mess with us.
     */
    frame_addr = env->regs[13];
    trace_user_do_sigreturn(env, frame_addr);
    if (frame_addr & 7) {
        goto badframe;
    }
2021

2022 2023 2024
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
P
pbrook 已提交
2025

2026 2027 2028
    if (do_sigframe_return_v2(env, frame_addr, &frame->uc)) {
        goto badframe;
    }
P
pbrook 已提交
2029

2030
    unlock_user_struct(frame, frame_addr, 0);
2031
    return -TARGET_QEMU_ESIGRETURN;
P
pbrook 已提交
2032 2033

badframe:
2034 2035 2036
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV /* , current */);
    return 0;
P
pbrook 已提交
2037 2038
}

2039
long do_sigreturn(CPUARMState *env)
P
pbrook 已提交
2040 2041 2042 2043 2044 2045 2046 2047
{
    if (get_osversion() >= 0x020612) {
        return do_sigreturn_v2(env);
    } else {
        return do_sigreturn_v1(env);
    }
}

2048
static long do_rt_sigreturn_v1(CPUARMState *env)
B
bellard 已提交
2049
{
2050 2051 2052
    abi_ulong frame_addr;
    struct rt_sigframe_v1 *frame = NULL;
    sigset_t host_set;
2053

2054 2055 2056 2057 2058 2059 2060 2061 2062 2063
    /*
     * Since we stacked the signal on a 64-bit boundary,
     * then 'sp' should be word aligned here.  If it's
     * not, then the user is trying to mess with us.
     */
    frame_addr = env->regs[13];
    trace_user_do_rt_sigreturn(env, frame_addr);
    if (frame_addr & 7) {
        goto badframe;
    }
P
pbrook 已提交
2064

2065 2066 2067 2068 2069 2070
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }

    target_to_host_sigset(&host_set, &frame->uc.tuc_sigmask);
    do_sigprocmask(SIG_SETMASK, &host_set, NULL);
P
pbrook 已提交
2071

2072 2073 2074
    if (restore_sigcontext(env, &frame->uc.tuc_mcontext)) {
        goto badframe;
    }
P
pbrook 已提交
2075

2076 2077
    if (do_sigaltstack(frame_addr + offsetof(struct rt_sigframe_v1, uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
        goto badframe;
P
pbrook 已提交
2078 2079

#if 0
2080 2081 2082
    /* Send SIGTRAP if we're single-stepping */
    if (ptrace_cancel_bpt(current))
        send_sig(SIGTRAP, current, 1);
P
pbrook 已提交
2083
#endif
2084
    unlock_user_struct(frame, frame_addr, 0);
2085
    return -TARGET_QEMU_ESIGRETURN;
P
pbrook 已提交
2086 2087

badframe:
2088 2089 2090
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV /* , current */);
    return 0;
P
pbrook 已提交
2091 2092
}

2093
static long do_rt_sigreturn_v2(CPUARMState *env)
P
pbrook 已提交
2094
{
2095 2096
    abi_ulong frame_addr;
    struct rt_sigframe_v2 *frame = NULL;
2097

2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111
    /*
     * Since we stacked the signal on a 64-bit boundary,
     * then 'sp' should be word aligned here.  If it's
     * not, then the user is trying to mess with us.
     */
    frame_addr = env->regs[13];
    trace_user_do_rt_sigreturn(env, frame_addr);
    if (frame_addr & 7) {
        goto badframe;
    }

    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
B
bellard 已提交
2112

2113 2114 2115
    if (do_sigframe_return_v2(env, frame_addr, &frame->uc)) {
        goto badframe;
    }
2116

2117
    unlock_user_struct(frame, frame_addr, 0);
2118
    return -TARGET_QEMU_ESIGRETURN;
B
bellard 已提交
2119 2120

badframe:
2121 2122 2123
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV /* , current */);
    return 0;
B
bellard 已提交
2124 2125
}

2126
long do_rt_sigreturn(CPUARMState *env)
P
pbrook 已提交
2127 2128 2129 2130 2131 2132 2133 2134
{
    if (get_osversion() >= 0x020612) {
        return do_rt_sigreturn_v2(env);
    } else {
        return do_rt_sigreturn_v1(env);
    }
}

B
bellard 已提交
2135
#elif defined(TARGET_SPARC)
B
bellard 已提交
2136

B
bellard 已提交
2137 2138 2139 2140
#define __SUNOS_MAXWIN   31

/* This is what SunOS does, so shall I. */
struct target_sigcontext {
2141
    abi_ulong sigc_onstack;      /* state to restore */
B
bellard 已提交
2142

2143 2144 2145 2146 2147 2148 2149
    abi_ulong sigc_mask;         /* sigmask to restore */
    abi_ulong sigc_sp;           /* stack pointer */
    abi_ulong sigc_pc;           /* program counter */
    abi_ulong sigc_npc;          /* next program counter */
    abi_ulong sigc_psr;          /* for condition codes etc */
    abi_ulong sigc_g1;           /* User uses these two registers */
    abi_ulong sigc_o0;           /* within the trampoline code. */
B
bellard 已提交
2150

2151
    /* Now comes information regarding the users window set
B
bellard 已提交
2152 2153
         * at the time of the signal.
         */
2154
    abi_ulong sigc_oswins;       /* outstanding windows */
B
bellard 已提交
2155

2156 2157
    /* stack ptrs for each regwin buf */
    char *sigc_spbuf[__SUNOS_MAXWIN];
B
bellard 已提交
2158

2159 2160 2161 2162 2163
    /* Windows to restore after signal */
    struct {
        abi_ulong locals[8];
        abi_ulong ins[8];
    } sigc_wbuf[__SUNOS_MAXWIN];
B
bellard 已提交
2164 2165 2166
};
/* A Sparc stack frame */
struct sparc_stackf {
2167 2168 2169
    abi_ulong locals[8];
    abi_ulong ins[8];
    /* It's simpler to treat fp and callers_pc as elements of ins[]
2170 2171
         * since we never need to access them ourselves.
         */
2172 2173 2174
    char *structptr;
    abi_ulong xargs[6];
    abi_ulong xxargs[1];
B
bellard 已提交
2175 2176 2177
};

typedef struct {
2178 2179 2180 2181 2182 2183 2184 2185
    struct {
        abi_ulong psr;
        abi_ulong pc;
        abi_ulong npc;
        abi_ulong y;
        abi_ulong u_regs[16]; /* globals and ins */
    }               si_regs;
    int             si_mask;
B
bellard 已提交
2186 2187 2188
} __siginfo_t;

typedef struct {
2189 2190 2191 2192 2193 2194 2195
    abi_ulong  si_float_regs[32];
    unsigned   long si_fsr;
    unsigned   long si_fpqdepth;
    struct {
        unsigned long *insn_addr;
        unsigned long insn;
    } si_fpqueue [16];
A
Anthony Liguori 已提交
2196
} qemu_siginfo_fpu_t;
B
bellard 已提交
2197 2198 2199


struct target_signal_frame {
2200 2201 2202 2203 2204 2205 2206
    struct sparc_stackf ss;
    __siginfo_t         info;
    abi_ulong           fpu_save;
    abi_ulong           insns[2] __attribute__ ((aligned (8)));
    abi_ulong           extramask[TARGET_NSIG_WORDS - 1];
    abi_ulong           extra_size; /* Should be 0 */
    qemu_siginfo_fpu_t fpu_state;
B
bellard 已提交
2207 2208
};
struct target_rt_signal_frame {
2209 2210 2211 2212 2213 2214 2215 2216 2217
    struct sparc_stackf ss;
    siginfo_t           info;
    abi_ulong           regs[20];
    sigset_t            mask;
    abi_ulong           fpu_save;
    unsigned int        insns[2];
    stack_t             stack;
    unsigned int        extra_size; /* Should be 0 */
    qemu_siginfo_fpu_t  fpu_state;
B
bellard 已提交
2218 2219
};

B
bellard 已提交
2220 2221 2222 2223 2224
#define UREG_O0        16
#define UREG_O6        22
#define UREG_I0        0
#define UREG_I1        1
#define UREG_I2        2
B
blueswir1 已提交
2225 2226 2227
#define UREG_I3        3
#define UREG_I4        4
#define UREG_I5        5
B
bellard 已提交
2228 2229 2230
#define UREG_I6        6
#define UREG_I7        7
#define UREG_L0	       8
B
bellard 已提交
2231 2232 2233
#define UREG_FP        UREG_I6
#define UREG_SP        UREG_O6

P
pbrook 已提交
2234
static inline abi_ulong get_sigframe(struct target_sigaction *sa, 
2235 2236
                                     CPUSPARCState *env,
                                     unsigned long framesize)
B
bellard 已提交
2237
{
2238
    abi_ulong sp;
B
bellard 已提交
2239

2240
    sp = env->regwptr[UREG_FP];
B
bellard 已提交
2241

2242 2243 2244 2245 2246 2247 2248 2249
    /* This is the X/Open sanctioned signal stack switching.  */
    if (sa->sa_flags & TARGET_SA_ONSTACK) {
        if (!on_sig_stack(sp)
                && !((target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size) & 7)) {
            sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
        }
    }
    return sp - framesize;
B
bellard 已提交
2250 2251 2252
}

static int
2253
setup___siginfo(__siginfo_t *si, CPUSPARCState *env, abi_ulong mask)
B
bellard 已提交
2254
{
2255
    int err = 0, i;
B
bellard 已提交
2256

2257 2258 2259 2260
    __put_user(env->psr, &si->si_regs.psr);
    __put_user(env->pc, &si->si_regs.pc);
    __put_user(env->npc, &si->si_regs.npc);
    __put_user(env->y, &si->si_regs.y);
2261
    for (i=0; i < 8; i++) {
2262
        __put_user(env->gregs[i], &si->si_regs.u_regs[i]);
2263 2264
    }
    for (i=0; i < 8; i++) {
2265
        __put_user(env->regwptr[UREG_I0 + i], &si->si_regs.u_regs[i+8]);
2266
    }
2267
    __put_user(mask, &si->si_mask);
2268
    return err;
B
bellard 已提交
2269
}
B
bellard 已提交
2270

B
bellard 已提交
2271
#if 0
B
bellard 已提交
2272 2273
static int
setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
2274
                 CPUSPARCState *env, unsigned long mask)
B
bellard 已提交
2275
{
2276
    int err = 0;
B
bellard 已提交
2277

2278 2279 2280 2281 2282 2283 2284
    __put_user(mask, &sc->sigc_mask);
    __put_user(env->regwptr[UREG_SP], &sc->sigc_sp);
    __put_user(env->pc, &sc->sigc_pc);
    __put_user(env->npc, &sc->sigc_npc);
    __put_user(env->psr, &sc->sigc_psr);
    __put_user(env->gregs[1], &sc->sigc_g1);
    __put_user(env->regwptr[UREG_O0], &sc->sigc_o0);
B
bellard 已提交
2285

2286
    return err;
B
bellard 已提交
2287
}
B
bellard 已提交
2288
#endif
B
bellard 已提交
2289 2290
#define NF_ALIGNEDSZ  (((sizeof(struct target_signal_frame) + 7) & (~7)))

P
pbrook 已提交
2291
static void setup_frame(int sig, struct target_sigaction *ka,
2292
                        target_sigset_t *set, CPUSPARCState *env)
B
bellard 已提交
2293
{
2294 2295 2296
    abi_ulong sf_addr;
    struct target_signal_frame *sf;
    int sigframe_size, err, i;
B
bellard 已提交
2297

2298 2299
    /* 1. Make sure everything is clean */
    //synchronize_user_stack();
B
bellard 已提交
2300

2301 2302 2303
    sigframe_size = NF_ALIGNEDSZ;
    sf_addr = get_sigframe(ka, env, sigframe_size);
    trace_user_setup_frame(env, sf_addr);
B
bellard 已提交
2304

2305 2306 2307 2308 2309
    sf = lock_user(VERIFY_WRITE, sf_addr,
                   sizeof(struct target_signal_frame), 0);
    if (!sf) {
        goto sigsegv;
    }
B
bellard 已提交
2310
#if 0
2311 2312
    if (invalid_frame_pointer(sf, sigframe_size))
        goto sigill_and_return;
B
bellard 已提交
2313
#endif
2314 2315
    /* 2. Save the current process state */
    err = setup___siginfo(&sf->info, env, set->sig[0]);
2316
    __put_user(0, &sf->extra_size);
B
bellard 已提交
2317

2318 2319
    //save_fpu_state(regs, &sf->fpu_state);
    //__put_user(&sf->fpu_state, &sf->fpu_save);
B
bellard 已提交
2320

2321
    __put_user(set->sig[0], &sf->info.si_mask);
2322
    for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
2323
        __put_user(set->sig[i + 1], &sf->extramask[i]);
2324
    }
B
bellard 已提交
2325

2326
    for (i = 0; i < 8; i++) {
2327
        __put_user(env->regwptr[i + UREG_L0], &sf->ss.locals[i]);
2328 2329
    }
    for (i = 0; i < 8; i++) {
2330
        __put_user(env->regwptr[i + UREG_I0], &sf->ss.ins[i]);
2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356
    }
    if (err)
        goto sigsegv;

    /* 3. signal handler back-trampoline and parameters */
    env->regwptr[UREG_FP] = sf_addr;
    env->regwptr[UREG_I0] = sig;
    env->regwptr[UREG_I1] = sf_addr +
            offsetof(struct target_signal_frame, info);
    env->regwptr[UREG_I2] = sf_addr +
            offsetof(struct target_signal_frame, info);

    /* 4. signal handler */
    env->pc = ka->_sa_handler;
    env->npc = (env->pc + 4);
    /* 5. return to kernel instructions */
    if (ka->sa_restorer) {
        env->regwptr[UREG_I7] = ka->sa_restorer;
    } else {
        uint32_t val32;

        env->regwptr[UREG_I7] = sf_addr +
                offsetof(struct target_signal_frame, insns) - 2 * 4;

        /* mov __NR_sigreturn, %g1 */
        val32 = 0x821020d8;
2357
        __put_user(val32, &sf->insns[0]);
B
bellard 已提交
2358

2359 2360
        /* t 0x10 */
        val32 = 0x91d02010;
2361
        __put_user(val32, &sf->insns[1]);
2362 2363
        if (err)
            goto sigsegv;
B
bellard 已提交
2364

2365 2366 2367 2368 2369 2370
        /* Flush instruction space. */
        // flush_sig_insns(current->mm, (unsigned long) &(sf->insns[0]));
        // tb_flush(env);
    }
    unlock_user(sf, sf_addr, sizeof(struct target_signal_frame));
    return;
2371 2372
#if 0
sigill_and_return:
2373
    force_sig(TARGET_SIGILL);
2374
#endif
B
bellard 已提交
2375
sigsegv:
2376 2377
    unlock_user(sf, sf_addr, sizeof(struct target_signal_frame));
    force_sig(TARGET_SIGSEGV);
B
bellard 已提交
2378 2379
}

P
pbrook 已提交
2380
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
2381
                           target_siginfo_t *info,
2382
                           target_sigset_t *set, CPUSPARCState *env)
B
bellard 已提交
2383 2384 2385 2386
{
    fprintf(stderr, "setup_rt_frame: not implemented\n");
}

2387
long do_sigreturn(CPUSPARCState *env)
B
bellard 已提交
2388
{
2389 2390 2391 2392 2393 2394
    abi_ulong sf_addr;
    struct target_signal_frame *sf;
    uint32_t up_psr, pc, npc;
    target_sigset_t set;
    sigset_t host_set;
    int err=0, i;
B
bellard 已提交
2395

2396 2397 2398 2399 2400
    sf_addr = env->regwptr[UREG_FP];
    trace_user_do_sigreturn(env, sf_addr);
    if (!lock_user_struct(VERIFY_READ, sf, sf_addr, 1)) {
        goto segv_and_exit;
    }
B
bellard 已提交
2401

2402
    /* 1. Make sure we are not getting garbage from the user */
B
bellard 已提交
2403

2404 2405
    if (sf_addr & 3)
        goto segv_and_exit;
B
bellard 已提交
2406

2407 2408
    __get_user(pc,  &sf->info.si_regs.pc);
    __get_user(npc, &sf->info.si_regs.npc);
B
bellard 已提交
2409

2410 2411 2412
    if ((pc | npc) & 3) {
        goto segv_and_exit;
    }
B
bellard 已提交
2413

2414 2415
    /* 2. Restore the state */
    __get_user(up_psr, &sf->info.si_regs.psr);
B
bellard 已提交
2416

2417 2418 2419
    /* User can only change condition codes and FPU enabling in %psr. */
    env->psr = (up_psr & (PSR_ICC /* | PSR_EF */))
            | (env->psr & ~(PSR_ICC /* | PSR_EF */));
B
bellard 已提交
2420

2421 2422 2423 2424 2425 2426 2427 2428 2429
    env->pc = pc;
    env->npc = npc;
    __get_user(env->y, &sf->info.si_regs.y);
    for (i=0; i < 8; i++) {
        __get_user(env->gregs[i], &sf->info.si_regs.u_regs[i]);
    }
    for (i=0; i < 8; i++) {
        __get_user(env->regwptr[i + UREG_I0], &sf->info.si_regs.u_regs[i+8]);
    }
B
bellard 已提交
2430

2431
    /* FIXME: implement FPU save/restore:
2432 2433 2434 2435
         * __get_user(fpu_save, &sf->fpu_save);
         * if (fpu_save)
         *        err |= restore_fpu_state(env, fpu_save);
         */
B
bellard 已提交
2436

2437
    /* This is pretty much atomic, no amount locking would prevent
B
bellard 已提交
2438 2439
         * the races which exist anyways.
         */
2440 2441 2442 2443
    __get_user(set.sig[0], &sf->info.si_mask);
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
        __get_user(set.sig[i], &sf->extramask[i - 1]);
    }
B
bellard 已提交
2444

2445 2446
    target_to_host_sigset_internal(&host_set, &set);
    do_sigprocmask(SIG_SETMASK, &host_set, NULL);
B
bellard 已提交
2447

2448 2449 2450 2451 2452
    if (err) {
        goto segv_and_exit;
    }
    unlock_user_struct(sf, sf_addr, 0);
    return env->regwptr[0];
B
bellard 已提交
2453 2454

segv_and_exit:
2455 2456
    unlock_user_struct(sf, sf_addr, 0);
    force_sig(TARGET_SIGSEGV);
B
bellard 已提交
2457 2458
}

2459
long do_rt_sigreturn(CPUSPARCState *env)
B
bellard 已提交
2460
{
2461
    trace_user_do_rt_sigreturn(env, 0);
B
bellard 已提交
2462
    fprintf(stderr, "do_rt_sigreturn: not implemented\n");
B
bellard 已提交
2463
    return -TARGET_ENOSYS;
B
bellard 已提交
2464 2465
}

2466
#if defined(TARGET_SPARC64) && !defined(TARGET_ABI32)
B
blueswir1 已提交
2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487
#define MC_TSTATE 0
#define MC_PC 1
#define MC_NPC 2
#define MC_Y 3
#define MC_G1 4
#define MC_G2 5
#define MC_G3 6
#define MC_G4 7
#define MC_G5 8
#define MC_G6 9
#define MC_G7 10
#define MC_O0 11
#define MC_O1 12
#define MC_O2 13
#define MC_O3 14
#define MC_O4 15
#define MC_O5 16
#define MC_O6 17
#define MC_O7 18
#define MC_NGREG 19

A
Anthony Liguori 已提交
2488 2489
typedef abi_ulong target_mc_greg_t;
typedef target_mc_greg_t target_mc_gregset_t[MC_NGREG];
B
blueswir1 已提交
2490 2491

struct target_mc_fq {
2492
    abi_ulong *mcfq_addr;
B
blueswir1 已提交
2493 2494 2495 2496 2497 2498 2499 2500 2501
    uint32_t mcfq_insn;
};

struct target_mc_fpu {
    union {
        uint32_t sregs[32];
        uint64_t dregs[32];
        //uint128_t qregs[16];
    } mcfpu_fregs;
2502 2503 2504
    abi_ulong mcfpu_fsr;
    abi_ulong mcfpu_fprs;
    abi_ulong mcfpu_gsr;
B
blueswir1 已提交
2505 2506 2507 2508 2509
    struct target_mc_fq *mcfpu_fq;
    unsigned char mcfpu_qcnt;
    unsigned char mcfpu_qentsz;
    unsigned char mcfpu_enab;
};
A
Anthony Liguori 已提交
2510
typedef struct target_mc_fpu target_mc_fpu_t;
B
blueswir1 已提交
2511 2512

typedef struct {
A
Anthony Liguori 已提交
2513 2514 2515 2516 2517
    target_mc_gregset_t mc_gregs;
    target_mc_greg_t mc_fp;
    target_mc_greg_t mc_i7;
    target_mc_fpu_t mc_fpregs;
} target_mcontext_t;
B
blueswir1 已提交
2518 2519

struct target_ucontext {
2520 2521 2522 2523
    struct target_ucontext *tuc_link;
    abi_ulong tuc_flags;
    target_sigset_t tuc_sigmask;
    target_mcontext_t tuc_mcontext;
B
blueswir1 已提交
2524 2525 2526 2527
};

/* A V9 register window */
struct target_reg_window {
2528 2529
    abi_ulong locals[8];
    abi_ulong ins[8];
B
blueswir1 已提交
2530 2531 2532 2533 2534 2535 2536
};

#define TARGET_STACK_BIAS 2047

/* {set, get}context() needed for 64-bit SparcLinux userland. */
void sparc64_set_context(CPUSPARCState *env)
{
2537 2538
    abi_ulong ucp_addr;
    struct target_ucontext *ucp;
A
Anthony Liguori 已提交
2539
    target_mc_gregset_t *grp;
2540
    abi_ulong pc, npc, tstate;
2541
    abi_ulong fp, i7, w_addr;
B
blueswir1 已提交
2542 2543
    unsigned int i;

2544
    ucp_addr = env->regwptr[UREG_I0];
2545
    if (!lock_user_struct(VERIFY_READ, ucp, ucp_addr, 1)) {
2546
        goto do_sigsegv;
2547
    }
2548
    grp  = &ucp->tuc_mcontext.mc_gregs;
2549 2550
    __get_user(pc, &((*grp)[MC_PC]));
    __get_user(npc, &((*grp)[MC_NPC]));
2551
    if ((pc | npc) & 3) {
B
blueswir1 已提交
2552
        goto do_sigsegv;
2553
    }
B
blueswir1 已提交
2554
    if (env->regwptr[UREG_I1]) {
A
Anthony Liguori 已提交
2555
        target_sigset_t target_set;
B
blueswir1 已提交
2556 2557 2558
        sigset_t set;

        if (TARGET_NSIG_WORDS == 1) {
2559
            __get_user(target_set.sig[0], &ucp->tuc_sigmask.sig[0]);
B
blueswir1 已提交
2560
        } else {
2561
            abi_ulong *src, *dst;
2562
            src = ucp->tuc_sigmask.sig;
2563
            dst = target_set.sig;
2564
            for (i = 0; i < TARGET_NSIG_WORDS; i++, dst++, src++) {
2565
                __get_user(*dst, src);
2566
            }
B
blueswir1 已提交
2567 2568
        }
        target_to_host_sigset_internal(&set, &target_set);
2569
        do_sigprocmask(SIG_SETMASK, &set, NULL);
B
blueswir1 已提交
2570 2571 2572
    }
    env->pc = pc;
    env->npc = npc;
2573 2574
    __get_user(env->y, &((*grp)[MC_Y]));
    __get_user(tstate, &((*grp)[MC_TSTATE]));
B
blueswir1 已提交
2575
    env->asi = (tstate >> 24) & 0xff;
2576 2577
    cpu_put_ccr(env, tstate >> 32);
    cpu_put_cwp64(env, tstate & 0x1f);
2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595
    __get_user(env->gregs[1], (&(*grp)[MC_G1]));
    __get_user(env->gregs[2], (&(*grp)[MC_G2]));
    __get_user(env->gregs[3], (&(*grp)[MC_G3]));
    __get_user(env->gregs[4], (&(*grp)[MC_G4]));
    __get_user(env->gregs[5], (&(*grp)[MC_G5]));
    __get_user(env->gregs[6], (&(*grp)[MC_G6]));
    __get_user(env->gregs[7], (&(*grp)[MC_G7]));
    __get_user(env->regwptr[UREG_I0], (&(*grp)[MC_O0]));
    __get_user(env->regwptr[UREG_I1], (&(*grp)[MC_O1]));
    __get_user(env->regwptr[UREG_I2], (&(*grp)[MC_O2]));
    __get_user(env->regwptr[UREG_I3], (&(*grp)[MC_O3]));
    __get_user(env->regwptr[UREG_I4], (&(*grp)[MC_O4]));
    __get_user(env->regwptr[UREG_I5], (&(*grp)[MC_O5]));
    __get_user(env->regwptr[UREG_I6], (&(*grp)[MC_O6]));
    __get_user(env->regwptr[UREG_I7], (&(*grp)[MC_O7]));

    __get_user(fp, &(ucp->tuc_mcontext.mc_fp));
    __get_user(i7, &(ucp->tuc_mcontext.mc_i7));
2596

2597
    w_addr = TARGET_STACK_BIAS+env->regwptr[UREG_I6];
2598 2599
    if (put_user(fp, w_addr + offsetof(struct target_reg_window, ins[6]),
                 abi_ulong) != 0) {
2600
        goto do_sigsegv;
2601 2602 2603
    }
    if (put_user(i7, w_addr + offsetof(struct target_reg_window, ins[7]),
                 abi_ulong) != 0) {
2604
        goto do_sigsegv;
2605
    }
2606 2607 2608 2609 2610
    /* FIXME this does not match how the kernel handles the FPU in
     * its sparc64_set_context implementation. In particular the FPU
     * is only restored if fenab is non-zero in:
     *   __get_user(fenab, &(ucp->tuc_mcontext.mc_fpregs.mcfpu_enab));
     */
2611
    __get_user(env->fprs, &(ucp->tuc_mcontext.mc_fpregs.mcfpu_fprs));
2612
    {
2613 2614 2615
        uint32_t *src = ucp->tuc_mcontext.mc_fpregs.mcfpu_fregs.sregs;
        for (i = 0; i < 64; i++, src++) {
            if (i & 1) {
2616
                __get_user(env->fpr[i/2].l.lower, src);
2617
            } else {
2618
                __get_user(env->fpr[i/2].l.upper, src);
2619 2620
            }
        }
2621
    }
2622 2623 2624 2625
    __get_user(env->fsr,
               &(ucp->tuc_mcontext.mc_fpregs.mcfpu_fsr));
    __get_user(env->gsr,
               &(ucp->tuc_mcontext.mc_fpregs.mcfpu_gsr));
2626
    unlock_user_struct(ucp, ucp_addr, 0);
B
blueswir1 已提交
2627
    return;
2628
do_sigsegv:
2629
    unlock_user_struct(ucp, ucp_addr, 0);
2630
    force_sig(TARGET_SIGSEGV);
B
blueswir1 已提交
2631 2632 2633 2634
}

void sparc64_get_context(CPUSPARCState *env)
{
2635 2636
    abi_ulong ucp_addr;
    struct target_ucontext *ucp;
A
Anthony Liguori 已提交
2637 2638
    target_mc_gregset_t *grp;
    target_mcontext_t *mcp;
2639
    abi_ulong fp, i7, w_addr;
B
blueswir1 已提交
2640 2641
    int err;
    unsigned int i;
A
Anthony Liguori 已提交
2642
    target_sigset_t target_set;
B
blueswir1 已提交
2643 2644
    sigset_t set;

2645
    ucp_addr = env->regwptr[UREG_I0];
2646
    if (!lock_user_struct(VERIFY_WRITE, ucp, ucp_addr, 0)) {
2647
        goto do_sigsegv;
2648
    }
2649
    
2650
    mcp = &ucp->tuc_mcontext;
B
blueswir1 已提交
2651 2652 2653 2654 2655 2656 2657 2658
    grp = &mcp->mc_gregs;

    /* Skip over the trap instruction, first. */
    env->pc = env->npc;
    env->npc += 4;

    err = 0;

2659
    do_sigprocmask(0, NULL, &set);
B
blueswir1 已提交
2660
    host_to_target_sigset_internal(&target_set, &set);
2661
    if (TARGET_NSIG_WORDS == 1) {
2662 2663
        __put_user(target_set.sig[0],
                   (abi_ulong *)&ucp->tuc_sigmask);
2664 2665 2666
    } else {
        abi_ulong *src, *dst;
        src = target_set.sig;
2667
        dst = ucp->tuc_sigmask.sig;
2668
        for (i = 0; i < TARGET_NSIG_WORDS; i++, dst++, src++) {
2669
            __put_user(*src, dst);
2670
        }
B
blueswir1 已提交
2671 2672 2673 2674
        if (err)
            goto do_sigsegv;
    }

2675
    /* XXX: tstate must be saved properly */
2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694
    //    __put_user(env->tstate, &((*grp)[MC_TSTATE]));
    __put_user(env->pc, &((*grp)[MC_PC]));
    __put_user(env->npc, &((*grp)[MC_NPC]));
    __put_user(env->y, &((*grp)[MC_Y]));
    __put_user(env->gregs[1], &((*grp)[MC_G1]));
    __put_user(env->gregs[2], &((*grp)[MC_G2]));
    __put_user(env->gregs[3], &((*grp)[MC_G3]));
    __put_user(env->gregs[4], &((*grp)[MC_G4]));
    __put_user(env->gregs[5], &((*grp)[MC_G5]));
    __put_user(env->gregs[6], &((*grp)[MC_G6]));
    __put_user(env->gregs[7], &((*grp)[MC_G7]));
    __put_user(env->regwptr[UREG_I0], &((*grp)[MC_O0]));
    __put_user(env->regwptr[UREG_I1], &((*grp)[MC_O1]));
    __put_user(env->regwptr[UREG_I2], &((*grp)[MC_O2]));
    __put_user(env->regwptr[UREG_I3], &((*grp)[MC_O3]));
    __put_user(env->regwptr[UREG_I4], &((*grp)[MC_O4]));
    __put_user(env->regwptr[UREG_I5], &((*grp)[MC_O5]));
    __put_user(env->regwptr[UREG_I6], &((*grp)[MC_O6]));
    __put_user(env->regwptr[UREG_I7], &((*grp)[MC_O7]));
2695

2696 2697
    w_addr = TARGET_STACK_BIAS+env->regwptr[UREG_I6];
    fp = i7 = 0;
2698 2699
    if (get_user(fp, w_addr + offsetof(struct target_reg_window, ins[6]),
                 abi_ulong) != 0) {
2700
        goto do_sigsegv;
2701 2702 2703
    }
    if (get_user(i7, w_addr + offsetof(struct target_reg_window, ins[7]),
                 abi_ulong) != 0) {
2704
        goto do_sigsegv;
2705
    }
2706 2707
    __put_user(fp, &(mcp->mc_fp));
    __put_user(i7, &(mcp->mc_i7));
B
blueswir1 已提交
2708

2709
    {
2710 2711 2712
        uint32_t *dst = ucp->tuc_mcontext.mc_fpregs.mcfpu_fregs.sregs;
        for (i = 0; i < 64; i++, dst++) {
            if (i & 1) {
2713
                __put_user(env->fpr[i/2].l.lower, dst);
2714
            } else {
2715
                __put_user(env->fpr[i/2].l.upper, dst);
2716 2717
            }
        }
2718
    }
2719 2720 2721
    __put_user(env->fsr, &(mcp->mc_fpregs.mcfpu_fsr));
    __put_user(env->gsr, &(mcp->mc_fpregs.mcfpu_gsr));
    __put_user(env->fprs, &(mcp->mc_fpregs.mcfpu_fprs));
B
blueswir1 已提交
2722 2723 2724

    if (err)
        goto do_sigsegv;
2725
    unlock_user_struct(ucp, ucp_addr, 1);
B
blueswir1 已提交
2726
    return;
2727
do_sigsegv:
2728
    unlock_user_struct(ucp, ucp_addr, 1);
2729
    force_sig(TARGET_SIGSEGV);
B
blueswir1 已提交
2730 2731
}
#endif
2732
#elif defined(TARGET_MIPS) || defined(TARGET_MIPS64)
2733

2734
# if defined(TARGET_ABI_MIPSO32)
2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745
struct target_sigcontext {
    uint32_t   sc_regmask;     /* Unused */
    uint32_t   sc_status;
    uint64_t   sc_pc;
    uint64_t   sc_regs[32];
    uint64_t   sc_fpregs[32];
    uint32_t   sc_ownedfp;     /* Unused */
    uint32_t   sc_fpc_csr;
    uint32_t   sc_fpc_eir;     /* Unused */
    uint32_t   sc_used_math;
    uint32_t   sc_dsp;         /* dsp status, was sc_ssflags */
P
Paul Brook 已提交
2746
    uint32_t   pad0;
2747 2748 2749 2750 2751 2752 2753 2754 2755
    uint64_t   sc_mdhi;
    uint64_t   sc_mdlo;
    target_ulong   sc_hi1;         /* Was sc_cause */
    target_ulong   sc_lo1;         /* Was sc_badvaddr */
    target_ulong   sc_hi2;         /* Was sc_sigset[4] */
    target_ulong   sc_lo2;
    target_ulong   sc_hi3;
    target_ulong   sc_lo3;
};
2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774
# else /* N32 || N64 */
struct target_sigcontext {
    uint64_t sc_regs[32];
    uint64_t sc_fpregs[32];
    uint64_t sc_mdhi;
    uint64_t sc_hi1;
    uint64_t sc_hi2;
    uint64_t sc_hi3;
    uint64_t sc_mdlo;
    uint64_t sc_lo1;
    uint64_t sc_lo2;
    uint64_t sc_lo3;
    uint64_t sc_pc;
    uint32_t sc_fpc_csr;
    uint32_t sc_used_math;
    uint32_t sc_dsp;
    uint32_t sc_reserved;
};
# endif /* O32 */
2775 2776 2777 2778 2779

struct sigframe {
    uint32_t sf_ass[4];			/* argument save space for o32 */
    uint32_t sf_code[2];			/* signal trampoline */
    struct target_sigcontext sf_sc;
A
Anthony Liguori 已提交
2780
    target_sigset_t sf_mask;
2781 2782
};

P
pbrook 已提交
2783
struct target_ucontext {
2784 2785 2786
    target_ulong tuc_flags;
    target_ulong tuc_link;
    target_stack_t tuc_stack;
P
Paul Brook 已提交
2787
    target_ulong pad0;
2788 2789
    struct target_sigcontext tuc_mcontext;
    target_sigset_t tuc_sigmask;
P
pbrook 已提交
2790 2791 2792 2793 2794 2795 2796 2797 2798
};

struct target_rt_sigframe {
    uint32_t rs_ass[4];               /* argument save space for o32 */
    uint32_t rs_code[2];              /* signal trampoline */
    struct target_siginfo rs_info;
    struct target_ucontext rs_uc;
};

2799 2800 2801
/* Install trampoline to jump back from signal handler */
static inline int install_sigtramp(unsigned int *tramp,   unsigned int syscall)
{
2802
    int err = 0;
2803 2804

    /*
2805 2806 2807 2808 2809
     * Set up the return code ...
     *
     *         li      v0, __NR__foo_sigreturn
     *         syscall
     */
2810

2811 2812
    __put_user(0x24020000 + syscall, tramp + 0);
    __put_user(0x0000000c          , tramp + 1);
2813 2814 2815
    return err;
}

2816
static inline void setup_sigcontext(CPUMIPSState *regs,
2817
                                    struct target_sigcontext *sc)
2818
{
2819
    int i;
2820

2821
    __put_user(exception_resume_pc(regs), &sc->sc_pc);
2822
    regs->hflags &= ~MIPS_HFLAG_BMASK;
2823

2824 2825
    __put_user(0, &sc->sc_regs[0]);
    for (i = 1; i < 32; ++i) {
2826
        __put_user(regs->active_tc.gpr[i], &sc->sc_regs[i]);
2827
    }
2828

2829 2830
    __put_user(regs->active_tc.HI[0], &sc->sc_mdhi);
    __put_user(regs->active_tc.LO[0], &sc->sc_mdlo);
2831

2832 2833
    /* Rather than checking for dsp existence, always copy.  The storage
       would just be garbage otherwise.  */
2834 2835 2836 2837 2838 2839
    __put_user(regs->active_tc.HI[1], &sc->sc_hi1);
    __put_user(regs->active_tc.HI[2], &sc->sc_hi2);
    __put_user(regs->active_tc.HI[3], &sc->sc_hi3);
    __put_user(regs->active_tc.LO[1], &sc->sc_lo1);
    __put_user(regs->active_tc.LO[2], &sc->sc_lo2);
    __put_user(regs->active_tc.LO[3], &sc->sc_lo3);
2840 2841
    {
        uint32_t dsp = cpu_rddsp(0x3ff, regs);
2842
        __put_user(dsp, &sc->sc_dsp);
2843 2844
    }

2845
    __put_user(1, &sc->sc_used_math);
2846

2847
    for (i = 0; i < 32; ++i) {
2848
        __put_user(regs->active_fpu.fpr[i].d, &sc->sc_fpregs[i]);
2849 2850 2851
    }
}

2852
static inline void
2853
restore_sigcontext(CPUMIPSState *regs, struct target_sigcontext *sc)
2854
{
2855
    int i;
2856

2857
    __get_user(regs->CP0_EPC, &sc->sc_pc);
2858

2859 2860
    __get_user(regs->active_tc.HI[0], &sc->sc_mdhi);
    __get_user(regs->active_tc.LO[0], &sc->sc_mdlo);
2861

2862
    for (i = 1; i < 32; ++i) {
2863
        __get_user(regs->active_tc.gpr[i], &sc->sc_regs[i]);
2864 2865
    }

2866 2867 2868 2869 2870 2871
    __get_user(regs->active_tc.HI[1], &sc->sc_hi1);
    __get_user(regs->active_tc.HI[2], &sc->sc_hi2);
    __get_user(regs->active_tc.HI[3], &sc->sc_hi3);
    __get_user(regs->active_tc.LO[1], &sc->sc_lo1);
    __get_user(regs->active_tc.LO[2], &sc->sc_lo2);
    __get_user(regs->active_tc.LO[3], &sc->sc_lo3);
2872 2873
    {
        uint32_t dsp;
2874
        __get_user(dsp, &sc->sc_dsp);
2875 2876
        cpu_wrdsp(dsp, 0x3ff, regs);
    }
2877

2878
    for (i = 0; i < 32; ++i) {
2879
        __get_user(regs->active_fpu.fpr[i].d, &sc->sc_fpregs[i]);
2880 2881
    }
}
2882

2883 2884 2885
/*
 * Determine which stack to use..
 */
2886
static inline abi_ulong
2887
get_sigframe(struct target_sigaction *ka, CPUMIPSState *regs, size_t frame_size)
2888 2889 2890 2891
{
    unsigned long sp;

    /* Default to using normal stack */
2892
    sp = regs->active_tc.gpr[29];
2893 2894

    /*
2895
     * FPU emulator may have its own trampoline active just
2896 2897 2898 2899 2900 2901
     * above the user stack, 16-bytes before the next lowest
     * 16 byte boundary.  Try to avoid trashing it.
     */
    sp -= 32;

    /* This is the X/Open sanctioned signal stack switching.  */
P
pbrook 已提交
2902
    if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
2903 2904
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }
2905

2906
    return (sp - frame_size) & ~7;
2907 2908
}

2909 2910 2911 2912 2913 2914 2915 2916 2917
static void mips_set_hflags_isa_mode_from_pc(CPUMIPSState *env)
{
    if (env->insn_flags & (ASE_MIPS16 | ASE_MICROMIPS)) {
        env->hflags &= ~MIPS_HFLAG_M16;
        env->hflags |= (env->active_tc.PC & 1) << MIPS_HFLAG_M16_SHIFT;
        env->active_tc.PC &= ~(target_ulong) 1;
    }
}

2918
# if defined(TARGET_ABI_MIPSO32)
2919
/* compare linux/arch/mips/kernel/signal.c:setup_frame() */
P
pbrook 已提交
2920
static void setup_frame(int sig, struct target_sigaction * ka,
2921
                        target_sigset_t *set, CPUMIPSState *regs)
2922 2923
{
    struct sigframe *frame;
2924
    abi_ulong frame_addr;
2925 2926
    int i;

2927
    frame_addr = get_sigframe(ka, regs, sizeof(*frame));
2928
    trace_user_setup_frame(regs, frame_addr);
2929 2930 2931
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }
2932 2933 2934

    install_sigtramp(frame->sf_code, TARGET_NR_sigreturn);

2935
    setup_sigcontext(regs, &frame->sf_sc);
2936 2937

    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2938
        __put_user(set->sig[i], &frame->sf_mask.sig[i]);
2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950
    }

    /*
    * Arguments to signal handler:
    *
    *   a0 = signal number
    *   a1 = 0 (should be cause)
    *   a2 = pointer to struct sigcontext
    *
    * $25 and PC point to the signal handler, $29 points to the
    * struct sigframe.
    */
2951 2952 2953 2954 2955
    regs->active_tc.gpr[ 4] = sig;
    regs->active_tc.gpr[ 5] = 0;
    regs->active_tc.gpr[ 6] = frame_addr + offsetof(struct sigframe, sf_sc);
    regs->active_tc.gpr[29] = frame_addr;
    regs->active_tc.gpr[31] = frame_addr + offsetof(struct sigframe, sf_code);
2956 2957 2958
    /* The original kernel code sets CP0_EPC to the handler
    * since it returns to userland using eret
    * we cannot do this here, and we must set PC directly */
2959
    regs->active_tc.PC = regs->active_tc.gpr[25] = ka->_sa_handler;
2960
    mips_set_hflags_isa_mode_from_pc(regs);
2961
    unlock_user_struct(frame, frame_addr, 1);
2962 2963 2964 2965 2966 2967
    return;

give_sigsegv:
    force_sig(TARGET_SIGSEGV/*, current*/);
}

2968
long do_sigreturn(CPUMIPSState *regs)
2969
{
T
ths 已提交
2970
    struct sigframe *frame;
2971
    abi_ulong frame_addr;
T
ths 已提交
2972
    sigset_t blocked;
A
Anthony Liguori 已提交
2973
    target_sigset_t target_set;
T
ths 已提交
2974
    int i;
2975

2976
    frame_addr = regs->active_tc.gpr[29];
2977
    trace_user_do_sigreturn(regs, frame_addr);
2978
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
2979
        goto badframe;
2980

T
ths 已提交
2981
    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2982
        __get_user(target_set.sig[i], &frame->sf_mask.sig[i]);
T
ths 已提交
2983
    }
2984

T
ths 已提交
2985
    target_to_host_sigset_internal(&blocked, &target_set);
2986
    do_sigprocmask(SIG_SETMASK, &blocked, NULL);
2987

2988
    restore_sigcontext(regs, &frame->sf_sc);
2989 2990

#if 0
T
ths 已提交
2991 2992 2993 2994
    /*
     * Don't let your children do this ...
     */
    __asm__ __volatile__(
2995 2996 2997 2998
   	"move\t$29, %0\n\t"
   	"j\tsyscall_exit"
   	:/* no outputs */
   	:"r" (&regs));
T
ths 已提交
2999
    /* Unreached */
3000
#endif
3001

3002
    regs->active_tc.PC = regs->CP0_EPC;
3003
    mips_set_hflags_isa_mode_from_pc(regs);
T
ths 已提交
3004
    /* I am not sure this is right, but it seems to work
3005 3006
    * maybe a problem with nested signals ? */
    regs->CP0_EPC = 0;
P
pbrook 已提交
3007
    return -TARGET_QEMU_ESIGRETURN;
3008 3009

badframe:
T
ths 已提交
3010 3011
    force_sig(TARGET_SIGSEGV/*, current*/);
    return 0;
3012
}
3013
# endif /* O32 */
3014

P
pbrook 已提交
3015
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
3016
                           target_siginfo_t *info,
3017
                           target_sigset_t *set, CPUMIPSState *env)
3018
{
P
pbrook 已提交
3019 3020 3021 3022 3023
    struct target_rt_sigframe *frame;
    abi_ulong frame_addr;
    int i;

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
3024
    trace_user_setup_rt_frame(env, frame_addr);
3025 3026 3027
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }
P
pbrook 已提交
3028 3029 3030

    install_sigtramp(frame->rs_code, TARGET_NR_rt_sigreturn);

3031
    tswap_siginfo(&frame->rs_info, info);
P
pbrook 已提交
3032

3033 3034 3035 3036
    __put_user(0, &frame->rs_uc.tuc_flags);
    __put_user(0, &frame->rs_uc.tuc_link);
    __put_user(target_sigaltstack_used.ss_sp, &frame->rs_uc.tuc_stack.ss_sp);
    __put_user(target_sigaltstack_used.ss_size, &frame->rs_uc.tuc_stack.ss_size);
P
pbrook 已提交
3037
    __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
3038
               &frame->rs_uc.tuc_stack.ss_flags);
P
pbrook 已提交
3039

3040
    setup_sigcontext(env, &frame->rs_uc.tuc_mcontext);
P
pbrook 已提交
3041 3042

    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
3043
        __put_user(set->sig[i], &frame->rs_uc.tuc_sigmask.sig[i]);
P
pbrook 已提交
3044 3045 3046 3047 3048 3049
    }

    /*
    * Arguments to signal handler:
    *
    *   a0 = signal number
3050
    *   a1 = pointer to siginfo_t
P
pbrook 已提交
3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067
    *   a2 = pointer to struct ucontext
    *
    * $25 and PC point to the signal handler, $29 points to the
    * struct sigframe.
    */
    env->active_tc.gpr[ 4] = sig;
    env->active_tc.gpr[ 5] = frame_addr
                             + offsetof(struct target_rt_sigframe, rs_info);
    env->active_tc.gpr[ 6] = frame_addr
                             + offsetof(struct target_rt_sigframe, rs_uc);
    env->active_tc.gpr[29] = frame_addr;
    env->active_tc.gpr[31] = frame_addr
                             + offsetof(struct target_rt_sigframe, rs_code);
    /* The original kernel code sets CP0_EPC to the handler
    * since it returns to userland using eret
    * we cannot do this here, and we must set PC directly */
    env->active_tc.PC = env->active_tc.gpr[25] = ka->_sa_handler;
3068
    mips_set_hflags_isa_mode_from_pc(env);
P
pbrook 已提交
3069 3070 3071 3072 3073 3074
    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
    force_sig(TARGET_SIGSEGV/*, current*/);
3075 3076
}

3077
long do_rt_sigreturn(CPUMIPSState *env)
3078
{
P
pbrook 已提交
3079 3080 3081 3082 3083
    struct target_rt_sigframe *frame;
    abi_ulong frame_addr;
    sigset_t blocked;

    frame_addr = env->active_tc.gpr[29];
3084
    trace_user_do_rt_sigreturn(env, frame_addr);
3085 3086 3087
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
P
pbrook 已提交
3088

3089
    target_to_host_sigset(&blocked, &frame->rs_uc.tuc_sigmask);
3090
    do_sigprocmask(SIG_SETMASK, &blocked, NULL);
P
pbrook 已提交
3091

3092
    restore_sigcontext(env, &frame->rs_uc.tuc_mcontext);
P
pbrook 已提交
3093 3094

    if (do_sigaltstack(frame_addr +
3095 3096
                       offsetof(struct target_rt_sigframe, rs_uc.tuc_stack),
                       0, get_sp_from_cpustate(env)) == -EFAULT)
P
pbrook 已提交
3097 3098 3099
        goto badframe;

    env->active_tc.PC = env->CP0_EPC;
3100
    mips_set_hflags_isa_mode_from_pc(env);
P
pbrook 已提交
3101 3102 3103 3104 3105 3106 3107 3108
    /* I am not sure this is right, but it seems to work
    * maybe a problem with nested signals ? */
    env->CP0_EPC = 0;
    return -TARGET_QEMU_ESIGRETURN;

badframe:
    force_sig(TARGET_SIGSEGV/*, current*/);
    return 0;
3109
}
B
bellard 已提交
3110

3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142 3143 3144 3145 3146 3147
#elif defined(TARGET_SH4)

/*
 * code and data structures from linux kernel:
 * include/asm-sh/sigcontext.h
 * arch/sh/kernel/signal.c
 */

struct target_sigcontext {
    target_ulong  oldmask;

    /* CPU registers */
    target_ulong  sc_gregs[16];
    target_ulong  sc_pc;
    target_ulong  sc_pr;
    target_ulong  sc_sr;
    target_ulong  sc_gbr;
    target_ulong  sc_mach;
    target_ulong  sc_macl;

    /* FPU registers */
    target_ulong  sc_fpregs[16];
    target_ulong  sc_xfpregs[16];
    unsigned int sc_fpscr;
    unsigned int sc_fpul;
    unsigned int sc_ownedfp;
};

struct target_sigframe
{
    struct target_sigcontext sc;
    target_ulong extramask[TARGET_NSIG_WORDS-1];
    uint16_t retcode[3];
};


struct target_ucontext {
3148 3149 3150 3151 3152
    target_ulong tuc_flags;
    struct target_ucontext *tuc_link;
    target_stack_t tuc_stack;
    struct target_sigcontext tuc_mcontext;
    target_sigset_t tuc_sigmask;	/* mask last for extensibility */
3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165
};

struct target_rt_sigframe
{
    struct target_siginfo info;
    struct target_ucontext uc;
    uint16_t retcode[3];
};


#define MOVW(n)  (0x9300|((n)-2)) /* Move mem word at PC+n to R3 */
#define TRAP_NOARG 0xc310         /* Syscall w/no args (NR in R3) SH3/4 */

P
pbrook 已提交
3166
static abi_ulong get_sigframe(struct target_sigaction *ka,
3167
                              unsigned long sp, size_t frame_size)
3168
{
P
pbrook 已提交
3169
    if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags(sp) == 0)) {
3170 3171 3172 3173 3174 3175
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }

    return (sp - frame_size) & -8ul;
}

3176
static void setup_sigcontext(struct target_sigcontext *sc,
3177
                             CPUSH4State *regs, unsigned long mask)
3178
{
3179
    int i;
3180

3181
#define COPY(x)         __put_user(regs->x, &sc->sc_##x)
3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194
    COPY(gregs[0]); COPY(gregs[1]);
    COPY(gregs[2]); COPY(gregs[3]);
    COPY(gregs[4]); COPY(gregs[5]);
    COPY(gregs[6]); COPY(gregs[7]);
    COPY(gregs[8]); COPY(gregs[9]);
    COPY(gregs[10]); COPY(gregs[11]);
    COPY(gregs[12]); COPY(gregs[13]);
    COPY(gregs[14]); COPY(gregs[15]);
    COPY(gbr); COPY(mach);
    COPY(macl); COPY(pr);
    COPY(sr); COPY(pc);
#undef COPY

3195
    for (i=0; i<16; i++) {
3196
        __put_user(regs->fregs[i], &sc->sc_fpregs[i]);
3197
    }
3198 3199
    __put_user(regs->fpscr, &sc->sc_fpscr);
    __put_user(regs->fpul, &sc->sc_fpul);
3200 3201

    /* non-iBCS2 extensions.. */
3202
    __put_user(mask, &sc->oldmask);
3203 3204
}

3205
static void restore_sigcontext(CPUSH4State *regs, struct target_sigcontext *sc,
3206
                               target_ulong *r0_p)
3207
{
3208
    int i;
3209

3210
#define COPY(x)         __get_user(regs->x, &sc->sc_##x)
3211 3212 3213 3214 3215 3216 3217 3218 3219 3220 3221 3222 3223
    COPY(gregs[1]);
    COPY(gregs[2]); COPY(gregs[3]);
    COPY(gregs[4]); COPY(gregs[5]);
    COPY(gregs[6]); COPY(gregs[7]);
    COPY(gregs[8]); COPY(gregs[9]);
    COPY(gregs[10]); COPY(gregs[11]);
    COPY(gregs[12]); COPY(gregs[13]);
    COPY(gregs[14]); COPY(gregs[15]);
    COPY(gbr); COPY(mach);
    COPY(macl); COPY(pr);
    COPY(sr); COPY(pc);
#undef COPY

3224
    for (i=0; i<16; i++) {
3225
        __get_user(regs->fregs[i], &sc->sc_fpregs[i]);
3226
    }
3227 3228
    __get_user(regs->fpscr, &sc->sc_fpscr);
    __get_user(regs->fpul, &sc->sc_fpul);
3229 3230

    regs->tra = -1;         /* disable syscall checks */
3231
    __get_user(*r0_p, &sc->sc_gregs[0]);
3232 3233
}

P
pbrook 已提交
3234
static void setup_frame(int sig, struct target_sigaction *ka,
3235
                        target_sigset_t *set, CPUSH4State *regs)
3236 3237 3238 3239 3240 3241
{
    struct target_sigframe *frame;
    abi_ulong frame_addr;
    int i;

    frame_addr = get_sigframe(ka, regs->gregs[15], sizeof(*frame));
3242
    trace_user_setup_frame(regs, frame_addr);
3243 3244 3245
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }
3246

3247
    setup_sigcontext(&frame->sc, regs, set->sig[0]);
3248 3249

    for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
3250
        __put_user(set->sig[i + 1], &frame->extramask[i]);
3251 3252 3253 3254
    }

    /* Set up to return from userspace.  If provided, use a stub
       already in userspace.  */
P
pbrook 已提交
3255 3256
    if (ka->sa_flags & TARGET_SA_RESTORER) {
        regs->pr = (unsigned long) ka->sa_restorer;
3257 3258
    } else {
        /* Generate return code (system call to sigreturn) */
3259 3260
        abi_ulong retcode_addr = frame_addr +
                                 offsetof(struct target_sigframe, retcode);
3261 3262 3263
        __put_user(MOVW(2), &frame->retcode[0]);
        __put_user(TRAP_NOARG, &frame->retcode[1]);
        __put_user((TARGET_NR_sigreturn), &frame->retcode[2]);
3264
        regs->pr = (unsigned long) retcode_addr;
3265 3266 3267
    }

    /* Set up registers for signal handler */
3268
    regs->gregs[15] = frame_addr;
3269
    regs->gregs[4] = sig; /* Arg for signal handler */
3270
    regs->gregs[5] = 0;
3271
    regs->gregs[6] = frame_addr += offsetof(typeof(*frame), sc);
P
pbrook 已提交
3272
    regs->pc = (unsigned long) ka->_sa_handler;
3273 3274 3275 3276 3277 3278

    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
3279
    force_sig(TARGET_SIGSEGV);
3280 3281
}

P
pbrook 已提交
3282
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
3283
                           target_siginfo_t *info,
3284
                           target_sigset_t *set, CPUSH4State *regs)
3285 3286 3287 3288 3289 3290
{
    struct target_rt_sigframe *frame;
    abi_ulong frame_addr;
    int i;

    frame_addr = get_sigframe(ka, regs->gregs[15], sizeof(*frame));
3291
    trace_user_setup_rt_frame(regs, frame_addr);
3292 3293 3294
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }
3295

3296
    tswap_siginfo(&frame->info, info);
3297 3298

    /* Create the ucontext.  */
3299 3300 3301 3302 3303 3304 3305 3306 3307
    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, (unsigned long *)&frame->uc.tuc_link);
    __put_user((unsigned long)target_sigaltstack_used.ss_sp,
               &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(regs->gregs[15]),
               &frame->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size,
               &frame->uc.tuc_stack.ss_size);
    setup_sigcontext(&frame->uc.tuc_mcontext,
3308
                     regs, set->sig[0]);
3309
    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
3310
        __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
3311 3312 3313 3314
    }

    /* Set up to return from userspace.  If provided, use a stub
       already in userspace.  */
P
pbrook 已提交
3315 3316
    if (ka->sa_flags & TARGET_SA_RESTORER) {
        regs->pr = (unsigned long) ka->sa_restorer;
3317 3318
    } else {
        /* Generate return code (system call to sigreturn) */
3319 3320
        abi_ulong retcode_addr = frame_addr +
                                 offsetof(struct target_rt_sigframe, retcode);
3321 3322 3323
        __put_user(MOVW(2), &frame->retcode[0]);
        __put_user(TRAP_NOARG, &frame->retcode[1]);
        __put_user((TARGET_NR_rt_sigreturn), &frame->retcode[2]);
3324
        regs->pr = (unsigned long) retcode_addr;
3325 3326 3327
    }

    /* Set up registers for signal handler */
3328
    regs->gregs[15] = frame_addr;
3329
    regs->gregs[4] = sig; /* Arg for signal handler */
3330 3331
    regs->gregs[5] = frame_addr + offsetof(typeof(*frame), info);
    regs->gregs[6] = frame_addr + offsetof(typeof(*frame), uc);
P
pbrook 已提交
3332
    regs->pc = (unsigned long) ka->_sa_handler;
3333 3334 3335 3336 3337 3338

    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
3339
    force_sig(TARGET_SIGSEGV);
3340 3341
}

3342
long do_sigreturn(CPUSH4State *regs)
3343 3344 3345 3346
{
    struct target_sigframe *frame;
    abi_ulong frame_addr;
    sigset_t blocked;
A
Anthony Liguori 已提交
3347
    target_sigset_t target_set;
3348
    target_ulong r0;
3349 3350 3351 3352
    int i;
    int err = 0;

    frame_addr = regs->gregs[15];
3353
    trace_user_do_sigreturn(regs, frame_addr);
3354 3355 3356
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
3357

3358
    __get_user(target_set.sig[0], &frame->sc.oldmask);
3359
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3360
        __get_user(target_set.sig[i], &frame->extramask[i - 1]);
3361 3362 3363 3364 3365 3366
    }

    if (err)
        goto badframe;

    target_to_host_sigset_internal(&blocked, &target_set);
3367
    do_sigprocmask(SIG_SETMASK, &blocked, NULL);
3368

3369
    restore_sigcontext(regs, &frame->sc, &r0);
3370 3371

    unlock_user_struct(frame, frame_addr, 0);
3372
    return r0;
3373 3374 3375 3376 3377 3378 3379

badframe:
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
    return 0;
}

3380
long do_rt_sigreturn(CPUSH4State *regs)
3381 3382 3383 3384
{
    struct target_rt_sigframe *frame;
    abi_ulong frame_addr;
    sigset_t blocked;
3385
    target_ulong r0;
3386 3387

    frame_addr = regs->gregs[15];
3388
    trace_user_do_rt_sigreturn(regs, frame_addr);
3389 3390 3391
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
3392

3393
    target_to_host_sigset(&blocked, &frame->uc.tuc_sigmask);
3394
    do_sigprocmask(SIG_SETMASK, &blocked, NULL);
3395

3396
    restore_sigcontext(regs, &frame->uc.tuc_mcontext, &r0);
3397 3398

    if (do_sigaltstack(frame_addr +
3399 3400
                       offsetof(struct target_rt_sigframe, uc.tuc_stack),
                       0, get_sp_from_cpustate(regs)) == -EFAULT) {
3401
        goto badframe;
3402
    }
3403 3404

    unlock_user_struct(frame, frame_addr, 0);
3405
    return r0;
3406 3407 3408 3409 3410 3411

badframe:
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
    return 0;
}
3412 3413 3414 3415 3416 3417 3418
#elif defined(TARGET_MICROBLAZE)

struct target_sigcontext {
    struct target_pt_regs regs;  /* needs to be first */
    uint32_t oldmask;
};

3419 3420 3421 3422 3423 3424 3425
struct target_stack_t {
    abi_ulong ss_sp;
    int ss_flags;
    unsigned int ss_size;
};

struct target_ucontext {
3426 3427 3428 3429 3430
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
    struct target_stack_t tuc_stack;
    struct target_sigcontext tuc_mcontext;
    uint32_t tuc_extramask[TARGET_NSIG_WORDS - 1];
3431 3432
};

3433 3434
/* Signal frames. */
struct target_signal_frame {
3435
    struct target_ucontext uc;
3436 3437 3438 3439 3440
    uint32_t extramask[TARGET_NSIG_WORDS - 1];
    uint32_t tramp[2];
};

struct rt_signal_frame {
3441
    siginfo_t info;
3442 3443 3444 3445
    struct ucontext uc;
    uint32_t tramp[2];
};

3446
static void setup_sigcontext(struct target_sigcontext *sc, CPUMBState *env)
3447 3448 3449 3450 3451 3452 3453 3454 3455 3456 3457 3458 3459 3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477 3478 3479 3480 3481 3482
{
    __put_user(env->regs[0], &sc->regs.r0);
    __put_user(env->regs[1], &sc->regs.r1);
    __put_user(env->regs[2], &sc->regs.r2);
    __put_user(env->regs[3], &sc->regs.r3);
    __put_user(env->regs[4], &sc->regs.r4);
    __put_user(env->regs[5], &sc->regs.r5);
    __put_user(env->regs[6], &sc->regs.r6);
    __put_user(env->regs[7], &sc->regs.r7);
    __put_user(env->regs[8], &sc->regs.r8);
    __put_user(env->regs[9], &sc->regs.r9);
    __put_user(env->regs[10], &sc->regs.r10);
    __put_user(env->regs[11], &sc->regs.r11);
    __put_user(env->regs[12], &sc->regs.r12);
    __put_user(env->regs[13], &sc->regs.r13);
    __put_user(env->regs[14], &sc->regs.r14);
    __put_user(env->regs[15], &sc->regs.r15);
    __put_user(env->regs[16], &sc->regs.r16);
    __put_user(env->regs[17], &sc->regs.r17);
    __put_user(env->regs[18], &sc->regs.r18);
    __put_user(env->regs[19], &sc->regs.r19);
    __put_user(env->regs[20], &sc->regs.r20);
    __put_user(env->regs[21], &sc->regs.r21);
    __put_user(env->regs[22], &sc->regs.r22);
    __put_user(env->regs[23], &sc->regs.r23);
    __put_user(env->regs[24], &sc->regs.r24);
    __put_user(env->regs[25], &sc->regs.r25);
    __put_user(env->regs[26], &sc->regs.r26);
    __put_user(env->regs[27], &sc->regs.r27);
    __put_user(env->regs[28], &sc->regs.r28);
    __put_user(env->regs[29], &sc->regs.r29);
    __put_user(env->regs[30], &sc->regs.r30);
    __put_user(env->regs[31], &sc->regs.r31);
    __put_user(env->sregs[SR_PC], &sc->regs.pc);
}

3483
static void restore_sigcontext(struct target_sigcontext *sc, CPUMBState *env)
3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 3519 3520
{
    __get_user(env->regs[0], &sc->regs.r0);
    __get_user(env->regs[1], &sc->regs.r1);
    __get_user(env->regs[2], &sc->regs.r2);
    __get_user(env->regs[3], &sc->regs.r3);
    __get_user(env->regs[4], &sc->regs.r4);
    __get_user(env->regs[5], &sc->regs.r5);
    __get_user(env->regs[6], &sc->regs.r6);
    __get_user(env->regs[7], &sc->regs.r7);
    __get_user(env->regs[8], &sc->regs.r8);
    __get_user(env->regs[9], &sc->regs.r9);
    __get_user(env->regs[10], &sc->regs.r10);
    __get_user(env->regs[11], &sc->regs.r11);
    __get_user(env->regs[12], &sc->regs.r12);
    __get_user(env->regs[13], &sc->regs.r13);
    __get_user(env->regs[14], &sc->regs.r14);
    __get_user(env->regs[15], &sc->regs.r15);
    __get_user(env->regs[16], &sc->regs.r16);
    __get_user(env->regs[17], &sc->regs.r17);
    __get_user(env->regs[18], &sc->regs.r18);
    __get_user(env->regs[19], &sc->regs.r19);
    __get_user(env->regs[20], &sc->regs.r20);
    __get_user(env->regs[21], &sc->regs.r21);
    __get_user(env->regs[22], &sc->regs.r22);
    __get_user(env->regs[23], &sc->regs.r23);
    __get_user(env->regs[24], &sc->regs.r24);
    __get_user(env->regs[25], &sc->regs.r25);
    __get_user(env->regs[26], &sc->regs.r26);
    __get_user(env->regs[27], &sc->regs.r27);
    __get_user(env->regs[28], &sc->regs.r28);
    __get_user(env->regs[29], &sc->regs.r29);
    __get_user(env->regs[30], &sc->regs.r30);
    __get_user(env->regs[31], &sc->regs.r31);
    __get_user(env->sregs[SR_PC], &sc->regs.pc);
}

static abi_ulong get_sigframe(struct target_sigaction *ka,
3521
                              CPUMBState *env, int frame_size)
3522 3523 3524
{
    abi_ulong sp = env->regs[1];

3525
    if ((ka->sa_flags & TARGET_SA_ONSTACK) != 0 && !on_sig_stack(sp)) {
3526
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
3527
    }
3528 3529 3530 3531 3532

    return ((sp - frame_size) & -8UL);
}

static void setup_frame(int sig, struct target_sigaction *ka,
3533
                        target_sigset_t *set, CPUMBState *env)
3534 3535 3536 3537 3538 3539
{
    struct target_signal_frame *frame;
    abi_ulong frame_addr;
    int i;

    frame_addr = get_sigframe(ka, env, sizeof *frame);
3540
    trace_user_setup_frame(env, frame_addr);
3541 3542 3543 3544
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
        goto badframe;

    /* Save the mask.  */
3545
    __put_user(set->sig[0], &frame->uc.tuc_mcontext.oldmask);
3546 3547

    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3548
        __put_user(set->sig[i], &frame->extramask[i - 1]);
3549 3550
    }

3551
    setup_sigcontext(&frame->uc.tuc_mcontext, env);
3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562

    /* Set up to return from userspace. If provided, use a stub
       already in userspace. */
    /* minus 8 is offset to cater for "rtsd r15,8" offset */
    if (ka->sa_flags & TARGET_SA_RESTORER) {
        env->regs[15] = ((unsigned long)ka->sa_restorer)-8;
    } else {
        uint32_t t;
        /* Note, these encodings are _big endian_! */
        /* addi r12, r0, __NR_sigreturn */
        t = 0x31800000UL | TARGET_NR_sigreturn;
3563
        __put_user(t, frame->tramp + 0);
3564 3565
        /* brki r14, 0x8 */
        t = 0xb9cc0008UL;
3566
        __put_user(t, frame->tramp + 1);
3567 3568 3569 3570 3571 3572 3573

        /* Return from sighandler will jump to the tramp.
           Negative 8 offset because return is rtsd r15, 8 */
        env->regs[15] = ((unsigned long)frame->tramp) - 8;
    }

    /* Set up registers for signal handler */
3574
    env->regs[1] = frame_addr;
3575 3576
    /* Signal handler args: */
    env->regs[5] = sig; /* Arg 0: signum */
3577
    env->regs[6] = 0;
3578 3579
    /* arg 1: sigcontext */
    env->regs[7] = frame_addr += offsetof(typeof(*frame), uc);
3580 3581 3582 3583 3584 3585

    /* Offset of 4 to handle microblaze rtid r14, 0 */
    env->sregs[SR_PC] = (unsigned long)ka->_sa_handler;

    unlock_user_struct(frame, frame_addr, 1);
    return;
3586
badframe:
3587 3588 3589 3590
    force_sig(TARGET_SIGSEGV);
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
3591
                           target_siginfo_t *info,
3592
                           target_sigset_t *set, CPUMBState *env)
3593 3594 3595 3596
{
    fprintf(stderr, "Microblaze setup_rt_frame: not implemented\n");
}

3597
long do_sigreturn(CPUMBState *env)
3598 3599 3600
{
    struct target_signal_frame *frame;
    abi_ulong frame_addr;
A
Anthony Liguori 已提交
3601
    target_sigset_t target_set;
3602 3603 3604 3605
    sigset_t set;
    int i;

    frame_addr = env->regs[R_SP];
3606
    trace_user_do_sigreturn(env, frame_addr);
3607 3608 3609 3610 3611
    /* Make sure the guest isn't playing games.  */
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
        goto badframe;

    /* Restore blocked signals */
3612
    __get_user(target_set.sig[0], &frame->uc.tuc_mcontext.oldmask);
3613
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3614
        __get_user(target_set.sig[i], &frame->extramask[i - 1]);
3615 3616
    }
    target_to_host_sigset_internal(&set, &target_set);
3617
    do_sigprocmask(SIG_SETMASK, &set, NULL);
3618

3619
    restore_sigcontext(&frame->uc.tuc_mcontext, env);
3620 3621 3622
    /* We got here through a sigreturn syscall, our path back is via an
       rtb insn so setup r14 for that.  */
    env->regs[14] = env->sregs[SR_PC];
3623

3624 3625
    unlock_user_struct(frame, frame_addr, 0);
    return env->regs[10];
3626
badframe:
3627 3628 3629
    force_sig(TARGET_SIGSEGV);
}

3630
long do_rt_sigreturn(CPUMBState *env)
3631
{
3632
    trace_user_do_rt_sigreturn(env, 0);
3633 3634 3635 3636
    fprintf(stderr, "Microblaze do_rt_sigreturn: not implemented\n");
    return -TARGET_ENOSYS;
}

3637 3638 3639
#elif defined(TARGET_CRIS)

struct target_sigcontext {
3640 3641 3642
    struct target_pt_regs regs;  /* needs to be first */
    uint32_t oldmask;
    uint32_t usp;    /* usp before stacking this gunk on it */
3643 3644 3645 3646
};

/* Signal frames. */
struct target_signal_frame {
3647 3648 3649
    struct target_sigcontext sc;
    uint32_t extramask[TARGET_NSIG_WORDS - 1];
    uint16_t retcode[4];      /* Trampoline code. */
3650 3651 3652
};

struct rt_signal_frame {
3653 3654 3655 3656 3657
    siginfo_t *pinfo;
    void *puc;
    siginfo_t info;
    struct ucontext uc;
    uint16_t retcode[4];      /* Trampoline code. */
3658 3659
};

3660
static void setup_sigcontext(struct target_sigcontext *sc, CPUCRISState *env)
3661
{
3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680
    __put_user(env->regs[0], &sc->regs.r0);
    __put_user(env->regs[1], &sc->regs.r1);
    __put_user(env->regs[2], &sc->regs.r2);
    __put_user(env->regs[3], &sc->regs.r3);
    __put_user(env->regs[4], &sc->regs.r4);
    __put_user(env->regs[5], &sc->regs.r5);
    __put_user(env->regs[6], &sc->regs.r6);
    __put_user(env->regs[7], &sc->regs.r7);
    __put_user(env->regs[8], &sc->regs.r8);
    __put_user(env->regs[9], &sc->regs.r9);
    __put_user(env->regs[10], &sc->regs.r10);
    __put_user(env->regs[11], &sc->regs.r11);
    __put_user(env->regs[12], &sc->regs.r12);
    __put_user(env->regs[13], &sc->regs.r13);
    __put_user(env->regs[14], &sc->usp);
    __put_user(env->regs[15], &sc->regs.acr);
    __put_user(env->pregs[PR_MOF], &sc->regs.mof);
    __put_user(env->pregs[PR_SRP], &sc->regs.srp);
    __put_user(env->pc, &sc->regs.erp);
3681
}
E
edgar_igl 已提交
3682

3683
static void restore_sigcontext(struct target_sigcontext *sc, CPUCRISState *env)
3684
{
3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703
    __get_user(env->regs[0], &sc->regs.r0);
    __get_user(env->regs[1], &sc->regs.r1);
    __get_user(env->regs[2], &sc->regs.r2);
    __get_user(env->regs[3], &sc->regs.r3);
    __get_user(env->regs[4], &sc->regs.r4);
    __get_user(env->regs[5], &sc->regs.r5);
    __get_user(env->regs[6], &sc->regs.r6);
    __get_user(env->regs[7], &sc->regs.r7);
    __get_user(env->regs[8], &sc->regs.r8);
    __get_user(env->regs[9], &sc->regs.r9);
    __get_user(env->regs[10], &sc->regs.r10);
    __get_user(env->regs[11], &sc->regs.r11);
    __get_user(env->regs[12], &sc->regs.r12);
    __get_user(env->regs[13], &sc->regs.r13);
    __get_user(env->regs[14], &sc->usp);
    __get_user(env->regs[15], &sc->regs.acr);
    __get_user(env->pregs[PR_MOF], &sc->regs.mof);
    __get_user(env->pregs[PR_SRP], &sc->regs.srp);
    __get_user(env->pc, &sc->regs.erp);
E
edgar_igl 已提交
3704 3705
}

3706
static abi_ulong get_sigframe(CPUCRISState *env, int framesize)
E
edgar_igl 已提交
3707
{
3708 3709 3710 3711
    abi_ulong sp;
    /* Align the stack downwards to 4.  */
    sp = (env->regs[R_SP] & ~3);
    return sp - framesize;
3712 3713
}

P
pbrook 已提交
3714
static void setup_frame(int sig, struct target_sigaction *ka,
3715
                        target_sigset_t *set, CPUCRISState *env)
3716
{
3717 3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732
    struct target_signal_frame *frame;
    abi_ulong frame_addr;
    int i;

    frame_addr = get_sigframe(env, sizeof *frame);
    trace_user_setup_frame(env, frame_addr);
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
        goto badframe;

    /*
     * The CRIS signal return trampoline. A real linux/CRIS kernel doesn't
     * use this trampoline anymore but it sets it up for GDB.
     * In QEMU, using the trampoline simplifies things a bit so we use it.
     *
     * This is movu.w __NR_sigreturn, r9; break 13;
     */
3733 3734 3735 3736
    __put_user(0x9c5f, frame->retcode+0);
    __put_user(TARGET_NR_sigreturn,
               frame->retcode + 1);
    __put_user(0xe93d, frame->retcode + 2);
3737

3738
    /* Save the mask.  */
3739
    __put_user(set->sig[0], &frame->sc.oldmask);
3740

3741 3742 3743
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
        __put_user(set->sig[i], &frame->extramask[i - 1]);
    }
3744

3745
    setup_sigcontext(&frame->sc, env);
3746

3747 3748 3749 3750 3751 3752
    /* Move the stack and setup the arguments for the handler.  */
    env->regs[R_SP] = frame_addr;
    env->regs[10] = sig;
    env->pc = (unsigned long) ka->_sa_handler;
    /* Link SRP so the guest returns through the trampoline.  */
    env->pregs[PR_SRP] = frame_addr + offsetof(typeof(*frame), retcode);
3753

3754 3755 3756 3757
    unlock_user_struct(frame, frame_addr, 1);
    return;
badframe:
    force_sig(TARGET_SIGSEGV);
3758 3759
}

P
pbrook 已提交
3760
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
3761
                           target_siginfo_t *info,
3762
                           target_sigset_t *set, CPUCRISState *env)
3763 3764 3765 3766
{
    fprintf(stderr, "CRIS setup_rt_frame: not implemented\n");
}

3767
long do_sigreturn(CPUCRISState *env)
3768
{
3769 3770 3771 3772 3773
    struct target_signal_frame *frame;
    abi_ulong frame_addr;
    target_sigset_t target_set;
    sigset_t set;
    int i;
3774

3775 3776 3777 3778 3779 3780
    frame_addr = env->regs[R_SP];
    trace_user_do_sigreturn(env, frame_addr);
    /* Make sure the guest isn't playing games.  */
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1)) {
        goto badframe;
    }
3781

3782
    /* Restore blocked signals */
3783
    __get_user(target_set.sig[0], &frame->sc.oldmask);
3784
    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3785
        __get_user(target_set.sig[i], &frame->extramask[i - 1]);
3786 3787 3788
    }
    target_to_host_sigset_internal(&set, &target_set);
    do_sigprocmask(SIG_SETMASK, &set, NULL);
3789

3790 3791 3792 3793 3794
    restore_sigcontext(&frame->sc, env);
    unlock_user_struct(frame, frame_addr, 0);
    return env->regs[10];
badframe:
    force_sig(TARGET_SIGSEGV);
3795 3796
}

3797
long do_rt_sigreturn(CPUCRISState *env)
3798
{
3799
    trace_user_do_rt_sigreturn(env, 0);
3800 3801 3802
    fprintf(stderr, "CRIS do_rt_sigreturn: not implemented\n");
    return -TARGET_ENOSYS;
}
3803

J
Jia Liu 已提交
3804 3805 3806 3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826 3827 3828 3829 3830 3831 3832 3833 3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851 3852 3853 3854 3855 3856 3857
#elif defined(TARGET_OPENRISC)

struct target_sigcontext {
    struct target_pt_regs regs;
    abi_ulong oldmask;
    abi_ulong usp;
};

struct target_ucontext {
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
    target_stack_t tuc_stack;
    struct target_sigcontext tuc_mcontext;
    target_sigset_t tuc_sigmask;   /* mask last for extensibility */
};

struct target_rt_sigframe {
    abi_ulong pinfo;
    uint64_t puc;
    struct target_siginfo info;
    struct target_sigcontext sc;
    struct target_ucontext uc;
    unsigned char retcode[16];  /* trampoline code */
};

/* This is the asm-generic/ucontext.h version */
#if 0
static int restore_sigcontext(CPUOpenRISCState *regs,
                              struct target_sigcontext *sc)
{
    unsigned int err = 0;
    unsigned long old_usp;

    /* Alwys make any pending restarted system call return -EINTR */
    current_thread_info()->restart_block.fn = do_no_restart_syscall;

    /* restore the regs from &sc->regs (same as sc, since regs is first)
     * (sc is already checked for VERIFY_READ since the sigframe was
     *  checked in sys_sigreturn previously)
     */

    if (copy_from_user(regs, &sc, sizeof(struct target_pt_regs))) {
        goto badframe;
    }

    /* make sure the U-flag is set so user-mode cannot fool us */

    regs->sr &= ~SR_SM;

    /* restore the old USP as it was before we stacked the sc etc.
     * (we cannot just pop the sigcontext since we aligned the sp and
     *  stuff after pushing it)
     */

3858
    __get_user(old_usp, &sc->usp);
J
Jia Liu 已提交
3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871 3872 3873 3874 3875 3876 3877 3878
    phx_signal("old_usp 0x%lx", old_usp);

    __PHX__ REALLY           /* ??? */
    wrusp(old_usp);
    regs->gpr[1] = old_usp;

    /* TODO: the other ports use regs->orig_XX to disable syscall checks
     * after this completes, but we don't use that mechanism. maybe we can
     * use it now ?
     */

    return err;

badframe:
    return 1;
}
#endif

/* Set up a signal frame.  */

3879
static void setup_sigcontext(struct target_sigcontext *sc,
3880 3881
                             CPUOpenRISCState *regs,
                             unsigned long mask)
J
Jia Liu 已提交
3882 3883 3884 3885 3886
{
    unsigned long usp = regs->gpr[1];

    /* copy the regs. they are first in sc so we can use sc directly */

3887
    /*copy_to_user(&sc, regs, sizeof(struct target_pt_regs));*/
J
Jia Liu 已提交
3888 3889 3890 3891 3892 3893 3894

    /* Set the frametype to CRIS_FRAME_NORMAL for the execution of
       the signal handler. The frametype will be restored to its previous
       value in restore_sigcontext. */
    /*regs->frametype = CRIS_FRAME_NORMAL;*/

    /* then some other stuff */
3895
    __put_user(mask, &sc->oldmask);
3896
    __put_user(usp, &sc->usp);
J
Jia Liu 已提交
3897 3898 3899 3900 3901 3902 3903 3904 3905 3906 3907 3908 3909 3910 3911 3912 3913 3914
}

static inline unsigned long align_sigframe(unsigned long sp)
{
    unsigned long i;
    i = sp & ~3UL;
    return i;
}

static inline abi_ulong get_sigframe(struct target_sigaction *ka,
                                     CPUOpenRISCState *regs,
                                     size_t frame_size)
{
    unsigned long sp = regs->gpr[1];
    int onsigstack = on_sig_stack(sp);

    /* redzone */
    /* This is the X/Open sanctioned signal stack switching.  */
3915
    if ((ka->sa_flags & TARGET_SA_ONSTACK) != 0 && !onsigstack) {
J
Jia Liu 已提交
3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938 3939 3940 3941 3942 3943
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }

    sp = align_sigframe(sp - frame_size);

    /*
     * If we are on the alternate signal stack and would overflow it, don't.
     * Return an always-bogus address instead so we will die with SIGSEGV.
     */

    if (onsigstack && !likely(on_sig_stack(sp))) {
        return -1L;
    }

    return sp;
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
                           target_siginfo_t *info,
                           target_sigset_t *set, CPUOpenRISCState *env)
{
    int err = 0;
    abi_ulong frame_addr;
    unsigned long return_ip;
    struct target_rt_sigframe *frame;
    abi_ulong info_addr, uc_addr;

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
3944
    trace_user_setup_rt_frame(env, frame_addr);
J
Jia Liu 已提交
3945 3946 3947 3948 3949
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }

    info_addr = frame_addr + offsetof(struct target_rt_sigframe, info);
3950
    __put_user(info_addr, &frame->pinfo);
J
Jia Liu 已提交
3951
    uc_addr = frame_addr + offsetof(struct target_rt_sigframe, uc);
3952
    __put_user(uc_addr, &frame->puc);
J
Jia Liu 已提交
3953 3954

    if (ka->sa_flags & SA_SIGINFO) {
3955
        tswap_siginfo(&frame->info, info);
J
Jia Liu 已提交
3956 3957 3958
    }

    /*err |= __clear_user(&frame->uc, offsetof(struct ucontext, uc_mcontext));*/
3959 3960 3961 3962 3963 3964 3965
    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, &frame->uc.tuc_link);
    __put_user(target_sigaltstack_used.ss_sp,
               &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(env->gpr[1]), &frame->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size,
               &frame->uc.tuc_stack.ss_size);
3966
    setup_sigcontext(&frame->sc, env, set->sig[0]);
J
Jia Liu 已提交
3967 3968 3969 3970 3971 3972

    /*err |= copy_to_user(frame->uc.tuc_sigmask, set, sizeof(*set));*/

    /* trampoline - the desired return ip is the retcode itself */
    return_ip = (unsigned long)&frame->retcode;
    /* This is l.ori r11,r0,__NR_sigreturn, l.sys 1 */
3973 3974 3975 3976
    __put_user(0xa960, (short *)(frame->retcode + 0));
    __put_user(TARGET_NR_rt_sigreturn, (short *)(frame->retcode + 2));
    __put_user(0x20000001, (unsigned long *)(frame->retcode + 4));
    __put_user(0x15000000, (unsigned long *)(frame->retcode + 8));
J
Jia Liu 已提交
3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005

    if (err) {
        goto give_sigsegv;
    }

    /* TODO what is the current->exec_domain stuff and invmap ? */

    /* Set up registers for signal handler */
    env->pc = (unsigned long)ka->_sa_handler; /* what we enter NOW */
    env->gpr[9] = (unsigned long)return_ip;     /* what we enter LATER */
    env->gpr[3] = (unsigned long)sig;           /* arg 1: signo */
    env->gpr[4] = (unsigned long)&frame->info;  /* arg 2: (siginfo_t*) */
    env->gpr[5] = (unsigned long)&frame->uc;    /* arg 3: ucontext */

    /* actually move the usp to reflect the stacked frame */
    env->gpr[1] = (unsigned long)frame;

    return;

give_sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
    if (sig == TARGET_SIGSEGV) {
        ka->_sa_handler = TARGET_SIG_DFL;
    }
    force_sig(TARGET_SIGSEGV);
}

long do_sigreturn(CPUOpenRISCState *env)
{
4006 4007
    trace_user_do_sigreturn(env, 0);
    fprintf(stderr, "do_sigreturn: not implemented\n");
J
Jia Liu 已提交
4008 4009 4010 4011 4012
    return -TARGET_ENOSYS;
}

long do_rt_sigreturn(CPUOpenRISCState *env)
{
4013 4014
    trace_user_do_rt_sigreturn(env, 0);
    fprintf(stderr, "do_rt_sigreturn: not implemented\n");
J
Jia Liu 已提交
4015 4016 4017 4018
    return -TARGET_ENOSYS;
}
/* TARGET_OPENRISC */

U
Ulrich Hecht 已提交
4019 4020 4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036 4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048 4049 4050 4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062 4063 4064
#elif defined(TARGET_S390X)

#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 {
4065 4066 4067 4068 4069
    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 */
U
Ulrich Hecht 已提交
4070 4071 4072 4073 4074 4075 4076 4077 4078 4079
};

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
4080
get_sigframe(struct target_sigaction *ka, CPUS390XState *env, size_t frame_size)
U
Ulrich Hecht 已提交
4081 4082 4083 4084 4085 4086 4087 4088 4089 4090 4091 4092 4093 4094 4095 4096 4097 4098 4099 4100 4101 4102 4103 4104
{
    abi_ulong sp;

    /* Default to using normal stack */
    sp = env->regs[15];

    /* This is the X/Open sanctioned signal stack switching.  */
    if (ka->sa_flags & TARGET_SA_ONSTACK) {
        if (!sas_ss_flags(sp)) {
            sp = target_sigaltstack_used.ss_sp +
                 target_sigaltstack_used.ss_size;
        }
    }

    /* 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;
}

4105
static void save_sigregs(CPUS390XState *env, target_sigregs *sregs)
U
Ulrich Hecht 已提交
4106 4107 4108 4109 4110 4111 4112 4113 4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125
{
    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(&current->thread.fp_regs); FIXME
    for (i = 0; i < 16; i++) {
4126
        __put_user(get_freg(env, i)->ll, &sregs->fpregs.fprs[i]);
U
Ulrich Hecht 已提交
4127 4128 4129 4130
    }
}

static void setup_frame(int sig, struct target_sigaction *ka,
4131
                        target_sigset_t *set, CPUS390XState *env)
U
Ulrich Hecht 已提交
4132 4133 4134 4135 4136
{
    sigframe *frame;
    abi_ulong frame_addr;

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
4137
    trace_user_setup_frame(env, frame_addr);
U
Ulrich Hecht 已提交
4138
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
4139
        goto give_sigsegv;
U
Ulrich Hecht 已提交
4140 4141
    }

4142
    __put_user(set->sig[0], &frame->sc.oldmask[0]);
U
Ulrich Hecht 已提交
4143 4144 4145 4146 4147 4148 4149 4150 4151

    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) {
4152 4153
        env->regs[14] = (unsigned long)
                ka->sa_restorer | PSW_ADDR_AMODE;
U
Ulrich Hecht 已提交
4154
    } else {
4155 4156 4157 4158
        env->regs[14] = (unsigned long)
                frame->retcode | PSW_ADDR_AMODE;
        __put_user(S390_SYSCALL_OPCODE | TARGET_NR_sigreturn,
                   (uint16_t *)(frame->retcode));
U
Ulrich Hecht 已提交
4159 4160 4161
    }

    /* Set up backchain. */
4162
    __put_user(env->regs[15], (abi_ulong *) frame);
U
Ulrich Hecht 已提交
4163 4164

    /* Set up registers for signal handler */
4165
    env->regs[15] = frame_addr;
U
Ulrich Hecht 已提交
4166 4167 4168
    env->psw.addr = (target_ulong) ka->_sa_handler | PSW_ADDR_AMODE;

    env->regs[2] = sig; //map_signal(sig);
4169
    env->regs[3] = frame_addr += offsetof(typeof(*frame), sc);
U
Ulrich Hecht 已提交
4170 4171 4172 4173 4174 4175 4176

    /* 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.  */
4177
    __put_user(env->regs[2], (int *) &frame->signo);
U
Ulrich Hecht 已提交
4178 4179 4180 4181 4182 4183 4184 4185 4186
    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
    force_sig(TARGET_SIGSEGV);
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
                           target_siginfo_t *info,
4187
                           target_sigset_t *set, CPUS390XState *env)
U
Ulrich Hecht 已提交
4188 4189 4190 4191 4192 4193
{
    int i;
    rt_sigframe *frame;
    abi_ulong frame_addr;

    frame_addr = get_sigframe(ka, env, sizeof *frame);
4194
    trace_user_setup_rt_frame(env, frame_addr);
U
Ulrich Hecht 已提交
4195 4196 4197 4198
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }

4199
    tswap_siginfo(&frame->info, info);
U
Ulrich Hecht 已提交
4200 4201

    /* Create the ucontext.  */
4202 4203 4204
    __put_user(0, &frame->uc.tuc_flags);
    __put_user((abi_ulong)0, (abi_ulong *)&frame->uc.tuc_link);
    __put_user(target_sigaltstack_used.ss_sp, &frame->uc.tuc_stack.ss_sp);
U
Ulrich Hecht 已提交
4205
    __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
4206
               &frame->uc.tuc_stack.ss_flags);
4207 4208
    __put_user(target_sigaltstack_used.ss_size, &frame->uc.tuc_stack.ss_size);
    save_sigregs(env, &frame->uc.tuc_mcontext);
U
Ulrich Hecht 已提交
4209 4210
    for (i = 0; i < TARGET_NSIG_WORDS; i++) {
        __put_user((abi_ulong)set->sig[i],
4211
                   (abi_ulong *)&frame->uc.tuc_sigmask.sig[i]);
U
Ulrich Hecht 已提交
4212 4213 4214 4215 4216 4217 4218 4219
    }

    /* 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;
4220 4221
        __put_user(S390_SYSCALL_OPCODE | TARGET_NR_rt_sigreturn,
                   (uint16_t *)(frame->retcode));
U
Ulrich Hecht 已提交
4222 4223 4224
    }

    /* Set up backchain. */
4225
    __put_user(env->regs[15], (abi_ulong *) frame);
U
Ulrich Hecht 已提交
4226 4227

    /* Set up registers for signal handler */
4228
    env->regs[15] = frame_addr;
U
Ulrich Hecht 已提交
4229 4230 4231
    env->psw.addr = (target_ulong) ka->_sa_handler | PSW_ADDR_AMODE;

    env->regs[2] = sig; //map_signal(sig);
4232 4233
    env->regs[3] = frame_addr + offsetof(typeof(*frame), info);
    env->regs[4] = frame_addr + offsetof(typeof(*frame), uc);
U
Ulrich Hecht 已提交
4234 4235 4236 4237 4238 4239 4240
    return;

give_sigsegv:
    force_sig(TARGET_SIGSEGV);
}

static int
4241
restore_sigregs(CPUS390XState *env, target_sigregs *sc)
U
Ulrich Hecht 已提交
4242 4243 4244 4245 4246
{
    int err = 0;
    int i;

    for (i = 0; i < 16; i++) {
4247
        __get_user(env->regs[i], &sc->regs.gprs[i]);
U
Ulrich Hecht 已提交
4248 4249
    }

4250
    __get_user(env->psw.mask, &sc->regs.psw.mask);
4251 4252
    trace_user_s390x_restore_sigregs(env, (unsigned long long)sc->regs.psw.addr,
                                     (unsigned long long)env->psw.addr);
4253
    __get_user(env->psw.addr, &sc->regs.psw.addr);
U
Ulrich Hecht 已提交
4254 4255 4256
    /* FIXME: 31-bit -> | PSW_ADDR_AMODE */

    for (i = 0; i < 16; i++) {
4257
        __get_user(env->aregs[i], &sc->regs.acrs[i]);
U
Ulrich Hecht 已提交
4258 4259
    }
    for (i = 0; i < 16; i++) {
4260
        __get_user(get_freg(env, i)->ll, &sc->fpregs.fprs[i]);
U
Ulrich Hecht 已提交
4261 4262 4263 4264 4265
    }

    return err;
}

4266
long do_sigreturn(CPUS390XState *env)
U
Ulrich Hecht 已提交
4267 4268 4269 4270 4271 4272
{
    sigframe *frame;
    abi_ulong frame_addr = env->regs[15];
    target_sigset_t target_set;
    sigset_t set;

4273
    trace_user_do_sigreturn(env, frame_addr);
U
Ulrich Hecht 已提交
4274 4275 4276
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
4277
    __get_user(target_set.sig[0], &frame->sc.oldmask[0]);
U
Ulrich Hecht 已提交
4278 4279

    target_to_host_sigset_internal(&set, &target_set);
4280
    do_sigprocmask(SIG_SETMASK, &set, NULL); /* ~_BLOCKABLE? */
U
Ulrich Hecht 已提交
4281 4282 4283 4284 4285 4286 4287 4288 4289 4290 4291 4292 4293

    if (restore_sigregs(env, &frame->sregs)) {
        goto badframe;
    }

    unlock_user_struct(frame, frame_addr, 0);
    return env->regs[2];

badframe:
    force_sig(TARGET_SIGSEGV);
    return 0;
}

4294
long do_rt_sigreturn(CPUS390XState *env)
U
Ulrich Hecht 已提交
4295 4296 4297 4298 4299
{
    rt_sigframe *frame;
    abi_ulong frame_addr = env->regs[15];
    sigset_t set;

4300
    trace_user_do_rt_sigreturn(env, frame_addr);
U
Ulrich Hecht 已提交
4301 4302 4303
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
4304
    target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
U
Ulrich Hecht 已提交
4305

4306
    do_sigprocmask(SIG_SETMASK, &set, NULL); /* ~_BLOCKABLE? */
U
Ulrich Hecht 已提交
4307

4308
    if (restore_sigregs(env, &frame->uc.tuc_mcontext)) {
U
Ulrich Hecht 已提交
4309 4310 4311
        goto badframe;
    }

4312
    if (do_sigaltstack(frame_addr + offsetof(rt_sigframe, uc.tuc_stack), 0,
U
Ulrich Hecht 已提交
4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323 4324
                       get_sp_from_cpustate(env)) == -EFAULT) {
        goto badframe;
    }
    unlock_user_struct(frame, frame_addr, 0);
    return env->regs[2];

badframe:
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
    return 0;
}

4325
#elif defined(TARGET_PPC)
N
Nathan Froyd 已提交
4326 4327 4328 4329 4330 4331 4332 4333 4334

/* Size of dummy stack frame allocated when calling signal handler.
   See arch/powerpc/include/asm/ptrace.h.  */
#if defined(TARGET_PPC64)
#define SIGNAL_FRAMESIZE 128
#else
#define SIGNAL_FRAMESIZE 64
#endif

4335 4336 4337 4338 4339 4340 4341 4342 4343 4344 4345 4346 4347 4348 4349 4350 4351 4352 4353 4354 4355 4356 4357 4358 4359 4360 4361
/* See arch/powerpc/include/asm/ucontext.h.  Only used for 32-bit PPC;
   on 64-bit PPC, sigcontext and mcontext are one and the same.  */
struct target_mcontext {
    target_ulong mc_gregs[48];
    /* Includes fpscr.  */
    uint64_t mc_fregs[33];
    target_ulong mc_pad[2];
    /* We need to handle Altivec and SPE at the same time, which no
       kernel needs to do.  Fortunately, the kernel defines this bit to
       be Altivec-register-large all the time, rather than trying to
       twiddle it based on the specific platform.  */
    union {
        /* SPE vector registers.  One extra for SPEFSCR.  */
        uint32_t spe[33];
        /* Altivec vector registers.  The packing of VSCR and VRSAVE
           varies depending on whether we're PPC64 or not: PPC64 splits
           them apart; PPC32 stuffs them together.  */
#if defined(TARGET_PPC64)
#define QEMU_NVRREG 34
#else
#define QEMU_NVRREG 33
#endif
        ppc_avr_t altivec[QEMU_NVRREG];
#undef QEMU_NVRREG
    } mc_vregs __attribute__((__aligned__(16)));
};

N
Nathan Froyd 已提交
4362 4363 4364 4365 4366 4367 4368 4369 4370 4371
/* See arch/powerpc/include/asm/sigcontext.h.  */
struct target_sigcontext {
    target_ulong _unused[4];
    int32_t signal;
#if defined(TARGET_PPC64)
    int32_t pad0;
#endif
    target_ulong handler;
    target_ulong oldmask;
    target_ulong regs;      /* struct pt_regs __user * */
4372 4373 4374
#if defined(TARGET_PPC64)
    struct target_mcontext mcontext;
#endif
N
Nathan Froyd 已提交
4375 4376 4377 4378 4379 4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404 4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425 4426 4427 4428 4429 4430
};

/* Indices for target_mcontext.mc_gregs, below.
   See arch/powerpc/include/asm/ptrace.h for details.  */
enum {
    TARGET_PT_R0 = 0,
    TARGET_PT_R1 = 1,
    TARGET_PT_R2 = 2,
    TARGET_PT_R3 = 3,
    TARGET_PT_R4 = 4,
    TARGET_PT_R5 = 5,
    TARGET_PT_R6 = 6,
    TARGET_PT_R7 = 7,
    TARGET_PT_R8 = 8,
    TARGET_PT_R9 = 9,
    TARGET_PT_R10 = 10,
    TARGET_PT_R11 = 11,
    TARGET_PT_R12 = 12,
    TARGET_PT_R13 = 13,
    TARGET_PT_R14 = 14,
    TARGET_PT_R15 = 15,
    TARGET_PT_R16 = 16,
    TARGET_PT_R17 = 17,
    TARGET_PT_R18 = 18,
    TARGET_PT_R19 = 19,
    TARGET_PT_R20 = 20,
    TARGET_PT_R21 = 21,
    TARGET_PT_R22 = 22,
    TARGET_PT_R23 = 23,
    TARGET_PT_R24 = 24,
    TARGET_PT_R25 = 25,
    TARGET_PT_R26 = 26,
    TARGET_PT_R27 = 27,
    TARGET_PT_R28 = 28,
    TARGET_PT_R29 = 29,
    TARGET_PT_R30 = 30,
    TARGET_PT_R31 = 31,
    TARGET_PT_NIP = 32,
    TARGET_PT_MSR = 33,
    TARGET_PT_ORIG_R3 = 34,
    TARGET_PT_CTR = 35,
    TARGET_PT_LNK = 36,
    TARGET_PT_XER = 37,
    TARGET_PT_CCR = 38,
    /* Yes, there are two registers with #39.  One is 64-bit only.  */
    TARGET_PT_MQ = 39,
    TARGET_PT_SOFTE = 39,
    TARGET_PT_TRAP = 40,
    TARGET_PT_DAR = 41,
    TARGET_PT_DSISR = 42,
    TARGET_PT_RESULT = 43,
    TARGET_PT_REGS_COUNT = 44
};


struct target_ucontext {
4431 4432 4433
    target_ulong tuc_flags;
    target_ulong tuc_link;    /* struct ucontext __user * */
    struct target_sigaltstack tuc_stack;
N
Nathan Froyd 已提交
4434
#if !defined(TARGET_PPC64)
4435 4436
    int32_t tuc_pad[7];
    target_ulong tuc_regs;    /* struct mcontext __user *
N
Nathan Froyd 已提交
4437 4438
                                points to uc_mcontext field */
#endif
4439
    target_sigset_t tuc_sigmask;
N
Nathan Froyd 已提交
4440
#if defined(TARGET_PPC64)
A
Anthony Liguori 已提交
4441
    target_sigset_t unused[15]; /* Allow for uc_sigmask growth */
4442
    struct target_sigcontext tuc_sigcontext;
N
Nathan Froyd 已提交
4443
#else
4444 4445 4446
    int32_t tuc_maskext[30];
    int32_t tuc_pad2[3];
    struct target_mcontext tuc_mcontext;
N
Nathan Froyd 已提交
4447 4448 4449 4450 4451 4452 4453 4454 4455 4456
#endif
};

/* See arch/powerpc/kernel/signal_32.c.  */
struct target_sigframe {
    struct target_sigcontext sctx;
    struct target_mcontext mctx;
    int32_t abigap[56];
};

4457 4458 4459 4460 4461
#if defined(TARGET_PPC64)

#define TARGET_TRAMP_SIZE 6

struct target_rt_sigframe {
4462 4463 4464 4465 4466 4467 4468 4469 4470
    /* sys_rt_sigreturn requires the ucontext be the first field */
    struct target_ucontext uc;
    target_ulong  _unused[2];
    uint32_t trampoline[TARGET_TRAMP_SIZE];
    target_ulong pinfo; /* struct siginfo __user * */
    target_ulong puc; /* void __user * */
    struct target_siginfo info;
    /* 64 bit ABI allows for 288 bytes below sp before decrementing it. */
    char abigap[288];
4471 4472 4473 4474
} __attribute__((aligned(16)));

#else

N
Nathan Froyd 已提交
4475 4476 4477 4478 4479 4480
struct target_rt_sigframe {
    struct target_siginfo info;
    struct target_ucontext uc;
    int32_t abigap[56];
};

4481 4482
#endif

4483 4484 4485 4486 4487 4488 4489 4490 4491
#if defined(TARGET_PPC64)

struct target_func_ptr {
    target_ulong entry;
    target_ulong toc;
};

#endif

N
Nathan Froyd 已提交
4492 4493 4494 4495 4496
/* We use the mc_pad field for the signal return trampoline.  */
#define tramp mc_pad

/* See arch/powerpc/kernel/signal.c.  */
static target_ulong get_sigframe(struct target_sigaction *ka,
4497
                                 CPUPPCState *env,
N
Nathan Froyd 已提交
4498 4499 4500 4501 4502 4503 4504
                                 int frame_size)
{
    target_ulong oldsp, newsp;

    oldsp = env->gpr[1];

    if ((ka->sa_flags & TARGET_SA_ONSTACK) &&
4505
            (sas_ss_flags(oldsp) == 0)) {
N
Nathan Froyd 已提交
4506 4507 4508 4509 4510 4511 4512 4513 4514
        oldsp = (target_sigaltstack_used.ss_sp
                 + target_sigaltstack_used.ss_size);
    }

    newsp = (oldsp - frame_size) & ~0xFUL;

    return newsp;
}

4515
static void save_user_regs(CPUPPCState *env, struct target_mcontext *frame)
N
Nathan Froyd 已提交
4516 4517 4518 4519 4520 4521 4522 4523 4524 4525 4526
{
    target_ulong msr = env->msr;
    int i;
    target_ulong ccr = 0;

    /* In general, the kernel attempts to be intelligent about what it
       needs to save for Altivec/FP/SPE registers.  We don't care that
       much, so we just go ahead and save everything.  */

    /* Save general registers.  */
    for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4527
        __put_user(env->gpr[i], &frame->mc_gregs[i]);
N
Nathan Froyd 已提交
4528
    }
4529 4530 4531 4532
    __put_user(env->nip, &frame->mc_gregs[TARGET_PT_NIP]);
    __put_user(env->ctr, &frame->mc_gregs[TARGET_PT_CTR]);
    __put_user(env->lr, &frame->mc_gregs[TARGET_PT_LNK]);
    __put_user(env->xer, &frame->mc_gregs[TARGET_PT_XER]);
N
Nathan Froyd 已提交
4533 4534 4535 4536

    for (i = 0; i < ARRAY_SIZE(env->crf); i++) {
        ccr |= env->crf[i] << (32 - ((i + 1) * 4));
    }
4537
    __put_user(ccr, &frame->mc_gregs[TARGET_PT_CCR]);
N
Nathan Froyd 已提交
4538 4539 4540 4541

    /* Save Altivec registers if necessary.  */
    if (env->insns_flags & PPC_ALTIVEC) {
        for (i = 0; i < ARRAY_SIZE(env->avr); i++) {
A
Anthony Liguori 已提交
4542 4543
            ppc_avr_t *avr = &env->avr[i];
            ppc_avr_t *vreg = &frame->mc_vregs.altivec[i];
N
Nathan Froyd 已提交
4544

4545 4546
            __put_user(avr->u64[0], &vreg->u64[0]);
            __put_user(avr->u64[1], &vreg->u64[1]);
N
Nathan Froyd 已提交
4547 4548 4549 4550
        }
        /* Set MSR_VR in the saved MSR value to indicate that
           frame->mc_vregs contains valid data.  */
        msr |= MSR_VR;
4551 4552
        __put_user((uint32_t)env->spr[SPR_VRSAVE],
                   &frame->mc_vregs.altivec[32].u32[3]);
N
Nathan Froyd 已提交
4553 4554 4555 4556 4557
    }

    /* Save floating point registers.  */
    if (env->insns_flags & PPC_FLOAT) {
        for (i = 0; i < ARRAY_SIZE(env->fpr); i++) {
4558
            __put_user(env->fpr[i], &frame->mc_fregs[i]);
N
Nathan Froyd 已提交
4559
        }
4560
        __put_user((uint64_t) env->fpscr, &frame->mc_fregs[32]);
N
Nathan Froyd 已提交
4561 4562 4563 4564 4565 4566
    }

    /* Save SPE registers.  The kernel only saves the high half.  */
    if (env->insns_flags & PPC_SPE) {
#if defined(TARGET_PPC64)
        for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4567
            __put_user(env->gpr[i] >> 32, &frame->mc_vregs.spe[i]);
N
Nathan Froyd 已提交
4568 4569 4570
        }
#else
        for (i = 0; i < ARRAY_SIZE(env->gprh); i++) {
4571
            __put_user(env->gprh[i], &frame->mc_vregs.spe[i]);
N
Nathan Froyd 已提交
4572 4573 4574 4575 4576
        }
#endif
        /* Set MSR_SPE in the saved MSR value to indicate that
           frame->mc_vregs contains valid data.  */
        msr |= MSR_SPE;
4577
        __put_user(env->spe_fscr, &frame->mc_vregs.spe[32]);
N
Nathan Froyd 已提交
4578 4579 4580
    }

    /* Store MSR.  */
4581
    __put_user(msr, &frame->mc_gregs[TARGET_PT_MSR]);
4582
}
N
Nathan Froyd 已提交
4583

4584 4585
static void encode_trampoline(int sigret, uint32_t *tramp)
{
N
Nathan Froyd 已提交
4586 4587
    /* Set up the sigreturn trampoline: li r0,sigret; sc.  */
    if (sigret) {
4588 4589
        __put_user(0x38000000 | sigret, &tramp[0]);
        __put_user(0x44000002, &tramp[1]);
N
Nathan Froyd 已提交
4590 4591 4592
    }
}

4593 4594
static void restore_user_regs(CPUPPCState *env,
                              struct target_mcontext *frame, int sig)
N
Nathan Froyd 已提交
4595 4596 4597 4598 4599 4600 4601 4602 4603 4604 4605 4606 4607
{
    target_ulong save_r2 = 0;
    target_ulong msr;
    target_ulong ccr;

    int i;

    if (!sig) {
        save_r2 = env->gpr[2];
    }

    /* Restore general registers.  */
    for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4608
        __get_user(env->gpr[i], &frame->mc_gregs[i]);
N
Nathan Froyd 已提交
4609
    }
4610 4611 4612 4613 4614
    __get_user(env->nip, &frame->mc_gregs[TARGET_PT_NIP]);
    __get_user(env->ctr, &frame->mc_gregs[TARGET_PT_CTR]);
    __get_user(env->lr, &frame->mc_gregs[TARGET_PT_LNK]);
    __get_user(env->xer, &frame->mc_gregs[TARGET_PT_XER]);
    __get_user(ccr, &frame->mc_gregs[TARGET_PT_CCR]);
N
Nathan Froyd 已提交
4615 4616 4617 4618 4619 4620 4621 4622 4623

    for (i = 0; i < ARRAY_SIZE(env->crf); i++) {
        env->crf[i] = (ccr >> (32 - ((i + 1) * 4))) & 0xf;
    }

    if (!sig) {
        env->gpr[2] = save_r2;
    }
    /* Restore MSR.  */
4624
    __get_user(msr, &frame->mc_gregs[TARGET_PT_MSR]);
N
Nathan Froyd 已提交
4625 4626 4627 4628 4629 4630 4631 4632

    /* If doing signal return, restore the previous little-endian mode.  */
    if (sig)
        env->msr = (env->msr & ~MSR_LE) | (msr & MSR_LE);

    /* Restore Altivec registers if necessary.  */
    if (env->insns_flags & PPC_ALTIVEC) {
        for (i = 0; i < ARRAY_SIZE(env->avr); i++) {
A
Anthony Liguori 已提交
4633 4634
            ppc_avr_t *avr = &env->avr[i];
            ppc_avr_t *vreg = &frame->mc_vregs.altivec[i];
N
Nathan Froyd 已提交
4635

4636 4637
            __get_user(avr->u64[0], &vreg->u64[0]);
            __get_user(avr->u64[1], &vreg->u64[1]);
N
Nathan Froyd 已提交
4638 4639 4640
        }
        /* Set MSR_VEC in the saved MSR value to indicate that
           frame->mc_vregs contains valid data.  */
4641 4642
        __get_user(env->spr[SPR_VRSAVE],
                   (target_ulong *)(&frame->mc_vregs.altivec[32].u32[3]));
N
Nathan Froyd 已提交
4643 4644 4645 4646 4647 4648
    }

    /* Restore floating point registers.  */
    if (env->insns_flags & PPC_FLOAT) {
        uint64_t fpscr;
        for (i = 0; i < ARRAY_SIZE(env->fpr); i++) {
4649
            __get_user(env->fpr[i], &frame->mc_fregs[i]);
N
Nathan Froyd 已提交
4650
        }
4651
        __get_user(fpscr, &frame->mc_fregs[32]);
N
Nathan Froyd 已提交
4652 4653 4654 4655 4656 4657 4658 4659 4660
        env->fpscr = (uint32_t) fpscr;
    }

    /* Save SPE registers.  The kernel only saves the high half.  */
    if (env->insns_flags & PPC_SPE) {
#if defined(TARGET_PPC64)
        for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
            uint32_t hi;

4661
            __get_user(hi, &frame->mc_vregs.spe[i]);
N
Nathan Froyd 已提交
4662 4663 4664 4665
            env->gpr[i] = ((uint64_t)hi << 32) | ((uint32_t) env->gpr[i]);
        }
#else
        for (i = 0; i < ARRAY_SIZE(env->gprh); i++) {
4666
            __get_user(env->gprh[i], &frame->mc_vregs.spe[i]);
N
Nathan Froyd 已提交
4667 4668
        }
#endif
4669
        __get_user(env->spe_fscr, &frame->mc_vregs.spe[32]);
N
Nathan Froyd 已提交
4670 4671 4672 4673
    }
}

static void setup_frame(int sig, struct target_sigaction *ka,
4674
                        target_sigset_t *set, CPUPPCState *env)
N
Nathan Froyd 已提交
4675 4676 4677 4678 4679
{
    struct target_sigframe *frame;
    struct target_sigcontext *sc;
    target_ulong frame_addr, newsp;
    int err = 0;
4680 4681 4682
#if defined(TARGET_PPC64)
    struct image_info *image = ((TaskState *)thread_cpu->opaque)->info;
#endif
N
Nathan Froyd 已提交
4683 4684

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
4685
    trace_user_setup_frame(env, frame_addr);
N
Nathan Froyd 已提交
4686 4687 4688 4689
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
        goto sigsegv;
    sc = &frame->sctx;

4690 4691
    __put_user(ka->_sa_handler, &sc->handler);
    __put_user(set->sig[0], &sc->oldmask);
4692
#if TARGET_ABI_BITS == 64
4693
    __put_user(set->sig[0] >> 32, &sc->_unused[3]);
N
Nathan Froyd 已提交
4694
#else
4695
    __put_user(set->sig[1], &sc->_unused[3]);
N
Nathan Froyd 已提交
4696
#endif
4697 4698
    __put_user(h2g(&frame->mctx), &sc->regs);
    __put_user(sig, &sc->signal);
N
Nathan Froyd 已提交
4699 4700

    /* Save user regs.  */
4701 4702 4703 4704
    save_user_regs(env, &frame->mctx);

    /* Construct the trampoline code on the stack. */
    encode_trampoline(TARGET_NR_sigreturn, (uint32_t *)&frame->mctx.tramp);
N
Nathan Froyd 已提交
4705 4706 4707 4708 4709 4710 4711 4712 4713 4714

    /* The kernel checks for the presence of a VDSO here.  We don't
       emulate a vdso, so use a sigreturn system call.  */
    env->lr = (target_ulong) h2g(frame->mctx.tramp);

    /* Turn off all fp exceptions.  */
    env->fpscr = 0;

    /* Create a stack frame for the caller of the handler.  */
    newsp = frame_addr - SIGNAL_FRAMESIZE;
4715
    err |= put_user(env->gpr[1], newsp, target_ulong);
N
Nathan Froyd 已提交
4716 4717 4718 4719 4720 4721

    if (err)
        goto sigsegv;

    /* Set up registers for signal handler.  */
    env->gpr[1] = newsp;
4722
    env->gpr[3] = sig;
4723
    env->gpr[4] = frame_addr + offsetof(struct target_sigframe, sctx);
4724 4725

#if defined(TARGET_PPC64)
4726 4727 4728 4729 4730 4731 4732 4733 4734 4735 4736 4737
    if (get_ppc64_abi(image) < 2) {
        /* ELFv1 PPC64 function pointers are pointers to OPD entries. */
        struct target_func_ptr *handler =
            (struct target_func_ptr *)g2h(ka->_sa_handler);
        env->nip = tswapl(handler->entry);
        env->gpr[2] = tswapl(handler->toc);
    } else {
        /* ELFv2 PPC64 function pointers are entry points, but R12
         * must also be set */
        env->nip = tswapl((target_ulong) ka->_sa_handler);
        env->gpr[12] = env->nip;
    }
4738
#else
N
Nathan Froyd 已提交
4739
    env->nip = (target_ulong) ka->_sa_handler;
4740 4741
#endif

N
Nathan Froyd 已提交
4742 4743 4744 4745 4746 4747 4748 4749
    /* Signal handlers are entered in big-endian mode.  */
    env->msr &= ~MSR_LE;

    unlock_user_struct(frame, frame_addr, 1);
    return;

sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
4750
    force_sig(TARGET_SIGSEGV);
N
Nathan Froyd 已提交
4751 4752 4753
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
4754
                           target_siginfo_t *info,
4755
                           target_sigset_t *set, CPUPPCState *env)
N
Nathan Froyd 已提交
4756 4757
{
    struct target_rt_sigframe *rt_sf;
4758 4759
    uint32_t *trampptr = 0;
    struct target_mcontext *mctx = 0;
N
Nathan Froyd 已提交
4760 4761
    target_ulong rt_sf_addr, newsp = 0;
    int i, err = 0;
4762 4763 4764
#if defined(TARGET_PPC64)
    struct image_info *image = ((TaskState *)thread_cpu->opaque)->info;
#endif
N
Nathan Froyd 已提交
4765 4766 4767 4768 4769

    rt_sf_addr = get_sigframe(ka, env, sizeof(*rt_sf));
    if (!lock_user_struct(VERIFY_WRITE, rt_sf, rt_sf_addr, 1))
        goto sigsegv;

4770
    tswap_siginfo(&rt_sf->info, info);
N
Nathan Froyd 已提交
4771

4772 4773 4774 4775 4776 4777 4778 4779
    __put_user(0, &rt_sf->uc.tuc_flags);
    __put_user(0, &rt_sf->uc.tuc_link);
    __put_user((target_ulong)target_sigaltstack_used.ss_sp,
               &rt_sf->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(env->gpr[1]),
               &rt_sf->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size,
               &rt_sf->uc.tuc_stack.ss_size);
4780
#if !defined(TARGET_PPC64)
4781 4782
    __put_user(h2g (&rt_sf->uc.tuc_mcontext),
               &rt_sf->uc.tuc_regs);
4783
#endif
N
Nathan Froyd 已提交
4784
    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
4785
        __put_user(set->sig[i], &rt_sf->uc.tuc_sigmask.sig[i]);
N
Nathan Froyd 已提交
4786 4787
    }

4788 4789 4790 4791 4792 4793 4794 4795 4796 4797
#if defined(TARGET_PPC64)
    mctx = &rt_sf->uc.tuc_sigcontext.mcontext;
    trampptr = &rt_sf->trampoline[0];
#else
    mctx = &rt_sf->uc.tuc_mcontext;
    trampptr = (uint32_t *)&rt_sf->uc.tuc_mcontext.tramp;
#endif

    save_user_regs(env, mctx);
    encode_trampoline(TARGET_NR_rt_sigreturn, trampptr);
N
Nathan Froyd 已提交
4798 4799 4800

    /* The kernel checks for the presence of a VDSO here.  We don't
       emulate a vdso, so use a sigreturn system call.  */
4801
    env->lr = (target_ulong) h2g(trampptr);
N
Nathan Froyd 已提交
4802 4803 4804 4805 4806 4807

    /* Turn off all fp exceptions.  */
    env->fpscr = 0;

    /* Create a stack frame for the caller of the handler.  */
    newsp = rt_sf_addr - (SIGNAL_FRAMESIZE + 16);
4808
    err |= put_user(env->gpr[1], newsp, target_ulong);
N
Nathan Froyd 已提交
4809 4810 4811 4812 4813 4814

    if (err)
        goto sigsegv;

    /* Set up registers for signal handler.  */
    env->gpr[1] = newsp;
4815
    env->gpr[3] = (target_ulong) sig;
N
Nathan Froyd 已提交
4816 4817 4818
    env->gpr[4] = (target_ulong) h2g(&rt_sf->info);
    env->gpr[5] = (target_ulong) h2g(&rt_sf->uc);
    env->gpr[6] = (target_ulong) h2g(rt_sf);
4819 4820

#if defined(TARGET_PPC64)
4821 4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832
    if (get_ppc64_abi(image) < 2) {
        /* ELFv1 PPC64 function pointers are pointers to OPD entries. */
        struct target_func_ptr *handler =
            (struct target_func_ptr *)g2h(ka->_sa_handler);
        env->nip = tswapl(handler->entry);
        env->gpr[2] = tswapl(handler->toc);
    } else {
        /* ELFv2 PPC64 function pointers are entry points, but R12
         * must also be set */
        env->nip = tswapl((target_ulong) ka->_sa_handler);
        env->gpr[12] = env->nip;
    }
4833
#else
N
Nathan Froyd 已提交
4834
    env->nip = (target_ulong) ka->_sa_handler;
4835 4836
#endif

N
Nathan Froyd 已提交
4837 4838 4839 4840 4841 4842 4843 4844
    /* Signal handlers are entered in big-endian mode.  */
    env->msr &= ~MSR_LE;

    unlock_user_struct(rt_sf, rt_sf_addr, 1);
    return;

sigsegv:
    unlock_user_struct(rt_sf, rt_sf_addr, 1);
4845
    force_sig(TARGET_SIGSEGV);
N
Nathan Froyd 已提交
4846 4847 4848

}

4849
long do_sigreturn(CPUPPCState *env)
N
Nathan Froyd 已提交
4850 4851 4852
{
    struct target_sigcontext *sc = NULL;
    struct target_mcontext *sr = NULL;
4853
    target_ulong sr_addr = 0, sc_addr;
N
Nathan Froyd 已提交
4854
    sigset_t blocked;
A
Anthony Liguori 已提交
4855
    target_sigset_t set;
N
Nathan Froyd 已提交
4856 4857 4858 4859 4860 4861

    sc_addr = env->gpr[1] + SIGNAL_FRAMESIZE;
    if (!lock_user_struct(VERIFY_READ, sc, sc_addr, 1))
        goto sigsegv;

#if defined(TARGET_PPC64)
4862
    set.sig[0] = sc->oldmask + ((uint64_t)(sc->_unused[3]) << 32);
N
Nathan Froyd 已提交
4863
#else
4864 4865
    __get_user(set.sig[0], &sc->oldmask);
    __get_user(set.sig[1], &sc->_unused[3]);
N
Nathan Froyd 已提交
4866 4867
#endif
    target_to_host_sigset_internal(&blocked, &set);
4868
    do_sigprocmask(SIG_SETMASK, &blocked, NULL);
N
Nathan Froyd 已提交
4869

4870
    __get_user(sr_addr, &sc->regs);
N
Nathan Froyd 已提交
4871 4872
    if (!lock_user_struct(VERIFY_READ, sr, sr_addr, 1))
        goto sigsegv;
4873
    restore_user_regs(env, sr, 1);
N
Nathan Froyd 已提交
4874 4875 4876 4877 4878 4879 4880 4881

    unlock_user_struct(sr, sr_addr, 1);
    unlock_user_struct(sc, sc_addr, 1);
    return -TARGET_QEMU_ESIGRETURN;

sigsegv:
    unlock_user_struct(sr, sr_addr, 1);
    unlock_user_struct(sc, sc_addr, 1);
4882
    force_sig(TARGET_SIGSEGV);
N
Nathan Froyd 已提交
4883 4884 4885 4886
    return 0;
}

/* See arch/powerpc/kernel/signal_32.c.  */
4887
static int do_setcontext(struct target_ucontext *ucp, CPUPPCState *env, int sig)
N
Nathan Froyd 已提交
4888 4889 4890 4891
{
    struct target_mcontext *mcp;
    target_ulong mcp_addr;
    sigset_t blocked;
A
Anthony Liguori 已提交
4892
    target_sigset_t set;
N
Nathan Froyd 已提交
4893

4894
    if (copy_from_user(&set, h2g(ucp) + offsetof(struct target_ucontext, tuc_sigmask),
N
Nathan Froyd 已提交
4895 4896 4897
                       sizeof (set)))
        return 1;

4898 4899 4900 4901
#if defined(TARGET_PPC64)
    mcp_addr = h2g(ucp) +
        offsetof(struct target_ucontext, tuc_sigcontext.mcontext);
#else
4902
    __get_user(mcp_addr, &ucp->tuc_regs);
4903
#endif
N
Nathan Froyd 已提交
4904 4905 4906 4907 4908

    if (!lock_user_struct(VERIFY_READ, mcp, mcp_addr, 1))
        return 1;

    target_to_host_sigset_internal(&blocked, &set);
4909
    do_sigprocmask(SIG_SETMASK, &blocked, NULL);
4910
    restore_user_regs(env, mcp, sig);
N
Nathan Froyd 已提交
4911 4912 4913 4914 4915

    unlock_user_struct(mcp, mcp_addr, 1);
    return 0;
}

4916
long do_rt_sigreturn(CPUPPCState *env)
N
Nathan Froyd 已提交
4917 4918 4919 4920 4921 4922 4923 4924 4925 4926 4927 4928
{
    struct target_rt_sigframe *rt_sf = NULL;
    target_ulong rt_sf_addr;

    rt_sf_addr = env->gpr[1] + SIGNAL_FRAMESIZE + 16;
    if (!lock_user_struct(VERIFY_READ, rt_sf, rt_sf_addr, 1))
        goto sigsegv;

    if (do_setcontext(&rt_sf->uc, env, 1))
        goto sigsegv;

    do_sigaltstack(rt_sf_addr
4929
                   + offsetof(struct target_rt_sigframe, uc.tuc_stack),
N
Nathan Froyd 已提交
4930 4931 4932 4933 4934 4935 4936
                   0, env->gpr[1]);

    unlock_user_struct(rt_sf, rt_sf_addr, 1);
    return -TARGET_QEMU_ESIGRETURN;

sigsegv:
    unlock_user_struct(rt_sf, rt_sf_addr, 1);
4937
    force_sig(TARGET_SIGSEGV);
N
Nathan Froyd 已提交
4938 4939 4940
    return 0;
}

4941 4942 4943 4944 4945 4946 4947 4948 4949 4950 4951 4952 4953 4954 4955 4956 4957 4958 4959 4960 4961 4962 4963
#elif defined(TARGET_M68K)

struct target_sigcontext {
    abi_ulong  sc_mask;
    abi_ulong  sc_usp;
    abi_ulong  sc_d0;
    abi_ulong  sc_d1;
    abi_ulong  sc_a0;
    abi_ulong  sc_a1;
    unsigned short sc_sr;
    abi_ulong  sc_pc;
};

struct target_sigframe
{
    abi_ulong pretcode;
    int sig;
    int code;
    abi_ulong psc;
    char retcode[8];
    abi_ulong extramask[TARGET_NSIG_WORDS-1];
    struct target_sigcontext sc;
};
4964

A
Anthony Liguori 已提交
4965
typedef int target_greg_t;
4966
#define TARGET_NGREG 18
A
Anthony Liguori 已提交
4967
typedef target_greg_t target_gregset_t[TARGET_NGREG];
4968 4969 4970 4971

typedef struct target_fpregset {
    int f_fpcntl[3];
    int f_fpregs[8*3];
A
Anthony Liguori 已提交
4972
} target_fpregset_t;
4973 4974 4975

struct target_mcontext {
    int version;
A
Anthony Liguori 已提交
4976 4977
    target_gregset_t gregs;
    target_fpregset_t fpregs;
4978 4979 4980 4981 4982
};

#define TARGET_MCONTEXT_VERSION 2

struct target_ucontext {
4983 4984 4985 4986 4987 4988
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
    target_stack_t tuc_stack;
    struct target_mcontext tuc_mcontext;
    abi_long tuc_filler[80];
    target_sigset_t tuc_sigmask;
4989 4990 4991 4992 4993 4994 4995 4996 4997 4998 4999 5000
};

struct target_rt_sigframe
{
    abi_ulong pretcode;
    int sig;
    abi_ulong pinfo;
    abi_ulong puc;
    char retcode[8];
    struct target_siginfo info;
    struct target_ucontext uc;
};
5001

5002
static void setup_sigcontext(struct target_sigcontext *sc, CPUM68KState *env,
5003
                             abi_ulong mask)
5004
{
5005 5006 5007 5008 5009 5010 5011 5012
    __put_user(mask, &sc->sc_mask);
    __put_user(env->aregs[7], &sc->sc_usp);
    __put_user(env->dregs[0], &sc->sc_d0);
    __put_user(env->dregs[1], &sc->sc_d1);
    __put_user(env->aregs[0], &sc->sc_a0);
    __put_user(env->aregs[1], &sc->sc_a1);
    __put_user(env->sr, &sc->sc_sr);
    __put_user(env->pc, &sc->sc_pc);
5013 5014
}

5015
static void
5016
restore_sigcontext(CPUM68KState *env, struct target_sigcontext *sc, int *pd0)
5017 5018 5019
{
    int temp;

5020 5021 5022 5023 5024 5025
    __get_user(env->aregs[7], &sc->sc_usp);
    __get_user(env->dregs[1], &sc->sc_d1);
    __get_user(env->aregs[0], &sc->sc_a0);
    __get_user(env->aregs[1], &sc->sc_a1);
    __get_user(env->pc, &sc->sc_pc);
    __get_user(temp, &sc->sc_sr);
5026 5027 5028 5029 5030 5031 5032 5033 5034
    env->sr = (env->sr & 0xff00) | (temp & 0xff);

    *pd0 = tswapl(sc->sc_d0);
}

/*
 * Determine which stack to use..
 */
static inline abi_ulong
5035 5036
get_sigframe(struct target_sigaction *ka, CPUM68KState *regs,
             size_t frame_size)
5037 5038 5039 5040 5041 5042 5043 5044 5045 5046 5047 5048 5049 5050
{
    unsigned long sp;

    sp = regs->aregs[7];

    /* This is the X/Open sanctioned signal stack switching.  */
    if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }

    return ((sp - frame_size) & -8UL);
}

static void setup_frame(int sig, struct target_sigaction *ka,
5051
                        target_sigset_t *set, CPUM68KState *env)
5052 5053 5054 5055 5056 5057 5058 5059
{
    struct target_sigframe *frame;
    abi_ulong frame_addr;
    abi_ulong retcode_addr;
    abi_ulong sc_addr;
    int i;

    frame_addr = get_sigframe(ka, env, sizeof *frame);
5060
    trace_user_setup_frame(env, frame_addr);
5061 5062 5063
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }
5064

5065
    __put_user(sig, &frame->sig);
5066 5067

    sc_addr = frame_addr + offsetof(struct target_sigframe, sc);
5068
    __put_user(sc_addr, &frame->psc);
5069

5070
    setup_sigcontext(&frame->sc, env, set->sig[0]);
5071 5072

    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
5073
        __put_user(set->sig[i], &frame->extramask[i - 1]);
5074 5075 5076 5077 5078
    }

    /* Set up to return from userspace.  */

    retcode_addr = frame_addr + offsetof(struct target_sigframe, retcode);
5079
    __put_user(retcode_addr, &frame->pretcode);
5080 5081 5082

    /* moveq #,d0; trap #0 */

5083
    __put_user(0x70004e40 + (TARGET_NR_sigreturn << 16),
5084
               (uint32_t *)(frame->retcode));
5085 5086 5087 5088 5089 5090 5091 5092 5093 5094

    /* Set up to return from userspace */

    env->aregs[7] = frame_addr;
    env->pc = ka->_sa_handler;

    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
5095
    force_sig(TARGET_SIGSEGV);
5096 5097
}

5098
static inline int target_rt_setup_ucontext(struct target_ucontext *uc,
5099
                                           CPUM68KState *env)
5100
{
5101
    target_greg_t *gregs = uc->tuc_mcontext.gregs;
5102

5103 5104 5105 5106 5107 5108 5109 5110 5111 5112 5113 5114 5115 5116 5117 5118 5119 5120 5121
    __put_user(TARGET_MCONTEXT_VERSION, &uc->tuc_mcontext.version);
    __put_user(env->dregs[0], &gregs[0]);
    __put_user(env->dregs[1], &gregs[1]);
    __put_user(env->dregs[2], &gregs[2]);
    __put_user(env->dregs[3], &gregs[3]);
    __put_user(env->dregs[4], &gregs[4]);
    __put_user(env->dregs[5], &gregs[5]);
    __put_user(env->dregs[6], &gregs[6]);
    __put_user(env->dregs[7], &gregs[7]);
    __put_user(env->aregs[0], &gregs[8]);
    __put_user(env->aregs[1], &gregs[9]);
    __put_user(env->aregs[2], &gregs[10]);
    __put_user(env->aregs[3], &gregs[11]);
    __put_user(env->aregs[4], &gregs[12]);
    __put_user(env->aregs[5], &gregs[13]);
    __put_user(env->aregs[6], &gregs[14]);
    __put_user(env->aregs[7], &gregs[15]);
    __put_user(env->pc, &gregs[16]);
    __put_user(env->sr, &gregs[17]);
5122

5123
    return 0;
5124
}
5125

5126
static inline int target_rt_restore_ucontext(CPUM68KState *env,
5127 5128 5129 5130
                                             struct target_ucontext *uc,
                                             int *pd0)
{
    int temp;
5131
    target_greg_t *gregs = uc->tuc_mcontext.gregs;
5132
    
5133
    __get_user(temp, &uc->tuc_mcontext.version);
5134 5135 5136 5137
    if (temp != TARGET_MCONTEXT_VERSION)
        goto badframe;

    /* restore passed registers */
5138 5139 5140 5141 5142 5143 5144 5145 5146 5147 5148 5149 5150 5151 5152 5153 5154 5155
    __get_user(env->dregs[0], &gregs[0]);
    __get_user(env->dregs[1], &gregs[1]);
    __get_user(env->dregs[2], &gregs[2]);
    __get_user(env->dregs[3], &gregs[3]);
    __get_user(env->dregs[4], &gregs[4]);
    __get_user(env->dregs[5], &gregs[5]);
    __get_user(env->dregs[6], &gregs[6]);
    __get_user(env->dregs[7], &gregs[7]);
    __get_user(env->aregs[0], &gregs[8]);
    __get_user(env->aregs[1], &gregs[9]);
    __get_user(env->aregs[2], &gregs[10]);
    __get_user(env->aregs[3], &gregs[11]);
    __get_user(env->aregs[4], &gregs[12]);
    __get_user(env->aregs[5], &gregs[13]);
    __get_user(env->aregs[6], &gregs[14]);
    __get_user(env->aregs[7], &gregs[15]);
    __get_user(env->pc, &gregs[16]);
    __get_user(temp, &gregs[17]);
5156 5157 5158
    env->sr = (env->sr & 0xff00) | (temp & 0xff);

    *pd0 = env->dregs[0];
5159
    return 0;
5160 5161 5162 5163 5164

badframe:
    return 1;
}

5165
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
5166
                           target_siginfo_t *info,
5167
                           target_sigset_t *set, CPUM68KState *env)
5168
{
5169 5170 5171 5172 5173 5174 5175 5176 5177
    struct target_rt_sigframe *frame;
    abi_ulong frame_addr;
    abi_ulong retcode_addr;
    abi_ulong info_addr;
    abi_ulong uc_addr;
    int err = 0;
    int i;

    frame_addr = get_sigframe(ka, env, sizeof *frame);
5178
    trace_user_setup_rt_frame(env, frame_addr);
5179 5180 5181
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }
5182

5183
    __put_user(sig, &frame->sig);
5184 5185

    info_addr = frame_addr + offsetof(struct target_rt_sigframe, info);
5186
    __put_user(info_addr, &frame->pinfo);
5187 5188

    uc_addr = frame_addr + offsetof(struct target_rt_sigframe, uc);
5189
    __put_user(uc_addr, &frame->puc);
5190

5191
    tswap_siginfo(&frame->info, info);
5192 5193 5194

    /* Create the ucontext */

5195 5196 5197 5198 5199
    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, &frame->uc.tuc_link);
    __put_user(target_sigaltstack_used.ss_sp,
               &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(env->aregs[7]),
5200
            &frame->uc.tuc_stack.ss_flags);
5201 5202
    __put_user(target_sigaltstack_used.ss_size,
               &frame->uc.tuc_stack.ss_size);
5203 5204 5205
    err |= target_rt_setup_ucontext(&frame->uc, env);

    if (err)
5206
        goto give_sigsegv;
5207 5208

    for(i = 0; i < TARGET_NSIG_WORDS; i++) {
5209
        __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
5210 5211 5212 5213 5214
    }

    /* Set up to return from userspace.  */

    retcode_addr = frame_addr + offsetof(struct target_sigframe, retcode);
5215
    __put_user(retcode_addr, &frame->pretcode);
5216 5217 5218

    /* moveq #,d0; notb d0; trap #0 */

5219
    __put_user(0x70004600 + ((TARGET_NR_rt_sigreturn ^ 0xff) << 16),
5220 5221
               (uint32_t *)(frame->retcode + 0));
    __put_user(0x4e40, (uint16_t *)(frame->retcode + 4));
5222 5223 5224 5225 5226 5227 5228 5229 5230 5231 5232 5233 5234 5235

    if (err)
        goto give_sigsegv;

    /* Set up to return from userspace */

    env->aregs[7] = frame_addr;
    env->pc = ka->_sa_handler;

    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
    unlock_user_struct(frame, frame_addr, 1);
5236
    force_sig(TARGET_SIGSEGV);
5237 5238
}

5239
long do_sigreturn(CPUM68KState *env)
5240 5241 5242
{
    struct target_sigframe *frame;
    abi_ulong frame_addr = env->aregs[7] - 4;
A
Anthony Liguori 已提交
5243
    target_sigset_t target_set;
5244 5245 5246
    sigset_t set;
    int d0, i;

5247
    trace_user_do_sigreturn(env, frame_addr);
5248 5249 5250 5251 5252
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
        goto badframe;

    /* set blocked signals */

5253
    __get_user(target_set.sig[0], &frame->sc.sc_mask);
5254 5255

    for(i = 1; i < TARGET_NSIG_WORDS; i++) {
5256
        __get_user(target_set.sig[i], &frame->extramask[i - 1]);
5257 5258 5259
    }

    target_to_host_sigset_internal(&set, &target_set);
5260
    do_sigprocmask(SIG_SETMASK, &set, NULL);
5261 5262 5263

    /* restore registers */

5264
    restore_sigcontext(env, &frame->sc, &d0);
5265 5266 5267 5268 5269 5270 5271 5272 5273

    unlock_user_struct(frame, frame_addr, 0);
    return d0;

badframe:
    force_sig(TARGET_SIGSEGV);
    return 0;
}

5274
long do_rt_sigreturn(CPUM68KState *env)
5275
{
5276 5277
    struct target_rt_sigframe *frame;
    abi_ulong frame_addr = env->aregs[7] - 4;
A
Anthony Liguori 已提交
5278
    target_sigset_t target_set;
5279 5280 5281
    sigset_t set;
    int d0;

5282
    trace_user_do_rt_sigreturn(env, frame_addr);
5283 5284 5285 5286
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
        goto badframe;

    target_to_host_sigset_internal(&set, &target_set);
5287
    do_sigprocmask(SIG_SETMASK, &set, NULL);
5288 5289 5290 5291 5292 5293 5294

    /* restore registers */

    if (target_rt_restore_ucontext(env, &frame->uc, &d0))
        goto badframe;

    if (do_sigaltstack(frame_addr +
5295
                       offsetof(struct target_rt_sigframe, uc.tuc_stack),
5296 5297 5298 5299 5300 5301 5302 5303 5304 5305
                       0, get_sp_from_cpustate(env)) == -EFAULT)
        goto badframe;

    unlock_user_struct(frame, frame_addr, 0);
    return d0;

badframe:
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
    return 0;
5306 5307
}

5308 5309 5310 5311 5312 5313 5314 5315 5316 5317 5318 5319 5320 5321 5322 5323 5324 5325 5326 5327 5328 5329 5330 5331 5332
#elif defined(TARGET_ALPHA)

struct target_sigcontext {
    abi_long sc_onstack;
    abi_long sc_mask;
    abi_long sc_pc;
    abi_long sc_ps;
    abi_long sc_regs[32];
    abi_long sc_ownedfp;
    abi_long sc_fpregs[32];
    abi_ulong sc_fpcr;
    abi_ulong sc_fp_control;
    abi_ulong sc_reserved1;
    abi_ulong sc_reserved2;
    abi_ulong sc_ssize;
    abi_ulong sc_sbase;
    abi_ulong sc_traparg_a0;
    abi_ulong sc_traparg_a1;
    abi_ulong sc_traparg_a2;
    abi_ulong sc_fp_trap_pc;
    abi_ulong sc_fp_trigger_sum;
    abi_ulong sc_fp_trigger_inst;
};

struct target_ucontext {
5333 5334 5335 5336 5337 5338
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
    abi_ulong tuc_osf_sigmask;
    target_stack_t tuc_stack;
    struct target_sigcontext tuc_mcontext;
    target_sigset_t tuc_sigmask;
5339 5340 5341 5342 5343 5344 5345 5346 5347 5348 5349 5350 5351 5352 5353 5354 5355
};

struct target_sigframe {
    struct target_sigcontext sc;
    unsigned int retcode[3];
};

struct target_rt_sigframe {
    target_siginfo_t info;
    struct target_ucontext uc;
    unsigned int retcode[3];
};

#define INSN_MOV_R30_R16        0x47fe0410
#define INSN_LDI_R0             0x201f0000
#define INSN_CALLSYS            0x00000083

5356
static void setup_sigcontext(struct target_sigcontext *sc, CPUAlphaState *env,
5357
                             abi_ulong frame_addr, target_sigset_t *set)
5358
{
5359
    int i;
5360

5361 5362 5363 5364
    __put_user(on_sig_stack(frame_addr), &sc->sc_onstack);
    __put_user(set->sig[0], &sc->sc_mask);
    __put_user(env->pc, &sc->sc_pc);
    __put_user(8, &sc->sc_ps);
5365 5366

    for (i = 0; i < 31; ++i) {
5367
        __put_user(env->ir[i], &sc->sc_regs[i]);
5368
    }
5369
    __put_user(0, &sc->sc_regs[31]);
5370 5371

    for (i = 0; i < 31; ++i) {
5372
        __put_user(env->fir[i], &sc->sc_fpregs[i]);
5373
    }
5374 5375
    __put_user(0, &sc->sc_fpregs[31]);
    __put_user(cpu_alpha_load_fpcr(env), &sc->sc_fpcr);
5376

5377 5378 5379
    __put_user(0, &sc->sc_traparg_a0); /* FIXME */
    __put_user(0, &sc->sc_traparg_a1); /* FIXME */
    __put_user(0, &sc->sc_traparg_a2); /* FIXME */
5380 5381
}

5382
static void restore_sigcontext(CPUAlphaState *env,
5383
                               struct target_sigcontext *sc)
5384 5385
{
    uint64_t fpcr;
5386
    int i;
5387

5388
    __get_user(env->pc, &sc->sc_pc);
5389 5390

    for (i = 0; i < 31; ++i) {
5391
        __get_user(env->ir[i], &sc->sc_regs[i]);
5392 5393
    }
    for (i = 0; i < 31; ++i) {
5394
        __get_user(env->fir[i], &sc->sc_fpregs[i]);
5395 5396
    }

5397
    __get_user(fpcr, &sc->sc_fpcr);
5398 5399 5400 5401
    cpu_alpha_store_fpcr(env, fpcr);
}

static inline abi_ulong get_sigframe(struct target_sigaction *sa,
5402 5403
                                     CPUAlphaState *env,
                                     unsigned long framesize)
5404 5405 5406 5407 5408 5409 5410 5411 5412 5413 5414
{
    abi_ulong sp = env->ir[IR_SP];

    /* This is the X/Open sanctioned signal stack switching.  */
    if ((sa->sa_flags & TARGET_SA_ONSTACK) != 0 && !sas_ss_flags(sp)) {
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }
    return (sp - framesize) & -32;
}

static void setup_frame(int sig, struct target_sigaction *ka,
5415
                        target_sigset_t *set, CPUAlphaState *env)
5416 5417 5418 5419 5420 5421
{
    abi_ulong frame_addr, r26;
    struct target_sigframe *frame;
    int err = 0;

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
5422
    trace_user_setup_frame(env, frame_addr);
5423 5424 5425 5426
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }

5427
    setup_sigcontext(&frame->sc, env, frame_addr, set);
5428 5429 5430 5431

    if (ka->sa_restorer) {
        r26 = ka->sa_restorer;
    } else {
5432 5433 5434 5435
        __put_user(INSN_MOV_R30_R16, &frame->retcode[0]);
        __put_user(INSN_LDI_R0 + TARGET_NR_sigreturn,
                   &frame->retcode[1]);
        __put_user(INSN_CALLSYS, &frame->retcode[2]);
5436 5437 5438 5439 5440 5441 5442
        /* imb() */
        r26 = frame_addr;
    }

    unlock_user_struct(frame, frame_addr, 1);

    if (err) {
5443
give_sigsegv:
5444 5445 5446 5447 5448 5449 5450 5451 5452 5453 5454 5455 5456 5457 5458 5459
        if (sig == TARGET_SIGSEGV) {
            ka->_sa_handler = TARGET_SIG_DFL;
        }
        force_sig(TARGET_SIGSEGV);
    }

    env->ir[IR_RA] = r26;
    env->ir[IR_PV] = env->pc = ka->_sa_handler;
    env->ir[IR_A0] = sig;
    env->ir[IR_A1] = 0;
    env->ir[IR_A2] = frame_addr + offsetof(struct target_sigframe, sc);
    env->ir[IR_SP] = frame_addr;
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
                           target_siginfo_t *info,
5460
                           target_sigset_t *set, CPUAlphaState *env)
5461 5462 5463 5464 5465 5466
{
    abi_ulong frame_addr, r26;
    struct target_rt_sigframe *frame;
    int i, err = 0;

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
5467
    trace_user_setup_rt_frame(env, frame_addr);
5468 5469 5470 5471
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }

5472
    tswap_siginfo(&frame->info, info);
5473

5474 5475 5476 5477 5478 5479 5480 5481 5482
    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, &frame->uc.tuc_link);
    __put_user(set->sig[0], &frame->uc.tuc_osf_sigmask);
    __put_user(target_sigaltstack_used.ss_sp,
               &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(env->ir[IR_SP]),
               &frame->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size,
               &frame->uc.tuc_stack.ss_size);
5483
    setup_sigcontext(&frame->uc.tuc_mcontext, env, frame_addr, set);
5484
    for (i = 0; i < TARGET_NSIG_WORDS; ++i) {
5485
        __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
5486 5487 5488 5489 5490
    }

    if (ka->sa_restorer) {
        r26 = ka->sa_restorer;
    } else {
5491 5492 5493 5494
        __put_user(INSN_MOV_R30_R16, &frame->retcode[0]);
        __put_user(INSN_LDI_R0 + TARGET_NR_rt_sigreturn,
                   &frame->retcode[1]);
        __put_user(INSN_CALLSYS, &frame->retcode[2]);
5495 5496 5497 5498 5499
        /* imb(); */
        r26 = frame_addr;
    }

    if (err) {
5500 5501
give_sigsegv:
        if (sig == TARGET_SIGSEGV) {
5502 5503 5504 5505 5506 5507 5508 5509 5510 5511 5512 5513 5514
            ka->_sa_handler = TARGET_SIG_DFL;
        }
        force_sig(TARGET_SIGSEGV);
    }

    env->ir[IR_RA] = r26;
    env->ir[IR_PV] = env->pc = ka->_sa_handler;
    env->ir[IR_A0] = sig;
    env->ir[IR_A1] = frame_addr + offsetof(struct target_rt_sigframe, info);
    env->ir[IR_A2] = frame_addr + offsetof(struct target_rt_sigframe, uc);
    env->ir[IR_SP] = frame_addr;
}

5515
long do_sigreturn(CPUAlphaState *env)
5516 5517 5518 5519 5520 5521 5522 5523 5524 5525 5526
{
    struct target_sigcontext *sc;
    abi_ulong sc_addr = env->ir[IR_A0];
    target_sigset_t target_set;
    sigset_t set;

    if (!lock_user_struct(VERIFY_READ, sc, sc_addr, 1)) {
        goto badframe;
    }

    target_sigemptyset(&target_set);
5527
    __get_user(target_set.sig[0], &sc->sc_mask);
5528 5529

    target_to_host_sigset_internal(&set, &target_set);
5530
    do_sigprocmask(SIG_SETMASK, &set, NULL);
5531

5532
    restore_sigcontext(env, sc);
5533 5534 5535
    unlock_user_struct(sc, sc_addr, 0);
    return env->ir[IR_V0];

5536
badframe:
5537 5538 5539
    force_sig(TARGET_SIGSEGV);
}

5540
long do_rt_sigreturn(CPUAlphaState *env)
5541 5542 5543 5544 5545
{
    abi_ulong frame_addr = env->ir[IR_A0];
    struct target_rt_sigframe *frame;
    sigset_t set;

5546
    trace_user_do_rt_sigreturn(env, frame_addr);
5547 5548 5549
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
5550
    target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
5551
    do_sigprocmask(SIG_SETMASK, &set, NULL);
5552

5553
    restore_sigcontext(env, &frame->uc.tuc_mcontext);
5554
    if (do_sigaltstack(frame_addr + offsetof(struct target_rt_sigframe,
5555
                                             uc.tuc_stack),
5556 5557 5558 5559 5560 5561 5562 5563
                       0, env->ir[IR_SP]) == -EFAULT) {
        goto badframe;
    }

    unlock_user_struct(frame, frame_addr, 0);
    return env->ir[IR_V0];


5564
badframe:
5565 5566 5567 5568
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
}

5569 5570 5571 5572 5573 5574 5575 5576 5577 5578 5579 5580 5581 5582 5583 5584 5585 5586 5587 5588 5589 5590 5591 5592 5593 5594 5595 5596 5597 5598 5599 5600 5601 5602 5603 5604 5605 5606 5607 5608 5609 5610 5611 5612 5613 5614 5615 5616 5617 5618 5619 5620 5621 5622 5623 5624 5625 5626 5627 5628 5629 5630 5631 5632 5633 5634 5635 5636 5637 5638 5639 5640 5641 5642 5643 5644 5645 5646 5647 5648 5649 5650 5651 5652 5653
#elif defined(TARGET_TILEGX)

struct target_sigcontext {
    union {
        /* General-purpose registers.  */
        abi_ulong gregs[56];
        struct {
            abi_ulong __gregs[53];
            abi_ulong tp;        /* Aliases gregs[TREG_TP].  */
            abi_ulong sp;        /* Aliases gregs[TREG_SP].  */
            abi_ulong lr;        /* Aliases gregs[TREG_LR].  */
        };
    };
    abi_ulong pc;        /* Program counter.  */
    abi_ulong ics;       /* In Interrupt Critical Section?  */
    abi_ulong faultnum;  /* Fault number.  */
    abi_ulong pad[5];
};

struct target_ucontext {
    abi_ulong tuc_flags;
    abi_ulong tuc_link;
    target_stack_t tuc_stack;
    struct target_sigcontext tuc_mcontext;
    target_sigset_t tuc_sigmask;   /* mask last for extensibility */
};

struct target_rt_sigframe {
    unsigned char save_area[16]; /* caller save area */
    struct target_siginfo info;
    struct target_ucontext uc;
};

static void setup_sigcontext(struct target_sigcontext *sc,
                             CPUArchState *env, int signo)
{
    int i;

    for (i = 0; i < TILEGX_R_COUNT; ++i) {
        __put_user(env->regs[i], &sc->gregs[i]);
    }

    __put_user(env->pc, &sc->pc);
    __put_user(0, &sc->ics);
    __put_user(signo, &sc->faultnum);
}

static void restore_sigcontext(CPUTLGState *env, struct target_sigcontext *sc)
{
    int i;

    for (i = 0; i < TILEGX_R_COUNT; ++i) {
        __get_user(env->regs[i], &sc->gregs[i]);
    }

    __get_user(env->pc, &sc->pc);
}

static abi_ulong get_sigframe(struct target_sigaction *ka, CPUArchState *env,
                              size_t frame_size)
{
    unsigned long sp = env->regs[TILEGX_R_SP];

    if (on_sig_stack(sp) && !likely(on_sig_stack(sp - frame_size))) {
        return -1UL;
    }

    if ((ka->sa_flags & SA_ONSTACK) && !sas_ss_flags(sp)) {
        sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
    }

    sp -= frame_size;
    sp &= -16UL;
    return sp;
}

static void setup_rt_frame(int sig, struct target_sigaction *ka,
                           target_siginfo_t *info,
                           target_sigset_t *set, CPUArchState *env)
{
    abi_ulong frame_addr;
    struct target_rt_sigframe *frame;
    unsigned long restorer;

    frame_addr = get_sigframe(ka, env, sizeof(*frame));
5654
    trace_user_setup_rt_frame(env, frame_addr);
5655 5656 5657 5658 5659 5660 5661 5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674 5675 5676 5677 5678 5679 5680 5681 5682 5683 5684 5685 5686 5687 5688 5689 5690 5691 5692 5693 5694 5695 5696 5697 5698 5699 5700 5701 5702 5703 5704
    if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
        goto give_sigsegv;
    }

    /* Always write at least the signal number for the stack backtracer. */
    if (ka->sa_flags & TARGET_SA_SIGINFO) {
        /* At sigreturn time, restore the callee-save registers too. */
        tswap_siginfo(&frame->info, info);
        /* regs->flags |= PT_FLAGS_RESTORE_REGS; FIXME: we can skip it? */
    } else {
        __put_user(info->si_signo, &frame->info.si_signo);
    }

    /* Create the ucontext.  */
    __put_user(0, &frame->uc.tuc_flags);
    __put_user(0, &frame->uc.tuc_link);
    __put_user(target_sigaltstack_used.ss_sp, &frame->uc.tuc_stack.ss_sp);
    __put_user(sas_ss_flags(env->regs[TILEGX_R_SP]),
               &frame->uc.tuc_stack.ss_flags);
    __put_user(target_sigaltstack_used.ss_size, &frame->uc.tuc_stack.ss_size);
    setup_sigcontext(&frame->uc.tuc_mcontext, env, info->si_signo);

    restorer = (unsigned long) do_rt_sigreturn;
    if (ka->sa_flags & TARGET_SA_RESTORER) {
            restorer = (unsigned long) ka->sa_restorer;
    }
    env->pc = (unsigned long) ka->_sa_handler;
    env->regs[TILEGX_R_SP] = (unsigned long) frame;
    env->regs[TILEGX_R_LR] = restorer;
    env->regs[0] = (unsigned long) sig;
    env->regs[1] = (unsigned long) &frame->info;
    env->regs[2] = (unsigned long) &frame->uc;
    /* regs->flags |= PT_FLAGS_CALLER_SAVES; FIXME: we can skip it? */

    unlock_user_struct(frame, frame_addr, 1);
    return;

give_sigsegv:
    if (sig == TARGET_SIGSEGV) {
        ka->_sa_handler = TARGET_SIG_DFL;
    }
    force_sig(TARGET_SIGSEGV /* , current */);
}

long do_rt_sigreturn(CPUTLGState *env)
{
    abi_ulong frame_addr = env->regs[TILEGX_R_SP];
    struct target_rt_sigframe *frame;
    sigset_t set;

5705
    trace_user_do_rt_sigreturn(env, frame_addr);
5706 5707 5708 5709 5710 5711 5712 5713 5714 5715 5716 5717 5718 5719 5720 5721 5722 5723 5724 5725 5726 5727
    if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
        goto badframe;
    }
    target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
    do_sigprocmask(SIG_SETMASK, &set, NULL);

    restore_sigcontext(env, &frame->uc.tuc_mcontext);
    if (do_sigaltstack(frame_addr + offsetof(struct target_rt_sigframe,
                                             uc.tuc_stack),
                       0, env->regs[TILEGX_R_SP]) == -EFAULT) {
        goto badframe;
    }

    unlock_user_struct(frame, frame_addr, 0);
    return env->regs[TILEGX_R_RE];


 badframe:
    unlock_user_struct(frame, frame_addr, 0);
    force_sig(TARGET_SIGSEGV);
}

B
bellard 已提交
5728 5729
#else

P
pbrook 已提交
5730
static void setup_frame(int sig, struct target_sigaction *ka,
5731
                        target_sigset_t *set, CPUArchState *env)
B
bellard 已提交
5732 5733 5734 5735
{
    fprintf(stderr, "setup_frame: not implemented\n");
}

P
pbrook 已提交
5736
static void setup_rt_frame(int sig, struct target_sigaction *ka,
A
Anthony Liguori 已提交
5737
                           target_siginfo_t *info,
5738
                           target_sigset_t *set, CPUArchState *env)
B
bellard 已提交
5739 5740 5741 5742
{
    fprintf(stderr, "setup_rt_frame: not implemented\n");
}

5743
long do_sigreturn(CPUArchState *env)
B
bellard 已提交
5744 5745
{
    fprintf(stderr, "do_sigreturn: not implemented\n");
B
bellard 已提交
5746
    return -TARGET_ENOSYS;
B
bellard 已提交
5747 5748
}

5749
long do_rt_sigreturn(CPUArchState *env)
B
bellard 已提交
5750 5751
{
    fprintf(stderr, "do_rt_sigreturn: not implemented\n");
B
bellard 已提交
5752
    return -TARGET_ENOSYS;
B
bellard 已提交
5753 5754
}

B
bellard 已提交
5755 5756
#endif

5757
void process_pending_signals(CPUArchState *cpu_env)
B
bellard 已提交
5758
{
5759
    CPUState *cpu = ENV_GET_CPU(cpu_env);
B
bellard 已提交
5760
    int sig;
5761
    abi_ulong handler;
B
bellard 已提交
5762
    sigset_t set, old_set;
A
Anthony Liguori 已提交
5763
    target_sigset_t target_old_set;
P
pbrook 已提交
5764 5765
    struct emulated_sigtable *k;
    struct target_sigaction *sa;
B
bellard 已提交
5766
    struct sigqueue *q;
5767
    TaskState *ts = cpu->opaque;
5768

P
pbrook 已提交
5769
    if (!ts->signal_pending)
5770 5771
        return;

P
pbrook 已提交
5772 5773
    /* FIXME: This is not threadsafe.  */
    k = ts->sigtab;
B
bellard 已提交
5774 5775
    for(sig = 1; sig <= TARGET_NSIG; sig++) {
        if (k->pending)
5776
            goto handle_signal;
B
bellard 已提交
5777
        k++;
5778 5779
    }
    /* if no signal is pending, just return */
P
pbrook 已提交
5780
    ts->signal_pending = 0;
5781
    return;
B
bellard 已提交
5782

5783
 handle_signal:
5784
    trace_user_handle_signal(cpu_env, sig);
B
bellard 已提交
5785 5786 5787 5788 5789
    /* dequeue signal */
    q = k->first;
    k->first = q->next;
    if (!k->first)
        k->pending = 0;
5790

5791
    sig = gdb_handlesig(cpu, sig);
B
bellard 已提交
5792
    if (!sig) {
5793 5794 5795 5796 5797
        sa = NULL;
        handler = TARGET_SIG_IGN;
    } else {
        sa = &sigact_table[sig - 1];
        handler = sa->_sa_handler;
B
bellard 已提交
5798
    }
B
bellard 已提交
5799

5800 5801 5802 5803 5804 5805 5806 5807
    if (ts->sigsegv_blocked && sig == TARGET_SIGSEGV) {
        /* Guest has blocked SIGSEGV but we got one anyway. Assume this
         * is a forced SIGSEGV (ie one the kernel handles via force_sig_info
         * because it got a real MMU fault), and treat as if default handler.
         */
        handler = TARGET_SIG_DFL;
    }

B
bellard 已提交
5808
    if (handler == TARGET_SIG_DFL) {
5809 5810 5811 5812 5813 5814 5815
        /* default handler : ignore some signal. The other are job control or fatal */
        if (sig == TARGET_SIGTSTP || sig == TARGET_SIGTTIN || sig == TARGET_SIGTTOU) {
            kill(getpid(),SIGSTOP);
        } else if (sig != TARGET_SIGCHLD &&
                   sig != TARGET_SIGURG &&
                   sig != TARGET_SIGWINCH &&
                   sig != TARGET_SIGCONT) {
B
bellard 已提交
5816 5817 5818 5819 5820 5821 5822
            force_sig(sig);
        }
    } else if (handler == TARGET_SIG_IGN) {
        /* ignore sig */
    } else if (handler == TARGET_SIG_ERR) {
        force_sig(sig);
    } else {
B
bellard 已提交
5823
        /* compute the blocked signals during the handler execution */
P
pbrook 已提交
5824
        target_to_host_sigset(&set, &sa->sa_mask);
B
bellard 已提交
5825 5826
        /* SA_NODEFER indicates that the current signal should not be
           blocked during the handler */
P
pbrook 已提交
5827
        if (!(sa->sa_flags & TARGET_SA_NODEFER))
B
bellard 已提交
5828
            sigaddset(&set, target_to_host_signal(sig));
5829

B
bellard 已提交
5830
        /* block signals in the handler using Linux */
5831
        do_sigprocmask(SIG_BLOCK, &set, &old_set);
B
bellard 已提交
5832 5833
        /* save the previous blocked signal state to restore it at the
           end of the signal execution (see do_sigreturn) */
5834
        host_to_target_sigset_internal(&target_old_set, &old_set);
B
bellard 已提交
5835

B
bellard 已提交
5836
        /* if the CPU is in VM86 mode, we restore the 32 bit values */
5837
#if defined(TARGET_I386) && !defined(TARGET_X86_64)
B
bellard 已提交
5838 5839 5840 5841 5842 5843
        {
            CPUX86State *env = cpu_env;
            if (env->eflags & VM_MASK)
                save_v86_state(env);
        }
#endif
B
bellard 已提交
5844
        /* prepare the stack frame of the virtual CPU */
5845
#if defined(TARGET_ABI_MIPSN32) || defined(TARGET_ABI_MIPSN64) \
5846
    || defined(TARGET_OPENRISC) || defined(TARGET_TILEGX)
5847 5848 5849
        /* These targets do not have traditional signals.  */
        setup_rt_frame(sig, sa, &q->info, &target_old_set, cpu_env);
#else
P
pbrook 已提交
5850 5851
        if (sa->sa_flags & TARGET_SA_SIGINFO)
            setup_rt_frame(sig, sa, &q->info, &target_old_set, cpu_env);
B
bellard 已提交
5852
        else
P
pbrook 已提交
5853
            setup_frame(sig, sa, &target_old_set, cpu_env);
5854
#endif
P
pbrook 已提交
5855 5856
	if (sa->sa_flags & TARGET_SA_RESETHAND)
            sa->_sa_handler = TARGET_SIG_DFL;
5857
    }
B
bellard 已提交
5858
    if (q != &k->info)
P
pbrook 已提交
5859
        free_sigqueue(cpu_env, q);
B
bellard 已提交
5860
}