Support routines for Token-Ring network drivers.
By Onno van der Linden.
This commit is contained in:
parent
2c16793ee5
commit
52c3a56a05
|
@ -0,0 +1,126 @@
|
|||
/* $NetBSD: if_token.h,v 1.1 1999/03/22 22:22:52 bad 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.
|
||||
*
|
||||
* @(#)if_tr.h 8.1 (Berkeley) 6/10/93
|
||||
* 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 */
|
||||
};
|
||||
|
||||
#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 */
|
||||
};
|
||||
|
||||
/* 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 tr_header
|
||||
*/
|
||||
#define TOKEN_RIF(x) ((struct token_rif *) ((x) + 1))
|
||||
|
||||
#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 *, caddr_t));
|
||||
void token_input __P((struct ifnet *, struct token_header *, struct mbuf *));
|
||||
int token_output __P((struct ifnet *,
|
||||
struct mbuf *, struct sockaddr *, struct rtentry *));
|
||||
|
||||
#endif
|
||||
|
||||
#endif _NET_IF_TOKEN_H_
|
|
@ -0,0 +1,675 @@
|
|||
/*
|
||||
* 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.
|
||||
*
|
||||
* @(#)if_trsubr.c 8.1 (Berkeley) 6/10/93
|
||||
* from: $NetBSD: if_tokensubr.c,v 1.1 1999/03/22 22:22:52 bad Exp $
|
||||
*/
|
||||
#include "opt_inet.h"
|
||||
#include "opt_atalk.h"
|
||||
#include "opt_ccitt.h"
|
||||
#include "opt_llc.h"
|
||||
#include "opt_iso.h"
|
||||
#include "opt_ns.h"
|
||||
#include "opt_gateway.h"
|
||||
|
||||
#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>
|
||||
|
||||
#include <net/if_ether.h>
|
||||
|
||||
#ifdef INET
|
||||
#include <netinet/in.h>
|
||||
#include <netinet/in_var.h>
|
||||
#include <netinet/if_inarp.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__)
|
||||
#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
|
||||
|
||||
/*
|
||||
* 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
|
||||
*/
|
||||
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 arphdr *ah = (struct arphdr *)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(ifp, 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;
|
||||
case AF_ARP:
|
||||
/*
|
||||
* XXX source routing, assume m->pktdat 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->m_pktdat;
|
||||
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
|
||||
#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;
|
||||
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
|
||||
} 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(LLADDR(ifp->if_sadl), (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);
|
||||
}
|
||||
send:
|
||||
|
||||
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 without
|
||||
* the token ring header, which is provided separately.
|
||||
*/
|
||||
void
|
||||
token_input(ifp, trh, m)
|
||||
struct ifnet *ifp;
|
||||
register struct token_header *trh;
|
||||
struct mbuf *m;
|
||||
{
|
||||
register struct ifqueue *inq;
|
||||
register struct llc *l;
|
||||
int s;
|
||||
|
||||
if ((ifp->if_flags & IFF_UP) == 0) {
|
||||
m_freem(m);
|
||||
return;
|
||||
}
|
||||
ifp->if_lastchange = time;
|
||||
/*
|
||||
* XXX (m->m_data - (char *) trh) assumes trh is in the same buf
|
||||
*/
|
||||
ifp->if_ibytes += m->m_pkthdr.len + (m->m_data - (char *) trh);
|
||||
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++;
|
||||
|
||||
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;
|
||||
IFDEBUG(D_ETHER)
|
||||
printf("clnp packet");
|
||||
ENDDEBUG
|
||||
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, lla)
|
||||
register struct ifnet *ifp;
|
||||
caddr_t lla;
|
||||
{
|
||||
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;
|
||||
ifp->if_broadcastaddr = tokenbroadcastaddr;
|
||||
#ifdef IFF_NOTRAILERS
|
||||
ifp->if_flags |= IFF_NOTRAILERS;
|
||||
#endif
|
||||
if ((sdl = ifp->if_sadl) != NULL && sdl->sdl_family == AF_LINK) {
|
||||
sdl->sdl_type = IFT_ISO88025;
|
||||
sdl->sdl_alen = ifp->if_addrlen;
|
||||
bcopy(lla, LLADDR(sdl), ifp->if_addrlen);
|
||||
}
|
||||
}
|
Loading…
Reference in New Issue