123166Smckusick /* 234853Sbostic * Copyright (c) 1982, 1986, 1988 Regents of the University of California. 333453Skarels * All rights reserved. 423166Smckusick * 5*44467Sbostic * %sccs.include.redist.c% 633453Skarels * 7*44467Sbostic * @(#)if_imp.c 7.13 (Berkeley) 06/28/90 823166Smckusick */ 95640Sroot 105640Sroot #include "imp.h" 115640Sroot #if NIMP > 0 125640Sroot /* 1333453Skarels * ARPANET IMP (PSN) interface driver. 145640Sroot * 1533453Skarels * The IMP-host protocol (AHIP) is handled here, leaving 165640Sroot * hardware specifics to the lower level interface driver. 175640Sroot */ 1817068Sbloom #include "param.h" 1917068Sbloom #include "systm.h" 2017068Sbloom #include "mbuf.h" 2117068Sbloom #include "buf.h" 2217068Sbloom #include "protosw.h" 2317068Sbloom #include "socket.h" 2417068Sbloom #include "time.h" 2517068Sbloom #include "kernel.h" 2617068Sbloom #include "errno.h" 2717068Sbloom #include "ioctl.h" 2833427Skarels #include "syslog.h" 298705Sroot 3037501Smckusick #include "machine/mtpr.h" 3133453Skarels 328705Sroot #include "../net/if.h" 338705Sroot #include "../net/netisr.h" 348408Swnj #include "../netinet/in.h" 358408Swnj #include "../netinet/in_systm.h" 3618412Skarels #include "../netinet/in_var.h" 378705Sroot #include "../netinet/ip.h" 388705Sroot #include "../netinet/ip_var.h" 3933427Skarels #define IMPMESSAGES 407199Ssam /* define IMPLEADERS here to get leader printing code */ 4117068Sbloom #include "if_imp.h" 4217068Sbloom #include "if_imphost.h" 435640Sroot 4433427Skarels struct imp_softc imp_softc[NIMP]; 4533453Skarels #ifndef lint 4633453Skarels int nimp = NIMP; /* for netstat */ 4733453Skarels #endif 4828849Skarels struct ifqueue impintrq; 4928849Skarels int impqmaxlen = IFQ_MAXLEN; 5033453Skarels int imphqlen = 12 + IMP_MAXHOSTMSG; /* max packets to queue per host */ 5124777Skarels 5233427Skarels int imppri = LOG_ERR; 5333427Skarels #ifdef IMPLEADERS 5433427Skarels int impprintfs = 0; 5533427Skarels #endif 5633427Skarels #ifdef IMPINIT 5733427Skarels int imptraceinit = 0; 5833427Skarels #endif 595640Sroot 6033453Skarels 6133427Skarels #define HOSTDEADTIMER (30 * PR_SLOWHZ) /* How long to wait when down */ 6218132Skarels 6333453Skarels int impdown(), impinit(), impioctl(), impoutput(), imptimo(); 645771Swnj 655640Sroot /* 665640Sroot * IMP attach routine. Called from hardware device attach routine 6733427Skarels * at configuration time with a pointer to the device structure. 685640Sroot * Sets up local state and returns pointer to base of ifnet+impcb 695640Sroot * structures. This is then used by the device's attach routine 705640Sroot * set up its back pointers. 715640Sroot */ 7233427Skarels struct imp_softc * 7334209Skarels impattach(hwname, hwunit, reset) 7434209Skarels char *hwname; 7534209Skarels int hwunit; 768815Sroot int (*reset)(); 775640Sroot { 7824777Skarels struct imp_softc *sc; 7924777Skarels register struct ifnet *ifp; 8033427Skarels static int impunit; 815640Sroot 8226397Skarels #ifdef lint 8326397Skarels impintr(); 8426397Skarels #endif 8533427Skarels if (impunit >= NIMP) { 8633427Skarels printf("imp%d: not configured\n", impunit++); 8724777Skarels return (0); 8824777Skarels } 8933427Skarels sc = &imp_softc[impunit]; 9024777Skarels ifp = &sc->imp_if; 9134209Skarels sc->imp_cb.ic_hwname = hwname; 9234209Skarels sc->imp_cb.ic_hwunit = hwunit; 9333427Skarels ifp->if_unit = impunit; 945640Sroot ifp->if_name = "imp"; 956271Sroot ifp->if_mtu = IMPMTU - sizeof(struct imp_leader); 969001Sroot ifp->if_reset = reset; 975771Swnj ifp->if_init = impinit; 9813067Ssam ifp->if_ioctl = impioctl; 995771Swnj ifp->if_output = impoutput; 10033453Skarels ifp->if_watchdog = imptimo; 1015640Sroot if_attach(ifp); 10233427Skarels impunit++; 10333427Skarels return (sc); 1045640Sroot } 1055640Sroot 1065640Sroot /* 1075640Sroot * IMP initialization routine: call hardware module to 10833427Skarels * setup resources, init state and get ready for 1095640Sroot * NOOPs the IMP should send us, and that we want to drop. 1105640Sroot */ 1115640Sroot impinit(unit) 1125640Sroot int unit; 1135640Sroot { 11432570Sbostic int s; 1155640Sroot register struct imp_softc *sc = &imp_softc[unit]; 1165640Sroot 11718412Skarels if (sc->imp_if.if_addrlist == 0) 11813067Ssam return; 11932570Sbostic s = splimp(); 12033427Skarels #ifdef IMPINIT 12133427Skarels if (imptraceinit) 12233427Skarels log(imppri, "impinit\n"); 12333427Skarels #endif 12433427Skarels sc->imp_state = IMPS_WINIT; 12533427Skarels if ((*sc->imp_cb.ic_init)(sc->imp_cb.ic_hwunit) == 0) 1266336Ssam sc->imp_if.if_flags &= ~IFF_UP; 12733427Skarels impintrq.ifq_maxlen = impqmaxlen; 1286500Ssam splx(s); 1295640Sroot } 1305640Sroot 1315640Sroot /* 13233453Skarels * ARPAnet 1822/AHIP input routine. 1335640Sroot * Called from hardware input interrupt routine to handle 1822 13433453Skarels * IMP-host messages. Data messages are passed to higher-level 13533453Skarels * protocol processors on the basis of link number. 13633453Skarels * Other type messages (control) are handled here. 1375640Sroot */ 1385771Swnj impinput(unit, m) 1395640Sroot int unit; 1405771Swnj register struct mbuf *m; 1415640Sroot { 14233427Skarels register struct control_leader *cp; 14333427Skarels #define ip ((struct imp_leader *)cp) 1445640Sroot register struct imp_softc *sc = &imp_softc[unit]; 14524777Skarels struct ifnet *ifp; 1465640Sroot register struct host *hp; 1475640Sroot register struct ifqueue *inq; 1486336Ssam struct sockaddr_in *sin; 14933453Skarels int s; 1505640Sroot 15124777Skarels /* 15224777Skarels * Pull the interface pointer out of the mbuf 15324777Skarels * and save for later; adjust mbuf to look at rest of data. 15424777Skarels */ 15535799Ssklower if ((m->m_flags && M_PKTHDR) == 0) 15635799Ssklower panic("No header in impinput"); 15735799Ssklower ifp = m->m_pkthdr.rcvif; 1586257Sroot /* verify leader length. */ 1595771Swnj if (m->m_len < sizeof(struct control_leader) && 1605771Swnj (m = m_pullup(m, sizeof(struct control_leader))) == 0) 1615771Swnj return; 1625771Swnj cp = mtod(m, struct control_leader *); 16333427Skarels if (cp->dl_mtype == IMPTYPE_DATA && 16433427Skarels m->m_len < sizeof(struct imp_leader)) { 16533427Skarels if ((m = m_pullup(m, sizeof(struct imp_leader))) == 0) 1665771Swnj return; 16733427Skarels cp = mtod(m, struct control_leader *); 16833427Skarels } 1697199Ssam #ifdef IMPLEADERS 1707170Ssam if (impprintfs) 1717170Ssam printleader("impinput", ip); 1727199Ssam #endif 17328849Skarels inq = &impintrq; 1745640Sroot 1756257Sroot /* check leader type */ 17633427Skarels if (cp->dl_format != IMP_NFF) { 17734209Skarels /* 17834209Skarels * We get 1822L NOOPs and RESET 17934209Skarels * at initialization. 18034209Skarels */ 18134209Skarels #ifdef IMPINIT 18234209Skarels if (imptraceinit) 18334209Skarels log(imppri, "input, format %x mtype %d\n", 18434209Skarels cp->dl_format, cp->dl_mtype); 18534209Skarels #endif 18634209Skarels if (cp->dl_format != IMP_1822L_I2H || 18734209Skarels (cp->dl_mtype != IMPTYPE_NOOP && 18834209Skarels cp->dl_mtype != IMPTYPE_RESET)) { 18933453Skarels sc->imp_garbage++; 19033453Skarels sc->imp_if.if_collisions++; /* XXX */ 19133453Skarels } 19233427Skarels } else switch (cp->dl_mtype) { 1935640Sroot 1945640Sroot case IMPTYPE_DATA: 19528849Skarels /* 19628849Skarels * Data for a protocol. Dispatch to the appropriate 19728849Skarels * protocol routine (running at software interrupt). 19828849Skarels * If this isn't a raw interface, advance pointer 19928849Skarels * into mbuf past leader. 20028849Skarels */ 20133427Skarels switch (cp->dl_link) { 20228849Skarels 20328849Skarels case IMPLINK_IP: 20428849Skarels m->m_len -= sizeof(struct imp_leader); 20535799Ssklower if (m->m_flags & M_PKTHDR) 20635799Ssklower m->m_pkthdr.len -= sizeof(struct imp_leader); 20735799Ssklower m->m_data += sizeof(struct imp_leader); 20828849Skarels schednetisr(NETISR_IP); 20928849Skarels inq = &ipintrq; 21028849Skarels break; 21128849Skarels 21228849Skarels default: 21328849Skarels break; 21428849Skarels } 2155640Sroot break; 2165640Sroot 2175640Sroot /* 2185640Sroot * IMP leader error. Reset the IMP and discard the packet. 2195640Sroot */ 2205640Sroot case IMPTYPE_BADLEADER: 2215647Ssam /* 2225647Ssam * According to 1822 document, this message 2235647Ssam * will be generated in response to the 2245647Ssam * first noop sent to the IMP after 2255647Ssam * the host resets the IMP interface. 2265647Ssam */ 22733427Skarels #ifdef IMPINIT 22833427Skarels if (imptraceinit) 22933427Skarels log(imppri, "badleader\n"); 23033427Skarels #endif 2315771Swnj if (sc->imp_state != IMPS_INIT) { 2325924Sroot impmsg(sc, "leader error"); 23333453Skarels sc->imp_msgready = 0; 23433427Skarels hostreset(unit); 2355647Ssam impnoops(sc); 23633453Skarels sc->imp_garbage++; 2375647Ssam } 23828849Skarels break; 2395640Sroot 2405640Sroot /* 2415640Sroot * IMP going down. Print message, and if not immediate, 2425640Sroot * set off a timer to insure things will be reset at the 2435640Sroot * appropriate time. 2445640Sroot */ 2455640Sroot case IMPTYPE_DOWN: 24633427Skarels { int type, when; 24733427Skarels 24833427Skarels type = cp->dl_link & IMP_DMASK; 24933427Skarels when = (cp->dl_link & IMPDOWN_WHENMASK) >> IMPDOWN_WHENSHIFT; 25033427Skarels #ifdef IMPINIT 25133427Skarels if (imptraceinit) 25233427Skarels log(imppri, "input DOWN %s %d\n", 25333427Skarels impmessage[type], when * IMPDOWN_WHENUNIT); 25433427Skarels #endif 25533427Skarels if (type != IMPDOWN_GOING && when) 25633427Skarels impmsg(sc, "going down %s in %d minutes", 25733427Skarels (u_int)impmessage[type], when * IMPDOWN_WHENUNIT); 25833427Skarels else 25933427Skarels impmsg(sc, "going down %s", (u_int)impmessage[type]); 26033427Skarels if (sc->imp_state != IMPS_UP) 26128849Skarels break; 26233427Skarels if (type == IMPDOWN_GOING) { 2635640Sroot sc->imp_state = IMPS_GOINGDOWN; 26433427Skarels timeout(impdown, (caddr_t)sc, IMPTV_DOWN * hz); 26533427Skarels } else if (when == 0) 26633427Skarels sc->imp_state = IMPS_WINIT; 26733427Skarels sc->imp_dropcnt = 0; 26828849Skarels break; 26933427Skarels } 2705640Sroot 2715640Sroot /* 27233427Skarels * A NOP, usually seen during the initialization sequence. 2735640Sroot * Compare the local address with that in the message. 2745640Sroot * Reset the local address notion if it doesn't match. 2755640Sroot */ 2766336Ssam case IMPTYPE_NOOP: 27733427Skarels #ifdef IMPINIT 27833427Skarels if (imptraceinit) 27933427Skarels log(imppri, "noop\n"); 28033427Skarels #endif 28133427Skarels if (sc->imp_state == IMPS_WINIT) { 28233427Skarels sc->imp_dropcnt = 0; 28333427Skarels impnoops(sc); 2845647Ssam sc->imp_state = IMPS_INIT; 2855647Ssam } 28633427Skarels sc->imp_dropcnt++; 28733427Skarels if (sc->imp_state == IMPS_INIT && cp->dl_imp != 0) { 28818132Skarels struct in_addr leader_addr; 28928849Skarels 29033427Skarels sin = (struct sockaddr_in *)&sc->imp_if.if_addrlist->ifa_addr; 29133427Skarels imp_leader_to_addr(&leader_addr, cp, &sc->imp_if); 29218412Skarels if (sin->sin_addr.s_addr != leader_addr.s_addr) { 29318412Skarels impmsg(sc, "address reset to x%x (%d/%d)", 29428849Skarels ntohl(leader_addr.s_addr), 29533427Skarels (u_int)cp->dl_host, 29633427Skarels ntohs(cp->dl_imp)); 29718132Skarels sin->sin_addr.s_addr = leader_addr.s_addr; 29818132Skarels } 2996500Ssam } 30028849Skarels break; 3015640Sroot 3025640Sroot /* 30333453Skarels * RFNM or INCOMPLETE message, decrement rfnm count 30433453Skarels * and prepare to send next message. 30534209Skarels * If the rfnm allows another queued 30634209Skarels * message to be sent, bump msgready 30734209Skarels * and start IMP if idle. 30833453Skarels * We could pass incomplete's up to the next level, 30933453Skarels * but this currently isn't needed. 31034209Skarels * Pass "bad" incompletes and rfnms to the raw socket. 3115640Sroot */ 31233427Skarels case IMPTYPE_INCOMPLETE: 31333427Skarels sc->imp_incomplete++; 31433427Skarels /* FALL THROUGH */ 3155640Sroot case IMPTYPE_RFNM: 31634509Skarels if ((hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, 31734509Skarels unit)) == 0 || hp->h_rfnm == 0) { 31834209Skarels sc->imp_badrfnm++; 31934209Skarels if (hp) 32033427Skarels hostfree(hp); 32134209Skarels break; 32234209Skarels } 32334209Skarels imprestarthost(sc, hp); 32434209Skarels if (cp->dl_mtype == IMPTYPE_RFNM) 32533427Skarels goto drop; 32633427Skarels break; 3275640Sroot 3285640Sroot /* 3295640Sroot * Host or IMP can't be reached. Flush any packets 3305640Sroot * awaiting transmission and release the host structure. 33124777Skarels * Enqueue for notifying protocols at software interrupt time. 3325640Sroot */ 3335640Sroot case IMPTYPE_HOSTDEAD: 33411230Ssam case IMPTYPE_HOSTUNREACH: 33534509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) { 33633427Skarels hp->h_flags |= (1 << (int)cp->dl_mtype); 33733453Skarels sc->imp_msgready -= 33833453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 33933427Skarels hp->h_rfnm = 0; 34033453Skarels hostflush(hp); 34124777Skarels hp->h_timer = HOSTDEADTIMER; 34224777Skarels } 34328849Skarels break; 3445640Sroot 3455640Sroot /* 3465640Sroot * Error in data. Clear RFNM status for this host and send 3475640Sroot * noops to the IMP to clear the interface. 3485640Sroot */ 34911230Ssam case IMPTYPE_BADDATA: 3505924Sroot impmsg(sc, "data error"); 35134509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) { 35233453Skarels sc->imp_msgready -= 35333453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 35434209Skarels if (hp->h_rfnm) 35534209Skarels hostrelease(hp); 35634209Skarels else 35734209Skarels hostfree(hp); 35833427Skarels } 3595640Sroot impnoops(sc); 36028849Skarels break; 3615640Sroot 3625640Sroot /* 3635647Ssam * Interface reset. 3645640Sroot */ 3655640Sroot case IMPTYPE_RESET: 36633427Skarels #ifdef IMPINIT 36733427Skarels if (imptraceinit) 36833427Skarels log(imppri, "reset complete\n"); 36933427Skarels #endif 37033427Skarels if (sc->imp_state != IMPS_INIT) { 37133427Skarels impmsg(sc, "interface reset"); 37233427Skarels impnoops(sc); 37333427Skarels } 37418412Skarels /* clear RFNM counts */ 37533453Skarels sc->imp_msgready = 0; 37633427Skarels hostreset(unit); 37733427Skarels if (sc->imp_state != IMPS_DOWN) { 37833427Skarels sc->imp_state = IMPS_UP; 37933427Skarels sc->imp_if.if_flags |= IFF_UP; 38033427Skarels #ifdef IMPINIT 38133427Skarels if (imptraceinit) 38233427Skarels log(imppri, "IMP UP\n"); 38333427Skarels #endif 38433427Skarels } 38528849Skarels break; 3865640Sroot 3875640Sroot default: 38833427Skarels sc->imp_garbage++; 3895640Sroot sc->imp_if.if_collisions++; /* XXX */ 39028849Skarels break; 3915640Sroot } 3925640Sroot 39328849Skarels if (inq == &impintrq) 39424777Skarels schednetisr(NETISR_IMP); 39533453Skarels s = splimp(); 39633453Skarels if (!IF_QFULL(inq)) { 39733453Skarels IF_ENQUEUE(inq, m); 39833453Skarels splx(s); 39933453Skarels return; 4006208Swnj } 40133453Skarels splx(s); 40234209Skarels IF_DROP(inq); 4035640Sroot drop: 4045640Sroot m_freem(m); 40533427Skarels #undef ip 4065640Sroot } 4075640Sroot 4085647Ssam /* 4095647Ssam * Bring the IMP down after notification. 4105647Ssam */ 4115647Ssam impdown(sc) 4125647Ssam struct imp_softc *sc; 4135647Ssam { 41411230Ssam int s = splimp(); 4156208Swnj 41633427Skarels if (sc->imp_state == IMPS_GOINGDOWN) { 41733427Skarels sc->imp_state = IMPS_WINIT; 41833427Skarels impmsg(sc, "marked down"); 41934209Skarels sc->imp_msgready = 0; 42033427Skarels hostreset(sc->imp_if.if_unit); 42133427Skarels if_down(&sc->imp_if); 42233427Skarels } 42333427Skarels #ifdef IMPINIT 42433427Skarels else if (imptraceinit) 42533427Skarels log(imppri, "impdown, state now %d (ignored)\n", sc->imp_state); 42633427Skarels #endif 42711230Ssam splx(s); 4285647Ssam } 4295647Ssam 43026397Skarels /*VARARGS2*/ 43134509Skarels impmsg(sc, fmt, a1) 4325640Sroot struct imp_softc *sc; 4335640Sroot char *fmt; 4346160Ssam u_int a1; 4355640Sroot { 4366208Swnj 43733427Skarels log(imppri, "imp%d: %r\n", sc->imp_if.if_unit, fmt, &a1); 4385640Sroot } 4395640Sroot 44024777Skarels struct sockproto impproto = { PF_IMPLINK }; 44144415Skarels struct sockaddr_in impdst = { sizeof (impdst), AF_INET }; 44244415Skarels struct sockaddr_in impsrc = { sizeof (impsrc), AF_INET }; 44324777Skarels 4445640Sroot /* 44524777Skarels * Pick up the IMP "error" messages enqueued earlier, 44624777Skarels * passing these up to the higher level protocol 44724777Skarels * and the raw interface. 4486582Ssam */ 44924777Skarels impintr() 4506582Ssam { 45124777Skarels register struct mbuf *m; 45224777Skarels register struct control_leader *cp; 45324777Skarels struct ifnet *ifp; 45444415Skarels int s, code; 4556582Ssam 45624777Skarels for (;;) { 45724777Skarels s = splimp(); 45824777Skarels IF_DEQUEUEIF(&impintrq, m, ifp); 45924777Skarels splx(s); 46024777Skarels if (m == 0) 46124777Skarels return; 46218132Skarels 46324777Skarels cp = mtod(m, struct control_leader *); 46433427Skarels imp_leader_to_addr(&impsrc.sin_addr, cp, ifp); 46524777Skarels impproto.sp_protocol = cp->dl_link; 46625409Skarels impdst.sin_addr = IA_SIN(ifp->if_addrlist)->sin_addr; 46724777Skarels 46828849Skarels if (cp->dl_mtype == IMPTYPE_HOSTDEAD || 46944415Skarels cp->dl_mtype == IMPTYPE_HOSTUNREACH) { 47044415Skarels code = (cp->dl_mtype == IMPTYPE_HOSTDEAD) ? 47144415Skarels PRC_HOSTDEAD : PRC_UNREACH_HOST; 47228849Skarels switch (cp->dl_link) { 47324777Skarels 47428849Skarels case IMPLINK_IP: 47544415Skarels pfctlinput(code, (struct sockaddr *)&impsrc); 47628849Skarels break; 47728849Skarels default: 47844415Skarels raw_ctlinput(code, (struct sockaddr *)&impsrc); 47928849Skarels break; 48028849Skarels } 48144415Skarels } 48224777Skarels 48324777Skarels raw_input(m, &impproto, (struct sockaddr *)&impsrc, 48424777Skarels (struct sockaddr *)&impdst); 4856588Ssam } 4866582Ssam } 4876582Ssam 4886582Ssam /* 4895640Sroot * ARPAnet 1822 output routine. 4905640Sroot * Called from higher level protocol routines to set up messages for 4915640Sroot * transmission to the imp. Sets up the header and calls impsnd to 4925640Sroot * enqueue the message for this IMP's hardware driver. 4935640Sroot */ 4946336Ssam impoutput(ifp, m0, dst) 4955640Sroot register struct ifnet *ifp; 4965640Sroot struct mbuf *m0; 4976336Ssam struct sockaddr *dst; 4985640Sroot { 4995640Sroot register struct imp_leader *imp; 5005640Sroot register struct mbuf *m = m0; 50134209Skarels caddr_t pkt = mtod(m, caddr_t); 5026504Ssam int error = 0; 5035640Sroot 5045640Sroot /* 5055640Sroot * Don't even try if the IMP is unavailable. 5065640Sroot */ 50733427Skarels if (!IMPS_RUNNING(imp_softc[ifp->if_unit].imp_state)) { 5086504Ssam error = ENETDOWN; 5095647Ssam goto drop; 5106504Ssam } 5115640Sroot 51233453Skarels /* 51333453Skarels * If AF_IMPLINK, leader exists; just send. 51433453Skarels * Otherwise, construct leader according to address family. 51533453Skarels */ 51633453Skarels if (dst->sa_family != AF_IMPLINK) { 51733453Skarels /* 51833453Skarels * Add IMP leader. If there's not enough space in the 51933453Skarels * first mbuf, allocate another. If that should fail, we 52033453Skarels * drop this sucker. 52133453Skarels */ 52235799Ssklower M_PREPEND(m, sizeof(struct imp_leadr), M_DONTWAIT); 52333453Skarels imp = mtod(m, struct imp_leader *); 52433453Skarels imp->il_format = IMP_NFF; 52533453Skarels imp->il_mtype = IMPTYPE_DATA; 52634209Skarels imp->il_flags = 0; 52734209Skarels imp->il_htype = 0; 52834209Skarels imp->il_subtype = 0; 5295640Sroot 53033453Skarels switch (dst->sa_family) { 5315640Sroot 53234209Skarels case AF_INET: 53333453Skarels imp->il_link = IMPLINK_IP; 53433453Skarels imp_addr_to_leader((struct control_leader *)imp, 53533453Skarels ((struct sockaddr_in *)dst)->sin_addr.s_addr); 53634209Skarels imp->il_length = htons(ntohs((u_short) 53734209Skarels ((struct ip *)pkt)->ip_len) << 3); 53833453Skarels break; 5395640Sroot 54033453Skarels default: 54133453Skarels printf("imp%d: can't handle af%d\n", ifp->if_unit, 54233453Skarels dst->sa_family); 54333453Skarels error = EAFNOSUPPORT; 54434209Skarels m0 = m; 5455647Ssam goto drop; 5466504Ssam } 5475640Sroot } 5485640Sroot return (impsnd(ifp, m)); 5495647Ssam drop: 5505647Ssam m_freem(m0); 5516504Ssam return (error); 5525640Sroot } 5535640Sroot 5545640Sroot /* 5555640Sroot * Put a message on an interface's output queue. 5565640Sroot * Perform RFNM counting: no more than 8 message may be 5575640Sroot * in flight to any one host. 5585640Sroot */ 5595640Sroot impsnd(ifp, m) 5605640Sroot struct ifnet *ifp; 5615640Sroot struct mbuf *m; 5625640Sroot { 56333427Skarels register struct control_leader *imp; 5645640Sroot register struct host *hp; 56533453Skarels register struct imp_softc *sc = &imp_softc[ifp->if_unit]; 56633453Skarels int s, error = 0; 5675640Sroot 56833427Skarels imp = mtod(m, struct control_leader *); 5695640Sroot 5705640Sroot /* 5715640Sroot * Do RFNM counting for data messages 57233453Skarels * (no more than 8 outstanding to any host). 57333453Skarels * Queue data messages per host if 8 are already outstanding 57433453Skarels * or if the hardware interface is already doing output. 57533453Skarels * Increment imp_msgready if the message could be sent now, 57633453Skarels * but must be queued because the imp output is busy. 5775640Sroot */ 5786588Ssam s = splimp(); 57933427Skarels if (imp->dl_mtype == IMPTYPE_DATA) { 58034509Skarels hp = hostenter((int)imp->dl_imp, (int)imp->dl_host, 58134509Skarels ifp->if_unit); 5825640Sroot if (hp) { 58334209Skarels if (hp->h_flags & (HF_DEAD|HF_UNREACH)) 58434209Skarels error = hp->h_flags & HF_DEAD ? 58534209Skarels EHOSTDOWN : EHOSTUNREACH; 58634209Skarels else if (hp->h_rfnm < IMP_MAXHOSTMSG && 58734209Skarels sc->imp_cb.ic_oactive == 0) { 58834209Skarels /* 58934209Skarels * Send without queuing; 59034209Skarels * adjust rfnm count and timer. 59134209Skarels */ 59234209Skarels if (hp->h_rfnm++ == 0) 59334209Skarels hp->h_timer = RFNMTIMER; 59434209Skarels goto send; 59533453Skarels } else if (hp->h_rfnm + hp->h_qcnt < imphqlen) { 5966095Swnj HOST_ENQUE(hp, m); 59734209Skarels if (hp->h_rfnm + hp->h_qcnt <= IMP_MAXHOSTMSG) 59834209Skarels sc->imp_msgready++; 59934272Skarels } else { 60033453Skarels error = ENOBUFS; 60134272Skarels IF_DROP(&ifp->if_snd); 60234272Skarels } 60333453Skarels } else 60433453Skarels error = ENOBUFS; 60533453Skarels } else if (sc->imp_cb.ic_oactive == 0) 60633453Skarels goto send; 60733453Skarels else 60833453Skarels IF_ENQUEUE(&ifp->if_snd, m); 60934209Skarels 61033453Skarels splx(s); 61134209Skarels if (error) 61234209Skarels m_freem(m); 61334209Skarels return (error); 61433453Skarels 61533453Skarels send: 61633453Skarels sc->imp_if.if_timer = IMP_OTIMER; 61733453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 61833453Skarels splx(s); 61933453Skarels return (0); 62033453Skarels } 62133453Skarels 62233453Skarels /* 62333453Skarels * Start another output operation on IMP; called from hardware 62433453Skarels * transmit-complete interrupt routine at splimp or from imp routines 62534209Skarels * when output is not in progress. If there are any packets on shared 62634209Skarels * output queue, send them, otherwise send the next data packet for a host. 62734209Skarels * Host data packets are sent round-robin based on destination by walking 62834209Skarels * the host list. 62933453Skarels */ 63033453Skarels impstart(sc) 63133453Skarels register struct imp_softc *sc; 63233453Skarels { 63333453Skarels register struct mbuf *m; 63434209Skarels int first = 1; /* XXX */ 63533453Skarels register struct host *hp; 63633453Skarels int index; 63733453Skarels 63833453Skarels IF_DEQUEUE(&sc->imp_if.if_snd, m); 63933453Skarels if (m) { 64033453Skarels sc->imp_if.if_timer = IMP_OTIMER; 64133453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 64233453Skarels return; 64333453Skarels } 64433453Skarels if (sc->imp_msgready) { 64533453Skarels if ((m = sc->imp_hostq) == 0 && (m = sc->imp_hosts) == 0) 64634209Skarels panic("imp msgready"); 64734209Skarels index = sc->imp_hostent; 64834209Skarels for (hp = &mtod(m, struct hmbuf *)->hm_hosts[index]; ; 64934209Skarels hp++, index++) { 65034209Skarels if (index >= HPMBUF) { 65134209Skarels if ((m = m->m_next) == 0) 65234209Skarels m = sc->imp_hosts; 65334209Skarels index = 0; 65434209Skarels hp = mtod(m, struct hmbuf *)->hm_hosts; 65534209Skarels first = 0; /* XXX */ 6566095Swnj } 65734209Skarels if (hp->h_qcnt && hp->h_rfnm < IMP_MAXHOSTMSG) { 65834209Skarels /* 65934209Skarels * Found host entry with another message 66034209Skarels * to send. Deliver it to the IMP. 66134209Skarels * Start with succeeding host next time. 66234209Skarels */ 66334209Skarels impstarthost(sc, hp); 66434209Skarels sc->imp_hostq = m; 66534209Skarels sc->imp_hostent = index + 1; 66634209Skarels return; 66733453Skarels } 66834209Skarels if (m == sc->imp_hostq && !first && 66934209Skarels index + 1 >= sc->imp_hostent) { /* XXX */ 67034209Skarels log(imppri, "imp: can't find %d msgready\n", 67134209Skarels sc->imp_msgready); 67234209Skarels sc->imp_msgready = 0; 67334209Skarels break; 67434209Skarels } 6755640Sroot } 6765640Sroot } 67733453Skarels sc->imp_if.if_timer = 0; 67833453Skarels } 67933453Skarels 68033453Skarels /* 68134209Skarels * Restart output for a host that has received a RFNM 68234209Skarels * or incomplete or has timed out while waiting for a RFNM. 68333453Skarels * Must be called at splimp. 68433453Skarels */ 68534209Skarels imprestarthost(sc, hp) 68634209Skarels register struct imp_softc *sc; 68733453Skarels struct host *hp; 68833453Skarels { 68933453Skarels 69033453Skarels if (--hp->h_rfnm > 0) 69133453Skarels hp->h_timer = RFNMTIMER; 69234209Skarels /* 69334209Skarels * If the RFNM moved a queued message into the window, 69434209Skarels * update msgready and start IMP if idle. 69534209Skarels */ 69634209Skarels if (hp->h_qcnt > IMP_MAXHOSTMSG - 1 - hp->h_rfnm) { 69734209Skarels sc->imp_msgready++; 69833453Skarels if (sc->imp_cb.ic_oactive == 0) 69933453Skarels impstarthost(sc, hp); 7006208Swnj } 70134209Skarels if (hp->h_rfnm == 0 && hp->h_qcnt == 0) 70234209Skarels hostidle(hp); 7035640Sroot } 7045640Sroot 7055640Sroot /* 70633453Skarels * Send the next message queued for a host 70733453Skarels * when ready to send another message to the IMP. 70833453Skarels * Called only when output is not in progress. 70933453Skarels * Bump RFNM counter and start RFNM timer 71033453Skarels * when we send the message to the IMP. 71133453Skarels * Must be called at splimp. 71233453Skarels */ 71333453Skarels impstarthost(sc, hp) 71433453Skarels register struct imp_softc *sc; 71533453Skarels register struct host *hp; 71633453Skarels { 71733453Skarels struct mbuf *m; 71833453Skarels 71933453Skarels if (hp->h_rfnm++ == 0) 72033453Skarels hp->h_timer = RFNMTIMER; 72133453Skarels HOST_DEQUE(hp, m); 72233453Skarels sc->imp_if.if_timer = IMP_OTIMER; 72333453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 72433453Skarels sc->imp_msgready--; 72533453Skarels } 72633453Skarels 72733453Skarels /* 72833453Skarels * "Watchdog" timeout. When the output timer expires, 72933453Skarels * we assume we have been blocked by the imp. 73033453Skarels * No need to restart, just collect statistics. 73133453Skarels */ 73233453Skarels imptimo(unit) 73333453Skarels int unit; 73433453Skarels { 73533453Skarels 73633453Skarels imp_softc[unit].imp_block++; 73733453Skarels } 73833453Skarels 73933453Skarels /* 7405640Sroot * Put three 1822 NOOPs at the head of the output queue. 7415640Sroot * Part of host-IMP initialization procedure. 7425640Sroot * (Should return success/failure, but noone knows 7435640Sroot * what to do with this, so why bother?) 7446818Ssam * This routine is always called at splimp, so we don't 7456818Ssam * protect the call to IF_PREPEND. 7465640Sroot */ 7475640Sroot impnoops(sc) 7485640Sroot register struct imp_softc *sc; 7495640Sroot { 7505640Sroot register i; 7515640Sroot register struct mbuf *m; 7525771Swnj register struct control_leader *cp; 7535640Sroot 75433427Skarels #ifdef IMPINIT 75533427Skarels if (imptraceinit) 75633427Skarels log(imppri, "impnoops\n"); 75733427Skarels #endif 75833427Skarels for (i = 0; i < IMP_NOOPCNT; i++) { 7599645Ssam if ((m = m_getclr(M_DONTWAIT, MT_HEADER)) == 0) 7605640Sroot return; 7615771Swnj m->m_len = sizeof(struct control_leader); 7625771Swnj cp = mtod(m, struct control_leader *); 7635771Swnj cp->dl_format = IMP_NFF; 76433427Skarels cp->dl_link = i; 76533427Skarels cp->dl_mtype = IMPTYPE_NOOP; 7665640Sroot IF_PREPEND(&sc->imp_if.if_snd, m); 7675640Sroot } 7685640Sroot if (sc->imp_cb.ic_oactive == 0) 76933453Skarels impstart(sc); 7705640Sroot } 7717170Ssam 77213067Ssam /* 77313067Ssam * Process an ioctl request. 77413067Ssam */ 77513067Ssam impioctl(ifp, cmd, data) 77613067Ssam register struct ifnet *ifp; 77713067Ssam int cmd; 77813067Ssam caddr_t data; 77913067Ssam { 78018412Skarels struct ifaddr *ifa = (struct ifaddr *) data; 78113067Ssam int s = splimp(), error = 0; 78233427Skarels #define sc ((struct imp_softc *)ifp) 78313067Ssam 78413067Ssam switch (cmd) { 78513067Ssam 78613067Ssam case SIOCSIFADDR: 78718412Skarels if (ifa->ifa_addr.sa_family != AF_INET) { 78818412Skarels error = EINVAL; 78918412Skarels break; 79018412Skarels } 79133427Skarels if ((ifp->if_flags & IFF_UP) == 0) 79213067Ssam impinit(ifp->if_unit); 79313067Ssam break; 79413067Ssam 79533427Skarels case SIOCSIFFLAGS: 79633427Skarels if ((ifp->if_flags & IFF_UP) == 0 && 79733427Skarels sc->imp_state != IMPS_DOWN) { 79833453Skarels if (sc->imp_cb.ic_down && 79934209Skarels (*sc->imp_cb.ic_down)(sc->imp_cb.ic_hwunit)) { 80033427Skarels sc->imp_state = IMPS_DOWN; 80134209Skarels sc->imp_msgready = 0; 80234209Skarels hostreset(ifp->if_unit); 80334272Skarels if_down(ifp); 80434209Skarels } 80533427Skarels } else if (ifp->if_flags & IFF_UP && sc->imp_state == IMPS_DOWN) 80633427Skarels impinit(ifp->if_unit); 80733427Skarels break; 80833427Skarels 80913067Ssam default: 81013067Ssam error = EINVAL; 81133427Skarels break; 81213067Ssam } 81313067Ssam splx(s); 81413067Ssam return (error); 81513067Ssam } 81613067Ssam 8177170Ssam #ifdef IMPLEADERS 8187170Ssam printleader(routine, ip) 8197170Ssam char *routine; 8207170Ssam register struct imp_leader *ip; 8217170Ssam { 8227170Ssam printf("%s: ", routine); 8237170Ssam printbyte((char *)ip, 12); 8247170Ssam printf("<fmt=%x,net=%x,flags=%x,mtype=", ip->il_format, ip->il_network, 8257170Ssam ip->il_flags); 8267170Ssam if (ip->il_mtype <= IMPTYPE_READY) 8277170Ssam printf("%s,", impleaders[ip->il_mtype]); 8287170Ssam else 8297170Ssam printf("%x,", ip->il_mtype); 8307170Ssam printf("htype=%x,host=%x,imp=%x,link=", ip->il_htype, ip->il_host, 8317170Ssam ntohs(ip->il_imp)); 8327170Ssam if (ip->il_link == IMPLINK_IP) 8337170Ssam printf("ip,"); 8347170Ssam else 8357170Ssam printf("%x,", ip->il_link); 8367170Ssam printf("subtype=%x,len=%x>\n",ip->il_subtype,ntohs(ip->il_length)>>3); 8377170Ssam } 8387170Ssam 8397170Ssam printbyte(cp, n) 8407170Ssam register char *cp; 8417170Ssam int n; 8427170Ssam { 8437170Ssam register i, j, c; 8447170Ssam 8457170Ssam for (i=0; i<n; i++) { 8467170Ssam c = *cp++; 8477170Ssam for (j=0; j<2; j++) 84824777Skarels putchar("0123456789abcdef"[(c>>((1-j)*4))&0xf], 0); 84924777Skarels putchar(' ', 0); 8507170Ssam } 85124777Skarels putchar('\n', 0); 8527170Ssam } 8535640Sroot #endif 85418132Skarels 85518132Skarels /* 85618132Skarels * Routine to convert from IMP Leader to InterNet Address. 85718132Skarels * 85818132Skarels * This procedure is necessary because IMPs may be assigned Class A, B, or C 85918132Skarels * network numbers, but only have 8 bits in the leader to reflect the 86018132Skarels * IMP "network number". The strategy is to take the network number from 86118132Skarels * the ifnet structure, and blend in the host-on-imp and imp-on-net numbers 86218132Skarels * from the leader. 86318132Skarels * 86418132Skarels * There is no support for "Logical Hosts". 86518132Skarels * 86618132Skarels * Class A: Net.Host.0.Imp 86718132Skarels * Class B: Net.net.Host.Imp 86818132Skarels * Class C: Net.net.net.(Host4|Imp4) 86918132Skarels */ 87033427Skarels imp_leader_to_addr(ap, cp, ifp) 87118412Skarels struct in_addr *ap; 87233427Skarels register struct control_leader *cp; 87318412Skarels struct ifnet *ifp; 87418132Skarels { 87526397Skarels register u_long final; 87618132Skarels register struct sockaddr_in *sin; 87733427Skarels int imp = ntohs(cp->dl_imp); 87818132Skarels 87918412Skarels sin = (struct sockaddr_in *)(&ifp->if_addrlist->ifa_addr); 88028849Skarels final = ntohl(sin->sin_addr.s_addr); 88118132Skarels 88218412Skarels if (IN_CLASSA(final)) { 88318132Skarels final &= IN_CLASSA_NET; 88433427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<16); 88518412Skarels } else if (IN_CLASSB(final)) { 88618132Skarels final &= IN_CLASSB_NET; 88733427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<8); 88818132Skarels } else { 88918132Skarels final &= IN_CLASSC_NET; 89033427Skarels final |= (imp & 0x0F) | ((cp->dl_host & 0x0F)<<4); 89118132Skarels } 89218412Skarels ap->s_addr = htonl(final); 89318132Skarels } 89418132Skarels 89518132Skarels /* 89618132Skarels * Function to take InterNet address and fill in IMP leader fields. 89718132Skarels */ 89818412Skarels imp_addr_to_leader(imp, a) 89933427Skarels register struct control_leader *imp; 90026397Skarels u_long a; 90118132Skarels { 90228849Skarels register u_long addr = ntohl(a); 90318132Skarels 90433427Skarels imp->dl_network = 0; /* !! */ 90518132Skarels 90618412Skarels if (IN_CLASSA(addr)) { 90733427Skarels imp->dl_host = ((addr>>16) & 0xFF); 90833427Skarels imp->dl_imp = addr & 0xFF; 90918412Skarels } else if (IN_CLASSB(addr)) { 91033427Skarels imp->dl_host = ((addr>>8) & 0xFF); 91133427Skarels imp->dl_imp = addr & 0xFF; 91218132Skarels } else { 91333427Skarels imp->dl_host = ((addr>>4) & 0xF); 91433427Skarels imp->dl_imp = addr & 0xF; 91518132Skarels } 91633427Skarels imp->dl_imp = htons(imp->dl_imp); 91718132Skarels } 9187170Ssam #endif 919