Token ring subroutines. For details see next commit.

2 files changed, 830 insertions, 0 deletions

diff --git a/sys/net/if_token.h b/sys/net/if_token.h
new file mode 100644
index 00000000000..cf3a7883a60
--- /dev/null
+++ b/sys/net/if_token.h
@@ -0,0 +1,132 @@
+/*	$OpenBSD: if_token.h,v 1.1 1999/12/27 21:47:23 fgsch Exp $	*/
+/*	$NetBSD: if_token.h,v 1.6 1999/11/19 20:41:19 thorpej Exp $	*/
+
+/*
+ * Copyright (c) 1982, 1986, 1993
+ *	The Regents of the University of California.  All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 3. All advertising materials mentioning features or use of this software
+ *    must display the following acknowledgement:
+ *	This product includes software developed by the University of
+ *	California, Berkeley and its contributors.
+ * 4. Neither the name of the University nor the names of its contributors
+ *    may be used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ *	from: NetBSD: if_fddi.h,v 1.2 1995/08/19 04:35:28 cgd Exp
+ */
+
+#ifndef _NET_IF_TOKEN_H_
+#define _NET_IF_TOKEN_H_
+
+#define ISO88025_ADDR_LEN 6
+
+/* Token Ring physical header */
+struct token_header {
+	u_int8_t  token_ac;			/* access control field */
+	u_int8_t  token_fc;			/* frame control field */
+	u_int8_t  token_dhost[ISO88025_ADDR_LEN];	/* dest. address */
+	u_int8_t  token_shost[ISO88025_ADDR_LEN];	/* source address */
+} __attribute__((__packed__));
+
+#define TOKEN_MAX_BRIDGE 8
+
+/* Token Ring routing information field */
+struct token_rif {
+	u_int16_t tr_rcf;			/* route control field */
+	u_int16_t tr_rdf[TOKEN_MAX_BRIDGE];	/* route-designator fields */
+} __attribute__((__packed__));
+
+/* standard values for adress control and frame control field */
+#define TOKEN_AC		0x10
+#define TOKEN_FC		0x40
+
+#define TOKEN_RI_PRESENT		0x80	/* routing info present bit */
+#define TOKEN_RCF_LEN_MASK		0x1f00
+#define TOKEN_RCF_BROADCAST_MASK	0xe000
+#define	TOKEN_RCF_BROADCAST_ALL		0x8000  /* all routes broadcast */
+#define	TOKEN_RCF_BROADCAST_SINGLE	0xc000  /* single route broadcast */
+				
+/*
+ * A Token-ring frame consists of
+ * header +      rif      + llcinfo + fcs
+ *  14    + 2 * (0 ... 9) +    x    +  4  octets
+ * where llcinfo contains the llcsnap header (8 octets) and the IP frame
+ */
+					/*  LLC INFO (802.5PD-2) */
+#define TOKEN_RCF_FRAME0	0x0000  /*    516    */
+#define TOKEN_RCF_FRAME1	0x0010  /*   1500    */
+#define TOKEN_RCF_FRAME2	0x0020  /*   2052    */
+#define TOKEN_RCF_FRAME3	0x0030  /*   4472    */
+#define TOKEN_RCF_FRAME4	0x0040  /*   8144    */
+#define TOKEN_RCF_FRAME5	0x0050  /*  11407    */
+#define TOKEN_RCF_FRAME6	0x0060  /*  17800    */
+#define TOKEN_RCF_FRAME7	0x0070	/*  65535    */
+#define TOKEN_RCF_FRAME_MASK	0x0070
+
+#define TOKEN_RCF_DIRECTION	0x0080
+
+/*
+ * According to RFC 1042
+ */
+#define IPMTU_4MBIT_MAX		4464
+#define IPMTU_16MBIT_MAX	8188
+
+/*
+ * RFC 1042:
+ * It is recommended that all implementations support IP packets
+ * of at least 2002 octets.
+ */
+#define ISO88025_MTU 2002
+
+/*
+ * This assumes that route information fields are appended to
+ * existing structures like llinfo_arp and token_header
+ */
+#define TOKEN_RIF(x) ((struct token_rif *) ((x) + 1))
+
+/*
+ * This is a kludge to get at the token ring mac header and the source route
+ * information after m_adj() has been used on the mbuf.
+ * Note that m is always an mbuf with a packet header.
+ */
+#define M_TRHSTART(m) \
+	(ALIGN(((m)->m_flags & M_EXT ? (m)->m_ext.ext_buf : &(m)->m_pktdat[0]) \
+	    + sizeof (struct token_header)) - sizeof(struct token_header))
+
+#if defined(_KERNEL)
+/*
+ * XXX we need if_ethersubr.c with all these defines
+ */
+#define	tokenbroadcastaddr	etherbroadcastaddr
+#define	token_ipmulticast_min	ether_ipmulticast_min
+#define	token_ipmulticast_max	ether_ipmulticast_max
+#define	token_addmulti		ether_addmulti
+#define	token_delmulti		ether_delmulti
+#define	token_sprintf		ether_sprintf
+
+void    token_ifattach __P((struct ifnet *));
+void	token_input __P((struct ifnet *, struct mbuf *));
+#endif
+
+#endif /* !_NET_IF_TOKEN_H_ */
diff --git a/sys/net/if_tokensubr.c b/sys/net/if_tokensubr.c
new file mode 100644
index 00000000000..2705902d883
--- /dev/null
+++ b/sys/net/if_tokensubr.c
@@ -0,0 +1,698 @@
+/*	$OpenBSD: if_tokensubr.c,v 1.1 1999/12/27 21:47:23 fgsch Exp $	*/
+/*	$NetBSD: if_tokensubr.c,v 1.7 1999/05/30 00:39:07 bad Exp $	*/
+
+/*
+ * Copyright (c) 1997-1999
+ *	Onno van der Linden
+ * Copyright (c) 1995
+ *	Matt Thomas.  All rights reserved.
+ * Copyright (c) 1982, 1989, 1993
+ *	The Regents of the University of California.  All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 3. All advertising materials mentioning features or use of this software
+ *    must display the following acknowledgement:
+ *	This product includes software developed by the University of
+ *	California, Berkeley and its contributors.
+ * 4. Neither the name of the University nor the names of its contributors
+ *    may be used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ *	from: NetBSD: if_fddisubr.c,v 1.2 1995/08/19 04:35:29 cgd Exp
+ */
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/malloc.h>
+#include <sys/mbuf.h>
+#include <sys/protosw.h>
+#include <sys/socket.h>
+#include <sys/ioctl.h>
+#include <sys/errno.h>
+#include <sys/syslog.h>
+
+#include <machine/cpu.h>
+
+#include <net/if.h>
+#include <net/netisr.h>
+#include <net/route.h>
+#include <net/if_llc.h>
+#include <net/if_dl.h>
+#include <net/if_types.h>
+
+
+#ifdef INET
+#include <netinet/in.h>
+#include <netinet/if_ether.h>
+#include <netinet/in_var.h>
+#include <net/if_token.h>
+#endif
+
+#ifdef NS
+#include <netns/ns.h>
+#include <netns/ns_if.h>
+#endif
+
+#ifdef DECNET
+#include <netdnet/dn.h>
+#endif
+
+#ifdef ISO
+#include <netiso/argo_debug.h>
+#include <netiso/iso.h>
+#include <netiso/iso_var.h>
+#include <netiso/iso_snpac.h>
+#endif
+
+#include "bpfilter.h"
+
+#ifdef LLC
+#include <netccitt/dll.h>
+#include <netccitt/llc_var.h>
+#endif
+
+/*
+ * TODO:
+ * handle source routing via send_xid()
+ * source routing for ISO,LLC,CCITT protocols
+ * need sockaddr_dl_8025 to handle this correctly
+ * IPX cases
+ * handle "fast" forwarding like if_ether and if_fddi
+ */
+
+#if defined(LLC) && defined(CCITT)
+extern struct ifqueue pkintrq;
+#endif
+
+#define senderr(e) { error = (e); goto bad;}
+
+#if defined(__bsdi__) || defined(__NetBSD__) || defined(__OpenBSD__)
+#define	RTALLOC1(a, b)			rtalloc1(a, b)
+#define	ARPRESOLVE(a, b, c, d, e, f)	arpresolve(a, b, c, d, e)
+#define	TYPEHTONS(t)			(t)
+#elif defined(__FreeBSD__)
+#define	RTALLOC1(a, b)			rtalloc1(a, b, 0UL)
+#define	ARPRESOLVE(a, b, c, d, e, f)	arpresolve(a, b, c, d, e, f)
+#define	TYPEHTONS(t)			(htons(t))
+#endif
+
+#define RCF_ALLROUTES (2 << 8) | TOKEN_RCF_FRAME2 | TOKEN_RCF_BROADCAST_ALL
+#define RCF_SINGLEROUTE (2 << 8) | TOKEN_RCF_FRAME2 | TOKEN_RCF_BROADCAST_SINGLE
+
+#ifndef llc_snap
+#define llc_snap	llc_un.type_snap
+#endif
+
+static	int token_output __P((struct ifnet *, struct mbuf *,
+	    struct sockaddr *, struct rtentry *)); 
+
+/*
+ * Token Ring output routine.
+ * Encapsulate a packet of type family for the local net.
+ * Assumes that ifp is actually pointer to arphdr structure.
+ * XXX route info has to go into the same mbuf as the header
+ */
+static int
+token_output(ifp, m0, dst, rt0)
+	register struct ifnet *ifp;
+	struct mbuf *m0;
+	struct sockaddr *dst;
+	struct rtentry *rt0;
+{
+	u_int16_t etype;
+	int s, error = 0;
+	u_char edst[ISO88025_ADDR_LEN];
+	register struct mbuf *m = m0;
+	register struct rtentry *rt;
+	struct mbuf *mcopy = (struct mbuf *)0;
+	struct token_header *trh;
+#ifdef INET
+	struct arpcom *ac = (struct arpcom *)ifp;
+#endif /* INET */
+	struct token_rif *rif = (struct  token_rif *)0;
+	struct token_rif bcastrif;
+	size_t riflen = 0;
+
+	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
+		senderr(ENETDOWN);
+	ifp->if_lastchange = time;
+	if ((rt = rt0)) {
+		if ((rt->rt_flags & RTF_UP) == 0) {
+			if ((rt0 = rt = RTALLOC1(dst, 1)))
+				rt->rt_refcnt--;
+			else
+				senderr(EHOSTUNREACH);
+		}
+		if (rt->rt_flags & RTF_GATEWAY) {
+			if (rt->rt_gwroute == 0)
+				goto lookup;
+			if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
+				rtfree(rt); rt = rt0;
+			lookup: rt->rt_gwroute = RTALLOC1(rt->rt_gateway, 1);
+				if ((rt = rt->rt_gwroute) == 0)
+					senderr(EHOSTUNREACH);
+			}
+		}
+		if (rt->rt_flags & RTF_REJECT)
+			if (rt->rt_rmx.rmx_expire == 0 ||
+			    time.tv_sec < rt->rt_rmx.rmx_expire)
+				senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
+	}
+	switch (dst->sa_family) {
+
+#ifdef INET
+	case AF_INET:
+		if (m->m_flags & M_BCAST) {
+			if (ifp->if_flags & IFF_LINK0) {
+				if (ifp->if_flags & IFF_LINK1)
+					bcastrif.tr_rcf = htons(RCF_ALLROUTES);
+				else
+					bcastrif.tr_rcf = htons(RCF_SINGLEROUTE);
+				rif = &bcastrif;
+				riflen = sizeof(rif->tr_rcf);
+			}
+			bcopy((caddr_t)etherbroadcastaddr, (caddr_t)edst,
+			    sizeof(edst));
+		}
+/*
+ * XXX m->m_flags & M_MCAST   IEEE802_MAP_IP_MULTICAST ??
+ */
+		else {
+			if (!ARPRESOLVE(ac, rt, m, dst, edst, rt0))
+				return (0);	/* if not yet resolved */
+			rif = TOKEN_RIF((struct llinfo_arp *) rt->rt_llinfo);
+			riflen = (ntohs(rif->tr_rcf) & TOKEN_RCF_LEN_MASK) >> 8;
+		}
+		/* If broadcasting on a simplex interface, loopback a copy. */
+		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
+			mcopy = m_copy(m, 0, (int)M_COPYALL);
+		etype = htons(ETHERTYPE_IP);
+		break;
+#if 0
+	case AF_ARP:
+/*
+ * XXX source routing, assume m->m_data contains the useful stuff
+ */
+		ah = mtod(m, struct arphdr *);
+		ah->ar_hrd = htons(ARPHRD_IEEE802);
+
+		switch(ntohs(ah->ar_op)) {
+		case ARPOP_REVREQUEST:
+		case ARPOP_REVREPLY:
+			etype = htons(ETHERTYPE_REVARP);
+			break;
+
+		case ARPOP_REQUEST:
+		case ARPOP_REPLY:
+		default:
+			etype = htons(ETHERTYPE_ARP);
+		}
+
+		if (m->m_flags & M_BCAST) {
+			if (ifp->if_flags & IFF_LINK0) {
+				if (ifp->if_flags & IFF_LINK1)
+					bcastrif.tr_rcf = htons(RCF_ALLROUTES);
+				else
+					bcastrif.tr_rcf = htons(RCF_SINGLEROUTE);
+				rif = &bcastrif;
+				riflen = sizeof(rif->tr_rcf);
+			}
+			bcopy((caddr_t)etherbroadcastaddr, (caddr_t)edst,
+			    sizeof(edst));
+		}
+		else {
+			bcopy((caddr_t)ar_tha(ah), (caddr_t)edst, sizeof(edst));
+			trh = (struct token_header *)M_TRHSTART(m);
+			trh->token_ac = TOKEN_AC;
+			trh->token_fc = TOKEN_FC;
+			if (trh->token_shost[0] & TOKEN_RI_PRESENT) {
+				struct token_rif *trrif;
+
+				trrif = TOKEN_RIF(trh);
+				riflen = (ntohs(trrif->tr_rcf) & TOKEN_RCF_LEN_MASK) >> 8;
+			}
+			bcopy((caddr_t)edst, (caddr_t)trh->token_dhost,
+			    sizeof (edst));
+			bcopy(LLADDR(ifp->if_sadl), (caddr_t)trh->token_shost,
+			    sizeof(trh->token_shost));
+			if (riflen != 0)
+				trh->token_shost[0] |= TOKEN_RI_PRESENT;
+/*
+ * compare (m->m_data - m->m_pktdat) with (sizeof(struct token_header) + riflen + ...
+ */
+			m->m_len += (sizeof(*trh) + riflen + LLC_SNAPFRAMELEN);
+			m->m_data -= (sizeof(*trh) + riflen + LLC_SNAPFRAMELEN);
+			m->m_pkthdr.len += (sizeof(*trh) + riflen + LLC_SNAPFRAMELEN);
+			goto send;
+		}
+		break;
+#endif /* 0 */
+#endif
+#ifdef NS
+	case AF_NS:
+		etype = htons(ETHERTYPE_NS);
+		bcopy((caddr_t)&(((struct sockaddr_ns *)dst)->sns_addr.x_host),
+		    (caddr_t)edst, sizeof (edst));
+		if (!bcmp((caddr_t)edst, (caddr_t)&ns_thishost, sizeof(edst)))
+			return (looutput(ifp, m, dst, rt));
+		/* If broadcasting on a simplex interface, loopback a copy. */
+		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
+			mcopy = m_copy(m, 0, (int)M_COPYALL);
+		break;
+#endif
+#ifdef	ISO
+	case AF_ISO: {
+		int	snpalen;
+		struct	llc *l;
+		register struct sockaddr_dl *sdl;
+
+		if (rt && (sdl = (struct sockaddr_dl *)rt->rt_gateway) &&
+		    sdl->sdl_family == AF_LINK && sdl->sdl_alen > 0) {
+			bcopy(LLADDR(sdl), (caddr_t)edst, sizeof(edst));
+		}
+		else if ((error =
+			    iso_snparesolve(ifp, (struct sockaddr_iso *)dst,
+					    (char *)edst, &snpalen)))
+			goto bad; /* Not resolved */
+		/* If broadcasting on a simplex interface, loopback a copy. */
+		if (*edst & 1)
+			m->m_flags |= (M_BCAST|M_MCAST);
+		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX) &&
+		    (mcopy = m_copy(m, 0, (int)M_COPYALL))) {
+			M_PREPEND(mcopy, sizeof (*trh), M_DONTWAIT);
+			if (mcopy) {
+				trh = mtod(mcopy, struct token_header *);
+				bcopy((caddr_t)edst,
+				    (caddr_t)trh->token_dhost, sizeof (edst));
+				bcopy(LLADDR(ifp->if_sadl),
+				    (caddr_t)trh->token_shost, sizeof (edst));
+			}
+		}
+		M_PREPEND(m, 3, M_DONTWAIT);
+		if (m == NULL)
+			return (0);
+		etype = 0;
+		l = mtod(m, struct llc *);
+		l->llc_dsap = l->llc_ssap = LLC_ISO_LSAP;
+		l->llc_control = LLC_UI;
+#if defined(__FreeBSD__)
+		IFDEBUG(D_ETHER)
+			int i;
+			printf("token_output: sending pkt to: ");
+			for (i=0; i < ISO88025_ADDR_LEN; i++)
+				printf("%x ", edst[i] & 0xff);
+			printf("\n");
+		ENDDEBUG
+#endif
+		} break;
+#endif /* ISO */
+#ifdef	LLC
+/*	case AF_NSAP: */
+	case AF_CCITT: {
+		register struct sockaddr_dl *sdl =
+		    (struct sockaddr_dl *) rt -> rt_gateway;
+
+		if (sdl && sdl->sdl_family == AF_LINK
+		    && sdl->sdl_alen > 0) {
+			bcopy(LLADDR(sdl), (char *)edst, sizeof(edst));
+		}
+		else {
+			/* Not a link interface ? Funny ... */
+			goto bad;
+		}
+		if ((ifp->if_flags & IFF_SIMPLEX) && (*edst & 1) &&
+		    (mcopy = m_copy(m, 0, (int)M_COPYALL))) {
+			M_PREPEND(mcopy, sizeof (*trh), M_DONTWAIT);
+			if (mcopy) {
+				trh = mtod(mcopy, struct token_header *);
+				bcopy((caddr_t)edst,
+				    (caddr_t)trh->token_dhost, sizeof (edst));
+				bcopy(LLADDR(ifp->if_sadl),
+				    (caddr_t)trh->token_shost, sizeof (edst));
+			}
+		}
+		etype = 0;
+#ifdef LLC_DEBUG
+		{
+			int i;
+			register struct llc *l = mtod(m, struct llc *);
+
+			printf("token_output: sending LLC2 pkt to: ");
+			for (i=0; i < ISO88025_ADDR_LEN; i++)
+				printf("%x ", edst[i] & 0xff);
+			printf(" len 0x%x dsap 0x%x ssap 0x%x control 0x%x\n",
+			    etype & 0xff, l->llc_dsap & 0xff, l->llc_ssap &0xff,
+			    l->llc_control & 0xff);
+
+		}
+#endif /* LLC_DEBUG */
+		}
+		break;
+#endif /* LLC */
+
+	case AF_UNSPEC:
+	{
+		struct ether_header *eh;
+		eh = (struct ether_header *)dst->sa_data;
+		bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, sizeof (edst));
+		if (*edst & 1)
+			m->m_flags |= (M_BCAST|M_MCAST);
+		etype = TYPEHTONS(eh->ether_type);
+		if (m->m_flags & M_BCAST) {
+			if (ifp->if_flags & IFF_LINK0) {
+				if (ifp->if_flags & IFF_LINK1)
+					bcastrif.tr_rcf = htons(RCF_ALLROUTES);
+				else
+					bcastrif.tr_rcf = htons(RCF_SINGLEROUTE);
+				rif = &bcastrif;
+				riflen = sizeof(bcastrif.tr_rcf);
+			}
+		}
+		break;
+	}
+
+	default:
+		printf("%s: can't handle af%d\n", ifp->if_xname,
+		    dst->sa_family);
+		senderr(EAFNOSUPPORT);
+	}
+
+
+	if (mcopy)
+		(void) looutput(ifp, mcopy, dst, rt);
+	if (etype != 0) {
+		register struct llc *l;
+		M_PREPEND(m, LLC_SNAPFRAMELEN, M_DONTWAIT);
+		if (m == 0)
+			senderr(ENOBUFS);
+		l = mtod(m, struct llc *);
+		l->llc_control = LLC_UI;
+		l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP;
+		l->llc_snap.org_code[0] = l->llc_snap.org_code[1] =
+		    l->llc_snap.org_code[2] = 0;
+		bcopy((caddr_t) &etype, (caddr_t) &l->llc_snap.ether_type,
+		    sizeof(u_short));
+	}
+
+	/*
+	 * Add local net header.  If no space in first mbuf,
+	 * allocate another.
+	 */
+
+	M_PREPEND(m, (riflen + sizeof (*trh)), M_DONTWAIT);
+	if (m == 0)
+		senderr(ENOBUFS);
+	trh = mtod(m, struct token_header *);
+	trh->token_ac = TOKEN_AC;
+	trh->token_fc = TOKEN_FC;
+	bcopy((caddr_t)edst, (caddr_t)trh->token_dhost, sizeof (edst));
+	bcopy((caddr_t)ac->ac_enaddr, (caddr_t)trh->token_shost,
+	    sizeof(trh->token_shost));
+
+	if (riflen != 0) {
+		struct token_rif *trrif;
+
+		trh->token_shost[0] |= TOKEN_RI_PRESENT;
+		trrif = TOKEN_RIF(trh);
+		bcopy(rif, trrif, riflen);
+	}
+#if 0
+send:
+#endif /* 0 */
+
+	s = splimp();
+	/*
+	 * Queue message on interface, and start output if interface
+	 * not yet active.
+	 */
+	if (IF_QFULL(&ifp->if_snd)) {
+		IF_DROP(&ifp->if_snd);
+		splx(s);
+		senderr(ENOBUFS);
+	}
+	ifp->if_obytes += m->m_pkthdr.len;
+	IF_ENQUEUE(&ifp->if_snd, m);
+	if ((ifp->if_flags & IFF_OACTIVE) == 0)
+		(*ifp->if_start)(ifp);
+	splx(s);
+	if (m->m_flags & M_MCAST)
+		ifp->if_omcasts++;
+	return (error);
+
+bad:
+	if (m)
+		m_freem(m);
+	return (error);
+}
+
+/*
+ * Process a received token ring packet;
+ * the packet is in the mbuf chain m with
+ * the token ring header.
+ */
+void
+token_input(ifp, m)
+	struct ifnet *ifp;
+	struct mbuf *m;
+{
+	register struct ifqueue *inq;
+	register struct llc *l;
+	struct token_header *trh;
+	int s, lan_hdr_len;
+
+	if ((ifp->if_flags & IFF_UP) == 0) {
+		m_freem(m);
+		return;
+	}
+
+	trh = mtod(m, struct token_header *);
+
+	ifp->if_lastchange = time;
+	ifp->if_ibytes += m->m_pkthdr.len;
+	if (bcmp((caddr_t)tokenbroadcastaddr, (caddr_t)trh->token_dhost,
+	    sizeof(tokenbroadcastaddr)) == 0)
+		m->m_flags |= M_BCAST;
+	else if (trh->token_dhost[0] & 1)
+		m->m_flags |= M_MCAST;
+	if (m->m_flags & (M_BCAST|M_MCAST))
+		ifp->if_imcasts++;
+
+	/* Skip past the Token Ring header and RIF. */
+	lan_hdr_len = sizeof(struct token_header);
+	if (trh->token_shost[0] & TOKEN_RI_PRESENT) {
+		struct token_rif *trrif;
+
+		trrif = TOKEN_RIF(trh);
+		lan_hdr_len += (ntohs(trrif->tr_rcf) & TOKEN_RCF_LEN_MASK) >> 8;
+	}
+	m_adj(m, lan_hdr_len);
+
+	l = mtod(m, struct llc *);
+	switch (l->llc_dsap) {
+#if defined(INET) || defined(NS) || defined(DECNET)
+	case LLC_SNAP_LSAP:
+	{
+		u_int16_t etype;
+		if (l->llc_control != LLC_UI || l->llc_ssap != LLC_SNAP_LSAP)
+			goto dropanyway;
+		if (l->llc_snap.org_code[0] != 0 ||
+		    l->llc_snap.org_code[1] != 0 ||
+		    l->llc_snap.org_code[2] != 0)
+			goto dropanyway;
+		etype = ntohs(l->llc_snap.ether_type);
+		m_adj(m, LLC_SNAPFRAMELEN);
+		switch (etype) {
+#ifdef INET
+		case ETHERTYPE_IP:
+			schednetisr(NETISR_IP);
+			inq = &ipintrq;
+			break;
+
+		case ETHERTYPE_ARP:
+			schednetisr(NETISR_ARP);
+			inq = &arpintrq;
+			break;
+#endif
+#ifdef NS
+		case ETHERTYPE_NS:
+			schednetisr(NETISR_NS);
+			inq = &nsintrq;
+			break;
+#endif
+#ifdef DECNET
+		case ETHERTYPE_DECNET:
+			schednetisr(NETISR_DECNET);
+			inq = &decnetintrq;
+			break;
+#endif
+		default:
+			/*
+			printf("token_input: unknown protocol 0x%x\n", etype);
+			*/
+			ifp->if_noproto++;
+			goto dropanyway;
+		}
+		break;
+	}
+#endif /* INET || NS */
+#ifdef	ISO
+	case LLC_ISO_LSAP:
+		switch (l->llc_control) {
+		case LLC_UI:
+			/* LLC_UI_P forbidden in class 1 service */
+			if ((l->llc_dsap == LLC_ISO_LSAP) &&
+			    (l->llc_ssap == LLC_ISO_LSAP)) {
+				/* LSAP for ISO */
+				m->m_data += 3;		/* XXX */
+				m->m_len -= 3;		/* XXX */
+				m->m_pkthdr.len -= 3;	/* XXX */
+				M_PREPEND(m, sizeof *trh, M_DONTWAIT);
+				if (m == 0)
+					return;
+				*mtod(m, struct token_header *) = *trh;
+#if defined(__FreeBSD__)
+				IFDEBUG(D_ETHER)
+					printf("clnp packet");
+				ENDDEBUG
+#endif
+				schednetisr(NETISR_ISO);
+				inq = &clnlintrq;
+				break;
+			}
+			goto dropanyway;
+
+		case LLC_XID:
+		case LLC_XID_P:
+			if(m->m_len < ISO88025_ADDR_LEN)
+				goto dropanyway;
+			l->llc_window = 0;
+			l->llc_fid = 9;
+			l->llc_class = 1;
+			l->llc_dsap = l->llc_ssap = 0;
+			/* Fall through to */
+		case LLC_TEST:
+		case LLC_TEST_P:
+		{
+			struct sockaddr sa;
+			register struct ether_header *eh;
+			int i;
+			u_char c = l->llc_dsap;
+
+			l->llc_dsap = l->llc_ssap;
+			l->llc_ssap = c;
+			if (m->m_flags & (M_BCAST | M_MCAST))
+				bcopy(LLADDR(ifp->if_sadl),
+				    (caddr_t)trh->token_dhost,
+				    ISO88025_ADDR_LEN);
+			sa.sa_family = AF_UNSPEC;
+			sa.sa_len = sizeof(sa);
+			eh = (struct ether_header *)sa.sa_data;
+			for (i = 0; i < ISO88025_ADDR_LEN; i++) {
+				eh->ether_shost[i] = c = trh->token_dhost[i];
+				eh->ether_dhost[i] =
+				    eh->ether_dhost[i] = trh->token_shost[i];
+				eh->ether_shost[i] = c;
+			}
+			eh->ether_type = 0;
+			ifp->if_output(ifp, m, &sa, NULL);
+			return;
+		}
+		default:
+			m_freem(m);
+			return;
+		}
+		break;
+#endif /* ISO */
+#ifdef LLC
+	case LLC_X25_LSAP:
+	{
+/*
+ * XXX check for source routing info ? (sizeof(struct sdl_hdr) and
+ * ISO88025_ADDR_LEN)
+ */
+		M_PREPEND(m, sizeof(struct sdl_hdr) , M_DONTWAIT);
+		if (m == 0)
+			return;
+		if (!sdl_sethdrif(ifp, trh->token_shost, LLC_X25_LSAP,
+				    trh->token_dhost, LLC_X25_LSAP,
+				    ISO88025_ADDR_LEN,
+				    mtod(m, struct sdl_hdr *)))
+			panic("ETHER cons addr failure");
+		mtod(m, struct sdl_hdr *)->sdlhdr_len =
+		    m->m_pkthdr.len - sizeof(struct sdl_hdr);
+#ifdef LLC_DEBUG
+		printf("llc packet\n");
+#endif /* LLC_DEBUG */
+		schednetisr(NETISR_CCITT);
+		inq = &llcintrq;
+		break;
+	}
+#endif /* LLC */
+
+	default:
+		/* printf("token_input: unknown dsap 0x%x\n", l->llc_dsap); */
+		ifp->if_noproto++;
+	dropanyway:
+		m_freem(m);
+		return;
+	}
+
+	s = splimp();
+	if (IF_QFULL(inq)) {
+		IF_DROP(inq);
+		m_freem(m);
+	}
+	else
+		IF_ENQUEUE(inq, m);
+	splx(s);
+}
+
+/*
+ * Perform common duties while attaching to interface list
+ */
+void
+token_ifattach(ifp)
+	register struct ifnet *ifp;
+{
+	register struct ifaddr *ifa;
+	register struct sockaddr_dl *sdl;
+
+	ifp->if_type = IFT_ISO88025;
+	ifp->if_addrlen = ISO88025_ADDR_LEN;
+	ifp->if_hdrlen = 14;
+	ifp->if_mtu = ISO88025_MTU;
+	ifp->if_output = token_output;
+#ifdef IFF_NOTRAILERS
+	ifp->if_flags |= IFF_NOTRAILERS;
+#endif
+	for (ifa = ifp->if_addrlist.tqh_first; ifa != 0;
+	    ifa = ifa->ifa_list.tqe_next)
+		if ((sdl = (struct sockaddr_dl *)ifa->ifa_addr) &&
+		    sdl->sdl_family == AF_LINK) {
+			sdl->sdl_type = IFT_ISO88025;
+			sdl->sdl_alen = ifp->if_addrlen;
+			bcopy((caddr_t)((struct arpcom *)ifp)->ac_enaddr,
+			    LLADDR(sdl), ifp->if_addrlen);
+			break;
+		}
+}