ec826ad5c7
1. separating L2 tables (ARP, NDP) from the L3 routing tables
2. removing as much locking dependencies among these layers as
possible to allow for some parallelism in the search operations
3. simplify the logic in the routing code,
The most notable end result is the obsolescent of the route
cloning (RTF_CLONING) concept, which translated into code reduction
in both IPv4 ARP and IPv6 NDP related modules, and size reduction in
struct rtentry{}. The change in design obsoletes the semantics of
RTF_CLONING, RTF_WASCLONE and RTF_LLINFO routing flags. The userland
applications such as "arp" and "ndp" have been modified to reflect
those changes. The output from "netstat -r" shows only the routing
entries.
Quite a few developers have contributed to this project in the
past: Glebius Smirnoff, Luigi Rizzo, Alessandro Cerri, and
Andre Oppermann. And most recently:
- Kip Macy revised the locking code completely, thus completing
the last piece of the puzzle, Kip has also been conducting
active functional testing
- Sam Leffler has helped me improving/refactoring the code, and
provided valuable reviews
- Julian Elischer setup the perforce tree for me and has helped
me maintaining that branch before the svn conversion
825 lines
19 KiB
C
825 lines
19 KiB
C
/*-
|
|
* Copyright (c) 1998, Larry Lile
|
|
* All rights reserved.
|
|
*
|
|
* For latest sources and information on this driver, please
|
|
* go to http://anarchy.stdio.com.
|
|
*
|
|
* Questions, comments or suggestions should be directed to
|
|
* Larry Lile <lile@stdio.com>.
|
|
*
|
|
* 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 unmodified, 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
|
|
*
|
|
* $FreeBSD$
|
|
*
|
|
*/
|
|
|
|
/*
|
|
*
|
|
* General ISO 802.5 (Token Ring) support routines
|
|
*
|
|
*/
|
|
|
|
#include "opt_inet.h"
|
|
#include "opt_inet6.h"
|
|
#include "opt_ipx.h"
|
|
#include "opt_mac.h"
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/module.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/sockio.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_arp.h>
|
|
#include <net/if_dl.h>
|
|
#include <net/if_llc.h>
|
|
#include <net/if_types.h>
|
|
#include <net/if_llatbl.h>
|
|
|
|
#include <net/ethernet.h>
|
|
#include <net/netisr.h>
|
|
#include <net/route.h>
|
|
#include <net/bpf.h>
|
|
#include <net/iso88025.h>
|
|
|
|
#if defined(INET) || defined(INET6)
|
|
#include <netinet/in.h>
|
|
#include <netinet/in_var.h>
|
|
#include <netinet/if_ether.h>
|
|
#endif
|
|
#ifdef INET6
|
|
#include <netinet6/nd6.h>
|
|
#endif
|
|
|
|
#ifdef IPX
|
|
#include <netipx/ipx.h>
|
|
#include <netipx/ipx_if.h>
|
|
#endif
|
|
|
|
#include <security/mac/mac_framework.h>
|
|
|
|
static const u_char iso88025_broadcastaddr[ISO88025_ADDR_LEN] =
|
|
{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
|
|
|
|
static int iso88025_resolvemulti (struct ifnet *, struct sockaddr **,
|
|
struct sockaddr *);
|
|
|
|
#define senderr(e) do { error = (e); goto bad; } while (0)
|
|
|
|
/*
|
|
* Perform common duties while attaching to interface list
|
|
*/
|
|
void
|
|
iso88025_ifattach(struct ifnet *ifp, const u_int8_t *lla, int bpf)
|
|
{
|
|
struct ifaddr *ifa;
|
|
struct sockaddr_dl *sdl;
|
|
|
|
ifa = NULL;
|
|
|
|
ifp->if_type = IFT_ISO88025;
|
|
ifp->if_addrlen = ISO88025_ADDR_LEN;
|
|
ifp->if_hdrlen = ISO88025_HDR_LEN;
|
|
|
|
if_attach(ifp); /* Must be called before additional assignments */
|
|
|
|
ifp->if_output = iso88025_output;
|
|
ifp->if_input = iso88025_input;
|
|
ifp->if_resolvemulti = iso88025_resolvemulti;
|
|
ifp->if_broadcastaddr = iso88025_broadcastaddr;
|
|
|
|
if (ifp->if_baudrate == 0)
|
|
ifp->if_baudrate = TR_16MBPS; /* 16Mbit should be a safe default */
|
|
if (ifp->if_mtu == 0)
|
|
ifp->if_mtu = ISO88025_DEFAULT_MTU;
|
|
|
|
ifa = ifp->if_addr;
|
|
KASSERT(ifa != NULL, ("%s: no lladdr!\n", __func__));
|
|
|
|
sdl = (struct sockaddr_dl *)ifa->ifa_addr;
|
|
sdl->sdl_type = IFT_ISO88025;
|
|
sdl->sdl_alen = ifp->if_addrlen;
|
|
bcopy(lla, LLADDR(sdl), ifp->if_addrlen);
|
|
|
|
if (bpf)
|
|
bpfattach(ifp, DLT_IEEE802, ISO88025_HDR_LEN);
|
|
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Perform common duties while detaching a Token Ring interface
|
|
*/
|
|
void
|
|
iso88025_ifdetach(ifp, bpf)
|
|
struct ifnet *ifp;
|
|
int bpf;
|
|
{
|
|
|
|
if (bpf)
|
|
bpfdetach(ifp);
|
|
|
|
if_detach(ifp);
|
|
|
|
return;
|
|
}
|
|
|
|
int
|
|
iso88025_ioctl(struct ifnet *ifp, int command, caddr_t data)
|
|
{
|
|
struct ifaddr *ifa;
|
|
struct ifreq *ifr;
|
|
int error;
|
|
|
|
ifa = (struct ifaddr *) data;
|
|
ifr = (struct ifreq *) data;
|
|
error = 0;
|
|
|
|
switch (command) {
|
|
case SIOCSIFADDR:
|
|
ifp->if_flags |= IFF_UP;
|
|
|
|
switch (ifa->ifa_addr->sa_family) {
|
|
#ifdef INET
|
|
case AF_INET:
|
|
ifp->if_init(ifp->if_softc); /* before arpwhohas */
|
|
arp_ifinit(ifp, ifa);
|
|
break;
|
|
#endif /* INET */
|
|
#ifdef IPX
|
|
/*
|
|
* XXX - This code is probably wrong
|
|
*/
|
|
case AF_IPX: {
|
|
struct ipx_addr *ina;
|
|
|
|
ina = &(IA_SIPX(ifa)->sipx_addr);
|
|
|
|
if (ipx_nullhost(*ina))
|
|
ina->x_host = *(union ipx_host *)
|
|
IF_LLADDR(ifp);
|
|
else
|
|
bcopy((caddr_t) ina->x_host.c_host,
|
|
(caddr_t) IF_LLADDR(ifp),
|
|
ISO88025_ADDR_LEN);
|
|
|
|
/*
|
|
* Set new address
|
|
*/
|
|
ifp->if_init(ifp->if_softc);
|
|
}
|
|
break;
|
|
#endif /* IPX */
|
|
default:
|
|
ifp->if_init(ifp->if_softc);
|
|
break;
|
|
}
|
|
break;
|
|
|
|
case SIOCGIFADDR: {
|
|
struct sockaddr *sa;
|
|
|
|
sa = (struct sockaddr *) & ifr->ifr_data;
|
|
bcopy(IF_LLADDR(ifp),
|
|
(caddr_t) sa->sa_data, ISO88025_ADDR_LEN);
|
|
}
|
|
break;
|
|
|
|
case SIOCSIFMTU:
|
|
/*
|
|
* Set the interface MTU.
|
|
*/
|
|
if (ifr->ifr_mtu > ISO88025_MAX_MTU) {
|
|
error = EINVAL;
|
|
} else {
|
|
ifp->if_mtu = ifr->ifr_mtu;
|
|
}
|
|
break;
|
|
default:
|
|
error = EINVAL; /* XXX netbsd has ENOTTY??? */
|
|
break;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* ISO88025 encapsulation
|
|
*/
|
|
int
|
|
iso88025_output(ifp, m, dst, rt0)
|
|
struct ifnet *ifp;
|
|
struct mbuf *m;
|
|
struct sockaddr *dst;
|
|
struct rtentry *rt0;
|
|
{
|
|
u_int16_t snap_type = 0;
|
|
int loop_copy = 0, error = 0, rif_len = 0;
|
|
u_char edst[ISO88025_ADDR_LEN];
|
|
struct iso88025_header *th;
|
|
struct iso88025_header gen_th;
|
|
struct sockaddr_dl *sdl = NULL;
|
|
struct llentry *lle;
|
|
|
|
#ifdef MAC
|
|
error = mac_ifnet_check_transmit(ifp, m);
|
|
if (error)
|
|
senderr(error);
|
|
#endif
|
|
|
|
if (ifp->if_flags & IFF_MONITOR)
|
|
senderr(ENETDOWN);
|
|
if (!((ifp->if_flags & IFF_UP) &&
|
|
(ifp->if_drv_flags & IFF_DRV_RUNNING)))
|
|
senderr(ENETDOWN);
|
|
getmicrotime(&ifp->if_lastchange);
|
|
|
|
/* Calculate routing info length based on arp table entry */
|
|
/* XXX any better way to do this ? */
|
|
|
|
if (rt0 && (sdl = (struct sockaddr_dl *)rt0->rt_gateway))
|
|
if (SDL_ISO88025(sdl)->trld_rcf != 0)
|
|
rif_len = TR_RCF_RIFLEN(SDL_ISO88025(sdl)->trld_rcf);
|
|
|
|
/* Generate a generic 802.5 header for the packet */
|
|
gen_th.ac = TR_AC;
|
|
gen_th.fc = TR_LLC_FRAME;
|
|
(void)memcpy((caddr_t)gen_th.iso88025_shost, IF_LLADDR(ifp),
|
|
ISO88025_ADDR_LEN);
|
|
if (rif_len) {
|
|
gen_th.iso88025_shost[0] |= TR_RII;
|
|
if (rif_len > 2) {
|
|
gen_th.rcf = SDL_ISO88025(sdl)->trld_rcf;
|
|
(void)memcpy((caddr_t)gen_th.rd,
|
|
(caddr_t)SDL_ISO88025(sdl)->trld_route,
|
|
rif_len - 2);
|
|
}
|
|
}
|
|
|
|
switch (dst->sa_family) {
|
|
#ifdef INET
|
|
case AF_INET:
|
|
error = arpresolve(ifp, rt0, m, dst, edst, &lle);
|
|
if (error)
|
|
return (error == EWOULDBLOCK ? 0 : error);
|
|
snap_type = ETHERTYPE_IP;
|
|
break;
|
|
case AF_ARP:
|
|
{
|
|
struct arphdr *ah;
|
|
ah = mtod(m, struct arphdr *);
|
|
ah->ar_hrd = htons(ARPHRD_IEEE802);
|
|
|
|
loop_copy = -1; /* if this is for us, don't do it */
|
|
|
|
switch(ntohs(ah->ar_op)) {
|
|
case ARPOP_REVREQUEST:
|
|
case ARPOP_REVREPLY:
|
|
snap_type = ETHERTYPE_REVARP;
|
|
break;
|
|
case ARPOP_REQUEST:
|
|
case ARPOP_REPLY:
|
|
default:
|
|
snap_type = ETHERTYPE_ARP;
|
|
break;
|
|
}
|
|
|
|
if (m->m_flags & M_BCAST)
|
|
bcopy(ifp->if_broadcastaddr, edst, ISO88025_ADDR_LEN);
|
|
else
|
|
bcopy(ar_tha(ah), edst, ISO88025_ADDR_LEN);
|
|
|
|
}
|
|
break;
|
|
#endif /* INET */
|
|
#ifdef INET6
|
|
case AF_INET6:
|
|
error = nd6_storelladdr(ifp, rt0, m, dst, (u_char *)edst, &lle);
|
|
if (error)
|
|
return (error);
|
|
snap_type = ETHERTYPE_IPV6;
|
|
break;
|
|
#endif /* INET6 */
|
|
#ifdef IPX
|
|
case AF_IPX:
|
|
{
|
|
u_int8_t *cp;
|
|
|
|
bcopy((caddr_t)&(satoipx_addr(dst).x_host), (caddr_t)edst,
|
|
ISO88025_ADDR_LEN);
|
|
|
|
M_PREPEND(m, 3, M_WAIT);
|
|
m = m_pullup(m, 3);
|
|
if (m == 0)
|
|
senderr(ENOBUFS);
|
|
cp = mtod(m, u_int8_t *);
|
|
*cp++ = ETHERTYPE_IPX_8022;
|
|
*cp++ = ETHERTYPE_IPX_8022;
|
|
*cp++ = LLC_UI;
|
|
}
|
|
break;
|
|
#endif /* IPX */
|
|
case AF_UNSPEC:
|
|
{
|
|
struct iso88025_sockaddr_data *sd;
|
|
/*
|
|
* For AF_UNSPEC sockaddr.sa_data must contain all of the
|
|
* mac information needed to send the packet. This allows
|
|
* full mac, llc, and source routing function to be controlled.
|
|
* llc and source routing information must already be in the
|
|
* mbuf provided, ac/fc are set in sa_data. sockaddr.sa_data
|
|
* should be an iso88025_sockaddr_data structure see iso88025.h
|
|
*/
|
|
loop_copy = -1;
|
|
sd = (struct iso88025_sockaddr_data *)dst->sa_data;
|
|
gen_th.ac = sd->ac;
|
|
gen_th.fc = sd->fc;
|
|
(void)memcpy((caddr_t)edst, (caddr_t)sd->ether_dhost,
|
|
ISO88025_ADDR_LEN);
|
|
(void)memcpy((caddr_t)gen_th.iso88025_shost,
|
|
(caddr_t)sd->ether_shost, ISO88025_ADDR_LEN);
|
|
rif_len = 0;
|
|
break;
|
|
}
|
|
default:
|
|
if_printf(ifp, "can't handle af%d\n", dst->sa_family);
|
|
senderr(EAFNOSUPPORT);
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Add LLC header.
|
|
*/
|
|
if (snap_type != 0) {
|
|
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;
|
|
l->llc_snap.ether_type = htons(snap_type);
|
|
}
|
|
|
|
/*
|
|
* Add local net header. If no space in first mbuf,
|
|
* allocate another.
|
|
*/
|
|
M_PREPEND(m, ISO88025_HDR_LEN + rif_len, M_DONTWAIT);
|
|
if (m == 0)
|
|
senderr(ENOBUFS);
|
|
th = mtod(m, struct iso88025_header *);
|
|
bcopy((caddr_t)edst, (caddr_t)&gen_th.iso88025_dhost, ISO88025_ADDR_LEN);
|
|
|
|
/* Copy as much of the generic header as is needed into the mbuf */
|
|
memcpy(th, &gen_th, ISO88025_HDR_LEN + rif_len);
|
|
|
|
/*
|
|
* If a simplex interface, and the packet is being sent to our
|
|
* Ethernet address or a broadcast address, loopback a copy.
|
|
* XXX To make a simplex device behave exactly like a duplex
|
|
* device, we should copy in the case of sending to our own
|
|
* ethernet address (thus letting the original actually appear
|
|
* on the wire). However, we don't do that here for security
|
|
* reasons and compatibility with the original behavior.
|
|
*/
|
|
if ((ifp->if_flags & IFF_SIMPLEX) && (loop_copy != -1)) {
|
|
if ((m->m_flags & M_BCAST) || (loop_copy > 0)) {
|
|
struct mbuf *n;
|
|
n = m_copy(m, 0, (int)M_COPYALL);
|
|
(void) if_simloop(ifp, n, dst->sa_family,
|
|
ISO88025_HDR_LEN);
|
|
} else if (bcmp(th->iso88025_dhost, th->iso88025_shost,
|
|
ETHER_ADDR_LEN) == 0) {
|
|
(void) if_simloop(ifp, m, dst->sa_family,
|
|
ISO88025_HDR_LEN);
|
|
return(0); /* XXX */
|
|
}
|
|
}
|
|
|
|
IFQ_HANDOFF_ADJ(ifp, m, ISO88025_HDR_LEN + LLC_SNAPFRAMELEN, error);
|
|
if (error) {
|
|
printf("iso88025_output: packet dropped QFULL.\n");
|
|
ifp->if_oerrors++;
|
|
}
|
|
return (error);
|
|
|
|
bad:
|
|
ifp->if_oerrors++;
|
|
if (m)
|
|
m_freem(m);
|
|
return (error);
|
|
}
|
|
|
|
/*
|
|
* ISO 88025 de-encapsulation
|
|
*/
|
|
void
|
|
iso88025_input(ifp, m)
|
|
struct ifnet *ifp;
|
|
struct mbuf *m;
|
|
{
|
|
struct iso88025_header *th;
|
|
struct llc *l;
|
|
int isr;
|
|
int mac_hdr_len;
|
|
|
|
/*
|
|
* Do consistency checks to verify assumptions
|
|
* made by code past this point.
|
|
*/
|
|
if ((m->m_flags & M_PKTHDR) == 0) {
|
|
if_printf(ifp, "discard frame w/o packet header\n");
|
|
ifp->if_ierrors++;
|
|
m_freem(m);
|
|
return;
|
|
}
|
|
if (m->m_pkthdr.rcvif == NULL) {
|
|
if_printf(ifp, "discard frame w/o interface pointer\n");
|
|
ifp->if_ierrors++;
|
|
m_freem(m);
|
|
return;
|
|
}
|
|
|
|
m = m_pullup(m, ISO88025_HDR_LEN);
|
|
if (m == NULL) {
|
|
ifp->if_ierrors++;
|
|
goto dropanyway;
|
|
}
|
|
th = mtod(m, struct iso88025_header *);
|
|
m->m_pkthdr.header = (void *)th;
|
|
|
|
/*
|
|
* Discard packet if interface is not up.
|
|
*/
|
|
if (!((ifp->if_flags & IFF_UP) &&
|
|
(ifp->if_drv_flags & IFF_DRV_RUNNING)))
|
|
goto dropanyway;
|
|
|
|
/*
|
|
* Give bpf a chance at the packet.
|
|
*/
|
|
BPF_MTAP(ifp, m);
|
|
|
|
/*
|
|
* Interface marked for monitoring; discard packet.
|
|
*/
|
|
if (ifp->if_flags & IFF_MONITOR) {
|
|
m_freem(m);
|
|
return;
|
|
}
|
|
|
|
#ifdef MAC
|
|
mac_ifnet_create_mbuf(ifp, m);
|
|
#endif
|
|
|
|
/*
|
|
* Update interface statistics.
|
|
*/
|
|
ifp->if_ibytes += m->m_pkthdr.len;
|
|
getmicrotime(&ifp->if_lastchange);
|
|
|
|
/*
|
|
* Discard non local unicast packets when interface
|
|
* is in promiscuous mode.
|
|
*/
|
|
if ((ifp->if_flags & IFF_PROMISC) &&
|
|
((th->iso88025_dhost[0] & 1) == 0) &&
|
|
(bcmp(IF_LLADDR(ifp), (caddr_t) th->iso88025_dhost,
|
|
ISO88025_ADDR_LEN) != 0))
|
|
goto dropanyway;
|
|
|
|
/*
|
|
* Set mbuf flags for bcast/mcast.
|
|
*/
|
|
if (th->iso88025_dhost[0] & 1) {
|
|
if (bcmp(iso88025_broadcastaddr, th->iso88025_dhost,
|
|
ISO88025_ADDR_LEN) == 0)
|
|
m->m_flags |= M_BCAST;
|
|
else
|
|
m->m_flags |= M_MCAST;
|
|
ifp->if_imcasts++;
|
|
}
|
|
|
|
mac_hdr_len = ISO88025_HDR_LEN;
|
|
/* Check for source routing info */
|
|
if (th->iso88025_shost[0] & TR_RII)
|
|
mac_hdr_len += TR_RCF_RIFLEN(th->rcf);
|
|
|
|
/* Strip off ISO88025 header. */
|
|
m_adj(m, mac_hdr_len);
|
|
|
|
m = m_pullup(m, LLC_SNAPFRAMELEN);
|
|
if (m == 0) {
|
|
ifp->if_ierrors++;
|
|
goto dropanyway;
|
|
}
|
|
l = mtod(m, struct llc *);
|
|
|
|
switch (l->llc_dsap) {
|
|
#ifdef IPX
|
|
case ETHERTYPE_IPX_8022: /* Thanks a bunch Novell */
|
|
if ((l->llc_control != LLC_UI) ||
|
|
(l->llc_ssap != ETHERTYPE_IPX_8022)) {
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
}
|
|
|
|
th->iso88025_shost[0] &= ~(TR_RII);
|
|
m_adj(m, 3);
|
|
isr = NETISR_IPX;
|
|
break;
|
|
#endif /* IPX */
|
|
case LLC_SNAP_LSAP: {
|
|
u_int16_t type;
|
|
if ((l->llc_control != LLC_UI) ||
|
|
(l->llc_ssap != LLC_SNAP_LSAP)) {
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
}
|
|
|
|
if (l->llc_snap.org_code[0] != 0 ||
|
|
l->llc_snap.org_code[1] != 0 ||
|
|
l->llc_snap.org_code[2] != 0) {
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
}
|
|
|
|
type = ntohs(l->llc_snap.ether_type);
|
|
m_adj(m, LLC_SNAPFRAMELEN);
|
|
switch (type) {
|
|
#ifdef INET
|
|
case ETHERTYPE_IP:
|
|
th->iso88025_shost[0] &= ~(TR_RII);
|
|
if ((m = ip_fastforward(m)) == NULL)
|
|
return;
|
|
isr = NETISR_IP;
|
|
break;
|
|
|
|
case ETHERTYPE_ARP:
|
|
if (ifp->if_flags & IFF_NOARP)
|
|
goto dropanyway;
|
|
isr = NETISR_ARP;
|
|
break;
|
|
#endif /* INET */
|
|
#ifdef IPX_SNAP /* XXX: Not supported! */
|
|
case ETHERTYPE_IPX:
|
|
th->iso88025_shost[0] &= ~(TR_RII);
|
|
isr = NETISR_IPX;
|
|
break;
|
|
#endif /* IPX_SNAP */
|
|
#ifdef INET6
|
|
case ETHERTYPE_IPV6:
|
|
th->iso88025_shost[0] &= ~(TR_RII);
|
|
isr = NETISR_IPV6;
|
|
break;
|
|
#endif /* INET6 */
|
|
default:
|
|
printf("iso88025_input: unexpected llc_snap ether_type 0x%02x\n", type);
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
}
|
|
break;
|
|
}
|
|
#ifdef ISO
|
|
case LLC_ISO_LSAP:
|
|
switch (l->llc_control) {
|
|
case LLC_UI:
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
break;
|
|
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;
|
|
struct arpcom *ac;
|
|
struct iso88025_sockaddr_data *th2;
|
|
int i;
|
|
u_char c;
|
|
|
|
c = l->llc_dsap;
|
|
|
|
if (th->iso88025_shost[0] & TR_RII) { /* XXX */
|
|
printf("iso88025_input: dropping source routed LLC_TEST\n");
|
|
goto dropanyway;
|
|
}
|
|
l->llc_dsap = l->llc_ssap;
|
|
l->llc_ssap = c;
|
|
if (m->m_flags & (M_BCAST | M_MCAST))
|
|
bcopy((caddr_t)IF_LLADDR(ifp),
|
|
(caddr_t)th->iso88025_dhost,
|
|
ISO88025_ADDR_LEN);
|
|
sa.sa_family = AF_UNSPEC;
|
|
sa.sa_len = sizeof(sa);
|
|
th2 = (struct iso88025_sockaddr_data *)sa.sa_data;
|
|
for (i = 0; i < ISO88025_ADDR_LEN; i++) {
|
|
th2->ether_shost[i] = c = th->iso88025_dhost[i];
|
|
th2->ether_dhost[i] = th->iso88025_dhost[i] =
|
|
th->iso88025_shost[i];
|
|
th->iso88025_shost[i] = c;
|
|
}
|
|
th2->ac = TR_AC;
|
|
th2->fc = TR_LLC_FRAME;
|
|
ifp->if_output(ifp, m, &sa, NULL);
|
|
return;
|
|
}
|
|
default:
|
|
printf("iso88025_input: unexpected llc control 0x%02x\n", l->llc_control);
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
break;
|
|
}
|
|
break;
|
|
#endif /* ISO */
|
|
default:
|
|
printf("iso88025_input: unknown dsap 0x%x\n", l->llc_dsap);
|
|
ifp->if_noproto++;
|
|
goto dropanyway;
|
|
break;
|
|
}
|
|
|
|
netisr_dispatch(isr, m);
|
|
return;
|
|
|
|
dropanyway:
|
|
ifp->if_iqdrops++;
|
|
if (m)
|
|
m_freem(m);
|
|
return;
|
|
}
|
|
|
|
static int
|
|
iso88025_resolvemulti (ifp, llsa, sa)
|
|
struct ifnet *ifp;
|
|
struct sockaddr **llsa;
|
|
struct sockaddr *sa;
|
|
{
|
|
struct sockaddr_dl *sdl;
|
|
#ifdef INET
|
|
struct sockaddr_in *sin;
|
|
#endif
|
|
#ifdef INET6
|
|
struct sockaddr_in6 *sin6;
|
|
#endif
|
|
u_char *e_addr;
|
|
|
|
switch(sa->sa_family) {
|
|
case AF_LINK:
|
|
/*
|
|
* No mapping needed. Just check that it's a valid MC address.
|
|
*/
|
|
sdl = (struct sockaddr_dl *)sa;
|
|
e_addr = LLADDR(sdl);
|
|
if ((e_addr[0] & 1) != 1) {
|
|
return (EADDRNOTAVAIL);
|
|
}
|
|
*llsa = 0;
|
|
return (0);
|
|
|
|
#ifdef INET
|
|
case AF_INET:
|
|
sin = (struct sockaddr_in *)sa;
|
|
if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr))) {
|
|
return (EADDRNOTAVAIL);
|
|
}
|
|
sdl = malloc(sizeof *sdl, M_IFMADDR,
|
|
M_NOWAIT|M_ZERO);
|
|
if (sdl == NULL)
|
|
return (ENOMEM);
|
|
sdl->sdl_len = sizeof *sdl;
|
|
sdl->sdl_family = AF_LINK;
|
|
sdl->sdl_index = ifp->if_index;
|
|
sdl->sdl_type = IFT_ISO88025;
|
|
sdl->sdl_alen = ISO88025_ADDR_LEN;
|
|
e_addr = LLADDR(sdl);
|
|
ETHER_MAP_IP_MULTICAST(&sin->sin_addr, e_addr);
|
|
*llsa = (struct sockaddr *)sdl;
|
|
return (0);
|
|
#endif
|
|
#ifdef INET6
|
|
case AF_INET6:
|
|
sin6 = (struct sockaddr_in6 *)sa;
|
|
if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
|
|
/*
|
|
* An IP6 address of 0 means listen to all
|
|
* of the Ethernet multicast address used for IP6.
|
|
* (This is used for multicast routers.)
|
|
*/
|
|
ifp->if_flags |= IFF_ALLMULTI;
|
|
*llsa = 0;
|
|
return (0);
|
|
}
|
|
if (!IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr)) {
|
|
return (EADDRNOTAVAIL);
|
|
}
|
|
sdl = malloc(sizeof *sdl, M_IFMADDR,
|
|
M_NOWAIT|M_ZERO);
|
|
if (sdl == NULL)
|
|
return (ENOMEM);
|
|
sdl->sdl_len = sizeof *sdl;
|
|
sdl->sdl_family = AF_LINK;
|
|
sdl->sdl_index = ifp->if_index;
|
|
sdl->sdl_type = IFT_ISO88025;
|
|
sdl->sdl_alen = ISO88025_ADDR_LEN;
|
|
e_addr = LLADDR(sdl);
|
|
ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, e_addr);
|
|
*llsa = (struct sockaddr *)sdl;
|
|
return (0);
|
|
#endif
|
|
|
|
default:
|
|
/*
|
|
* Well, the text isn't quite right, but it's the name
|
|
* that counts...
|
|
*/
|
|
return (EAFNOSUPPORT);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
MALLOC_DEFINE(M_ISO88025, "arpcom", "802.5 interface internals");
|
|
|
|
static void*
|
|
iso88025_alloc(u_char type, struct ifnet *ifp)
|
|
{
|
|
struct arpcom *ac;
|
|
|
|
ac = malloc(sizeof(struct arpcom), M_ISO88025, M_WAITOK | M_ZERO);
|
|
ac->ac_ifp = ifp;
|
|
|
|
return (ac);
|
|
}
|
|
|
|
static void
|
|
iso88025_free(void *com, u_char type)
|
|
{
|
|
|
|
free(com, M_ISO88025);
|
|
}
|
|
|
|
static int
|
|
iso88025_modevent(module_t mod, int type, void *data)
|
|
{
|
|
|
|
switch (type) {
|
|
case MOD_LOAD:
|
|
if_register_com_alloc(IFT_ISO88025, iso88025_alloc,
|
|
iso88025_free);
|
|
break;
|
|
case MOD_UNLOAD:
|
|
if_deregister_com_alloc(IFT_ISO88025);
|
|
break;
|
|
default:
|
|
return EOPNOTSUPP;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static moduledata_t iso88025_mod = {
|
|
"iso88025",
|
|
iso88025_modevent,
|
|
0
|
|
};
|
|
|
|
DECLARE_MODULE(iso88025, iso88025_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
|
|
MODULE_VERSION(iso88025, 1);
|