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