123166Smckusick /* 234853Sbostic * 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 634853Sbostic * provided that the above copyright notice and this paragraph are 734853Sbostic * duplicated in all such forms and that any documentation, 834853Sbostic * advertising materials, and other materials related to such 934853Sbostic * distribution and use acknowledge that the software was developed 1034853Sbostic * by the University of California, Berkeley. The name of the 1134853Sbostic * University may not be used to endorse or promote products derived 1234853Sbostic * from this software without specific prior written permission. 1334853Sbostic * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR 1434853Sbostic * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED 1534853Sbostic * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE. 1633453Skarels * 17*35799Ssklower * @(#)if_imp.c 7.9 (Berkeley) 10/12/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 */ 165*35799Ssklower if ((m->m_flags && M_PKTHDR) == 0) 166*35799Ssklower panic("No header in impinput"); 167*35799Ssklower ifp = m->m_pkthdr.rcvif; 1686257Sroot /* verify leader length. */ 1695771Swnj if (m->m_len < sizeof(struct control_leader) && 1705771Swnj (m = m_pullup(m, sizeof(struct control_leader))) == 0) 1715771Swnj return; 1725771Swnj cp = mtod(m, struct control_leader *); 17333427Skarels if (cp->dl_mtype == IMPTYPE_DATA && 17433427Skarels m->m_len < sizeof(struct imp_leader)) { 17533427Skarels if ((m = m_pullup(m, sizeof(struct imp_leader))) == 0) 1765771Swnj return; 17733427Skarels cp = mtod(m, struct control_leader *); 17833427Skarels } 1797199Ssam #ifdef IMPLEADERS 1807170Ssam if (impprintfs) 1817170Ssam printleader("impinput", ip); 1827199Ssam #endif 18328849Skarels inq = &impintrq; 1845640Sroot 1856257Sroot /* check leader type */ 18633427Skarels if (cp->dl_format != IMP_NFF) { 18734209Skarels /* 18834209Skarels * We get 1822L NOOPs and RESET 18934209Skarels * at initialization. 19034209Skarels */ 19134209Skarels #ifdef IMPINIT 19234209Skarels if (imptraceinit) 19334209Skarels log(imppri, "input, format %x mtype %d\n", 19434209Skarels cp->dl_format, cp->dl_mtype); 19534209Skarels #endif 19634209Skarels if (cp->dl_format != IMP_1822L_I2H || 19734209Skarels (cp->dl_mtype != IMPTYPE_NOOP && 19834209Skarels cp->dl_mtype != IMPTYPE_RESET)) { 19933453Skarels sc->imp_garbage++; 20033453Skarels sc->imp_if.if_collisions++; /* XXX */ 20133453Skarels } 20233427Skarels } else switch (cp->dl_mtype) { 2035640Sroot 2045640Sroot case IMPTYPE_DATA: 20528849Skarels /* 20628849Skarels * Data for a protocol. Dispatch to the appropriate 20728849Skarels * protocol routine (running at software interrupt). 20828849Skarels * If this isn't a raw interface, advance pointer 20928849Skarels * into mbuf past leader. 21028849Skarels */ 21133427Skarels switch (cp->dl_link) { 21228849Skarels 21328849Skarels case IMPLINK_IP: 21428849Skarels m->m_len -= sizeof(struct imp_leader); 215*35799Ssklower if (m->m_flags & M_PKTHDR) 216*35799Ssklower m->m_pkthdr.len -= sizeof(struct imp_leader); 217*35799Ssklower m->m_data += sizeof(struct imp_leader); 21828849Skarels schednetisr(NETISR_IP); 21928849Skarels inq = &ipintrq; 22028849Skarels break; 22128849Skarels 22228849Skarels default: 22328849Skarels break; 22428849Skarels } 2255640Sroot break; 2265640Sroot 2275640Sroot /* 2285640Sroot * IMP leader error. Reset the IMP and discard the packet. 2295640Sroot */ 2305640Sroot case IMPTYPE_BADLEADER: 2315647Ssam /* 2325647Ssam * According to 1822 document, this message 2335647Ssam * will be generated in response to the 2345647Ssam * first noop sent to the IMP after 2355647Ssam * the host resets the IMP interface. 2365647Ssam */ 23733427Skarels #ifdef IMPINIT 23833427Skarels if (imptraceinit) 23933427Skarels log(imppri, "badleader\n"); 24033427Skarels #endif 2415771Swnj if (sc->imp_state != IMPS_INIT) { 2425924Sroot impmsg(sc, "leader error"); 24333453Skarels sc->imp_msgready = 0; 24433427Skarels hostreset(unit); 2455647Ssam impnoops(sc); 24633453Skarels sc->imp_garbage++; 2475647Ssam } 24828849Skarels break; 2495640Sroot 2505640Sroot /* 2515640Sroot * IMP going down. Print message, and if not immediate, 2525640Sroot * set off a timer to insure things will be reset at the 2535640Sroot * appropriate time. 2545640Sroot */ 2555640Sroot case IMPTYPE_DOWN: 25633427Skarels { int type, when; 25733427Skarels 25833427Skarels type = cp->dl_link & IMP_DMASK; 25933427Skarels when = (cp->dl_link & IMPDOWN_WHENMASK) >> IMPDOWN_WHENSHIFT; 26033427Skarels #ifdef IMPINIT 26133427Skarels if (imptraceinit) 26233427Skarels log(imppri, "input DOWN %s %d\n", 26333427Skarels impmessage[type], when * IMPDOWN_WHENUNIT); 26433427Skarels #endif 26533427Skarels if (type != IMPDOWN_GOING && when) 26633427Skarels impmsg(sc, "going down %s in %d minutes", 26733427Skarels (u_int)impmessage[type], when * IMPDOWN_WHENUNIT); 26833427Skarels else 26933427Skarels impmsg(sc, "going down %s", (u_int)impmessage[type]); 27033427Skarels if (sc->imp_state != IMPS_UP) 27128849Skarels break; 27233427Skarels if (type == IMPDOWN_GOING) { 2735640Sroot sc->imp_state = IMPS_GOINGDOWN; 27433427Skarels timeout(impdown, (caddr_t)sc, IMPTV_DOWN * hz); 27533427Skarels } else if (when == 0) 27633427Skarels sc->imp_state = IMPS_WINIT; 27733427Skarels sc->imp_dropcnt = 0; 27828849Skarels break; 27933427Skarels } 2805640Sroot 2815640Sroot /* 28233427Skarels * A NOP, usually seen during the initialization sequence. 2835640Sroot * Compare the local address with that in the message. 2845640Sroot * Reset the local address notion if it doesn't match. 2855640Sroot */ 2866336Ssam case IMPTYPE_NOOP: 28733427Skarels #ifdef IMPINIT 28833427Skarels if (imptraceinit) 28933427Skarels log(imppri, "noop\n"); 29033427Skarels #endif 29133427Skarels if (sc->imp_state == IMPS_WINIT) { 29233427Skarels sc->imp_dropcnt = 0; 29333427Skarels impnoops(sc); 2945647Ssam sc->imp_state = IMPS_INIT; 2955647Ssam } 29633427Skarels sc->imp_dropcnt++; 29733427Skarels if (sc->imp_state == IMPS_INIT && cp->dl_imp != 0) { 29818132Skarels struct in_addr leader_addr; 29928849Skarels 30033427Skarels sin = (struct sockaddr_in *)&sc->imp_if.if_addrlist->ifa_addr; 30133427Skarels imp_leader_to_addr(&leader_addr, cp, &sc->imp_if); 30218412Skarels if (sin->sin_addr.s_addr != leader_addr.s_addr) { 30318412Skarels impmsg(sc, "address reset to x%x (%d/%d)", 30428849Skarels ntohl(leader_addr.s_addr), 30533427Skarels (u_int)cp->dl_host, 30633427Skarels ntohs(cp->dl_imp)); 30718132Skarels sin->sin_addr.s_addr = leader_addr.s_addr; 30818132Skarels } 3096500Ssam } 31028849Skarels break; 3115640Sroot 3125640Sroot /* 31333453Skarels * RFNM or INCOMPLETE message, decrement rfnm count 31433453Skarels * and prepare to send next message. 31534209Skarels * If the rfnm allows another queued 31634209Skarels * message to be sent, bump msgready 31734209Skarels * and start IMP if idle. 31833453Skarels * We could pass incomplete's up to the next level, 31933453Skarels * but this currently isn't needed. 32034209Skarels * Pass "bad" incompletes and rfnms to the raw socket. 3215640Sroot */ 32233427Skarels case IMPTYPE_INCOMPLETE: 32333427Skarels sc->imp_incomplete++; 32433427Skarels /* FALL THROUGH */ 3255640Sroot case IMPTYPE_RFNM: 32634509Skarels if ((hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, 32734509Skarels unit)) == 0 || hp->h_rfnm == 0) { 32834209Skarels sc->imp_badrfnm++; 32934209Skarels if (hp) 33033427Skarels hostfree(hp); 33134209Skarels break; 33234209Skarels } 33334209Skarels imprestarthost(sc, hp); 33434209Skarels if (cp->dl_mtype == IMPTYPE_RFNM) 33533427Skarels goto drop; 33633427Skarels break; 3375640Sroot 3385640Sroot /* 3395640Sroot * Host or IMP can't be reached. Flush any packets 3405640Sroot * awaiting transmission and release the host structure. 34124777Skarels * Enqueue for notifying protocols at software interrupt time. 3425640Sroot */ 3435640Sroot case IMPTYPE_HOSTDEAD: 34411230Ssam case IMPTYPE_HOSTUNREACH: 34534509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) { 34633427Skarels hp->h_flags |= (1 << (int)cp->dl_mtype); 34733453Skarels sc->imp_msgready -= 34833453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 34933427Skarels hp->h_rfnm = 0; 35033453Skarels hostflush(hp); 35124777Skarels hp->h_timer = HOSTDEADTIMER; 35224777Skarels } 35328849Skarels break; 3545640Sroot 3555640Sroot /* 3565640Sroot * Error in data. Clear RFNM status for this host and send 3575640Sroot * noops to the IMP to clear the interface. 3585640Sroot */ 35911230Ssam case IMPTYPE_BADDATA: 3605924Sroot impmsg(sc, "data error"); 36134509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) { 36233453Skarels sc->imp_msgready -= 36333453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm); 36434209Skarels if (hp->h_rfnm) 36534209Skarels hostrelease(hp); 36634209Skarels else 36734209Skarels hostfree(hp); 36833427Skarels } 3695640Sroot impnoops(sc); 37028849Skarels break; 3715640Sroot 3725640Sroot /* 3735647Ssam * Interface reset. 3745640Sroot */ 3755640Sroot case IMPTYPE_RESET: 37633427Skarels #ifdef IMPINIT 37733427Skarels if (imptraceinit) 37833427Skarels log(imppri, "reset complete\n"); 37933427Skarels #endif 38033427Skarels if (sc->imp_state != IMPS_INIT) { 38133427Skarels impmsg(sc, "interface reset"); 38233427Skarels impnoops(sc); 38333427Skarels } 38418412Skarels /* clear RFNM counts */ 38533453Skarels sc->imp_msgready = 0; 38633427Skarels hostreset(unit); 38733427Skarels if (sc->imp_state != IMPS_DOWN) { 38833427Skarels sc->imp_state = IMPS_UP; 38933427Skarels sc->imp_if.if_flags |= IFF_UP; 39033427Skarels #ifdef IMPINIT 39133427Skarels if (imptraceinit) 39233427Skarels log(imppri, "IMP UP\n"); 39333427Skarels #endif 39433427Skarels } 39528849Skarels break; 3965640Sroot 3975640Sroot default: 39833427Skarels sc->imp_garbage++; 3995640Sroot sc->imp_if.if_collisions++; /* XXX */ 40028849Skarels break; 4015640Sroot } 4025640Sroot 40328849Skarels if (inq == &impintrq) 40424777Skarels schednetisr(NETISR_IMP); 40533453Skarels s = splimp(); 40633453Skarels if (!IF_QFULL(inq)) { 40733453Skarels IF_ENQUEUE(inq, m); 40833453Skarels splx(s); 40933453Skarels return; 4106208Swnj } 41133453Skarels splx(s); 41234209Skarels IF_DROP(inq); 4135640Sroot drop: 4145640Sroot m_freem(m); 41533427Skarels #undef ip 4165640Sroot } 4175640Sroot 4185647Ssam /* 4195647Ssam * Bring the IMP down after notification. 4205647Ssam */ 4215647Ssam impdown(sc) 4225647Ssam struct imp_softc *sc; 4235647Ssam { 42411230Ssam int s = splimp(); 4256208Swnj 42633427Skarels if (sc->imp_state == IMPS_GOINGDOWN) { 42733427Skarels sc->imp_state = IMPS_WINIT; 42833427Skarels impmsg(sc, "marked down"); 42934209Skarels sc->imp_msgready = 0; 43033427Skarels hostreset(sc->imp_if.if_unit); 43133427Skarels if_down(&sc->imp_if); 43233427Skarels } 43333427Skarels #ifdef IMPINIT 43433427Skarels else if (imptraceinit) 43533427Skarels log(imppri, "impdown, state now %d (ignored)\n", sc->imp_state); 43633427Skarels #endif 43711230Ssam splx(s); 4385647Ssam } 4395647Ssam 44026397Skarels /*VARARGS2*/ 44134509Skarels impmsg(sc, fmt, a1) 4425640Sroot struct imp_softc *sc; 4435640Sroot char *fmt; 4446160Ssam u_int a1; 4455640Sroot { 4466208Swnj 44733427Skarels log(imppri, "imp%d: %r\n", sc->imp_if.if_unit, fmt, &a1); 4485640Sroot } 4495640Sroot 45024777Skarels struct sockproto impproto = { PF_IMPLINK }; 45124777Skarels struct sockaddr_in impdst = { AF_IMPLINK }; 45224777Skarels struct sockaddr_in impsrc = { AF_IMPLINK }; 45324777Skarels 4545640Sroot /* 45524777Skarels * Pick up the IMP "error" messages enqueued earlier, 45624777Skarels * passing these up to the higher level protocol 45724777Skarels * and the raw interface. 4586582Ssam */ 45924777Skarels impintr() 4606582Ssam { 46124777Skarels register struct mbuf *m; 46224777Skarels register struct control_leader *cp; 46324777Skarels struct ifnet *ifp; 46424777Skarels int s; 4656582Ssam 46624777Skarels for (;;) { 46724777Skarels s = splimp(); 46824777Skarels IF_DEQUEUEIF(&impintrq, m, ifp); 46924777Skarels splx(s); 47024777Skarels if (m == 0) 47124777Skarels return; 47218132Skarels 47324777Skarels cp = mtod(m, struct control_leader *); 47433427Skarels imp_leader_to_addr(&impsrc.sin_addr, cp, ifp); 47524777Skarels impproto.sp_protocol = cp->dl_link; 47625409Skarels impdst.sin_addr = IA_SIN(ifp->if_addrlist)->sin_addr; 47724777Skarels 47828849Skarels if (cp->dl_mtype == IMPTYPE_HOSTDEAD || 47928849Skarels cp->dl_mtype == IMPTYPE_HOSTUNREACH) 48028849Skarels switch (cp->dl_link) { 48124777Skarels 48228849Skarels case IMPLINK_IP: 48328849Skarels pfctlinput((int)cp->dl_mtype, 48428849Skarels (struct sockaddr *)&impsrc); 48528849Skarels break; 48628849Skarels default: 48728849Skarels raw_ctlinput((int)cp->dl_mtype, 48828849Skarels (struct sockaddr *)&impsrc); 48928849Skarels break; 49028849Skarels } 49124777Skarels 49224777Skarels raw_input(m, &impproto, (struct sockaddr *)&impsrc, 49324777Skarels (struct sockaddr *)&impdst); 4946588Ssam } 4956582Ssam } 4966582Ssam 4976582Ssam /* 4985640Sroot * ARPAnet 1822 output routine. 4995640Sroot * Called from higher level protocol routines to set up messages for 5005640Sroot * transmission to the imp. Sets up the header and calls impsnd to 5015640Sroot * enqueue the message for this IMP's hardware driver. 5025640Sroot */ 5036336Ssam impoutput(ifp, m0, dst) 5045640Sroot register struct ifnet *ifp; 5055640Sroot struct mbuf *m0; 5066336Ssam struct sockaddr *dst; 5075640Sroot { 5085640Sroot register struct imp_leader *imp; 5095640Sroot register struct mbuf *m = m0; 51034209Skarels caddr_t pkt = mtod(m, caddr_t); 5116504Ssam int error = 0; 5125640Sroot 5135640Sroot /* 5145640Sroot * Don't even try if the IMP is unavailable. 5155640Sroot */ 51633427Skarels if (!IMPS_RUNNING(imp_softc[ifp->if_unit].imp_state)) { 5176504Ssam error = ENETDOWN; 5185647Ssam goto drop; 5196504Ssam } 5205640Sroot 52133453Skarels /* 52233453Skarels * If AF_IMPLINK, leader exists; just send. 52333453Skarels * Otherwise, construct leader according to address family. 52433453Skarels */ 52533453Skarels if (dst->sa_family != AF_IMPLINK) { 52633453Skarels /* 52733453Skarels * Add IMP leader. If there's not enough space in the 52833453Skarels * first mbuf, allocate another. If that should fail, we 52933453Skarels * drop this sucker. 53033453Skarels */ 531*35799Ssklower M_PREPEND(m, sizeof(struct imp_leadr), M_DONTWAIT); 53233453Skarels imp = mtod(m, struct imp_leader *); 53333453Skarels imp->il_format = IMP_NFF; 53433453Skarels imp->il_mtype = IMPTYPE_DATA; 53534209Skarels imp->il_flags = 0; 53634209Skarels imp->il_htype = 0; 53734209Skarels imp->il_subtype = 0; 5385640Sroot 53933453Skarels switch (dst->sa_family) { 5405640Sroot 54134209Skarels case AF_INET: 54233453Skarels imp->il_link = IMPLINK_IP; 54333453Skarels imp_addr_to_leader((struct control_leader *)imp, 54433453Skarels ((struct sockaddr_in *)dst)->sin_addr.s_addr); 54534209Skarels imp->il_length = htons(ntohs((u_short) 54634209Skarels ((struct ip *)pkt)->ip_len) << 3); 54733453Skarels break; 5485640Sroot 54933453Skarels default: 55033453Skarels printf("imp%d: can't handle af%d\n", ifp->if_unit, 55133453Skarels dst->sa_family); 55233453Skarels error = EAFNOSUPPORT; 55334209Skarels m0 = m; 5545647Ssam goto drop; 5556504Ssam } 5565640Sroot } 5575640Sroot return (impsnd(ifp, m)); 5585647Ssam drop: 5595647Ssam m_freem(m0); 5606504Ssam return (error); 5615640Sroot } 5625640Sroot 5635640Sroot /* 5645640Sroot * Put a message on an interface's output queue. 5655640Sroot * Perform RFNM counting: no more than 8 message may be 5665640Sroot * in flight to any one host. 5675640Sroot */ 5685640Sroot impsnd(ifp, m) 5695640Sroot struct ifnet *ifp; 5705640Sroot struct mbuf *m; 5715640Sroot { 57233427Skarels register struct control_leader *imp; 5735640Sroot register struct host *hp; 57433453Skarels register struct imp_softc *sc = &imp_softc[ifp->if_unit]; 57533453Skarels int s, error = 0; 5765640Sroot 57733427Skarels imp = mtod(m, struct control_leader *); 5785640Sroot 5795640Sroot /* 5805640Sroot * Do RFNM counting for data messages 58133453Skarels * (no more than 8 outstanding to any host). 58233453Skarels * Queue data messages per host if 8 are already outstanding 58333453Skarels * or if the hardware interface is already doing output. 58433453Skarels * Increment imp_msgready if the message could be sent now, 58533453Skarels * but must be queued because the imp output is busy. 5865640Sroot */ 5876588Ssam s = splimp(); 58833427Skarels if (imp->dl_mtype == IMPTYPE_DATA) { 58934509Skarels hp = hostenter((int)imp->dl_imp, (int)imp->dl_host, 59034509Skarels ifp->if_unit); 5915640Sroot if (hp) { 59234209Skarels if (hp->h_flags & (HF_DEAD|HF_UNREACH)) 59334209Skarels error = hp->h_flags & HF_DEAD ? 59434209Skarels EHOSTDOWN : EHOSTUNREACH; 59534209Skarels else if (hp->h_rfnm < IMP_MAXHOSTMSG && 59634209Skarels sc->imp_cb.ic_oactive == 0) { 59734209Skarels /* 59834209Skarels * Send without queuing; 59934209Skarels * adjust rfnm count and timer. 60034209Skarels */ 60134209Skarels if (hp->h_rfnm++ == 0) 60234209Skarels hp->h_timer = RFNMTIMER; 60334209Skarels goto send; 60433453Skarels } else if (hp->h_rfnm + hp->h_qcnt < imphqlen) { 6056095Swnj HOST_ENQUE(hp, m); 60634209Skarels if (hp->h_rfnm + hp->h_qcnt <= IMP_MAXHOSTMSG) 60734209Skarels sc->imp_msgready++; 60834272Skarels } else { 60933453Skarels error = ENOBUFS; 61034272Skarels IF_DROP(&ifp->if_snd); 61134272Skarels } 61233453Skarels } else 61333453Skarels error = ENOBUFS; 61433453Skarels } else if (sc->imp_cb.ic_oactive == 0) 61533453Skarels goto send; 61633453Skarels else 61733453Skarels IF_ENQUEUE(&ifp->if_snd, m); 61834209Skarels 61933453Skarels splx(s); 62034209Skarels if (error) 62134209Skarels m_freem(m); 62234209Skarels return (error); 62333453Skarels 62433453Skarels send: 62533453Skarels sc->imp_if.if_timer = IMP_OTIMER; 62633453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 62733453Skarels splx(s); 62833453Skarels return (0); 62933453Skarels } 63033453Skarels 63133453Skarels /* 63233453Skarels * Start another output operation on IMP; called from hardware 63333453Skarels * transmit-complete interrupt routine at splimp or from imp routines 63434209Skarels * when output is not in progress. If there are any packets on shared 63534209Skarels * output queue, send them, otherwise send the next data packet for a host. 63634209Skarels * Host data packets are sent round-robin based on destination by walking 63734209Skarels * the host list. 63833453Skarels */ 63933453Skarels impstart(sc) 64033453Skarels register struct imp_softc *sc; 64133453Skarels { 64233453Skarels register struct mbuf *m; 64334209Skarels int first = 1; /* XXX */ 64433453Skarels register struct host *hp; 64533453Skarels int index; 64633453Skarels 64733453Skarels IF_DEQUEUE(&sc->imp_if.if_snd, m); 64833453Skarels if (m) { 64933453Skarels sc->imp_if.if_timer = IMP_OTIMER; 65033453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 65133453Skarels return; 65233453Skarels } 65333453Skarels if (sc->imp_msgready) { 65433453Skarels if ((m = sc->imp_hostq) == 0 && (m = sc->imp_hosts) == 0) 65534209Skarels panic("imp msgready"); 65634209Skarels index = sc->imp_hostent; 65734209Skarels for (hp = &mtod(m, struct hmbuf *)->hm_hosts[index]; ; 65834209Skarels hp++, index++) { 65934209Skarels if (index >= HPMBUF) { 66034209Skarels if ((m = m->m_next) == 0) 66134209Skarels m = sc->imp_hosts; 66234209Skarels index = 0; 66334209Skarels hp = mtod(m, struct hmbuf *)->hm_hosts; 66434209Skarels first = 0; /* XXX */ 6656095Swnj } 66634209Skarels if (hp->h_qcnt && hp->h_rfnm < IMP_MAXHOSTMSG) { 66734209Skarels /* 66834209Skarels * Found host entry with another message 66934209Skarels * to send. Deliver it to the IMP. 67034209Skarels * Start with succeeding host next time. 67134209Skarels */ 67234209Skarels impstarthost(sc, hp); 67334209Skarels sc->imp_hostq = m; 67434209Skarels sc->imp_hostent = index + 1; 67534209Skarels return; 67633453Skarels } 67734209Skarels if (m == sc->imp_hostq && !first && 67834209Skarels index + 1 >= sc->imp_hostent) { /* XXX */ 67934209Skarels log(imppri, "imp: can't find %d msgready\n", 68034209Skarels sc->imp_msgready); 68134209Skarels sc->imp_msgready = 0; 68234209Skarels break; 68334209Skarels } 6845640Sroot } 6855640Sroot } 68633453Skarels sc->imp_if.if_timer = 0; 68733453Skarels } 68833453Skarels 68933453Skarels /* 69034209Skarels * Restart output for a host that has received a RFNM 69134209Skarels * or incomplete or has timed out while waiting for a RFNM. 69233453Skarels * Must be called at splimp. 69333453Skarels */ 69434209Skarels imprestarthost(sc, hp) 69534209Skarels register struct imp_softc *sc; 69633453Skarels struct host *hp; 69733453Skarels { 69833453Skarels 69933453Skarels if (--hp->h_rfnm > 0) 70033453Skarels hp->h_timer = RFNMTIMER; 70134209Skarels /* 70234209Skarels * If the RFNM moved a queued message into the window, 70334209Skarels * update msgready and start IMP if idle. 70434209Skarels */ 70534209Skarels if (hp->h_qcnt > IMP_MAXHOSTMSG - 1 - hp->h_rfnm) { 70634209Skarels sc->imp_msgready++; 70733453Skarels if (sc->imp_cb.ic_oactive == 0) 70833453Skarels impstarthost(sc, hp); 7096208Swnj } 71034209Skarels if (hp->h_rfnm == 0 && hp->h_qcnt == 0) 71134209Skarels hostidle(hp); 7125640Sroot } 7135640Sroot 7145640Sroot /* 71533453Skarels * Send the next message queued for a host 71633453Skarels * when ready to send another message to the IMP. 71733453Skarels * Called only when output is not in progress. 71833453Skarels * Bump RFNM counter and start RFNM timer 71933453Skarels * when we send the message to the IMP. 72033453Skarels * Must be called at splimp. 72133453Skarels */ 72233453Skarels impstarthost(sc, hp) 72333453Skarels register struct imp_softc *sc; 72433453Skarels register struct host *hp; 72533453Skarels { 72633453Skarels struct mbuf *m; 72733453Skarels 72833453Skarels if (hp->h_rfnm++ == 0) 72933453Skarels hp->h_timer = RFNMTIMER; 73033453Skarels HOST_DEQUE(hp, m); 73133453Skarels sc->imp_if.if_timer = IMP_OTIMER; 73233453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m); 73333453Skarels sc->imp_msgready--; 73433453Skarels } 73533453Skarels 73633453Skarels /* 73733453Skarels * "Watchdog" timeout. When the output timer expires, 73833453Skarels * we assume we have been blocked by the imp. 73933453Skarels * No need to restart, just collect statistics. 74033453Skarels */ 74133453Skarels imptimo(unit) 74233453Skarels int unit; 74333453Skarels { 74433453Skarels 74533453Skarels imp_softc[unit].imp_block++; 74633453Skarels } 74733453Skarels 74833453Skarels /* 7495640Sroot * Put three 1822 NOOPs at the head of the output queue. 7505640Sroot * Part of host-IMP initialization procedure. 7515640Sroot * (Should return success/failure, but noone knows 7525640Sroot * what to do with this, so why bother?) 7536818Ssam * This routine is always called at splimp, so we don't 7546818Ssam * protect the call to IF_PREPEND. 7555640Sroot */ 7565640Sroot impnoops(sc) 7575640Sroot register struct imp_softc *sc; 7585640Sroot { 7595640Sroot register i; 7605640Sroot register struct mbuf *m; 7615771Swnj register struct control_leader *cp; 7625640Sroot 76333427Skarels #ifdef IMPINIT 76433427Skarels if (imptraceinit) 76533427Skarels log(imppri, "impnoops\n"); 76633427Skarels #endif 76733427Skarels for (i = 0; i < IMP_NOOPCNT; i++) { 7689645Ssam if ((m = m_getclr(M_DONTWAIT, MT_HEADER)) == 0) 7695640Sroot return; 7705771Swnj m->m_len = sizeof(struct control_leader); 7715771Swnj cp = mtod(m, struct control_leader *); 7725771Swnj cp->dl_format = IMP_NFF; 77333427Skarels cp->dl_link = i; 77433427Skarels cp->dl_mtype = IMPTYPE_NOOP; 7755640Sroot IF_PREPEND(&sc->imp_if.if_snd, m); 7765640Sroot } 7775640Sroot if (sc->imp_cb.ic_oactive == 0) 77833453Skarels impstart(sc); 7795640Sroot } 7807170Ssam 78113067Ssam /* 78213067Ssam * Process an ioctl request. 78313067Ssam */ 78413067Ssam impioctl(ifp, cmd, data) 78513067Ssam register struct ifnet *ifp; 78613067Ssam int cmd; 78713067Ssam caddr_t data; 78813067Ssam { 78918412Skarels struct ifaddr *ifa = (struct ifaddr *) data; 79013067Ssam int s = splimp(), error = 0; 79133427Skarels #define sc ((struct imp_softc *)ifp) 79213067Ssam 79313067Ssam switch (cmd) { 79413067Ssam 79513067Ssam case SIOCSIFADDR: 79618412Skarels if (ifa->ifa_addr.sa_family != AF_INET) { 79718412Skarels error = EINVAL; 79818412Skarels break; 79918412Skarels } 80033427Skarels if ((ifp->if_flags & IFF_UP) == 0) 80113067Ssam impinit(ifp->if_unit); 80213067Ssam break; 80313067Ssam 80433427Skarels case SIOCSIFFLAGS: 80533427Skarels if ((ifp->if_flags & IFF_UP) == 0 && 80633427Skarels sc->imp_state != IMPS_DOWN) { 80733453Skarels if (sc->imp_cb.ic_down && 80834209Skarels (*sc->imp_cb.ic_down)(sc->imp_cb.ic_hwunit)) { 80933427Skarels sc->imp_state = IMPS_DOWN; 81034209Skarels sc->imp_msgready = 0; 81134209Skarels hostreset(ifp->if_unit); 81234272Skarels if_down(ifp); 81334209Skarels } 81433427Skarels } else if (ifp->if_flags & IFF_UP && sc->imp_state == IMPS_DOWN) 81533427Skarels impinit(ifp->if_unit); 81633427Skarels break; 81733427Skarels 81813067Ssam default: 81913067Ssam error = EINVAL; 82033427Skarels break; 82113067Ssam } 82213067Ssam splx(s); 82313067Ssam return (error); 82413067Ssam } 82513067Ssam 8267170Ssam #ifdef IMPLEADERS 8277170Ssam printleader(routine, ip) 8287170Ssam char *routine; 8297170Ssam register struct imp_leader *ip; 8307170Ssam { 8317170Ssam printf("%s: ", routine); 8327170Ssam printbyte((char *)ip, 12); 8337170Ssam printf("<fmt=%x,net=%x,flags=%x,mtype=", ip->il_format, ip->il_network, 8347170Ssam ip->il_flags); 8357170Ssam if (ip->il_mtype <= IMPTYPE_READY) 8367170Ssam printf("%s,", impleaders[ip->il_mtype]); 8377170Ssam else 8387170Ssam printf("%x,", ip->il_mtype); 8397170Ssam printf("htype=%x,host=%x,imp=%x,link=", ip->il_htype, ip->il_host, 8407170Ssam ntohs(ip->il_imp)); 8417170Ssam if (ip->il_link == IMPLINK_IP) 8427170Ssam printf("ip,"); 8437170Ssam else 8447170Ssam printf("%x,", ip->il_link); 8457170Ssam printf("subtype=%x,len=%x>\n",ip->il_subtype,ntohs(ip->il_length)>>3); 8467170Ssam } 8477170Ssam 8487170Ssam printbyte(cp, n) 8497170Ssam register char *cp; 8507170Ssam int n; 8517170Ssam { 8527170Ssam register i, j, c; 8537170Ssam 8547170Ssam for (i=0; i<n; i++) { 8557170Ssam c = *cp++; 8567170Ssam for (j=0; j<2; j++) 85724777Skarels putchar("0123456789abcdef"[(c>>((1-j)*4))&0xf], 0); 85824777Skarels putchar(' ', 0); 8597170Ssam } 86024777Skarels putchar('\n', 0); 8617170Ssam } 8625640Sroot #endif 86318132Skarels 86418132Skarels /* 86518132Skarels * Routine to convert from IMP Leader to InterNet Address. 86618132Skarels * 86718132Skarels * This procedure is necessary because IMPs may be assigned Class A, B, or C 86818132Skarels * network numbers, but only have 8 bits in the leader to reflect the 86918132Skarels * IMP "network number". The strategy is to take the network number from 87018132Skarels * the ifnet structure, and blend in the host-on-imp and imp-on-net numbers 87118132Skarels * from the leader. 87218132Skarels * 87318132Skarels * There is no support for "Logical Hosts". 87418132Skarels * 87518132Skarels * Class A: Net.Host.0.Imp 87618132Skarels * Class B: Net.net.Host.Imp 87718132Skarels * Class C: Net.net.net.(Host4|Imp4) 87818132Skarels */ 87933427Skarels imp_leader_to_addr(ap, cp, ifp) 88018412Skarels struct in_addr *ap; 88133427Skarels register struct control_leader *cp; 88218412Skarels struct ifnet *ifp; 88318132Skarels { 88426397Skarels register u_long final; 88518132Skarels register struct sockaddr_in *sin; 88633427Skarels int imp = ntohs(cp->dl_imp); 88718132Skarels 88818412Skarels sin = (struct sockaddr_in *)(&ifp->if_addrlist->ifa_addr); 88928849Skarels final = ntohl(sin->sin_addr.s_addr); 89018132Skarels 89118412Skarels if (IN_CLASSA(final)) { 89218132Skarels final &= IN_CLASSA_NET; 89333427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<16); 89418412Skarels } else if (IN_CLASSB(final)) { 89518132Skarels final &= IN_CLASSB_NET; 89633427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<8); 89718132Skarels } else { 89818132Skarels final &= IN_CLASSC_NET; 89933427Skarels final |= (imp & 0x0F) | ((cp->dl_host & 0x0F)<<4); 90018132Skarels } 90118412Skarels ap->s_addr = htonl(final); 90218132Skarels } 90318132Skarels 90418132Skarels /* 90518132Skarels * Function to take InterNet address and fill in IMP leader fields. 90618132Skarels */ 90718412Skarels imp_addr_to_leader(imp, a) 90833427Skarels register struct control_leader *imp; 90926397Skarels u_long a; 91018132Skarels { 91128849Skarels register u_long addr = ntohl(a); 91218132Skarels 91333427Skarels imp->dl_network = 0; /* !! */ 91418132Skarels 91518412Skarels if (IN_CLASSA(addr)) { 91633427Skarels imp->dl_host = ((addr>>16) & 0xFF); 91733427Skarels imp->dl_imp = addr & 0xFF; 91818412Skarels } else if (IN_CLASSB(addr)) { 91933427Skarels imp->dl_host = ((addr>>8) & 0xFF); 92033427Skarels imp->dl_imp = addr & 0xFF; 92118132Skarels } else { 92233427Skarels imp->dl_host = ((addr>>4) & 0xF); 92333427Skarels imp->dl_imp = addr & 0xF; 92418132Skarels } 92533427Skarels imp->dl_imp = htons(imp->dl_imp); 92618132Skarels } 9277170Ssam #endif 928