]> Git Repo - qemu.git/blob - linux-user/signal.c
Merge remote-tracking branch 'agraf/xen-next' into staging
[qemu.git] / linux-user / signal.c
1 /*
2  *  Emulation of Linux signals
3  *
4  *  Copyright (c) 2003 Fabrice Bellard
5  *
6  *  This program is free software; you can redistribute it and/or modify
7  *  it under the terms of the GNU General Public License as published by
8  *  the Free Software Foundation; either version 2 of the License, or
9  *  (at your option) any later version.
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  *
16  *  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  */
19 #include <stdlib.h>
20 #include <stdio.h>
21 #include <string.h>
22 #include <stdarg.h>
23 #include <unistd.h>
24 #include <errno.h>
25 #include <assert.h>
26 #include <sys/ucontext.h>
27 #include <sys/resource.h>
28
29 #include "qemu.h"
30 #include "qemu-common.h"
31 #include "target_signal.h"
32
33 //#define DEBUG_SIGNAL
34
35 static struct target_sigaltstack target_sigaltstack_used = {
36     .ss_sp = 0,
37     .ss_size = 0,
38     .ss_flags = TARGET_SS_DISABLE,
39 };
40
41 static struct target_sigaction sigact_table[TARGET_NSIG];
42
43 static void host_signal_handler(int host_signum, siginfo_t *info,
44                                 void *puc);
45
46 static uint8_t host_to_target_signal_table[_NSIG] = {
47     [SIGHUP] = TARGET_SIGHUP,
48     [SIGINT] = TARGET_SIGINT,
49     [SIGQUIT] = TARGET_SIGQUIT,
50     [SIGILL] = TARGET_SIGILL,
51     [SIGTRAP] = TARGET_SIGTRAP,
52     [SIGABRT] = TARGET_SIGABRT,
53 /*    [SIGIOT] = TARGET_SIGIOT,*/
54     [SIGBUS] = TARGET_SIGBUS,
55     [SIGFPE] = TARGET_SIGFPE,
56     [SIGKILL] = TARGET_SIGKILL,
57     [SIGUSR1] = TARGET_SIGUSR1,
58     [SIGSEGV] = TARGET_SIGSEGV,
59     [SIGUSR2] = TARGET_SIGUSR2,
60     [SIGPIPE] = TARGET_SIGPIPE,
61     [SIGALRM] = TARGET_SIGALRM,
62     [SIGTERM] = TARGET_SIGTERM,
63 #ifdef SIGSTKFLT
64     [SIGSTKFLT] = TARGET_SIGSTKFLT,
65 #endif
66     [SIGCHLD] = TARGET_SIGCHLD,
67     [SIGCONT] = TARGET_SIGCONT,
68     [SIGSTOP] = TARGET_SIGSTOP,
69     [SIGTSTP] = TARGET_SIGTSTP,
70     [SIGTTIN] = TARGET_SIGTTIN,
71     [SIGTTOU] = TARGET_SIGTTOU,
72     [SIGURG] = TARGET_SIGURG,
73     [SIGXCPU] = TARGET_SIGXCPU,
74     [SIGXFSZ] = TARGET_SIGXFSZ,
75     [SIGVTALRM] = TARGET_SIGVTALRM,
76     [SIGPROF] = TARGET_SIGPROF,
77     [SIGWINCH] = TARGET_SIGWINCH,
78     [SIGIO] = TARGET_SIGIO,
79     [SIGPWR] = TARGET_SIGPWR,
80     [SIGSYS] = TARGET_SIGSYS,
81     /* next signals stay the same */
82     /* Nasty hack: Reverse SIGRTMIN and SIGRTMAX to avoid overlap with
83        host libpthread signals.  This assumes noone actually uses SIGRTMAX :-/
84        To fix this properly we need to do manual signal delivery multiplexed
85        over a single host signal.  */
86     [__SIGRTMIN] = __SIGRTMAX,
87     [__SIGRTMAX] = __SIGRTMIN,
88 };
89 static uint8_t target_to_host_signal_table[_NSIG];
90
91 static inline int on_sig_stack(unsigned long sp)
92 {
93     return (sp - target_sigaltstack_used.ss_sp
94             < target_sigaltstack_used.ss_size);
95 }
96
97 static inline int sas_ss_flags(unsigned long sp)
98 {
99     return (target_sigaltstack_used.ss_size == 0 ? SS_DISABLE
100             : on_sig_stack(sp) ? SS_ONSTACK : 0);
101 }
102
103 int host_to_target_signal(int sig)
104 {
105     if (sig >= _NSIG)
106         return sig;
107     return host_to_target_signal_table[sig];
108 }
109
110 int target_to_host_signal(int sig)
111 {
112     if (sig >= _NSIG)
113         return sig;
114     return target_to_host_signal_table[sig];
115 }
116
117 static inline void target_sigemptyset(target_sigset_t *set)
118 {
119     memset(set, 0, sizeof(*set));
120 }
121
122 static inline void target_sigaddset(target_sigset_t *set, int signum)
123 {
124     signum--;
125     abi_ulong mask = (abi_ulong)1 << (signum % TARGET_NSIG_BPW);
126     set->sig[signum / TARGET_NSIG_BPW] |= mask;
127 }
128
129 static inline int target_sigismember(const target_sigset_t *set, int signum)
130 {
131     signum--;
132     abi_ulong mask = (abi_ulong)1 << (signum % TARGET_NSIG_BPW);
133     return ((set->sig[signum / TARGET_NSIG_BPW] & mask) != 0);
134 }
135
136 static void host_to_target_sigset_internal(target_sigset_t *d,
137                                            const sigset_t *s)
138 {
139     int i;
140     target_sigemptyset(d);
141     for (i = 1; i <= TARGET_NSIG; i++) {
142         if (sigismember(s, i)) {
143             target_sigaddset(d, host_to_target_signal(i));
144         }
145     }
146 }
147
148 void host_to_target_sigset(target_sigset_t *d, const sigset_t *s)
149 {
150     target_sigset_t d1;
151     int i;
152
153     host_to_target_sigset_internal(&d1, s);
154     for(i = 0;i < TARGET_NSIG_WORDS; i++)
155         d->sig[i] = tswapl(d1.sig[i]);
156 }
157
158 static void target_to_host_sigset_internal(sigset_t *d,
159                                            const target_sigset_t *s)
160 {
161     int i;
162     sigemptyset(d);
163     for (i = 1; i <= TARGET_NSIG; i++) {
164         if (target_sigismember(s, i)) {
165             sigaddset(d, target_to_host_signal(i));
166         }
167      }
168 }
169
170 void target_to_host_sigset(sigset_t *d, const target_sigset_t *s)
171 {
172     target_sigset_t s1;
173     int i;
174
175     for(i = 0;i < TARGET_NSIG_WORDS; i++)
176         s1.sig[i] = tswapl(s->sig[i]);
177     target_to_host_sigset_internal(d, &s1);
178 }
179
180 void host_to_target_old_sigset(abi_ulong *old_sigset,
181                                const sigset_t *sigset)
182 {
183     target_sigset_t d;
184     host_to_target_sigset(&d, sigset);
185     *old_sigset = d.sig[0];
186 }
187
188 void target_to_host_old_sigset(sigset_t *sigset,
189                                const abi_ulong *old_sigset)
190 {
191     target_sigset_t d;
192     int i;
193
194     d.sig[0] = *old_sigset;
195     for(i = 1;i < TARGET_NSIG_WORDS; i++)
196         d.sig[i] = 0;
197     target_to_host_sigset(sigset, &d);
198 }
199
200 /* siginfo conversion */
201
202 static inline void host_to_target_siginfo_noswap(target_siginfo_t *tinfo,
203                                                  const siginfo_t *info)
204 {
205     int sig;
206     sig = host_to_target_signal(info->si_signo);
207     tinfo->si_signo = sig;
208     tinfo->si_errno = 0;
209     tinfo->si_code = info->si_code;
210     if (sig == SIGILL || sig == SIGFPE || sig == SIGSEGV ||
211         sig == SIGBUS || sig == SIGTRAP) {
212         /* should never come here, but who knows. The information for
213            the target is irrelevant */
214         tinfo->_sifields._sigfault._addr = 0;
215     } else if (sig == SIGIO) {
216         tinfo->_sifields._sigpoll._fd = info->si_fd;
217     } else if (sig >= TARGET_SIGRTMIN) {
218         tinfo->_sifields._rt._pid = info->si_pid;
219         tinfo->_sifields._rt._uid = info->si_uid;
220         /* XXX: potential problem if 64 bit */
221         tinfo->_sifields._rt._sigval.sival_ptr =
222             (abi_ulong)(unsigned long)info->si_value.sival_ptr;
223     }
224 }
225
226 static void tswap_siginfo(target_siginfo_t *tinfo,
227                           const target_siginfo_t *info)
228 {
229     int sig;
230     sig = info->si_signo;
231     tinfo->si_signo = tswap32(sig);
232     tinfo->si_errno = tswap32(info->si_errno);
233     tinfo->si_code = tswap32(info->si_code);
234     if (sig == SIGILL || sig == SIGFPE || sig == SIGSEGV ||
235         sig == SIGBUS || sig == SIGTRAP) {
236         tinfo->_sifields._sigfault._addr =
237             tswapl(info->_sifields._sigfault._addr);
238     } else if (sig == SIGIO) {
239         tinfo->_sifields._sigpoll._fd = tswap32(info->_sifields._sigpoll._fd);
240     } else if (sig >= TARGET_SIGRTMIN) {
241         tinfo->_sifields._rt._pid = tswap32(info->_sifields._rt._pid);
242         tinfo->_sifields._rt._uid = tswap32(info->_sifields._rt._uid);
243         tinfo->_sifields._rt._sigval.sival_ptr =
244             tswapl(info->_sifields._rt._sigval.sival_ptr);
245     }
246 }
247
248
249 void host_to_target_siginfo(target_siginfo_t *tinfo, const siginfo_t *info)
250 {
251     host_to_target_siginfo_noswap(tinfo, info);
252     tswap_siginfo(tinfo, tinfo);
253 }
254
255 /* XXX: we support only POSIX RT signals are used. */
256 /* XXX: find a solution for 64 bit (additional malloced data is needed) */
257 void target_to_host_siginfo(siginfo_t *info, const target_siginfo_t *tinfo)
258 {
259     info->si_signo = tswap32(tinfo->si_signo);
260     info->si_errno = tswap32(tinfo->si_errno);
261     info->si_code = tswap32(tinfo->si_code);
262     info->si_pid = tswap32(tinfo->_sifields._rt._pid);
263     info->si_uid = tswap32(tinfo->_sifields._rt._uid);
264     info->si_value.sival_ptr =
265             (void *)(long)tswapl(tinfo->_sifields._rt._sigval.sival_ptr);
266 }
267
268 static int fatal_signal (int sig)
269 {
270     switch (sig) {
271     case TARGET_SIGCHLD:
272     case TARGET_SIGURG:
273     case TARGET_SIGWINCH:
274         /* Ignored by default.  */
275         return 0;
276     case TARGET_SIGCONT:
277     case TARGET_SIGSTOP:
278     case TARGET_SIGTSTP:
279     case TARGET_SIGTTIN:
280     case TARGET_SIGTTOU:
281         /* Job control signals.  */
282         return 0;
283     default:
284         return 1;
285     }
286 }
287
288 /* returns 1 if given signal should dump core if not handled */
289 static int core_dump_signal(int sig)
290 {
291     switch (sig) {
292     case TARGET_SIGABRT:
293     case TARGET_SIGFPE:
294     case TARGET_SIGILL:
295     case TARGET_SIGQUIT:
296     case TARGET_SIGSEGV:
297     case TARGET_SIGTRAP:
298     case TARGET_SIGBUS:
299         return (1);
300     default:
301         return (0);
302     }
303 }
304
305 void signal_init(void)
306 {
307     struct sigaction act;
308     struct sigaction oact;
309     int i, j;
310     int host_sig;
311
312     /* generate signal conversion tables */
313     for(i = 1; i < _NSIG; i++) {
314         if (host_to_target_signal_table[i] == 0)
315             host_to_target_signal_table[i] = i;
316     }
317     for(i = 1; i < _NSIG; i++) {
318         j = host_to_target_signal_table[i];
319         target_to_host_signal_table[j] = i;
320     }
321
322     /* set all host signal handlers. ALL signals are blocked during
323        the handlers to serialize them. */
324     memset(sigact_table, 0, sizeof(sigact_table));
325
326     sigfillset(&act.sa_mask);
327     act.sa_flags = SA_SIGINFO;
328     act.sa_sigaction = host_signal_handler;
329     for(i = 1; i <= TARGET_NSIG; i++) {
330         host_sig = target_to_host_signal(i);
331         sigaction(host_sig, NULL, &oact);
332         if (oact.sa_sigaction == (void *)SIG_IGN) {
333             sigact_table[i - 1]._sa_handler = TARGET_SIG_IGN;
334         } else if (oact.sa_sigaction == (void *)SIG_DFL) {
335             sigact_table[i - 1]._sa_handler = TARGET_SIG_DFL;
336         }
337         /* If there's already a handler installed then something has
338            gone horribly wrong, so don't even try to handle that case.  */
339         /* Install some handlers for our own use.  We need at least
340            SIGSEGV and SIGBUS, to detect exceptions.  We can not just
341            trap all signals because it affects syscall interrupt
342            behavior.  But do trap all default-fatal signals.  */
343         if (fatal_signal (i))
344             sigaction(host_sig, &act, NULL);
345     }
346 }
347
348 /* signal queue handling */
349
350 static inline struct sigqueue *alloc_sigqueue(CPUState *env)
351 {
352     TaskState *ts = env->opaque;
353     struct sigqueue *q = ts->first_free;
354     if (!q)
355         return NULL;
356     ts->first_free = q->next;
357     return q;
358 }
359
360 static inline void free_sigqueue(CPUState *env, struct sigqueue *q)
361 {
362     TaskState *ts = env->opaque;
363     q->next = ts->first_free;
364     ts->first_free = q;
365 }
366
367 /* abort execution with signal */
368 static void QEMU_NORETURN force_sig(int target_sig)
369 {
370     TaskState *ts = (TaskState *)thread_env->opaque;
371     int host_sig, core_dumped = 0;
372     struct sigaction act;
373     host_sig = target_to_host_signal(target_sig);
374     gdb_signalled(thread_env, target_sig);
375
376     /* dump core if supported by target binary format */
377     if (core_dump_signal(target_sig) && (ts->bprm->core_dump != NULL)) {
378         stop_all_tasks();
379         core_dumped =
380             ((*ts->bprm->core_dump)(target_sig, thread_env) == 0);
381     }
382     if (core_dumped) {
383         /* we already dumped the core of target process, we don't want
384          * a coredump of qemu itself */
385         struct rlimit nodump;
386         getrlimit(RLIMIT_CORE, &nodump);
387         nodump.rlim_cur=0;
388         setrlimit(RLIMIT_CORE, &nodump);
389         (void) fprintf(stderr, "qemu: uncaught target signal %d (%s) - %s\n",
390             target_sig, strsignal(host_sig), "core dumped" );
391     }
392
393     /* The proper exit code for dying from an uncaught signal is
394      * -<signal>.  The kernel doesn't allow exit() or _exit() to pass
395      * a negative value.  To get the proper exit code we need to
396      * actually die from an uncaught signal.  Here the default signal
397      * handler is installed, we send ourself a signal and we wait for
398      * it to arrive. */
399     sigfillset(&act.sa_mask);
400     act.sa_handler = SIG_DFL;
401     sigaction(host_sig, &act, NULL);
402
403     /* For some reason raise(host_sig) doesn't send the signal when
404      * statically linked on x86-64. */
405     kill(getpid(), host_sig);
406
407     /* Make sure the signal isn't masked (just reuse the mask inside
408     of act) */
409     sigdelset(&act.sa_mask, host_sig);
410     sigsuspend(&act.sa_mask);
411
412     /* unreachable */
413     abort();
414 }
415
416 /* queue a signal so that it will be send to the virtual CPU as soon
417    as possible */
418 int queue_signal(CPUState *env, int sig, target_siginfo_t *info)
419 {
420     TaskState *ts = env->opaque;
421     struct emulated_sigtable *k;
422     struct sigqueue *q, **pq;
423     abi_ulong handler;
424     int queue;
425
426 #if defined(DEBUG_SIGNAL)
427     fprintf(stderr, "queue_signal: sig=%d\n",
428             sig);
429 #endif
430     k = &ts->sigtab[sig - 1];
431     queue = gdb_queuesig ();
432     handler = sigact_table[sig - 1]._sa_handler;
433     if (!queue && handler == TARGET_SIG_DFL) {
434         if (sig == TARGET_SIGTSTP || sig == TARGET_SIGTTIN || sig == TARGET_SIGTTOU) {
435             kill(getpid(),SIGSTOP);
436             return 0;
437         } else
438         /* default handler : ignore some signal. The other are fatal */
439         if (sig != TARGET_SIGCHLD &&
440             sig != TARGET_SIGURG &&
441             sig != TARGET_SIGWINCH &&
442             sig != TARGET_SIGCONT) {
443             force_sig(sig);
444         } else {
445             return 0; /* indicate ignored */
446         }
447     } else if (!queue && handler == TARGET_SIG_IGN) {
448         /* ignore signal */
449         return 0;
450     } else if (!queue && handler == TARGET_SIG_ERR) {
451         force_sig(sig);
452     } else {
453         pq = &k->first;
454         if (sig < TARGET_SIGRTMIN) {
455             /* if non real time signal, we queue exactly one signal */
456             if (!k->pending)
457                 q = &k->info;
458             else
459                 return 0;
460         } else {
461             if (!k->pending) {
462                 /* first signal */
463                 q = &k->info;
464             } else {
465                 q = alloc_sigqueue(env);
466                 if (!q)
467                     return -EAGAIN;
468                 while (*pq != NULL)
469                     pq = &(*pq)->next;
470             }
471         }
472         *pq = q;
473         q->info = *info;
474         q->next = NULL;
475         k->pending = 1;
476         /* signal that a new signal is pending */
477         ts->signal_pending = 1;
478         return 1; /* indicates that the signal was queued */
479     }
480 }
481
482 static void host_signal_handler(int host_signum, siginfo_t *info,
483                                 void *puc)
484 {
485     int sig;
486     target_siginfo_t tinfo;
487
488     /* the CPU emulator uses some host signals to detect exceptions,
489        we forward to it some signals */
490     if ((host_signum == SIGSEGV || host_signum == SIGBUS)
491         && info->si_code > 0) {
492         if (cpu_signal_handler(host_signum, info, puc))
493             return;
494     }
495
496     /* get target signal number */
497     sig = host_to_target_signal(host_signum);
498     if (sig < 1 || sig > TARGET_NSIG)
499         return;
500 #if defined(DEBUG_SIGNAL)
501     fprintf(stderr, "qemu: got signal %d\n", sig);
502 #endif
503     host_to_target_siginfo_noswap(&tinfo, info);
504     if (queue_signal(thread_env, sig, &tinfo) == 1) {
505         /* interrupt the virtual CPU as soon as possible */
506         cpu_exit(thread_env);
507     }
508 }
509
510 /* do_sigaltstack() returns target values and errnos. */
511 /* compare linux/kernel/signal.c:do_sigaltstack() */
512 abi_long do_sigaltstack(abi_ulong uss_addr, abi_ulong uoss_addr, abi_ulong sp)
513 {
514     int ret;
515     struct target_sigaltstack oss;
516
517     /* XXX: test errors */
518     if(uoss_addr)
519     {
520         __put_user(target_sigaltstack_used.ss_sp, &oss.ss_sp);
521         __put_user(target_sigaltstack_used.ss_size, &oss.ss_size);
522         __put_user(sas_ss_flags(sp), &oss.ss_flags);
523     }
524
525     if(uss_addr)
526     {
527         struct target_sigaltstack *uss;
528         struct target_sigaltstack ss;
529
530         ret = -TARGET_EFAULT;
531         if (!lock_user_struct(VERIFY_READ, uss, uss_addr, 1)
532             || __get_user(ss.ss_sp, &uss->ss_sp)
533             || __get_user(ss.ss_size, &uss->ss_size)
534             || __get_user(ss.ss_flags, &uss->ss_flags))
535             goto out;
536         unlock_user_struct(uss, uss_addr, 0);
537
538         ret = -TARGET_EPERM;
539         if (on_sig_stack(sp))
540             goto out;
541
542         ret = -TARGET_EINVAL;
543         if (ss.ss_flags != TARGET_SS_DISABLE
544             && ss.ss_flags != TARGET_SS_ONSTACK
545             && ss.ss_flags != 0)
546             goto out;
547
548         if (ss.ss_flags == TARGET_SS_DISABLE) {
549             ss.ss_size = 0;
550             ss.ss_sp = 0;
551         } else {
552             ret = -TARGET_ENOMEM;
553             if (ss.ss_size < MINSIGSTKSZ)
554                 goto out;
555         }
556
557         target_sigaltstack_used.ss_sp = ss.ss_sp;
558         target_sigaltstack_used.ss_size = ss.ss_size;
559     }
560
561     if (uoss_addr) {
562         ret = -TARGET_EFAULT;
563         if (copy_to_user(uoss_addr, &oss, sizeof(oss)))
564             goto out;
565     }
566
567     ret = 0;
568 out:
569     return ret;
570 }
571
572 /* do_sigaction() return host values and errnos */
573 int do_sigaction(int sig, const struct target_sigaction *act,
574                  struct target_sigaction *oact)
575 {
576     struct target_sigaction *k;
577     struct sigaction act1;
578     int host_sig;
579     int ret = 0;
580
581     if (sig < 1 || sig > TARGET_NSIG || sig == TARGET_SIGKILL || sig == TARGET_SIGSTOP)
582         return -EINVAL;
583     k = &sigact_table[sig - 1];
584 #if defined(DEBUG_SIGNAL)
585     fprintf(stderr, "sigaction sig=%d act=0x%p, oact=0x%p\n",
586             sig, act, oact);
587 #endif
588     if (oact) {
589         oact->_sa_handler = tswapl(k->_sa_handler);
590         oact->sa_flags = tswapl(k->sa_flags);
591 #if !defined(TARGET_MIPS)
592         oact->sa_restorer = tswapl(k->sa_restorer);
593 #endif
594         oact->sa_mask = k->sa_mask;
595     }
596     if (act) {
597         /* FIXME: This is not threadsafe.  */
598         k->_sa_handler = tswapl(act->_sa_handler);
599         k->sa_flags = tswapl(act->sa_flags);
600 #if !defined(TARGET_MIPS)
601         k->sa_restorer = tswapl(act->sa_restorer);
602 #endif
603         k->sa_mask = act->sa_mask;
604
605         /* we update the host linux signal state */
606         host_sig = target_to_host_signal(sig);
607         if (host_sig != SIGSEGV && host_sig != SIGBUS) {
608             sigfillset(&act1.sa_mask);
609             act1.sa_flags = SA_SIGINFO;
610             if (k->sa_flags & TARGET_SA_RESTART)
611                 act1.sa_flags |= SA_RESTART;
612             /* NOTE: it is important to update the host kernel signal
613                ignore state to avoid getting unexpected interrupted
614                syscalls */
615             if (k->_sa_handler == TARGET_SIG_IGN) {
616                 act1.sa_sigaction = (void *)SIG_IGN;
617             } else if (k->_sa_handler == TARGET_SIG_DFL) {
618                 if (fatal_signal (sig))
619                     act1.sa_sigaction = host_signal_handler;
620                 else
621                     act1.sa_sigaction = (void *)SIG_DFL;
622             } else {
623                 act1.sa_sigaction = host_signal_handler;
624             }
625             ret = sigaction(host_sig, &act1, NULL);
626         }
627     }
628     return ret;
629 }
630
631 static inline int copy_siginfo_to_user(target_siginfo_t *tinfo,
632                                        const target_siginfo_t *info)
633 {
634     tswap_siginfo(tinfo, info);
635     return 0;
636 }
637
638 static inline int current_exec_domain_sig(int sig)
639 {
640     return /* current->exec_domain && current->exec_domain->signal_invmap
641               && sig < 32 ? current->exec_domain->signal_invmap[sig] : */ sig;
642 }
643
644 #if defined(TARGET_I386) && TARGET_ABI_BITS == 32
645
646 /* from the Linux kernel */
647
648 struct target_fpreg {
649         uint16_t significand[4];
650         uint16_t exponent;
651 };
652
653 struct target_fpxreg {
654         uint16_t significand[4];
655         uint16_t exponent;
656         uint16_t padding[3];
657 };
658
659 struct target_xmmreg {
660         abi_ulong element[4];
661 };
662
663 struct target_fpstate {
664         /* Regular FPU environment */
665         abi_ulong       cw;
666         abi_ulong       sw;
667         abi_ulong       tag;
668         abi_ulong       ipoff;
669         abi_ulong       cssel;
670         abi_ulong       dataoff;
671         abi_ulong       datasel;
672         struct target_fpreg     _st[8];
673         uint16_t        status;
674         uint16_t        magic;          /* 0xffff = regular FPU data only */
675
676         /* FXSR FPU environment */
677         abi_ulong       _fxsr_env[6];   /* FXSR FPU env is ignored */
678         abi_ulong       mxcsr;
679         abi_ulong       reserved;
680         struct target_fpxreg    _fxsr_st[8];    /* FXSR FPU reg data is ignored */
681         struct target_xmmreg    _xmm[8];
682         abi_ulong       padding[56];
683 };
684
685 #define X86_FXSR_MAGIC          0x0000
686
687 struct target_sigcontext {
688         uint16_t gs, __gsh;
689         uint16_t fs, __fsh;
690         uint16_t es, __esh;
691         uint16_t ds, __dsh;
692         abi_ulong edi;
693         abi_ulong esi;
694         abi_ulong ebp;
695         abi_ulong esp;
696         abi_ulong ebx;
697         abi_ulong edx;
698         abi_ulong ecx;
699         abi_ulong eax;
700         abi_ulong trapno;
701         abi_ulong err;
702         abi_ulong eip;
703         uint16_t cs, __csh;
704         abi_ulong eflags;
705         abi_ulong esp_at_signal;
706         uint16_t ss, __ssh;
707         abi_ulong fpstate; /* pointer */
708         abi_ulong oldmask;
709         abi_ulong cr2;
710 };
711
712 struct target_ucontext {
713         abi_ulong         tuc_flags;
714         abi_ulong         tuc_link;
715         target_stack_t    tuc_stack;
716         struct target_sigcontext tuc_mcontext;
717         target_sigset_t   tuc_sigmask;  /* mask last for extensibility */
718 };
719
720 struct sigframe
721 {
722     abi_ulong pretcode;
723     int sig;
724     struct target_sigcontext sc;
725     struct target_fpstate fpstate;
726     abi_ulong extramask[TARGET_NSIG_WORDS-1];
727     char retcode[8];
728 };
729
730 struct rt_sigframe
731 {
732     abi_ulong pretcode;
733     int sig;
734     abi_ulong pinfo;
735     abi_ulong puc;
736     struct target_siginfo info;
737     struct target_ucontext uc;
738     struct target_fpstate fpstate;
739     char retcode[8];
740 };
741
742 /*
743  * Set up a signal frame.
744  */
745
746 /* XXX: save x87 state */
747 static int
748 setup_sigcontext(struct target_sigcontext *sc, struct target_fpstate *fpstate,
749                  CPUX86State *env, abi_ulong mask, abi_ulong fpstate_addr)
750 {
751         int err = 0;
752         uint16_t magic;
753
754         /* already locked in setup_frame() */
755         err |= __put_user(env->segs[R_GS].selector, (unsigned int *)&sc->gs);
756         err |= __put_user(env->segs[R_FS].selector, (unsigned int *)&sc->fs);
757         err |= __put_user(env->segs[R_ES].selector, (unsigned int *)&sc->es);
758         err |= __put_user(env->segs[R_DS].selector, (unsigned int *)&sc->ds);
759         err |= __put_user(env->regs[R_EDI], &sc->edi);
760         err |= __put_user(env->regs[R_ESI], &sc->esi);
761         err |= __put_user(env->regs[R_EBP], &sc->ebp);
762         err |= __put_user(env->regs[R_ESP], &sc->esp);
763         err |= __put_user(env->regs[R_EBX], &sc->ebx);
764         err |= __put_user(env->regs[R_EDX], &sc->edx);
765         err |= __put_user(env->regs[R_ECX], &sc->ecx);
766         err |= __put_user(env->regs[R_EAX], &sc->eax);
767         err |= __put_user(env->exception_index, &sc->trapno);
768         err |= __put_user(env->error_code, &sc->err);
769         err |= __put_user(env->eip, &sc->eip);
770         err |= __put_user(env->segs[R_CS].selector, (unsigned int *)&sc->cs);
771         err |= __put_user(env->eflags, &sc->eflags);
772         err |= __put_user(env->regs[R_ESP], &sc->esp_at_signal);
773         err |= __put_user(env->segs[R_SS].selector, (unsigned int *)&sc->ss);
774
775         cpu_x86_fsave(env, fpstate_addr, 1);
776         fpstate->status = fpstate->sw;
777         magic = 0xffff;
778         err |= __put_user(magic, &fpstate->magic);
779         err |= __put_user(fpstate_addr, &sc->fpstate);
780
781         /* non-iBCS2 extensions.. */
782         err |= __put_user(mask, &sc->oldmask);
783         err |= __put_user(env->cr[2], &sc->cr2);
784         return err;
785 }
786
787 /*
788  * Determine which stack to use..
789  */
790
791 static inline abi_ulong
792 get_sigframe(struct target_sigaction *ka, CPUX86State *env, size_t frame_size)
793 {
794         unsigned long esp;
795
796         /* Default to using normal stack */
797         esp = env->regs[R_ESP];
798         /* This is the X/Open sanctioned signal stack switching.  */
799         if (ka->sa_flags & TARGET_SA_ONSTACK) {
800             if (sas_ss_flags(esp) == 0)
801                 esp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
802         }
803
804         /* This is the legacy signal stack switching. */
805         else
806         if ((env->segs[R_SS].selector & 0xffff) != __USER_DS &&
807             !(ka->sa_flags & TARGET_SA_RESTORER) &&
808             ka->sa_restorer) {
809             esp = (unsigned long) ka->sa_restorer;
810         }
811         return (esp - frame_size) & -8ul;
812 }
813
814 /* compare linux/arch/i386/kernel/signal.c:setup_frame() */
815 static void setup_frame(int sig, struct target_sigaction *ka,
816                         target_sigset_t *set, CPUX86State *env)
817 {
818         abi_ulong frame_addr;
819         struct sigframe *frame;
820         int i, err = 0;
821
822         frame_addr = get_sigframe(ka, env, sizeof(*frame));
823
824         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
825                 goto give_sigsegv;
826
827         err |= __put_user(current_exec_domain_sig(sig),
828                           &frame->sig);
829         if (err)
830                 goto give_sigsegv;
831
832         setup_sigcontext(&frame->sc, &frame->fpstate, env, set->sig[0],
833                          frame_addr + offsetof(struct sigframe, fpstate));
834         if (err)
835                 goto give_sigsegv;
836
837         for(i = 1; i < TARGET_NSIG_WORDS; i++) {
838             if (__put_user(set->sig[i], &frame->extramask[i - 1]))
839                 goto give_sigsegv;
840         }
841
842         /* Set up to return from userspace.  If provided, use a stub
843            already in userspace.  */
844         if (ka->sa_flags & TARGET_SA_RESTORER) {
845                 err |= __put_user(ka->sa_restorer, &frame->pretcode);
846         } else {
847                 uint16_t val16;
848                 abi_ulong retcode_addr;
849                 retcode_addr = frame_addr + offsetof(struct sigframe, retcode);
850                 err |= __put_user(retcode_addr, &frame->pretcode);
851                 /* This is popl %eax ; movl $,%eax ; int $0x80 */
852                 val16 = 0xb858;
853                 err |= __put_user(val16, (uint16_t *)(frame->retcode+0));
854                 err |= __put_user(TARGET_NR_sigreturn, (int *)(frame->retcode+2));
855                 val16 = 0x80cd;
856                 err |= __put_user(val16, (uint16_t *)(frame->retcode+6));
857         }
858
859         if (err)
860                 goto give_sigsegv;
861
862         /* Set up registers for signal handler */
863         env->regs[R_ESP] = frame_addr;
864         env->eip = ka->_sa_handler;
865
866         cpu_x86_load_seg(env, R_DS, __USER_DS);
867         cpu_x86_load_seg(env, R_ES, __USER_DS);
868         cpu_x86_load_seg(env, R_SS, __USER_DS);
869         cpu_x86_load_seg(env, R_CS, __USER_CS);
870         env->eflags &= ~TF_MASK;
871
872         unlock_user_struct(frame, frame_addr, 1);
873
874         return;
875
876 give_sigsegv:
877         unlock_user_struct(frame, frame_addr, 1);
878         if (sig == TARGET_SIGSEGV)
879                 ka->_sa_handler = TARGET_SIG_DFL;
880         force_sig(TARGET_SIGSEGV /* , current */);
881 }
882
883 /* compare linux/arch/i386/kernel/signal.c:setup_rt_frame() */
884 static void setup_rt_frame(int sig, struct target_sigaction *ka,
885                            target_siginfo_t *info,
886                            target_sigset_t *set, CPUX86State *env)
887 {
888         abi_ulong frame_addr, addr;
889         struct rt_sigframe *frame;
890         int i, err = 0;
891
892         frame_addr = get_sigframe(ka, env, sizeof(*frame));
893
894         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
895                 goto give_sigsegv;
896
897         err |= __put_user(current_exec_domain_sig(sig),
898                           &frame->sig);
899         addr = frame_addr + offsetof(struct rt_sigframe, info);
900         err |= __put_user(addr, &frame->pinfo);
901         addr = frame_addr + offsetof(struct rt_sigframe, uc);
902         err |= __put_user(addr, &frame->puc);
903         err |= copy_siginfo_to_user(&frame->info, info);
904         if (err)
905                 goto give_sigsegv;
906
907         /* Create the ucontext.  */
908         err |= __put_user(0, &frame->uc.tuc_flags);
909         err |= __put_user(0, &frame->uc.tuc_link);
910         err |= __put_user(target_sigaltstack_used.ss_sp,
911                           &frame->uc.tuc_stack.ss_sp);
912         err |= __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
913                           &frame->uc.tuc_stack.ss_flags);
914         err |= __put_user(target_sigaltstack_used.ss_size,
915                           &frame->uc.tuc_stack.ss_size);
916         err |= setup_sigcontext(&frame->uc.tuc_mcontext, &frame->fpstate,
917                                 env, set->sig[0], 
918                                 frame_addr + offsetof(struct rt_sigframe, fpstate));
919         for(i = 0; i < TARGET_NSIG_WORDS; i++) {
920             if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
921                 goto give_sigsegv;
922         }
923
924         /* Set up to return from userspace.  If provided, use a stub
925            already in userspace.  */
926         if (ka->sa_flags & TARGET_SA_RESTORER) {
927                 err |= __put_user(ka->sa_restorer, &frame->pretcode);
928         } else {
929                 uint16_t val16;
930                 addr = frame_addr + offsetof(struct rt_sigframe, retcode);
931                 err |= __put_user(addr, &frame->pretcode);
932                 /* This is movl $,%eax ; int $0x80 */
933                 err |= __put_user(0xb8, (char *)(frame->retcode+0));
934                 err |= __put_user(TARGET_NR_rt_sigreturn, (int *)(frame->retcode+1));
935                 val16 = 0x80cd;
936                 err |= __put_user(val16, (uint16_t *)(frame->retcode+5));
937         }
938
939         if (err)
940                 goto give_sigsegv;
941
942         /* Set up registers for signal handler */
943         env->regs[R_ESP] = frame_addr;
944         env->eip = ka->_sa_handler;
945
946         cpu_x86_load_seg(env, R_DS, __USER_DS);
947         cpu_x86_load_seg(env, R_ES, __USER_DS);
948         cpu_x86_load_seg(env, R_SS, __USER_DS);
949         cpu_x86_load_seg(env, R_CS, __USER_CS);
950         env->eflags &= ~TF_MASK;
951
952         unlock_user_struct(frame, frame_addr, 1);
953
954         return;
955
956 give_sigsegv:
957         unlock_user_struct(frame, frame_addr, 1);
958         if (sig == TARGET_SIGSEGV)
959                 ka->_sa_handler = TARGET_SIG_DFL;
960         force_sig(TARGET_SIGSEGV /* , current */);
961 }
962
963 static int
964 restore_sigcontext(CPUX86State *env, struct target_sigcontext *sc, int *peax)
965 {
966         unsigned int err = 0;
967         abi_ulong fpstate_addr;
968         unsigned int tmpflags;
969
970         cpu_x86_load_seg(env, R_GS, tswap16(sc->gs));
971         cpu_x86_load_seg(env, R_FS, tswap16(sc->fs));
972         cpu_x86_load_seg(env, R_ES, tswap16(sc->es));
973         cpu_x86_load_seg(env, R_DS, tswap16(sc->ds));
974
975         env->regs[R_EDI] = tswapl(sc->edi);
976         env->regs[R_ESI] = tswapl(sc->esi);
977         env->regs[R_EBP] = tswapl(sc->ebp);
978         env->regs[R_ESP] = tswapl(sc->esp);
979         env->regs[R_EBX] = tswapl(sc->ebx);
980         env->regs[R_EDX] = tswapl(sc->edx);
981         env->regs[R_ECX] = tswapl(sc->ecx);
982         env->eip = tswapl(sc->eip);
983
984         cpu_x86_load_seg(env, R_CS, lduw_p(&sc->cs) | 3);
985         cpu_x86_load_seg(env, R_SS, lduw_p(&sc->ss) | 3);
986
987         tmpflags = tswapl(sc->eflags);
988         env->eflags = (env->eflags & ~0x40DD5) | (tmpflags & 0x40DD5);
989         //              regs->orig_eax = -1;            /* disable syscall checks */
990
991         fpstate_addr = tswapl(sc->fpstate);
992         if (fpstate_addr != 0) {
993                 if (!access_ok(VERIFY_READ, fpstate_addr, 
994                                sizeof(struct target_fpstate)))
995                         goto badframe;
996                 cpu_x86_frstor(env, fpstate_addr, 1);
997         }
998
999         *peax = tswapl(sc->eax);
1000         return err;
1001 badframe:
1002         return 1;
1003 }
1004
1005 long do_sigreturn(CPUX86State *env)
1006 {
1007     struct sigframe *frame;
1008     abi_ulong frame_addr = env->regs[R_ESP] - 8;
1009     target_sigset_t target_set;
1010     sigset_t set;
1011     int eax, i;
1012
1013 #if defined(DEBUG_SIGNAL)
1014     fprintf(stderr, "do_sigreturn\n");
1015 #endif
1016     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1017         goto badframe;
1018     /* set blocked signals */
1019     if (__get_user(target_set.sig[0], &frame->sc.oldmask))
1020         goto badframe;
1021     for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1022         if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
1023             goto badframe;
1024     }
1025
1026     target_to_host_sigset_internal(&set, &target_set);
1027     sigprocmask(SIG_SETMASK, &set, NULL);
1028
1029     /* restore registers */
1030     if (restore_sigcontext(env, &frame->sc, &eax))
1031         goto badframe;
1032     unlock_user_struct(frame, frame_addr, 0);
1033     return eax;
1034
1035 badframe:
1036     unlock_user_struct(frame, frame_addr, 0);
1037     force_sig(TARGET_SIGSEGV);
1038     return 0;
1039 }
1040
1041 long do_rt_sigreturn(CPUX86State *env)
1042 {
1043         abi_ulong frame_addr;
1044         struct rt_sigframe *frame;
1045         sigset_t set;
1046         int eax;
1047
1048         frame_addr = env->regs[R_ESP] - 4;
1049         if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1050                 goto badframe;
1051         target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
1052         sigprocmask(SIG_SETMASK, &set, NULL);
1053
1054         if (restore_sigcontext(env, &frame->uc.tuc_mcontext, &eax))
1055                 goto badframe;
1056
1057         if (do_sigaltstack(frame_addr + offsetof(struct rt_sigframe, uc.tuc_stack), 0, 
1058                            get_sp_from_cpustate(env)) == -EFAULT)
1059                 goto badframe;
1060
1061         unlock_user_struct(frame, frame_addr, 0);
1062         return eax;
1063
1064 badframe:
1065         unlock_user_struct(frame, frame_addr, 0);
1066         force_sig(TARGET_SIGSEGV);
1067         return 0;
1068 }
1069
1070 #elif defined(TARGET_ARM)
1071
1072 struct target_sigcontext {
1073         abi_ulong trap_no;
1074         abi_ulong error_code;
1075         abi_ulong oldmask;
1076         abi_ulong arm_r0;
1077         abi_ulong arm_r1;
1078         abi_ulong arm_r2;
1079         abi_ulong arm_r3;
1080         abi_ulong arm_r4;
1081         abi_ulong arm_r5;
1082         abi_ulong arm_r6;
1083         abi_ulong arm_r7;
1084         abi_ulong arm_r8;
1085         abi_ulong arm_r9;
1086         abi_ulong arm_r10;
1087         abi_ulong arm_fp;
1088         abi_ulong arm_ip;
1089         abi_ulong arm_sp;
1090         abi_ulong arm_lr;
1091         abi_ulong arm_pc;
1092         abi_ulong arm_cpsr;
1093         abi_ulong fault_address;
1094 };
1095
1096 struct target_ucontext_v1 {
1097     abi_ulong tuc_flags;
1098     abi_ulong tuc_link;
1099     target_stack_t tuc_stack;
1100     struct target_sigcontext tuc_mcontext;
1101     target_sigset_t  tuc_sigmask;       /* mask last for extensibility */
1102 };
1103
1104 struct target_ucontext_v2 {
1105     abi_ulong tuc_flags;
1106     abi_ulong tuc_link;
1107     target_stack_t tuc_stack;
1108     struct target_sigcontext tuc_mcontext;
1109     target_sigset_t  tuc_sigmask;       /* mask last for extensibility */
1110     char __unused[128 - sizeof(target_sigset_t)];
1111     abi_ulong tuc_regspace[128] __attribute__((__aligned__(8)));
1112 };
1113
1114 struct target_user_vfp {
1115     uint64_t fpregs[32];
1116     abi_ulong fpscr;
1117 };
1118
1119 struct target_user_vfp_exc {
1120     abi_ulong fpexc;
1121     abi_ulong fpinst;
1122     abi_ulong fpinst2;
1123 };
1124
1125 struct target_vfp_sigframe {
1126     abi_ulong magic;
1127     abi_ulong size;
1128     struct target_user_vfp ufp;
1129     struct target_user_vfp_exc ufp_exc;
1130 } __attribute__((__aligned__(8)));
1131
1132 struct target_iwmmxt_sigframe {
1133     abi_ulong magic;
1134     abi_ulong size;
1135     uint64_t regs[16];
1136     /* Note that not all the coprocessor control registers are stored here */
1137     uint32_t wcssf;
1138     uint32_t wcasf;
1139     uint32_t wcgr0;
1140     uint32_t wcgr1;
1141     uint32_t wcgr2;
1142     uint32_t wcgr3;
1143 } __attribute__((__aligned__(8)));
1144
1145 #define TARGET_VFP_MAGIC 0x56465001
1146 #define TARGET_IWMMXT_MAGIC 0x12ef842a
1147
1148 struct sigframe_v1
1149 {
1150     struct target_sigcontext sc;
1151     abi_ulong extramask[TARGET_NSIG_WORDS-1];
1152     abi_ulong retcode;
1153 };
1154
1155 struct sigframe_v2
1156 {
1157     struct target_ucontext_v2 uc;
1158     abi_ulong retcode;
1159 };
1160
1161 struct rt_sigframe_v1
1162 {
1163     abi_ulong pinfo;
1164     abi_ulong puc;
1165     struct target_siginfo info;
1166     struct target_ucontext_v1 uc;
1167     abi_ulong retcode;
1168 };
1169
1170 struct rt_sigframe_v2
1171 {
1172     struct target_siginfo info;
1173     struct target_ucontext_v2 uc;
1174     abi_ulong retcode;
1175 };
1176
1177 #define TARGET_CONFIG_CPU_32 1
1178
1179 /*
1180  * For ARM syscalls, we encode the syscall number into the instruction.
1181  */
1182 #define SWI_SYS_SIGRETURN       (0xef000000|(TARGET_NR_sigreturn + ARM_SYSCALL_BASE))
1183 #define SWI_SYS_RT_SIGRETURN    (0xef000000|(TARGET_NR_rt_sigreturn + ARM_SYSCALL_BASE))
1184
1185 /*
1186  * For Thumb syscalls, we pass the syscall number via r7.  We therefore
1187  * need two 16-bit instructions.
1188  */
1189 #define SWI_THUMB_SIGRETURN     (0xdf00 << 16 | 0x2700 | (TARGET_NR_sigreturn))
1190 #define SWI_THUMB_RT_SIGRETURN  (0xdf00 << 16 | 0x2700 | (TARGET_NR_rt_sigreturn))
1191
1192 static const abi_ulong retcodes[4] = {
1193         SWI_SYS_SIGRETURN,      SWI_THUMB_SIGRETURN,
1194         SWI_SYS_RT_SIGRETURN,   SWI_THUMB_RT_SIGRETURN
1195 };
1196
1197
1198 #define __get_user_error(x,p,e) __get_user(x, p)
1199
1200 static inline int valid_user_regs(CPUState *regs)
1201 {
1202     return 1;
1203 }
1204
1205 static void
1206 setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1207                  CPUState *env, abi_ulong mask)
1208 {
1209         __put_user(env->regs[0], &sc->arm_r0);
1210         __put_user(env->regs[1], &sc->arm_r1);
1211         __put_user(env->regs[2], &sc->arm_r2);
1212         __put_user(env->regs[3], &sc->arm_r3);
1213         __put_user(env->regs[4], &sc->arm_r4);
1214         __put_user(env->regs[5], &sc->arm_r5);
1215         __put_user(env->regs[6], &sc->arm_r6);
1216         __put_user(env->regs[7], &sc->arm_r7);
1217         __put_user(env->regs[8], &sc->arm_r8);
1218         __put_user(env->regs[9], &sc->arm_r9);
1219         __put_user(env->regs[10], &sc->arm_r10);
1220         __put_user(env->regs[11], &sc->arm_fp);
1221         __put_user(env->regs[12], &sc->arm_ip);
1222         __put_user(env->regs[13], &sc->arm_sp);
1223         __put_user(env->regs[14], &sc->arm_lr);
1224         __put_user(env->regs[15], &sc->arm_pc);
1225 #ifdef TARGET_CONFIG_CPU_32
1226         __put_user(cpsr_read(env), &sc->arm_cpsr);
1227 #endif
1228
1229         __put_user(/* current->thread.trap_no */ 0, &sc->trap_no);
1230         __put_user(/* current->thread.error_code */ 0, &sc->error_code);
1231         __put_user(/* current->thread.address */ 0, &sc->fault_address);
1232         __put_user(mask, &sc->oldmask);
1233 }
1234
1235 static inline abi_ulong
1236 get_sigframe(struct target_sigaction *ka, CPUState *regs, int framesize)
1237 {
1238         unsigned long sp = regs->regs[13];
1239
1240         /*
1241          * This is the X/Open sanctioned signal stack switching.
1242          */
1243         if ((ka->sa_flags & TARGET_SA_ONSTACK) && !sas_ss_flags(sp))
1244             sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
1245         /*
1246          * ATPCS B01 mandates 8-byte alignment
1247          */
1248         return (sp - framesize) & ~7;
1249 }
1250
1251 static int
1252 setup_return(CPUState *env, struct target_sigaction *ka,
1253              abi_ulong *rc, abi_ulong frame_addr, int usig, abi_ulong rc_addr)
1254 {
1255         abi_ulong handler = ka->_sa_handler;
1256         abi_ulong retcode;
1257         int thumb = handler & 1;
1258         uint32_t cpsr = cpsr_read(env);
1259
1260         cpsr &= ~CPSR_IT;
1261         if (thumb) {
1262                 cpsr |= CPSR_T;
1263         } else {
1264                 cpsr &= ~CPSR_T;
1265         }
1266
1267         if (ka->sa_flags & TARGET_SA_RESTORER) {
1268                 retcode = ka->sa_restorer;
1269         } else {
1270                 unsigned int idx = thumb;
1271
1272                 if (ka->sa_flags & TARGET_SA_SIGINFO)
1273                         idx += 2;
1274
1275                 if (__put_user(retcodes[idx], rc))
1276                         return 1;
1277 #if 0
1278                 flush_icache_range((abi_ulong)rc,
1279                                    (abi_ulong)(rc + 1));
1280 #endif
1281                 retcode = rc_addr + thumb;
1282         }
1283
1284         env->regs[0] = usig;
1285         env->regs[13] = frame_addr;
1286         env->regs[14] = retcode;
1287         env->regs[15] = handler & (thumb ? ~1 : ~3);
1288         cpsr_write(env, cpsr, 0xffffffff);
1289
1290         return 0;
1291 }
1292
1293 static abi_ulong *setup_sigframe_v2_vfp(abi_ulong *regspace, CPUState *env)
1294 {
1295     int i;
1296     struct target_vfp_sigframe *vfpframe;
1297     vfpframe = (struct target_vfp_sigframe *)regspace;
1298     __put_user(TARGET_VFP_MAGIC, &vfpframe->magic);
1299     __put_user(sizeof(*vfpframe), &vfpframe->size);
1300     for (i = 0; i < 32; i++) {
1301         __put_user(float64_val(env->vfp.regs[i]), &vfpframe->ufp.fpregs[i]);
1302     }
1303     __put_user(vfp_get_fpscr(env), &vfpframe->ufp.fpscr);
1304     __put_user(env->vfp.xregs[ARM_VFP_FPEXC], &vfpframe->ufp_exc.fpexc);
1305     __put_user(env->vfp.xregs[ARM_VFP_FPINST], &vfpframe->ufp_exc.fpinst);
1306     __put_user(env->vfp.xregs[ARM_VFP_FPINST2], &vfpframe->ufp_exc.fpinst2);
1307     return (abi_ulong*)(vfpframe+1);
1308 }
1309
1310 static abi_ulong *setup_sigframe_v2_iwmmxt(abi_ulong *regspace, CPUState *env)
1311 {
1312     int i;
1313     struct target_iwmmxt_sigframe *iwmmxtframe;
1314     iwmmxtframe = (struct target_iwmmxt_sigframe *)regspace;
1315     __put_user(TARGET_IWMMXT_MAGIC, &iwmmxtframe->magic);
1316     __put_user(sizeof(*iwmmxtframe), &iwmmxtframe->size);
1317     for (i = 0; i < 16; i++) {
1318         __put_user(env->iwmmxt.regs[i], &iwmmxtframe->regs[i]);
1319     }
1320     __put_user(env->vfp.xregs[ARM_IWMMXT_wCSSF], &iwmmxtframe->wcssf);
1321     __put_user(env->vfp.xregs[ARM_IWMMXT_wCASF], &iwmmxtframe->wcssf);
1322     __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR0], &iwmmxtframe->wcgr0);
1323     __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR1], &iwmmxtframe->wcgr1);
1324     __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR2], &iwmmxtframe->wcgr2);
1325     __put_user(env->vfp.xregs[ARM_IWMMXT_wCGR3], &iwmmxtframe->wcgr3);
1326     return (abi_ulong*)(iwmmxtframe+1);
1327 }
1328
1329 static void setup_sigframe_v2(struct target_ucontext_v2 *uc,
1330                               target_sigset_t *set, CPUState *env)
1331 {
1332     struct target_sigaltstack stack;
1333     int i;
1334     abi_ulong *regspace;
1335
1336     /* Clear all the bits of the ucontext we don't use.  */
1337     memset(uc, 0, offsetof(struct target_ucontext_v2, tuc_mcontext));
1338
1339     memset(&stack, 0, sizeof(stack));
1340     __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
1341     __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
1342     __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
1343     memcpy(&uc->tuc_stack, &stack, sizeof(stack));
1344
1345     setup_sigcontext(&uc->tuc_mcontext, env, set->sig[0]);
1346     /* Save coprocessor signal frame.  */
1347     regspace = uc->tuc_regspace;
1348     if (arm_feature(env, ARM_FEATURE_VFP)) {
1349         regspace = setup_sigframe_v2_vfp(regspace, env);
1350     }
1351     if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
1352         regspace = setup_sigframe_v2_iwmmxt(regspace, env);
1353     }
1354
1355     /* Write terminating magic word */
1356     __put_user(0, regspace);
1357
1358     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
1359         __put_user(set->sig[i], &uc->tuc_sigmask.sig[i]);
1360     }
1361 }
1362
1363 /* compare linux/arch/arm/kernel/signal.c:setup_frame() */
1364 static void setup_frame_v1(int usig, struct target_sigaction *ka,
1365                            target_sigset_t *set, CPUState *regs)
1366 {
1367         struct sigframe_v1 *frame;
1368         abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
1369         int i;
1370
1371         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1372                 return;
1373
1374         setup_sigcontext(&frame->sc, regs, set->sig[0]);
1375
1376         for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1377             if (__put_user(set->sig[i], &frame->extramask[i - 1]))
1378                 goto end;
1379         }
1380
1381         setup_return(regs, ka, &frame->retcode, frame_addr, usig,
1382                      frame_addr + offsetof(struct sigframe_v1, retcode));
1383
1384 end:
1385         unlock_user_struct(frame, frame_addr, 1);
1386 }
1387
1388 static void setup_frame_v2(int usig, struct target_sigaction *ka,
1389                            target_sigset_t *set, CPUState *regs)
1390 {
1391         struct sigframe_v2 *frame;
1392         abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
1393
1394         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1395                 return;
1396
1397         setup_sigframe_v2(&frame->uc, set, regs);
1398
1399         setup_return(regs, ka, &frame->retcode, frame_addr, usig,
1400                      frame_addr + offsetof(struct sigframe_v2, retcode));
1401
1402         unlock_user_struct(frame, frame_addr, 1);
1403 }
1404
1405 static void setup_frame(int usig, struct target_sigaction *ka,
1406                         target_sigset_t *set, CPUState *regs)
1407 {
1408     if (get_osversion() >= 0x020612) {
1409         setup_frame_v2(usig, ka, set, regs);
1410     } else {
1411         setup_frame_v1(usig, ka, set, regs);
1412     }
1413 }
1414
1415 /* compare linux/arch/arm/kernel/signal.c:setup_rt_frame() */
1416 static void setup_rt_frame_v1(int usig, struct target_sigaction *ka,
1417                               target_siginfo_t *info,
1418                               target_sigset_t *set, CPUState *env)
1419 {
1420         struct rt_sigframe_v1 *frame;
1421         abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
1422         struct target_sigaltstack stack;
1423         int i;
1424         abi_ulong info_addr, uc_addr;
1425
1426         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1427             return /* 1 */;
1428
1429         info_addr = frame_addr + offsetof(struct rt_sigframe_v1, info);
1430         __put_user(info_addr, &frame->pinfo);
1431         uc_addr = frame_addr + offsetof(struct rt_sigframe_v1, uc);
1432         __put_user(uc_addr, &frame->puc);
1433         copy_siginfo_to_user(&frame->info, info);
1434
1435         /* Clear all the bits of the ucontext we don't use.  */
1436         memset(&frame->uc, 0, offsetof(struct target_ucontext_v1, tuc_mcontext));
1437
1438         memset(&stack, 0, sizeof(stack));
1439         __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
1440         __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
1441         __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
1442         memcpy(&frame->uc.tuc_stack, &stack, sizeof(stack));
1443
1444         setup_sigcontext(&frame->uc.tuc_mcontext, env, set->sig[0]);
1445         for(i = 0; i < TARGET_NSIG_WORDS; i++) {
1446             if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
1447                 goto end;
1448         }
1449
1450         setup_return(env, ka, &frame->retcode, frame_addr, usig,
1451                      frame_addr + offsetof(struct rt_sigframe_v1, retcode));
1452
1453         env->regs[1] = info_addr;
1454         env->regs[2] = uc_addr;
1455
1456 end:
1457         unlock_user_struct(frame, frame_addr, 1);
1458 }
1459
1460 static void setup_rt_frame_v2(int usig, struct target_sigaction *ka,
1461                               target_siginfo_t *info,
1462                               target_sigset_t *set, CPUState *env)
1463 {
1464         struct rt_sigframe_v2 *frame;
1465         abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
1466         abi_ulong info_addr, uc_addr;
1467
1468         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1469             return /* 1 */;
1470
1471         info_addr = frame_addr + offsetof(struct rt_sigframe_v2, info);
1472         uc_addr = frame_addr + offsetof(struct rt_sigframe_v2, uc);
1473         copy_siginfo_to_user(&frame->info, info);
1474
1475         setup_sigframe_v2(&frame->uc, set, env);
1476
1477         setup_return(env, ka, &frame->retcode, frame_addr, usig,
1478                      frame_addr + offsetof(struct rt_sigframe_v2, retcode));
1479
1480         env->regs[1] = info_addr;
1481         env->regs[2] = uc_addr;
1482
1483         unlock_user_struct(frame, frame_addr, 1);
1484 }
1485
1486 static void setup_rt_frame(int usig, struct target_sigaction *ka,
1487                            target_siginfo_t *info,
1488                            target_sigset_t *set, CPUState *env)
1489 {
1490     if (get_osversion() >= 0x020612) {
1491         setup_rt_frame_v2(usig, ka, info, set, env);
1492     } else {
1493         setup_rt_frame_v1(usig, ka, info, set, env);
1494     }
1495 }
1496
1497 static int
1498 restore_sigcontext(CPUState *env, struct target_sigcontext *sc)
1499 {
1500         int err = 0;
1501         uint32_t cpsr;
1502
1503         __get_user_error(env->regs[0], &sc->arm_r0, err);
1504         __get_user_error(env->regs[1], &sc->arm_r1, err);
1505         __get_user_error(env->regs[2], &sc->arm_r2, err);
1506         __get_user_error(env->regs[3], &sc->arm_r3, err);
1507         __get_user_error(env->regs[4], &sc->arm_r4, err);
1508         __get_user_error(env->regs[5], &sc->arm_r5, err);
1509         __get_user_error(env->regs[6], &sc->arm_r6, err);
1510         __get_user_error(env->regs[7], &sc->arm_r7, err);
1511         __get_user_error(env->regs[8], &sc->arm_r8, err);
1512         __get_user_error(env->regs[9], &sc->arm_r9, err);
1513         __get_user_error(env->regs[10], &sc->arm_r10, err);
1514         __get_user_error(env->regs[11], &sc->arm_fp, err);
1515         __get_user_error(env->regs[12], &sc->arm_ip, err);
1516         __get_user_error(env->regs[13], &sc->arm_sp, err);
1517         __get_user_error(env->regs[14], &sc->arm_lr, err);
1518         __get_user_error(env->regs[15], &sc->arm_pc, err);
1519 #ifdef TARGET_CONFIG_CPU_32
1520         __get_user_error(cpsr, &sc->arm_cpsr, err);
1521         cpsr_write(env, cpsr, CPSR_USER | CPSR_EXEC);
1522 #endif
1523
1524         err |= !valid_user_regs(env);
1525
1526         return err;
1527 }
1528
1529 static long do_sigreturn_v1(CPUState *env)
1530 {
1531         abi_ulong frame_addr;
1532         struct sigframe_v1 *frame;
1533         target_sigset_t set;
1534         sigset_t host_set;
1535         int i;
1536
1537         /*
1538          * Since we stacked the signal on a 64-bit boundary,
1539          * then 'sp' should be word aligned here.  If it's
1540          * not, then the user is trying to mess with us.
1541          */
1542         if (env->regs[13] & 7)
1543                 goto badframe;
1544
1545         frame_addr = env->regs[13];
1546         if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1547                 goto badframe;
1548
1549         if (__get_user(set.sig[0], &frame->sc.oldmask))
1550             goto badframe;
1551         for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1552             if (__get_user(set.sig[i], &frame->extramask[i - 1]))
1553                 goto badframe;
1554         }
1555
1556         target_to_host_sigset_internal(&host_set, &set);
1557         sigprocmask(SIG_SETMASK, &host_set, NULL);
1558
1559         if (restore_sigcontext(env, &frame->sc))
1560                 goto badframe;
1561
1562 #if 0
1563         /* Send SIGTRAP if we're single-stepping */
1564         if (ptrace_cancel_bpt(current))
1565                 send_sig(SIGTRAP, current, 1);
1566 #endif
1567         unlock_user_struct(frame, frame_addr, 0);
1568         return env->regs[0];
1569
1570 badframe:
1571         unlock_user_struct(frame, frame_addr, 0);
1572         force_sig(TARGET_SIGSEGV /* , current */);
1573         return 0;
1574 }
1575
1576 static abi_ulong *restore_sigframe_v2_vfp(CPUState *env, abi_ulong *regspace)
1577 {
1578     int i;
1579     abi_ulong magic, sz;
1580     uint32_t fpscr, fpexc;
1581     struct target_vfp_sigframe *vfpframe;
1582     vfpframe = (struct target_vfp_sigframe *)regspace;
1583
1584     __get_user(magic, &vfpframe->magic);
1585     __get_user(sz, &vfpframe->size);
1586     if (magic != TARGET_VFP_MAGIC || sz != sizeof(*vfpframe)) {
1587         return 0;
1588     }
1589     for (i = 0; i < 32; i++) {
1590         __get_user(float64_val(env->vfp.regs[i]), &vfpframe->ufp.fpregs[i]);
1591     }
1592     __get_user(fpscr, &vfpframe->ufp.fpscr);
1593     vfp_set_fpscr(env, fpscr);
1594     __get_user(fpexc, &vfpframe->ufp_exc.fpexc);
1595     /* Sanitise FPEXC: ensure VFP is enabled, FPINST2 is invalid
1596      * and the exception flag is cleared
1597      */
1598     fpexc |= (1 << 30);
1599     fpexc &= ~((1 << 31) | (1 << 28));
1600     env->vfp.xregs[ARM_VFP_FPEXC] = fpexc;
1601     __get_user(env->vfp.xregs[ARM_VFP_FPINST], &vfpframe->ufp_exc.fpinst);
1602     __get_user(env->vfp.xregs[ARM_VFP_FPINST2], &vfpframe->ufp_exc.fpinst2);
1603     return (abi_ulong*)(vfpframe + 1);
1604 }
1605
1606 static abi_ulong *restore_sigframe_v2_iwmmxt(CPUState *env, abi_ulong *regspace)
1607 {
1608     int i;
1609     abi_ulong magic, sz;
1610     struct target_iwmmxt_sigframe *iwmmxtframe;
1611     iwmmxtframe = (struct target_iwmmxt_sigframe *)regspace;
1612
1613     __get_user(magic, &iwmmxtframe->magic);
1614     __get_user(sz, &iwmmxtframe->size);
1615     if (magic != TARGET_IWMMXT_MAGIC || sz != sizeof(*iwmmxtframe)) {
1616         return 0;
1617     }
1618     for (i = 0; i < 16; i++) {
1619         __get_user(env->iwmmxt.regs[i], &iwmmxtframe->regs[i]);
1620     }
1621     __get_user(env->vfp.xregs[ARM_IWMMXT_wCSSF], &iwmmxtframe->wcssf);
1622     __get_user(env->vfp.xregs[ARM_IWMMXT_wCASF], &iwmmxtframe->wcssf);
1623     __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR0], &iwmmxtframe->wcgr0);
1624     __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR1], &iwmmxtframe->wcgr1);
1625     __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR2], &iwmmxtframe->wcgr2);
1626     __get_user(env->vfp.xregs[ARM_IWMMXT_wCGR3], &iwmmxtframe->wcgr3);
1627     return (abi_ulong*)(iwmmxtframe + 1);
1628 }
1629
1630 static int do_sigframe_return_v2(CPUState *env, target_ulong frame_addr,
1631                                  struct target_ucontext_v2 *uc)
1632 {
1633     sigset_t host_set;
1634     abi_ulong *regspace;
1635
1636     target_to_host_sigset(&host_set, &uc->tuc_sigmask);
1637     sigprocmask(SIG_SETMASK, &host_set, NULL);
1638
1639     if (restore_sigcontext(env, &uc->tuc_mcontext))
1640         return 1;
1641
1642     /* Restore coprocessor signal frame */
1643     regspace = uc->tuc_regspace;
1644     if (arm_feature(env, ARM_FEATURE_VFP)) {
1645         regspace = restore_sigframe_v2_vfp(env, regspace);
1646         if (!regspace) {
1647             return 1;
1648         }
1649     }
1650     if (arm_feature(env, ARM_FEATURE_IWMMXT)) {
1651         regspace = restore_sigframe_v2_iwmmxt(env, regspace);
1652         if (!regspace) {
1653             return 1;
1654         }
1655     }
1656
1657     if (do_sigaltstack(frame_addr + offsetof(struct target_ucontext_v2, tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
1658         return 1;
1659
1660 #if 0
1661     /* Send SIGTRAP if we're single-stepping */
1662     if (ptrace_cancel_bpt(current))
1663             send_sig(SIGTRAP, current, 1);
1664 #endif
1665
1666     return 0;
1667 }
1668
1669 static long do_sigreturn_v2(CPUState *env)
1670 {
1671         abi_ulong frame_addr;
1672         struct sigframe_v2 *frame;
1673
1674         /*
1675          * Since we stacked the signal on a 64-bit boundary,
1676          * then 'sp' should be word aligned here.  If it's
1677          * not, then the user is trying to mess with us.
1678          */
1679         if (env->regs[13] & 7)
1680                 goto badframe;
1681
1682         frame_addr = env->regs[13];
1683         if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1684                 goto badframe;
1685
1686         if (do_sigframe_return_v2(env, frame_addr, &frame->uc))
1687                 goto badframe;
1688
1689         unlock_user_struct(frame, frame_addr, 0);
1690         return env->regs[0];
1691
1692 badframe:
1693         unlock_user_struct(frame, frame_addr, 0);
1694         force_sig(TARGET_SIGSEGV /* , current */);
1695         return 0;
1696 }
1697
1698 long do_sigreturn(CPUState *env)
1699 {
1700     if (get_osversion() >= 0x020612) {
1701         return do_sigreturn_v2(env);
1702     } else {
1703         return do_sigreturn_v1(env);
1704     }
1705 }
1706
1707 static long do_rt_sigreturn_v1(CPUState *env)
1708 {
1709         abi_ulong frame_addr;
1710         struct rt_sigframe_v1 *frame;
1711         sigset_t host_set;
1712
1713         /*
1714          * Since we stacked the signal on a 64-bit boundary,
1715          * then 'sp' should be word aligned here.  If it's
1716          * not, then the user is trying to mess with us.
1717          */
1718         if (env->regs[13] & 7)
1719                 goto badframe;
1720
1721         frame_addr = env->regs[13];
1722         if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1723                 goto badframe;
1724
1725         target_to_host_sigset(&host_set, &frame->uc.tuc_sigmask);
1726         sigprocmask(SIG_SETMASK, &host_set, NULL);
1727
1728         if (restore_sigcontext(env, &frame->uc.tuc_mcontext))
1729                 goto badframe;
1730
1731         if (do_sigaltstack(frame_addr + offsetof(struct rt_sigframe_v1, uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
1732                 goto badframe;
1733
1734 #if 0
1735         /* Send SIGTRAP if we're single-stepping */
1736         if (ptrace_cancel_bpt(current))
1737                 send_sig(SIGTRAP, current, 1);
1738 #endif
1739         unlock_user_struct(frame, frame_addr, 0);
1740         return env->regs[0];
1741
1742 badframe:
1743         unlock_user_struct(frame, frame_addr, 0);
1744         force_sig(TARGET_SIGSEGV /* , current */);
1745         return 0;
1746 }
1747
1748 static long do_rt_sigreturn_v2(CPUState *env)
1749 {
1750         abi_ulong frame_addr;
1751         struct rt_sigframe_v2 *frame;
1752
1753         /*
1754          * Since we stacked the signal on a 64-bit boundary,
1755          * then 'sp' should be word aligned here.  If it's
1756          * not, then the user is trying to mess with us.
1757          */
1758         if (env->regs[13] & 7)
1759                 goto badframe;
1760
1761         frame_addr = env->regs[13];
1762         if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1763                 goto badframe;
1764
1765         if (do_sigframe_return_v2(env, frame_addr, &frame->uc))
1766                 goto badframe;
1767
1768         unlock_user_struct(frame, frame_addr, 0);
1769         return env->regs[0];
1770
1771 badframe:
1772         unlock_user_struct(frame, frame_addr, 0);
1773         force_sig(TARGET_SIGSEGV /* , current */);
1774         return 0;
1775 }
1776
1777 long do_rt_sigreturn(CPUState *env)
1778 {
1779     if (get_osversion() >= 0x020612) {
1780         return do_rt_sigreturn_v2(env);
1781     } else {
1782         return do_rt_sigreturn_v1(env);
1783     }
1784 }
1785
1786 #elif defined(TARGET_SPARC)
1787
1788 #define __SUNOS_MAXWIN   31
1789
1790 /* This is what SunOS does, so shall I. */
1791 struct target_sigcontext {
1792         abi_ulong sigc_onstack;      /* state to restore */
1793
1794         abi_ulong sigc_mask;         /* sigmask to restore */
1795         abi_ulong sigc_sp;           /* stack pointer */
1796         abi_ulong sigc_pc;           /* program counter */
1797         abi_ulong sigc_npc;          /* next program counter */
1798         abi_ulong sigc_psr;          /* for condition codes etc */
1799         abi_ulong sigc_g1;           /* User uses these two registers */
1800         abi_ulong sigc_o0;           /* within the trampoline code. */
1801
1802         /* Now comes information regarding the users window set
1803          * at the time of the signal.
1804          */
1805         abi_ulong sigc_oswins;       /* outstanding windows */
1806
1807         /* stack ptrs for each regwin buf */
1808         char *sigc_spbuf[__SUNOS_MAXWIN];
1809
1810         /* Windows to restore after signal */
1811         struct {
1812                 abi_ulong locals[8];
1813                 abi_ulong ins[8];
1814         } sigc_wbuf[__SUNOS_MAXWIN];
1815 };
1816 /* A Sparc stack frame */
1817 struct sparc_stackf {
1818         abi_ulong locals[8];
1819         abi_ulong ins[8];
1820         /* It's simpler to treat fp and callers_pc as elements of ins[]
1821          * since we never need to access them ourselves.
1822          */
1823         char *structptr;
1824         abi_ulong xargs[6];
1825         abi_ulong xxargs[1];
1826 };
1827
1828 typedef struct {
1829         struct {
1830                 abi_ulong psr;
1831                 abi_ulong pc;
1832                 abi_ulong npc;
1833                 abi_ulong y;
1834                 abi_ulong u_regs[16]; /* globals and ins */
1835         }               si_regs;
1836         int             si_mask;
1837 } __siginfo_t;
1838
1839 typedef struct {
1840         unsigned   long si_float_regs [32];
1841         unsigned   long si_fsr;
1842         unsigned   long si_fpqdepth;
1843         struct {
1844                 unsigned long *insn_addr;
1845                 unsigned long insn;
1846         } si_fpqueue [16];
1847 } qemu_siginfo_fpu_t;
1848
1849
1850 struct target_signal_frame {
1851         struct sparc_stackf     ss;
1852         __siginfo_t             info;
1853         abi_ulong               fpu_save;
1854         abi_ulong               insns[2] __attribute__ ((aligned (8)));
1855         abi_ulong               extramask[TARGET_NSIG_WORDS - 1];
1856         abi_ulong               extra_size; /* Should be 0 */
1857         qemu_siginfo_fpu_t      fpu_state;
1858 };
1859 struct target_rt_signal_frame {
1860         struct sparc_stackf     ss;
1861         siginfo_t               info;
1862         abi_ulong               regs[20];
1863         sigset_t                mask;
1864         abi_ulong               fpu_save;
1865         unsigned int            insns[2];
1866         stack_t                 stack;
1867         unsigned int            extra_size; /* Should be 0 */
1868         qemu_siginfo_fpu_t      fpu_state;
1869 };
1870
1871 #define UREG_O0        16
1872 #define UREG_O6        22
1873 #define UREG_I0        0
1874 #define UREG_I1        1
1875 #define UREG_I2        2
1876 #define UREG_I3        3
1877 #define UREG_I4        4
1878 #define UREG_I5        5
1879 #define UREG_I6        6
1880 #define UREG_I7        7
1881 #define UREG_L0        8
1882 #define UREG_FP        UREG_I6
1883 #define UREG_SP        UREG_O6
1884
1885 static inline abi_ulong get_sigframe(struct target_sigaction *sa, 
1886                                      CPUState *env, unsigned long framesize)
1887 {
1888         abi_ulong sp;
1889
1890         sp = env->regwptr[UREG_FP];
1891
1892         /* This is the X/Open sanctioned signal stack switching.  */
1893         if (sa->sa_flags & TARGET_SA_ONSTACK) {
1894             if (!on_sig_stack(sp)
1895                 && !((target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size) & 7))
1896                 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
1897         }
1898         return sp - framesize;
1899 }
1900
1901 static int
1902 setup___siginfo(__siginfo_t *si, CPUState *env, abi_ulong mask)
1903 {
1904         int err = 0, i;
1905
1906         err |= __put_user(env->psr, &si->si_regs.psr);
1907         err |= __put_user(env->pc, &si->si_regs.pc);
1908         err |= __put_user(env->npc, &si->si_regs.npc);
1909         err |= __put_user(env->y, &si->si_regs.y);
1910         for (i=0; i < 8; i++) {
1911                 err |= __put_user(env->gregs[i], &si->si_regs.u_regs[i]);
1912         }
1913         for (i=0; i < 8; i++) {
1914                 err |= __put_user(env->regwptr[UREG_I0 + i], &si->si_regs.u_regs[i+8]);
1915         }
1916         err |= __put_user(mask, &si->si_mask);
1917         return err;
1918 }
1919
1920 #if 0
1921 static int
1922 setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1923                  CPUState *env, unsigned long mask)
1924 {
1925         int err = 0;
1926
1927         err |= __put_user(mask, &sc->sigc_mask);
1928         err |= __put_user(env->regwptr[UREG_SP], &sc->sigc_sp);
1929         err |= __put_user(env->pc, &sc->sigc_pc);
1930         err |= __put_user(env->npc, &sc->sigc_npc);
1931         err |= __put_user(env->psr, &sc->sigc_psr);
1932         err |= __put_user(env->gregs[1], &sc->sigc_g1);
1933         err |= __put_user(env->regwptr[UREG_O0], &sc->sigc_o0);
1934
1935         return err;
1936 }
1937 #endif
1938 #define NF_ALIGNEDSZ  (((sizeof(struct target_signal_frame) + 7) & (~7)))
1939
1940 static void setup_frame(int sig, struct target_sigaction *ka,
1941                         target_sigset_t *set, CPUState *env)
1942 {
1943         abi_ulong sf_addr;
1944         struct target_signal_frame *sf;
1945         int sigframe_size, err, i;
1946
1947         /* 1. Make sure everything is clean */
1948         //synchronize_user_stack();
1949
1950         sigframe_size = NF_ALIGNEDSZ;
1951         sf_addr = get_sigframe(ka, env, sigframe_size);
1952
1953         sf = lock_user(VERIFY_WRITE, sf_addr, 
1954                        sizeof(struct target_signal_frame), 0);
1955         if (!sf)
1956                 goto sigsegv;
1957                 
1958         //fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
1959 #if 0
1960         if (invalid_frame_pointer(sf, sigframe_size))
1961                 goto sigill_and_return;
1962 #endif
1963         /* 2. Save the current process state */
1964         err = setup___siginfo(&sf->info, env, set->sig[0]);
1965         err |= __put_user(0, &sf->extra_size);
1966
1967         //err |= save_fpu_state(regs, &sf->fpu_state);
1968         //err |= __put_user(&sf->fpu_state, &sf->fpu_save);
1969
1970         err |= __put_user(set->sig[0], &sf->info.si_mask);
1971         for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
1972                 err |= __put_user(set->sig[i + 1], &sf->extramask[i]);
1973         }
1974
1975         for (i = 0; i < 8; i++) {
1976                 err |= __put_user(env->regwptr[i + UREG_L0], &sf->ss.locals[i]);
1977         }
1978         for (i = 0; i < 8; i++) {
1979                 err |= __put_user(env->regwptr[i + UREG_I0], &sf->ss.ins[i]);
1980         }
1981         if (err)
1982                 goto sigsegv;
1983
1984         /* 3. signal handler back-trampoline and parameters */
1985         env->regwptr[UREG_FP] = sf_addr;
1986         env->regwptr[UREG_I0] = sig;
1987         env->regwptr[UREG_I1] = sf_addr + 
1988                 offsetof(struct target_signal_frame, info);
1989         env->regwptr[UREG_I2] = sf_addr + 
1990                 offsetof(struct target_signal_frame, info);
1991
1992         /* 4. signal handler */
1993         env->pc = ka->_sa_handler;
1994         env->npc = (env->pc + 4);
1995         /* 5. return to kernel instructions */
1996         if (ka->sa_restorer)
1997                 env->regwptr[UREG_I7] = ka->sa_restorer;
1998         else {
1999                 uint32_t val32;
2000
2001                 env->regwptr[UREG_I7] = sf_addr + 
2002                         offsetof(struct target_signal_frame, insns) - 2 * 4;
2003
2004                 /* mov __NR_sigreturn, %g1 */
2005                 val32 = 0x821020d8;
2006                 err |= __put_user(val32, &sf->insns[0]);
2007
2008                 /* t 0x10 */
2009                 val32 = 0x91d02010;
2010                 err |= __put_user(val32, &sf->insns[1]);
2011                 if (err)
2012                         goto sigsegv;
2013
2014                 /* Flush instruction space. */
2015                 //flush_sig_insns(current->mm, (unsigned long) &(sf->insns[0]));
2016                 //              tb_flush(env);
2017         }
2018         unlock_user(sf, sf_addr, sizeof(struct target_signal_frame));
2019         return;
2020 #if 0
2021 sigill_and_return:
2022         force_sig(TARGET_SIGILL);
2023 #endif
2024 sigsegv:
2025         //fprintf(stderr, "force_sig\n");
2026         unlock_user(sf, sf_addr, sizeof(struct target_signal_frame));
2027         force_sig(TARGET_SIGSEGV);
2028 }
2029 static inline int
2030 restore_fpu_state(CPUState *env, qemu_siginfo_fpu_t *fpu)
2031 {
2032         int err;
2033 #if 0
2034 #ifdef CONFIG_SMP
2035         if (current->flags & PF_USEDFPU)
2036                 regs->psr &= ~PSR_EF;
2037 #else
2038         if (current == last_task_used_math) {
2039                 last_task_used_math = 0;
2040                 regs->psr &= ~PSR_EF;
2041         }
2042 #endif
2043         current->used_math = 1;
2044         current->flags &= ~PF_USEDFPU;
2045 #endif
2046 #if 0
2047         if (verify_area (VERIFY_READ, fpu, sizeof(*fpu)))
2048                 return -EFAULT;
2049 #endif
2050
2051 #if 0
2052         /* XXX: incorrect */
2053         err = __copy_from_user(&env->fpr[0], &fpu->si_float_regs[0],
2054                                      (sizeof(unsigned long) * 32));
2055 #endif
2056         err |= __get_user(env->fsr, &fpu->si_fsr);
2057 #if 0
2058         err |= __get_user(current->thread.fpqdepth, &fpu->si_fpqdepth);
2059         if (current->thread.fpqdepth != 0)
2060                 err |= __copy_from_user(&current->thread.fpqueue[0],
2061                                         &fpu->si_fpqueue[0],
2062                                         ((sizeof(unsigned long) +
2063                                         (sizeof(unsigned long *)))*16));
2064 #endif
2065         return err;
2066 }
2067
2068
2069 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2070                            target_siginfo_t *info,
2071                            target_sigset_t *set, CPUState *env)
2072 {
2073     fprintf(stderr, "setup_rt_frame: not implemented\n");
2074 }
2075
2076 long do_sigreturn(CPUState *env)
2077 {
2078         abi_ulong sf_addr;
2079         struct target_signal_frame *sf;
2080         uint32_t up_psr, pc, npc;
2081         target_sigset_t set;
2082         sigset_t host_set;
2083         int err, i;
2084
2085         sf_addr = env->regwptr[UREG_FP];
2086         if (!lock_user_struct(VERIFY_READ, sf, sf_addr, 1))
2087                 goto segv_and_exit;
2088 #if 0
2089         fprintf(stderr, "sigreturn\n");
2090         fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
2091 #endif
2092         //cpu_dump_state(env, stderr, fprintf, 0);
2093
2094         /* 1. Make sure we are not getting garbage from the user */
2095
2096         if (sf_addr & 3)
2097                 goto segv_and_exit;
2098
2099         err = __get_user(pc,  &sf->info.si_regs.pc);
2100         err |= __get_user(npc, &sf->info.si_regs.npc);
2101
2102         if ((pc | npc) & 3)
2103                 goto segv_and_exit;
2104
2105         /* 2. Restore the state */
2106         err |= __get_user(up_psr, &sf->info.si_regs.psr);
2107
2108         /* User can only change condition codes and FPU enabling in %psr. */
2109         env->psr = (up_psr & (PSR_ICC /* | PSR_EF */))
2110                   | (env->psr & ~(PSR_ICC /* | PSR_EF */));
2111
2112         env->pc = pc;
2113         env->npc = npc;
2114         err |= __get_user(env->y, &sf->info.si_regs.y);
2115         for (i=0; i < 8; i++) {
2116                 err |= __get_user(env->gregs[i], &sf->info.si_regs.u_regs[i]);
2117         }
2118         for (i=0; i < 8; i++) {
2119                 err |= __get_user(env->regwptr[i + UREG_I0], &sf->info.si_regs.u_regs[i+8]);
2120         }
2121
2122         /* FIXME: implement FPU save/restore:
2123          * __get_user(fpu_save, &sf->fpu_save);
2124          * if (fpu_save)
2125          *        err |= restore_fpu_state(env, fpu_save);
2126          */
2127
2128         /* This is pretty much atomic, no amount locking would prevent
2129          * the races which exist anyways.
2130          */
2131         err |= __get_user(set.sig[0], &sf->info.si_mask);
2132         for(i = 1; i < TARGET_NSIG_WORDS; i++) {
2133             err |= (__get_user(set.sig[i], &sf->extramask[i - 1]));
2134         }
2135
2136         target_to_host_sigset_internal(&host_set, &set);
2137         sigprocmask(SIG_SETMASK, &host_set, NULL);
2138
2139         if (err)
2140                 goto segv_and_exit;
2141         unlock_user_struct(sf, sf_addr, 0);
2142         return env->regwptr[0];
2143
2144 segv_and_exit:
2145         unlock_user_struct(sf, sf_addr, 0);
2146         force_sig(TARGET_SIGSEGV);
2147 }
2148
2149 long do_rt_sigreturn(CPUState *env)
2150 {
2151     fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2152     return -TARGET_ENOSYS;
2153 }
2154
2155 #if defined(TARGET_SPARC64) && !defined(TARGET_ABI32)
2156 #define MC_TSTATE 0
2157 #define MC_PC 1
2158 #define MC_NPC 2
2159 #define MC_Y 3
2160 #define MC_G1 4
2161 #define MC_G2 5
2162 #define MC_G3 6
2163 #define MC_G4 7
2164 #define MC_G5 8
2165 #define MC_G6 9
2166 #define MC_G7 10
2167 #define MC_O0 11
2168 #define MC_O1 12
2169 #define MC_O2 13
2170 #define MC_O3 14
2171 #define MC_O4 15
2172 #define MC_O5 16
2173 #define MC_O6 17
2174 #define MC_O7 18
2175 #define MC_NGREG 19
2176
2177 typedef abi_ulong target_mc_greg_t;
2178 typedef target_mc_greg_t target_mc_gregset_t[MC_NGREG];
2179
2180 struct target_mc_fq {
2181     abi_ulong *mcfq_addr;
2182     uint32_t mcfq_insn;
2183 };
2184
2185 struct target_mc_fpu {
2186     union {
2187         uint32_t sregs[32];
2188         uint64_t dregs[32];
2189         //uint128_t qregs[16];
2190     } mcfpu_fregs;
2191     abi_ulong mcfpu_fsr;
2192     abi_ulong mcfpu_fprs;
2193     abi_ulong mcfpu_gsr;
2194     struct target_mc_fq *mcfpu_fq;
2195     unsigned char mcfpu_qcnt;
2196     unsigned char mcfpu_qentsz;
2197     unsigned char mcfpu_enab;
2198 };
2199 typedef struct target_mc_fpu target_mc_fpu_t;
2200
2201 typedef struct {
2202     target_mc_gregset_t mc_gregs;
2203     target_mc_greg_t mc_fp;
2204     target_mc_greg_t mc_i7;
2205     target_mc_fpu_t mc_fpregs;
2206 } target_mcontext_t;
2207
2208 struct target_ucontext {
2209     struct target_ucontext *tuc_link;
2210     abi_ulong tuc_flags;
2211     target_sigset_t tuc_sigmask;
2212     target_mcontext_t tuc_mcontext;
2213 };
2214
2215 /* A V9 register window */
2216 struct target_reg_window {
2217     abi_ulong locals[8];
2218     abi_ulong ins[8];
2219 };
2220
2221 #define TARGET_STACK_BIAS 2047
2222
2223 /* {set, get}context() needed for 64-bit SparcLinux userland. */
2224 void sparc64_set_context(CPUSPARCState *env)
2225 {
2226     abi_ulong ucp_addr;
2227     struct target_ucontext *ucp;
2228     target_mc_gregset_t *grp;
2229     abi_ulong pc, npc, tstate;
2230     abi_ulong fp, i7, w_addr;
2231     int err;
2232     unsigned int i;
2233
2234     ucp_addr = env->regwptr[UREG_I0];
2235     if (!lock_user_struct(VERIFY_READ, ucp, ucp_addr, 1))
2236         goto do_sigsegv;
2237     grp  = &ucp->tuc_mcontext.mc_gregs;
2238     err  = __get_user(pc, &((*grp)[MC_PC]));
2239     err |= __get_user(npc, &((*grp)[MC_NPC]));
2240     if (err || ((pc | npc) & 3))
2241         goto do_sigsegv;
2242     if (env->regwptr[UREG_I1]) {
2243         target_sigset_t target_set;
2244         sigset_t set;
2245
2246         if (TARGET_NSIG_WORDS == 1) {
2247             if (__get_user(target_set.sig[0], &ucp->tuc_sigmask.sig[0]))
2248                 goto do_sigsegv;
2249         } else {
2250             abi_ulong *src, *dst;
2251             src = ucp->tuc_sigmask.sig;
2252             dst = target_set.sig;
2253             for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
2254                  i++, dst++, src++)
2255                 err |= __get_user(*dst, src);
2256             if (err)
2257                 goto do_sigsegv;
2258         }
2259         target_to_host_sigset_internal(&set, &target_set);
2260         sigprocmask(SIG_SETMASK, &set, NULL);
2261     }
2262     env->pc = pc;
2263     env->npc = npc;
2264     err |= __get_user(env->y, &((*grp)[MC_Y]));
2265     err |= __get_user(tstate, &((*grp)[MC_TSTATE]));
2266     env->asi = (tstate >> 24) & 0xff;
2267     cpu_put_ccr(env, tstate >> 32);
2268     cpu_put_cwp64(env, tstate & 0x1f);
2269     err |= __get_user(env->gregs[1], (&(*grp)[MC_G1]));
2270     err |= __get_user(env->gregs[2], (&(*grp)[MC_G2]));
2271     err |= __get_user(env->gregs[3], (&(*grp)[MC_G3]));
2272     err |= __get_user(env->gregs[4], (&(*grp)[MC_G4]));
2273     err |= __get_user(env->gregs[5], (&(*grp)[MC_G5]));
2274     err |= __get_user(env->gregs[6], (&(*grp)[MC_G6]));
2275     err |= __get_user(env->gregs[7], (&(*grp)[MC_G7]));
2276     err |= __get_user(env->regwptr[UREG_I0], (&(*grp)[MC_O0]));
2277     err |= __get_user(env->regwptr[UREG_I1], (&(*grp)[MC_O1]));
2278     err |= __get_user(env->regwptr[UREG_I2], (&(*grp)[MC_O2]));
2279     err |= __get_user(env->regwptr[UREG_I3], (&(*grp)[MC_O3]));
2280     err |= __get_user(env->regwptr[UREG_I4], (&(*grp)[MC_O4]));
2281     err |= __get_user(env->regwptr[UREG_I5], (&(*grp)[MC_O5]));
2282     err |= __get_user(env->regwptr[UREG_I6], (&(*grp)[MC_O6]));
2283     err |= __get_user(env->regwptr[UREG_I7], (&(*grp)[MC_O7]));
2284
2285     err |= __get_user(fp, &(ucp->tuc_mcontext.mc_fp));
2286     err |= __get_user(i7, &(ucp->tuc_mcontext.mc_i7));
2287
2288     w_addr = TARGET_STACK_BIAS+env->regwptr[UREG_I6];
2289     if (put_user(fp, w_addr + offsetof(struct target_reg_window, ins[6]), 
2290                  abi_ulong) != 0)
2291         goto do_sigsegv;
2292     if (put_user(i7, w_addr + offsetof(struct target_reg_window, ins[7]), 
2293                  abi_ulong) != 0)
2294         goto do_sigsegv;
2295     /* FIXME this does not match how the kernel handles the FPU in
2296      * its sparc64_set_context implementation. In particular the FPU
2297      * is only restored if fenab is non-zero in:
2298      *   __get_user(fenab, &(ucp->tuc_mcontext.mc_fpregs.mcfpu_enab));
2299      */
2300     err |= __get_user(env->fprs, &(ucp->tuc_mcontext.mc_fpregs.mcfpu_fprs));
2301     {
2302         uint32_t *src, *dst;
2303         src = ucp->tuc_mcontext.mc_fpregs.mcfpu_fregs.sregs;
2304         dst = env->fpr;
2305         /* XXX: check that the CPU storage is the same as user context */
2306         for (i = 0; i < 64; i++, dst++, src++)
2307             err |= __get_user(*dst, src);
2308     }
2309     err |= __get_user(env->fsr,
2310                       &(ucp->tuc_mcontext.mc_fpregs.mcfpu_fsr));
2311     err |= __get_user(env->gsr,
2312                       &(ucp->tuc_mcontext.mc_fpregs.mcfpu_gsr));
2313     if (err)
2314         goto do_sigsegv;
2315     unlock_user_struct(ucp, ucp_addr, 0);
2316     return;
2317  do_sigsegv:
2318     unlock_user_struct(ucp, ucp_addr, 0);
2319     force_sig(TARGET_SIGSEGV);
2320 }
2321
2322 void sparc64_get_context(CPUSPARCState *env)
2323 {
2324     abi_ulong ucp_addr;
2325     struct target_ucontext *ucp;
2326     target_mc_gregset_t *grp;
2327     target_mcontext_t *mcp;
2328     abi_ulong fp, i7, w_addr;
2329     int err;
2330     unsigned int i;
2331     target_sigset_t target_set;
2332     sigset_t set;
2333
2334     ucp_addr = env->regwptr[UREG_I0];
2335     if (!lock_user_struct(VERIFY_WRITE, ucp, ucp_addr, 0))
2336         goto do_sigsegv;
2337     
2338     mcp = &ucp->tuc_mcontext;
2339     grp = &mcp->mc_gregs;
2340
2341     /* Skip over the trap instruction, first. */
2342     env->pc = env->npc;
2343     env->npc += 4;
2344
2345     err = 0;
2346
2347     sigprocmask(0, NULL, &set);
2348     host_to_target_sigset_internal(&target_set, &set);
2349     if (TARGET_NSIG_WORDS == 1) {
2350         err |= __put_user(target_set.sig[0],
2351                           (abi_ulong *)&ucp->tuc_sigmask);
2352     } else {
2353         abi_ulong *src, *dst;
2354         src = target_set.sig;
2355         dst = ucp->tuc_sigmask.sig;
2356         for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
2357              i++, dst++, src++)
2358             err |= __put_user(*src, dst);
2359         if (err)
2360             goto do_sigsegv;
2361     }
2362
2363     /* XXX: tstate must be saved properly */
2364     //    err |= __put_user(env->tstate, &((*grp)[MC_TSTATE]));
2365     err |= __put_user(env->pc, &((*grp)[MC_PC]));
2366     err |= __put_user(env->npc, &((*grp)[MC_NPC]));
2367     err |= __put_user(env->y, &((*grp)[MC_Y]));
2368     err |= __put_user(env->gregs[1], &((*grp)[MC_G1]));
2369     err |= __put_user(env->gregs[2], &((*grp)[MC_G2]));
2370     err |= __put_user(env->gregs[3], &((*grp)[MC_G3]));
2371     err |= __put_user(env->gregs[4], &((*grp)[MC_G4]));
2372     err |= __put_user(env->gregs[5], &((*grp)[MC_G5]));
2373     err |= __put_user(env->gregs[6], &((*grp)[MC_G6]));
2374     err |= __put_user(env->gregs[7], &((*grp)[MC_G7]));
2375     err |= __put_user(env->regwptr[UREG_I0], &((*grp)[MC_O0]));
2376     err |= __put_user(env->regwptr[UREG_I1], &((*grp)[MC_O1]));
2377     err |= __put_user(env->regwptr[UREG_I2], &((*grp)[MC_O2]));
2378     err |= __put_user(env->regwptr[UREG_I3], &((*grp)[MC_O3]));
2379     err |= __put_user(env->regwptr[UREG_I4], &((*grp)[MC_O4]));
2380     err |= __put_user(env->regwptr[UREG_I5], &((*grp)[MC_O5]));
2381     err |= __put_user(env->regwptr[UREG_I6], &((*grp)[MC_O6]));
2382     err |= __put_user(env->regwptr[UREG_I7], &((*grp)[MC_O7]));
2383
2384     w_addr = TARGET_STACK_BIAS+env->regwptr[UREG_I6];
2385     fp = i7 = 0;
2386     if (get_user(fp, w_addr + offsetof(struct target_reg_window, ins[6]), 
2387                  abi_ulong) != 0)
2388         goto do_sigsegv;
2389     if (get_user(i7, w_addr + offsetof(struct target_reg_window, ins[7]), 
2390                  abi_ulong) != 0)
2391         goto do_sigsegv;
2392     err |= __put_user(fp, &(mcp->mc_fp));
2393     err |= __put_user(i7, &(mcp->mc_i7));
2394
2395     {
2396         uint32_t *src, *dst;
2397         src = env->fpr;
2398         dst = ucp->tuc_mcontext.mc_fpregs.mcfpu_fregs.sregs;
2399         /* XXX: check that the CPU storage is the same as user context */
2400         for (i = 0; i < 64; i++, dst++, src++)
2401             err |= __put_user(*src, dst);
2402     }
2403     err |= __put_user(env->fsr, &(mcp->mc_fpregs.mcfpu_fsr));
2404     err |= __put_user(env->gsr, &(mcp->mc_fpregs.mcfpu_gsr));
2405     err |= __put_user(env->fprs, &(mcp->mc_fpregs.mcfpu_fprs));
2406
2407     if (err)
2408         goto do_sigsegv;
2409     unlock_user_struct(ucp, ucp_addr, 1);
2410     return;
2411  do_sigsegv:
2412     unlock_user_struct(ucp, ucp_addr, 1);
2413     force_sig(TARGET_SIGSEGV);
2414 }
2415 #endif
2416 #elif defined(TARGET_ABI_MIPSN64)
2417
2418 # warning signal handling not implemented
2419
2420 static void setup_frame(int sig, struct target_sigaction *ka,
2421                         target_sigset_t *set, CPUState *env)
2422 {
2423     fprintf(stderr, "setup_frame: not implemented\n");
2424 }
2425
2426 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2427                            target_siginfo_t *info,
2428                            target_sigset_t *set, CPUState *env)
2429 {
2430     fprintf(stderr, "setup_rt_frame: not implemented\n");
2431 }
2432
2433 long do_sigreturn(CPUState *env)
2434 {
2435     fprintf(stderr, "do_sigreturn: not implemented\n");
2436     return -TARGET_ENOSYS;
2437 }
2438
2439 long do_rt_sigreturn(CPUState *env)
2440 {
2441     fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2442     return -TARGET_ENOSYS;
2443 }
2444
2445 #elif defined(TARGET_ABI_MIPSN32)
2446
2447 # warning signal handling not implemented
2448
2449 static void setup_frame(int sig, struct target_sigaction *ka,
2450                         target_sigset_t *set, CPUState *env)
2451 {
2452     fprintf(stderr, "setup_frame: not implemented\n");
2453 }
2454
2455 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2456                            target_siginfo_t *info,
2457                            target_sigset_t *set, CPUState *env)
2458 {
2459     fprintf(stderr, "setup_rt_frame: not implemented\n");
2460 }
2461
2462 long do_sigreturn(CPUState *env)
2463 {
2464     fprintf(stderr, "do_sigreturn: not implemented\n");
2465     return -TARGET_ENOSYS;
2466 }
2467
2468 long do_rt_sigreturn(CPUState *env)
2469 {
2470     fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2471     return -TARGET_ENOSYS;
2472 }
2473
2474 #elif defined(TARGET_ABI_MIPSO32)
2475
2476 struct target_sigcontext {
2477     uint32_t   sc_regmask;     /* Unused */
2478     uint32_t   sc_status;
2479     uint64_t   sc_pc;
2480     uint64_t   sc_regs[32];
2481     uint64_t   sc_fpregs[32];
2482     uint32_t   sc_ownedfp;     /* Unused */
2483     uint32_t   sc_fpc_csr;
2484     uint32_t   sc_fpc_eir;     /* Unused */
2485     uint32_t   sc_used_math;
2486     uint32_t   sc_dsp;         /* dsp status, was sc_ssflags */
2487     uint32_t   pad0;
2488     uint64_t   sc_mdhi;
2489     uint64_t   sc_mdlo;
2490     target_ulong   sc_hi1;         /* Was sc_cause */
2491     target_ulong   sc_lo1;         /* Was sc_badvaddr */
2492     target_ulong   sc_hi2;         /* Was sc_sigset[4] */
2493     target_ulong   sc_lo2;
2494     target_ulong   sc_hi3;
2495     target_ulong   sc_lo3;
2496 };
2497
2498 struct sigframe {
2499     uint32_t sf_ass[4];                 /* argument save space for o32 */
2500     uint32_t sf_code[2];                        /* signal trampoline */
2501     struct target_sigcontext sf_sc;
2502     target_sigset_t sf_mask;
2503 };
2504
2505 struct target_ucontext {
2506     target_ulong tuc_flags;
2507     target_ulong tuc_link;
2508     target_stack_t tuc_stack;
2509     target_ulong pad0;
2510     struct target_sigcontext tuc_mcontext;
2511     target_sigset_t tuc_sigmask;
2512 };
2513
2514 struct target_rt_sigframe {
2515     uint32_t rs_ass[4];               /* argument save space for o32 */
2516     uint32_t rs_code[2];              /* signal trampoline */
2517     struct target_siginfo rs_info;
2518     struct target_ucontext rs_uc;
2519 };
2520
2521 /* Install trampoline to jump back from signal handler */
2522 static inline int install_sigtramp(unsigned int *tramp,   unsigned int syscall)
2523 {
2524     int err;
2525
2526     /*
2527     * Set up the return code ...
2528     *
2529     *         li      v0, __NR__foo_sigreturn
2530     *         syscall
2531     */
2532
2533     err = __put_user(0x24020000 + syscall, tramp + 0);
2534     err |= __put_user(0x0000000c          , tramp + 1);
2535     /* flush_cache_sigtramp((unsigned long) tramp); */
2536     return err;
2537 }
2538
2539 static inline int
2540 setup_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2541 {
2542     int err = 0;
2543
2544     err |= __put_user(regs->active_tc.PC, &sc->sc_pc);
2545
2546 #define save_gp_reg(i) do {                                             \
2547         err |= __put_user(regs->active_tc.gpr[i], &sc->sc_regs[i]);     \
2548     } while(0)
2549     __put_user(0, &sc->sc_regs[0]); save_gp_reg(1); save_gp_reg(2);
2550     save_gp_reg(3); save_gp_reg(4); save_gp_reg(5); save_gp_reg(6);
2551     save_gp_reg(7); save_gp_reg(8); save_gp_reg(9); save_gp_reg(10);
2552     save_gp_reg(11); save_gp_reg(12); save_gp_reg(13); save_gp_reg(14);
2553     save_gp_reg(15); save_gp_reg(16); save_gp_reg(17); save_gp_reg(18);
2554     save_gp_reg(19); save_gp_reg(20); save_gp_reg(21); save_gp_reg(22);
2555     save_gp_reg(23); save_gp_reg(24); save_gp_reg(25); save_gp_reg(26);
2556     save_gp_reg(27); save_gp_reg(28); save_gp_reg(29); save_gp_reg(30);
2557     save_gp_reg(31);
2558 #undef save_gp_reg
2559
2560     err |= __put_user(regs->active_tc.HI[0], &sc->sc_mdhi);
2561     err |= __put_user(regs->active_tc.LO[0], &sc->sc_mdlo);
2562
2563     /* Not used yet, but might be useful if we ever have DSP suppport */
2564 #if 0
2565     if (cpu_has_dsp) {
2566         err |= __put_user(mfhi1(), &sc->sc_hi1);
2567         err |= __put_user(mflo1(), &sc->sc_lo1);
2568         err |= __put_user(mfhi2(), &sc->sc_hi2);
2569         err |= __put_user(mflo2(), &sc->sc_lo2);
2570         err |= __put_user(mfhi3(), &sc->sc_hi3);
2571         err |= __put_user(mflo3(), &sc->sc_lo3);
2572         err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2573     }
2574     /* same with 64 bit */
2575 #ifdef CONFIG_64BIT
2576     err |= __put_user(regs->hi, &sc->sc_hi[0]);
2577     err |= __put_user(regs->lo, &sc->sc_lo[0]);
2578     if (cpu_has_dsp) {
2579         err |= __put_user(mfhi1(), &sc->sc_hi[1]);
2580         err |= __put_user(mflo1(), &sc->sc_lo[1]);
2581         err |= __put_user(mfhi2(), &sc->sc_hi[2]);
2582         err |= __put_user(mflo2(), &sc->sc_lo[2]);
2583         err |= __put_user(mfhi3(), &sc->sc_hi[3]);
2584         err |= __put_user(mflo3(), &sc->sc_lo[3]);
2585         err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2586     }
2587 #endif
2588 #endif
2589
2590 #if 0
2591     err |= __put_user(!!used_math(), &sc->sc_used_math);
2592
2593     if (!used_math())
2594         goto out;
2595
2596     /*
2597     * Save FPU state to signal context.  Signal handler will "inherit"
2598     * current FPU state.
2599     */
2600     preempt_disable();
2601
2602     if (!is_fpu_owner()) {
2603         own_fpu();
2604         restore_fp(current);
2605     }
2606     err |= save_fp_context(sc);
2607
2608     preempt_enable();
2609     out:
2610 #endif
2611     return err;
2612 }
2613
2614 static inline int
2615 restore_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2616 {
2617     int err = 0;
2618
2619     err |= __get_user(regs->CP0_EPC, &sc->sc_pc);
2620
2621     err |= __get_user(regs->active_tc.HI[0], &sc->sc_mdhi);
2622     err |= __get_user(regs->active_tc.LO[0], &sc->sc_mdlo);
2623
2624 #define restore_gp_reg(i) do {                                                          \
2625         err |= __get_user(regs->active_tc.gpr[i], &sc->sc_regs[i]);             \
2626     } while(0)
2627     restore_gp_reg( 1); restore_gp_reg( 2); restore_gp_reg( 3);
2628     restore_gp_reg( 4); restore_gp_reg( 5); restore_gp_reg( 6);
2629     restore_gp_reg( 7); restore_gp_reg( 8); restore_gp_reg( 9);
2630     restore_gp_reg(10); restore_gp_reg(11); restore_gp_reg(12);
2631     restore_gp_reg(13); restore_gp_reg(14); restore_gp_reg(15);
2632     restore_gp_reg(16); restore_gp_reg(17); restore_gp_reg(18);
2633     restore_gp_reg(19); restore_gp_reg(20); restore_gp_reg(21);
2634     restore_gp_reg(22); restore_gp_reg(23); restore_gp_reg(24);
2635     restore_gp_reg(25); restore_gp_reg(26); restore_gp_reg(27);
2636     restore_gp_reg(28); restore_gp_reg(29); restore_gp_reg(30);
2637     restore_gp_reg(31);
2638 #undef restore_gp_reg
2639
2640 #if 0
2641     if (cpu_has_dsp) {
2642         err |= __get_user(treg, &sc->sc_hi1); mthi1(treg);
2643         err |= __get_user(treg, &sc->sc_lo1); mtlo1(treg);
2644         err |= __get_user(treg, &sc->sc_hi2); mthi2(treg);
2645         err |= __get_user(treg, &sc->sc_lo2); mtlo2(treg);
2646         err |= __get_user(treg, &sc->sc_hi3); mthi3(treg);
2647         err |= __get_user(treg, &sc->sc_lo3); mtlo3(treg);
2648         err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2649     }
2650 #ifdef CONFIG_64BIT
2651     err |= __get_user(regs->hi, &sc->sc_hi[0]);
2652     err |= __get_user(regs->lo, &sc->sc_lo[0]);
2653     if (cpu_has_dsp) {
2654         err |= __get_user(treg, &sc->sc_hi[1]); mthi1(treg);
2655         err |= __get_user(treg, &sc->sc_lo[1]); mthi1(treg);
2656         err |= __get_user(treg, &sc->sc_hi[2]); mthi2(treg);
2657         err |= __get_user(treg, &sc->sc_lo[2]); mthi2(treg);
2658         err |= __get_user(treg, &sc->sc_hi[3]); mthi3(treg);
2659         err |= __get_user(treg, &sc->sc_lo[3]); mthi3(treg);
2660         err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2661     }
2662 #endif
2663
2664     err |= __get_user(used_math, &sc->sc_used_math);
2665     conditional_used_math(used_math);
2666
2667     preempt_disable();
2668
2669     if (used_math()) {
2670         /* restore fpu context if we have used it before */
2671         own_fpu();
2672         err |= restore_fp_context(sc);
2673     } else {
2674         /* signal handler may have used FPU.  Give it up. */
2675         lose_fpu();
2676     }
2677
2678     preempt_enable();
2679 #endif
2680     return err;
2681 }
2682 /*
2683  * Determine which stack to use..
2684  */
2685 static inline abi_ulong
2686 get_sigframe(struct target_sigaction *ka, CPUState *regs, size_t frame_size)
2687 {
2688     unsigned long sp;
2689
2690     /* Default to using normal stack */
2691     sp = regs->active_tc.gpr[29];
2692
2693     /*
2694      * FPU emulator may have it's own trampoline active just
2695      * above the user stack, 16-bytes before the next lowest
2696      * 16 byte boundary.  Try to avoid trashing it.
2697      */
2698     sp -= 32;
2699
2700     /* This is the X/Open sanctioned signal stack switching.  */
2701     if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
2702         sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
2703     }
2704
2705     return (sp - frame_size) & ~7;
2706 }
2707
2708 /* compare linux/arch/mips/kernel/signal.c:setup_frame() */
2709 static void setup_frame(int sig, struct target_sigaction * ka,
2710                         target_sigset_t *set, CPUState *regs)
2711 {
2712     struct sigframe *frame;
2713     abi_ulong frame_addr;
2714     int i;
2715
2716     frame_addr = get_sigframe(ka, regs, sizeof(*frame));
2717     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
2718         goto give_sigsegv;
2719
2720     install_sigtramp(frame->sf_code, TARGET_NR_sigreturn);
2721
2722     if(setup_sigcontext(regs, &frame->sf_sc))
2723         goto give_sigsegv;
2724
2725     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2726         if(__put_user(set->sig[i], &frame->sf_mask.sig[i]))
2727             goto give_sigsegv;
2728     }
2729
2730     /*
2731     * Arguments to signal handler:
2732     *
2733     *   a0 = signal number
2734     *   a1 = 0 (should be cause)
2735     *   a2 = pointer to struct sigcontext
2736     *
2737     * $25 and PC point to the signal handler, $29 points to the
2738     * struct sigframe.
2739     */
2740     regs->active_tc.gpr[ 4] = sig;
2741     regs->active_tc.gpr[ 5] = 0;
2742     regs->active_tc.gpr[ 6] = frame_addr + offsetof(struct sigframe, sf_sc);
2743     regs->active_tc.gpr[29] = frame_addr;
2744     regs->active_tc.gpr[31] = frame_addr + offsetof(struct sigframe, sf_code);
2745     /* The original kernel code sets CP0_EPC to the handler
2746     * since it returns to userland using eret
2747     * we cannot do this here, and we must set PC directly */
2748     regs->active_tc.PC = regs->active_tc.gpr[25] = ka->_sa_handler;
2749     unlock_user_struct(frame, frame_addr, 1);
2750     return;
2751
2752 give_sigsegv:
2753     unlock_user_struct(frame, frame_addr, 1);
2754     force_sig(TARGET_SIGSEGV/*, current*/);
2755     return;
2756 }
2757
2758 long do_sigreturn(CPUState *regs)
2759 {
2760     struct sigframe *frame;
2761     abi_ulong frame_addr;
2762     sigset_t blocked;
2763     target_sigset_t target_set;
2764     int i;
2765
2766 #if defined(DEBUG_SIGNAL)
2767     fprintf(stderr, "do_sigreturn\n");
2768 #endif
2769     frame_addr = regs->active_tc.gpr[29];
2770     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
2771         goto badframe;
2772
2773     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2774         if(__get_user(target_set.sig[i], &frame->sf_mask.sig[i]))
2775             goto badframe;
2776     }
2777
2778     target_to_host_sigset_internal(&blocked, &target_set);
2779     sigprocmask(SIG_SETMASK, &blocked, NULL);
2780
2781     if (restore_sigcontext(regs, &frame->sf_sc))
2782         goto badframe;
2783
2784 #if 0
2785     /*
2786      * Don't let your children do this ...
2787      */
2788     __asm__ __volatile__(
2789         "move\t$29, %0\n\t"
2790         "j\tsyscall_exit"
2791         :/* no outputs */
2792         :"r" (&regs));
2793     /* Unreached */
2794 #endif
2795
2796     regs->active_tc.PC = regs->CP0_EPC;
2797     /* I am not sure this is right, but it seems to work
2798     * maybe a problem with nested signals ? */
2799     regs->CP0_EPC = 0;
2800     return -TARGET_QEMU_ESIGRETURN;
2801
2802 badframe:
2803     force_sig(TARGET_SIGSEGV/*, current*/);
2804     return 0;
2805 }
2806
2807 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2808                            target_siginfo_t *info,
2809                            target_sigset_t *set, CPUState *env)
2810 {
2811     struct target_rt_sigframe *frame;
2812     abi_ulong frame_addr;
2813     int i;
2814
2815     frame_addr = get_sigframe(ka, env, sizeof(*frame));
2816     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
2817         goto give_sigsegv;
2818
2819     install_sigtramp(frame->rs_code, TARGET_NR_rt_sigreturn);
2820
2821     copy_siginfo_to_user(&frame->rs_info, info);
2822
2823     __put_user(0, &frame->rs_uc.tuc_flags);
2824     __put_user(0, &frame->rs_uc.tuc_link);
2825     __put_user(target_sigaltstack_used.ss_sp, &frame->rs_uc.tuc_stack.ss_sp);
2826     __put_user(target_sigaltstack_used.ss_size, &frame->rs_uc.tuc_stack.ss_size);
2827     __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
2828                &frame->rs_uc.tuc_stack.ss_flags);
2829
2830     setup_sigcontext(env, &frame->rs_uc.tuc_mcontext);
2831
2832     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2833         __put_user(set->sig[i], &frame->rs_uc.tuc_sigmask.sig[i]);
2834     }
2835
2836     /*
2837     * Arguments to signal handler:
2838     *
2839     *   a0 = signal number
2840     *   a1 = pointer to struct siginfo
2841     *   a2 = pointer to struct ucontext
2842     *
2843     * $25 and PC point to the signal handler, $29 points to the
2844     * struct sigframe.
2845     */
2846     env->active_tc.gpr[ 4] = sig;
2847     env->active_tc.gpr[ 5] = frame_addr
2848                              + offsetof(struct target_rt_sigframe, rs_info);
2849     env->active_tc.gpr[ 6] = frame_addr
2850                              + offsetof(struct target_rt_sigframe, rs_uc);
2851     env->active_tc.gpr[29] = frame_addr;
2852     env->active_tc.gpr[31] = frame_addr
2853                              + offsetof(struct target_rt_sigframe, rs_code);
2854     /* The original kernel code sets CP0_EPC to the handler
2855     * since it returns to userland using eret
2856     * we cannot do this here, and we must set PC directly */
2857     env->active_tc.PC = env->active_tc.gpr[25] = ka->_sa_handler;
2858     unlock_user_struct(frame, frame_addr, 1);
2859     return;
2860
2861 give_sigsegv:
2862     unlock_user_struct(frame, frame_addr, 1);
2863     force_sig(TARGET_SIGSEGV/*, current*/);
2864     return;
2865 }
2866
2867 long do_rt_sigreturn(CPUState *env)
2868 {
2869     struct target_rt_sigframe *frame;
2870     abi_ulong frame_addr;
2871     sigset_t blocked;
2872
2873 #if defined(DEBUG_SIGNAL)
2874     fprintf(stderr, "do_rt_sigreturn\n");
2875 #endif
2876     frame_addr = env->active_tc.gpr[29];
2877     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
2878         goto badframe;
2879
2880     target_to_host_sigset(&blocked, &frame->rs_uc.tuc_sigmask);
2881     sigprocmask(SIG_SETMASK, &blocked, NULL);
2882
2883     if (restore_sigcontext(env, &frame->rs_uc.tuc_mcontext))
2884         goto badframe;
2885
2886     if (do_sigaltstack(frame_addr +
2887                        offsetof(struct target_rt_sigframe, rs_uc.tuc_stack),
2888                        0, get_sp_from_cpustate(env)) == -EFAULT)
2889         goto badframe;
2890
2891     env->active_tc.PC = env->CP0_EPC;
2892     /* I am not sure this is right, but it seems to work
2893     * maybe a problem with nested signals ? */
2894     env->CP0_EPC = 0;
2895     return -TARGET_QEMU_ESIGRETURN;
2896
2897 badframe:
2898     force_sig(TARGET_SIGSEGV/*, current*/);
2899     return 0;
2900 }
2901
2902 #elif defined(TARGET_SH4)
2903
2904 /*
2905  * code and data structures from linux kernel:
2906  * include/asm-sh/sigcontext.h
2907  * arch/sh/kernel/signal.c
2908  */
2909
2910 struct target_sigcontext {
2911     target_ulong  oldmask;
2912
2913     /* CPU registers */
2914     target_ulong  sc_gregs[16];
2915     target_ulong  sc_pc;
2916     target_ulong  sc_pr;
2917     target_ulong  sc_sr;
2918     target_ulong  sc_gbr;
2919     target_ulong  sc_mach;
2920     target_ulong  sc_macl;
2921
2922     /* FPU registers */
2923     target_ulong  sc_fpregs[16];
2924     target_ulong  sc_xfpregs[16];
2925     unsigned int sc_fpscr;
2926     unsigned int sc_fpul;
2927     unsigned int sc_ownedfp;
2928 };
2929
2930 struct target_sigframe
2931 {
2932     struct target_sigcontext sc;
2933     target_ulong extramask[TARGET_NSIG_WORDS-1];
2934     uint16_t retcode[3];
2935 };
2936
2937
2938 struct target_ucontext {
2939     target_ulong tuc_flags;
2940     struct target_ucontext *tuc_link;
2941     target_stack_t tuc_stack;
2942     struct target_sigcontext tuc_mcontext;
2943     target_sigset_t tuc_sigmask;        /* mask last for extensibility */
2944 };
2945
2946 struct target_rt_sigframe
2947 {
2948     struct target_siginfo info;
2949     struct target_ucontext uc;
2950     uint16_t retcode[3];
2951 };
2952
2953
2954 #define MOVW(n)  (0x9300|((n)-2)) /* Move mem word at PC+n to R3 */
2955 #define TRAP_NOARG 0xc310         /* Syscall w/no args (NR in R3) SH3/4 */
2956
2957 static abi_ulong get_sigframe(struct target_sigaction *ka,
2958                          unsigned long sp, size_t frame_size)
2959 {
2960     if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags(sp) == 0)) {
2961         sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
2962     }
2963
2964     return (sp - frame_size) & -8ul;
2965 }
2966
2967 static int setup_sigcontext(struct target_sigcontext *sc,
2968                             CPUState *regs, unsigned long mask)
2969 {
2970     int err = 0;
2971     int i;
2972
2973 #define COPY(x)         err |= __put_user(regs->x, &sc->sc_##x)
2974     COPY(gregs[0]); COPY(gregs[1]);
2975     COPY(gregs[2]); COPY(gregs[3]);
2976     COPY(gregs[4]); COPY(gregs[5]);
2977     COPY(gregs[6]); COPY(gregs[7]);
2978     COPY(gregs[8]); COPY(gregs[9]);
2979     COPY(gregs[10]); COPY(gregs[11]);
2980     COPY(gregs[12]); COPY(gregs[13]);
2981     COPY(gregs[14]); COPY(gregs[15]);
2982     COPY(gbr); COPY(mach);
2983     COPY(macl); COPY(pr);
2984     COPY(sr); COPY(pc);
2985 #undef COPY
2986
2987     for (i=0; i<16; i++) {
2988         err |= __put_user(regs->fregs[i], &sc->sc_fpregs[i]);
2989     }
2990     err |= __put_user(regs->fpscr, &sc->sc_fpscr);
2991     err |= __put_user(regs->fpul, &sc->sc_fpul);
2992
2993     /* non-iBCS2 extensions.. */
2994     err |= __put_user(mask, &sc->oldmask);
2995
2996     return err;
2997 }
2998
2999 static int restore_sigcontext(CPUState *regs, struct target_sigcontext *sc,
3000                               target_ulong *r0_p)
3001 {
3002     unsigned int err = 0;
3003     int i;
3004
3005 #define COPY(x)         err |= __get_user(regs->x, &sc->sc_##x)
3006     COPY(gregs[1]);
3007     COPY(gregs[2]); COPY(gregs[3]);
3008     COPY(gregs[4]); COPY(gregs[5]);
3009     COPY(gregs[6]); COPY(gregs[7]);
3010     COPY(gregs[8]); COPY(gregs[9]);
3011     COPY(gregs[10]); COPY(gregs[11]);
3012     COPY(gregs[12]); COPY(gregs[13]);
3013     COPY(gregs[14]); COPY(gregs[15]);
3014     COPY(gbr); COPY(mach);
3015     COPY(macl); COPY(pr);
3016     COPY(sr); COPY(pc);
3017 #undef COPY
3018
3019     for (i=0; i<16; i++) {
3020         err |= __get_user(regs->fregs[i], &sc->sc_fpregs[i]);
3021     }
3022     err |= __get_user(regs->fpscr, &sc->sc_fpscr);
3023     err |= __get_user(regs->fpul, &sc->sc_fpul);
3024
3025     regs->tra = -1;         /* disable syscall checks */
3026     err |= __get_user(*r0_p, &sc->sc_gregs[0]);
3027     return err;
3028 }
3029
3030 static void setup_frame(int sig, struct target_sigaction *ka,
3031                         target_sigset_t *set, CPUState *regs)
3032 {
3033     struct target_sigframe *frame;
3034     abi_ulong frame_addr;
3035     int i;
3036     int err = 0;
3037     int signal;
3038
3039     frame_addr = get_sigframe(ka, regs->gregs[15], sizeof(*frame));
3040     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
3041         goto give_sigsegv;
3042
3043     signal = current_exec_domain_sig(sig);
3044
3045     err |= setup_sigcontext(&frame->sc, regs, set->sig[0]);
3046
3047     for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
3048         err |= __put_user(set->sig[i + 1], &frame->extramask[i]);
3049     }
3050
3051     /* Set up to return from userspace.  If provided, use a stub
3052        already in userspace.  */
3053     if (ka->sa_flags & TARGET_SA_RESTORER) {
3054         regs->pr = (unsigned long) ka->sa_restorer;
3055     } else {
3056         /* Generate return code (system call to sigreturn) */
3057         err |= __put_user(MOVW(2), &frame->retcode[0]);
3058         err |= __put_user(TRAP_NOARG, &frame->retcode[1]);
3059         err |= __put_user((TARGET_NR_sigreturn), &frame->retcode[2]);
3060         regs->pr = (unsigned long) frame->retcode;
3061     }
3062
3063     if (err)
3064         goto give_sigsegv;
3065
3066     /* Set up registers for signal handler */
3067     regs->gregs[15] = (unsigned long) frame;
3068     regs->gregs[4] = signal; /* Arg for signal handler */
3069     regs->gregs[5] = 0;
3070     regs->gregs[6] = (unsigned long) &frame->sc;
3071     regs->pc = (unsigned long) ka->_sa_handler;
3072
3073     unlock_user_struct(frame, frame_addr, 1);
3074     return;
3075
3076 give_sigsegv:
3077     unlock_user_struct(frame, frame_addr, 1);
3078     force_sig(TARGET_SIGSEGV);
3079 }
3080
3081 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3082                            target_siginfo_t *info,
3083                            target_sigset_t *set, CPUState *regs)
3084 {
3085     struct target_rt_sigframe *frame;
3086     abi_ulong frame_addr;
3087     int i;
3088     int err = 0;
3089     int signal;
3090
3091     frame_addr = get_sigframe(ka, regs->gregs[15], sizeof(*frame));
3092     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
3093         goto give_sigsegv;
3094
3095     signal = current_exec_domain_sig(sig);
3096
3097     err |= copy_siginfo_to_user(&frame->info, info);
3098
3099     /* Create the ucontext.  */
3100     err |= __put_user(0, &frame->uc.tuc_flags);
3101     err |= __put_user(0, (unsigned long *)&frame->uc.tuc_link);
3102     err |= __put_user((unsigned long)target_sigaltstack_used.ss_sp,
3103                       &frame->uc.tuc_stack.ss_sp);
3104     err |= __put_user(sas_ss_flags(regs->gregs[15]),
3105                       &frame->uc.tuc_stack.ss_flags);
3106     err |= __put_user(target_sigaltstack_used.ss_size,
3107                       &frame->uc.tuc_stack.ss_size);
3108     err |= setup_sigcontext(&frame->uc.tuc_mcontext,
3109                             regs, set->sig[0]);
3110     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
3111         err |= __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
3112     }
3113
3114     /* Set up to return from userspace.  If provided, use a stub
3115        already in userspace.  */
3116     if (ka->sa_flags & TARGET_SA_RESTORER) {
3117         regs->pr = (unsigned long) ka->sa_restorer;
3118     } else {
3119         /* Generate return code (system call to sigreturn) */
3120         err |= __put_user(MOVW(2), &frame->retcode[0]);
3121         err |= __put_user(TRAP_NOARG, &frame->retcode[1]);
3122         err |= __put_user((TARGET_NR_rt_sigreturn), &frame->retcode[2]);
3123         regs->pr = (unsigned long) frame->retcode;
3124     }
3125
3126     if (err)
3127         goto give_sigsegv;
3128
3129     /* Set up registers for signal handler */
3130     regs->gregs[15] = (unsigned long) frame;
3131     regs->gregs[4] = signal; /* Arg for signal handler */
3132     regs->gregs[5] = (unsigned long) &frame->info;
3133     regs->gregs[6] = (unsigned long) &frame->uc;
3134     regs->pc = (unsigned long) ka->_sa_handler;
3135
3136     unlock_user_struct(frame, frame_addr, 1);
3137     return;
3138
3139 give_sigsegv:
3140     unlock_user_struct(frame, frame_addr, 1);
3141     force_sig(TARGET_SIGSEGV);
3142 }
3143
3144 long do_sigreturn(CPUState *regs)
3145 {
3146     struct target_sigframe *frame;
3147     abi_ulong frame_addr;
3148     sigset_t blocked;
3149     target_sigset_t target_set;
3150     target_ulong r0;
3151     int i;
3152     int err = 0;
3153
3154 #if defined(DEBUG_SIGNAL)
3155     fprintf(stderr, "do_sigreturn\n");
3156 #endif
3157     frame_addr = regs->gregs[15];
3158     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
3159         goto badframe;
3160
3161     err |= __get_user(target_set.sig[0], &frame->sc.oldmask);
3162     for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3163         err |= (__get_user(target_set.sig[i], &frame->extramask[i - 1]));
3164     }
3165
3166     if (err)
3167         goto badframe;
3168
3169     target_to_host_sigset_internal(&blocked, &target_set);
3170     sigprocmask(SIG_SETMASK, &blocked, NULL);
3171
3172     if (restore_sigcontext(regs, &frame->sc, &r0))
3173         goto badframe;
3174
3175     unlock_user_struct(frame, frame_addr, 0);
3176     return r0;
3177
3178 badframe:
3179     unlock_user_struct(frame, frame_addr, 0);
3180     force_sig(TARGET_SIGSEGV);
3181     return 0;
3182 }
3183
3184 long do_rt_sigreturn(CPUState *regs)
3185 {
3186     struct target_rt_sigframe *frame;
3187     abi_ulong frame_addr;
3188     sigset_t blocked;
3189     target_ulong r0;
3190
3191 #if defined(DEBUG_SIGNAL)
3192     fprintf(stderr, "do_rt_sigreturn\n");
3193 #endif
3194     frame_addr = regs->gregs[15];
3195     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
3196         goto badframe;
3197
3198     target_to_host_sigset(&blocked, &frame->uc.tuc_sigmask);
3199     sigprocmask(SIG_SETMASK, &blocked, NULL);
3200
3201     if (restore_sigcontext(regs, &frame->uc.tuc_mcontext, &r0))
3202         goto badframe;
3203
3204     if (do_sigaltstack(frame_addr +
3205                        offsetof(struct target_rt_sigframe, uc.tuc_stack),
3206                        0, get_sp_from_cpustate(regs)) == -EFAULT)
3207         goto badframe;
3208
3209     unlock_user_struct(frame, frame_addr, 0);
3210     return r0;
3211
3212 badframe:
3213     unlock_user_struct(frame, frame_addr, 0);
3214     force_sig(TARGET_SIGSEGV);
3215     return 0;
3216 }
3217 #elif defined(TARGET_MICROBLAZE)
3218
3219 struct target_sigcontext {
3220     struct target_pt_regs regs;  /* needs to be first */
3221     uint32_t oldmask;
3222 };
3223
3224 struct target_stack_t {
3225     abi_ulong ss_sp;
3226     int ss_flags;
3227     unsigned int ss_size;
3228 };
3229
3230 struct target_ucontext {
3231     abi_ulong tuc_flags;
3232     abi_ulong tuc_link;
3233     struct target_stack_t tuc_stack;
3234     struct target_sigcontext tuc_mcontext;
3235     uint32_t tuc_extramask[TARGET_NSIG_WORDS - 1];
3236 };
3237
3238 /* Signal frames. */
3239 struct target_signal_frame {
3240     struct target_ucontext uc;
3241     uint32_t extramask[TARGET_NSIG_WORDS - 1];
3242     uint32_t tramp[2];
3243 };
3244
3245 struct rt_signal_frame {
3246     struct siginfo info;
3247     struct ucontext uc;
3248     uint32_t tramp[2];
3249 };
3250
3251 static void setup_sigcontext(struct target_sigcontext *sc, CPUState *env)
3252 {
3253     __put_user(env->regs[0], &sc->regs.r0);
3254     __put_user(env->regs[1], &sc->regs.r1);
3255     __put_user(env->regs[2], &sc->regs.r2);
3256     __put_user(env->regs[3], &sc->regs.r3);
3257     __put_user(env->regs[4], &sc->regs.r4);
3258     __put_user(env->regs[5], &sc->regs.r5);
3259     __put_user(env->regs[6], &sc->regs.r6);
3260     __put_user(env->regs[7], &sc->regs.r7);
3261     __put_user(env->regs[8], &sc->regs.r8);
3262     __put_user(env->regs[9], &sc->regs.r9);
3263     __put_user(env->regs[10], &sc->regs.r10);
3264     __put_user(env->regs[11], &sc->regs.r11);
3265     __put_user(env->regs[12], &sc->regs.r12);
3266     __put_user(env->regs[13], &sc->regs.r13);
3267     __put_user(env->regs[14], &sc->regs.r14);
3268     __put_user(env->regs[15], &sc->regs.r15);
3269     __put_user(env->regs[16], &sc->regs.r16);
3270     __put_user(env->regs[17], &sc->regs.r17);
3271     __put_user(env->regs[18], &sc->regs.r18);
3272     __put_user(env->regs[19], &sc->regs.r19);
3273     __put_user(env->regs[20], &sc->regs.r20);
3274     __put_user(env->regs[21], &sc->regs.r21);
3275     __put_user(env->regs[22], &sc->regs.r22);
3276     __put_user(env->regs[23], &sc->regs.r23);
3277     __put_user(env->regs[24], &sc->regs.r24);
3278     __put_user(env->regs[25], &sc->regs.r25);
3279     __put_user(env->regs[26], &sc->regs.r26);
3280     __put_user(env->regs[27], &sc->regs.r27);
3281     __put_user(env->regs[28], &sc->regs.r28);
3282     __put_user(env->regs[29], &sc->regs.r29);
3283     __put_user(env->regs[30], &sc->regs.r30);
3284     __put_user(env->regs[31], &sc->regs.r31);
3285     __put_user(env->sregs[SR_PC], &sc->regs.pc);
3286 }
3287
3288 static void restore_sigcontext(struct target_sigcontext *sc, CPUState *env)
3289 {
3290     __get_user(env->regs[0], &sc->regs.r0);
3291     __get_user(env->regs[1], &sc->regs.r1);
3292     __get_user(env->regs[2], &sc->regs.r2);
3293     __get_user(env->regs[3], &sc->regs.r3);
3294     __get_user(env->regs[4], &sc->regs.r4);
3295     __get_user(env->regs[5], &sc->regs.r5);
3296     __get_user(env->regs[6], &sc->regs.r6);
3297     __get_user(env->regs[7], &sc->regs.r7);
3298     __get_user(env->regs[8], &sc->regs.r8);
3299     __get_user(env->regs[9], &sc->regs.r9);
3300     __get_user(env->regs[10], &sc->regs.r10);
3301     __get_user(env->regs[11], &sc->regs.r11);
3302     __get_user(env->regs[12], &sc->regs.r12);
3303     __get_user(env->regs[13], &sc->regs.r13);
3304     __get_user(env->regs[14], &sc->regs.r14);
3305     __get_user(env->regs[15], &sc->regs.r15);
3306     __get_user(env->regs[16], &sc->regs.r16);
3307     __get_user(env->regs[17], &sc->regs.r17);
3308     __get_user(env->regs[18], &sc->regs.r18);
3309     __get_user(env->regs[19], &sc->regs.r19);
3310     __get_user(env->regs[20], &sc->regs.r20);
3311     __get_user(env->regs[21], &sc->regs.r21);
3312     __get_user(env->regs[22], &sc->regs.r22);
3313     __get_user(env->regs[23], &sc->regs.r23);
3314     __get_user(env->regs[24], &sc->regs.r24);
3315     __get_user(env->regs[25], &sc->regs.r25);
3316     __get_user(env->regs[26], &sc->regs.r26);
3317     __get_user(env->regs[27], &sc->regs.r27);
3318     __get_user(env->regs[28], &sc->regs.r28);
3319     __get_user(env->regs[29], &sc->regs.r29);
3320     __get_user(env->regs[30], &sc->regs.r30);
3321     __get_user(env->regs[31], &sc->regs.r31);
3322     __get_user(env->sregs[SR_PC], &sc->regs.pc);
3323 }
3324
3325 static abi_ulong get_sigframe(struct target_sigaction *ka,
3326                               CPUState *env, int frame_size)
3327 {
3328     abi_ulong sp = env->regs[1];
3329
3330     if ((ka->sa_flags & SA_ONSTACK) != 0 && !on_sig_stack(sp))
3331         sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
3332
3333     return ((sp - frame_size) & -8UL);
3334 }
3335
3336 static void setup_frame(int sig, struct target_sigaction *ka,
3337                         target_sigset_t *set, CPUState *env)
3338 {
3339     struct target_signal_frame *frame;
3340     abi_ulong frame_addr;
3341     int err = 0;
3342     int i;
3343
3344     frame_addr = get_sigframe(ka, env, sizeof *frame);
3345     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
3346         goto badframe;
3347
3348     /* Save the mask.  */
3349     err |= __put_user(set->sig[0], &frame->uc.tuc_mcontext.oldmask);
3350     if (err)
3351         goto badframe;
3352
3353     for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3354         if (__put_user(set->sig[i], &frame->extramask[i - 1]))
3355             goto badframe;
3356     }
3357
3358     setup_sigcontext(&frame->uc.tuc_mcontext, env);
3359
3360     /* Set up to return from userspace. If provided, use a stub
3361        already in userspace. */
3362     /* minus 8 is offset to cater for "rtsd r15,8" offset */
3363     if (ka->sa_flags & TARGET_SA_RESTORER) {
3364         env->regs[15] = ((unsigned long)ka->sa_restorer)-8;
3365     } else {
3366         uint32_t t;
3367         /* Note, these encodings are _big endian_! */
3368         /* addi r12, r0, __NR_sigreturn */
3369         t = 0x31800000UL | TARGET_NR_sigreturn;
3370         err |= __put_user(t, frame->tramp + 0);
3371         /* brki r14, 0x8 */
3372         t = 0xb9cc0008UL;
3373         err |= __put_user(t, frame->tramp + 1);
3374
3375         /* Return from sighandler will jump to the tramp.
3376            Negative 8 offset because return is rtsd r15, 8 */
3377         env->regs[15] = ((unsigned long)frame->tramp) - 8;
3378     }
3379
3380     if (err)
3381         goto badframe;
3382
3383     /* Set up registers for signal handler */
3384     env->regs[1] = (unsigned long) frame;
3385     /* Signal handler args: */
3386     env->regs[5] = sig; /* Arg 0: signum */
3387     env->regs[6] = 0;
3388     env->regs[7] = (unsigned long) &frame->uc; /* arg 1: sigcontext */
3389
3390     /* Offset of 4 to handle microblaze rtid r14, 0 */
3391     env->sregs[SR_PC] = (unsigned long)ka->_sa_handler;
3392
3393     unlock_user_struct(frame, frame_addr, 1);
3394     return;
3395   badframe:
3396     unlock_user_struct(frame, frame_addr, 1);
3397     force_sig(TARGET_SIGSEGV);
3398 }
3399
3400 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3401                            target_siginfo_t *info,
3402                            target_sigset_t *set, CPUState *env)
3403 {
3404     fprintf(stderr, "Microblaze setup_rt_frame: not implemented\n");
3405 }
3406
3407 long do_sigreturn(CPUState *env)
3408 {
3409     struct target_signal_frame *frame;
3410     abi_ulong frame_addr;
3411     target_sigset_t target_set;
3412     sigset_t set;
3413     int i;
3414
3415     frame_addr = env->regs[R_SP];
3416     /* Make sure the guest isn't playing games.  */
3417     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
3418         goto badframe;
3419
3420     /* Restore blocked signals */
3421     if (__get_user(target_set.sig[0], &frame->uc.tuc_mcontext.oldmask))
3422         goto badframe;
3423     for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3424         if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
3425             goto badframe;
3426     }
3427     target_to_host_sigset_internal(&set, &target_set);
3428     sigprocmask(SIG_SETMASK, &set, NULL);
3429
3430     restore_sigcontext(&frame->uc.tuc_mcontext, env);
3431     /* We got here through a sigreturn syscall, our path back is via an
3432        rtb insn so setup r14 for that.  */
3433     env->regs[14] = env->sregs[SR_PC];
3434  
3435     unlock_user_struct(frame, frame_addr, 0);
3436     return env->regs[10];
3437   badframe:
3438     unlock_user_struct(frame, frame_addr, 0);
3439     force_sig(TARGET_SIGSEGV);
3440 }
3441
3442 long do_rt_sigreturn(CPUState *env)
3443 {
3444     fprintf(stderr, "Microblaze do_rt_sigreturn: not implemented\n");
3445     return -TARGET_ENOSYS;
3446 }
3447
3448 #elif defined(TARGET_CRIS)
3449
3450 struct target_sigcontext {
3451         struct target_pt_regs regs;  /* needs to be first */
3452         uint32_t oldmask;
3453         uint32_t usp;    /* usp before stacking this gunk on it */
3454 };
3455
3456 /* Signal frames. */
3457 struct target_signal_frame {
3458         struct target_sigcontext sc;
3459         uint32_t extramask[TARGET_NSIG_WORDS - 1];
3460         uint8_t retcode[8];       /* Trampoline code. */
3461 };
3462
3463 struct rt_signal_frame {
3464         struct siginfo *pinfo;
3465         void *puc;
3466         struct siginfo info;
3467         struct ucontext uc;
3468         uint8_t retcode[8];       /* Trampoline code. */
3469 };
3470
3471 static void setup_sigcontext(struct target_sigcontext *sc, CPUState *env)
3472 {
3473         __put_user(env->regs[0], &sc->regs.r0);
3474         __put_user(env->regs[1], &sc->regs.r1);
3475         __put_user(env->regs[2], &sc->regs.r2);
3476         __put_user(env->regs[3], &sc->regs.r3);
3477         __put_user(env->regs[4], &sc->regs.r4);
3478         __put_user(env->regs[5], &sc->regs.r5);
3479         __put_user(env->regs[6], &sc->regs.r6);
3480         __put_user(env->regs[7], &sc->regs.r7);
3481         __put_user(env->regs[8], &sc->regs.r8);
3482         __put_user(env->regs[9], &sc->regs.r9);
3483         __put_user(env->regs[10], &sc->regs.r10);
3484         __put_user(env->regs[11], &sc->regs.r11);
3485         __put_user(env->regs[12], &sc->regs.r12);
3486         __put_user(env->regs[13], &sc->regs.r13);
3487         __put_user(env->regs[14], &sc->usp);
3488         __put_user(env->regs[15], &sc->regs.acr);
3489         __put_user(env->pregs[PR_MOF], &sc->regs.mof);
3490         __put_user(env->pregs[PR_SRP], &sc->regs.srp);
3491         __put_user(env->pc, &sc->regs.erp);
3492 }
3493
3494 static void restore_sigcontext(struct target_sigcontext *sc, CPUState *env)
3495 {
3496         __get_user(env->regs[0], &sc->regs.r0);
3497         __get_user(env->regs[1], &sc->regs.r1);
3498         __get_user(env->regs[2], &sc->regs.r2);
3499         __get_user(env->regs[3], &sc->regs.r3);
3500         __get_user(env->regs[4], &sc->regs.r4);
3501         __get_user(env->regs[5], &sc->regs.r5);
3502         __get_user(env->regs[6], &sc->regs.r6);
3503         __get_user(env->regs[7], &sc->regs.r7);
3504         __get_user(env->regs[8], &sc->regs.r8);
3505         __get_user(env->regs[9], &sc->regs.r9);
3506         __get_user(env->regs[10], &sc->regs.r10);
3507         __get_user(env->regs[11], &sc->regs.r11);
3508         __get_user(env->regs[12], &sc->regs.r12);
3509         __get_user(env->regs[13], &sc->regs.r13);
3510         __get_user(env->regs[14], &sc->usp);
3511         __get_user(env->regs[15], &sc->regs.acr);
3512         __get_user(env->pregs[PR_MOF], &sc->regs.mof);
3513         __get_user(env->pregs[PR_SRP], &sc->regs.srp);
3514         __get_user(env->pc, &sc->regs.erp);
3515 }
3516
3517 static abi_ulong get_sigframe(CPUState *env, int framesize)
3518 {
3519         abi_ulong sp;
3520         /* Align the stack downwards to 4.  */
3521         sp = (env->regs[R_SP] & ~3);
3522         return sp - framesize;
3523 }
3524
3525 static void setup_frame(int sig, struct target_sigaction *ka,
3526                         target_sigset_t *set, CPUState *env)
3527 {
3528         struct target_signal_frame *frame;
3529         abi_ulong frame_addr;
3530         int err = 0;
3531         int i;
3532
3533         frame_addr = get_sigframe(env, sizeof *frame);
3534         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
3535                 goto badframe;
3536
3537         /*
3538          * The CRIS signal return trampoline. A real linux/CRIS kernel doesn't
3539          * use this trampoline anymore but it sets it up for GDB.
3540          * In QEMU, using the trampoline simplifies things a bit so we use it.
3541          *
3542          * This is movu.w __NR_sigreturn, r9; break 13;
3543          */
3544         err |= __put_user(0x9c5f, frame->retcode+0);
3545         err |= __put_user(TARGET_NR_sigreturn, 
3546                           frame->retcode+2);
3547         err |= __put_user(0xe93d, frame->retcode+4);
3548
3549         /* Save the mask.  */
3550         err |= __put_user(set->sig[0], &frame->sc.oldmask);
3551         if (err)
3552                 goto badframe;
3553
3554         for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3555                 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
3556                         goto badframe;
3557         }
3558
3559         setup_sigcontext(&frame->sc, env);
3560
3561         /* Move the stack and setup the arguments for the handler.  */
3562         env->regs[R_SP] = (uint32_t) (unsigned long) frame;
3563         env->regs[10] = sig;
3564         env->pc = (unsigned long) ka->_sa_handler;
3565         /* Link SRP so the guest returns through the trampoline.  */
3566         env->pregs[PR_SRP] = (uint32_t) (unsigned long) &frame->retcode[0];
3567
3568         unlock_user_struct(frame, frame_addr, 1);
3569         return;
3570   badframe:
3571         unlock_user_struct(frame, frame_addr, 1);
3572         force_sig(TARGET_SIGSEGV);
3573 }
3574
3575 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3576                            target_siginfo_t *info,
3577                            target_sigset_t *set, CPUState *env)
3578 {
3579     fprintf(stderr, "CRIS setup_rt_frame: not implemented\n");
3580 }
3581
3582 long do_sigreturn(CPUState *env)
3583 {
3584         struct target_signal_frame *frame;
3585         abi_ulong frame_addr;
3586         target_sigset_t target_set;
3587         sigset_t set;
3588         int i;
3589
3590         frame_addr = env->regs[R_SP];
3591         /* Make sure the guest isn't playing games.  */
3592         if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
3593                 goto badframe;
3594
3595         /* Restore blocked signals */
3596         if (__get_user(target_set.sig[0], &frame->sc.oldmask))
3597                 goto badframe;
3598         for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3599                 if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
3600                         goto badframe;
3601         }
3602         target_to_host_sigset_internal(&set, &target_set);
3603         sigprocmask(SIG_SETMASK, &set, NULL);
3604
3605         restore_sigcontext(&frame->sc, env);
3606         unlock_user_struct(frame, frame_addr, 0);
3607         return env->regs[10];
3608   badframe:
3609         unlock_user_struct(frame, frame_addr, 0);
3610         force_sig(TARGET_SIGSEGV);
3611 }
3612
3613 long do_rt_sigreturn(CPUState *env)
3614 {
3615     fprintf(stderr, "CRIS do_rt_sigreturn: not implemented\n");
3616     return -TARGET_ENOSYS;
3617 }
3618
3619 #elif defined(TARGET_S390X)
3620
3621 #define __NUM_GPRS 16
3622 #define __NUM_FPRS 16
3623 #define __NUM_ACRS 16
3624
3625 #define S390_SYSCALL_SIZE   2
3626 #define __SIGNAL_FRAMESIZE      160 /* FIXME: 31-bit mode -> 96 */
3627
3628 #define _SIGCONTEXT_NSIG        64
3629 #define _SIGCONTEXT_NSIG_BPW    64 /* FIXME: 31-bit mode -> 32 */
3630 #define _SIGCONTEXT_NSIG_WORDS  (_SIGCONTEXT_NSIG / _SIGCONTEXT_NSIG_BPW)
3631 #define _SIGMASK_COPY_SIZE    (sizeof(unsigned long)*_SIGCONTEXT_NSIG_WORDS)
3632 #define PSW_ADDR_AMODE            0x0000000000000000UL /* 0x80000000UL for 31-bit */
3633 #define S390_SYSCALL_OPCODE ((uint16_t)0x0a00)
3634
3635 typedef struct {
3636     target_psw_t psw;
3637     target_ulong gprs[__NUM_GPRS];
3638     unsigned int acrs[__NUM_ACRS];
3639 } target_s390_regs_common;
3640
3641 typedef struct {
3642     unsigned int fpc;
3643     double   fprs[__NUM_FPRS];
3644 } target_s390_fp_regs;
3645
3646 typedef struct {
3647     target_s390_regs_common regs;
3648     target_s390_fp_regs     fpregs;
3649 } target_sigregs;
3650
3651 struct target_sigcontext {
3652     target_ulong   oldmask[_SIGCONTEXT_NSIG_WORDS];
3653     target_sigregs *sregs;
3654 };
3655
3656 typedef struct {
3657     uint8_t callee_used_stack[__SIGNAL_FRAMESIZE];
3658     struct target_sigcontext sc;
3659     target_sigregs sregs;
3660     int signo;
3661     uint8_t retcode[S390_SYSCALL_SIZE];
3662 } sigframe;
3663
3664 struct target_ucontext {
3665     target_ulong tuc_flags;
3666     struct target_ucontext *tuc_link;
3667     target_stack_t tuc_stack;
3668     target_sigregs tuc_mcontext;
3669     target_sigset_t tuc_sigmask;   /* mask last for extensibility */
3670 };
3671
3672 typedef struct {
3673     uint8_t callee_used_stack[__SIGNAL_FRAMESIZE];
3674     uint8_t retcode[S390_SYSCALL_SIZE];
3675     struct target_siginfo info;
3676     struct target_ucontext uc;
3677 } rt_sigframe;
3678
3679 static inline abi_ulong
3680 get_sigframe(struct target_sigaction *ka, CPUState *env, size_t frame_size)
3681 {
3682     abi_ulong sp;
3683
3684     /* Default to using normal stack */
3685     sp = env->regs[15];
3686
3687     /* This is the X/Open sanctioned signal stack switching.  */
3688     if (ka->sa_flags & TARGET_SA_ONSTACK) {
3689         if (!sas_ss_flags(sp)) {
3690             sp = target_sigaltstack_used.ss_sp +
3691                  target_sigaltstack_used.ss_size;
3692         }
3693     }
3694
3695     /* This is the legacy signal stack switching. */
3696     else if (/* FIXME !user_mode(regs) */ 0 &&
3697              !(ka->sa_flags & TARGET_SA_RESTORER) &&
3698              ka->sa_restorer) {
3699         sp = (abi_ulong) ka->sa_restorer;
3700     }
3701
3702     return (sp - frame_size) & -8ul;
3703 }
3704
3705 static void save_sigregs(CPUState *env, target_sigregs *sregs)
3706 {
3707     int i;
3708     //save_access_regs(current->thread.acrs); FIXME
3709
3710     /* Copy a 'clean' PSW mask to the user to avoid leaking
3711        information about whether PER is currently on.  */
3712     __put_user(env->psw.mask, &sregs->regs.psw.mask);
3713     __put_user(env->psw.addr, &sregs->regs.psw.addr);
3714     for (i = 0; i < 16; i++) {
3715         __put_user(env->regs[i], &sregs->regs.gprs[i]);
3716     }
3717     for (i = 0; i < 16; i++) {
3718         __put_user(env->aregs[i], &sregs->regs.acrs[i]);
3719     }
3720     /*
3721      * We have to store the fp registers to current->thread.fp_regs
3722      * to merge them with the emulated registers.
3723      */
3724     //save_fp_regs(&current->thread.fp_regs); FIXME
3725     for (i = 0; i < 16; i++) {
3726         __put_user(env->fregs[i].ll, &sregs->fpregs.fprs[i]);
3727     }
3728 }
3729
3730 static void setup_frame(int sig, struct target_sigaction *ka,
3731                         target_sigset_t *set, CPUState *env)
3732 {
3733     sigframe *frame;
3734     abi_ulong frame_addr;
3735
3736     frame_addr = get_sigframe(ka, env, sizeof(*frame));
3737     qemu_log("%s: frame_addr 0x%llx\n", __FUNCTION__,
3738              (unsigned long long)frame_addr);
3739     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
3740             goto give_sigsegv;
3741     }
3742
3743     qemu_log("%s: 1\n", __FUNCTION__);
3744     if (__put_user(set->sig[0], &frame->sc.oldmask[0])) {
3745               goto give_sigsegv;
3746     }
3747
3748     save_sigregs(env, &frame->sregs);
3749
3750     __put_user((abi_ulong)(unsigned long)&frame->sregs,
3751                (abi_ulong *)&frame->sc.sregs);
3752
3753     /* Set up to return from userspace.  If provided, use a stub
3754        already in userspace.  */
3755     if (ka->sa_flags & TARGET_SA_RESTORER) {
3756             env->regs[14] = (unsigned long)
3757                     ka->sa_restorer | PSW_ADDR_AMODE;
3758     } else {
3759             env->regs[14] = (unsigned long)
3760                     frame->retcode | PSW_ADDR_AMODE;
3761             if (__put_user(S390_SYSCALL_OPCODE | TARGET_NR_sigreturn,
3762                            (uint16_t *)(frame->retcode)))
3763                     goto give_sigsegv;
3764     }
3765
3766     /* Set up backchain. */
3767     if (__put_user(env->regs[15], (abi_ulong *) frame)) {
3768             goto give_sigsegv;
3769     }
3770
3771     /* Set up registers for signal handler */
3772     env->regs[15] = (target_ulong)(unsigned long) frame;
3773     env->psw.addr = (target_ulong) ka->_sa_handler | PSW_ADDR_AMODE;
3774
3775     env->regs[2] = sig; //map_signal(sig);
3776     env->regs[3] = (target_ulong)(unsigned long) &frame->sc;
3777
3778     /* We forgot to include these in the sigcontext.
3779        To avoid breaking binary compatibility, they are passed as args. */
3780     env->regs[4] = 0; // FIXME: no clue... current->thread.trap_no;
3781     env->regs[5] = 0; // FIXME: no clue... current->thread.prot_addr;
3782
3783     /* Place signal number on stack to allow backtrace from handler.  */
3784     if (__put_user(env->regs[2], (int *) &frame->signo)) {
3785             goto give_sigsegv;
3786     }
3787     unlock_user_struct(frame, frame_addr, 1);
3788     return;
3789
3790 give_sigsegv:
3791     qemu_log("%s: give_sigsegv\n", __FUNCTION__);
3792     unlock_user_struct(frame, frame_addr, 1);
3793     force_sig(TARGET_SIGSEGV);
3794 }
3795
3796 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3797                            target_siginfo_t *info,
3798                            target_sigset_t *set, CPUState *env)
3799 {
3800     int i;
3801     rt_sigframe *frame;
3802     abi_ulong frame_addr;
3803
3804     frame_addr = get_sigframe(ka, env, sizeof *frame);
3805     qemu_log("%s: frame_addr 0x%llx\n", __FUNCTION__,
3806              (unsigned long long)frame_addr);
3807     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
3808         goto give_sigsegv;
3809     }
3810
3811     qemu_log("%s: 1\n", __FUNCTION__);
3812     if (copy_siginfo_to_user(&frame->info, info)) {
3813         goto give_sigsegv;
3814     }
3815
3816     /* Create the ucontext.  */
3817     __put_user(0, &frame->uc.tuc_flags);
3818     __put_user((abi_ulong)0, (abi_ulong *)&frame->uc.tuc_link);
3819     __put_user(target_sigaltstack_used.ss_sp, &frame->uc.tuc_stack.ss_sp);
3820     __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
3821                       &frame->uc.tuc_stack.ss_flags);
3822     __put_user(target_sigaltstack_used.ss_size, &frame->uc.tuc_stack.ss_size);
3823     save_sigregs(env, &frame->uc.tuc_mcontext);
3824     for (i = 0; i < TARGET_NSIG_WORDS; i++) {
3825         __put_user((abi_ulong)set->sig[i],
3826         (abi_ulong *)&frame->uc.tuc_sigmask.sig[i]);
3827     }
3828
3829     /* Set up to return from userspace.  If provided, use a stub
3830        already in userspace.  */
3831     if (ka->sa_flags & TARGET_SA_RESTORER) {
3832         env->regs[14] = (unsigned long) ka->sa_restorer | PSW_ADDR_AMODE;
3833     } else {
3834         env->regs[14] = (unsigned long) frame->retcode | PSW_ADDR_AMODE;
3835         if (__put_user(S390_SYSCALL_OPCODE | TARGET_NR_rt_sigreturn,
3836                        (uint16_t *)(frame->retcode))) {
3837             goto give_sigsegv;
3838         }
3839     }
3840
3841     /* Set up backchain. */
3842     if (__put_user(env->regs[15], (abi_ulong *) frame)) {
3843         goto give_sigsegv;
3844     }
3845
3846     /* Set up registers for signal handler */
3847     env->regs[15] = (target_ulong)(unsigned long) frame;
3848     env->psw.addr = (target_ulong) ka->_sa_handler | PSW_ADDR_AMODE;
3849
3850     env->regs[2] = sig; //map_signal(sig);
3851     env->regs[3] = (target_ulong)(unsigned long) &frame->info;
3852     env->regs[4] = (target_ulong)(unsigned long) &frame->uc;
3853     return;
3854
3855 give_sigsegv:
3856     qemu_log("%s: give_sigsegv\n", __FUNCTION__);
3857     unlock_user_struct(frame, frame_addr, 1);
3858     force_sig(TARGET_SIGSEGV);
3859 }
3860
3861 static int
3862 restore_sigregs(CPUState *env, target_sigregs *sc)
3863 {
3864     int err = 0;
3865     int i;
3866
3867     for (i = 0; i < 16; i++) {
3868         err |= __get_user(env->regs[i], &sc->regs.gprs[i]);
3869     }
3870
3871     err |= __get_user(env->psw.mask, &sc->regs.psw.mask);
3872     qemu_log("%s: sc->regs.psw.addr 0x%llx env->psw.addr 0x%llx\n",
3873              __FUNCTION__, (unsigned long long)sc->regs.psw.addr,
3874              (unsigned long long)env->psw.addr);
3875     err |= __get_user(env->psw.addr, &sc->regs.psw.addr);
3876     /* FIXME: 31-bit -> | PSW_ADDR_AMODE */
3877
3878     for (i = 0; i < 16; i++) {
3879         err |= __get_user(env->aregs[i], &sc->regs.acrs[i]);
3880     }
3881     for (i = 0; i < 16; i++) {
3882         err |= __get_user(env->fregs[i].ll, &sc->fpregs.fprs[i]);
3883     }
3884
3885     return err;
3886 }
3887
3888 long do_sigreturn(CPUState *env)
3889 {
3890     sigframe *frame;
3891     abi_ulong frame_addr = env->regs[15];
3892     qemu_log("%s: frame_addr 0x%llx\n", __FUNCTION__,
3893              (unsigned long long)frame_addr);
3894     target_sigset_t target_set;
3895     sigset_t set;
3896
3897     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
3898         goto badframe;
3899     }
3900     if (__get_user(target_set.sig[0], &frame->sc.oldmask[0])) {
3901         goto badframe;
3902     }
3903
3904     target_to_host_sigset_internal(&set, &target_set);
3905     sigprocmask(SIG_SETMASK, &set, NULL); /* ~_BLOCKABLE? */
3906
3907     if (restore_sigregs(env, &frame->sregs)) {
3908         goto badframe;
3909     }
3910
3911     unlock_user_struct(frame, frame_addr, 0);
3912     return env->regs[2];
3913
3914 badframe:
3915     unlock_user_struct(frame, frame_addr, 0);
3916     force_sig(TARGET_SIGSEGV);
3917     return 0;
3918 }
3919
3920 long do_rt_sigreturn(CPUState *env)
3921 {
3922     rt_sigframe *frame;
3923     abi_ulong frame_addr = env->regs[15];
3924     qemu_log("%s: frame_addr 0x%llx\n", __FUNCTION__,
3925              (unsigned long long)frame_addr);
3926     sigset_t set;
3927
3928     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
3929         goto badframe;
3930     }
3931     target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
3932
3933     sigprocmask(SIG_SETMASK, &set, NULL); /* ~_BLOCKABLE? */
3934
3935     if (restore_sigregs(env, &frame->uc.tuc_mcontext)) {
3936         goto badframe;
3937     }
3938
3939     if (do_sigaltstack(frame_addr + offsetof(rt_sigframe, uc.tuc_stack), 0,
3940                        get_sp_from_cpustate(env)) == -EFAULT) {
3941         goto badframe;
3942     }
3943     unlock_user_struct(frame, frame_addr, 0);
3944     return env->regs[2];
3945
3946 badframe:
3947     unlock_user_struct(frame, frame_addr, 0);
3948     force_sig(TARGET_SIGSEGV);
3949     return 0;
3950 }
3951
3952 #elif defined(TARGET_PPC) && !defined(TARGET_PPC64)
3953
3954 /* FIXME: Many of the structures are defined for both PPC and PPC64, but
3955    the signal handling is different enough that we haven't implemented
3956    support for PPC64 yet.  Hence the restriction above.
3957
3958    There are various #if'd blocks for code for TARGET_PPC64.  These
3959    blocks should go away so that we can successfully run 32-bit and
3960    64-bit binaries on a QEMU configured for PPC64.  */
3961
3962 /* Size of dummy stack frame allocated when calling signal handler.
3963    See arch/powerpc/include/asm/ptrace.h.  */
3964 #if defined(TARGET_PPC64)
3965 #define SIGNAL_FRAMESIZE 128
3966 #else
3967 #define SIGNAL_FRAMESIZE 64
3968 #endif
3969
3970 /* See arch/powerpc/include/asm/sigcontext.h.  */
3971 struct target_sigcontext {
3972     target_ulong _unused[4];
3973     int32_t signal;
3974 #if defined(TARGET_PPC64)
3975     int32_t pad0;
3976 #endif
3977     target_ulong handler;
3978     target_ulong oldmask;
3979     target_ulong regs;      /* struct pt_regs __user * */
3980     /* TODO: PPC64 includes extra bits here.  */
3981 };
3982
3983 /* Indices for target_mcontext.mc_gregs, below.
3984    See arch/powerpc/include/asm/ptrace.h for details.  */
3985 enum {
3986     TARGET_PT_R0 = 0,
3987     TARGET_PT_R1 = 1,
3988     TARGET_PT_R2 = 2,
3989     TARGET_PT_R3 = 3,
3990     TARGET_PT_R4 = 4,
3991     TARGET_PT_R5 = 5,
3992     TARGET_PT_R6 = 6,
3993     TARGET_PT_R7 = 7,
3994     TARGET_PT_R8 = 8,
3995     TARGET_PT_R9 = 9,
3996     TARGET_PT_R10 = 10,
3997     TARGET_PT_R11 = 11,
3998     TARGET_PT_R12 = 12,
3999     TARGET_PT_R13 = 13,
4000     TARGET_PT_R14 = 14,
4001     TARGET_PT_R15 = 15,
4002     TARGET_PT_R16 = 16,
4003     TARGET_PT_R17 = 17,
4004     TARGET_PT_R18 = 18,
4005     TARGET_PT_R19 = 19,
4006     TARGET_PT_R20 = 20,
4007     TARGET_PT_R21 = 21,
4008     TARGET_PT_R22 = 22,
4009     TARGET_PT_R23 = 23,
4010     TARGET_PT_R24 = 24,
4011     TARGET_PT_R25 = 25,
4012     TARGET_PT_R26 = 26,
4013     TARGET_PT_R27 = 27,
4014     TARGET_PT_R28 = 28,
4015     TARGET_PT_R29 = 29,
4016     TARGET_PT_R30 = 30,
4017     TARGET_PT_R31 = 31,
4018     TARGET_PT_NIP = 32,
4019     TARGET_PT_MSR = 33,
4020     TARGET_PT_ORIG_R3 = 34,
4021     TARGET_PT_CTR = 35,
4022     TARGET_PT_LNK = 36,
4023     TARGET_PT_XER = 37,
4024     TARGET_PT_CCR = 38,
4025     /* Yes, there are two registers with #39.  One is 64-bit only.  */
4026     TARGET_PT_MQ = 39,
4027     TARGET_PT_SOFTE = 39,
4028     TARGET_PT_TRAP = 40,
4029     TARGET_PT_DAR = 41,
4030     TARGET_PT_DSISR = 42,
4031     TARGET_PT_RESULT = 43,
4032     TARGET_PT_REGS_COUNT = 44
4033 };
4034
4035 /* See arch/powerpc/include/asm/ucontext.h.  Only used for 32-bit PPC;
4036    on 64-bit PPC, sigcontext and mcontext are one and the same.  */
4037 struct target_mcontext {
4038     target_ulong mc_gregs[48];
4039     /* Includes fpscr.  */
4040     uint64_t mc_fregs[33];
4041     target_ulong mc_pad[2];
4042     /* We need to handle Altivec and SPE at the same time, which no
4043        kernel needs to do.  Fortunately, the kernel defines this bit to
4044        be Altivec-register-large all the time, rather than trying to
4045        twiddle it based on the specific platform.  */
4046     union {
4047         /* SPE vector registers.  One extra for SPEFSCR.  */
4048         uint32_t spe[33];
4049         /* Altivec vector registers.  The packing of VSCR and VRSAVE
4050            varies depending on whether we're PPC64 or not: PPC64 splits
4051            them apart; PPC32 stuffs them together.  */
4052 #if defined(TARGET_PPC64)
4053 #define QEMU_NVRREG 34
4054 #else
4055 #define QEMU_NVRREG 33
4056 #endif
4057         ppc_avr_t altivec[QEMU_NVRREG];
4058 #undef QEMU_NVRREG
4059     } mc_vregs __attribute__((__aligned__(16)));
4060 };
4061
4062 struct target_ucontext {
4063     target_ulong tuc_flags;
4064     target_ulong tuc_link;    /* struct ucontext __user * */
4065     struct target_sigaltstack tuc_stack;
4066 #if !defined(TARGET_PPC64)
4067     int32_t tuc_pad[7];
4068     target_ulong tuc_regs;    /* struct mcontext __user *
4069                                 points to uc_mcontext field */
4070 #endif
4071     target_sigset_t tuc_sigmask;
4072 #if defined(TARGET_PPC64)
4073     target_sigset_t unused[15]; /* Allow for uc_sigmask growth */
4074     struct target_sigcontext tuc_mcontext;
4075 #else
4076     int32_t tuc_maskext[30];
4077     int32_t tuc_pad2[3];
4078     struct target_mcontext tuc_mcontext;
4079 #endif
4080 };
4081
4082 /* See arch/powerpc/kernel/signal_32.c.  */
4083 struct target_sigframe {
4084     struct target_sigcontext sctx;
4085     struct target_mcontext mctx;
4086     int32_t abigap[56];
4087 };
4088
4089 struct target_rt_sigframe {
4090     struct target_siginfo info;
4091     struct target_ucontext uc;
4092     int32_t abigap[56];
4093 };
4094
4095 /* We use the mc_pad field for the signal return trampoline.  */
4096 #define tramp mc_pad
4097
4098 /* See arch/powerpc/kernel/signal.c.  */
4099 static target_ulong get_sigframe(struct target_sigaction *ka,
4100                                  CPUState *env,
4101                                  int frame_size)
4102 {
4103     target_ulong oldsp, newsp;
4104
4105     oldsp = env->gpr[1];
4106
4107     if ((ka->sa_flags & TARGET_SA_ONSTACK) &&
4108         (sas_ss_flags(oldsp))) {
4109         oldsp = (target_sigaltstack_used.ss_sp
4110                  + target_sigaltstack_used.ss_size);
4111     }
4112
4113     newsp = (oldsp - frame_size) & ~0xFUL;
4114
4115     return newsp;
4116 }
4117
4118 static int save_user_regs(CPUState *env, struct target_mcontext *frame,
4119                           int sigret)
4120 {
4121     target_ulong msr = env->msr;
4122     int i;
4123     target_ulong ccr = 0;
4124
4125     /* In general, the kernel attempts to be intelligent about what it
4126        needs to save for Altivec/FP/SPE registers.  We don't care that
4127        much, so we just go ahead and save everything.  */
4128
4129     /* Save general registers.  */
4130     for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4131         if (__put_user(env->gpr[i], &frame->mc_gregs[i])) {
4132             return 1;
4133         }
4134     }
4135     if (__put_user(env->nip, &frame->mc_gregs[TARGET_PT_NIP])
4136         || __put_user(env->ctr, &frame->mc_gregs[TARGET_PT_CTR])
4137         || __put_user(env->lr, &frame->mc_gregs[TARGET_PT_LNK])
4138         || __put_user(env->xer, &frame->mc_gregs[TARGET_PT_XER]))
4139         return 1;
4140
4141     for (i = 0; i < ARRAY_SIZE(env->crf); i++) {
4142         ccr |= env->crf[i] << (32 - ((i + 1) * 4));
4143     }
4144     if (__put_user(ccr, &frame->mc_gregs[TARGET_PT_CCR]))
4145         return 1;
4146
4147     /* Save Altivec registers if necessary.  */
4148     if (env->insns_flags & PPC_ALTIVEC) {
4149         for (i = 0; i < ARRAY_SIZE(env->avr); i++) {
4150             ppc_avr_t *avr = &env->avr[i];
4151             ppc_avr_t *vreg = &frame->mc_vregs.altivec[i];
4152
4153             if (__put_user(avr->u64[0], &vreg->u64[0]) ||
4154                 __put_user(avr->u64[1], &vreg->u64[1])) {
4155                 return 1;
4156             }
4157         }
4158         /* Set MSR_VR in the saved MSR value to indicate that
4159            frame->mc_vregs contains valid data.  */
4160         msr |= MSR_VR;
4161         if (__put_user((uint32_t)env->spr[SPR_VRSAVE],
4162                        &frame->mc_vregs.altivec[32].u32[3]))
4163             return 1;
4164     }
4165
4166     /* Save floating point registers.  */
4167     if (env->insns_flags & PPC_FLOAT) {
4168         for (i = 0; i < ARRAY_SIZE(env->fpr); i++) {
4169             if (__put_user(env->fpr[i], &frame->mc_fregs[i])) {
4170                 return 1;
4171             }
4172         }
4173         if (__put_user((uint64_t) env->fpscr, &frame->mc_fregs[32]))
4174             return 1;
4175     }
4176
4177     /* Save SPE registers.  The kernel only saves the high half.  */
4178     if (env->insns_flags & PPC_SPE) {
4179 #if defined(TARGET_PPC64)
4180         for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4181             if (__put_user(env->gpr[i] >> 32, &frame->mc_vregs.spe[i])) {
4182                 return 1;
4183             }
4184         }
4185 #else
4186         for (i = 0; i < ARRAY_SIZE(env->gprh); i++) {
4187             if (__put_user(env->gprh[i], &frame->mc_vregs.spe[i])) {
4188                 return 1;
4189             }
4190         }
4191 #endif
4192         /* Set MSR_SPE in the saved MSR value to indicate that
4193            frame->mc_vregs contains valid data.  */
4194         msr |= MSR_SPE;
4195         if (__put_user(env->spe_fscr, &frame->mc_vregs.spe[32]))
4196             return 1;
4197     }
4198
4199     /* Store MSR.  */
4200     if (__put_user(msr, &frame->mc_gregs[TARGET_PT_MSR]))
4201         return 1;
4202
4203     /* Set up the sigreturn trampoline: li r0,sigret; sc.  */
4204     if (sigret) {
4205         if (__put_user(0x38000000UL | sigret, &frame->tramp[0]) ||
4206             __put_user(0x44000002UL, &frame->tramp[1])) {
4207             return 1;
4208         }
4209     }
4210
4211     return 0;
4212 }
4213
4214 static int restore_user_regs(CPUState *env,
4215                              struct target_mcontext *frame, int sig)
4216 {
4217     target_ulong save_r2 = 0;
4218     target_ulong msr;
4219     target_ulong ccr;
4220
4221     int i;
4222
4223     if (!sig) {
4224         save_r2 = env->gpr[2];
4225     }
4226
4227     /* Restore general registers.  */
4228     for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4229         if (__get_user(env->gpr[i], &frame->mc_gregs[i])) {
4230             return 1;
4231         }
4232     }
4233     if (__get_user(env->nip, &frame->mc_gregs[TARGET_PT_NIP])
4234         || __get_user(env->ctr, &frame->mc_gregs[TARGET_PT_CTR])
4235         || __get_user(env->lr, &frame->mc_gregs[TARGET_PT_LNK])
4236         || __get_user(env->xer, &frame->mc_gregs[TARGET_PT_XER]))
4237         return 1;
4238     if (__get_user(ccr, &frame->mc_gregs[TARGET_PT_CCR]))
4239         return 1;
4240
4241     for (i = 0; i < ARRAY_SIZE(env->crf); i++) {
4242         env->crf[i] = (ccr >> (32 - ((i + 1) * 4))) & 0xf;
4243     }
4244
4245     if (!sig) {
4246         env->gpr[2] = save_r2;
4247     }
4248     /* Restore MSR.  */
4249     if (__get_user(msr, &frame->mc_gregs[TARGET_PT_MSR]))
4250         return 1;
4251
4252     /* If doing signal return, restore the previous little-endian mode.  */
4253     if (sig)
4254         env->msr = (env->msr & ~MSR_LE) | (msr & MSR_LE);
4255
4256     /* Restore Altivec registers if necessary.  */
4257     if (env->insns_flags & PPC_ALTIVEC) {
4258         for (i = 0; i < ARRAY_SIZE(env->avr); i++) {
4259             ppc_avr_t *avr = &env->avr[i];
4260             ppc_avr_t *vreg = &frame->mc_vregs.altivec[i];
4261
4262             if (__get_user(avr->u64[0], &vreg->u64[0]) ||
4263                 __get_user(avr->u64[1], &vreg->u64[1])) {
4264                 return 1;
4265             }
4266         }
4267         /* Set MSR_VEC in the saved MSR value to indicate that
4268            frame->mc_vregs contains valid data.  */
4269         if (__get_user(env->spr[SPR_VRSAVE],
4270                        (target_ulong *)(&frame->mc_vregs.altivec[32].u32[3])))
4271             return 1;
4272     }
4273
4274     /* Restore floating point registers.  */
4275     if (env->insns_flags & PPC_FLOAT) {
4276         uint64_t fpscr;
4277         for (i = 0; i < ARRAY_SIZE(env->fpr); i++) {
4278             if (__get_user(env->fpr[i], &frame->mc_fregs[i])) {
4279                 return 1;
4280             }
4281         }
4282         if (__get_user(fpscr, &frame->mc_fregs[32]))
4283             return 1;
4284         env->fpscr = (uint32_t) fpscr;
4285     }
4286
4287     /* Save SPE registers.  The kernel only saves the high half.  */
4288     if (env->insns_flags & PPC_SPE) {
4289 #if defined(TARGET_PPC64)
4290         for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
4291             uint32_t hi;
4292
4293             if (__get_user(hi, &frame->mc_vregs.spe[i])) {
4294                 return 1;
4295             }
4296             env->gpr[i] = ((uint64_t)hi << 32) | ((uint32_t) env->gpr[i]);
4297         }
4298 #else
4299         for (i = 0; i < ARRAY_SIZE(env->gprh); i++) {
4300             if (__get_user(env->gprh[i], &frame->mc_vregs.spe[i])) {
4301                 return 1;
4302             }
4303         }
4304 #endif
4305         if (__get_user(env->spe_fscr, &frame->mc_vregs.spe[32]))
4306             return 1;
4307     }
4308
4309     return 0;
4310 }
4311
4312 static void setup_frame(int sig, struct target_sigaction *ka,
4313                         target_sigset_t *set, CPUState *env)
4314 {
4315     struct target_sigframe *frame;
4316     struct target_sigcontext *sc;
4317     target_ulong frame_addr, newsp;
4318     int err = 0;
4319     int signal;
4320
4321     frame_addr = get_sigframe(ka, env, sizeof(*frame));
4322     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
4323         goto sigsegv;
4324     sc = &frame->sctx;
4325
4326     signal = current_exec_domain_sig(sig);
4327
4328     err |= __put_user(h2g(ka->_sa_handler), &sc->handler);
4329     err |= __put_user(set->sig[0], &sc->oldmask);
4330 #if defined(TARGET_PPC64)
4331     err |= __put_user(set->sig[0] >> 32, &sc->_unused[3]);
4332 #else
4333     err |= __put_user(set->sig[1], &sc->_unused[3]);
4334 #endif
4335     err |= __put_user(h2g(&frame->mctx), &sc->regs);
4336     err |= __put_user(sig, &sc->signal);
4337
4338     /* Save user regs.  */
4339     err |= save_user_regs(env, &frame->mctx, TARGET_NR_sigreturn);
4340
4341     /* The kernel checks for the presence of a VDSO here.  We don't
4342        emulate a vdso, so use a sigreturn system call.  */
4343     env->lr = (target_ulong) h2g(frame->mctx.tramp);
4344
4345     /* Turn off all fp exceptions.  */
4346     env->fpscr = 0;
4347
4348     /* Create a stack frame for the caller of the handler.  */
4349     newsp = frame_addr - SIGNAL_FRAMESIZE;
4350     err |= __put_user(env->gpr[1], (target_ulong *)(uintptr_t) newsp);
4351
4352     if (err)
4353         goto sigsegv;
4354
4355     /* Set up registers for signal handler.  */
4356     env->gpr[1] = newsp;
4357     env->gpr[3] = signal;
4358     env->gpr[4] = (target_ulong) h2g(sc);
4359     env->nip = (target_ulong) ka->_sa_handler;
4360     /* Signal handlers are entered in big-endian mode.  */
4361     env->msr &= ~MSR_LE;
4362
4363     unlock_user_struct(frame, frame_addr, 1);
4364     return;
4365
4366 sigsegv:
4367     unlock_user_struct(frame, frame_addr, 1);
4368     if (logfile)
4369         fprintf (logfile, "segfaulting from setup_frame\n");
4370     force_sig(TARGET_SIGSEGV);
4371 }
4372
4373 static void setup_rt_frame(int sig, struct target_sigaction *ka,
4374                            target_siginfo_t *info,
4375                            target_sigset_t *set, CPUState *env)
4376 {
4377     struct target_rt_sigframe *rt_sf;
4378     struct target_mcontext *frame;
4379     target_ulong rt_sf_addr, newsp = 0;
4380     int i, err = 0;
4381     int signal;
4382
4383     rt_sf_addr = get_sigframe(ka, env, sizeof(*rt_sf));
4384     if (!lock_user_struct(VERIFY_WRITE, rt_sf, rt_sf_addr, 1))
4385         goto sigsegv;
4386
4387     signal = current_exec_domain_sig(sig);
4388
4389     err |= copy_siginfo_to_user(&rt_sf->info, info);
4390
4391     err |= __put_user(0, &rt_sf->uc.tuc_flags);
4392     err |= __put_user(0, &rt_sf->uc.tuc_link);
4393     err |= __put_user((target_ulong)target_sigaltstack_used.ss_sp,
4394                       &rt_sf->uc.tuc_stack.ss_sp);
4395     err |= __put_user(sas_ss_flags(env->gpr[1]),
4396                       &rt_sf->uc.tuc_stack.ss_flags);
4397     err |= __put_user(target_sigaltstack_used.ss_size,
4398                       &rt_sf->uc.tuc_stack.ss_size);
4399     err |= __put_user(h2g (&rt_sf->uc.tuc_mcontext),
4400                       &rt_sf->uc.tuc_regs);
4401     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
4402         err |= __put_user(set->sig[i], &rt_sf->uc.tuc_sigmask.sig[i]);
4403     }
4404
4405     frame = &rt_sf->uc.tuc_mcontext;
4406     err |= save_user_regs(env, frame, TARGET_NR_rt_sigreturn);
4407
4408     /* The kernel checks for the presence of a VDSO here.  We don't
4409        emulate a vdso, so use a sigreturn system call.  */
4410     env->lr = (target_ulong) h2g(frame->tramp);
4411
4412     /* Turn off all fp exceptions.  */
4413     env->fpscr = 0;
4414
4415     /* Create a stack frame for the caller of the handler.  */
4416     newsp = rt_sf_addr - (SIGNAL_FRAMESIZE + 16);
4417     err |= __put_user(env->gpr[1], (target_ulong *)(uintptr_t) newsp);
4418
4419     if (err)
4420         goto sigsegv;
4421
4422     /* Set up registers for signal handler.  */
4423     env->gpr[1] = newsp;
4424     env->gpr[3] = (target_ulong) signal;
4425     env->gpr[4] = (target_ulong) h2g(&rt_sf->info);
4426     env->gpr[5] = (target_ulong) h2g(&rt_sf->uc);
4427     env->gpr[6] = (target_ulong) h2g(rt_sf);
4428     env->nip = (target_ulong) ka->_sa_handler;
4429     /* Signal handlers are entered in big-endian mode.  */
4430     env->msr &= ~MSR_LE;
4431
4432     unlock_user_struct(rt_sf, rt_sf_addr, 1);
4433     return;
4434
4435 sigsegv:
4436     unlock_user_struct(rt_sf, rt_sf_addr, 1);
4437     if (logfile)
4438         fprintf (logfile, "segfaulting from setup_rt_frame\n");
4439     force_sig(TARGET_SIGSEGV);
4440
4441 }
4442
4443 long do_sigreturn(CPUState *env)
4444 {
4445     struct target_sigcontext *sc = NULL;
4446     struct target_mcontext *sr = NULL;
4447     target_ulong sr_addr, sc_addr;
4448     sigset_t blocked;
4449     target_sigset_t set;
4450
4451     sc_addr = env->gpr[1] + SIGNAL_FRAMESIZE;
4452     if (!lock_user_struct(VERIFY_READ, sc, sc_addr, 1))
4453         goto sigsegv;
4454
4455 #if defined(TARGET_PPC64)
4456     set.sig[0] = sc->oldmask + ((long)(sc->_unused[3]) << 32);
4457 #else
4458     if(__get_user(set.sig[0], &sc->oldmask) ||
4459        __get_user(set.sig[1], &sc->_unused[3]))
4460        goto sigsegv;
4461 #endif
4462     target_to_host_sigset_internal(&blocked, &set);
4463     sigprocmask(SIG_SETMASK, &blocked, NULL);
4464
4465     if (__get_user(sr_addr, &sc->regs))
4466         goto sigsegv;
4467     if (!lock_user_struct(VERIFY_READ, sr, sr_addr, 1))
4468         goto sigsegv;
4469     if (restore_user_regs(env, sr, 1))
4470         goto sigsegv;
4471
4472     unlock_user_struct(sr, sr_addr, 1);
4473     unlock_user_struct(sc, sc_addr, 1);
4474     return -TARGET_QEMU_ESIGRETURN;
4475
4476 sigsegv:
4477     unlock_user_struct(sr, sr_addr, 1);
4478     unlock_user_struct(sc, sc_addr, 1);
4479     if (logfile)
4480         fprintf (logfile, "segfaulting from do_sigreturn\n");
4481     force_sig(TARGET_SIGSEGV);
4482     return 0;
4483 }
4484
4485 /* See arch/powerpc/kernel/signal_32.c.  */
4486 static int do_setcontext(struct target_ucontext *ucp, CPUState *env, int sig)
4487 {
4488     struct target_mcontext *mcp;
4489     target_ulong mcp_addr;
4490     sigset_t blocked;
4491     target_sigset_t set;
4492
4493     if (copy_from_user(&set, h2g(ucp) + offsetof(struct target_ucontext, tuc_sigmask),
4494                        sizeof (set)))
4495         return 1;
4496
4497 #if defined(TARGET_PPC64)
4498     fprintf (stderr, "do_setcontext: not implemented\n");
4499     return 0;
4500 #else
4501     if (__get_user(mcp_addr, &ucp->tuc_regs))
4502         return 1;
4503
4504     if (!lock_user_struct(VERIFY_READ, mcp, mcp_addr, 1))
4505         return 1;
4506
4507     target_to_host_sigset_internal(&blocked, &set);
4508     sigprocmask(SIG_SETMASK, &blocked, NULL);
4509     if (restore_user_regs(env, mcp, sig))
4510         goto sigsegv;
4511
4512     unlock_user_struct(mcp, mcp_addr, 1);
4513     return 0;
4514
4515 sigsegv:
4516     unlock_user_struct(mcp, mcp_addr, 1);
4517     return 1;
4518 #endif
4519 }
4520
4521 long do_rt_sigreturn(CPUState *env)
4522 {
4523     struct target_rt_sigframe *rt_sf = NULL;
4524     target_ulong rt_sf_addr;
4525
4526     rt_sf_addr = env->gpr[1] + SIGNAL_FRAMESIZE + 16;
4527     if (!lock_user_struct(VERIFY_READ, rt_sf, rt_sf_addr, 1))
4528         goto sigsegv;
4529
4530     if (do_setcontext(&rt_sf->uc, env, 1))
4531         goto sigsegv;
4532
4533     do_sigaltstack(rt_sf_addr
4534                    + offsetof(struct target_rt_sigframe, uc.tuc_stack),
4535                    0, env->gpr[1]);
4536
4537     unlock_user_struct(rt_sf, rt_sf_addr, 1);
4538     return -TARGET_QEMU_ESIGRETURN;
4539
4540 sigsegv:
4541     unlock_user_struct(rt_sf, rt_sf_addr, 1);
4542     if (logfile)
4543         fprintf (logfile, "segfaulting from do_rt_sigreturn\n");
4544     force_sig(TARGET_SIGSEGV);
4545     return 0;
4546 }
4547
4548 #elif defined(TARGET_M68K)
4549
4550 struct target_sigcontext {
4551     abi_ulong  sc_mask;
4552     abi_ulong  sc_usp;
4553     abi_ulong  sc_d0;
4554     abi_ulong  sc_d1;
4555     abi_ulong  sc_a0;
4556     abi_ulong  sc_a1;
4557     unsigned short sc_sr;
4558     abi_ulong  sc_pc;
4559 };
4560
4561 struct target_sigframe
4562 {
4563     abi_ulong pretcode;
4564     int sig;
4565     int code;
4566     abi_ulong psc;
4567     char retcode[8];
4568     abi_ulong extramask[TARGET_NSIG_WORDS-1];
4569     struct target_sigcontext sc;
4570 };
4571  
4572 typedef int target_greg_t;
4573 #define TARGET_NGREG 18
4574 typedef target_greg_t target_gregset_t[TARGET_NGREG];
4575
4576 typedef struct target_fpregset {
4577     int f_fpcntl[3];
4578     int f_fpregs[8*3];
4579 } target_fpregset_t;
4580
4581 struct target_mcontext {
4582     int version;
4583     target_gregset_t gregs;
4584     target_fpregset_t fpregs;
4585 };
4586
4587 #define TARGET_MCONTEXT_VERSION 2
4588
4589 struct target_ucontext {
4590     abi_ulong tuc_flags;
4591     abi_ulong tuc_link;
4592     target_stack_t tuc_stack;
4593     struct target_mcontext tuc_mcontext;
4594     abi_long tuc_filler[80];
4595     target_sigset_t tuc_sigmask;
4596 };
4597
4598 struct target_rt_sigframe
4599 {
4600     abi_ulong pretcode;
4601     int sig;
4602     abi_ulong pinfo;
4603     abi_ulong puc;
4604     char retcode[8];
4605     struct target_siginfo info;
4606     struct target_ucontext uc;
4607 };
4608
4609 static int
4610 setup_sigcontext(struct target_sigcontext *sc, CPUState *env, abi_ulong mask)
4611 {
4612     int err = 0;
4613
4614     err |= __put_user(mask, &sc->sc_mask);
4615     err |= __put_user(env->aregs[7], &sc->sc_usp);
4616     err |= __put_user(env->dregs[0], &sc->sc_d0);
4617     err |= __put_user(env->dregs[1], &sc->sc_d1);
4618     err |= __put_user(env->aregs[0], &sc->sc_a0);
4619     err |= __put_user(env->aregs[1], &sc->sc_a1);
4620     err |= __put_user(env->sr, &sc->sc_sr);
4621     err |= __put_user(env->pc, &sc->sc_pc);
4622
4623     return err;
4624 }
4625
4626 static int
4627 restore_sigcontext(CPUState *env, struct target_sigcontext *sc, int *pd0)
4628 {
4629     int err = 0;
4630     int temp;
4631
4632     err |= __get_user(env->aregs[7], &sc->sc_usp);
4633     err |= __get_user(env->dregs[1], &sc->sc_d1);
4634     err |= __get_user(env->aregs[0], &sc->sc_a0);
4635     err |= __get_user(env->aregs[1], &sc->sc_a1);
4636     err |= __get_user(env->pc, &sc->sc_pc);
4637     err |= __get_user(temp, &sc->sc_sr);
4638     env->sr = (env->sr & 0xff00) | (temp & 0xff);
4639
4640     *pd0 = tswapl(sc->sc_d0);
4641
4642     return err;
4643 }
4644
4645 /*
4646  * Determine which stack to use..
4647  */
4648 static inline abi_ulong
4649 get_sigframe(struct target_sigaction *ka, CPUState *regs, size_t frame_size)
4650 {
4651     unsigned long sp;
4652
4653     sp = regs->aregs[7];
4654
4655     /* This is the X/Open sanctioned signal stack switching.  */
4656     if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
4657         sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
4658     }
4659
4660     return ((sp - frame_size) & -8UL);
4661 }
4662
4663 static void setup_frame(int sig, struct target_sigaction *ka,
4664                         target_sigset_t *set, CPUState *env)
4665 {
4666     struct target_sigframe *frame;
4667     abi_ulong frame_addr;
4668     abi_ulong retcode_addr;
4669     abi_ulong sc_addr;
4670     int err = 0;
4671     int i;
4672
4673     frame_addr = get_sigframe(ka, env, sizeof *frame);
4674     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
4675         goto give_sigsegv;
4676
4677     err |= __put_user(sig, &frame->sig);
4678
4679     sc_addr = frame_addr + offsetof(struct target_sigframe, sc);
4680     err |= __put_user(sc_addr, &frame->psc);
4681
4682     err |= setup_sigcontext(&frame->sc, env, set->sig[0]);
4683     if (err)
4684         goto give_sigsegv;
4685
4686     for(i = 1; i < TARGET_NSIG_WORDS; i++) {
4687         if (__put_user(set->sig[i], &frame->extramask[i - 1]))
4688             goto give_sigsegv;
4689     }
4690
4691     /* Set up to return from userspace.  */
4692
4693     retcode_addr = frame_addr + offsetof(struct target_sigframe, retcode);
4694     err |= __put_user(retcode_addr, &frame->pretcode);
4695
4696     /* moveq #,d0; trap #0 */
4697
4698     err |= __put_user(0x70004e40 + (TARGET_NR_sigreturn << 16),
4699                       (long *)(frame->retcode));
4700
4701     if (err)
4702         goto give_sigsegv;
4703
4704     /* Set up to return from userspace */
4705
4706     env->aregs[7] = frame_addr;
4707     env->pc = ka->_sa_handler;
4708
4709     unlock_user_struct(frame, frame_addr, 1);
4710     return;
4711
4712 give_sigsegv:
4713     unlock_user_struct(frame, frame_addr, 1);
4714     force_sig(TARGET_SIGSEGV);
4715 }
4716
4717 static inline int target_rt_setup_ucontext(struct target_ucontext *uc,
4718                                            CPUState *env)
4719 {
4720     target_greg_t *gregs = uc->tuc_mcontext.gregs;
4721     int err;
4722
4723     err = __put_user(TARGET_MCONTEXT_VERSION, &uc->tuc_mcontext.version);
4724     err |= __put_user(env->dregs[0], &gregs[0]);
4725     err |= __put_user(env->dregs[1], &gregs[1]);
4726     err |= __put_user(env->dregs[2], &gregs[2]);
4727     err |= __put_user(env->dregs[3], &gregs[3]);
4728     err |= __put_user(env->dregs[4], &gregs[4]);
4729     err |= __put_user(env->dregs[5], &gregs[5]);
4730     err |= __put_user(env->dregs[6], &gregs[6]);
4731     err |= __put_user(env->dregs[7], &gregs[7]);
4732     err |= __put_user(env->aregs[0], &gregs[8]);
4733     err |= __put_user(env->aregs[1], &gregs[9]);
4734     err |= __put_user(env->aregs[2], &gregs[10]);
4735     err |= __put_user(env->aregs[3], &gregs[11]);
4736     err |= __put_user(env->aregs[4], &gregs[12]);
4737     err |= __put_user(env->aregs[5], &gregs[13]);
4738     err |= __put_user(env->aregs[6], &gregs[14]);
4739     err |= __put_user(env->aregs[7], &gregs[15]);
4740     err |= __put_user(env->pc, &gregs[16]);
4741     err |= __put_user(env->sr, &gregs[17]);
4742
4743     return err;
4744 }
4745  
4746 static inline int target_rt_restore_ucontext(CPUState *env,
4747                                              struct target_ucontext *uc,
4748                                              int *pd0)
4749 {
4750     int temp;
4751     int err;
4752     target_greg_t *gregs = uc->tuc_mcontext.gregs;
4753     
4754     err = __get_user(temp, &uc->tuc_mcontext.version);
4755     if (temp != TARGET_MCONTEXT_VERSION)
4756         goto badframe;
4757
4758     /* restore passed registers */
4759     err |= __get_user(env->dregs[0], &gregs[0]);
4760     err |= __get_user(env->dregs[1], &gregs[1]);
4761     err |= __get_user(env->dregs[2], &gregs[2]);
4762     err |= __get_user(env->dregs[3], &gregs[3]);
4763     err |= __get_user(env->dregs[4], &gregs[4]);
4764     err |= __get_user(env->dregs[5], &gregs[5]);
4765     err |= __get_user(env->dregs[6], &gregs[6]);
4766     err |= __get_user(env->dregs[7], &gregs[7]);
4767     err |= __get_user(env->aregs[0], &gregs[8]);
4768     err |= __get_user(env->aregs[1], &gregs[9]);
4769     err |= __get_user(env->aregs[2], &gregs[10]);
4770     err |= __get_user(env->aregs[3], &gregs[11]);
4771     err |= __get_user(env->aregs[4], &gregs[12]);
4772     err |= __get_user(env->aregs[5], &gregs[13]);
4773     err |= __get_user(env->aregs[6], &gregs[14]);
4774     err |= __get_user(env->aregs[7], &gregs[15]);
4775     err |= __get_user(env->pc, &gregs[16]);
4776     err |= __get_user(temp, &gregs[17]);
4777     env->sr = (env->sr & 0xff00) | (temp & 0xff);
4778
4779     *pd0 = env->dregs[0];
4780     return err;
4781
4782 badframe:
4783     return 1;
4784 }
4785
4786 static void setup_rt_frame(int sig, struct target_sigaction *ka,
4787                            target_siginfo_t *info,
4788                            target_sigset_t *set, CPUState *env)
4789 {
4790     struct target_rt_sigframe *frame;
4791     abi_ulong frame_addr;
4792     abi_ulong retcode_addr;
4793     abi_ulong info_addr;
4794     abi_ulong uc_addr;
4795     int err = 0;
4796     int i;
4797
4798     frame_addr = get_sigframe(ka, env, sizeof *frame);
4799     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
4800         goto give_sigsegv;
4801
4802     err |= __put_user(sig, &frame->sig);
4803
4804     info_addr = frame_addr + offsetof(struct target_rt_sigframe, info);
4805     err |= __put_user(info_addr, &frame->pinfo);
4806
4807     uc_addr = frame_addr + offsetof(struct target_rt_sigframe, uc);
4808     err |= __put_user(uc_addr, &frame->puc);
4809
4810     err |= copy_siginfo_to_user(&frame->info, info);
4811
4812     /* Create the ucontext */
4813
4814     err |= __put_user(0, &frame->uc.tuc_flags);
4815     err |= __put_user(0, &frame->uc.tuc_link);
4816     err |= __put_user(target_sigaltstack_used.ss_sp,
4817                       &frame->uc.tuc_stack.ss_sp);
4818     err |= __put_user(sas_ss_flags(env->aregs[7]),
4819                       &frame->uc.tuc_stack.ss_flags);
4820     err |= __put_user(target_sigaltstack_used.ss_size,
4821                       &frame->uc.tuc_stack.ss_size);
4822     err |= target_rt_setup_ucontext(&frame->uc, env);
4823
4824     if (err)
4825             goto give_sigsegv;
4826
4827     for(i = 0; i < TARGET_NSIG_WORDS; i++) {
4828         if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
4829             goto give_sigsegv;
4830     }
4831
4832     /* Set up to return from userspace.  */
4833
4834     retcode_addr = frame_addr + offsetof(struct target_sigframe, retcode);
4835     err |= __put_user(retcode_addr, &frame->pretcode);
4836
4837     /* moveq #,d0; notb d0; trap #0 */
4838
4839     err |= __put_user(0x70004600 + ((TARGET_NR_rt_sigreturn ^ 0xff) << 16),
4840                       (long *)(frame->retcode + 0));
4841     err |= __put_user(0x4e40, (short *)(frame->retcode + 4));
4842
4843     if (err)
4844         goto give_sigsegv;
4845
4846     /* Set up to return from userspace */
4847
4848     env->aregs[7] = frame_addr;
4849     env->pc = ka->_sa_handler;
4850
4851     unlock_user_struct(frame, frame_addr, 1);
4852     return;
4853
4854 give_sigsegv:
4855     unlock_user_struct(frame, frame_addr, 1);
4856     force_sig(TARGET_SIGSEGV);
4857 }
4858
4859 long do_sigreturn(CPUState *env)
4860 {
4861     struct target_sigframe *frame;
4862     abi_ulong frame_addr = env->aregs[7] - 4;
4863     target_sigset_t target_set;
4864     sigset_t set;
4865     int d0, i;
4866
4867     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
4868         goto badframe;
4869
4870     /* set blocked signals */
4871
4872     if (__get_user(target_set.sig[0], &frame->sc.sc_mask))
4873         goto badframe;
4874
4875     for(i = 1; i < TARGET_NSIG_WORDS; i++) {
4876         if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
4877             goto badframe;
4878     }
4879
4880     target_to_host_sigset_internal(&set, &target_set);
4881     sigprocmask(SIG_SETMASK, &set, NULL);
4882
4883     /* restore registers */
4884
4885     if (restore_sigcontext(env, &frame->sc, &d0))
4886         goto badframe;
4887
4888     unlock_user_struct(frame, frame_addr, 0);
4889     return d0;
4890
4891 badframe:
4892     unlock_user_struct(frame, frame_addr, 0);
4893     force_sig(TARGET_SIGSEGV);
4894     return 0;
4895 }
4896
4897 long do_rt_sigreturn(CPUState *env)
4898 {
4899     struct target_rt_sigframe *frame;
4900     abi_ulong frame_addr = env->aregs[7] - 4;
4901     target_sigset_t target_set;
4902     sigset_t set;
4903     int d0;
4904
4905     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
4906         goto badframe;
4907
4908     target_to_host_sigset_internal(&set, &target_set);
4909     sigprocmask(SIG_SETMASK, &set, NULL);
4910
4911     /* restore registers */
4912
4913     if (target_rt_restore_ucontext(env, &frame->uc, &d0))
4914         goto badframe;
4915
4916     if (do_sigaltstack(frame_addr +
4917                        offsetof(struct target_rt_sigframe, uc.tuc_stack),
4918                        0, get_sp_from_cpustate(env)) == -EFAULT)
4919         goto badframe;
4920
4921     unlock_user_struct(frame, frame_addr, 0);
4922     return d0;
4923
4924 badframe:
4925     unlock_user_struct(frame, frame_addr, 0);
4926     force_sig(TARGET_SIGSEGV);
4927     return 0;
4928 }
4929
4930 #elif defined(TARGET_ALPHA)
4931
4932 struct target_sigcontext {
4933     abi_long sc_onstack;
4934     abi_long sc_mask;
4935     abi_long sc_pc;
4936     abi_long sc_ps;
4937     abi_long sc_regs[32];
4938     abi_long sc_ownedfp;
4939     abi_long sc_fpregs[32];
4940     abi_ulong sc_fpcr;
4941     abi_ulong sc_fp_control;
4942     abi_ulong sc_reserved1;
4943     abi_ulong sc_reserved2;
4944     abi_ulong sc_ssize;
4945     abi_ulong sc_sbase;
4946     abi_ulong sc_traparg_a0;
4947     abi_ulong sc_traparg_a1;
4948     abi_ulong sc_traparg_a2;
4949     abi_ulong sc_fp_trap_pc;
4950     abi_ulong sc_fp_trigger_sum;
4951     abi_ulong sc_fp_trigger_inst;
4952 };
4953
4954 struct target_ucontext {
4955     abi_ulong tuc_flags;
4956     abi_ulong tuc_link;
4957     abi_ulong tuc_osf_sigmask;
4958     target_stack_t tuc_stack;
4959     struct target_sigcontext tuc_mcontext;
4960     target_sigset_t tuc_sigmask;
4961 };
4962
4963 struct target_sigframe {
4964     struct target_sigcontext sc;
4965     unsigned int retcode[3];
4966 };
4967
4968 struct target_rt_sigframe {
4969     target_siginfo_t info;
4970     struct target_ucontext uc;
4971     unsigned int retcode[3];
4972 };
4973
4974 #define INSN_MOV_R30_R16        0x47fe0410
4975 #define INSN_LDI_R0             0x201f0000
4976 #define INSN_CALLSYS            0x00000083
4977
4978 static int setup_sigcontext(struct target_sigcontext *sc, CPUState *env,
4979                             abi_ulong frame_addr, target_sigset_t *set)
4980 {
4981     int i, err = 0;
4982
4983     err |= __put_user(on_sig_stack(frame_addr), &sc->sc_onstack);
4984     err |= __put_user(set->sig[0], &sc->sc_mask);
4985     err |= __put_user(env->pc, &sc->sc_pc);
4986     err |= __put_user(8, &sc->sc_ps);
4987
4988     for (i = 0; i < 31; ++i) {
4989         err |= __put_user(env->ir[i], &sc->sc_regs[i]);
4990     }
4991     err |= __put_user(0, &sc->sc_regs[31]);
4992
4993     for (i = 0; i < 31; ++i) {
4994         err |= __put_user(env->fir[i], &sc->sc_fpregs[i]);
4995     }
4996     err |= __put_user(0, &sc->sc_fpregs[31]);
4997     err |= __put_user(cpu_alpha_load_fpcr(env), &sc->sc_fpcr);
4998
4999     err |= __put_user(0, &sc->sc_traparg_a0); /* FIXME */
5000     err |= __put_user(0, &sc->sc_traparg_a1); /* FIXME */
5001     err |= __put_user(0, &sc->sc_traparg_a2); /* FIXME */
5002
5003     return err;
5004 }
5005
5006 static int restore_sigcontext(CPUState *env, struct target_sigcontext *sc)
5007 {
5008     uint64_t fpcr;
5009     int i, err = 0;
5010
5011     err |= __get_user(env->pc, &sc->sc_pc);
5012
5013     for (i = 0; i < 31; ++i) {
5014         err |= __get_user(env->ir[i], &sc->sc_regs[i]);
5015     }
5016     for (i = 0; i < 31; ++i) {
5017         err |= __get_user(env->fir[i], &sc->sc_fpregs[i]);
5018     }
5019
5020     err |= __get_user(fpcr, &sc->sc_fpcr);
5021     cpu_alpha_store_fpcr(env, fpcr);
5022
5023     return err;
5024 }
5025
5026 static inline abi_ulong get_sigframe(struct target_sigaction *sa,
5027                                      CPUState *env, unsigned long framesize)
5028 {
5029     abi_ulong sp = env->ir[IR_SP];
5030
5031     /* This is the X/Open sanctioned signal stack switching.  */
5032     if ((sa->sa_flags & TARGET_SA_ONSTACK) != 0 && !sas_ss_flags(sp)) {
5033         sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
5034     }
5035     return (sp - framesize) & -32;
5036 }
5037
5038 static void setup_frame(int sig, struct target_sigaction *ka,
5039                         target_sigset_t *set, CPUState *env)
5040 {
5041     abi_ulong frame_addr, r26;
5042     struct target_sigframe *frame;
5043     int err = 0;
5044
5045     frame_addr = get_sigframe(ka, env, sizeof(*frame));
5046     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
5047         goto give_sigsegv;
5048     }
5049
5050     err |= setup_sigcontext(&frame->sc, env, frame_addr, set);
5051
5052     if (ka->sa_restorer) {
5053         r26 = ka->sa_restorer;
5054     } else {
5055         err |= __put_user(INSN_MOV_R30_R16, &frame->retcode[0]);
5056         err |= __put_user(INSN_LDI_R0 + TARGET_NR_sigreturn,
5057                           &frame->retcode[1]);
5058         err |= __put_user(INSN_CALLSYS, &frame->retcode[2]);
5059         /* imb() */
5060         r26 = frame_addr;
5061     }
5062
5063     unlock_user_struct(frame, frame_addr, 1);
5064
5065     if (err) {
5066     give_sigsegv:
5067         if (sig == TARGET_SIGSEGV) {
5068             ka->_sa_handler = TARGET_SIG_DFL;
5069         }
5070         force_sig(TARGET_SIGSEGV);
5071     }
5072
5073     env->ir[IR_RA] = r26;
5074     env->ir[IR_PV] = env->pc = ka->_sa_handler;
5075     env->ir[IR_A0] = sig;
5076     env->ir[IR_A1] = 0;
5077     env->ir[IR_A2] = frame_addr + offsetof(struct target_sigframe, sc);
5078     env->ir[IR_SP] = frame_addr;
5079 }
5080
5081 static void setup_rt_frame(int sig, struct target_sigaction *ka,
5082                            target_siginfo_t *info,
5083                            target_sigset_t *set, CPUState *env)
5084 {
5085     abi_ulong frame_addr, r26;
5086     struct target_rt_sigframe *frame;
5087     int i, err = 0;
5088
5089     frame_addr = get_sigframe(ka, env, sizeof(*frame));
5090     if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0)) {
5091         goto give_sigsegv;
5092     }
5093
5094     err |= copy_siginfo_to_user(&frame->info, info);
5095
5096     err |= __put_user(0, &frame->uc.tuc_flags);
5097     err |= __put_user(0, &frame->uc.tuc_link);
5098     err |= __put_user(set->sig[0], &frame->uc.tuc_osf_sigmask);
5099     err |= __put_user(target_sigaltstack_used.ss_sp,
5100                       &frame->uc.tuc_stack.ss_sp);
5101     err |= __put_user(sas_ss_flags(env->ir[IR_SP]),
5102                       &frame->uc.tuc_stack.ss_flags);
5103     err |= __put_user(target_sigaltstack_used.ss_size,
5104                       &frame->uc.tuc_stack.ss_size);
5105     err |= setup_sigcontext(&frame->uc.tuc_mcontext, env, frame_addr, set);
5106     for (i = 0; i < TARGET_NSIG_WORDS; ++i) {
5107         err |= __put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]);
5108     }
5109
5110     if (ka->sa_restorer) {
5111         r26 = ka->sa_restorer;
5112     } else {
5113         err |= __put_user(INSN_MOV_R30_R16, &frame->retcode[0]);
5114         err |= __put_user(INSN_LDI_R0 + TARGET_NR_rt_sigreturn,
5115                           &frame->retcode[1]);
5116         err |= __put_user(INSN_CALLSYS, &frame->retcode[2]);
5117         /* imb(); */
5118         r26 = frame_addr;
5119     }
5120
5121     if (err) {
5122     give_sigsegv:
5123        if (sig == TARGET_SIGSEGV) {
5124             ka->_sa_handler = TARGET_SIG_DFL;
5125         }
5126         force_sig(TARGET_SIGSEGV);
5127     }
5128
5129     env->ir[IR_RA] = r26;
5130     env->ir[IR_PV] = env->pc = ka->_sa_handler;
5131     env->ir[IR_A0] = sig;
5132     env->ir[IR_A1] = frame_addr + offsetof(struct target_rt_sigframe, info);
5133     env->ir[IR_A2] = frame_addr + offsetof(struct target_rt_sigframe, uc);
5134     env->ir[IR_SP] = frame_addr;
5135 }
5136
5137 long do_sigreturn(CPUState *env)
5138 {
5139     struct target_sigcontext *sc;
5140     abi_ulong sc_addr = env->ir[IR_A0];
5141     target_sigset_t target_set;
5142     sigset_t set;
5143
5144     if (!lock_user_struct(VERIFY_READ, sc, sc_addr, 1)) {
5145         goto badframe;
5146     }
5147
5148     target_sigemptyset(&target_set);
5149     if (__get_user(target_set.sig[0], &sc->sc_mask)) {
5150         goto badframe;
5151     }
5152
5153     target_to_host_sigset_internal(&set, &target_set);
5154     sigprocmask(SIG_SETMASK, &set, NULL);
5155
5156     if (restore_sigcontext(env, sc)) {
5157         goto badframe;
5158     }
5159     unlock_user_struct(sc, sc_addr, 0);
5160     return env->ir[IR_V0];
5161
5162  badframe:
5163     unlock_user_struct(sc, sc_addr, 0);
5164     force_sig(TARGET_SIGSEGV);
5165 }
5166
5167 long do_rt_sigreturn(CPUState *env)
5168 {
5169     abi_ulong frame_addr = env->ir[IR_A0];
5170     struct target_rt_sigframe *frame;
5171     sigset_t set;
5172
5173     if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1)) {
5174         goto badframe;
5175     }
5176     target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
5177     sigprocmask(SIG_SETMASK, &set, NULL);
5178
5179     if (restore_sigcontext(env, &frame->uc.tuc_mcontext)) {
5180         goto badframe;
5181     }
5182     if (do_sigaltstack(frame_addr + offsetof(struct target_rt_sigframe,
5183                                              uc.tuc_stack),
5184                        0, env->ir[IR_SP]) == -EFAULT) {
5185         goto badframe;
5186     }
5187
5188     unlock_user_struct(frame, frame_addr, 0);
5189     return env->ir[IR_V0];
5190
5191
5192  badframe:
5193     unlock_user_struct(frame, frame_addr, 0);
5194     force_sig(TARGET_SIGSEGV);
5195 }
5196
5197 #else
5198
5199 static void setup_frame(int sig, struct target_sigaction *ka,
5200                         target_sigset_t *set, CPUState *env)
5201 {
5202     fprintf(stderr, "setup_frame: not implemented\n");
5203 }
5204
5205 static void setup_rt_frame(int sig, struct target_sigaction *ka,
5206                            target_siginfo_t *info,
5207                            target_sigset_t *set, CPUState *env)
5208 {
5209     fprintf(stderr, "setup_rt_frame: not implemented\n");
5210 }
5211
5212 long do_sigreturn(CPUState *env)
5213 {
5214     fprintf(stderr, "do_sigreturn: not implemented\n");
5215     return -TARGET_ENOSYS;
5216 }
5217
5218 long do_rt_sigreturn(CPUState *env)
5219 {
5220     fprintf(stderr, "do_rt_sigreturn: not implemented\n");
5221     return -TARGET_ENOSYS;
5222 }
5223
5224 #endif
5225
5226 void process_pending_signals(CPUState *cpu_env)
5227 {
5228     int sig;
5229     abi_ulong handler;
5230     sigset_t set, old_set;
5231     target_sigset_t target_old_set;
5232     struct emulated_sigtable *k;
5233     struct target_sigaction *sa;
5234     struct sigqueue *q;
5235     TaskState *ts = cpu_env->opaque;
5236
5237     if (!ts->signal_pending)
5238         return;
5239
5240     /* FIXME: This is not threadsafe.  */
5241     k = ts->sigtab;
5242     for(sig = 1; sig <= TARGET_NSIG; sig++) {
5243         if (k->pending)
5244             goto handle_signal;
5245         k++;
5246     }
5247     /* if no signal is pending, just return */
5248     ts->signal_pending = 0;
5249     return;
5250
5251  handle_signal:
5252 #ifdef DEBUG_SIGNAL
5253     fprintf(stderr, "qemu: process signal %d\n", sig);
5254 #endif
5255     /* dequeue signal */
5256     q = k->first;
5257     k->first = q->next;
5258     if (!k->first)
5259         k->pending = 0;
5260
5261     sig = gdb_handlesig (cpu_env, sig);
5262     if (!sig) {
5263         sa = NULL;
5264         handler = TARGET_SIG_IGN;
5265     } else {
5266         sa = &sigact_table[sig - 1];
5267         handler = sa->_sa_handler;
5268     }
5269
5270     if (handler == TARGET_SIG_DFL) {
5271         /* default handler : ignore some signal. The other are job control or fatal */
5272         if (sig == TARGET_SIGTSTP || sig == TARGET_SIGTTIN || sig == TARGET_SIGTTOU) {
5273             kill(getpid(),SIGSTOP);
5274         } else if (sig != TARGET_SIGCHLD &&
5275                    sig != TARGET_SIGURG &&
5276                    sig != TARGET_SIGWINCH &&
5277                    sig != TARGET_SIGCONT) {
5278             force_sig(sig);
5279         }
5280     } else if (handler == TARGET_SIG_IGN) {
5281         /* ignore sig */
5282     } else if (handler == TARGET_SIG_ERR) {
5283         force_sig(sig);
5284     } else {
5285         /* compute the blocked signals during the handler execution */
5286         target_to_host_sigset(&set, &sa->sa_mask);
5287         /* SA_NODEFER indicates that the current signal should not be
5288            blocked during the handler */
5289         if (!(sa->sa_flags & TARGET_SA_NODEFER))
5290             sigaddset(&set, target_to_host_signal(sig));
5291
5292         /* block signals in the handler using Linux */
5293         sigprocmask(SIG_BLOCK, &set, &old_set);
5294         /* save the previous blocked signal state to restore it at the
5295            end of the signal execution (see do_sigreturn) */
5296         host_to_target_sigset_internal(&target_old_set, &old_set);
5297
5298         /* if the CPU is in VM86 mode, we restore the 32 bit values */
5299 #if defined(TARGET_I386) && !defined(TARGET_X86_64)
5300         {
5301             CPUX86State *env = cpu_env;
5302             if (env->eflags & VM_MASK)
5303                 save_v86_state(env);
5304         }
5305 #endif
5306         /* prepare the stack frame of the virtual CPU */
5307         if (sa->sa_flags & TARGET_SA_SIGINFO)
5308             setup_rt_frame(sig, sa, &q->info, &target_old_set, cpu_env);
5309         else
5310             setup_frame(sig, sa, &target_old_set, cpu_env);
5311         if (sa->sa_flags & TARGET_SA_RESETHAND)
5312             sa->_sa_handler = TARGET_SIG_DFL;
5313     }
5314     if (q != &k->info)
5315         free_sigqueue(cpu_env, q);
5316 }
This page took 0.320925 seconds and 4 git commands to generate.