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