?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Add serial number support for virtio_blk
[qemu.git] / linux-user / signal.c
blob6a34171aa0e72c4838b2e3b0822bedfc54e3e302
1 /*
2 * Emulation of Linux signals
3 *
4 * Copyright (c) 2003 Fabrice Bellard
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin Street - Fifth Floor, Boston,
19 * MA 02110-1301, USA.
20 */
21 #include <stdlib.h>
22 #include <stdio.h>
23 #include <string.h>
24 #include <stdarg.h>
25 #include <unistd.h>
26 #include <signal.h>
27 #include <errno.h>
28 #include <assert.h>
29 #include <sys/ucontext.h>
30 #include <sys/resource.h>
31
32 #include "qemu.h"
33 #include "qemu-common.h"
34 #include "target_signal.h"
35
36 //#define DEBUG_SIGNAL
37
38 static struct target_sigaltstack target_sigaltstack_used = {
39 .ss_sp = 0,
40 .ss_size = 0,
41 .ss_flags = TARGET_SS_DISABLE,
42 };
43
44 static struct target_sigaction sigact_table[TARGET_NSIG];
45
46 static void host_signal_handler(int host_signum, siginfo_t *info,
47 void *puc);
48
49 static uint8_t host_to_target_signal_table[65] = {
50 [SIGHUP] = TARGET_SIGHUP,
51 [SIGINT] = TARGET_SIGINT,
52 [SIGQUIT] = TARGET_SIGQUIT,
53 [SIGILL] = TARGET_SIGILL,
54 [SIGTRAP] = TARGET_SIGTRAP,
55 [SIGABRT] = TARGET_SIGABRT,
56 /* [SIGIOT] = TARGET_SIGIOT,*/
57 [SIGBUS] = TARGET_SIGBUS,
58 [SIGFPE] = TARGET_SIGFPE,
59 [SIGKILL] = TARGET_SIGKILL,
60 [SIGUSR1] = TARGET_SIGUSR1,
61 [SIGSEGV] = TARGET_SIGSEGV,
62 [SIGUSR2] = TARGET_SIGUSR2,
63 [SIGPIPE] = TARGET_SIGPIPE,
64 [SIGALRM] = TARGET_SIGALRM,
65 [SIGTERM] = TARGET_SIGTERM,
66 #ifdef SIGSTKFLT
67 [SIGSTKFLT] = TARGET_SIGSTKFLT,
68 #endif
69 [SIGCHLD] = TARGET_SIGCHLD,
70 [SIGCONT] = TARGET_SIGCONT,
71 [SIGSTOP] = TARGET_SIGSTOP,
72 [SIGTSTP] = TARGET_SIGTSTP,
73 [SIGTTIN] = TARGET_SIGTTIN,
74 [SIGTTOU] = TARGET_SIGTTOU,
75 [SIGURG] = TARGET_SIGURG,
76 [SIGXCPU] = TARGET_SIGXCPU,
77 [SIGXFSZ] = TARGET_SIGXFSZ,
78 [SIGVTALRM] = TARGET_SIGVTALRM,
79 [SIGPROF] = TARGET_SIGPROF,
80 [SIGWINCH] = TARGET_SIGWINCH,
81 [SIGIO] = TARGET_SIGIO,
82 [SIGPWR] = TARGET_SIGPWR,
83 [SIGSYS] = TARGET_SIGSYS,
84 /* next signals stay the same */
85 /* Nasty hack: Reverse SIGRTMIN and SIGRTMAX to avoid overlap with
86 host libpthread signals. This assumes noone actually uses SIGRTMAX :-/
87 To fix this properly we need to do manual signal delivery multiplexed
88 over a single host signal. */
89 [__SIGRTMIN] = __SIGRTMAX,
90 [__SIGRTMAX] = __SIGRTMIN,
91 };
92 static uint8_t target_to_host_signal_table[65];
93
94 static inline int on_sig_stack(unsigned long sp)
95 {
96 return (sp - target_sigaltstack_used.ss_sp
97 < target_sigaltstack_used.ss_size);
98 }
99
100 static inline int sas_ss_flags(unsigned long sp)
101 {
102 return (target_sigaltstack_used.ss_size == 0 ? SS_DISABLE
103 : on_sig_stack(sp) ? SS_ONSTACK : 0);
104 }
105
106 int host_to_target_signal(int sig)
107 {
108 if (sig > 64)
109 return sig;
110 return host_to_target_signal_table[sig];
111 }
112
113 int target_to_host_signal(int sig)
114 {
115 if (sig > 64)
116 return sig;
117 return target_to_host_signal_table[sig];
118 }
119
120 static inline void target_sigemptyset(target_sigset_t *set)
121 {
122 memset(set, 0, sizeof(*set));
123 }
124
125 static inline void target_sigaddset(target_sigset_t *set, int signum)
126 {
127 signum--;
128 abi_ulong mask = (abi_ulong)1 << (signum % TARGET_NSIG_BPW);
129 set->sig[signum / TARGET_NSIG_BPW] |= mask;
130 }
131
132 static inline int target_sigismember(const target_sigset_t *set, int signum)
133 {
134 signum--;
135 abi_ulong mask = (abi_ulong)1 << (signum % TARGET_NSIG_BPW);
136 return ((set->sig[signum / TARGET_NSIG_BPW] & mask) != 0);
137 }
138
139 static void host_to_target_sigset_internal(target_sigset_t *d,
140 const sigset_t *s)
141 {
142 int i;
143 target_sigemptyset(d);
144 for (i = 1; i <= TARGET_NSIG; i++) {
145 if (sigismember(s, i)) {
146 target_sigaddset(d, host_to_target_signal(i));
147 }
148 }
149 }
150
151 void host_to_target_sigset(target_sigset_t *d, const sigset_t *s)
152 {
153 target_sigset_t d1;
154 int i;
155
156 host_to_target_sigset_internal(&d1, s);
157 for(i = 0;i < TARGET_NSIG_WORDS; i++)
158 d->sig[i] = tswapl(d1.sig[i]);
159 }
160
161 static void target_to_host_sigset_internal(sigset_t *d,
162 const target_sigset_t *s)
163 {
164 int i;
165 sigemptyset(d);
166 for (i = 1; i <= TARGET_NSIG; i++) {
167 if (target_sigismember(s, i)) {
168 sigaddset(d, target_to_host_signal(i));
169 }
170 }
171 }
172
173 void target_to_host_sigset(sigset_t *d, const target_sigset_t *s)
174 {
175 target_sigset_t s1;
176 int i;
177
178 for(i = 0;i < TARGET_NSIG_WORDS; i++)
179 s1.sig[i] = tswapl(s->sig[i]);
180 target_to_host_sigset_internal(d, &s1);
181 }
182
183 void host_to_target_old_sigset(abi_ulong *old_sigset,
184 const sigset_t *sigset)
185 {
186 target_sigset_t d;
187 host_to_target_sigset(&d, sigset);
188 *old_sigset = d.sig[0];
189 }
190
191 void target_to_host_old_sigset(sigset_t *sigset,
192 const abi_ulong *old_sigset)
193 {
194 target_sigset_t d;
195 int i;
196
197 d.sig[0] = *old_sigset;
198 for(i = 1;i < TARGET_NSIG_WORDS; i++)
199 d.sig[i] = 0;
200 target_to_host_sigset(sigset, &d);
201 }
202
203 /* siginfo conversion */
204
205 static inline void host_to_target_siginfo_noswap(target_siginfo_t *tinfo,
206 const siginfo_t *info)
207 {
208 int sig;
209 sig = host_to_target_signal(info->si_signo);
210 tinfo->si_signo = sig;
211 tinfo->si_errno = 0;
212 tinfo->si_code = info->si_code;
213 if (sig == SIGILL || sig == SIGFPE || sig == SIGSEGV ||
214 sig == SIGBUS || sig == SIGTRAP) {
215 /* should never come here, but who knows. The information for
216 the target is irrelevant */
217 tinfo->_sifields._sigfault._addr = 0;
218 } else if (sig == SIGIO) {
219 tinfo->_sifields._sigpoll._fd = info->si_fd;
220 } else if (sig >= TARGET_SIGRTMIN) {
221 tinfo->_sifields._rt._pid = info->si_pid;
222 tinfo->_sifields._rt._uid = info->si_uid;
223 /* XXX: potential problem if 64 bit */
224 tinfo->_sifields._rt._sigval.sival_ptr =
225 (abi_ulong)(unsigned long)info->si_value.sival_ptr;
226 }
227 }
228
229 static void tswap_siginfo(target_siginfo_t *tinfo,
230 const target_siginfo_t *info)
231 {
232 int sig;
233 sig = info->si_signo;
234 tinfo->si_signo = tswap32(sig);
235 tinfo->si_errno = tswap32(info->si_errno);
236 tinfo->si_code = tswap32(info->si_code);
237 if (sig == SIGILL || sig == SIGFPE || sig == SIGSEGV ||
238 sig == SIGBUS || sig == SIGTRAP) {
239 tinfo->_sifields._sigfault._addr =
240 tswapl(info->_sifields._sigfault._addr);
241 } else if (sig == SIGIO) {
242 tinfo->_sifields._sigpoll._fd = tswap32(info->_sifields._sigpoll._fd);
243 } else if (sig >= TARGET_SIGRTMIN) {
244 tinfo->_sifields._rt._pid = tswap32(info->_sifields._rt._pid);
245 tinfo->_sifields._rt._uid = tswap32(info->_sifields._rt._uid);
246 tinfo->_sifields._rt._sigval.sival_ptr =
247 tswapl(info->_sifields._rt._sigval.sival_ptr);
248 }
249 }
250
251
252 void host_to_target_siginfo(target_siginfo_t *tinfo, const siginfo_t *info)
253 {
254 host_to_target_siginfo_noswap(tinfo, info);
255 tswap_siginfo(tinfo, tinfo);
256 }
257
258 /* XXX: we support only POSIX RT signals are used. */
259 /* XXX: find a solution for 64 bit (additional malloced data is needed) */
260 void target_to_host_siginfo(siginfo_t *info, const target_siginfo_t *tinfo)
261 {
262 info->si_signo = tswap32(tinfo->si_signo);
263 info->si_errno = tswap32(tinfo->si_errno);
264 info->si_code = tswap32(tinfo->si_code);
265 info->si_pid = tswap32(tinfo->_sifields._rt._pid);
266 info->si_uid = tswap32(tinfo->_sifields._rt._uid);
267 info->si_value.sival_ptr =
268 (void *)(long)tswapl(tinfo->_sifields._rt._sigval.sival_ptr);
269 }
270
271 static int fatal_signal (int sig)
272 {
273 switch (sig) {
274 case TARGET_SIGCHLD:
275 case TARGET_SIGURG:
276 case TARGET_SIGWINCH:
277 /* Ignored by default. */
278 return 0;
279 case TARGET_SIGCONT:
280 case TARGET_SIGSTOP:
281 case TARGET_SIGTSTP:
282 case TARGET_SIGTTIN:
283 case TARGET_SIGTTOU:
284 /* Job control signals. */
285 return 0;
286 default:
287 return 1;
288 }
289 }
290
291 /* returns 1 if given signal should dump core if not handled */
292 static int core_dump_signal(int sig)
293 {
294 switch (sig) {
295 case TARGET_SIGABRT:
296 case TARGET_SIGFPE:
297 case TARGET_SIGILL:
298 case TARGET_SIGQUIT:
299 case TARGET_SIGSEGV:
300 case TARGET_SIGTRAP:
301 case TARGET_SIGBUS:
302 return (1);
303 default:
304 return (0);
305 }
306 }
307
308 void signal_init(void)
309 {
310 struct sigaction act;
311 struct sigaction oact;
312 int i, j;
313 int host_sig;
314
315 /* generate signal conversion tables */
316 for(i = 1; i <= 64; i++) {
317 if (host_to_target_signal_table[i] == 0)
318 host_to_target_signal_table[i] = i;
319 }
320 for(i = 1; i <= 64; i++) {
321 j = host_to_target_signal_table[i];
322 target_to_host_signal_table[j] = i;
323 }
324
325 /* set all host signal handlers. ALL signals are blocked during
326 the handlers to serialize them. */
327 memset(sigact_table, 0, sizeof(sigact_table));
328
329 sigfillset(&act.sa_mask);
330 act.sa_flags = SA_SIGINFO;
331 act.sa_sigaction = host_signal_handler;
332 for(i = 1; i <= TARGET_NSIG; i++) {
333 host_sig = target_to_host_signal(i);
334 sigaction(host_sig, NULL, &oact);
335 if (oact.sa_sigaction == (void *)SIG_IGN) {
336 sigact_table[i - 1]._sa_handler = TARGET_SIG_IGN;
337 } else if (oact.sa_sigaction == (void *)SIG_DFL) {
338 sigact_table[i - 1]._sa_handler = TARGET_SIG_DFL;
339 }
340 /* If there's already a handler installed then something has
341 gone horribly wrong, so don't even try to handle that case. */
342 /* Install some handlers for our own use. We need at least
343 SIGSEGV and SIGBUS, to detect exceptions. We can not just
344 trap all signals because it affects syscall interrupt
345 behavior. But do trap all default-fatal signals. */
346 if (fatal_signal (i))
347 sigaction(host_sig, &act, NULL);
348 }
349 }
350
351 /* signal queue handling */
352
353 static inline struct sigqueue *alloc_sigqueue(CPUState *env)
354 {
355 TaskState *ts = env->opaque;
356 struct sigqueue *q = ts->first_free;
357 if (!q)
358 return NULL;
359 ts->first_free = q->next;
360 return q;
361 }
362
363 static inline void free_sigqueue(CPUState *env, struct sigqueue *q)
364 {
365 TaskState *ts = env->opaque;
366 q->next = ts->first_free;
367 ts->first_free = q;
368 }
369
370 /* abort execution with signal */
371 static void QEMU_NORETURN force_sig(int sig)
372 {
373 TaskState *ts = (TaskState *)thread_env->opaque;
374 int host_sig, core_dumped = 0;
375 struct sigaction act;
376 host_sig = target_to_host_signal(sig);
377 gdb_signalled(thread_env, sig);
378
379 /* dump core if supported by target binary format */
380 if (core_dump_signal(sig) && (ts->bprm->core_dump != NULL)) {
381 stop_all_tasks();
382 core_dumped =
383 ((*ts->bprm->core_dump)(sig, thread_env) == 0);
384 }
385 if (core_dumped) {
386 /* we already dumped the core of target process, we don't want
387 * a coredump of qemu itself */
388 struct rlimit nodump;
389 getrlimit(RLIMIT_CORE, &nodump);
390 nodump.rlim_cur=0;
391 setrlimit(RLIMIT_CORE, &nodump);
392 (void) fprintf(stderr, "qemu: uncaught target signal %d (%s) - %s\n",
393 sig, strsignal(host_sig), "core dumped" );
394 }
395
396 /* The proper exit code for dieing from an uncaught signal is
397 * -<signal>. The kernel doesn't allow exit() or _exit() to pass
398 * a negative value. To get the proper exit code we need to
399 * actually die from an uncaught signal. Here the default signal
400 * handler is installed, we send ourself a signal and we wait for
401 * it to arrive. */
402 sigfillset(&act.sa_mask);
403 act.sa_handler = SIG_DFL;
404 sigaction(host_sig, &act, NULL);
405
406 /* For some reason raise(host_sig) doesn't send the signal when
407 * statically linked on x86-64. */
408 kill(getpid(), host_sig);
409
410 /* Make sure the signal isn't masked (just reuse the mask inside
411 of act) */
412 sigdelset(&act.sa_mask, host_sig);
413 sigsuspend(&act.sa_mask);
414
415 /* unreachable */
416 assert(0);
417
418 }
419
420 /* queue a signal so that it will be send to the virtual CPU as soon
421 as possible */
422 int queue_signal(CPUState *env, int sig, target_siginfo_t *info)
423 {
424 TaskState *ts = env->opaque;
425 struct emulated_sigtable *k;
426 struct sigqueue *q, **pq;
427 abi_ulong handler;
428 int queue;
429
430 #if defined(DEBUG_SIGNAL)
431 fprintf(stderr, "queue_signal: sig=%d\n",
432 sig);
433 #endif
434 k = &ts->sigtab[sig - 1];
435 queue = gdb_queuesig ();
436 handler = sigact_table[sig - 1]._sa_handler;
437 if (!queue && handler == TARGET_SIG_DFL) {
438 if (sig == TARGET_SIGTSTP || sig == TARGET_SIGTTIN || sig == TARGET_SIGTTOU) {
439 kill(getpid(),SIGSTOP);
440 return 0;
441 } else
442 /* default handler : ignore some signal. The other are fatal */
443 if (sig != TARGET_SIGCHLD &&
444 sig != TARGET_SIGURG &&
445 sig != TARGET_SIGWINCH &&
446 sig != TARGET_SIGCONT) {
447 force_sig(sig);
448 } else {
449 return 0; /* indicate ignored */
450 }
451 } else if (!queue && handler == TARGET_SIG_IGN) {
452 /* ignore signal */
453 return 0;
454 } else if (!queue && handler == TARGET_SIG_ERR) {
455 force_sig(sig);
456 } else {
457 pq = &k->first;
458 if (sig < TARGET_SIGRTMIN) {
459 /* if non real time signal, we queue exactly one signal */
460 if (!k->pending)
461 q = &k->info;
462 else
463 return 0;
464 } else {
465 if (!k->pending) {
466 /* first signal */
467 q = &k->info;
468 } else {
469 q = alloc_sigqueue(env);
470 if (!q)
471 return -EAGAIN;
472 while (*pq != NULL)
473 pq = &(*pq)->next;
474 }
475 }
476 *pq = q;
477 q->info = *info;
478 q->next = NULL;
479 k->pending = 1;
480 /* signal that a new signal is pending */
481 ts->signal_pending = 1;
482 return 1; /* indicates that the signal was queued */
483 }
484 }
485
486 static void host_signal_handler(int host_signum, siginfo_t *info,
487 void *puc)
488 {
489 int sig;
490 target_siginfo_t tinfo;
491
492 /* the CPU emulator uses some host signals to detect exceptions,
493 we forward to it some signals */
494 if ((host_signum == SIGSEGV || host_signum == SIGBUS)
495 && info->si_code > 0) {
496 if (cpu_signal_handler(host_signum, info, puc))
497 return;
498 }
499
500 /* get target signal number */
501 sig = host_to_target_signal(host_signum);
502 if (sig < 1 || sig > TARGET_NSIG)
503 return;
504 #if defined(DEBUG_SIGNAL)
505 fprintf(stderr, "qemu: got signal %d\n", sig);
506 #endif
507 host_to_target_siginfo_noswap(&tinfo, info);
508 if (queue_signal(thread_env, sig, &tinfo) == 1) {
509 /* interrupt the virtual CPU as soon as possible */
510 cpu_exit(thread_env);
511 }
512 }
513
514 /* do_sigaltstack() returns target values and errnos. */
515 /* compare linux/kernel/signal.c:do_sigaltstack() */
516 abi_long do_sigaltstack(abi_ulong uss_addr, abi_ulong uoss_addr, abi_ulong sp)
517 {
518 int ret;
519 struct target_sigaltstack oss;
520
521 /* XXX: test errors */
522 if(uoss_addr)
523 {
524 __put_user(target_sigaltstack_used.ss_sp, &oss.ss_sp);
525 __put_user(target_sigaltstack_used.ss_size, &oss.ss_size);
526 __put_user(sas_ss_flags(sp), &oss.ss_flags);
527 }
528
529 if(uss_addr)
530 {
531 struct target_sigaltstack *uss;
532 struct target_sigaltstack ss;
533
534 ret = -TARGET_EFAULT;
535 if (!lock_user_struct(VERIFY_READ, uss, uss_addr, 1)
536 || __get_user(ss.ss_sp, &uss->ss_sp)
537 || __get_user(ss.ss_size, &uss->ss_size)
538 || __get_user(ss.ss_flags, &uss->ss_flags))
539 goto out;
540 unlock_user_struct(uss, uss_addr, 0);
541
542 ret = -TARGET_EPERM;
543 if (on_sig_stack(sp))
544 goto out;
545
546 ret = -TARGET_EINVAL;
547 if (ss.ss_flags != TARGET_SS_DISABLE
548 && ss.ss_flags != TARGET_SS_ONSTACK
549 && ss.ss_flags != 0)
550 goto out;
551
552 if (ss.ss_flags == TARGET_SS_DISABLE) {
553 ss.ss_size = 0;
554 ss.ss_sp = 0;
555 } else {
556 ret = -TARGET_ENOMEM;
557 if (ss.ss_size < MINSIGSTKSZ)
558 goto out;
559 }
560
561 target_sigaltstack_used.ss_sp = ss.ss_sp;
562 target_sigaltstack_used.ss_size = ss.ss_size;
563 }
564
565 if (uoss_addr) {
566 ret = -TARGET_EFAULT;
567 if (copy_to_user(uoss_addr, &oss, sizeof(oss)))
568 goto out;
569 }
570
571 ret = 0;
572 out:
573 return ret;
574 }
575
576 /* do_sigaction() return host values and errnos */
577 int do_sigaction(int sig, const struct target_sigaction *act,
578 struct target_sigaction *oact)
579 {
580 struct target_sigaction *k;
581 struct sigaction act1;
582 int host_sig;
583 int ret = 0;
584
585 if (sig < 1 || sig > TARGET_NSIG || sig == TARGET_SIGKILL || sig == TARGET_SIGSTOP)
586 return -EINVAL;
587 k = &sigact_table[sig - 1];
588 #if defined(DEBUG_SIGNAL)
589 fprintf(stderr, "sigaction sig=%d act=0x%08x, oact=0x%08x\n",
590 sig, (int)act, (int)oact);
591 #endif
592 if (oact) {
593 oact->_sa_handler = tswapl(k->_sa_handler);
594 oact->sa_flags = tswapl(k->sa_flags);
595 #if !defined(TARGET_MIPS)
596 oact->sa_restorer = tswapl(k->sa_restorer);
597 #endif
598 oact->sa_mask = k->sa_mask;
599 }
600 if (act) {
601 /* FIXME: This is not threadsafe. */
602 k->_sa_handler = tswapl(act->_sa_handler);
603 k->sa_flags = tswapl(act->sa_flags);
604 #if !defined(TARGET_MIPS)
605 k->sa_restorer = tswapl(act->sa_restorer);
606 #endif
607 k->sa_mask = act->sa_mask;
608
609 /* we update the host linux signal state */
610 host_sig = target_to_host_signal(sig);
611 if (host_sig != SIGSEGV && host_sig != SIGBUS) {
612 sigfillset(&act1.sa_mask);
613 act1.sa_flags = SA_SIGINFO;
614 if (k->sa_flags & TARGET_SA_RESTART)
615 act1.sa_flags |= SA_RESTART;
616 /* NOTE: it is important to update the host kernel signal
617 ignore state to avoid getting unexpected interrupted
618 syscalls */
619 if (k->_sa_handler == TARGET_SIG_IGN) {
620 act1.sa_sigaction = (void *)SIG_IGN;
621 } else if (k->_sa_handler == TARGET_SIG_DFL) {
622 if (fatal_signal (sig))
623 act1.sa_sigaction = host_signal_handler;
624 else
625 act1.sa_sigaction = (void *)SIG_DFL;
626 } else {
627 act1.sa_sigaction = host_signal_handler;
628 }
629 ret = sigaction(host_sig, &act1, NULL);
630 }
631 }
632 return ret;
633 }
634
635 static inline int copy_siginfo_to_user(target_siginfo_t *tinfo,
636 const target_siginfo_t *info)
637 {
638 tswap_siginfo(tinfo, info);
639 return 0;
640 }
641
642 static inline int current_exec_domain_sig(int sig)
643 {
644 return /* current->exec_domain && current->exec_domain->signal_invmap
645 && sig < 32 ? current->exec_domain->signal_invmap[sig] : */ sig;
646 }
647
648 #if defined(TARGET_I386) && TARGET_ABI_BITS == 32
649
650 /* from the Linux kernel */
651
652 struct target_fpreg {
653 uint16_t significand[4];
654 uint16_t exponent;
655 };
656
657 struct target_fpxreg {
658 uint16_t significand[4];
659 uint16_t exponent;
660 uint16_t padding[3];
661 };
662
663 struct target_xmmreg {
664 abi_ulong element[4];
665 };
666
667 struct target_fpstate {
668 /* Regular FPU environment */
669 abi_ulong cw;
670 abi_ulong sw;
671 abi_ulong tag;
672 abi_ulong ipoff;
673 abi_ulong cssel;
674 abi_ulong dataoff;
675 abi_ulong datasel;
676 struct target_fpreg _st[8];
677 uint16_t status;
678 uint16_t magic; /* 0xffff = regular FPU data only */
679
680 /* FXSR FPU environment */
681 abi_ulong _fxsr_env[6]; /* FXSR FPU env is ignored */
682 abi_ulong mxcsr;
683 abi_ulong reserved;
684 struct target_fpxreg _fxsr_st[8]; /* FXSR FPU reg data is ignored */
685 struct target_xmmreg _xmm[8];
686 abi_ulong padding[56];
687 };
688
689 #define X86_FXSR_MAGIC 0x0000
690
691 struct target_sigcontext {
692 uint16_t gs, __gsh;
693 uint16_t fs, __fsh;
694 uint16_t es, __esh;
695 uint16_t ds, __dsh;
696 abi_ulong edi;
697 abi_ulong esi;
698 abi_ulong ebp;
699 abi_ulong esp;
700 abi_ulong ebx;
701 abi_ulong edx;
702 abi_ulong ecx;
703 abi_ulong eax;
704 abi_ulong trapno;
705 abi_ulong err;
706 abi_ulong eip;
707 uint16_t cs, __csh;
708 abi_ulong eflags;
709 abi_ulong esp_at_signal;
710 uint16_t ss, __ssh;
711 abi_ulong fpstate; /* pointer */
712 abi_ulong oldmask;
713 abi_ulong cr2;
714 };
715
716 struct target_ucontext {
717 abi_ulong tuc_flags;
718 abi_ulong tuc_link;
719 target_stack_t tuc_stack;
720 struct target_sigcontext tuc_mcontext;
721 target_sigset_t tuc_sigmask; /* mask last for extensibility */
722 };
723
724 struct sigframe
725 {
726 abi_ulong pretcode;
727 int sig;
728 struct target_sigcontext sc;
729 struct target_fpstate fpstate;
730 abi_ulong extramask[TARGET_NSIG_WORDS-1];
731 char retcode[8];
732 };
733
734 struct rt_sigframe
735 {
736 abi_ulong pretcode;
737 int sig;
738 abi_ulong pinfo;
739 abi_ulong puc;
740 struct target_siginfo info;
741 struct target_ucontext uc;
742 struct target_fpstate fpstate;
743 char retcode[8];
744 };
745
746 /*
747 * Set up a signal frame.
748 */
749
750 /* XXX: save x87 state */
751 static int
752 setup_sigcontext(struct target_sigcontext *sc, struct target_fpstate *fpstate,
753 CPUX86State *env, abi_ulong mask, abi_ulong fpstate_addr)
754 {
755 int err = 0;
756 uint16_t magic;
757
758 /* already locked in setup_frame() */
759 err |= __put_user(env->segs[R_GS].selector, (unsigned int *)&sc->gs);
760 err |= __put_user(env->segs[R_FS].selector, (unsigned int *)&sc->fs);
761 err |= __put_user(env->segs[R_ES].selector, (unsigned int *)&sc->es);
762 err |= __put_user(env->segs[R_DS].selector, (unsigned int *)&sc->ds);
763 err |= __put_user(env->regs[R_EDI], &sc->edi);
764 err |= __put_user(env->regs[R_ESI], &sc->esi);
765 err |= __put_user(env->regs[R_EBP], &sc->ebp);
766 err |= __put_user(env->regs[R_ESP], &sc->esp);
767 err |= __put_user(env->regs[R_EBX], &sc->ebx);
768 err |= __put_user(env->regs[R_EDX], &sc->edx);
769 err |= __put_user(env->regs[R_ECX], &sc->ecx);
770 err |= __put_user(env->regs[R_EAX], &sc->eax);
771 err |= __put_user(env->exception_index, &sc->trapno);
772 err |= __put_user(env->error_code, &sc->err);
773 err |= __put_user(env->eip, &sc->eip);
774 err |= __put_user(env->segs[R_CS].selector, (unsigned int *)&sc->cs);
775 err |= __put_user(env->eflags, &sc->eflags);
776 err |= __put_user(env->regs[R_ESP], &sc->esp_at_signal);
777 err |= __put_user(env->segs[R_SS].selector, (unsigned int *)&sc->ss);
778
779 cpu_x86_fsave(env, fpstate_addr, 1);
780 fpstate->status = fpstate->sw;
781 magic = 0xffff;
782 err |= __put_user(magic, &fpstate->magic);
783 err |= __put_user(fpstate_addr, &sc->fpstate);
784
785 /* non-iBCS2 extensions.. */
786 err |= __put_user(mask, &sc->oldmask);
787 err |= __put_user(env->cr[2], &sc->cr2);
788 return err;
789 }
790
791 /*
792 * Determine which stack to use..
793 */
794
795 static inline abi_ulong
796 get_sigframe(struct target_sigaction *ka, CPUX86State *env, size_t frame_size)
797 {
798 unsigned long esp;
799
800 /* Default to using normal stack */
801 esp = env->regs[R_ESP];
802 /* This is the X/Open sanctioned signal stack switching. */
803 if (ka->sa_flags & TARGET_SA_ONSTACK) {
804 if (sas_ss_flags(esp) == 0)
805 esp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
806 }
807
808 /* This is the legacy signal stack switching. */
809 else
810 if ((env->segs[R_SS].selector & 0xffff) != __USER_DS &&
811 !(ka->sa_flags & TARGET_SA_RESTORER) &&
812 ka->sa_restorer) {
813 esp = (unsigned long) ka->sa_restorer;
814 }
815 return (esp - frame_size) & -8ul;
816 }
817
818 /* compare linux/arch/i386/kernel/signal.c:setup_frame() */
819 static void setup_frame(int sig, struct target_sigaction *ka,
820 target_sigset_t *set, CPUX86State *env)
821 {
822 abi_ulong frame_addr;
823 struct sigframe *frame;
824 int i, err = 0;
825
826 frame_addr = get_sigframe(ka, env, sizeof(*frame));
827
828 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
829 goto give_sigsegv;
830
831 err |= __put_user(current_exec_domain_sig(sig),
832 &frame->sig);
833 if (err)
834 goto give_sigsegv;
835
836 setup_sigcontext(&frame->sc, &frame->fpstate, env, set->sig[0],
837 frame_addr + offsetof(struct sigframe, fpstate));
838 if (err)
839 goto give_sigsegv;
840
841 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
842 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
843 goto give_sigsegv;
844 }
845
846 /* Set up to return from userspace. If provided, use a stub
847 already in userspace. */
848 if (ka->sa_flags & TARGET_SA_RESTORER) {
849 err |= __put_user(ka->sa_restorer, &frame->pretcode);
850 } else {
851 uint16_t val16;
852 abi_ulong retcode_addr;
853 retcode_addr = frame_addr + offsetof(struct sigframe, retcode);
854 err |= __put_user(retcode_addr, &frame->pretcode);
855 /* This is popl %eax ; movl $,%eax ; int $0x80 */
856 val16 = 0xb858;
857 err |= __put_user(val16, (uint16_t *)(frame->retcode+0));
858 err |= __put_user(TARGET_NR_sigreturn, (int *)(frame->retcode+2));
859 val16 = 0x80cd;
860 err |= __put_user(val16, (uint16_t *)(frame->retcode+6));
861 }
862
863 if (err)
864 goto give_sigsegv;
865
866 /* Set up registers for signal handler */
867 env->regs[R_ESP] = frame_addr;
868 env->eip = ka->_sa_handler;
869
870 cpu_x86_load_seg(env, R_DS, __USER_DS);
871 cpu_x86_load_seg(env, R_ES, __USER_DS);
872 cpu_x86_load_seg(env, R_SS, __USER_DS);
873 cpu_x86_load_seg(env, R_CS, __USER_CS);
874 env->eflags &= ~TF_MASK;
875
876 unlock_user_struct(frame, frame_addr, 1);
877
878 return;
879
880 give_sigsegv:
881 unlock_user_struct(frame, frame_addr, 1);
882 if (sig == TARGET_SIGSEGV)
883 ka->_sa_handler = TARGET_SIG_DFL;
884 force_sig(TARGET_SIGSEGV /* , current */);
885 }
886
887 /* compare linux/arch/i386/kernel/signal.c:setup_rt_frame() */
888 static void setup_rt_frame(int sig, struct target_sigaction *ka,
889 target_siginfo_t *info,
890 target_sigset_t *set, CPUX86State *env)
891 {
892 abi_ulong frame_addr, addr;
893 struct rt_sigframe *frame;
894 int i, err = 0;
895
896 frame_addr = get_sigframe(ka, env, sizeof(*frame));
897
898 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
899 goto give_sigsegv;
900
901 err |= __put_user(current_exec_domain_sig(sig),
902 &frame->sig);
903 addr = frame_addr + offsetof(struct rt_sigframe, info);
904 err |= __put_user(addr, &frame->pinfo);
905 addr = frame_addr + offsetof(struct rt_sigframe, uc);
906 err |= __put_user(addr, &frame->puc);
907 err |= copy_siginfo_to_user(&frame->info, info);
908 if (err)
909 goto give_sigsegv;
910
911 /* Create the ucontext. */
912 err |= __put_user(0, &frame->uc.tuc_flags);
913 err |= __put_user(0, &frame->uc.tuc_link);
914 err |= __put_user(target_sigaltstack_used.ss_sp,
915 &frame->uc.tuc_stack.ss_sp);
916 err |= __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
917 &frame->uc.tuc_stack.ss_flags);
918 err |= __put_user(target_sigaltstack_used.ss_size,
919 &frame->uc.tuc_stack.ss_size);
920 err |= setup_sigcontext(&frame->uc.tuc_mcontext, &frame->fpstate,
921 env, set->sig[0],
922 frame_addr + offsetof(struct rt_sigframe, fpstate));
923 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
924 if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
925 goto give_sigsegv;
926 }
927
928 /* Set up to return from userspace. If provided, use a stub
929 already in userspace. */
930 if (ka->sa_flags & TARGET_SA_RESTORER) {
931 err |= __put_user(ka->sa_restorer, &frame->pretcode);
932 } else {
933 uint16_t val16;
934 addr = frame_addr + offsetof(struct rt_sigframe, retcode);
935 err |= __put_user(addr, &frame->pretcode);
936 /* This is movl $,%eax ; int $0x80 */
937 err |= __put_user(0xb8, (char *)(frame->retcode+0));
938 err |= __put_user(TARGET_NR_rt_sigreturn, (int *)(frame->retcode+1));
939 val16 = 0x80cd;
940 err |= __put_user(val16, (uint16_t *)(frame->retcode+5));
941 }
942
943 if (err)
944 goto give_sigsegv;
945
946 /* Set up registers for signal handler */
947 env->regs[R_ESP] = frame_addr;
948 env->eip = ka->_sa_handler;
949
950 cpu_x86_load_seg(env, R_DS, __USER_DS);
951 cpu_x86_load_seg(env, R_ES, __USER_DS);
952 cpu_x86_load_seg(env, R_SS, __USER_DS);
953 cpu_x86_load_seg(env, R_CS, __USER_CS);
954 env->eflags &= ~TF_MASK;
955
956 unlock_user_struct(frame, frame_addr, 1);
957
958 return;
959
960 give_sigsegv:
961 unlock_user_struct(frame, frame_addr, 1);
962 if (sig == TARGET_SIGSEGV)
963 ka->_sa_handler = TARGET_SIG_DFL;
964 force_sig(TARGET_SIGSEGV /* , current */);
965 }
966
967 static int
968 restore_sigcontext(CPUX86State *env, struct target_sigcontext *sc, int *peax)
969 {
970 unsigned int err = 0;
971 abi_ulong fpstate_addr;
972 unsigned int tmpflags;
973
974 cpu_x86_load_seg(env, R_GS, tswap16(sc->gs));
975 cpu_x86_load_seg(env, R_FS, tswap16(sc->fs));
976 cpu_x86_load_seg(env, R_ES, tswap16(sc->es));
977 cpu_x86_load_seg(env, R_DS, tswap16(sc->ds));
978
979 env->regs[R_EDI] = tswapl(sc->edi);
980 env->regs[R_ESI] = tswapl(sc->esi);
981 env->regs[R_EBP] = tswapl(sc->ebp);
982 env->regs[R_ESP] = tswapl(sc->esp);
983 env->regs[R_EBX] = tswapl(sc->ebx);
984 env->regs[R_EDX] = tswapl(sc->edx);
985 env->regs[R_ECX] = tswapl(sc->ecx);
986 env->eip = tswapl(sc->eip);
987
988 cpu_x86_load_seg(env, R_CS, lduw(&sc->cs) | 3);
989 cpu_x86_load_seg(env, R_SS, lduw(&sc->ss) | 3);
990
991 tmpflags = tswapl(sc->eflags);
992 env->eflags = (env->eflags & ~0x40DD5) | (tmpflags & 0x40DD5);
993 // regs->orig_eax = -1; /* disable syscall checks */
994
995 fpstate_addr = tswapl(sc->fpstate);
996 if (fpstate_addr != 0) {
997 if (!access_ok(VERIFY_READ, fpstate_addr,
998 sizeof(struct target_fpstate)))
999 goto badframe;
1000 cpu_x86_frstor(env, fpstate_addr, 1);
1001 }
1002
1003 *peax = tswapl(sc->eax);
1004 return err;
1005 badframe:
1006 return 1;
1007 }
1008
1009 long do_sigreturn(CPUX86State *env)
1010 {
1011 struct sigframe *frame;
1012 abi_ulong frame_addr = env->regs[R_ESP] - 8;
1013 target_sigset_t target_set;
1014 sigset_t set;
1015 int eax, i;
1016
1017 #if defined(DEBUG_SIGNAL)
1018 fprintf(stderr, "do_sigreturn\n");
1019 #endif
1020 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1021 goto badframe;
1022 /* set blocked signals */
1023 if (__get_user(target_set.sig[0], &frame->sc.oldmask))
1024 goto badframe;
1025 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1026 if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
1027 goto badframe;
1028 }
1029
1030 target_to_host_sigset_internal(&set, &target_set);
1031 sigprocmask(SIG_SETMASK, &set, NULL);
1032
1033 /* restore registers */
1034 if (restore_sigcontext(env, &frame->sc, &eax))
1035 goto badframe;
1036 unlock_user_struct(frame, frame_addr, 0);
1037 return eax;
1038
1039 badframe:
1040 unlock_user_struct(frame, frame_addr, 0);
1041 force_sig(TARGET_SIGSEGV);
1042 return 0;
1043 }
1044
1045 long do_rt_sigreturn(CPUX86State *env)
1046 {
1047 abi_ulong frame_addr;
1048 struct rt_sigframe *frame;
1049 sigset_t set;
1050 int eax;
1051
1052 frame_addr = env->regs[R_ESP] - 4;
1053 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1054 goto badframe;
1055 target_to_host_sigset(&set, &frame->uc.tuc_sigmask);
1056 sigprocmask(SIG_SETMASK, &set, NULL);
1057
1058 if (restore_sigcontext(env, &frame->uc.tuc_mcontext, &eax))
1059 goto badframe;
1060
1061 if (do_sigaltstack(frame_addr + offsetof(struct rt_sigframe, uc.tuc_stack), 0,
1062 get_sp_from_cpustate(env)) == -EFAULT)
1063 goto badframe;
1064
1065 unlock_user_struct(frame, frame_addr, 0);
1066 return eax;
1067
1068 badframe:
1069 unlock_user_struct(frame, frame_addr, 0);
1070 force_sig(TARGET_SIGSEGV);
1071 return 0;
1072 }
1073
1074 #elif defined(TARGET_ARM)
1075
1076 struct target_sigcontext {
1077 abi_ulong trap_no;
1078 abi_ulong error_code;
1079 abi_ulong oldmask;
1080 abi_ulong arm_r0;
1081 abi_ulong arm_r1;
1082 abi_ulong arm_r2;
1083 abi_ulong arm_r3;
1084 abi_ulong arm_r4;
1085 abi_ulong arm_r5;
1086 abi_ulong arm_r6;
1087 abi_ulong arm_r7;
1088 abi_ulong arm_r8;
1089 abi_ulong arm_r9;
1090 abi_ulong arm_r10;
1091 abi_ulong arm_fp;
1092 abi_ulong arm_ip;
1093 abi_ulong arm_sp;
1094 abi_ulong arm_lr;
1095 abi_ulong arm_pc;
1096 abi_ulong arm_cpsr;
1097 abi_ulong fault_address;
1098 };
1099
1100 struct target_ucontext_v1 {
1101 abi_ulong tuc_flags;
1102 abi_ulong tuc_link;
1103 target_stack_t tuc_stack;
1104 struct target_sigcontext tuc_mcontext;
1105 target_sigset_t tuc_sigmask; /* mask last for extensibility */
1106 };
1107
1108 struct target_ucontext_v2 {
1109 abi_ulong tuc_flags;
1110 abi_ulong tuc_link;
1111 target_stack_t tuc_stack;
1112 struct target_sigcontext tuc_mcontext;
1113 target_sigset_t tuc_sigmask; /* mask last for extensibility */
1114 char __unused[128 - sizeof(sigset_t)];
1115 abi_ulong tuc_regspace[128] __attribute__((__aligned__(8)));
1116 };
1117
1118 struct sigframe_v1
1119 {
1120 struct target_sigcontext sc;
1121 abi_ulong extramask[TARGET_NSIG_WORDS-1];
1122 abi_ulong retcode;
1123 };
1124
1125 struct sigframe_v2
1126 {
1127 struct target_ucontext_v2 uc;
1128 abi_ulong retcode;
1129 };
1130
1131 struct rt_sigframe_v1
1132 {
1133 abi_ulong pinfo;
1134 abi_ulong puc;
1135 struct target_siginfo info;
1136 struct target_ucontext_v1 uc;
1137 abi_ulong retcode;
1138 };
1139
1140 struct rt_sigframe_v2
1141 {
1142 struct target_siginfo info;
1143 struct target_ucontext_v2 uc;
1144 abi_ulong retcode;
1145 };
1146
1147 #define TARGET_CONFIG_CPU_32 1
1148
1149 /*
1150 * For ARM syscalls, we encode the syscall number into the instruction.
1151 */
1152 #define SWI_SYS_SIGRETURN (0xef000000|(TARGET_NR_sigreturn + ARM_SYSCALL_BASE))
1153 #define SWI_SYS_RT_SIGRETURN (0xef000000|(TARGET_NR_rt_sigreturn + ARM_SYSCALL_BASE))
1154
1155 /*
1156 * For Thumb syscalls, we pass the syscall number via r7. We therefore
1157 * need two 16-bit instructions.
1158 */
1159 #define SWI_THUMB_SIGRETURN (0xdf00 << 16 | 0x2700 | (TARGET_NR_sigreturn))
1160 #define SWI_THUMB_RT_SIGRETURN (0xdf00 << 16 | 0x2700 | (TARGET_NR_rt_sigreturn))
1161
1162 static const abi_ulong retcodes[4] = {
1163 SWI_SYS_SIGRETURN, SWI_THUMB_SIGRETURN,
1164 SWI_SYS_RT_SIGRETURN, SWI_THUMB_RT_SIGRETURN
1165 };
1166
1167
1168 #define __get_user_error(x,p,e) __get_user(x, p)
1169
1170 static inline int valid_user_regs(CPUState *regs)
1171 {
1172 return 1;
1173 }
1174
1175 static void
1176 setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1177 CPUState *env, abi_ulong mask)
1178 {
1179 __put_user(env->regs[0], &sc->arm_r0);
1180 __put_user(env->regs[1], &sc->arm_r1);
1181 __put_user(env->regs[2], &sc->arm_r2);
1182 __put_user(env->regs[3], &sc->arm_r3);
1183 __put_user(env->regs[4], &sc->arm_r4);
1184 __put_user(env->regs[5], &sc->arm_r5);
1185 __put_user(env->regs[6], &sc->arm_r6);
1186 __put_user(env->regs[7], &sc->arm_r7);
1187 __put_user(env->regs[8], &sc->arm_r8);
1188 __put_user(env->regs[9], &sc->arm_r9);
1189 __put_user(env->regs[10], &sc->arm_r10);
1190 __put_user(env->regs[11], &sc->arm_fp);
1191 __put_user(env->regs[12], &sc->arm_ip);
1192 __put_user(env->regs[13], &sc->arm_sp);
1193 __put_user(env->regs[14], &sc->arm_lr);
1194 __put_user(env->regs[15], &sc->arm_pc);
1195 #ifdef TARGET_CONFIG_CPU_32
1196 __put_user(cpsr_read(env), &sc->arm_cpsr);
1197 #endif
1198
1199 __put_user(/* current->thread.trap_no */ 0, &sc->trap_no);
1200 __put_user(/* current->thread.error_code */ 0, &sc->error_code);
1201 __put_user(/* current->thread.address */ 0, &sc->fault_address);
1202 __put_user(mask, &sc->oldmask);
1203 }
1204
1205 static inline abi_ulong
1206 get_sigframe(struct target_sigaction *ka, CPUState *regs, int framesize)
1207 {
1208 unsigned long sp = regs->regs[13];
1209
1210 /*
1211 * This is the X/Open sanctioned signal stack switching.
1212 */
1213 if ((ka->sa_flags & TARGET_SA_ONSTACK) && !sas_ss_flags(sp))
1214 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
1215 /*
1216 * ATPCS B01 mandates 8-byte alignment
1217 */
1218 return (sp - framesize) & ~7;
1219 }
1220
1221 static int
1222 setup_return(CPUState *env, struct target_sigaction *ka,
1223 abi_ulong *rc, abi_ulong frame_addr, int usig, abi_ulong rc_addr)
1224 {
1225 abi_ulong handler = ka->_sa_handler;
1226 abi_ulong retcode;
1227 int thumb = handler & 1;
1228
1229 if (ka->sa_flags & TARGET_SA_RESTORER) {
1230 retcode = ka->sa_restorer;
1231 } else {
1232 unsigned int idx = thumb;
1233
1234 if (ka->sa_flags & TARGET_SA_SIGINFO)
1235 idx += 2;
1236
1237 if (__put_user(retcodes[idx], rc))
1238 return 1;
1239 #if 0
1240 flush_icache_range((abi_ulong)rc,
1241 (abi_ulong)(rc + 1));
1242 #endif
1243 retcode = rc_addr + thumb;
1244 }
1245
1246 env->regs[0] = usig;
1247 env->regs[13] = frame_addr;
1248 env->regs[14] = retcode;
1249 env->regs[15] = handler & (thumb ? ~1 : ~3);
1250 env->thumb = thumb;
1251
1252 #if 0
1253 #ifdef TARGET_CONFIG_CPU_32
1254 env->cpsr = cpsr;
1255 #endif
1256 #endif
1257
1258 return 0;
1259 }
1260
1261 static void setup_sigframe_v2(struct target_ucontext_v2 *uc,
1262 target_sigset_t *set, CPUState *env)
1263 {
1264 struct target_sigaltstack stack;
1265 int i;
1266
1267 /* Clear all the bits of the ucontext we don't use. */
1268 memset(uc, 0, offsetof(struct target_ucontext_v2, tuc_mcontext));
1269
1270 memset(&stack, 0, sizeof(stack));
1271 __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
1272 __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
1273 __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
1274 memcpy(&uc->tuc_stack, &stack, sizeof(stack));
1275
1276 setup_sigcontext(&uc->tuc_mcontext, env, set->sig[0]);
1277 /* FIXME: Save coprocessor signal frame. */
1278 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
1279 __put_user(set->sig[i], &uc->tuc_sigmask.sig[i]);
1280 }
1281 }
1282
1283 /* compare linux/arch/arm/kernel/signal.c:setup_frame() */
1284 static void setup_frame_v1(int usig, struct target_sigaction *ka,
1285 target_sigset_t *set, CPUState *regs)
1286 {
1287 struct sigframe_v1 *frame;
1288 abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
1289 int i;
1290
1291 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1292 return;
1293
1294 setup_sigcontext(&frame->sc, regs, set->sig[0]);
1295
1296 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1297 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
1298 goto end;
1299 }
1300
1301 setup_return(regs, ka, &frame->retcode, frame_addr, usig,
1302 frame_addr + offsetof(struct sigframe_v1, retcode));
1303
1304 end:
1305 unlock_user_struct(frame, frame_addr, 1);
1306 }
1307
1308 static void setup_frame_v2(int usig, struct target_sigaction *ka,
1309 target_sigset_t *set, CPUState *regs)
1310 {
1311 struct sigframe_v2 *frame;
1312 abi_ulong frame_addr = get_sigframe(ka, regs, sizeof(*frame));
1313
1314 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1315 return;
1316
1317 setup_sigframe_v2(&frame->uc, set, regs);
1318
1319 setup_return(regs, ka, &frame->retcode, frame_addr, usig,
1320 frame_addr + offsetof(struct sigframe_v2, retcode));
1321
1322 unlock_user_struct(frame, frame_addr, 1);
1323 }
1324
1325 static void setup_frame(int usig, struct target_sigaction *ka,
1326 target_sigset_t *set, CPUState *regs)
1327 {
1328 if (get_osversion() >= 0x020612) {
1329 setup_frame_v2(usig, ka, set, regs);
1330 } else {
1331 setup_frame_v1(usig, ka, set, regs);
1332 }
1333 }
1334
1335 /* compare linux/arch/arm/kernel/signal.c:setup_rt_frame() */
1336 static void setup_rt_frame_v1(int usig, struct target_sigaction *ka,
1337 target_siginfo_t *info,
1338 target_sigset_t *set, CPUState *env)
1339 {
1340 struct rt_sigframe_v1 *frame;
1341 abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
1342 struct target_sigaltstack stack;
1343 int i;
1344 abi_ulong info_addr, uc_addr;
1345
1346 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1347 return /* 1 */;
1348
1349 info_addr = frame_addr + offsetof(struct rt_sigframe_v1, info);
1350 __put_user(info_addr, &frame->pinfo);
1351 uc_addr = frame_addr + offsetof(struct rt_sigframe_v1, uc);
1352 __put_user(uc_addr, &frame->puc);
1353 copy_siginfo_to_user(&frame->info, info);
1354
1355 /* Clear all the bits of the ucontext we don't use. */
1356 memset(&frame->uc, 0, offsetof(struct target_ucontext_v1, tuc_mcontext));
1357
1358 memset(&stack, 0, sizeof(stack));
1359 __put_user(target_sigaltstack_used.ss_sp, &stack.ss_sp);
1360 __put_user(target_sigaltstack_used.ss_size, &stack.ss_size);
1361 __put_user(sas_ss_flags(get_sp_from_cpustate(env)), &stack.ss_flags);
1362 memcpy(&frame->uc.tuc_stack, &stack, sizeof(stack));
1363
1364 setup_sigcontext(&frame->uc.tuc_mcontext, env, set->sig[0]);
1365 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
1366 if (__put_user(set->sig[i], &frame->uc.tuc_sigmask.sig[i]))
1367 goto end;
1368 }
1369
1370 setup_return(env, ka, &frame->retcode, frame_addr, usig,
1371 frame_addr + offsetof(struct rt_sigframe_v1, retcode));
1372
1373 env->regs[1] = info_addr;
1374 env->regs[2] = uc_addr;
1375
1376 end:
1377 unlock_user_struct(frame, frame_addr, 1);
1378 }
1379
1380 static void setup_rt_frame_v2(int usig, struct target_sigaction *ka,
1381 target_siginfo_t *info,
1382 target_sigset_t *set, CPUState *env)
1383 {
1384 struct rt_sigframe_v2 *frame;
1385 abi_ulong frame_addr = get_sigframe(ka, env, sizeof(*frame));
1386 abi_ulong info_addr, uc_addr;
1387
1388 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
1389 return /* 1 */;
1390
1391 info_addr = frame_addr + offsetof(struct rt_sigframe_v2, info);
1392 uc_addr = frame_addr + offsetof(struct rt_sigframe_v2, uc);
1393 copy_siginfo_to_user(&frame->info, info);
1394
1395 setup_sigframe_v2(&frame->uc, set, env);
1396
1397 setup_return(env, ka, &frame->retcode, frame_addr, usig,
1398 frame_addr + offsetof(struct rt_sigframe_v2, retcode));
1399
1400 env->regs[1] = info_addr;
1401 env->regs[2] = uc_addr;
1402
1403 unlock_user_struct(frame, frame_addr, 1);
1404 }
1405
1406 static void setup_rt_frame(int usig, struct target_sigaction *ka,
1407 target_siginfo_t *info,
1408 target_sigset_t *set, CPUState *env)
1409 {
1410 if (get_osversion() >= 0x020612) {
1411 setup_rt_frame_v2(usig, ka, info, set, env);
1412 } else {
1413 setup_rt_frame_v1(usig, ka, info, set, env);
1414 }
1415 }
1416
1417 static int
1418 restore_sigcontext(CPUState *env, struct target_sigcontext *sc)
1419 {
1420 int err = 0;
1421 uint32_t cpsr;
1422
1423 __get_user_error(env->regs[0], &sc->arm_r0, err);
1424 __get_user_error(env->regs[1], &sc->arm_r1, err);
1425 __get_user_error(env->regs[2], &sc->arm_r2, err);
1426 __get_user_error(env->regs[3], &sc->arm_r3, err);
1427 __get_user_error(env->regs[4], &sc->arm_r4, err);
1428 __get_user_error(env->regs[5], &sc->arm_r5, err);
1429 __get_user_error(env->regs[6], &sc->arm_r6, err);
1430 __get_user_error(env->regs[7], &sc->arm_r7, err);
1431 __get_user_error(env->regs[8], &sc->arm_r8, err);
1432 __get_user_error(env->regs[9], &sc->arm_r9, err);
1433 __get_user_error(env->regs[10], &sc->arm_r10, err);
1434 __get_user_error(env->regs[11], &sc->arm_fp, err);
1435 __get_user_error(env->regs[12], &sc->arm_ip, err);
1436 __get_user_error(env->regs[13], &sc->arm_sp, err);
1437 __get_user_error(env->regs[14], &sc->arm_lr, err);
1438 __get_user_error(env->regs[15], &sc->arm_pc, err);
1439 #ifdef TARGET_CONFIG_CPU_32
1440 __get_user_error(cpsr, &sc->arm_cpsr, err);
1441 cpsr_write(env, cpsr, CPSR_USER | CPSR_EXEC);
1442 #endif
1443
1444 err |= !valid_user_regs(env);
1445
1446 return err;
1447 }
1448
1449 static long do_sigreturn_v1(CPUState *env)
1450 {
1451 abi_ulong frame_addr;
1452 struct sigframe_v1 *frame;
1453 target_sigset_t set;
1454 sigset_t host_set;
1455 int i;
1456
1457 /*
1458 * Since we stacked the signal on a 64-bit boundary,
1459 * then 'sp' should be word aligned here. If it's
1460 * not, then the user is trying to mess with us.
1461 */
1462 if (env->regs[13] & 7)
1463 goto badframe;
1464
1465 frame_addr = env->regs[13];
1466 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1467 goto badframe;
1468
1469 if (__get_user(set.sig[0], &frame->sc.oldmask))
1470 goto badframe;
1471 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1472 if (__get_user(set.sig[i], &frame->extramask[i - 1]))
1473 goto badframe;
1474 }
1475
1476 target_to_host_sigset_internal(&host_set, &set);
1477 sigprocmask(SIG_SETMASK, &host_set, NULL);
1478
1479 if (restore_sigcontext(env, &frame->sc))
1480 goto badframe;
1481
1482 #if 0
1483 /* Send SIGTRAP if we're single-stepping */
1484 if (ptrace_cancel_bpt(current))
1485 send_sig(SIGTRAP, current, 1);
1486 #endif
1487 unlock_user_struct(frame, frame_addr, 0);
1488 return env->regs[0];
1489
1490 badframe:
1491 unlock_user_struct(frame, frame_addr, 0);
1492 force_sig(SIGSEGV /* , current */);
1493 return 0;
1494 }
1495
1496 static int do_sigframe_return_v2(CPUState *env, target_ulong frame_addr,
1497 struct target_ucontext_v2 *uc)
1498 {
1499 sigset_t host_set;
1500
1501 target_to_host_sigset(&host_set, &uc->tuc_sigmask);
1502 sigprocmask(SIG_SETMASK, &host_set, NULL);
1503
1504 if (restore_sigcontext(env, &uc->tuc_mcontext))
1505 return 1;
1506
1507 if (do_sigaltstack(frame_addr + offsetof(struct target_ucontext_v2, tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
1508 return 1;
1509
1510 #if 0
1511 /* Send SIGTRAP if we're single-stepping */
1512 if (ptrace_cancel_bpt(current))
1513 send_sig(SIGTRAP, current, 1);
1514 #endif
1515
1516 return 0;
1517 }
1518
1519 static long do_sigreturn_v2(CPUState *env)
1520 {
1521 abi_ulong frame_addr;
1522 struct sigframe_v2 *frame;
1523
1524 /*
1525 * Since we stacked the signal on a 64-bit boundary,
1526 * then 'sp' should be word aligned here. If it's
1527 * not, then the user is trying to mess with us.
1528 */
1529 if (env->regs[13] & 7)
1530 goto badframe;
1531
1532 frame_addr = env->regs[13];
1533 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1534 goto badframe;
1535
1536 if (do_sigframe_return_v2(env, frame_addr, &frame->uc))
1537 goto badframe;
1538
1539 unlock_user_struct(frame, frame_addr, 0);
1540 return env->regs[0];
1541
1542 badframe:
1543 unlock_user_struct(frame, frame_addr, 0);
1544 force_sig(SIGSEGV /* , current */);
1545 return 0;
1546 }
1547
1548 long do_sigreturn(CPUState *env)
1549 {
1550 if (get_osversion() >= 0x020612) {
1551 return do_sigreturn_v2(env);
1552 } else {
1553 return do_sigreturn_v1(env);
1554 }
1555 }
1556
1557 static long do_rt_sigreturn_v1(CPUState *env)
1558 {
1559 abi_ulong frame_addr;
1560 struct rt_sigframe_v1 *frame;
1561 sigset_t host_set;
1562
1563 /*
1564 * Since we stacked the signal on a 64-bit boundary,
1565 * then 'sp' should be word aligned here. If it's
1566 * not, then the user is trying to mess with us.
1567 */
1568 if (env->regs[13] & 7)
1569 goto badframe;
1570
1571 frame_addr = env->regs[13];
1572 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1573 goto badframe;
1574
1575 target_to_host_sigset(&host_set, &frame->uc.tuc_sigmask);
1576 sigprocmask(SIG_SETMASK, &host_set, NULL);
1577
1578 if (restore_sigcontext(env, &frame->uc.tuc_mcontext))
1579 goto badframe;
1580
1581 if (do_sigaltstack(frame_addr + offsetof(struct rt_sigframe_v1, uc.tuc_stack), 0, get_sp_from_cpustate(env)) == -EFAULT)
1582 goto badframe;
1583
1584 #if 0
1585 /* Send SIGTRAP if we're single-stepping */
1586 if (ptrace_cancel_bpt(current))
1587 send_sig(SIGTRAP, current, 1);
1588 #endif
1589 unlock_user_struct(frame, frame_addr, 0);
1590 return env->regs[0];
1591
1592 badframe:
1593 unlock_user_struct(frame, frame_addr, 0);
1594 force_sig(SIGSEGV /* , current */);
1595 return 0;
1596 }
1597
1598 static long do_rt_sigreturn_v2(CPUState *env)
1599 {
1600 abi_ulong frame_addr;
1601 struct rt_sigframe_v2 *frame;
1602
1603 /*
1604 * Since we stacked the signal on a 64-bit boundary,
1605 * then 'sp' should be word aligned here. If it's
1606 * not, then the user is trying to mess with us.
1607 */
1608 if (env->regs[13] & 7)
1609 goto badframe;
1610
1611 frame_addr = env->regs[13];
1612 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
1613 goto badframe;
1614
1615 if (do_sigframe_return_v2(env, frame_addr, &frame->uc))
1616 goto badframe;
1617
1618 unlock_user_struct(frame, frame_addr, 0);
1619 return env->regs[0];
1620
1621 badframe:
1622 unlock_user_struct(frame, frame_addr, 0);
1623 force_sig(SIGSEGV /* , current */);
1624 return 0;
1625 }
1626
1627 long do_rt_sigreturn(CPUState *env)
1628 {
1629 if (get_osversion() >= 0x020612) {
1630 return do_rt_sigreturn_v2(env);
1631 } else {
1632 return do_rt_sigreturn_v1(env);
1633 }
1634 }
1635
1636 #elif defined(TARGET_SPARC)
1637
1638 #define __SUNOS_MAXWIN 31
1639
1640 /* This is what SunOS does, so shall I. */
1641 struct target_sigcontext {
1642 abi_ulong sigc_onstack; /* state to restore */
1643
1644 abi_ulong sigc_mask; /* sigmask to restore */
1645 abi_ulong sigc_sp; /* stack pointer */
1646 abi_ulong sigc_pc; /* program counter */
1647 abi_ulong sigc_npc; /* next program counter */
1648 abi_ulong sigc_psr; /* for condition codes etc */
1649 abi_ulong sigc_g1; /* User uses these two registers */
1650 abi_ulong sigc_o0; /* within the trampoline code. */
1651
1652 /* Now comes information regarding the users window set
1653 * at the time of the signal.
1654 */
1655 abi_ulong sigc_oswins; /* outstanding windows */
1656
1657 /* stack ptrs for each regwin buf */
1658 char *sigc_spbuf[__SUNOS_MAXWIN];
1659
1660 /* Windows to restore after signal */
1661 struct {
1662 abi_ulong locals[8];
1663 abi_ulong ins[8];
1664 } sigc_wbuf[__SUNOS_MAXWIN];
1665 };
1666 /* A Sparc stack frame */
1667 struct sparc_stackf {
1668 abi_ulong locals[8];
1669 abi_ulong ins[6];
1670 struct sparc_stackf *fp;
1671 abi_ulong callers_pc;
1672 char *structptr;
1673 abi_ulong xargs[6];
1674 abi_ulong xxargs[1];
1675 };
1676
1677 typedef struct {
1678 struct {
1679 abi_ulong psr;
1680 abi_ulong pc;
1681 abi_ulong npc;
1682 abi_ulong y;
1683 abi_ulong u_regs[16]; /* globals and ins */
1684 } si_regs;
1685 int si_mask;
1686 } __siginfo_t;
1687
1688 typedef struct {
1689 unsigned long si_float_regs [32];
1690 unsigned long si_fsr;
1691 unsigned long si_fpqdepth;
1692 struct {
1693 unsigned long *insn_addr;
1694 unsigned long insn;
1695 } si_fpqueue [16];
1696 } qemu_siginfo_fpu_t;
1697
1698
1699 struct target_signal_frame {
1700 struct sparc_stackf ss;
1701 __siginfo_t info;
1702 abi_ulong fpu_save;
1703 abi_ulong insns[2] __attribute__ ((aligned (8)));
1704 abi_ulong extramask[TARGET_NSIG_WORDS - 1];
1705 abi_ulong extra_size; /* Should be 0 */
1706 qemu_siginfo_fpu_t fpu_state;
1707 };
1708 struct target_rt_signal_frame {
1709 struct sparc_stackf ss;
1710 siginfo_t info;
1711 abi_ulong regs[20];
1712 sigset_t mask;
1713 abi_ulong fpu_save;
1714 unsigned int insns[2];
1715 stack_t stack;
1716 unsigned int extra_size; /* Should be 0 */
1717 qemu_siginfo_fpu_t fpu_state;
1718 };
1719
1720 #define UREG_O0 16
1721 #define UREG_O6 22
1722 #define UREG_I0 0
1723 #define UREG_I1 1
1724 #define UREG_I2 2
1725 #define UREG_I3 3
1726 #define UREG_I4 4
1727 #define UREG_I5 5
1728 #define UREG_I6 6
1729 #define UREG_I7 7
1730 #define UREG_L0 8
1731 #define UREG_FP UREG_I6
1732 #define UREG_SP UREG_O6
1733
1734 static inline abi_ulong get_sigframe(struct target_sigaction *sa,
1735 CPUState *env, unsigned long framesize)
1736 {
1737 abi_ulong sp;
1738
1739 sp = env->regwptr[UREG_FP];
1740
1741 /* This is the X/Open sanctioned signal stack switching. */
1742 if (sa->sa_flags & TARGET_SA_ONSTACK) {
1743 if (!on_sig_stack(sp)
1744 && !((target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size) & 7))
1745 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
1746 }
1747 return sp - framesize;
1748 }
1749
1750 static int
1751 setup___siginfo(__siginfo_t *si, CPUState *env, abi_ulong mask)
1752 {
1753 int err = 0, i;
1754
1755 err |= __put_user(env->psr, &si->si_regs.psr);
1756 err |= __put_user(env->pc, &si->si_regs.pc);
1757 err |= __put_user(env->npc, &si->si_regs.npc);
1758 err |= __put_user(env->y, &si->si_regs.y);
1759 for (i=0; i < 8; i++) {
1760 err |= __put_user(env->gregs[i], &si->si_regs.u_regs[i]);
1761 }
1762 for (i=0; i < 8; i++) {
1763 err |= __put_user(env->regwptr[UREG_I0 + i], &si->si_regs.u_regs[i+8]);
1764 }
1765 err |= __put_user(mask, &si->si_mask);
1766 return err;
1767 }
1768
1769 #if 0
1770 static int
1771 setup_sigcontext(struct target_sigcontext *sc, /*struct _fpstate *fpstate,*/
1772 CPUState *env, unsigned long mask)
1773 {
1774 int err = 0;
1775
1776 err |= __put_user(mask, &sc->sigc_mask);
1777 err |= __put_user(env->regwptr[UREG_SP], &sc->sigc_sp);
1778 err |= __put_user(env->pc, &sc->sigc_pc);
1779 err |= __put_user(env->npc, &sc->sigc_npc);
1780 err |= __put_user(env->psr, &sc->sigc_psr);
1781 err |= __put_user(env->gregs[1], &sc->sigc_g1);
1782 err |= __put_user(env->regwptr[UREG_O0], &sc->sigc_o0);
1783
1784 return err;
1785 }
1786 #endif
1787 #define NF_ALIGNEDSZ (((sizeof(struct target_signal_frame) + 7) & (~7)))
1788
1789 static void setup_frame(int sig, struct target_sigaction *ka,
1790 target_sigset_t *set, CPUState *env)
1791 {
1792 abi_ulong sf_addr;
1793 struct target_signal_frame *sf;
1794 int sigframe_size, err, i;
1795
1796 /* 1. Make sure everything is clean */
1797 //synchronize_user_stack();
1798
1799 sigframe_size = NF_ALIGNEDSZ;
1800 sf_addr = get_sigframe(ka, env, sigframe_size);
1801
1802 sf = lock_user(VERIFY_WRITE, sf_addr,
1803 sizeof(struct target_signal_frame), 0);
1804 if (!sf)
1805 goto sigsegv;
1806
1807 //fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
1808 #if 0
1809 if (invalid_frame_pointer(sf, sigframe_size))
1810 goto sigill_and_return;
1811 #endif
1812 /* 2. Save the current process state */
1813 err = setup___siginfo(&sf->info, env, set->sig[0]);
1814 err |= __put_user(0, &sf->extra_size);
1815
1816 //err |= save_fpu_state(regs, &sf->fpu_state);
1817 //err |= __put_user(&sf->fpu_state, &sf->fpu_save);
1818
1819 err |= __put_user(set->sig[0], &sf->info.si_mask);
1820 for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
1821 err |= __put_user(set->sig[i + 1], &sf->extramask[i]);
1822 }
1823
1824 for (i = 0; i < 8; i++) {
1825 err |= __put_user(env->regwptr[i + UREG_L0], &sf->ss.locals[i]);
1826 }
1827 for (i = 0; i < 8; i++) {
1828 err |= __put_user(env->regwptr[i + UREG_I0], &sf->ss.ins[i]);
1829 }
1830 if (err)
1831 goto sigsegv;
1832
1833 /* 3. signal handler back-trampoline and parameters */
1834 env->regwptr[UREG_FP] = sf_addr;
1835 env->regwptr[UREG_I0] = sig;
1836 env->regwptr[UREG_I1] = sf_addr +
1837 offsetof(struct target_signal_frame, info);
1838 env->regwptr[UREG_I2] = sf_addr +
1839 offsetof(struct target_signal_frame, info);
1840
1841 /* 4. signal handler */
1842 env->pc = ka->_sa_handler;
1843 env->npc = (env->pc + 4);
1844 /* 5. return to kernel instructions */
1845 if (ka->sa_restorer)
1846 env->regwptr[UREG_I7] = ka->sa_restorer;
1847 else {
1848 uint32_t val32;
1849
1850 env->regwptr[UREG_I7] = sf_addr +
1851 offsetof(struct target_signal_frame, insns) - 2 * 4;
1852
1853 /* mov __NR_sigreturn, %g1 */
1854 val32 = 0x821020d8;
1855 err |= __put_user(val32, &sf->insns[0]);
1856
1857 /* t 0x10 */
1858 val32 = 0x91d02010;
1859 err |= __put_user(val32, &sf->insns[1]);
1860 if (err)
1861 goto sigsegv;
1862
1863 /* Flush instruction space. */
1864 //flush_sig_insns(current->mm, (unsigned long) &(sf->insns[0]));
1865 // tb_flush(env);
1866 }
1867 unlock_user(sf, sf_addr, sizeof(struct target_signal_frame));
1868 return;
1869 #if 0
1870 sigill_and_return:
1871 force_sig(TARGET_SIGILL);
1872 #endif
1873 sigsegv:
1874 //fprintf(stderr, "force_sig\n");
1875 unlock_user(sf, sf_addr, sizeof(struct target_signal_frame));
1876 force_sig(TARGET_SIGSEGV);
1877 }
1878 static inline int
1879 restore_fpu_state(CPUState *env, qemu_siginfo_fpu_t *fpu)
1880 {
1881 int err;
1882 #if 0
1883 #ifdef CONFIG_SMP
1884 if (current->flags & PF_USEDFPU)
1885 regs->psr &= ~PSR_EF;
1886 #else
1887 if (current == last_task_used_math) {
1888 last_task_used_math = 0;
1889 regs->psr &= ~PSR_EF;
1890 }
1891 #endif
1892 current->used_math = 1;
1893 current->flags &= ~PF_USEDFPU;
1894 #endif
1895 #if 0
1896 if (verify_area (VERIFY_READ, fpu, sizeof(*fpu)))
1897 return -EFAULT;
1898 #endif
1899
1900 #if 0
1901 /* XXX: incorrect */
1902 err = __copy_from_user(&env->fpr[0], &fpu->si_float_regs[0],
1903 (sizeof(unsigned long) * 32));
1904 #endif
1905 err |= __get_user(env->fsr, &fpu->si_fsr);
1906 #if 0
1907 err |= __get_user(current->thread.fpqdepth, &fpu->si_fpqdepth);
1908 if (current->thread.fpqdepth != 0)
1909 err |= __copy_from_user(&current->thread.fpqueue[0],
1910 &fpu->si_fpqueue[0],
1911 ((sizeof(unsigned long) +
1912 (sizeof(unsigned long *)))*16));
1913 #endif
1914 return err;
1915 }
1916
1917
1918 static void setup_rt_frame(int sig, struct target_sigaction *ka,
1919 target_siginfo_t *info,
1920 target_sigset_t *set, CPUState *env)
1921 {
1922 fprintf(stderr, "setup_rt_frame: not implemented\n");
1923 }
1924
1925 long do_sigreturn(CPUState *env)
1926 {
1927 abi_ulong sf_addr;
1928 struct target_signal_frame *sf;
1929 uint32_t up_psr, pc, npc;
1930 target_sigset_t set;
1931 sigset_t host_set;
1932 abi_ulong fpu_save_addr;
1933 int err, i;
1934
1935 sf_addr = env->regwptr[UREG_FP];
1936 if (!lock_user_struct(VERIFY_READ, sf, sf_addr, 1))
1937 goto segv_and_exit;
1938 #if 0
1939 fprintf(stderr, "sigreturn\n");
1940 fprintf(stderr, "sf: %x pc %x fp %x sp %x\n", sf, env->pc, env->regwptr[UREG_FP], env->regwptr[UREG_SP]);
1941 #endif
1942 //cpu_dump_state(env, stderr, fprintf, 0);
1943
1944 /* 1. Make sure we are not getting garbage from the user */
1945
1946 if (sf_addr & 3)
1947 goto segv_and_exit;
1948
1949 err = __get_user(pc, &sf->info.si_regs.pc);
1950 err |= __get_user(npc, &sf->info.si_regs.npc);
1951
1952 if ((pc | npc) & 3)
1953 goto segv_and_exit;
1954
1955 /* 2. Restore the state */
1956 err |= __get_user(up_psr, &sf->info.si_regs.psr);
1957
1958 /* User can only change condition codes and FPU enabling in %psr. */
1959 env->psr = (up_psr & (PSR_ICC /* | PSR_EF */))
1960 | (env->psr & ~(PSR_ICC /* | PSR_EF */));
1961
1962 env->pc = pc;
1963 env->npc = npc;
1964 err |= __get_user(env->y, &sf->info.si_regs.y);
1965 for (i=0; i < 8; i++) {
1966 err |= __get_user(env->gregs[i], &sf->info.si_regs.u_regs[i]);
1967 }
1968 for (i=0; i < 8; i++) {
1969 err |= __get_user(env->regwptr[i + UREG_I0], &sf->info.si_regs.u_regs[i+8]);
1970 }
1971
1972 err |= __get_user(fpu_save_addr, &sf->fpu_save);
1973
1974 //if (fpu_save)
1975 // err |= restore_fpu_state(env, fpu_save);
1976
1977 /* This is pretty much atomic, no amount locking would prevent
1978 * the races which exist anyways.
1979 */
1980 err |= __get_user(set.sig[0], &sf->info.si_mask);
1981 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
1982 err |= (__get_user(set.sig[i], &sf->extramask[i - 1]));
1983 }
1984
1985 target_to_host_sigset_internal(&host_set, &set);
1986 sigprocmask(SIG_SETMASK, &host_set, NULL);
1987
1988 if (err)
1989 goto segv_and_exit;
1990 unlock_user_struct(sf, sf_addr, 0);
1991 return env->regwptr[0];
1992
1993 segv_and_exit:
1994 unlock_user_struct(sf, sf_addr, 0);
1995 force_sig(TARGET_SIGSEGV);
1996 }
1997
1998 long do_rt_sigreturn(CPUState *env)
1999 {
2000 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2001 return -TARGET_ENOSYS;
2002 }
2003
2004 #if defined(TARGET_SPARC64) && !defined(TARGET_ABI32)
2005 #define MC_TSTATE 0
2006 #define MC_PC 1
2007 #define MC_NPC 2
2008 #define MC_Y 3
2009 #define MC_G1 4
2010 #define MC_G2 5
2011 #define MC_G3 6
2012 #define MC_G4 7
2013 #define MC_G5 8
2014 #define MC_G6 9
2015 #define MC_G7 10
2016 #define MC_O0 11
2017 #define MC_O1 12
2018 #define MC_O2 13
2019 #define MC_O3 14
2020 #define MC_O4 15
2021 #define MC_O5 16
2022 #define MC_O6 17
2023 #define MC_O7 18
2024 #define MC_NGREG 19
2025
2026 typedef abi_ulong target_mc_greg_t;
2027 typedef target_mc_greg_t target_mc_gregset_t[MC_NGREG];
2028
2029 struct target_mc_fq {
2030 abi_ulong *mcfq_addr;
2031 uint32_t mcfq_insn;
2032 };
2033
2034 struct target_mc_fpu {
2035 union {
2036 uint32_t sregs[32];
2037 uint64_t dregs[32];
2038 //uint128_t qregs[16];
2039 } mcfpu_fregs;
2040 abi_ulong mcfpu_fsr;
2041 abi_ulong mcfpu_fprs;
2042 abi_ulong mcfpu_gsr;
2043 struct target_mc_fq *mcfpu_fq;
2044 unsigned char mcfpu_qcnt;
2045 unsigned char mcfpu_qentsz;
2046 unsigned char mcfpu_enab;
2047 };
2048 typedef struct target_mc_fpu target_mc_fpu_t;
2049
2050 typedef struct {
2051 target_mc_gregset_t mc_gregs;
2052 target_mc_greg_t mc_fp;
2053 target_mc_greg_t mc_i7;
2054 target_mc_fpu_t mc_fpregs;
2055 } target_mcontext_t;
2056
2057 struct target_ucontext {
2058 struct target_ucontext *uc_link;
2059 abi_ulong uc_flags;
2060 target_sigset_t uc_sigmask;
2061 target_mcontext_t uc_mcontext;
2062 };
2063
2064 /* A V9 register window */
2065 struct target_reg_window {
2066 abi_ulong locals[8];
2067 abi_ulong ins[8];
2068 };
2069
2070 #define TARGET_STACK_BIAS 2047
2071
2072 /* {set, get}context() needed for 64-bit SparcLinux userland. */
2073 void sparc64_set_context(CPUSPARCState *env)
2074 {
2075 abi_ulong ucp_addr;
2076 struct target_ucontext *ucp;
2077 target_mc_gregset_t *grp;
2078 abi_ulong pc, npc, tstate;
2079 abi_ulong fp, i7, w_addr;
2080 unsigned char fenab;
2081 int err;
2082 unsigned int i;
2083
2084 ucp_addr = env->regwptr[UREG_I0];
2085 if (!lock_user_struct(VERIFY_READ, ucp, ucp_addr, 1))
2086 goto do_sigsegv;
2087 grp = &ucp->uc_mcontext.mc_gregs;
2088 err = __get_user(pc, &((*grp)[MC_PC]));
2089 err |= __get_user(npc, &((*grp)[MC_NPC]));
2090 if (err || ((pc | npc) & 3))
2091 goto do_sigsegv;
2092 if (env->regwptr[UREG_I1]) {
2093 target_sigset_t target_set;
2094 sigset_t set;
2095
2096 if (TARGET_NSIG_WORDS == 1) {
2097 if (__get_user(target_set.sig[0], &ucp->uc_sigmask.sig[0]))
2098 goto do_sigsegv;
2099 } else {
2100 abi_ulong *src, *dst;
2101 src = ucp->uc_sigmask.sig;
2102 dst = target_set.sig;
2103 for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
2104 i++, dst++, src++)
2105 err |= __get_user(*dst, src);
2106 if (err)
2107 goto do_sigsegv;
2108 }
2109 target_to_host_sigset_internal(&set, &target_set);
2110 sigprocmask(SIG_SETMASK, &set, NULL);
2111 }
2112 env->pc = pc;
2113 env->npc = npc;
2114 err |= __get_user(env->y, &((*grp)[MC_Y]));
2115 err |= __get_user(tstate, &((*grp)[MC_TSTATE]));
2116 env->asi = (tstate >> 24) & 0xff;
2117 PUT_CCR(env, tstate >> 32);
2118 PUT_CWP64(env, tstate & 0x1f);
2119 err |= __get_user(env->gregs[1], (&(*grp)[MC_G1]));
2120 err |= __get_user(env->gregs[2], (&(*grp)[MC_G2]));
2121 err |= __get_user(env->gregs[3], (&(*grp)[MC_G3]));
2122 err |= __get_user(env->gregs[4], (&(*grp)[MC_G4]));
2123 err |= __get_user(env->gregs[5], (&(*grp)[MC_G5]));
2124 err |= __get_user(env->gregs[6], (&(*grp)[MC_G6]));
2125 err |= __get_user(env->gregs[7], (&(*grp)[MC_G7]));
2126 err |= __get_user(env->regwptr[UREG_I0], (&(*grp)[MC_O0]));
2127 err |= __get_user(env->regwptr[UREG_I1], (&(*grp)[MC_O1]));
2128 err |= __get_user(env->regwptr[UREG_I2], (&(*grp)[MC_O2]));
2129 err |= __get_user(env->regwptr[UREG_I3], (&(*grp)[MC_O3]));
2130 err |= __get_user(env->regwptr[UREG_I4], (&(*grp)[MC_O4]));
2131 err |= __get_user(env->regwptr[UREG_I5], (&(*grp)[MC_O5]));
2132 err |= __get_user(env->regwptr[UREG_I6], (&(*grp)[MC_O6]));
2133 err |= __get_user(env->regwptr[UREG_I7], (&(*grp)[MC_O7]));
2134
2135 err |= __get_user(fp, &(ucp->uc_mcontext.mc_fp));
2136 err |= __get_user(i7, &(ucp->uc_mcontext.mc_i7));
2137
2138 w_addr = TARGET_STACK_BIAS+env->regwptr[UREG_I6];
2139 if (put_user(fp, w_addr + offsetof(struct target_reg_window, ins[6]),
2140 abi_ulong) != 0)
2141 goto do_sigsegv;
2142 if (put_user(i7, w_addr + offsetof(struct target_reg_window, ins[7]),
2143 abi_ulong) != 0)
2144 goto do_sigsegv;
2145 err |= __get_user(fenab, &(ucp->uc_mcontext.mc_fpregs.mcfpu_enab));
2146 err |= __get_user(env->fprs, &(ucp->uc_mcontext.mc_fpregs.mcfpu_fprs));
2147 {
2148 uint32_t *src, *dst;
2149 src = ucp->uc_mcontext.mc_fpregs.mcfpu_fregs.sregs;
2150 dst = env->fpr;
2151 /* XXX: check that the CPU storage is the same as user context */
2152 for (i = 0; i < 64; i++, dst++, src++)
2153 err |= __get_user(*dst, src);
2154 }
2155 err |= __get_user(env->fsr,
2156 &(ucp->uc_mcontext.mc_fpregs.mcfpu_fsr));
2157 err |= __get_user(env->gsr,
2158 &(ucp->uc_mcontext.mc_fpregs.mcfpu_gsr));
2159 if (err)
2160 goto do_sigsegv;
2161 unlock_user_struct(ucp, ucp_addr, 0);
2162 return;
2163 do_sigsegv:
2164 unlock_user_struct(ucp, ucp_addr, 0);
2165 force_sig(SIGSEGV);
2166 }
2167
2168 void sparc64_get_context(CPUSPARCState *env)
2169 {
2170 abi_ulong ucp_addr;
2171 struct target_ucontext *ucp;
2172 target_mc_gregset_t *grp;
2173 target_mcontext_t *mcp;
2174 abi_ulong fp, i7, w_addr;
2175 int err;
2176 unsigned int i;
2177 target_sigset_t target_set;
2178 sigset_t set;
2179
2180 ucp_addr = env->regwptr[UREG_I0];
2181 if (!lock_user_struct(VERIFY_WRITE, ucp, ucp_addr, 0))
2182 goto do_sigsegv;
2183
2184 mcp = &ucp->uc_mcontext;
2185 grp = &mcp->mc_gregs;
2186
2187 /* Skip over the trap instruction, first. */
2188 env->pc = env->npc;
2189 env->npc += 4;
2190
2191 err = 0;
2192
2193 sigprocmask(0, NULL, &set);
2194 host_to_target_sigset_internal(&target_set, &set);
2195 if (TARGET_NSIG_WORDS == 1) {
2196 err |= __put_user(target_set.sig[0],
2197 (abi_ulong *)&ucp->uc_sigmask);
2198 } else {
2199 abi_ulong *src, *dst;
2200 src = target_set.sig;
2201 dst = ucp->uc_sigmask.sig;
2202 for (i = 0; i < sizeof(target_sigset_t) / sizeof(abi_ulong);
2203 i++, dst++, src++)
2204 err |= __put_user(*src, dst);
2205 if (err)
2206 goto do_sigsegv;
2207 }
2208
2209 /* XXX: tstate must be saved properly */
2210 // err |= __put_user(env->tstate, &((*grp)[MC_TSTATE]));
2211 err |= __put_user(env->pc, &((*grp)[MC_PC]));
2212 err |= __put_user(env->npc, &((*grp)[MC_NPC]));
2213 err |= __put_user(env->y, &((*grp)[MC_Y]));
2214 err |= __put_user(env->gregs[1], &((*grp)[MC_G1]));
2215 err |= __put_user(env->gregs[2], &((*grp)[MC_G2]));
2216 err |= __put_user(env->gregs[3], &((*grp)[MC_G3]));
2217 err |= __put_user(env->gregs[4], &((*grp)[MC_G4]));
2218 err |= __put_user(env->gregs[5], &((*grp)[MC_G5]));
2219 err |= __put_user(env->gregs[6], &((*grp)[MC_G6]));
2220 err |= __put_user(env->gregs[7], &((*grp)[MC_G7]));
2221 err |= __put_user(env->regwptr[UREG_I0], &((*grp)[MC_O0]));
2222 err |= __put_user(env->regwptr[UREG_I1], &((*grp)[MC_O1]));
2223 err |= __put_user(env->regwptr[UREG_I2], &((*grp)[MC_O2]));
2224 err |= __put_user(env->regwptr[UREG_I3], &((*grp)[MC_O3]));
2225 err |= __put_user(env->regwptr[UREG_I4], &((*grp)[MC_O4]));
2226 err |= __put_user(env->regwptr[UREG_I5], &((*grp)[MC_O5]));
2227 err |= __put_user(env->regwptr[UREG_I6], &((*grp)[MC_O6]));
2228 err |= __put_user(env->regwptr[UREG_I7], &((*grp)[MC_O7]));
2229
2230 w_addr = TARGET_STACK_BIAS+env->regwptr[UREG_I6];
2231 fp = i7 = 0;
2232 if (get_user(fp, w_addr + offsetof(struct target_reg_window, ins[6]),
2233 abi_ulong) != 0)
2234 goto do_sigsegv;
2235 if (get_user(i7, w_addr + offsetof(struct target_reg_window, ins[7]),
2236 abi_ulong) != 0)
2237 goto do_sigsegv;
2238 err |= __put_user(fp, &(mcp->mc_fp));
2239 err |= __put_user(i7, &(mcp->mc_i7));
2240
2241 {
2242 uint32_t *src, *dst;
2243 src = env->fpr;
2244 dst = ucp->uc_mcontext.mc_fpregs.mcfpu_fregs.sregs;
2245 /* XXX: check that the CPU storage is the same as user context */
2246 for (i = 0; i < 64; i++, dst++, src++)
2247 err |= __put_user(*src, dst);
2248 }
2249 err |= __put_user(env->fsr, &(mcp->mc_fpregs.mcfpu_fsr));
2250 err |= __put_user(env->gsr, &(mcp->mc_fpregs.mcfpu_gsr));
2251 err |= __put_user(env->fprs, &(mcp->mc_fpregs.mcfpu_fprs));
2252
2253 if (err)
2254 goto do_sigsegv;
2255 unlock_user_struct(ucp, ucp_addr, 1);
2256 return;
2257 do_sigsegv:
2258 unlock_user_struct(ucp, ucp_addr, 1);
2259 force_sig(SIGSEGV);
2260 }
2261 #endif
2262 #elif defined(TARGET_ABI_MIPSN64)
2263
2264 # warning signal handling not implemented
2265
2266 static void setup_frame(int sig, struct target_sigaction *ka,
2267 target_sigset_t *set, CPUState *env)
2268 {
2269 fprintf(stderr, "setup_frame: not implemented\n");
2270 }
2271
2272 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2273 target_siginfo_t *info,
2274 target_sigset_t *set, CPUState *env)
2275 {
2276 fprintf(stderr, "setup_rt_frame: not implemented\n");
2277 }
2278
2279 long do_sigreturn(CPUState *env)
2280 {
2281 fprintf(stderr, "do_sigreturn: not implemented\n");
2282 return -TARGET_ENOSYS;
2283 }
2284
2285 long do_rt_sigreturn(CPUState *env)
2286 {
2287 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2288 return -TARGET_ENOSYS;
2289 }
2290
2291 #elif defined(TARGET_ABI_MIPSN32)
2292
2293 # warning signal handling not implemented
2294
2295 static void setup_frame(int sig, struct target_sigaction *ka,
2296 target_sigset_t *set, CPUState *env)
2297 {
2298 fprintf(stderr, "setup_frame: not implemented\n");
2299 }
2300
2301 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2302 target_siginfo_t *info,
2303 target_sigset_t *set, CPUState *env)
2304 {
2305 fprintf(stderr, "setup_rt_frame: not implemented\n");
2306 }
2307
2308 long do_sigreturn(CPUState *env)
2309 {
2310 fprintf(stderr, "do_sigreturn: not implemented\n");
2311 return -TARGET_ENOSYS;
2312 }
2313
2314 long do_rt_sigreturn(CPUState *env)
2315 {
2316 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
2317 return -TARGET_ENOSYS;
2318 }
2319
2320 #elif defined(TARGET_ABI_MIPSO32)
2321
2322 struct target_sigcontext {
2323 uint32_t sc_regmask; /* Unused */
2324 uint32_t sc_status;
2325 uint64_t sc_pc;
2326 uint64_t sc_regs[32];
2327 uint64_t sc_fpregs[32];
2328 uint32_t sc_ownedfp; /* Unused */
2329 uint32_t sc_fpc_csr;
2330 uint32_t sc_fpc_eir; /* Unused */
2331 uint32_t sc_used_math;
2332 uint32_t sc_dsp; /* dsp status, was sc_ssflags */
2333 uint64_t sc_mdhi;
2334 uint64_t sc_mdlo;
2335 target_ulong sc_hi1; /* Was sc_cause */
2336 target_ulong sc_lo1; /* Was sc_badvaddr */
2337 target_ulong sc_hi2; /* Was sc_sigset[4] */
2338 target_ulong sc_lo2;
2339 target_ulong sc_hi3;
2340 target_ulong sc_lo3;
2341 };
2342
2343 struct sigframe {
2344 uint32_t sf_ass[4]; /* argument save space for o32 */
2345 uint32_t sf_code[2]; /* signal trampoline */
2346 struct target_sigcontext sf_sc;
2347 target_sigset_t sf_mask;
2348 };
2349
2350 struct target_ucontext {
2351 target_ulong uc_flags;
2352 target_ulong uc_link;
2353 target_stack_t uc_stack;
2354 struct target_sigcontext uc_mcontext;
2355 target_sigset_t uc_sigmask;
2356 };
2357
2358 struct target_rt_sigframe {
2359 uint32_t rs_ass[4]; /* argument save space for o32 */
2360 uint32_t rs_code[2]; /* signal trampoline */
2361 struct target_siginfo rs_info;
2362 struct target_ucontext rs_uc;
2363 };
2364
2365 /* Install trampoline to jump back from signal handler */
2366 static inline int install_sigtramp(unsigned int *tramp, unsigned int syscall)
2367 {
2368 int err;
2369
2370 /*
2371 * Set up the return code ...
2372 *
2373 * li v0, __NR__foo_sigreturn
2374 * syscall
2375 */
2376
2377 err = __put_user(0x24020000 + syscall, tramp + 0);
2378 err |= __put_user(0x0000000c , tramp + 1);
2379 /* flush_cache_sigtramp((unsigned long) tramp); */
2380 return err;
2381 }
2382
2383 static inline int
2384 setup_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2385 {
2386 int err = 0;
2387
2388 err |= __put_user(regs->active_tc.PC, &sc->sc_pc);
2389
2390 #define save_gp_reg(i) do { \
2391 err |= __put_user(regs->active_tc.gpr[i], &sc->sc_regs[i]); \
2392 } while(0)
2393 __put_user(0, &sc->sc_regs[0]); save_gp_reg(1); save_gp_reg(2);
2394 save_gp_reg(3); save_gp_reg(4); save_gp_reg(5); save_gp_reg(6);
2395 save_gp_reg(7); save_gp_reg(8); save_gp_reg(9); save_gp_reg(10);
2396 save_gp_reg(11); save_gp_reg(12); save_gp_reg(13); save_gp_reg(14);
2397 save_gp_reg(15); save_gp_reg(16); save_gp_reg(17); save_gp_reg(18);
2398 save_gp_reg(19); save_gp_reg(20); save_gp_reg(21); save_gp_reg(22);
2399 save_gp_reg(23); save_gp_reg(24); save_gp_reg(25); save_gp_reg(26);
2400 save_gp_reg(27); save_gp_reg(28); save_gp_reg(29); save_gp_reg(30);
2401 save_gp_reg(31);
2402 #undef save_gp_reg
2403
2404 err |= __put_user(regs->active_tc.HI[0], &sc->sc_mdhi);
2405 err |= __put_user(regs->active_tc.LO[0], &sc->sc_mdlo);
2406
2407 /* Not used yet, but might be useful if we ever have DSP suppport */
2408 #if 0
2409 if (cpu_has_dsp) {
2410 err |= __put_user(mfhi1(), &sc->sc_hi1);
2411 err |= __put_user(mflo1(), &sc->sc_lo1);
2412 err |= __put_user(mfhi2(), &sc->sc_hi2);
2413 err |= __put_user(mflo2(), &sc->sc_lo2);
2414 err |= __put_user(mfhi3(), &sc->sc_hi3);
2415 err |= __put_user(mflo3(), &sc->sc_lo3);
2416 err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2417 }
2418 /* same with 64 bit */
2419 #ifdef CONFIG_64BIT
2420 err |= __put_user(regs->hi, &sc->sc_hi[0]);
2421 err |= __put_user(regs->lo, &sc->sc_lo[0]);
2422 if (cpu_has_dsp) {
2423 err |= __put_user(mfhi1(), &sc->sc_hi[1]);
2424 err |= __put_user(mflo1(), &sc->sc_lo[1]);
2425 err |= __put_user(mfhi2(), &sc->sc_hi[2]);
2426 err |= __put_user(mflo2(), &sc->sc_lo[2]);
2427 err |= __put_user(mfhi3(), &sc->sc_hi[3]);
2428 err |= __put_user(mflo3(), &sc->sc_lo[3]);
2429 err |= __put_user(rddsp(DSP_MASK), &sc->sc_dsp);
2430 }
2431 #endif
2432 #endif
2433
2434 #if 0
2435 err |= __put_user(!!used_math(), &sc->sc_used_math);
2436
2437 if (!used_math())
2438 goto out;
2439
2440 /*
2441 * Save FPU state to signal context. Signal handler will "inherit"
2442 * current FPU state.
2443 */
2444 preempt_disable();
2445
2446 if (!is_fpu_owner()) {
2447 own_fpu();
2448 restore_fp(current);
2449 }
2450 err |= save_fp_context(sc);
2451
2452 preempt_enable();
2453 out:
2454 #endif
2455 return err;
2456 }
2457
2458 static inline int
2459 restore_sigcontext(CPUState *regs, struct target_sigcontext *sc)
2460 {
2461 int err = 0;
2462
2463 err |= __get_user(regs->CP0_EPC, &sc->sc_pc);
2464
2465 err |= __get_user(regs->active_tc.HI[0], &sc->sc_mdhi);
2466 err |= __get_user(regs->active_tc.LO[0], &sc->sc_mdlo);
2467
2468 #define restore_gp_reg(i) do { \
2469 err |= __get_user(regs->active_tc.gpr[i], &sc->sc_regs[i]); \
2470 } while(0)
2471 restore_gp_reg( 1); restore_gp_reg( 2); restore_gp_reg( 3);
2472 restore_gp_reg( 4); restore_gp_reg( 5); restore_gp_reg( 6);
2473 restore_gp_reg( 7); restore_gp_reg( 8); restore_gp_reg( 9);
2474 restore_gp_reg(10); restore_gp_reg(11); restore_gp_reg(12);
2475 restore_gp_reg(13); restore_gp_reg(14); restore_gp_reg(15);
2476 restore_gp_reg(16); restore_gp_reg(17); restore_gp_reg(18);
2477 restore_gp_reg(19); restore_gp_reg(20); restore_gp_reg(21);
2478 restore_gp_reg(22); restore_gp_reg(23); restore_gp_reg(24);
2479 restore_gp_reg(25); restore_gp_reg(26); restore_gp_reg(27);
2480 restore_gp_reg(28); restore_gp_reg(29); restore_gp_reg(30);
2481 restore_gp_reg(31);
2482 #undef restore_gp_reg
2483
2484 #if 0
2485 if (cpu_has_dsp) {
2486 err |= __get_user(treg, &sc->sc_hi1); mthi1(treg);
2487 err |= __get_user(treg, &sc->sc_lo1); mtlo1(treg);
2488 err |= __get_user(treg, &sc->sc_hi2); mthi2(treg);
2489 err |= __get_user(treg, &sc->sc_lo2); mtlo2(treg);
2490 err |= __get_user(treg, &sc->sc_hi3); mthi3(treg);
2491 err |= __get_user(treg, &sc->sc_lo3); mtlo3(treg);
2492 err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2493 }
2494 #ifdef CONFIG_64BIT
2495 err |= __get_user(regs->hi, &sc->sc_hi[0]);
2496 err |= __get_user(regs->lo, &sc->sc_lo[0]);
2497 if (cpu_has_dsp) {
2498 err |= __get_user(treg, &sc->sc_hi[1]); mthi1(treg);
2499 err |= __get_user(treg, &sc->sc_lo[1]); mthi1(treg);
2500 err |= __get_user(treg, &sc->sc_hi[2]); mthi2(treg);
2501 err |= __get_user(treg, &sc->sc_lo[2]); mthi2(treg);
2502 err |= __get_user(treg, &sc->sc_hi[3]); mthi3(treg);
2503 err |= __get_user(treg, &sc->sc_lo[3]); mthi3(treg);
2504 err |= __get_user(treg, &sc->sc_dsp); wrdsp(treg, DSP_MASK);
2505 }
2506 #endif
2507
2508 err |= __get_user(used_math, &sc->sc_used_math);
2509 conditional_used_math(used_math);
2510
2511 preempt_disable();
2512
2513 if (used_math()) {
2514 /* restore fpu context if we have used it before */
2515 own_fpu();
2516 err |= restore_fp_context(sc);
2517 } else {
2518 /* signal handler may have used FPU. Give it up. */
2519 lose_fpu();
2520 }
2521
2522 preempt_enable();
2523 #endif
2524 return err;
2525 }
2526 /*
2527 * Determine which stack to use..
2528 */
2529 static inline abi_ulong
2530 get_sigframe(struct target_sigaction *ka, CPUState *regs, size_t frame_size)
2531 {
2532 unsigned long sp;
2533
2534 /* Default to using normal stack */
2535 sp = regs->active_tc.gpr[29];
2536
2537 /*
2538 * FPU emulator may have it's own trampoline active just
2539 * above the user stack, 16-bytes before the next lowest
2540 * 16 byte boundary. Try to avoid trashing it.
2541 */
2542 sp -= 32;
2543
2544 /* This is the X/Open sanctioned signal stack switching. */
2545 if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags (sp) == 0)) {
2546 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
2547 }
2548
2549 return (sp - frame_size) & ~7;
2550 }
2551
2552 /* compare linux/arch/mips/kernel/signal.c:setup_frame() */
2553 static void setup_frame(int sig, struct target_sigaction * ka,
2554 target_sigset_t *set, CPUState *regs)
2555 {
2556 struct sigframe *frame;
2557 abi_ulong frame_addr;
2558 int i;
2559
2560 frame_addr = get_sigframe(ka, regs, sizeof(*frame));
2561 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
2562 goto give_sigsegv;
2563
2564 install_sigtramp(frame->sf_code, TARGET_NR_sigreturn);
2565
2566 if(setup_sigcontext(regs, &frame->sf_sc))
2567 goto give_sigsegv;
2568
2569 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2570 if(__put_user(set->sig[i], &frame->sf_mask.sig[i]))
2571 goto give_sigsegv;
2572 }
2573
2574 /*
2575 * Arguments to signal handler:
2576 *
2577 * a0 = signal number
2578 * a1 = 0 (should be cause)
2579 * a2 = pointer to struct sigcontext
2580 *
2581 * $25 and PC point to the signal handler, $29 points to the
2582 * struct sigframe.
2583 */
2584 regs->active_tc.gpr[ 4] = sig;
2585 regs->active_tc.gpr[ 5] = 0;
2586 regs->active_tc.gpr[ 6] = frame_addr + offsetof(struct sigframe, sf_sc);
2587 regs->active_tc.gpr[29] = frame_addr;
2588 regs->active_tc.gpr[31] = frame_addr + offsetof(struct sigframe, sf_code);
2589 /* The original kernel code sets CP0_EPC to the handler
2590 * since it returns to userland using eret
2591 * we cannot do this here, and we must set PC directly */
2592 regs->active_tc.PC = regs->active_tc.gpr[25] = ka->_sa_handler;
2593 unlock_user_struct(frame, frame_addr, 1);
2594 return;
2595
2596 give_sigsegv:
2597 unlock_user_struct(frame, frame_addr, 1);
2598 force_sig(TARGET_SIGSEGV/*, current*/);
2599 return;
2600 }
2601
2602 long do_sigreturn(CPUState *regs)
2603 {
2604 struct sigframe *frame;
2605 abi_ulong frame_addr;
2606 sigset_t blocked;
2607 target_sigset_t target_set;
2608 int i;
2609
2610 #if defined(DEBUG_SIGNAL)
2611 fprintf(stderr, "do_sigreturn\n");
2612 #endif
2613 frame_addr = regs->active_tc.gpr[29];
2614 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
2615 goto badframe;
2616
2617 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2618 if(__get_user(target_set.sig[i], &frame->sf_mask.sig[i]))
2619 goto badframe;
2620 }
2621
2622 target_to_host_sigset_internal(&blocked, &target_set);
2623 sigprocmask(SIG_SETMASK, &blocked, NULL);
2624
2625 if (restore_sigcontext(regs, &frame->sf_sc))
2626 goto badframe;
2627
2628 #if 0
2629 /*
2630 * Don't let your children do this ...
2631 */
2632 __asm__ __volatile__(
2633 "move\t$29, %0\n\t"
2634 "j\tsyscall_exit"
2635 :/* no outputs */
2636 :"r" (&regs));
2637 /* Unreached */
2638 #endif
2639
2640 regs->active_tc.PC = regs->CP0_EPC;
2641 /* I am not sure this is right, but it seems to work
2642 * maybe a problem with nested signals ? */
2643 regs->CP0_EPC = 0;
2644 return -TARGET_QEMU_ESIGRETURN;
2645
2646 badframe:
2647 force_sig(TARGET_SIGSEGV/*, current*/);
2648 return 0;
2649 }
2650
2651 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2652 target_siginfo_t *info,
2653 target_sigset_t *set, CPUState *env)
2654 {
2655 struct target_rt_sigframe *frame;
2656 abi_ulong frame_addr;
2657 int i;
2658
2659 frame_addr = get_sigframe(ka, env, sizeof(*frame));
2660 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
2661 goto give_sigsegv;
2662
2663 install_sigtramp(frame->rs_code, TARGET_NR_rt_sigreturn);
2664
2665 copy_siginfo_to_user(&frame->rs_info, info);
2666
2667 __put_user(0, &frame->rs_uc.uc_flags);
2668 __put_user(0, &frame->rs_uc.uc_link);
2669 __put_user(target_sigaltstack_used.ss_sp, &frame->rs_uc.uc_stack.ss_sp);
2670 __put_user(target_sigaltstack_used.ss_size, &frame->rs_uc.uc_stack.ss_size);
2671 __put_user(sas_ss_flags(get_sp_from_cpustate(env)),
2672 &frame->rs_uc.uc_stack.ss_flags);
2673
2674 setup_sigcontext(env, &frame->rs_uc.uc_mcontext);
2675
2676 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2677 __put_user(set->sig[i], &frame->rs_uc.uc_sigmask.sig[i]);
2678 }
2679
2680 /*
2681 * Arguments to signal handler:
2682 *
2683 * a0 = signal number
2684 * a1 = pointer to struct siginfo
2685 * a2 = pointer to struct ucontext
2686 *
2687 * $25 and PC point to the signal handler, $29 points to the
2688 * struct sigframe.
2689 */
2690 env->active_tc.gpr[ 4] = sig;
2691 env->active_tc.gpr[ 5] = frame_addr
2692 + offsetof(struct target_rt_sigframe, rs_info);
2693 env->active_tc.gpr[ 6] = frame_addr
2694 + offsetof(struct target_rt_sigframe, rs_uc);
2695 env->active_tc.gpr[29] = frame_addr;
2696 env->active_tc.gpr[31] = frame_addr
2697 + offsetof(struct target_rt_sigframe, rs_code);
2698 /* The original kernel code sets CP0_EPC to the handler
2699 * since it returns to userland using eret
2700 * we cannot do this here, and we must set PC directly */
2701 env->active_tc.PC = env->active_tc.gpr[25] = ka->_sa_handler;
2702 unlock_user_struct(frame, frame_addr, 1);
2703 return;
2704
2705 give_sigsegv:
2706 unlock_user_struct(frame, frame_addr, 1);
2707 force_sig(TARGET_SIGSEGV/*, current*/);
2708 return;
2709 }
2710
2711 long do_rt_sigreturn(CPUState *env)
2712 {
2713 struct target_rt_sigframe *frame;
2714 abi_ulong frame_addr;
2715 sigset_t blocked;
2716
2717 #if defined(DEBUG_SIGNAL)
2718 fprintf(stderr, "do_rt_sigreturn\n");
2719 #endif
2720 frame_addr = env->active_tc.gpr[29];
2721 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
2722 goto badframe;
2723
2724 target_to_host_sigset(&blocked, &frame->rs_uc.uc_sigmask);
2725 sigprocmask(SIG_SETMASK, &blocked, NULL);
2726
2727 if (restore_sigcontext(env, &frame->rs_uc.uc_mcontext))
2728 goto badframe;
2729
2730 if (do_sigaltstack(frame_addr +
2731 offsetof(struct target_rt_sigframe, rs_uc.uc_stack),
2732 0, get_sp_from_cpustate(env)) == -EFAULT)
2733 goto badframe;
2734
2735 env->active_tc.PC = env->CP0_EPC;
2736 /* I am not sure this is right, but it seems to work
2737 * maybe a problem with nested signals ? */
2738 env->CP0_EPC = 0;
2739 return -TARGET_QEMU_ESIGRETURN;
2740
2741 badframe:
2742 force_sig(TARGET_SIGSEGV/*, current*/);
2743 return 0;
2744 }
2745
2746 #elif defined(TARGET_SH4)
2747
2748 /*
2749 * code and data structures from linux kernel:
2750 * include/asm-sh/sigcontext.h
2751 * arch/sh/kernel/signal.c
2752 */
2753
2754 struct target_sigcontext {
2755 target_ulong oldmask;
2756
2757 /* CPU registers */
2758 target_ulong sc_gregs[16];
2759 target_ulong sc_pc;
2760 target_ulong sc_pr;
2761 target_ulong sc_sr;
2762 target_ulong sc_gbr;
2763 target_ulong sc_mach;
2764 target_ulong sc_macl;
2765
2766 /* FPU registers */
2767 target_ulong sc_fpregs[16];
2768 target_ulong sc_xfpregs[16];
2769 unsigned int sc_fpscr;
2770 unsigned int sc_fpul;
2771 unsigned int sc_ownedfp;
2772 };
2773
2774 struct target_sigframe
2775 {
2776 struct target_sigcontext sc;
2777 target_ulong extramask[TARGET_NSIG_WORDS-1];
2778 uint16_t retcode[3];
2779 };
2780
2781
2782 struct target_ucontext {
2783 target_ulong uc_flags;
2784 struct target_ucontext *uc_link;
2785 target_stack_t uc_stack;
2786 struct target_sigcontext uc_mcontext;
2787 target_sigset_t uc_sigmask; /* mask last for extensibility */
2788 };
2789
2790 struct target_rt_sigframe
2791 {
2792 struct target_siginfo info;
2793 struct target_ucontext uc;
2794 uint16_t retcode[3];
2795 };
2796
2797
2798 #define MOVW(n) (0x9300|((n)-2)) /* Move mem word at PC+n to R3 */
2799 #define TRAP_NOARG 0xc310 /* Syscall w/no args (NR in R3) SH3/4 */
2800
2801 static abi_ulong get_sigframe(struct target_sigaction *ka,
2802 unsigned long sp, size_t frame_size)
2803 {
2804 if ((ka->sa_flags & TARGET_SA_ONSTACK) && (sas_ss_flags(sp) == 0)) {
2805 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
2806 }
2807
2808 return (sp - frame_size) & -8ul;
2809 }
2810
2811 static int setup_sigcontext(struct target_sigcontext *sc,
2812 CPUState *regs, unsigned long mask)
2813 {
2814 int err = 0;
2815
2816 #define COPY(x) err |= __put_user(regs->x, &sc->sc_##x)
2817 COPY(gregs[0]); COPY(gregs[1]);
2818 COPY(gregs[2]); COPY(gregs[3]);
2819 COPY(gregs[4]); COPY(gregs[5]);
2820 COPY(gregs[6]); COPY(gregs[7]);
2821 COPY(gregs[8]); COPY(gregs[9]);
2822 COPY(gregs[10]); COPY(gregs[11]);
2823 COPY(gregs[12]); COPY(gregs[13]);
2824 COPY(gregs[14]); COPY(gregs[15]);
2825 COPY(gbr); COPY(mach);
2826 COPY(macl); COPY(pr);
2827 COPY(sr); COPY(pc);
2828 #undef COPY
2829
2830 /* todo: save FPU registers here */
2831
2832 /* non-iBCS2 extensions.. */
2833 err |= __put_user(mask, &sc->oldmask);
2834
2835 return err;
2836 }
2837
2838 static int restore_sigcontext(CPUState *regs,
2839 struct target_sigcontext *sc)
2840 {
2841 unsigned int err = 0;
2842
2843 #define COPY(x) err |= __get_user(regs->x, &sc->sc_##x)
2844 COPY(gregs[1]);
2845 COPY(gregs[2]); COPY(gregs[3]);
2846 COPY(gregs[4]); COPY(gregs[5]);
2847 COPY(gregs[6]); COPY(gregs[7]);
2848 COPY(gregs[8]); COPY(gregs[9]);
2849 COPY(gregs[10]); COPY(gregs[11]);
2850 COPY(gregs[12]); COPY(gregs[13]);
2851 COPY(gregs[14]); COPY(gregs[15]);
2852 COPY(gbr); COPY(mach);
2853 COPY(macl); COPY(pr);
2854 COPY(sr); COPY(pc);
2855 #undef COPY
2856
2857 /* todo: restore FPU registers here */
2858
2859 regs->tra = -1; /* disable syscall checks */
2860 return err;
2861 }
2862
2863 static void setup_frame(int sig, struct target_sigaction *ka,
2864 target_sigset_t *set, CPUState *regs)
2865 {
2866 struct target_sigframe *frame;
2867 abi_ulong frame_addr;
2868 int i;
2869 int err = 0;
2870 int signal;
2871
2872 frame_addr = get_sigframe(ka, regs->gregs[15], sizeof(*frame));
2873 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
2874 goto give_sigsegv;
2875
2876 signal = current_exec_domain_sig(sig);
2877
2878 err |= setup_sigcontext(&frame->sc, regs, set->sig[0]);
2879
2880 for (i = 0; i < TARGET_NSIG_WORDS - 1; i++) {
2881 err |= __put_user(set->sig[i + 1], &frame->extramask[i]);
2882 }
2883
2884 /* Set up to return from userspace. If provided, use a stub
2885 already in userspace. */
2886 if (ka->sa_flags & TARGET_SA_RESTORER) {
2887 regs->pr = (unsigned long) ka->sa_restorer;
2888 } else {
2889 /* Generate return code (system call to sigreturn) */
2890 err |= __put_user(MOVW(2), &frame->retcode[0]);
2891 err |= __put_user(TRAP_NOARG, &frame->retcode[1]);
2892 err |= __put_user((TARGET_NR_sigreturn), &frame->retcode[2]);
2893 regs->pr = (unsigned long) frame->retcode;
2894 }
2895
2896 if (err)
2897 goto give_sigsegv;
2898
2899 /* Set up registers for signal handler */
2900 regs->gregs[15] = (unsigned long) frame;
2901 regs->gregs[4] = signal; /* Arg for signal handler */
2902 regs->gregs[5] = 0;
2903 regs->gregs[6] = (unsigned long) &frame->sc;
2904 regs->pc = (unsigned long) ka->_sa_handler;
2905
2906 unlock_user_struct(frame, frame_addr, 1);
2907 return;
2908
2909 give_sigsegv:
2910 unlock_user_struct(frame, frame_addr, 1);
2911 force_sig(SIGSEGV);
2912 }
2913
2914 static void setup_rt_frame(int sig, struct target_sigaction *ka,
2915 target_siginfo_t *info,
2916 target_sigset_t *set, CPUState *regs)
2917 {
2918 struct target_rt_sigframe *frame;
2919 abi_ulong frame_addr;
2920 int i;
2921 int err = 0;
2922 int signal;
2923
2924 frame_addr = get_sigframe(ka, regs->gregs[15], sizeof(*frame));
2925 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
2926 goto give_sigsegv;
2927
2928 signal = current_exec_domain_sig(sig);
2929
2930 err |= copy_siginfo_to_user(&frame->info, info);
2931
2932 /* Create the ucontext. */
2933 err |= __put_user(0, &frame->uc.uc_flags);
2934 err |= __put_user(0, (unsigned long *)&frame->uc.uc_link);
2935 err |= __put_user((unsigned long)target_sigaltstack_used.ss_sp,
2936 &frame->uc.uc_stack.ss_sp);
2937 err |= __put_user(sas_ss_flags(regs->gregs[15]),
2938 &frame->uc.uc_stack.ss_flags);
2939 err |= __put_user(target_sigaltstack_used.ss_size,
2940 &frame->uc.uc_stack.ss_size);
2941 err |= setup_sigcontext(&frame->uc.uc_mcontext,
2942 regs, set->sig[0]);
2943 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
2944 err |= __put_user(set->sig[i], &frame->uc.uc_sigmask.sig[i]);
2945 }
2946
2947 /* Set up to return from userspace. If provided, use a stub
2948 already in userspace. */
2949 if (ka->sa_flags & TARGET_SA_RESTORER) {
2950 regs->pr = (unsigned long) ka->sa_restorer;
2951 } else {
2952 /* Generate return code (system call to sigreturn) */
2953 err |= __put_user(MOVW(2), &frame->retcode[0]);
2954 err |= __put_user(TRAP_NOARG, &frame->retcode[1]);
2955 err |= __put_user((TARGET_NR_rt_sigreturn), &frame->retcode[2]);
2956 regs->pr = (unsigned long) frame->retcode;
2957 }
2958
2959 if (err)
2960 goto give_sigsegv;
2961
2962 /* Set up registers for signal handler */
2963 regs->gregs[15] = (unsigned long) frame;
2964 regs->gregs[4] = signal; /* Arg for signal handler */
2965 regs->gregs[5] = (unsigned long) &frame->info;
2966 regs->gregs[6] = (unsigned long) &frame->uc;
2967 regs->pc = (unsigned long) ka->_sa_handler;
2968
2969 unlock_user_struct(frame, frame_addr, 1);
2970 return;
2971
2972 give_sigsegv:
2973 unlock_user_struct(frame, frame_addr, 1);
2974 force_sig(SIGSEGV);
2975 }
2976
2977 long do_sigreturn(CPUState *regs)
2978 {
2979 struct target_sigframe *frame;
2980 abi_ulong frame_addr;
2981 sigset_t blocked;
2982 target_sigset_t target_set;
2983 int i;
2984 int err = 0;
2985
2986 #if defined(DEBUG_SIGNAL)
2987 fprintf(stderr, "do_sigreturn\n");
2988 #endif
2989 frame_addr = regs->gregs[15];
2990 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
2991 goto badframe;
2992
2993 err |= __get_user(target_set.sig[0], &frame->sc.oldmask);
2994 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
2995 err |= (__get_user(target_set.sig[i], &frame->extramask[i - 1]));
2996 }
2997
2998 if (err)
2999 goto badframe;
3000
3001 target_to_host_sigset_internal(&blocked, &target_set);
3002 sigprocmask(SIG_SETMASK, &blocked, NULL);
3003
3004 if (restore_sigcontext(regs, &frame->sc))
3005 goto badframe;
3006
3007 unlock_user_struct(frame, frame_addr, 0);
3008 return regs->gregs[0];
3009
3010 badframe:
3011 unlock_user_struct(frame, frame_addr, 0);
3012 force_sig(TARGET_SIGSEGV);
3013 return 0;
3014 }
3015
3016 long do_rt_sigreturn(CPUState *regs)
3017 {
3018 struct target_rt_sigframe *frame;
3019 abi_ulong frame_addr;
3020 sigset_t blocked;
3021
3022 #if defined(DEBUG_SIGNAL)
3023 fprintf(stderr, "do_rt_sigreturn\n");
3024 #endif
3025 frame_addr = regs->gregs[15];
3026 if (!lock_user_struct(VERIFY_READ, frame, frame_addr, 1))
3027 goto badframe;
3028
3029 target_to_host_sigset(&blocked, &frame->uc.uc_sigmask);
3030 sigprocmask(SIG_SETMASK, &blocked, NULL);
3031
3032 if (restore_sigcontext(regs, &frame->uc.uc_mcontext))
3033 goto badframe;
3034
3035 if (do_sigaltstack(frame_addr +
3036 offsetof(struct target_rt_sigframe, uc.uc_stack),
3037 0, get_sp_from_cpustate(regs)) == -EFAULT)
3038 goto badframe;
3039
3040 unlock_user_struct(frame, frame_addr, 0);
3041 return regs->gregs[0];
3042
3043 badframe:
3044 unlock_user_struct(frame, frame_addr, 0);
3045 force_sig(TARGET_SIGSEGV);
3046 return 0;
3047 }
3048 #elif defined(TARGET_MICROBLAZE)
3049
3050 struct target_sigcontext {
3051 struct target_pt_regs regs; /* needs to be first */
3052 uint32_t oldmask;
3053 };
3054
3055 /* Signal frames. */
3056 struct target_signal_frame {
3057 struct target_sigcontext sc;
3058 uint32_t extramask[TARGET_NSIG_WORDS - 1];
3059 uint32_t tramp[2];
3060 };
3061
3062 struct rt_signal_frame {
3063 struct siginfo info;
3064 struct ucontext uc;
3065 uint32_t tramp[2];
3066 };
3067
3068 static void setup_sigcontext(struct target_sigcontext *sc, CPUState *env)
3069 {
3070 __put_user(env->regs[0], &sc->regs.r0);
3071 __put_user(env->regs[1], &sc->regs.r1);
3072 __put_user(env->regs[2], &sc->regs.r2);
3073 __put_user(env->regs[3], &sc->regs.r3);
3074 __put_user(env->regs[4], &sc->regs.r4);
3075 __put_user(env->regs[5], &sc->regs.r5);
3076 __put_user(env->regs[6], &sc->regs.r6);
3077 __put_user(env->regs[7], &sc->regs.r7);
3078 __put_user(env->regs[8], &sc->regs.r8);
3079 __put_user(env->regs[9], &sc->regs.r9);
3080 __put_user(env->regs[10], &sc->regs.r10);
3081 __put_user(env->regs[11], &sc->regs.r11);
3082 __put_user(env->regs[12], &sc->regs.r12);
3083 __put_user(env->regs[13], &sc->regs.r13);
3084 __put_user(env->regs[14], &sc->regs.r14);
3085 __put_user(env->regs[15], &sc->regs.r15);
3086 __put_user(env->regs[16], &sc->regs.r16);
3087 __put_user(env->regs[17], &sc->regs.r17);
3088 __put_user(env->regs[18], &sc->regs.r18);
3089 __put_user(env->regs[19], &sc->regs.r19);
3090 __put_user(env->regs[20], &sc->regs.r20);
3091 __put_user(env->regs[21], &sc->regs.r21);
3092 __put_user(env->regs[22], &sc->regs.r22);
3093 __put_user(env->regs[23], &sc->regs.r23);
3094 __put_user(env->regs[24], &sc->regs.r24);
3095 __put_user(env->regs[25], &sc->regs.r25);
3096 __put_user(env->regs[26], &sc->regs.r26);
3097 __put_user(env->regs[27], &sc->regs.r27);
3098 __put_user(env->regs[28], &sc->regs.r28);
3099 __put_user(env->regs[29], &sc->regs.r29);
3100 __put_user(env->regs[30], &sc->regs.r30);
3101 __put_user(env->regs[31], &sc->regs.r31);
3102 __put_user(env->sregs[SR_PC], &sc->regs.pc);
3103 }
3104
3105 static void restore_sigcontext(struct target_sigcontext *sc, CPUState *env)
3106 {
3107 __get_user(env->regs[0], &sc->regs.r0);
3108 __get_user(env->regs[1], &sc->regs.r1);
3109 __get_user(env->regs[2], &sc->regs.r2);
3110 __get_user(env->regs[3], &sc->regs.r3);
3111 __get_user(env->regs[4], &sc->regs.r4);
3112 __get_user(env->regs[5], &sc->regs.r5);
3113 __get_user(env->regs[6], &sc->regs.r6);
3114 __get_user(env->regs[7], &sc->regs.r7);
3115 __get_user(env->regs[8], &sc->regs.r8);
3116 __get_user(env->regs[9], &sc->regs.r9);
3117 __get_user(env->regs[10], &sc->regs.r10);
3118 __get_user(env->regs[11], &sc->regs.r11);
3119 __get_user(env->regs[12], &sc->regs.r12);
3120 __get_user(env->regs[13], &sc->regs.r13);
3121 __get_user(env->regs[14], &sc->regs.r14);
3122 __get_user(env->regs[15], &sc->regs.r15);
3123 __get_user(env->regs[16], &sc->regs.r16);
3124 __get_user(env->regs[17], &sc->regs.r17);
3125 __get_user(env->regs[18], &sc->regs.r18);
3126 __get_user(env->regs[19], &sc->regs.r19);
3127 __get_user(env->regs[20], &sc->regs.r20);
3128 __get_user(env->regs[21], &sc->regs.r21);
3129 __get_user(env->regs[22], &sc->regs.r22);
3130 __get_user(env->regs[23], &sc->regs.r23);
3131 __get_user(env->regs[24], &sc->regs.r24);
3132 __get_user(env->regs[25], &sc->regs.r25);
3133 __get_user(env->regs[26], &sc->regs.r26);
3134 __get_user(env->regs[27], &sc->regs.r27);
3135 __get_user(env->regs[28], &sc->regs.r28);
3136 __get_user(env->regs[29], &sc->regs.r29);
3137 __get_user(env->regs[30], &sc->regs.r30);
3138 __get_user(env->regs[31], &sc->regs.r31);
3139 __get_user(env->sregs[SR_PC], &sc->regs.pc);
3140 }
3141
3142 static abi_ulong get_sigframe(struct target_sigaction *ka,
3143 CPUState *env, int frame_size)
3144 {
3145 abi_ulong sp = env->regs[1];
3146
3147 if ((ka->sa_flags & SA_ONSTACK) != 0 && !on_sig_stack(sp))
3148 sp = target_sigaltstack_used.ss_sp + target_sigaltstack_used.ss_size;
3149
3150 return ((sp - frame_size) & -8UL);
3151 }
3152
3153 static void setup_frame(int sig, struct target_sigaction *ka,
3154 target_sigset_t *set, CPUState *env)
3155 {
3156 struct target_signal_frame *frame;
3157 abi_ulong frame_addr;
3158 int err = 0;
3159 int i;
3160
3161 frame_addr = get_sigframe(ka, env, sizeof *frame);
3162 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
3163 goto badframe;
3164
3165 /* Save the mask. */
3166 err |= __put_user(set->sig[0], &frame->sc.oldmask);
3167 if (err)
3168 goto badframe;
3169
3170 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3171 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
3172 goto badframe;
3173 }
3174
3175 setup_sigcontext(&frame->sc, env);
3176
3177 /* Set up to return from userspace. If provided, use a stub
3178 already in userspace. */
3179 /* minus 8 is offset to cater for "rtsd r15,8" offset */
3180 if (ka->sa_flags & TARGET_SA_RESTORER) {
3181 env->regs[15] = ((unsigned long)ka->sa_restorer)-8;
3182 } else {
3183 uint32_t t;
3184 /* Note, these encodings are _big endian_! */
3185 /* addi r12, r0, __NR_sigreturn */
3186 t = 0x31800000UL | TARGET_NR_sigreturn;
3187 err |= __put_user(t, frame->tramp + 0);
3188 /* brki r14, 0x8 */
3189 t = 0xb9cc0008UL;
3190 err |= __put_user(t, frame->tramp + 1);
3191
3192 /* Return from sighandler will jump to the tramp.
3193 Negative 8 offset because return is rtsd r15, 8 */
3194 env->regs[15] = ((unsigned long)frame->tramp) - 8;
3195 }
3196
3197 if (err)
3198 goto badframe;
3199
3200 /* Set up registers for signal handler */
3201 env->regs[1] = (unsigned long) frame;
3202 /* Signal handler args: */
3203 env->regs[5] = sig; /* Arg 0: signum */
3204 env->regs[6] = (unsigned long) &frame->sc; /* arg 1: sigcontext */
3205
3206 /* Offset of 4 to handle microblaze rtid r14, 0 */
3207 env->sregs[SR_PC] = (unsigned long)ka->_sa_handler;
3208
3209 unlock_user_struct(frame, frame_addr, 1);
3210 return;
3211 badframe:
3212 unlock_user_struct(frame, frame_addr, 1);
3213 force_sig(TARGET_SIGSEGV);
3214 }
3215
3216 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3217 target_siginfo_t *info,
3218 target_sigset_t *set, CPUState *env)
3219 {
3220 fprintf(stderr, "Microblaze setup_rt_frame: not implemented\n");
3221 }
3222
3223 long do_sigreturn(CPUState *env)
3224 {
3225 struct target_signal_frame *frame;
3226 abi_ulong frame_addr;
3227 target_sigset_t target_set;
3228 sigset_t set;
3229 int i;
3230
3231 frame_addr = env->regs[R_SP];
3232 /* Make sure the guest isn't playing games. */
3233 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
3234 goto badframe;
3235
3236 /* Restore blocked signals */
3237 if (__get_user(target_set.sig[0], &frame->sc.oldmask))
3238 goto badframe;
3239 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3240 if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
3241 goto badframe;
3242 }
3243 target_to_host_sigset_internal(&set, &target_set);
3244 sigprocmask(SIG_SETMASK, &set, NULL);
3245
3246 restore_sigcontext(&frame->sc, env);
3247 /* We got here through a sigreturn syscall, our path back is via an
3248 rtb insn so setup r14 for that. */
3249 env->regs[14] = env->sregs[SR_PC];
3250
3251 unlock_user_struct(frame, frame_addr, 0);
3252 return env->regs[10];
3253 badframe:
3254 unlock_user_struct(frame, frame_addr, 0);
3255 force_sig(TARGET_SIGSEGV);
3256 }
3257
3258 long do_rt_sigreturn(CPUState *env)
3259 {
3260 fprintf(stderr, "Microblaze do_rt_sigreturn: not implemented\n");
3261 return -TARGET_ENOSYS;
3262 }
3263
3264 #elif defined(TARGET_CRIS)
3265
3266 struct target_sigcontext {
3267 struct target_pt_regs regs; /* needs to be first */
3268 uint32_t oldmask;
3269 uint32_t usp; /* usp before stacking this gunk on it */
3270 };
3271
3272 /* Signal frames. */
3273 struct target_signal_frame {
3274 struct target_sigcontext sc;
3275 uint32_t extramask[TARGET_NSIG_WORDS - 1];
3276 uint8_t retcode[8]; /* Trampoline code. */
3277 };
3278
3279 struct rt_signal_frame {
3280 struct siginfo *pinfo;
3281 void *puc;
3282 struct siginfo info;
3283 struct ucontext uc;
3284 uint8_t retcode[8]; /* Trampoline code. */
3285 };
3286
3287 static void setup_sigcontext(struct target_sigcontext *sc, CPUState *env)
3288 {
3289 __put_user(env->regs[0], &sc->regs.r0);
3290 __put_user(env->regs[1], &sc->regs.r1);
3291 __put_user(env->regs[2], &sc->regs.r2);
3292 __put_user(env->regs[3], &sc->regs.r3);
3293 __put_user(env->regs[4], &sc->regs.r4);
3294 __put_user(env->regs[5], &sc->regs.r5);
3295 __put_user(env->regs[6], &sc->regs.r6);
3296 __put_user(env->regs[7], &sc->regs.r7);
3297 __put_user(env->regs[8], &sc->regs.r8);
3298 __put_user(env->regs[9], &sc->regs.r9);
3299 __put_user(env->regs[10], &sc->regs.r10);
3300 __put_user(env->regs[11], &sc->regs.r11);
3301 __put_user(env->regs[12], &sc->regs.r12);
3302 __put_user(env->regs[13], &sc->regs.r13);
3303 __put_user(env->regs[14], &sc->usp);
3304 __put_user(env->regs[15], &sc->regs.acr);
3305 __put_user(env->pregs[PR_MOF], &sc->regs.mof);
3306 __put_user(env->pregs[PR_SRP], &sc->regs.srp);
3307 __put_user(env->pc, &sc->regs.erp);
3308 }
3309
3310 static void restore_sigcontext(struct target_sigcontext *sc, CPUState *env)
3311 {
3312 __get_user(env->regs[0], &sc->regs.r0);
3313 __get_user(env->regs[1], &sc->regs.r1);
3314 __get_user(env->regs[2], &sc->regs.r2);
3315 __get_user(env->regs[3], &sc->regs.r3);
3316 __get_user(env->regs[4], &sc->regs.r4);
3317 __get_user(env->regs[5], &sc->regs.r5);
3318 __get_user(env->regs[6], &sc->regs.r6);
3319 __get_user(env->regs[7], &sc->regs.r7);
3320 __get_user(env->regs[8], &sc->regs.r8);
3321 __get_user(env->regs[9], &sc->regs.r9);
3322 __get_user(env->regs[10], &sc->regs.r10);
3323 __get_user(env->regs[11], &sc->regs.r11);
3324 __get_user(env->regs[12], &sc->regs.r12);
3325 __get_user(env->regs[13], &sc->regs.r13);
3326 __get_user(env->regs[14], &sc->usp);
3327 __get_user(env->regs[15], &sc->regs.acr);
3328 __get_user(env->pregs[PR_MOF], &sc->regs.mof);
3329 __get_user(env->pregs[PR_SRP], &sc->regs.srp);
3330 __get_user(env->pc, &sc->regs.erp);
3331 }
3332
3333 static abi_ulong get_sigframe(CPUState *env, int framesize)
3334 {
3335 abi_ulong sp;
3336 /* Align the stack downwards to 4. */
3337 sp = (env->regs[R_SP] & ~3);
3338 return sp - framesize;
3339 }
3340
3341 static void setup_frame(int sig, struct target_sigaction *ka,
3342 target_sigset_t *set, CPUState *env)
3343 {
3344 struct target_signal_frame *frame;
3345 abi_ulong frame_addr;
3346 int err = 0;
3347 int i;
3348
3349 frame_addr = get_sigframe(env, sizeof *frame);
3350 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 0))
3351 goto badframe;
3352
3353 /*
3354 * The CRIS signal return trampoline. A real linux/CRIS kernel doesn't
3355 * use this trampoline anymore but it sets it up for GDB.
3356 * In QEMU, using the trampoline simplifies things a bit so we use it.
3357 *
3358 * This is movu.w __NR_sigreturn, r9; break 13;
3359 */
3360 err |= __put_user(0x9c5f, frame->retcode+0);
3361 err |= __put_user(TARGET_NR_sigreturn,
3362 frame->retcode+2);
3363 err |= __put_user(0xe93d, frame->retcode+4);
3364
3365 /* Save the mask. */
3366 err |= __put_user(set->sig[0], &frame->sc.oldmask);
3367 if (err)
3368 goto badframe;
3369
3370 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3371 if (__put_user(set->sig[i], &frame->extramask[i - 1]))
3372 goto badframe;
3373 }
3374
3375 setup_sigcontext(&frame->sc, env);
3376
3377 /* Move the stack and setup the arguments for the handler. */
3378 env->regs[R_SP] = (uint32_t) (unsigned long) frame;
3379 env->regs[10] = sig;
3380 env->pc = (unsigned long) ka->_sa_handler;
3381 /* Link SRP so the guest returns through the trampoline. */
3382 env->pregs[PR_SRP] = (uint32_t) (unsigned long) &frame->retcode[0];
3383
3384 unlock_user_struct(frame, frame_addr, 1);
3385 return;
3386 badframe:
3387 unlock_user_struct(frame, frame_addr, 1);
3388 force_sig(TARGET_SIGSEGV);
3389 }
3390
3391 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3392 target_siginfo_t *info,
3393 target_sigset_t *set, CPUState *env)
3394 {
3395 fprintf(stderr, "CRIS setup_rt_frame: not implemented\n");
3396 }
3397
3398 long do_sigreturn(CPUState *env)
3399 {
3400 struct target_signal_frame *frame;
3401 abi_ulong frame_addr;
3402 target_sigset_t target_set;
3403 sigset_t set;
3404 int i;
3405
3406 frame_addr = env->regs[R_SP];
3407 /* Make sure the guest isn't playing games. */
3408 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
3409 goto badframe;
3410
3411 /* Restore blocked signals */
3412 if (__get_user(target_set.sig[0], &frame->sc.oldmask))
3413 goto badframe;
3414 for(i = 1; i < TARGET_NSIG_WORDS; i++) {
3415 if (__get_user(target_set.sig[i], &frame->extramask[i - 1]))
3416 goto badframe;
3417 }
3418 target_to_host_sigset_internal(&set, &target_set);
3419 sigprocmask(SIG_SETMASK, &set, NULL);
3420
3421 restore_sigcontext(&frame->sc, env);
3422 unlock_user_struct(frame, frame_addr, 0);
3423 return env->regs[10];
3424 badframe:
3425 unlock_user_struct(frame, frame_addr, 0);
3426 force_sig(TARGET_SIGSEGV);
3427 }
3428
3429 long do_rt_sigreturn(CPUState *env)
3430 {
3431 fprintf(stderr, "CRIS do_rt_sigreturn: not implemented\n");
3432 return -TARGET_ENOSYS;
3433 }
3434
3435 #elif defined(TARGET_PPC) && !defined(TARGET_PPC64)
3436
3437 /* FIXME: Many of the structures are defined for both PPC and PPC64, but
3438 the signal handling is different enough that we haven't implemented
3439 support for PPC64 yet. Hence the restriction above.
3440
3441 There are various #if'd blocks for code for TARGET_PPC64. These
3442 blocks should go away so that we can successfully run 32-bit and
3443 64-bit binaries on a QEMU configured for PPC64. */
3444
3445 /* Size of dummy stack frame allocated when calling signal handler.
3446 See arch/powerpc/include/asm/ptrace.h. */
3447 #if defined(TARGET_PPC64)
3448 #define SIGNAL_FRAMESIZE 128
3449 #else
3450 #define SIGNAL_FRAMESIZE 64
3451 #endif
3452
3453 /* See arch/powerpc/include/asm/sigcontext.h. */
3454 struct target_sigcontext {
3455 target_ulong _unused[4];
3456 int32_t signal;
3457 #if defined(TARGET_PPC64)
3458 int32_t pad0;
3459 #endif
3460 target_ulong handler;
3461 target_ulong oldmask;
3462 target_ulong regs; /* struct pt_regs __user * */
3463 /* TODO: PPC64 includes extra bits here. */
3464 };
3465
3466 /* Indices for target_mcontext.mc_gregs, below.
3467 See arch/powerpc/include/asm/ptrace.h for details. */
3468 enum {
3469 TARGET_PT_R0 = 0,
3470 TARGET_PT_R1 = 1,
3471 TARGET_PT_R2 = 2,
3472 TARGET_PT_R3 = 3,
3473 TARGET_PT_R4 = 4,
3474 TARGET_PT_R5 = 5,
3475 TARGET_PT_R6 = 6,
3476 TARGET_PT_R7 = 7,
3477 TARGET_PT_R8 = 8,
3478 TARGET_PT_R9 = 9,
3479 TARGET_PT_R10 = 10,
3480 TARGET_PT_R11 = 11,
3481 TARGET_PT_R12 = 12,
3482 TARGET_PT_R13 = 13,
3483 TARGET_PT_R14 = 14,
3484 TARGET_PT_R15 = 15,
3485 TARGET_PT_R16 = 16,
3486 TARGET_PT_R17 = 17,
3487 TARGET_PT_R18 = 18,
3488 TARGET_PT_R19 = 19,
3489 TARGET_PT_R20 = 20,
3490 TARGET_PT_R21 = 21,
3491 TARGET_PT_R22 = 22,
3492 TARGET_PT_R23 = 23,
3493 TARGET_PT_R24 = 24,
3494 TARGET_PT_R25 = 25,
3495 TARGET_PT_R26 = 26,
3496 TARGET_PT_R27 = 27,
3497 TARGET_PT_R28 = 28,
3498 TARGET_PT_R29 = 29,
3499 TARGET_PT_R30 = 30,
3500 TARGET_PT_R31 = 31,
3501 TARGET_PT_NIP = 32,
3502 TARGET_PT_MSR = 33,
3503 TARGET_PT_ORIG_R3 = 34,
3504 TARGET_PT_CTR = 35,
3505 TARGET_PT_LNK = 36,
3506 TARGET_PT_XER = 37,
3507 TARGET_PT_CCR = 38,
3508 /* Yes, there are two registers with #39. One is 64-bit only. */
3509 TARGET_PT_MQ = 39,
3510 TARGET_PT_SOFTE = 39,
3511 TARGET_PT_TRAP = 40,
3512 TARGET_PT_DAR = 41,
3513 TARGET_PT_DSISR = 42,
3514 TARGET_PT_RESULT = 43,
3515 TARGET_PT_REGS_COUNT = 44
3516 };
3517
3518 /* See arch/powerpc/include/asm/ucontext.h. Only used for 32-bit PPC;
3519 on 64-bit PPC, sigcontext and mcontext are one and the same. */
3520 struct target_mcontext {
3521 target_ulong mc_gregs[48];
3522 /* Includes fpscr. */
3523 uint64_t mc_fregs[33];
3524 target_ulong mc_pad[2];
3525 /* We need to handle Altivec and SPE at the same time, which no
3526 kernel needs to do. Fortunately, the kernel defines this bit to
3527 be Altivec-register-large all the time, rather than trying to
3528 twiddle it based on the specific platform. */
3529 union {
3530 /* SPE vector registers. One extra for SPEFSCR. */
3531 uint32_t spe[33];
3532 /* Altivec vector registers. The packing of VSCR and VRSAVE
3533 varies depending on whether we're PPC64 or not: PPC64 splits
3534 them apart; PPC32 stuffs them together. */
3535 #if defined(TARGET_PPC64)
3536 #define NVRREG 34
3537 #else
3538 #define NVRREG 33
3539 #endif
3540 ppc_avr_t altivec[NVRREG];
3541 #undef NVRREG
3542 } mc_vregs __attribute__((__aligned__(16)));
3543 };
3544
3545 struct target_ucontext {
3546 target_ulong uc_flags;
3547 target_ulong uc_link; /* struct ucontext __user * */
3548 struct target_sigaltstack uc_stack;
3549 #if !defined(TARGET_PPC64)
3550 int32_t uc_pad[7];
3551 target_ulong uc_regs; /* struct mcontext __user *
3552 points to uc_mcontext field */
3553 #endif
3554 target_sigset_t uc_sigmask;
3555 #if defined(TARGET_PPC64)
3556 target_sigset_t unused[15]; /* Allow for uc_sigmask growth */
3557 struct target_sigcontext uc_mcontext;
3558 #else
3559 int32_t uc_maskext[30];
3560 int32_t uc_pad2[3];
3561 struct target_mcontext uc_mcontext;
3562 #endif
3563 };
3564
3565 /* See arch/powerpc/kernel/signal_32.c. */
3566 struct target_sigframe {
3567 struct target_sigcontext sctx;
3568 struct target_mcontext mctx;
3569 int32_t abigap[56];
3570 };
3571
3572 struct target_rt_sigframe {
3573 struct target_siginfo info;
3574 struct target_ucontext uc;
3575 int32_t abigap[56];
3576 };
3577
3578 /* We use the mc_pad field for the signal return trampoline. */
3579 #define tramp mc_pad
3580
3581 /* See arch/powerpc/kernel/signal.c. */
3582 static target_ulong get_sigframe(struct target_sigaction *ka,
3583 CPUState *env,
3584 int frame_size)
3585 {
3586 target_ulong oldsp, newsp;
3587
3588 oldsp = env->gpr[1];
3589
3590 if ((ka->sa_flags & TARGET_SA_ONSTACK) &&
3591 (sas_ss_flags(oldsp))) {
3592 oldsp = (target_sigaltstack_used.ss_sp
3593 + target_sigaltstack_used.ss_size);
3594 }
3595
3596 newsp = (oldsp - frame_size) & ~0xFUL;
3597
3598 return newsp;
3599 }
3600
3601 static int save_user_regs(CPUState *env, struct target_mcontext *frame,
3602 int sigret)
3603 {
3604 target_ulong msr = env->msr;
3605 int i;
3606 target_ulong ccr = 0;
3607
3608 /* In general, the kernel attempts to be intelligent about what it
3609 needs to save for Altivec/FP/SPE registers. We don't care that
3610 much, so we just go ahead and save everything. */
3611
3612 /* Save general registers. */
3613 for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
3614 if (__put_user(env->gpr[i], &frame->mc_gregs[i])) {
3615 return 1;
3616 }
3617 }
3618 if (__put_user(env->nip, &frame->mc_gregs[TARGET_PT_NIP])
3619 || __put_user(env->ctr, &frame->mc_gregs[TARGET_PT_CTR])
3620 || __put_user(env->lr, &frame->mc_gregs[TARGET_PT_LNK])
3621 || __put_user(env->xer, &frame->mc_gregs[TARGET_PT_XER]))
3622 return 1;
3623
3624 for (i = 0; i < ARRAY_SIZE(env->crf); i++) {
3625 ccr |= env->crf[i] << (32 - ((i + 1) * 4));
3626 }
3627 if (__put_user(ccr, &frame->mc_gregs[TARGET_PT_CCR]))
3628 return 1;
3629
3630 /* Save Altivec registers if necessary. */
3631 if (env->insns_flags & PPC_ALTIVEC) {
3632 for (i = 0; i < ARRAY_SIZE(env->avr); i++) {
3633 ppc_avr_t *avr = &env->avr[i];
3634 ppc_avr_t *vreg = &frame->mc_vregs.altivec[i];
3635
3636 if (__put_user(avr->u64[0], &vreg->u64[0]) ||
3637 __put_user(avr->u64[1], &vreg->u64[1])) {
3638 return 1;
3639 }
3640 }
3641 /* Set MSR_VR in the saved MSR value to indicate that
3642 frame->mc_vregs contains valid data. */
3643 msr |= MSR_VR;
3644 if (__put_user((uint32_t)env->spr[SPR_VRSAVE],
3645 &frame->mc_vregs.altivec[32].u32[3]))
3646 return 1;
3647 }
3648
3649 /* Save floating point registers. */
3650 if (env->insns_flags & PPC_FLOAT) {
3651 for (i = 0; i < ARRAY_SIZE(env->fpr); i++) {
3652 if (__put_user(env->fpr[i], &frame->mc_fregs[i])) {
3653 return 1;
3654 }
3655 }
3656 if (__put_user((uint64_t) env->fpscr, &frame->mc_fregs[32]))
3657 return 1;
3658 }
3659
3660 /* Save SPE registers. The kernel only saves the high half. */
3661 if (env->insns_flags & PPC_SPE) {
3662 #if defined(TARGET_PPC64)
3663 for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
3664 if (__put_user(env->gpr[i] >> 32, &frame->mc_vregs.spe[i])) {
3665 return 1;
3666 }
3667 }
3668 #else
3669 for (i = 0; i < ARRAY_SIZE(env->gprh); i++) {
3670 if (__put_user(env->gprh[i], &frame->mc_vregs.spe[i])) {
3671 return 1;
3672 }
3673 }
3674 #endif
3675 /* Set MSR_SPE in the saved MSR value to indicate that
3676 frame->mc_vregs contains valid data. */
3677 msr |= MSR_SPE;
3678 if (__put_user(env->spe_fscr, &frame->mc_vregs.spe[32]))
3679 return 1;
3680 }
3681
3682 /* Store MSR. */
3683 if (__put_user(msr, &frame->mc_gregs[TARGET_PT_MSR]))
3684 return 1;
3685
3686 /* Set up the sigreturn trampoline: li r0,sigret; sc. */
3687 if (sigret) {
3688 if (__put_user(0x38000000UL | sigret, &frame->tramp[0]) ||
3689 __put_user(0x44000002UL, &frame->tramp[1])) {
3690 return 1;
3691 }
3692 }
3693
3694 return 0;
3695 }
3696
3697 static int restore_user_regs(CPUState *env,
3698 struct target_mcontext *frame, int sig)
3699 {
3700 target_ulong save_r2 = 0;
3701 target_ulong msr;
3702 target_ulong ccr;
3703
3704 int i;
3705
3706 if (!sig) {
3707 save_r2 = env->gpr[2];
3708 }
3709
3710 /* Restore general registers. */
3711 for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
3712 if (__get_user(env->gpr[i], &frame->mc_gregs[i])) {
3713 return 1;
3714 }
3715 }
3716 if (__get_user(env->nip, &frame->mc_gregs[TARGET_PT_NIP])
3717 || __get_user(env->ctr, &frame->mc_gregs[TARGET_PT_CTR])
3718 || __get_user(env->lr, &frame->mc_gregs[TARGET_PT_LNK])
3719 || __get_user(env->xer, &frame->mc_gregs[TARGET_PT_XER]))
3720 return 1;
3721 if (__get_user(ccr, &frame->mc_gregs[TARGET_PT_CCR]))
3722 return 1;
3723
3724 for (i = 0; i < ARRAY_SIZE(env->crf); i++) {
3725 env->crf[i] = (ccr >> (32 - ((i + 1) * 4))) & 0xf;
3726 }
3727
3728 if (!sig) {
3729 env->gpr[2] = save_r2;
3730 }
3731 /* Restore MSR. */
3732 if (__get_user(msr, &frame->mc_gregs[TARGET_PT_MSR]))
3733 return 1;
3734
3735 /* If doing signal return, restore the previous little-endian mode. */
3736 if (sig)
3737 env->msr = (env->msr & ~MSR_LE) | (msr & MSR_LE);
3738
3739 /* Restore Altivec registers if necessary. */
3740 if (env->insns_flags & PPC_ALTIVEC) {
3741 for (i = 0; i < ARRAY_SIZE(env->avr); i++) {
3742 ppc_avr_t *avr = &env->avr[i];
3743 ppc_avr_t *vreg = &frame->mc_vregs.altivec[i];
3744
3745 if (__get_user(avr->u64[0], &vreg->u64[0]) ||
3746 __get_user(avr->u64[1], &vreg->u64[1])) {
3747 return 1;
3748 }
3749 }
3750 /* Set MSR_VEC in the saved MSR value to indicate that
3751 frame->mc_vregs contains valid data. */
3752 if (__get_user(env->spr[SPR_VRSAVE],
3753 (target_ulong *)(&frame->mc_vregs.altivec[32].u32[3])))
3754 return 1;
3755 }
3756
3757 /* Restore floating point registers. */
3758 if (env->insns_flags & PPC_FLOAT) {
3759 uint64_t fpscr;
3760 for (i = 0; i < ARRAY_SIZE(env->fpr); i++) {
3761 if (__get_user(env->fpr[i], &frame->mc_fregs[i])) {
3762 return 1;
3763 }
3764 }
3765 if (__get_user(fpscr, &frame->mc_fregs[32]))
3766 return 1;
3767 env->fpscr = (uint32_t) fpscr;
3768 }
3769
3770 /* Save SPE registers. The kernel only saves the high half. */
3771 if (env->insns_flags & PPC_SPE) {
3772 #if defined(TARGET_PPC64)
3773 for (i = 0; i < ARRAY_SIZE(env->gpr); i++) {
3774 uint32_t hi;
3775
3776 if (__get_user(hi, &frame->mc_vregs.spe[i])) {
3777 return 1;
3778 }
3779 env->gpr[i] = ((uint64_t)hi << 32) | ((uint32_t) env->gpr[i]);
3780 }
3781 #else
3782 for (i = 0; i < ARRAY_SIZE(env->gprh); i++) {
3783 if (__get_user(env->gprh[i], &frame->mc_vregs.spe[i])) {
3784 return 1;
3785 }
3786 }
3787 #endif
3788 if (__get_user(env->spe_fscr, &frame->mc_vregs.spe[32]))
3789 return 1;
3790 }
3791
3792 return 0;
3793 }
3794
3795 static void setup_frame(int sig, struct target_sigaction *ka,
3796 target_sigset_t *set, CPUState *env)
3797 {
3798 struct target_sigframe *frame;
3799 struct target_sigcontext *sc;
3800 target_ulong frame_addr, newsp;
3801 int err = 0;
3802 int signal;
3803
3804 frame_addr = get_sigframe(ka, env, sizeof(*frame));
3805 if (!lock_user_struct(VERIFY_WRITE, frame, frame_addr, 1))
3806 goto sigsegv;
3807 sc = &frame->sctx;
3808
3809 signal = current_exec_domain_sig(sig);
3810
3811 err |= __put_user(h2g(ka->_sa_handler), &sc->handler);
3812 err |= __put_user(set->sig[0], &sc->oldmask);
3813 #if defined(TARGET_PPC64)
3814 err |= __put_user(set->sig[0] >> 32, &sc->_unused[3]);
3815 #else
3816 err |= __put_user(set->sig[1], &sc->_unused[3]);
3817 #endif
3818 err |= __put_user(h2g(&frame->mctx), &sc->regs);
3819 err |= __put_user(sig, &sc->signal);
3820
3821 /* Save user regs. */
3822 err |= save_user_regs(env, &frame->mctx, TARGET_NR_sigreturn);
3823
3824 /* The kernel checks for the presence of a VDSO here. We don't
3825 emulate a vdso, so use a sigreturn system call. */
3826 env->lr = (target_ulong) h2g(frame->mctx.tramp);
3827
3828 /* Turn off all fp exceptions. */
3829 env->fpscr = 0;
3830
3831 /* Create a stack frame for the caller of the handler. */
3832 newsp = frame_addr - SIGNAL_FRAMESIZE;
3833 err |= __put_user(env->gpr[1], (target_ulong *)(uintptr_t) newsp);
3834
3835 if (err)
3836 goto sigsegv;
3837
3838 /* Set up registers for signal handler. */
3839 env->gpr[1] = newsp;
3840 env->gpr[3] = signal;
3841 env->gpr[4] = (target_ulong) h2g(sc);
3842 env->nip = (target_ulong) ka->_sa_handler;
3843 /* Signal handlers are entered in big-endian mode. */
3844 env->msr &= ~MSR_LE;
3845
3846 unlock_user_struct(frame, frame_addr, 1);
3847 return;
3848
3849 sigsegv:
3850 unlock_user_struct(frame, frame_addr, 1);
3851 if (logfile)
3852 fprintf (logfile, "segfaulting from setup_frame\n");
3853 force_sig(SIGSEGV);
3854 }
3855
3856 static void setup_rt_frame(int sig, struct target_sigaction *ka,
3857 target_siginfo_t *info,
3858 target_sigset_t *set, CPUState *env)
3859 {
3860 struct target_rt_sigframe *rt_sf;
3861 struct target_mcontext *frame;
3862 target_ulong rt_sf_addr, newsp = 0;
3863 int i, err = 0;
3864 int signal;
3865
3866 rt_sf_addr = get_sigframe(ka, env, sizeof(*rt_sf));
3867 if (!lock_user_struct(VERIFY_WRITE, rt_sf, rt_sf_addr, 1))
3868 goto sigsegv;
3869
3870 signal = current_exec_domain_sig(sig);
3871
3872 err |= copy_siginfo_to_user(&rt_sf->info, info);
3873
3874 err |= __put_user(0, &rt_sf->uc.uc_flags);
3875 err |= __put_user(0, &rt_sf->uc.uc_link);
3876 err |= __put_user((target_ulong)target_sigaltstack_used.ss_sp,
3877 &rt_sf->uc.uc_stack.ss_sp);
3878 err |= __put_user(sas_ss_flags(env->gpr[1]),
3879 &rt_sf->uc.uc_stack.ss_flags);
3880 err |= __put_user(target_sigaltstack_used.ss_size,
3881 &rt_sf->uc.uc_stack.ss_size);
3882 err |= __put_user(h2g (&rt_sf->uc.uc_mcontext),
3883 &rt_sf->uc.uc_regs);
3884 for(i = 0; i < TARGET_NSIG_WORDS; i++) {
3885 err |= __put_user(set->sig[i], &rt_sf->uc.uc_sigmask.sig[i]);
3886 }
3887
3888 frame = &rt_sf->uc.uc_mcontext;
3889 err |= save_user_regs(env, frame, TARGET_NR_rt_sigreturn);
3890
3891 /* The kernel checks for the presence of a VDSO here. We don't
3892 emulate a vdso, so use a sigreturn system call. */
3893 env->lr = (target_ulong) h2g(frame->tramp);
3894
3895 /* Turn off all fp exceptions. */
3896 env->fpscr = 0;
3897
3898 /* Create a stack frame for the caller of the handler. */
3899 newsp = rt_sf_addr - (SIGNAL_FRAMESIZE + 16);
3900 err |= __put_user(env->gpr[1], (target_ulong *)(uintptr_t) newsp);
3901
3902 if (err)
3903 goto sigsegv;
3904
3905 /* Set up registers for signal handler. */
3906 env->gpr[1] = newsp;
3907 env->gpr[3] = (target_ulong) signal;
3908 env->gpr[4] = (target_ulong) h2g(&rt_sf->info);
3909 env->gpr[5] = (target_ulong) h2g(&rt_sf->uc);
3910 env->gpr[6] = (target_ulong) h2g(rt_sf);
3911 env->nip = (target_ulong) ka->_sa_handler;
3912 /* Signal handlers are entered in big-endian mode. */
3913 env->msr &= ~MSR_LE;
3914
3915 unlock_user_struct(rt_sf, rt_sf_addr, 1);
3916 return;
3917
3918 sigsegv:
3919 unlock_user_struct(rt_sf, rt_sf_addr, 1);
3920 if (logfile)
3921 fprintf (logfile, "segfaulting from setup_rt_frame\n");
3922 force_sig(SIGSEGV);
3923
3924 }
3925
3926 long do_sigreturn(CPUState *env)
3927 {
3928 struct target_sigcontext *sc = NULL;
3929 struct target_mcontext *sr = NULL;
3930 target_ulong sr_addr, sc_addr;
3931 sigset_t blocked;
3932 target_sigset_t set;
3933
3934 sc_addr = env->gpr[1] + SIGNAL_FRAMESIZE;
3935 if (!lock_user_struct(VERIFY_READ, sc, sc_addr, 1))
3936 goto sigsegv;
3937
3938 #if defined(TARGET_PPC64)
3939 set.sig[0] = sc->oldmask + ((long)(sc->_unused[3]) << 32);
3940 #else
3941 if(__get_user(set.sig[0], &sc->oldmask) ||
3942 __get_user(set.sig[1], &sc->_unused[3]))
3943 goto sigsegv;
3944 #endif
3945 target_to_host_sigset_internal(&blocked, &set);
3946 sigprocmask(SIG_SETMASK, &blocked, NULL);
3947
3948 if (__get_user(sr_addr, &sc->regs))
3949 goto sigsegv;
3950 if (!lock_user_struct(VERIFY_READ, sr, sr_addr, 1))
3951 goto sigsegv;
3952 if (restore_user_regs(env, sr, 1))
3953 goto sigsegv;
3954
3955 unlock_user_struct(sr, sr_addr, 1);
3956 unlock_user_struct(sc, sc_addr, 1);
3957 return -TARGET_QEMU_ESIGRETURN;
3958
3959 sigsegv:
3960 unlock_user_struct(sr, sr_addr, 1);
3961 unlock_user_struct(sc, sc_addr, 1);
3962 if (logfile)
3963 fprintf (logfile, "segfaulting from do_sigreturn\n");
3964 force_sig(SIGSEGV);
3965 return 0;
3966 }
3967
3968 /* See arch/powerpc/kernel/signal_32.c. */
3969 static int do_setcontext(struct target_ucontext *ucp, CPUState *env, int sig)
3970 {
3971 struct target_mcontext *mcp;
3972 target_ulong mcp_addr;
3973 sigset_t blocked;
3974 target_sigset_t set;
3975
3976 if (copy_from_user(&set, h2g(ucp) + offsetof(struct target_ucontext, uc_sigmask),
3977 sizeof (set)))
3978 return 1;
3979
3980 #if defined(TARGET_PPC64)
3981 fprintf (stderr, "do_setcontext: not implemented\n");
3982 return 0;
3983 #else
3984 if (__get_user(mcp_addr, &ucp->uc_regs))
3985 return 1;
3986
3987 if (!lock_user_struct(VERIFY_READ, mcp, mcp_addr, 1))
3988 return 1;
3989
3990 target_to_host_sigset_internal(&blocked, &set);
3991 sigprocmask(SIG_SETMASK, &blocked, NULL);
3992 if (restore_user_regs(env, mcp, sig))
3993 goto sigsegv;
3994
3995 unlock_user_struct(mcp, mcp_addr, 1);
3996 return 0;
3997
3998 sigsegv:
3999 unlock_user_struct(mcp, mcp_addr, 1);
4000 return 1;
4001 #endif
4002 }
4003
4004 long do_rt_sigreturn(CPUState *env)
4005 {
4006 struct target_rt_sigframe *rt_sf = NULL;
4007 target_ulong rt_sf_addr;
4008
4009 rt_sf_addr = env->gpr[1] + SIGNAL_FRAMESIZE + 16;
4010 if (!lock_user_struct(VERIFY_READ, rt_sf, rt_sf_addr, 1))
4011 goto sigsegv;
4012
4013 if (do_setcontext(&rt_sf->uc, env, 1))
4014 goto sigsegv;
4015
4016 do_sigaltstack(rt_sf_addr
4017 + offsetof(struct target_rt_sigframe, uc.uc_stack),
4018 0, env->gpr[1]);
4019
4020 unlock_user_struct(rt_sf, rt_sf_addr, 1);
4021 return -TARGET_QEMU_ESIGRETURN;
4022
4023 sigsegv:
4024 unlock_user_struct(rt_sf, rt_sf_addr, 1);
4025 if (logfile)
4026 fprintf (logfile, "segfaulting from do_rt_sigreturn\n");
4027 force_sig(SIGSEGV);
4028 return 0;
4029 }
4030
4031 #else
4032
4033 static void setup_frame(int sig, struct target_sigaction *ka,
4034 target_sigset_t *set, CPUState *env)
4035 {
4036 fprintf(stderr, "setup_frame: not implemented\n");
4037 }
4038
4039 static void setup_rt_frame(int sig, struct target_sigaction *ka,
4040 target_siginfo_t *info,
4041 target_sigset_t *set, CPUState *env)
4042 {
4043 fprintf(stderr, "setup_rt_frame: not implemented\n");
4044 }
4045
4046 long do_sigreturn(CPUState *env)
4047 {
4048 fprintf(stderr, "do_sigreturn: not implemented\n");
4049 return -TARGET_ENOSYS;
4050 }
4051
4052 long do_rt_sigreturn(CPUState *env)
4053 {
4054 fprintf(stderr, "do_rt_sigreturn: not implemented\n");
4055 return -TARGET_ENOSYS;
4056 }
4057
4058 #endif
4059
4060 void process_pending_signals(CPUState *cpu_env)
4061 {
4062 int sig;
4063 abi_ulong handler;
4064 sigset_t set, old_set;
4065 target_sigset_t target_old_set;
4066 struct emulated_sigtable *k;
4067 struct target_sigaction *sa;
4068 struct sigqueue *q;
4069 TaskState *ts = cpu_env->opaque;
4070
4071 if (!ts->signal_pending)
4072 return;
4073
4074 /* FIXME: This is not threadsafe. */
4075 k = ts->sigtab;
4076 for(sig = 1; sig <= TARGET_NSIG; sig++) {
4077 if (k->pending)
4078 goto handle_signal;
4079 k++;
4080 }
4081 /* if no signal is pending, just return */
4082 ts->signal_pending = 0;
4083 return;
4084
4085 handle_signal:
4086 #ifdef DEBUG_SIGNAL
4087 fprintf(stderr, "qemu: process signal %d\n", sig);
4088 #endif
4089 /* dequeue signal */
4090 q = k->first;
4091 k->first = q->next;
4092 if (!k->first)
4093 k->pending = 0;
4094
4095 sig = gdb_handlesig (cpu_env, sig);
4096 if (!sig) {
4097 sa = NULL;
4098 handler = TARGET_SIG_IGN;
4099 } else {
4100 sa = &sigact_table[sig - 1];
4101 handler = sa->_sa_handler;
4102 }
4103
4104 if (handler == TARGET_SIG_DFL) {
4105 /* default handler : ignore some signal. The other are job control or fatal */
4106 if (sig == TARGET_SIGTSTP || sig == TARGET_SIGTTIN || sig == TARGET_SIGTTOU) {
4107 kill(getpid(),SIGSTOP);
4108 } else if (sig != TARGET_SIGCHLD &&
4109 sig != TARGET_SIGURG &&
4110 sig != TARGET_SIGWINCH &&
4111 sig != TARGET_SIGCONT) {
4112 force_sig(sig);
4113 }
4114 } else if (handler == TARGET_SIG_IGN) {
4115 /* ignore sig */
4116 } else if (handler == TARGET_SIG_ERR) {
4117 force_sig(sig);
4118 } else {
4119 /* compute the blocked signals during the handler execution */
4120 target_to_host_sigset(&set, &sa->sa_mask);
4121 /* SA_NODEFER indicates that the current signal should not be
4122 blocked during the handler */
4123 if (!(sa->sa_flags & TARGET_SA_NODEFER))
4124 sigaddset(&set, target_to_host_signal(sig));
4125
4126 /* block signals in the handler using Linux */
4127 sigprocmask(SIG_BLOCK, &set, &old_set);
4128 /* save the previous blocked signal state to restore it at the
4129 end of the signal execution (see do_sigreturn) */
4130 host_to_target_sigset_internal(&target_old_set, &old_set);
4131
4132 /* if the CPU is in VM86 mode, we restore the 32 bit values */
4133 #if defined(TARGET_I386) && !defined(TARGET_X86_64)
4134 {
4135 CPUX86State *env = cpu_env;
4136 if (env->eflags & VM_MASK)
4137 save_v86_state(env);
4138 }
4139 #endif
4140 /* prepare the stack frame of the virtual CPU */
4141 if (sa->sa_flags & TARGET_SA_SIGINFO)
4142 setup_rt_frame(sig, sa, &q->info, &target_old_set, cpu_env);
4143 else
4144 setup_frame(sig, sa, &target_old_set, cpu_env);
4145 if (sa->sa_flags & TARGET_SA_RESETHAND)
4146 sa->_sa_handler = TARGET_SIG_DFL;
4147 }
4148 if (q != &k->info)
4149 free_sigqueue(cpu_env, q);
4150 }
QEmu