123166Smckusick /* 233453Skarels * Copyright (c) 1982,1986,1988 Regents of the University of California. 333453Skarels * All rights reserved. 423166Smckusick * 533453Skarels * Redistribution and use in source and binary forms are permitted 633453Skarels * provided that this notice is preserved and that due credit is given 733453Skarels * to the University of California at Berkeley. The name of the University 833453Skarels * may not be used to endorse or promote products derived from this 933453Skarels * software without specific prior written permission. This software 1033453Skarels * is provided ``as is'' without express or implied warranty. 1133453Skarels * 12*34209Skarels * @(#)if_imp.c 7.5 (Berkeley) 05/06/88 1323166Smckusick */ 145640Sroot 155640Sroot #include "imp.h" 165640Sroot #if NIMP > 0 175640Sroot /* 1833453Skarels * ARPANET IMP (PSN) interface driver. 195640Sroot * 2033453Skarels * The IMP-host protocol (AHIP) is handled here, leaving 215640Sroot * hardware specifics to the lower level interface driver. 225640Sroot */ 2317068Sbloom #include "param.h" 2417068Sbloom #include "systm.h" 2517068Sbloom #include "mbuf.h" 2617068Sbloom #include "buf.h" 2717068Sbloom #include "protosw.h" 2817068Sbloom #include "socket.h" 2917068Sbloom #include "time.h" 3017068Sbloom #include "kernel.h" 3117068Sbloom #include "errno.h" 3217068Sbloom #include "ioctl.h" 3333427Skarels #include "syslog.h" 348705Sroot 3533453Skarels #include "../machine/mtpr.h" 3633453Skarels 378705Sroot #include "../net/if.h" 388705Sroot #include "../net/netisr.h" 398408Swnj #include "../netinet/in.h" 408408Swnj #include "../netinet/in_systm.h" 4118412Skarels #include "../netinet/in_var.h" 428705Sroot #include "../netinet/ip.h" 438705Sroot #include "../netinet/ip_var.h" 4433427Skarels #define IMPMESSAGES 457199Ssam /* define IMPLEADERS here to get leader printing code */ 4617068Sbloom #include "if_imp.h" 4717068Sbloom #include "if_imphost.h" 485640Sroot 4933427Skarels struct imp_softc imp_softc[NIMP]; 5033453Skarels #ifndef lint 5133453Skarels int nimp = NIMP; /* for netstat */ 5233453Skarels #endif 5328849Skarels struct ifqueue impintrq; 5428849Skarels int impqmaxlen = IFQ_MAXLEN; 5533453Skarels int imphqlen = 12 + IMP_MAXHOSTMSG; /* max packets to queue per host */ 5624777Skarels 5733427Skarels int imppri = LOG_ERR; 5833427Skarels #ifdef IMPLEADERS 5933427Skarels int impprintfs = 0; 6033427Skarels #endif 6133427Skarels #ifdef IMPINIT 6233427Skarels int imptraceinit = 0; 6333427Skarels #endif 645640Sroot 6533453Skarels 6633427Skarels #define HOSTDEADTIMER (30 * PR_SLOWHZ) /* How long to wait when down */ 6718132Skarels 6833453Skarels int impdown(), impinit(), impioctl(), impoutput(), imptimo(); 695771Swnj 705640Sroot /* 715640Sroot * IMP attach routine. Called from hardware device attach routine 7233427Skarels * at configuration time with a pointer to the device structure. 735640Sroot * Sets up local state and returns pointer to base of ifnet+impcb 745640Sroot * structures. This is then used by the device's attach routine 755640Sroot * set up its back pointers. 765640Sroot */ 7733427Skarels struct imp_softc * 78*34209Skarels impattach(hwname, hwunit, reset) 79*34209Skarels char *hwname; 80*34209Skarels int hwunit; 818815Sroot int (*reset)(); 825640Sroot { 8324777Skarels struct imp_softc *sc; 8424777Skarels register struct ifnet *ifp; 8533427Skarels static int impunit; 865640Sroot 8726397Skarels #ifdef lint 8826397Skarels impintr(); 8926397Skarels #endif 9033427Skarels if (impunit >= NIMP) { 9133427Skarels printf("imp%d: not configured\n", impunit++); 9224777Skarels return (0); 9324777Skarels } 9433427Skarels sc = &imp_softc[impunit]; 9524777Skarels ifp = &sc->imp_if; 96*34209Skarels sc->imp_cb.ic_hwname = hwname; 97*34209Skarels sc->imp_cb.ic_hwunit = hwunit; 9833427Skarels ifp->if_unit = impunit; 995640Sroot ifp->if_name = "imp"; 1006271Sroot ifp->if_mtu = IMPMTU - sizeof(struct imp_leader); 1019001Sroot ifp->if_reset = reset; 1025771Swnj ifp->if_init = impinit; 10313067Ssam ifp->if_ioctl = impioctl; 1045771Swnj ifp->if_output = impoutput; 10533453Skarels ifp->if_watchdog = imptimo; 1065640Sroot if_attach(ifp); 10733427Skarels impunit++; 10833427Skarels return (sc); 1095640Sroot } 1105640Sroot 1115640Sroot /* 1125640Sroot * IMP initialization routine: call hardware module to 11333427Skarels * setup resources, init state and get ready for 1145640Sroot * NOOPs the IMP should send us, and that we want to drop. 1155640Sroot */ 1165640Sroot impinit(unit) 1175640Sroot int unit; 1185640Sroot { 11932570Sbostic int s; 1205640Sroot register struct imp_softc *sc = &imp_softc[unit]; 1215640Sroot 12218412Skarels if (sc->imp_if.if_addrlist == 0) 12313067Ssam return; 12432570Sbostic s = splimp(); 12533427Skarels #ifdef IMPINIT 12633427Skarels if (imptraceinit) 12733427Skarels log(imppri, "impinit\n"); 12833427Skarels #endif 12933427Skarels sc->imp_state = IMPS_WINIT; 13033427Skarels if ((*sc->imp_cb.ic_init)(sc->imp_cb.ic_hwunit) == 0) 1316336Ssam sc->imp_if.if_flags &= ~IFF_UP; 13233427Skarels impintrq.ifq_maxlen = impqmaxlen; 1336500Ssam splx(s); 1345640Sroot } 1355640Sroot 1365640Sroot /* 13733453Skarels * ARPAnet 1822/AHIP input routine. 1385640Sroot * Called from hardware input interrupt routine to handle 1822 13933453Skarels * IMP-host messages. Data messages are passed to higher-level 14033453Skarels * protocol processors on the basis of link number. 14133453Skarels * Other type messages (control) are handled here. 1425640Sroot */ 1435771Swnj impinput(unit, m) 1445640Sroot int unit; 1455771Swnj register struct mbuf *m; 1465640Sroot { 14733427Skarels register struct control_leader *cp; 14833427Skarels #define ip ((struct imp_leader *)cp) 1495640Sroot register struct imp_softc *sc = &imp_softc[unit]; 15024777Skarels struct ifnet *ifp; 1515640Sroot register struct host *hp; 1525640Sroot register struct ifqueue *inq; 1535924Sroot struct mbuf *next; 1546336Ssam struct sockaddr_in *sin; 15533453Skarels int s; 1565640Sroot 15724777Skarels /* 15824777Skarels * Pull the interface pointer out of the mbuf 15924777Skarels * and save for later; adjust mbuf to look at rest of data. 16024777Skarels */ 16124777Skarels ifp = *(mtod(m, struct ifnet **)); 16224777Skarels IF_ADJ(m); 1636257Sroot /* verify leader length. */ 1645771Swnj if (m->m_len < sizeof(struct control_leader) && 1655771Swnj (m = m_pullup(m, sizeof(struct control_leader))) == 0) 1665771Swnj return; 1675771Swnj cp = mtod(m, struct control_leader *); 16833427Skarels if (cp->dl_mtype == IMPTYPE_DATA && 16933427Skarels m->m_len < sizeof(struct imp_leader)) { 17033427Skarels if ((m = m_pullup(m, sizeof(struct imp_leader))) == 0) 1715771Swnj return; 17233427Skarels cp = mtod(m, struct control_leader *); 17333427Skarels } 1747199Ssam #ifdef IMPLEADERS 1757170Ssam if (impprintfs) 1767170Ssam printleader("impinput", ip); 1777199Ssam #endif 17828849Skarels inq = &impintrq; 1795640Sroot 1806257Sroot /* check leader type */ 18133427Skarels if (cp->dl_format != IMP_NFF) { 182*34209Skarels /* 183*34209Skarels * We get 1822L NOOPs and RESET 184*34209Skarels * at initialization. 185*34209Skarels */ 186*34209Skarels #ifdef IMPINIT 187*34209Skarels if (imptraceinit) 188*34209Skarels log(imppri, "input, format %x mtype %d\n", 189*34209Skarels cp->dl_format, cp->dl_mtype); 190*34209Skarels #endif 191*34209Skarels if (cp->dl_format != IMP_1822L_I2H || 192*34209Skarels (cp->dl_mtype != IMPTYPE_NOOP && 193*34209Skarels cp->dl_mtype != IMPTYPE_RESET)) { 19433453Skarels sc->imp_garbage++; 19533453Skarels sc->imp_if.if_collisions++; /* XXX */ 19633453Skarels } 19733427Skarels } else switch (cp->dl_mtype) { 1985640Sroot 1995640Sroot case IMPTYPE_DATA: 20028849Skarels /* 20128849Skarels * Data for a protocol. Dispatch to the appropriate 20228849Skarels * protocol routine (running at software interrupt). 20328849Skarels * If this isn't a raw interface, advance pointer 20428849Skarels * into mbuf past leader. 20528849Skarels */ 20633427Skarels switch (cp->dl_link) { 20728849Skarels 20828849Skarels case IMPLINK_IP: 20928849Skarels m->m_len -= sizeof(struct imp_leader); 21028849Skarels m->m_off += sizeof(struct imp_leader); 21128849Skarels schednetisr(NETISR_IP); 21228849Skarels inq = &ipintrq; 21328849Skarels break; 21428849Skarels 21528849Skarels default: 21628849Skarels break; 21728849Skarels } 2185640Sroot break; 2195640Sroot 2205640Sroot /* 2215640Sroot * IMP leader error. Reset the IMP and discard the packet. 2225640Sroot */ 2235640Sroot case IMPTYPE_BADLEADER: 2245647Ssam /* 2255647Ssam * According to 1822 document, this message 2265647Ssam * will be generated in response to the 2275647Ssam * first noop sent to the IMP after 2285647Ssam * the host resets the IMP interface. 2295647Ssam */ 23033427Skarels #ifdef IMPINIT 23133427Skarels if (imptraceinit) 23233427Skarels log(imppri, "badleader\n"); 23333427Skarels #endif 2345771Swnj if (sc->imp_state != IMPS_INIT) { 2355924Sroot impmsg(sc, "leader error"); 23633453Skarels sc->imp_msgready = 0; 23733427Skarels hostreset(unit); 2385647Ssam impnoops(sc); 23933453Skarels sc->imp_garbage++; 2405647Ssam } 24128849Skarels break; 2425640Sroot 2435640Sroot /* 2445640Sroot * IMP going down. Print message, and if not immediate, 2455640Sroot * set off a timer to insure things will be reset at the 2465640Sroot * appropriate time. 2475640Sroot */ 2485640Sroot case IMPTYPE_DOWN: 24933427Skarels { int type, when; 25033427Skarels 25133427Skarels type = cp->dl_link & IMP_DMASK; 25233427Skarels when = (cp->dl_link & IMPDOWN_WHENMASK) >> IMPDOWN_WHENSHIFT; 25333427Skarels #ifdef IMPINIT 25433427Skarels if (imptraceinit) 25533427Skarels log(imppri, "input DOWN %s %d\n", 25633427Skarels impmessage[type], when * IMPDOWN_WHENUNIT); 25733427Skarels #endif 25833427Skarels if (type != IMPDOWN_GOING && when) 25933427Skarels impmsg(sc, "going down %s in %d minutes", 26033427Skarels (u_int)impmessage[type], when * IMPDOWN_WHENUNIT); 26133427Skarels else 26233427Skarels impmsg(sc, "going down %s", (u_int)impmessage[type]); 26333427Skarels if (sc->imp_state != IMPS_UP) 26428849Skarels break; 26533427Skarels if (type == IMPDOWN_GOING) { 2665640Sroot sc->imp_state = IMPS_GOINGDOWN; 26733427Skarels timeout(impdown, (caddr_t)sc, IMPTV_DOWN * hz); 26833427Skarels } else if (when == 0) 26933427Skarels sc->imp_state = IMPS_WINIT; 27033427Skarels sc->imp_dropcnt = 0; 27128849Skarels break; 27233427Skarels } 2735640Sroot 2745640Sroot /* 27533427Skarels * A NOP, usually seen during the initialization sequence. 2765640Sroot * Compare the local address with that in the message. 2775640Sroot * Reset the local address notion if it doesn't match. 2785640Sroot */ 2796336Ssam case IMPTYPE_NOOP: 28033427Skarels #ifdef IMPINIT 28133427Skarels if (imptraceinit) 28233427Skarels log(imppri, "noop\n"); 28333427Skarels #endif 28433427Skarels if (sc->imp_state == IMPS_WINIT) { 28533427Skarels sc->imp_dropcnt = 0; 28633427Skarels impnoops(sc); 2875647Ssam sc->imp_state = IMPS_INIT; 2885647Ssam } 28933427Skarels sc->imp_dropcnt++; 29033427Skarels if (sc->imp_state == IMPS_INIT && cp->dl_imp != 0) { 29118132Skarels struct in_addr leader_addr; 29228849Skarels 29333427Skarels sin = (struct sockaddr_in *)&sc->imp_if.if_addrlist->ifa_addr; 29433427Skarels imp_leader_to_addr(&leader_addr, cp, &sc->imp_if); 29518412Skarels if (sin->sin_addr.s_addr != leader_addr.s_addr) { 29618412Skarels impmsg(sc, "address reset to x%x (%d/%d)", 29728849Skarels ntohl(leader_addr.s_addr), 29833427Skarels (u_int)cp->dl_host, 29933427Skarels ntohs(cp->dl_imp)); 30018132Skarels sin->sin_addr.s_addr = leader_addr.s_addr; 30118132Skarels } 3026500Ssam } 30328849Skarels break; 3045640Sroot 3055640Sroot /* 30633453Skarels * RFNM or INCOMPLETE message, decrement rfnm count 30733453Skarels * and prepare to send next message. 308*34209Skarels * If the rfnm allows another queued 309*34209Skarels * message to be sent, bump msgready 310*34209Skarels * and start IMP if idle. 31133453Skarels * We could pass incomplete's up to the next level, 31233453Skarels * but this currently isn't needed. 313*34209Skarels * Pass "bad" incompletes and rfnms to the raw socket. 3145640Sroot */ 31533427Skarels case IMPTYPE_INCOMPLETE: 31633427Skarels sc->imp_incomplete++; 31733427Skarels /* FALL THROUGH */ 3185640Sroot case IMPTYPE_RFNM: 319*34209Skarels if ((hp = hostlookup(cp->dl_imp, cp->dl_host, unit)) == 0 || 320*34209Skarels hp->h_rfnm == 0) { 321*34209Skarels sc->imp_badrfnm++; 322*34209Skarels if (hp) 32333427Skarels hostfree(hp); 324*34209Skarels break; 325*34209Skarels } 326*34209Skarels imprestarthost(sc, hp); 327*34209Skarels if (cp->dl_mtype == IMPTYPE_RFNM) 32833427Skarels goto drop; 32933427Skarels break; 3305640Sroot 3315640Sroot /* 3325640Sroot * Host or IMP can't be reached. Flush any packets 3335640Sroot * awaiting transmission and release the host structure. 33424777Skarels * Enqueue for notifying protocols at software interrupt time. 3355640Sroot */ 3365640Sroot case IMPTYPE_HOSTDEAD: 33711230Ssam case IMPTYPE_HOSTUNREACH: 33833427Skarels if (hp = hostlookup(cp->dl_imp, cp->dl_host, unit)) { 33933427Skarels hp->h_flags |= (1 << (int)cp->dl_mtype); 34033453Skarels sc->imp_msgready -= 34133453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 34233427Skarels hp->h_rfnm = 0; 34333453Skarels hostflush(hp); 34424777Skarels hp->h_timer = HOSTDEADTIMER; 34524777Skarels } 34628849Skarels break; 3475640Sroot 3485640Sroot /* 3495640Sroot * Error in data. Clear RFNM status for this host and send 3505640Sroot * noops to the IMP to clear the interface. 3515640Sroot */ 35211230Ssam case IMPTYPE_BADDATA: 3535924Sroot impmsg(sc, "data error"); 354*34209Skarels if (hp = hostlookup(cp->dl_imp, cp->dl_host, unit)) { 35533453Skarels sc->imp_msgready -= 35633453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 357*34209Skarels if (hp->h_rfnm) 358*34209Skarels hostrelease(hp); 359*34209Skarels else 360*34209Skarels hostfree(hp); 36133427Skarels } 3625640Sroot impnoops(sc); 36328849Skarels break; 3645640Sroot 3655640Sroot /* 3665647Ssam * Interface reset. 3675640Sroot */ 3685640Sroot case IMPTYPE_RESET: 36933427Skarels #ifdef IMPINIT 37033427Skarels if (imptraceinit) 37133427Skarels log(imppri, "reset complete\n"); 37233427Skarels #endif 37333427Skarels if (sc->imp_state != IMPS_INIT) { 37433427Skarels impmsg(sc, "interface reset"); 37533427Skarels impnoops(sc); 37633427Skarels } 37718412Skarels /* clear RFNM counts */ 37833453Skarels sc->imp_msgready = 0; 37933427Skarels hostreset(unit); 38033427Skarels if (sc->imp_state != IMPS_DOWN) { 38133427Skarels sc->imp_state = IMPS_UP; 38233427Skarels sc->imp_if.if_flags |= IFF_UP; 38333427Skarels #ifdef IMPINIT 38433427Skarels if (imptraceinit) 38533427Skarels log(imppri, "IMP UP\n"); 38633427Skarels #endif 38733427Skarels } 38828849Skarels break; 3895640Sroot 3905640Sroot default: 39133427Skarels sc->imp_garbage++; 3925640Sroot sc->imp_if.if_collisions++; /* XXX */ 39328849Skarels break; 3945640Sroot } 3955640Sroot 39628849Skarels if (inq == &impintrq) 39724777Skarels schednetisr(NETISR_IMP); 39824777Skarels /* 39924777Skarels * Re-insert interface pointer in the mbuf chain 40024777Skarels * for the next protocol up. 40124777Skarels */ 40228849Skarels if (M_HASCL(m) && (mtod(m, int) & CLOFSET) < sizeof(struct ifnet *)) { 40328849Skarels struct mbuf *n; 40428849Skarels 40528849Skarels MGET(n, M_DONTWAIT, MT_HEADER); 40628849Skarels if (n == 0) 40728849Skarels goto drop; 40828849Skarels n->m_next = m; 40928849Skarels m = n; 41028849Skarels m->m_len = 0; 41128849Skarels m->m_off = MMINOFF + sizeof(struct ifnet *); 41228849Skarels } 41324777Skarels m->m_off -= sizeof(struct ifnet *); 41424777Skarels m->m_len += sizeof(struct ifnet *); 41524777Skarels *(mtod(m, struct ifnet **)) = ifp; 41628849Skarels 41733453Skarels s = splimp(); 41833453Skarels if (!IF_QFULL(inq)) { 41933453Skarels IF_ENQUEUE(inq, m); 42033453Skarels splx(s); 42133453Skarels return; 4226208Swnj } 42333453Skarels splx(s); 424*34209Skarels IF_DROP(inq); 4255640Sroot drop: 4265640Sroot m_freem(m); 42733427Skarels #undef ip 4285640Sroot } 4295640Sroot 4305647Ssam /* 4315647Ssam * Bring the IMP down after notification. 4325647Ssam */ 4335647Ssam impdown(sc) 4345647Ssam struct imp_softc *sc; 4355647Ssam { 43611230Ssam int s = splimp(); 4376208Swnj 43833427Skarels if (sc->imp_state == IMPS_GOINGDOWN) { 43933427Skarels sc->imp_state = IMPS_WINIT; 44033427Skarels impmsg(sc, "marked down"); 441*34209Skarels sc->imp_msgready = 0; 44233427Skarels hostreset(sc->imp_if.if_unit); 44333427Skarels if_down(&sc->imp_if); 44433427Skarels } 44533427Skarels #ifdef IMPINIT 44633427Skarels else if (imptraceinit) 44733427Skarels log(imppri, "impdown, state now %d (ignored)\n", sc->imp_state); 44833427Skarels #endif 44911230Ssam splx(s); 4505647Ssam } 4515647Ssam 45226397Skarels /*VARARGS2*/ 45318132Skarels impmsg(sc, fmt, a1, a2, a3) 4545640Sroot struct imp_softc *sc; 4555640Sroot char *fmt; 4566160Ssam u_int a1; 4575640Sroot { 4586208Swnj 45933427Skarels log(imppri, "imp%d: %r\n", sc->imp_if.if_unit, fmt, &a1); 4605640Sroot } 4615640Sroot 46224777Skarels struct sockproto impproto = { PF_IMPLINK }; 46324777Skarels struct sockaddr_in impdst = { AF_IMPLINK }; 46424777Skarels struct sockaddr_in impsrc = { AF_IMPLINK }; 46524777Skarels 4665640Sroot /* 46724777Skarels * Pick up the IMP "error" messages enqueued earlier, 46824777Skarels * passing these up to the higher level protocol 46924777Skarels * and the raw interface. 4706582Ssam */ 47124777Skarels impintr() 4726582Ssam { 47324777Skarels register struct mbuf *m; 47424777Skarels register struct control_leader *cp; 47524777Skarels struct ifnet *ifp; 47624777Skarels int s; 4776582Ssam 47824777Skarels for (;;) { 47924777Skarels s = splimp(); 48024777Skarels IF_DEQUEUEIF(&impintrq, m, ifp); 48124777Skarels splx(s); 48224777Skarels if (m == 0) 48324777Skarels return; 48418132Skarels 48524777Skarels cp = mtod(m, struct control_leader *); 48633427Skarels imp_leader_to_addr(&impsrc.sin_addr, cp, ifp); 48724777Skarels impproto.sp_protocol = cp->dl_link; 48825409Skarels impdst.sin_addr = IA_SIN(ifp->if_addrlist)->sin_addr; 48924777Skarels 49028849Skarels if (cp->dl_mtype == IMPTYPE_HOSTDEAD || 49128849Skarels cp->dl_mtype == IMPTYPE_HOSTUNREACH) 49228849Skarels switch (cp->dl_link) { 49324777Skarels 49428849Skarels case IMPLINK_IP: 49528849Skarels pfctlinput((int)cp->dl_mtype, 49628849Skarels (struct sockaddr *)&impsrc); 49728849Skarels break; 49828849Skarels default: 49928849Skarels raw_ctlinput((int)cp->dl_mtype, 50028849Skarels (struct sockaddr *)&impsrc); 50128849Skarels break; 50228849Skarels } 50324777Skarels 50424777Skarels raw_input(m, &impproto, (struct sockaddr *)&impsrc, 50524777Skarels (struct sockaddr *)&impdst); 5066588Ssam } 5076582Ssam } 5086582Ssam 5096582Ssam /* 5105640Sroot * ARPAnet 1822 output routine. 5115640Sroot * Called from higher level protocol routines to set up messages for 5125640Sroot * transmission to the imp. Sets up the header and calls impsnd to 5135640Sroot * enqueue the message for this IMP's hardware driver. 5145640Sroot */ 5156336Ssam impoutput(ifp, m0, dst) 5165640Sroot register struct ifnet *ifp; 5175640Sroot struct mbuf *m0; 5186336Ssam struct sockaddr *dst; 5195640Sroot { 5205640Sroot register struct imp_leader *imp; 5215640Sroot register struct mbuf *m = m0; 522*34209Skarels caddr_t pkt = mtod(m, caddr_t); 5236504Ssam int error = 0; 5245640Sroot 5255640Sroot /* 5265640Sroot * Don't even try if the IMP is unavailable. 5275640Sroot */ 52833427Skarels if (!IMPS_RUNNING(imp_softc[ifp->if_unit].imp_state)) { 5296504Ssam error = ENETDOWN; 5305647Ssam goto drop; 5316504Ssam } 5325640Sroot 53333453Skarels /* 53433453Skarels * If AF_IMPLINK, leader exists; just send. 53533453Skarels * Otherwise, construct leader according to address family. 53633453Skarels */ 53733453Skarels if (dst->sa_family != AF_IMPLINK) { 53833453Skarels /* 53933453Skarels * Add IMP leader. If there's not enough space in the 54033453Skarels * first mbuf, allocate another. If that should fail, we 54133453Skarels * drop this sucker. 54233453Skarels */ 54333453Skarels if (m->m_off > MMAXOFF || 54433453Skarels MMINOFF + sizeof(struct imp_leader) > m->m_off) { 545*34209Skarels MGET(m, M_DONTWAIT, MT_HEADER); 54633453Skarels if (m == 0) { 54733453Skarels error = ENOBUFS; 54833453Skarels goto drop; 54933453Skarels } 55033453Skarels m->m_next = m0; 55133453Skarels m->m_len = sizeof(struct imp_leader); 55233453Skarels } else { 55333453Skarels m->m_off -= sizeof(struct imp_leader); 55433453Skarels m->m_len += sizeof(struct imp_leader); 55533453Skarels } 55633453Skarels imp = mtod(m, struct imp_leader *); 55733453Skarels imp->il_format = IMP_NFF; 55833453Skarels imp->il_mtype = IMPTYPE_DATA; 559*34209Skarels imp->il_flags = 0; 560*34209Skarels imp->il_htype = 0; 561*34209Skarels imp->il_subtype = 0; 5625640Sroot 56333453Skarels switch (dst->sa_family) { 5645640Sroot 565*34209Skarels case AF_INET: 56633453Skarels imp->il_link = IMPLINK_IP; 56733453Skarels imp_addr_to_leader((struct control_leader *)imp, 56833453Skarels ((struct sockaddr_in *)dst)->sin_addr.s_addr); 569*34209Skarels imp->il_length = htons(ntohs((u_short) 570*34209Skarels ((struct ip *)pkt)->ip_len) << 3); 57133453Skarels break; 5725640Sroot 57333453Skarels default: 57433453Skarels printf("imp%d: can't handle af%d\n", ifp->if_unit, 57533453Skarels dst->sa_family); 57633453Skarels error = EAFNOSUPPORT; 577*34209Skarels m0 = m; 5785647Ssam goto drop; 5796504Ssam } 5805640Sroot } 5815640Sroot return (impsnd(ifp, m)); 5825647Ssam drop: 5835647Ssam m_freem(m0); 5846504Ssam return (error); 5855640Sroot } 5865640Sroot 5875640Sroot /* 5885640Sroot * Put a message on an interface's output queue. 5895640Sroot * Perform RFNM counting: no more than 8 message may be 5905640Sroot * in flight to any one host. 5915640Sroot */ 5925640Sroot impsnd(ifp, m) 5935640Sroot struct ifnet *ifp; 5945640Sroot struct mbuf *m; 5955640Sroot { 59633427Skarels register struct control_leader *imp; 5975640Sroot register struct host *hp; 59833453Skarels register struct imp_softc *sc = &imp_softc[ifp->if_unit]; 59933453Skarels int s, error = 0; 6005640Sroot 60133427Skarels imp = mtod(m, struct control_leader *); 6025640Sroot 6035640Sroot /* 6045640Sroot * Do RFNM counting for data messages 60533453Skarels * (no more than 8 outstanding to any host). 60633453Skarels * Queue data messages per host if 8 are already outstanding 60733453Skarels * or if the hardware interface is already doing output. 60833453Skarels * Increment imp_msgready if the message could be sent now, 60933453Skarels * but must be queued because the imp output is busy. 6105640Sroot */ 6116588Ssam s = splimp(); 61233427Skarels if (imp->dl_mtype == IMPTYPE_DATA) { 61333427Skarels hp = hostenter(imp->dl_imp, imp->dl_host, ifp->if_unit); 6145640Sroot if (hp) { 615*34209Skarels if (hp->h_flags & (HF_DEAD|HF_UNREACH)) 616*34209Skarels error = hp->h_flags & HF_DEAD ? 617*34209Skarels EHOSTDOWN : EHOSTUNREACH; 618*34209Skarels else if (hp->h_rfnm < IMP_MAXHOSTMSG && 619*34209Skarels sc->imp_cb.ic_oactive == 0) { 620*34209Skarels /* 621*34209Skarels * Send without queuing; 622*34209Skarels * adjust rfnm count and timer. 623*34209Skarels */ 624*34209Skarels if (hp->h_rfnm++ == 0) 625*34209Skarels hp->h_timer = RFNMTIMER; 626*34209Skarels goto send; 62733453Skarels } else if (hp->h_rfnm + hp->h_qcnt < imphqlen) { 6286095Swnj HOST_ENQUE(hp, m); 629*34209Skarels if (hp->h_rfnm + hp->h_qcnt <= IMP_MAXHOSTMSG) 630*34209Skarels sc->imp_msgready++; 63133453Skarels } else 63233453Skarels error = ENOBUFS; 63333453Skarels } else 63433453Skarels error = ENOBUFS; 63533453Skarels } else if (sc->imp_cb.ic_oactive == 0) 63633453Skarels goto send; 63733453Skarels else 63833453Skarels IF_ENQUEUE(&ifp->if_snd, m); 639*34209Skarels 64033453Skarels splx(s); 641*34209Skarels if (error) 642*34209Skarels m_freem(m); 643*34209Skarels return (error); 64433453Skarels 64533453Skarels send: 64633453Skarels sc->imp_if.if_timer = IMP_OTIMER; 64733453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 64833453Skarels splx(s); 64933453Skarels return (0); 65033453Skarels } 65133453Skarels 65233453Skarels /* 65333453Skarels * Start another output operation on IMP; called from hardware 65433453Skarels * transmit-complete interrupt routine at splimp or from imp routines 655*34209Skarels * when output is not in progress. If there are any packets on shared 656*34209Skarels * output queue, send them, otherwise send the next data packet for a host. 657*34209Skarels * Host data packets are sent round-robin based on destination by walking 658*34209Skarels * the host list. 65933453Skarels */ 66033453Skarels impstart(sc) 66133453Skarels register struct imp_softc *sc; 66233453Skarels { 66333453Skarels register struct mbuf *m; 664*34209Skarels int first = 1; /* XXX */ 66533453Skarels register struct host *hp; 66633453Skarels int index; 66733453Skarels 66833453Skarels IF_DEQUEUE(&sc->imp_if.if_snd, m); 66933453Skarels if (m) { 67033453Skarels sc->imp_if.if_timer = IMP_OTIMER; 67133453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 67233453Skarels return; 67333453Skarels } 67433453Skarels if (sc->imp_msgready) { 67533453Skarels if ((m = sc->imp_hostq) == 0 && (m = sc->imp_hosts) == 0) 676*34209Skarels panic("imp msgready"); 677*34209Skarels index = sc->imp_hostent; 678*34209Skarels for (hp = &mtod(m, struct hmbuf *)->hm_hosts[index]; ; 679*34209Skarels hp++, index++) { 680*34209Skarels if (index >= HPMBUF) { 681*34209Skarels if ((m = m->m_next) == 0) 682*34209Skarels m = sc->imp_hosts; 683*34209Skarels index = 0; 684*34209Skarels hp = mtod(m, struct hmbuf *)->hm_hosts; 685*34209Skarels first = 0; /* XXX */ 6866095Swnj } 687*34209Skarels if (hp->h_qcnt && hp->h_rfnm < IMP_MAXHOSTMSG) { 688*34209Skarels /* 689*34209Skarels * Found host entry with another message 690*34209Skarels * to send. Deliver it to the IMP. 691*34209Skarels * Start with succeeding host next time. 692*34209Skarels */ 693*34209Skarels impstarthost(sc, hp); 694*34209Skarels sc->imp_hostq = m; 695*34209Skarels sc->imp_hostent = index + 1; 696*34209Skarels return; 69733453Skarels } 698*34209Skarels if (m == sc->imp_hostq && !first && 699*34209Skarels index + 1 >= sc->imp_hostent) { /* XXX */ 700*34209Skarels log(imppri, "imp: can't find %d msgready\n", 701*34209Skarels sc->imp_msgready); 702*34209Skarels sc->imp_msgready = 0; 703*34209Skarels break; 704*34209Skarels } 7055640Sroot } 7065640Sroot } 70733453Skarels sc->imp_if.if_timer = 0; 70833453Skarels } 70933453Skarels 71033453Skarels /* 711*34209Skarels * Restart output for a host that has received a RFNM 712*34209Skarels * or incomplete or has timed out while waiting for a RFNM. 71333453Skarels * Must be called at splimp. 71433453Skarels */ 715*34209Skarels imprestarthost(sc, hp) 716*34209Skarels register struct imp_softc *sc; 71733453Skarels struct host *hp; 71833453Skarels { 71933453Skarels 72033453Skarels if (--hp->h_rfnm > 0) 72133453Skarels hp->h_timer = RFNMTIMER; 722*34209Skarels /* 723*34209Skarels * If the RFNM moved a queued message into the window, 724*34209Skarels * update msgready and start IMP if idle. 725*34209Skarels */ 726*34209Skarels if (hp->h_qcnt > IMP_MAXHOSTMSG - 1 - hp->h_rfnm) { 727*34209Skarels sc->imp_msgready++; 72833453Skarels if (sc->imp_cb.ic_oactive == 0) 72933453Skarels impstarthost(sc, hp); 7306208Swnj } 731*34209Skarels if (hp->h_rfnm == 0 && hp->h_qcnt == 0) 732*34209Skarels hostidle(hp); 7335640Sroot } 7345640Sroot 7355640Sroot /* 73633453Skarels * Send the next message queued for a host 73733453Skarels * when ready to send another message to the IMP. 73833453Skarels * Called only when output is not in progress. 73933453Skarels * Bump RFNM counter and start RFNM timer 74033453Skarels * when we send the message to the IMP. 74133453Skarels * Must be called at splimp. 74233453Skarels */ 74333453Skarels impstarthost(sc, hp) 74433453Skarels register struct imp_softc *sc; 74533453Skarels register struct host *hp; 74633453Skarels { 74733453Skarels struct mbuf *m; 74833453Skarels 74933453Skarels if (hp->h_rfnm++ == 0) 75033453Skarels hp->h_timer = RFNMTIMER; 75133453Skarels HOST_DEQUE(hp, m); 75233453Skarels sc->imp_if.if_timer = IMP_OTIMER; 75333453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 75433453Skarels sc->imp_msgready--; 75533453Skarels } 75633453Skarels 75733453Skarels /* 75833453Skarels * "Watchdog" timeout. When the output timer expires, 75933453Skarels * we assume we have been blocked by the imp. 76033453Skarels * No need to restart, just collect statistics. 76133453Skarels */ 76233453Skarels imptimo(unit) 76333453Skarels int unit; 76433453Skarels { 76533453Skarels 76633453Skarels imp_softc[unit].imp_block++; 76733453Skarels } 76833453Skarels 76933453Skarels /* 7705640Sroot * Put three 1822 NOOPs at the head of the output queue. 7715640Sroot * Part of host-IMP initialization procedure. 7725640Sroot * (Should return success/failure, but noone knows 7735640Sroot * what to do with this, so why bother?) 7746818Ssam * This routine is always called at splimp, so we don't 7756818Ssam * protect the call to IF_PREPEND. 7765640Sroot */ 7775640Sroot impnoops(sc) 7785640Sroot register struct imp_softc *sc; 7795640Sroot { 7805640Sroot register i; 7815640Sroot register struct mbuf *m; 7825771Swnj register struct control_leader *cp; 7835640Sroot 78433427Skarels #ifdef IMPINIT 78533427Skarels if (imptraceinit) 78633427Skarels log(imppri, "impnoops\n"); 78733427Skarels #endif 78833427Skarels for (i = 0; i < IMP_NOOPCNT; i++) { 7899645Ssam if ((m = m_getclr(M_DONTWAIT, MT_HEADER)) == 0) 7905640Sroot return; 7915771Swnj m->m_len = sizeof(struct control_leader); 7925771Swnj cp = mtod(m, struct control_leader *); 7935771Swnj cp->dl_format = IMP_NFF; 79433427Skarels cp->dl_link = i; 79533427Skarels cp->dl_mtype = IMPTYPE_NOOP; 7965640Sroot IF_PREPEND(&sc->imp_if.if_snd, m); 7975640Sroot } 7985640Sroot if (sc->imp_cb.ic_oactive == 0) 79933453Skarels impstart(sc); 8005640Sroot } 8017170Ssam 80213067Ssam /* 80313067Ssam * Process an ioctl request. 80413067Ssam */ 80513067Ssam impioctl(ifp, cmd, data) 80613067Ssam register struct ifnet *ifp; 80713067Ssam int cmd; 80813067Ssam caddr_t data; 80913067Ssam { 81018412Skarels struct ifaddr *ifa = (struct ifaddr *) data; 81113067Ssam int s = splimp(), error = 0; 81233427Skarels #define sc ((struct imp_softc *)ifp) 81313067Ssam 81413067Ssam switch (cmd) { 81513067Ssam 81613067Ssam case SIOCSIFADDR: 81718412Skarels if (ifa->ifa_addr.sa_family != AF_INET) { 81818412Skarels error = EINVAL; 81918412Skarels break; 82018412Skarels } 82133427Skarels if ((ifp->if_flags & IFF_UP) == 0) 82213067Ssam impinit(ifp->if_unit); 82313067Ssam break; 82413067Ssam 82533427Skarels case SIOCSIFFLAGS: 82633427Skarels if ((ifp->if_flags & IFF_UP) == 0 && 82733427Skarels sc->imp_state != IMPS_DOWN) { 82833453Skarels if (sc->imp_cb.ic_down && 829*34209Skarels (*sc->imp_cb.ic_down)(sc->imp_cb.ic_hwunit)) { 83033427Skarels sc->imp_state = IMPS_DOWN; 831*34209Skarels sc->imp_msgready = 0; 832*34209Skarels hostreset(ifp->if_unit); 833*34209Skarels } 83433427Skarels } else if (ifp->if_flags & IFF_UP && sc->imp_state == IMPS_DOWN) 83533427Skarels impinit(ifp->if_unit); 83633427Skarels break; 83733427Skarels 83813067Ssam default: 83913067Ssam error = EINVAL; 84033427Skarels break; 84113067Ssam } 84213067Ssam splx(s); 84313067Ssam return (error); 84413067Ssam } 84513067Ssam 8467170Ssam #ifdef IMPLEADERS 8477170Ssam printleader(routine, ip) 8487170Ssam char *routine; 8497170Ssam register struct imp_leader *ip; 8507170Ssam { 8517170Ssam printf("%s: ", routine); 8527170Ssam printbyte((char *)ip, 12); 8537170Ssam printf("<fmt=%x,net=%x,flags=%x,mtype=", ip->il_format, ip->il_network, 8547170Ssam ip->il_flags); 8557170Ssam if (ip->il_mtype <= IMPTYPE_READY) 8567170Ssam printf("%s,", impleaders[ip->il_mtype]); 8577170Ssam else 8587170Ssam printf("%x,", ip->il_mtype); 8597170Ssam printf("htype=%x,host=%x,imp=%x,link=", ip->il_htype, ip->il_host, 8607170Ssam ntohs(ip->il_imp)); 8617170Ssam if (ip->il_link == IMPLINK_IP) 8627170Ssam printf("ip,"); 8637170Ssam else 8647170Ssam printf("%x,", ip->il_link); 8657170Ssam printf("subtype=%x,len=%x>\n",ip->il_subtype,ntohs(ip->il_length)>>3); 8667170Ssam } 8677170Ssam 8687170Ssam printbyte(cp, n) 8697170Ssam register char *cp; 8707170Ssam int n; 8717170Ssam { 8727170Ssam register i, j, c; 8737170Ssam 8747170Ssam for (i=0; i<n; i++) { 8757170Ssam c = *cp++; 8767170Ssam for (j=0; j<2; j++) 87724777Skarels putchar("0123456789abcdef"[(c>>((1-j)*4))&0xf], 0); 87824777Skarels putchar(' ', 0); 8797170Ssam } 88024777Skarels putchar('\n', 0); 8817170Ssam } 8825640Sroot #endif 88318132Skarels 88418132Skarels /* 88518132Skarels * Routine to convert from IMP Leader to InterNet Address. 88618132Skarels * 88718132Skarels * This procedure is necessary because IMPs may be assigned Class A, B, or C 88818132Skarels * network numbers, but only have 8 bits in the leader to reflect the 88918132Skarels * IMP "network number". The strategy is to take the network number from 89018132Skarels * the ifnet structure, and blend in the host-on-imp and imp-on-net numbers 89118132Skarels * from the leader. 89218132Skarels * 89318132Skarels * There is no support for "Logical Hosts". 89418132Skarels * 89518132Skarels * Class A: Net.Host.0.Imp 89618132Skarels * Class B: Net.net.Host.Imp 89718132Skarels * Class C: Net.net.net.(Host4|Imp4) 89818132Skarels */ 89933427Skarels imp_leader_to_addr(ap, cp, ifp) 90018412Skarels struct in_addr *ap; 90133427Skarels register struct control_leader *cp; 90218412Skarels struct ifnet *ifp; 90318132Skarels { 90426397Skarels register u_long final; 90518132Skarels register struct sockaddr_in *sin; 90633427Skarels int imp = ntohs(cp->dl_imp); 90718132Skarels 90818412Skarels sin = (struct sockaddr_in *)(&ifp->if_addrlist->ifa_addr); 90928849Skarels final = ntohl(sin->sin_addr.s_addr); 91018132Skarels 91118412Skarels if (IN_CLASSA(final)) { 91218132Skarels final &= IN_CLASSA_NET; 91333427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<16); 91418412Skarels } else if (IN_CLASSB(final)) { 91518132Skarels final &= IN_CLASSB_NET; 91633427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<8); 91718132Skarels } else { 91818132Skarels final &= IN_CLASSC_NET; 91933427Skarels final |= (imp & 0x0F) | ((cp->dl_host & 0x0F)<<4); 92018132Skarels } 92118412Skarels ap->s_addr = htonl(final); 92218132Skarels } 92318132Skarels 92418132Skarels /* 92518132Skarels * Function to take InterNet address and fill in IMP leader fields. 92618132Skarels */ 92718412Skarels imp_addr_to_leader(imp, a) 92833427Skarels register struct control_leader *imp; 92926397Skarels u_long a; 93018132Skarels { 93128849Skarels register u_long addr = ntohl(a); 93218132Skarels 93333427Skarels imp->dl_network = 0; /* !! */ 93418132Skarels 93518412Skarels if (IN_CLASSA(addr)) { 93633427Skarels imp->dl_host = ((addr>>16) & 0xFF); 93733427Skarels imp->dl_imp = addr & 0xFF; 93818412Skarels } else if (IN_CLASSB(addr)) { 93933427Skarels imp->dl_host = ((addr>>8) & 0xFF); 94033427Skarels imp->dl_imp = addr & 0xFF; 94118132Skarels } else { 94233427Skarels imp->dl_host = ((addr>>4) & 0xF); 94333427Skarels imp->dl_imp = addr & 0xF; 94418132Skarels } 94533427Skarels imp->dl_imp = htons(imp->dl_imp); 94618132Skarels } 9477170Ssam #endif 948