131908Skarels /* 2*31909Skarels * @(#)if_dmv.c 7.2 (Berkeley) 07/20/87 331908Skarels * DMV-11 Driver 431908Skarels * 531908Skarels * Qbus Sync DDCMP interface - DMV operated in full duplex, point to point mode 631908Skarels * 731908Skarels * Derived from 4.3 release if_dmv.c rev. 6.12 dated 4/23/86 831908Skarels * (which wasn't the 4.3 release!) 931908Skarels * 1031908Skarels * Bob Kridle 1131908Skarels * mt Xinu 1231908Skarels */ 1331908Skarels 1431908Skarels #include "dmv.h" 1531908Skarels #if NDMV > 0 1631908Skarels 1731908Skarels 1831908Skarels #include "../machine/pte.h" 1931908Skarels 2031908Skarels #include "param.h" 2131908Skarels #include "systm.h" 2231908Skarels #include "mbuf.h" 2331908Skarels #include "buf.h" 2431908Skarels #include "ioctl.h" /* must precede tty.h */ 2531908Skarels #include "tty.h" 2631908Skarels #include "protosw.h" 2731908Skarels #include "socket.h" 2831908Skarels #include "syslog.h" 2931908Skarels #include "vmmac.h" 3031908Skarels #include "errno.h" 3131908Skarels 3231908Skarels #include "../net/if.h" 3331908Skarels #include "../net/netisr.h" 3431908Skarels #include "../net/route.h" 3531908Skarels 3631908Skarels #ifdef INET 3731908Skarels #include "../netinet/in.h" 3831908Skarels #include "../netinet/in_systm.h" 3931908Skarels #include "../netinet/in_var.h" 4031908Skarels #include "../netinet/ip.h" 4131908Skarels #endif 4231908Skarels 4331908Skarels #include "../vax/cpu.h" 4431908Skarels #include "../vax/mtpr.h" 4531908Skarels #include "if_uba.h" 4631908Skarels #include "if_dmv.h" 4731908Skarels #include "../vaxuba/ubareg.h" 4831908Skarels #include "../vaxuba/ubavar.h" 4931908Skarels 5031908Skarels #include "../h/time.h" 5131908Skarels #include "../h/kernel.h" 5231908Skarels 5331908Skarels int dmvtimer; /* timer started? */ 5431908Skarels int dmv_timeout = 8; /* timeout value */ 5531908Skarels int dmvwatch(); 5631908Skarels 5731908Skarels /* 5831908Skarels * Driver information for auto-configuration stuff. 5931908Skarels */ 6031908Skarels int dmvprobe(), dmvattach(), dmvinit(), dmvioctl(); 6131908Skarels int dmvoutput(), dmvreset(); 6231908Skarels struct uba_device *dmvinfo[NDMV]; 6331908Skarels u_short dmvstd[] = { 0 }; 6431908Skarels struct uba_driver dmvdriver = 6531908Skarels { dmvprobe, 0, dmvattach, 0, dmvstd, "dmv", dmvinfo }; 6631908Skarels 6731908Skarels /* 6831908Skarels * Don't really know how many buffers/commands can be queued to a DMV-11. 6931908Skarels * Manual doesn't say... Perhaps we can look at a DEC driver some day. 7031908Skarels * These numbers ame from DMV/DMR driver. 7131908Skarels */ 7231908Skarels #define NRCV 5 7331908Skarels #define NXMT 3 7431908Skarels #define NCMDS (NRCV+NXMT+4) /* size of command queue */ 7531908Skarels 7631908Skarels #define printd if (sc->sc_if.if_flags & IFF_DEBUG) \ 7731908Skarels printf("DMVDEBUG: dmv%d: ", unit), printf 7831908Skarels 7931908Skarels /* error reporting intervals */ 8031908Skarels 8131908Skarels #define DMV_RPRTE 1 8231908Skarels #define DMV_RPTTE 1 8331908Skarels #define DMV_RPSTE 1 8431908Skarels #define DMV_RPNXM 1 8531908Skarels #define DMV_RPMODD 1 8631908Skarels #define DMV_RPQOVF 1 8731908Skarels #define DMV_RPCXRL 1 8831908Skarels 89*31909Skarels /* number of errors to accept before trying a reset */ 90*31909Skarels #define DMV_RPUNKNOWN 10 91*31909Skarels 9231908Skarels struct dmv_command { 9331908Skarels u_char qp_mask; /* Which registers to set up */ 9431908Skarels #define QP_TRIB 0x01 9531908Skarels #define QP_SEL4 0x02 9631908Skarels #define QP_SEL6 0x04 9731908Skarels #define QP_SEL10 0x08 9831908Skarels u_char qp_cmd; 9931908Skarels u_char qp_tributary; 10031908Skarels u_short qp_sel4; 10131908Skarels u_short qp_sel6; 10231908Skarels u_short qp_sel10; 10331908Skarels struct dmv_command *qp_next; /* next command on queue */ 10431908Skarels }; 10531908Skarels 10631908Skarels #define qp_lowbufaddr qp_ 10731908Skarels 10831908Skarels struct dmvbufs { 10931908Skarels int ubinfo; /* from uballoc */ 11031908Skarels short cc; /* buffer size */ 11131908Skarels short flags; /* access control */ 11231908Skarels }; 11331908Skarels 11431908Skarels #define DBUF_OURS 0 /* buffer is available */ 11531908Skarels #define DBUF_DMVS 1 /* buffer claimed by somebody */ 11631908Skarels #define DBUF_XMIT 4 /* transmit buffer */ 11731908Skarels #define DBUF_RCV 8 /* receive buffer */ 11831908Skarels 11931908Skarels 12031908Skarels /* 12131908Skarels * DMV software status per interface. 12231908Skarels * 12331908Skarels * Each interface is referenced by a network interface structure, 12431908Skarels * sc_if, which the routing code uses to locate the interface. 12531908Skarels * This structure contains the output queue for the interface, its address, ... 12631908Skarels * We also have, for each interface, a set of 7 UBA interface structures 12731908Skarels * for each, which 12831908Skarels * contain information about the UNIBUS resources held by the interface: 12931908Skarels * map registers, buffered data paths, etc. Information is cached in this 13031908Skarels * structure for use by the if_uba.c routines in running the interface 13131908Skarels * efficiently. 13231908Skarels */ 13331908Skarels struct dmv_softc { 13431908Skarels struct ifnet sc_if; /* network-visible interface */ 13531908Skarels struct dmvbufs sc_rbufs[NRCV]; /* receive buffer info */ 13631908Skarels struct dmvbufs sc_xbufs[NXMT]; /* transmit buffer info */ 13731908Skarels struct ifubinfo sc_ifuba; /* UNIBUS resources */ 13831908Skarels struct ifrw sc_ifr[NRCV]; /* UNIBUS receive buffer maps */ 13931908Skarels struct ifxmt sc_ifw[NXMT]; /* UNIBUS receive buffer maps */ 14031908Skarels short sc_oused; /* output buffers currently in use */ 14131908Skarels short sc_iused; /* input buffers given to DMV */ 14231908Skarels short sc_flag; /* flags */ 14331908Skarels int sc_nticks; /* seconds since last interrupt */ 14431908Skarels int sc_ubinfo; /* UBA mapping info for base table */ 14531908Skarels int sc_errors[8]; /* error counters */ 14631908Skarels #define sc_rte sc_errors[0] /* receive threshhold error */ 14731908Skarels #define sc_xte sc_errors[1] /* xmit threshhold error */ 14831908Skarels #define sc_ste sc_errors[2] /* select threshhold error */ 14931908Skarels #define sc_nxm sc_errors[3] /* non-existant memory */ 15031908Skarels #define sc_modd sc_errors[4] /* modem disconnect */ 15131908Skarels #define sc_qovf sc_errors[5] /* command/response queue overflow */ 15231908Skarels #define sc_cxrl sc_errors[6] /* carrier loss */ 15331908Skarels #define sc_unknown sc_errors[7] /* other errors - look in DMV manual */ 15431908Skarels /* command queue stuff */ 15531908Skarels struct dmv_command sc_cmdbuf[NCMDS]; 15631908Skarels struct dmv_command *sc_qhead; /* head of command queue */ 15731908Skarels struct dmv_command *sc_qtail; /* tail of command queue */ 15831908Skarels struct dmv_command *sc_qactive; /* command in progress */ 15931908Skarels struct dmv_command *sc_qfreeh; /* head of list of free cmd buffers */ 16031908Skarels struct dmv_command *sc_qfreet; /* tail of list of free cmd buffers */ 16131908Skarels /* end command queue stuff */ 16231908Skarels } dmv_softc[NDMV]; 16331908Skarels 16431908Skarels /* flags */ 16531908Skarels #define DMV_ALLOC 0x01 /* unibus resources allocated */ 16631908Skarels #define DMV_RESTART 0x04 /* software restart in progress */ 16731908Skarels #define DMV_ACTIVE 0x08 /* device active */ 16831908Skarels #define DMV_RUNNING 0x20 /* device initialized */ 16931908Skarels 17031908Skarels 17131908Skarels /* queue manipulation macros */ 17231908Skarels #define QUEUE_AT_HEAD(qp, head, tail) \ 17331908Skarels (qp)->qp_next = (head); \ 17431908Skarels (head) = (qp); \ 17531908Skarels if ((tail) == (struct dmv_command *) 0) \ 17631908Skarels (tail) = (head) 17731908Skarels 17831908Skarels #define QUEUE_AT_TAIL(qp, head, tail) \ 17931908Skarels if ((tail)) \ 18031908Skarels (tail)->qp_next = (qp); \ 18131908Skarels else \ 18231908Skarels (head) = (qp); \ 18331908Skarels (qp)->qp_next = (struct dmv_command *) 0; \ 18431908Skarels (tail) = (qp) 18531908Skarels 18631908Skarels #define DEQUEUE(head, tail) \ 18731908Skarels (head) = (head)->qp_next;\ 18831908Skarels if ((head) == (struct dmv_command *) 0)\ 18931908Skarels (tail) = (head) 19031908Skarels 19131908Skarels dmvprobe(reg) 19231908Skarels caddr_t reg; 19331908Skarels { 19431908Skarels register int br, cvec; 19531908Skarels register struct dmvdevice *addr = (struct dmvdevice *)reg; 19631908Skarels register int i; 19731908Skarels 19831908Skarels #ifdef lint 19931908Skarels br = 0; cvec = br; br = cvec; 20031908Skarels dmvrint(0); dmvxint(0); 20131908Skarels #endif 20231908Skarels addr->bsel1 = DMV_MCLR; 20331908Skarels for (i = 100000; i && (addr->bsel1 & DMV_RUN) == 0; i--) 20431908Skarels ; 20531908Skarels if ((addr->bsel1 & DMV_RUN) == 0) { 20631908Skarels printf("dmvprobe: can't start device\n" ); 20731908Skarels return (0); 20831908Skarels } 20931908Skarels if ((addr->bsel4 != 033) || (addr->bsel6 != 0305)) 21031908Skarels { 21131908Skarels printf("dmvprobe: device init failed, bsel4=%o, bsel6=%o\n", 21231908Skarels addr->bsel4, addr->bsel6); 21331908Skarels return (0); 21431908Skarels } 21531908Skarels addr->bsel0 = DMV_RQI|DMV_IEI|DMV_IEO; 21631908Skarels DELAY(1000000); 21731908Skarels addr->bsel1 = DMV_MCLR; 21831908Skarels for (i = 100000; i && (addr->bsel1 & DMV_RUN) == 0; i--) 21931908Skarels ; 22031908Skarels return (1); 22131908Skarels } 22231908Skarels 22331908Skarels /* 22431908Skarels * Interface exists: make available by filling in network interface 22531908Skarels * record. System will initialize the interface when it is ready 22631908Skarels * to accept packets. 22731908Skarels */ 22831908Skarels dmvattach(ui) 22931908Skarels register struct uba_device *ui; 23031908Skarels { 23131908Skarels register struct dmv_softc *sc = &dmv_softc[ui->ui_unit]; 23231908Skarels 23331908Skarels sc->sc_if.if_unit = ui->ui_unit; 23431908Skarels sc->sc_if.if_name = "dmv"; 23531908Skarels sc->sc_if.if_mtu = DMVMTU; 23631908Skarels sc->sc_if.if_init = dmvinit; 23731908Skarels sc->sc_if.if_output = dmvoutput; 23831908Skarels sc->sc_if.if_ioctl = dmvioctl; 23931908Skarels sc->sc_if.if_reset = dmvreset; 24031908Skarels sc->sc_if.if_flags = IFF_POINTOPOINT; 24131908Skarels sc->sc_ifuba.iff_flags = UBA_CANTWAIT; 24231908Skarels 24331908Skarels if (dmvtimer == 0) { 24431908Skarels dmvtimer = 1; 24531908Skarels timeout(dmvwatch, (caddr_t) 0, hz); 24631908Skarels } 24731908Skarels if_attach(&sc->sc_if); 24831908Skarels } 24931908Skarels 25031908Skarels /* 25131908Skarels * Reset of interface after UNIBUS reset. 25231908Skarels * If interface is on specified UBA, reset its state. 25331908Skarels */ 25431908Skarels dmvreset(unit, uban) 25531908Skarels int unit, uban; 25631908Skarels { 25731908Skarels register struct uba_device *ui; 25831908Skarels register struct dmv_softc *sc = &dmv_softc[unit]; 25931908Skarels 26031908Skarels if (unit >= NDMV || (ui = dmvinfo[unit]) == 0 || ui->ui_alive == 0 || 26131908Skarels ui->ui_ubanum != uban) 26231908Skarels return; 26331908Skarels printf(" dmv%d", unit); 26431908Skarels sc->sc_flag = 0; 26531908Skarels sc->sc_if.if_flags &= ~IFF_RUNNING; 26631908Skarels dmvinit(unit); 26731908Skarels } 26831908Skarels 26931908Skarels /* 27031908Skarels * Initialization of interface; reinitialize UNIBUS usage. 27131908Skarels */ 27231908Skarels dmvinit(unit) 27331908Skarels int unit; 27431908Skarels { 27531908Skarels register struct dmv_softc *sc = &dmv_softc[unit]; 27631908Skarels register struct uba_device *ui = dmvinfo[unit]; 27731908Skarels register struct dmvdevice *addr; 27831908Skarels register struct ifnet *ifp = &sc->sc_if; 27931908Skarels register struct ifrw *ifrw; 28031908Skarels register struct ifxmt *ifxp; 28131908Skarels register struct dmvbufs *rp; 28231908Skarels register struct dmv_command *qp; 28331908Skarels struct ifaddr *ifa; 28431908Skarels int base; 28531908Skarels int s; 28631908Skarels 28731908Skarels addr = (struct dmvdevice *)ui->ui_addr; 28831908Skarels 28931908Skarels /* 29031908Skarels * Check to see that an address has been set 29131908Skarels * (both local and destination for an address family). 29231908Skarels */ 29331908Skarels for (ifa = ifp->if_addrlist; ifa; ifa = ifa->ifa_next) 29431908Skarels if (ifa->ifa_addr.sa_family && ifa->ifa_dstaddr.sa_family) 29531908Skarels break; 29631908Skarels if (ifa == (struct ifaddr *) 0) 29731908Skarels return; 29831908Skarels 29931908Skarels if ((addr->bsel1&DMV_RUN) == 0) { 30031908Skarels log(LOG_CRIT, "dmvinit: dmv%d not running\n", unit); 30131908Skarels ifp->if_flags &= ~IFF_UP; 30231908Skarels return; 30331908Skarels } 30431908Skarels printd("dmvinit\n"); 30531908Skarels /* initialize UNIBUS resources */ 30631908Skarels sc->sc_iused = sc->sc_oused = 0; 30731908Skarels if ((ifp->if_flags & IFF_RUNNING) == 0) { 30831908Skarels if (if_ubaminit( 30931908Skarels &sc->sc_ifuba, 31031908Skarels ui->ui_ubanum, 31131908Skarels sizeof(struct dmv_header), 31231908Skarels (int)btoc(DMVMTU), 31331908Skarels sc->sc_ifr, 31431908Skarels NRCV, 31531908Skarels sc->sc_ifw, 31631908Skarels NXMT 31731908Skarels ) == 0) { 31831908Skarels log(LOG_CRIT, "dmvinit: dmv%d can't allocate uba resources\n", unit); 31931908Skarels ifp->if_flags &= ~IFF_UP; 32031908Skarels return; 32131908Skarels } 32231908Skarels ifp->if_flags |= IFF_RUNNING; 32331908Skarels } 32431908Skarels 32531908Skarels /* initialize buffer pool */ 32631908Skarels /* receives */ 32731908Skarels ifrw = &sc->sc_ifr[0]; 32831908Skarels for (rp = &sc->sc_rbufs[0]; rp < &sc->sc_rbufs[NRCV]; rp++) { 32931908Skarels rp->ubinfo = ifrw->ifrw_info & 0x3ffff; 33031908Skarels rp->cc = DMVMTU + sizeof (struct dmv_header); 33131908Skarels rp->flags = DBUF_OURS|DBUF_RCV; 33231908Skarels ifrw++; 33331908Skarels } 33431908Skarels /* transmits */ 33531908Skarels ifxp = &sc->sc_ifw[0]; 33631908Skarels for (rp = &sc->sc_xbufs[0]; rp < &sc->sc_xbufs[NXMT]; rp++) { 33731908Skarels rp->ubinfo = ifxp->ifw_info & 0x3ffff; 33831908Skarels rp->cc = 0; 33931908Skarels rp->flags = DBUF_OURS|DBUF_XMIT; 34031908Skarels ifxp++; 34131908Skarels } 34231908Skarels 34331908Skarels /* set up command queues */ 34431908Skarels sc->sc_qfreeh = sc->sc_qfreet 34531908Skarels = sc->sc_qhead = sc->sc_qtail = sc->sc_qactive = 34631908Skarels (struct dmv_command *)0; 34731908Skarels /* set up free command buffer list */ 34831908Skarels for (qp = &sc->sc_cmdbuf[0]; qp < &sc->sc_cmdbuf[NCMDS]; qp++) { 34931908Skarels QUEUE_AT_HEAD(qp, sc->sc_qfreeh, sc->sc_qfreet); 35031908Skarels } 35131908Skarels if(sc->sc_flag & DMV_RUNNING) 35231908Skarels dmvload( sc, DMV_CNTRLI, (QP_TRIB|QP_SEL6), 1, 0, DMV_REQHS,0); 35331908Skarels else 35431908Skarels dmvload( sc, DMV_CNTRLI, (QP_TRIB|QP_SEL6), 1, 0, DMV_ESTTRIB,0); 35531908Skarels dmvload( sc, DMV_CNTRLI, (QP_TRIB|QP_SEL6), 1, 0, DMV_REQSUS,0); 35631908Skarels sc->sc_flag |= (DMV_RESTART|DMV_RUNNING); 35731908Skarels sc->sc_flag &= ~DMV_ACTIVE; 35831908Skarels addr->bsel0 |= DMV_IEO; 35931908Skarels } 36031908Skarels 36131908Skarels /* 36231908Skarels * Start output on interface. Get another datagram 36331908Skarels * to send from the interface queue and map it to 36431908Skarels * the interface before starting output. 36531908Skarels * 36631908Skarels * Must be called at spl 5 36731908Skarels */ 36831908Skarels dmvstart(dev) 36931908Skarels dev_t dev; 37031908Skarels { 37131908Skarels int unit = minor(dev); 37231908Skarels register struct dmv_softc *sc = &dmv_softc[unit]; 37331908Skarels struct mbuf *m; 37431908Skarels register struct dmvbufs *rp; 37531908Skarels register int n; 37631908Skarels 37731908Skarels /* 37831908Skarels * Dequeue up to NXMT requests and map them to the UNIBUS. 37931908Skarels * If no more requests, or no dmv buffers available, just return. 38031908Skarels */ 38131908Skarels printd("dmvstart\n"); 38231908Skarels n = 0; 38331908Skarels for (rp = &sc->sc_xbufs[0]; rp < &sc->sc_xbufs[NXMT]; rp++ ) { 38431908Skarels /* find an available buffer */ 38531908Skarels if ((rp->flags & DBUF_DMVS) == 0) { 38631908Skarels IF_DEQUEUE(&sc->sc_if.if_snd, m); 38731908Skarels if (m == 0) 38831908Skarels return; 38931908Skarels /* mark it dmvs */ 39031908Skarels rp->flags |= (DBUF_DMVS); 39131908Skarels /* 39231908Skarels * Have request mapped to UNIBUS for transmission 39331908Skarels * and start the output. 39431908Skarels */ 39531908Skarels rp->cc = if_ubaput(&sc->sc_ifuba, &sc->sc_ifw[n], m); 39631908Skarels sc->sc_oused++; 39731908Skarels dmvload( 39831908Skarels sc, 39931908Skarels DMV_BACCX, 40031908Skarels QP_TRIB|QP_SEL4|QP_SEL6|QP_SEL10, 40131908Skarels 1, 40231908Skarels rp->ubinfo, 40331908Skarels (rp->ubinfo>>16)&0x3f, 40431908Skarels rp->cc 40531908Skarels ); 40631908Skarels } 40731908Skarels n++; 40831908Skarels } 40931908Skarels } 41031908Skarels 41131908Skarels /* 41231908Skarels * Utility routine to load the DMV device registers. 41331908Skarels */ 41431908Skarels dmvload(sc, cmd, mask, tributary, sel4, sel6, sel10) 41531908Skarels register struct dmv_softc *sc; 41631908Skarels u_char cmd, tributary, mask; 41731908Skarels u_short sel4, sel6, sel10; 41831908Skarels { 41931908Skarels register struct dmvdevice *addr; 42031908Skarels register int unit, sps; 42131908Skarels register struct dmv_command *qp; 42231908Skarels 42331908Skarels unit = sc - dmv_softc; 42431908Skarels printd("dmvload: cmd=%x mask=%x trib=%x sel4=%x sel6=%x sel10=%x\n", 42531908Skarels (unsigned) cmd, 42631908Skarels (unsigned) mask, 42731908Skarels (unsigned) tributary, 42831908Skarels (unsigned) sel4, 42931908Skarels (unsigned) sel6, 43031908Skarels (unsigned) sel10 43131908Skarels ); 43231908Skarels addr = (struct dmvdevice *)dmvinfo[unit]->ui_addr; 43331908Skarels sps = spl5(); 43431908Skarels 43531908Skarels /* grab a command buffer from the free list */ 43631908Skarels if ((qp = sc->sc_qfreeh) == (struct dmv_command *)0) 43731908Skarels panic("dmv command queue overflow"); 43831908Skarels DEQUEUE(sc->sc_qfreeh, sc->sc_qfreet); 43931908Skarels 44031908Skarels /* fill in requested info */ 44131908Skarels qp->qp_cmd = cmd; 44231908Skarels qp->qp_mask = mask; 44331908Skarels qp->qp_tributary = tributary; 44431908Skarels qp->qp_sel4 = sel4; 44531908Skarels qp->qp_sel6 = sel6; 44631908Skarels qp->qp_sel10 = sel10; 44731908Skarels 44831908Skarels if (sc->sc_qactive) { /* command in progress */ 44931908Skarels if (cmd == DMV_BACCR) { /* supply read buffers first */ 45031908Skarels QUEUE_AT_HEAD(qp, sc->sc_qhead, sc->sc_qtail); 45131908Skarels } else { 45231908Skarels QUEUE_AT_TAIL(qp, sc->sc_qhead, sc->sc_qtail); 45331908Skarels } 45431908Skarels } else { /* command port free */ 45531908Skarels sc->sc_qactive = qp; 45631908Skarels addr->bsel0 = (DMV_RQI|DMV_IEI|DMV_IEO); 45731908Skarels } 45831908Skarels splx(sps); 45931908Skarels } 46031908Skarels /* 46131908Skarels * DMV interface input interrupt. 46231908Skarels * Ready to accept another command, 46331908Skarels * pull one off the command queue. 46431908Skarels */ 46531908Skarels dmvrint(unit) 46631908Skarels int unit; 46731908Skarels { 46831908Skarels register struct dmv_softc *sc; 46931908Skarels register struct dmvdevice *addr; 47031908Skarels register struct dmv_command *qp; 47131908Skarels register int n; 47231908Skarels 47331908Skarels addr = (struct dmvdevice *)dmvinfo[unit]->ui_addr; 47431908Skarels sc = &dmv_softc[unit]; 47531908Skarels printd("dmvrint\n"); 47631908Skarels if ((qp = sc->sc_qactive) == (struct dmv_command *) 0) { 47731908Skarels log(LOG_WARNING, "dmvrint: dmv%d no command\n", unit); 47831908Skarels return; 47931908Skarels } 48031908Skarels while (addr->bsel2&DMV_RDI) { 48131908Skarels if(qp->qp_mask&QP_SEL4) 48231908Skarels addr->wsel4 = qp->qp_sel4; 48331908Skarels if(qp->qp_mask&QP_SEL6) 48431908Skarels addr->wsel6 = qp->qp_sel6; 48531908Skarels if(qp->qp_mask&QP_SEL10) { 48631908Skarels addr->wsel10 = qp->qp_sel10; 48731908Skarels qp->qp_cmd |= DMV_22BIT; 48831908Skarels } 48931908Skarels if(qp->qp_mask&QP_TRIB) 49031908Skarels addr->wsel2 = qp->qp_cmd|(qp->qp_tributary << 8); 49131908Skarels else 49231908Skarels addr->bsel2 = qp->qp_cmd; 49331908Skarels QUEUE_AT_HEAD(qp, sc->sc_qfreeh, sc->sc_qfreet); 49431908Skarels if ((sc->sc_qactive = sc->sc_qhead) == (struct dmv_command *)0) 49531908Skarels break; 49631908Skarels qp = sc->sc_qactive; 49731908Skarels DEQUEUE(sc->sc_qhead, sc->sc_qtail); 49831908Skarels if (addr->bsel2&DMV_RDO) 49931908Skarels break; 50031908Skarels } 50131908Skarels if (!sc->sc_qactive) { 50231908Skarels if(addr->bsel2&DMV_RDI) { 50331908Skarels /* clear RQI prior to last command per DMV manual */ 50431908Skarels addr->bsel0 &= ~DMV_RQI; 50531908Skarels addr->wsel6 = DMV_NOP; 50631908Skarels addr->bsel2 = DMV_CNTRLI; 50731908Skarels } 50831908Skarels addr->bsel0 = DMV_IEO; 50931908Skarels } 51031908Skarels else /* RDO set or DMV still holding CSR */ 51131908Skarels addr->bsel0 = (DMV_RQI|DMV_IEI|DMV_IEO); 51231908Skarels 51331908Skarels } 51431908Skarels 51531908Skarels /* 51631908Skarels * DMV interface output interrupt. 51731908Skarels * A transfer may have completed, check for errors. 51831908Skarels * If it was a read, notify appropriate protocol. 51931908Skarels * If it was a write, pull the next one off the queue. 52031908Skarels */ 52131908Skarels dmvxint(unit) 52231908Skarels int unit; 52331908Skarels { 52431908Skarels register struct dmv_softc *sc; 52531908Skarels register struct ifnet *ifp; 52631908Skarels struct uba_device *ui = dmvinfo[unit]; 52731908Skarels struct dmvdevice *addr; 52831908Skarels struct mbuf *m; 52931908Skarels struct ifqueue *inq; 53031908Skarels int sel2, sel3, sel4, sel6, sel10, pkaddr, len, s; 53131908Skarels register struct ifrw *ifrw; 53231908Skarels register struct dmvbufs *rp; 53331908Skarels register struct ifxmt *ifxp; 53431908Skarels struct dmv_header *dh; 53531908Skarels int off, resid, fatal; 53631908Skarels 53731908Skarels addr = (struct dmvdevice *)ui->ui_addr; 53831908Skarels sc = &dmv_softc[unit]; 53931908Skarels ifp = &sc->sc_if; 54031908Skarels 54131908Skarels while (addr->bsel2 & DMV_RDO) { 54231908Skarels 54331908Skarels sel2 = addr->bsel2; 54431908Skarels sel3 = addr->bsel3; 54531908Skarels sel4 = addr->wsel4; /* release port */ 54631908Skarels sel6 = addr->wsel6; 54731908Skarels if(sel2 & DMV_22BIT) 54831908Skarels sel10 = addr->wsel10; 54931908Skarels addr->bsel2 &= ~DMV_RDO; 55031908Skarels pkaddr = sel4 | ((sel6 & 0x3f) << 16); 55131908Skarels printd("dmvxint: sel2=%x sel4=%x sel6=%x sel10=%x pkaddr=%x\n", 55231908Skarels (unsigned) sel2, 55331908Skarels (unsigned) sel4, 55431908Skarels (unsigned) sel6, 55531908Skarels (unsigned) sel10, 55631908Skarels (unsigned) pkaddr 55731908Skarels ); 55831908Skarels if((sc->sc_flag & DMV_RUNNING)==0) { 55931908Skarels log(LOG_WARNING, "dmvxint: dmv%d xint while down\n", unit); 56031908Skarels return; 56131908Skarels } 56231908Skarels switch (sel2 & 07) { 56331908Skarels case DMV_BDRUS: 56431908Skarels /* 56531908Skarels * A read has completed. 56631908Skarels * Pass packet to type specific 56731908Skarels * higher-level input routine. 56831908Skarels */ 56931908Skarels ifp->if_ipackets++; 57031908Skarels /* find location in dmvuba struct */ 57131908Skarels ifrw= &sc->sc_ifr[0]; 57231908Skarels for (rp = &sc->sc_rbufs[0]; rp < &sc->sc_rbufs[NRCV]; rp++) { 57331908Skarels if(rp->ubinfo == pkaddr) 57431908Skarels break; 57531908Skarels ifrw++; 57631908Skarels } 57731908Skarels if (rp >= &sc->sc_rbufs[NRCV]) 57831908Skarels panic("dmv rcv"); 57931908Skarels if ((rp->flags & DBUF_DMVS) == 0) 58031908Skarels log(LOG_WARNING, "dmvxint: dmv%d done unalloc rbuf\n", unit); 58131908Skarels 58231908Skarels len = (sel10&0x3fff) - sizeof (struct dmv_header); 58331908Skarels if (len < 0 || len > DMVMTU) { 58431908Skarels ifp->if_ierrors++; 58531908Skarels log(LOG_ERR, "dmvxint: dmv%d bad rcv pkt addr 0x%x len 0x%x\n", 58631908Skarels unit, pkaddr, len); 58731908Skarels goto setup; 58831908Skarels } 58931908Skarels /* 59031908Skarels * Deal with trailer protocol: if type is trailer 59131908Skarels * get true type from first 16-bit word past data. 59231908Skarels * Remember that type was trailer by setting off. 59331908Skarels */ 59431908Skarels dh = (struct dmv_header *)ifrw->ifrw_addr; 59531908Skarels dh->dmv_type = ntohs((u_short)dh->dmv_type); 59631908Skarels #define dmvdataaddr(dh, off, type) ((type)(((caddr_t)((dh)+1)+(off)))) 59731908Skarels if (dh->dmv_type >= DMV_TRAILER && 59831908Skarels dh->dmv_type < DMV_TRAILER+DMV_NTRAILER) { 59931908Skarels off = (dh->dmv_type - DMV_TRAILER) * 512; 60031908Skarels if (off >= DMVMTU) 60131908Skarels goto setup; /* sanity */ 60231908Skarels dh->dmv_type = ntohs(*dmvdataaddr(dh, off, u_short *)); 60331908Skarels resid = ntohs(*(dmvdataaddr(dh, off+2, u_short *))); 60431908Skarels if (off + resid > len) 60531908Skarels goto setup; /* sanity */ 60631908Skarels len = off + resid; 60731908Skarels } else 60831908Skarels off = 0; 60931908Skarels if (len == 0) 61031908Skarels goto setup; 61131908Skarels 61231908Skarels /* 61331908Skarels * Pull packet off interface. Off is nonzero if 61431908Skarels * packet has trailing header; dmv_get will then 61531908Skarels * force this header information to be at the front, 61631908Skarels * but we still have to drop the type and length 61731908Skarels * which are at the front of any trailer data. 61831908Skarels */ 61931908Skarels m = if_ubaget(&sc->sc_ifuba, ifrw, len, off, ifp); 62031908Skarels if (m == 0) 62131908Skarels goto setup; 62231908Skarels if (off) { 62331908Skarels ifp = *(mtod(m, struct ifnet **)); 62431908Skarels m->m_off += 2 * sizeof (u_short); 62531908Skarels m->m_len -= 2 * sizeof (u_short); 62631908Skarels *(mtod(m, struct ifnet **)) = ifp; 62731908Skarels } 62831908Skarels switch (dh->dmv_type) { 62931908Skarels #ifdef INET 63031908Skarels case DMV_IPTYPE: 63131908Skarels schednetisr(NETISR_IP); 63231908Skarels inq = &ipintrq; 63331908Skarels break; 63431908Skarels #endif 63531908Skarels default: 63631908Skarels m_freem(m); 63731908Skarels goto setup; 63831908Skarels } 63931908Skarels 64031908Skarels s = splimp(); 64131908Skarels if (IF_QFULL(inq)) { 64231908Skarels IF_DROP(inq); 64331908Skarels m_freem(m); 64431908Skarels } else 64531908Skarels IF_ENQUEUE(inq, m); 64631908Skarels splx(s); 64731908Skarels setup: 64831908Skarels /* is this needed? */ 64931908Skarels rp->ubinfo = ifrw->ifrw_info & 0x3ffff; 65031908Skarels dmvload( 65131908Skarels sc, 65231908Skarels DMV_BACCR, 65331908Skarels QP_SEL4|QP_SEL6|QP_SEL10, 65431908Skarels 0, 65531908Skarels rp->ubinfo, 65631908Skarels (rp->ubinfo>>16)&0x3f, 65731908Skarels rp->cc 65831908Skarels ); 65931908Skarels break; 66031908Skarels case DMV_BDXSA: 66131908Skarels /* 66231908Skarels * A write has completed, start another 66331908Skarels * transfer if there is more data to send. 66431908Skarels */ 66531908Skarels ifp->if_opackets++; 66631908Skarels /* find associated dmvbuf structure */ 66731908Skarels ifxp = &sc->sc_ifw[0]; 66831908Skarels for (rp = &sc->sc_xbufs[0]; rp < &sc->sc_xbufs[NXMT]; rp++) { 66931908Skarels if(rp->ubinfo == pkaddr) 67031908Skarels break; 67131908Skarels ifxp++; 67231908Skarels } 67331908Skarels if (rp >= &sc->sc_xbufs[NXMT]) { 67431908Skarels log(LOG_ERR, "dmv%d: bad packet address 0x%x\n", 67531908Skarels unit, pkaddr); 67631908Skarels break; 67731908Skarels } 67831908Skarels if ((rp->flags & DBUF_DMVS) == 0) 67931908Skarels log(LOG_ERR, "dmvxint: dmv%d unallocated packet 0x%x\n", 68031908Skarels unit, pkaddr); 68131908Skarels /* mark buffer free */ 68231908Skarels if (ifxp->ifw_xtofree) { 68331908Skarels (void)m_freem(ifxp->ifw_xtofree); 68431908Skarels ifxp->ifw_xtofree = 0; 68531908Skarels } 68631908Skarels rp->flags &= ~DBUF_DMVS; 68731908Skarels sc->sc_oused--; 68831908Skarels sc->sc_nticks = 0; 68931908Skarels sc->sc_flag |= DMV_ACTIVE; 69031908Skarels break; 69131908Skarels 69231908Skarels case DMV_CNTRLO: 69331908Skarels /* ACCUMULATE STATISTICS */ 69431908Skarels fatal=0; 69531908Skarels switch(sel6&DMV_EEC) { 69631908Skarels case DMV_ORUN: 69731908Skarels if(sc->sc_flag & DMV_RESTART) { 69831908Skarels load_rec_bufs(sc); 69931908Skarels sc->sc_flag &= ~DMV_RESTART; 70031908Skarels log(LOG_INFO, 70131908Skarels "dmvxint: dmv%d far end on-line\n", 70231908Skarels unit 70331908Skarels ); 70431908Skarels } else { 70531908Skarels log(LOG_WARNING, 70631908Skarels "dmvxint: dmv%d far end restart\n", 70731908Skarels unit 70831908Skarels ); 70931908Skarels goto fatal; 71031908Skarels } 71131908Skarels break; 71231908Skarels case DMV_RTE: 71331908Skarels ifp->if_ierrors++; 714*31909Skarels if ((sc->sc_rte++ % DMV_RPRTE) == 0) 715*31909Skarels log(LOG_WARNING, 71631908Skarels "dmvxint: dmv%d receive threshold error\n", 717*31909Skarels unit); 71831908Skarels break; 71931908Skarels case DMV_TTE: 72031908Skarels ifp->if_oerrors++; 721*31909Skarels if ((sc->sc_xte++ % DMV_RPTTE) == 0) 722*31909Skarels log(LOG_WARNING, 72331908Skarels "dmvxint: dmv%d transmit threshold error\n", 724*31909Skarels unit); 72531908Skarels break; 72631908Skarels case DMV_STE: 727*31909Skarels if ((sc->sc_ste++ % DMV_RPSTE) == 0) 728*31909Skarels log(LOG_WARNING, 72931908Skarels "dmvxint: dmv%d select threshold error\n", 730*31909Skarels unit); 73131908Skarels break; 73231908Skarels case DMV_NXM: 733*31909Skarels if ((sc->sc_nxm++ % DMV_RPNXM) == 0) 734*31909Skarels log(LOG_WARNING, 73531908Skarels "dmvxint: dmv%d nonexistent memory error\n", 736*31909Skarels unit); 73731908Skarels break; 73831908Skarels case DMV_MODD: 739*31909Skarels if ((sc->sc_modd++ % DMV_RPMODD) == 0) 740*31909Skarels log(LOG_WARNING, 74131908Skarels "dmvxint: dmv%d modem disconnected error\n", 742*31909Skarels unit); 74331908Skarels break; 74431908Skarels case DMV_CXRL: 745*31909Skarels if ((sc->sc_cxrl++ % DMV_RPCXRL) == 0) 746*31909Skarels log(LOG_WARNING, 74731908Skarels "dmvxint: dmv%d carrier loss error\n", 748*31909Skarels unit); 74931908Skarels break; 75031908Skarels case DMV_QOVF: 75131908Skarels log(LOG_WARNING, 75231908Skarels "dmvxint: dmv%d response queue overflow\n", 75331908Skarels unit 75431908Skarels ); 75531908Skarels sc->sc_qovf++; 75631908Skarels goto fatal; 75731908Skarels 75831908Skarels default: 75931908Skarels log(LOG_WARNING, 76031908Skarels "dmvxint: dmv%d unknown error %o\n", 76131908Skarels unit, 76231908Skarels sel6&DMV_EEC 76331908Skarels ); 76431908Skarels if ((sc->sc_unknown++ % DMV_RPUNKNOWN) == 0) 76531908Skarels goto fatal; 76631908Skarels break; 76731908Skarels } 76831908Skarels break; 76931908Skarels 77031908Skarels case DMV_BDRUNUS: 77131908Skarels case DMV_BDXSN: 77231908Skarels case DMV_BDXNS: 77331908Skarels log(LOG_INFO, 77431908Skarels "dmvxint: dmv%d buffer disp for halted trib %o\n", 77531908Skarels unit, sel2&0x7 77631908Skarels ); 77731908Skarels break; 77831908Skarels 77931908Skarels case DMV_MDEFO: 78031908Skarels if((sel6&0x1f) == 020) { 78131908Skarels log(LOG_INFO, 78231908Skarels "dmvxint: dmv%d buffer return complete sel3=%x\n", 78331908Skarels unit, sel3); 78431908Skarels } else { 78531908Skarels log(LOG_INFO, 78631908Skarels "dmvxint: dmv%d info resp sel3=%x sel4=%x sel6=%x\n", 78731908Skarels unit, sel3, sel4, sel6 78831908Skarels ); 78931908Skarels } 79031908Skarels break; 79131908Skarels 79231908Skarels default: 79331908Skarels log(LOG_WARNING, 79431908Skarels "dmvxint: dmv%d bad control %o\n", 79531908Skarels unit, sel2&0x7 79631908Skarels ); 79731908Skarels break; 79831908Skarels } 79931908Skarels } 80031908Skarels dmvstart(unit); 80131908Skarels return; 80231908Skarels fatal: 80331908Skarels log( 80431908Skarels LOG_ERR, 80531908Skarels "dmv%d: fatal error, output code ==%o\n", 80631908Skarels unit, 80731908Skarels sel6&DMV_EEC 80831908Skarels ); 80931908Skarels dmvrestart(unit); 81031908Skarels } 81131908Skarels load_rec_bufs(sc) 81231908Skarels register struct dmv_softc *sc; 81331908Skarels { 81431908Skarels register struct dmvbufs *rp; 81531908Skarels 81631908Skarels /* queue first NRCV buffers for DMV to fill */ 81731908Skarels for (rp = &sc->sc_rbufs[0]; rp < &sc->sc_rbufs[NRCV]; rp++) { 81831908Skarels rp->flags |= DBUF_DMVS; 81931908Skarels dmvload( 82031908Skarels sc, 82131908Skarels DMV_BACCR, 82231908Skarels QP_TRIB|QP_SEL4|QP_SEL6|QP_SEL10, 82331908Skarels 1, 82431908Skarels rp->ubinfo, 82531908Skarels (rp->ubinfo>>16)&0x3f, 82631908Skarels rp->cc 82731908Skarels ); 82831908Skarels sc->sc_iused++; 82931908Skarels } 83031908Skarels } 83131908Skarels 83231908Skarels /* 83331908Skarels * DMV output routine. 83431908Skarels * Encapsulate a packet of type family for the dmv. 83531908Skarels * Use trailer local net encapsulation if enough data in first 83631908Skarels * packet leaves a multiple of 512 bytes of data in remainder. 83731908Skarels */ 83831908Skarels dmvoutput(ifp, m0, dst) 83931908Skarels register struct ifnet *ifp; 84031908Skarels register struct mbuf *m0; 84131908Skarels struct sockaddr *dst; 84231908Skarels { 84331908Skarels int type, error, s; 84431908Skarels register struct mbuf *m = m0; 84531908Skarels register struct dmv_header *dh; 84631908Skarels register int off; 84731908Skarels 84831908Skarels switch (dst->sa_family) { 84931908Skarels #ifdef INET 85031908Skarels case AF_INET: 85131908Skarels off = ntohs((u_short)mtod(m, struct ip *)->ip_len) - m->m_len; 85231908Skarels if ((ifp->if_flags & IFF_NOTRAILERS) == 0) 85331908Skarels if (off > 0 && (off & 0x1ff) == 0 && 85431908Skarels m->m_off >= MMINOFF + 2 * sizeof (u_short)) { 85531908Skarels type = DMV_TRAILER + (off>>9); 85631908Skarels m->m_off -= 2 * sizeof (u_short); 85731908Skarels m->m_len += 2 * sizeof (u_short); 85831908Skarels *mtod(m, u_short *) = htons((u_short)DMV_IPTYPE); 85931908Skarels *(mtod(m, u_short *) + 1) = htons((u_short)m->m_len); 86031908Skarels goto gottrailertype; 86131908Skarels } 86231908Skarels type = DMV_IPTYPE; 86331908Skarels off = 0; 86431908Skarels goto gottype; 86531908Skarels #endif 86631908Skarels 86731908Skarels case AF_UNSPEC: 86831908Skarels dh = (struct dmv_header *)dst->sa_data; 86931908Skarels type = dh->dmv_type; 87031908Skarels goto gottype; 87131908Skarels 87231908Skarels default: 87331908Skarels log(LOG_ERR, "dmvoutput, dmv%d can't handle af%d\n", ifp->if_unit, 87431908Skarels dst->sa_family); 87531908Skarels error = EAFNOSUPPORT; 87631908Skarels goto bad; 87731908Skarels } 87831908Skarels 87931908Skarels gottrailertype: 88031908Skarels /* 88131908Skarels * Packet to be sent as a trailer; move first packet 88231908Skarels * (control information) to end of chain. 88331908Skarels */ 88431908Skarels while (m->m_next) 88531908Skarels m = m->m_next; 88631908Skarels m->m_next = m0; 88731908Skarels m = m0->m_next; 88831908Skarels m0->m_next = 0; 88931908Skarels m0 = m; 89031908Skarels 89131908Skarels gottype: 89231908Skarels /* 89331908Skarels * Add local network header 89431908Skarels * (there is space for a uba on a vax to step on) 89531908Skarels */ 89631908Skarels if (m->m_off > MMAXOFF || 89731908Skarels MMINOFF + sizeof(struct dmv_header) > m->m_off) { 89831908Skarels m = m_get(M_DONTWAIT, MT_HEADER); 89931908Skarels if (m == 0) { 90031908Skarels error = ENOBUFS; 90131908Skarels goto bad; 90231908Skarels } 90331908Skarels m->m_next = m0; 90431908Skarels m->m_off = MMINOFF; 90531908Skarels m->m_len = sizeof (struct dmv_header); 90631908Skarels } else { 90731908Skarels m->m_off -= sizeof (struct dmv_header); 90831908Skarels m->m_len += sizeof (struct dmv_header); 90931908Skarels } 91031908Skarels dh = mtod(m, struct dmv_header *); 91131908Skarels dh->dmv_type = htons((u_short)type); 91231908Skarels 91331908Skarels /* 91431908Skarels * Queue message on interface, and start output if interface 91531908Skarels * not yet active. 91631908Skarels */ 91731908Skarels s = splimp(); 91831908Skarels if (IF_QFULL(&ifp->if_snd)) { 91931908Skarels IF_DROP(&ifp->if_snd); 92031908Skarels m_freem(m); 92131908Skarels splx(s); 92231908Skarels return (ENOBUFS); 92331908Skarels } 92431908Skarels IF_ENQUEUE(&ifp->if_snd, m); 92531908Skarels dmvstart(ifp->if_unit); 92631908Skarels splx(s); 92731908Skarels return (0); 92831908Skarels 92931908Skarels bad: 93031908Skarels m_freem(m0); 93131908Skarels return (error); 93231908Skarels } 93331908Skarels 93431908Skarels 93531908Skarels /* 93631908Skarels * Process an ioctl request. 93731908Skarels */ 93831908Skarels /* ARGSUSED */ 93931908Skarels dmvioctl(ifp, cmd, data) 94031908Skarels register struct ifnet *ifp; 94131908Skarels int cmd; 94231908Skarels caddr_t data; 94331908Skarels { 94431908Skarels int s = splimp(), error = 0; 94531908Skarels struct mbuf *m; 94631908Skarels register struct dmv_softc *sc = &dmv_softc[ifp->if_unit]; 94731908Skarels 94831908Skarels switch (cmd) { 94931908Skarels 95031908Skarels case SIOCSIFADDR: 95131908Skarels ifp->if_flags |= IFF_UP; 95231908Skarels if ((ifp->if_flags & IFF_RUNNING) == 0) 95331908Skarels dmvinit(ifp->if_unit); 95431908Skarels break; 95531908Skarels 95631908Skarels case SIOCSIFDSTADDR: 95731908Skarels if ((ifp->if_flags & IFF_RUNNING) == 0) 95831908Skarels dmvinit(ifp->if_unit); 95931908Skarels break; 96031908Skarels 96131908Skarels case SIOCSIFFLAGS: 96231908Skarels if ((ifp->if_flags & IFF_UP) == 0 && 96331908Skarels sc->sc_flag & DMV_RUNNING) { 96431908Skarels ((struct dmvdevice *) 96531908Skarels (dmvinfo[ifp->if_unit]->ui_addr))->bsel1 = DMV_MCLR; 96631908Skarels for(;;) { 96731908Skarels IF_DEQUEUE(&sc->sc_if.if_snd, m); 96831908Skarels if (m != NULL) 96931908Skarels m_freem(m); 97031908Skarels else 97131908Skarels break; 97231908Skarels } 97331908Skarels sc->sc_flag &= ~DMV_RUNNING; 97431908Skarels } else if (ifp->if_flags & IFF_UP && 97531908Skarels (sc->sc_flag & DMV_RUNNING) == 0) 97631908Skarels dmvrestart(ifp->if_unit); 97731908Skarels break; 97831908Skarels 97931908Skarels default: 98031908Skarels error = EINVAL; 98131908Skarels } 98231908Skarels splx(s); 98331908Skarels return (error); 98431908Skarels } 98531908Skarels 98631908Skarels /* 98731908Skarels * Restart after a fatal error. 98831908Skarels * Clear device and reinitialize. 98931908Skarels */ 99031908Skarels dmvrestart(unit) 99131908Skarels int unit; 99231908Skarels { 99331908Skarels register struct dmv_softc *sc = &dmv_softc[unit]; 99431908Skarels register struct uba_device *ui = dmvinfo[unit]; 99531908Skarels register struct dmvdevice *addr; 99631908Skarels register struct ifxmt *ifxp; 99731908Skarels register int i; 99831908Skarels 99931908Skarels #ifdef notdef 100031908Skarels addr = (struct dmvdevice *)ui->ui_addr; 100131908Skarels /* 100231908Skarels * Let the DMR finish the MCLR. At 1 Mbit, it should do so 100331908Skarels * in about a max of 6.4 milliseconds with diagnostics enabled. 100431908Skarels */ 100531908Skarels addr->bsel1 = DMV_MCLR; 100631908Skarels for (i = 100000; i && (addr->bsel1 & DMV_RUN) == 0; i--) 100731908Skarels ; 100831908Skarels if ((addr->bsel1 & DMV_RUN) == 0) { 100931908Skarels log(LOG_ERR, "dmvrestart: can't start device\n" ); 101031908Skarels return (0); 101131908Skarels } 101231908Skarels if ((addr->bsel4 != 033) || (addr->bsel6 != 0305)) 101331908Skarels { 101431908Skarels log(LOG_ERR, "dmvrestart: device init failed, bsel4=%o, bsel6=%o\n", 101531908Skarels addr->bsel4, addr->bsel6); 101631908Skarels return (0); 101731908Skarels } 101831908Skarels #endif 101931908Skarels for (ifxp = sc->sc_ifw; ifxp < &sc->sc_ifw[NXMT]; ifxp++) { 102031908Skarels if (ifxp->ifw_xtofree) { 102131908Skarels (void) m_freem(ifxp->ifw_xtofree); 102231908Skarels ifxp->ifw_xtofree = 0; 102331908Skarels } 102431908Skarels } 102531908Skarels /* restart DMV */ 102631908Skarels dmvinit(unit); 102731908Skarels sc->sc_if.if_collisions++; /* why not? */ 102831908Skarels } 102931908Skarels 103031908Skarels /* 103131908Skarels * Check to see that transmitted packets don't 103231908Skarels * lose interrupts. The device has to be active. 103331908Skarels */ 103431908Skarels dmvwatch() 103531908Skarels { 103631908Skarels register struct uba_device *ui; 103731908Skarels register struct dmv_softc *sc; 103831908Skarels struct dmvdevice *addr; 103931908Skarels register int i; 104031908Skarels 104131908Skarels for (i = 0; i < NDMV; i++) { 104231908Skarels sc = &dmv_softc[i]; 104331908Skarels if ((sc->sc_flag & DMV_ACTIVE) == 0) 104431908Skarels continue; 104531908Skarels if ((ui = dmvinfo[i]) == 0 || ui->ui_alive == 0) 104631908Skarels continue; 104731908Skarels if (sc->sc_oused) { 104831908Skarels sc->sc_nticks++; 104931908Skarels if (sc->sc_nticks > dmv_timeout) { 105031908Skarels sc->sc_nticks = 0; 105131908Skarels addr = (struct dmvdevice *)ui->ui_addr; 105231908Skarels log(LOG_ERR, "dmv%d hung: bsel0=%b bsel2=%b\n", 105331908Skarels i, addr->bsel0 & 0xff, DMV0BITS, 105431908Skarels addr->bsel2 & 0xff, DMV2BITS); 105531908Skarels dmvrestart(i); 105631908Skarels } 105731908Skarels } 105831908Skarels } 105931908Skarels timeout(dmvwatch, (caddr_t) 0, hz); 106031908Skarels } 106131908Skarels #endif 1062