xref: /csrg-svn/sys/deprecated/netimp/if_imp.c (revision 44467)
123166Smckusick /*
234853Sbostic  * Copyright (c) 1982, 1986, 1988 Regents of the University of California.
333453Skarels  * All rights reserved.
423166Smckusick  *
5*44467Sbostic  * %sccs.include.redist.c%
633453Skarels  *
7*44467Sbostic  *	@(#)if_imp.c	7.13 (Berkeley) 06/28/90
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  */
1817068Sbloom #include "param.h"
1917068Sbloom #include "systm.h"
2017068Sbloom #include "mbuf.h"
2117068Sbloom #include "buf.h"
2217068Sbloom #include "protosw.h"
2317068Sbloom #include "socket.h"
2417068Sbloom #include "time.h"
2517068Sbloom #include "kernel.h"
2617068Sbloom #include "errno.h"
2717068Sbloom #include "ioctl.h"
2833427Skarels #include "syslog.h"
298705Sroot 
3037501Smckusick #include "machine/mtpr.h"
3133453Skarels 
328705Sroot #include "../net/if.h"
338705Sroot #include "../net/netisr.h"
348408Swnj #include "../netinet/in.h"
358408Swnj #include "../netinet/in_systm.h"
3618412Skarels #include "../netinet/in_var.h"
378705Sroot #include "../netinet/ip.h"
388705Sroot #include "../netinet/ip_var.h"
3933427Skarels #define IMPMESSAGES
407199Ssam /* define IMPLEADERS here to get leader printing code */
4117068Sbloom #include "if_imp.h"
4217068Sbloom #include "if_imphost.h"
435640Sroot 
4433427Skarels struct	imp_softc imp_softc[NIMP];
4533453Skarels #ifndef lint
4633453Skarels int	nimp = NIMP;			/* for netstat */
4733453Skarels #endif
4828849Skarels struct	ifqueue impintrq;
4928849Skarels int	impqmaxlen = IFQ_MAXLEN;
5033453Skarels int	imphqlen = 12 + IMP_MAXHOSTMSG;	/* max packets to queue per host */
5124777Skarels 
5233427Skarels int	imppri = LOG_ERR;
5333427Skarels #ifdef IMPLEADERS
5433427Skarels int	impprintfs = 0;
5533427Skarels #endif
5633427Skarels #ifdef IMPINIT
5733427Skarels int	imptraceinit = 0;
5833427Skarels #endif
595640Sroot 
6033453Skarels 
6133427Skarels #define HOSTDEADTIMER	(30 * PR_SLOWHZ)	/* How long to wait when down */
6218132Skarels 
6333453Skarels int	impdown(), impinit(), impioctl(), impoutput(), imptimo();
645771Swnj 
655640Sroot /*
665640Sroot  * IMP attach routine.  Called from hardware device attach routine
6733427Skarels  * at configuration time with a pointer to the device structure.
685640Sroot  * Sets up local state and returns pointer to base of ifnet+impcb
695640Sroot  * structures.  This is then used by the device's attach routine
705640Sroot  * set up its back pointers.
715640Sroot  */
7233427Skarels struct imp_softc *
7334209Skarels impattach(hwname, hwunit, reset)
7434209Skarels 	char *hwname;
7534209Skarels 	int hwunit;
768815Sroot 	int (*reset)();
775640Sroot {
7824777Skarels 	struct imp_softc *sc;
7924777Skarels 	register struct ifnet *ifp;
8033427Skarels 	static int impunit;
815640Sroot 
8226397Skarels #ifdef lint
8326397Skarels 	impintr();
8426397Skarels #endif
8533427Skarels 	if (impunit >= NIMP) {
8633427Skarels 		printf("imp%d: not configured\n", impunit++);
8724777Skarels 		return (0);
8824777Skarels 	}
8933427Skarels 	sc = &imp_softc[impunit];
9024777Skarels 	ifp = &sc->imp_if;
9134209Skarels 	sc->imp_cb.ic_hwname = hwname;
9234209Skarels 	sc->imp_cb.ic_hwunit = hwunit;
9333427Skarels 	ifp->if_unit = impunit;
945640Sroot 	ifp->if_name = "imp";
956271Sroot 	ifp->if_mtu = IMPMTU - sizeof(struct imp_leader);
969001Sroot 	ifp->if_reset = reset;
975771Swnj 	ifp->if_init = impinit;
9813067Ssam 	ifp->if_ioctl = impioctl;
995771Swnj 	ifp->if_output = impoutput;
10033453Skarels 	ifp->if_watchdog = imptimo;
1015640Sroot 	if_attach(ifp);
10233427Skarels 	impunit++;
10333427Skarels 	return (sc);
1045640Sroot }
1055640Sroot 
1065640Sroot /*
1075640Sroot  * IMP initialization routine: call hardware module to
10833427Skarels  * setup resources, init state and get ready for
1095640Sroot  * NOOPs the IMP should send us, and that we want to drop.
1105640Sroot  */
1115640Sroot impinit(unit)
1125640Sroot 	int unit;
1135640Sroot {
11432570Sbostic 	int s;
1155640Sroot 	register struct imp_softc *sc = &imp_softc[unit];
1165640Sroot 
11718412Skarels 	if (sc->imp_if.if_addrlist == 0)
11813067Ssam 		return;
11932570Sbostic 	s = splimp();
12033427Skarels #ifdef IMPINIT
12133427Skarels 	if (imptraceinit)
12233427Skarels 		log(imppri, "impinit\n");
12333427Skarels #endif
12433427Skarels 	sc->imp_state = IMPS_WINIT;
12533427Skarels 	if ((*sc->imp_cb.ic_init)(sc->imp_cb.ic_hwunit) == 0)
1266336Ssam 		sc->imp_if.if_flags &= ~IFF_UP;
12733427Skarels 	impintrq.ifq_maxlen = impqmaxlen;
1286500Ssam 	splx(s);
1295640Sroot }
1305640Sroot 
1315640Sroot /*
13233453Skarels  * ARPAnet 1822/AHIP input routine.
1335640Sroot  * Called from hardware input interrupt routine to handle 1822
13433453Skarels  * IMP-host messages.  Data messages are passed to higher-level
13533453Skarels  * protocol processors on the basis of link number.
13633453Skarels  * Other type messages (control) are handled here.
1375640Sroot  */
1385771Swnj impinput(unit, m)
1395640Sroot 	int unit;
1405771Swnj 	register struct mbuf *m;
1415640Sroot {
14233427Skarels 	register struct control_leader *cp;
14333427Skarels #define	ip	((struct imp_leader *)cp)
1445640Sroot 	register struct imp_softc *sc = &imp_softc[unit];
14524777Skarels 	struct ifnet *ifp;
1465640Sroot 	register struct host *hp;
1475640Sroot 	register struct ifqueue *inq;
1486336Ssam 	struct sockaddr_in *sin;
14933453Skarels 	int s;
1505640Sroot 
15124777Skarels 	/*
15224777Skarels 	 * Pull the interface pointer out of the mbuf
15324777Skarels 	 * and save for later; adjust mbuf to look at rest of data.
15424777Skarels 	 */
15535799Ssklower if ((m->m_flags && M_PKTHDR) == 0)
15635799Ssklower panic("No header in impinput");
15735799Ssklower 	ifp = m->m_pkthdr.rcvif;
1586257Sroot 	/* verify leader length. */
1595771Swnj 	if (m->m_len < sizeof(struct control_leader) &&
1605771Swnj 	    (m = m_pullup(m, sizeof(struct control_leader))) == 0)
1615771Swnj 		return;
1625771Swnj 	cp = mtod(m, struct control_leader *);
16333427Skarels 	if (cp->dl_mtype == IMPTYPE_DATA &&
16433427Skarels 	    m->m_len < sizeof(struct imp_leader)) {
16533427Skarels 		if ((m = m_pullup(m, sizeof(struct imp_leader))) == 0)
1665771Swnj 			return;
16733427Skarels 		cp = mtod(m, struct control_leader *);
16833427Skarels 	}
1697199Ssam #ifdef IMPLEADERS
1707170Ssam 	if (impprintfs)
1717170Ssam 		printleader("impinput", ip);
1727199Ssam #endif
17328849Skarels 	inq = &impintrq;
1745640Sroot 
1756257Sroot 	/* check leader type */
17633427Skarels 	if (cp->dl_format != IMP_NFF) {
17734209Skarels 		/*
17834209Skarels 		 * We get 1822L NOOPs and RESET
17934209Skarels 		 * at initialization.
18034209Skarels 		 */
18134209Skarels #ifdef IMPINIT
18234209Skarels 		if (imptraceinit)
18334209Skarels 			log(imppri, "input, format %x mtype %d\n",
18434209Skarels 			    cp->dl_format, cp->dl_mtype);
18534209Skarels #endif
18634209Skarels 		if (cp->dl_format != IMP_1822L_I2H ||
18734209Skarels 		    (cp->dl_mtype != IMPTYPE_NOOP &&
18834209Skarels 		    cp->dl_mtype != IMPTYPE_RESET)) {
18933453Skarels 			sc->imp_garbage++;
19033453Skarels 			sc->imp_if.if_collisions++;	/* XXX */
19133453Skarels 		}
19233427Skarels 	} else switch (cp->dl_mtype) {
1935640Sroot 
1945640Sroot 	case IMPTYPE_DATA:
19528849Skarels 		/*
19628849Skarels 		 * Data for a protocol.  Dispatch to the appropriate
19728849Skarels 		 * protocol routine (running at software interrupt).
19828849Skarels 		 * If this isn't a raw interface, advance pointer
19928849Skarels 		 * into mbuf past leader.
20028849Skarels 		 */
20133427Skarels 		switch (cp->dl_link) {
20228849Skarels 
20328849Skarels 		case IMPLINK_IP:
20428849Skarels 			m->m_len -= sizeof(struct imp_leader);
20535799Ssklower 			if (m->m_flags & M_PKTHDR)
20635799Ssklower 				m->m_pkthdr.len -= sizeof(struct imp_leader);
20735799Ssklower 			m->m_data += sizeof(struct imp_leader);
20828849Skarels 			schednetisr(NETISR_IP);
20928849Skarels 			inq = &ipintrq;
21028849Skarels 			break;
21128849Skarels 
21228849Skarels 		default:
21328849Skarels 			break;
21428849Skarels 		}
2155640Sroot 		break;
2165640Sroot 
2175640Sroot 	/*
2185640Sroot 	 * IMP leader error.  Reset the IMP and discard the packet.
2195640Sroot 	 */
2205640Sroot 	case IMPTYPE_BADLEADER:
2215647Ssam 		/*
2225647Ssam 		 * According to 1822 document, this message
2235647Ssam 		 * will be generated in response to the
2245647Ssam 		 * first noop sent to the IMP after
2255647Ssam 		 * the host resets the IMP interface.
2265647Ssam 		 */
22733427Skarels #ifdef IMPINIT
22833427Skarels 		if (imptraceinit)
22933427Skarels 			log(imppri, "badleader\n");
23033427Skarels #endif
2315771Swnj 		if (sc->imp_state != IMPS_INIT) {
2325924Sroot 			impmsg(sc, "leader error");
23333453Skarels 			sc->imp_msgready = 0;
23433427Skarels 			hostreset(unit);
2355647Ssam 			impnoops(sc);
23633453Skarels 			sc->imp_garbage++;
2375647Ssam 		}
23828849Skarels 		break;
2395640Sroot 
2405640Sroot 	/*
2415640Sroot 	 * IMP going down.  Print message, and if not immediate,
2425640Sroot 	 * set off a timer to insure things will be reset at the
2435640Sroot 	 * appropriate time.
2445640Sroot 	 */
2455640Sroot 	case IMPTYPE_DOWN:
24633427Skarels 	    {	int type, when;
24733427Skarels 
24833427Skarels 		type = cp->dl_link & IMP_DMASK;
24933427Skarels 		when = (cp->dl_link & IMPDOWN_WHENMASK) >> IMPDOWN_WHENSHIFT;
25033427Skarels #ifdef IMPINIT
25133427Skarels 		if (imptraceinit)
25233427Skarels 			log(imppri, "input DOWN %s %d\n",
25333427Skarels 			    impmessage[type], when * IMPDOWN_WHENUNIT);
25433427Skarels #endif
25533427Skarels 		if (type != IMPDOWN_GOING && when)
25633427Skarels 			impmsg(sc, "going down %s in %d minutes",
25733427Skarels 			    (u_int)impmessage[type], when * IMPDOWN_WHENUNIT);
25833427Skarels 		else
25933427Skarels 			impmsg(sc, "going down %s", (u_int)impmessage[type]);
26033427Skarels 		if (sc->imp_state != IMPS_UP)
26128849Skarels 			break;
26233427Skarels 		if (type == IMPDOWN_GOING) {
2635640Sroot 			sc->imp_state = IMPS_GOINGDOWN;
26433427Skarels 			timeout(impdown, (caddr_t)sc, IMPTV_DOWN * hz);
26533427Skarels 		} else if (when == 0)
26633427Skarels 			sc->imp_state = IMPS_WINIT;
26733427Skarels 		sc->imp_dropcnt = 0;
26828849Skarels 		break;
26933427Skarels 	    }
2705640Sroot 
2715640Sroot 	/*
27233427Skarels 	 * A NOP, usually seen during the initialization sequence.
2735640Sroot 	 * Compare the local address with that in the message.
2745640Sroot 	 * Reset the local address notion if it doesn't match.
2755640Sroot 	 */
2766336Ssam 	case IMPTYPE_NOOP:
27733427Skarels #ifdef IMPINIT
27833427Skarels 		if (imptraceinit)
27933427Skarels 			log(imppri, "noop\n");
28033427Skarels #endif
28133427Skarels 		if (sc->imp_state == IMPS_WINIT) {
28233427Skarels 			sc->imp_dropcnt = 0;
28333427Skarels 			impnoops(sc);
2845647Ssam 			sc->imp_state = IMPS_INIT;
2855647Ssam 		}
28633427Skarels 		sc->imp_dropcnt++;
28733427Skarels 		if (sc->imp_state == IMPS_INIT && cp->dl_imp != 0) {
28818132Skarels 			struct in_addr leader_addr;
28928849Skarels 
29033427Skarels 			sin = (struct sockaddr_in *)&sc->imp_if.if_addrlist->ifa_addr;
29133427Skarels 			imp_leader_to_addr(&leader_addr, cp, &sc->imp_if);
29218412Skarels 			if (sin->sin_addr.s_addr != leader_addr.s_addr) {
29318412Skarels 				impmsg(sc, "address reset to x%x (%d/%d)",
29428849Skarels 					ntohl(leader_addr.s_addr),
29533427Skarels 					(u_int)cp->dl_host,
29633427Skarels 					ntohs(cp->dl_imp));
29718132Skarels 				sin->sin_addr.s_addr = leader_addr.s_addr;
29818132Skarels 			}
2996500Ssam 		}
30028849Skarels 		break;
3015640Sroot 
3025640Sroot 	/*
30333453Skarels 	 * RFNM or INCOMPLETE message, decrement rfnm count
30433453Skarels 	 * and prepare to send next message.
30534209Skarels 	 * If the rfnm allows another queued
30634209Skarels 	 * message to be sent, bump msgready
30734209Skarels 	 * and start IMP if idle.
30833453Skarels 	 * We could pass incomplete's up to the next level,
30933453Skarels 	 * but this currently isn't needed.
31034209Skarels 	 * Pass "bad" incompletes and rfnms to the raw socket.
3115640Sroot 	 */
31233427Skarels 	case IMPTYPE_INCOMPLETE:
31333427Skarels 		sc->imp_incomplete++;
31433427Skarels 		/* FALL THROUGH */
3155640Sroot 	case IMPTYPE_RFNM:
31634509Skarels 		if ((hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host,
31734509Skarels 		    unit)) == 0 || hp->h_rfnm == 0) {
31834209Skarels 			sc->imp_badrfnm++;
31934209Skarels 			if (hp)
32033427Skarels 				hostfree(hp);
32134209Skarels 			break;
32234209Skarels 		}
32334209Skarels 		imprestarthost(sc, hp);
32434209Skarels 		if (cp->dl_mtype == IMPTYPE_RFNM)
32533427Skarels 			goto drop;
32633427Skarels 		break;
3275640Sroot 
3285640Sroot 	/*
3295640Sroot 	 * Host or IMP can't be reached.  Flush any packets
3305640Sroot 	 * awaiting transmission and release the host structure.
33124777Skarels 	 * Enqueue for notifying protocols at software interrupt time.
3325640Sroot 	 */
3335640Sroot 	case IMPTYPE_HOSTDEAD:
33411230Ssam 	case IMPTYPE_HOSTUNREACH:
33534509Skarels 		if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) {
33633427Skarels 			hp->h_flags |= (1 << (int)cp->dl_mtype);
33733453Skarels 			sc->imp_msgready -=
33833453Skarels 			   MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm);
33933427Skarels 			hp->h_rfnm = 0;
34033453Skarels 			hostflush(hp);
34124777Skarels 			hp->h_timer = HOSTDEADTIMER;
34224777Skarels 		}
34328849Skarels 		break;
3445640Sroot 
3455640Sroot 	/*
3465640Sroot 	 * Error in data.  Clear RFNM status for this host and send
3475640Sroot 	 * noops to the IMP to clear the interface.
3485640Sroot 	 */
34911230Ssam 	case IMPTYPE_BADDATA:
3505924Sroot 		impmsg(sc, "data error");
35134509Skarels 		if (hp = hostlookup((int)cp->dl_imp, (int)cp->dl_host, unit)) {
35233453Skarels 			sc->imp_msgready -=
35333453Skarels 			   MIN(hp->h_qcnt, IMP_MAXHOSTMSG - hp->h_rfnm);
35434209Skarels 			if (hp->h_rfnm)
35534209Skarels 				hostrelease(hp);
35634209Skarels 			else
35734209Skarels 				hostfree(hp);
35833427Skarels 		}
3595640Sroot 		impnoops(sc);
36028849Skarels 		break;
3615640Sroot 
3625640Sroot 	/*
3635647Ssam 	 * Interface reset.
3645640Sroot 	 */
3655640Sroot 	case IMPTYPE_RESET:
36633427Skarels #ifdef IMPINIT
36733427Skarels 		if (imptraceinit)
36833427Skarels 			log(imppri, "reset complete\n");
36933427Skarels #endif
37033427Skarels 		if (sc->imp_state != IMPS_INIT) {
37133427Skarels 			impmsg(sc, "interface reset");
37233427Skarels 			impnoops(sc);
37333427Skarels 		}
37418412Skarels 		/* clear RFNM counts */
37533453Skarels 		sc->imp_msgready = 0;
37633427Skarels 		hostreset(unit);
37733427Skarels 		if (sc->imp_state != IMPS_DOWN) {
37833427Skarels 			sc->imp_state = IMPS_UP;
37933427Skarels 			sc->imp_if.if_flags |= IFF_UP;
38033427Skarels #ifdef IMPINIT
38133427Skarels 			if (imptraceinit)
38233427Skarels 				log(imppri, "IMP UP\n");
38333427Skarels #endif
38433427Skarels 		}
38528849Skarels 		break;
3865640Sroot 
3875640Sroot 	default:
38833427Skarels 		sc->imp_garbage++;
3895640Sroot 		sc->imp_if.if_collisions++;		/* XXX */
39028849Skarels 		break;
3915640Sroot 	}
3925640Sroot 
39328849Skarels 	if (inq == &impintrq)
39424777Skarels 		schednetisr(NETISR_IMP);
39533453Skarels 	s = splimp();
39633453Skarels 	if (!IF_QFULL(inq)) {
39733453Skarels 		IF_ENQUEUE(inq, m);
39833453Skarels 		splx(s);
39933453Skarels 		return;
4006208Swnj 	}
40133453Skarels 	splx(s);
40234209Skarels 	IF_DROP(inq);
4035640Sroot drop:
4045640Sroot 	m_freem(m);
40533427Skarels #undef ip
4065640Sroot }
4075640Sroot 
4085647Ssam /*
4095647Ssam  * Bring the IMP down after notification.
4105647Ssam  */
4115647Ssam impdown(sc)
4125647Ssam 	struct imp_softc *sc;
4135647Ssam {
41411230Ssam 	int s = splimp();
4156208Swnj 
41633427Skarels 	if (sc->imp_state == IMPS_GOINGDOWN) {
41733427Skarels 		sc->imp_state = IMPS_WINIT;
41833427Skarels 		impmsg(sc, "marked down");
41934209Skarels 		sc->imp_msgready = 0;
42033427Skarels 		hostreset(sc->imp_if.if_unit);
42133427Skarels 		if_down(&sc->imp_if);
42233427Skarels 	}
42333427Skarels #ifdef IMPINIT
42433427Skarels 	else if (imptraceinit)
42533427Skarels 		log(imppri, "impdown, state now %d (ignored)\n", sc->imp_state);
42633427Skarels #endif
42711230Ssam 	splx(s);
4285647Ssam }
4295647Ssam 
43026397Skarels /*VARARGS2*/
43134509Skarels impmsg(sc, fmt, a1)
4325640Sroot 	struct imp_softc *sc;
4335640Sroot 	char *fmt;
4346160Ssam 	u_int a1;
4355640Sroot {
4366208Swnj 
43733427Skarels 	log(imppri, "imp%d: %r\n", sc->imp_if.if_unit, fmt, &a1);
4385640Sroot }
4395640Sroot 
44024777Skarels struct sockproto impproto = { PF_IMPLINK };
44144415Skarels struct sockaddr_in impdst = { sizeof (impdst), AF_INET };
44244415Skarels struct sockaddr_in impsrc = { sizeof (impsrc), AF_INET };
44324777Skarels 
4445640Sroot /*
44524777Skarels  * Pick up the IMP "error" messages enqueued earlier,
44624777Skarels  * passing these up to the higher level protocol
44724777Skarels  * and the raw interface.
4486582Ssam  */
44924777Skarels impintr()
4506582Ssam {
45124777Skarels 	register struct mbuf *m;
45224777Skarels 	register struct control_leader *cp;
45324777Skarels 	struct ifnet *ifp;
45444415Skarels 	int s, code;
4556582Ssam 
45624777Skarels 	for (;;) {
45724777Skarels 		s = splimp();
45824777Skarels 		IF_DEQUEUEIF(&impintrq, m, ifp);
45924777Skarels 		splx(s);
46024777Skarels 		if (m == 0)
46124777Skarels 			return;
46218132Skarels 
46324777Skarels 		cp = mtod(m, struct control_leader *);
46433427Skarels 		imp_leader_to_addr(&impsrc.sin_addr, cp, ifp);
46524777Skarels 		impproto.sp_protocol = cp->dl_link;
46625409Skarels 		impdst.sin_addr = IA_SIN(ifp->if_addrlist)->sin_addr;
46724777Skarels 
46828849Skarels 		if (cp->dl_mtype == IMPTYPE_HOSTDEAD ||
46944415Skarels 		    cp->dl_mtype == IMPTYPE_HOSTUNREACH) {
47044415Skarels 			code = (cp->dl_mtype == IMPTYPE_HOSTDEAD) ?
47144415Skarels 				PRC_HOSTDEAD : PRC_UNREACH_HOST;
47228849Skarels 			switch (cp->dl_link) {
47324777Skarels 
47428849Skarels 			case IMPLINK_IP:
47544415Skarels 				pfctlinput(code, (struct sockaddr *)&impsrc);
47628849Skarels 				break;
47728849Skarels 			default:
47844415Skarels 				raw_ctlinput(code, (struct sockaddr *)&impsrc);
47928849Skarels 				break;
48028849Skarels 			}
48144415Skarels 		}
48224777Skarels 
48324777Skarels 		raw_input(m, &impproto, (struct sockaddr *)&impsrc,
48424777Skarels 		  (struct sockaddr *)&impdst);
4856588Ssam 	}
4866582Ssam }
4876582Ssam 
4886582Ssam /*
4895640Sroot  * ARPAnet 1822 output routine.
4905640Sroot  * Called from higher level protocol routines to set up messages for
4915640Sroot  * transmission to the imp.  Sets up the header and calls impsnd to
4925640Sroot  * enqueue the message for this IMP's hardware driver.
4935640Sroot  */
4946336Ssam impoutput(ifp, m0, dst)
4955640Sroot 	register struct ifnet *ifp;
4965640Sroot 	struct mbuf *m0;
4976336Ssam 	struct sockaddr *dst;
4985640Sroot {
4995640Sroot 	register struct imp_leader *imp;
5005640Sroot 	register struct mbuf *m = m0;
50134209Skarels 	caddr_t pkt = mtod(m, caddr_t);
5026504Ssam 	int error = 0;
5035640Sroot 
5045640Sroot 	/*
5055640Sroot 	 * Don't even try if the IMP is unavailable.
5065640Sroot 	 */
50733427Skarels 	if (!IMPS_RUNNING(imp_softc[ifp->if_unit].imp_state)) {
5086504Ssam 		error = ENETDOWN;
5095647Ssam 		goto drop;
5106504Ssam 	}
5115640Sroot 
51233453Skarels 	/*
51333453Skarels 	 * If AF_IMPLINK, leader exists; just send.
51433453Skarels 	 * Otherwise, construct leader according to address family.
51533453Skarels 	 */
51633453Skarels 	if (dst->sa_family != AF_IMPLINK) {
51733453Skarels 		/*
51833453Skarels 		 * Add IMP leader.  If there's not enough space in the
51933453Skarels 		 * first mbuf, allocate another.  If that should fail, we
52033453Skarels 		 * drop this sucker.
52133453Skarels 		 */
52235799Ssklower 		M_PREPEND(m, sizeof(struct imp_leadr), M_DONTWAIT);
52333453Skarels 		imp = mtod(m, struct imp_leader *);
52433453Skarels 		imp->il_format = IMP_NFF;
52533453Skarels 		imp->il_mtype = IMPTYPE_DATA;
52634209Skarels 		imp->il_flags = 0;
52734209Skarels 		imp->il_htype = 0;
52834209Skarels 		imp->il_subtype = 0;
5295640Sroot 
53033453Skarels 		switch (dst->sa_family) {
5315640Sroot 
53234209Skarels 		case AF_INET:
53333453Skarels 			imp->il_link = IMPLINK_IP;
53433453Skarels 			imp_addr_to_leader((struct control_leader *)imp,
53533453Skarels 				((struct sockaddr_in *)dst)->sin_addr.s_addr);
53634209Skarels 			imp->il_length = htons(ntohs((u_short)
53734209Skarels 			    ((struct ip *)pkt)->ip_len) << 3);
53833453Skarels 			break;
5395640Sroot 
54033453Skarels 		default:
54133453Skarels 			printf("imp%d: can't handle af%d\n", ifp->if_unit,
54233453Skarels 				dst->sa_family);
54333453Skarels 			error = EAFNOSUPPORT;
54434209Skarels 			m0 = m;
5455647Ssam 			goto drop;
5466504Ssam 		}
5475640Sroot 	}
5485640Sroot 	return (impsnd(ifp, m));
5495647Ssam drop:
5505647Ssam 	m_freem(m0);
5516504Ssam 	return (error);
5525640Sroot }
5535640Sroot 
5545640Sroot /*
5555640Sroot  * Put a message on an interface's output queue.
5565640Sroot  * Perform RFNM counting: no more than 8 message may be
5575640Sroot  * in flight to any one host.
5585640Sroot  */
5595640Sroot impsnd(ifp, m)
5605640Sroot 	struct ifnet *ifp;
5615640Sroot 	struct mbuf *m;
5625640Sroot {
56333427Skarels 	register struct control_leader *imp;
5645640Sroot 	register struct host *hp;
56533453Skarels 	register struct imp_softc *sc = &imp_softc[ifp->if_unit];
56633453Skarels 	int s, error = 0;
5675640Sroot 
56833427Skarels 	imp = mtod(m, struct control_leader *);
5695640Sroot 
5705640Sroot 	/*
5715640Sroot 	 * Do RFNM counting for data messages
57233453Skarels 	 * (no more than 8 outstanding to any host).
57333453Skarels 	 * Queue data messages per host if 8 are already outstanding
57433453Skarels 	 * or if the hardware interface is already doing output.
57533453Skarels 	 * Increment imp_msgready if the message could be sent now,
57633453Skarels 	 * but must be queued because the imp output is busy.
5775640Sroot 	 */
5786588Ssam 	s = splimp();
57933427Skarels 	if (imp->dl_mtype == IMPTYPE_DATA) {
58034509Skarels 		hp = hostenter((int)imp->dl_imp, (int)imp->dl_host,
58134509Skarels 		    ifp->if_unit);
5825640Sroot 		if (hp) {
58334209Skarels 			if (hp->h_flags & (HF_DEAD|HF_UNREACH))
58434209Skarels 				error = hp->h_flags & HF_DEAD ?
58534209Skarels 				    EHOSTDOWN : EHOSTUNREACH;
58634209Skarels 			else if (hp->h_rfnm < IMP_MAXHOSTMSG &&
58734209Skarels 			    sc->imp_cb.ic_oactive == 0) {
58834209Skarels 				/*
58934209Skarels 				 * Send without queuing;
59034209Skarels 				 * adjust rfnm count and timer.
59134209Skarels 				 */
59234209Skarels 				if (hp->h_rfnm++ == 0)
59334209Skarels 				    hp->h_timer = RFNMTIMER;
59434209Skarels 				goto send;
59533453Skarels 			} else if (hp->h_rfnm + hp->h_qcnt < imphqlen) {
5966095Swnj 				HOST_ENQUE(hp, m);
59734209Skarels 				if (hp->h_rfnm + hp->h_qcnt <= IMP_MAXHOSTMSG)
59834209Skarels 					sc->imp_msgready++;
59934272Skarels 			} else {
60033453Skarels 				error = ENOBUFS;
60134272Skarels 				IF_DROP(&ifp->if_snd);
60234272Skarels 			}
60333453Skarels 		} else
60433453Skarels 			error = ENOBUFS;
60533453Skarels 	} else if (sc->imp_cb.ic_oactive == 0)
60633453Skarels 		goto send;
60733453Skarels 	else
60833453Skarels 		IF_ENQUEUE(&ifp->if_snd, m);
60934209Skarels 
61033453Skarels 	splx(s);
61134209Skarels 	if (error)
61234209Skarels 		m_freem(m);
61334209Skarels 	return (error);
61433453Skarels 
61533453Skarels send:
61633453Skarels 	sc->imp_if.if_timer = IMP_OTIMER;
61733453Skarels 	(*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m);
61833453Skarels 	splx(s);
61933453Skarels 	return (0);
62033453Skarels }
62133453Skarels 
62233453Skarels /*
62333453Skarels  * Start another output operation on IMP; called from hardware
62433453Skarels  * transmit-complete interrupt routine at splimp or from imp routines
62534209Skarels  * when output is not in progress.  If there are any packets on shared
62634209Skarels  * output queue, send them, otherwise send the next data packet for a host.
62734209Skarels  * Host data packets are sent round-robin based on destination by walking
62834209Skarels  * the host list.
62933453Skarels  */
63033453Skarels impstart(sc)
63133453Skarels 	register struct imp_softc *sc;
63233453Skarels {
63333453Skarels 	register struct mbuf *m;
63434209Skarels 	int first = 1;				/* XXX */
63533453Skarels 	register struct host *hp;
63633453Skarels 	int index;
63733453Skarels 
63833453Skarels 	IF_DEQUEUE(&sc->imp_if.if_snd, m);
63933453Skarels 	if (m) {
64033453Skarels 		sc->imp_if.if_timer = IMP_OTIMER;
64133453Skarels 		(*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m);
64233453Skarels 		return;
64333453Skarels 	}
64433453Skarels 	if (sc->imp_msgready) {
64533453Skarels 		if ((m = sc->imp_hostq) == 0 && (m = sc->imp_hosts) == 0)
64634209Skarels 			panic("imp msgready");
64734209Skarels 		index = sc->imp_hostent;
64834209Skarels 		for (hp = &mtod(m, struct hmbuf *)->hm_hosts[index]; ;
64934209Skarels 		    hp++, index++) {
65034209Skarels 			if (index >= HPMBUF) {
65134209Skarels 				if ((m = m->m_next) == 0)
65234209Skarels 					m = sc->imp_hosts;
65334209Skarels 				index = 0;
65434209Skarels 				hp = mtod(m, struct hmbuf *)->hm_hosts;
65534209Skarels 				first = 0;		/* XXX */
6566095Swnj 			}
65734209Skarels 			if (hp->h_qcnt && hp->h_rfnm < IMP_MAXHOSTMSG) {
65834209Skarels 				/*
65934209Skarels 				 * Found host entry with another message
66034209Skarels 				 * to send.  Deliver it to the IMP.
66134209Skarels 				 * Start with succeeding host next time.
66234209Skarels 				 */
66334209Skarels 				impstarthost(sc, hp);
66434209Skarels 				sc->imp_hostq = m;
66534209Skarels 				sc->imp_hostent = index + 1;
66634209Skarels 				return;
66733453Skarels 			}
66834209Skarels 			if (m == sc->imp_hostq && !first &&
66934209Skarels 			    index + 1 >= sc->imp_hostent) {	/* XXX */
67034209Skarels 				log(imppri, "imp: can't find %d msgready\n",
67134209Skarels 				    sc->imp_msgready);
67234209Skarels 				sc->imp_msgready = 0;
67334209Skarels 				break;
67434209Skarels 			}
6755640Sroot 		}
6765640Sroot 	}
67733453Skarels 	sc->imp_if.if_timer = 0;
67833453Skarels }
67933453Skarels 
68033453Skarels /*
68134209Skarels  * Restart output for a host that has received a RFNM
68234209Skarels  * or incomplete or has timed out while waiting for a RFNM.
68333453Skarels  * Must be called at splimp.
68433453Skarels  */
68534209Skarels imprestarthost(sc, hp)
68634209Skarels 	register struct imp_softc *sc;
68733453Skarels 	struct host *hp;
68833453Skarels {
68933453Skarels 
69033453Skarels 	if (--hp->h_rfnm > 0)
69133453Skarels 		hp->h_timer = RFNMTIMER;
69234209Skarels 	/*
69334209Skarels 	 * If the RFNM moved a queued message into the window,
69434209Skarels 	 * update msgready and start IMP if idle.
69534209Skarels 	 */
69634209Skarels 	if (hp->h_qcnt > IMP_MAXHOSTMSG - 1 - hp->h_rfnm) {
69734209Skarels 		sc->imp_msgready++;
69833453Skarels 		if (sc->imp_cb.ic_oactive == 0)
69933453Skarels 			impstarthost(sc, hp);
7006208Swnj 	}
70134209Skarels 	if (hp->h_rfnm == 0 && hp->h_qcnt == 0)
70234209Skarels 		hostidle(hp);
7035640Sroot }
7045640Sroot 
7055640Sroot /*
70633453Skarels  * Send the next message queued for a host
70733453Skarels  * when ready to send another message to the IMP.
70833453Skarels  * Called only when output is not in progress.
70933453Skarels  * Bump RFNM counter and start RFNM timer
71033453Skarels  * when we send the message to the IMP.
71133453Skarels  * Must be called at splimp.
71233453Skarels  */
71333453Skarels impstarthost(sc, hp)
71433453Skarels 	register struct imp_softc *sc;
71533453Skarels 	register struct host *hp;
71633453Skarels {
71733453Skarels 	struct mbuf *m;
71833453Skarels 
71933453Skarels 	if (hp->h_rfnm++ == 0)
72033453Skarels 		hp->h_timer = RFNMTIMER;
72133453Skarels 	HOST_DEQUE(hp, m);
72233453Skarels 	sc->imp_if.if_timer = IMP_OTIMER;
72333453Skarels 	(*sc->imp_cb.ic_output)(sc->imp_cb.ic_hwunit, m);
72433453Skarels 	sc->imp_msgready--;
72533453Skarels }
72633453Skarels 
72733453Skarels /*
72833453Skarels  * "Watchdog" timeout.  When the output timer expires,
72933453Skarels  * we assume we have been blocked by the imp.
73033453Skarels  * No need to restart, just collect statistics.
73133453Skarels  */
73233453Skarels imptimo(unit)
73333453Skarels 	int unit;
73433453Skarels {
73533453Skarels 
73633453Skarels 	imp_softc[unit].imp_block++;
73733453Skarels }
73833453Skarels 
73933453Skarels /*
7405640Sroot  * Put three 1822 NOOPs at the head of the output queue.
7415640Sroot  * Part of host-IMP initialization procedure.
7425640Sroot  * (Should return success/failure, but noone knows
7435640Sroot  * what to do with this, so why bother?)
7446818Ssam  * This routine is always called at splimp, so we don't
7456818Ssam  * protect the call to IF_PREPEND.
7465640Sroot  */
7475640Sroot impnoops(sc)
7485640Sroot 	register struct imp_softc *sc;
7495640Sroot {
7505640Sroot 	register i;
7515640Sroot 	register struct mbuf *m;
7525771Swnj 	register struct control_leader *cp;
7535640Sroot 
75433427Skarels #ifdef IMPINIT
75533427Skarels 	if (imptraceinit)
75633427Skarels 		log(imppri, "impnoops\n");
75733427Skarels #endif
75833427Skarels 	for (i = 0; i < IMP_NOOPCNT; i++) {
7599645Ssam 		if ((m = m_getclr(M_DONTWAIT, MT_HEADER)) == 0)
7605640Sroot 			return;
7615771Swnj 		m->m_len = sizeof(struct control_leader);
7625771Swnj 		cp = mtod(m, struct control_leader *);
7635771Swnj 		cp->dl_format = IMP_NFF;
76433427Skarels 		cp->dl_link = i;
76533427Skarels 		cp->dl_mtype = IMPTYPE_NOOP;
7665640Sroot 		IF_PREPEND(&sc->imp_if.if_snd, m);
7675640Sroot 	}
7685640Sroot 	if (sc->imp_cb.ic_oactive == 0)
76933453Skarels 		impstart(sc);
7705640Sroot }
7717170Ssam 
77213067Ssam /*
77313067Ssam  * Process an ioctl request.
77413067Ssam  */
77513067Ssam impioctl(ifp, cmd, data)
77613067Ssam 	register struct ifnet *ifp;
77713067Ssam 	int cmd;
77813067Ssam 	caddr_t data;
77913067Ssam {
78018412Skarels 	struct ifaddr *ifa = (struct ifaddr *) data;
78113067Ssam 	int s = splimp(), error = 0;
78233427Skarels #define sc	((struct imp_softc *)ifp)
78313067Ssam 
78413067Ssam 	switch (cmd) {
78513067Ssam 
78613067Ssam 	case SIOCSIFADDR:
78718412Skarels 		if (ifa->ifa_addr.sa_family != AF_INET) {
78818412Skarels 			error = EINVAL;
78918412Skarels 			break;
79018412Skarels 		}
79133427Skarels 		if ((ifp->if_flags & IFF_UP) == 0)
79213067Ssam 			impinit(ifp->if_unit);
79313067Ssam 		break;
79413067Ssam 
79533427Skarels 	case SIOCSIFFLAGS:
79633427Skarels 		if ((ifp->if_flags & IFF_UP) == 0 &&
79733427Skarels 		    sc->imp_state != IMPS_DOWN) {
79833453Skarels 			if (sc->imp_cb.ic_down &&
79934209Skarels 			    (*sc->imp_cb.ic_down)(sc->imp_cb.ic_hwunit)) {
80033427Skarels 				sc->imp_state = IMPS_DOWN;
80134209Skarels 				sc->imp_msgready = 0;
80234209Skarels 				hostreset(ifp->if_unit);
80334272Skarels 				if_down(ifp);
80434209Skarels 			}
80533427Skarels 		} else if (ifp->if_flags & IFF_UP && sc->imp_state == IMPS_DOWN)
80633427Skarels 			impinit(ifp->if_unit);
80733427Skarels 		break;
80833427Skarels 
80913067Ssam 	default:
81013067Ssam 		error = EINVAL;
81133427Skarels 		break;
81213067Ssam 	}
81313067Ssam 	splx(s);
81413067Ssam 	return (error);
81513067Ssam }
81613067Ssam 
8177170Ssam #ifdef IMPLEADERS
8187170Ssam printleader(routine, ip)
8197170Ssam 	char *routine;
8207170Ssam 	register struct imp_leader *ip;
8217170Ssam {
8227170Ssam 	printf("%s: ", routine);
8237170Ssam 	printbyte((char *)ip, 12);
8247170Ssam 	printf("<fmt=%x,net=%x,flags=%x,mtype=", ip->il_format, ip->il_network,
8257170Ssam 		ip->il_flags);
8267170Ssam 	if (ip->il_mtype <= IMPTYPE_READY)
8277170Ssam 		printf("%s,", impleaders[ip->il_mtype]);
8287170Ssam 	else
8297170Ssam 		printf("%x,", ip->il_mtype);
8307170Ssam 	printf("htype=%x,host=%x,imp=%x,link=", ip->il_htype, ip->il_host,
8317170Ssam 		ntohs(ip->il_imp));
8327170Ssam 	if (ip->il_link == IMPLINK_IP)
8337170Ssam 		printf("ip,");
8347170Ssam 	else
8357170Ssam 		printf("%x,", ip->il_link);
8367170Ssam 	printf("subtype=%x,len=%x>\n",ip->il_subtype,ntohs(ip->il_length)>>3);
8377170Ssam }
8387170Ssam 
8397170Ssam printbyte(cp, n)
8407170Ssam 	register char *cp;
8417170Ssam 	int n;
8427170Ssam {
8437170Ssam 	register i, j, c;
8447170Ssam 
8457170Ssam 	for (i=0; i<n; i++) {
8467170Ssam 		c = *cp++;
8477170Ssam 		for (j=0; j<2; j++)
84824777Skarels 			putchar("0123456789abcdef"[(c>>((1-j)*4))&0xf], 0);
84924777Skarels 		putchar(' ', 0);
8507170Ssam 	}
85124777Skarels 	putchar('\n', 0);
8527170Ssam }
8535640Sroot #endif
85418132Skarels 
85518132Skarels /*
85618132Skarels  * Routine to convert from IMP Leader to InterNet Address.
85718132Skarels  *
85818132Skarels  * This procedure is necessary because IMPs may be assigned Class A, B, or C
85918132Skarels  * network numbers, but only have 8 bits in the leader to reflect the
86018132Skarels  * IMP "network number".  The strategy is to take the network number from
86118132Skarels  * the ifnet structure, and blend in the host-on-imp and imp-on-net numbers
86218132Skarels  * from the leader.
86318132Skarels  *
86418132Skarels  * There is no support for "Logical Hosts".
86518132Skarels  *
86618132Skarels  * Class A:	Net.Host.0.Imp
86718132Skarels  * Class B:	Net.net.Host.Imp
86818132Skarels  * Class C:	Net.net.net.(Host4|Imp4)
86918132Skarels  */
87033427Skarels imp_leader_to_addr(ap, cp, ifp)
87118412Skarels 	struct in_addr *ap;
87233427Skarels 	register struct control_leader *cp;
87318412Skarels 	struct ifnet *ifp;
87418132Skarels {
87526397Skarels 	register u_long final;
87618132Skarels 	register struct sockaddr_in *sin;
87733427Skarels 	int imp = ntohs(cp->dl_imp);
87818132Skarels 
87918412Skarels 	sin = (struct sockaddr_in *)(&ifp->if_addrlist->ifa_addr);
88028849Skarels 	final = ntohl(sin->sin_addr.s_addr);
88118132Skarels 
88218412Skarels 	if (IN_CLASSA(final)) {
88318132Skarels 		final &= IN_CLASSA_NET;
88433427Skarels 		final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<16);
88518412Skarels 	} else if (IN_CLASSB(final)) {
88618132Skarels 		final &= IN_CLASSB_NET;
88733427Skarels 		final |= (imp & 0xFF) | ((cp->dl_host & 0xFF)<<8);
88818132Skarels 	} else {
88918132Skarels 		final &= IN_CLASSC_NET;
89033427Skarels 		final |= (imp & 0x0F) | ((cp->dl_host & 0x0F)<<4);
89118132Skarels 	}
89218412Skarels 	ap->s_addr = htonl(final);
89318132Skarels }
89418132Skarels 
89518132Skarels /*
89618132Skarels  * Function to take InterNet address and fill in IMP leader fields.
89718132Skarels  */
89818412Skarels imp_addr_to_leader(imp, a)
89933427Skarels 	register struct control_leader *imp;
90026397Skarels 	u_long a;
90118132Skarels {
90228849Skarels 	register u_long addr = ntohl(a);
90318132Skarels 
90433427Skarels 	imp->dl_network = 0;	/* !! */
90518132Skarels 
90618412Skarels 	if (IN_CLASSA(addr)) {
90733427Skarels 		imp->dl_host = ((addr>>16) & 0xFF);
90833427Skarels 		imp->dl_imp = addr & 0xFF;
90918412Skarels 	} else if (IN_CLASSB(addr)) {
91033427Skarels 		imp->dl_host = ((addr>>8) & 0xFF);
91133427Skarels 		imp->dl_imp = addr & 0xFF;
91218132Skarels 	} else {
91333427Skarels 		imp->dl_host = ((addr>>4) & 0xF);
91433427Skarels 		imp->dl_imp = addr & 0xF;
91518132Skarels 	}
91633427Skarels 	imp->dl_imp = htons(imp->dl_imp);
91718132Skarels }
9187170Ssam #endif
919