1*12172Ssam /* if_vv.c 4.16 83/05/01 */ 27024Ssam 39799Ssam #include "vv.h" 411192Ssam 57024Ssam /* 67024Ssam * Proteon 10 Meg Ring Driver. 77024Ssam * This device is called "vv" because its "real name", 87024Ssam * V2LNI won't work if shortened to the obvious "v2". 97024Ssam * Hence the subterfuge. 1011192Ssam * 1111209Ssam * UNTESTED WITH 4.1C 127024Ssam */ 1311209Ssam #include "../machine/pte.h" 149799Ssam 157024Ssam #include "../h/param.h" 167024Ssam #include "../h/systm.h" 177024Ssam #include "../h/mbuf.h" 187024Ssam #include "../h/buf.h" 197024Ssam #include "../h/protosw.h" 207024Ssam #include "../h/socket.h" 217024Ssam #include "../h/vmmac.h" 2211192Ssam #include "../h/errno.h" 2311209Ssam #include "../h/time.h" 2411209Ssam #include "../h/kernel.h" 258465Sroot 268465Sroot #include "../net/if.h" 2711209Ssam #include "../net/netisr.h" 288465Sroot #include "../net/route.h" 2911192Ssam 308421Swnj #include "../netinet/in.h" 318421Swnj #include "../netinet/in_systm.h" 328421Swnj #include "../netinet/ip.h" 338421Swnj #include "../netinet/ip_var.h" 348465Sroot 3511209Ssam #include "../vax/mtpr.h" 3611209Ssam #include "../vax/cpu.h" 3711192Ssam 388465Sroot #include "../vaxuba/ubareg.h" 398465Sroot #include "../vaxuba/ubavar.h" 407024Ssam 4111209Ssam #include "../vaxif/if_vv.h" 4211209Ssam #include "../vaxif/if_uba.h" 4311209Ssam 447024Ssam /* 457024Ssam * N.B. - if WIRECENTER is defined wrong, it can well break 467024Ssam * the hardware!! 477024Ssam */ 487024Ssam #define WIRECENTER 497024Ssam 507024Ssam #ifdef WIRECENTER 517024Ssam #define VV_CONF VV_HEN /* drive wire center relay */ 527024Ssam #else 537024Ssam #define VV_CONF VV_STE /* allow operation without wire center */ 547024Ssam #endif 557024Ssam 567024Ssam #define VVMTU (1024+512) 577640Ssam #define VVMRU (1024+512+16) /* space for trailer */ 587024Ssam 5911192Ssam int vv_dotrailer = 0, /* 1 => do trailer protocol */ 6011192Ssam vv_tracehdr = 0, /* 1 => trace headers (slowly!!) */ 6111192Ssam vv_tracetimeout = 1; /* 1 => trace input error-rate limiting */ 6211192Ssam vv_logreaderrors = 0; /* 1 => log all read errors */ 637640Ssam 6411192Ssam #define vvtracehdr if (vv_tracehdr) vvprt_hdr 6511192Ssam #define vvtrprintf if (vv_tracetimeout) printf 6611192Ssam 6711192Ssam int vv_ticking = 0; /* error flywheel is running */ 6811192Ssam 6911209Ssam /* 7011209Ssam * Interval in HZ - 50 msec. 7111209Ssam * N.B. all times below are in units of flywheel ticks 7211209Ssam */ 7311209Ssam #define VV_FLYWHEEL 3 7411192Ssam #define VV_ERRORTHRESHOLD 100 /* errors/flywheel-interval */ 7511192Ssam #define VV_MODE1ATTEMPTS 10 /* number mode 1 retries */ 7611192Ssam #define VV_MODE1DELAY 2 /* period interface is PAUSEd - 100ms */ 7711192Ssam #define VV_MODE2DELAY 4 /* base interval host relay is off - 200ms */ 7811192Ssam #define VV_MAXDELAY 6400 /* max interval host relay is off - 2 minutes */ 7911192Ssam 807024Ssam int vvprobe(), vvattach(), vvrint(), vvxint(); 817024Ssam struct uba_device *vvinfo[NVV]; 827024Ssam u_short vvstd[] = { 0 }; 837024Ssam struct uba_driver vvdriver = 847024Ssam { vvprobe, 0, vvattach, 0, vvstd, "vv", vvinfo }; 857024Ssam #define VVUNIT(x) minor(x) 867024Ssam int vvinit(),vvoutput(),vvreset(); 877024Ssam 887024Ssam /* 897024Ssam * Software status of each interface. 907024Ssam * 917024Ssam * Each interface is referenced by a network interface structure, 927024Ssam * vs_if, which the routing code uses to locate the interface. 937024Ssam * This structure contains the output queue for the interface, its address, ... 947024Ssam * We also have, for each interface, a UBA interface structure, which 957024Ssam * contains information about the UNIBUS resources held by the interface: 967024Ssam * map registers, buffered data paths, etc. Information is cached in this 977024Ssam * structure for use by the if_uba.c routines in running the interface 987024Ssam * efficiently. 997024Ssam */ 1007024Ssam struct vv_softc { 1017024Ssam struct ifnet vs_if; /* network-visible interface */ 1027024Ssam struct ifuba vs_ifuba; /* UNIBUS resources */ 10311192Ssam short vs_oactive; /* is output active */ 10411192Ssam short vs_iactive; /* is input active */ 1057024Ssam short vs_olen; /* length of last output */ 1067024Ssam u_short vs_lastx; /* last destination address */ 10711192Ssam short vs_tries; /* transmit current retry count */ 1087024Ssam short vs_init; /* number of ring inits */ 1097024Ssam short vs_nottaken; /* number of packets refused */ 11011192Ssam /* input error rate limiting state */ 11111192Ssam short vs_major; /* recovery major state */ 11211192Ssam short vs_minor; /* recovery minor state */ 11311192Ssam short vs_retry; /* recovery retry count */ 11411192Ssam short vs_delayclock; /* recovery delay clock */ 11511192Ssam short vs_delayrange; /* increasing delay interval */ 11611192Ssam short vs_dropped; /* number of packes tossed in last dt */ 1177024Ssam } vv_softc[NVV]; 1187024Ssam 11911192Ssam /* 12011209Ssam * States of vs_iactive. 12111192Ssam */ 12211192Ssam #define ACTIVE 1 /* interface should post new receives */ 12311192Ssam #define PAUSE 0 /* interface should NOT post new receives */ 12411192Ssam #define OPEN -1 /* PAUSE and open host relay */ 12511192Ssam 12611192Ssam /* 12711209Ssam * Recovery major states. 12811192Ssam */ 12911192Ssam #define MODE0 0 /* everything is wonderful */ 13011192Ssam #define MODE1 1 /* hopefully whatever will go away */ 13111209Ssam #define MODE2 2 /* drastic measures - open host relay for increasing intervals */ 13211192Ssam 1337024Ssam vvprobe(reg) 1347024Ssam caddr_t reg; 1357024Ssam { 1367024Ssam register int br, cvec; 1377024Ssam register struct vvreg *addr = (struct vvreg *)reg; 1387024Ssam 1397024Ssam #ifdef lint 1407024Ssam br = 0; cvec = br; br = cvec; 1417024Ssam #endif 1427024Ssam /* reset interface, enable, and wait till dust settles */ 1437024Ssam addr->vvicsr = VV_RST; 1447024Ssam addr->vvocsr = VV_RST; 1457024Ssam DELAY(100000); 1467024Ssam /* generate interrupt by doing 1 word DMA from 0 in uba space!! */ 1477024Ssam addr->vvocsr = VV_IEN; /* enable interrupt */ 1487024Ssam addr->vvoba = 0; /* low 16 bits */ 1497024Ssam addr->vvoea = 0; /* extended bits */ 1507024Ssam addr->vvowc = -1; /* for 1 word */ 1517024Ssam addr->vvocsr |= VV_DEN; /* start the DMA */ 1527024Ssam DELAY(100000); 1537024Ssam addr->vvocsr = 0; 1547024Ssam if (cvec && cvec != 0x200) 1557024Ssam cvec -= 4; /* backup so vector => recieve */ 1567024Ssam return(1); 1577024Ssam } 1587024Ssam 1597024Ssam /* 1607024Ssam * Interface exists: make available by filling in network interface 1617024Ssam * record. System will initialize the interface when it is ready 1627024Ssam * to accept packets. 1637024Ssam */ 1647024Ssam vvattach(ui) 1657024Ssam struct uba_device *ui; 1667024Ssam { 1677024Ssam register struct vv_softc *vs = &vv_softc[ui->ui_unit]; 1687024Ssam register struct sockaddr_in *sin; 1697024Ssam 1707024Ssam vs->vs_if.if_unit = ui->ui_unit; 1717024Ssam vs->vs_if.if_name = "vv"; 1727024Ssam vs->vs_if.if_mtu = VVMTU; 1737024Ssam vs->vs_if.if_net = ui->ui_flags; 1747024Ssam vs->vs_if.if_host[0] = 0; /* this will be reset in vvinit() */ 1757024Ssam sin = (struct sockaddr_in *)&vs->vs_if.if_addr; 1767024Ssam sin->sin_family = AF_INET; 1777024Ssam sin->sin_addr = if_makeaddr(vs->vs_if.if_net, vs->vs_if.if_host[0]); 1787024Ssam sin = (struct sockaddr_in *)&vs->vs_if.if_broadaddr; 1797024Ssam sin->sin_family = AF_INET; 1807024Ssam sin->sin_addr = if_makeaddr(vs->vs_if.if_net, VV_BROADCAST); 1817024Ssam vs->vs_if.if_flags = IFF_BROADCAST; 1827024Ssam vs->vs_if.if_init = vvinit; 1837024Ssam vs->vs_if.if_output = vvoutput; 18411209Ssam vs->vs_if.if_reset = vvreset; 1857640Ssam vs->vs_ifuba.ifu_flags = UBA_CANTWAIT | UBA_NEEDBDP | UBA_NEED16; 1867024Ssam if_attach(&vs->vs_if); 1877024Ssam } 1887024Ssam 1897024Ssam /* 1907024Ssam * Reset of interface after UNIBUS reset. 1917024Ssam * If interface is on specified uba, reset its state. 1927024Ssam */ 1937024Ssam vvreset(unit, uban) 1947024Ssam int unit, uban; 1957024Ssam { 1967024Ssam register struct uba_device *ui; 1977024Ssam 1987024Ssam if (unit >= NVV || (ui = vvinfo[unit]) == 0 || ui->ui_alive == 0 || 1997024Ssam ui->ui_ubanum != uban) 2007024Ssam return; 2017024Ssam printf(" vv%d", unit); 2027024Ssam vvinit(unit); 2037024Ssam } 2047024Ssam 2057024Ssam /* 2067024Ssam * Initialization of interface; clear recorded pending 2077024Ssam * operations, and reinitialize UNIBUS usage. 2087024Ssam */ 2097024Ssam vvinit(unit) 2107024Ssam int unit; 2117024Ssam { 2127024Ssam register struct vv_softc *vs = &vv_softc[unit]; 2137024Ssam register struct uba_device *ui = vvinfo[unit]; 2147024Ssam register struct vvreg *addr; 2157024Ssam struct sockaddr_in *sin; 2167640Ssam int ubainfo, s; 21711192Ssam int vvtimeout(); 2187024Ssam 2197640Ssam addr = (struct vvreg *)ui->ui_addr; 2207024Ssam if (if_ubainit(&vs->vs_ifuba, ui->ui_ubanum, 2217024Ssam sizeof (struct vv_header), (int)btoc(VVMTU)) == 0) { 2227024Ssam printf("vv%d: can't initialize\n", unit); 2237640Ssam vs->vs_if.if_flags &= ~IFF_UP; 2247024Ssam return; 2257024Ssam } 22611209Ssam if (vv_ticking++ == 0) 22711209Ssam timeout(vvtimeout, (caddr_t) 0, VV_FLYWHEEL); 2287024Ssam /* 22911209Ssam * Discover our host address and post it 2307640Ssam */ 2317640Ssam vs->vs_if.if_host[0] = vvidentify(unit); 2327640Ssam printf("vv%d: host %d\n", unit, vs->vs_if.if_host[0]); 2337640Ssam sin = (struct sockaddr_in *)&vs->vs_if.if_addr; 2347640Ssam sin->sin_family = AF_INET; 23511209Ssam sin->sin_addr = if_makeaddr(vs->vs_if.if_net, vs->vs_if.if_host[0]); 2367640Ssam 2377640Ssam /* 2387640Ssam * Reset the interface, and join the ring 2397640Ssam */ 2407640Ssam addr->vvocsr = VV_RST | VV_CPB; /* clear packet buffer */ 2417640Ssam addr->vvicsr = VV_RST | VV_CONF; /* close logical relay */ 2427640Ssam sleep((caddr_t)&lbolt, PZERO); /* let contacts settle */ 2437640Ssam vs->vs_init = 0; 24411192Ssam vs->vs_dropped = 0; 2457640Ssam vs->vs_nottaken = 0; 2467640Ssam 2477640Ssam /* 2487640Ssam * Hang a receive and start any 2497640Ssam * pending writes by faking a transmit complete. 2507640Ssam */ 2517640Ssam s = splimp(); 2527640Ssam ubainfo = vs->vs_ifuba.ifu_r.ifrw_info; 2537640Ssam addr->vviba = (u_short) ubainfo; 2547640Ssam addr->vviea = (u_short) (ubainfo >> 16); 2557640Ssam addr->vviwc = -(sizeof (struct vv_header) + VVMTU) >> 1; 2567640Ssam addr->vvicsr = VV_IEN | VV_CONF | VV_DEN | VV_ENB; 25711192Ssam vs->vs_iactive = ACTIVE; 2587640Ssam vs->vs_oactive = 1; 2597640Ssam vs->vs_if.if_flags |= IFF_UP; 2607640Ssam vvxint(unit); 2617640Ssam splx(s); 2627640Ssam if_rtinit(&vs->vs_if, RTF_UP); 2637640Ssam } 2647640Ssam 2657640Ssam /* 2667640Ssam * vvidentify() - return our host address 2677640Ssam */ 26811209Ssam vvidentify(unit) 26911209Ssam { 2707640Ssam register struct vv_softc *vs = &vv_softc[unit]; 2717640Ssam register struct uba_device *ui = vvinfo[unit]; 2727640Ssam register struct vvreg *addr; 2737640Ssam struct mbuf *m; 2747640Ssam struct vv_header *v; 2757640Ssam int ubainfo, retrying, attempts, waitcount, s; 2767640Ssam 2777640Ssam /* 2787024Ssam * Build a multicast message to identify our address 2797024Ssam */ 2807640Ssam addr = (struct vvreg *)ui->ui_addr; 2817024Ssam attempts = 0; /* total attempts, including bad msg type */ 2827024Ssam retrying = 0; /* first time through */ 28311209Ssam m = m_get(M_DONTWAIT, MT_HEADER); 28411192Ssam if (m == 0) 28511192Ssam panic("vvinit: can't get mbuf"); 28611192Ssam m->m_next = 0; 2877024Ssam m->m_off = MMINOFF; 2887024Ssam m->m_len = sizeof(struct vv_header); 2897024Ssam v = mtod(m, struct vv_header *); 29011192Ssam v->vh_dhost = VV_BROADCAST; /* multicast destination address */ 2917024Ssam v->vh_shost = 0; /* will be overwritten with ours */ 2927024Ssam v->vh_version = RING_VERSION; 2937024Ssam v->vh_type = RING_WHOAMI; 2947024Ssam v->vh_info = 0; 29511192Ssam /* map xmit message into uba */ 2967640Ssam vs->vs_olen = if_wubaput(&vs->vs_ifuba, m); 2977640Ssam if (vs->vs_ifuba.ifu_flags & UBA_NEEDBDP) 2987640Ssam UBAPURGE(vs->vs_ifuba.ifu_uba, vs->vs_ifuba.ifu_w.ifrw_bdp); 2997024Ssam /* 3007024Ssam * Reset interface, establish Digital Loopback Mode, and 3017024Ssam * send the multicast (to myself) with Input Copy enabled. 3027024Ssam */ 3037024Ssam retry: 3047024Ssam ubainfo = vs->vs_ifuba.ifu_r.ifrw_info; 3057024Ssam addr->vvicsr = VV_RST; 3067024Ssam addr->vviba = (u_short) ubainfo; 3077024Ssam addr->vviea = (u_short) (ubainfo >> 16); 3087024Ssam addr->vviwc = -(sizeof (struct vv_header) + VVMTU) >> 1; 3097024Ssam addr->vvicsr = VV_STE | VV_DEN | VV_ENB | VV_LPB; 3107640Ssam 3117640Ssam /* let flag timers fire so ring will initialize */ 31212164Ssam DELAY(2000000); 3137640Ssam 3147024Ssam addr->vvocsr = VV_RST | VV_CPB; /* clear packet buffer */ 3157024Ssam ubainfo = vs->vs_ifuba.ifu_w.ifrw_info; 3167024Ssam addr->vvoba = (u_short) ubainfo; 3177024Ssam addr->vvoea = (u_short) (ubainfo >> 16); 3187024Ssam addr->vvowc = -((vs->vs_olen + 1) >> 1); 3197024Ssam addr->vvocsr = VV_CPB | VV_DEN | VV_INR | VV_ENB; 3207024Ssam /* 3217024Ssam * Wait for receive side to finish. 32211192Ssam * Extract source address (which will our own), 3237024Ssam * and post to interface structure. 3247024Ssam */ 3257024Ssam DELAY(1000); 32611192Ssam for (waitcount = 0; (addr->vvicsr & VV_RDY) == 0; waitcount++) { 3279876Ssam if (waitcount < 10) { 3287024Ssam DELAY(1000); 32911209Ssam continue; 33011192Ssam } 33111209Ssam if (attempts++ >= 10) { 33211209Ssam printf("vv%d: can't initialize\n", unit); 33311209Ssam printf("vvinit loopwait: icsr = %b\n", 33411209Ssam 0xffff&(addr->vvicsr), VV_IBITS); 33511209Ssam vs->vs_if.if_flags &= ~IFF_UP; 33611209Ssam return; 3377024Ssam } 33811209Ssam goto retry; 33911192Ssam } 3407024Ssam if (vs->vs_ifuba.ifu_flags & UBA_NEEDBDP) 3417024Ssam UBAPURGE(vs->vs_ifuba.ifu_uba, vs->vs_ifuba.ifu_w.ifrw_bdp); 3427024Ssam if (vs->vs_ifuba.ifu_xtofree) 3437024Ssam m_freem(vs->vs_ifuba.ifu_xtofree); 3447024Ssam if (vs->vs_ifuba.ifu_flags & UBA_NEEDBDP) 3457024Ssam UBAPURGE(vs->vs_ifuba.ifu_uba, vs->vs_ifuba.ifu_r.ifrw_bdp); 3467024Ssam m = if_rubaget(&vs->vs_ifuba, sizeof(struct vv_header), 0); 34711209Ssam if (m != NULL) 3487024Ssam m_freem(m); 3497024Ssam /* 35011209Ssam * Check message type before we believe the source host address 3517024Ssam */ 3527024Ssam v = (struct vv_header *)(vs->vs_ifuba.ifu_r.ifrw_addr); 35311209Ssam if (v->vh_type != RING_WHOAMI) 3547640Ssam goto retry; 35511209Ssam return(v->vh_shost); 3567024Ssam } 3577024Ssam 3587024Ssam /* 35911192Ssam * vvtimeout() - called by timer flywheel to monitor input packet 36011192Ssam * discard rate. Interfaces getting too many errors are shut 36111192Ssam * down for a while. If the condition persists, the interface 36211192Ssam * is marked down. 36311192Ssam */ 36411192Ssam vvtimeout(junk) 36511209Ssam int junk; 36611192Ssam { 36711192Ssam register struct vv_softc *vs; 36811192Ssam register int i; 36911192Ssam register struct vvreg *addr; 37011192Ssam int ubainfo; 37111192Ssam 37211192Ssam timeout(vvtimeout, (caddr_t) 0, VV_FLYWHEEL); 37311209Ssam for (i = 0; i < NVV; i++) { 37411192Ssam vs = &vv_softc[i]; 37511192Ssam addr = (struct vvreg *)vvinfo[i]->ui_addr; 37611192Ssam if (vs->vs_if.if_flags & IFF_UP == 0) continue; 37711192Ssam switch (vs->vs_major) { 37811192Ssam 37911192Ssam /* 38011192Ssam * MODE0: generally OK, just check error rate 38111192Ssam */ 38211192Ssam case MODE0: 38311192Ssam if (vs->vs_dropped < VV_ERRORTHRESHOLD) { 38411192Ssam vs->vs_dropped = 0; 38511192Ssam continue; 38611192Ssam } 38711209Ssam /* suspend reads for a while */ 38811209Ssam vvtrprintf("vv%d going MODE1 in vvtimeout\n",i); 38911209Ssam vs->vs_major = MODE1; 39011209Ssam vs->vs_iactive = PAUSE; /* no new reads */ 39111209Ssam vs->vs_retry = VV_MODE1ATTEMPTS; 39211209Ssam vs->vs_delayclock = VV_MODE1DELAY; 39311209Ssam vs->vs_minor = 0; 39411209Ssam continue; 39511192Ssam 39611192Ssam /* 39711192Ssam * MODE1: excessive error rate observed 39811192Ssam * Scheme: try simply suspending reads for a 39911192Ssam * short while a small number of times 40011192Ssam */ 40111192Ssam case MODE1: 40211192Ssam if (vs->vs_delayclock > 0) { 40311192Ssam vs->vs_delayclock--; 40411192Ssam continue; 40511192Ssam } 40611192Ssam switch (vs->vs_minor) { 40711209Ssam 40811192Ssam case 0: /* reenable reads */ 40911192Ssam vvtrprintf("vv%d M1m0\n",i); 41011192Ssam vs->vs_dropped = 0; 41111192Ssam vs->vs_iactive = ACTIVE; 41211192Ssam vs->vs_minor = 1; /* next state */ 41311192Ssam ubainfo = vs->vs_ifuba.ifu_r.ifrw_info; 41411192Ssam addr->vviba = (u_short) ubainfo; 41511192Ssam addr->vviea = (u_short) (ubainfo >> 16); 41611209Ssam addr->vviwc = 41711209Ssam -(sizeof (struct vv_header) + VVMTU) >> 1; 41811192Ssam addr->vvicsr = VV_RST | VV_CONF; 41911192Ssam addr->vvicsr |= VV_IEN | VV_DEN | VV_ENB; 42011192Ssam continue; 42111209Ssam 42211192Ssam case 1: /* see if it worked */ 42311192Ssam vvtrprintf("vv%d M1m1\n",i); 42411192Ssam if (vs->vs_dropped < VV_ERRORTHRESHOLD) { 42511192Ssam vs->vs_dropped = 0; 42611192Ssam vs->vs_major = MODE0; /* yeah!! */ 42711192Ssam continue; 42811192Ssam } 42911209Ssam if (vs->vs_retry -- > 0) { 43011209Ssam vs->vs_dropped = 0; 43111209Ssam vs->vs_iactive = PAUSE; 43211209Ssam vs->vs_delayclock = VV_MODE1DELAY; 43311209Ssam vs->vs_minor = 0; /* recheck */ 43411209Ssam continue; 43511192Ssam } 43611209Ssam vs->vs_major = MODE2; 43711209Ssam vs->vs_minor = 0; 43811209Ssam vs->vs_dropped = 0; 43911209Ssam vs->vs_iactive = OPEN; 44011209Ssam vs->vs_delayrange = VV_MODE2DELAY; 44111209Ssam vs->vs_delayclock = VV_MODE2DELAY; 44211209Ssam /* fall thru ... */ 44311192Ssam } 44411192Ssam 44511192Ssam /* 44611192Ssam * MODE2: simply ignoring traffic didn't relieve condition 44711192Ssam * Scheme: open host relay for intervals linearly 44811192Ssam * increasing up to some maximum of a several minutes. 44911192Ssam * This allows broken networks to return to operation 45011192Ssam * without rebooting. 45111192Ssam */ 45211192Ssam case MODE2: 45311192Ssam if (vs->vs_delayclock > 0) { 45411192Ssam vs->vs_delayclock--; 45511192Ssam continue; 45611192Ssam } 45711192Ssam switch (vs->vs_minor) { 45811209Ssam 45911192Ssam case 0: /* close relay and reenable reads */ 46011192Ssam vvtrprintf("vv%d M2m0\n",i); 46111192Ssam vs->vs_dropped = 0; 46211192Ssam vs->vs_iactive = ACTIVE; 46311192Ssam vs->vs_minor = 1; /* next state */ 46411192Ssam ubainfo = vs->vs_ifuba.ifu_r.ifrw_info; 46511192Ssam addr->vviba = (u_short) ubainfo; 46611192Ssam addr->vviea = (u_short) (ubainfo >> 16); 46711209Ssam addr->vviwc = 46811209Ssam -(sizeof (struct vv_header) + VVMTU) >> 1; 46911192Ssam addr->vvicsr = VV_RST | VV_CONF; 47011192Ssam addr->vvicsr |= VV_IEN | VV_DEN | VV_ENB; 47111192Ssam continue; 47211209Ssam 47311192Ssam case 1: /* see if it worked */ 47411192Ssam vvtrprintf("vv%d M2m1\n",i); 47511192Ssam if (vs->vs_dropped < VV_ERRORTHRESHOLD) { 47611192Ssam vs->vs_dropped = 0; 47711192Ssam vs->vs_major = MODE0; /* yeah!! */ 47811192Ssam continue; 47911192Ssam } 48011209Ssam vvtrprintf("vv%d M2m1 ++ delay\n",i); 48111209Ssam vs->vs_dropped = 0; 48211209Ssam vs->vs_iactive = OPEN; 48311209Ssam vs->vs_minor = 0; 48411209Ssam if (vs->vs_delayrange < VV_MAXDELAY) 48511209Ssam vs->vs_delayrange += 48611209Ssam (vs->vs_delayrange/2); 48711209Ssam vs->vs_delayclock = vs->vs_delayrange; 48811209Ssam continue; 48911192Ssam } 49011192Ssam 49111192Ssam default: 49211192Ssam printf("vv%d: major state screwed\n", i); 49311192Ssam vs->vs_if.if_flags &= ~IFF_UP; 49411192Ssam } 49511192Ssam } 49611192Ssam } 49711192Ssam 49811192Ssam /* 4997024Ssam * Start or restart output on interface. 50011192Ssam * If interface is active, this is a retransmit, so just 50111192Ssam * restuff registers and go. 5027024Ssam * If interface is not already active, get another datagram 5037024Ssam * to send off of the interface queue, and map it to the interface 5047024Ssam * before starting the output. 5057024Ssam */ 5067024Ssam vvstart(dev) 5077024Ssam dev_t dev; 5087024Ssam { 5097024Ssam int unit = VVUNIT(dev); 5107024Ssam struct uba_device *ui = vvinfo[unit]; 5117024Ssam register struct vv_softc *vs = &vv_softc[unit]; 5127024Ssam register struct vvreg *addr; 5137024Ssam struct mbuf *m; 51411192Ssam int ubainfo; 51511192Ssam int dest; 5167024Ssam 5177024Ssam if (vs->vs_oactive) 5187024Ssam goto restart; 5197024Ssam /* 5207024Ssam * Not already active: dequeue another request 5217024Ssam * and map it to the UNIBUS. If no more requests, 5227024Ssam * just return. 5237024Ssam */ 5247024Ssam IF_DEQUEUE(&vs->vs_if.if_snd, m); 52511209Ssam if (m == NULL) { 5267024Ssam vs->vs_oactive = 0; 5277024Ssam return; 5287024Ssam } 5297024Ssam dest = mtod(m, struct vv_header *)->vh_dhost; 5307024Ssam vs->vs_olen = if_wubaput(&vs->vs_ifuba, m); 5317024Ssam vs->vs_lastx = dest; 5327024Ssam restart: 5337024Ssam /* 5347024Ssam * Have request mapped to UNIBUS for transmission. 5357024Ssam * Purge any stale data from this BDP, and start the otput. 5367024Ssam */ 537*12172Ssam if (vs->vs_olen > VVMTU + sizeof (struct vvheader)) { 53811192Ssam printf("vv%d vs_olen: %d > VVMTU\n", unit, vs->vs_olen); 53911192Ssam panic("vvdriver vs_olen botch"); 54011192Ssam } 5417024Ssam if (vs->vs_ifuba.ifu_flags & UBA_NEEDBDP) 5427024Ssam UBAPURGE(vs->vs_ifuba.ifu_uba, vs->vs_ifuba.ifu_w.ifrw_bdp); 5437024Ssam addr = (struct vvreg *)ui->ui_addr; 5447024Ssam ubainfo = vs->vs_ifuba.ifu_w.ifrw_info; 5457024Ssam addr->vvoba = (u_short) ubainfo; 5467024Ssam addr->vvoea = (u_short) (ubainfo >> 16); 5477024Ssam addr->vvowc = -((vs->vs_olen + 1) >> 1); 5487024Ssam addr->vvocsr = VV_IEN | VV_CPB | VV_DEN | VV_INR | VV_ENB; 5497024Ssam vs->vs_oactive = 1; 5507024Ssam } 5517024Ssam 5527024Ssam /* 5537024Ssam * VVLNI transmit interrupt 5547024Ssam * Start another output if more data to send. 5557024Ssam */ 5567024Ssam vvxint(unit) 5577024Ssam int unit; 5587024Ssam { 5597024Ssam register struct uba_device *ui = vvinfo[unit]; 5607024Ssam register struct vv_softc *vs = &vv_softc[unit]; 5617024Ssam register struct vvreg *addr; 5627024Ssam register int oc; 5637024Ssam 5647024Ssam addr = (struct vvreg *)ui->ui_addr; 5657024Ssam oc = 0xffff & (addr->vvocsr); 5667024Ssam if (vs->vs_oactive == 0) { 56711192Ssam printf("vv%d: stray interrupt vvocsr = %b\n", unit, 5687024Ssam oc, VV_OBITS); 5697024Ssam return; 5707024Ssam } 5717024Ssam if (oc & (VV_OPT | VV_RFS)) { 5727640Ssam vs->vs_if.if_collisions++; 57311192Ssam if (vs->vs_tries++ < VVRETRY) { 5747024Ssam if (oc & VV_OPT) 5757024Ssam vs->vs_init++; 5767024Ssam if (oc & VV_RFS) 5777024Ssam vs->vs_nottaken++; 57811192Ssam vvstart(unit); /* restart this message */ 5797024Ssam return; 5807024Ssam } 5817024Ssam if (oc & VV_OPT) 5827024Ssam printf("vv%d: output timeout\n"); 5837024Ssam } 5847024Ssam vs->vs_if.if_opackets++; 5857024Ssam vs->vs_oactive = 0; 5867024Ssam vs->vs_tries = 0; 5877024Ssam if (oc & VVXERR) { 5887024Ssam vs->vs_if.if_oerrors++; 58911192Ssam printf("vv%d: error vvocsr = %b\n", unit, 0xffff & oc, 5907024Ssam VV_OBITS); 5917024Ssam } 5927024Ssam if (vs->vs_ifuba.ifu_xtofree) { 5937024Ssam m_freem(vs->vs_ifuba.ifu_xtofree); 5947024Ssam vs->vs_ifuba.ifu_xtofree = 0; 5957024Ssam } 5967024Ssam if (vs->vs_if.if_snd.ifq_head == 0) { 59711192Ssam vs->vs_lastx = 256; /* an invalid address */ 5987024Ssam return; 5997024Ssam } 6007024Ssam vvstart(unit); 6017024Ssam } 6027024Ssam 6037024Ssam /* 6047024Ssam * V2lni interface receiver interrupt. 6057024Ssam * If input error just drop packet. 6067024Ssam * Otherwise purge input buffered data path and examine 6077024Ssam * packet to determine type. If can't determine length 6087024Ssam * from type, then have to drop packet. Othewise decapsulate 6097024Ssam * packet based on type and pass to type specific higher-level 6107024Ssam * input routine. 6117024Ssam */ 6127024Ssam vvrint(unit) 6137024Ssam int unit; 6147024Ssam { 6157024Ssam register struct vv_softc *vs = &vv_softc[unit]; 6167024Ssam struct vvreg *addr = (struct vvreg *)vvinfo[unit]->ui_addr; 6177024Ssam register struct vv_header *vv; 6187024Ssam register struct ifqueue *inq; 6197024Ssam struct mbuf *m; 6207024Ssam int ubainfo, len, off; 6217640Ssam short resid; 6227024Ssam 6237024Ssam vs->vs_if.if_ipackets++; 6247024Ssam /* 6257024Ssam * Purge BDP; drop if input error indicated. 6267024Ssam */ 6277024Ssam if (vs->vs_ifuba.ifu_flags & UBA_NEEDBDP) 6287024Ssam UBAPURGE(vs->vs_ifuba.ifu_uba, vs->vs_ifuba.ifu_r.ifrw_bdp); 6297024Ssam if (addr->vvicsr & VVRERR) { 63011192Ssam if (vv_logreaderrors) 63111192Ssam printf("vv%d: error vvicsr = %b\n", unit, 63211192Ssam 0xffff&(addr->vvicsr), VV_IBITS); 6337640Ssam goto dropit; 6347024Ssam } 6357640Ssam 6367024Ssam /* 6377640Ssam * Get packet length from word count residue 6387640Ssam * 6397640Ssam * Compute header offset if trailer protocol 6407640Ssam * 6417640Ssam * Pull packet off interface. Off is nonzero if packet 6427640Ssam * has trailing header; if_rubaget will then force this header 6437640Ssam * information to be at the front. The vh_info field 6447640Ssam * carries the offset to the trailer data in trailer 6457640Ssam * format packets. 6467024Ssam */ 6477640Ssam vv = (struct vv_header *)(vs->vs_ifuba.ifu_r.ifrw_addr); 64811192Ssam vvtracehdr("vi", vv); 6497640Ssam resid = addr->vviwc; 6507640Ssam if (resid) 6517640Ssam resid |= 0176000; /* ugly!!!! */ 6527640Ssam len = (((sizeof (struct vv_header) + VVMRU) >> 1) + resid) << 1; 6537640Ssam len -= sizeof(struct vv_header); 65411192Ssam if (len > VVMRU || len <= 0) 6557640Ssam goto dropit; 6567640Ssam #define vvdataaddr(vv, off, type) ((type)(((caddr_t)((vv)+1)+(off)))) 6577640Ssam if (vv_dotrailer && vv->vh_type >= RING_IPTrailer && 6587640Ssam vv->vh_type < RING_IPTrailer+RING_IPNTrailer){ 6597640Ssam off = (vv->vh_type - RING_IPTrailer) * 512; 6607640Ssam if (off > VVMTU) 6617640Ssam goto dropit; 6627640Ssam vv->vh_type = *vvdataaddr(vv, off, u_short *); 6637640Ssam resid = *(vvdataaddr(vv, off+2, u_short *)); 6647640Ssam if (off + resid > len) 6657640Ssam goto dropit; 6667640Ssam len = off + resid; 66711209Ssam } else 6687640Ssam off = 0; 6697640Ssam if (len == 0) 6707640Ssam goto dropit; 6717640Ssam m = if_rubaget(&vs->vs_ifuba, len, off); 67211209Ssam if (m == NULL) 6737640Ssam goto dropit; 6747640Ssam if (off) { 6757640Ssam m->m_off += 2 * sizeof(u_short); 6767640Ssam m->m_len -= 2 * sizeof(u_short); 6777640Ssam } 67811192Ssam 67911192Ssam /* 68011192Ssam * Demultiplex on packet type 68111192Ssam */ 6827024Ssam switch (vv->vh_type) { 68311192Ssam 6847024Ssam #ifdef INET 6857024Ssam case RING_IP: 6867024Ssam schednetisr(NETISR_IP); 6877024Ssam inq = &ipintrq; 6887024Ssam break; 6897024Ssam #endif 6907024Ssam default: 6917024Ssam printf("vv%d: unknown pkt type 0x%x\n", unit, vv->vh_type); 6927640Ssam m_freem(m); 6937024Ssam goto setup; 6947024Ssam } 6957640Ssam if (IF_QFULL(inq)) { 6967640Ssam IF_DROP(inq); 6977640Ssam m_freem(m); 69811209Ssam } else 6997640Ssam IF_ENQUEUE(inq, m); 7007024Ssam setup: 7017024Ssam /* 70211192Ssam * Check the error rate and start recovery if needed 70311192Ssam * this has to go here since the timer flywheel runs at 70411192Ssam * a lower ipl and never gets a chance to change the mode 7057024Ssam */ 70611192Ssam if (vs->vs_major == MODE0 && vs->vs_dropped > VV_ERRORTHRESHOLD) { 70711192Ssam vvtrprintf("vv%d going MODE1 in vvrint\n",unit); 70811192Ssam vs->vs_major = MODE1; 70911192Ssam vs->vs_iactive = PAUSE; /* no new reads */ 71011192Ssam vs->vs_retry = VV_MODE1ATTEMPTS; 71111192Ssam vs->vs_delayclock = VV_MODE1DELAY; 71211192Ssam vs->vs_minor = 0; 71311192Ssam vs->vs_dropped = 0; 71411192Ssam } 71511192Ssam switch (vs->vs_iactive) { 71611192Ssam 71711209Ssam case ACTIVE: /* Restart the read for next packet */ 71811192Ssam ubainfo = vs->vs_ifuba.ifu_r.ifrw_info; 71911192Ssam addr->vviba = (u_short) ubainfo; 72011192Ssam addr->vviea = (u_short) (ubainfo >> 16); 72111192Ssam addr->vviwc = -(sizeof (struct vv_header) + VVMTU) >> 1; 72211192Ssam addr->vvicsr = VV_RST | VV_CONF; 72311192Ssam addr->vvicsr |= VV_IEN | VV_DEN | VV_ENB; 72411192Ssam return; 72511192Ssam 72611209Ssam case PAUSE: /* requested to not start any new reads */ 72711192Ssam vs->vs_dropped = 0; 72811192Ssam return; 72911192Ssam 73011209Ssam case OPEN: /* request to open host relay */ 73111192Ssam vs->vs_dropped = 0; 73211192Ssam addr->vvicsr = 0; 73311192Ssam return; 73411192Ssam 73511192Ssam default: 73611192Ssam printf("vv%d: vs_iactive = %d\n", unit, vs->vs_iactive); 73711192Ssam return; 73811192Ssam } 73911192Ssam /* 74011209Ssam * Drop packet on floor -- count them!! 74111192Ssam */ 7427640Ssam dropit: 7437640Ssam vs->vs_if.if_ierrors++; 74411192Ssam vs->vs_dropped++; 7457640Ssam /* 7467640Ssam printf("vv%d: error vvicsr = %b\n", unit, 7477640Ssam 0xffff&(addr->vvicsr), VV_IBITS); 7487640Ssam */ 7497640Ssam goto setup; 7507024Ssam } 7517024Ssam 7527024Ssam /* 7537024Ssam * V2lni output routine. 7547024Ssam * Encapsulate a packet of type family for the local net. 7557024Ssam * Use trailer local net encapsulation if enough data in first 7567024Ssam * packet leaves a multiple of 512 bytes of data in remainder. 7577024Ssam */ 7587024Ssam vvoutput(ifp, m0, dst) 7597024Ssam struct ifnet *ifp; 7607024Ssam struct mbuf *m0; 7617024Ssam struct sockaddr *dst; 7627024Ssam { 7637024Ssam register struct mbuf *m = m0; 7647024Ssam register struct vv_header *vv; 7657640Ssam register int off; 7667640Ssam int type, dest, s, error; 7677024Ssam 7687024Ssam switch (dst->sa_family) { 76911192Ssam 7707024Ssam #ifdef INET 7717024Ssam case AF_INET: { 7727640Ssam dest = ((struct sockaddr_in *)dst)->sin_addr.s_addr; 77311192Ssam if ((dest = in_lnaof(*((struct in_addr *)&dest))) >= 0x100) { 7747640Ssam error = EPERM; 7757640Ssam goto bad; 7767640Ssam } 7777640Ssam off = ntohs((u_short)mtod(m, struct ip *)->ip_len) - m->m_len; 7787640Ssam if (vv_dotrailer && off > 0 && (off & 0x1ff) == 0 && 7797640Ssam m->m_off >= MMINOFF + 2 * sizeof (u_short)) { 7807640Ssam type = RING_IPTrailer + (off>>9); 7817640Ssam m->m_off -= 2 * sizeof (u_short); 7827640Ssam m->m_len += 2 * sizeof (u_short); 7837640Ssam *mtod(m, u_short *) = RING_IP; 7847640Ssam *(mtod(m, u_short *) + 1) = m->m_len; 7857640Ssam goto gottrailertype; 7867640Ssam } 7877024Ssam type = RING_IP; 7887024Ssam off = 0; 7897024Ssam goto gottype; 7907024Ssam } 7917024Ssam #endif 7927024Ssam default: 7937024Ssam printf("vv%d: can't handle af%d\n", ifp->if_unit, 7947024Ssam dst->sa_family); 7957640Ssam error = EAFNOSUPPORT; 7967640Ssam goto bad; 7977024Ssam } 7987024Ssam 7997024Ssam gottrailertype: 8007024Ssam /* 8017024Ssam * Packet to be sent as trailer: move first packet 8027024Ssam * (control information) to end of chain. 8037024Ssam */ 8047024Ssam while (m->m_next) 8057024Ssam m = m->m_next; 8067024Ssam m->m_next = m0; 8077024Ssam m = m0->m_next; 8087024Ssam m0->m_next = 0; 8097024Ssam m0 = m; 8107024Ssam gottype: 8117024Ssam /* 8127024Ssam * Add local net header. If no space in first mbuf, 8137024Ssam * allocate another. 8147024Ssam */ 8157024Ssam if (m->m_off > MMAXOFF || 8167024Ssam MMINOFF + sizeof (struct vv_header) > m->m_off) { 81711209Ssam m = m_get(M_DONTWAIT, MT_HEADER); 81811209Ssam if (m == NULL) { 8197640Ssam error = ENOBUFS; 8207640Ssam goto bad; 8217024Ssam } 8227024Ssam m->m_next = m0; 8237024Ssam m->m_off = MMINOFF; 8247024Ssam m->m_len = sizeof (struct vv_header); 8257024Ssam } else { 8267024Ssam m->m_off -= sizeof (struct vv_header); 8277024Ssam m->m_len += sizeof (struct vv_header); 8287024Ssam } 8297024Ssam vv = mtod(m, struct vv_header *); 8307024Ssam vv->vh_shost = ifp->if_host[0]; 8317024Ssam vv->vh_dhost = dest; 8327024Ssam vv->vh_version = RING_VERSION; 8337024Ssam vv->vh_type = type; 8347640Ssam vv->vh_info = off; 83511192Ssam vvtracehdr("vo", vv); 8367024Ssam 8377024Ssam /* 8387024Ssam * Queue message on interface, and start output if interface 8397024Ssam * not yet active. 8407024Ssam */ 8417024Ssam s = splimp(); 8427640Ssam if (IF_QFULL(&ifp->if_snd)) { 8437640Ssam IF_DROP(&ifp->if_snd); 8447640Ssam error = ENOBUFS; 8457640Ssam goto qfull; 8467640Ssam } 8477024Ssam IF_ENQUEUE(&ifp->if_snd, m); 8487024Ssam if (vv_softc[ifp->if_unit].vs_oactive == 0) 8497024Ssam vvstart(ifp->if_unit); 8507024Ssam splx(s); 8517640Ssam return (0); 8527640Ssam qfull: 8537640Ssam m0 = m; 8547640Ssam splx(s); 8557640Ssam bad: 8567640Ssam m_freem(m0); 8577640Ssam return(error); 8587024Ssam } 8597024Ssam 8607024Ssam /* 8617024Ssam * vvprt_hdr(s, v) print the local net header in "v" 8627024Ssam * with title is "s" 8637024Ssam */ 8647024Ssam vvprt_hdr(s, v) 8657024Ssam char *s; 8667024Ssam register struct vv_header *v; 8677024Ssam { 8687024Ssam printf("%s: dsvti: 0x%x 0x%x 0x%x 0x%x 0x%x\n", 8697024Ssam s, 8707024Ssam 0xff & (int)(v->vh_dhost), 0xff & (int)(v->vh_shost), 8717024Ssam 0xff & (int)(v->vh_version), 0xff & (int)(v->vh_type), 8727024Ssam 0xffff & (int)(v->vh_info)); 8737024Ssam } 8747024Ssam 8757024Ssam /* 8767024Ssam * print "l" hex bytes starting at "s" 8777024Ssam */ 8787024Ssam vvprt_hex(s, l) 8797024Ssam char *s; 8807024Ssam int l; 8817024Ssam { 8827024Ssam register int i; 8837024Ssam register int z; 8847024Ssam 8857024Ssam for (i=0 ; i < l; i++) { 8867024Ssam z = 0xff & (int)(*(s + i)); 8877024Ssam printf("%c%c ", 8887024Ssam "0123456789abcdef"[(z >> 4) & 0x0f], 8897024Ssam "0123456789abcdef"[z & 0x0f] 8907024Ssam ); 8917024Ssam } 8927024Ssam } 893