]> git.ipfire.org Git - thirdparty/qemu.git/blame - linux-user/signal.c
Linux user memory access API change (initial patch by Thayne Harbaugh)
[thirdparty/qemu.git] / linux-user / signal.c
CommitLineData
31e31b8a 1/*
66fb9763 2 * Emulation of Linux signals
5fafdf24 3 *
31e31b8a
FB
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, write to the Free Software
18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 */
20#include <stdlib.h>
21#include <stdio.h>
66fb9763 22#include <string.h>
31e31b8a 23#include <stdarg.h>
2677e107 24#include <unistd.h>
31e31b8a 25#include <signal.h>
66fb9763 26#include <errno.h>
31e31b8a
FB
27#include <sys/ucontext.h>
28
3ef693a0 29#include "qemu.h"
992f48a0 30#include "target_signal.h"
66fb9763
FB
31
32//#define DEBUG_SIGNAL
33
34#define MAX_SIGQUEUE_SIZE 1024
35
36struct sigqueue {
37 struct sigqueue *next;
9de5e440 38 target_siginfo_t info;
66fb9763 39};
31e31b8a
FB
40
41struct emulated_sigaction {
42 struct target_sigaction sa;
66fb9763
FB
43 int pending; /* true if signal is pending */
44 struct sigqueue *first;
45 struct sigqueue info; /* in order to always have memory for the
46 first signal, we put it here */
31e31b8a
FB
47};
48
a04e134a
TS
49struct target_sigaltstack target_sigaltstack_used = {
50 .ss_sp = 0,
51 .ss_size = 0,
52 .ss_flags = TARGET_SS_DISABLE,
53};
54
66fb9763
FB
55static struct emulated_sigaction sigact_table[TARGET_NSIG];
56static struct sigqueue sigqueue_table[MAX_SIGQUEUE_SIZE]; /* siginfo queue */
57static struct sigqueue *first_free; /* first free siginfo queue entry */
58static int signal_pending; /* non zero if a signal may be pending */
31e31b8a 59
5fafdf24 60static void host_signal_handler(int host_signum, siginfo_t *info,
66fb9763
FB
61 void *puc);
62
9e5f5284
FB
63static uint8_t host_to_target_signal_table[65] = {
64 [SIGHUP] = TARGET_SIGHUP,
65 [SIGINT] = TARGET_SIGINT,
66 [SIGQUIT] = TARGET_SIGQUIT,
67 [SIGILL] = TARGET_SIGILL,
68 [SIGTRAP] = TARGET_SIGTRAP,
69 [SIGABRT] = TARGET_SIGABRT,
01e3b763 70/* [SIGIOT] = TARGET_SIGIOT,*/
9e5f5284
FB
71 [SIGBUS] = TARGET_SIGBUS,
72 [SIGFPE] = TARGET_SIGFPE,
73 [SIGKILL] = TARGET_SIGKILL,
74 [SIGUSR1] = TARGET_SIGUSR1,
75 [SIGSEGV] = TARGET_SIGSEGV,
76 [SIGUSR2] = TARGET_SIGUSR2,
77 [SIGPIPE] = TARGET_SIGPIPE,
78 [SIGALRM] = TARGET_SIGALRM,
79 [SIGTERM] = TARGET_SIGTERM,
80#ifdef SIGSTKFLT
81 [SIGSTKFLT] = TARGET_SIGSTKFLT,
82#endif
83 [SIGCHLD] = TARGET_SIGCHLD,
84 [SIGCONT] = TARGET_SIGCONT,
85 [SIGSTOP] = TARGET_SIGSTOP,
86 [SIGTSTP] = TARGET_SIGTSTP,
87 [SIGTTIN] = TARGET_SIGTTIN,
88 [SIGTTOU] = TARGET_SIGTTOU,
89 [SIGURG] = TARGET_SIGURG,
90 [SIGXCPU] = TARGET_SIGXCPU,
91 [SIGXFSZ] = TARGET_SIGXFSZ,
92 [SIGVTALRM] = TARGET_SIGVTALRM,
93 [SIGPROF] = TARGET_SIGPROF,
94 [SIGWINCH] = TARGET_SIGWINCH,
95 [SIGIO] = TARGET_SIGIO,
96 [SIGPWR] = TARGET_SIGPWR,
97 [SIGSYS] = TARGET_SIGSYS,
98 /* next signals stay the same */
99};
100static uint8_t target_to_host_signal_table[65];
101
a04e134a
TS
102static inline int on_sig_stack(unsigned long sp)
103{
104 return (sp - target_sigaltstack_used.ss_sp
105 < target_sigaltstack_used.ss_size);
106}
107
108static inline int sas_ss_flags(unsigned long sp)
109{
110 return (target_sigaltstack_used.ss_size == 0 ? SS_DISABLE
111 : on_sig_stack(sp) ? SS_ONSTACK : 0);
112}
113
31e31b8a
FB
114static inline int host_to_target_signal(int sig)
115{
9e5f5284 116 return host_to_target_signal_table[sig];
31e31b8a
FB
117}
118
119static inline int target_to_host_signal(int sig)
120{
9e5f5284 121 return target_to_host_signal_table[sig];
31e31b8a
FB
122}
123
5fafdf24 124static void host_to_target_sigset_internal(target_sigset_t *d,
9231944d 125 const sigset_t *s)
66fb9763
FB
126{
127 int i;
9e5f5284
FB
128 unsigned long sigmask;
129 uint32_t target_sigmask;
3b46e624 130
9e5f5284
FB
131 sigmask = ((unsigned long *)s)[0];
132 target_sigmask = 0;
133 for(i = 0; i < 32; i++) {
5fafdf24 134 if (sigmask & (1 << i))
9e5f5284
FB
135 target_sigmask |= 1 << (host_to_target_signal(i + 1) - 1);
136 }
992f48a0 137#if TARGET_ABI_BITS == 32 && HOST_LONG_BITS == 32
9231944d 138 d->sig[0] = target_sigmask;
9e5f5284 139 for(i = 1;i < TARGET_NSIG_WORDS; i++) {
9231944d 140 d->sig[i] = ((unsigned long *)s)[i];
66fb9763 141 }
992f48a0 142#elif TARGET_ABI_BITS == 32 && HOST_LONG_BITS == 64 && TARGET_NSIG_WORDS == 2
9231944d
FB
143 d->sig[0] = target_sigmask;
144 d->sig[1] = sigmask >> 32;
9e5f5284 145#else
a315a145 146#warning host_to_target_sigset
9e5f5284 147#endif
66fb9763
FB
148}
149
9231944d
FB
150void host_to_target_sigset(target_sigset_t *d, const sigset_t *s)
151{
152 target_sigset_t d1;
153 int i;
154
155 host_to_target_sigset_internal(&d1, s);
156 for(i = 0;i < TARGET_NSIG_WORDS; i++)
53a5960a 157 d->sig[i] = tswapl(d1.sig[i]);
9231944d
FB
158}
159
160void target_to_host_sigset_internal(sigset_t *d, const target_sigset_t *s)
66fb9763
FB
161{
162 int i;
9e5f5284 163 unsigned long sigmask;
992f48a0 164 abi_ulong target_sigmask;
9e5f5284 165
9231944d 166 target_sigmask = s->sig[0];
9e5f5284
FB
167 sigmask = 0;
168 for(i = 0; i < 32; i++) {
5fafdf24 169 if (target_sigmask & (1 << i))
9e5f5284
FB
170 sigmask |= 1 << (target_to_host_signal(i + 1) - 1);
171 }
992f48a0 172#if TARGET_ABI_BITS == 32 && HOST_LONG_BITS == 32
9e5f5284
FB
173 ((unsigned long *)d)[0] = sigmask;
174 for(i = 1;i < TARGET_NSIG_WORDS; i++) {
9231944d 175 ((unsigned long *)d)[i] = s->sig[i];
66fb9763 176 }
992f48a0 177#elif TARGET_ABI_BITS == 32 && HOST_LONG_BITS == 64 && TARGET_NSIG_WORDS == 2
9231944d 178 ((unsigned long *)d)[0] = sigmask | ((unsigned long)(s->sig[1]) << 32);
9e5f5284 179#else
a315a145 180#warning target_to_host_sigset
992f48a0 181#endif /* TARGET_ABI_BITS */
66fb9763
FB
182}
183
9231944d
FB
184void target_to_host_sigset(sigset_t *d, const target_sigset_t *s)
185{
186 target_sigset_t s1;
187 int i;
188
189 for(i = 0;i < TARGET_NSIG_WORDS; i++)
53a5960a 190 s1.sig[i] = tswapl(s->sig[i]);
9231944d
FB
191 target_to_host_sigset_internal(d, &s1);
192}
3b46e624 193
992f48a0 194void host_to_target_old_sigset(abi_ulong *old_sigset,
66fb9763
FB
195 const sigset_t *sigset)
196{
9e5f5284
FB
197 target_sigset_t d;
198 host_to_target_sigset(&d, sigset);
199 *old_sigset = d.sig[0];
66fb9763
FB
200}
201
5fafdf24 202void target_to_host_old_sigset(sigset_t *sigset,
992f48a0 203 const abi_ulong *old_sigset)
66fb9763 204{
9e5f5284
FB
205 target_sigset_t d;
206 int i;
207
208 d.sig[0] = *old_sigset;
209 for(i = 1;i < TARGET_NSIG_WORDS; i++)
210 d.sig[i] = 0;
211 target_to_host_sigset(sigset, &d);
66fb9763
FB
212}
213
9de5e440
FB
214/* siginfo conversion */
215
5fafdf24 216static inline void host_to_target_siginfo_noswap(target_siginfo_t *tinfo,
9de5e440 217 const siginfo_t *info)
66fb9763 218{
9de5e440
FB
219 int sig;
220 sig = host_to_target_signal(info->si_signo);
221 tinfo->si_signo = sig;
222 tinfo->si_errno = 0;
223 tinfo->si_code = 0;
5fafdf24 224 if (sig == SIGILL || sig == SIGFPE || sig == SIGSEGV ||
447db213 225 sig == SIGBUS || sig == SIGTRAP) {
9de5e440
FB
226 /* should never come here, but who knows. The information for
227 the target is irrelevant */
228 tinfo->_sifields._sigfault._addr = 0;
7f7f7c84
TS
229 } else if (sig == SIGIO) {
230 tinfo->_sifields._sigpoll._fd = info->si_fd;
9de5e440
FB
231 } else if (sig >= TARGET_SIGRTMIN) {
232 tinfo->_sifields._rt._pid = info->si_pid;
233 tinfo->_sifields._rt._uid = info->si_uid;
234 /* XXX: potential problem if 64 bit */
5fafdf24 235 tinfo->_sifields._rt._sigval.sival_ptr =
992f48a0 236 (abi_ulong)info->si_value.sival_ptr;
9de5e440
FB
237 }
238}
239
5fafdf24 240static void tswap_siginfo(target_siginfo_t *tinfo,
9de5e440
FB
241 const target_siginfo_t *info)
242{
243 int sig;
244 sig = info->si_signo;
245 tinfo->si_signo = tswap32(sig);
66fb9763
FB
246 tinfo->si_errno = tswap32(info->si_errno);
247 tinfo->si_code = tswap32(info->si_code);
5fafdf24 248 if (sig == SIGILL || sig == SIGFPE || sig == SIGSEGV ||
447db213 249 sig == SIGBUS || sig == SIGTRAP) {
5fafdf24 250 tinfo->_sifields._sigfault._addr =
9de5e440 251 tswapl(info->_sifields._sigfault._addr);
7f7f7c84
TS
252 } else if (sig == SIGIO) {
253 tinfo->_sifields._sigpoll._fd = tswap32(info->_sifields._sigpoll._fd);
9de5e440
FB
254 } else if (sig >= TARGET_SIGRTMIN) {
255 tinfo->_sifields._rt._pid = tswap32(info->_sifields._rt._pid);
256 tinfo->_sifields._rt._uid = tswap32(info->_sifields._rt._uid);
5fafdf24 257 tinfo->_sifields._rt._sigval.sival_ptr =
9de5e440
FB
258 tswapl(info->_sifields._rt._sigval.sival_ptr);
259 }
260}
261
262
263void host_to_target_siginfo(target_siginfo_t *tinfo, const siginfo_t *info)
264{
265 host_to_target_siginfo_noswap(tinfo, info);
266 tswap_siginfo(tinfo, tinfo);
66fb9763
FB
267}
268
9de5e440 269/* XXX: we support only POSIX RT signals are used. */
aa1f17c1 270/* XXX: find a solution for 64 bit (additional malloced data is needed) */
9de5e440 271void target_to_host_siginfo(siginfo_t *info, const target_siginfo_t *tinfo)
66fb9763
FB
272{
273 info->si_signo = tswap32(tinfo->si_signo);
274 info->si_errno = tswap32(tinfo->si_errno);
275 info->si_code = tswap32(tinfo->si_code);
9de5e440
FB
276 info->si_pid = tswap32(tinfo->_sifields._rt._pid);
277 info->si_uid = tswap32(tinfo->_sifields._rt._uid);
5fafdf24 278 info->si_value.sival_ptr =
9de5e440 279 (void *)tswapl(tinfo->_sifields._rt._sigval.sival_ptr);
66fb9763
FB
280}
281
31e31b8a
FB
282void signal_init(void)
283{
284 struct sigaction act;
9e5f5284 285 int i, j;
31e31b8a 286
9e5f5284
FB
287 /* generate signal conversion tables */
288 for(i = 1; i <= 64; i++) {
289 if (host_to_target_signal_table[i] == 0)
290 host_to_target_signal_table[i] = i;
291 }
292 for(i = 1; i <= 64; i++) {
293 j = host_to_target_signal_table[i];
294 target_to_host_signal_table[j] = i;
295 }
3b46e624 296
9de5e440
FB
297 /* set all host signal handlers. ALL signals are blocked during
298 the handlers to serialize them. */
299 sigfillset(&act.sa_mask);
31e31b8a
FB
300 act.sa_flags = SA_SIGINFO;
301 act.sa_sigaction = host_signal_handler;
302 for(i = 1; i < NSIG; i++) {
c9087c2a 303 sigaction(i, &act, NULL);
31e31b8a 304 }
3b46e624 305
31e31b8a 306 memset(sigact_table, 0, sizeof(sigact_table));
66fb9763
FB
307
308 first_free = &sigqueue_table[0];
5fafdf24 309 for(i = 0; i < MAX_SIGQUEUE_SIZE - 1; i++)
66fb9763
FB
310 sigqueue_table[i].next = &sigqueue_table[i + 1];
311 sigqueue_table[MAX_SIGQUEUE_SIZE - 1].next = NULL;
312}
313
314/* signal queue handling */
315
316static inline struct sigqueue *alloc_sigqueue(void)
317{
318 struct sigqueue *q = first_free;
319 if (!q)
320 return NULL;
321 first_free = q->next;
322 return q;
31e31b8a
FB
323}
324
66fb9763
FB
325static inline void free_sigqueue(struct sigqueue *q)
326{
327 q->next = first_free;
328 first_free = q;
329}
330
9de5e440
FB
331/* abort execution with signal */
332void __attribute((noreturn)) force_sig(int sig)
66fb9763
FB
333{
334 int host_sig;
66fb9763 335 host_sig = target_to_host_signal(sig);
5fafdf24 336 fprintf(stderr, "qemu: uncaught target signal %d (%s) - exiting\n",
66fb9763 337 sig, strsignal(host_sig));
9de5e440 338#if 1
66fb9763 339 _exit(-host_sig);
9de5e440
FB
340#else
341 {
342 struct sigaction act;
343 sigemptyset(&act.sa_mask);
344 act.sa_flags = SA_SIGINFO;
345 act.sa_sigaction = SIG_DFL;
346 sigaction(SIGABRT, &act, NULL);
347 abort();
348 }
349#endif
66fb9763
FB
350}
351
9de5e440
FB
352/* queue a signal so that it will be send to the virtual CPU as soon
353 as possible */
354int queue_signal(int sig, target_siginfo_t *info)
31e31b8a 355{
66fb9763 356 struct emulated_sigaction *k;
9de5e440 357 struct sigqueue *q, **pq;
992f48a0 358 abi_ulong handler;
66fb9763 359
9de5e440 360#if defined(DEBUG_SIGNAL)
5fafdf24 361 fprintf(stderr, "queue_signal: sig=%d\n",
9de5e440 362 sig);
66fb9763 363#endif
9de5e440 364 k = &sigact_table[sig - 1];
66fb9763
FB
365 handler = k->sa._sa_handler;
366 if (handler == TARGET_SIG_DFL) {
367 /* default handler : ignore some signal. The other are fatal */
5fafdf24
TS
368 if (sig != TARGET_SIGCHLD &&
369 sig != TARGET_SIGURG &&
66fb9763
FB
370 sig != TARGET_SIGWINCH) {
371 force_sig(sig);
9de5e440
FB
372 } else {
373 return 0; /* indicate ignored */
66fb9763
FB
374 }
375 } else if (handler == TARGET_SIG_IGN) {
376 /* ignore signal */
9de5e440 377 return 0;
66fb9763
FB
378 } else if (handler == TARGET_SIG_ERR) {
379 force_sig(sig);
380 } else {
9de5e440
FB
381 pq = &k->first;
382 if (sig < TARGET_SIGRTMIN) {
383 /* if non real time signal, we queue exactly one signal */
384 if (!k->pending)
385 q = &k->info;
386 else
387 return 0;
388 } else {
389 if (!k->pending) {
390 /* first signal */
391 q = &k->info;
392 } else {
393 q = alloc_sigqueue();
394 if (!q)
395 return -EAGAIN;
396 while (*pq != NULL)
397 pq = &(*pq)->next;
398 }
399 }
400 *pq = q;
401 q->info = *info;
402 q->next = NULL;
403 k->pending = 1;
404 /* signal that a new signal is pending */
405 signal_pending = 1;
406 return 1; /* indicates that the signal was queued */
407 }
408}
409
5fafdf24 410static void host_signal_handler(int host_signum, siginfo_t *info,
9de5e440
FB
411 void *puc)
412{
413 int sig;
414 target_siginfo_t tinfo;
415
416 /* the CPU emulator uses some host signals to detect exceptions,
417 we we forward to it some signals */
ec6338ba 418 if (host_signum == SIGSEGV || host_signum == SIGBUS) {
b346ff46 419 if (cpu_signal_handler(host_signum, info, puc))
9de5e440
FB
420 return;
421 }
422
423 /* get target signal number */
424 sig = host_to_target_signal(host_signum);
425 if (sig < 1 || sig > TARGET_NSIG)
426 return;
427#if defined(DEBUG_SIGNAL)
bc8a22cc 428 fprintf(stderr, "qemu: got signal %d\n", sig);
9de5e440
FB
429#endif
430 host_to_target_siginfo_noswap(&tinfo, info);
431 if (queue_signal(sig, &tinfo) == 1) {
432 /* interrupt the virtual CPU as soon as possible */
68a79315 433 cpu_interrupt(global_env, CPU_INTERRUPT_EXIT);
66fb9763
FB
434 }
435}
436
0da46a6e 437/* do_sigaltstack() returns target values and errnos. */
579a97f7
FB
438/* compare linux/kernel/signal.c:do_sigaltstack() */
439abi_long do_sigaltstack(abi_ulong uss_addr, abi_ulong uoss_addr, abi_ulong sp)
a04e134a
TS
440{
441 int ret;
442 struct target_sigaltstack oss;
443
444 /* XXX: test errors */
579a97f7 445 if(uoss_addr)
a04e134a
TS
446 {
447 __put_user(target_sigaltstack_used.ss_sp, &oss.ss_sp);
448 __put_user(target_sigaltstack_used.ss_size, &oss.ss_size);
449 __put_user(sas_ss_flags(sp), &oss.ss_flags);
450 }
451
579a97f7 452 if(uss_addr)
a04e134a 453 {
579a97f7
FB
454 struct target_sigaltstack *uss;
455 struct target_sigaltstack ss;
a04e134a 456
0da46a6e 457 ret = -TARGET_EFAULT;
579a97f7 458 if (!lock_user_struct(VERIFY_READ, uss, uss_addr, 1)
a04e134a
TS
459 || __get_user(ss.ss_sp, &uss->ss_sp)
460 || __get_user(ss.ss_size, &uss->ss_size)
461 || __get_user(ss.ss_flags, &uss->ss_flags))
462 goto out;
579a97f7 463 unlock_user_struct(uss, uss_addr, 0);
a04e134a 464
0da46a6e 465 ret = -TARGET_EPERM;
a04e134a
TS
466 if (on_sig_stack(sp))
467 goto out;
468
0da46a6e 469 ret = -TARGET_EINVAL;
a04e134a
TS
470 if (ss.ss_flags != TARGET_SS_DISABLE
471 && ss.ss_flags != TARGET_SS_ONSTACK
472 && ss.ss_flags != 0)
473 goto out;
474
475 if (ss.ss_flags == TARGET_SS_DISABLE) {
476 ss.ss_size = 0;
477 ss.ss_sp = 0;
478 } else {
0da46a6e 479 ret = -TARGET_ENOMEM;
a04e134a
TS
480 if (ss.ss_size < MINSIGSTKSZ)
481 goto out;
482 }
483
484 target_sigaltstack_used.ss_sp = ss.ss_sp;
485 target_sigaltstack_used.ss_size = ss.ss_size;
486 }
487
579a97f7 488 if (uoss_addr) {
0da46a6e 489 ret = -TARGET_EFAULT;
579a97f7 490 if (copy_to_user(uoss_addr, &oss, sizeof(oss)))
a04e134a 491 goto out;
a04e134a
TS
492 }
493
494 ret = 0;
495out:
496 return ret;
497}
498
0da46a6e 499/* do_sigaction() return host values and errnos */
66fb9763
FB
500int do_sigaction(int sig, const struct target_sigaction *act,
501 struct target_sigaction *oact)
502{
503 struct emulated_sigaction *k;
773b93ee
FB
504 struct sigaction act1;
505 int host_sig;
0da46a6e 506 int ret = 0;
66fb9763 507
0aeaa8ce 508 if (sig < 1 || sig > TARGET_NSIG || sig == SIGKILL || sig == SIGSTOP)
66fb9763
FB
509 return -EINVAL;
510 k = &sigact_table[sig - 1];
773b93ee 511#if defined(DEBUG_SIGNAL)
5fafdf24 512 fprintf(stderr, "sigaction sig=%d act=0x%08x, oact=0x%08x\n",
66fb9763
FB
513 sig, (int)act, (int)oact);
514#endif
515 if (oact) {
516 oact->_sa_handler = tswapl(k->sa._sa_handler);
517 oact->sa_flags = tswapl(k->sa.sa_flags);
388bb21a
TS
518#if !defined(TARGET_MIPS)
519 oact->sa_restorer = tswapl(k->sa.sa_restorer);
520#endif
66fb9763
FB
521 oact->sa_mask = k->sa.sa_mask;
522 }
523 if (act) {
524 k->sa._sa_handler = tswapl(act->_sa_handler);
525 k->sa.sa_flags = tswapl(act->sa_flags);
388bb21a
TS
526#if !defined(TARGET_MIPS)
527 k->sa.sa_restorer = tswapl(act->sa_restorer);
528#endif
66fb9763 529 k->sa.sa_mask = act->sa_mask;
773b93ee
FB
530
531 /* we update the host linux signal state */
532 host_sig = target_to_host_signal(sig);
533 if (host_sig != SIGSEGV && host_sig != SIGBUS) {
534 sigfillset(&act1.sa_mask);
535 act1.sa_flags = SA_SIGINFO;
536 if (k->sa.sa_flags & TARGET_SA_RESTART)
537 act1.sa_flags |= SA_RESTART;
538 /* NOTE: it is important to update the host kernel signal
539 ignore state to avoid getting unexpected interrupted
540 syscalls */
541 if (k->sa._sa_handler == TARGET_SIG_IGN) {
542 act1.sa_sigaction = (void *)SIG_IGN;
543 } else if (k->sa._sa_handler == TARGET_SIG_DFL) {
544 act1.sa_sigaction = (void *)SIG_DFL;
545 } else {
546 act1.sa_sigaction = host_signal_handler;
547 }
0da46a6e 548 ret = sigaction(host_sig, &act1, NULL);
773b93ee 549 }
66fb9763 550 }
0da46a6e 551 return ret;
66fb9763
FB
552}
553
43fff238
FB
554#ifndef offsetof
555#define offsetof(type, field) ((size_t) &((type *)0)->field)
556#endif
557
5fafdf24 558static inline int copy_siginfo_to_user(target_siginfo_t *tinfo,
43fff238
FB
559 const target_siginfo_t *info)
560{
561 tswap_siginfo(tinfo, info);
562 return 0;
563}
564
66fb9763
FB
565#ifdef TARGET_I386
566
567/* from the Linux kernel */
568
569struct target_fpreg {
570 uint16_t significand[4];
571 uint16_t exponent;
572};
573
574struct target_fpxreg {
575 uint16_t significand[4];
576 uint16_t exponent;
577 uint16_t padding[3];
578};
579
580struct target_xmmreg {
992f48a0 581 abi_ulong element[4];
66fb9763
FB
582};
583
584struct target_fpstate {
585 /* Regular FPU environment */
992f48a0
BS
586 abi_ulong cw;
587 abi_ulong sw;
588 abi_ulong tag;
589 abi_ulong ipoff;
590 abi_ulong cssel;
591 abi_ulong dataoff;
592 abi_ulong datasel;
66fb9763
FB
593 struct target_fpreg _st[8];
594 uint16_t status;
595 uint16_t magic; /* 0xffff = regular FPU data only */
596
597 /* FXSR FPU environment */
992f48a0
BS
598 abi_ulong _fxsr_env[6]; /* FXSR FPU env is ignored */
599 abi_ulong mxcsr;
600 abi_ulong reserved;
66fb9763
FB
601 struct target_fpxreg _fxsr_st[8]; /* FXSR FPU reg data is ignored */
602 struct target_xmmreg _xmm[8];
992f48a0 603 abi_ulong padding[56];
66fb9763
FB
604};
605
606#define X86_FXSR_MAGIC 0x0000
607
608struct target_sigcontext {
609 uint16_t gs, __gsh;
610 uint16_t fs, __fsh;
611 uint16_t es, __esh;
612 uint16_t ds, __dsh;
992f48a0
BS
613 abi_ulong edi;
614 abi_ulong esi;
615 abi_ulong ebp;
616 abi_ulong esp;
617 abi_ulong ebx;
618 abi_ulong edx;
619 abi_ulong ecx;
620 abi_ulong eax;
621 abi_ulong trapno;
622 abi_ulong err;
623 abi_ulong eip;
66fb9763 624 uint16_t cs, __csh;
992f48a0
BS
625 abi_ulong eflags;
626 abi_ulong esp_at_signal;
66fb9763 627 uint16_t ss, __ssh;
992f48a0
BS
628 abi_ulong fpstate; /* pointer */
629 abi_ulong oldmask;
630 abi_ulong cr2;
66fb9763
FB
631};
632
66fb9763 633struct target_ucontext {
992f48a0
BS
634 abi_ulong tuc_flags;
635 abi_ulong tuc_link;
b8076a74
FB
636 target_stack_t tuc_stack;
637 struct target_sigcontext tuc_mcontext;
638 target_sigset_t tuc_sigmask; /* mask last for extensibility */
66fb9763
FB
639};
640
641struct sigframe
642{
992f48a0 643 abi_ulong pretcode;
66fb9763
FB
644 int sig;
645 struct target_sigcontext sc;
646 struct target_fpstate fpstate;
992f48a0 647 abi_ulong extramask[TARGET_NSIG_WORDS-1];
66fb9763
FB
648 char retcode[8];
649};
650
651struct rt_sigframe
652{
992f48a0 653 abi_ulong pretcode;
66fb9763 654 int sig;
992f48a0
BS
655 abi_ulong pinfo;
656 abi_ulong puc;
66fb9763
FB
657 struct target_siginfo info;
658 struct target_ucontext uc;
659 struct target_fpstate fpstate;
660 char retcode[8];
661};
662
663/*
664 * Set up a signal frame.
665 */
666
66fb9763
FB
667/* XXX: save x87 state */
668static int
669setup_sigcontext(struct target_sigcontext *sc, struct target_fpstate *fpstate,
670 CPUX86State *env, unsigned long mask)
671{
672 int err = 0;
673
579a97f7 674 /* already locked in setup_frame() */
a52c757c
FB
675 err |= __put_user(env->segs[R_GS].selector, (unsigned int *)&sc->gs);
676 err |= __put_user(env->segs[R_FS].selector, (unsigned int *)&sc->fs);
677 err |= __put_user(env->segs[R_ES].selector, (unsigned int *)&sc->es);
678 err |= __put_user(env->segs[R_DS].selector, (unsigned int *)&sc->ds);
66fb9763
FB
679 err |= __put_user(env->regs[R_EDI], &sc->edi);
680 err |= __put_user(env->regs[R_ESI], &sc->esi);
681 err |= __put_user(env->regs[R_EBP], &sc->ebp);
682 err |= __put_user(env->regs[R_ESP], &sc->esp);
683 err |= __put_user(env->regs[R_EBX], &sc->ebx);
684 err |= __put_user(env->regs[R_EDX], &sc->edx);
685 err |= __put_user(env->regs[R_ECX], &sc->ecx);
686 err |= __put_user(env->regs[R_EAX], &sc->eax);
66099dd9
FB
687 err |= __put_user(env->exception_index, &sc->trapno);
688 err |= __put_user(env->error_code, &sc->err);
66fb9763 689 err |= __put_user(env->eip, &sc->eip);
a52c757c 690 err |= __put_user(env->segs[R_CS].selector, (unsigned int *)&sc->cs);
66fb9763
FB
691 err |= __put_user(env->eflags, &sc->eflags);
692 err |= __put_user(env->regs[R_ESP], &sc->esp_at_signal);
a52c757c 693 err |= __put_user(env->segs[R_SS].selector, (unsigned int *)&sc->ss);
ed2dcdf6
FB
694
695 cpu_x86_fsave(env, (void *)fpstate, 1);
696 fpstate->status = fpstate->sw;
697 err |= __put_user(0xffff, &fpstate->magic);
698 err |= __put_user(fpstate, &sc->fpstate);
699
66fb9763
FB
700 /* non-iBCS2 extensions.. */
701 err |= __put_user(mask, &sc->oldmask);
a52c757c 702 err |= __put_user(env->cr[2], &sc->cr2);
66fb9763 703 return err;
31e31b8a
FB
704}
705
66fb9763
FB
706/*
707 * Determine which stack to use..
708 */
31e31b8a 709
579a97f7 710static inline abi_ulong
66fb9763 711get_sigframe(struct emulated_sigaction *ka, CPUX86State *env, size_t frame_size)
31e31b8a 712{
66fb9763
FB
713 unsigned long esp;
714
715 /* Default to using normal stack */
716 esp = env->regs[R_ESP];
66fb9763 717 /* This is the X/Open sanctioned signal stack switching. */
a04e134a
TS
718 if (ka->sa.sa_flags & TARGET_SA_ONSTACK) {
719 if (sas_ss_flags(esp) == 0)
720 esp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
721 }
66fb9763
FB
722
723 /* This is the legacy signal stack switching. */
5fafdf24 724 else
a52c757c
FB
725 if ((env->segs[R_SS].selector & 0xffff) != __USER_DS &&
726 !(ka->sa.sa_flags & TARGET_SA_RESTORER) &&
727 ka->sa.sa_restorer) {
728 esp = (unsigned long) ka->sa.sa_restorer;
729 }
579a97f7 730 return (esp - frame_size) & -8ul;
66fb9763
FB
731}
732
579a97f7 733/* compare linux/arch/i386/kernel/signal.c:setup_frame() */
66fb9763
FB
734static void setup_frame(int sig, struct emulated_sigaction *ka,
735 target_sigset_t *set, CPUX86State *env)
736{
579a97f7 737 abi_ulong frame_addr;
66fb9763 738 struct sigframe *frame;
9231944d 739 int i, err = 0;
66fb9763 740
579a97f7 741 frame_addr = get_sigframe(ka, env, sizeof(*frame));
66fb9763 742
579a97f7 743 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
66fb9763 744 goto give_sigsegv;
579a97f7 745
66fb9763
FB
746 err |= __put_user((/*current->exec_domain
747 && current->exec_domain->signal_invmap
748 && sig < 32
749 ? current->exec_domain->signal_invmap[sig]
750 : */ sig),
751 &frame->sig);
752 if (err)
753 goto give_sigsegv;
754
755 setup_sigcontext(&frame->sc, &frame->fpstate, env, set->sig[0]);
756 if (err)
757 goto give_sigsegv;
758
9231944d
FB
759 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
760 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
761 goto give_sigsegv;
762 }
66fb9763
FB
763
764 /* Set up to return from userspace. If provided, use a stub
765 already in userspace. */
766 if (ka->sa.sa_flags & TARGET_SA_RESTORER) {
767 err |= __put_user(ka->sa.sa_restorer, &frame->pretcode);
768 } else {
769 err |= __put_user(frame->retcode, &frame->pretcode);
770 /* This is popl %eax ; movl $,%eax ; int $0x80 */
771 err |= __put_user(0xb858, (short *)(frame->retcode+0));
84409ddb
JM
772#if defined(TARGET_X86_64)
773#warning "Fix this !"
774#else
66fb9763 775 err |= __put_user(TARGET_NR_sigreturn, (int *)(frame->retcode+2));
84409ddb 776#endif
66fb9763
FB
777 err |= __put_user(0x80cd, (short *)(frame->retcode+6));
778 }
779
780 if (err)
781 goto give_sigsegv;
782
783 /* Set up registers for signal handler */
53a5960a 784 env->regs[R_ESP] = h2g(frame);
66fb9763
FB
785 env->eip = (unsigned long) ka->sa._sa_handler;
786
787 cpu_x86_load_seg(env, R_DS, __USER_DS);
788 cpu_x86_load_seg(env, R_ES, __USER_DS);
789 cpu_x86_load_seg(env, R_SS, __USER_DS);
790 cpu_x86_load_seg(env, R_CS, __USER_CS);
791 env->eflags &= ~TF_MASK;
792
579a97f7
FB
793 unlock_user_struct(frame, frame_addr, 1);
794
66fb9763
FB
795 return;
796
797give_sigsegv:
579a97f7 798 unlock_user_struct(frame, frame_addr, 1);
66fb9763
FB
799 if (sig == TARGET_SIGSEGV)
800 ka->sa._sa_handler = TARGET_SIG_DFL;
801 force_sig(TARGET_SIGSEGV /* , current */);
802}
803
579a97f7 804/* compare linux/arch/i386/kernel/signal.c:setup_rt_frame() */
5fafdf24 805static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
9de5e440 806 target_siginfo_t *info,
66fb9763
FB
807 target_sigset_t *set, CPUX86State *env)
808{
579a97f7 809 abi_ulong frame_addr;
66fb9763 810 struct rt_sigframe *frame;
9231944d 811 int i, err = 0;
66fb9763 812
579a97f7 813 frame_addr = get_sigframe(ka, env, sizeof(*frame));
66fb9763 814
579a97f7 815 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
66fb9763 816 goto give_sigsegv;
66fb9763
FB
817
818 err |= __put_user((/*current->exec_domain
819 && current->exec_domain->signal_invmap
820 && sig < 32
821 ? current->exec_domain->signal_invmap[sig]
822 : */sig),
823 &frame->sig);
992f48a0
BS
824 err |= __put_user((abi_ulong)&frame->info, &frame->pinfo);
825 err |= __put_user((abi_ulong)&frame->uc, &frame->puc);
66fb9763
FB
826 err |= copy_siginfo_to_user(&frame->info, info);
827 if (err)
828 goto give_sigsegv;
31e31b8a 829
66fb9763 830 /* Create the ucontext. */
b8076a74
FB
831 err |= __put_user(0, &frame->uc.tuc_flags);
832 err |= __put_user(0, &frame->uc.tuc_link);
a04e134a 833 err |= __put_user(target_sigaltstack_used.ss_sp,
b8076a74 834 &frame->uc.tuc_stack.ss_sp);
a04e134a 835 err |= __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
b8076a74 836 &frame->uc.tuc_stack.ss_flags);
a04e134a 837 err |= __put_user(target_sigaltstack_used.ss_size,
b8076a74
FB
838 &frame->uc.tuc_stack.ss_size);
839 err |= setup_sigcontext(&frame->uc.tuc_mcontext, &frame->fpstate,
66fb9763 840 env, set->sig[0]);
9231944d 841 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
b8076a74 842 if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
9231944d
FB
843 goto give_sigsegv;
844 }
31e31b8a 845
66fb9763
FB
846 /* Set up to return from userspace. If provided, use a stub
847 already in userspace. */
848 if (ka->sa.sa_flags & TARGET_SA_RESTORER) {
849 err |= __put_user(ka->sa.sa_restorer, &frame->pretcode);
850 } else {
851 err |= __put_user(frame->retcode, &frame->pretcode);
852 /* This is movl $,%eax ; int $0x80 */
853 err |= __put_user(0xb8, (char *)(frame->retcode+0));
854 err |= __put_user(TARGET_NR_rt_sigreturn, (int *)(frame->retcode+1));
855 err |= __put_user(0x80cd, (short *)(frame->retcode+5));
856 }
857
858 if (err)
859 goto give_sigsegv;
860
861 /* Set up registers for signal handler */
862 env->regs[R_ESP] = (unsigned long) frame;
863 env->eip = (unsigned long) ka->sa._sa_handler;
864
865 cpu_x86_load_seg(env, R_DS, __USER_DS);
866 cpu_x86_load_seg(env, R_ES, __USER_DS);
867 cpu_x86_load_seg(env, R_SS, __USER_DS);
868 cpu_x86_load_seg(env, R_CS, __USER_CS);
869 env->eflags &= ~TF_MASK;
870
579a97f7
FB
871 unlock_user_struct(frame, frame_addr, 1);
872
66fb9763
FB
873 return;
874
875give_sigsegv:
579a97f7 876 unlock_user_struct(frame, frame_addr, 1);
66fb9763
FB
877 if (sig == TARGET_SIGSEGV)
878 ka->sa._sa_handler = TARGET_SIG_DFL;
879 force_sig(TARGET_SIGSEGV /* , current */);
880}
881
882static int
883restore_sigcontext(CPUX86State *env, struct target_sigcontext *sc, int *peax)
884{
885 unsigned int err = 0;
886
66fb9763
FB
887 cpu_x86_load_seg(env, R_GS, lduw(&sc->gs));
888 cpu_x86_load_seg(env, R_FS, lduw(&sc->fs));
889 cpu_x86_load_seg(env, R_ES, lduw(&sc->es));
890 cpu_x86_load_seg(env, R_DS, lduw(&sc->ds));
891
892 env->regs[R_EDI] = ldl(&sc->edi);
893 env->regs[R_ESI] = ldl(&sc->esi);
894 env->regs[R_EBP] = ldl(&sc->ebp);
895 env->regs[R_ESP] = ldl(&sc->esp);
896 env->regs[R_EBX] = ldl(&sc->ebx);
897 env->regs[R_EDX] = ldl(&sc->edx);
898 env->regs[R_ECX] = ldl(&sc->ecx);
899 env->eip = ldl(&sc->eip);
900
901 cpu_x86_load_seg(env, R_CS, lduw(&sc->cs) | 3);
902 cpu_x86_load_seg(env, R_SS, lduw(&sc->ss) | 3);
5fafdf24 903
66fb9763
FB
904 {
905 unsigned int tmpflags;
906 tmpflags = ldl(&sc->eflags);
907 env->eflags = (env->eflags & ~0x40DD5) | (tmpflags & 0x40DD5);
908 // regs->orig_eax = -1; /* disable syscall checks */
909 }
910
66fb9763
FB
911 {
912 struct _fpstate * buf;
ed2dcdf6 913 buf = (void *)ldl(&sc->fpstate);
66fb9763 914 if (buf) {
ed2dcdf6 915#if 0
66fb9763
FB
916 if (verify_area(VERIFY_READ, buf, sizeof(*buf)))
917 goto badframe;
ed2dcdf6
FB
918#endif
919 cpu_x86_frstor(env, (void *)buf, 1);
66fb9763
FB
920 }
921 }
ed2dcdf6 922
66fb9763
FB
923 *peax = ldl(&sc->eax);
924 return err;
925#if 0
926badframe:
927 return 1;
928#endif
929}
930
931long do_sigreturn(CPUX86State *env)
932{
579a97f7
FB
933 struct sigframe *frame;
934 abi_ulong frame_addr = env->regs[R_ESP] - 8;
66fb9763
FB
935 target_sigset_t target_set;
936 sigset_t set;
937 int eax, i;
938
447db213
FB
939#if defined(DEBUG_SIGNAL)
940 fprintf(stderr, "do_sigreturn\n");
941#endif
579a97f7
FB
942 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
943 goto badframe;
66fb9763 944 /* set blocked signals */
9231944d
FB
945 if (__get_user(target_set.sig[0], &frame->sc.oldmask))
946 goto badframe;
947 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
948 if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
949 goto badframe;
950 }
66fb9763 951
9231944d 952 target_to_host_sigset_internal(&set, &target_set);
66fb9763 953 sigprocmask(SIG_SETMASK, &set, NULL);
3b46e624 954
66fb9763
FB
955 /* restore registers */
956 if (restore_sigcontext(env, &frame->sc, &eax))
957 goto badframe;
579a97f7 958 unlock_user_struct(frame, frame_addr, 0);
66fb9763
FB
959 return eax;
960
961badframe:
579a97f7 962 unlock_user_struct(frame, frame_addr, 0);
66fb9763
FB
963 force_sig(TARGET_SIGSEGV);
964 return 0;
965}
966
967long do_rt_sigreturn(CPUX86State *env)
968{
53a5960a 969 struct rt_sigframe *frame = (struct rt_sigframe *)g2h(env->regs[R_ESP] - 4);
66fb9763 970 sigset_t set;
66fb9763
FB
971 int eax;
972
973#if 0
974 if (verify_area(VERIFY_READ, frame, sizeof(*frame)))
975 goto badframe;
976#endif
b8076a74 977 target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
66fb9763 978 sigprocmask(SIG_SETMASK, &set, NULL);
5fafdf24 979
b8076a74 980 if (restore_sigcontext(env, &frame->uc.tuc_mcontext, &eax))
66fb9763
FB
981 goto badframe;
982
579a97f7 983 if (do_sigaltstack(h2g(&frame->uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
66fb9763 984 goto badframe;
a04e134a 985
66fb9763
FB
986 return eax;
987
988badframe:
989 force_sig(TARGET_SIGSEGV);
990 return 0;
991}
992
43fff238
FB
993#elif defined(TARGET_ARM)
994
995struct target_sigcontext {
992f48a0
BS
996 abi_ulong trap_no;
997 abi_ulong error_code;
998 abi_ulong oldmask;
999 abi_ulong arm_r0;
1000 abi_ulong arm_r1;
1001 abi_ulong arm_r2;
1002 abi_ulong arm_r3;
1003 abi_ulong arm_r4;
1004 abi_ulong arm_r5;
1005 abi_ulong arm_r6;
1006 abi_ulong arm_r7;
1007 abi_ulong arm_r8;
1008 abi_ulong arm_r9;
1009 abi_ulong arm_r10;
1010 abi_ulong arm_fp;
1011 abi_ulong arm_ip;
1012 abi_ulong arm_sp;
1013 abi_ulong arm_lr;
1014 abi_ulong arm_pc;
1015 abi_ulong arm_cpsr;
1016 abi_ulong fault_address;
43fff238
FB
1017};
1018
43fff238 1019struct target_ucontext {
992f48a0
BS
1020 abi_ulong tuc_flags;
1021 abi_ulong tuc_link;
b8076a74
FB
1022 target_stack_t tuc_stack;
1023 struct target_sigcontext tuc_mcontext;
1024 target_sigset_t tuc_sigmask; /* mask last for extensibility */
43fff238
FB
1025};
1026
1027struct sigframe
1028{
1029 struct target_sigcontext sc;
992f48a0
BS
1030 abi_ulong extramask[TARGET_NSIG_WORDS-1];
1031 abi_ulong retcode;
43fff238
FB
1032};
1033
1034struct rt_sigframe
1035{
1036 struct target_siginfo *pinfo;
1037 void *puc;
1038 struct target_siginfo info;
1039 struct target_ucontext uc;
992f48a0 1040 abi_ulong retcode;
43fff238
FB
1041};
1042
1043#define TARGET_CONFIG_CPU_32 1
1044
1045/*
1046 * For ARM syscalls, we encode the syscall number into the instruction.
1047 */
1048#define SWI_SYS_SIGRETURN (0xef000000|(TARGET_NR_sigreturn + ARM_SYSCALL_BASE))
1049#define SWI_SYS_RT_SIGRETURN (0xef000000|(TARGET_NR_rt_sigreturn + ARM_SYSCALL_BASE))
1050
1051/*
1052 * For Thumb syscalls, we pass the syscall number via r7. We therefore
1053 * need two 16-bit instructions.
1054 */
1055#define SWI_THUMB_SIGRETURN (0xdf00 << 16 | 0x2700 | (TARGET_NR_sigreturn))
1056#define SWI_THUMB_RT_SIGRETURN (0xdf00 << 16 | 0x2700 | (TARGET_NR_rt_sigreturn))
1057
992f48a0 1058static const abi_ulong retcodes[4] = {
43fff238
FB
1059 SWI_SYS_SIGRETURN, SWI_THUMB_SIGRETURN,
1060 SWI_SYS_RT_SIGRETURN, SWI_THUMB_RT_SIGRETURN
1061};
1062
1063
1064#define __put_user_error(x,p,e) __put_user(x, p)
1065#define __get_user_error(x,p,e) __get_user(x, p)
1066
1067static inline int valid_user_regs(CPUState *regs)
1068{
1069 return 1;
1070}
1071
1072static int
1073setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1074 CPUState *env, unsigned long mask)
1075{
1076 int err = 0;
1077
1078 __put_user_error(env->regs[0], &sc->arm_r0, err);
1079 __put_user_error(env->regs[1], &sc->arm_r1, err);
1080 __put_user_error(env->regs[2], &sc->arm_r2, err);
1081 __put_user_error(env->regs[3], &sc->arm_r3, err);
1082 __put_user_error(env->regs[4], &sc->arm_r4, err);
1083 __put_user_error(env->regs[5], &sc->arm_r5, err);
1084 __put_user_error(env->regs[6], &sc->arm_r6, err);
1085 __put_user_error(env->regs[7], &sc->arm_r7, err);
1086 __put_user_error(env->regs[8], &sc->arm_r8, err);
1087 __put_user_error(env->regs[9], &sc->arm_r9, err);
1088 __put_user_error(env->regs[10], &sc->arm_r10, err);
1089 __put_user_error(env->regs[11], &sc->arm_fp, err);
1090 __put_user_error(env->regs[12], &sc->arm_ip, err);
1091 __put_user_error(env->regs[13], &sc->arm_sp, err);
1092 __put_user_error(env->regs[14], &sc->arm_lr, err);
1093 __put_user_error(env->regs[15], &sc->arm_pc, err);
1094#ifdef TARGET_CONFIG_CPU_32
b5ff1b31 1095 __put_user_error(cpsr_read(env), &sc->arm_cpsr, err);
43fff238
FB
1096#endif
1097
1098 __put_user_error(/* current->thread.trap_no */ 0, &sc->trap_no, err);
1099 __put_user_error(/* current->thread.error_code */ 0, &sc->error_code, err);
1100 __put_user_error(/* current->thread.address */ 0, &sc->fault_address, err);
1101 __put_user_error(mask, &sc->oldmask, err);
1102
1103 return err;
1104}
1105
579a97f7 1106static inline abi_ulong
43fff238
FB
1107get_sigframe(struct emulated_sigaction *ka, CPUState *regs, int framesize)
1108{
1109 unsigned long sp = regs->regs[13];
1110
43fff238
FB
1111 /*
1112 * This is the X/Open sanctioned signal stack switching.
1113 */
a04e134a
TS
1114 if ((ka->sa.sa_flags & TARGET_SA_ONSTACK) && !sas_ss_flags(sp))
1115 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
43fff238
FB
1116 /*
1117 * ATPCS B01 mandates 8-byte alignment
1118 */
579a97f7 1119 return (sp - framesize) & ~7;
43fff238
FB
1120}
1121
1122static int
1123setup_return(CPUState *env, struct emulated_sigaction *ka,
992f48a0 1124 abi_ulong *rc, void *frame, int usig)
43fff238 1125{
992f48a0
BS
1126 abi_ulong handler = (abi_ulong)ka->sa._sa_handler;
1127 abi_ulong retcode;
43fff238
FB
1128 int thumb = 0;
1129#if defined(TARGET_CONFIG_CPU_32)
b5ff1b31 1130#if 0
992f48a0 1131 abi_ulong cpsr = env->cpsr;
43fff238 1132
43fff238
FB
1133 /*
1134 * Maybe we need to deliver a 32-bit signal to a 26-bit task.
1135 */
1136 if (ka->sa.sa_flags & SA_THIRTYTWO)
1137 cpsr = (cpsr & ~MODE_MASK) | USR_MODE;
1138
1139#ifdef CONFIG_ARM_THUMB
1140 if (elf_hwcap & HWCAP_THUMB) {
1141 /*
1142 * The LSB of the handler determines if we're going to
1143 * be using THUMB or ARM mode for this signal handler.
1144 */
1145 thumb = handler & 1;
1146
1147 if (thumb)
1148 cpsr |= T_BIT;
1149 else
1150 cpsr &= ~T_BIT;
1151 }
a04e134a
TS
1152#endif /* CONFIG_ARM_THUMB */
1153#endif /* 0 */
43fff238
FB
1154#endif /* TARGET_CONFIG_CPU_32 */
1155
1156 if (ka->sa.sa_flags & TARGET_SA_RESTORER) {
992f48a0 1157 retcode = (abi_ulong)ka->sa.sa_restorer;
43fff238
FB
1158 } else {
1159 unsigned int idx = thumb;
1160
1161 if (ka->sa.sa_flags & TARGET_SA_SIGINFO)
1162 idx += 2;
1163
1164 if (__put_user(retcodes[idx], rc))
1165 return 1;
1166#if 0
992f48a0
BS
1167 flush_icache_range((abi_ulong)rc,
1168 (abi_ulong)(rc + 1));
43fff238 1169#endif
992f48a0 1170 retcode = ((abi_ulong)rc) + thumb;
43fff238
FB
1171 }
1172
1173 env->regs[0] = usig;
53a5960a 1174 env->regs[13] = h2g(frame);
43fff238
FB
1175 env->regs[14] = retcode;
1176 env->regs[15] = handler & (thumb ? ~1 : ~3);
1177
b5ff1b31 1178#if 0
43fff238
FB
1179#ifdef TARGET_CONFIG_CPU_32
1180 env->cpsr = cpsr;
b5ff1b31 1181#endif
43fff238
FB
1182#endif
1183
1184 return 0;
1185}
1186
579a97f7 1187/* compare linux/arch/arm/kernel/signal.c:setup_frame() */
43fff238
FB
1188static void setup_frame(int usig, struct emulated_sigaction *ka,
1189 target_sigset_t *set, CPUState *regs)
1190{
579a97f7
FB
1191 struct sigframe *frame;
1192 abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
9231944d 1193 int i, err = 0;
43fff238 1194
579a97f7
FB
1195 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1196 return;
1197
43fff238
FB
1198 err |= setup_sigcontext(&frame->sc, /*&frame->fpstate,*/ regs, set->sig[0]);
1199
9231944d
FB
1200 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1201 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
579a97f7 1202 goto end;
43fff238
FB
1203 }
1204
1205 if (err == 0)
1206 err = setup_return(regs, ka, &frame->retcode, frame, usig);
579a97f7
FB
1207
1208end:
1209 unlock_user_struct(frame, frame_addr, 1);
43fff238
FB
1210 // return err;
1211}
1212
579a97f7 1213/* compare linux/arch/arm/kernel/signal.c:setup_rt_frame() */
5fafdf24 1214static void setup_rt_frame(int usig, struct emulated_sigaction *ka,
43fff238
FB
1215 target_siginfo_t *info,
1216 target_sigset_t *set, CPUState *env)
1217{
579a97f7
FB
1218 struct rt_sigframe *frame;
1219 abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
a04e134a 1220 struct target_sigaltstack stack;
9231944d 1221 int i, err = 0;
43fff238 1222
579a97f7 1223 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
edf779ff
FB
1224 return /* 1 */;
1225
992f48a0
BS
1226 __put_user_error(&frame->info, (abi_ulong *)&frame->pinfo, err);
1227 __put_user_error(&frame->uc, (abi_ulong *)&frame->puc, err);
43fff238
FB
1228 err |= copy_siginfo_to_user(&frame->info, info);
1229
1230 /* Clear all the bits of the ucontext we don't use. */
53a5960a 1231 memset(&frame->uc, 0, offsetof(struct target_ucontext, tuc_mcontext));
43fff238 1232
a04e134a
TS
1233 memset(&stack, 0, sizeof(stack));
1234 __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
1235 __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
1236 __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
579a97f7 1237 err |= copy_to_user(&frame->uc.tuc_stack, &stack, sizeof(stack));
a04e134a 1238
b8076a74 1239 err |= setup_sigcontext(&frame->uc.tuc_mcontext, /*&frame->fpstate,*/
43fff238 1240 env, set->sig[0]);
9231944d 1241 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
b8076a74 1242 if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
579a97f7 1243 goto end;
9231944d 1244 }
43fff238
FB
1245
1246 if (err == 0)
1247 err = setup_return(env, ka, &frame->retcode, frame, usig);
1248
1249 if (err == 0) {
1250 /*
1251 * For realtime signals we must also set the second and third
1252 * arguments for the signal handler.
1253 * -- Peter Maydell <pmaydell@chiark.greenend.org.uk> 2000-12-06
1254 */
992f48a0
BS
1255 env->regs[1] = (abi_ulong)frame->pinfo;
1256 env->regs[2] = (abi_ulong)frame->puc;
43fff238
FB
1257 }
1258
579a97f7
FB
1259end:
1260 unlock_user_struct(frame, frame_addr, 1);
1261
43fff238
FB
1262 // return err;
1263}
1264
1265static int
1266restore_sigcontext(CPUState *env, struct target_sigcontext *sc)
1267{
1268 int err = 0;
b5ff1b31 1269 uint32_t cpsr;
43fff238
FB
1270
1271 __get_user_error(env->regs[0], &sc->arm_r0, err);
1272 __get_user_error(env->regs[1], &sc->arm_r1, err);
1273 __get_user_error(env->regs[2], &sc->arm_r2, err);
1274 __get_user_error(env->regs[3], &sc->arm_r3, err);
1275 __get_user_error(env->regs[4], &sc->arm_r4, err);
1276 __get_user_error(env->regs[5], &sc->arm_r5, err);
1277 __get_user_error(env->regs[6], &sc->arm_r6, err);
1278 __get_user_error(env->regs[7], &sc->arm_r7, err);
1279 __get_user_error(env->regs[8], &sc->arm_r8, err);
1280 __get_user_error(env->regs[9], &sc->arm_r9, err);
1281 __get_user_error(env->regs[10], &sc->arm_r10, err);
1282 __get_user_error(env->regs[11], &sc->arm_fp, err);
1283 __get_user_error(env->regs[12], &sc->arm_ip, err);
1284 __get_user_error(env->regs[13], &sc->arm_sp, err);
1285 __get_user_error(env->regs[14], &sc->arm_lr, err);
1286 __get_user_error(env->regs[15], &sc->arm_pc, err);
1287#ifdef TARGET_CONFIG_CPU_32
b5ff1b31
FB
1288 __get_user_error(cpsr, &sc->arm_cpsr, err);
1289 cpsr_write(env, cpsr, 0xffffffff);
43fff238
FB
1290#endif
1291
1292 err |= !valid_user_regs(env);
1293
1294 return err;
1295}
1296
1297long do_sigreturn(CPUState *env)
1298{
1299 struct sigframe *frame;
1300 target_sigset_t set;
1301 sigset_t host_set;
9231944d 1302 int i;
43fff238
FB
1303
1304 /*
1305 * Since we stacked the signal on a 64-bit boundary,
1306 * then 'sp' should be word aligned here. If it's
1307 * not, then the user is trying to mess with us.
1308 */
1309 if (env->regs[13] & 7)
1310 goto badframe;
1311
53a5960a 1312 frame = (struct sigframe *)g2h(env->regs[13]);
43fff238
FB
1313
1314#if 0
1315 if (verify_area(VERIFY_READ, frame, sizeof (*frame)))
1316 goto badframe;
1317#endif
9231944d
FB
1318 if (__get_user(set.sig[0], &frame->sc.oldmask))
1319 goto badframe;
1320 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1321 if (__get_user(set.sig[i], &frame->extramask[i - 1]))
1322 goto badframe;
1323 }
43fff238 1324
9231944d 1325 target_to_host_sigset_internal(&host_set, &set);
43fff238
FB
1326 sigprocmask(SIG_SETMASK, &host_set, NULL);
1327
1328 if (restore_sigcontext(env, &frame->sc))
1329 goto badframe;
1330
1331#if 0
1332 /* Send SIGTRAP if we're single-stepping */
1333 if (ptrace_cancel_bpt(current))
1334 send_sig(SIGTRAP, current, 1);
1335#endif
1336 return env->regs[0];
1337
1338badframe:
1339 force_sig(SIGSEGV /* , current */);
1340 return 0;
1341}
1342
1343long do_rt_sigreturn(CPUState *env)
1344{
1345 struct rt_sigframe *frame;
43fff238
FB
1346 sigset_t host_set;
1347
1348 /*
1349 * Since we stacked the signal on a 64-bit boundary,
1350 * then 'sp' should be word aligned here. If it's
1351 * not, then the user is trying to mess with us.
1352 */
1353 if (env->regs[13] & 7)
1354 goto badframe;
1355
1356 frame = (struct rt_sigframe *)env->regs[13];
1357
1358#if 0
1359 if (verify_area(VERIFY_READ, frame, sizeof (*frame)))
1360 goto badframe;
1361#endif
b8076a74 1362 target_to_host_sigset(&host_set, &frame->uc.tuc_sigmask);
43fff238
FB
1363 sigprocmask(SIG_SETMASK, &host_set, NULL);
1364
b8076a74 1365 if (restore_sigcontext(env, &frame->uc.tuc_mcontext))
43fff238
FB
1366 goto badframe;
1367
579a97f7 1368 if (do_sigaltstack(h2g(&frame->uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
a04e134a
TS
1369 goto badframe;
1370
43fff238
FB
1371#if 0
1372 /* Send SIGTRAP if we're single-stepping */
1373 if (ptrace_cancel_bpt(current))
1374 send_sig(SIGTRAP, current, 1);
1375#endif
1376 return env->regs[0];
1377
1378badframe:
1379 force_sig(SIGSEGV /* , current */);
1380 return 0;
1381}
1382
6d5e216d 1383#elif defined(TARGET_SPARC)
80a9d035 1384
6d5e216d
FB
1385#define __SUNOS_MAXWIN 31
1386
1387/* This is what SunOS does, so shall I. */
1388struct target_sigcontext {
992f48a0 1389 abi_ulong sigc_onstack; /* state to restore */
6d5e216d 1390
992f48a0
BS
1391 abi_ulong sigc_mask; /* sigmask to restore */
1392 abi_ulong sigc_sp; /* stack pointer */
1393 abi_ulong sigc_pc; /* program counter */
1394 abi_ulong sigc_npc; /* next program counter */
1395 abi_ulong sigc_psr; /* for condition codes etc */
1396 abi_ulong sigc_g1; /* User uses these two registers */
1397 abi_ulong sigc_o0; /* within the trampoline code. */
6d5e216d
FB
1398
1399 /* Now comes information regarding the users window set
1400 * at the time of the signal.
1401 */
992f48a0 1402 abi_ulong sigc_oswins; /* outstanding windows */
6d5e216d
FB
1403
1404 /* stack ptrs for each regwin buf */
1405 char *sigc_spbuf[__SUNOS_MAXWIN];
1406
1407 /* Windows to restore after signal */
1408 struct {
992f48a0
BS
1409 abi_ulong locals[8];
1410 abi_ulong ins[8];
6d5e216d
FB
1411 } sigc_wbuf[__SUNOS_MAXWIN];
1412};
1413/* A Sparc stack frame */
1414struct sparc_stackf {
992f48a0
BS
1415 abi_ulong locals[8];
1416 abi_ulong ins[6];
6d5e216d 1417 struct sparc_stackf *fp;
992f48a0 1418 abi_ulong callers_pc;
6d5e216d 1419 char *structptr;
992f48a0
BS
1420 abi_ulong xargs[6];
1421 abi_ulong xxargs[1];
6d5e216d
FB
1422};
1423
1424typedef struct {
1425 struct {
992f48a0
BS
1426 abi_ulong psr;
1427 abi_ulong pc;
1428 abi_ulong npc;
1429 abi_ulong y;
1430 abi_ulong u_regs[16]; /* globals and ins */
6d5e216d
FB
1431 } si_regs;
1432 int si_mask;
1433} __siginfo_t;
1434
1435typedef struct {
1436 unsigned long si_float_regs [32];
1437 unsigned long si_fsr;
1438 unsigned long si_fpqdepth;
1439 struct {
1440 unsigned long *insn_addr;
1441 unsigned long insn;
1442 } si_fpqueue [16];
74ccb34e 1443} qemu_siginfo_fpu_t;
6d5e216d
FB
1444
1445
1446struct target_signal_frame {
1447 struct sparc_stackf ss;
1448 __siginfo_t info;
74ccb34e 1449 qemu_siginfo_fpu_t *fpu_save;
992f48a0
BS
1450 abi_ulong insns[2] __attribute__ ((aligned (8)));
1451 abi_ulong extramask[TARGET_NSIG_WORDS - 1];
1452 abi_ulong extra_size; /* Should be 0 */
74ccb34e 1453 qemu_siginfo_fpu_t fpu_state;
6d5e216d
FB
1454};
1455struct target_rt_signal_frame {
1456 struct sparc_stackf ss;
1457 siginfo_t info;
992f48a0 1458 abi_ulong regs[20];
6d5e216d 1459 sigset_t mask;
74ccb34e 1460 qemu_siginfo_fpu_t *fpu_save;
6d5e216d
FB
1461 unsigned int insns[2];
1462 stack_t stack;
1463 unsigned int extra_size; /* Should be 0 */
74ccb34e 1464 qemu_siginfo_fpu_t fpu_state;
6d5e216d
FB
1465};
1466
e80cfcfc
FB
1467#define UREG_O0 16
1468#define UREG_O6 22
1469#define UREG_I0 0
1470#define UREG_I1 1
1471#define UREG_I2 2
5bfb56b2
BS
1472#define UREG_I3 3
1473#define UREG_I4 4
1474#define UREG_I5 5
e80cfcfc
FB
1475#define UREG_I6 6
1476#define UREG_I7 7
1477#define UREG_L0 8
6d5e216d
FB
1478#define UREG_FP UREG_I6
1479#define UREG_SP UREG_O6
1480
1481static inline void *get_sigframe(struct emulated_sigaction *sa, CPUState *env, unsigned long framesize)
1482{
1483 unsigned long sp;
1484
1485 sp = env->regwptr[UREG_FP];
6d5e216d
FB
1486
1487 /* This is the X/Open sanctioned signal stack switching. */
a04e134a
TS
1488 if (sa->sa.sa_flags & TARGET_SA_ONSTACK) {
1489 if (!on_sig_stack(sp)
1490 && !((target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size) & 7))
1491 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
6d5e216d 1492 }
53a5960a 1493 return g2h(sp - framesize);
6d5e216d
FB
1494}
1495
1496static int
992f48a0 1497setup___siginfo(__siginfo_t *si, CPUState *env, abi_ulong mask)
6d5e216d
FB
1498{
1499 int err = 0, i;
1500
6d5e216d 1501 err |= __put_user(env->psr, &si->si_regs.psr);
6d5e216d
FB
1502 err |= __put_user(env->pc, &si->si_regs.pc);
1503 err |= __put_user(env->npc, &si->si_regs.npc);
1504 err |= __put_user(env->y, &si->si_regs.y);
a315a145 1505 for (i=0; i < 8; i++) {
6d5e216d
FB
1506 err |= __put_user(env->gregs[i], &si->si_regs.u_regs[i]);
1507 }
a315a145 1508 for (i=0; i < 8; i++) {
e80cfcfc 1509 err |= __put_user(env->regwptr[UREG_I0 + i], &si->si_regs.u_regs[i+8]);
6d5e216d 1510 }
6d5e216d
FB
1511 err |= __put_user(mask, &si->si_mask);
1512 return err;
1513}
e80cfcfc 1514
80a9d035 1515#if 0
6d5e216d
FB
1516static int
1517setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1518 CPUState *env, unsigned long mask)
1519{
1520 int err = 0;
1521
1522 err |= __put_user(mask, &sc->sigc_mask);
1523 err |= __put_user(env->regwptr[UREG_SP], &sc->sigc_sp);
1524 err |= __put_user(env->pc, &sc->sigc_pc);
1525 err |= __put_user(env->npc, &sc->sigc_npc);
1526 err |= __put_user(env->psr, &sc->sigc_psr);
1527 err |= __put_user(env->gregs[1], &sc->sigc_g1);
1528 err |= __put_user(env->regwptr[UREG_O0], &sc->sigc_o0);
1529
1530 return err;
1531}
80a9d035 1532#endif
6d5e216d
FB
1533#define NF_ALIGNEDSZ (((sizeof(struct target_signal_frame) + 7) & (~7)))
1534
1535static void setup_frame(int sig, struct emulated_sigaction *ka,
1536 target_sigset_t *set, CPUState *env)
1537{
1538 struct target_signal_frame *sf;
1539 int sigframe_size, err, i;
1540
1541 /* 1. Make sure everything is clean */
1542 //synchronize_user_stack();
1543
1544 sigframe_size = NF_ALIGNEDSZ;
1545
1546 sf = (struct target_signal_frame *)
1547 get_sigframe(ka, env, sigframe_size);
1548
e80cfcfc 1549 //fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
6d5e216d
FB
1550#if 0
1551 if (invalid_frame_pointer(sf, sigframe_size))
1552 goto sigill_and_return;
1553#endif
1554 /* 2. Save the current process state */
1555 err = setup___siginfo(&sf->info, env, set->sig[0]);
1556 err |= __put_user(0, &sf->extra_size);
1557
1558 //err |= save_fpu_state(regs, &sf->fpu_state);
1559 //err |= __put_user(&sf->fpu_state, &sf->fpu_save);
1560
1561 err |= __put_user(set->sig[0], &sf->info.si_mask);
1562 for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
1563 err |= __put_user(set->sig[i + 1], &sf->extramask[i]);
1564 }
1565
a315a145 1566 for (i = 0; i < 8; i++) {
e80cfcfc 1567 err |= __put_user(env->regwptr[i + UREG_L0], &sf->ss.locals[i]);
6d5e216d 1568 }
a315a145 1569 for (i = 0; i < 8; i++) {
e80cfcfc 1570 err |= __put_user(env->regwptr[i + UREG_I0], &sf->ss.ins[i]);
6d5e216d 1571 }
6d5e216d
FB
1572 if (err)
1573 goto sigsegv;
1574
1575 /* 3. signal handler back-trampoline and parameters */
53a5960a 1576 env->regwptr[UREG_FP] = h2g(sf);
6d5e216d 1577 env->regwptr[UREG_I0] = sig;
53a5960a
PB
1578 env->regwptr[UREG_I1] = h2g(&sf->info);
1579 env->regwptr[UREG_I2] = h2g(&sf->info);
6d5e216d
FB
1580
1581 /* 4. signal handler */
1582 env->pc = (unsigned long) ka->sa._sa_handler;
1583 env->npc = (env->pc + 4);
1584 /* 5. return to kernel instructions */
1585 if (ka->sa.sa_restorer)
1586 env->regwptr[UREG_I7] = (unsigned long)ka->sa.sa_restorer;
1587 else {
53a5960a 1588 env->regwptr[UREG_I7] = h2g(&(sf->insns[0]) - 2);
6d5e216d
FB
1589
1590 /* mov __NR_sigreturn, %g1 */
1591 err |= __put_user(0x821020d8, &sf->insns[0]);
1592
1593 /* t 0x10 */
1594 err |= __put_user(0x91d02010, &sf->insns[1]);
1595 if (err)
1596 goto sigsegv;
1597
1598 /* Flush instruction space. */
1599 //flush_sig_insns(current->mm, (unsigned long) &(sf->insns[0]));
80a9d035 1600 // tb_flush(env);
6d5e216d
FB
1601 }
1602 return;
1603
80a9d035 1604 //sigill_and_return:
6d5e216d
FB
1605 force_sig(TARGET_SIGILL);
1606sigsegv:
e80cfcfc 1607 //fprintf(stderr, "force_sig\n");
6d5e216d
FB
1608 force_sig(TARGET_SIGSEGV);
1609}
1610static inline int
74ccb34e 1611restore_fpu_state(CPUState *env, qemu_siginfo_fpu_t *fpu)
6d5e216d
FB
1612{
1613 int err;
1614#if 0
1615#ifdef CONFIG_SMP
1616 if (current->flags & PF_USEDFPU)
1617 regs->psr &= ~PSR_EF;
1618#else
1619 if (current == last_task_used_math) {
1620 last_task_used_math = 0;
1621 regs->psr &= ~PSR_EF;
1622 }
1623#endif
1624 current->used_math = 1;
1625 current->flags &= ~PF_USEDFPU;
1626#endif
1627#if 0
1628 if (verify_area (VERIFY_READ, fpu, sizeof(*fpu)))
1629 return -EFAULT;
1630#endif
1631
fafffaef
FB
1632#if 0
1633 /* XXX: incorrect */
6d5e216d
FB
1634 err = __copy_from_user(&env->fpr[0], &fpu->si_float_regs[0],
1635 (sizeof(unsigned long) * 32));
fafffaef 1636#endif
6d5e216d
FB
1637 err |= __get_user(env->fsr, &fpu->si_fsr);
1638#if 0
1639 err |= __get_user(current->thread.fpqdepth, &fpu->si_fpqdepth);
1640 if (current->thread.fpqdepth != 0)
1641 err |= __copy_from_user(&current->thread.fpqueue[0],
1642 &fpu->si_fpqueue[0],
1643 ((sizeof(unsigned long) +
1644 (sizeof(unsigned long *)))*16));
1645#endif
1646 return err;
1647}
1648
1649
5fafdf24 1650static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
6d5e216d
FB
1651 target_siginfo_t *info,
1652 target_sigset_t *set, CPUState *env)
1653{
1654 fprintf(stderr, "setup_rt_frame: not implemented\n");
1655}
1656
1657long do_sigreturn(CPUState *env)
1658{
1659 struct target_signal_frame *sf;
e80cfcfc 1660 uint32_t up_psr, pc, npc;
6d5e216d 1661 target_sigset_t set;
e80cfcfc 1662 sigset_t host_set;
992f48a0 1663 abi_ulong fpu_save;
e80cfcfc 1664 int err, i;
6d5e216d 1665
53a5960a 1666 sf = (struct target_signal_frame *)g2h(env->regwptr[UREG_FP]);
80a9d035 1667#if 0
e80cfcfc
FB
1668 fprintf(stderr, "sigreturn\n");
1669 fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
80a9d035 1670#endif
e80cfcfc 1671 //cpu_dump_state(env, stderr, fprintf, 0);
6d5e216d
FB
1672
1673 /* 1. Make sure we are not getting garbage from the user */
1674#if 0
1675 if (verify_area (VERIFY_READ, sf, sizeof (*sf)))
1676 goto segv_and_exit;
1677#endif
1678
1679 if (((uint) sf) & 3)
1680 goto segv_and_exit;
1681
1682 err = __get_user(pc, &sf->info.si_regs.pc);
1683 err |= __get_user(npc, &sf->info.si_regs.npc);
1684
6d5e216d
FB
1685 if ((pc | npc) & 3)
1686 goto segv_and_exit;
1687
1688 /* 2. Restore the state */
e80cfcfc
FB
1689 err |= __get_user(up_psr, &sf->info.si_regs.psr);
1690
6d5e216d 1691 /* User can only change condition codes and FPU enabling in %psr. */
a315a145
FB
1692 env->psr = (up_psr & (PSR_ICC /* | PSR_EF */))
1693 | (env->psr & ~(PSR_ICC /* | PSR_EF */));
1694
1695 env->pc = pc;
1696 env->npc = npc;
e80cfcfc 1697 err |= __get_user(env->y, &sf->info.si_regs.y);
a315a145 1698 for (i=0; i < 8; i++) {
e80cfcfc
FB
1699 err |= __get_user(env->gregs[i], &sf->info.si_regs.u_regs[i]);
1700 }
a315a145 1701 for (i=0; i < 8; i++) {
e80cfcfc
FB
1702 err |= __get_user(env->regwptr[i + UREG_I0], &sf->info.si_regs.u_regs[i+8]);
1703 }
6d5e216d 1704
992f48a0 1705 err |= __get_user(fpu_save, (abi_ulong *)&sf->fpu_save);
6d5e216d 1706
e80cfcfc
FB
1707 //if (fpu_save)
1708 // err |= restore_fpu_state(env, fpu_save);
6d5e216d
FB
1709
1710 /* This is pretty much atomic, no amount locking would prevent
1711 * the races which exist anyways.
1712 */
1713 err |= __get_user(set.sig[0], &sf->info.si_mask);
e80cfcfc
FB
1714 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1715 err |= (__get_user(set.sig[i], &sf->extramask[i - 1]));
1716 }
1717
1718 target_to_host_sigset_internal(&host_set, &set);
1719 sigprocmask(SIG_SETMASK, &host_set, NULL);
6d5e216d
FB
1720
1721 if (err)
1722 goto segv_and_exit;
1723
6d5e216d
FB
1724 return env->regwptr[0];
1725
1726segv_and_exit:
1727 force_sig(TARGET_SIGSEGV);
1728}
1729
1730long do_rt_sigreturn(CPUState *env)
1731{
1732 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
1733 return -ENOSYS;
1734}
1735
5bfb56b2
BS
1736#ifdef TARGET_SPARC64
1737#define MC_TSTATE 0
1738#define MC_PC 1
1739#define MC_NPC 2
1740#define MC_Y 3
1741#define MC_G1 4
1742#define MC_G2 5
1743#define MC_G3 6
1744#define MC_G4 7
1745#define MC_G5 8
1746#define MC_G6 9
1747#define MC_G7 10
1748#define MC_O0 11
1749#define MC_O1 12
1750#define MC_O2 13
1751#define MC_O3 14
1752#define MC_O4 15
1753#define MC_O5 16
1754#define MC_O6 17
1755#define MC_O7 18
1756#define MC_NGREG 19
1757
992f48a0 1758typedef abi_ulong target_mc_greg_t;
5bfb56b2
BS
1759typedef target_mc_greg_t target_mc_gregset_t[MC_NGREG];
1760
1761struct target_mc_fq {
992f48a0 1762 abi_ulong *mcfq_addr;
5bfb56b2
BS
1763 uint32_t mcfq_insn;
1764};
1765
1766struct target_mc_fpu {
1767 union {
1768 uint32_t sregs[32];
1769 uint64_t dregs[32];
1770 //uint128_t qregs[16];
1771 } mcfpu_fregs;
992f48a0
BS
1772 abi_ulong mcfpu_fsr;
1773 abi_ulong mcfpu_fprs;
1774 abi_ulong mcfpu_gsr;
5bfb56b2
BS
1775 struct target_mc_fq *mcfpu_fq;
1776 unsigned char mcfpu_qcnt;
1777 unsigned char mcfpu_qentsz;
1778 unsigned char mcfpu_enab;
1779};
1780typedef struct target_mc_fpu target_mc_fpu_t;
1781
1782typedef struct {
1783 target_mc_gregset_t mc_gregs;
1784 target_mc_greg_t mc_fp;
1785 target_mc_greg_t mc_i7;
1786 target_mc_fpu_t mc_fpregs;
1787} target_mcontext_t;
1788
1789struct target_ucontext {
1790 struct target_ucontext *uc_link;
992f48a0 1791 abi_ulong uc_flags;
5bfb56b2
BS
1792 target_sigset_t uc_sigmask;
1793 target_mcontext_t uc_mcontext;
1794};
1795
1796/* A V9 register window */
1797struct target_reg_window {
992f48a0
BS
1798 abi_ulong locals[8];
1799 abi_ulong ins[8];
5bfb56b2
BS
1800};
1801
1802#define TARGET_STACK_BIAS 2047
1803
1804/* {set, get}context() needed for 64-bit SparcLinux userland. */
1805void sparc64_set_context(CPUSPARCState *env)
1806{
1807 struct target_ucontext *ucp = (struct target_ucontext *)
1808 env->regwptr[UREG_I0];
1809 target_mc_gregset_t *grp;
992f48a0
BS
1810 abi_ulong pc, npc, tstate;
1811 abi_ulong fp, i7;
5bfb56b2
BS
1812 unsigned char fenab;
1813 int err;
1814 unsigned int i;
992f48a0 1815 abi_ulong *src, *dst;
5bfb56b2
BS
1816
1817 grp = &ucp->uc_mcontext.mc_gregs;
579a97f7
FB
1818 err = __get_user(pc, &((*grp)[MC_PC]));
1819 err |= __get_user(npc, &((*grp)[MC_NPC]));
5bfb56b2
BS
1820 if (err || ((pc | npc) & 3))
1821 goto do_sigsegv;
1822 if (env->regwptr[UREG_I1]) {
1823 target_sigset_t target_set;
1824 sigset_t set;
1825
1826 if (TARGET_NSIG_WORDS == 1) {
579a97f7 1827 if (__get_user(target_set.sig[0], &ucp->uc_sigmask.sig[0]))
5bfb56b2
BS
1828 goto do_sigsegv;
1829 } else {
1830 src = &ucp->uc_sigmask;
1831 dst = &target_set;
992f48a0 1832 for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
5bfb56b2 1833 i++, dst++, src++)
579a97f7 1834 err |= __get_user(dst, src);
5bfb56b2
BS
1835 if (err)
1836 goto do_sigsegv;
1837 }
1838 target_to_host_sigset_internal(&set, &target_set);
1839 sigprocmask(SIG_SETMASK, &set, NULL);
1840 }
1841 env->pc = pc;
1842 env->npc = npc;
579a97f7
FB
1843 err |= __get_user(env->y, &((*grp)[MC_Y]));
1844 err |= __get_user(tstate, &((*grp)[MC_TSTATE]));
5bfb56b2
BS
1845 env->asi = (tstate >> 24) & 0xff;
1846 PUT_CCR(env, tstate >> 32);
1847 PUT_CWP64(env, tstate & 0x1f);
579a97f7
FB
1848 err |= __get_user(env->gregs[1], (&(*grp)[MC_G1]));
1849 err |= __get_user(env->gregs[2], (&(*grp)[MC_G2]));
1850 err |= __get_user(env->gregs[3], (&(*grp)[MC_G3]));
1851 err |= __get_user(env->gregs[4], (&(*grp)[MC_G4]));
1852 err |= __get_user(env->gregs[5], (&(*grp)[MC_G5]));
1853 err |= __get_user(env->gregs[6], (&(*grp)[MC_G6]));
1854 err |= __get_user(env->gregs[7], (&(*grp)[MC_G7]));
1855 err |= __get_user(env->regwptr[UREG_I0], (&(*grp)[MC_O0]));
1856 err |= __get_user(env->regwptr[UREG_I1], (&(*grp)[MC_O1]));
1857 err |= __get_user(env->regwptr[UREG_I2], (&(*grp)[MC_O2]));
1858 err |= __get_user(env->regwptr[UREG_I3], (&(*grp)[MC_O3]));
1859 err |= __get_user(env->regwptr[UREG_I4], (&(*grp)[MC_O4]));
1860 err |= __get_user(env->regwptr[UREG_I5], (&(*grp)[MC_O5]));
1861 err |= __get_user(env->regwptr[UREG_I6], (&(*grp)[MC_O6]));
1862 err |= __get_user(env->regwptr[UREG_I7], (&(*grp)[MC_O7]));
1863
1864 err |= __get_user(fp, &(ucp->uc_mcontext.mc_fp));
1865 err |= __get_user(i7, &(ucp->uc_mcontext.mc_i7));
1866 err |= __put_user(fp,
1867 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[6])));
1868 err |= __put_user(i7,
1869 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[7])));
1870
1871 err |= __get_user(fenab, &(ucp->uc_mcontext.mc_fpregs.mcfpu_enab));
1872 err |= __get_user(env->fprs, &(ucp->uc_mcontext.mc_fpregs.mcfpu_fprs));
5bfb56b2
BS
1873 src = &(ucp->uc_mcontext.mc_fpregs.mcfpu_fregs);
1874 dst = &env->fpr;
1875 for (i = 0; i < 64; i++, dst++, src++)
579a97f7
FB
1876 err |= __get_user(dst, src);
1877 err |= __get_user(env->fsr,
1878 &(ucp->uc_mcontext.mc_fpregs.mcfpu_fsr));
1879 err |= __get_user(env->gsr,
1880 &(ucp->uc_mcontext.mc_fpregs.mcfpu_gsr));
5bfb56b2
BS
1881 if (err)
1882 goto do_sigsegv;
1883
1884 return;
1885 do_sigsegv:
1886 force_sig(SIGSEGV);
1887}
1888
1889void sparc64_get_context(CPUSPARCState *env)
1890{
1891 struct target_ucontext *ucp = (struct target_ucontext *)
1892 env->regwptr[UREG_I0];
1893 target_mc_gregset_t *grp;
1894 target_mcontext_t *mcp;
992f48a0 1895 abi_ulong fp, i7;
5bfb56b2
BS
1896 int err;
1897 unsigned int i;
992f48a0 1898 abi_ulong *src, *dst;
5bfb56b2
BS
1899 target_sigset_t target_set;
1900 sigset_t set;
1901
1902 mcp = &ucp->uc_mcontext;
1903 grp = &mcp->mc_gregs;
1904
1905 /* Skip over the trap instruction, first. */
1906 env->pc = env->npc;
1907 env->npc += 4;
1908
1909 err = 0;
1910
1911 sigprocmask(0, NULL, &set);
1912 host_to_target_sigset_internal(&target_set, &set);
1913 if (TARGET_NSIG_WORDS == 1)
579a97f7
FB
1914 err |= __put_user(target_set.sig[0],
1915 (abi_ulong *)&ucp->uc_sigmask);
5bfb56b2
BS
1916 else {
1917 src = &target_set;
1918 dst = &ucp->uc_sigmask;
992f48a0 1919 for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
5bfb56b2 1920 i++, dst++, src++)
579a97f7 1921 err |= __put_user(src, dst);
5bfb56b2
BS
1922 if (err)
1923 goto do_sigsegv;
1924 }
1925
579a97f7
FB
1926 err |= __put_user(env->tstate, &((*grp)[MC_TSTATE]));
1927 err |= __put_user(env->pc, &((*grp)[MC_PC]));
1928 err |= __put_user(env->npc, &((*grp)[MC_NPC]));
1929 err |= __put_user(env->y, &((*grp)[MC_Y]));
1930 err |= __put_user(env->gregs[1], &((*grp)[MC_G1]));
1931 err |= __put_user(env->gregs[2], &((*grp)[MC_G2]));
1932 err |= __put_user(env->gregs[3], &((*grp)[MC_G3]));
1933 err |= __put_user(env->gregs[4], &((*grp)[MC_G4]));
1934 err |= __put_user(env->gregs[5], &((*grp)[MC_G5]));
1935 err |= __put_user(env->gregs[6], &((*grp)[MC_G6]));
1936 err |= __put_user(env->gregs[7], &((*grp)[MC_G7]));
1937 err |= __put_user(env->regwptr[UREG_I0], &((*grp)[MC_O0]));
1938 err |= __put_user(env->regwptr[UREG_I1], &((*grp)[MC_O1]));
1939 err |= __put_user(env->regwptr[UREG_I2], &((*grp)[MC_O2]));
1940 err |= __put_user(env->regwptr[UREG_I3], &((*grp)[MC_O3]));
1941 err |= __put_user(env->regwptr[UREG_I4], &((*grp)[MC_O4]));
1942 err |= __put_user(env->regwptr[UREG_I5], &((*grp)[MC_O5]));
1943 err |= __put_user(env->regwptr[UREG_I6], &((*grp)[MC_O6]));
1944 err |= __put_user(env->regwptr[UREG_I7], &((*grp)[MC_O7]));
1945
1946 err |= __get_user(fp,
1947 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[6])));
1948 err |= __get_user(i7,
1949 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[7])));
1950 err |= __put_user(fp, &(mcp->mc_fp));
1951 err |= __put_user(i7, &(mcp->mc_i7));
5bfb56b2
BS
1952
1953 src = &env->fpr;
1954 dst = &(ucp->uc_mcontext.mc_fpregs.mcfpu_fregs);
1955 for (i = 0; i < 64; i++, dst++, src++)
579a97f7
FB
1956 err |= __put_user(src, dst);
1957 err |= __put_user(env->fsr, &(mcp->mc_fpregs.mcfpu_fsr));
1958 err |= __put_user(env->gsr, &(mcp->mc_fpregs.mcfpu_gsr));
1959 err |= __put_user(env->fprs, &(mcp->mc_fpregs.mcfpu_fprs));
5bfb56b2
BS
1960
1961 if (err)
1962 goto do_sigsegv;
1963
1964 return;
1965 do_sigsegv:
1966 force_sig(SIGSEGV);
1967}
1968#endif
d26bc211 1969#elif defined(TARGET_ABI_MIPSN64)
540635ba
TS
1970
1971# warning signal handling not implemented
1972
1973static void setup_frame(int sig, struct emulated_sigaction *ka,
1974 target_sigset_t *set, CPUState *env)
1975{
1976 fprintf(stderr, "setup_frame: not implemented\n");
1977}
1978
1979static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
1980 target_siginfo_t *info,
1981 target_sigset_t *set, CPUState *env)
1982{
1983 fprintf(stderr, "setup_rt_frame: not implemented\n");
1984}
1985
1986long do_sigreturn(CPUState *env)
1987{
1988 fprintf(stderr, "do_sigreturn: not implemented\n");
1989 return -ENOSYS;
1990}
1991
1992long do_rt_sigreturn(CPUState *env)
1993{
1994 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
1995 return -ENOSYS;
1996}
1997
d26bc211 1998#elif defined(TARGET_ABI_MIPSN32)
540635ba
TS
1999
2000# warning signal handling not implemented
2001
2002static void setup_frame(int sig, struct emulated_sigaction *ka,
2003 target_sigset_t *set, CPUState *env)
2004{
2005 fprintf(stderr, "setup_frame: not implemented\n");
2006}
2007
2008static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
2009 target_siginfo_t *info,
2010 target_sigset_t *set, CPUState *env)
2011{
2012 fprintf(stderr, "setup_rt_frame: not implemented\n");
2013}
2014
2015long do_sigreturn(CPUState *env)
2016{
2017 fprintf(stderr, "do_sigreturn: not implemented\n");
2018 return -ENOSYS;
2019}
2020
2021long do_rt_sigreturn(CPUState *env)
2022{
2023 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2024 return -ENOSYS;
2025}
2026
d26bc211 2027#elif defined(TARGET_ABI_MIPSO32)
106ec879
FB
2028
2029struct target_sigcontext {
2030 uint32_t sc_regmask; /* Unused */
2031 uint32_t sc_status;
2032 uint64_t sc_pc;
2033 uint64_t sc_regs[32];
2034 uint64_t sc_fpregs[32];
2035 uint32_t sc_ownedfp; /* Unused */
2036 uint32_t sc_fpc_csr;
2037 uint32_t sc_fpc_eir; /* Unused */
2038 uint32_t sc_used_math;
2039 uint32_t sc_dsp; /* dsp status, was sc_ssflags */
2040 uint64_t sc_mdhi;
2041 uint64_t sc_mdlo;
2042 target_ulong sc_hi1; /* Was sc_cause */
2043 target_ulong sc_lo1; /* Was sc_badvaddr */
2044 target_ulong sc_hi2; /* Was sc_sigset[4] */
2045 target_ulong sc_lo2;
2046 target_ulong sc_hi3;
2047 target_ulong sc_lo3;
2048};
2049
2050struct sigframe {
2051 uint32_t sf_ass[4]; /* argument save space for o32 */
2052 uint32_t sf_code[2]; /* signal trampoline */
2053 struct target_sigcontext sf_sc;
2054 target_sigset_t sf_mask;
2055};
2056
2057/* Install trampoline to jump back from signal handler */
2058static inline int install_sigtramp(unsigned int *tramp, unsigned int syscall)
2059{
2060 int err;
2061
2062 /*
2063 * Set up the return code ...
2064 *
2065 * li v0, __NR__foo_sigreturn
2066 * syscall
2067 */
2068
2069 err = __put_user(0x24020000 + syscall, tramp + 0);
2070 err |= __put_user(0x0000000c , tramp + 1);
2071 /* flush_cache_sigtramp((unsigned long) tramp); */
2072 return err;
2073}
2074
2075static inline int
2076setup_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2077{
2078 int err = 0;
2079
ead9360e 2080 err |= __put_user(regs->PC[regs->current_tc], &sc->sc_pc);
106ec879 2081
ead9360e
TS
2082#define save_gp_reg(i) do { \
2083 err |= __put_user(regs->gpr[i][regs->current_tc], &sc->sc_regs[i]); \
106ec879
FB
2084 } while(0)
2085 __put_user(0, &sc->sc_regs[0]); save_gp_reg(1); save_gp_reg(2);
2086 save_gp_reg(3); save_gp_reg(4); save_gp_reg(5); save_gp_reg(6);
2087 save_gp_reg(7); save_gp_reg(8); save_gp_reg(9); save_gp_reg(10);
2088 save_gp_reg(11); save_gp_reg(12); save_gp_reg(13); save_gp_reg(14);
2089 save_gp_reg(15); save_gp_reg(16); save_gp_reg(17); save_gp_reg(18);
2090 save_gp_reg(19); save_gp_reg(20); save_gp_reg(21); save_gp_reg(22);
2091 save_gp_reg(23); save_gp_reg(24); save_gp_reg(25); save_gp_reg(26);
2092 save_gp_reg(27); save_gp_reg(28); save_gp_reg(29); save_gp_reg(30);
2093 save_gp_reg(31);
388bb21a 2094#undef save_gp_reg
106ec879 2095
ead9360e
TS
2096 err |= __put_user(regs->HI[0][regs->current_tc], &sc->sc_mdhi);
2097 err |= __put_user(regs->LO[0][regs->current_tc], &sc->sc_mdlo);
106ec879
FB
2098
2099 /* Not used yet, but might be useful if we ever have DSP suppport */
2100#if 0
2101 if (cpu_has_dsp) {
2102 err |= __put_user(mfhi1(), &sc->sc_hi1);
2103 err |= __put_user(mflo1(), &sc->sc_lo1);
2104 err |= __put_user(mfhi2(), &sc->sc_hi2);
2105 err |= __put_user(mflo2(), &sc->sc_lo2);
2106 err |= __put_user(mfhi3(), &sc->sc_hi3);
2107 err |= __put_user(mflo3(), &sc->sc_lo3);
2108 err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2109 }
2110 /* same with 64 bit */
388bb21a 2111#ifdef CONFIG_64BIT
106ec879
FB
2112 err |= __put_user(regs->hi, &sc->sc_hi[0]);
2113 err |= __put_user(regs->lo, &sc->sc_lo[0]);
2114 if (cpu_has_dsp) {
2115 err |= __put_user(mfhi1(), &sc->sc_hi[1]);
2116 err |= __put_user(mflo1(), &sc->sc_lo[1]);
2117 err |= __put_user(mfhi2(), &sc->sc_hi[2]);
2118 err |= __put_user(mflo2(), &sc->sc_lo[2]);
2119 err |= __put_user(mfhi3(), &sc->sc_hi[3]);
2120 err |= __put_user(mflo3(), &sc->sc_lo[3]);
2121 err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2122 }
388bb21a
TS
2123#endif
2124#endif
106ec879 2125
388bb21a 2126#if 0
106ec879
FB
2127 err |= __put_user(!!used_math(), &sc->sc_used_math);
2128
2129 if (!used_math())
2130 goto out;
2131
2132 /*
2133 * Save FPU state to signal context. Signal handler will "inherit"
2134 * current FPU state.
2135 */
2136 preempt_disable();
2137
2138 if (!is_fpu_owner()) {
2139 own_fpu();
2140 restore_fp(current);
2141 }
2142 err |= save_fp_context(sc);
2143
2144 preempt_enable();
2145 out:
2146#endif
2147 return err;
2148}
2149
2150static inline int
2151restore_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2152{
2153 int err = 0;
2154
2155 err |= __get_user(regs->CP0_EPC, &sc->sc_pc);
2156
ead9360e
TS
2157 err |= __get_user(regs->HI[0][regs->current_tc], &sc->sc_mdhi);
2158 err |= __get_user(regs->LO[0][regs->current_tc], &sc->sc_mdlo);
106ec879 2159
ead9360e
TS
2160#define restore_gp_reg(i) do { \
2161 err |= __get_user(regs->gpr[i][regs->current_tc], &sc->sc_regs[i]); \
106ec879
FB
2162 } while(0)
2163 restore_gp_reg( 1); restore_gp_reg( 2); restore_gp_reg( 3);
2164 restore_gp_reg( 4); restore_gp_reg( 5); restore_gp_reg( 6);
2165 restore_gp_reg( 7); restore_gp_reg( 8); restore_gp_reg( 9);
2166 restore_gp_reg(10); restore_gp_reg(11); restore_gp_reg(12);
2167 restore_gp_reg(13); restore_gp_reg(14); restore_gp_reg(15);
2168 restore_gp_reg(16); restore_gp_reg(17); restore_gp_reg(18);
2169 restore_gp_reg(19); restore_gp_reg(20); restore_gp_reg(21);
2170 restore_gp_reg(22); restore_gp_reg(23); restore_gp_reg(24);
2171 restore_gp_reg(25); restore_gp_reg(26); restore_gp_reg(27);
2172 restore_gp_reg(28); restore_gp_reg(29); restore_gp_reg(30);
2173 restore_gp_reg(31);
388bb21a 2174#undef restore_gp_reg
106ec879
FB
2175
2176#if 0
2177 if (cpu_has_dsp) {
2178 err |= __get_user(treg, &sc->sc_hi1); mthi1(treg);
2179 err |= __get_user(treg, &sc->sc_lo1); mtlo1(treg);
2180 err |= __get_user(treg, &sc->sc_hi2); mthi2(treg);
2181 err |= __get_user(treg, &sc->sc_lo2); mtlo2(treg);
2182 err |= __get_user(treg, &sc->sc_hi3); mthi3(treg);
2183 err |= __get_user(treg, &sc->sc_lo3); mtlo3(treg);
2184 err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2185 }
388bb21a 2186#ifdef CONFIG_64BIT
106ec879
FB
2187 err |= __get_user(regs->hi, &sc->sc_hi[0]);
2188 err |= __get_user(regs->lo, &sc->sc_lo[0]);
2189 if (cpu_has_dsp) {
2190 err |= __get_user(treg, &sc->sc_hi[1]); mthi1(treg);
2191 err |= __get_user(treg, &sc->sc_lo[1]); mthi1(treg);
2192 err |= __get_user(treg, &sc->sc_hi[2]); mthi2(treg);
2193 err |= __get_user(treg, &sc->sc_lo[2]); mthi2(treg);
2194 err |= __get_user(treg, &sc->sc_hi[3]); mthi3(treg);
2195 err |= __get_user(treg, &sc->sc_lo[3]); mthi3(treg);
2196 err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2197 }
388bb21a 2198#endif
106ec879
FB
2199
2200 err |= __get_user(used_math, &sc->sc_used_math);
2201 conditional_used_math(used_math);
2202
2203 preempt_disable();
2204
2205 if (used_math()) {
2206 /* restore fpu context if we have used it before */
2207 own_fpu();
2208 err |= restore_fp_context(sc);
2209 } else {
2210 /* signal handler may have used FPU. Give it up. */
2211 lose_fpu();
2212 }
2213
2214 preempt_enable();
2215#endif
2216 return err;
2217}
2218/*
2219 * Determine which stack to use..
2220 */
579a97f7 2221static inline abi_ulong
106ec879
FB
2222get_sigframe(struct emulated_sigaction *ka, CPUState *regs, size_t frame_size)
2223{
2224 unsigned long sp;
2225
2226 /* Default to using normal stack */
ead9360e 2227 sp = regs->gpr[29][regs->current_tc];
106ec879
FB
2228
2229 /*
2230 * FPU emulator may have it's own trampoline active just
2231 * above the user stack, 16-bytes before the next lowest
2232 * 16 byte boundary. Try to avoid trashing it.
2233 */
2234 sp -= 32;
2235
106ec879 2236 /* This is the X/Open sanctioned signal stack switching. */
a04e134a
TS
2237 if ((ka->sa.sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
2238 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
2239 }
106ec879 2240
579a97f7 2241 return (sp - frame_size) & ~7;
106ec879
FB
2242}
2243
579a97f7 2244/* compare linux/arch/mips/kernel/signal.c:setup_frame() */
5fafdf24 2245static void setup_frame(int sig, struct emulated_sigaction * ka,
579a97f7 2246 target_sigset_t *set, CPUState *regs)
106ec879
FB
2247{
2248 struct sigframe *frame;
579a97f7 2249 abi_ulong frame_addr;
106ec879
FB
2250 int i;
2251
579a97f7
FB
2252 frame_addr = get_sigframe(ka, regs, sizeof(*frame));
2253 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
106ec879
FB
2254 goto give_sigsegv;
2255
2256 install_sigtramp(frame->sf_code, TARGET_NR_sigreturn);
2257
2258 if(setup_sigcontext(regs, &frame->sf_sc))
2259 goto give_sigsegv;
2260
2261 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2262 if(__put_user(set->sig[i], &frame->sf_mask.sig[i]))
2263 goto give_sigsegv;
2264 }
2265
2266 /*
2267 * Arguments to signal handler:
2268 *
2269 * a0 = signal number
2270 * a1 = 0 (should be cause)
2271 * a2 = pointer to struct sigcontext
2272 *
2273 * $25 and PC point to the signal handler, $29 points to the
2274 * struct sigframe.
2275 */
ead9360e
TS
2276 regs->gpr[ 4][regs->current_tc] = sig;
2277 regs->gpr[ 5][regs->current_tc] = 0;
2278 regs->gpr[ 6][regs->current_tc] = h2g(&frame->sf_sc);
2279 regs->gpr[29][regs->current_tc] = h2g(frame);
2280 regs->gpr[31][regs->current_tc] = h2g(frame->sf_code);
106ec879
FB
2281 /* The original kernel code sets CP0_EPC to the handler
2282 * since it returns to userland using eret
2283 * we cannot do this here, and we must set PC directly */
ead9360e 2284 regs->PC[regs->current_tc] = regs->gpr[25][regs->current_tc] = ka->sa._sa_handler;
579a97f7 2285 unlock_user_struct(frame, frame_addr, 1);
106ec879
FB
2286 return;
2287
2288give_sigsegv:
579a97f7 2289 unlock_user_struct(frame, frame_addr, 1);
106ec879 2290 force_sig(TARGET_SIGSEGV/*, current*/);
5fafdf24 2291 return;
106ec879
FB
2292}
2293
2294long do_sigreturn(CPUState *regs)
2295{
388bb21a 2296 struct sigframe *frame;
579a97f7 2297 abi_ulong frame_addr;
388bb21a
TS
2298 sigset_t blocked;
2299 target_sigset_t target_set;
2300 int i;
106ec879
FB
2301
2302#if defined(DEBUG_SIGNAL)
388bb21a 2303 fprintf(stderr, "do_sigreturn\n");
106ec879 2304#endif
579a97f7
FB
2305 frame_addr = regs->gpr[29][regs->current_tc];
2306 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
106ec879
FB
2307 goto badframe;
2308
388bb21a 2309 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
106ec879
FB
2310 if(__get_user(target_set.sig[i], &frame->sf_mask.sig[i]))
2311 goto badframe;
388bb21a 2312 }
106ec879 2313
388bb21a
TS
2314 target_to_host_sigset_internal(&blocked, &target_set);
2315 sigprocmask(SIG_SETMASK, &blocked, NULL);
106ec879 2316
388bb21a 2317 if (restore_sigcontext(regs, &frame->sf_sc))
106ec879
FB
2318 goto badframe;
2319
2320#if 0
388bb21a
TS
2321 /*
2322 * Don't let your children do this ...
2323 */
2324 __asm__ __volatile__(
106ec879
FB
2325 "move\t$29, %0\n\t"
2326 "j\tsyscall_exit"
2327 :/* no outputs */
2328 :"r" (&regs));
388bb21a 2329 /* Unreached */
106ec879 2330#endif
3b46e624 2331
ead9360e 2332 regs->PC[regs->current_tc] = regs->CP0_EPC;
388bb21a 2333 /* I am not sure this is right, but it seems to work
106ec879
FB
2334 * maybe a problem with nested signals ? */
2335 regs->CP0_EPC = 0;
2336 return 0;
2337
2338badframe:
388bb21a
TS
2339 force_sig(TARGET_SIGSEGV/*, current*/);
2340 return 0;
106ec879
FB
2341}
2342
5fafdf24 2343static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
106ec879
FB
2344 target_siginfo_t *info,
2345 target_sigset_t *set, CPUState *env)
2346{
2347 fprintf(stderr, "setup_rt_frame: not implemented\n");
2348}
2349
2350long do_rt_sigreturn(CPUState *env)
2351{
2352 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2353 return -ENOSYS;
2354}
6d5e216d 2355
b346ff46
FB
2356#else
2357
2358static void setup_frame(int sig, struct emulated_sigaction *ka,
2359 target_sigset_t *set, CPUState *env)
2360{
2361 fprintf(stderr, "setup_frame: not implemented\n");
2362}
2363
5fafdf24 2364static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
b346ff46
FB
2365 target_siginfo_t *info,
2366 target_sigset_t *set, CPUState *env)
2367{
2368 fprintf(stderr, "setup_rt_frame: not implemented\n");
2369}
2370
2371long do_sigreturn(CPUState *env)
2372{
2373 fprintf(stderr, "do_sigreturn: not implemented\n");
2374 return -ENOSYS;
2375}
2376
2377long do_rt_sigreturn(CPUState *env)
2378{
2379 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2380 return -ENOSYS;
2381}
2382
66fb9763
FB
2383#endif
2384
2385void process_pending_signals(void *cpu_env)
2386{
2387 int sig;
992f48a0 2388 abi_ulong handler;
9de5e440
FB
2389 sigset_t set, old_set;
2390 target_sigset_t target_old_set;
66fb9763
FB
2391 struct emulated_sigaction *k;
2392 struct sigqueue *q;
3b46e624 2393
31e31b8a
FB
2394 if (!signal_pending)
2395 return;
2396
66fb9763
FB
2397 k = sigact_table;
2398 for(sig = 1; sig <= TARGET_NSIG; sig++) {
2399 if (k->pending)
31e31b8a 2400 goto handle_signal;
66fb9763 2401 k++;
31e31b8a
FB
2402 }
2403 /* if no signal is pending, just return */
2404 signal_pending = 0;
2405 return;
66fb9763 2406
31e31b8a 2407 handle_signal:
66fb9763 2408#ifdef DEBUG_SIGNAL
bc8a22cc 2409 fprintf(stderr, "qemu: process signal %d\n", sig);
66fb9763
FB
2410#endif
2411 /* dequeue signal */
2412 q = k->first;
2413 k->first = q->next;
2414 if (!k->first)
2415 k->pending = 0;
3b46e624 2416
1fddef4b
FB
2417 sig = gdb_handlesig (cpu_env, sig);
2418 if (!sig) {
2419 fprintf (stderr, "Lost signal\n");
2420 abort();
2421 }
66fb9763
FB
2422
2423 handler = k->sa._sa_handler;
2424 if (handler == TARGET_SIG_DFL) {
2425 /* default handler : ignore some signal. The other are fatal */
5fafdf24
TS
2426 if (sig != TARGET_SIGCHLD &&
2427 sig != TARGET_SIGURG &&
66fb9763
FB
2428 sig != TARGET_SIGWINCH) {
2429 force_sig(sig);
2430 }
2431 } else if (handler == TARGET_SIG_IGN) {
2432 /* ignore sig */
2433 } else if (handler == TARGET_SIG_ERR) {
2434 force_sig(sig);
2435 } else {
9de5e440
FB
2436 /* compute the blocked signals during the handler execution */
2437 target_to_host_sigset(&set, &k->sa.sa_mask);
2438 /* SA_NODEFER indicates that the current signal should not be
2439 blocked during the handler */
2440 if (!(k->sa.sa_flags & TARGET_SA_NODEFER))
2441 sigaddset(&set, target_to_host_signal(sig));
3b46e624 2442
9de5e440
FB
2443 /* block signals in the handler using Linux */
2444 sigprocmask(SIG_BLOCK, &set, &old_set);
2445 /* save the previous blocked signal state to restore it at the
2446 end of the signal execution (see do_sigreturn) */
9231944d 2447 host_to_target_sigset_internal(&target_old_set, &old_set);
9de5e440 2448
bc8a22cc 2449 /* if the CPU is in VM86 mode, we restore the 32 bit values */
84409ddb 2450#if defined(TARGET_I386) && !defined(TARGET_X86_64)
bc8a22cc
FB
2451 {
2452 CPUX86State *env = cpu_env;
2453 if (env->eflags & VM_MASK)
2454 save_v86_state(env);
2455 }
2456#endif
9de5e440 2457 /* prepare the stack frame of the virtual CPU */
66fb9763 2458 if (k->sa.sa_flags & TARGET_SA_SIGINFO)
9de5e440 2459 setup_rt_frame(sig, k, &q->info, &target_old_set, cpu_env);
66fb9763 2460 else
9de5e440 2461 setup_frame(sig, k, &target_old_set, cpu_env);
66fb9763
FB
2462 if (k->sa.sa_flags & TARGET_SA_RESETHAND)
2463 k->sa._sa_handler = TARGET_SIG_DFL;
31e31b8a 2464 }
66fb9763
FB
2465 if (q != &k->info)
2466 free_sigqueue(q);
2467}