]> git.proxmox.com Git - mirror_qemu.git/blame - linux-user/signal.c
removed warning
[mirror_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;
775b58d8 673 uint16_t magic;
66fb9763 674
579a97f7 675 /* already locked in setup_frame() */
a52c757c
FB
676 err |= __put_user(env->segs[R_GS].selector, (unsigned int *)&sc->gs);
677 err |= __put_user(env->segs[R_FS].selector, (unsigned int *)&sc->fs);
678 err |= __put_user(env->segs[R_ES].selector, (unsigned int *)&sc->es);
679 err |= __put_user(env->segs[R_DS].selector, (unsigned int *)&sc->ds);
66fb9763
FB
680 err |= __put_user(env->regs[R_EDI], &sc->edi);
681 err |= __put_user(env->regs[R_ESI], &sc->esi);
682 err |= __put_user(env->regs[R_EBP], &sc->ebp);
683 err |= __put_user(env->regs[R_ESP], &sc->esp);
684 err |= __put_user(env->regs[R_EBX], &sc->ebx);
685 err |= __put_user(env->regs[R_EDX], &sc->edx);
686 err |= __put_user(env->regs[R_ECX], &sc->ecx);
687 err |= __put_user(env->regs[R_EAX], &sc->eax);
66099dd9
FB
688 err |= __put_user(env->exception_index, &sc->trapno);
689 err |= __put_user(env->error_code, &sc->err);
66fb9763 690 err |= __put_user(env->eip, &sc->eip);
a52c757c 691 err |= __put_user(env->segs[R_CS].selector, (unsigned int *)&sc->cs);
66fb9763
FB
692 err |= __put_user(env->eflags, &sc->eflags);
693 err |= __put_user(env->regs[R_ESP], &sc->esp_at_signal);
a52c757c 694 err |= __put_user(env->segs[R_SS].selector, (unsigned int *)&sc->ss);
ed2dcdf6
FB
695
696 cpu_x86_fsave(env, (void *)fpstate, 1);
697 fpstate->status = fpstate->sw;
775b58d8
FB
698 magic = 0xffff;
699 err |= __put_user(magic, &fpstate->magic);
ed2dcdf6
FB
700 err |= __put_user(fpstate, &sc->fpstate);
701
66fb9763
FB
702 /* non-iBCS2 extensions.. */
703 err |= __put_user(mask, &sc->oldmask);
a52c757c 704 err |= __put_user(env->cr[2], &sc->cr2);
66fb9763 705 return err;
31e31b8a
FB
706}
707
66fb9763
FB
708/*
709 * Determine which stack to use..
710 */
31e31b8a 711
579a97f7 712static inline abi_ulong
66fb9763 713get_sigframe(struct emulated_sigaction *ka, CPUX86State *env, size_t frame_size)
31e31b8a 714{
66fb9763
FB
715 unsigned long esp;
716
717 /* Default to using normal stack */
718 esp = env->regs[R_ESP];
66fb9763 719 /* This is the X/Open sanctioned signal stack switching. */
a04e134a
TS
720 if (ka->sa.sa_flags & TARGET_SA_ONSTACK) {
721 if (sas_ss_flags(esp) == 0)
722 esp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
723 }
66fb9763
FB
724
725 /* This is the legacy signal stack switching. */
5fafdf24 726 else
a52c757c
FB
727 if ((env->segs[R_SS].selector & 0xffff) != __USER_DS &&
728 !(ka->sa.sa_flags & TARGET_SA_RESTORER) &&
729 ka->sa.sa_restorer) {
730 esp = (unsigned long) ka->sa.sa_restorer;
731 }
579a97f7 732 return (esp - frame_size) & -8ul;
66fb9763
FB
733}
734
579a97f7 735/* compare linux/arch/i386/kernel/signal.c:setup_frame() */
66fb9763
FB
736static void setup_frame(int sig, struct emulated_sigaction *ka,
737 target_sigset_t *set, CPUX86State *env)
738{
579a97f7 739 abi_ulong frame_addr;
66fb9763 740 struct sigframe *frame;
9231944d 741 int i, err = 0;
66fb9763 742
579a97f7 743 frame_addr = get_sigframe(ka, env, sizeof(*frame));
66fb9763 744
579a97f7 745 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
66fb9763 746 goto give_sigsegv;
579a97f7 747
66fb9763
FB
748 err |= __put_user((/*current->exec_domain
749 && current->exec_domain->signal_invmap
750 && sig < 32
751 ? current->exec_domain->signal_invmap[sig]
752 : */ sig),
753 &frame->sig);
754 if (err)
755 goto give_sigsegv;
756
757 setup_sigcontext(&frame->sc, &frame->fpstate, env, set->sig[0]);
758 if (err)
759 goto give_sigsegv;
760
9231944d
FB
761 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
762 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
763 goto give_sigsegv;
764 }
66fb9763
FB
765
766 /* Set up to return from userspace. If provided, use a stub
767 already in userspace. */
768 if (ka->sa.sa_flags & TARGET_SA_RESTORER) {
769 err |= __put_user(ka->sa.sa_restorer, &frame->pretcode);
770 } else {
775b58d8 771 uint16_t val16;
66fb9763
FB
772 err |= __put_user(frame->retcode, &frame->pretcode);
773 /* This is popl %eax ; movl $,%eax ; int $0x80 */
775b58d8
FB
774 val16 = 0xb858;
775 err |= __put_user(val16, (uint16_t *)(frame->retcode+0));
84409ddb
JM
776#if defined(TARGET_X86_64)
777#warning "Fix this !"
778#else
66fb9763 779 err |= __put_user(TARGET_NR_sigreturn, (int *)(frame->retcode+2));
84409ddb 780#endif
775b58d8
FB
781 val16 = 0x80cd;
782 err |= __put_user(val16, (uint16_t *)(frame->retcode+6));
66fb9763
FB
783 }
784
785 if (err)
786 goto give_sigsegv;
787
788 /* Set up registers for signal handler */
53a5960a 789 env->regs[R_ESP] = h2g(frame);
66fb9763
FB
790 env->eip = (unsigned long) ka->sa._sa_handler;
791
792 cpu_x86_load_seg(env, R_DS, __USER_DS);
793 cpu_x86_load_seg(env, R_ES, __USER_DS);
794 cpu_x86_load_seg(env, R_SS, __USER_DS);
795 cpu_x86_load_seg(env, R_CS, __USER_CS);
796 env->eflags &= ~TF_MASK;
797
579a97f7
FB
798 unlock_user_struct(frame, frame_addr, 1);
799
66fb9763
FB
800 return;
801
802give_sigsegv:
579a97f7 803 unlock_user_struct(frame, frame_addr, 1);
66fb9763
FB
804 if (sig == TARGET_SIGSEGV)
805 ka->sa._sa_handler = TARGET_SIG_DFL;
806 force_sig(TARGET_SIGSEGV /* , current */);
807}
808
579a97f7 809/* compare linux/arch/i386/kernel/signal.c:setup_rt_frame() */
5fafdf24 810static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
9de5e440 811 target_siginfo_t *info,
66fb9763
FB
812 target_sigset_t *set, CPUX86State *env)
813{
579a97f7 814 abi_ulong frame_addr;
66fb9763 815 struct rt_sigframe *frame;
9231944d 816 int i, err = 0;
66fb9763 817
579a97f7 818 frame_addr = get_sigframe(ka, env, sizeof(*frame));
66fb9763 819
579a97f7 820 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
66fb9763 821 goto give_sigsegv;
66fb9763
FB
822
823 err |= __put_user((/*current->exec_domain
824 && current->exec_domain->signal_invmap
825 && sig < 32
826 ? current->exec_domain->signal_invmap[sig]
827 : */sig),
828 &frame->sig);
992f48a0
BS
829 err |= __put_user((abi_ulong)&frame->info, &frame->pinfo);
830 err |= __put_user((abi_ulong)&frame->uc, &frame->puc);
66fb9763
FB
831 err |= copy_siginfo_to_user(&frame->info, info);
832 if (err)
833 goto give_sigsegv;
31e31b8a 834
66fb9763 835 /* Create the ucontext. */
b8076a74
FB
836 err |= __put_user(0, &frame->uc.tuc_flags);
837 err |= __put_user(0, &frame->uc.tuc_link);
a04e134a 838 err |= __put_user(target_sigaltstack_used.ss_sp,
b8076a74 839 &frame->uc.tuc_stack.ss_sp);
a04e134a 840 err |= __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
b8076a74 841 &frame->uc.tuc_stack.ss_flags);
a04e134a 842 err |= __put_user(target_sigaltstack_used.ss_size,
b8076a74
FB
843 &frame->uc.tuc_stack.ss_size);
844 err |= setup_sigcontext(&frame->uc.tuc_mcontext, &frame->fpstate,
66fb9763 845 env, set->sig[0]);
9231944d 846 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
b8076a74 847 if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
9231944d
FB
848 goto give_sigsegv;
849 }
31e31b8a 850
66fb9763
FB
851 /* Set up to return from userspace. If provided, use a stub
852 already in userspace. */
853 if (ka->sa.sa_flags & TARGET_SA_RESTORER) {
854 err |= __put_user(ka->sa.sa_restorer, &frame->pretcode);
855 } else {
775b58d8
FB
856 uint16_t val16;
857
66fb9763
FB
858 err |= __put_user(frame->retcode, &frame->pretcode);
859 /* This is movl $,%eax ; int $0x80 */
775b58d8 860 err |= __put_user(0xb8, (char *)(frame->retcode+0));
66fb9763 861 err |= __put_user(TARGET_NR_rt_sigreturn, (int *)(frame->retcode+1));
775b58d8
FB
862 val16 = 0x80cd;
863 err |= __put_user(val16, (uint16_t *)(frame->retcode+5));
66fb9763
FB
864 }
865
866 if (err)
867 goto give_sigsegv;
868
869 /* Set up registers for signal handler */
870 env->regs[R_ESP] = (unsigned long) frame;
871 env->eip = (unsigned long) ka->sa._sa_handler;
872
873 cpu_x86_load_seg(env, R_DS, __USER_DS);
874 cpu_x86_load_seg(env, R_ES, __USER_DS);
875 cpu_x86_load_seg(env, R_SS, __USER_DS);
876 cpu_x86_load_seg(env, R_CS, __USER_CS);
877 env->eflags &= ~TF_MASK;
878
579a97f7
FB
879 unlock_user_struct(frame, frame_addr, 1);
880
66fb9763
FB
881 return;
882
883give_sigsegv:
579a97f7 884 unlock_user_struct(frame, frame_addr, 1);
66fb9763
FB
885 if (sig == TARGET_SIGSEGV)
886 ka->sa._sa_handler = TARGET_SIG_DFL;
887 force_sig(TARGET_SIGSEGV /* , current */);
888}
889
890static int
891restore_sigcontext(CPUX86State *env, struct target_sigcontext *sc, int *peax)
892{
893 unsigned int err = 0;
894
66fb9763
FB
895 cpu_x86_load_seg(env, R_GS, lduw(&sc->gs));
896 cpu_x86_load_seg(env, R_FS, lduw(&sc->fs));
897 cpu_x86_load_seg(env, R_ES, lduw(&sc->es));
898 cpu_x86_load_seg(env, R_DS, lduw(&sc->ds));
899
900 env->regs[R_EDI] = ldl(&sc->edi);
901 env->regs[R_ESI] = ldl(&sc->esi);
902 env->regs[R_EBP] = ldl(&sc->ebp);
903 env->regs[R_ESP] = ldl(&sc->esp);
904 env->regs[R_EBX] = ldl(&sc->ebx);
905 env->regs[R_EDX] = ldl(&sc->edx);
906 env->regs[R_ECX] = ldl(&sc->ecx);
907 env->eip = ldl(&sc->eip);
908
909 cpu_x86_load_seg(env, R_CS, lduw(&sc->cs) | 3);
910 cpu_x86_load_seg(env, R_SS, lduw(&sc->ss) | 3);
5fafdf24 911
66fb9763
FB
912 {
913 unsigned int tmpflags;
914 tmpflags = ldl(&sc->eflags);
915 env->eflags = (env->eflags & ~0x40DD5) | (tmpflags & 0x40DD5);
916 // regs->orig_eax = -1; /* disable syscall checks */
917 }
918
66fb9763
FB
919 {
920 struct _fpstate * buf;
ed2dcdf6 921 buf = (void *)ldl(&sc->fpstate);
66fb9763 922 if (buf) {
ed2dcdf6 923#if 0
66fb9763
FB
924 if (verify_area(VERIFY_READ, buf, sizeof(*buf)))
925 goto badframe;
ed2dcdf6
FB
926#endif
927 cpu_x86_frstor(env, (void *)buf, 1);
66fb9763
FB
928 }
929 }
ed2dcdf6 930
66fb9763
FB
931 *peax = ldl(&sc->eax);
932 return err;
933#if 0
934badframe:
935 return 1;
936#endif
937}
938
939long do_sigreturn(CPUX86State *env)
940{
579a97f7
FB
941 struct sigframe *frame;
942 abi_ulong frame_addr = env->regs[R_ESP] - 8;
66fb9763
FB
943 target_sigset_t target_set;
944 sigset_t set;
945 int eax, i;
946
447db213
FB
947#if defined(DEBUG_SIGNAL)
948 fprintf(stderr, "do_sigreturn\n");
949#endif
579a97f7
FB
950 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
951 goto badframe;
66fb9763 952 /* set blocked signals */
9231944d
FB
953 if (__get_user(target_set.sig[0], &frame->sc.oldmask))
954 goto badframe;
955 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
956 if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
957 goto badframe;
958 }
66fb9763 959
9231944d 960 target_to_host_sigset_internal(&set, &target_set);
66fb9763 961 sigprocmask(SIG_SETMASK, &set, NULL);
3b46e624 962
66fb9763
FB
963 /* restore registers */
964 if (restore_sigcontext(env, &frame->sc, &eax))
965 goto badframe;
579a97f7 966 unlock_user_struct(frame, frame_addr, 0);
66fb9763
FB
967 return eax;
968
969badframe:
579a97f7 970 unlock_user_struct(frame, frame_addr, 0);
66fb9763
FB
971 force_sig(TARGET_SIGSEGV);
972 return 0;
973}
974
975long do_rt_sigreturn(CPUX86State *env)
976{
53a5960a 977 struct rt_sigframe *frame = (struct rt_sigframe *)g2h(env->regs[R_ESP] - 4);
66fb9763 978 sigset_t set;
66fb9763
FB
979 int eax;
980
981#if 0
982 if (verify_area(VERIFY_READ, frame, sizeof(*frame)))
983 goto badframe;
984#endif
b8076a74 985 target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
66fb9763 986 sigprocmask(SIG_SETMASK, &set, NULL);
5fafdf24 987
b8076a74 988 if (restore_sigcontext(env, &frame->uc.tuc_mcontext, &eax))
66fb9763
FB
989 goto badframe;
990
579a97f7 991 if (do_sigaltstack(h2g(&frame->uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
66fb9763 992 goto badframe;
a04e134a 993
66fb9763
FB
994 return eax;
995
996badframe:
997 force_sig(TARGET_SIGSEGV);
998 return 0;
999}
1000
43fff238
FB
1001#elif defined(TARGET_ARM)
1002
1003struct target_sigcontext {
992f48a0
BS
1004 abi_ulong trap_no;
1005 abi_ulong error_code;
1006 abi_ulong oldmask;
1007 abi_ulong arm_r0;
1008 abi_ulong arm_r1;
1009 abi_ulong arm_r2;
1010 abi_ulong arm_r3;
1011 abi_ulong arm_r4;
1012 abi_ulong arm_r5;
1013 abi_ulong arm_r6;
1014 abi_ulong arm_r7;
1015 abi_ulong arm_r8;
1016 abi_ulong arm_r9;
1017 abi_ulong arm_r10;
1018 abi_ulong arm_fp;
1019 abi_ulong arm_ip;
1020 abi_ulong arm_sp;
1021 abi_ulong arm_lr;
1022 abi_ulong arm_pc;
1023 abi_ulong arm_cpsr;
1024 abi_ulong fault_address;
43fff238
FB
1025};
1026
43fff238 1027struct target_ucontext {
992f48a0
BS
1028 abi_ulong tuc_flags;
1029 abi_ulong tuc_link;
b8076a74
FB
1030 target_stack_t tuc_stack;
1031 struct target_sigcontext tuc_mcontext;
1032 target_sigset_t tuc_sigmask; /* mask last for extensibility */
43fff238
FB
1033};
1034
1035struct sigframe
1036{
1037 struct target_sigcontext sc;
992f48a0
BS
1038 abi_ulong extramask[TARGET_NSIG_WORDS-1];
1039 abi_ulong retcode;
43fff238
FB
1040};
1041
1042struct rt_sigframe
1043{
1044 struct target_siginfo *pinfo;
1045 void *puc;
1046 struct target_siginfo info;
1047 struct target_ucontext uc;
992f48a0 1048 abi_ulong retcode;
43fff238
FB
1049};
1050
1051#define TARGET_CONFIG_CPU_32 1
1052
1053/*
1054 * For ARM syscalls, we encode the syscall number into the instruction.
1055 */
1056#define SWI_SYS_SIGRETURN (0xef000000|(TARGET_NR_sigreturn + ARM_SYSCALL_BASE))
1057#define SWI_SYS_RT_SIGRETURN (0xef000000|(TARGET_NR_rt_sigreturn + ARM_SYSCALL_BASE))
1058
1059/*
1060 * For Thumb syscalls, we pass the syscall number via r7. We therefore
1061 * need two 16-bit instructions.
1062 */
1063#define SWI_THUMB_SIGRETURN (0xdf00 << 16 | 0x2700 | (TARGET_NR_sigreturn))
1064#define SWI_THUMB_RT_SIGRETURN (0xdf00 << 16 | 0x2700 | (TARGET_NR_rt_sigreturn))
1065
992f48a0 1066static const abi_ulong retcodes[4] = {
43fff238
FB
1067 SWI_SYS_SIGRETURN, SWI_THUMB_SIGRETURN,
1068 SWI_SYS_RT_SIGRETURN, SWI_THUMB_RT_SIGRETURN
1069};
1070
1071
1072#define __put_user_error(x,p,e) __put_user(x, p)
1073#define __get_user_error(x,p,e) __get_user(x, p)
1074
1075static inline int valid_user_regs(CPUState *regs)
1076{
1077 return 1;
1078}
1079
1080static int
1081setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1082 CPUState *env, unsigned long mask)
1083{
1084 int err = 0;
1085
1086 __put_user_error(env->regs[0], &sc->arm_r0, err);
1087 __put_user_error(env->regs[1], &sc->arm_r1, err);
1088 __put_user_error(env->regs[2], &sc->arm_r2, err);
1089 __put_user_error(env->regs[3], &sc->arm_r3, err);
1090 __put_user_error(env->regs[4], &sc->arm_r4, err);
1091 __put_user_error(env->regs[5], &sc->arm_r5, err);
1092 __put_user_error(env->regs[6], &sc->arm_r6, err);
1093 __put_user_error(env->regs[7], &sc->arm_r7, err);
1094 __put_user_error(env->regs[8], &sc->arm_r8, err);
1095 __put_user_error(env->regs[9], &sc->arm_r9, err);
1096 __put_user_error(env->regs[10], &sc->arm_r10, err);
1097 __put_user_error(env->regs[11], &sc->arm_fp, err);
1098 __put_user_error(env->regs[12], &sc->arm_ip, err);
1099 __put_user_error(env->regs[13], &sc->arm_sp, err);
1100 __put_user_error(env->regs[14], &sc->arm_lr, err);
1101 __put_user_error(env->regs[15], &sc->arm_pc, err);
1102#ifdef TARGET_CONFIG_CPU_32
b5ff1b31 1103 __put_user_error(cpsr_read(env), &sc->arm_cpsr, err);
43fff238
FB
1104#endif
1105
1106 __put_user_error(/* current->thread.trap_no */ 0, &sc->trap_no, err);
1107 __put_user_error(/* current->thread.error_code */ 0, &sc->error_code, err);
1108 __put_user_error(/* current->thread.address */ 0, &sc->fault_address, err);
1109 __put_user_error(mask, &sc->oldmask, err);
1110
1111 return err;
1112}
1113
579a97f7 1114static inline abi_ulong
43fff238
FB
1115get_sigframe(struct emulated_sigaction *ka, CPUState *regs, int framesize)
1116{
1117 unsigned long sp = regs->regs[13];
1118
43fff238
FB
1119 /*
1120 * This is the X/Open sanctioned signal stack switching.
1121 */
a04e134a
TS
1122 if ((ka->sa.sa_flags & TARGET_SA_ONSTACK) && !sas_ss_flags(sp))
1123 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
43fff238
FB
1124 /*
1125 * ATPCS B01 mandates 8-byte alignment
1126 */
579a97f7 1127 return (sp - framesize) & ~7;
43fff238
FB
1128}
1129
1130static int
1131setup_return(CPUState *env, struct emulated_sigaction *ka,
992f48a0 1132 abi_ulong *rc, void *frame, int usig)
43fff238 1133{
992f48a0
BS
1134 abi_ulong handler = (abi_ulong)ka->sa._sa_handler;
1135 abi_ulong retcode;
43fff238
FB
1136 int thumb = 0;
1137#if defined(TARGET_CONFIG_CPU_32)
b5ff1b31 1138#if 0
992f48a0 1139 abi_ulong cpsr = env->cpsr;
43fff238 1140
43fff238
FB
1141 /*
1142 * Maybe we need to deliver a 32-bit signal to a 26-bit task.
1143 */
1144 if (ka->sa.sa_flags & SA_THIRTYTWO)
1145 cpsr = (cpsr & ~MODE_MASK) | USR_MODE;
1146
1147#ifdef CONFIG_ARM_THUMB
1148 if (elf_hwcap & HWCAP_THUMB) {
1149 /*
1150 * The LSB of the handler determines if we're going to
1151 * be using THUMB or ARM mode for this signal handler.
1152 */
1153 thumb = handler & 1;
1154
1155 if (thumb)
1156 cpsr |= T_BIT;
1157 else
1158 cpsr &= ~T_BIT;
1159 }
a04e134a
TS
1160#endif /* CONFIG_ARM_THUMB */
1161#endif /* 0 */
43fff238
FB
1162#endif /* TARGET_CONFIG_CPU_32 */
1163
1164 if (ka->sa.sa_flags & TARGET_SA_RESTORER) {
992f48a0 1165 retcode = (abi_ulong)ka->sa.sa_restorer;
43fff238
FB
1166 } else {
1167 unsigned int idx = thumb;
1168
1169 if (ka->sa.sa_flags & TARGET_SA_SIGINFO)
1170 idx += 2;
1171
1172 if (__put_user(retcodes[idx], rc))
1173 return 1;
1174#if 0
992f48a0
BS
1175 flush_icache_range((abi_ulong)rc,
1176 (abi_ulong)(rc + 1));
43fff238 1177#endif
992f48a0 1178 retcode = ((abi_ulong)rc) + thumb;
43fff238
FB
1179 }
1180
1181 env->regs[0] = usig;
53a5960a 1182 env->regs[13] = h2g(frame);
43fff238
FB
1183 env->regs[14] = retcode;
1184 env->regs[15] = handler & (thumb ? ~1 : ~3);
1185
b5ff1b31 1186#if 0
43fff238
FB
1187#ifdef TARGET_CONFIG_CPU_32
1188 env->cpsr = cpsr;
b5ff1b31 1189#endif
43fff238
FB
1190#endif
1191
1192 return 0;
1193}
1194
579a97f7 1195/* compare linux/arch/arm/kernel/signal.c:setup_frame() */
43fff238
FB
1196static void setup_frame(int usig, struct emulated_sigaction *ka,
1197 target_sigset_t *set, CPUState *regs)
1198{
579a97f7
FB
1199 struct sigframe *frame;
1200 abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
9231944d 1201 int i, err = 0;
43fff238 1202
579a97f7
FB
1203 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1204 return;
1205
43fff238
FB
1206 err |= setup_sigcontext(&frame->sc, /*&frame->fpstate,*/ regs, set->sig[0]);
1207
9231944d
FB
1208 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1209 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
579a97f7 1210 goto end;
43fff238
FB
1211 }
1212
1213 if (err == 0)
1214 err = setup_return(regs, ka, &frame->retcode, frame, usig);
579a97f7
FB
1215
1216end:
1217 unlock_user_struct(frame, frame_addr, 1);
43fff238
FB
1218 // return err;
1219}
1220
579a97f7 1221/* compare linux/arch/arm/kernel/signal.c:setup_rt_frame() */
5fafdf24 1222static void setup_rt_frame(int usig, struct emulated_sigaction *ka,
43fff238
FB
1223 target_siginfo_t *info,
1224 target_sigset_t *set, CPUState *env)
1225{
579a97f7
FB
1226 struct rt_sigframe *frame;
1227 abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
a04e134a 1228 struct target_sigaltstack stack;
9231944d 1229 int i, err = 0;
43fff238 1230
579a97f7 1231 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
edf779ff
FB
1232 return /* 1 */;
1233
992f48a0
BS
1234 __put_user_error(&frame->info, (abi_ulong *)&frame->pinfo, err);
1235 __put_user_error(&frame->uc, (abi_ulong *)&frame->puc, err);
43fff238
FB
1236 err |= copy_siginfo_to_user(&frame->info, info);
1237
1238 /* Clear all the bits of the ucontext we don't use. */
53a5960a 1239 memset(&frame->uc, 0, offsetof(struct target_ucontext, tuc_mcontext));
43fff238 1240
a04e134a
TS
1241 memset(&stack, 0, sizeof(stack));
1242 __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
1243 __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
1244 __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
775b58d8 1245 memcpy(&frame->uc.tuc_stack, &stack, sizeof(stack));
a04e134a 1246
b8076a74 1247 err |= setup_sigcontext(&frame->uc.tuc_mcontext, /*&frame->fpstate,*/
43fff238 1248 env, set->sig[0]);
9231944d 1249 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
b8076a74 1250 if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
579a97f7 1251 goto end;
9231944d 1252 }
43fff238
FB
1253
1254 if (err == 0)
1255 err = setup_return(env, ka, &frame->retcode, frame, usig);
1256
1257 if (err == 0) {
1258 /*
1259 * For realtime signals we must also set the second and third
1260 * arguments for the signal handler.
1261 * -- Peter Maydell <pmaydell@chiark.greenend.org.uk> 2000-12-06
1262 */
992f48a0
BS
1263 env->regs[1] = (abi_ulong)frame->pinfo;
1264 env->regs[2] = (abi_ulong)frame->puc;
43fff238
FB
1265 }
1266
579a97f7
FB
1267end:
1268 unlock_user_struct(frame, frame_addr, 1);
1269
43fff238
FB
1270 // return err;
1271}
1272
1273static int
1274restore_sigcontext(CPUState *env, struct target_sigcontext *sc)
1275{
1276 int err = 0;
b5ff1b31 1277 uint32_t cpsr;
43fff238
FB
1278
1279 __get_user_error(env->regs[0], &sc->arm_r0, err);
1280 __get_user_error(env->regs[1], &sc->arm_r1, err);
1281 __get_user_error(env->regs[2], &sc->arm_r2, err);
1282 __get_user_error(env->regs[3], &sc->arm_r3, err);
1283 __get_user_error(env->regs[4], &sc->arm_r4, err);
1284 __get_user_error(env->regs[5], &sc->arm_r5, err);
1285 __get_user_error(env->regs[6], &sc->arm_r6, err);
1286 __get_user_error(env->regs[7], &sc->arm_r7, err);
1287 __get_user_error(env->regs[8], &sc->arm_r8, err);
1288 __get_user_error(env->regs[9], &sc->arm_r9, err);
1289 __get_user_error(env->regs[10], &sc->arm_r10, err);
1290 __get_user_error(env->regs[11], &sc->arm_fp, err);
1291 __get_user_error(env->regs[12], &sc->arm_ip, err);
1292 __get_user_error(env->regs[13], &sc->arm_sp, err);
1293 __get_user_error(env->regs[14], &sc->arm_lr, err);
1294 __get_user_error(env->regs[15], &sc->arm_pc, err);
1295#ifdef TARGET_CONFIG_CPU_32
b5ff1b31
FB
1296 __get_user_error(cpsr, &sc->arm_cpsr, err);
1297 cpsr_write(env, cpsr, 0xffffffff);
43fff238
FB
1298#endif
1299
1300 err |= !valid_user_regs(env);
1301
1302 return err;
1303}
1304
1305long do_sigreturn(CPUState *env)
1306{
1307 struct sigframe *frame;
1308 target_sigset_t set;
1309 sigset_t host_set;
9231944d 1310 int i;
43fff238
FB
1311
1312 /*
1313 * Since we stacked the signal on a 64-bit boundary,
1314 * then 'sp' should be word aligned here. If it's
1315 * not, then the user is trying to mess with us.
1316 */
1317 if (env->regs[13] & 7)
1318 goto badframe;
1319
53a5960a 1320 frame = (struct sigframe *)g2h(env->regs[13]);
43fff238
FB
1321
1322#if 0
1323 if (verify_area(VERIFY_READ, frame, sizeof (*frame)))
1324 goto badframe;
1325#endif
9231944d
FB
1326 if (__get_user(set.sig[0], &frame->sc.oldmask))
1327 goto badframe;
1328 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1329 if (__get_user(set.sig[i], &frame->extramask[i - 1]))
1330 goto badframe;
1331 }
43fff238 1332
9231944d 1333 target_to_host_sigset_internal(&host_set, &set);
43fff238
FB
1334 sigprocmask(SIG_SETMASK, &host_set, NULL);
1335
1336 if (restore_sigcontext(env, &frame->sc))
1337 goto badframe;
1338
1339#if 0
1340 /* Send SIGTRAP if we're single-stepping */
1341 if (ptrace_cancel_bpt(current))
1342 send_sig(SIGTRAP, current, 1);
1343#endif
1344 return env->regs[0];
1345
1346badframe:
1347 force_sig(SIGSEGV /* , current */);
1348 return 0;
1349}
1350
1351long do_rt_sigreturn(CPUState *env)
1352{
1353 struct rt_sigframe *frame;
43fff238
FB
1354 sigset_t host_set;
1355
1356 /*
1357 * Since we stacked the signal on a 64-bit boundary,
1358 * then 'sp' should be word aligned here. If it's
1359 * not, then the user is trying to mess with us.
1360 */
1361 if (env->regs[13] & 7)
1362 goto badframe;
1363
1364 frame = (struct rt_sigframe *)env->regs[13];
1365
1366#if 0
1367 if (verify_area(VERIFY_READ, frame, sizeof (*frame)))
1368 goto badframe;
1369#endif
b8076a74 1370 target_to_host_sigset(&host_set, &frame->uc.tuc_sigmask);
43fff238
FB
1371 sigprocmask(SIG_SETMASK, &host_set, NULL);
1372
b8076a74 1373 if (restore_sigcontext(env, &frame->uc.tuc_mcontext))
43fff238
FB
1374 goto badframe;
1375
579a97f7 1376 if (do_sigaltstack(h2g(&frame->uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
a04e134a
TS
1377 goto badframe;
1378
43fff238
FB
1379#if 0
1380 /* Send SIGTRAP if we're single-stepping */
1381 if (ptrace_cancel_bpt(current))
1382 send_sig(SIGTRAP, current, 1);
1383#endif
1384 return env->regs[0];
1385
1386badframe:
1387 force_sig(SIGSEGV /* , current */);
1388 return 0;
1389}
1390
6d5e216d 1391#elif defined(TARGET_SPARC)
80a9d035 1392
6d5e216d
FB
1393#define __SUNOS_MAXWIN 31
1394
1395/* This is what SunOS does, so shall I. */
1396struct target_sigcontext {
992f48a0 1397 abi_ulong sigc_onstack; /* state to restore */
6d5e216d 1398
992f48a0
BS
1399 abi_ulong sigc_mask; /* sigmask to restore */
1400 abi_ulong sigc_sp; /* stack pointer */
1401 abi_ulong sigc_pc; /* program counter */
1402 abi_ulong sigc_npc; /* next program counter */
1403 abi_ulong sigc_psr; /* for condition codes etc */
1404 abi_ulong sigc_g1; /* User uses these two registers */
1405 abi_ulong sigc_o0; /* within the trampoline code. */
6d5e216d
FB
1406
1407 /* Now comes information regarding the users window set
1408 * at the time of the signal.
1409 */
992f48a0 1410 abi_ulong sigc_oswins; /* outstanding windows */
6d5e216d
FB
1411
1412 /* stack ptrs for each regwin buf */
1413 char *sigc_spbuf[__SUNOS_MAXWIN];
1414
1415 /* Windows to restore after signal */
1416 struct {
992f48a0
BS
1417 abi_ulong locals[8];
1418 abi_ulong ins[8];
6d5e216d
FB
1419 } sigc_wbuf[__SUNOS_MAXWIN];
1420};
1421/* A Sparc stack frame */
1422struct sparc_stackf {
992f48a0
BS
1423 abi_ulong locals[8];
1424 abi_ulong ins[6];
6d5e216d 1425 struct sparc_stackf *fp;
992f48a0 1426 abi_ulong callers_pc;
6d5e216d 1427 char *structptr;
992f48a0
BS
1428 abi_ulong xargs[6];
1429 abi_ulong xxargs[1];
6d5e216d
FB
1430};
1431
1432typedef struct {
1433 struct {
992f48a0
BS
1434 abi_ulong psr;
1435 abi_ulong pc;
1436 abi_ulong npc;
1437 abi_ulong y;
1438 abi_ulong u_regs[16]; /* globals and ins */
6d5e216d
FB
1439 } si_regs;
1440 int si_mask;
1441} __siginfo_t;
1442
1443typedef struct {
1444 unsigned long si_float_regs [32];
1445 unsigned long si_fsr;
1446 unsigned long si_fpqdepth;
1447 struct {
1448 unsigned long *insn_addr;
1449 unsigned long insn;
1450 } si_fpqueue [16];
74ccb34e 1451} qemu_siginfo_fpu_t;
6d5e216d
FB
1452
1453
1454struct target_signal_frame {
1455 struct sparc_stackf ss;
1456 __siginfo_t info;
74ccb34e 1457 qemu_siginfo_fpu_t *fpu_save;
992f48a0
BS
1458 abi_ulong insns[2] __attribute__ ((aligned (8)));
1459 abi_ulong extramask[TARGET_NSIG_WORDS - 1];
1460 abi_ulong extra_size; /* Should be 0 */
74ccb34e 1461 qemu_siginfo_fpu_t fpu_state;
6d5e216d
FB
1462};
1463struct target_rt_signal_frame {
1464 struct sparc_stackf ss;
1465 siginfo_t info;
992f48a0 1466 abi_ulong regs[20];
6d5e216d 1467 sigset_t mask;
74ccb34e 1468 qemu_siginfo_fpu_t *fpu_save;
6d5e216d
FB
1469 unsigned int insns[2];
1470 stack_t stack;
1471 unsigned int extra_size; /* Should be 0 */
74ccb34e 1472 qemu_siginfo_fpu_t fpu_state;
6d5e216d
FB
1473};
1474
e80cfcfc
FB
1475#define UREG_O0 16
1476#define UREG_O6 22
1477#define UREG_I0 0
1478#define UREG_I1 1
1479#define UREG_I2 2
5bfb56b2
BS
1480#define UREG_I3 3
1481#define UREG_I4 4
1482#define UREG_I5 5
e80cfcfc
FB
1483#define UREG_I6 6
1484#define UREG_I7 7
1485#define UREG_L0 8
6d5e216d
FB
1486#define UREG_FP UREG_I6
1487#define UREG_SP UREG_O6
1488
1489static inline void *get_sigframe(struct emulated_sigaction *sa, CPUState *env, unsigned long framesize)
1490{
1491 unsigned long sp;
1492
1493 sp = env->regwptr[UREG_FP];
6d5e216d
FB
1494
1495 /* This is the X/Open sanctioned signal stack switching. */
a04e134a
TS
1496 if (sa->sa.sa_flags & TARGET_SA_ONSTACK) {
1497 if (!on_sig_stack(sp)
1498 && !((target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size) & 7))
1499 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
6d5e216d 1500 }
53a5960a 1501 return g2h(sp - framesize);
6d5e216d
FB
1502}
1503
1504static int
992f48a0 1505setup___siginfo(__siginfo_t *si, CPUState *env, abi_ulong mask)
6d5e216d
FB
1506{
1507 int err = 0, i;
1508
6d5e216d 1509 err |= __put_user(env->psr, &si->si_regs.psr);
6d5e216d
FB
1510 err |= __put_user(env->pc, &si->si_regs.pc);
1511 err |= __put_user(env->npc, &si->si_regs.npc);
1512 err |= __put_user(env->y, &si->si_regs.y);
a315a145 1513 for (i=0; i < 8; i++) {
6d5e216d
FB
1514 err |= __put_user(env->gregs[i], &si->si_regs.u_regs[i]);
1515 }
a315a145 1516 for (i=0; i < 8; i++) {
e80cfcfc 1517 err |= __put_user(env->regwptr[UREG_I0 + i], &si->si_regs.u_regs[i+8]);
6d5e216d 1518 }
6d5e216d
FB
1519 err |= __put_user(mask, &si->si_mask);
1520 return err;
1521}
e80cfcfc 1522
80a9d035 1523#if 0
6d5e216d
FB
1524static int
1525setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1526 CPUState *env, unsigned long mask)
1527{
1528 int err = 0;
1529
1530 err |= __put_user(mask, &sc->sigc_mask);
1531 err |= __put_user(env->regwptr[UREG_SP], &sc->sigc_sp);
1532 err |= __put_user(env->pc, &sc->sigc_pc);
1533 err |= __put_user(env->npc, &sc->sigc_npc);
1534 err |= __put_user(env->psr, &sc->sigc_psr);
1535 err |= __put_user(env->gregs[1], &sc->sigc_g1);
1536 err |= __put_user(env->regwptr[UREG_O0], &sc->sigc_o0);
1537
1538 return err;
1539}
80a9d035 1540#endif
6d5e216d
FB
1541#define NF_ALIGNEDSZ (((sizeof(struct target_signal_frame) + 7) & (~7)))
1542
1543static void setup_frame(int sig, struct emulated_sigaction *ka,
1544 target_sigset_t *set, CPUState *env)
1545{
1546 struct target_signal_frame *sf;
1547 int sigframe_size, err, i;
1548
1549 /* 1. Make sure everything is clean */
1550 //synchronize_user_stack();
1551
1552 sigframe_size = NF_ALIGNEDSZ;
1553
1554 sf = (struct target_signal_frame *)
1555 get_sigframe(ka, env, sigframe_size);
1556
e80cfcfc 1557 //fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
6d5e216d
FB
1558#if 0
1559 if (invalid_frame_pointer(sf, sigframe_size))
1560 goto sigill_and_return;
1561#endif
1562 /* 2. Save the current process state */
1563 err = setup___siginfo(&sf->info, env, set->sig[0]);
1564 err |= __put_user(0, &sf->extra_size);
1565
1566 //err |= save_fpu_state(regs, &sf->fpu_state);
1567 //err |= __put_user(&sf->fpu_state, &sf->fpu_save);
1568
1569 err |= __put_user(set->sig[0], &sf->info.si_mask);
1570 for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
1571 err |= __put_user(set->sig[i + 1], &sf->extramask[i]);
1572 }
1573
a315a145 1574 for (i = 0; i < 8; i++) {
e80cfcfc 1575 err |= __put_user(env->regwptr[i + UREG_L0], &sf->ss.locals[i]);
6d5e216d 1576 }
a315a145 1577 for (i = 0; i < 8; i++) {
e80cfcfc 1578 err |= __put_user(env->regwptr[i + UREG_I0], &sf->ss.ins[i]);
6d5e216d 1579 }
6d5e216d
FB
1580 if (err)
1581 goto sigsegv;
1582
1583 /* 3. signal handler back-trampoline and parameters */
53a5960a 1584 env->regwptr[UREG_FP] = h2g(sf);
6d5e216d 1585 env->regwptr[UREG_I0] = sig;
53a5960a
PB
1586 env->regwptr[UREG_I1] = h2g(&sf->info);
1587 env->regwptr[UREG_I2] = h2g(&sf->info);
6d5e216d
FB
1588
1589 /* 4. signal handler */
1590 env->pc = (unsigned long) ka->sa._sa_handler;
1591 env->npc = (env->pc + 4);
1592 /* 5. return to kernel instructions */
1593 if (ka->sa.sa_restorer)
1594 env->regwptr[UREG_I7] = (unsigned long)ka->sa.sa_restorer;
1595 else {
775b58d8 1596 uint32_t val32;
53a5960a 1597 env->regwptr[UREG_I7] = h2g(&(sf->insns[0]) - 2);
6d5e216d
FB
1598
1599 /* mov __NR_sigreturn, %g1 */
775b58d8
FB
1600 val32 = 0x821020d8;
1601 err |= __put_user(val32, &sf->insns[0]);
6d5e216d
FB
1602
1603 /* t 0x10 */
775b58d8
FB
1604 val32 = 0x91d02010;
1605 err |= __put_user(val32, &sf->insns[1]);
6d5e216d
FB
1606 if (err)
1607 goto sigsegv;
1608
1609 /* Flush instruction space. */
1610 //flush_sig_insns(current->mm, (unsigned long) &(sf->insns[0]));
80a9d035 1611 // tb_flush(env);
6d5e216d
FB
1612 }
1613 return;
1614
80a9d035 1615 //sigill_and_return:
6d5e216d
FB
1616 force_sig(TARGET_SIGILL);
1617sigsegv:
e80cfcfc 1618 //fprintf(stderr, "force_sig\n");
6d5e216d
FB
1619 force_sig(TARGET_SIGSEGV);
1620}
1621static inline int
74ccb34e 1622restore_fpu_state(CPUState *env, qemu_siginfo_fpu_t *fpu)
6d5e216d
FB
1623{
1624 int err;
1625#if 0
1626#ifdef CONFIG_SMP
1627 if (current->flags & PF_USEDFPU)
1628 regs->psr &= ~PSR_EF;
1629#else
1630 if (current == last_task_used_math) {
1631 last_task_used_math = 0;
1632 regs->psr &= ~PSR_EF;
1633 }
1634#endif
1635 current->used_math = 1;
1636 current->flags &= ~PF_USEDFPU;
1637#endif
1638#if 0
1639 if (verify_area (VERIFY_READ, fpu, sizeof(*fpu)))
1640 return -EFAULT;
1641#endif
1642
fafffaef
FB
1643#if 0
1644 /* XXX: incorrect */
6d5e216d
FB
1645 err = __copy_from_user(&env->fpr[0], &fpu->si_float_regs[0],
1646 (sizeof(unsigned long) * 32));
fafffaef 1647#endif
6d5e216d
FB
1648 err |= __get_user(env->fsr, &fpu->si_fsr);
1649#if 0
1650 err |= __get_user(current->thread.fpqdepth, &fpu->si_fpqdepth);
1651 if (current->thread.fpqdepth != 0)
1652 err |= __copy_from_user(&current->thread.fpqueue[0],
1653 &fpu->si_fpqueue[0],
1654 ((sizeof(unsigned long) +
1655 (sizeof(unsigned long *)))*16));
1656#endif
1657 return err;
1658}
1659
1660
5fafdf24 1661static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
6d5e216d
FB
1662 target_siginfo_t *info,
1663 target_sigset_t *set, CPUState *env)
1664{
1665 fprintf(stderr, "setup_rt_frame: not implemented\n");
1666}
1667
1668long do_sigreturn(CPUState *env)
1669{
1670 struct target_signal_frame *sf;
e80cfcfc 1671 uint32_t up_psr, pc, npc;
6d5e216d 1672 target_sigset_t set;
e80cfcfc 1673 sigset_t host_set;
992f48a0 1674 abi_ulong fpu_save;
e80cfcfc 1675 int err, i;
6d5e216d 1676
53a5960a 1677 sf = (struct target_signal_frame *)g2h(env->regwptr[UREG_FP]);
80a9d035 1678#if 0
e80cfcfc
FB
1679 fprintf(stderr, "sigreturn\n");
1680 fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
80a9d035 1681#endif
e80cfcfc 1682 //cpu_dump_state(env, stderr, fprintf, 0);
6d5e216d
FB
1683
1684 /* 1. Make sure we are not getting garbage from the user */
1685#if 0
1686 if (verify_area (VERIFY_READ, sf, sizeof (*sf)))
1687 goto segv_and_exit;
1688#endif
1689
1690 if (((uint) sf) & 3)
1691 goto segv_and_exit;
1692
1693 err = __get_user(pc, &sf->info.si_regs.pc);
1694 err |= __get_user(npc, &sf->info.si_regs.npc);
1695
6d5e216d
FB
1696 if ((pc | npc) & 3)
1697 goto segv_and_exit;
1698
1699 /* 2. Restore the state */
e80cfcfc
FB
1700 err |= __get_user(up_psr, &sf->info.si_regs.psr);
1701
6d5e216d 1702 /* User can only change condition codes and FPU enabling in %psr. */
a315a145
FB
1703 env->psr = (up_psr & (PSR_ICC /* | PSR_EF */))
1704 | (env->psr & ~(PSR_ICC /* | PSR_EF */));
1705
1706 env->pc = pc;
1707 env->npc = npc;
e80cfcfc 1708 err |= __get_user(env->y, &sf->info.si_regs.y);
a315a145 1709 for (i=0; i < 8; i++) {
e80cfcfc
FB
1710 err |= __get_user(env->gregs[i], &sf->info.si_regs.u_regs[i]);
1711 }
a315a145 1712 for (i=0; i < 8; i++) {
e80cfcfc
FB
1713 err |= __get_user(env->regwptr[i + UREG_I0], &sf->info.si_regs.u_regs[i+8]);
1714 }
6d5e216d 1715
992f48a0 1716 err |= __get_user(fpu_save, (abi_ulong *)&sf->fpu_save);
6d5e216d 1717
e80cfcfc
FB
1718 //if (fpu_save)
1719 // err |= restore_fpu_state(env, fpu_save);
6d5e216d
FB
1720
1721 /* This is pretty much atomic, no amount locking would prevent
1722 * the races which exist anyways.
1723 */
1724 err |= __get_user(set.sig[0], &sf->info.si_mask);
e80cfcfc
FB
1725 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1726 err |= (__get_user(set.sig[i], &sf->extramask[i - 1]));
1727 }
1728
1729 target_to_host_sigset_internal(&host_set, &set);
1730 sigprocmask(SIG_SETMASK, &host_set, NULL);
6d5e216d
FB
1731
1732 if (err)
1733 goto segv_and_exit;
1734
6d5e216d
FB
1735 return env->regwptr[0];
1736
1737segv_and_exit:
1738 force_sig(TARGET_SIGSEGV);
1739}
1740
1741long do_rt_sigreturn(CPUState *env)
1742{
1743 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
1744 return -ENOSYS;
1745}
1746
5bfb56b2
BS
1747#ifdef TARGET_SPARC64
1748#define MC_TSTATE 0
1749#define MC_PC 1
1750#define MC_NPC 2
1751#define MC_Y 3
1752#define MC_G1 4
1753#define MC_G2 5
1754#define MC_G3 6
1755#define MC_G4 7
1756#define MC_G5 8
1757#define MC_G6 9
1758#define MC_G7 10
1759#define MC_O0 11
1760#define MC_O1 12
1761#define MC_O2 13
1762#define MC_O3 14
1763#define MC_O4 15
1764#define MC_O5 16
1765#define MC_O6 17
1766#define MC_O7 18
1767#define MC_NGREG 19
1768
992f48a0 1769typedef abi_ulong target_mc_greg_t;
5bfb56b2
BS
1770typedef target_mc_greg_t target_mc_gregset_t[MC_NGREG];
1771
1772struct target_mc_fq {
992f48a0 1773 abi_ulong *mcfq_addr;
5bfb56b2
BS
1774 uint32_t mcfq_insn;
1775};
1776
1777struct target_mc_fpu {
1778 union {
1779 uint32_t sregs[32];
1780 uint64_t dregs[32];
1781 //uint128_t qregs[16];
1782 } mcfpu_fregs;
992f48a0
BS
1783 abi_ulong mcfpu_fsr;
1784 abi_ulong mcfpu_fprs;
1785 abi_ulong mcfpu_gsr;
5bfb56b2
BS
1786 struct target_mc_fq *mcfpu_fq;
1787 unsigned char mcfpu_qcnt;
1788 unsigned char mcfpu_qentsz;
1789 unsigned char mcfpu_enab;
1790};
1791typedef struct target_mc_fpu target_mc_fpu_t;
1792
1793typedef struct {
1794 target_mc_gregset_t mc_gregs;
1795 target_mc_greg_t mc_fp;
1796 target_mc_greg_t mc_i7;
1797 target_mc_fpu_t mc_fpregs;
1798} target_mcontext_t;
1799
1800struct target_ucontext {
1801 struct target_ucontext *uc_link;
992f48a0 1802 abi_ulong uc_flags;
5bfb56b2
BS
1803 target_sigset_t uc_sigmask;
1804 target_mcontext_t uc_mcontext;
1805};
1806
1807/* A V9 register window */
1808struct target_reg_window {
992f48a0
BS
1809 abi_ulong locals[8];
1810 abi_ulong ins[8];
5bfb56b2
BS
1811};
1812
1813#define TARGET_STACK_BIAS 2047
1814
1815/* {set, get}context() needed for 64-bit SparcLinux userland. */
1816void sparc64_set_context(CPUSPARCState *env)
1817{
1818 struct target_ucontext *ucp = (struct target_ucontext *)
1819 env->regwptr[UREG_I0];
1820 target_mc_gregset_t *grp;
992f48a0
BS
1821 abi_ulong pc, npc, tstate;
1822 abi_ulong fp, i7;
5bfb56b2
BS
1823 unsigned char fenab;
1824 int err;
1825 unsigned int i;
992f48a0 1826 abi_ulong *src, *dst;
5bfb56b2
BS
1827
1828 grp = &ucp->uc_mcontext.mc_gregs;
579a97f7
FB
1829 err = __get_user(pc, &((*grp)[MC_PC]));
1830 err |= __get_user(npc, &((*grp)[MC_NPC]));
5bfb56b2
BS
1831 if (err || ((pc | npc) & 3))
1832 goto do_sigsegv;
1833 if (env->regwptr[UREG_I1]) {
1834 target_sigset_t target_set;
1835 sigset_t set;
1836
1837 if (TARGET_NSIG_WORDS == 1) {
579a97f7 1838 if (__get_user(target_set.sig[0], &ucp->uc_sigmask.sig[0]))
5bfb56b2
BS
1839 goto do_sigsegv;
1840 } else {
1841 src = &ucp->uc_sigmask;
1842 dst = &target_set;
992f48a0 1843 for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
5bfb56b2 1844 i++, dst++, src++)
579a97f7 1845 err |= __get_user(dst, src);
5bfb56b2
BS
1846 if (err)
1847 goto do_sigsegv;
1848 }
1849 target_to_host_sigset_internal(&set, &target_set);
1850 sigprocmask(SIG_SETMASK, &set, NULL);
1851 }
1852 env->pc = pc;
1853 env->npc = npc;
579a97f7
FB
1854 err |= __get_user(env->y, &((*grp)[MC_Y]));
1855 err |= __get_user(tstate, &((*grp)[MC_TSTATE]));
5bfb56b2
BS
1856 env->asi = (tstate >> 24) & 0xff;
1857 PUT_CCR(env, tstate >> 32);
1858 PUT_CWP64(env, tstate & 0x1f);
579a97f7
FB
1859 err |= __get_user(env->gregs[1], (&(*grp)[MC_G1]));
1860 err |= __get_user(env->gregs[2], (&(*grp)[MC_G2]));
1861 err |= __get_user(env->gregs[3], (&(*grp)[MC_G3]));
1862 err |= __get_user(env->gregs[4], (&(*grp)[MC_G4]));
1863 err |= __get_user(env->gregs[5], (&(*grp)[MC_G5]));
1864 err |= __get_user(env->gregs[6], (&(*grp)[MC_G6]));
1865 err |= __get_user(env->gregs[7], (&(*grp)[MC_G7]));
1866 err |= __get_user(env->regwptr[UREG_I0], (&(*grp)[MC_O0]));
1867 err |= __get_user(env->regwptr[UREG_I1], (&(*grp)[MC_O1]));
1868 err |= __get_user(env->regwptr[UREG_I2], (&(*grp)[MC_O2]));
1869 err |= __get_user(env->regwptr[UREG_I3], (&(*grp)[MC_O3]));
1870 err |= __get_user(env->regwptr[UREG_I4], (&(*grp)[MC_O4]));
1871 err |= __get_user(env->regwptr[UREG_I5], (&(*grp)[MC_O5]));
1872 err |= __get_user(env->regwptr[UREG_I6], (&(*grp)[MC_O6]));
1873 err |= __get_user(env->regwptr[UREG_I7], (&(*grp)[MC_O7]));
1874
1875 err |= __get_user(fp, &(ucp->uc_mcontext.mc_fp));
1876 err |= __get_user(i7, &(ucp->uc_mcontext.mc_i7));
1877 err |= __put_user(fp,
1878 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[6])));
1879 err |= __put_user(i7,
1880 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[7])));
1881
1882 err |= __get_user(fenab, &(ucp->uc_mcontext.mc_fpregs.mcfpu_enab));
1883 err |= __get_user(env->fprs, &(ucp->uc_mcontext.mc_fpregs.mcfpu_fprs));
5bfb56b2
BS
1884 src = &(ucp->uc_mcontext.mc_fpregs.mcfpu_fregs);
1885 dst = &env->fpr;
1886 for (i = 0; i < 64; i++, dst++, src++)
579a97f7
FB
1887 err |= __get_user(dst, src);
1888 err |= __get_user(env->fsr,
1889 &(ucp->uc_mcontext.mc_fpregs.mcfpu_fsr));
1890 err |= __get_user(env->gsr,
1891 &(ucp->uc_mcontext.mc_fpregs.mcfpu_gsr));
5bfb56b2
BS
1892 if (err)
1893 goto do_sigsegv;
1894
1895 return;
1896 do_sigsegv:
1897 force_sig(SIGSEGV);
1898}
1899
1900void sparc64_get_context(CPUSPARCState *env)
1901{
1902 struct target_ucontext *ucp = (struct target_ucontext *)
1903 env->regwptr[UREG_I0];
1904 target_mc_gregset_t *grp;
1905 target_mcontext_t *mcp;
992f48a0 1906 abi_ulong fp, i7;
5bfb56b2
BS
1907 int err;
1908 unsigned int i;
992f48a0 1909 abi_ulong *src, *dst;
5bfb56b2
BS
1910 target_sigset_t target_set;
1911 sigset_t set;
1912
1913 mcp = &ucp->uc_mcontext;
1914 grp = &mcp->mc_gregs;
1915
1916 /* Skip over the trap instruction, first. */
1917 env->pc = env->npc;
1918 env->npc += 4;
1919
1920 err = 0;
1921
1922 sigprocmask(0, NULL, &set);
1923 host_to_target_sigset_internal(&target_set, &set);
1924 if (TARGET_NSIG_WORDS == 1)
579a97f7
FB
1925 err |= __put_user(target_set.sig[0],
1926 (abi_ulong *)&ucp->uc_sigmask);
5bfb56b2
BS
1927 else {
1928 src = &target_set;
1929 dst = &ucp->uc_sigmask;
992f48a0 1930 for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
5bfb56b2 1931 i++, dst++, src++)
579a97f7 1932 err |= __put_user(src, dst);
5bfb56b2
BS
1933 if (err)
1934 goto do_sigsegv;
1935 }
1936
579a97f7
FB
1937 err |= __put_user(env->tstate, &((*grp)[MC_TSTATE]));
1938 err |= __put_user(env->pc, &((*grp)[MC_PC]));
1939 err |= __put_user(env->npc, &((*grp)[MC_NPC]));
1940 err |= __put_user(env->y, &((*grp)[MC_Y]));
1941 err |= __put_user(env->gregs[1], &((*grp)[MC_G1]));
1942 err |= __put_user(env->gregs[2], &((*grp)[MC_G2]));
1943 err |= __put_user(env->gregs[3], &((*grp)[MC_G3]));
1944 err |= __put_user(env->gregs[4], &((*grp)[MC_G4]));
1945 err |= __put_user(env->gregs[5], &((*grp)[MC_G5]));
1946 err |= __put_user(env->gregs[6], &((*grp)[MC_G6]));
1947 err |= __put_user(env->gregs[7], &((*grp)[MC_G7]));
1948 err |= __put_user(env->regwptr[UREG_I0], &((*grp)[MC_O0]));
1949 err |= __put_user(env->regwptr[UREG_I1], &((*grp)[MC_O1]));
1950 err |= __put_user(env->regwptr[UREG_I2], &((*grp)[MC_O2]));
1951 err |= __put_user(env->regwptr[UREG_I3], &((*grp)[MC_O3]));
1952 err |= __put_user(env->regwptr[UREG_I4], &((*grp)[MC_O4]));
1953 err |= __put_user(env->regwptr[UREG_I5], &((*grp)[MC_O5]));
1954 err |= __put_user(env->regwptr[UREG_I6], &((*grp)[MC_O6]));
1955 err |= __put_user(env->regwptr[UREG_I7], &((*grp)[MC_O7]));
1956
1957 err |= __get_user(fp,
1958 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[6])));
1959 err |= __get_user(i7,
1960 (&(((struct target_reg_window *)(TARGET_STACK_BIAS+env->regwptr[UREG_I6]))->ins[7])));
1961 err |= __put_user(fp, &(mcp->mc_fp));
1962 err |= __put_user(i7, &(mcp->mc_i7));
5bfb56b2
BS
1963
1964 src = &env->fpr;
1965 dst = &(ucp->uc_mcontext.mc_fpregs.mcfpu_fregs);
1966 for (i = 0; i < 64; i++, dst++, src++)
579a97f7
FB
1967 err |= __put_user(src, dst);
1968 err |= __put_user(env->fsr, &(mcp->mc_fpregs.mcfpu_fsr));
1969 err |= __put_user(env->gsr, &(mcp->mc_fpregs.mcfpu_gsr));
1970 err |= __put_user(env->fprs, &(mcp->mc_fpregs.mcfpu_fprs));
5bfb56b2
BS
1971
1972 if (err)
1973 goto do_sigsegv;
1974
1975 return;
1976 do_sigsegv:
1977 force_sig(SIGSEGV);
1978}
1979#endif
d26bc211 1980#elif defined(TARGET_ABI_MIPSN64)
540635ba
TS
1981
1982# warning signal handling not implemented
1983
1984static void setup_frame(int sig, struct emulated_sigaction *ka,
1985 target_sigset_t *set, CPUState *env)
1986{
1987 fprintf(stderr, "setup_frame: not implemented\n");
1988}
1989
1990static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
1991 target_siginfo_t *info,
1992 target_sigset_t *set, CPUState *env)
1993{
1994 fprintf(stderr, "setup_rt_frame: not implemented\n");
1995}
1996
1997long do_sigreturn(CPUState *env)
1998{
1999 fprintf(stderr, "do_sigreturn: not implemented\n");
2000 return -ENOSYS;
2001}
2002
2003long do_rt_sigreturn(CPUState *env)
2004{
2005 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2006 return -ENOSYS;
2007}
2008
d26bc211 2009#elif defined(TARGET_ABI_MIPSN32)
540635ba
TS
2010
2011# warning signal handling not implemented
2012
2013static void setup_frame(int sig, struct emulated_sigaction *ka,
2014 target_sigset_t *set, CPUState *env)
2015{
2016 fprintf(stderr, "setup_frame: not implemented\n");
2017}
2018
2019static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
2020 target_siginfo_t *info,
2021 target_sigset_t *set, CPUState *env)
2022{
2023 fprintf(stderr, "setup_rt_frame: not implemented\n");
2024}
2025
2026long do_sigreturn(CPUState *env)
2027{
2028 fprintf(stderr, "do_sigreturn: not implemented\n");
2029 return -ENOSYS;
2030}
2031
2032long do_rt_sigreturn(CPUState *env)
2033{
2034 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2035 return -ENOSYS;
2036}
2037
d26bc211 2038#elif defined(TARGET_ABI_MIPSO32)
106ec879
FB
2039
2040struct target_sigcontext {
2041 uint32_t sc_regmask; /* Unused */
2042 uint32_t sc_status;
2043 uint64_t sc_pc;
2044 uint64_t sc_regs[32];
2045 uint64_t sc_fpregs[32];
2046 uint32_t sc_ownedfp; /* Unused */
2047 uint32_t sc_fpc_csr;
2048 uint32_t sc_fpc_eir; /* Unused */
2049 uint32_t sc_used_math;
2050 uint32_t sc_dsp; /* dsp status, was sc_ssflags */
2051 uint64_t sc_mdhi;
2052 uint64_t sc_mdlo;
2053 target_ulong sc_hi1; /* Was sc_cause */
2054 target_ulong sc_lo1; /* Was sc_badvaddr */
2055 target_ulong sc_hi2; /* Was sc_sigset[4] */
2056 target_ulong sc_lo2;
2057 target_ulong sc_hi3;
2058 target_ulong sc_lo3;
2059};
2060
2061struct sigframe {
2062 uint32_t sf_ass[4]; /* argument save space for o32 */
2063 uint32_t sf_code[2]; /* signal trampoline */
2064 struct target_sigcontext sf_sc;
2065 target_sigset_t sf_mask;
2066};
2067
2068/* Install trampoline to jump back from signal handler */
2069static inline int install_sigtramp(unsigned int *tramp, unsigned int syscall)
2070{
2071 int err;
2072
2073 /*
2074 * Set up the return code ...
2075 *
2076 * li v0, __NR__foo_sigreturn
2077 * syscall
2078 */
2079
2080 err = __put_user(0x24020000 + syscall, tramp + 0);
2081 err |= __put_user(0x0000000c , tramp + 1);
2082 /* flush_cache_sigtramp((unsigned long) tramp); */
2083 return err;
2084}
2085
2086static inline int
2087setup_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2088{
2089 int err = 0;
2090
ead9360e 2091 err |= __put_user(regs->PC[regs->current_tc], &sc->sc_pc);
106ec879 2092
ead9360e
TS
2093#define save_gp_reg(i) do { \
2094 err |= __put_user(regs->gpr[i][regs->current_tc], &sc->sc_regs[i]); \
106ec879
FB
2095 } while(0)
2096 __put_user(0, &sc->sc_regs[0]); save_gp_reg(1); save_gp_reg(2);
2097 save_gp_reg(3); save_gp_reg(4); save_gp_reg(5); save_gp_reg(6);
2098 save_gp_reg(7); save_gp_reg(8); save_gp_reg(9); save_gp_reg(10);
2099 save_gp_reg(11); save_gp_reg(12); save_gp_reg(13); save_gp_reg(14);
2100 save_gp_reg(15); save_gp_reg(16); save_gp_reg(17); save_gp_reg(18);
2101 save_gp_reg(19); save_gp_reg(20); save_gp_reg(21); save_gp_reg(22);
2102 save_gp_reg(23); save_gp_reg(24); save_gp_reg(25); save_gp_reg(26);
2103 save_gp_reg(27); save_gp_reg(28); save_gp_reg(29); save_gp_reg(30);
2104 save_gp_reg(31);
388bb21a 2105#undef save_gp_reg
106ec879 2106
ead9360e
TS
2107 err |= __put_user(regs->HI[0][regs->current_tc], &sc->sc_mdhi);
2108 err |= __put_user(regs->LO[0][regs->current_tc], &sc->sc_mdlo);
106ec879
FB
2109
2110 /* Not used yet, but might be useful if we ever have DSP suppport */
2111#if 0
2112 if (cpu_has_dsp) {
2113 err |= __put_user(mfhi1(), &sc->sc_hi1);
2114 err |= __put_user(mflo1(), &sc->sc_lo1);
2115 err |= __put_user(mfhi2(), &sc->sc_hi2);
2116 err |= __put_user(mflo2(), &sc->sc_lo2);
2117 err |= __put_user(mfhi3(), &sc->sc_hi3);
2118 err |= __put_user(mflo3(), &sc->sc_lo3);
2119 err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2120 }
2121 /* same with 64 bit */
388bb21a 2122#ifdef CONFIG_64BIT
106ec879
FB
2123 err |= __put_user(regs->hi, &sc->sc_hi[0]);
2124 err |= __put_user(regs->lo, &sc->sc_lo[0]);
2125 if (cpu_has_dsp) {
2126 err |= __put_user(mfhi1(), &sc->sc_hi[1]);
2127 err |= __put_user(mflo1(), &sc->sc_lo[1]);
2128 err |= __put_user(mfhi2(), &sc->sc_hi[2]);
2129 err |= __put_user(mflo2(), &sc->sc_lo[2]);
2130 err |= __put_user(mfhi3(), &sc->sc_hi[3]);
2131 err |= __put_user(mflo3(), &sc->sc_lo[3]);
2132 err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2133 }
388bb21a
TS
2134#endif
2135#endif
106ec879 2136
388bb21a 2137#if 0
106ec879
FB
2138 err |= __put_user(!!used_math(), &sc->sc_used_math);
2139
2140 if (!used_math())
2141 goto out;
2142
2143 /*
2144 * Save FPU state to signal context. Signal handler will "inherit"
2145 * current FPU state.
2146 */
2147 preempt_disable();
2148
2149 if (!is_fpu_owner()) {
2150 own_fpu();
2151 restore_fp(current);
2152 }
2153 err |= save_fp_context(sc);
2154
2155 preempt_enable();
2156 out:
2157#endif
2158 return err;
2159}
2160
2161static inline int
2162restore_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2163{
2164 int err = 0;
2165
2166 err |= __get_user(regs->CP0_EPC, &sc->sc_pc);
2167
ead9360e
TS
2168 err |= __get_user(regs->HI[0][regs->current_tc], &sc->sc_mdhi);
2169 err |= __get_user(regs->LO[0][regs->current_tc], &sc->sc_mdlo);
106ec879 2170
ead9360e
TS
2171#define restore_gp_reg(i) do { \
2172 err |= __get_user(regs->gpr[i][regs->current_tc], &sc->sc_regs[i]); \
106ec879
FB
2173 } while(0)
2174 restore_gp_reg( 1); restore_gp_reg( 2); restore_gp_reg( 3);
2175 restore_gp_reg( 4); restore_gp_reg( 5); restore_gp_reg( 6);
2176 restore_gp_reg( 7); restore_gp_reg( 8); restore_gp_reg( 9);
2177 restore_gp_reg(10); restore_gp_reg(11); restore_gp_reg(12);
2178 restore_gp_reg(13); restore_gp_reg(14); restore_gp_reg(15);
2179 restore_gp_reg(16); restore_gp_reg(17); restore_gp_reg(18);
2180 restore_gp_reg(19); restore_gp_reg(20); restore_gp_reg(21);
2181 restore_gp_reg(22); restore_gp_reg(23); restore_gp_reg(24);
2182 restore_gp_reg(25); restore_gp_reg(26); restore_gp_reg(27);
2183 restore_gp_reg(28); restore_gp_reg(29); restore_gp_reg(30);
2184 restore_gp_reg(31);
388bb21a 2185#undef restore_gp_reg
106ec879
FB
2186
2187#if 0
2188 if (cpu_has_dsp) {
2189 err |= __get_user(treg, &sc->sc_hi1); mthi1(treg);
2190 err |= __get_user(treg, &sc->sc_lo1); mtlo1(treg);
2191 err |= __get_user(treg, &sc->sc_hi2); mthi2(treg);
2192 err |= __get_user(treg, &sc->sc_lo2); mtlo2(treg);
2193 err |= __get_user(treg, &sc->sc_hi3); mthi3(treg);
2194 err |= __get_user(treg, &sc->sc_lo3); mtlo3(treg);
2195 err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2196 }
388bb21a 2197#ifdef CONFIG_64BIT
106ec879
FB
2198 err |= __get_user(regs->hi, &sc->sc_hi[0]);
2199 err |= __get_user(regs->lo, &sc->sc_lo[0]);
2200 if (cpu_has_dsp) {
2201 err |= __get_user(treg, &sc->sc_hi[1]); mthi1(treg);
2202 err |= __get_user(treg, &sc->sc_lo[1]); mthi1(treg);
2203 err |= __get_user(treg, &sc->sc_hi[2]); mthi2(treg);
2204 err |= __get_user(treg, &sc->sc_lo[2]); mthi2(treg);
2205 err |= __get_user(treg, &sc->sc_hi[3]); mthi3(treg);
2206 err |= __get_user(treg, &sc->sc_lo[3]); mthi3(treg);
2207 err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2208 }
388bb21a 2209#endif
106ec879
FB
2210
2211 err |= __get_user(used_math, &sc->sc_used_math);
2212 conditional_used_math(used_math);
2213
2214 preempt_disable();
2215
2216 if (used_math()) {
2217 /* restore fpu context if we have used it before */
2218 own_fpu();
2219 err |= restore_fp_context(sc);
2220 } else {
2221 /* signal handler may have used FPU. Give it up. */
2222 lose_fpu();
2223 }
2224
2225 preempt_enable();
2226#endif
2227 return err;
2228}
2229/*
2230 * Determine which stack to use..
2231 */
579a97f7 2232static inline abi_ulong
106ec879
FB
2233get_sigframe(struct emulated_sigaction *ka, CPUState *regs, size_t frame_size)
2234{
2235 unsigned long sp;
2236
2237 /* Default to using normal stack */
ead9360e 2238 sp = regs->gpr[29][regs->current_tc];
106ec879
FB
2239
2240 /*
2241 * FPU emulator may have it's own trampoline active just
2242 * above the user stack, 16-bytes before the next lowest
2243 * 16 byte boundary. Try to avoid trashing it.
2244 */
2245 sp -= 32;
2246
106ec879 2247 /* This is the X/Open sanctioned signal stack switching. */
a04e134a
TS
2248 if ((ka->sa.sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
2249 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
2250 }
106ec879 2251
579a97f7 2252 return (sp - frame_size) & ~7;
106ec879
FB
2253}
2254
579a97f7 2255/* compare linux/arch/mips/kernel/signal.c:setup_frame() */
5fafdf24 2256static void setup_frame(int sig, struct emulated_sigaction * ka,
579a97f7 2257 target_sigset_t *set, CPUState *regs)
106ec879
FB
2258{
2259 struct sigframe *frame;
579a97f7 2260 abi_ulong frame_addr;
106ec879
FB
2261 int i;
2262
579a97f7
FB
2263 frame_addr = get_sigframe(ka, regs, sizeof(*frame));
2264 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
106ec879
FB
2265 goto give_sigsegv;
2266
2267 install_sigtramp(frame->sf_code, TARGET_NR_sigreturn);
2268
2269 if(setup_sigcontext(regs, &frame->sf_sc))
2270 goto give_sigsegv;
2271
2272 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2273 if(__put_user(set->sig[i], &frame->sf_mask.sig[i]))
2274 goto give_sigsegv;
2275 }
2276
2277 /*
2278 * Arguments to signal handler:
2279 *
2280 * a0 = signal number
2281 * a1 = 0 (should be cause)
2282 * a2 = pointer to struct sigcontext
2283 *
2284 * $25 and PC point to the signal handler, $29 points to the
2285 * struct sigframe.
2286 */
ead9360e
TS
2287 regs->gpr[ 4][regs->current_tc] = sig;
2288 regs->gpr[ 5][regs->current_tc] = 0;
2289 regs->gpr[ 6][regs->current_tc] = h2g(&frame->sf_sc);
2290 regs->gpr[29][regs->current_tc] = h2g(frame);
2291 regs->gpr[31][regs->current_tc] = h2g(frame->sf_code);
106ec879
FB
2292 /* The original kernel code sets CP0_EPC to the handler
2293 * since it returns to userland using eret
2294 * we cannot do this here, and we must set PC directly */
ead9360e 2295 regs->PC[regs->current_tc] = regs->gpr[25][regs->current_tc] = ka->sa._sa_handler;
579a97f7 2296 unlock_user_struct(frame, frame_addr, 1);
106ec879
FB
2297 return;
2298
2299give_sigsegv:
579a97f7 2300 unlock_user_struct(frame, frame_addr, 1);
106ec879 2301 force_sig(TARGET_SIGSEGV/*, current*/);
5fafdf24 2302 return;
106ec879
FB
2303}
2304
2305long do_sigreturn(CPUState *regs)
2306{
388bb21a 2307 struct sigframe *frame;
579a97f7 2308 abi_ulong frame_addr;
388bb21a
TS
2309 sigset_t blocked;
2310 target_sigset_t target_set;
2311 int i;
106ec879
FB
2312
2313#if defined(DEBUG_SIGNAL)
388bb21a 2314 fprintf(stderr, "do_sigreturn\n");
106ec879 2315#endif
579a97f7
FB
2316 frame_addr = regs->gpr[29][regs->current_tc];
2317 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
106ec879
FB
2318 goto badframe;
2319
388bb21a 2320 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
106ec879
FB
2321 if(__get_user(target_set.sig[i], &frame->sf_mask.sig[i]))
2322 goto badframe;
388bb21a 2323 }
106ec879 2324
388bb21a
TS
2325 target_to_host_sigset_internal(&blocked, &target_set);
2326 sigprocmask(SIG_SETMASK, &blocked, NULL);
106ec879 2327
388bb21a 2328 if (restore_sigcontext(regs, &frame->sf_sc))
106ec879
FB
2329 goto badframe;
2330
2331#if 0
388bb21a
TS
2332 /*
2333 * Don't let your children do this ...
2334 */
2335 __asm__ __volatile__(
106ec879
FB
2336 "move\t$29, %0\n\t"
2337 "j\tsyscall_exit"
2338 :/* no outputs */
2339 :"r" (&regs));
388bb21a 2340 /* Unreached */
106ec879 2341#endif
3b46e624 2342
ead9360e 2343 regs->PC[regs->current_tc] = regs->CP0_EPC;
388bb21a 2344 /* I am not sure this is right, but it seems to work
106ec879
FB
2345 * maybe a problem with nested signals ? */
2346 regs->CP0_EPC = 0;
2347 return 0;
2348
2349badframe:
388bb21a
TS
2350 force_sig(TARGET_SIGSEGV/*, current*/);
2351 return 0;
106ec879
FB
2352}
2353
5fafdf24 2354static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
106ec879
FB
2355 target_siginfo_t *info,
2356 target_sigset_t *set, CPUState *env)
2357{
2358 fprintf(stderr, "setup_rt_frame: not implemented\n");
2359}
2360
2361long do_rt_sigreturn(CPUState *env)
2362{
2363 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2364 return -ENOSYS;
2365}
6d5e216d 2366
b346ff46
FB
2367#else
2368
2369static void setup_frame(int sig, struct emulated_sigaction *ka,
2370 target_sigset_t *set, CPUState *env)
2371{
2372 fprintf(stderr, "setup_frame: not implemented\n");
2373}
2374
5fafdf24 2375static void setup_rt_frame(int sig, struct emulated_sigaction *ka,
b346ff46
FB
2376 target_siginfo_t *info,
2377 target_sigset_t *set, CPUState *env)
2378{
2379 fprintf(stderr, "setup_rt_frame: not implemented\n");
2380}
2381
2382long do_sigreturn(CPUState *env)
2383{
2384 fprintf(stderr, "do_sigreturn: not implemented\n");
2385 return -ENOSYS;
2386}
2387
2388long do_rt_sigreturn(CPUState *env)
2389{
2390 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2391 return -ENOSYS;
2392}
2393
66fb9763
FB
2394#endif
2395
2396void process_pending_signals(void *cpu_env)
2397{
2398 int sig;
992f48a0 2399 abi_ulong handler;
9de5e440
FB
2400 sigset_t set, old_set;
2401 target_sigset_t target_old_set;
66fb9763
FB
2402 struct emulated_sigaction *k;
2403 struct sigqueue *q;
3b46e624 2404
31e31b8a
FB
2405 if (!signal_pending)
2406 return;
2407
66fb9763
FB
2408 k = sigact_table;
2409 for(sig = 1; sig <= TARGET_NSIG; sig++) {
2410 if (k->pending)
31e31b8a 2411 goto handle_signal;
66fb9763 2412 k++;
31e31b8a
FB
2413 }
2414 /* if no signal is pending, just return */
2415 signal_pending = 0;
2416 return;
66fb9763 2417
31e31b8a 2418 handle_signal:
66fb9763 2419#ifdef DEBUG_SIGNAL
bc8a22cc 2420 fprintf(stderr, "qemu: process signal %d\n", sig);
66fb9763
FB
2421#endif
2422 /* dequeue signal */
2423 q = k->first;
2424 k->first = q->next;
2425 if (!k->first)
2426 k->pending = 0;
3b46e624 2427
1fddef4b
FB
2428 sig = gdb_handlesig (cpu_env, sig);
2429 if (!sig) {
2430 fprintf (stderr, "Lost signal\n");
2431 abort();
2432 }
66fb9763
FB
2433
2434 handler = k->sa._sa_handler;
2435 if (handler == TARGET_SIG_DFL) {
2436 /* default handler : ignore some signal. The other are fatal */
5fafdf24
TS
2437 if (sig != TARGET_SIGCHLD &&
2438 sig != TARGET_SIGURG &&
66fb9763
FB
2439 sig != TARGET_SIGWINCH) {
2440 force_sig(sig);
2441 }
2442 } else if (handler == TARGET_SIG_IGN) {
2443 /* ignore sig */
2444 } else if (handler == TARGET_SIG_ERR) {
2445 force_sig(sig);
2446 } else {
9de5e440
FB
2447 /* compute the blocked signals during the handler execution */
2448 target_to_host_sigset(&set, &k->sa.sa_mask);
2449 /* SA_NODEFER indicates that the current signal should not be
2450 blocked during the handler */
2451 if (!(k->sa.sa_flags & TARGET_SA_NODEFER))
2452 sigaddset(&set, target_to_host_signal(sig));
3b46e624 2453
9de5e440
FB
2454 /* block signals in the handler using Linux */
2455 sigprocmask(SIG_BLOCK, &set, &old_set);
2456 /* save the previous blocked signal state to restore it at the
2457 end of the signal execution (see do_sigreturn) */
9231944d 2458 host_to_target_sigset_internal(&target_old_set, &old_set);
9de5e440 2459
bc8a22cc 2460 /* if the CPU is in VM86 mode, we restore the 32 bit values */
84409ddb 2461#if defined(TARGET_I386) && !defined(TARGET_X86_64)
bc8a22cc
FB
2462 {
2463 CPUX86State *env = cpu_env;
2464 if (env->eflags & VM_MASK)
2465 save_v86_state(env);
2466 }
2467#endif
9de5e440 2468 /* prepare the stack frame of the virtual CPU */
66fb9763 2469 if (k->sa.sa_flags & TARGET_SA_SIGINFO)
9de5e440 2470 setup_rt_frame(sig, k, &q->info, &target_old_set, cpu_env);
66fb9763 2471 else
9de5e440 2472 setup_frame(sig, k, &target_old_set, cpu_env);
66fb9763
FB
2473 if (k->sa.sa_flags & TARGET_SA_RESETHAND)
2474 k->sa._sa_handler = TARGET_SIG_DFL;
31e31b8a 2475 }
66fb9763
FB
2476 if (q != &k->info)
2477 free_sigqueue(q);
2478}