[BACK]Return to trap.c CVS log [TXT][DIR] Up to [local] / sys / arch / mvme68k / mvme68k

Annotation of sys/arch/mvme68k/mvme68k/trap.c, Revision 1.1

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

CVSweb