xref: /csrg-svn/sys/deprecated/netimp/if_imp.c (revision 34853)
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