xref: /csrg-svn/sys/vax/if/if_ec.c (revision 7032)
16956Ssam /*	if_ec.c	4.12	82/05/27	*/
26520Sfeldman 
36520Sfeldman #include "ec.h"
46520Sfeldman #include "imp.h"
56545Sfeldman #include "loop.h"
66520Sfeldman 
76520Sfeldman /*
86520Sfeldman  * 3Com Ethernet Controller interface
96520Sfeldman  */
106520Sfeldman 
116520Sfeldman #include "../h/param.h"
126520Sfeldman #include "../h/systm.h"
136520Sfeldman #include "../h/mbuf.h"
146520Sfeldman #include "../h/pte.h"
156520Sfeldman #include "../h/buf.h"
166520Sfeldman #include "../h/protosw.h"
176520Sfeldman #include "../h/socket.h"
186520Sfeldman #include "../h/ubareg.h"
196520Sfeldman #include "../h/ubavar.h"
206520Sfeldman #include "../h/ecreg.h"
216520Sfeldman #include "../h/cpu.h"
226520Sfeldman #include "../h/mtpr.h"
236520Sfeldman #include "../h/vmmac.h"
246520Sfeldman #include "../net/in.h"
256520Sfeldman #include "../net/in_systm.h"
266520Sfeldman #include "../net/if.h"
276520Sfeldman #include "../net/if_ec.h"
286520Sfeldman #include "../net/if_uba.h"
296520Sfeldman #include "../net/ip.h"
306520Sfeldman #include "../net/ip_var.h"
316520Sfeldman #include "../net/pup.h"
326520Sfeldman #include "../net/route.h"
336520Sfeldman #include <errno.h>
346520Sfeldman 
356520Sfeldman #define	ECMTU	1500
366520Sfeldman 
376520Sfeldman int	ecprobe(), ecattach(), ecrint(), ecxint(), eccollide();
386520Sfeldman struct	uba_device *ecinfo[NEC];
396520Sfeldman u_short ecstd[] = { 0 };
406520Sfeldman struct	uba_driver ecdriver =
416520Sfeldman 	{ ecprobe, 0, ecattach, 0, ecstd, "ec", ecinfo };
426892Sfeldman u_char	ec_iltop[3] = { 0x02, 0x07, 0x01 };
436520Sfeldman #define	ECUNIT(x)	minor(x)
446520Sfeldman 
456520Sfeldman int	ecinit(),ecoutput(),ecreset();
466520Sfeldman struct mbuf *ecget();
476520Sfeldman 
486545Sfeldman extern struct ifnet loif;
496545Sfeldman 
506520Sfeldman /*
516520Sfeldman  * Ethernet software status per interface.
526520Sfeldman  *
536520Sfeldman  * Each interface is referenced by a network interface structure,
546520Sfeldman  * es_if, which the routing code uses to locate the interface.
556520Sfeldman  * This structure contains the output queue for the interface, its address, ...
566520Sfeldman  * We also have, for each interface, a UBA interface structure, which
576520Sfeldman  * contains information about the UNIBUS resources held by the interface:
586520Sfeldman  * map registers, buffered data paths, etc.  Information is cached in this
596520Sfeldman  * structure for use by the if_uba.c routines in running the interface
606520Sfeldman  * efficiently.
616520Sfeldman  */
626520Sfeldman struct	ec_softc {
636520Sfeldman 	struct	ifnet es_if;		/* network-visible interface */
646520Sfeldman 	struct	ifuba es_ifuba;		/* UNIBUS resources */
656520Sfeldman 	short	es_mask;		/* mask for current output delay */
666520Sfeldman 	short	es_oactive;		/* is output active? */
676520Sfeldman 	caddr_t	es_buf[16];		/* virtual addresses of buffers */
686520Sfeldman 	u_char	es_enaddr[6];		/* board's ethernet address */
696520Sfeldman } ec_softc[NEC];
706520Sfeldman 
716520Sfeldman /*
726520Sfeldman  * Do output DMA to determine interface presence and
736520Sfeldman  * interrupt vector.  DMA is too short to disturb other hosts.
746520Sfeldman  */
756520Sfeldman ecprobe(reg)
766520Sfeldman 	caddr_t reg;
776520Sfeldman {
786520Sfeldman 	register int br, cvec;		/* r11, r10 value-result */
796520Sfeldman 	register struct ecdevice *addr = (struct ecdevice *)reg;
806520Sfeldman 	register caddr_t ecbuf = (caddr_t) &umem[0][0600000];
816520Sfeldman 
826520Sfeldman COUNT(ECPROBE);
836520Sfeldman #ifdef lint
846520Sfeldman 	br = 0; cvec = br; br = cvec;
856520Sfeldman 	ecrint(0); ecxint(0); eccollide(0);
866520Sfeldman #endif
876520Sfeldman 	/*
886637Sfeldman 	 * Make sure memory is turned on
896637Sfeldman 	 */
906637Sfeldman 	addr->ec_rcr = EC_AROM;
916637Sfeldman 	/*
926520Sfeldman 	 * Check for existence of buffers on Unibus.
936520Sfeldman 	 * This won't work on a 780 until more work is done.
946520Sfeldman 	 */
956520Sfeldman 	if (badaddr((caddr_t) ecbuf, 2)) {
966520Sfeldman 		printf("ec: buffer mem not found");
976520Sfeldman 		return (0);
986520Sfeldman 	}
996520Sfeldman 
1006520Sfeldman 	/*
1016520Sfeldman 	 * Tell the system that the board has memory here, so it won't
1026520Sfeldman 	 * attempt to allocate the addresses later.
1036520Sfeldman 	 */
1046520Sfeldman 	ubamem(0, 0600000, 32*2);
1056520Sfeldman 
1066520Sfeldman 	/*
1076520Sfeldman 	 * Make a one byte packet in what should be buffer #0.
1086520Sfeldman 	 * Submit it for sending.  This whould cause an xmit interrupt.
1096520Sfeldman 	 * The xmit interrupt vector is 8 bytes after the receive vector,
1106520Sfeldman 	 * so adjust for this before returning.
1116520Sfeldman 	 */
1126520Sfeldman 	*(u_short *)ecbuf = (u_short) 03777;
1136520Sfeldman 	ecbuf[03777] = '\0';
1146520Sfeldman 	addr->ec_xcr = EC_XINTEN|EC_XWBN;
1156520Sfeldman 	DELAY(100000);
1166520Sfeldman 	addr->ec_xcr = EC_XCLR;
1176520Sfeldman 	if (cvec > 0 && cvec != 0x200)
1186520Sfeldman 		cvec -= 010;
1196520Sfeldman 		br += 2;
1206520Sfeldman 	return (1);
1216520Sfeldman }
1226520Sfeldman 
1236520Sfeldman /*
1246520Sfeldman  * Interface exists: make available by filling in network interface
1256520Sfeldman  * record.  System will initialize the interface when it is ready
1266520Sfeldman  * to accept packets.
1276520Sfeldman  */
1286520Sfeldman ecattach(ui)
1296520Sfeldman 	struct uba_device *ui;
1306520Sfeldman {
1316520Sfeldman 	register struct ec_softc *es = &ec_softc[ui->ui_unit];
1326520Sfeldman 	register struct sockaddr_in *sin;
1336520Sfeldman 	register struct ecdevice *addr = (struct ecdevice *)ui->ui_addr;
1346520Sfeldman 	register int i, j;
1356520Sfeldman 	register u_char *cp;
1366520Sfeldman COUNT(ECATTACH);
1376520Sfeldman 
1386520Sfeldman 	es->es_if.if_unit = ui->ui_unit;
1396520Sfeldman 	es->es_if.if_name = "ec";
1406520Sfeldman 	es->es_if.if_mtu = ECMTU;
1416520Sfeldman 	es->es_if.if_net = ui->ui_flags & 0xff;
1426520Sfeldman 
1436520Sfeldman 	/*
1446520Sfeldman 	 * Read the ethernet address off the board,
1456520Sfeldman 	 * one nibble at a time!
1466520Sfeldman 	 */
1476520Sfeldman 	addr->ec_xcr = EC_UECLR;
1486520Sfeldman 	addr->ec_rcr = EC_AROM;
1496520Sfeldman 	cp = es->es_enaddr;
1506520Sfeldman 	for (i=0; i<6; i++) {
1516520Sfeldman 		*cp = 0;
1526520Sfeldman 		for (j=0; j<=4; j+=4) {
1536520Sfeldman 			*cp |= ((addr->ec_rcr >> 8) & 0xf) << j;
1546520Sfeldman 			addr->ec_rcr = EC_AROM|EC_ASTEP;
1556520Sfeldman 			addr->ec_rcr = EC_AROM;
1566520Sfeldman 			addr->ec_rcr = EC_AROM|EC_ASTEP;
1576520Sfeldman 			addr->ec_rcr = EC_AROM;
1586520Sfeldman 			addr->ec_rcr = EC_AROM|EC_ASTEP;
1596520Sfeldman 			addr->ec_rcr = EC_AROM;
1606520Sfeldman 			addr->ec_rcr = EC_AROM|EC_ASTEP;
1616520Sfeldman 			addr->ec_rcr = EC_AROM;
1626520Sfeldman 		}
1636520Sfeldman 		cp++;
1646520Sfeldman 	}
1656520Sfeldman 	printf("ec%d: addr=%x:%x:%x:%x:%x:%x\n", ui->ui_unit,
1666520Sfeldman 		es->es_enaddr[0]&0xff, es->es_enaddr[1]&0xff,
1676520Sfeldman 		es->es_enaddr[2]&0xff, es->es_enaddr[3]&0xff,
1686520Sfeldman 		es->es_enaddr[4]&0xff, es->es_enaddr[5]&0xff);
1696520Sfeldman 	es->es_if.if_host[0] = ((es->es_enaddr[3]&0xff)<<16) |
1706520Sfeldman 	    ((es->es_enaddr[4]&0xff)<<8) | (es->es_enaddr[5]&0xff);
1716520Sfeldman 	sin = (struct sockaddr_in *)&es->es_if.if_addr;
1726520Sfeldman 	sin->sin_family = AF_INET;
1736520Sfeldman 	sin->sin_addr = if_makeaddr(es->es_if.if_net, es->es_if.if_host[0]);
1746520Sfeldman 
1756520Sfeldman 	sin = (struct sockaddr_in *)&es->es_if.if_broadaddr;
1766520Sfeldman 	sin->sin_family = AF_INET;
1776520Sfeldman 	sin->sin_addr = if_makeaddr(es->es_if.if_net, 0);
1786520Sfeldman 	es->es_if.if_flags = IFF_BROADCAST;
1796520Sfeldman 
1806520Sfeldman 	es->es_if.if_init = ecinit;
1816520Sfeldman 	es->es_if.if_output = ecoutput;
1826520Sfeldman 	es->es_if.if_ubareset = ecreset;
1836520Sfeldman 	for (i=0; i<16; i++)
1846520Sfeldman 		es->es_buf[i] = &umem[ui->ui_ubanum][0600000+2048*i];
1856520Sfeldman 	if_attach(&es->es_if);
1866520Sfeldman #if NIMP == 0
1876520Sfeldman 	/* here's one for you john baby.... */
1886520Sfeldman 	if (ui->ui_flags &~ 0xff)
1896924Swnj 		eclhinit(&es->es_if, (ui->ui_flags &~ 0xff) | 0x0a);
1906520Sfeldman #endif
1916520Sfeldman }
1926520Sfeldman 
1936520Sfeldman /*
1946520Sfeldman  * Reset of interface after UNIBUS reset.
1956520Sfeldman  * If interface is on specified uba, reset its state.
1966520Sfeldman  */
1976520Sfeldman ecreset(unit, uban)
1986520Sfeldman 	int unit, uban;
1996520Sfeldman {
2006520Sfeldman 	register struct uba_device *ui;
2016520Sfeldman COUNT(ECRESET);
2026520Sfeldman 
2036520Sfeldman 	if (unit >= NEC || (ui = ecinfo[unit]) == 0 || ui->ui_alive == 0 ||
2046520Sfeldman 	    ui->ui_ubanum != uban)
2056520Sfeldman 		return;
2066520Sfeldman 	printf(" ec%d", unit);
2076520Sfeldman 	ecinit(unit);
2086520Sfeldman }
2096520Sfeldman 
2106520Sfeldman /*
2116520Sfeldman  * Initialization of interface; clear recorded pending
2126520Sfeldman  * operations, and reinitialize UNIBUS usage.
2136520Sfeldman  */
2146520Sfeldman ecinit(unit)
2156520Sfeldman 	int unit;
2166520Sfeldman {
2176520Sfeldman 	register struct ec_softc *es = &ec_softc[unit];
2186520Sfeldman 	register struct uba_device *ui = ecinfo[unit];
2196520Sfeldman 	register struct ecdevice *addr;
2206520Sfeldman 	register i;
2216520Sfeldman 	int s;
2226520Sfeldman 
2236520Sfeldman 	addr = (struct ecdevice *)ui->ui_addr;
2246520Sfeldman 
2256520Sfeldman 	/*
2266520Sfeldman 	 * Hang receive buffers and start any pending
2276520Sfeldman 	 * writes by faking a transmit complete.
2286637Sfeldman 	 * Writing into the rcr also makes sure the memory
2296637Sfeldman 	 * is turned on.
2306520Sfeldman 	 */
2316520Sfeldman 	s = splimp();
2326520Sfeldman 	for (i=ECRHBF; i>=ECRLBF; i--)
2336520Sfeldman 		addr->ec_rcr = EC_READ|i;
2346520Sfeldman 	es->es_oactive = 1;
2356520Sfeldman 	es->es_if.if_flags |= IFF_UP;
2366520Sfeldman 	ecxint(unit);
2376520Sfeldman 	splx(s);
2386520Sfeldman 	if_rtinit(&es->es_if, RTF_DIRECT|RTF_UP);
2396520Sfeldman }
2406520Sfeldman 
2416520Sfeldman /*
2426520Sfeldman  * Start or restart output on interface.
2436520Sfeldman  * If interface is already active, then this is a retransmit
2446545Sfeldman  * after a collision, and just restuff registers.
2456520Sfeldman  * If interface is not already active, get another datagram
2466520Sfeldman  * to send off of the interface queue, and map it to the interface
2476520Sfeldman  * before starting the output.
2486520Sfeldman  */
2496520Sfeldman ecstart(dev)
2506520Sfeldman 	dev_t dev;
2516520Sfeldman {
2526520Sfeldman         int unit = ECUNIT(dev);
2536520Sfeldman 	struct uba_device *ui = ecinfo[unit];
2546520Sfeldman 	register struct ec_softc *es = &ec_softc[unit];
2556520Sfeldman 	register struct ecdevice *addr;
2566520Sfeldman 	struct mbuf *m;
2576520Sfeldman 	caddr_t ecbuf;
2586520Sfeldman 	int dest;
2596520Sfeldman COUNT(ECSTART);
2606520Sfeldman 
2616520Sfeldman 	if (es->es_oactive)
2626520Sfeldman 		goto restart;
2636520Sfeldman 
2646520Sfeldman 	/*
2656520Sfeldman 	 * Not already active: dequeue another request
2666520Sfeldman 	 * and copy it into the buffer.  If no more requests,
2676520Sfeldman 	 * just return.
2686520Sfeldman 	 */
2696520Sfeldman 	IF_DEQUEUE(&es->es_if.if_snd, m);
2706520Sfeldman 	if (m == 0) {
2716520Sfeldman 		es->es_oactive = 0;
2726520Sfeldman 		return;
2736520Sfeldman 	}
2746520Sfeldman 	ecput(es->es_buf[ECTBF], m);
2756520Sfeldman 
2766520Sfeldman restart:
2776520Sfeldman 	/*
2786520Sfeldman 	 * Start the output.
2796520Sfeldman 	 */
2806520Sfeldman 	addr = (struct ecdevice *)ui->ui_addr;
2816520Sfeldman 	addr->ec_xcr = EC_WRITE|ECTBF;
2826520Sfeldman 	es->es_oactive = 1;
2836520Sfeldman }
2846520Sfeldman 
2856520Sfeldman /*
2866520Sfeldman  * Ethernet interface transmitter interrupt.
2876520Sfeldman  * Start another output if more data to send.
2886520Sfeldman  */
2896520Sfeldman ecxint(unit)
2906520Sfeldman 	int unit;
2916520Sfeldman {
2926520Sfeldman 	register struct uba_device *ui = ecinfo[unit];
2936520Sfeldman 	register struct ec_softc *es = &ec_softc[unit];
2946520Sfeldman 	register struct ecdevice *addr = (struct ecdevice *)ui->ui_addr;
2956520Sfeldman COUNT(ECXINT);
2966520Sfeldman 
2976520Sfeldman 	if (es->es_oactive == 0)
2986520Sfeldman 		return;
2996520Sfeldman 	if (addr->ec_xcr&EC_XDONE == 0 || addr->ec_xcr&EC_XBN != ECTBF)
3006520Sfeldman 		printf("ec%d: strange xmit interrupt!\n", unit);
3016520Sfeldman 	es->es_if.if_opackets++;
3026520Sfeldman 	es->es_oactive = 0;
3036520Sfeldman 	es->es_mask = ~0;
3046520Sfeldman 	addr->ec_xcr = EC_XCLR;
3056520Sfeldman 	/*
3066520Sfeldman 	 * There shouldn't ever be any mbuf's to free, but just in case...
3076520Sfeldman 	 */
3086520Sfeldman 	if (es->es_ifuba.ifu_xtofree) {
3096520Sfeldman 		m_freem(es->es_ifuba.ifu_xtofree);
3106520Sfeldman 		es->es_ifuba.ifu_xtofree = 0;
3116520Sfeldman 	}
3126892Sfeldman 	if (es->es_if.if_snd.ifq_head == 0) {
3136520Sfeldman 		return;
3146892Sfeldman 	}
3156520Sfeldman 	ecstart(unit);
3166520Sfeldman }
3176520Sfeldman 
3186520Sfeldman /*
3196520Sfeldman  * Collision on ethernet interface.  Do exponential
3206520Sfeldman  * backoff, and retransmit.  If have backed off all
3216520Sfeldman  * the way print warning diagnostic, and drop packet.
3226520Sfeldman  */
3236520Sfeldman eccollide(unit)
3246520Sfeldman 	int unit;
3256520Sfeldman {
3266520Sfeldman 	struct ec_softc *es = &ec_softc[unit];
3276520Sfeldman COUNT(ECCOLLIDE);
3286520Sfeldman 
3296545Sfeldman 	printf("ec%d: collision\n", unit);
3306520Sfeldman 	es->es_if.if_collisions++;
3316520Sfeldman 	if (es->es_oactive == 0)
3326520Sfeldman 		return;
3336520Sfeldman 	ecdocoll(unit);
3346520Sfeldman }
3356520Sfeldman 
3366520Sfeldman ecdocoll(unit)
3376520Sfeldman 	int unit;
3386520Sfeldman {
3396520Sfeldman 	register struct ec_softc *es = &ec_softc[unit];
3406545Sfeldman 	register struct ecdevice *addr =
3416545Sfeldman 	    (struct ecdevice *)ecinfo[unit]->ui_addr;
3426545Sfeldman 	register i;
3436545Sfeldman 	int delay;
3446520Sfeldman 
3456520Sfeldman 	/*
3466520Sfeldman 	 * Es_mask is a 16 bit number with n low zero bits, with
3476520Sfeldman 	 * n the number of backoffs.  When es_mask is 0 we have
3486520Sfeldman 	 * backed off 16 times, and give up.
3496520Sfeldman 	 */
3506520Sfeldman 	if (es->es_mask == 0) {
3516545Sfeldman 		es->es_if.if_oerrors++;
3526520Sfeldman 		printf("ec%d: send error\n", unit);
3536520Sfeldman 		/*
3546545Sfeldman 		 * Reset interface, then requeue rcv buffers.
3556545Sfeldman 		 * Some incoming packets may be lost, but that
3566545Sfeldman 		 * can't be helped.
3576520Sfeldman 		 */
3586545Sfeldman 		addr->ec_xcr = EC_UECLR;
3596545Sfeldman 		for (i=ECRHBF; i>=ECRLBF; i--)
3606545Sfeldman 			addr->ec_rcr = EC_READ|i;
3616545Sfeldman 		/*
3626545Sfeldman 		 * Reset and transmit next packet (if any).
3636545Sfeldman 		 */
3646545Sfeldman 		es->es_oactive = 0;
3656545Sfeldman 		es->es_mask = ~0;
3666545Sfeldman 		if (es->es_if.if_snd.ifq_head)
3676545Sfeldman 			ecstart(unit);
3686520Sfeldman 		return;
3696520Sfeldman 	}
3706520Sfeldman 	/*
3716545Sfeldman 	 * Do exponential backoff.  Compute delay based on low bits
3726545Sfeldman 	 * of the interval timer.  Then delay for that number of
3736545Sfeldman 	 * slot times.  A slot time is 51.2 microseconds (rounded to 51).
3746545Sfeldman 	 * This does not take into account the time already used to
3756545Sfeldman 	 * process the interrupt.
3766520Sfeldman 	 */
3776520Sfeldman 	es->es_mask <<= 1;
3786545Sfeldman 	delay = mfpr(ICR) &~ es->es_mask;
3796545Sfeldman 	DELAY(delay * 51);
3806520Sfeldman 	/*
3816545Sfeldman 	 * Clear the controller's collision flag, thus enabling retransmit.
3826520Sfeldman 	 */
3836717Sfeldman 	addr->ec_xcr = EC_JINTEN|EC_XINTEN|EC_JCLR;
3846520Sfeldman }
3856520Sfeldman 
3866520Sfeldman /*
3876520Sfeldman  * Ethernet interface receiver interrupt.
3886520Sfeldman  * If input error just drop packet.
3896520Sfeldman  * Otherwise purge input buffered data path and examine
3906520Sfeldman  * packet to determine type.  If can't determine length
3916520Sfeldman  * from type, then have to drop packet.  Othewise decapsulate
3926520Sfeldman  * packet based on type and pass to type specific higher-level
3936520Sfeldman  * input routine.
3946520Sfeldman  */
3956520Sfeldman ecrint(unit)
3966520Sfeldman 	int unit;
3976520Sfeldman {
3986520Sfeldman 	struct ecdevice *addr = (struct ecdevice *)ecinfo[unit]->ui_addr;
3996520Sfeldman COUNT(ECRINT);
4006520Sfeldman 
4016520Sfeldman 	while (addr->ec_rcr & EC_RDONE)
4026520Sfeldman 		ecread(unit);
4036520Sfeldman }
4046520Sfeldman 
4056520Sfeldman ecread(unit)
4066520Sfeldman 	int unit;
4076520Sfeldman {
4086520Sfeldman 	register struct ec_softc *es = &ec_softc[unit];
4096520Sfeldman 	struct ecdevice *addr = (struct ecdevice *)ecinfo[unit]->ui_addr;
4106520Sfeldman 	register struct ec_header *ec;
4116520Sfeldman     	struct mbuf *m;
4126520Sfeldman 	int len, off, resid;
4136520Sfeldman 	register struct ifqueue *inq;
4146520Sfeldman 	caddr_t ecbuf;
4156520Sfeldman 	int ecoff;
4166520Sfeldman 	int buf;
4176520Sfeldman COUNT(ECREAD);
4186520Sfeldman 
4196520Sfeldman 	es->es_if.if_ipackets++;
4206520Sfeldman 	buf = addr->ec_rcr & EC_RBN;
4216520Sfeldman 	if (buf < ECRLBF || buf > ECRHBF)
4226520Sfeldman 		panic("ecrint");
4236520Sfeldman 	ecbuf = es->es_buf[buf];
4246520Sfeldman 	ecoff = *(short *)ecbuf;
4256545Sfeldman 	if (ecoff <= ECRDOFF || ecoff > 2046) {
4266520Sfeldman 		es->es_if.if_ierrors++;
4276520Sfeldman #ifdef notdef
4286520Sfeldman 		if (es->es_if.if_ierrors % 100 == 0)
4296520Sfeldman 			printf("ec%d: += 100 input errors\n", unit);
4306520Sfeldman #endif
4316520Sfeldman 		printf("ec%d: input error (offset=%d)\n", unit, ecoff);
4326520Sfeldman 		goto setup;
4336520Sfeldman 	}
4346520Sfeldman 
4356520Sfeldman 	/*
4366520Sfeldman 	 * Get input data length.
4376520Sfeldman 	 * Get pointer to ethernet header (in input buffer).
4386520Sfeldman 	 * Deal with trailer protocol: if type is PUP trailer
4396520Sfeldman 	 * get true type from first 16-bit word past data.
4406520Sfeldman 	 * Remember that type was trailer by setting off.
4416520Sfeldman 	 */
4426520Sfeldman 	len = ecoff - ECRDOFF - sizeof (struct ec_header);
4436520Sfeldman 	ec = (struct ec_header *)(ecbuf + ECRDOFF);
4446520Sfeldman #define	ecdataaddr(ec, off, type)	((type)(((caddr_t)((ec)+1)+(off))))
4456520Sfeldman 	if (ec->ec_type >= ECPUP_TRAIL &&
4466520Sfeldman 	    ec->ec_type < ECPUP_TRAIL+ECPUP_NTRAILER) {
4476520Sfeldman 		off = (ec->ec_type - ECPUP_TRAIL) * 512;
4486520Sfeldman 		if (off >= ECMTU)
4496520Sfeldman 			goto setup;		/* sanity */
4506520Sfeldman 		ec->ec_type = *ecdataaddr(ec, off, u_short *);
4516520Sfeldman 		resid = *(ecdataaddr(ec, off+2, u_short *));
4526520Sfeldman 		if (off + resid > len)
4536520Sfeldman 			goto setup;		/* sanity */
4546520Sfeldman 		len = off + resid;
4556520Sfeldman 	} else
4566520Sfeldman 		off = 0;
4576520Sfeldman 	if (len == 0)
4586520Sfeldman 		goto setup;
4596520Sfeldman 
4606520Sfeldman 	/*
4616520Sfeldman 	 * Pull packet off interface.  Off is nonzero if packet
4626520Sfeldman 	 * has trailing header; ecget will then force this header
4636520Sfeldman 	 * information to be at the front, but we still have to drop
4646520Sfeldman 	 * the type and length which are at the front of any trailer data.
4656520Sfeldman 	 */
4666520Sfeldman 	m = ecget(ecbuf, len, off);
4676520Sfeldman 	if (m == 0)
4686520Sfeldman 		goto setup;
4696520Sfeldman 	if (off) {
4706520Sfeldman 		m->m_off += 2 * sizeof (u_short);
4716520Sfeldman 		m->m_len -= 2 * sizeof (u_short);
4726520Sfeldman 	}
4736520Sfeldman 	switch (ec->ec_type) {
4746520Sfeldman 
4756520Sfeldman #ifdef INET
4766520Sfeldman 	case ECPUP_IPTYPE:
4776520Sfeldman 		schednetisr(NETISR_IP);
4786520Sfeldman 		inq = &ipintrq;
4796520Sfeldman 		break;
4806520Sfeldman #endif
4816520Sfeldman 	default:
4826520Sfeldman 		m_freem(m);
4836520Sfeldman 		goto setup;
4846520Sfeldman 	}
4856520Sfeldman 
4866520Sfeldman 	if (IF_QFULL(inq)) {
4876520Sfeldman 		IF_DROP(inq);
4886520Sfeldman 		m_freem(m);
4896520Sfeldman 	} else
4906520Sfeldman 		IF_ENQUEUE(inq, m);
4916520Sfeldman 
4926520Sfeldman setup:
4936520Sfeldman 	/*
4946520Sfeldman 	 * Reset for next packet.
4956520Sfeldman 	 */
4966520Sfeldman 	addr->ec_rcr = EC_READ|EC_RCLR|buf;
4976520Sfeldman }
4986520Sfeldman 
4996520Sfeldman /*
5006520Sfeldman  * Ethernet output routine.
5016520Sfeldman  * Encapsulate a packet of type family for the local net.
5026520Sfeldman  * Use trailer local net encapsulation if enough data in first
5036520Sfeldman  * packet leaves a multiple of 512 bytes of data in remainder.
5046545Sfeldman  * If destination is this address or broadcast, send packet to
5056545Sfeldman  * loop device to kludge around the fact that 3com interfaces can't
5066545Sfeldman  * talk to themselves.
5076520Sfeldman  */
5086520Sfeldman ecoutput(ifp, m0, dst)
5096520Sfeldman 	struct ifnet *ifp;
5106520Sfeldman 	struct mbuf *m0;
5116520Sfeldman 	struct sockaddr *dst;
5126520Sfeldman {
5136520Sfeldman 	int type, dest, s, error;
5146520Sfeldman 	register struct ec_softc *es = &ec_softc[ifp->if_unit];
5156520Sfeldman 	register struct mbuf *m = m0;
5166520Sfeldman 	register struct ec_header *ec;
5176520Sfeldman 	register int off;
5186520Sfeldman 	register int i;
5196545Sfeldman 	struct mbuf *mcopy = (struct mbuf *) 0;		/* Null */
5206520Sfeldman 
5216520Sfeldman COUNT(ECOUTPUT);
5226520Sfeldman 	switch (dst->sa_family) {
5236520Sfeldman 
5246520Sfeldman #ifdef INET
5256520Sfeldman 	case AF_INET:
5266520Sfeldman 		dest = ((struct sockaddr_in *)dst)->sin_addr.s_addr;
5276545Sfeldman 		if ((dest &~ 0xff) == 0)
5286545Sfeldman 			mcopy = m_copy(m, 0, M_COPYALL);
5296545Sfeldman 		else if (dest == ((struct sockaddr_in *)&es->es_if.if_addr)->
5306545Sfeldman 		    sin_addr.s_addr) {
5316545Sfeldman 			mcopy = m;
5326545Sfeldman 			goto gotlocal;
5336545Sfeldman 		}
5346520Sfeldman 		off = ntohs((u_short)mtod(m, struct ip *)->ip_len) - m->m_len;
5356520Sfeldman 		if (off > 0 && (off & 0x1ff) == 0 &&
5366520Sfeldman 		    m->m_off >= MMINOFF + 2 * sizeof (u_short)) {
5376520Sfeldman 			type = ECPUP_TRAIL + (off>>9);
5386520Sfeldman 			m->m_off -= 2 * sizeof (u_short);
5396520Sfeldman 			m->m_len += 2 * sizeof (u_short);
5406520Sfeldman 			*mtod(m, u_short *) = ECPUP_IPTYPE;
5416520Sfeldman 			*(mtod(m, u_short *) + 1) = m->m_len;
5426520Sfeldman 			goto gottrailertype;
5436520Sfeldman 		}
5446520Sfeldman 		type = ECPUP_IPTYPE;
5456520Sfeldman 		off = 0;
5466520Sfeldman 		goto gottype;
5476520Sfeldman #endif
5486520Sfeldman 
5496520Sfeldman 	default:
5506520Sfeldman 		printf("ec%d: can't handle af%d\n", ifp->if_unit,
5516520Sfeldman 			dst->sa_family);
5526520Sfeldman 		error = EAFNOSUPPORT;
5536520Sfeldman 		goto bad;
5546520Sfeldman 	}
5556520Sfeldman 
5566520Sfeldman gottrailertype:
5576520Sfeldman 	/*
5586520Sfeldman 	 * Packet to be sent as trailer: move first packet
5596520Sfeldman 	 * (control information) to end of chain.
5606520Sfeldman 	 */
5616520Sfeldman 	while (m->m_next)
5626520Sfeldman 		m = m->m_next;
5636520Sfeldman 	m->m_next = m0;
5646520Sfeldman 	m = m0->m_next;
5656520Sfeldman 	m0->m_next = 0;
5666520Sfeldman 	m0 = m;
5676520Sfeldman 
5686520Sfeldman gottype:
5696520Sfeldman 	/*
5706520Sfeldman 	 * Add local net header.  If no space in first mbuf,
5716520Sfeldman 	 * allocate another.
5726520Sfeldman 	 */
5736520Sfeldman 	if (m->m_off > MMAXOFF ||
5746520Sfeldman 	    MMINOFF + sizeof (struct ec_header) > m->m_off) {
5756520Sfeldman 		m = m_get(M_DONTWAIT);
5766520Sfeldman 		if (m == 0) {
5776520Sfeldman 			error = ENOBUFS;
5786520Sfeldman 			goto bad;
5796520Sfeldman 		}
5806520Sfeldman 		m->m_next = m0;
5816520Sfeldman 		m->m_off = MMINOFF;
5826520Sfeldman 		m->m_len = sizeof (struct ec_header);
5836520Sfeldman 	} else {
5846520Sfeldman 		m->m_off -= sizeof (struct ec_header);
5856520Sfeldman 		m->m_len += sizeof (struct ec_header);
5866520Sfeldman 	}
5876520Sfeldman 	ec = mtod(m, struct ec_header *);
5886520Sfeldman 	for (i=0; i<6; i++)
5896520Sfeldman 		ec->ec_shost[i] = es->es_enaddr[i];
5906525Sfeldman 	if ((dest &~ 0xff) == 0)
5916520Sfeldman 		for (i=0; i<6; i++)
5926520Sfeldman 			ec->ec_dhost[i] = 0xff;
5936520Sfeldman 	else {
5946892Sfeldman 		if (dest & 0x8000) {
5956892Sfeldman 			ec->ec_dhost[0] = ec_iltop[0];
5966892Sfeldman 			ec->ec_dhost[1] = ec_iltop[1];
5976892Sfeldman 			ec->ec_dhost[2] = ec_iltop[2];
5986892Sfeldman 		} else {
5996892Sfeldman 			ec->ec_dhost[0] = es->es_enaddr[0];
6006892Sfeldman 			ec->ec_dhost[1] = es->es_enaddr[1];
6016892Sfeldman 			ec->ec_dhost[2] = es->es_enaddr[2];
6026892Sfeldman 		}
6036892Sfeldman 		ec->ec_dhost[3] = (dest>>8) & 0x7f;
6046520Sfeldman 		ec->ec_dhost[4] = (dest>>16) & 0xff;
6056520Sfeldman 		ec->ec_dhost[5] = (dest>>24) & 0xff;
6066520Sfeldman 	}
6076520Sfeldman 	ec->ec_type = type;
6086520Sfeldman 
6096520Sfeldman 	/*
6106520Sfeldman 	 * Queue message on interface, and start output if interface
6116520Sfeldman 	 * not yet active.
6126520Sfeldman 	 */
6136520Sfeldman 	s = splimp();
6146520Sfeldman 	if (IF_QFULL(&ifp->if_snd)) {
6156520Sfeldman 		IF_DROP(&ifp->if_snd);
6166520Sfeldman 		error = ENOBUFS;
6176520Sfeldman 		goto qfull;
6186520Sfeldman 	}
6196520Sfeldman 	IF_ENQUEUE(&ifp->if_snd, m);
6206520Sfeldman 	if (es->es_oactive == 0)
6216520Sfeldman 		ecstart(ifp->if_unit);
6226520Sfeldman 	splx(s);
6236545Sfeldman gotlocal:
6246545Sfeldman 	if (mcopy)				/* Kludge, but it works! */
6256545Sfeldman 		return(looutput(&loif, mcopy, dst));
6266545Sfeldman 	else
6276545Sfeldman 		return (0);
6286520Sfeldman qfull:
6296520Sfeldman 	m0 = m;
6306520Sfeldman 	splx(s);
6316520Sfeldman bad:
6326520Sfeldman 	m_freem(m0);
6336520Sfeldman 	return(error);
6346520Sfeldman }
6356520Sfeldman 
6366520Sfeldman /*
6376520Sfeldman  * Routine to copy from mbufs to UNIBUS memory.
6386520Sfeldman  * Similar in spirit to if_wubaput.
6396520Sfeldman  */
6406520Sfeldman ecput(ecbuf, m)
6416520Sfeldman 	char *ecbuf;
6426520Sfeldman 	struct mbuf *m;
6436520Sfeldman {
6446520Sfeldman 	register int len;
6456520Sfeldman 	register struct mbuf *mp;
6466520Sfeldman 	register char *bp, *mcp;
6476520Sfeldman 	register int i;
6486520Sfeldman 
6496520Sfeldman COUNT(ECPUT);
6506520Sfeldman 	len = 0;
6516520Sfeldman 	for (mp=m; mp; mp=mp->m_next)
6526520Sfeldman 		len += mp->m_len;
6536520Sfeldman 	*(u_short *)ecbuf = 2048 - len;
6546520Sfeldman 	bp = ecbuf + 2048 - len;
6556520Sfeldman 	mp = m;
6566520Sfeldman 	while (mp) {
6576520Sfeldman 		mcp = mtod(mp, char *);
658*7032Swnj 		i = 0;
659*7032Swnj 		if ((int)bp&1) {
660*7032Swnj 			*bp++ = *mcp++;
661*7032Swnj 			i++;
662*7032Swnj 		}
6636520Sfeldman 		for (i=0; i<mp->m_len; i++)
664*7032Swnj 		while (i < mp->m_len) {
665*7032Swnj 			*(short *)bp = *(short *)mcp;
666*7032Swnj 			bp += 2;
667*7032Swnj 			mcp += 2;
668*7032Swnj 			i += 2;
669*7032Swnj 		}
670*7032Swnj 		if (mp->m_len&1)
6716520Sfeldman 			*bp++ = *mcp++;
6726520Sfeldman 		mp = m_free(mp);
6736520Sfeldman 	}
6746520Sfeldman 	if (bp != ecbuf+2048)
6756520Sfeldman 		printf("ec: bad ecput!\n");
6766520Sfeldman }
6776520Sfeldman 
6786520Sfeldman /*
6796520Sfeldman  * Routine to copy from UNIBUS memory into mbufs.
6806520Sfeldman  * Similar in spirit to if_rubaget.
681*7032Swnj  *
682*7032Swnj  * Warning: This makes the fairly safe assumption that
683*7032Swnj  * mbufs have even lengths.
6846520Sfeldman  */
6856520Sfeldman struct mbuf *
6866520Sfeldman ecget(ecbuf, totlen, off0)
6876520Sfeldman 	char *ecbuf;
6886520Sfeldman 	int totlen, off0;
6896520Sfeldman {
6906520Sfeldman 	struct mbuf *top, **mp, *m;
6916520Sfeldman 	int off = off0;
6926520Sfeldman 	int len;
6936520Sfeldman 	register char *cp = ecbuf + ECRDOFF + sizeof (struct ec_header);
6946520Sfeldman 	register char *mcp;
6956520Sfeldman 	register int i;
6966520Sfeldman 
6976520Sfeldman COUNT(ECGET);
6986520Sfeldman 	top = 0;
6996520Sfeldman 	mp = &top;
7006520Sfeldman 	while (totlen > 0) {
7016520Sfeldman 		MGET(m, 0);
7026520Sfeldman 		if (m == 0)
7036520Sfeldman 			goto bad;
7046520Sfeldman 		if (off) {
7056520Sfeldman 			len = totlen - off;
7066520Sfeldman 			cp = ecbuf + ECRDOFF + sizeof (struct ec_header) + off;
7076520Sfeldman 		} else
7086520Sfeldman 			len = totlen;
7096520Sfeldman 		if (len >= CLBYTES) {
7106520Sfeldman 			struct mbuf *p;
7116520Sfeldman 
7126520Sfeldman 			MCLGET(p, 1);
7136520Sfeldman 			if (p != 0) {
7146520Sfeldman 				m->m_len = len = CLBYTES;
7156520Sfeldman 				m->m_off = (int)p - (int)m;
7166520Sfeldman 			} else {
7176520Sfeldman 				m->m_len = len = MIN(MLEN, len);
7186520Sfeldman 				m->m_off = MMINOFF;
7196520Sfeldman 			}
7206520Sfeldman 		} else {
7216520Sfeldman 			m->m_len = len = MIN(MLEN, len);
7226520Sfeldman 			m->m_off = MMINOFF;
7236520Sfeldman 		}
7246520Sfeldman 		mcp = mtod(m, char *);
725*7032Swnj 		for (i=0; i<len; i+=2) {
726*7032Swnj 			*(short *)mcp = *(short *)cp;
727*7032Swnj 			mcp += 2;
728*7032Swnj 			cp += 2;
729*7032Swnj 		}
730*7032Swnj 		if (len&1)
7316520Sfeldman 			*mcp++ = *cp++;
7326520Sfeldman 		*mp = m;
7336520Sfeldman 		mp = &m->m_next;
7346520Sfeldman 		if (off) {
7356520Sfeldman 			off += len;
7366520Sfeldman 			if (off == totlen) {
7376520Sfeldman 				cp = ecbuf + ECRDOFF +
7386520Sfeldman 				    sizeof (struct ec_header);
7396520Sfeldman 				off = 0;
7406520Sfeldman 				totlen = off0;
7416520Sfeldman 			}
7426520Sfeldman 		} else
7436520Sfeldman 			totlen -= len;
7446520Sfeldman 	}
7456520Sfeldman 	return (top);
7466520Sfeldman bad:
7476520Sfeldman 	m_freem(top);
7486520Sfeldman 	return (0);
7496520Sfeldman }
7506520Sfeldman 
7516520Sfeldman #if NIMP == 0 && NEC > 0
7526520Sfeldman /*
7536520Sfeldman  * Logical host interface driver.
7546520Sfeldman  * Allows host to appear as an ARPAnet
7556520Sfeldman  * logical host.  Must also have routing
7566520Sfeldman  * table entry set up to forward packets
7576520Sfeldman  * to appropriate gateway on localnet.
7586520Sfeldman  */
7596520Sfeldman 
7606520Sfeldman struct	ifnet eclhif;
7616924Swnj int	looutput();
7626520Sfeldman 
7636520Sfeldman /*
7646520Sfeldman  * Called by localnet interface to allow logical
7656924Swnj  * host interface to "attach", it's purpose
7666520Sfeldman  * is simply to establish the host's arpanet address.
7676520Sfeldman  */
7686924Swnj eclhinit(ecifp, addr)
7696924Swnj 	struct ifnet *ecifp;
7706520Sfeldman 	int addr;
7716520Sfeldman {
7726520Sfeldman 	register struct ifnet *ifp = &eclhif;
7736520Sfeldman 	register struct sockaddr_in *sin;
7746520Sfeldman 
7756520Sfeldman COUNT(ECLHINIT);
7766520Sfeldman 	ifp->if_name = "lh";
7776520Sfeldman 	ifp->if_mtu = ECMTU;
7786520Sfeldman 	sin = (struct sockaddr_in *)&ifp->if_addr;
7796520Sfeldman 	sin->sin_family = AF_INET;
7806520Sfeldman 	sin->sin_addr.s_addr = addr;
7816956Ssam 	sin->sin_addr.s_lh = ecifp->if_host[0];
7826520Sfeldman 	ifp->if_net = sin->sin_addr.s_net;
7836956Ssam 	ifp->if_dstaddr = ifp->if_addr;
7846924Swnj 	ifp->if_flags = IFF_UP|IFF_POINTOPOINT;
7856924Swnj 	ifp->if_output = looutput;
7866520Sfeldman 	if_attach(ifp);
7876931Ssam 	rtinit(&ifp->if_addr, &ifp->if_addr, RTF_UP|RTF_DIRECT|RTF_HOST);
7886520Sfeldman }
7896520Sfeldman #endif
790