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