Home | History | Annotate | Line # | Download | only in net
if_ethersubr.c revision 1.108
      1  1.108    itojun /*	$NetBSD: if_ethersubr.c,v 1.108 2003/05/16 04:54:55 itojun Exp $	*/
      2   1.44    itojun 
      3   1.44    itojun /*
      4   1.44    itojun  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      5   1.44    itojun  * All rights reserved.
      6   1.44    itojun  *
      7   1.44    itojun  * Redistribution and use in source and binary forms, with or without
      8   1.44    itojun  * modification, are permitted provided that the following conditions
      9   1.44    itojun  * are met:
     10   1.44    itojun  * 1. Redistributions of source code must retain the above copyright
     11   1.44    itojun  *    notice, this list of conditions and the following disclaimer.
     12   1.44    itojun  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.44    itojun  *    notice, this list of conditions and the following disclaimer in the
     14   1.44    itojun  *    documentation and/or other materials provided with the distribution.
     15   1.44    itojun  * 3. Neither the name of the project nor the names of its contributors
     16   1.44    itojun  *    may be used to endorse or promote products derived from this software
     17   1.44    itojun  *    without specific prior written permission.
     18   1.44    itojun  *
     19   1.44    itojun  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     20   1.44    itojun  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21   1.44    itojun  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22   1.44    itojun  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     23   1.44    itojun  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24   1.44    itojun  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25   1.44    itojun  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26   1.44    itojun  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27   1.44    itojun  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28   1.44    itojun  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29   1.44    itojun  * SUCH DAMAGE.
     30   1.44    itojun  */
     31    1.9       cgd 
     32    1.1       cgd /*
     33    1.8   mycroft  * Copyright (c) 1982, 1989, 1993
     34    1.8   mycroft  *	The Regents of the University of California.  All rights reserved.
     35    1.1       cgd  *
     36    1.1       cgd  * Redistribution and use in source and binary forms, with or without
     37    1.1       cgd  * modification, are permitted provided that the following conditions
     38    1.1       cgd  * are met:
     39    1.1       cgd  * 1. Redistributions of source code must retain the above copyright
     40    1.1       cgd  *    notice, this list of conditions and the following disclaimer.
     41    1.1       cgd  * 2. Redistributions in binary form must reproduce the above copyright
     42    1.1       cgd  *    notice, this list of conditions and the following disclaimer in the
     43    1.1       cgd  *    documentation and/or other materials provided with the distribution.
     44    1.1       cgd  * 3. All advertising materials mentioning features or use of this software
     45    1.1       cgd  *    must display the following acknowledgement:
     46    1.1       cgd  *	This product includes software developed by the University of
     47    1.1       cgd  *	California, Berkeley and its contributors.
     48    1.1       cgd  * 4. Neither the name of the University nor the names of its contributors
     49    1.1       cgd  *    may be used to endorse or promote products derived from this software
     50    1.1       cgd  *    without specific prior written permission.
     51    1.1       cgd  *
     52    1.1       cgd  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     53    1.1       cgd  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     54    1.1       cgd  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     55    1.1       cgd  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     56    1.1       cgd  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     57    1.1       cgd  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     58    1.1       cgd  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     59    1.1       cgd  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     60    1.1       cgd  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     61    1.1       cgd  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     62    1.1       cgd  * SUCH DAMAGE.
     63    1.1       cgd  *
     64   1.27      fvdl  *	@(#)if_ethersubr.c	8.2 (Berkeley) 4/4/96
     65    1.1       cgd  */
     66   1.90     lukem 
     67   1.90     lukem #include <sys/cdefs.h>
     68  1.108    itojun __KERNEL_RCSID(0, "$NetBSD: if_ethersubr.c,v 1.108 2003/05/16 04:54:55 itojun Exp $");
     69    1.1       cgd 
     70   1.33  jonathan #include "opt_inet.h"
     71   1.33  jonathan #include "opt_atalk.h"
     72   1.34  jonathan #include "opt_ccitt.h"
     73   1.35  jonathan #include "opt_llc.h"
     74   1.36  jonathan #include "opt_iso.h"
     75   1.37  jonathan #include "opt_ns.h"
     76   1.30      matt #include "opt_gateway.h"
     77   1.77   thorpej #include "opt_pfil_hooks.h"
     78   1.59   thorpej #include "vlan.h"
     79   1.81    martin #include "pppoe.h"
     80   1.78   thorpej #include "bridge.h"
     81   1.69   thorpej #include "bpfilter.h"
     82   1.93    martin #include "arp.h"
     83   1.30      matt 
     84    1.4   mycroft #include <sys/param.h>
     85    1.4   mycroft #include <sys/systm.h>
     86    1.4   mycroft #include <sys/kernel.h>
     87   1.81    martin #include <sys/callout.h>
     88    1.4   mycroft #include <sys/malloc.h>
     89    1.4   mycroft #include <sys/mbuf.h>
     90    1.4   mycroft #include <sys/protosw.h>
     91    1.4   mycroft #include <sys/socket.h>
     92    1.4   mycroft #include <sys/ioctl.h>
     93    1.4   mycroft #include <sys/errno.h>
     94    1.4   mycroft #include <sys/syslog.h>
     95    1.4   mycroft 
     96    1.8   mycroft #include <machine/cpu.h>
     97    1.8   mycroft 
     98    1.4   mycroft #include <net/if.h>
     99    1.4   mycroft #include <net/netisr.h>
    100    1.4   mycroft #include <net/route.h>
    101    1.4   mycroft #include <net/if_llc.h>
    102    1.4   mycroft #include <net/if_dl.h>
    103    1.8   mycroft #include <net/if_types.h>
    104   1.93    martin 
    105   1.93    martin #if NARP == 0
    106   1.93    martin /*
    107  1.102      jmmv  * XXX there should really be a way to issue this warning from within config(8)
    108   1.93    martin  */
    109  1.102      jmmv #error You have included a pseudo-device in your configuration that depends on the presence of ethernet interfaces, but have no such interfaces configured. Check if you really need pseudo-device bridge, ppppoe or vlan.
    110   1.93    martin #endif
    111    1.1       cgd 
    112   1.69   thorpej #if NBPFILTER > 0
    113   1.69   thorpej #include <net/bpf.h>
    114   1.69   thorpej #endif
    115   1.69   thorpej 
    116   1.22        is #include <net/if_ether.h>
    117   1.59   thorpej #if NVLAN > 0
    118   1.59   thorpej #include <net/if_vlanvar.h>
    119   1.59   thorpej #endif
    120   1.22        is 
    121   1.81    martin #if NPPPOE > 0
    122   1.81    martin #include <net/if_pppoe.h>
    123   1.81    martin #endif
    124   1.81    martin 
    125   1.78   thorpej #if NBRIDGE > 0
    126   1.78   thorpej #include <net/if_bridgevar.h>
    127   1.78   thorpej #endif
    128   1.78   thorpej 
    129   1.15      phil #include <netinet/in.h>
    130    1.1       cgd #ifdef INET
    131    1.4   mycroft #include <netinet/in_var.h>
    132    1.1       cgd #endif
    133   1.22        is #include <netinet/if_inarp.h>
    134    1.1       cgd 
    135   1.44    itojun #ifdef INET6
    136   1.44    itojun #ifndef INET
    137   1.44    itojun #include <netinet/in.h>
    138   1.44    itojun #endif
    139   1.44    itojun #include <netinet6/in6_var.h>
    140   1.44    itojun #include <netinet6/nd6.h>
    141   1.44    itojun #endif
    142   1.44    itojun 
    143    1.1       cgd #ifdef NS
    144    1.4   mycroft #include <netns/ns.h>
    145    1.4   mycroft #include <netns/ns_if.h>
    146    1.1       cgd #endif
    147    1.1       cgd 
    148   1.32  christos #ifdef IPX
    149   1.32  christos #include <netipx/ipx.h>
    150   1.32  christos #include <netipx/ipx_if.h>
    151   1.32  christos #endif
    152   1.32  christos 
    153    1.1       cgd #ifdef ISO
    154    1.4   mycroft #include <netiso/argo_debug.h>
    155    1.4   mycroft #include <netiso/iso.h>
    156    1.4   mycroft #include <netiso/iso_var.h>
    157    1.4   mycroft #include <netiso/iso_snpac.h>
    158    1.1       cgd #endif
    159    1.4   mycroft 
    160    1.8   mycroft #ifdef LLC
    161    1.8   mycroft #include <netccitt/dll.h>
    162    1.8   mycroft #include <netccitt/llc_var.h>
    163    1.8   mycroft #endif
    164    1.8   mycroft 
    165    1.8   mycroft #if defined(LLC) && defined(CCITT)
    166    1.8   mycroft extern struct ifqueue pkintrq;
    167    1.8   mycroft #endif
    168    1.1       cgd 
    169   1.23  christos #ifdef NETATALK
    170   1.23  christos #include <netatalk/at.h>
    171   1.23  christos #include <netatalk/at_var.h>
    172   1.23  christos #include <netatalk/at_extern.h>
    173   1.23  christos 
    174   1.23  christos #define llc_snap_org_code llc_un.type_snap.org_code
    175   1.23  christos #define llc_snap_ether_type llc_un.type_snap.ether_type
    176   1.23  christos 
    177   1.23  christos extern u_char	at_org_code[3];
    178   1.23  christos extern u_char	aarp_org_code[3];
    179   1.23  christos #endif /* NETATALK */
    180   1.23  christos 
    181    1.1       cgd u_char	etherbroadcastaddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
    182    1.8   mycroft #define senderr(e) { error = (e); goto bad;}
    183    1.1       cgd 
    184   1.22        is #define SIN(x) ((struct sockaddr_in *)x)
    185   1.22        is 
    186   1.42   thorpej static	int ether_output __P((struct ifnet *, struct mbuf *,
    187   1.42   thorpej 	    struct sockaddr *, struct rtentry *));
    188   1.42   thorpej static	void ether_input __P((struct ifnet *, struct mbuf *));
    189   1.42   thorpej 
    190    1.1       cgd /*
    191    1.1       cgd  * Ethernet output routine.
    192    1.1       cgd  * Encapsulate a packet of type family for the local net.
    193   1.22        is  * Assumes that ifp is actually pointer to ethercom structure.
    194    1.1       cgd  */
    195   1.42   thorpej static int
    196   1.58      matt ether_output(struct ifnet *ifp, struct mbuf *m0, struct sockaddr *dst,
    197   1.58      matt 	struct rtentry *rt0)
    198    1.1       cgd {
    199   1.49      matt 	u_int16_t etype = 0;
    200   1.72   thorpej 	int s, len, error = 0, hdrcmplt = 0;
    201   1.31   thorpej  	u_char esrc[6], edst[6];
    202   1.29       mrg 	struct mbuf *m = m0;
    203   1.29       mrg 	struct rtentry *rt;
    204    1.1       cgd 	struct mbuf *mcopy = (struct mbuf *)0;
    205   1.29       mrg 	struct ether_header *eh;
    206   1.72   thorpej 	ALTQ_DECL(struct altq_pktattr pktattr;)
    207   1.24  christos #ifdef INET
    208   1.22        is 	struct arphdr *ah;
    209   1.24  christos #endif /* INET */
    210   1.23  christos #ifdef NETATALK
    211   1.23  christos 	struct at_ifaddr *aa;
    212   1.23  christos #endif /* NETATALK */
    213   1.72   thorpej 	short mflags;
    214    1.1       cgd 
    215  1.104      matt #ifdef MBUFTRACE
    216  1.104      matt 	m_claim(m, ifp->if_mowner);
    217  1.104      matt #endif
    218    1.8   mycroft 	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
    219    1.8   mycroft 		senderr(ENETDOWN);
    220   1.18  christos 	if ((rt = rt0) != NULL) {
    221    1.8   mycroft 		if ((rt->rt_flags & RTF_UP) == 0) {
    222   1.27      fvdl 			if ((rt0 = rt = rtalloc1(dst, 1)) != NULL) {
    223    1.8   mycroft 				rt->rt_refcnt--;
    224   1.27      fvdl 				if (rt->rt_ifp != ifp)
    225   1.27      fvdl 					return (*rt->rt_ifp->if_output)
    226   1.27      fvdl 							(ifp, m0, dst, rt);
    227   1.27      fvdl 			} else
    228    1.8   mycroft 				senderr(EHOSTUNREACH);
    229    1.8   mycroft 		}
    230   1.27      fvdl 		if ((rt->rt_flags & RTF_GATEWAY) && dst->sa_family != AF_NS) {
    231    1.8   mycroft 			if (rt->rt_gwroute == 0)
    232    1.8   mycroft 				goto lookup;
    233    1.8   mycroft 			if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
    234    1.8   mycroft 				rtfree(rt); rt = rt0;
    235    1.8   mycroft 			lookup: rt->rt_gwroute = rtalloc1(rt->rt_gateway, 1);
    236    1.8   mycroft 				if ((rt = rt->rt_gwroute) == 0)
    237    1.8   mycroft 					senderr(EHOSTUNREACH);
    238   1.27      fvdl 				/* the "G" test below also prevents rt == rt0 */
    239   1.27      fvdl 				if ((rt->rt_flags & RTF_GATEWAY) ||
    240   1.27      fvdl 				    (rt->rt_ifp != ifp)) {
    241   1.27      fvdl 					rt->rt_refcnt--;
    242   1.27      fvdl 					rt0->rt_gwroute = 0;
    243   1.27      fvdl 					senderr(EHOSTUNREACH);
    244   1.27      fvdl 				}
    245    1.8   mycroft 			}
    246    1.8   mycroft 		}
    247    1.8   mycroft 		if (rt->rt_flags & RTF_REJECT)
    248    1.8   mycroft 			if (rt->rt_rmx.rmx_expire == 0 ||
    249   1.98   thorpej 			    (u_long) time.tv_sec < rt->rt_rmx.rmx_expire)
    250    1.8   mycroft 				senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
    251    1.1       cgd 	}
    252   1.72   thorpej 
    253    1.1       cgd 	switch (dst->sa_family) {
    254    1.1       cgd 
    255    1.1       cgd #ifdef INET
    256    1.1       cgd 	case AF_INET:
    257   1.22        is 		if (m->m_flags & M_BCAST)
    258   1.22        is                 	bcopy((caddr_t)etherbroadcastaddr, (caddr_t)edst,
    259   1.22        is 				sizeof(edst));
    260   1.22        is 
    261   1.22        is 		else if (m->m_flags & M_MCAST) {
    262   1.22        is 			ETHER_MAP_IP_MULTICAST(&SIN(dst)->sin_addr,
    263   1.22        is 			    (caddr_t)edst)
    264   1.22        is 
    265   1.22        is 		} else if (!arpresolve(ifp, rt, m, dst, edst))
    266    1.1       cgd 			return (0);	/* if not yet resolved */
    267    1.3   hpeyerl 		/* If broadcasting on a simplex interface, loopback a copy */
    268    1.3   hpeyerl 		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
    269    1.1       cgd 			mcopy = m_copy(m, 0, (int)M_COPYALL);
    270   1.17   mycroft 		etype = htons(ETHERTYPE_IP);
    271    1.8   mycroft 		break;
    272   1.22        is 
    273   1.22        is 	case AF_ARP:
    274   1.22        is 		ah = mtod(m, struct arphdr *);
    275   1.22        is 		if (m->m_flags & M_BCAST)
    276   1.22        is                 	bcopy((caddr_t)etherbroadcastaddr, (caddr_t)edst,
    277   1.22        is 				sizeof(edst));
    278   1.22        is 		else
    279   1.22        is 			bcopy((caddr_t)ar_tha(ah),
    280   1.22        is 				(caddr_t)edst, sizeof(edst));
    281   1.22        is 
    282   1.22        is 		ah->ar_hrd = htons(ARPHRD_ETHER);
    283   1.22        is 
    284  1.107    itojun 		switch (ntohs(ah->ar_op)) {
    285   1.22        is 		case ARPOP_REVREQUEST:
    286   1.22        is 		case ARPOP_REVREPLY:
    287   1.22        is 			etype = htons(ETHERTYPE_REVARP);
    288   1.22        is 			break;
    289   1.22        is 
    290   1.22        is 		case ARPOP_REQUEST:
    291   1.22        is 		case ARPOP_REPLY:
    292   1.22        is 		default:
    293   1.22        is 			etype = htons(ETHERTYPE_ARP);
    294   1.22        is 		}
    295   1.22        is 
    296   1.22        is 		break;
    297    1.1       cgd #endif
    298   1.44    itojun #ifdef INET6
    299   1.44    itojun 	case AF_INET6:
    300   1.51    itojun 		if (!nd6_storelladdr(ifp, rt, m, dst, (u_char *)edst)){
    301   1.67    itojun 			/* something bad happened */
    302   1.99    itojun 			return (0);
    303   1.51    itojun 		}
    304   1.44    itojun 		etype = htons(ETHERTYPE_IPV6);
    305   1.44    itojun 		break;
    306   1.44    itojun #endif
    307   1.23  christos #ifdef NETATALK
    308   1.23  christos     case AF_APPLETALK:
    309   1.23  christos 		if (!aarpresolve(ifp, m, (struct sockaddr_at *)dst, edst)) {
    310   1.23  christos #ifdef NETATALKDEBUG
    311   1.23  christos 			printf("aarpresolv failed\n");
    312   1.23  christos #endif /* NETATALKDEBUG */
    313   1.23  christos 			return (0);
    314   1.23  christos 		}
    315   1.23  christos 		/*
    316   1.23  christos 		 * ifaddr is the first thing in at_ifaddr
    317   1.23  christos 		 */
    318   1.23  christos 		aa = (struct at_ifaddr *) at_ifawithnet(
    319   1.25  christos 		    (struct sockaddr_at *)dst, ifp);
    320   1.23  christos 		if (aa == NULL)
    321   1.23  christos 		    goto bad;
    322   1.23  christos 
    323   1.23  christos 		/*
    324   1.23  christos 		 * In the phase 2 case, we need to prepend an mbuf for the
    325   1.23  christos 		 * llc header.  Since we must preserve the value of m,
    326   1.23  christos 		 * which is passed to us by value, we m_copy() the first
    327   1.23  christos 		 * mbuf, and use it for our llc header.
    328   1.23  christos 		 */
    329   1.23  christos 		if (aa->aa_flags & AFA_PHASE2) {
    330   1.23  christos 			struct llc llc;
    331   1.23  christos 
    332   1.43    bouyer 			M_PREPEND(m, sizeof(struct llc), M_DONTWAIT);
    333   1.23  christos 			llc.llc_dsap = llc.llc_ssap = LLC_SNAP_LSAP;
    334   1.23  christos 			llc.llc_control = LLC_UI;
    335   1.23  christos 			bcopy(at_org_code, llc.llc_snap_org_code,
    336   1.23  christos 			    sizeof(llc.llc_snap_org_code));
    337   1.38       kim 			llc.llc_snap_ether_type = htons(ETHERTYPE_ATALK);
    338   1.23  christos 			bcopy(&llc, mtod(m, caddr_t), sizeof(struct llc));
    339   1.23  christos 		} else {
    340   1.38       kim 			etype = htons(ETHERTYPE_ATALK);
    341   1.23  christos 		}
    342   1.23  christos 		break;
    343   1.23  christos #endif /* NETATALK */
    344    1.1       cgd #ifdef NS
    345    1.1       cgd 	case AF_NS:
    346   1.17   mycroft 		etype = htons(ETHERTYPE_NS);
    347    1.1       cgd  		bcopy((caddr_t)&(((struct sockaddr_ns *)dst)->sns_addr.x_host),
    348    1.1       cgd 		    (caddr_t)edst, sizeof (edst));
    349    1.1       cgd 		if (!bcmp((caddr_t)edst, (caddr_t)&ns_thishost, sizeof(edst)))
    350    1.1       cgd 			return (looutput(ifp, m, dst, rt));
    351    1.3   hpeyerl 		/* If broadcasting on a simplex interface, loopback a copy */
    352    1.3   hpeyerl 		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
    353    1.1       cgd 			mcopy = m_copy(m, 0, (int)M_COPYALL);
    354    1.8   mycroft 		break;
    355    1.1       cgd #endif
    356   1.32  christos #ifdef IPX
    357   1.32  christos 	case AF_IPX:
    358   1.39  christos 		etype = htons(ETHERTYPE_IPX);
    359   1.39  christos  		bcopy((caddr_t)&(((struct sockaddr_ipx *)dst)->sipx_addr.x_host),
    360   1.32  christos 		    (caddr_t)edst, sizeof (edst));
    361   1.32  christos 		/* If broadcasting on a simplex interface, loopback a copy */
    362   1.32  christos 		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
    363   1.32  christos 			mcopy = m_copy(m, 0, (int)M_COPYALL);
    364   1.32  christos 		break;
    365   1.32  christos #endif
    366    1.1       cgd #ifdef	ISO
    367    1.1       cgd 	case AF_ISO: {
    368    1.1       cgd 		int	snpalen;
    369    1.1       cgd 		struct	llc *l;
    370   1.29       mrg 		struct sockaddr_dl *sdl;
    371    1.1       cgd 
    372    1.8   mycroft 		if (rt && (sdl = (struct sockaddr_dl *)rt->rt_gateway) &&
    373    1.8   mycroft 		    sdl->sdl_family == AF_LINK && sdl->sdl_alen > 0) {
    374    1.8   mycroft 			bcopy(LLADDR(sdl), (caddr_t)edst, sizeof(edst));
    375   1.18  christos 		} else {
    376   1.18  christos 			error = iso_snparesolve(ifp, (struct sockaddr_iso *)dst,
    377   1.18  christos 						(char *)edst, &snpalen);
    378   1.18  christos 			if (error)
    379   1.18  christos 				goto bad; /* Not Resolved */
    380   1.18  christos 		}
    381    1.3   hpeyerl 		/* If broadcasting on a simplex interface, loopback a copy */
    382    1.8   mycroft 		if (*edst & 1)
    383    1.8   mycroft 			m->m_flags |= (M_BCAST|M_MCAST);
    384    1.3   hpeyerl 		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX) &&
    385    1.1       cgd 		    (mcopy = m_copy(m, 0, (int)M_COPYALL))) {
    386    1.1       cgd 			M_PREPEND(mcopy, sizeof (*eh), M_DONTWAIT);
    387    1.1       cgd 			if (mcopy) {
    388    1.1       cgd 				eh = mtod(mcopy, struct ether_header *);
    389    1.1       cgd 				bcopy((caddr_t)edst,
    390    1.1       cgd 				      (caddr_t)eh->ether_dhost, sizeof (edst));
    391   1.22        is 				bcopy(LLADDR(ifp->if_sadl),
    392    1.1       cgd 				      (caddr_t)eh->ether_shost, sizeof (edst));
    393    1.1       cgd 			}
    394    1.1       cgd 		}
    395    1.1       cgd 		M_PREPEND(m, 3, M_DONTWAIT);
    396    1.1       cgd 		if (m == NULL)
    397    1.1       cgd 			return (0);
    398    1.1       cgd 		l = mtod(m, struct llc *);
    399    1.1       cgd 		l->llc_dsap = l->llc_ssap = LLC_ISO_LSAP;
    400    1.1       cgd 		l->llc_control = LLC_UI;
    401   1.18  christos #ifdef ARGO_DEBUG
    402   1.18  christos 		if (argo_debug[D_ETHER]) {
    403    1.1       cgd 			int i;
    404   1.21  christos 			printf("unoutput: sending pkt to: ");
    405    1.1       cgd 			for (i=0; i<6; i++)
    406   1.21  christos 				printf("%x ", edst[i] & 0xff);
    407   1.21  christos 			printf("\n");
    408   1.18  christos 		}
    409   1.18  christos #endif
    410    1.8   mycroft 		} break;
    411    1.8   mycroft #endif /* ISO */
    412    1.8   mycroft #ifdef	LLC
    413    1.8   mycroft /*	case AF_NSAP: */
    414    1.8   mycroft 	case AF_CCITT: {
    415   1.29       mrg 		struct sockaddr_dl *sdl =
    416    1.8   mycroft 			(struct sockaddr_dl *) rt -> rt_gateway;
    417    1.8   mycroft 
    418    1.8   mycroft 		if (sdl && sdl->sdl_family == AF_LINK
    419    1.8   mycroft 		    && sdl->sdl_alen > 0) {
    420    1.8   mycroft 			bcopy(LLADDR(sdl), (char *)edst,
    421    1.8   mycroft 				sizeof(edst));
    422    1.8   mycroft 		} else goto bad; /* Not a link interface ? Funny ... */
    423    1.8   mycroft 		if ((ifp->if_flags & IFF_SIMPLEX) && (*edst & 1) &&
    424    1.8   mycroft 		    (mcopy = m_copy(m, 0, (int)M_COPYALL))) {
    425    1.8   mycroft 			M_PREPEND(mcopy, sizeof (*eh), M_DONTWAIT);
    426    1.8   mycroft 			if (mcopy) {
    427    1.8   mycroft 				eh = mtod(mcopy, struct ether_header *);
    428    1.8   mycroft 				bcopy((caddr_t)edst,
    429    1.8   mycroft 				      (caddr_t)eh->ether_dhost, sizeof (edst));
    430   1.22        is 				bcopy(LLADDR(ifp->if_sadl),
    431    1.8   mycroft 				      (caddr_t)eh->ether_shost, sizeof (edst));
    432    1.8   mycroft 			}
    433    1.3   hpeyerl 		}
    434    1.8   mycroft #ifdef LLC_DEBUG
    435    1.8   mycroft 		{
    436    1.8   mycroft 			int i;
    437   1.29       mrg 			struct llc *l = mtod(m, struct llc *);
    438    1.8   mycroft 
    439   1.21  christos 			printf("ether_output: sending LLC2 pkt to: ");
    440    1.8   mycroft 			for (i=0; i<6; i++)
    441   1.21  christos 				printf("%x ", edst[i] & 0xff);
    442   1.21  christos 			printf(" len 0x%x dsap 0x%x ssap 0x%x control 0x%x\n",
    443   1.17   mycroft 			    m->m_pkthdr.len, l->llc_dsap & 0xff, l->llc_ssap &0xff,
    444   1.17   mycroft 			    l->llc_control & 0xff);
    445    1.8   mycroft 
    446    1.8   mycroft 		}
    447    1.8   mycroft #endif /* LLC_DEBUG */
    448    1.8   mycroft 		} break;
    449    1.8   mycroft #endif /* LLC */
    450    1.1       cgd 
    451   1.31   thorpej 	case pseudo_AF_HDRCMPLT:
    452   1.31   thorpej 		hdrcmplt = 1;
    453   1.31   thorpej 		eh = (struct ether_header *)dst->sa_data;
    454   1.31   thorpej 		bcopy((caddr_t)eh->ether_shost, (caddr_t)esrc, sizeof (esrc));
    455   1.31   thorpej 		/* FALLTHROUGH */
    456   1.31   thorpej 
    457    1.1       cgd 	case AF_UNSPEC:
    458    1.1       cgd 		eh = (struct ether_header *)dst->sa_data;
    459    1.1       cgd  		bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, sizeof (edst));
    460    1.8   mycroft 		/* AF_UNSPEC doesn't swap the byte order of the ether_type. */
    461   1.17   mycroft 		etype = eh->ether_type;
    462    1.8   mycroft 		break;
    463    1.1       cgd 
    464    1.1       cgd 	default:
    465   1.21  christos 		printf("%s: can't handle af%d\n", ifp->if_xname,
    466    1.1       cgd 			dst->sa_family);
    467    1.8   mycroft 		senderr(EAFNOSUPPORT);
    468    1.1       cgd 	}
    469    1.1       cgd 
    470    1.1       cgd 	if (mcopy)
    471    1.1       cgd 		(void) looutput(ifp, mcopy, dst, rt);
    472   1.16   mycroft 
    473   1.50      matt 	/* If no ether type is set, this must be a 802.2 formatted packet.
    474   1.50      matt 	 */
    475   1.50      matt 	if (etype == 0)
    476   1.50      matt 		etype = htons(m->m_pkthdr.len);
    477    1.1       cgd 	/*
    478    1.1       cgd 	 * Add local net header.  If no space in first mbuf,
    479    1.1       cgd 	 * allocate another.
    480    1.1       cgd 	 */
    481    1.1       cgd 	M_PREPEND(m, sizeof (struct ether_header), M_DONTWAIT);
    482    1.8   mycroft 	if (m == 0)
    483    1.8   mycroft 		senderr(ENOBUFS);
    484    1.1       cgd 	eh = mtod(m, struct ether_header *);
    485   1.96   thorpej 	/* Note: etype is already in network byte order. */
    486   1.96   thorpej #ifdef __NO_STRICT_ALIGNMENT
    487   1.97  kristerw 	eh->ether_type = etype;
    488   1.96   thorpej #else
    489   1.96   thorpej 	{
    490   1.96   thorpej 		uint8_t *dstp = (uint8_t *) &eh->ether_type;
    491   1.96   thorpej #if BYTE_ORDER == BIG_ENDIAN
    492   1.96   thorpej 		dstp[0] = etype >> 8;
    493   1.96   thorpej 		dstp[1] = etype;
    494   1.96   thorpej #else
    495   1.96   thorpej 		dstp[0] = etype;
    496   1.96   thorpej 		dstp[1] = etype >> 8;
    497   1.96   thorpej #endif /* BYTE_ORDER == BIG_ENDIAN */
    498   1.96   thorpej 	}
    499   1.96   thorpej #endif /* __NO_STRICT_ALIGNMENT */
    500    1.1       cgd  	bcopy((caddr_t)edst, (caddr_t)eh->ether_dhost, sizeof (edst));
    501   1.31   thorpej 	if (hdrcmplt)
    502   1.31   thorpej 		bcopy((caddr_t)esrc, (caddr_t)eh->ether_shost,
    503   1.31   thorpej 		    sizeof(eh->ether_shost));
    504   1.31   thorpej 	else
    505   1.31   thorpej 	 	bcopy(LLADDR(ifp->if_sadl), (caddr_t)eh->ether_shost,
    506   1.31   thorpej 		    sizeof(eh->ether_shost));
    507   1.77   thorpej 
    508   1.77   thorpej #ifdef PFIL_HOOKS
    509   1.77   thorpej 	if ((error = pfil_run_hooks(&ifp->if_pfil, &m, ifp, PFIL_OUT)) != 0)
    510   1.77   thorpej 		return (error);
    511   1.77   thorpej 	if (m == NULL)
    512   1.77   thorpej 		return (0);
    513   1.77   thorpej #endif
    514   1.77   thorpej 
    515   1.78   thorpej #if NBRIDGE > 0
    516   1.78   thorpej 	/*
    517   1.78   thorpej 	 * Bridges require special output handling.
    518   1.78   thorpej 	 */
    519   1.78   thorpej 	if (ifp->if_bridge)
    520   1.78   thorpej 		return (bridge_output(ifp, m, NULL, NULL));
    521   1.78   thorpej #endif
    522   1.78   thorpej 
    523   1.77   thorpej #ifdef ALTQ
    524   1.77   thorpej 	/*
    525   1.77   thorpej 	 * If ALTQ is enabled on the parent interface, do
    526   1.77   thorpej 	 * classification; the queueing discipline might not
    527   1.77   thorpej 	 * require classification, but might require the
    528   1.77   thorpej 	 * address family/header pointer in the pktattr.
    529   1.77   thorpej 	 */
    530   1.77   thorpej 	if (ALTQ_IS_ENABLED(&ifp->if_snd))
    531   1.77   thorpej 		altq_etherclassify(&ifp->if_snd, m, &pktattr);
    532   1.77   thorpej #endif
    533   1.77   thorpej 
    534   1.72   thorpej 	mflags = m->m_flags;
    535   1.72   thorpej 	len = m->m_pkthdr.len;
    536   1.79   thorpej 	s = splnet();
    537    1.1       cgd 	/*
    538    1.1       cgd 	 * Queue message on interface, and start output if interface
    539    1.1       cgd 	 * not yet active.
    540    1.1       cgd 	 */
    541   1.72   thorpej 	IFQ_ENQUEUE(&ifp->if_snd, m, &pktattr, error);
    542   1.72   thorpej 	if (error) {
    543   1.72   thorpej 		/* mbuf is already freed */
    544    1.1       cgd 		splx(s);
    545   1.72   thorpej 		return (error);
    546    1.1       cgd 	}
    547   1.72   thorpej 	ifp->if_obytes += len;
    548   1.72   thorpej 	if (mflags & M_MCAST)
    549   1.57   mycroft 		ifp->if_omcasts++;
    550    1.1       cgd 	if ((ifp->if_flags & IFF_OACTIVE) == 0)
    551    1.1       cgd 		(*ifp->if_start)(ifp);
    552    1.1       cgd 	splx(s);
    553    1.1       cgd 	return (error);
    554    1.1       cgd 
    555    1.1       cgd bad:
    556    1.1       cgd 	if (m)
    557    1.1       cgd 		m_freem(m);
    558    1.1       cgd 	return (error);
    559    1.1       cgd }
    560   1.76   thorpej 
    561   1.76   thorpej #ifdef ALTQ
    562   1.76   thorpej /*
    563   1.76   thorpej  * This routine is a slight hack to allow a packet to be classified
    564   1.76   thorpej  * if the Ethernet headers are present.  It will go away when ALTQ's
    565   1.76   thorpej  * classification engine understands link headers.
    566   1.76   thorpej  */
    567   1.76   thorpej void
    568   1.76   thorpej altq_etherclassify(struct ifaltq *ifq, struct mbuf *m,
    569   1.76   thorpej     struct altq_pktattr *pktattr)
    570   1.76   thorpej {
    571   1.76   thorpej 	struct ether_header *eh;
    572   1.76   thorpej 	u_int16_t ether_type;
    573   1.76   thorpej 	int hlen, af, hdrsize;
    574   1.76   thorpej 	caddr_t hdr;
    575   1.76   thorpej 
    576   1.76   thorpej 	hlen = ETHER_HDR_LEN;
    577   1.76   thorpej 	eh = mtod(m, struct ether_header *);
    578   1.76   thorpej 
    579   1.76   thorpej 	ether_type = htons(eh->ether_type);
    580   1.76   thorpej 
    581   1.76   thorpej 	if (ether_type < ETHERMTU) {
    582   1.76   thorpej 		/* LLC/SNAP */
    583   1.76   thorpej 		struct llc *llc = (struct llc *)(eh + 1);
    584   1.76   thorpej 		hlen += 8;
    585   1.76   thorpej 
    586   1.76   thorpej 		if (m->m_len < hlen ||
    587   1.76   thorpej 		    llc->llc_dsap != LLC_SNAP_LSAP ||
    588   1.76   thorpej 		    llc->llc_ssap != LLC_SNAP_LSAP ||
    589   1.76   thorpej 		    llc->llc_control != LLC_UI) {
    590   1.76   thorpej 			/* Not SNAP. */
    591   1.76   thorpej 			goto bad;
    592   1.76   thorpej 		}
    593   1.76   thorpej 
    594   1.76   thorpej 		ether_type = htons(llc->llc_un.type_snap.ether_type);
    595   1.76   thorpej 	}
    596   1.76   thorpej 
    597   1.76   thorpej 	switch (ether_type) {
    598   1.76   thorpej 	case ETHERTYPE_IP:
    599   1.76   thorpej 		af = AF_INET;
    600   1.76   thorpej 		hdrsize = 20;		/* sizeof(struct ip) */
    601   1.76   thorpej 		break;
    602   1.76   thorpej 
    603   1.76   thorpej 	case ETHERTYPE_IPV6:
    604   1.76   thorpej 		af = AF_INET6;
    605   1.76   thorpej 		hdrsize = 40;		/* sizeof(struct ip6_hdr) */
    606   1.76   thorpej 		break;
    607   1.76   thorpej 
    608   1.76   thorpej 	default:
    609   1.76   thorpej 		af = AF_UNSPEC;
    610   1.76   thorpej 		hdrsize = 0;
    611   1.76   thorpej 		break;
    612   1.76   thorpej 	}
    613   1.76   thorpej 
    614   1.95    itojun 	while (m->m_len <= hlen) {
    615   1.95    itojun 		hlen -= m->m_len;
    616   1.95    itojun 		m = m->m_next;
    617   1.95    itojun 	}
    618   1.76   thorpej 	if (m->m_len < (hlen + hdrsize)) {
    619   1.76   thorpej 		/*
    620   1.95    itojun 		 * protocol header not in a single mbuf.
    621   1.95    itojun 		 * We can't cope with this situation right
    622   1.76   thorpej 		 * now (but it shouldn't ever happen, really, anyhow).
    623   1.76   thorpej 		 */
    624   1.92    itojun #ifdef DEBUG
    625   1.78   thorpej 		printf("altq_etherclassify: headers span multiple mbufs: "
    626   1.78   thorpej 		    "%d < %d\n", m->m_len, (hlen + hdrsize));
    627   1.92    itojun #endif
    628   1.76   thorpej 		goto bad;
    629   1.76   thorpej 	}
    630   1.76   thorpej 
    631   1.76   thorpej 	m->m_data += hlen;
    632   1.76   thorpej 	m->m_len -= hlen;
    633   1.76   thorpej 
    634   1.76   thorpej 	hdr = mtod(m, caddr_t);
    635   1.76   thorpej 
    636   1.76   thorpej 	if (ALTQ_NEEDS_CLASSIFY(ifq))
    637   1.76   thorpej 		pktattr->pattr_class =
    638   1.76   thorpej 		    (*ifq->altq_classify)(ifq->altq_clfier, m, af);
    639   1.76   thorpej 	pktattr->pattr_af = af;
    640   1.76   thorpej 	pktattr->pattr_hdr = hdr;
    641   1.76   thorpej 
    642   1.76   thorpej 	m->m_data -= hlen;
    643   1.76   thorpej 	m->m_len += hlen;
    644   1.76   thorpej 
    645   1.76   thorpej 	return;
    646   1.76   thorpej 
    647   1.76   thorpej  bad:
    648   1.76   thorpej 	pktattr->pattr_class = NULL;
    649   1.76   thorpej 	pktattr->pattr_hdr = NULL;
    650   1.76   thorpej 	pktattr->pattr_af = AF_UNSPEC;
    651   1.76   thorpej }
    652   1.76   thorpej #endif /* ALTQ */
    653    1.1       cgd 
    654    1.1       cgd /*
    655    1.1       cgd  * Process a received Ethernet packet;
    656   1.42   thorpej  * the packet is in the mbuf chain m with
    657   1.42   thorpej  * the ether header.
    658    1.1       cgd  */
    659   1.42   thorpej static void
    660   1.58      matt ether_input(struct ifnet *ifp, struct mbuf *m)
    661    1.1       cgd {
    662   1.91   thorpej 	struct ethercom *ec = (struct ethercom *) ifp;
    663   1.29       mrg 	struct ifqueue *inq;
    664   1.18  christos 	u_int16_t etype;
    665   1.18  christos 	int s;
    666   1.42   thorpej 	struct ether_header *eh;
    667  1.101    itojun 	struct m_tag *mtag;
    668   1.23  christos #if defined (ISO) || defined (LLC) || defined(NETATALK)
    669   1.29       mrg 	struct llc *l;
    670   1.18  christos #endif
    671    1.1       cgd 
    672    1.8   mycroft 	if ((ifp->if_flags & IFF_UP) == 0) {
    673    1.8   mycroft 		m_freem(m);
    674    1.8   mycroft 		return;
    675    1.8   mycroft 	}
    676   1.42   thorpej 
    677  1.104      matt #ifdef MBUFTRACE
    678  1.104      matt 	m_claim(m, &ec->ec_rx_mowner);
    679  1.104      matt #endif
    680   1.42   thorpej 	eh = mtod(m, struct ether_header *);
    681   1.63   thorpej 	etype = ntohs(eh->ether_type);
    682   1.63   thorpej 
    683   1.63   thorpej 	/*
    684   1.63   thorpej 	 * Determine if the packet is within its size limits.
    685   1.63   thorpej 	 */
    686   1.83   thorpej 	if (m->m_pkthdr.len >
    687   1.83   thorpej 	    ETHER_MAX_FRAME(ifp, etype, m->m_flags & M_HASFCS)) {
    688   1.68      matt 		printf("%s: discarding oversize frame (len=%d)\n",
    689   1.68      matt 		    ifp->if_xname, m->m_pkthdr.len);
    690   1.63   thorpej 		m_freem(m);
    691   1.63   thorpej 		return;
    692   1.63   thorpej 	}
    693   1.77   thorpej 
    694   1.84   thorpej 	if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
    695   1.84   thorpej 		/*
    696   1.84   thorpej 		 * If this is not a simplex interface, drop the packet
    697   1.84   thorpej 		 * if it came from us.
    698   1.84   thorpej 		 */
    699   1.84   thorpej 		if ((ifp->if_flags & IFF_SIMPLEX) == 0 &&
    700   1.84   thorpej 		    memcmp(LLADDR(ifp->if_sadl), eh->ether_shost,
    701   1.84   thorpej 		    ETHER_ADDR_LEN) == 0) {
    702   1.84   thorpej 			m_freem(m);
    703   1.84   thorpej 			return;
    704   1.84   thorpej 		}
    705   1.84   thorpej 
    706   1.84   thorpej 		if (memcmp(etherbroadcastaddr,
    707   1.84   thorpej 		    eh->ether_dhost, ETHER_ADDR_LEN) == 0)
    708   1.84   thorpej 			m->m_flags |= M_BCAST;
    709   1.84   thorpej 		else
    710   1.84   thorpej 			m->m_flags |= M_MCAST;
    711   1.84   thorpej 		ifp->if_imcasts++;
    712   1.84   thorpej 	}
    713   1.84   thorpej 
    714   1.79   thorpej 	/* If the CRC is still on the packet, trim it off. */
    715   1.79   thorpej 	if (m->m_flags & M_HASFCS) {
    716   1.79   thorpej 		m_adj(m, -ETHER_CRC_LEN);
    717   1.79   thorpej 		m->m_flags &= ~M_HASFCS;
    718   1.79   thorpej 	}
    719   1.79   thorpej 
    720   1.42   thorpej 	ifp->if_ibytes += m->m_pkthdr.len;
    721   1.78   thorpej 
    722   1.78   thorpej #if NBRIDGE > 0
    723   1.78   thorpej 	/*
    724   1.78   thorpej 	 * Tap the packet off here for a bridge.  bridge_input()
    725   1.78   thorpej 	 * will return NULL if it has consumed the packet, otherwise
    726   1.78   thorpej 	 * it gets processed as normal.  Note that bridge_input()
    727   1.78   thorpej 	 * will always return the original packet if we need to
    728   1.78   thorpej 	 * process it locally.
    729   1.78   thorpej 	 */
    730   1.78   thorpej 	if (ifp->if_bridge) {
    731  1.106    bouyer 		/* clear M_PROMISC, in case the packets comes from a vlan */
    732  1.106    bouyer 		m->m_flags &= ~M_PROMISC;
    733   1.78   thorpej 		m = bridge_input(ifp, m);
    734   1.78   thorpej 		if (m == NULL)
    735   1.78   thorpej 			return;
    736   1.78   thorpej 
    737   1.78   thorpej 		/*
    738   1.78   thorpej 		 * Bridge has determined that the packet is for us.
    739   1.78   thorpej 		 * Update our interface pointer -- we may have had
    740   1.78   thorpej 		 * to "bridge" the packet locally.
    741   1.78   thorpej 		 */
    742   1.78   thorpej 		ifp = m->m_pkthdr.rcvif;
    743  1.106    bouyer 	} else
    744   1.78   thorpej #endif /* NBRIDGE > 0 */
    745  1.106    bouyer 	{
    746  1.106    bouyer 		if ((m->m_flags & (M_BCAST|M_MCAST)) == 0 &&
    747  1.106    bouyer 		    (ifp->if_flags & IFF_PROMISC) != 0 &&
    748  1.106    bouyer 		    memcmp(LLADDR(ifp->if_sadl), eh->ether_dhost,
    749  1.106    bouyer 			   ETHER_ADDR_LEN) != 0) {
    750  1.106    bouyer 			m->m_flags |= M_PROMISC;
    751  1.106    bouyer 		}
    752   1.70    bouyer 	}
    753   1.78   thorpej 
    754   1.78   thorpej #ifdef PFIL_HOOKS
    755  1.106    bouyer 	if ((m->m_flags & M_PROMISC) == 0) {
    756  1.106    bouyer 		if (pfil_run_hooks(&ifp->if_pfil, &m, ifp, PFIL_IN) != 0)
    757  1.106    bouyer 			return;
    758  1.106    bouyer 		if (m == NULL)
    759  1.106    bouyer 			return;
    760   1.78   thorpej 
    761  1.106    bouyer 		eh = mtod(m, struct ether_header *);
    762  1.106    bouyer 		etype = ntohs(eh->ether_type);
    763  1.106    bouyer 	}
    764   1.78   thorpej #endif
    765   1.70    bouyer 
    766   1.91   thorpej 	/*
    767   1.91   thorpej 	 * If VLANs are configured on the interface, check to
    768   1.91   thorpej 	 * see if the device performed the decapsulation and
    769   1.91   thorpej 	 * provided us with the tag.
    770   1.91   thorpej 	 */
    771   1.91   thorpej 	if (ec->ec_nvlans &&
    772  1.101    itojun 	    (mtag = m_tag_find(m, PACKET_TAG_VLAN, NULL)) != NULL) {
    773   1.70    bouyer #if NVLAN > 0
    774   1.70    bouyer 		/*
    775   1.70    bouyer 		 * vlan_input() will either recursively call ether_input()
    776   1.70    bouyer 		 * or drop the packet.
    777   1.70    bouyer 		 */
    778   1.91   thorpej 		vlan_input(ifp, m);
    779   1.91   thorpej #else
    780   1.91   thorpej 		m_freem(m);
    781   1.70    bouyer #endif
    782   1.61   thorpej 		return;
    783   1.61   thorpej 	}
    784    1.1       cgd 
    785   1.59   thorpej 	/*
    786   1.59   thorpej 	 * Handle protocols that expect to have the Ethernet header
    787   1.59   thorpej 	 * (and possibly FCS) intact.
    788   1.59   thorpej 	 */
    789   1.59   thorpej 	switch (etype) {
    790   1.59   thorpej #if NVLAN > 0
    791   1.59   thorpej 	case ETHERTYPE_VLAN:
    792   1.59   thorpej 		/*
    793   1.59   thorpej 		 * vlan_input() will either recursively call ether_input()
    794   1.59   thorpej 		 * or drop the packet.
    795   1.59   thorpej 		 */
    796   1.63   thorpej 		if (((struct ethercom *)ifp)->ec_nvlans != 0)
    797   1.63   thorpej 			vlan_input(ifp, m);
    798   1.65     enami 		else
    799   1.65     enami 			m_freem(m);
    800   1.59   thorpej 		return;
    801   1.59   thorpej #endif /* NVLAN > 0 */
    802   1.81    martin #if NPPPOE > 0
    803   1.81    martin 	case ETHERTYPE_PPPOEDISC:
    804   1.81    martin 	case ETHERTYPE_PPPOE:
    805  1.106    bouyer 		if (m->m_flags & M_PROMISC) {
    806  1.106    bouyer 			m_freem(m);
    807  1.106    bouyer 			return;
    808  1.106    bouyer 		}
    809  1.105   aymeric #ifndef PPPOE_SERVER
    810  1.105   aymeric 		if (m->m_flags & (M_MCAST | M_BCAST)) {
    811  1.105   aymeric 			m_freem(m);
    812  1.105   aymeric 			return;
    813  1.105   aymeric 		}
    814  1.105   aymeric #endif
    815  1.105   aymeric 
    816   1.81    martin 		if (etype == ETHERTYPE_PPPOEDISC)
    817   1.81    martin 			inq = &ppoediscinq;
    818   1.81    martin 		else
    819   1.81    martin 			inq = &ppoeinq;
    820   1.81    martin 		s = splnet();
    821   1.81    martin 		if (IF_QFULL(inq)) {
    822   1.81    martin 			IF_DROP(inq);
    823   1.81    martin 			m_freem(m);
    824   1.81    martin 		} else
    825   1.81    martin 			IF_ENQUEUE(inq, m);
    826   1.81    martin 		splx(s);
    827   1.81    martin #ifndef __HAVE_GENERIC_SOFT_INTERRUPTS
    828  1.103   thorpej 		if (!callout_pending(&pppoe_softintr))
    829   1.81    martin 			callout_reset(&pppoe_softintr, 1, pppoe_softintr_handler, NULL);
    830   1.81    martin #else
    831   1.81    martin 		softintr_schedule(pppoe_softintr);
    832   1.81    martin #endif
    833   1.81    martin 		return;
    834   1.81    martin #endif /* NPPPOE > 0 */
    835   1.59   thorpej 	default:
    836  1.106    bouyer 		if (m->m_flags & M_PROMISC) {
    837  1.106    bouyer 			m_freem(m);
    838  1.106    bouyer 			return;
    839  1.106    bouyer 		}
    840   1.59   thorpej 	}
    841   1.42   thorpej 
    842   1.42   thorpej 	/* Strip off the Ethernet header. */
    843   1.42   thorpej 	m_adj(m, sizeof(struct ether_header));
    844   1.45   thorpej 
    845   1.45   thorpej 	/* If the CRC is still on the packet, trim it off. */
    846   1.79   thorpej 	if (m->m_flags & M_HASFCS) {
    847   1.45   thorpej 		m_adj(m, -ETHER_CRC_LEN);
    848   1.79   thorpej 		m->m_flags &= ~M_HASFCS;
    849   1.79   thorpej 	}
    850   1.42   thorpej 
    851    1.5   deraadt 	switch (etype) {
    852    1.1       cgd #ifdef INET
    853    1.1       cgd 	case ETHERTYPE_IP:
    854   1.30      matt #ifdef GATEWAY
    855   1.30      matt 		if (ipflow_fastforward(m))
    856   1.30      matt 			return;
    857   1.30      matt #endif
    858    1.1       cgd 		schednetisr(NETISR_IP);
    859    1.1       cgd 		inq = &ipintrq;
    860    1.1       cgd 		break;
    861    1.1       cgd 
    862    1.1       cgd 	case ETHERTYPE_ARP:
    863    1.8   mycroft 		schednetisr(NETISR_ARP);
    864    1.8   mycroft 		inq = &arpintrq;
    865    1.8   mycroft 		break;
    866    1.7     glass 
    867    1.7     glass 	case ETHERTYPE_REVARP:
    868    1.8   mycroft 		revarpinput(m);	/* XXX queue? */
    869    1.1       cgd 		return;
    870    1.1       cgd #endif
    871   1.44    itojun #ifdef INET6
    872   1.44    itojun 	case ETHERTYPE_IPV6:
    873   1.44    itojun 		schednetisr(NETISR_IPV6);
    874   1.44    itojun 		inq = &ip6intrq;
    875   1.44    itojun 		break;
    876   1.44    itojun #endif
    877    1.1       cgd #ifdef NS
    878    1.1       cgd 	case ETHERTYPE_NS:
    879    1.1       cgd 		schednetisr(NETISR_NS);
    880    1.1       cgd 		inq = &nsintrq;
    881    1.1       cgd 		break;
    882    1.1       cgd 
    883   1.32  christos #endif
    884   1.32  christos #ifdef IPX
    885   1.32  christos 	case ETHERTYPE_IPX:
    886   1.32  christos 		schednetisr(NETISR_IPX);
    887   1.32  christos 		inq = &ipxintrq;
    888   1.32  christos 		break;
    889    1.1       cgd #endif
    890   1.23  christos #ifdef NETATALK
    891   1.38       kim         case ETHERTYPE_ATALK:
    892   1.23  christos                 schednetisr(NETISR_ATALK);
    893   1.23  christos                 inq = &atintrq1;
    894   1.23  christos                 break;
    895   1.23  christos         case ETHERTYPE_AARP:
    896   1.23  christos 		/* probably this should be done with a NETISR as well */
    897   1.23  christos                 aarpinput(ifp, m); /* XXX */
    898   1.23  christos                 return;
    899   1.23  christos #endif /* NETATALK */
    900    1.1       cgd 	default:
    901   1.23  christos #if defined (ISO) || defined (LLC) || defined (NETATALK)
    902   1.11   mycroft 		if (etype > ETHERMTU)
    903    1.1       cgd 			goto dropanyway;
    904    1.1       cgd 		l = mtod(m, struct llc *);
    905    1.8   mycroft 		switch (l->llc_dsap) {
    906   1.23  christos #ifdef NETATALK
    907   1.23  christos 		case LLC_SNAP_LSAP:
    908   1.23  christos 			switch (l->llc_control) {
    909   1.23  christos 			case LLC_UI:
    910   1.23  christos 				if (l->llc_ssap != LLC_SNAP_LSAP) {
    911   1.23  christos 					goto dropanyway;
    912   1.23  christos 				}
    913   1.23  christos 
    914   1.23  christos 				if (Bcmp(&(l->llc_snap_org_code)[0],
    915   1.23  christos 				    at_org_code, sizeof(at_org_code)) == 0 &&
    916   1.23  christos 				    ntohs(l->llc_snap_ether_type) ==
    917   1.38       kim 				    ETHERTYPE_ATALK) {
    918   1.23  christos 					inq = &atintrq2;
    919   1.23  christos 					m_adj(m, sizeof(struct llc));
    920   1.23  christos 					schednetisr(NETISR_ATALK);
    921   1.23  christos 					break;
    922   1.23  christos 				}
    923   1.23  christos 
    924   1.23  christos 				if (Bcmp(&(l->llc_snap_org_code)[0],
    925   1.23  christos 				    aarp_org_code,
    926   1.23  christos 				    sizeof(aarp_org_code)) == 0 &&
    927   1.23  christos 				    ntohs(l->llc_snap_ether_type) ==
    928   1.23  christos 				    ETHERTYPE_AARP) {
    929   1.23  christos 					m_adj( m, sizeof(struct llc));
    930   1.23  christos 					aarpinput(ifp, m); /* XXX */
    931   1.23  christos 				    return;
    932   1.23  christos 				}
    933   1.23  christos 
    934   1.23  christos 			default:
    935   1.23  christos 				goto dropanyway;
    936   1.23  christos 			}
    937   1.23  christos 			break;
    938   1.23  christos #endif /* NETATALK */
    939    1.8   mycroft #ifdef	ISO
    940    1.8   mycroft 		case LLC_ISO_LSAP:
    941    1.8   mycroft 			switch (l->llc_control) {
    942    1.8   mycroft 			case LLC_UI:
    943    1.8   mycroft 				/* LLC_UI_P forbidden in class 1 service */
    944    1.8   mycroft 				if ((l->llc_dsap == LLC_ISO_LSAP) &&
    945    1.8   mycroft 				    (l->llc_ssap == LLC_ISO_LSAP)) {
    946    1.8   mycroft 					/* LSAP for ISO */
    947   1.11   mycroft 					if (m->m_pkthdr.len > etype)
    948   1.11   mycroft 						m_adj(m, etype - m->m_pkthdr.len);
    949    1.8   mycroft 					m->m_data += 3;		/* XXX */
    950    1.8   mycroft 					m->m_len -= 3;		/* XXX */
    951    1.8   mycroft 					m->m_pkthdr.len -= 3;	/* XXX */
    952    1.8   mycroft 					M_PREPEND(m, sizeof *eh, M_DONTWAIT);
    953    1.8   mycroft 					if (m == 0)
    954    1.8   mycroft 						return;
    955    1.8   mycroft 					*mtod(m, struct ether_header *) = *eh;
    956   1.18  christos #ifdef ARGO_DEBUG
    957   1.18  christos 					if (argo_debug[D_ETHER])
    958   1.21  christos 						printf("clnp packet");
    959   1.18  christos #endif
    960    1.8   mycroft 					schednetisr(NETISR_ISO);
    961    1.8   mycroft 					inq = &clnlintrq;
    962    1.8   mycroft 					break;
    963    1.8   mycroft 				}
    964    1.8   mycroft 				goto dropanyway;
    965    1.8   mycroft 
    966    1.8   mycroft 			case LLC_XID:
    967    1.8   mycroft 			case LLC_XID_P:
    968    1.8   mycroft 				if(m->m_len < 6)
    969    1.8   mycroft 					goto dropanyway;
    970    1.8   mycroft 				l->llc_window = 0;
    971    1.8   mycroft 				l->llc_fid = 9;
    972    1.8   mycroft 				l->llc_class = 1;
    973    1.8   mycroft 				l->llc_dsap = l->llc_ssap = 0;
    974    1.8   mycroft 				/* Fall through to */
    975    1.8   mycroft 			case LLC_TEST:
    976    1.8   mycroft 			case LLC_TEST_P:
    977    1.8   mycroft 			{
    978    1.8   mycroft 				struct sockaddr sa;
    979   1.29       mrg 				struct ether_header *eh2;
    980    1.8   mycroft 				int i;
    981    1.8   mycroft 				u_char c = l->llc_dsap;
    982    1.8   mycroft 
    983    1.8   mycroft 				l->llc_dsap = l->llc_ssap;
    984    1.8   mycroft 				l->llc_ssap = c;
    985    1.8   mycroft 				if (m->m_flags & (M_BCAST | M_MCAST))
    986   1.22        is 					bcopy(LLADDR(ifp->if_sadl),
    987    1.8   mycroft 					      (caddr_t)eh->ether_dhost, 6);
    988    1.8   mycroft 				sa.sa_family = AF_UNSPEC;
    989    1.8   mycroft 				sa.sa_len = sizeof(sa);
    990    1.8   mycroft 				eh2 = (struct ether_header *)sa.sa_data;
    991    1.8   mycroft 				for (i = 0; i < 6; i++) {
    992   1.22        is 					eh2->ether_shost[i] = c =
    993   1.22        is 					    eh->ether_dhost[i];
    994    1.8   mycroft 					eh2->ether_dhost[i] =
    995   1.22        is 					    eh->ether_dhost[i] =
    996   1.22        is 					    eh->ether_shost[i];
    997    1.8   mycroft 					eh->ether_shost[i] = c;
    998    1.8   mycroft 				}
    999    1.8   mycroft 				ifp->if_output(ifp, m, &sa, NULL);
   1000    1.8   mycroft 				return;
   1001    1.8   mycroft 			}
   1002    1.8   mycroft 			default:
   1003    1.8   mycroft 				m_freem(m);
   1004    1.8   mycroft 				return;
   1005    1.8   mycroft 			}
   1006    1.8   mycroft 			break;
   1007    1.8   mycroft #endif /* ISO */
   1008    1.8   mycroft #ifdef LLC
   1009    1.8   mycroft 		case LLC_X25_LSAP:
   1010    1.8   mycroft 		{
   1011   1.11   mycroft 			if (m->m_pkthdr.len > etype)
   1012   1.11   mycroft 				m_adj(m, etype - m->m_pkthdr.len);
   1013    1.8   mycroft 			M_PREPEND(m, sizeof(struct sdl_hdr) , M_DONTWAIT);
   1014    1.1       cgd 			if (m == 0)
   1015    1.1       cgd 				return;
   1016    1.8   mycroft 			if ( !sdl_sethdrif(ifp, eh->ether_shost, LLC_X25_LSAP,
   1017    1.8   mycroft 					    eh->ether_dhost, LLC_X25_LSAP, 6,
   1018    1.8   mycroft 					    mtod(m, struct sdl_hdr *)))
   1019    1.8   mycroft 				panic("ETHER cons addr failure");
   1020   1.11   mycroft 			mtod(m, struct sdl_hdr *)->sdlhdr_len = etype;
   1021    1.8   mycroft #ifdef LLC_DEBUG
   1022   1.21  christos 				printf("llc packet\n");
   1023    1.8   mycroft #endif /* LLC_DEBUG */
   1024    1.8   mycroft 			schednetisr(NETISR_CCITT);
   1025    1.8   mycroft 			inq = &llcintrq;
   1026    1.1       cgd 			break;
   1027    1.1       cgd 		}
   1028    1.8   mycroft #endif /* LLC */
   1029    1.1       cgd 		dropanyway:
   1030    1.1       cgd 		default:
   1031    1.8   mycroft 			m_freem(m);
   1032    1.8   mycroft 			return;
   1033    1.8   mycroft 		}
   1034   1.23  christos #else /* ISO || LLC  || NETATALK*/
   1035    1.1       cgd 	    m_freem(m);
   1036    1.1       cgd 	    return;
   1037   1.23  christos #endif /* ISO || LLC || NETATALK*/
   1038    1.1       cgd 	}
   1039    1.1       cgd 
   1040   1.79   thorpej 	s = splnet();
   1041    1.1       cgd 	if (IF_QFULL(inq)) {
   1042    1.1       cgd 		IF_DROP(inq);
   1043    1.1       cgd 		m_freem(m);
   1044    1.1       cgd 	} else
   1045    1.1       cgd 		IF_ENQUEUE(inq, m);
   1046    1.1       cgd 	splx(s);
   1047    1.1       cgd }
   1048    1.1       cgd 
   1049    1.1       cgd /*
   1050    1.1       cgd  * Convert Ethernet address to printable (loggable) representation.
   1051    1.1       cgd  */
   1052    1.1       cgd static char digits[] = "0123456789abcdef";
   1053    1.1       cgd char *
   1054   1.58      matt ether_sprintf(const u_char *ap)
   1055    1.1       cgd {
   1056    1.1       cgd 	static char etherbuf[18];
   1057   1.29       mrg 	char *cp = etherbuf;
   1058   1.29       mrg 	int i;
   1059    1.1       cgd 
   1060    1.1       cgd 	for (i = 0; i < 6; i++) {
   1061    1.1       cgd 		*cp++ = digits[*ap >> 4];
   1062    1.1       cgd 		*cp++ = digits[*ap++ & 0xf];
   1063    1.1       cgd 		*cp++ = ':';
   1064    1.1       cgd 	}
   1065    1.1       cgd 	*--cp = 0;
   1066    1.1       cgd 	return (etherbuf);
   1067    1.1       cgd }
   1068    1.8   mycroft 
   1069    1.8   mycroft /*
   1070    1.8   mycroft  * Perform common duties while attaching to interface list
   1071    1.8   mycroft  */
   1072    1.8   mycroft void
   1073   1.58      matt ether_ifattach(struct ifnet *ifp, const u_int8_t *lla)
   1074    1.8   mycroft {
   1075  1.104      matt 	struct ethercom *ec = (struct ethercom *)ifp;
   1076    1.8   mycroft 
   1077    1.8   mycroft 	ifp->if_type = IFT_ETHER;
   1078   1.75   thorpej 	ifp->if_addrlen = ETHER_ADDR_LEN;
   1079   1.94     enami 	ifp->if_hdrlen = ETHER_HDR_LEN;
   1080   1.73   thorpej 	ifp->if_dlt = DLT_EN10MB;
   1081    1.8   mycroft 	ifp->if_mtu = ETHERMTU;
   1082   1.12   mycroft 	ifp->if_output = ether_output;
   1083   1.42   thorpej 	ifp->if_input = ether_input;
   1084   1.54   thorpej 	if (ifp->if_baudrate == 0)
   1085   1.54   thorpej 		ifp->if_baudrate = IF_Mbps(10);		/* just a default */
   1086   1.75   thorpej 
   1087   1.75   thorpej 	if_alloc_sadl(ifp);
   1088   1.75   thorpej 	memcpy(LLADDR(ifp->if_sadl), lla, ifp->if_addrlen);
   1089   1.75   thorpej 
   1090  1.104      matt 	LIST_INIT(&ec->ec_multiaddrs);
   1091   1.26        is 	ifp->if_broadcastaddr = etherbroadcastaddr;
   1092   1.69   thorpej #if NBPFILTER > 0
   1093   1.71   thorpej 	bpfattach(ifp, DLT_EN10MB, sizeof(struct ether_header));
   1094   1.69   thorpej #endif
   1095  1.104      matt #ifdef MBUFTRACE
   1096  1.108    itojun 	strlcpy(ec->ec_tx_mowner.mo_name, ifp->if_xname,
   1097  1.108    itojun 	    sizeof(ec->ec_tx_mowner.mo_name));
   1098  1.108    itojun 	strlcpy(ec->ec_tx_mowner.mo_descr, "tx",
   1099  1.108    itojun 	    sizeof(ec->ec_tx_mowner.mo_descr));
   1100  1.108    itojun 	strlcpy(ec->ec_rx_mowner.mo_name, ifp->if_xname,
   1101  1.108    itojun 	    sizeof(ec->ec_rx_mowner.mo_name));
   1102  1.108    itojun 	strlcpy(ec->ec_rx_mowner.mo_descr, "rx",
   1103  1.108    itojun 	    sizeof(ec->ec_rx_mowner.mo_descr));
   1104  1.104      matt 	MOWNER_ATTACH(&ec->ec_tx_mowner);
   1105  1.104      matt 	MOWNER_ATTACH(&ec->ec_rx_mowner);
   1106  1.104      matt 	ifp->if_mowner = &ec->ec_tx_mowner;
   1107  1.104      matt #endif
   1108   1.52   thorpej }
   1109   1.52   thorpej 
   1110   1.52   thorpej void
   1111   1.58      matt ether_ifdetach(struct ifnet *ifp)
   1112   1.52   thorpej {
   1113   1.63   thorpej 	struct ethercom *ec = (void *) ifp;
   1114   1.63   thorpej 	struct ether_multi *enm;
   1115   1.63   thorpej 	int s;
   1116   1.69   thorpej 
   1117   1.69   thorpej #if NBPFILTER > 0
   1118   1.69   thorpej 	bpfdetach(ifp);
   1119   1.69   thorpej #endif
   1120   1.64   thorpej 
   1121   1.64   thorpej #if NVLAN > 0
   1122   1.64   thorpej 	if (ec->ec_nvlans)
   1123   1.64   thorpej 		vlan_ifdetach(ifp);
   1124   1.64   thorpej #endif
   1125   1.63   thorpej 
   1126   1.79   thorpej 	s = splnet();
   1127   1.63   thorpej 	while ((enm = LIST_FIRST(&ec->ec_multiaddrs)) != NULL) {
   1128   1.63   thorpej 		LIST_REMOVE(enm, enm_list);
   1129  1.100  jdolecek 		free(enm, M_IFMADDR);
   1130   1.63   thorpej 		ec->ec_multicnt--;
   1131   1.63   thorpej 	}
   1132   1.63   thorpej 	splx(s);
   1133   1.52   thorpej 
   1134   1.75   thorpej 	if_free_sadl(ifp);
   1135  1.104      matt 
   1136  1.104      matt 	MOWNER_DETACH(&ec->ec_rx_mowner);
   1137  1.104      matt 	MOWNER_DETACH(&ec->ec_tx_mowner);
   1138   1.53   thorpej }
   1139   1.53   thorpej 
   1140   1.56   thorpej #if 0
   1141   1.56   thorpej /*
   1142   1.56   thorpej  * This is for reference.  We have a table-driven version
   1143   1.56   thorpej  * of the little-endian crc32 generator, which is faster
   1144   1.56   thorpej  * than the double-loop.
   1145   1.56   thorpej  */
   1146   1.53   thorpej u_int32_t
   1147   1.58      matt ether_crc32_le(const u_int8_t *buf, size_t len)
   1148   1.53   thorpej {
   1149   1.53   thorpej 	u_int32_t c, crc, carry;
   1150   1.53   thorpej 	size_t i, j;
   1151   1.53   thorpej 
   1152   1.53   thorpej 	crc = 0xffffffffU;	/* initial value */
   1153   1.53   thorpej 
   1154   1.53   thorpej 	for (i = 0; i < len; i++) {
   1155   1.53   thorpej 		c = buf[i];
   1156   1.53   thorpej 		for (j = 0; j < 8; j++) {
   1157   1.53   thorpej 			carry = ((crc & 0x01) ? 1 : 0) ^ (c & 0x01);
   1158   1.53   thorpej 			crc >>= 1;
   1159   1.53   thorpej 			c >>= 1;
   1160   1.53   thorpej 			if (carry)
   1161   1.56   thorpej 				crc = (crc ^ ETHER_CRC_POLY_LE);
   1162   1.53   thorpej 		}
   1163   1.53   thorpej 	}
   1164   1.53   thorpej 
   1165   1.53   thorpej 	return (crc);
   1166   1.53   thorpej }
   1167   1.56   thorpej #else
   1168   1.56   thorpej u_int32_t
   1169   1.58      matt ether_crc32_le(const u_int8_t *buf, size_t len)
   1170   1.56   thorpej {
   1171   1.56   thorpej 	static const u_int32_t crctab[] = {
   1172   1.56   thorpej 		0x00000000, 0x1db71064, 0x3b6e20c8, 0x26d930ac,
   1173   1.56   thorpej 		0x76dc4190, 0x6b6b51f4, 0x4db26158, 0x5005713c,
   1174   1.56   thorpej 		0xedb88320, 0xf00f9344, 0xd6d6a3e8, 0xcb61b38c,
   1175   1.56   thorpej 		0x9b64c2b0, 0x86d3d2d4, 0xa00ae278, 0xbdbdf21c
   1176   1.56   thorpej 	};
   1177   1.56   thorpej 	u_int32_t crc;
   1178   1.98   thorpej 	size_t i;
   1179   1.56   thorpej 
   1180   1.56   thorpej 	crc = 0xffffffffU;	/* initial value */
   1181   1.56   thorpej 
   1182   1.56   thorpej 	for (i = 0; i < len; i++) {
   1183   1.56   thorpej 		crc ^= buf[i];
   1184   1.56   thorpej 		crc = (crc >> 4) ^ crctab[crc & 0xf];
   1185   1.56   thorpej 		crc = (crc >> 4) ^ crctab[crc & 0xf];
   1186   1.56   thorpej 	}
   1187   1.56   thorpej 
   1188   1.56   thorpej 	return (crc);
   1189   1.56   thorpej }
   1190   1.56   thorpej #endif
   1191   1.53   thorpej 
   1192   1.53   thorpej u_int32_t
   1193   1.58      matt ether_crc32_be(const u_int8_t *buf, size_t len)
   1194   1.53   thorpej {
   1195   1.53   thorpej 	u_int32_t c, crc, carry;
   1196   1.53   thorpej 	size_t i, j;
   1197   1.53   thorpej 
   1198   1.53   thorpej 	crc = 0xffffffffU;	/* initial value */
   1199   1.53   thorpej 
   1200   1.53   thorpej 	for (i = 0; i < len; i++) {
   1201   1.53   thorpej 		c = buf[i];
   1202   1.53   thorpej 		for (j = 0; j < 8; j++) {
   1203   1.53   thorpej 			carry = ((crc & 0x80000000U) ? 1 : 0) ^ (c & 0x01);
   1204   1.53   thorpej 			crc <<= 1;
   1205   1.53   thorpej 			c >>= 1;
   1206   1.53   thorpej 			if (carry)
   1207   1.53   thorpej 				crc = (crc ^ ETHER_CRC_POLY_BE) | carry;
   1208   1.53   thorpej 		}
   1209   1.53   thorpej 	}
   1210   1.53   thorpej 
   1211   1.53   thorpej 	return (crc);
   1212    1.8   mycroft }
   1213    1.8   mycroft 
   1214   1.48        is #ifdef INET
   1215    1.3   hpeyerl u_char	ether_ipmulticast_min[6] = { 0x01, 0x00, 0x5e, 0x00, 0x00, 0x00 };
   1216    1.3   hpeyerl u_char	ether_ipmulticast_max[6] = { 0x01, 0x00, 0x5e, 0x7f, 0xff, 0xff };
   1217   1.48        is #endif
   1218   1.44    itojun #ifdef INET6
   1219   1.44    itojun u_char	ether_ip6multicast_min[6] = { 0x33, 0x33, 0x00, 0x00, 0x00, 0x00 };
   1220   1.44    itojun u_char	ether_ip6multicast_max[6] = { 0x33, 0x33, 0xff, 0xff, 0xff, 0xff };
   1221   1.44    itojun #endif
   1222   1.60     enami 
   1223    1.3   hpeyerl /*
   1224   1.60     enami  * Convert a sockaddr into an Ethernet address or range of Ethernet
   1225   1.60     enami  * addresses.
   1226    1.3   hpeyerl  */
   1227    1.3   hpeyerl int
   1228   1.60     enami ether_multiaddr(struct sockaddr *sa, u_int8_t addrlo[ETHER_ADDR_LEN],
   1229   1.60     enami     u_int8_t addrhi[ETHER_ADDR_LEN])
   1230    1.3   hpeyerl {
   1231   1.24  christos #ifdef INET
   1232    1.3   hpeyerl 	struct sockaddr_in *sin;
   1233   1.24  christos #endif /* INET */
   1234   1.44    itojun #ifdef INET6
   1235   1.44    itojun 	struct sockaddr_in6 *sin6;
   1236   1.44    itojun #endif /* INET6 */
   1237    1.3   hpeyerl 
   1238   1.60     enami 	switch (sa->sa_family) {
   1239    1.3   hpeyerl 
   1240    1.3   hpeyerl 	case AF_UNSPEC:
   1241   1.60     enami 		bcopy(sa->sa_data, addrlo, ETHER_ADDR_LEN);
   1242   1.60     enami 		bcopy(addrlo, addrhi, ETHER_ADDR_LEN);
   1243    1.3   hpeyerl 		break;
   1244    1.3   hpeyerl 
   1245    1.3   hpeyerl #ifdef INET
   1246    1.3   hpeyerl 	case AF_INET:
   1247   1.60     enami 		sin = satosin(sa);
   1248    1.3   hpeyerl 		if (sin->sin_addr.s_addr == INADDR_ANY) {
   1249    1.3   hpeyerl 			/*
   1250   1.60     enami 			 * An IP address of INADDR_ANY means listen to
   1251   1.60     enami 			 * or stop listening to all of the Ethernet
   1252   1.60     enami 			 * multicast addresses used for IP.
   1253    1.3   hpeyerl 			 * (This is for the sake of IP multicast routers.)
   1254    1.3   hpeyerl 			 */
   1255   1.60     enami 			bcopy(ether_ipmulticast_min, addrlo, ETHER_ADDR_LEN);
   1256   1.60     enami 			bcopy(ether_ipmulticast_max, addrhi, ETHER_ADDR_LEN);
   1257    1.3   hpeyerl 		}
   1258    1.3   hpeyerl 		else {
   1259    1.3   hpeyerl 			ETHER_MAP_IP_MULTICAST(&sin->sin_addr, addrlo);
   1260   1.60     enami 			bcopy(addrlo, addrhi, ETHER_ADDR_LEN);
   1261    1.3   hpeyerl 		}
   1262    1.3   hpeyerl 		break;
   1263    1.3   hpeyerl #endif
   1264   1.44    itojun #ifdef INET6
   1265   1.44    itojun 	case AF_INET6:
   1266   1.60     enami 		sin6 = satosin6(sa);
   1267   1.47    itojun 		if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
   1268   1.44    itojun 			/*
   1269   1.60     enami 			 * An IP6 address of 0 means listen to or stop
   1270   1.60     enami 			 * listening to all of the Ethernet multicast
   1271   1.60     enami 			 * address used for IP6.
   1272   1.44    itojun 			 * (This is used for multicast routers.)
   1273   1.44    itojun 			 */
   1274   1.44    itojun 			bcopy(ether_ip6multicast_min, addrlo, ETHER_ADDR_LEN);
   1275   1.44    itojun 			bcopy(ether_ip6multicast_max, addrhi, ETHER_ADDR_LEN);
   1276   1.44    itojun 		} else {
   1277   1.44    itojun 			ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, addrlo);
   1278   1.44    itojun 			bcopy(addrlo, addrhi, ETHER_ADDR_LEN);
   1279   1.44    itojun 		}
   1280   1.44    itojun 		break;
   1281   1.44    itojun #endif
   1282    1.3   hpeyerl 
   1283    1.3   hpeyerl 	default:
   1284   1.60     enami 		return (EAFNOSUPPORT);
   1285   1.60     enami 	}
   1286   1.60     enami 	return (0);
   1287   1.60     enami }
   1288   1.60     enami 
   1289   1.60     enami /*
   1290   1.60     enami  * Add an Ethernet multicast address or range of addresses to the list for a
   1291   1.60     enami  * given interface.
   1292   1.60     enami  */
   1293   1.60     enami int
   1294   1.60     enami ether_addmulti(struct ifreq *ifr, struct ethercom *ec)
   1295   1.60     enami {
   1296   1.60     enami 	struct ether_multi *enm;
   1297   1.60     enami 	u_char addrlo[ETHER_ADDR_LEN];
   1298   1.60     enami 	u_char addrhi[ETHER_ADDR_LEN];
   1299   1.79   thorpej 	int s = splnet(), error;
   1300   1.60     enami 
   1301   1.60     enami 	error = ether_multiaddr(&ifr->ifr_addr, addrlo, addrhi);
   1302   1.60     enami 	if (error != 0) {
   1303    1.3   hpeyerl 		splx(s);
   1304   1.60     enami 		return (error);
   1305    1.3   hpeyerl 	}
   1306    1.3   hpeyerl 
   1307    1.3   hpeyerl 	/*
   1308    1.3   hpeyerl 	 * Verify that we have valid Ethernet multicast addresses.
   1309    1.3   hpeyerl 	 */
   1310    1.3   hpeyerl 	if ((addrlo[0] & 0x01) != 1 || (addrhi[0] & 0x01) != 1) {
   1311    1.3   hpeyerl 		splx(s);
   1312    1.3   hpeyerl 		return (EINVAL);
   1313    1.3   hpeyerl 	}
   1314    1.3   hpeyerl 	/*
   1315    1.3   hpeyerl 	 * See if the address range is already in the list.
   1316    1.3   hpeyerl 	 */
   1317   1.22        is 	ETHER_LOOKUP_MULTI(addrlo, addrhi, ec, enm);
   1318    1.3   hpeyerl 	if (enm != NULL) {
   1319    1.3   hpeyerl 		/*
   1320    1.3   hpeyerl 		 * Found it; just increment the reference count.
   1321    1.3   hpeyerl 		 */
   1322    1.3   hpeyerl 		++enm->enm_refcount;
   1323    1.3   hpeyerl 		splx(s);
   1324    1.3   hpeyerl 		return (0);
   1325    1.3   hpeyerl 	}
   1326    1.3   hpeyerl 	/*
   1327    1.3   hpeyerl 	 * New address or range; malloc a new multicast record
   1328    1.3   hpeyerl 	 * and link it into the interface's multicast list.
   1329    1.3   hpeyerl 	 */
   1330    1.3   hpeyerl 	enm = (struct ether_multi *)malloc(sizeof(*enm), M_IFMADDR, M_NOWAIT);
   1331    1.3   hpeyerl 	if (enm == NULL) {
   1332    1.3   hpeyerl 		splx(s);
   1333    1.3   hpeyerl 		return (ENOBUFS);
   1334    1.3   hpeyerl 	}
   1335    1.3   hpeyerl 	bcopy(addrlo, enm->enm_addrlo, 6);
   1336    1.3   hpeyerl 	bcopy(addrhi, enm->enm_addrhi, 6);
   1337   1.22        is 	enm->enm_ec = ec;
   1338    1.3   hpeyerl 	enm->enm_refcount = 1;
   1339   1.22        is 	LIST_INSERT_HEAD(&ec->ec_multiaddrs, enm, enm_list);
   1340   1.22        is 	ec->ec_multicnt++;
   1341    1.3   hpeyerl 	splx(s);
   1342    1.3   hpeyerl 	/*
   1343    1.3   hpeyerl 	 * Return ENETRESET to inform the driver that the list has changed
   1344    1.3   hpeyerl 	 * and its reception filter should be adjusted accordingly.
   1345    1.3   hpeyerl 	 */
   1346    1.3   hpeyerl 	return (ENETRESET);
   1347    1.3   hpeyerl }
   1348    1.3   hpeyerl 
   1349    1.3   hpeyerl /*
   1350    1.3   hpeyerl  * Delete a multicast address record.
   1351    1.3   hpeyerl  */
   1352    1.3   hpeyerl int
   1353   1.58      matt ether_delmulti(struct ifreq *ifr, struct ethercom *ec)
   1354    1.3   hpeyerl {
   1355   1.29       mrg 	struct ether_multi *enm;
   1356   1.60     enami 	u_char addrlo[ETHER_ADDR_LEN];
   1357   1.60     enami 	u_char addrhi[ETHER_ADDR_LEN];
   1358   1.79   thorpej 	int s = splnet(), error;
   1359    1.3   hpeyerl 
   1360   1.60     enami 	error = ether_multiaddr(&ifr->ifr_addr, addrlo, addrhi);
   1361   1.60     enami 	if (error != 0) {
   1362    1.3   hpeyerl 		splx(s);
   1363   1.60     enami 		return (error);
   1364    1.3   hpeyerl 	}
   1365    1.3   hpeyerl 
   1366    1.3   hpeyerl 	/*
   1367   1.66   thorpej 	 * Look ur the address in our list.
   1368    1.3   hpeyerl 	 */
   1369   1.22        is 	ETHER_LOOKUP_MULTI(addrlo, addrhi, ec, enm);
   1370    1.3   hpeyerl 	if (enm == NULL) {
   1371    1.3   hpeyerl 		splx(s);
   1372    1.3   hpeyerl 		return (ENXIO);
   1373    1.3   hpeyerl 	}
   1374    1.3   hpeyerl 	if (--enm->enm_refcount != 0) {
   1375    1.3   hpeyerl 		/*
   1376    1.3   hpeyerl 		 * Still some claims to this record.
   1377    1.3   hpeyerl 		 */
   1378    1.3   hpeyerl 		splx(s);
   1379    1.3   hpeyerl 		return (0);
   1380    1.3   hpeyerl 	}
   1381    1.3   hpeyerl 	/*
   1382    1.3   hpeyerl 	 * No remaining claims to this record; unlink and free it.
   1383    1.3   hpeyerl 	 */
   1384   1.13   mycroft 	LIST_REMOVE(enm, enm_list);
   1385    1.3   hpeyerl 	free(enm, M_IFMADDR);
   1386   1.22        is 	ec->ec_multicnt--;
   1387    1.3   hpeyerl 	splx(s);
   1388    1.3   hpeyerl 	/*
   1389    1.3   hpeyerl 	 * Return ENETRESET to inform the driver that the list has changed
   1390    1.3   hpeyerl 	 * and its reception filter should be adjusted accordingly.
   1391    1.3   hpeyerl 	 */
   1392    1.3   hpeyerl 	return (ENETRESET);
   1393   1.66   thorpej }
   1394   1.66   thorpej 
   1395   1.66   thorpej /*
   1396   1.66   thorpej  * Common ioctls for Ethernet interfaces.  Note, we must be
   1397   1.66   thorpej  * called at splnet().
   1398   1.66   thorpej  */
   1399   1.66   thorpej int
   1400   1.66   thorpej ether_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
   1401   1.66   thorpej {
   1402   1.66   thorpej 	struct ethercom *ec = (void *) ifp;
   1403   1.66   thorpej 	struct ifreq *ifr = (struct ifreq *)data;
   1404   1.66   thorpej 	struct ifaddr *ifa = (struct ifaddr *)data;
   1405   1.66   thorpej 	int error = 0;
   1406   1.66   thorpej 
   1407   1.66   thorpej 	switch (cmd) {
   1408   1.66   thorpej 	case SIOCSIFADDR:
   1409   1.66   thorpej 		ifp->if_flags |= IFF_UP;
   1410   1.66   thorpej 		switch (ifa->ifa_addr->sa_family) {
   1411   1.75   thorpej 		case AF_LINK:
   1412   1.75   thorpej 		    {
   1413   1.75   thorpej 			struct sockaddr_dl *sdl =
   1414   1.75   thorpej 			    (struct sockaddr_dl *) ifa->ifa_addr;
   1415   1.75   thorpej 
   1416   1.75   thorpej 			if (sdl->sdl_type != IFT_ETHER ||
   1417   1.75   thorpej 			    sdl->sdl_alen != ifp->if_addrlen) {
   1418   1.75   thorpej 				error = EINVAL;
   1419   1.75   thorpej 				break;
   1420   1.75   thorpej 			}
   1421   1.75   thorpej 
   1422   1.75   thorpej 			memcpy(LLADDR(ifp->if_sadl), LLADDR(sdl),
   1423   1.75   thorpej 			    ifp->if_addrlen);
   1424   1.75   thorpej 
   1425   1.75   thorpej 			/* Set new address. */
   1426   1.75   thorpej 			error = (*ifp->if_init)(ifp);
   1427   1.75   thorpej 			break;
   1428   1.75   thorpej 		    }
   1429   1.66   thorpej #ifdef INET
   1430   1.66   thorpej 		case AF_INET:
   1431   1.86   thorpej 			if ((ifp->if_flags & IFF_RUNNING) == 0 &&
   1432   1.86   thorpej 			    (error = (*ifp->if_init)(ifp)) != 0)
   1433   1.66   thorpej 				break;
   1434   1.66   thorpej 			arp_ifinit(ifp, ifa);
   1435   1.66   thorpej 			break;
   1436   1.66   thorpej #endif /* INET */
   1437   1.66   thorpej #ifdef NS
   1438   1.66   thorpej 		case AF_NS:
   1439   1.66   thorpej 		    {
   1440   1.66   thorpej 			struct ns_addr *ina = &IA_SNS(ifa)->sns_addr;
   1441   1.66   thorpej 
   1442   1.66   thorpej 			if (ns_nullhost(*ina))
   1443   1.66   thorpej 				ina->x_host = *(union ns_host *)
   1444   1.66   thorpej 				    LLADDR(ifp->if_sadl);
   1445   1.66   thorpej 			else
   1446   1.66   thorpej 				memcpy(LLADDR(ifp->if_sadl),
   1447   1.66   thorpej 				    ina->x_host.c_host, ifp->if_addrlen);
   1448   1.66   thorpej 			/* Set new address. */
   1449   1.66   thorpej 			error = (*ifp->if_init)(ifp);
   1450   1.66   thorpej 			break;
   1451   1.66   thorpej 		    }
   1452   1.66   thorpej #endif /* NS */
   1453   1.66   thorpej 		default:
   1454   1.86   thorpej 			if ((ifp->if_flags & IFF_RUNNING) == 0)
   1455   1.86   thorpej 				error = (*ifp->if_init)(ifp);
   1456   1.66   thorpej 			break;
   1457   1.66   thorpej 		}
   1458   1.66   thorpej 		break;
   1459   1.66   thorpej 
   1460   1.66   thorpej 	case SIOCGIFADDR:
   1461   1.66   thorpej 		memcpy(((struct sockaddr *)&ifr->ifr_data)->sa_data,
   1462   1.66   thorpej 		    LLADDR(ifp->if_sadl), ETHER_ADDR_LEN);
   1463   1.66   thorpej 		break;
   1464   1.66   thorpej 
   1465   1.66   thorpej 	case SIOCSIFMTU:
   1466   1.82   thorpej 	    {
   1467   1.82   thorpej 		int maxmtu;
   1468   1.82   thorpej 
   1469   1.82   thorpej 		if (ec->ec_capabilities & ETHERCAP_JUMBO_MTU)
   1470   1.82   thorpej 			maxmtu = ETHERMTU_JUMBO;
   1471   1.82   thorpej 		else
   1472   1.82   thorpej 			maxmtu = ETHERMTU;
   1473   1.82   thorpej 
   1474   1.82   thorpej 		if (ifr->ifr_mtu < ETHERMIN || ifr->ifr_mtu > maxmtu)
   1475   1.66   thorpej 			error = EINVAL;
   1476   1.88   thorpej 		else {
   1477   1.66   thorpej 			ifp->if_mtu = ifr->ifr_mtu;
   1478   1.87   thorpej 
   1479   1.88   thorpej 			/* Make sure the device notices the MTU change. */
   1480   1.88   thorpej 			if (ifp->if_flags & IFF_UP)
   1481   1.88   thorpej 				error = (*ifp->if_init)(ifp);
   1482   1.88   thorpej 		}
   1483   1.66   thorpej 		break;
   1484   1.82   thorpej 	    }
   1485   1.66   thorpej 
   1486   1.66   thorpej 	case SIOCSIFFLAGS:
   1487   1.66   thorpej 		if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) == IFF_RUNNING) {
   1488   1.66   thorpej 			/*
   1489   1.66   thorpej 			 * If interface is marked down and it is running,
   1490   1.66   thorpej 			 * then stop and disable it.
   1491   1.66   thorpej 			 */
   1492   1.66   thorpej 			(*ifp->if_stop)(ifp, 1);
   1493   1.66   thorpej 		} else if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) == IFF_UP) {
   1494   1.66   thorpej 			/*
   1495   1.66   thorpej 			 * If interface is marked up and it is stopped, then
   1496   1.66   thorpej 			 * start it.
   1497   1.66   thorpej 			 */
   1498   1.66   thorpej 			error = (*ifp->if_init)(ifp);
   1499   1.66   thorpej 		} else if ((ifp->if_flags & IFF_UP) != 0) {
   1500   1.66   thorpej 			/*
   1501   1.66   thorpej 			 * Reset the interface to pick up changes in any other
   1502   1.66   thorpej 			 * flags that affect the hardware state.
   1503   1.66   thorpej 			 */
   1504   1.66   thorpej 			error = (*ifp->if_init)(ifp);
   1505   1.66   thorpej 		}
   1506   1.66   thorpej 		break;
   1507   1.66   thorpej 
   1508   1.66   thorpej 	case SIOCADDMULTI:
   1509   1.74  augustss 		error = ether_addmulti(ifr, ec);
   1510   1.74  augustss 		break;
   1511   1.74  augustss 
   1512   1.66   thorpej 	case SIOCDELMULTI:
   1513   1.74  augustss 		error = ether_delmulti(ifr, ec);
   1514   1.66   thorpej 		break;
   1515   1.66   thorpej 
   1516   1.66   thorpej 	default:
   1517   1.66   thorpej 		error = ENOTTY;
   1518   1.66   thorpej 	}
   1519   1.66   thorpej 
   1520   1.66   thorpej 	return (error);
   1521    1.3   hpeyerl }
   1522