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