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