123166Smckusick /* 2*34853Sbostic * 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 6*34853Sbostic * provided that the above copyright notice and this paragraph are 7*34853Sbostic * duplicated in all such forms and that any documentation, 8*34853Sbostic * advertising materials, and other materials related to such 9*34853Sbostic * distribution and use acknowledge that the software was developed 10*34853Sbostic * by the University of California, Berkeley. The name of the 11*34853Sbostic * University may not be used to endorse or promote products derived 12*34853Sbostic * from this software without specific prior written permission. 13*34853Sbostic * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR 14*34853Sbostic * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED 15*34853Sbostic * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE. 1633453Skarels * 17*34853Sbostic * @(#)if_imp.c 7.8 (Berkeley) 06/29/88 1823166Smckusick */ 195640Sroot 205640Sroot #include "imp.h" 215640Sroot #if NIMP > 0 225640Sroot /* 2333453Skarels * ARPANET IMP (PSN) interface driver. 245640Sroot * 2533453Skarels * The IMP-host protocol (AHIP) is handled here, leaving 265640Sroot * hardware specifics to the lower level interface driver. 275640Sroot */ 2817068Sbloom #include "param.h" 2917068Sbloom #include "systm.h" 3017068Sbloom #include "mbuf.h" 3117068Sbloom #include "buf.h" 3217068Sbloom #include "protosw.h" 3317068Sbloom #include "socket.h" 3417068Sbloom #include "time.h" 3517068Sbloom #include "kernel.h" 3617068Sbloom #include "errno.h" 3717068Sbloom #include "ioctl.h" 3833427Skarels #include "syslog.h" 398705Sroot 4033453Skarels #include "../machine/mtpr.h" 4133453Skarels 428705Sroot #include "../net/if.h" 438705Sroot #include "../net/netisr.h" 448408Swnj #include "../netinet/in.h" 458408Swnj #include "../netinet/in_systm.h" 4618412Skarels #include "../netinet/in_var.h" 478705Sroot #include "../netinet/ip.h" 488705Sroot #include "../netinet/ip_var.h" 4933427Skarels #define IMPMESSAGES 507199Ssam /* define IMPLEADERS here to get leader printing code */ 5117068Sbloom #include "if_imp.h" 5217068Sbloom #include "if_imphost.h" 535640Sroot 5433427Skarels struct imp_softc imp_softc[NIMP]; 5533453Skarels #ifndef lint 5633453Skarels int nimp = NIMP; /* for netstat */ 5733453Skarels #endif 5828849Skarels struct ifqueue impintrq; 5928849Skarels int impqmaxlen = IFQ_MAXLEN; 6033453Skarels int imphqlen = 12 + IMP_MAXHOSTMSG; /* max packets to queue per host */ 6124777Skarels 6233427Skarels int imppri = LOG_ERR; 6333427Skarels #ifdef IMPLEADERS 6433427Skarels int impprintfs = 0; 6533427Skarels #endif 6633427Skarels #ifdef IMPINIT 6733427Skarels int imptraceinit = 0; 6833427Skarels #endif 695640Sroot 7033453Skarels 7133427Skarels #define HOSTDEADTIMER (30 * PR_SLOWHZ) /* How long to wait when down */ 7218132Skarels 7333453Skarels int impdown(), impinit(), impioctl(), impoutput(), imptimo(); 745771Swnj 755640Sroot /* 765640Sroot * IMP attach routine. Called from hardware device attach routine 7733427Skarels * at configuration time with a pointer to the device structure. 785640Sroot * Sets up local state and returns pointer to base of ifnet+impcb 795640Sroot * structures. This is then used by the device's attach routine 805640Sroot * set up its back pointers. 815640Sroot */ 8233427Skarels struct imp_softc * 8334209Skarels impattach(hwname, hwunit, reset) 8434209Skarels char *hwname; 8534209Skarels int hwunit; 868815Sroot int (*reset)(); 875640Sroot { 8824777Skarels struct imp_softc *sc; 8924777Skarels register struct ifnet *ifp; 9033427Skarels static int impunit; 915640Sroot 9226397Skarels #ifdef lint 9326397Skarels impintr(); 9426397Skarels #endif 9533427Skarels if (impunit >= NIMP) { 9633427Skarels printf("imp%d: not configured\n", impunit++); 9724777Skarels return (0); 9824777Skarels } 9933427Skarels sc = &imp_softc[impunit]; 10024777Skarels ifp = &sc->imp_if; 10134209Skarels sc->imp_cb.ic_hwname = hwname; 10234209Skarels sc->imp_cb.ic_hwunit = hwunit; 10333427Skarels ifp->if_unit = impunit; 1045640Sroot ifp->if_name = "imp"; 1056271Sroot ifp->if_mtu = IMPMTU - sizeof(struct imp_leader); 1069001Sroot ifp->if_reset = reset; 1075771Swnj ifp->if_init = impinit; 10813067Ssam ifp->if_ioctl = impioctl; 1095771Swnj ifp->if_output = impoutput; 11033453Skarels ifp->if_watchdog = imptimo; 1115640Sroot if_attach(ifp); 11233427Skarels impunit++; 11333427Skarels return (sc); 1145640Sroot } 1155640Sroot 1165640Sroot /* 1175640Sroot * IMP initialization routine: call hardware module to 11833427Skarels * setup resources, init state and get ready for 1195640Sroot * NOOPs the IMP should send us, and that we want to drop. 1205640Sroot */ 1215640Sroot impinit(unit) 1225640Sroot int unit; 1235640Sroot { 12432570Sbostic int s; 1255640Sroot register struct imp_softc *sc = &imp_softc[unit]; 1265640Sroot 12718412Skarels if (sc->imp_if.if_addrlist == 0) 12813067Ssam return; 12932570Sbostic s = splimp(); 13033427Skarels #ifdef IMPINIT 13133427Skarels if (imptraceinit) 13233427Skarels log(imppri, "impinit\n"); 13333427Skarels #endif 13433427Skarels sc->imp_state = IMPS_WINIT; 13533427Skarels if ((*sc->imp_cb.ic_init)(sc->imp_cb.ic_hwunit) == 0) 1366336Ssam sc->imp_if.if_flags &= ~IFF_UP; 13733427Skarels impintrq.ifq_maxlen = impqmaxlen; 1386500Ssam splx(s); 1395640Sroot } 1405640Sroot 1415640Sroot /* 14233453Skarels * ARPAnet 1822/AHIP input routine. 1435640Sroot * Called from hardware input interrupt routine to handle 1822 14433453Skarels * IMP-host messages. Data messages are passed to higher-level 14533453Skarels * protocol processors on the basis of link number. 14633453Skarels * Other type messages (control) are handled here. 1475640Sroot */ 1485771Swnj impinput(unit, m) 1495640Sroot int unit; 1505771Swnj register struct mbuf *m; 1515640Sroot { 15233427Skarels register struct control_leader *cp; 15333427Skarels #define ip ((struct imp_leader *)cp) 1545640Sroot register struct imp_softc *sc = &imp_softc[unit]; 15524777Skarels struct ifnet *ifp; 1565640Sroot register struct host *hp; 1575640Sroot register struct ifqueue *inq; 1586336Ssam struct sockaddr_in *sin; 15933453Skarels int s; 1605640Sroot 16124777Skarels /* 16224777Skarels * Pull the interface pointer out of the mbuf 16324777Skarels * and save for later; adjust mbuf to look at rest of data. 16424777Skarels */ 16524777Skarels ifp = *(mtod(m, struct ifnet **)); 16624777Skarels IF_ADJ(m); 1676257Sroot /* verify leader length. */ 1685771Swnj if (m->m_len < sizeof(struct control_leader) && 1695771Swnj (m = m_pullup(m, sizeof(struct control_leader))) == 0) 1705771Swnj return; 1715771Swnj cp = mtod(m, struct control_leader *); 17233427Skarels if (cp->dl_mtype == IMPTYPE_DATA && 17333427Skarels m->m_len < sizeof(struct imp_leader)) { 17433427Skarels if ((m = m_pullup(m, sizeof(struct imp_leader))) == 0) 1755771Swnj return; 17633427Skarels cp = mtod(m, struct control_leader *); 17733427Skarels } 1787199Ssam #ifdef IMPLEADERS 1797170Ssam if (impprintfs) 1807170Ssam printleader("impinput", ip); 1817199Ssam #endif 18228849Skarels inq = &impintrq; 1835640Sroot 1846257Sroot /* check leader type */ 18533427Skarels if (cp->dl_format != IMP_NFF) { 18634209Skarels /* 18734209Skarels * We get 1822L NOOPs and RESET 18834209Skarels * at initialization. 18934209Skarels */ 19034209Skarels #ifdef IMPINIT 19134209Skarels if (imptraceinit) 19234209Skarels log(imppri, "input, format %x mtype %d\n", 19334209Skarels cp->dl_format, cp->dl_mtype); 19434209Skarels #endif 19534209Skarels if (cp->dl_format != IMP_1822L_I2H || 19634209Skarels (cp->dl_mtype != IMPTYPE_NOOP && 19734209Skarels cp->dl_mtype != IMPTYPE_RESET)) { 19833453Skarels sc->imp_garbage++; 19933453Skarels sc->imp_if.if_collisions++; /* XXX */ 20033453Skarels } 20133427Skarels } else switch (cp->dl_mtype) { 2025640Sroot 2035640Sroot case IMPTYPE_DATA: 20428849Skarels /* 20528849Skarels * Data for a protocol. Dispatch to the appropriate 20628849Skarels * protocol routine (running at software interrupt). 20728849Skarels * If this isn't a raw interface, advance pointer 20828849Skarels * into mbuf past leader. 20928849Skarels */ 21033427Skarels switch (cp->dl_link) { 21128849Skarels 21228849Skarels case IMPLINK_IP: 21328849Skarels m->m_len -= sizeof(struct imp_leader); 21428849Skarels m->m_off += sizeof(struct imp_leader); 21528849Skarels schednetisr(NETISR_IP); 21628849Skarels inq = &ipintrq; 21728849Skarels break; 21828849Skarels 21928849Skarels default: 22028849Skarels break; 22128849Skarels } 2225640Sroot break; 2235640Sroot 2245640Sroot /* 2255640Sroot * IMP leader error. Reset the IMP and discard the packet. 2265640Sroot */ 2275640Sroot case IMPTYPE_BADLEADER: 2285647Ssam /* 2295647Ssam * According to 1822 document, this message 2305647Ssam * will be generated in response to the 2315647Ssam * first noop sent to the IMP after 2325647Ssam * the host resets the IMP interface. 2335647Ssam */ 23433427Skarels #ifdef IMPINIT 23533427Skarels if (imptraceinit) 23633427Skarels log(imppri, "badleader\n"); 23733427Skarels #endif 2385771Swnj if (sc->imp_state != IMPS_INIT) { 2395924Sroot impmsg(sc, "leader error"); 24033453Skarels sc->imp_msgready = 0; 24133427Skarels hostreset(unit); 2425647Ssam impnoops(sc); 24333453Skarels sc->imp_garbage++; 2445647Ssam } 24528849Skarels break; 2465640Sroot 2475640Sroot /* 2485640Sroot * IMP going down. Print message, and if not immediate, 2495640Sroot * set off a timer to insure things will be reset at the 2505640Sroot * appropriate time. 2515640Sroot */ 2525640Sroot case IMPTYPE_DOWN: 25333427Skarels { int type, when; 25433427Skarels 25533427Skarels type = cp->dl_link & IMP_DMASK; 25633427Skarels when = (cp->dl_link & IMPDOWN_WHENMASK) >> IMPDOWN_WHENSHIFT; 25733427Skarels #ifdef IMPINIT 25833427Skarels if (imptraceinit) 25933427Skarels log(imppri, "input DOWN %s %d\n", 26033427Skarels impmessage[type], when * IMPDOWN_WHENUNIT); 26133427Skarels #endif 26233427Skarels if (type != IMPDOWN_GOING && when) 26333427Skarels impmsg(sc, "going down %s in %d minutes", 26433427Skarels (u_int)impmessage[type], when * IMPDOWN_WHENUNIT); 26533427Skarels else 26633427Skarels impmsg(sc, "going down %s", (u_int)impmessage[type]); 26733427Skarels if (sc->imp_state != IMPS_UP) 26828849Skarels break; 26933427Skarels if (type == IMPDOWN_GOING) { 2705640Sroot sc->imp_state = IMPS_GOINGDOWN; 27133427Skarels timeout(impdown, (caddr_t)sc, IMPTV_DOWN * hz); 27233427Skarels } else if (when == 0) 27333427Skarels sc->imp_state = IMPS_WINIT; 27433427Skarels sc->imp_dropcnt = 0; 27528849Skarels break; 27633427Skarels } 2775640Sroot 2785640Sroot /* 27933427Skarels * A NOP, usually seen during the initialization sequence. 2805640Sroot * Compare the local address with that in the message. 2815640Sroot * Reset the local address notion if it doesn't match. 2825640Sroot */ 2836336Ssam case IMPTYPE_NOOP: 28433427Skarels #ifdef IMPINIT 28533427Skarels if (imptraceinit) 28633427Skarels log(imppri, "noop\n"); 28733427Skarels #endif 28833427Skarels if (sc->imp_state == IMPS_WINIT) { 28933427Skarels sc->imp_dropcnt = 0; 29033427Skarels impnoops(sc); 2915647Ssam sc->imp_state = IMPS_INIT; 2925647Ssam } 29333427Skarels sc->imp_dropcnt++; 29433427Skarels if (sc->imp_state == IMPS_INIT && cp->dl_imp != 0) { 29518132Skarels struct in_addr leader_addr; 29628849Skarels 29733427Skarels sin = (struct sockaddr_in *)&sc->imp_if.if_addrlist->ifa_addr; 29833427Skarels imp_leader_to_addr(&leader_addr, cp, &sc->imp_if); 29918412Skarels if (sin->sin_addr.s_addr != leader_addr.s_addr) { 30018412Skarels impmsg(sc, "address reset to x%x (%d/%d)", 30128849Skarels ntohl(leader_addr.s_addr), 30233427Skarels (u_int)cp->dl_host, 30333427Skarels ntohs(cp->dl_imp)); 30418132Skarels sin->sin_addr.s_addr = leader_addr.s_addr; 30518132Skarels } 3066500Ssam } 30728849Skarels break; 3085640Sroot 3095640Sroot /* 31033453Skarels * RFNM or INCOMPLETE message, decrement rfnm count 31133453Skarels * and prepare to send next message. 31234209Skarels * If the rfnm allows another queued 31334209Skarels * message to be sent, bump msgready 31434209Skarels * and start IMP if idle. 31533453Skarels * We could pass incomplete's up to the next level, 31633453Skarels * but this currently isn't needed. 31734209Skarels * Pass "bad" incompletes and rfnms to the raw socket. 3185640Sroot */ 31933427Skarels case IMPTYPE_INCOMPLETE: 32033427Skarels sc->imp_incomplete++; 32133427Skarels /* FALL THROUGH */ 3225640Sroot case IMPTYPE_RFNM: 32334509Skarels if ((hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, 32434509Skarels unit)) == 0 || hp->h_rfnm == 0) { 32534209Skarels sc->imp_badrfnm++; 32634209Skarels if (hp) 32733427Skarels hostfree(hp); 32834209Skarels break; 32934209Skarels } 33034209Skarels imprestarthost(sc, hp); 33134209Skarels if (cp->dl_mtype == IMPTYPE_RFNM) 33233427Skarels goto drop; 33333427Skarels break; 3345640Sroot 3355640Sroot /* 3365640Sroot * Host or IMP can't be reached. Flush any packets 3375640Sroot * awaiting transmission and release the host structure. 33824777Skarels * Enqueue for notifying protocols at software interrupt time. 3395640Sroot */ 3405640Sroot case IMPTYPE_HOSTDEAD: 34111230Ssam case IMPTYPE_HOSTUNREACH: 34234509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) { 34333427Skarels hp->h_flags |= (1 << (int)cp->dl_mtype); 34433453Skarels sc->imp_msgready -= 34533453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 34633427Skarels hp->h_rfnm = 0; 34733453Skarels hostflush(hp); 34824777Skarels hp->h_timer = HOSTDEADTIMER; 34924777Skarels } 35028849Skarels break; 3515640Sroot 3525640Sroot /* 3535640Sroot * Error in data. Clear RFNM status for this host and send 3545640Sroot * noops to the IMP to clear the interface. 3555640Sroot */ 35611230Ssam case IMPTYPE_BADDATA: 3575924Sroot impmsg(sc, "data error"); 35834509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) { 35933453Skarels sc->imp_msgready -= 36033453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 36134209Skarels if (hp->h_rfnm) 36234209Skarels hostrelease(hp); 36334209Skarels else 36434209Skarels hostfree(hp); 36533427Skarels } 3665640Sroot impnoops(sc); 36728849Skarels break; 3685640Sroot 3695640Sroot /* 3705647Ssam * Interface reset. 3715640Sroot */ 3725640Sroot case IMPTYPE_RESET: 37333427Skarels #ifdef IMPINIT 37433427Skarels if (imptraceinit) 37533427Skarels log(imppri, "reset complete\n"); 37633427Skarels #endif 37733427Skarels if (sc->imp_state != IMPS_INIT) { 37833427Skarels impmsg(sc, "interface reset"); 37933427Skarels impnoops(sc); 38033427Skarels } 38118412Skarels /* clear RFNM counts */ 38233453Skarels sc->imp_msgready = 0; 38333427Skarels hostreset(unit); 38433427Skarels if (sc->imp_state != IMPS_DOWN) { 38533427Skarels sc->imp_state = IMPS_UP; 38633427Skarels sc->imp_if.if_flags |= IFF_UP; 38733427Skarels #ifdef IMPINIT 38833427Skarels if (imptraceinit) 38933427Skarels log(imppri, "IMP UP\n"); 39033427Skarels #endif 39133427Skarels } 39228849Skarels break; 3935640Sroot 3945640Sroot default: 39533427Skarels sc->imp_garbage++; 3965640Sroot sc->imp_if.if_collisions++; /* XXX */ 39728849Skarels break; 3985640Sroot } 3995640Sroot 40028849Skarels if (inq == &impintrq) 40124777Skarels schednetisr(NETISR_IMP); 40224777Skarels /* 40324777Skarels * Re-insert interface pointer in the mbuf chain 40424777Skarels * for the next protocol up. 40524777Skarels */ 40628849Skarels if (M_HASCL(m) && (mtod(m, int) & CLOFSET) < sizeof(struct ifnet *)) { 40728849Skarels struct mbuf *n; 40828849Skarels 40928849Skarels MGET(n, M_DONTWAIT, MT_HEADER); 41028849Skarels if (n == 0) 41128849Skarels goto drop; 41228849Skarels n->m_next = m; 41328849Skarels m = n; 41428849Skarels m->m_len = 0; 41528849Skarels m->m_off = MMINOFF + sizeof(struct ifnet *); 41628849Skarels } 41724777Skarels m->m_off -= sizeof(struct ifnet *); 41824777Skarels m->m_len += sizeof(struct ifnet *); 41924777Skarels *(mtod(m, struct ifnet **)) = ifp; 42028849Skarels 42133453Skarels s = splimp(); 42233453Skarels if (!IF_QFULL(inq)) { 42333453Skarels IF_ENQUEUE(inq, m); 42433453Skarels splx(s); 42533453Skarels return; 4266208Swnj } 42733453Skarels splx(s); 42834209Skarels IF_DROP(inq); 4295640Sroot drop: 4305640Sroot m_freem(m); 43133427Skarels #undef ip 4325640Sroot } 4335640Sroot 4345647Ssam /* 4355647Ssam * Bring the IMP down after notification. 4365647Ssam */ 4375647Ssam impdown(sc) 4385647Ssam struct imp_softc *sc; 4395647Ssam { 44011230Ssam int s = splimp(); 4416208Swnj 44233427Skarels if (sc->imp_state == IMPS_GOINGDOWN) { 44333427Skarels sc->imp_state = IMPS_WINIT; 44433427Skarels impmsg(sc, "marked down"); 44534209Skarels sc->imp_msgready = 0; 44633427Skarels hostreset(sc->imp_if.if_unit); 44733427Skarels if_down(&sc->imp_if); 44833427Skarels } 44933427Skarels #ifdef IMPINIT 45033427Skarels else if (imptraceinit) 45133427Skarels log(imppri, "impdown, state now %d (ignored)\n", sc->imp_state); 45233427Skarels #endif 45311230Ssam splx(s); 4545647Ssam } 4555647Ssam 45626397Skarels /*VARARGS2*/ 45734509Skarels impmsg(sc, fmt, a1) 4585640Sroot struct imp_softc *sc; 4595640Sroot char *fmt; 4606160Ssam u_int a1; 4615640Sroot { 4626208Swnj 46333427Skarels log(imppri, "imp%d: %r\n", sc->imp_if.if_unit, fmt, &a1); 4645640Sroot } 4655640Sroot 46624777Skarels struct sockproto impproto = { PF_IMPLINK }; 46724777Skarels struct sockaddr_in impdst = { AF_IMPLINK }; 46824777Skarels struct sockaddr_in impsrc = { AF_IMPLINK }; 46924777Skarels 4705640Sroot /* 47124777Skarels * Pick up the IMP "error" messages enqueued earlier, 47224777Skarels * passing these up to the higher level protocol 47324777Skarels * and the raw interface. 4746582Ssam */ 47524777Skarels impintr() 4766582Ssam { 47724777Skarels register struct mbuf *m; 47824777Skarels register struct control_leader *cp; 47924777Skarels struct ifnet *ifp; 48024777Skarels int s; 4816582Ssam 48224777Skarels for (;;) { 48324777Skarels s = splimp(); 48424777Skarels IF_DEQUEUEIF(&impintrq, m, ifp); 48524777Skarels splx(s); 48624777Skarels if (m == 0) 48724777Skarels return; 48818132Skarels 48924777Skarels cp = mtod(m, struct control_leader *); 49033427Skarels imp_leader_to_addr(&impsrc.sin_addr, cp, ifp); 49124777Skarels impproto.sp_protocol = cp->dl_link; 49225409Skarels impdst.sin_addr = IA_SIN(ifp->if_addrlist)->sin_addr; 49324777Skarels 49428849Skarels if (cp->dl_mtype == IMPTYPE_HOSTDEAD || 49528849Skarels cp->dl_mtype == IMPTYPE_HOSTUNREACH) 49628849Skarels switch (cp->dl_link) { 49724777Skarels 49828849Skarels case IMPLINK_IP: 49928849Skarels pfctlinput((int)cp->dl_mtype, 50028849Skarels (struct sockaddr *)&impsrc); 50128849Skarels break; 50228849Skarels default: 50328849Skarels raw_ctlinput((int)cp->dl_mtype, 50428849Skarels (struct sockaddr *)&impsrc); 50528849Skarels break; 50628849Skarels } 50724777Skarels 50824777Skarels raw_input(m, &impproto, (struct sockaddr *)&impsrc, 50924777Skarels (struct sockaddr *)&impdst); 5106588Ssam } 5116582Ssam } 5126582Ssam 5136582Ssam /* 5145640Sroot * ARPAnet 1822 output routine. 5155640Sroot * Called from higher level protocol routines to set up messages for 5165640Sroot * transmission to the imp. Sets up the header and calls impsnd to 5175640Sroot * enqueue the message for this IMP's hardware driver. 5185640Sroot */ 5196336Ssam impoutput(ifp, m0, dst) 5205640Sroot register struct ifnet *ifp; 5215640Sroot struct mbuf *m0; 5226336Ssam struct sockaddr *dst; 5235640Sroot { 5245640Sroot register struct imp_leader *imp; 5255640Sroot register struct mbuf *m = m0; 52634209Skarels caddr_t pkt = mtod(m, caddr_t); 5276504Ssam int error = 0; 5285640Sroot 5295640Sroot /* 5305640Sroot * Don't even try if the IMP is unavailable. 5315640Sroot */ 53233427Skarels if (!IMPS_RUNNING(imp_softc[ifp->if_unit].imp_state)) { 5336504Ssam error = ENETDOWN; 5345647Ssam goto drop; 5356504Ssam } 5365640Sroot 53733453Skarels /* 53833453Skarels * If AF_IMPLINK, leader exists; just send. 53933453Skarels * Otherwise, construct leader according to address family. 54033453Skarels */ 54133453Skarels if (dst->sa_family != AF_IMPLINK) { 54233453Skarels /* 54333453Skarels * Add IMP leader. If there's not enough space in the 54433453Skarels * first mbuf, allocate another. If that should fail, we 54533453Skarels * drop this sucker. 54633453Skarels */ 54733453Skarels if (m->m_off > MMAXOFF || 54833453Skarels MMINOFF + sizeof(struct imp_leader) > m->m_off) { 54934209Skarels MGET(m, M_DONTWAIT, MT_HEADER); 55033453Skarels if (m == 0) { 55133453Skarels error = ENOBUFS; 55233453Skarels goto drop; 55333453Skarels } 55433453Skarels m->m_next = m0; 55533453Skarels m->m_len = sizeof(struct imp_leader); 55633453Skarels } else { 55733453Skarels m->m_off -= sizeof(struct imp_leader); 55833453Skarels m->m_len += sizeof(struct imp_leader); 55933453Skarels } 56033453Skarels imp = mtod(m, struct imp_leader *); 56133453Skarels imp->il_format = IMP_NFF; 56233453Skarels imp->il_mtype = IMPTYPE_DATA; 56334209Skarels imp->il_flags = 0; 56434209Skarels imp->il_htype = 0; 56534209Skarels imp->il_subtype = 0; 5665640Sroot 56733453Skarels switch (dst->sa_family) { 5685640Sroot 56934209Skarels case AF_INET: 57033453Skarels imp->il_link = IMPLINK_IP; 57133453Skarels imp_addr_to_leader((struct control_leader *)imp, 57233453Skarels ((struct sockaddr_in *)dst)->sin_addr.s_addr); 57334209Skarels imp->il_length = htons(ntohs((u_short) 57434209Skarels ((struct ip *)pkt)->ip_len) << 3); 57533453Skarels break; 5765640Sroot 57733453Skarels default: 57833453Skarels printf("imp%d: can't handle af%d\n", ifp->if_unit, 57933453Skarels dst->sa_family); 58033453Skarels error = EAFNOSUPPORT; 58134209Skarels m0 = m; 5825647Ssam goto drop; 5836504Ssam } 5845640Sroot } 5855640Sroot return (impsnd(ifp, m)); 5865647Ssam drop: 5875647Ssam m_freem(m0); 5886504Ssam return (error); 5895640Sroot } 5905640Sroot 5915640Sroot /* 5925640Sroot * Put a message on an interface's output queue. 5935640Sroot * Perform RFNM counting: no more than 8 message may be 5945640Sroot * in flight to any one host. 5955640Sroot */ 5965640Sroot impsnd(ifp, m) 5975640Sroot struct ifnet *ifp; 5985640Sroot struct mbuf *m; 5995640Sroot { 60033427Skarels register struct control_leader *imp; 6015640Sroot register struct host *hp; 60233453Skarels register struct imp_softc *sc = &imp_softc[ifp->if_unit]; 60333453Skarels int s, error = 0; 6045640Sroot 60533427Skarels imp = mtod(m, struct control_leader *); 6065640Sroot 6075640Sroot /* 6085640Sroot * Do RFNM counting for data messages 60933453Skarels * (no more than 8 outstanding to any host). 61033453Skarels * Queue data messages per host if 8 are already outstanding 61133453Skarels * or if the hardware interface is already doing output. 61233453Skarels * Increment imp_msgready if the message could be sent now, 61333453Skarels * but must be queued because the imp output is busy. 6145640Sroot */ 6156588Ssam s = splimp(); 61633427Skarels if (imp->dl_mtype == IMPTYPE_DATA) { 61734509Skarels hp = hostenter((int)imp->dl_imp, (int)imp->dl_host, 61834509Skarels ifp->if_unit); 6195640Sroot if (hp) { 62034209Skarels if (hp->h_flags & (HF_DEAD|HF_UNREACH)) 62134209Skarels error = hp->h_flags & HF_DEAD ? 62234209Skarels EHOSTDOWN : EHOSTUNREACH; 62334209Skarels else if (hp->h_rfnm < IMP_MAXHOSTMSG && 62434209Skarels sc->imp_cb.ic_oactive == 0) { 62534209Skarels /* 62634209Skarels * Send without queuing; 62734209Skarels * adjust rfnm count and timer. 62834209Skarels */ 62934209Skarels if (hp->h_rfnm++ == 0) 63034209Skarels hp->h_timer = RFNMTIMER; 63134209Skarels goto send; 63233453Skarels } else if (hp->h_rfnm + hp->h_qcnt < imphqlen) { 6336095Swnj HOST_ENQUE(hp, m); 63434209Skarels if (hp->h_rfnm + hp->h_qcnt <= IMP_MAXHOSTMSG) 63534209Skarels sc->imp_msgready++; 63634272Skarels } else { 63733453Skarels error = ENOBUFS; 63834272Skarels IF_DROP(&ifp->if_snd); 63934272Skarels } 64033453Skarels } else 64133453Skarels error = ENOBUFS; 64233453Skarels } else if (sc->imp_cb.ic_oactive == 0) 64333453Skarels goto send; 64433453Skarels else 64533453Skarels IF_ENQUEUE(&ifp->if_snd, m); 64634209Skarels 64733453Skarels splx(s); 64834209Skarels if (error) 64934209Skarels m_freem(m); 65034209Skarels return (error); 65133453Skarels 65233453Skarels send: 65333453Skarels sc->imp_if.if_timer = IMP_OTIMER; 65433453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 65533453Skarels splx(s); 65633453Skarels return (0); 65733453Skarels } 65833453Skarels 65933453Skarels /* 66033453Skarels * Start another output operation on IMP; called from hardware 66133453Skarels * transmit-complete interrupt routine at splimp or from imp routines 66234209Skarels * when output is not in progress. If there are any packets on shared 66334209Skarels * output queue, send them, otherwise send the next data packet for a host. 66434209Skarels * Host data packets are sent round-robin based on destination by walking 66534209Skarels * the host list. 66633453Skarels */ 66733453Skarels impstart(sc) 66833453Skarels register struct imp_softc *sc; 66933453Skarels { 67033453Skarels register struct mbuf *m; 67134209Skarels int first = 1; /* XXX */ 67233453Skarels register struct host *hp; 67333453Skarels int index; 67433453Skarels 67533453Skarels IF_DEQUEUE(&sc->imp_if.if_snd, m); 67633453Skarels if (m) { 67733453Skarels sc->imp_if.if_timer = IMP_OTIMER; 67833453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 67933453Skarels return; 68033453Skarels } 68133453Skarels if (sc->imp_msgready) { 68233453Skarels if ((m = sc->imp_hostq) == 0 && (m = sc->imp_hosts) == 0) 68334209Skarels panic("imp msgready"); 68434209Skarels index = sc->imp_hostent; 68534209Skarels for (hp = &mtod(m, struct hmbuf *)->hm_hosts[index]; ; 68634209Skarels hp++, index++) { 68734209Skarels if (index >= HPMBUF) { 68834209Skarels if ((m = m->m_next) == 0) 68934209Skarels m = sc->imp_hosts; 69034209Skarels index = 0; 69134209Skarels hp = mtod(m, struct hmbuf *)->hm_hosts; 69234209Skarels first = 0; /* XXX */ 6936095Swnj } 69434209Skarels if (hp->h_qcnt && hp->h_rfnm < IMP_MAXHOSTMSG) { 69534209Skarels /* 69634209Skarels * Found host entry with another message 69734209Skarels * to send. Deliver it to the IMP. 69834209Skarels * Start with succeeding host next time. 69934209Skarels */ 70034209Skarels impstarthost(sc, hp); 70134209Skarels sc->imp_hostq = m; 70234209Skarels sc->imp_hostent = index + 1; 70334209Skarels return; 70433453Skarels } 70534209Skarels if (m == sc->imp_hostq && !first && 70634209Skarels index + 1 >= sc->imp_hostent) { /* XXX */ 70734209Skarels log(imppri, "imp: can't find %d msgready\n", 70834209Skarels sc->imp_msgready); 70934209Skarels sc->imp_msgready = 0; 71034209Skarels break; 71134209Skarels } 7125640Sroot } 7135640Sroot } 71433453Skarels sc->imp_if.if_timer = 0; 71533453Skarels } 71633453Skarels 71733453Skarels /* 71834209Skarels * Restart output for a host that has received a RFNM 71934209Skarels * or incomplete or has timed out while waiting for a RFNM. 72033453Skarels * Must be called at splimp. 72133453Skarels */ 72234209Skarels imprestarthost(sc, hp) 72334209Skarels register struct imp_softc *sc; 72433453Skarels struct host *hp; 72533453Skarels { 72633453Skarels 72733453Skarels if (--hp->h_rfnm > 0) 72833453Skarels hp->h_timer = RFNMTIMER; 72934209Skarels /* 73034209Skarels * If the RFNM moved a queued message into the window, 73134209Skarels * update msgready and start IMP if idle. 73234209Skarels */ 73334209Skarels if (hp->h_qcnt > IMP_MAXHOSTMSG - 1 - hp->h_rfnm) { 73434209Skarels sc->imp_msgready++; 73533453Skarels if (sc->imp_cb.ic_oactive == 0) 73633453Skarels impstarthost(sc, hp); 7376208Swnj } 73834209Skarels if (hp->h_rfnm == 0 && hp->h_qcnt == 0) 73934209Skarels hostidle(hp); 7405640Sroot } 7415640Sroot 7425640Sroot /* 74333453Skarels * Send the next message queued for a host 74433453Skarels * when ready to send another message to the IMP. 74533453Skarels * Called only when output is not in progress. 74633453Skarels * Bump RFNM counter and start RFNM timer 74733453Skarels * when we send the message to the IMP. 74833453Skarels * Must be called at splimp. 74933453Skarels */ 75033453Skarels impstarthost(sc, hp) 75133453Skarels register struct imp_softc *sc; 75233453Skarels register struct host *hp; 75333453Skarels { 75433453Skarels struct mbuf *m; 75533453Skarels 75633453Skarels if (hp->h_rfnm++ == 0) 75733453Skarels hp->h_timer = RFNMTIMER; 75833453Skarels HOST_DEQUE(hp, m); 75933453Skarels sc->imp_if.if_timer = IMP_OTIMER; 76033453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 76133453Skarels sc->imp_msgready--; 76233453Skarels } 76333453Skarels 76433453Skarels /* 76533453Skarels * "Watchdog" timeout. When the output timer expires, 76633453Skarels * we assume we have been blocked by the imp. 76733453Skarels * No need to restart, just collect statistics. 76833453Skarels */ 76933453Skarels imptimo(unit) 77033453Skarels int unit; 77133453Skarels { 77233453Skarels 77333453Skarels imp_softc[unit].imp_block++; 77433453Skarels } 77533453Skarels 77633453Skarels /* 7775640Sroot * Put three 1822 NOOPs at the head of the output queue. 7785640Sroot * Part of host-IMP initialization procedure. 7795640Sroot * (Should return success/failure, but noone knows 7805640Sroot * what to do with this, so why bother?) 7816818Ssam * This routine is always called at splimp, so we don't 7826818Ssam * protect the call to IF_PREPEND. 7835640Sroot */ 7845640Sroot impnoops(sc) 7855640Sroot register struct imp_softc *sc; 7865640Sroot { 7875640Sroot register i; 7885640Sroot register struct mbuf *m; 7895771Swnj register struct control_leader *cp; 7905640Sroot 79133427Skarels #ifdef IMPINIT 79233427Skarels if (imptraceinit) 79333427Skarels log(imppri, "impnoops\n"); 79433427Skarels #endif 79533427Skarels for (i = 0; i < IMP_NOOPCNT; i++) { 7969645Ssam if ((m = m_getclr(M_DONTWAIT, MT_HEADER)) == 0) 7975640Sroot return; 7985771Swnj m->m_len = sizeof(struct control_leader); 7995771Swnj cp = mtod(m, struct control_leader *); 8005771Swnj cp->dl_format = IMP_NFF; 80133427Skarels cp->dl_link = i; 80233427Skarels cp->dl_mtype = IMPTYPE_NOOP; 8035640Sroot IF_PREPEND(&sc->imp_if.if_snd, m); 8045640Sroot } 8055640Sroot if (sc->imp_cb.ic_oactive == 0) 80633453Skarels impstart(sc); 8075640Sroot } 8087170Ssam 80913067Ssam /* 81013067Ssam * Process an ioctl request. 81113067Ssam */ 81213067Ssam impioctl(ifp, cmd, data) 81313067Ssam register struct ifnet *ifp; 81413067Ssam int cmd; 81513067Ssam caddr_t data; 81613067Ssam { 81718412Skarels struct ifaddr *ifa = (struct ifaddr *) data; 81813067Ssam int s = splimp(), error = 0; 81933427Skarels #define sc ((struct imp_softc *)ifp) 82013067Ssam 82113067Ssam switch (cmd) { 82213067Ssam 82313067Ssam case SIOCSIFADDR: 82418412Skarels if (ifa->ifa_addr.sa_family != AF_INET) { 82518412Skarels error = EINVAL; 82618412Skarels break; 82718412Skarels } 82833427Skarels if ((ifp->if_flags & IFF_UP) == 0) 82913067Ssam impinit(ifp->if_unit); 83013067Ssam break; 83113067Ssam 83233427Skarels case SIOCSIFFLAGS: 83333427Skarels if ((ifp->if_flags & IFF_UP) == 0 && 83433427Skarels sc->imp_state != IMPS_DOWN) { 83533453Skarels if (sc->imp_cb.ic_down && 83634209Skarels (*sc->imp_cb.ic_down)(sc->imp_cb.ic_hwunit)) { 83733427Skarels sc->imp_state = IMPS_DOWN; 83834209Skarels sc->imp_msgready = 0; 83934209Skarels hostreset(ifp->if_unit); 84034272Skarels if_down(ifp); 84134209Skarels } 84233427Skarels } else if (ifp->if_flags & IFF_UP && sc->imp_state == IMPS_DOWN) 84333427Skarels impinit(ifp->if_unit); 84433427Skarels break; 84533427Skarels 84613067Ssam default: 84713067Ssam error = EINVAL; 84833427Skarels break; 84913067Ssam } 85013067Ssam splx(s); 85113067Ssam return (error); 85213067Ssam } 85313067Ssam 8547170Ssam #ifdef IMPLEADERS 8557170Ssam printleader(routine, ip) 8567170Ssam char *routine; 8577170Ssam register struct imp_leader *ip; 8587170Ssam { 8597170Ssam printf("%s: ", routine); 8607170Ssam printbyte((char *)ip, 12); 8617170Ssam printf("<fmt=%x,net=%x,flags=%x,mtype=", ip->il_format, ip->il_network, 8627170Ssam ip->il_flags); 8637170Ssam if (ip->il_mtype <= IMPTYPE_READY) 8647170Ssam printf("%s,", impleaders[ip->il_mtype]); 8657170Ssam else 8667170Ssam printf("%x,", ip->il_mtype); 8677170Ssam printf("htype=%x,host=%x,imp=%x,link=", ip->il_htype, ip->il_host, 8687170Ssam ntohs(ip->il_imp)); 8697170Ssam if (ip->il_link == IMPLINK_IP) 8707170Ssam printf("ip,"); 8717170Ssam else 8727170Ssam printf("%x,", ip->il_link); 8737170Ssam printf("subtype=%x,len=%x>\n",ip->il_subtype,ntohs(ip->il_length)>>3); 8747170Ssam } 8757170Ssam 8767170Ssam printbyte(cp, n) 8777170Ssam register char *cp; 8787170Ssam int n; 8797170Ssam { 8807170Ssam register i, j, c; 8817170Ssam 8827170Ssam for (i=0; i<n; i++) { 8837170Ssam c = *cp++; 8847170Ssam for (j=0; j<2; j++) 88524777Skarels putchar("0123456789abcdef"[(c>>((1-j)*4))&0xf], 0); 88624777Skarels putchar(' ', 0); 8877170Ssam } 88824777Skarels putchar('\n', 0); 8897170Ssam } 8905640Sroot #endif 89118132Skarels 89218132Skarels /* 89318132Skarels * Routine to convert from IMP Leader to InterNet Address. 89418132Skarels * 89518132Skarels * This procedure is necessary because IMPs may be assigned Class A, B, or C 89618132Skarels * network numbers, but only have 8 bits in the leader to reflect the 89718132Skarels * IMP "network number". The strategy is to take the network number from 89818132Skarels * the ifnet structure, and blend in the host-on-imp and imp-on-net numbers 89918132Skarels * from the leader. 90018132Skarels * 90118132Skarels * There is no support for "Logical Hosts". 90218132Skarels * 90318132Skarels * Class A: Net.Host.0.Imp 90418132Skarels * Class B: Net.net.Host.Imp 90518132Skarels * Class C: Net.net.net.(Host4|Imp4) 90618132Skarels */ 90733427Skarels imp_leader_to_addr(ap, cp, ifp) 90818412Skarels struct in_addr *ap; 90933427Skarels register struct control_leader *cp; 91018412Skarels struct ifnet *ifp; 91118132Skarels { 91226397Skarels register u_long final; 91318132Skarels register struct sockaddr_in *sin; 91433427Skarels int imp = ntohs(cp->dl_imp); 91518132Skarels 91618412Skarels sin = (struct sockaddr_in *)(&ifp->if_addrlist->ifa_addr); 91728849Skarels final = ntohl(sin->sin_addr.s_addr); 91818132Skarels 91918412Skarels if (IN_CLASSA(final)) { 92018132Skarels final &= IN_CLASSA_NET; 92133427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<16); 92218412Skarels } else if (IN_CLASSB(final)) { 92318132Skarels final &= IN_CLASSB_NET; 92433427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<8); 92518132Skarels } else { 92618132Skarels final &= IN_CLASSC_NET; 92733427Skarels final |= (imp & 0x0F) | ((cp->dl_host & 0x0F)<<4); 92818132Skarels } 92918412Skarels ap->s_addr = htonl(final); 93018132Skarels } 93118132Skarels 93218132Skarels /* 93318132Skarels * Function to take InterNet address and fill in IMP leader fields. 93418132Skarels */ 93518412Skarels imp_addr_to_leader(imp, a) 93633427Skarels register struct control_leader *imp; 93726397Skarels u_long a; 93818132Skarels { 93928849Skarels register u_long addr = ntohl(a); 94018132Skarels 94133427Skarels imp->dl_network = 0; /* !! */ 94218132Skarels 94318412Skarels if (IN_CLASSA(addr)) { 94433427Skarels imp->dl_host = ((addr>>16) & 0xFF); 94533427Skarels imp->dl_imp = addr & 0xFF; 94618412Skarels } else if (IN_CLASSB(addr)) { 94733427Skarels imp->dl_host = ((addr>>8) & 0xFF); 94833427Skarels imp->dl_imp = addr & 0xFF; 94918132Skarels } else { 95033427Skarels imp->dl_host = ((addr>>4) & 0xF); 95133427Skarels imp->dl_imp = addr & 0xF; 95218132Skarels } 95333427Skarels imp->dl_imp = htons(imp->dl_imp); 95418132Skarels } 9557170Ssam #endif 956