Annotation of sys/arch/mac68k/mac68k/trap.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: trap.c,v 1.54 2007/05/15 13:46:22 martin Exp $ */
! 2: /* $NetBSD: trap.c,v 1.68 1998/12/22 08:47:07 scottr Exp $ */
! 3:
! 4: /*
! 5: * Copyright (c) 1988 University of Utah.
! 6: * Copyright (c) 1982, 1986, 1990, 1993
! 7: * The Regents of the University of California. All rights reserved.
! 8: *
! 9: * This code is derived from software contributed to Berkeley by
! 10: * the Systems Programming Group of the University of Utah Computer
! 11: * Science Department.
! 12: *
! 13: * Redistribution and use in source and binary forms, with or without
! 14: * modification, are permitted provided that the following conditions
! 15: * are met:
! 16: * 1. Redistributions of source code must retain the above copyright
! 17: * notice, this list of conditions and the following disclaimer.
! 18: * 2. Redistributions in binary form must reproduce the above copyright
! 19: * notice, this list of conditions and the following disclaimer in the
! 20: * documentation and/or other materials provided with the distribution.
! 21: * 3. Neither the name of the University nor the names of its contributors
! 22: * may be used to endorse or promote products derived from this software
! 23: * without specific prior written permission.
! 24: *
! 25: * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
! 26: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 27: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 28: * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
! 29: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 30: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 31: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 32: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 33: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 34: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 35: * SUCH DAMAGE.
! 36: *
! 37: * from: Utah $Hdr: trap.c 1.37 92/12/20$
! 38: *
! 39: * @(#)trap.c 8.5 (Berkeley) 1/4/94
! 40: */
! 41:
! 42: #include <sys/param.h>
! 43: #include <sys/systm.h>
! 44: #include <sys/proc.h>
! 45: #include <sys/acct.h>
! 46: #include <sys/kernel.h>
! 47: #include <sys/signalvar.h>
! 48: #include <sys/resourcevar.h>
! 49: #include <sys/syscall.h>
! 50: #include <sys/syslog.h>
! 51: #include <sys/user.h>
! 52: #ifdef KGDB
! 53: #include <sys/kgdb.h>
! 54: #endif
! 55: #ifdef KTRACE
! 56: #include <sys/ktrace.h>
! 57: #endif
! 58: #ifdef DEBUG
! 59: #include <dev/cons.h>
! 60: #endif
! 61:
! 62: #include <machine/db_machdep.h>
! 63: #include <machine/psl.h>
! 64: #include <machine/trap.h>
! 65: #include <machine/cpu.h>
! 66: #include <machine/reg.h>
! 67:
! 68: #include <m68k/fpe/fpu_emulate.h>
! 69:
! 70: #include "systrace.h"
! 71: #include <dev/systrace.h>
! 72:
! 73: #include <uvm/uvm_extern.h>
! 74: #include <uvm/uvm_pmap.h>
! 75:
! 76: #ifdef COMPAT_SUNOS
! 77: #include <compat/sunos/sunos_syscall.h>
! 78: extern struct emul emul_sunos;
! 79: #endif
! 80:
! 81: int astpending;
! 82:
! 83: char *trap_type[] = {
! 84: "Bus error",
! 85: "Address error",
! 86: "Illegal instruction",
! 87: "Zero divide",
! 88: "CHK instruction",
! 89: "TRAPV instruction",
! 90: "Privilege violation",
! 91: "Trace trap",
! 92: "MMU fault",
! 93: "SSIR trap",
! 94: "Format error",
! 95: "68881 exception",
! 96: "Coprocessor violation",
! 97: "Async system trap"
! 98: };
! 99: int trap_types = sizeof trap_type / sizeof trap_type[0];
! 100:
! 101: /*
! 102: * Size of various exception stack frames (minus the standard 8 bytes)
! 103: */
! 104: short exframesize[] = {
! 105: FMT0SIZE, /* type 0 - normal (68020/030/040) */
! 106: FMT1SIZE, /* type 1 - throwaway (68020/030/040) */
! 107: FMT2SIZE, /* type 2 - normal 6-word (68020/030/040) */
! 108: FMT3SIZE, /* type 3 - FP post-instruction (68040) */
! 109: FMT4SIZE, /* type 4 - LC040 FP exception (68LC040) */
! 110: -1, -1, /* type 5-6 - undefined */
! 111: FMT7SIZE, /* type 7 - access error (68040) */
! 112: 58, /* type 8 - bus fault (68010) */
! 113: FMT9SIZE, /* type 9 - coprocessor mid-instruction (68020/030) */
! 114: FMTASIZE, /* type A - short bus fault (68020/030) */
! 115: FMTBSIZE, /* type B - long bus fault (68020/030) */
! 116: -1, -1, -1, -1 /* type C-F - undefined */
! 117: };
! 118:
! 119: #ifdef M68040
! 120: #define KDFAULT(c) (mmutype == MMU_68040 ? \
! 121: ((c) & SSW4_TMMASK) == SSW4_TMKD : \
! 122: ((c) & (SSW_DF|SSW_FCMASK)) == (SSW_DF|FC_SUPERD))
! 123: #define WRFAULT(c) (mmutype == MMU_68040 ? \
! 124: ((c) & SSW4_RW) == 0 : \
! 125: ((c) & (SSW_DF|SSW_RW)) == SSW_DF)
! 126: #else
! 127: #define KDFAULT(c) (((c) & (SSW_DF|SSW_FCMASK)) == (SSW_DF|FC_SUPERD))
! 128: #define WRFAULT(c) (((c) & (SSW_DF|SSW_RW)) == SSW_DF)
! 129: #endif
! 130:
! 131: #ifdef DEBUG
! 132: int mmudebug = 0;
! 133: int mmupid = -1;
! 134: #define MDB_FOLLOW 1
! 135: #define MDB_WBFOLLOW 2
! 136: #define MDB_WBFAILED 4
! 137: #define MDB_ISPID(pid) ((pid) == mmupid)
! 138: #endif
! 139:
! 140: /* trap() and syscall() only called from locore */
! 141: void trap(int, u_int, u_int, struct frame);
! 142: void syscall(register_t, struct frame);
! 143:
! 144: #if defined(M68040)
! 145: int writeback(struct frame *);
! 146: void wb_userret(struct proc *, struct frame *);
! 147: #if DEBUG
! 148: static void dumpssw(u_short);
! 149: static void dumpwb(int, u_short, u_int, u_int);
! 150: #endif
! 151: #endif
! 152:
! 153: /*
! 154: * Trap and syscall both need the following work done before returning
! 155: * to user mode.
! 156: */
! 157: void
! 158: userret(struct proc *p)
! 159: {
! 160: int sig;
! 161:
! 162: /* take pending signals */
! 163: while ((sig = CURSIG(p)) != 0)
! 164: postsig(sig);
! 165: curcpu()->ci_schedstate.spc_curpriority = p->p_priority = p->p_usrpri;
! 166: }
! 167:
! 168: #ifdef M68040
! 169: /*
! 170: * Same as above, but also handles writeback completion on 68040.
! 171: */
! 172: void
! 173: wb_userret(struct proc *p, struct frame *fp)
! 174: {
! 175: int sig;
! 176: union sigval sv;
! 177:
! 178: /* take pending signals */
! 179: while ((sig = CURSIG(p)) != 0)
! 180: postsig(sig);
! 181: p->p_priority = p->p_usrpri;
! 182:
! 183: /*
! 184: * Deal with user mode writebacks (from trap, or from sigreturn).
! 185: * If any writeback fails, go back and attempt signal delivery
! 186: * unless we have already been here and attempted the writeback
! 187: * (e.g. bad address with user ignoring SIGSEGV). In that case,
! 188: * we just return to the user without successfully completing
! 189: * the writebacks. Maybe we should just drop the sucker?
! 190: */
! 191: if (mmutype == MMU_68040 && fp->f_format == FMT7) {
! 192: if ((sig = writeback(fp)) != 0) {
! 193: sv.sival_ptr = (void *)fp->f_fmt7.f_fa;
! 194: trapsignal(p, sig, T_MMUFLT, SEGV_MAPERR, sv);
! 195:
! 196: while ((sig = CURSIG(p)) != 0)
! 197: postsig(sig);
! 198: p->p_priority = p->p_usrpri;
! 199: }
! 200: }
! 201: curcpu()->ci_schedstate.spc_curpriority = p->p_priority;
! 202: }
! 203: #endif
! 204:
! 205: /*
! 206: * Trap is called from locore to handle most types of processor traps,
! 207: * including events such as simulated software interrupts/AST's.
! 208: * System calls are broken out for efficiency.
! 209: */
! 210: /*ARGSUSED*/
! 211: void
! 212: trap(type, code, v, frame)
! 213: int type;
! 214: u_int code;
! 215: u_int v;
! 216: struct frame frame;
! 217: {
! 218: struct proc *p;
! 219: int i, s;
! 220: u_int ucode;
! 221: int typ = 0;
! 222: union sigval sv;
! 223:
! 224: uvmexp.traps++;
! 225: p = curproc;
! 226: ucode = 0;
! 227:
! 228: /* I have verified that this DOES happen! -gwr */
! 229: if (p == NULL)
! 230: p = &proc0;
! 231: #ifdef DIAGNOSTIC
! 232: if (p->p_addr == NULL)
! 233: panic("trap: type 0x%x, code 0x%x, v 0x%x -- no pcb",
! 234: type, code, v);
! 235: #endif
! 236:
! 237: if (USERMODE(frame.f_sr)) {
! 238: type |= T_USER;
! 239: p->p_md.md_regs = frame.f_regs;
! 240: }
! 241:
! 242: switch (type) {
! 243: default:
! 244: dopanic:
! 245: printf("trap type %d, code = 0x%x, v = 0x%x\n", type, code, v);
! 246: printf("%s program counter = 0x%x\n",
! 247: (type & T_USER) ? "user" : "kernel", frame.f_pc);
! 248: /*
! 249: * Let the kernel debugger see the trap frame that
! 250: * caused us to panic. This is a convenience so
! 251: * one can see registers at the point of failure.
! 252: */
! 253: s = splhigh();
! 254: #ifdef KGDB
! 255: /* If connected, step or cont returns 1 */
! 256: if (kgdb_trap(type, (db_regs_t *)&frame))
! 257: goto kgdb_cont;
! 258: #endif
! 259: #ifdef DDB
! 260: (void)kdb_trap(type, (db_regs_t *)&frame);
! 261: #endif
! 262: #ifdef KGDB
! 263: kgdb_cont:
! 264: #endif
! 265: splx(s);
! 266: if (panicstr) {
! 267: printf("trap during panic!\n");
! 268: #ifdef DEBUG
! 269: /* XXX should be a machine-dependent hook */
! 270: printf("(press a key)\n"); (void)cngetc();
! 271: #endif
! 272: }
! 273: regdump(&(frame.F_t), 128);
! 274: type &= ~T_USER;
! 275: if ((u_int)type < trap_types)
! 276: panic(trap_type[type]);
! 277: panic("trap");
! 278:
! 279: case T_BUSERR: /* Kernel bus error */
! 280: if (!p->p_addr->u_pcb.pcb_onfault)
! 281: goto dopanic;
! 282: /*
! 283: * If we have arranged to catch this fault in any of the
! 284: * copy to/from user space routines, set PC to return to
! 285: * indicated location and set flag informing buserror code
! 286: * that it may need to clean up stack frame.
! 287: */
! 288: copyfault:
! 289: frame.f_stackadj = exframesize[frame.f_format];
! 290: frame.f_format = frame.f_vector = 0;
! 291: frame.f_pc = (int)p->p_addr->u_pcb.pcb_onfault;
! 292: return;
! 293:
! 294: case T_BUSERR|T_USER: /* Bus error */
! 295: typ = BUS_OBJERR;
! 296: ucode = code & ~T_USER;
! 297: i = SIGBUS;
! 298: break;
! 299: case T_ADDRERR|T_USER: /* Address error */
! 300: typ = BUS_ADRALN;
! 301: ucode = code & ~T_USER;
! 302: i = SIGBUS;
! 303: break;
! 304:
! 305: case T_ILLINST|T_USER: /* Illegal instruction fault */
! 306: ucode = frame.f_format; /* XXX was ILL_PRIVIN_FAULT */
! 307: typ = ILL_ILLOPC;
! 308: i = SIGILL;
! 309: v = frame.f_pc;
! 310: break;
! 311:
! 312: case T_PRIVINST|T_USER: /* Privileged instruction fault */
! 313: ucode = frame.f_format; /* XXX was ILL_PRIVIN_FAULT */
! 314: typ = ILL_PRVOPC;
! 315: i = SIGILL;
! 316: v = frame.f_pc;
! 317: break;
! 318: /*
! 319: * divde by zero, CHK/TRAPV inst
! 320: */
! 321: case T_ZERODIV|T_USER: /* Divide by zero trap */
! 322: ucode = frame.f_format;
! 323: typ = FPE_INTDIV;
! 324: i = SIGFPE;
! 325: v = frame.f_pc;
! 326: break;
! 327:
! 328: case T_CHKINST|T_USER: /* CHK instruction trap */
! 329: ucode = frame.f_format;
! 330: type = FPE_FLTSUB;
! 331: i = SIGFPE;
! 332: v = frame.f_pc;
! 333: break;
! 334:
! 335: case T_TRAPVINST|T_USER: /* TRAPV instruction trap */
! 336: ucode = frame.f_format;
! 337: typ = ILL_ILLTRP;
! 338: i = SIGILL;
! 339: v = frame.f_pc;
! 340: break;
! 341: /*
! 342: * User coprocessor violation
! 343: */
! 344: case T_COPERR|T_USER:
! 345: typ = ILL_COPROC;
! 346: ucode = 0;
! 347: i = SIGILL;
! 348: break;
! 349: /*
! 350: * 6888x exceptions
! 351: */
! 352: case T_FPERR|T_USER:
! 353: typ = FPE_FLTRES;
! 354: ucode = code;
! 355: i = SIGFPE;
! 356: v = frame.f_pc;
! 357: break;
! 358:
! 359: /*
! 360: * FPU faults in supervisor mode.
! 361: */
! 362: case T_ILLINST: /* fnop generates this, apparently. */
! 363: case T_FPEMULI:
! 364: case T_FPEMULD: {
! 365: extern label_t *nofault;
! 366:
! 367: if (nofault) /* If we're probing. */
! 368: longjmp(nofault);
! 369: if (type == T_ILLINST)
! 370: printf("Kernel Illegal Instruction trap.\n");
! 371: else
! 372: printf("Kernel FPU trap.\n");
! 373: goto dopanic;
! 374: }
! 375:
! 376: /*
! 377: * Unimplemented FPU instructions/datatypes.
! 378: */
! 379: case T_FPEMULI|T_USER:
! 380: case T_FPEMULD|T_USER:
! 381: #ifdef FPU_EMULATE
! 382: i = fpu_emulate(&frame, &p->p_addr->u_pcb.pcb_fpregs,
! 383: &typ);
! 384: /* XXX -- deal with tracing? (frame.f_sr & PSL_T) */
! 385: if (i == 0)
! 386: goto out;
! 387: #else
! 388: uprintf("pid %d killed: no floating point support.\n",
! 389: p->p_pid);
! 390: i = SIGILL;
! 391: typ = ILL_COPROC;
! 392: #endif
! 393: ucode = frame.f_format;
! 394: v = frame.f_pc;
! 395: break;
! 396:
! 397: case T_COPERR: /* Kernel coprocessor violation */
! 398: case T_FMTERR: /* Kernel format error */
! 399: case T_FMTERR|T_USER: /* User format error */
! 400: /*
! 401: * The user has most likely trashed the RTE or FP state info
! 402: * in the stack frame of a signal handler.
! 403: */
! 404: printf("pid %d: kernel %s exception\n", p->p_pid,
! 405: type==T_COPERR ? "coprocessor" : "format");
! 406: type |= T_USER;
! 407: p->p_sigacts->ps_sigact[SIGILL] = SIG_DFL;
! 408: i = sigmask(SIGILL);
! 409: p->p_sigignore &= ~i;
! 410: p->p_sigcatch &= ~i;
! 411: p->p_sigmask &= ~i;
! 412: i = SIGILL;
! 413: ucode = frame.f_format; /* XXX was ILL_RESAD_FAULT */
! 414: typ = ILL_COPROC;
! 415: v = frame.f_pc;
! 416: break;
! 417:
! 418: /*
! 419: * XXX: Trace traps are a nightmare.
! 420: *
! 421: * HP-UX uses trap #1 for breakpoints,
! 422: * OpenBSD/m68k uses trap #2,
! 423: * SUN 3.x uses trap #15,
! 424: * DDB and KGDB uses trap #15 (for kernel breakpoints;
! 425: * handled elsewhere).
! 426: *
! 427: * OpenBSD and HP-UX traps both get mapped by locore.s into T_TRACE.
! 428: * SUN 3.x traps get passed through as T_TRAP15 and are not really
! 429: * supported yet.
! 430: *
! 431: * XXX: We should never get kernel-mode T_TRACE or T_TRAP15
! 432: * XXX: because locore.s now gives them special treatment.
! 433: */
! 434: case T_TRAP15: /* kernel breakpoint */
! 435: frame.f_sr &= ~PSL_T;
! 436: return;
! 437:
! 438: case T_TRACE|T_USER: /* user trace trap */
! 439: #ifdef COMPAT_SUNOS
! 440: /*
! 441: * SunOS uses Trap #2 for a "CPU cache flush"
! 442: * Just flush the on-chip caches and return.
! 443: * XXX - Too bad OpenBSD uses trap 2...
! 444: */
! 445: if (p->p_emul == &emul_sunos) {
! 446: ICIA();
! 447: DCIU();
! 448: /* get out fast */
! 449: return;
! 450: }
! 451: #endif
! 452: /* FALLTHROUGH */
! 453: case T_TRACE: /* Kernel trace trap */
! 454: case T_TRAP15|T_USER: /* Sun user trace trap */
! 455: frame.f_sr &= ~PSL_T;
! 456: i = SIGTRAP;
! 457: typ = TRAP_TRACE;
! 458: break;
! 459:
! 460: case T_ASTFLT: /* System async trap, cannot happen */
! 461: goto dopanic;
! 462:
! 463: case T_ASTFLT|T_USER: /* User async trap. */
! 464: astpending = 0;
! 465: /*
! 466: * We check for software interrupts first. This is because
! 467: * they are at a higher level than ASTs, and on a VAX would
! 468: * interrupt the AST. We assume that if we are processing
! 469: * an AST that we must be at IPL0 so we don't bother to
! 470: * check. Note that we ensure that we are at least at SIR
! 471: * IPL while processing the SIR.
! 472: */
! 473: splsoft();
! 474: /* FALLTHROUGH */
! 475:
! 476: case T_SSIR: /* Software interrupt */
! 477: case T_SSIR|T_USER:
! 478: if (ssir & SIR_SERIAL) {
! 479: void zssoft(int);
! 480: siroff(SIR_SERIAL);
! 481: uvmexp.softs++;
! 482: zssoft(0);
! 483: }
! 484: if (ssir & SIR_NET) {
! 485: void netintr(void);
! 486: siroff(SIR_NET);
! 487: uvmexp.softs++;
! 488: netintr();
! 489: }
! 490: if (ssir & SIR_CLOCK) {
! 491: void softclock(void);
! 492: siroff(SIR_CLOCK);
! 493: uvmexp.softs++;
! 494: softclock();
! 495: }
! 496: if (ssir & SIR_ADB) {
! 497: void adb_soft_intr(void);
! 498: siroff(SIR_ADB);
! 499: uvmexp.softs++;
! 500: adb_soft_intr();
! 501: }
! 502: /*
! 503: * If this was not an AST trap, we are all done.
! 504: */
! 505: if (type != (T_ASTFLT|T_USER)) {
! 506: uvmexp.traps--;
! 507: return;
! 508: }
! 509: spl0();
! 510: if (p->p_flag & P_OWEUPC) {
! 511: ADDUPROF(p);
! 512: }
! 513: if (type == (T_ASTFLT | T_USER) && want_resched) {
! 514: preempt(NULL);
! 515: }
! 516: goto out;
! 517:
! 518: case T_MMUFLT: /* Kernel mode page fault */
! 519: case T_MMUFLT|T_USER: /* page fault */
! 520: {
! 521: vaddr_t va;
! 522: struct vmspace *vm = p->p_vmspace;
! 523: struct vm_map *map;
! 524: int rv;
! 525: vm_prot_t ftype, vftype;
! 526: extern struct vm_map *kernel_map;
! 527:
! 528: #ifdef DEBUG
! 529: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
! 530: printf("trap: T_MMUFLT pid=%d, code=%x, v=%x, pc=%x, sr=%x\n",
! 531: p->p_pid, code, v, frame.f_pc, frame.f_sr);
! 532: #endif
! 533: /*
! 534: * It is only a kernel address space fault iff:
! 535: * 1. (type & T_USER) == 0 and
! 536: * 2. pcb_onfault not set or
! 537: * 3. pcb_onfault set but supervisor data fault
! 538: * The last can occur during an exec() copyin where the
! 539: * argument space is lazy-allocated.
! 540: */
! 541: if ((type & T_USER) == 0 &&
! 542: (!p->p_addr->u_pcb.pcb_onfault || KDFAULT(code)))
! 543: map = kernel_map;
! 544: else
! 545: map = vm ? &vm->vm_map : kernel_map;
! 546:
! 547: if (WRFAULT(code)) {
! 548: vftype = VM_PROT_WRITE;
! 549: ftype = VM_PROT_READ | VM_PROT_WRITE;
! 550: }
! 551: else
! 552: vftype = ftype = VM_PROT_READ;
! 553:
! 554: va = trunc_page((vaddr_t)v);
! 555:
! 556: if (map == kernel_map && va == 0) {
! 557: printf("trap: bad kernel %s access at 0x%x\n",
! 558: (ftype & VM_PROT_WRITE) ? "read/write" : "read", v);
! 559: goto dopanic;
! 560: }
! 561: rv = uvm_fault(map, va, 0, ftype);
! 562: #ifdef DEBUG
! 563: if (rv && MDB_ISPID(p->p_pid))
! 564: printf("uvm_fault(%p, 0x%lx, 0, 0x%x) -> 0x%x\n",
! 565: map, va, ftype, rv);
! 566: #endif
! 567: /*
! 568: * If this was a stack access, we keep track of the maximum
! 569: * accessed stack size. Also, if vm_fault gets a protection
! 570: * failure, it is due to accessing the stack region outside
! 571: * the current limit and we need to reflect that as an access
! 572: * error.
! 573: */
! 574: if ((vm != NULL && (caddr_t)va >= vm->vm_maxsaddr)
! 575: && map != kernel_map) {
! 576: if (rv == 0)
! 577: uvm_grow(p, va);
! 578: else if (rv == EACCES)
! 579: rv = EFAULT;
! 580: }
! 581: if (rv == 0) {
! 582: if (type == T_MMUFLT) {
! 583: #if defined(M68040)
! 584: if (mmutype == MMU_68040)
! 585: (void)writeback(&frame);
! 586: #endif
! 587: return;
! 588: }
! 589: goto out;
! 590: }
! 591: if (type == T_MMUFLT) {
! 592: if (p->p_addr->u_pcb.pcb_onfault)
! 593: goto copyfault;
! 594: printf("uvm_fault(%p, 0x%lx, 0, 0x%x) -> 0x%x\n",
! 595: map, va, ftype, rv);
! 596: printf(" type %x, code [mmu,,ssw]: %x\n",
! 597: type, code);
! 598: goto dopanic;
! 599: }
! 600: frame.f_pad = code & 0xffff;
! 601: ucode = vftype;
! 602: typ = SEGV_MAPERR;
! 603: i = SIGSEGV;
! 604: break;
! 605: }
! 606: }
! 607: sv.sival_ptr = (void *)v;
! 608: trapsignal(p, i, ucode, typ, sv);
! 609: out:
! 610: if ((type & T_USER) == 0)
! 611: return;
! 612: #ifdef M68040
! 613: wb_userret(p, &frame);
! 614: #else
! 615: userret(p);
! 616: #endif
! 617: }
! 618:
! 619: #if defined(M68040)
! 620: #ifdef DEBUG
! 621: struct writebackstats {
! 622: int calls;
! 623: int cpushes;
! 624: int move16s;
! 625: int wb1s, wb2s, wb3s;
! 626: int wbsize[4];
! 627: } wbstats;
! 628:
! 629: char *f7sz[] = { "longword", "byte", "word", "line" };
! 630: char *f7tt[] = { "normal", "MOVE16", "AFC", "ACK" };
! 631: char *f7tm[] = { "d-push", "u-data", "u-code", "M-data",
! 632: "M-code", "k-data", "k-code", "RES" };
! 633: char wberrstr[] =
! 634: "WARNING: pid %d(%s) writeback [%s] failed, pc=%x fa=%x wba=%x wbd=%x\n";
! 635: #endif
! 636:
! 637: int
! 638: writeback(struct frame *fp)
! 639: {
! 640: struct fmt7 *f = &fp->f_fmt7;
! 641: struct proc *p = curproc;
! 642: int err = 0;
! 643: u_int fa;
! 644: paddr_t pa;
! 645: caddr_t oonfault = p->p_addr->u_pcb.pcb_onfault;
! 646:
! 647: #ifdef DEBUG
! 648: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid)) {
! 649: printf(" pid=%d, fa=%x,", p->p_pid, f->f_fa);
! 650: dumpssw(f->f_ssw);
! 651: }
! 652: wbstats.calls++;
! 653: #endif
! 654: /*
! 655: * Deal with special cases first.
! 656: */
! 657: if ((f->f_ssw & SSW4_TMMASK) == SSW4_TMDCP) {
! 658: /*
! 659: * Dcache push fault.
! 660: * Line-align the address and write out the push data to
! 661: * the indicated physical address.
! 662: */
! 663: #ifdef DEBUG
! 664: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid)) {
! 665: printf(" pushing %s to PA %x, data %x",
! 666: f7sz[(f->f_ssw & SSW4_SZMASK) >> 5],
! 667: f->f_fa, f->f_pd0);
! 668: if ((f->f_ssw & SSW4_SZMASK) == SSW4_SZLN)
! 669: printf("/%x/%x/%x",
! 670: f->f_pd1, f->f_pd2, f->f_pd3);
! 671: printf("\n");
! 672: }
! 673: if (f->f_wb1s & SSW4_WBSV)
! 674: panic("writeback: cache push with WB1S valid");
! 675: wbstats.cpushes++;
! 676: #endif
! 677: /*
! 678: * XXX there are security problems if we attempt to do a
! 679: * cache push after a signal handler has been called.
! 680: */
! 681: pmap_kenter_pa((vaddr_t)vmmap,
! 682: trunc_page((vaddr_t)f->f_fa), VM_PROT_WRITE);
! 683: pmap_update(pmap_kernel());
! 684: fa = (u_int)&vmmap[m68k_page_offset(f->f_fa) & ~0x000f];
! 685: bcopy((caddr_t)&f->f_pd0, (caddr_t)fa, 16);
! 686: pmap_extract(pmap_kernel(), (vaddr_t)fa, &pa);
! 687: DCFL(pa);
! 688: pmap_kremove((vaddr_t)vmmap, PAGE_SIZE);
! 689: pmap_update(pmap_kernel());
! 690: } else if ((f->f_ssw & (SSW4_RW|SSW4_TTMASK)) == SSW4_TTM16) {
! 691: /*
! 692: * MOVE16 fault.
! 693: * Line-align the address and write out the push data to
! 694: * the indicated virtual address.
! 695: */
! 696: #ifdef DEBUG
! 697: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
! 698: printf(" MOVE16 to VA %x(%x), data %x/%x/%x/%x\n",
! 699: f->f_fa, f->f_fa & ~0xF, f->f_pd0, f->f_pd1,
! 700: f->f_pd2, f->f_pd3);
! 701: if (f->f_wb1s & SSW4_WBSV)
! 702: panic("writeback: MOVE16 with WB1S valid");
! 703: wbstats.move16s++;
! 704: #endif
! 705: if (KDFAULT(f->f_wb1s))
! 706: bcopy((caddr_t)&f->f_pd0, (caddr_t)(f->f_fa & ~0xF), 16);
! 707: else
! 708: err = suline((caddr_t)(f->f_fa & ~0xF), (caddr_t)&f->f_pd0);
! 709: if (err) {
! 710: fa = f->f_fa & ~0xF;
! 711: #ifdef DEBUG
! 712: if (mmudebug & MDB_WBFAILED)
! 713: printf(wberrstr, p->p_pid, p->p_comm,
! 714: "MOVE16", fp->f_pc, f->f_fa,
! 715: f->f_fa & ~0xF, f->f_pd0);
! 716: #endif
! 717: }
! 718: } else if (f->f_wb1s & SSW4_WBSV) {
! 719: /*
! 720: * Writeback #1.
! 721: * Position the "memory-aligned" data and write it out.
! 722: */
! 723: u_int wb1d = f->f_wb1d;
! 724: int off;
! 725:
! 726: #ifdef DEBUG
! 727: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
! 728: dumpwb(1, f->f_wb1s, f->f_wb1a, f->f_wb1d);
! 729: wbstats.wb1s++;
! 730: wbstats.wbsize[(f->f_wb2s&SSW4_SZMASK)>>5]++;
! 731: #endif
! 732: off = (f->f_wb1a & 3) * 8;
! 733: switch (f->f_wb1s & SSW4_SZMASK) {
! 734: case SSW4_SZLW:
! 735: if (off)
! 736: wb1d = (wb1d >> (32 - off)) | (wb1d << off);
! 737: if (KDFAULT(f->f_wb1s))
! 738: *(long *)f->f_wb1a = wb1d;
! 739: else
! 740: err = copyout(&wb1d, (caddr_t)f->f_wb1a,
! 741: sizeof(int));
! 742: break;
! 743: case SSW4_SZB:
! 744: off = 24 - off;
! 745: if (off)
! 746: wb1d >>= off;
! 747: if (KDFAULT(f->f_wb1s))
! 748: *(char *)f->f_wb1a = wb1d;
! 749: else {
! 750: char tmp = wb1d;
! 751:
! 752: err = copyout(&tmp, (caddr_t)f->f_wb1a,
! 753: sizeof(char));
! 754: }
! 755: break;
! 756: case SSW4_SZW:
! 757: off = (off + 16) % 32;
! 758: if (off)
! 759: wb1d = (wb1d >> (32 - off)) | (wb1d << off);
! 760: if (KDFAULT(f->f_wb1s))
! 761: *(short *)f->f_wb1a = wb1d;
! 762: else {
! 763: short tmp = wb1d;
! 764:
! 765: err = copyout(&tmp, (caddr_t)f->f_wb1a,
! 766: sizeof(short));
! 767: }
! 768: break;
! 769: }
! 770: if (err) {
! 771: fa = f->f_wb1a;
! 772: #ifdef DEBUG
! 773: if (mmudebug & MDB_WBFAILED)
! 774: printf(wberrstr, p->p_pid, p->p_comm,
! 775: "#1", fp->f_pc, f->f_fa,
! 776: f->f_wb1a, f->f_wb1d);
! 777: #endif
! 778: }
! 779: }
! 780: /*
! 781: * Deal with the "normal" writebacks.
! 782: *
! 783: * XXX writeback2 is known to reflect a LINE size writeback after
! 784: * a MOVE16 was already dealt with above. Ignore it.
! 785: */
! 786: if (err == 0 && (f->f_wb2s & SSW4_WBSV) &&
! 787: (f->f_wb2s & SSW4_SZMASK) != SSW4_SZLN) {
! 788: #ifdef DEBUG
! 789: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
! 790: dumpwb(2, f->f_wb2s, f->f_wb2a, f->f_wb2d);
! 791: wbstats.wb2s++;
! 792: wbstats.wbsize[(f->f_wb2s&SSW4_SZMASK)>>5]++;
! 793: #endif
! 794: switch (f->f_wb2s & SSW4_SZMASK) {
! 795: case SSW4_SZLW:
! 796: if (KDFAULT(f->f_wb2s))
! 797: *(long *)f->f_wb2a = f->f_wb2d;
! 798: else
! 799: err = copyout(&f->f_wb2d, (caddr_t)f->f_wb2a,
! 800: sizeof(int));
! 801: break;
! 802: case SSW4_SZB:
! 803: if (KDFAULT(f->f_wb2s))
! 804: *(char *)f->f_wb2a = f->f_wb2d;
! 805: else {
! 806: char tmp = f->f_wb2d;
! 807:
! 808: err = copyout(&tmp, (caddr_t)f->f_wb2a,
! 809: sizeof(char));
! 810: }
! 811: break;
! 812: case SSW4_SZW:
! 813: if (KDFAULT(f->f_wb2s))
! 814: *(short *)f->f_wb2a = f->f_wb2d;
! 815: else {
! 816: short tmp = f->f_wb2d;
! 817:
! 818: err = copyout(&tmp, (caddr_t)f->f_wb2a,
! 819: sizeof(short));
! 820: }
! 821: break;
! 822: }
! 823: if (err) {
! 824: fa = f->f_wb2a;
! 825: #ifdef DEBUG
! 826: if (mmudebug & MDB_WBFAILED) {
! 827: printf(wberrstr, p->p_pid, p->p_comm,
! 828: "#2", fp->f_pc, f->f_fa,
! 829: f->f_wb2a, f->f_wb2d);
! 830: dumpssw(f->f_ssw);
! 831: dumpwb(2, f->f_wb2s, f->f_wb2a, f->f_wb2d);
! 832: }
! 833: #endif
! 834: }
! 835: }
! 836: if (err == 0 && (f->f_wb3s & SSW4_WBSV)) {
! 837: #ifdef DEBUG
! 838: if ((mmudebug & MDB_WBFOLLOW) || MDB_ISPID(p->p_pid))
! 839: dumpwb(3, f->f_wb3s, f->f_wb3a, f->f_wb3d);
! 840: wbstats.wb3s++;
! 841: wbstats.wbsize[(f->f_wb3s&SSW4_SZMASK)>>5]++;
! 842: #endif
! 843: switch (f->f_wb3s & SSW4_SZMASK) {
! 844: case SSW4_SZLW:
! 845: if (KDFAULT(f->f_wb3s))
! 846: *(long *)f->f_wb3a = f->f_wb3d;
! 847: else
! 848: err = copyout(&f->f_wb3d, (caddr_t)f->f_wb3a,
! 849: sizeof(int));
! 850: break;
! 851: case SSW4_SZB:
! 852: if (KDFAULT(f->f_wb3s))
! 853: *(char *)f->f_wb3a = f->f_wb3d;
! 854: else {
! 855: char tmp = f->f_wb3d;
! 856:
! 857: err = copyout(&tmp, (caddr_t)f->f_wb3a,
! 858: sizeof(char));
! 859: }
! 860: break;
! 861: case SSW4_SZW:
! 862: if (KDFAULT(f->f_wb3s))
! 863: *(short *)f->f_wb3a = f->f_wb3d;
! 864: else {
! 865: short tmp = f->f_wb3d;
! 866:
! 867: err = copyout(&tmp, (caddr_t)f->f_wb3a,
! 868: sizeof(short));
! 869: }
! 870: break;
! 871: #ifdef DEBUG
! 872: case SSW4_SZLN:
! 873: panic("writeback: wb3s indicates LINE write");
! 874: #endif
! 875: }
! 876: if (err) {
! 877: fa = f->f_wb3a;
! 878: #ifdef DEBUG
! 879: if (mmudebug & MDB_WBFAILED)
! 880: printf(wberrstr, p->p_pid, p->p_comm,
! 881: "#3", fp->f_pc, f->f_fa,
! 882: f->f_wb3a, f->f_wb3d);
! 883: #endif
! 884: }
! 885: }
! 886: p->p_addr->u_pcb.pcb_onfault = oonfault;
! 887: /*
! 888: * Any problems are SIGSEGV's
! 889: */
! 890: if (err)
! 891: err = SIGSEGV;
! 892: return (err);
! 893: }
! 894:
! 895: #ifdef DEBUG
! 896: void
! 897: dumpssw(ssw)
! 898: u_short ssw;
! 899: {
! 900: printf(" SSW: %x: ", ssw);
! 901: if (ssw & SSW4_CP)
! 902: printf("CP,");
! 903: if (ssw & SSW4_CU)
! 904: printf("CU,");
! 905: if (ssw & SSW4_CT)
! 906: printf("CT,");
! 907: if (ssw & SSW4_CM)
! 908: printf("CM,");
! 909: if (ssw & SSW4_MA)
! 910: printf("MA,");
! 911: if (ssw & SSW4_ATC)
! 912: printf("ATC,");
! 913: if (ssw & SSW4_LK)
! 914: printf("LK,");
! 915: if (ssw & SSW4_RW)
! 916: printf("RW,");
! 917: printf(" SZ=%s, TT=%s, TM=%s\n",
! 918: f7sz[(ssw & SSW4_SZMASK) >> 5],
! 919: f7tt[(ssw & SSW4_TTMASK) >> 3],
! 920: f7tm[ssw & SSW4_TMMASK]);
! 921: }
! 922:
! 923: void
! 924: dumpwb(num, s, a, d)
! 925: int num;
! 926: u_short s;
! 927: u_int a, d;
! 928: {
! 929: struct proc *p = curproc;
! 930: paddr_t pa;
! 931: int tmp;
! 932:
! 933: printf(" writeback #%d: VA %x, data %x, SZ=%s, TT=%s, TM=%s\n",
! 934: num, a, d, f7sz[(s & SSW4_SZMASK) >> 5],
! 935: f7tt[(s & SSW4_TTMASK) >> 3], f7tm[s & SSW4_TMMASK]);
! 936: printf(" PA ");
! 937: if (pmap_extract(p->p_vmspace->vm_map.pmap, (vaddr_t)a, &pa) == FALSE)
! 938: printf("<invalid address>");
! 939: else {
! 940: if (copyin((caddr_t)a, &tmp, sizeof(int)) == 0)
! 941: printf("%lx, current value %lx", pa, tmp);
! 942: else
! 943: printf("%lx, current value inaccessible", pa);
! 944: }
! 945: printf("\n");
! 946: }
! 947: #endif
! 948: #endif
! 949:
! 950: /*
! 951: * Process a system call.
! 952: */
! 953: void
! 954: syscall(code, frame)
! 955: register_t code;
! 956: struct frame frame;
! 957: {
! 958: caddr_t params;
! 959: struct sysent *callp;
! 960: struct proc *p;
! 961: int error, opc, nsys;
! 962: size_t argsize;
! 963: register_t args[8], rval[2];
! 964:
! 965: uvmexp.syscalls++;
! 966: if (!USERMODE(frame.f_sr))
! 967: panic("syscall");
! 968: p = curproc;
! 969: p->p_md.md_regs = frame.f_regs;
! 970: opc = frame.f_pc;
! 971:
! 972: nsys = p->p_emul->e_nsysent;
! 973: callp = p->p_emul->e_sysent;
! 974:
! 975: #ifdef COMPAT_SUNOS
! 976: if (p->p_emul == &emul_sunos) {
! 977: /*
! 978: * SunOS passes the syscall-number on the stack, whereas
! 979: * BSD passes it in D0. So, we have to get the real "code"
! 980: * from the stack, and clean up the stack, as SunOS glue
! 981: * code assumes the kernel pops the syscall argument the
! 982: * glue pushed on the stack. Sigh...
! 983: */
! 984: if (copyin((caddr_t)frame.f_regs[SP], &code,
! 985: sizeof(register_t)) != 0)
! 986: code = -1;
! 987:
! 988: /*
! 989: * XXX
! 990: * Don't do this for sunos_sigreturn, as there's no stored pc
! 991: * on the stack to skip, the argument follows the syscall
! 992: * number without a gap.
! 993: */
! 994: if (code != SUNOS_SYS_sigreturn) {
! 995: frame.f_regs[SP] += sizeof (int);
! 996: /*
! 997: * remember that we adjusted the SP,
! 998: * might have to undo this if the system call
! 999: * returns ERESTART.
! 1000: */
! 1001: p->p_md.md_flags |= MDP_STACKADJ;
! 1002: } else
! 1003: p->p_md.md_flags &= ~MDP_STACKADJ;
! 1004: }
! 1005: #endif
! 1006:
! 1007: params = (caddr_t)frame.f_regs[SP] + sizeof(int);
! 1008:
! 1009: switch (code) {
! 1010: case SYS_syscall:
! 1011: /*
! 1012: * Code is first argument, followed by actual args.
! 1013: */
! 1014: if (copyin(params, &code, sizeof(register_t)) != 0)
! 1015: code = -1;
! 1016: params += sizeof(int);
! 1017: /*
! 1018: * XXX sigreturn requires special stack manipulation
! 1019: * that is only done if entered via the sigreturn
! 1020: * trap. Cannot allow here, so make sure we fail.
! 1021: */
! 1022: if (code == SYS_sigreturn)
! 1023: code = nsys;
! 1024: break;
! 1025: case SYS___syscall:
! 1026: /*
! 1027: * Like syscall, but code is a quad, so as to maintain
! 1028: * quad alignment for the rest of the arguments.
! 1029: */
! 1030: if (callp != sysent)
! 1031: break;
! 1032: if (copyin(params + _QUAD_LOWWORD * sizeof(int), &code,
! 1033: sizeof(register_t)) != 0)
! 1034: code = -1;
! 1035: params += sizeof(quad_t);
! 1036: break;
! 1037: default:
! 1038: break;
! 1039: }
! 1040: if (code < 0 || code >= nsys)
! 1041: callp += p->p_emul->e_nosys; /* illegal */
! 1042: else
! 1043: callp += code;
! 1044: argsize = callp->sy_argsize;
! 1045: if (argsize)
! 1046: error = copyin(params, (caddr_t)args, argsize);
! 1047: else
! 1048: error = 0;
! 1049: #ifdef SYSCALL_DEBUG
! 1050: scdebug_call(p, code, args);
! 1051: #endif
! 1052: #ifdef KTRACE
! 1053: if (KTRPOINT(p, KTR_SYSCALL))
! 1054: ktrsyscall(p, code, argsize, args);
! 1055: #endif
! 1056: if (error)
! 1057: goto bad;
! 1058: rval[0] = 0;
! 1059: rval[1] = frame.f_regs[D1];
! 1060: #if NSYSTRACE > 0
! 1061: if (ISSET(p->p_flag, P_SYSTRACE))
! 1062: error = systrace_redirect(code, p, args, rval);
! 1063: else
! 1064: #endif
! 1065: error = (*callp->sy_call)(p, args, rval);
! 1066: switch (error) {
! 1067: case 0:
! 1068: frame.f_regs[D0] = rval[0];
! 1069: frame.f_regs[D1] = rval[1];
! 1070: frame.f_sr &= ~PSL_C; /* carry bit */
! 1071: break;
! 1072: case ERESTART:
! 1073: /*
! 1074: * We always enter through a `trap' instruction, which is 2
! 1075: * bytes, so adjust the pc by that amount.
! 1076: */
! 1077: frame.f_pc = opc - 2;
! 1078: break;
! 1079: case EJUSTRETURN:
! 1080: /* nothing to do */
! 1081: break;
! 1082: default:
! 1083: bad:
! 1084: if (p->p_emul->e_errno)
! 1085: error = p->p_emul->e_errno[error];
! 1086: frame.f_regs[D0] = error;
! 1087: frame.f_sr |= PSL_C; /* carry bit */
! 1088: break;
! 1089: }
! 1090:
! 1091: #ifdef SYSCALL_DEBUG
! 1092: scdebug_ret(p, code, error, rval);
! 1093: #endif
! 1094: #ifdef COMPAT_SUNOS
! 1095: /* need new p-value for this */
! 1096: if (error == ERESTART && (p->p_md.md_flags & MDP_STACKADJ))
! 1097: frame.f_regs[SP] -= sizeof (int);
! 1098: #endif
! 1099: userret(p);
! 1100: #ifdef KTRACE
! 1101: if (KTRPOINT(p, KTR_SYSRET))
! 1102: ktrsysret(p, code, error, rval[0]);
! 1103: #endif
! 1104: }
CVSweb