123166Smckusick /*
234853Sbostic * Copyright (c) 1982, 1986, 1988 Regents of the University of California.
333453Skarels * All rights reserved.
423166Smckusick *
544467Sbostic * %sccs.include.redist.c%
633453Skarels *
7*56528Sbostic * @(#)if_imp.c 7.14 (Berkeley) 10/11/92
823166Smckusick */
95640Sroot
105640Sroot #include "imp.h"
115640Sroot #if NIMP > 0
125640Sroot /*
1333453Skarels * ARPANET IMP (PSN) interface driver.
145640Sroot *
1533453Skarels * The IMP-host protocol (AHIP) is handled here, leaving
165640Sroot * hardware specifics to the lower level interface driver.
175640Sroot */
18*56528Sbostic #include <sys/param.h>
19*56528Sbostic #include <sys/systm.h>
20*56528Sbostic #include <sys/mbuf.h>
21*56528Sbostic #include <sys/buf.h>
22*56528Sbostic #include <sys/protosw.h>
23*56528Sbostic #include <sys/socket.h>
24*56528Sbostic #include <sys/time.h>
25*56528Sbostic #include <sys/kernel.h>
26*56528Sbostic #include <sys/errno.h>
27*56528Sbostic #include <sys/ioctl.h>
28*56528Sbostic #include <sys/syslog.h>
298705Sroot
30*56528Sbostic #include <machine/mtpr.h>
3133453Skarels
32*56528Sbostic #include <net/if.h>
33*56528Sbostic #include <net/netisr.h>
34*56528Sbostic #include <netinet/in.h>
35*56528Sbostic #include <netinet/in_systm.h>
36*56528Sbostic #include <netinet/in_var.h>
37*56528Sbostic #include <netinet/ip.h>
38*56528Sbostic #include <netinet/ip_var.h>
39*56528Sbostic
4033427Skarels #define IMPMESSAGES
417199Ssam /* define IMPLEADERS here to get leader printing code */
42*56528Sbostic #include <netimp/if_imp.h>
43*56528Sbostic #include <netimp/if_imphost.h>
445640Sroot
4533427Skarels struct imp_softc imp_softc[NIMP];
4633453Skarels #ifndef lint
4733453Skarels int nimp = NIMP; /* for netstat */
4833453Skarels #endif
4928849Skarels struct ifqueue impintrq;
5028849Skarels int impqmaxlen = IFQ_MAXLEN;
5133453Skarels int imphqlen = 12 + IMP_MAXHOSTMSG; /* max packets to queue per host */
5224777Skarels
5333427Skarels int imppri = LOG_ERR;
5433427Skarels #ifdef IMPLEADERS
5533427Skarels int impprintfs = 0;
5633427Skarels #endif
5733427Skarels #ifdef IMPINIT
5833427Skarels int imptraceinit = 0;
5933427Skarels #endif
605640Sroot
6133453Skarels
6233427Skarels #define HOSTDEADTIMER (30 * PR_SLOWHZ) /* How long to wait when down */
6318132Skarels
6433453Skarels int impdown(), impinit(), impioctl(), impoutput(), imptimo();
655771Swnj
665640Sroot /*
675640Sroot * IMP attach routine. Called from hardware device attach routine
6833427Skarels * at configuration time with a pointer to the device structure.
695640Sroot * Sets up local state and returns pointer to base of ifnet+impcb
705640Sroot * structures. This is then used by the device's attach routine
715640Sroot * set up its back pointers.
725640Sroot */
7333427Skarels struct imp_softc *
impattach(hwname,hwunit,reset)7434209Skarels impattach(hwname, hwunit, reset)
7534209Skarels char *hwname;
7634209Skarels int hwunit;
778815Sroot int (*reset)();
785640Sroot {
7924777Skarels struct imp_softc *sc;
8024777Skarels register struct ifnet *ifp;
8133427Skarels static int impunit;
825640Sroot
8326397Skarels #ifdef lint
8426397Skarels impintr();
8526397Skarels #endif
8633427Skarels if (impunit >= NIMP) {
8733427Skarels printf("imp%d: not configured\n", impunit++);
8824777Skarels return (0);
8924777Skarels }
9033427Skarels sc = &imp_softc[impunit];
9124777Skarels ifp = &sc->imp_if;
9234209Skarels sc->imp_cb.ic_hwname = hwname;
9334209Skarels sc->imp_cb.ic_hwunit = hwunit;
9433427Skarels ifp->if_unit = impunit;
955640Sroot ifp->if_name = "imp";
966271Sroot ifp->if_mtu = IMPMTU - sizeof(struct imp_leader);
979001Sroot ifp->if_reset = reset;
985771Swnj ifp->if_init = impinit;
9913067Ssam ifp->if_ioctl = impioctl;
1005771Swnj ifp->if_output = impoutput;
10133453Skarels ifp->if_watchdog = imptimo;
1025640Sroot if_attach(ifp);
10333427Skarels impunit++;
10433427Skarels return (sc);
1055640Sroot }
1065640Sroot
1075640Sroot /*
1085640Sroot * IMP initialization routine: call hardware module to
10933427Skarels * setup resources, init state and get ready for
1105640Sroot * NOOPs the IMP should send us, and that we want to drop.
1115640Sroot */
impinit(unit)1125640Sroot impinit(unit)
1135640Sroot int unit;
1145640Sroot {
11532570Sbostic int s;
1165640Sroot register struct imp_softc *sc = &imp_softc[unit];
1175640Sroot
11818412Skarels if (sc->imp_if.if_addrlist == 0)
11913067Ssam return;
12032570Sbostic s = splimp();
12133427Skarels #ifdef IMPINIT
12233427Skarels if (imptraceinit)
12333427Skarels log(imppri, "impinit\n");
12433427Skarels #endif
12533427Skarels sc->imp_state = IMPS_WINIT;
12633427Skarels if ((*sc->imp_cb.ic_init)(sc->imp_cb.ic_hwunit) == 0)
1276336Ssam sc->imp_if.if_flags &= ~IFF_UP;
12833427Skarels impintrq.ifq_maxlen = impqmaxlen;
1296500Ssam splx(s);
1305640Sroot }
1315640Sroot
1325640Sroot /*
13333453Skarels * ARPAnet 1822/AHIP input routine.
1345640Sroot * Called from hardware input interrupt routine to handle 1822
13533453Skarels * IMP-host messages. Data messages are passed to higher-level
13633453Skarels * protocol processors on the basis of link number.
13733453Skarels * Other type messages (control) are handled here.
1385640Sroot */
impinput(unit,m)1395771Swnj impinput(unit, m)
1405640Sroot int unit;
1415771Swnj register struct mbuf *m;
1425640Sroot {
14333427Skarels register struct control_leader *cp;
14433427Skarels #define ip ((struct imp_leader *)cp)
1455640Sroot register struct imp_softc *sc = &imp_softc[unit];
14624777Skarels struct ifnet *ifp;
1475640Sroot register struct host *hp;
1485640Sroot register struct ifqueue *inq;
1496336Ssam struct sockaddr_in *sin;
15033453Skarels int s;
1515640Sroot
15224777Skarels /*
15324777Skarels * Pull the interface pointer out of the mbuf
15424777Skarels * and save for later; adjust mbuf to look at rest of data.
15524777Skarels */
15635799Ssklower if ((m->m_flags && M_PKTHDR) == 0)
15735799Ssklower panic("No header in impinput");
15835799Ssklower ifp = m->m_pkthdr.rcvif;
1596257Sroot /* verify leader length. */
1605771Swnj if (m->m_len < sizeof(struct control_leader) &&
1615771Swnj (m = m_pullup(m, sizeof(struct control_leader))) == 0)
1625771Swnj return;
1635771Swnj cp = mtod(m, struct control_leader *);
16433427Skarels if (cp->dl_mtype == IMPTYPE_DATA &&
16533427Skarels m->m_len < sizeof(struct imp_leader)) {
16633427Skarels if ((m = m_pullup(m, sizeof(struct imp_leader))) == 0)
1675771Swnj return;
16833427Skarels cp = mtod(m, struct control_leader *);
16933427Skarels }
1707199Ssam #ifdef IMPLEADERS
1717170Ssam if (impprintfs)
1727170Ssam printleader("impinput", ip);
1737199Ssam #endif
17428849Skarels inq = &impintrq;
1755640Sroot
1766257Sroot /* check leader type */
17733427Skarels if (cp->dl_format != IMP_NFF) {
17834209Skarels /*
17934209Skarels * We get 1822L NOOPs and RESET
18034209Skarels * at initialization.
18134209Skarels */
18234209Skarels #ifdef IMPINIT
18334209Skarels if (imptraceinit)
18434209Skarels log(imppri, "input, format %x mtype %d\n",
18534209Skarels cp->dl_format, cp->dl_mtype);
18634209Skarels #endif
18734209Skarels if (cp->dl_format != IMP_1822L_I2H ||
18834209Skarels (cp->dl_mtype != IMPTYPE_NOOP &&
18934209Skarels cp->dl_mtype != IMPTYPE_RESET)) {
19033453Skarels sc->imp_garbage++;
19133453Skarels sc->imp_if.if_collisions++; /* XXX */
19233453Skarels }
19333427Skarels } else switch (cp->dl_mtype) {
1945640Sroot
1955640Sroot case IMPTYPE_DATA:
19628849Skarels /*
19728849Skarels * Data for a protocol. Dispatch to the appropriate
19828849Skarels * protocol routine (running at software interrupt).
19928849Skarels * If this isn't a raw interface, advance pointer
20028849Skarels * into mbuf past leader.
20128849Skarels */
20233427Skarels switch (cp->dl_link) {
20328849Skarels
20428849Skarels case IMPLINK_IP:
20528849Skarels m->m_len -= sizeof(struct imp_leader);
20635799Ssklower if (m->m_flags & M_PKTHDR)
20735799Ssklower m->m_pkthdr.len -= sizeof(struct imp_leader);
20835799Ssklower m->m_data += sizeof(struct imp_leader);
20928849Skarels schednetisr(NETISR_IP);
21028849Skarels inq = &ipintrq;
21128849Skarels break;
21228849Skarels
21328849Skarels default:
21428849Skarels break;
21528849Skarels }
2165640Sroot break;
2175640Sroot
2185640Sroot /*
2195640Sroot * IMP leader error. Reset the IMP and discard the packet.
2205640Sroot */
2215640Sroot case IMPTYPE_BADLEADER:
2225647Ssam /*
2235647Ssam * According to 1822 document, this message
2245647Ssam * will be generated in response to the
2255647Ssam * first noop sent to the IMP after
2265647Ssam * the host resets the IMP interface.
2275647Ssam */
22833427Skarels #ifdef IMPINIT
22933427Skarels if (imptraceinit)
23033427Skarels log(imppri, "badleader\n");
23133427Skarels #endif
2325771Swnj if (sc->imp_state != IMPS_INIT) {
2335924Sroot impmsg(sc, "leader error");
23433453Skarels sc->imp_msgready = 0;
23533427Skarels hostreset(unit);
2365647Ssam impnoops(sc);
23733453Skarels sc->imp_garbage++;
2385647Ssam }
23928849Skarels break;
2405640Sroot
2415640Sroot /*
2425640Sroot * IMP going down. Print message, and if not immediate,
2435640Sroot * set off a timer to insure things will be reset at the
2445640Sroot * appropriate time.
2455640Sroot */
2465640Sroot case IMPTYPE_DOWN:
24733427Skarels { int type, when;
24833427Skarels
24933427Skarels type = cp->dl_link & IMP_DMASK;
25033427Skarels when = (cp->dl_link & IMPDOWN_WHENMASK) >> IMPDOWN_WHENSHIFT;
25133427Skarels #ifdef IMPINIT
25233427Skarels if (imptraceinit)
25333427Skarels log(imppri, "input DOWN %s %d\n",
25433427Skarels impmessage[type], when * IMPDOWN_WHENUNIT);
25533427Skarels #endif
25633427Skarels if (type != IMPDOWN_GOING && when)
25733427Skarels impmsg(sc, "going down %s in %d minutes",
25833427Skarels (u_int)impmessage[type], when * IMPDOWN_WHENUNIT);
25933427Skarels else
26033427Skarels impmsg(sc, "going down %s", (u_int)impmessage[type]);
26133427Skarels if (sc->imp_state != IMPS_UP)
26228849Skarels break;
26333427Skarels if (type == IMPDOWN_GOING) {
2645640Sroot sc->imp_state = IMPS_GOINGDOWN;
26533427Skarels timeout(impdown, (caddr_t)sc, IMPTV_DOWN * hz);
26633427Skarels } else if (when == 0)
26733427Skarels sc->imp_state = IMPS_WINIT;
26833427Skarels sc->imp_dropcnt = 0;
26928849Skarels break;
27033427Skarels }
2715640Sroot
2725640Sroot /*
27333427Skarels * A NOP, usually seen during the initialization sequence.
2745640Sroot * Compare the local address with that in the message.
2755640Sroot * Reset the local address notion if it doesn't match.
2765640Sroot */
2776336Ssam case IMPTYPE_NOOP:
27833427Skarels #ifdef IMPINIT
27933427Skarels if (imptraceinit)
28033427Skarels log(imppri, "noop\n");
28133427Skarels #endif
28233427Skarels if (sc->imp_state == IMPS_WINIT) {
28333427Skarels sc->imp_dropcnt = 0;
28433427Skarels impnoops(sc);
2855647Ssam sc->imp_state = IMPS_INIT;
2865647Ssam }
28733427Skarels sc->imp_dropcnt++;
28833427Skarels if (sc->imp_state == IMPS_INIT && cp->dl_imp != 0) {
28918132Skarels struct in_addr leader_addr;
29028849Skarels
29133427Skarels sin = (struct sockaddr_in *)&sc->imp_if.if_addrlist->ifa_addr;
29233427Skarels imp_leader_to_addr(&leader_addr, cp, &sc->imp_if);
29318412Skarels if (sin->sin_addr.s_addr != leader_addr.s_addr) {
29418412Skarels impmsg(sc, "address reset to x%x (%d/%d)",
29528849Skarels ntohl(leader_addr.s_addr),
29633427Skarels (u_int)cp->dl_host,
29733427Skarels ntohs(cp->dl_imp));
29818132Skarels sin->sin_addr.s_addr = leader_addr.s_addr;
29918132Skarels }
3006500Ssam }
30128849Skarels break;
3025640Sroot
3035640Sroot /*
30433453Skarels * RFNM or INCOMPLETE message, decrement rfnm count
30533453Skarels * and prepare to send next message.
30634209Skarels * If the rfnm allows another queued
30734209Skarels * message to be sent, bump msgready
30834209Skarels * and start IMP if idle.
30933453Skarels * We could pass incomplete's up to the next level,
31033453Skarels * but this currently isn't needed.
31134209Skarels * Pass "bad" incompletes and rfnms to the raw socket.
3125640Sroot */
31333427Skarels case IMPTYPE_INCOMPLETE:
31433427Skarels sc->imp_incomplete++;
31533427Skarels /* FALL THROUGH */
3165640Sroot case IMPTYPE_RFNM:
31734509Skarels if ((hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host,
31834509Skarels unit)) == 0 || hp->h_rfnm == 0) {
31934209Skarels sc->imp_badrfnm++;
32034209Skarels if (hp)
32133427Skarels hostfree(hp);
32234209Skarels break;
32334209Skarels }
32434209Skarels imprestarthost(sc, hp);
32534209Skarels if (cp->dl_mtype == IMPTYPE_RFNM)
32633427Skarels goto drop;
32733427Skarels break;
3285640Sroot
3295640Sroot /*
3305640Sroot * Host or IMP can't be reached. Flush any packets
3315640Sroot * awaiting transmission and release the host structure.
33224777Skarels * Enqueue for notifying protocols at software interrupt time.
3335640Sroot */
3345640Sroot case IMPTYPE_HOSTDEAD:
33511230Ssam case IMPTYPE_HOSTUNREACH:
33634509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) {
33733427Skarels hp->h_flags |= (1 << (int)cp->dl_mtype);
33833453Skarels sc->imp_msgready -=
33933453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm);
34033427Skarels hp->h_rfnm = 0;
34133453Skarels hostflush(hp);
34224777Skarels hp->h_timer = HOSTDEADTIMER;
34324777Skarels }
34428849Skarels break;
3455640Sroot
3465640Sroot /*
3475640Sroot * Error in data. Clear RFNM status for this host and send
3485640Sroot * noops to the IMP to clear the interface.
3495640Sroot */
35011230Ssam case IMPTYPE_BADDATA:
3515924Sroot impmsg(sc, "data error");
35234509Skarels if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) {
35333453Skarels sc->imp_msgready -=
35433453Skarels MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm);
35534209Skarels if (hp->h_rfnm)
35634209Skarels hostrelease(hp);
35734209Skarels else
35834209Skarels hostfree(hp);
35933427Skarels }
3605640Sroot impnoops(sc);
36128849Skarels break;
3625640Sroot
3635640Sroot /*
3645647Ssam * Interface reset.
3655640Sroot */
3665640Sroot case IMPTYPE_RESET:
36733427Skarels #ifdef IMPINIT
36833427Skarels if (imptraceinit)
36933427Skarels log(imppri, "reset complete\n");
37033427Skarels #endif
37133427Skarels if (sc->imp_state != IMPS_INIT) {
37233427Skarels impmsg(sc, "interface reset");
37333427Skarels impnoops(sc);
37433427Skarels }
37518412Skarels /* clear RFNM counts */
37633453Skarels sc->imp_msgready = 0;
37733427Skarels hostreset(unit);
37833427Skarels if (sc->imp_state != IMPS_DOWN) {
37933427Skarels sc->imp_state = IMPS_UP;
38033427Skarels sc->imp_if.if_flags |= IFF_UP;
38133427Skarels #ifdef IMPINIT
38233427Skarels if (imptraceinit)
38333427Skarels log(imppri, "IMP UP\n");
38433427Skarels #endif
38533427Skarels }
38628849Skarels break;
3875640Sroot
3885640Sroot default:
38933427Skarels sc->imp_garbage++;
3905640Sroot sc->imp_if.if_collisions++; /* XXX */
39128849Skarels break;
3925640Sroot }
3935640Sroot
39428849Skarels if (inq == &impintrq)
39524777Skarels schednetisr(NETISR_IMP);
39633453Skarels s = splimp();
39733453Skarels if (!IF_QFULL(inq)) {
39833453Skarels IF_ENQUEUE(inq, m);
39933453Skarels splx(s);
40033453Skarels return;
4016208Swnj }
40233453Skarels splx(s);
40334209Skarels IF_DROP(inq);
4045640Sroot drop:
4055640Sroot m_freem(m);
40633427Skarels #undef ip
4075640Sroot }
4085640Sroot
4095647Ssam /*
4105647Ssam * Bring the IMP down after notification.
4115647Ssam */
4125647Ssam impdown(sc)
4135647Ssam struct imp_softc *sc;
4145647Ssam {
41511230Ssam int s = splimp();
4166208Swnj
41733427Skarels if (sc->imp_state == IMPS_GOINGDOWN) {
41833427Skarels sc->imp_state = IMPS_WINIT;
41933427Skarels impmsg(sc, "marked down");
42034209Skarels sc->imp_msgready = 0;
42133427Skarels hostreset(sc->imp_if.if_unit);
42233427Skarels if_down(&sc->imp_if);
42333427Skarels }
42433427Skarels #ifdef IMPINIT
42533427Skarels else if (imptraceinit)
42633427Skarels log(imppri, "impdown, state now %d (ignored)\n", sc->imp_state);
42733427Skarels #endif
42811230Ssam splx(s);
4295647Ssam }
4305647Ssam
43126397Skarels /*VARARGS2*/
43234509Skarels impmsg(sc, fmt, a1)
4335640Sroot struct imp_softc *sc;
4345640Sroot char *fmt;
4356160Ssam u_int a1;
4365640Sroot {
4376208Swnj
43833427Skarels log(imppri, "imp%d: %r\n", sc->imp_if.if_unit, fmt, &a1);
4395640Sroot }
4405640Sroot
44124777Skarels struct sockproto impproto = { PF_IMPLINK };
44244415Skarels struct sockaddr_in impdst = { sizeof (impdst), AF_INET };
44344415Skarels struct sockaddr_in impsrc = { sizeof (impsrc), AF_INET };
44424777Skarels
4455640Sroot /*
44624777Skarels * Pick up the IMP "error" messages enqueued earlier,
44724777Skarels * passing these up to the higher level protocol
44824777Skarels * and the raw interface.
4496582Ssam */
impintr()45024777Skarels impintr()
4516582Ssam {
45224777Skarels register struct mbuf *m;
45324777Skarels register struct control_leader *cp;
45424777Skarels struct ifnet *ifp;
45544415Skarels int s, code;
4566582Ssam
45724777Skarels for (;;) {
45824777Skarels s = splimp();
45924777Skarels IF_DEQUEUEIF(&impintrq, m, ifp);
46024777Skarels splx(s);
46124777Skarels if (m == 0)
46224777Skarels return;
46318132Skarels
46424777Skarels cp = mtod(m, struct control_leader *);
46533427Skarels imp_leader_to_addr(&impsrc.sin_addr, cp, ifp);
46624777Skarels impproto.sp_protocol = cp->dl_link;
46725409Skarels impdst.sin_addr = IA_SIN(ifp->if_addrlist)->sin_addr;
46824777Skarels
46928849Skarels if (cp->dl_mtype == IMPTYPE_HOSTDEAD ||
47044415Skarels cp->dl_mtype == IMPTYPE_HOSTUNREACH) {
47144415Skarels code = (cp->dl_mtype == IMPTYPE_HOSTDEAD) ?
47244415Skarels PRC_HOSTDEAD : PRC_UNREACH_HOST;
47328849Skarels switch (cp->dl_link) {
47424777Skarels
47528849Skarels case IMPLINK_IP:
47644415Skarels pfctlinput(code, (struct sockaddr *)&impsrc);
47728849Skarels break;
47828849Skarels default:
47944415Skarels raw_ctlinput(code, (struct sockaddr *)&impsrc);
48028849Skarels break;
48128849Skarels }
48244415Skarels }
48324777Skarels
48424777Skarels raw_input(m, &impproto, (struct sockaddr *)&impsrc,
48524777Skarels (struct sockaddr *)&impdst);
4866588Ssam }
4876582Ssam }
4886582Ssam
4896582Ssam /*
4905640Sroot * ARPAnet 1822 output routine.
4915640Sroot * Called from higher level protocol routines to set up messages for
4925640Sroot * transmission to the imp. Sets up the header and calls impsnd to
4935640Sroot * enqueue the message for this IMP's hardware driver.
4945640Sroot */
impoutput(ifp,m0,dst)4956336Ssam impoutput(ifp, m0, dst)
4965640Sroot register struct ifnet *ifp;
4975640Sroot struct mbuf *m0;
4986336Ssam struct sockaddr *dst;
4995640Sroot {
5005640Sroot register struct imp_leader *imp;
5015640Sroot register struct mbuf *m = m0;
50234209Skarels caddr_t pkt = mtod(m, caddr_t);
5036504Ssam int error = 0;
5045640Sroot
5055640Sroot /*
5065640Sroot * Don't even try if the IMP is unavailable.
5075640Sroot */
50833427Skarels if (!IMPS_RUNNING(imp_softc[ifp->if_unit].imp_state)) {
5096504Ssam error = ENETDOWN;
5105647Ssam goto drop;
5116504Ssam }
5125640Sroot
51333453Skarels /*
51433453Skarels * If AF_IMPLINK, leader exists; just send.
51533453Skarels * Otherwise, construct leader according to address family.
51633453Skarels */
51733453Skarels if (dst->sa_family != AF_IMPLINK) {
51833453Skarels /*
51933453Skarels * Add IMP leader. If there's not enough space in the
52033453Skarels * first mbuf, allocate another. If that should fail, we
52133453Skarels * drop this sucker.
52233453Skarels */
52335799Ssklower M_PREPEND(m, sizeof(struct imp_leadr), M_DONTWAIT);
52433453Skarels imp = mtod(m, struct imp_leader *);
52533453Skarels imp->il_format = IMP_NFF;
52633453Skarels imp->il_mtype = IMPTYPE_DATA;
52734209Skarels imp->il_flags = 0;
52834209Skarels imp->il_htype = 0;
52934209Skarels imp->il_subtype = 0;
5305640Sroot
53133453Skarels switch (dst->sa_family) {
5325640Sroot
53334209Skarels case AF_INET:
53433453Skarels imp->il_link = IMPLINK_IP;
53533453Skarels imp_addr_to_leader((struct control_leader *)imp,
53633453Skarels ((struct sockaddr_in *)dst)->sin_addr.s_addr);
53734209Skarels imp->il_length = htons(ntohs((u_short)
53834209Skarels ((struct ip *)pkt)->ip_len) << 3);
53933453Skarels break;
5405640Sroot
54133453Skarels default:
54233453Skarels printf("imp%d: can't handle af%d\n", ifp->if_unit,
54333453Skarels dst->sa_family);
54433453Skarels error = EAFNOSUPPORT;
54534209Skarels m0 = m;
5465647Ssam goto drop;
5476504Ssam }
5485640Sroot }
5495640Sroot return (impsnd(ifp, m));
5505647Ssam drop:
5515647Ssam m_freem(m0);
5526504Ssam return (error);
5535640Sroot }
5545640Sroot
5555640Sroot /*
5565640Sroot * Put a message on an interface's output queue.
5575640Sroot * Perform RFNM counting: no more than 8 message may be
5585640Sroot * in flight to any one host.
5595640Sroot */
5605640Sroot impsnd(ifp, m)
5615640Sroot struct ifnet *ifp;
5625640Sroot struct mbuf *m;
5635640Sroot {
56433427Skarels register struct control_leader *imp;
5655640Sroot register struct host *hp;
56633453Skarels register struct imp_softc *sc = &imp_softc[ifp->if_unit];
56733453Skarels int s, error = 0;
5685640Sroot
56933427Skarels imp = mtod(m, struct control_leader *);
5705640Sroot
5715640Sroot /*
5725640Sroot * Do RFNM counting for data messages
57333453Skarels * (no more than 8 outstanding to any host).
57433453Skarels * Queue data messages per host if 8 are already outstanding
57533453Skarels * or if the hardware interface is already doing output.
57633453Skarels * Increment imp_msgready if the message could be sent now,
57733453Skarels * but must be queued because the imp output is busy.
5785640Sroot */
5796588Ssam s = splimp();
58033427Skarels if (imp->dl_mtype == IMPTYPE_DATA) {
58134509Skarels hp = hostenter((int)imp->dl_imp, (int)imp->dl_host,
58234509Skarels ifp->if_unit);
5835640Sroot if (hp) {
58434209Skarels if (hp->h_flags & (HF_DEAD|HF_UNREACH))
58534209Skarels error = hp->h_flags & HF_DEAD ?
58634209Skarels EHOSTDOWN : EHOSTUNREACH;
58734209Skarels else if (hp->h_rfnm < IMP_MAXHOSTMSG &&
58834209Skarels sc->imp_cb.ic_oactive == 0) {
58934209Skarels /*
59034209Skarels * Send without queuing;
59134209Skarels * adjust rfnm count and timer.
59234209Skarels */
59334209Skarels if (hp->h_rfnm++ == 0)
59434209Skarels hp->h_timer = RFNMTIMER;
59534209Skarels goto send;
59633453Skarels } else if (hp->h_rfnm + hp->h_qcnt < imphqlen) {
5976095Swnj HOST_ENQUE(hp, m);
59834209Skarels if (hp->h_rfnm + hp->h_qcnt <= IMP_MAXHOSTMSG)
59934209Skarels sc->imp_msgready++;
60034272Skarels } else {
60133453Skarels error = ENOBUFS;
60234272Skarels IF_DROP(&ifp->if_snd);
60334272Skarels }
60433453Skarels } else
60533453Skarels error = ENOBUFS;
60633453Skarels } else if (sc->imp_cb.ic_oactive == 0)
60733453Skarels goto send;
60833453Skarels else
60933453Skarels IF_ENQUEUE(&ifp->if_snd, m);
61034209Skarels
61133453Skarels splx(s);
61234209Skarels if (error)
61334209Skarels m_freem(m);
61434209Skarels return (error);
61533453Skarels
61633453Skarels send:
61733453Skarels sc->imp_if.if_timer = IMP_OTIMER;
61833453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m);
61933453Skarels splx(s);
62033453Skarels return (0);
62133453Skarels }
62233453Skarels
62333453Skarels /*
62433453Skarels * Start another output operation on IMP; called from hardware
62533453Skarels * transmit-complete interrupt routine at splimp or from imp routines
62634209Skarels * when output is not in progress. If there are any packets on shared
62734209Skarels * output queue, send them, otherwise send the next data packet for a host.
62834209Skarels * Host data packets are sent round-robin based on destination by walking
62934209Skarels * the host list.
63033453Skarels */
impstart(sc)63133453Skarels impstart(sc)
63233453Skarels register struct imp_softc *sc;
63333453Skarels {
63433453Skarels register struct mbuf *m;
63534209Skarels int first = 1; /* XXX */
63633453Skarels register struct host *hp;
63733453Skarels int index;
63833453Skarels
63933453Skarels IF_DEQUEUE(&sc->imp_if.if_snd, m);
64033453Skarels if (m) {
64133453Skarels sc->imp_if.if_timer = IMP_OTIMER;
64233453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m);
64333453Skarels return;
64433453Skarels }
64533453Skarels if (sc->imp_msgready) {
64633453Skarels if ((m = sc->imp_hostq) == 0 && (m = sc->imp_hosts) == 0)
64734209Skarels panic("imp msgready");
64834209Skarels index = sc->imp_hostent;
64934209Skarels for (hp = &mtod(m, struct hmbuf *)->hm_hosts[index]; ;
65034209Skarels hp++, index++) {
65134209Skarels if (index >= HPMBUF) {
65234209Skarels if ((m = m->m_next) == 0)
65334209Skarels m = sc->imp_hosts;
65434209Skarels index = 0;
65534209Skarels hp = mtod(m, struct hmbuf *)->hm_hosts;
65634209Skarels first = 0; /* XXX */
6576095Swnj }
65834209Skarels if (hp->h_qcnt && hp->h_rfnm < IMP_MAXHOSTMSG) {
65934209Skarels /*
66034209Skarels * Found host entry with another message
66134209Skarels * to send. Deliver it to the IMP.
66234209Skarels * Start with succeeding host next time.
66334209Skarels */
66434209Skarels impstarthost(sc, hp);
66534209Skarels sc->imp_hostq = m;
66634209Skarels sc->imp_hostent = index + 1;
66734209Skarels return;
66833453Skarels }
66934209Skarels if (m == sc->imp_hostq && !first &&
67034209Skarels index + 1 >= sc->imp_hostent) { /* XXX */
67134209Skarels log(imppri, "imp: can't find %d msgready\n",
67234209Skarels sc->imp_msgready);
67334209Skarels sc->imp_msgready = 0;
67434209Skarels break;
67534209Skarels }
6765640Sroot }
6775640Sroot }
67833453Skarels sc->imp_if.if_timer = 0;
67933453Skarels }
68033453Skarels
68133453Skarels /*
68234209Skarels * Restart output for a host that has received a RFNM
68334209Skarels * or incomplete or has timed out while waiting for a RFNM.
68433453Skarels * Must be called at splimp.
68533453Skarels */
imprestarthost(sc,hp)68634209Skarels imprestarthost(sc, hp)
68734209Skarels register struct imp_softc *sc;
68833453Skarels struct host *hp;
68933453Skarels {
69033453Skarels
69133453Skarels if (--hp->h_rfnm > 0)
69233453Skarels hp->h_timer = RFNMTIMER;
69334209Skarels /*
69434209Skarels * If the RFNM moved a queued message into the window,
69534209Skarels * update msgready and start IMP if idle.
69634209Skarels */
69734209Skarels if (hp->h_qcnt > IMP_MAXHOSTMSG - 1 - hp->h_rfnm) {
69834209Skarels sc->imp_msgready++;
69933453Skarels if (sc->imp_cb.ic_oactive == 0)
70033453Skarels impstarthost(sc, hp);
7016208Swnj }
70234209Skarels if (hp->h_rfnm == 0 && hp->h_qcnt == 0)
70334209Skarels hostidle(hp);
7045640Sroot }
7055640Sroot
7065640Sroot /*
70733453Skarels * Send the next message queued for a host
70833453Skarels * when ready to send another message to the IMP.
70933453Skarels * Called only when output is not in progress.
71033453Skarels * Bump RFNM counter and start RFNM timer
71133453Skarels * when we send the message to the IMP.
71233453Skarels * Must be called at splimp.
71333453Skarels */
impstarthost(sc,hp)71433453Skarels impstarthost(sc, hp)
71533453Skarels register struct imp_softc *sc;
71633453Skarels register struct host *hp;
71733453Skarels {
71833453Skarels struct mbuf *m;
71933453Skarels
72033453Skarels if (hp->h_rfnm++ == 0)
72133453Skarels hp->h_timer = RFNMTIMER;
72233453Skarels HOST_DEQUE(hp, m);
72333453Skarels sc->imp_if.if_timer = IMP_OTIMER;
72433453Skarels (*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m);
72533453Skarels sc->imp_msgready--;
72633453Skarels }
72733453Skarels
72833453Skarels /*
72933453Skarels * "Watchdog" timeout. When the output timer expires,
73033453Skarels * we assume we have been blocked by the imp.
73133453Skarels * No need to restart, just collect statistics.
73233453Skarels */
imptimo(unit)73333453Skarels imptimo(unit)
73433453Skarels int unit;
73533453Skarels {
73633453Skarels
73733453Skarels imp_softc[unit].imp_block++;
73833453Skarels }
73933453Skarels
74033453Skarels /*
7415640Sroot * Put three 1822 NOOPs at the head of the output queue.
7425640Sroot * Part of host-IMP initialization procedure.
7435640Sroot * (Should return success/failure, but noone knows
7445640Sroot * what to do with this, so why bother?)
7456818Ssam * This routine is always called at splimp, so we don't
7466818Ssam * protect the call to IF_PREPEND.
7475640Sroot */
impnoops(sc)7485640Sroot impnoops(sc)
7495640Sroot register struct imp_softc *sc;
7505640Sroot {
7515640Sroot register i;
7525640Sroot register struct mbuf *m;
7535771Swnj register struct control_leader *cp;
7545640Sroot
75533427Skarels #ifdef IMPINIT
75633427Skarels if (imptraceinit)
75733427Skarels log(imppri, "impnoops\n");
75833427Skarels #endif
75933427Skarels for (i = 0; i < IMP_NOOPCNT; i++) {
7609645Ssam if ((m = m_getclr(M_DONTWAIT, MT_HEADER)) == 0)
7615640Sroot return;
7625771Swnj m->m_len = sizeof(struct control_leader);
7635771Swnj cp = mtod(m, struct control_leader *);
7645771Swnj cp->dl_format = IMP_NFF;
76533427Skarels cp->dl_link = i;
76633427Skarels cp->dl_mtype = IMPTYPE_NOOP;
7675640Sroot IF_PREPEND(&sc->imp_if.if_snd, m);
7685640Sroot }
7695640Sroot if (sc->imp_cb.ic_oactive == 0)
77033453Skarels impstart(sc);
7715640Sroot }
7727170Ssam
77313067Ssam /*
77413067Ssam * Process an ioctl request.
77513067Ssam */
impioctl(ifp,cmd,data)77613067Ssam impioctl(ifp, cmd, data)
77713067Ssam register struct ifnet *ifp;
77813067Ssam int cmd;
77913067Ssam caddr_t data;
78013067Ssam {
78118412Skarels struct ifaddr *ifa = (struct ifaddr *) data;
78213067Ssam int s = splimp(), error = 0;
78333427Skarels #define sc ((struct imp_softc *)ifp)
78413067Ssam
78513067Ssam switch (cmd) {
78613067Ssam
78713067Ssam case SIOCSIFADDR:
78818412Skarels if (ifa->ifa_addr.sa_family != AF_INET) {
78918412Skarels error = EINVAL;
79018412Skarels break;
79118412Skarels }
79233427Skarels if ((ifp->if_flags & IFF_UP) == 0)
79313067Ssam impinit(ifp->if_unit);
79413067Ssam break;
79513067Ssam
79633427Skarels case SIOCSIFFLAGS:
79733427Skarels if ((ifp->if_flags & IFF_UP) == 0 &&
79833427Skarels sc->imp_state != IMPS_DOWN) {
79933453Skarels if (sc->imp_cb.ic_down &&
80034209Skarels (*sc->imp_cb.ic_down)(sc->imp_cb.ic_hwunit)) {
80133427Skarels sc->imp_state = IMPS_DOWN;
80234209Skarels sc->imp_msgready = 0;
80334209Skarels hostreset(ifp->if_unit);
80434272Skarels if_down(ifp);
80534209Skarels }
80633427Skarels } else if (ifp->if_flags & IFF_UP && sc->imp_state == IMPS_DOWN)
80733427Skarels impinit(ifp->if_unit);
80833427Skarels break;
80933427Skarels
81013067Ssam default:
81113067Ssam error = EINVAL;
81233427Skarels break;
81313067Ssam }
81413067Ssam splx(s);
81513067Ssam return (error);
81613067Ssam }
81713067Ssam
8187170Ssam #ifdef IMPLEADERS
printleader(routine,ip)8197170Ssam printleader(routine, ip)
8207170Ssam char *routine;
8217170Ssam register struct imp_leader *ip;
8227170Ssam {
8237170Ssam printf("%s: ", routine);
8247170Ssam printbyte((char *)ip, 12);
8257170Ssam printf("<fmt=%x,net=%x,flags=%x,mtype=", ip->il_format, ip->il_network,
8267170Ssam ip->il_flags);
8277170Ssam if (ip->il_mtype <= IMPTYPE_READY)
8287170Ssam printf("%s,", impleaders[ip->il_mtype]);
8297170Ssam else
8307170Ssam printf("%x,", ip->il_mtype);
8317170Ssam printf("htype=%x,host=%x,imp=%x,link=", ip->il_htype, ip->il_host,
8327170Ssam ntohs(ip->il_imp));
8337170Ssam if (ip->il_link == IMPLINK_IP)
8347170Ssam printf("ip,");
8357170Ssam else
8367170Ssam printf("%x,", ip->il_link);
8377170Ssam printf("subtype=%x,len=%x>\n",ip->il_subtype,ntohs(ip->il_length)>>3);
8387170Ssam }
8397170Ssam
printbyte(cp,n)8407170Ssam printbyte(cp, n)
8417170Ssam register char *cp;
8427170Ssam int n;
8437170Ssam {
8447170Ssam register i, j, c;
8457170Ssam
8467170Ssam for (i=0; i<n; i++) {
8477170Ssam c = *cp++;
8487170Ssam for (j=0; j<2; j++)
84924777Skarels putchar("0123456789abcdef"[(c>>((1-j)*4))&0xf], 0);
85024777Skarels putchar(' ', 0);
8517170Ssam }
85224777Skarels putchar('\n', 0);
8537170Ssam }
8545640Sroot #endif
85518132Skarels
85618132Skarels /*
85718132Skarels * Routine to convert from IMP Leader to InterNet Address.
85818132Skarels *
85918132Skarels * This procedure is necessary because IMPs may be assigned Class A, B, or C
86018132Skarels * network numbers, but only have 8 bits in the leader to reflect the
86118132Skarels * IMP "network number". The strategy is to take the network number from
86218132Skarels * the ifnet structure, and blend in the host-on-imp and imp-on-net numbers
86318132Skarels * from the leader.
86418132Skarels *
86518132Skarels * There is no support for "Logical Hosts".
86618132Skarels *
86718132Skarels * Class A: Net.Host.0.Imp
86818132Skarels * Class B: Net.net.Host.Imp
86918132Skarels * Class C: Net.net.net.(Host4|Imp4)
87018132Skarels */
87133427Skarels imp_leader_to_addr(ap, cp, ifp)
87218412Skarels struct in_addr *ap;
87333427Skarels register struct control_leader *cp;
87418412Skarels struct ifnet *ifp;
87518132Skarels {
87626397Skarels register u_long final;
87718132Skarels register struct sockaddr_in *sin;
87833427Skarels int imp = ntohs(cp->dl_imp);
87918132Skarels
88018412Skarels sin = (struct sockaddr_in *)(&ifp->if_addrlist->ifa_addr);
88128849Skarels final = ntohl(sin->sin_addr.s_addr);
88218132Skarels
88318412Skarels if (IN_CLASSA(final)) {
88418132Skarels final &= IN_CLASSA_NET;
88533427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<16);
88618412Skarels } else if (IN_CLASSB(final)) {
88718132Skarels final &= IN_CLASSB_NET;
88833427Skarels final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<8);
88918132Skarels } else {
89018132Skarels final &= IN_CLASSC_NET;
89133427Skarels final |= (imp & 0x0F) | ((cp->dl_host & 0x0F)<<4);
89218132Skarels }
89318412Skarels ap->s_addr = htonl(final);
89418132Skarels }
89518132Skarels
89618132Skarels /*
89718132Skarels * Function to take InterNet address and fill in IMP leader fields.
89818132Skarels */
imp_addr_to_leader(imp,a)89918412Skarels imp_addr_to_leader(imp, a)
90033427Skarels register struct control_leader *imp;
90126397Skarels u_long a;
90218132Skarels {
90328849Skarels register u_long addr = ntohl(a);
90418132Skarels
90533427Skarels imp->dl_network = 0; /* !! */
90618132Skarels
90718412Skarels if (IN_CLASSA(addr)) {
90833427Skarels imp->dl_host = ((addr>>16) & 0xFF);
90933427Skarels imp->dl_imp = addr & 0xFF;
91018412Skarels } else if (IN_CLASSB(addr)) {
91133427Skarels imp->dl_host = ((addr>>8) & 0xFF);
91233427Skarels imp->dl_imp = addr & 0xFF;
91318132Skarels } else {
91433427Skarels imp->dl_host = ((addr>>4) & 0xF);
91533427Skarels imp->dl_imp = addr & 0xF;
91618132Skarels }
91733427Skarels imp->dl_imp = htons(imp->dl_imp);
91818132Skarels }
9197170Ssam #endif
920