Home | History | Annotate | Line # | Download | only in net
if_ethersubr.c revision 1.227
      1  1.227     ozaki /*	$NetBSD: if_ethersubr.c,v 1.227 2016/08/01 03:15:30 ozaki-r 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.227     ozaki __KERNEL_RCSID(0, "$NetBSD: if_ethersubr.c,v 1.227 2016/08/01 03:15:30 ozaki-r Exp $");
     65    1.1       cgd 
     66  1.212     pooka #ifdef _KERNEL_OPT
     67   1.33  jonathan #include "opt_inet.h"
     68   1.33  jonathan #include "opt_atalk.h"
     69  1.112    martin #include "opt_mbuftrace.h"
     70  1.182    kefren #include "opt_mpls.h"
     71   1.30      matt #include "opt_gateway.h"
     72  1.135     pavel #include "opt_pppoe.h"
     73  1.206     ozaki #include "opt_net_mpsafe.h"
     74  1.212     pooka #endif
     75  1.212     pooka 
     76   1.59   thorpej #include "vlan.h"
     77   1.81    martin #include "pppoe.h"
     78   1.78   thorpej #include "bridge.h"
     79   1.93    martin #include "arp.h"
     80  1.121      yamt #include "agr.h"
     81   1.30      matt 
     82  1.200     joerg #include <sys/sysctl.h>
     83    1.4   mycroft #include <sys/malloc.h>
     84    1.4   mycroft #include <sys/mbuf.h>
     85  1.211     ozaki #include <sys/mutex.h>
     86    1.4   mycroft #include <sys/ioctl.h>
     87    1.4   mycroft #include <sys/errno.h>
     88  1.158    dyoung #include <sys/device.h>
     89  1.204       tls #include <sys/rnd.h>
     90  1.207  riastrad #include <sys/rndsource.h>
     91  1.216     ozaki #include <sys/cpu.h>
     92    1.8   mycroft 
     93    1.4   mycroft #include <net/if.h>
     94    1.4   mycroft #include <net/netisr.h>
     95    1.4   mycroft #include <net/route.h>
     96    1.4   mycroft #include <net/if_llc.h>
     97    1.4   mycroft #include <net/if_dl.h>
     98    1.8   mycroft #include <net/if_types.h>
     99  1.211     ozaki #include <net/pktqueue.h>
    100   1.93    martin 
    101  1.158    dyoung #include <net/if_media.h>
    102  1.158    dyoung #include <dev/mii/mii.h>
    103  1.158    dyoung #include <dev/mii/miivar.h>
    104  1.158    dyoung 
    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.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.
    110   1.93    martin #endif
    111    1.1       cgd 
    112   1.69   thorpej #include <net/bpf.h>
    113   1.69   thorpej 
    114   1.22        is #include <net/if_ether.h>
    115   1.59   thorpej #include <net/if_vlanvar.h>
    116   1.22        is 
    117   1.81    martin #if NPPPOE > 0
    118   1.81    martin #include <net/if_pppoe.h>
    119   1.81    martin #endif
    120   1.81    martin 
    121  1.121      yamt #if NAGR > 0
    122  1.121      yamt #include <net/agr/ieee8023_slowprotocols.h>	/* XXX */
    123  1.121      yamt #include <net/agr/ieee8023ad.h>
    124  1.121      yamt #include <net/agr/if_agrvar.h>
    125  1.121      yamt #endif
    126  1.121      yamt 
    127   1.78   thorpej #if NBRIDGE > 0
    128   1.78   thorpej #include <net/if_bridgevar.h>
    129   1.78   thorpej #endif
    130   1.78   thorpej 
    131   1.15      phil #include <netinet/in.h>
    132    1.1       cgd #ifdef INET
    133    1.4   mycroft #include <netinet/in_var.h>
    134    1.1       cgd #endif
    135   1.22        is #include <netinet/if_inarp.h>
    136    1.1       cgd 
    137   1.44    itojun #ifdef INET6
    138   1.44    itojun #ifndef INET
    139   1.44    itojun #include <netinet/in.h>
    140   1.44    itojun #endif
    141   1.44    itojun #include <netinet6/in6_var.h>
    142   1.44    itojun #include <netinet6/nd6.h>
    143   1.44    itojun #endif
    144   1.44    itojun 
    145    1.1       cgd 
    146  1.133  liamjfoy #include "carp.h"
    147  1.133  liamjfoy #if NCARP > 0
    148  1.133  liamjfoy #include <netinet/ip_carp.h>
    149  1.133  liamjfoy #endif
    150  1.133  liamjfoy 
    151   1.23  christos #ifdef NETATALK
    152   1.23  christos #include <netatalk/at.h>
    153   1.23  christos #include <netatalk/at_var.h>
    154   1.23  christos #include <netatalk/at_extern.h>
    155   1.23  christos 
    156   1.23  christos #define llc_snap_org_code llc_un.type_snap.org_code
    157   1.23  christos #define llc_snap_ether_type llc_un.type_snap.ether_type
    158   1.23  christos 
    159   1.23  christos extern u_char	at_org_code[3];
    160   1.23  christos extern u_char	aarp_org_code[3];
    161   1.23  christos #endif /* NETATALK */
    162   1.23  christos 
    163  1.182    kefren #ifdef MPLS
    164  1.182    kefren #include <netmpls/mpls.h>
    165  1.182    kefren #include <netmpls/mpls_var.h>
    166  1.182    kefren #endif
    167  1.182    kefren 
    168  1.123      matt static struct timeval bigpktppslim_last;
    169  1.123      matt static int bigpktppslim = 2;	/* XXX */
    170  1.123      matt static int bigpktpps_count;
    171  1.203     ozaki static kmutex_t bigpktpps_lock __cacheline_aligned;
    172  1.123      matt 
    173  1.123      matt 
    174  1.118      yamt const uint8_t etherbroadcastaddr[ETHER_ADDR_LEN] =
    175  1.118      yamt     { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
    176  1.121      yamt const uint8_t ethermulticastaddr_slowprotocols[ETHER_ADDR_LEN] =
    177  1.121      yamt     { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x02 };
    178    1.8   mycroft #define senderr(e) { error = (e); goto bad;}
    179    1.1       cgd 
    180  1.128   thorpej static	int ether_output(struct ifnet *, struct mbuf *,
    181  1.222     ozaki 	    const struct sockaddr *, const struct rtentry *);
    182   1.42   thorpej 
    183    1.1       cgd /*
    184    1.1       cgd  * Ethernet output routine.
    185    1.1       cgd  * Encapsulate a packet of type family for the local net.
    186   1.22        is  * Assumes that ifp is actually pointer to ethercom structure.
    187    1.1       cgd  */
    188   1.42   thorpej static int
    189  1.178    dyoung ether_output(struct ifnet * const ifp0, struct mbuf * const m0,
    190  1.178    dyoung 	const struct sockaddr * const dst,
    191  1.222     ozaki 	const struct rtentry *rt)
    192    1.1       cgd {
    193  1.162      matt 	uint16_t etype = 0;
    194  1.122  christos 	int error = 0, hdrcmplt = 0;
    195  1.145    dyoung  	uint8_t esrc[6], edst[6];
    196   1.29       mrg 	struct mbuf *m = m0;
    197  1.151    dyoung 	struct mbuf *mcopy = NULL;
    198   1.29       mrg 	struct ether_header *eh;
    199  1.133  liamjfoy 	struct ifnet *ifp = ifp0;
    200   1.24  christos #ifdef INET
    201   1.22        is 	struct arphdr *ah;
    202   1.24  christos #endif /* INET */
    203   1.23  christos #ifdef NETATALK
    204   1.23  christos 	struct at_ifaddr *aa;
    205   1.23  christos #endif /* NETATALK */
    206    1.1       cgd 
    207  1.225  knakahar 	/*
    208  1.225  knakahar 	 * some paths such as carp_output() call ethr_output() with "ifp"
    209  1.225  knakahar 	 * argument as other than ether ifnet.
    210  1.225  knakahar 	 */
    211  1.225  knakahar 	KASSERT(ifp->if_output != ether_output
    212  1.225  knakahar 	    || ifp->if_extflags & IFEF_OUTPUT_MPSAFE);
    213  1.197    bouyer 
    214  1.104      matt #ifdef MBUFTRACE
    215  1.116  jonathan 	m_claimm(m, ifp->if_mowner);
    216  1.104      matt #endif
    217  1.133  liamjfoy 
    218  1.133  liamjfoy #if NCARP > 0
    219  1.133  liamjfoy 	if (ifp->if_type == IFT_CARP) {
    220  1.133  liamjfoy 		struct ifaddr *ifa;
    221  1.227     ozaki 		int s = pserialize_read_enter();
    222  1.133  liamjfoy 
    223  1.133  liamjfoy 		/* loop back if this is going to the carp interface */
    224  1.133  liamjfoy 		if (dst != NULL && ifp0->if_link_state == LINK_STATE_UP &&
    225  1.227     ozaki 		    (ifa = ifa_ifwithaddr(dst)) != NULL) {
    226  1.227     ozaki 			if (ifa->ifa_ifp == ifp0) {
    227  1.227     ozaki 				pserialize_read_exit(s);
    228  1.227     ozaki 				return looutput(ifp0, m, dst, rt);
    229  1.227     ozaki 			}
    230  1.227     ozaki 		}
    231  1.227     ozaki 		pserialize_read_exit(s);
    232  1.133  liamjfoy 
    233  1.133  liamjfoy 		ifp = ifp->if_carpdev;
    234  1.133  liamjfoy 		/* ac = (struct arpcom *)ifp; */
    235  1.133  liamjfoy 
    236  1.133  liamjfoy 		if ((ifp0->if_flags & (IFF_UP|IFF_RUNNING)) !=
    237  1.133  liamjfoy 		    (IFF_UP|IFF_RUNNING))
    238  1.133  liamjfoy 			senderr(ENETDOWN);
    239  1.133  liamjfoy 	}
    240  1.133  liamjfoy #endif /* NCARP > 0 */
    241  1.133  liamjfoy 
    242    1.8   mycroft 	if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
    243    1.8   mycroft 		senderr(ENETDOWN);
    244   1.72   thorpej 
    245    1.1       cgd 	switch (dst->sa_family) {
    246    1.1       cgd 
    247    1.1       cgd #ifdef INET
    248    1.1       cgd 	case AF_INET:
    249  1.224  knakahar 		KERNEL_LOCK(1, NULL);
    250   1.22        is 		if (m->m_flags & M_BCAST)
    251  1.174     isaki 			(void)memcpy(edst, etherbroadcastaddr, sizeof(edst));
    252  1.145    dyoung 		else if (m->m_flags & M_MCAST)
    253  1.145    dyoung 			ETHER_MAP_IP_MULTICAST(&satocsin(dst)->sin_addr, edst);
    254  1.217  christos 		else if ((error = arpresolve(ifp, rt, m, dst, edst,
    255  1.224  knakahar 		    sizeof(edst))) != 0) {
    256  1.224  knakahar 			KERNEL_UNLOCK_ONE(NULL);
    257  1.214       roy 			return error == EWOULDBLOCK ? 0 : error;
    258  1.224  knakahar 		}
    259  1.224  knakahar 		KERNEL_UNLOCK_ONE(NULL);
    260    1.3   hpeyerl 		/* If broadcasting on a simplex interface, loopback a copy */
    261    1.3   hpeyerl 		if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
    262    1.1       cgd 			mcopy = m_copy(m, 0, (int)M_COPYALL);
    263   1.17   mycroft 		etype = htons(ETHERTYPE_IP);
    264    1.8   mycroft 		break;
    265   1.22        is 
    266   1.22        is 	case AF_ARP:
    267   1.22        is 		ah = mtod(m, struct arphdr *);
    268   1.22        is 		if (m->m_flags & M_BCAST)
    269  1.174     isaki 			(void)memcpy(edst, etherbroadcastaddr, sizeof(edst));
    270  1.131       mrg 		else {
    271  1.147  christos 			void *tha = ar_tha(ah);
    272  1.131       mrg 
    273  1.173  christos 			if (tha == NULL) {
    274  1.173  christos 				/* fake with ARPHDR_IEEE1394 */
    275  1.173  christos 				return 0;
    276  1.173  christos 			}
    277  1.146    dyoung 			memcpy(edst, tha, sizeof(edst));
    278  1.131       mrg 		}
    279  1.120     perry 
    280   1.22        is 		ah->ar_hrd = htons(ARPHRD_ETHER);
    281   1.22        is 
    282  1.107    itojun 		switch (ntohs(ah->ar_op)) {
    283   1.22        is 		case ARPOP_REVREQUEST:
    284   1.22        is 		case ARPOP_REVREPLY:
    285   1.22        is 			etype = htons(ETHERTYPE_REVARP);
    286   1.22        is 			break;
    287   1.22        is 
    288   1.22        is 		case ARPOP_REQUEST:
    289   1.22        is 		case ARPOP_REPLY:
    290   1.22        is 		default:
    291   1.22        is 			etype = htons(ETHERTYPE_ARP);
    292   1.22        is 		}
    293   1.22        is 
    294   1.22        is 		break;
    295    1.1       cgd #endif
    296   1.44    itojun #ifdef INET6
    297   1.44    itojun 	case AF_INET6:
    298  1.166    dyoung 		if (!nd6_storelladdr(ifp, rt, m, dst, edst, sizeof(edst))){
    299   1.67    itojun 			/* something bad happened */
    300   1.99    itojun 			return (0);
    301   1.51    itojun 		}
    302   1.44    itojun 		etype = htons(ETHERTYPE_IPV6);
    303   1.44    itojun 		break;
    304   1.44    itojun #endif
    305   1.23  christos #ifdef NETATALK
    306  1.227     ozaki     case AF_APPLETALK: {
    307  1.227     ozaki 		struct ifaddr *ifa;
    308  1.227     ozaki 		int s;
    309  1.227     ozaki 
    310  1.224  knakahar 		KERNEL_LOCK(1, NULL);
    311  1.226       rjs 		if (!aarpresolve(ifp, m, (const struct sockaddr_at *)dst, edst)) {
    312   1.23  christos #ifdef NETATALKDEBUG
    313   1.23  christos 			printf("aarpresolv failed\n");
    314   1.23  christos #endif /* NETATALKDEBUG */
    315  1.224  knakahar 			KERNEL_UNLOCK_ONE(NULL);
    316   1.23  christos 			return (0);
    317   1.23  christos 		}
    318   1.23  christos 		/*
    319   1.23  christos 		 * ifaddr is the first thing in at_ifaddr
    320   1.23  christos 		 */
    321  1.227     ozaki 		s = pserialize_read_enter();
    322  1.227     ozaki 		ifa = at_ifawithnet((const struct sockaddr_at *)dst, ifp);
    323  1.227     ozaki 		if (ifa == NULL) {
    324  1.227     ozaki 			pserialize_read_exit(s);
    325  1.227     ozaki 			KERNEL_UNLOCK_ONE(NULL);
    326  1.227     ozaki 			goto bad;
    327  1.224  knakahar 		}
    328  1.227     ozaki 		aa = (struct at_ifaddr *)ifa;
    329  1.120     perry 
    330   1.23  christos 		/*
    331   1.23  christos 		 * In the phase 2 case, we need to prepend an mbuf for the
    332   1.23  christos 		 * llc header.  Since we must preserve the value of m,
    333   1.23  christos 		 * which is passed to us by value, we m_copy() the first
    334   1.23  christos 		 * mbuf, and use it for our llc header.
    335   1.23  christos 		 */
    336   1.23  christos 		if (aa->aa_flags & AFA_PHASE2) {
    337   1.23  christos 			struct llc llc;
    338   1.23  christos 
    339   1.43    bouyer 			M_PREPEND(m, sizeof(struct llc), M_DONTWAIT);
    340   1.23  christos 			llc.llc_dsap = llc.llc_ssap = LLC_SNAP_LSAP;
    341   1.23  christos 			llc.llc_control = LLC_UI;
    342  1.146    dyoung 			memcpy(llc.llc_snap_org_code, at_org_code,
    343   1.23  christos 			    sizeof(llc.llc_snap_org_code));
    344   1.38       kim 			llc.llc_snap_ether_type = htons(ETHERTYPE_ATALK);
    345  1.147  christos 			memcpy(mtod(m, void *), &llc, sizeof(struct llc));
    346   1.23  christos 		} else {
    347   1.38       kim 			etype = htons(ETHERTYPE_ATALK);
    348   1.23  christos 		}
    349  1.227     ozaki 		pserialize_read_exit(s);
    350  1.224  knakahar 		KERNEL_UNLOCK_ONE(NULL);
    351   1.23  christos 		break;
    352  1.227     ozaki 	    }
    353   1.23  christos #endif /* NETATALK */
    354   1.31   thorpej 	case pseudo_AF_HDRCMPLT:
    355   1.31   thorpej 		hdrcmplt = 1;
    356  1.146    dyoung 		memcpy(esrc,
    357  1.146    dyoung 		    ((const struct ether_header *)dst->sa_data)->ether_shost,
    358  1.146    dyoung 		    sizeof(esrc));
    359   1.31   thorpej 		/* FALLTHROUGH */
    360   1.31   thorpej 
    361    1.1       cgd 	case AF_UNSPEC:
    362  1.146    dyoung  		memcpy(edst,
    363  1.146    dyoung 		    ((const struct ether_header *)dst->sa_data)->ether_dhost,
    364  1.146    dyoung 		    sizeof(edst));
    365    1.8   mycroft 		/* AF_UNSPEC doesn't swap the byte order of the ether_type. */
    366  1.145    dyoung 		etype = ((const struct ether_header *)dst->sa_data)->ether_type;
    367    1.8   mycroft 		break;
    368    1.1       cgd 
    369    1.1       cgd 	default:
    370   1.21  christos 		printf("%s: can't handle af%d\n", ifp->if_xname,
    371    1.1       cgd 			dst->sa_family);
    372    1.8   mycroft 		senderr(EAFNOSUPPORT);
    373    1.1       cgd 	}
    374    1.1       cgd 
    375  1.182    kefren #ifdef MPLS
    376  1.224  knakahar 	KERNEL_LOCK(1, NULL);
    377  1.210     ozaki 	{
    378  1.210     ozaki 		struct m_tag *mtag;
    379  1.210     ozaki 		mtag = m_tag_find(m, PACKET_TAG_MPLS, NULL);
    380  1.210     ozaki 		if (mtag != NULL) {
    381  1.210     ozaki 			/* Having the tag itself indicates it's MPLS */
    382  1.184    dyoung 			etype = htons(ETHERTYPE_MPLS);
    383  1.210     ozaki 			m_tag_delete(m, mtag);
    384  1.210     ozaki 		}
    385  1.184    dyoung 	}
    386  1.224  knakahar 	KERNEL_UNLOCK_ONE(NULL);
    387  1.182    kefren #endif
    388  1.182    kefren 
    389    1.1       cgd 	if (mcopy)
    390  1.145    dyoung 		(void)looutput(ifp, mcopy, dst, rt);
    391   1.16   mycroft 
    392   1.50      matt 	/* If no ether type is set, this must be a 802.2 formatted packet.
    393   1.50      matt 	 */
    394   1.50      matt 	if (etype == 0)
    395   1.50      matt 		etype = htons(m->m_pkthdr.len);
    396    1.1       cgd 	/*
    397    1.1       cgd 	 * Add local net header.  If no space in first mbuf,
    398    1.1       cgd 	 * allocate another.
    399    1.1       cgd 	 */
    400    1.1       cgd 	M_PREPEND(m, sizeof (struct ether_header), M_DONTWAIT);
    401    1.8   mycroft 	if (m == 0)
    402    1.8   mycroft 		senderr(ENOBUFS);
    403    1.1       cgd 	eh = mtod(m, struct ether_header *);
    404   1.96   thorpej 	/* Note: etype is already in network byte order. */
    405  1.143    cbiere 	(void)memcpy(&eh->ether_type, &etype, sizeof(eh->ether_type));
    406  1.146    dyoung  	memcpy(eh->ether_dhost, edst, sizeof(edst));
    407   1.31   thorpej 	if (hdrcmplt)
    408  1.146    dyoung 		memcpy(eh->ether_shost, esrc, sizeof(eh->ether_shost));
    409   1.31   thorpej 	else
    410  1.153    dyoung 	 	memcpy(eh->ether_shost, CLLADDR(ifp->if_sadl),
    411   1.31   thorpej 		    sizeof(eh->ether_shost));
    412   1.77   thorpej 
    413  1.133  liamjfoy #if NCARP > 0
    414  1.133  liamjfoy 	if (ifp0 != ifp && ifp0->if_type == IFT_CARP) {
    415  1.153    dyoung 	 	memcpy(eh->ether_shost, CLLADDR(ifp0->if_sadl),
    416  1.133  liamjfoy 		    sizeof(eh->ether_shost));
    417  1.133  liamjfoy 	}
    418  1.133  liamjfoy #endif /* NCARP > 0 */
    419  1.133  liamjfoy 
    420  1.195     rmind 	if ((error = pfil_run_hooks(ifp->if_pfil, &m, ifp, PFIL_OUT)) != 0)
    421   1.77   thorpej 		return (error);
    422   1.77   thorpej 	if (m == NULL)
    423   1.77   thorpej 		return (0);
    424   1.77   thorpej 
    425   1.78   thorpej #if NBRIDGE > 0
    426   1.78   thorpej 	/*
    427   1.78   thorpej 	 * Bridges require special output handling.
    428   1.78   thorpej 	 */
    429   1.78   thorpej 	if (ifp->if_bridge)
    430   1.78   thorpej 		return (bridge_output(ifp, m, NULL, NULL));
    431   1.78   thorpej #endif
    432   1.78   thorpej 
    433  1.133  liamjfoy #if NCARP > 0
    434  1.133  liamjfoy 	if (ifp != ifp0)
    435  1.133  liamjfoy 		ifp0->if_obytes += m->m_pkthdr.len + ETHER_HDR_LEN;
    436  1.133  liamjfoy #endif /* NCARP > 0 */
    437  1.133  liamjfoy 
    438   1.77   thorpej #ifdef ALTQ
    439  1.224  knakahar 	KERNEL_LOCK(1, NULL);
    440   1.77   thorpej 	/*
    441   1.77   thorpej 	 * If ALTQ is enabled on the parent interface, do
    442   1.77   thorpej 	 * classification; the queueing discipline might not
    443   1.77   thorpej 	 * require classification, but might require the
    444   1.77   thorpej 	 * address family/header pointer in the pktattr.
    445   1.77   thorpej 	 */
    446   1.77   thorpej 	if (ALTQ_IS_ENABLED(&ifp->if_snd))
    447  1.220  knakahar 		altq_etherclassify(&ifp->if_snd, m);
    448  1.224  knakahar 	KERNEL_UNLOCK_ONE(NULL);
    449   1.77   thorpej #endif
    450  1.221  knakahar 	return ifq_enqueue(ifp, m);
    451    1.1       cgd 
    452    1.1       cgd bad:
    453    1.1       cgd 	if (m)
    454    1.1       cgd 		m_freem(m);
    455    1.1       cgd 	return (error);
    456    1.1       cgd }
    457   1.76   thorpej 
    458   1.76   thorpej #ifdef ALTQ
    459   1.76   thorpej /*
    460   1.76   thorpej  * This routine is a slight hack to allow a packet to be classified
    461   1.76   thorpej  * if the Ethernet headers are present.  It will go away when ALTQ's
    462   1.76   thorpej  * classification engine understands link headers.
    463   1.76   thorpej  */
    464   1.76   thorpej void
    465  1.220  knakahar altq_etherclassify(struct ifaltq *ifq, struct mbuf *m)
    466   1.76   thorpej {
    467   1.76   thorpej 	struct ether_header *eh;
    468  1.162      matt 	uint16_t ether_type;
    469   1.76   thorpej 	int hlen, af, hdrsize;
    470  1.147  christos 	void *hdr;
    471   1.76   thorpej 
    472   1.76   thorpej 	hlen = ETHER_HDR_LEN;
    473   1.76   thorpej 	eh = mtod(m, struct ether_header *);
    474   1.76   thorpej 
    475   1.76   thorpej 	ether_type = htons(eh->ether_type);
    476   1.76   thorpej 
    477   1.76   thorpej 	if (ether_type < ETHERMTU) {
    478   1.76   thorpej 		/* LLC/SNAP */
    479   1.76   thorpej 		struct llc *llc = (struct llc *)(eh + 1);
    480   1.76   thorpej 		hlen += 8;
    481   1.76   thorpej 
    482   1.76   thorpej 		if (m->m_len < hlen ||
    483   1.76   thorpej 		    llc->llc_dsap != LLC_SNAP_LSAP ||
    484   1.76   thorpej 		    llc->llc_ssap != LLC_SNAP_LSAP ||
    485   1.76   thorpej 		    llc->llc_control != LLC_UI) {
    486   1.76   thorpej 			/* Not SNAP. */
    487   1.76   thorpej 			goto bad;
    488   1.76   thorpej 		}
    489   1.76   thorpej 
    490   1.76   thorpej 		ether_type = htons(llc->llc_un.type_snap.ether_type);
    491   1.76   thorpej 	}
    492   1.76   thorpej 
    493   1.76   thorpej 	switch (ether_type) {
    494   1.76   thorpej 	case ETHERTYPE_IP:
    495   1.76   thorpej 		af = AF_INET;
    496   1.76   thorpej 		hdrsize = 20;		/* sizeof(struct ip) */
    497   1.76   thorpej 		break;
    498   1.76   thorpej 
    499   1.76   thorpej 	case ETHERTYPE_IPV6:
    500   1.76   thorpej 		af = AF_INET6;
    501   1.76   thorpej 		hdrsize = 40;		/* sizeof(struct ip6_hdr) */
    502   1.76   thorpej 		break;
    503   1.76   thorpej 
    504   1.76   thorpej 	default:
    505   1.76   thorpej 		af = AF_UNSPEC;
    506   1.76   thorpej 		hdrsize = 0;
    507   1.76   thorpej 		break;
    508   1.76   thorpej 	}
    509   1.76   thorpej 
    510   1.95    itojun 	while (m->m_len <= hlen) {
    511   1.95    itojun 		hlen -= m->m_len;
    512   1.95    itojun 		m = m->m_next;
    513   1.95    itojun 	}
    514   1.76   thorpej 	if (m->m_len < (hlen + hdrsize)) {
    515   1.76   thorpej 		/*
    516   1.95    itojun 		 * protocol header not in a single mbuf.
    517   1.95    itojun 		 * We can't cope with this situation right
    518   1.76   thorpej 		 * now (but it shouldn't ever happen, really, anyhow).
    519   1.76   thorpej 		 */
    520   1.92    itojun #ifdef DEBUG
    521   1.78   thorpej 		printf("altq_etherclassify: headers span multiple mbufs: "
    522   1.78   thorpej 		    "%d < %d\n", m->m_len, (hlen + hdrsize));
    523   1.92    itojun #endif
    524   1.76   thorpej 		goto bad;
    525   1.76   thorpej 	}
    526   1.76   thorpej 
    527   1.76   thorpej 	m->m_data += hlen;
    528   1.76   thorpej 	m->m_len -= hlen;
    529   1.76   thorpej 
    530  1.147  christos 	hdr = mtod(m, void *);
    531   1.76   thorpej 
    532   1.76   thorpej 	if (ALTQ_NEEDS_CLASSIFY(ifq))
    533  1.219  knakahar 		m->m_pkthdr.pattr_class =
    534   1.76   thorpej 		    (*ifq->altq_classify)(ifq->altq_clfier, m, af);
    535  1.219  knakahar 	m->m_pkthdr.pattr_af = af;
    536  1.219  knakahar 	m->m_pkthdr.pattr_hdr = hdr;
    537   1.76   thorpej 
    538   1.76   thorpej 	m->m_data -= hlen;
    539   1.76   thorpej 	m->m_len += hlen;
    540   1.76   thorpej 
    541   1.76   thorpej 	return;
    542   1.76   thorpej 
    543   1.76   thorpej  bad:
    544  1.219  knakahar 	m->m_pkthdr.pattr_class = NULL;
    545  1.219  knakahar 	m->m_pkthdr.pattr_hdr = NULL;
    546  1.219  knakahar 	m->m_pkthdr.pattr_af = AF_UNSPEC;
    547   1.76   thorpej }
    548   1.76   thorpej #endif /* ALTQ */
    549    1.1       cgd 
    550    1.1       cgd /*
    551    1.1       cgd  * Process a received Ethernet packet;
    552   1.42   thorpej  * the packet is in the mbuf chain m with
    553   1.42   thorpej  * the ether header.
    554    1.1       cgd  */
    555  1.133  liamjfoy void
    556   1.58      matt ether_input(struct ifnet *ifp, struct mbuf *m)
    557    1.1       cgd {
    558   1.91   thorpej 	struct ethercom *ec = (struct ethercom *) ifp;
    559  1.199     rmind 	pktqueue_t *pktq = NULL;
    560  1.199     rmind 	struct ifqueue *inq = NULL;
    561  1.162      matt 	uint16_t etype;
    562   1.42   thorpej 	struct ether_header *eh;
    563  1.187      matt 	size_t ehlen;
    564  1.204       tls 	static int earlypkts;
    565  1.198   msaitoh 	int isr = 0;
    566  1.194     joerg #if defined (LLC) || defined(NETATALK)
    567   1.29       mrg 	struct llc *l;
    568   1.18  christos #endif
    569    1.1       cgd 
    570  1.216     ozaki 	KASSERT(!cpu_intr_p());
    571  1.216     ozaki 
    572    1.8   mycroft 	if ((ifp->if_flags & IFF_UP) == 0) {
    573    1.8   mycroft 		m_freem(m);
    574    1.8   mycroft 		return;
    575    1.8   mycroft 	}
    576   1.42   thorpej 
    577  1.104      matt #ifdef MBUFTRACE
    578  1.116  jonathan 	m_claimm(m, &ec->ec_rx_mowner);
    579  1.104      matt #endif
    580   1.42   thorpej 	eh = mtod(m, struct ether_header *);
    581   1.63   thorpej 	etype = ntohs(eh->ether_type);
    582  1.187      matt 	ehlen = sizeof(*eh);
    583   1.63   thorpej 
    584  1.204       tls 	if(__predict_false(earlypkts < 100 || !rnd_initial_entropy)) {
    585  1.204       tls 		rnd_add_data(NULL, eh, ehlen, 0);
    586  1.204       tls 		earlypkts++;
    587  1.204       tls 	}
    588  1.204       tls 
    589   1.63   thorpej 	/*
    590   1.63   thorpej 	 * Determine if the packet is within its size limits.
    591   1.63   thorpej 	 */
    592  1.182    kefren 	if (etype != ETHERTYPE_MPLS && m->m_pkthdr.len >
    593   1.83   thorpej 	    ETHER_MAX_FRAME(ifp, etype, m->m_flags & M_HASFCS)) {
    594  1.203     ozaki 		mutex_enter(&bigpktpps_lock);
    595  1.123      matt 		if (ppsratecheck(&bigpktppslim_last, &bigpktpps_count,
    596  1.123      matt 			    bigpktppslim)) {
    597  1.123      matt 			printf("%s: discarding oversize frame (len=%d)\n",
    598  1.123      matt 			    ifp->if_xname, m->m_pkthdr.len);
    599  1.123      matt 		}
    600  1.203     ozaki 		mutex_exit(&bigpktpps_lock);
    601   1.63   thorpej 		m_freem(m);
    602   1.63   thorpej 		return;
    603   1.63   thorpej 	}
    604   1.77   thorpej 
    605   1.84   thorpej 	if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
    606   1.84   thorpej 		/*
    607   1.84   thorpej 		 * If this is not a simplex interface, drop the packet
    608   1.84   thorpej 		 * if it came from us.
    609   1.84   thorpej 		 */
    610   1.84   thorpej 		if ((ifp->if_flags & IFF_SIMPLEX) == 0 &&
    611  1.153    dyoung 		    memcmp(CLLADDR(ifp->if_sadl), eh->ether_shost,
    612   1.84   thorpej 		    ETHER_ADDR_LEN) == 0) {
    613   1.84   thorpej 			m_freem(m);
    614   1.84   thorpej 			return;
    615   1.84   thorpej 		}
    616   1.84   thorpej 
    617   1.84   thorpej 		if (memcmp(etherbroadcastaddr,
    618   1.84   thorpej 		    eh->ether_dhost, ETHER_ADDR_LEN) == 0)
    619   1.84   thorpej 			m->m_flags |= M_BCAST;
    620   1.84   thorpej 		else
    621   1.84   thorpej 			m->m_flags |= M_MCAST;
    622   1.84   thorpej 		ifp->if_imcasts++;
    623   1.84   thorpej 	}
    624   1.84   thorpej 
    625   1.79   thorpej 	/* If the CRC is still on the packet, trim it off. */
    626   1.79   thorpej 	if (m->m_flags & M_HASFCS) {
    627   1.79   thorpej 		m_adj(m, -ETHER_CRC_LEN);
    628   1.79   thorpej 		m->m_flags &= ~M_HASFCS;
    629   1.79   thorpej 	}
    630   1.79   thorpej 
    631   1.42   thorpej 	ifp->if_ibytes += m->m_pkthdr.len;
    632   1.78   thorpej 
    633  1.201     ozaki #if NCARP > 0
    634  1.201     ozaki 	if (__predict_false(ifp->if_carp && ifp->if_type != IFT_CARP)) {
    635  1.201     ozaki 		/*
    636  1.201     ozaki 		 * clear M_PROMISC, in case the packets comes from a
    637  1.201     ozaki 		 * vlan
    638  1.201     ozaki 		 */
    639  1.137    rpaulo 		m->m_flags &= ~M_PROMISC;
    640  1.201     ozaki 		if (carp_input(m, (uint8_t *)&eh->ether_shost,
    641  1.201     ozaki 		    (uint8_t *)&eh->ether_dhost, eh->ether_type) == 0)
    642  1.137    rpaulo 			return;
    643  1.201     ozaki 	}
    644  1.133  liamjfoy #endif /* NCARP > 0 */
    645  1.201     ozaki 	if ((m->m_flags & (M_BCAST|M_MCAST|M_PROMISC)) == 0 &&
    646  1.201     ozaki 	    (ifp->if_flags & IFF_PROMISC) != 0 &&
    647  1.201     ozaki 	    memcmp(CLLADDR(ifp->if_sadl), eh->ether_dhost,
    648  1.201     ozaki 		   ETHER_ADDR_LEN) != 0) {
    649  1.201     ozaki 		m->m_flags |= M_PROMISC;
    650   1.70    bouyer 	}
    651   1.78   thorpej 
    652  1.106    bouyer 	if ((m->m_flags & M_PROMISC) == 0) {
    653  1.195     rmind 		if (pfil_run_hooks(ifp->if_pfil, &m, ifp, PFIL_IN) != 0)
    654  1.106    bouyer 			return;
    655  1.106    bouyer 		if (m == NULL)
    656  1.106    bouyer 			return;
    657   1.78   thorpej 
    658  1.106    bouyer 		eh = mtod(m, struct ether_header *);
    659  1.106    bouyer 		etype = ntohs(eh->ether_type);
    660  1.187      matt 		ehlen = sizeof(*eh);
    661  1.106    bouyer 	}
    662   1.70    bouyer 
    663  1.172    darran #if NAGR > 0
    664  1.172    darran 	if (ifp->if_agrprivate &&
    665  1.172    darran 	    __predict_true(etype != ETHERTYPE_SLOWPROTOCOLS)) {
    666  1.172    darran 		m->m_flags &= ~M_PROMISC;
    667  1.172    darran 		agr_input(ifp, m);
    668  1.172    darran 		return;
    669  1.172    darran 	}
    670  1.172    darran #endif /* NAGR > 0 */
    671  1.172    darran 
    672   1.91   thorpej 	/*
    673   1.91   thorpej 	 * If VLANs are configured on the interface, check to
    674   1.91   thorpej 	 * see if the device performed the decapsulation and
    675   1.91   thorpej 	 * provided us with the tag.
    676   1.91   thorpej 	 */
    677  1.114    simonb 	if (ec->ec_nvlans && m_tag_find(m, PACKET_TAG_VLAN, NULL) != NULL) {
    678   1.70    bouyer #if NVLAN > 0
    679   1.70    bouyer 		/*
    680   1.70    bouyer 		 * vlan_input() will either recursively call ether_input()
    681   1.70    bouyer 		 * or drop the packet.
    682   1.70    bouyer 		 */
    683   1.91   thorpej 		vlan_input(ifp, m);
    684   1.91   thorpej #else
    685   1.91   thorpej 		m_freem(m);
    686   1.70    bouyer #endif
    687   1.61   thorpej 		return;
    688   1.61   thorpej 	}
    689    1.1       cgd 
    690   1.59   thorpej 	/*
    691   1.59   thorpej 	 * Handle protocols that expect to have the Ethernet header
    692   1.59   thorpej 	 * (and possibly FCS) intact.
    693   1.59   thorpej 	 */
    694   1.59   thorpej 	switch (etype) {
    695  1.187      matt 	case ETHERTYPE_VLAN: {
    696  1.187      matt 		struct ether_vlan_header *evl = (void *)eh;
    697  1.187      matt 		/*
    698  1.187      matt 		 * If there is a tag of 0, then the VLAN header was probably
    699  1.187      matt 		 * just being used to store the priority.  Extract the ether
    700  1.187      matt 		 * type, and if IP or IPV6, let them deal with it.
    701  1.187      matt 		 */
    702  1.187      matt 		if (m->m_len <= sizeof(*evl)
    703  1.187      matt 		    && EVL_VLANOFTAG(evl->evl_tag) == 0) {
    704  1.187      matt 			etype = ntohs(evl->evl_proto);
    705  1.187      matt 			ehlen = sizeof(*evl);
    706  1.187      matt 			if ((m->m_flags & M_PROMISC) == 0
    707  1.187      matt 			    && (etype == ETHERTYPE_IP
    708  1.187      matt 				|| etype == ETHERTYPE_IPV6))
    709  1.187      matt 				break;
    710  1.187      matt 		}
    711   1.59   thorpej #if NVLAN > 0
    712   1.59   thorpej 		/*
    713   1.59   thorpej 		 * vlan_input() will either recursively call ether_input()
    714   1.59   thorpej 		 * or drop the packet.
    715   1.59   thorpej 		 */
    716   1.63   thorpej 		if (((struct ethercom *)ifp)->ec_nvlans != 0)
    717   1.63   thorpej 			vlan_input(ifp, m);
    718   1.65     enami 		else
    719  1.187      matt #endif /* NVLAN > 0 */
    720   1.65     enami 			m_freem(m);
    721   1.59   thorpej 		return;
    722  1.187      matt 	}
    723   1.81    martin #if NPPPOE > 0
    724   1.81    martin 	case ETHERTYPE_PPPOEDISC:
    725  1.218     ozaki 		pppoedisc_input(ifp, m);
    726  1.218     ozaki 		return;
    727   1.81    martin 	case ETHERTYPE_PPPOE:
    728  1.218     ozaki 		pppoe_input(ifp, m);
    729   1.81    martin 		return;
    730   1.81    martin #endif /* NPPPOE > 0 */
    731  1.121      yamt 	case ETHERTYPE_SLOWPROTOCOLS: {
    732  1.121      yamt 		uint8_t subtype;
    733  1.121      yamt 
    734  1.121      yamt #if defined(DIAGNOSTIC)
    735  1.121      yamt 		if (m->m_pkthdr.len < sizeof(*eh) + sizeof(subtype)) {
    736  1.121      yamt 			panic("ether_input: too short slow protocol packet");
    737  1.121      yamt 		}
    738  1.121      yamt #endif
    739  1.121      yamt 		m_copydata(m, sizeof(*eh), sizeof(subtype), &subtype);
    740  1.121      yamt 		switch (subtype) {
    741  1.121      yamt #if NAGR > 0
    742  1.121      yamt 		case SLOWPROTOCOLS_SUBTYPE_LACP:
    743  1.121      yamt 			if (ifp->if_agrprivate) {
    744  1.121      yamt 				ieee8023ad_lacp_input(ifp, m);
    745  1.121      yamt 				return;
    746  1.121      yamt 			}
    747  1.121      yamt 			break;
    748  1.121      yamt 
    749  1.121      yamt 		case SLOWPROTOCOLS_SUBTYPE_MARKER:
    750  1.121      yamt 			if (ifp->if_agrprivate) {
    751  1.121      yamt 				ieee8023ad_marker_input(ifp, m);
    752  1.121      yamt 				return;
    753  1.121      yamt 			}
    754  1.121      yamt 			break;
    755  1.121      yamt #endif /* NAGR > 0 */
    756  1.121      yamt 		default:
    757  1.121      yamt 			if (subtype == 0 || subtype > 10) {
    758  1.121      yamt 				/* illegal value */
    759  1.121      yamt 				m_freem(m);
    760  1.121      yamt 				return;
    761  1.121      yamt 			}
    762  1.121      yamt 			/* unknown subtype */
    763  1.121      yamt 			break;
    764  1.121      yamt 		}
    765  1.121      yamt 		/* FALLTHROUGH */
    766  1.121      yamt 	}
    767   1.59   thorpej 	default:
    768  1.106    bouyer 		if (m->m_flags & M_PROMISC) {
    769  1.106    bouyer 			m_freem(m);
    770  1.106    bouyer 			return;
    771  1.106    bouyer 		}
    772   1.59   thorpej 	}
    773   1.42   thorpej 
    774   1.45   thorpej 	/* If the CRC is still on the packet, trim it off. */
    775   1.79   thorpej 	if (m->m_flags & M_HASFCS) {
    776   1.45   thorpej 		m_adj(m, -ETHER_CRC_LEN);
    777   1.79   thorpej 		m->m_flags &= ~M_HASFCS;
    778   1.79   thorpej 	}
    779   1.42   thorpej 
    780  1.139        is 	if (etype > ETHERMTU + sizeof (struct ether_header)) {
    781  1.139        is 		/* Strip off the Ethernet header. */
    782  1.187      matt 		m_adj(m, ehlen);
    783  1.139        is 
    784  1.139        is 		switch (etype) {
    785    1.1       cgd #ifdef INET
    786  1.139        is 		case ETHERTYPE_IP:
    787   1.30      matt #ifdef GATEWAY
    788  1.139        is 			if (ipflow_fastforward(m))
    789  1.139        is 				return;
    790   1.30      matt #endif
    791  1.199     rmind 			pktq = ip_pktq;
    792  1.139        is 			break;
    793    1.1       cgd 
    794  1.139        is 		case ETHERTYPE_ARP:
    795  1.198   msaitoh 			isr = NETISR_ARP;
    796  1.139        is 			inq = &arpintrq;
    797  1.139        is 			break;
    798    1.7     glass 
    799  1.139        is 		case ETHERTYPE_REVARP:
    800  1.139        is 			revarpinput(m);	/* XXX queue? */
    801  1.139        is 			return;
    802    1.1       cgd #endif
    803   1.44    itojun #ifdef INET6
    804  1.139        is 		case ETHERTYPE_IPV6:
    805  1.196     pooka 			if (__predict_false(!in6_present)) {
    806  1.196     pooka 				m_freem(m);
    807  1.196     pooka 				return;
    808  1.196     pooka 			}
    809  1.148  liamjfoy #ifdef GATEWAY
    810  1.192  christos 			if (ip6flow_fastforward(&m))
    811  1.148  liamjfoy 				return;
    812  1.148  liamjfoy #endif
    813  1.199     rmind 			pktq = ip6_pktq;
    814  1.139        is 			break;
    815   1.44    itojun #endif
    816   1.23  christos #ifdef NETATALK
    817  1.174     isaki 		case ETHERTYPE_ATALK:
    818  1.198   msaitoh 			isr = NETISR_ATALK;
    819  1.174     isaki 			inq = &atintrq1;
    820  1.174     isaki 			break;
    821  1.174     isaki 		case ETHERTYPE_AARP:
    822  1.139        is 			/* probably this should be done with a NETISR as well */
    823  1.175   mbalmer 			aarpinput(ifp, m); /* XXX */
    824  1.174     isaki 			return;
    825   1.23  christos #endif /* NETATALK */
    826  1.182    kefren #ifdef MPLS
    827  1.182    kefren 		case ETHERTYPE_MPLS:
    828  1.198   msaitoh 			isr = NETISR_MPLS;
    829  1.182    kefren 			inq = &mplsintrq;
    830  1.182    kefren 			break;
    831  1.182    kefren #endif
    832  1.139        is 		default:
    833  1.139        is 			m_freem(m);
    834  1.139        is 			return;
    835  1.139        is 		}
    836  1.139        is 	} else {
    837  1.194     joerg #if defined (LLC) || defined (NETATALK)
    838  1.139        is 		l = (struct llc *)(eh+1);
    839    1.8   mycroft 		switch (l->llc_dsap) {
    840   1.23  christos #ifdef NETATALK
    841   1.23  christos 		case LLC_SNAP_LSAP:
    842   1.23  christos 			switch (l->llc_control) {
    843   1.23  christos 			case LLC_UI:
    844   1.23  christos 				if (l->llc_ssap != LLC_SNAP_LSAP) {
    845   1.23  christos 					goto dropanyway;
    846   1.23  christos 				}
    847  1.120     perry 
    848  1.166    dyoung 				if (memcmp(&(l->llc_snap_org_code)[0],
    849   1.23  christos 				    at_org_code, sizeof(at_org_code)) == 0 &&
    850   1.23  christos 				    ntohs(l->llc_snap_ether_type) ==
    851   1.38       kim 				    ETHERTYPE_ATALK) {
    852   1.23  christos 					inq = &atintrq2;
    853  1.139        is 					m_adj(m, sizeof(struct ether_header)
    854  1.139        is 					    + sizeof(struct llc));
    855  1.198   msaitoh 					isr = NETISR_ATALK;
    856   1.23  christos 					break;
    857   1.23  christos 				}
    858   1.23  christos 
    859  1.166    dyoung 				if (memcmp(&(l->llc_snap_org_code)[0],
    860   1.23  christos 				    aarp_org_code,
    861   1.23  christos 				    sizeof(aarp_org_code)) == 0 &&
    862   1.23  christos 				    ntohs(l->llc_snap_ether_type) ==
    863   1.23  christos 				    ETHERTYPE_AARP) {
    864  1.139        is 					m_adj( m, sizeof(struct ether_header)
    865  1.139        is 					    + sizeof(struct llc));
    866   1.23  christos 					aarpinput(ifp, m); /* XXX */
    867   1.23  christos 				    return;
    868   1.23  christos 				}
    869  1.120     perry 
    870   1.23  christos 			default:
    871   1.23  christos 				goto dropanyway;
    872   1.23  christos 			}
    873   1.23  christos 			break;
    874    1.1       cgd 		dropanyway:
    875  1.142    bouyer #endif
    876    1.1       cgd 		default:
    877    1.8   mycroft 			m_freem(m);
    878    1.8   mycroft 			return;
    879    1.8   mycroft 		}
    880  1.139        is #else /* ISO || LLC || NETATALK*/
    881  1.139        is 		m_freem(m);
    882  1.139        is 		return;
    883   1.23  christos #endif /* ISO || LLC || NETATALK*/
    884    1.1       cgd 	}
    885    1.1       cgd 
    886  1.199     rmind 	if (__predict_true(pktq)) {
    887  1.199     rmind 		const uint32_t h = pktq_rps_hash(m);
    888  1.199     rmind 		if (__predict_false(!pktq_enqueue(pktq, m, h))) {
    889  1.199     rmind 			m_freem(m);
    890  1.199     rmind 		}
    891  1.199     rmind 		return;
    892  1.199     rmind 	}
    893  1.199     rmind 
    894  1.199     rmind 	if (__predict_false(!inq)) {
    895  1.199     rmind 		/* Should not happen. */
    896  1.199     rmind 		m_freem(m);
    897  1.199     rmind 		return;
    898  1.199     rmind 	}
    899    1.1       cgd 	if (IF_QFULL(inq)) {
    900    1.1       cgd 		IF_DROP(inq);
    901    1.1       cgd 		m_freem(m);
    902  1.198   msaitoh 	} else {
    903    1.1       cgd 		IF_ENQUEUE(inq, m);
    904  1.198   msaitoh 		schednetisr(isr);
    905  1.198   msaitoh 	}
    906    1.1       cgd }
    907    1.1       cgd 
    908    1.1       cgd /*
    909    1.1       cgd  * Convert Ethernet address to printable (loggable) representation.
    910    1.1       cgd  */
    911    1.1       cgd char *
    912   1.58      matt ether_sprintf(const u_char *ap)
    913    1.1       cgd {
    914  1.129  christos 	static char etherbuf[3 * ETHER_ADDR_LEN];
    915  1.129  christos 	return ether_snprintf(etherbuf, sizeof(etherbuf), ap);
    916  1.129  christos }
    917  1.129  christos 
    918  1.129  christos char *
    919  1.129  christos ether_snprintf(char *buf, size_t len, const u_char *ap)
    920  1.129  christos {
    921  1.129  christos 	char *cp = buf;
    922  1.129  christos 	size_t i;
    923    1.1       cgd 
    924  1.129  christos 	for (i = 0; i < len / 3; i++) {
    925  1.124  christos 		*cp++ = hexdigits[*ap >> 4];
    926  1.124  christos 		*cp++ = hexdigits[*ap++ & 0xf];
    927    1.1       cgd 		*cp++ = ':';
    928    1.1       cgd 	}
    929  1.129  christos 	*--cp = '\0';
    930  1.129  christos 	return buf;
    931    1.1       cgd }
    932    1.8   mycroft 
    933    1.8   mycroft /*
    934    1.8   mycroft  * Perform common duties while attaching to interface list
    935    1.8   mycroft  */
    936    1.8   mycroft void
    937  1.162      matt ether_ifattach(struct ifnet *ifp, const uint8_t *lla)
    938    1.8   mycroft {
    939  1.104      matt 	struct ethercom *ec = (struct ethercom *)ifp;
    940    1.8   mycroft 
    941  1.224  knakahar 	ifp->if_extflags |= IFEF_OUTPUT_MPSAFE;
    942    1.8   mycroft 	ifp->if_type = IFT_ETHER;
    943   1.94     enami 	ifp->if_hdrlen = ETHER_HDR_LEN;
    944   1.73   thorpej 	ifp->if_dlt = DLT_EN10MB;
    945    1.8   mycroft 	ifp->if_mtu = ETHERMTU;
    946   1.12   mycroft 	ifp->if_output = ether_output;
    947  1.216     ozaki 	ifp->_if_input = ether_input;
    948   1.54   thorpej 	if (ifp->if_baudrate == 0)
    949   1.54   thorpej 		ifp->if_baudrate = IF_Mbps(10);		/* just a default */
    950   1.75   thorpej 
    951  1.170    dyoung 	if_set_sadl(ifp, lla, ETHER_ADDR_LEN, !ETHER_IS_LOCAL(lla));
    952   1.75   thorpej 
    953  1.104      matt 	LIST_INIT(&ec->ec_multiaddrs);
    954   1.26        is 	ifp->if_broadcastaddr = etherbroadcastaddr;
    955  1.177     joerg 	bpf_attach(ifp, DLT_EN10MB, sizeof(struct ether_header));
    956  1.104      matt #ifdef MBUFTRACE
    957  1.108    itojun 	strlcpy(ec->ec_tx_mowner.mo_name, ifp->if_xname,
    958  1.108    itojun 	    sizeof(ec->ec_tx_mowner.mo_name));
    959  1.108    itojun 	strlcpy(ec->ec_tx_mowner.mo_descr, "tx",
    960  1.108    itojun 	    sizeof(ec->ec_tx_mowner.mo_descr));
    961  1.108    itojun 	strlcpy(ec->ec_rx_mowner.mo_name, ifp->if_xname,
    962  1.108    itojun 	    sizeof(ec->ec_rx_mowner.mo_name));
    963  1.108    itojun 	strlcpy(ec->ec_rx_mowner.mo_descr, "rx",
    964  1.108    itojun 	    sizeof(ec->ec_rx_mowner.mo_descr));
    965  1.104      matt 	MOWNER_ATTACH(&ec->ec_tx_mowner);
    966  1.104      matt 	MOWNER_ATTACH(&ec->ec_rx_mowner);
    967  1.104      matt 	ifp->if_mowner = &ec->ec_tx_mowner;
    968  1.104      matt #endif
    969   1.52   thorpej }
    970   1.52   thorpej 
    971   1.52   thorpej void
    972   1.58      matt ether_ifdetach(struct ifnet *ifp)
    973   1.52   thorpej {
    974   1.63   thorpej 	struct ethercom *ec = (void *) ifp;
    975   1.63   thorpej 	struct ether_multi *enm;
    976   1.63   thorpej 	int s;
    977   1.69   thorpej 
    978  1.190  christos 	/*
    979  1.190  christos 	 * Prevent further calls to ioctl (for example turning off
    980  1.190  christos 	 * promiscuous mode from the bridge code), which eventually can
    981  1.190  christos 	 * call if_init() which can cause panics because the interface
    982  1.190  christos 	 * is in the process of being detached. Return device not configured
    983  1.190  christos 	 * instead.
    984  1.190  christos 	 */
    985  1.190  christos 	ifp->if_ioctl = (int (*)(struct ifnet *, u_long, void *))enxio;
    986  1.190  christos 
    987  1.115    dyoung #if NBRIDGE > 0
    988  1.115    dyoung 	if (ifp->if_bridge)
    989  1.115    dyoung 		bridge_ifdetach(ifp);
    990  1.115    dyoung #endif
    991  1.115    dyoung 
    992  1.177     joerg 	bpf_detach(ifp);
    993   1.64   thorpej 
    994   1.64   thorpej #if NVLAN > 0
    995   1.64   thorpej 	if (ec->ec_nvlans)
    996   1.64   thorpej 		vlan_ifdetach(ifp);
    997   1.64   thorpej #endif
    998   1.63   thorpej 
    999   1.79   thorpej 	s = splnet();
   1000   1.63   thorpej 	while ((enm = LIST_FIRST(&ec->ec_multiaddrs)) != NULL) {
   1001   1.63   thorpej 		LIST_REMOVE(enm, enm_list);
   1002  1.100  jdolecek 		free(enm, M_IFMADDR);
   1003   1.63   thorpej 		ec->ec_multicnt--;
   1004   1.63   thorpej 	}
   1005   1.63   thorpej 	splx(s);
   1006   1.52   thorpej 
   1007  1.189       chs 	ifp->if_mowner = NULL;
   1008  1.104      matt 	MOWNER_DETACH(&ec->ec_rx_mowner);
   1009  1.104      matt 	MOWNER_DETACH(&ec->ec_tx_mowner);
   1010   1.53   thorpej }
   1011   1.53   thorpej 
   1012   1.56   thorpej #if 0
   1013   1.56   thorpej /*
   1014   1.56   thorpej  * This is for reference.  We have a table-driven version
   1015   1.56   thorpej  * of the little-endian crc32 generator, which is faster
   1016   1.56   thorpej  * than the double-loop.
   1017   1.56   thorpej  */
   1018  1.162      matt uint32_t
   1019  1.162      matt ether_crc32_le(const uint8_t *buf, size_t len)
   1020   1.53   thorpej {
   1021  1.162      matt 	uint32_t c, crc, carry;
   1022   1.53   thorpej 	size_t i, j;
   1023   1.53   thorpej 
   1024   1.53   thorpej 	crc = 0xffffffffU;	/* initial value */
   1025   1.53   thorpej 
   1026   1.53   thorpej 	for (i = 0; i < len; i++) {
   1027   1.53   thorpej 		c = buf[i];
   1028   1.53   thorpej 		for (j = 0; j < 8; j++) {
   1029   1.53   thorpej 			carry = ((crc & 0x01) ? 1 : 0) ^ (c & 0x01);
   1030   1.53   thorpej 			crc >>= 1;
   1031   1.53   thorpej 			c >>= 1;
   1032   1.53   thorpej 			if (carry)
   1033   1.56   thorpej 				crc = (crc ^ ETHER_CRC_POLY_LE);
   1034   1.53   thorpej 		}
   1035   1.53   thorpej 	}
   1036   1.53   thorpej 
   1037   1.53   thorpej 	return (crc);
   1038   1.53   thorpej }
   1039   1.56   thorpej #else
   1040  1.162      matt uint32_t
   1041  1.162      matt ether_crc32_le(const uint8_t *buf, size_t len)
   1042   1.56   thorpej {
   1043  1.162      matt 	static const uint32_t crctab[] = {
   1044   1.56   thorpej 		0x00000000, 0x1db71064, 0x3b6e20c8, 0x26d930ac,
   1045   1.56   thorpej 		0x76dc4190, 0x6b6b51f4, 0x4db26158, 0x5005713c,
   1046   1.56   thorpej 		0xedb88320, 0xf00f9344, 0xd6d6a3e8, 0xcb61b38c,
   1047   1.56   thorpej 		0x9b64c2b0, 0x86d3d2d4, 0xa00ae278, 0xbdbdf21c
   1048   1.56   thorpej 	};
   1049  1.162      matt 	uint32_t crc;
   1050   1.98   thorpej 	size_t i;
   1051   1.56   thorpej 
   1052   1.56   thorpej 	crc = 0xffffffffU;	/* initial value */
   1053   1.56   thorpej 
   1054   1.56   thorpej 	for (i = 0; i < len; i++) {
   1055   1.56   thorpej 		crc ^= buf[i];
   1056   1.56   thorpej 		crc = (crc >> 4) ^ crctab[crc & 0xf];
   1057   1.56   thorpej 		crc = (crc >> 4) ^ crctab[crc & 0xf];
   1058   1.56   thorpej 	}
   1059   1.56   thorpej 
   1060   1.56   thorpej 	return (crc);
   1061   1.56   thorpej }
   1062   1.56   thorpej #endif
   1063   1.53   thorpej 
   1064  1.162      matt uint32_t
   1065  1.162      matt ether_crc32_be(const uint8_t *buf, size_t len)
   1066   1.53   thorpej {
   1067  1.162      matt 	uint32_t c, crc, carry;
   1068   1.53   thorpej 	size_t i, j;
   1069   1.53   thorpej 
   1070   1.53   thorpej 	crc = 0xffffffffU;	/* initial value */
   1071   1.53   thorpej 
   1072   1.53   thorpej 	for (i = 0; i < len; i++) {
   1073   1.53   thorpej 		c = buf[i];
   1074   1.53   thorpej 		for (j = 0; j < 8; j++) {
   1075   1.53   thorpej 			carry = ((crc & 0x80000000U) ? 1 : 0) ^ (c & 0x01);
   1076   1.53   thorpej 			crc <<= 1;
   1077   1.53   thorpej 			c >>= 1;
   1078   1.53   thorpej 			if (carry)
   1079   1.53   thorpej 				crc = (crc ^ ETHER_CRC_POLY_BE) | carry;
   1080   1.53   thorpej 		}
   1081   1.53   thorpej 	}
   1082   1.53   thorpej 
   1083   1.53   thorpej 	return (crc);
   1084    1.8   mycroft }
   1085    1.8   mycroft 
   1086   1.48        is #ifdef INET
   1087  1.118      yamt const uint8_t ether_ipmulticast_min[ETHER_ADDR_LEN] =
   1088  1.118      yamt     { 0x01, 0x00, 0x5e, 0x00, 0x00, 0x00 };
   1089  1.118      yamt const uint8_t ether_ipmulticast_max[ETHER_ADDR_LEN] =
   1090  1.118      yamt     { 0x01, 0x00, 0x5e, 0x7f, 0xff, 0xff };
   1091   1.48        is #endif
   1092   1.44    itojun #ifdef INET6
   1093  1.118      yamt const uint8_t ether_ip6multicast_min[ETHER_ADDR_LEN] =
   1094  1.118      yamt     { 0x33, 0x33, 0x00, 0x00, 0x00, 0x00 };
   1095  1.118      yamt const uint8_t ether_ip6multicast_max[ETHER_ADDR_LEN] =
   1096  1.118      yamt     { 0x33, 0x33, 0xff, 0xff, 0xff, 0xff };
   1097   1.44    itojun #endif
   1098   1.60     enami 
   1099    1.3   hpeyerl /*
   1100  1.138    rpaulo  * ether_aton implementation, not using a static buffer.
   1101  1.138    rpaulo  */
   1102  1.138    rpaulo int
   1103  1.180  christos ether_aton_r(u_char *dest, size_t len, const char *str)
   1104  1.138    rpaulo {
   1105  1.180  christos         const u_char *cp = (const void *)str;
   1106  1.180  christos 	u_char *ep;
   1107  1.180  christos 
   1108  1.185   tsutsui #define atox(c)	(((c) <= '9') ? ((c) - '0') : ((toupper(c) - 'A') + 10))
   1109  1.180  christos 
   1110  1.180  christos 	if (len < ETHER_ADDR_LEN)
   1111  1.180  christos 		return ENOSPC;
   1112  1.180  christos 
   1113  1.180  christos 	ep = dest + ETHER_ADDR_LEN;
   1114  1.180  christos 
   1115  1.180  christos 	while (*cp) {
   1116  1.180  christos                 if (!isxdigit(*cp))
   1117  1.180  christos                         return EINVAL;
   1118  1.180  christos 		*dest = atox(*cp);
   1119  1.180  christos 		cp++;
   1120  1.180  christos                 if (isxdigit(*cp)) {
   1121  1.180  christos                         *dest = (*dest << 4) | atox(*cp);
   1122  1.180  christos 			dest++;
   1123  1.180  christos 			cp++;
   1124  1.180  christos                 } else
   1125  1.181  christos 			dest++;
   1126  1.180  christos 		if (dest == ep)
   1127  1.180  christos 			return *cp == '\0' ? 0 : ENAMETOOLONG;
   1128  1.180  christos 		switch (*cp) {
   1129  1.180  christos 		case ':':
   1130  1.180  christos 		case '-':
   1131  1.180  christos 		case '.':
   1132  1.179  jakllsch 			cp++;
   1133  1.180  christos 			break;
   1134  1.179  jakllsch 		}
   1135  1.180  christos         }
   1136  1.180  christos 	return ENOBUFS;
   1137  1.138    rpaulo }
   1138  1.138    rpaulo 
   1139  1.138    rpaulo /*
   1140   1.60     enami  * Convert a sockaddr into an Ethernet address or range of Ethernet
   1141   1.60     enami  * addresses.
   1142    1.3   hpeyerl  */
   1143    1.3   hpeyerl int
   1144  1.162      matt ether_multiaddr(const struct sockaddr *sa, uint8_t addrlo[ETHER_ADDR_LEN],
   1145  1.162      matt     uint8_t addrhi[ETHER_ADDR_LEN])
   1146    1.3   hpeyerl {
   1147   1.24  christos #ifdef INET
   1148  1.155    dyoung 	const struct sockaddr_in *sin;
   1149   1.24  christos #endif /* INET */
   1150   1.44    itojun #ifdef INET6
   1151  1.155    dyoung 	const struct sockaddr_in6 *sin6;
   1152   1.44    itojun #endif /* INET6 */
   1153    1.3   hpeyerl 
   1154   1.60     enami 	switch (sa->sa_family) {
   1155    1.3   hpeyerl 
   1156    1.3   hpeyerl 	case AF_UNSPEC:
   1157  1.146    dyoung 		memcpy(addrlo, sa->sa_data, ETHER_ADDR_LEN);
   1158  1.146    dyoung 		memcpy(addrhi, addrlo, ETHER_ADDR_LEN);
   1159    1.3   hpeyerl 		break;
   1160    1.3   hpeyerl 
   1161    1.3   hpeyerl #ifdef INET
   1162    1.3   hpeyerl 	case AF_INET:
   1163  1.155    dyoung 		sin = satocsin(sa);
   1164    1.3   hpeyerl 		if (sin->sin_addr.s_addr == INADDR_ANY) {
   1165    1.3   hpeyerl 			/*
   1166   1.60     enami 			 * An IP address of INADDR_ANY means listen to
   1167   1.60     enami 			 * or stop listening to all of the Ethernet
   1168   1.60     enami 			 * multicast addresses used for IP.
   1169    1.3   hpeyerl 			 * (This is for the sake of IP multicast routers.)
   1170    1.3   hpeyerl 			 */
   1171  1.146    dyoung 			memcpy(addrlo, ether_ipmulticast_min, ETHER_ADDR_LEN);
   1172  1.146    dyoung 			memcpy(addrhi, ether_ipmulticast_max, ETHER_ADDR_LEN);
   1173    1.3   hpeyerl 		}
   1174    1.3   hpeyerl 		else {
   1175    1.3   hpeyerl 			ETHER_MAP_IP_MULTICAST(&sin->sin_addr, addrlo);
   1176  1.146    dyoung 			memcpy(addrhi, addrlo, ETHER_ADDR_LEN);
   1177    1.3   hpeyerl 		}
   1178    1.3   hpeyerl 		break;
   1179    1.3   hpeyerl #endif
   1180   1.44    itojun #ifdef INET6
   1181   1.44    itojun 	case AF_INET6:
   1182  1.155    dyoung 		sin6 = satocsin6(sa);
   1183   1.47    itojun 		if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
   1184   1.44    itojun 			/*
   1185   1.60     enami 			 * An IP6 address of 0 means listen to or stop
   1186   1.60     enami 			 * listening to all of the Ethernet multicast
   1187   1.60     enami 			 * address used for IP6.
   1188   1.44    itojun 			 * (This is used for multicast routers.)
   1189   1.44    itojun 			 */
   1190  1.146    dyoung 			memcpy(addrlo, ether_ip6multicast_min, ETHER_ADDR_LEN);
   1191  1.146    dyoung 			memcpy(addrhi, ether_ip6multicast_max, ETHER_ADDR_LEN);
   1192   1.44    itojun 		} else {
   1193   1.44    itojun 			ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, addrlo);
   1194  1.146    dyoung 			memcpy(addrhi, addrlo, ETHER_ADDR_LEN);
   1195   1.44    itojun 		}
   1196   1.44    itojun 		break;
   1197   1.44    itojun #endif
   1198    1.3   hpeyerl 
   1199    1.3   hpeyerl 	default:
   1200  1.146    dyoung 		return EAFNOSUPPORT;
   1201   1.60     enami 	}
   1202  1.146    dyoung 	return 0;
   1203   1.60     enami }
   1204   1.60     enami 
   1205   1.60     enami /*
   1206   1.60     enami  * Add an Ethernet multicast address or range of addresses to the list for a
   1207   1.60     enami  * given interface.
   1208   1.60     enami  */
   1209   1.60     enami int
   1210  1.155    dyoung ether_addmulti(const struct sockaddr *sa, struct ethercom *ec)
   1211   1.60     enami {
   1212   1.60     enami 	struct ether_multi *enm;
   1213   1.60     enami 	u_char addrlo[ETHER_ADDR_LEN];
   1214   1.60     enami 	u_char addrhi[ETHER_ADDR_LEN];
   1215   1.79   thorpej 	int s = splnet(), error;
   1216   1.60     enami 
   1217  1.155    dyoung 	error = ether_multiaddr(sa, addrlo, addrhi);
   1218   1.60     enami 	if (error != 0) {
   1219    1.3   hpeyerl 		splx(s);
   1220  1.146    dyoung 		return error;
   1221    1.3   hpeyerl 	}
   1222    1.3   hpeyerl 
   1223    1.3   hpeyerl 	/*
   1224    1.3   hpeyerl 	 * Verify that we have valid Ethernet multicast addresses.
   1225    1.3   hpeyerl 	 */
   1226  1.186      yamt 	if (!ETHER_IS_MULTICAST(addrlo) || !ETHER_IS_MULTICAST(addrhi)) {
   1227    1.3   hpeyerl 		splx(s);
   1228  1.146    dyoung 		return EINVAL;
   1229    1.3   hpeyerl 	}
   1230    1.3   hpeyerl 	/*
   1231    1.3   hpeyerl 	 * See if the address range is already in the list.
   1232    1.3   hpeyerl 	 */
   1233   1.22        is 	ETHER_LOOKUP_MULTI(addrlo, addrhi, ec, enm);
   1234    1.3   hpeyerl 	if (enm != NULL) {
   1235    1.3   hpeyerl 		/*
   1236    1.3   hpeyerl 		 * Found it; just increment the reference count.
   1237    1.3   hpeyerl 		 */
   1238    1.3   hpeyerl 		++enm->enm_refcount;
   1239    1.3   hpeyerl 		splx(s);
   1240  1.146    dyoung 		return 0;
   1241    1.3   hpeyerl 	}
   1242    1.3   hpeyerl 	/*
   1243    1.3   hpeyerl 	 * New address or range; malloc a new multicast record
   1244    1.3   hpeyerl 	 * and link it into the interface's multicast list.
   1245    1.3   hpeyerl 	 */
   1246    1.3   hpeyerl 	enm = (struct ether_multi *)malloc(sizeof(*enm), M_IFMADDR, M_NOWAIT);
   1247    1.3   hpeyerl 	if (enm == NULL) {
   1248    1.3   hpeyerl 		splx(s);
   1249  1.146    dyoung 		return ENOBUFS;
   1250    1.3   hpeyerl 	}
   1251  1.146    dyoung 	memcpy(enm->enm_addrlo, addrlo, 6);
   1252  1.146    dyoung 	memcpy(enm->enm_addrhi, addrhi, 6);
   1253    1.3   hpeyerl 	enm->enm_refcount = 1;
   1254   1.22        is 	LIST_INSERT_HEAD(&ec->ec_multiaddrs, enm, enm_list);
   1255   1.22        is 	ec->ec_multicnt++;
   1256    1.3   hpeyerl 	splx(s);
   1257    1.3   hpeyerl 	/*
   1258    1.3   hpeyerl 	 * Return ENETRESET to inform the driver that the list has changed
   1259    1.3   hpeyerl 	 * and its reception filter should be adjusted accordingly.
   1260    1.3   hpeyerl 	 */
   1261  1.146    dyoung 	return ENETRESET;
   1262    1.3   hpeyerl }
   1263    1.3   hpeyerl 
   1264    1.3   hpeyerl /*
   1265    1.3   hpeyerl  * Delete a multicast address record.
   1266    1.3   hpeyerl  */
   1267    1.3   hpeyerl int
   1268  1.155    dyoung ether_delmulti(const struct sockaddr *sa, struct ethercom *ec)
   1269    1.3   hpeyerl {
   1270   1.29       mrg 	struct ether_multi *enm;
   1271   1.60     enami 	u_char addrlo[ETHER_ADDR_LEN];
   1272   1.60     enami 	u_char addrhi[ETHER_ADDR_LEN];
   1273   1.79   thorpej 	int s = splnet(), error;
   1274    1.3   hpeyerl 
   1275  1.155    dyoung 	error = ether_multiaddr(sa, addrlo, addrhi);
   1276   1.60     enami 	if (error != 0) {
   1277    1.3   hpeyerl 		splx(s);
   1278   1.60     enami 		return (error);
   1279    1.3   hpeyerl 	}
   1280    1.3   hpeyerl 
   1281    1.3   hpeyerl 	/*
   1282   1.66   thorpej 	 * Look ur the address in our list.
   1283    1.3   hpeyerl 	 */
   1284   1.22        is 	ETHER_LOOKUP_MULTI(addrlo, addrhi, ec, enm);
   1285    1.3   hpeyerl 	if (enm == NULL) {
   1286    1.3   hpeyerl 		splx(s);
   1287    1.3   hpeyerl 		return (ENXIO);
   1288    1.3   hpeyerl 	}
   1289    1.3   hpeyerl 	if (--enm->enm_refcount != 0) {
   1290    1.3   hpeyerl 		/*
   1291    1.3   hpeyerl 		 * Still some claims to this record.
   1292    1.3   hpeyerl 		 */
   1293    1.3   hpeyerl 		splx(s);
   1294    1.3   hpeyerl 		return (0);
   1295    1.3   hpeyerl 	}
   1296    1.3   hpeyerl 	/*
   1297    1.3   hpeyerl 	 * No remaining claims to this record; unlink and free it.
   1298    1.3   hpeyerl 	 */
   1299   1.13   mycroft 	LIST_REMOVE(enm, enm_list);
   1300    1.3   hpeyerl 	free(enm, M_IFMADDR);
   1301   1.22        is 	ec->ec_multicnt--;
   1302    1.3   hpeyerl 	splx(s);
   1303    1.3   hpeyerl 	/*
   1304    1.3   hpeyerl 	 * Return ENETRESET to inform the driver that the list has changed
   1305    1.3   hpeyerl 	 * and its reception filter should be adjusted accordingly.
   1306    1.3   hpeyerl 	 */
   1307    1.3   hpeyerl 	return (ENETRESET);
   1308   1.66   thorpej }
   1309   1.66   thorpej 
   1310  1.170    dyoung void
   1311  1.170    dyoung ether_set_ifflags_cb(struct ethercom *ec, ether_cb_t cb)
   1312  1.170    dyoung {
   1313  1.170    dyoung 	ec->ec_ifflags_cb = cb;
   1314  1.170    dyoung }
   1315  1.170    dyoung 
   1316   1.66   thorpej /*
   1317   1.66   thorpej  * Common ioctls for Ethernet interfaces.  Note, we must be
   1318   1.66   thorpej  * called at splnet().
   1319   1.66   thorpej  */
   1320   1.66   thorpej int
   1321  1.147  christos ether_ioctl(struct ifnet *ifp, u_long cmd, void *data)
   1322   1.66   thorpej {
   1323   1.66   thorpej 	struct ethercom *ec = (void *) ifp;
   1324  1.193   msaitoh 	struct eccapreq *eccr;
   1325   1.66   thorpej 	struct ifreq *ifr = (struct ifreq *)data;
   1326  1.170    dyoung 	struct if_laddrreq *iflr = data;
   1327  1.170    dyoung 	const struct sockaddr_dl *sdl;
   1328  1.170    dyoung 	static const uint8_t zero[ETHER_ADDR_LEN];
   1329  1.169    dyoung 	int error;
   1330   1.66   thorpej 
   1331   1.66   thorpej 	switch (cmd) {
   1332  1.170    dyoung 	case SIOCINITIFADDR:
   1333  1.191      matt 	    {
   1334  1.191      matt 		struct ifaddr *ifa = (struct ifaddr *)data;
   1335  1.191      matt 		if (ifa->ifa_addr->sa_family != AF_LINK
   1336  1.191      matt 		    && (ifp->if_flags & (IFF_UP|IFF_RUNNING)) !=
   1337  1.191      matt 		       (IFF_UP|IFF_RUNNING)) {
   1338  1.170    dyoung 			ifp->if_flags |= IFF_UP;
   1339  1.170    dyoung 			if ((error = (*ifp->if_init)(ifp)) != 0)
   1340  1.170    dyoung 				return error;
   1341  1.170    dyoung 		}
   1342   1.66   thorpej #ifdef INET
   1343  1.191      matt 		if (ifa->ifa_addr->sa_family == AF_INET)
   1344  1.191      matt 			arp_ifinit(ifp, ifa);
   1345   1.66   thorpej #endif /* INET */
   1346  1.169    dyoung 		return 0;
   1347  1.191      matt 	    }
   1348   1.66   thorpej 
   1349   1.66   thorpej 	case SIOCSIFMTU:
   1350   1.82   thorpej 	    {
   1351   1.82   thorpej 		int maxmtu;
   1352   1.82   thorpej 
   1353   1.82   thorpej 		if (ec->ec_capabilities & ETHERCAP_JUMBO_MTU)
   1354   1.82   thorpej 			maxmtu = ETHERMTU_JUMBO;
   1355   1.82   thorpej 		else
   1356   1.82   thorpej 			maxmtu = ETHERMTU;
   1357   1.82   thorpej 
   1358   1.82   thorpej 		if (ifr->ifr_mtu < ETHERMIN || ifr->ifr_mtu > maxmtu)
   1359  1.169    dyoung 			return EINVAL;
   1360  1.169    dyoung 		else if ((error = ifioctl_common(ifp, cmd, data)) != ENETRESET)
   1361  1.169    dyoung 			return error;
   1362  1.169    dyoung 		else if (ifp->if_flags & IFF_UP) {
   1363   1.88   thorpej 			/* Make sure the device notices the MTU change. */
   1364  1.169    dyoung 			return (*ifp->if_init)(ifp);
   1365  1.169    dyoung 		} else
   1366  1.169    dyoung 			return 0;
   1367   1.82   thorpej 	    }
   1368   1.66   thorpej 
   1369   1.66   thorpej 	case SIOCSIFFLAGS:
   1370  1.170    dyoung 		if ((error = ifioctl_common(ifp, cmd, data)) != 0)
   1371  1.170    dyoung 			return error;
   1372  1.169    dyoung 		switch (ifp->if_flags & (IFF_UP|IFF_RUNNING)) {
   1373  1.169    dyoung 		case IFF_RUNNING:
   1374   1.66   thorpej 			/*
   1375   1.66   thorpej 			 * If interface is marked down and it is running,
   1376   1.66   thorpej 			 * then stop and disable it.
   1377   1.66   thorpej 			 */
   1378   1.66   thorpej 			(*ifp->if_stop)(ifp, 1);
   1379  1.169    dyoung 			break;
   1380  1.169    dyoung 		case IFF_UP:
   1381   1.66   thorpej 			/*
   1382   1.66   thorpej 			 * If interface is marked up and it is stopped, then
   1383   1.66   thorpej 			 * start it.
   1384   1.66   thorpej 			 */
   1385  1.169    dyoung 			return (*ifp->if_init)(ifp);
   1386  1.169    dyoung 		case IFF_UP|IFF_RUNNING:
   1387  1.170    dyoung 			error = 0;
   1388  1.170    dyoung 			if (ec->ec_ifflags_cb == NULL ||
   1389  1.170    dyoung 			    (error = (*ec->ec_ifflags_cb)(ec)) == ENETRESET) {
   1390  1.170    dyoung 				/*
   1391  1.170    dyoung 				 * Reset the interface to pick up
   1392  1.170    dyoung 				 * changes in any other flags that
   1393  1.170    dyoung 				 * affect the hardware state.
   1394  1.170    dyoung 				 */
   1395  1.170    dyoung 				return (*ifp->if_init)(ifp);
   1396  1.170    dyoung 			} else
   1397  1.170    dyoung 				return error;
   1398  1.169    dyoung 		case 0:
   1399  1.169    dyoung 			break;
   1400   1.66   thorpej 		}
   1401  1.169    dyoung 		return 0;
   1402  1.193   msaitoh 	case SIOCGETHERCAP:
   1403  1.193   msaitoh 		eccr = (struct eccapreq *)data;
   1404  1.193   msaitoh 		eccr->eccr_capabilities = ec->ec_capabilities;
   1405  1.193   msaitoh 		eccr->eccr_capenable = ec->ec_capenable;
   1406  1.193   msaitoh 		return 0;
   1407   1.66   thorpej 	case SIOCADDMULTI:
   1408  1.169    dyoung 		return ether_addmulti(ifreq_getaddr(cmd, ifr), ec);
   1409   1.66   thorpej 	case SIOCDELMULTI:
   1410  1.169    dyoung 		return ether_delmulti(ifreq_getaddr(cmd, ifr), ec);
   1411  1.160    dyoung 	case SIOCSIFMEDIA:
   1412  1.160    dyoung 	case SIOCGIFMEDIA:
   1413  1.160    dyoung 		if (ec->ec_mii == NULL)
   1414  1.169    dyoung 			return ENOTTY;
   1415  1.169    dyoung 		return ifmedia_ioctl(ifp, ifr, &ec->ec_mii->mii_media, cmd);
   1416  1.170    dyoung 	case SIOCALIFADDR:
   1417  1.170    dyoung 		sdl = satocsdl(sstocsa(&iflr->addr));
   1418  1.170    dyoung 		if (sdl->sdl_family != AF_LINK)
   1419  1.170    dyoung 			;
   1420  1.170    dyoung 		else if (ETHER_IS_MULTICAST(CLLADDR(sdl)))
   1421  1.170    dyoung 			return EINVAL;
   1422  1.170    dyoung 		else if (memcmp(zero, CLLADDR(sdl), sizeof(zero)) == 0)
   1423  1.170    dyoung 			return EINVAL;
   1424  1.170    dyoung 		/*FALLTHROUGH*/
   1425  1.170    dyoung 	default:
   1426  1.161    dyoung 		return ifioctl_common(ifp, cmd, data);
   1427   1.66   thorpej 	}
   1428  1.169    dyoung 	return 0;
   1429    1.3   hpeyerl }
   1430  1.200     joerg 
   1431  1.215  christos /*
   1432  1.215  christos  * Enable/disable passing VLAN packets if the parent interface supports it.
   1433  1.215  christos  * Return:
   1434  1.215  christos  * 	 0: Ok
   1435  1.215  christos  *	-1: Parent interface does not support vlans
   1436  1.215  christos  *	>0: Error
   1437  1.215  christos  */
   1438  1.215  christos int
   1439  1.215  christos ether_enable_vlan_mtu(struct ifnet *ifp)
   1440  1.215  christos {
   1441  1.215  christos 	int error;
   1442  1.215  christos 	struct ethercom *ec = (void *)ifp;
   1443  1.215  christos 
   1444  1.215  christos 	/* Already have VLAN's do nothing. */
   1445  1.215  christos 	if (ec->ec_nvlans != 0)
   1446  1.215  christos 		return 0;
   1447  1.215  christos 
   1448  1.215  christos 	/* Parent does not support VLAN's */
   1449  1.215  christos 	if ((ec->ec_capabilities & ETHERCAP_VLAN_MTU) == 0)
   1450  1.215  christos 		return -1;
   1451  1.215  christos 
   1452  1.215  christos 	/*
   1453  1.215  christos 	 * Parent supports the VLAN_MTU capability,
   1454  1.215  christos 	 * i.e. can Tx/Rx larger than ETHER_MAX_LEN frames;
   1455  1.215  christos 	 * enable it.
   1456  1.215  christos 	 */
   1457  1.215  christos 	ec->ec_capenable |= ETHERCAP_VLAN_MTU;
   1458  1.215  christos 
   1459  1.215  christos 	/* Interface is down, defer for later */
   1460  1.215  christos 	if ((ifp->if_flags & IFF_UP) == 0)
   1461  1.215  christos 		return 0;
   1462  1.215  christos 
   1463  1.215  christos 	if ((error = if_flags_set(ifp, ifp->if_flags)) == 0)
   1464  1.215  christos 		return 0;
   1465  1.215  christos 
   1466  1.215  christos 	ec->ec_capenable &= ~ETHERCAP_VLAN_MTU;
   1467  1.215  christos 	return error;
   1468  1.215  christos }
   1469  1.215  christos 
   1470  1.215  christos int
   1471  1.215  christos ether_disable_vlan_mtu(struct ifnet *ifp)
   1472  1.215  christos {
   1473  1.215  christos 	int error;
   1474  1.215  christos 	struct ethercom *ec = (void *)ifp;
   1475  1.215  christos 
   1476  1.215  christos 	/* We still have VLAN's, defer for later */
   1477  1.215  christos 	if (ec->ec_nvlans != 0)
   1478  1.215  christos 		return 0;
   1479  1.215  christos 
   1480  1.215  christos 	/* Parent does not support VLAB's, nothing to do. */
   1481  1.215  christos 	if ((ec->ec_capenable & ETHERCAP_VLAN_MTU) == 0)
   1482  1.215  christos 		return -1;
   1483  1.215  christos 
   1484  1.215  christos 	/*
   1485  1.215  christos 	 * Disable Tx/Rx of VLAN-sized frames.
   1486  1.215  christos 	 */
   1487  1.215  christos 	ec->ec_capenable &= ~ETHERCAP_VLAN_MTU;
   1488  1.215  christos 
   1489  1.215  christos 	/* Interface is down, defer for later */
   1490  1.215  christos 	if ((ifp->if_flags & IFF_UP) == 0)
   1491  1.215  christos 		return 0;
   1492  1.215  christos 
   1493  1.215  christos 	if ((error = if_flags_set(ifp, ifp->if_flags)) == 0)
   1494  1.215  christos 		return 0;
   1495  1.215  christos 
   1496  1.215  christos 	ec->ec_capenable |= ETHERCAP_VLAN_MTU;
   1497  1.215  christos 	return error;
   1498  1.215  christos }
   1499  1.215  christos 
   1500  1.200     joerg static int
   1501  1.200     joerg ether_multicast_sysctl(SYSCTLFN_ARGS)
   1502  1.200     joerg {
   1503  1.200     joerg 	struct ether_multi *enm;
   1504  1.200     joerg 	struct ether_multi_sysctl addr;
   1505  1.200     joerg 	struct ifnet *ifp;
   1506  1.200     joerg 	struct ethercom *ec;
   1507  1.223     ozaki 	int error = 0;
   1508  1.200     joerg 	size_t written;
   1509  1.223     ozaki 	struct psref psref;
   1510  1.223     ozaki 	int bound;
   1511  1.200     joerg 
   1512  1.200     joerg 	if (namelen != 1)
   1513  1.200     joerg 		return EINVAL;
   1514  1.200     joerg 
   1515  1.223     ozaki 	bound = curlwp_bind();
   1516  1.223     ozaki 	ifp = if_get_byindex(name[0], &psref);
   1517  1.223     ozaki 	if (ifp == NULL) {
   1518  1.223     ozaki 		error = ENODEV;
   1519  1.223     ozaki 		goto out;
   1520  1.223     ozaki 	}
   1521  1.200     joerg 	if (ifp->if_type != IFT_ETHER) {
   1522  1.223     ozaki 		if_put(ifp, &psref);
   1523  1.200     joerg 		*oldlenp = 0;
   1524  1.223     ozaki 		goto out;
   1525  1.200     joerg 	}
   1526  1.200     joerg 	ec = (struct ethercom *)ifp;
   1527  1.200     joerg 
   1528  1.200     joerg 	if (oldp == NULL) {
   1529  1.223     ozaki 		if_put(ifp, &psref);
   1530  1.200     joerg 		*oldlenp = ec->ec_multicnt * sizeof(addr);
   1531  1.223     ozaki 		goto out;
   1532  1.200     joerg 	}
   1533  1.200     joerg 
   1534  1.200     joerg 	memset(&addr, 0, sizeof(addr));
   1535  1.200     joerg 	error = 0;
   1536  1.200     joerg 	written = 0;
   1537  1.200     joerg 
   1538  1.200     joerg 	LIST_FOREACH(enm, &ec->ec_multiaddrs, enm_list) {
   1539  1.200     joerg 		if (written + sizeof(addr) > *oldlenp)
   1540  1.200     joerg 			break;
   1541  1.200     joerg 		addr.enm_refcount = enm->enm_refcount;
   1542  1.200     joerg 		memcpy(addr.enm_addrlo, enm->enm_addrlo, ETHER_ADDR_LEN);
   1543  1.200     joerg 		memcpy(addr.enm_addrhi, enm->enm_addrhi, ETHER_ADDR_LEN);
   1544  1.200     joerg 		error = sysctl_copyout(l, &addr, oldp, sizeof(addr));
   1545  1.200     joerg 		if (error)
   1546  1.200     joerg 			break;
   1547  1.200     joerg 		written += sizeof(addr);
   1548  1.200     joerg 		oldp = (char *)oldp + sizeof(addr);
   1549  1.200     joerg 	}
   1550  1.223     ozaki 	if_put(ifp, &psref);
   1551  1.200     joerg 
   1552  1.200     joerg 	*oldlenp = written;
   1553  1.223     ozaki out:
   1554  1.223     ozaki 	curlwp_bindx(bound);
   1555  1.200     joerg 	return error;
   1556  1.200     joerg }
   1557  1.200     joerg 
   1558  1.200     joerg SYSCTL_SETUP(sysctl_net_ether_setup, "sysctl net.ether subtree setup")
   1559  1.200     joerg {
   1560  1.200     joerg 	const struct sysctlnode *rnode = NULL;
   1561  1.200     joerg 
   1562  1.200     joerg 	sysctl_createv(clog, 0, NULL, &rnode,
   1563  1.200     joerg 		       CTLFLAG_PERMANENT,
   1564  1.200     joerg 		       CTLTYPE_NODE, "ether",
   1565  1.200     joerg 		       SYSCTL_DESCR("Ethernet-specific information"),
   1566  1.200     joerg 		       NULL, 0, NULL, 0,
   1567  1.200     joerg 		       CTL_NET, CTL_CREATE, CTL_EOL);
   1568  1.200     joerg 
   1569  1.200     joerg 	sysctl_createv(clog, 0, &rnode, NULL,
   1570  1.200     joerg 		       CTLFLAG_PERMANENT,
   1571  1.200     joerg 		       CTLTYPE_NODE, "multicast",
   1572  1.200     joerg 		       SYSCTL_DESCR("multicast addresses"),
   1573  1.200     joerg 		       ether_multicast_sysctl, 0, NULL, 0,
   1574  1.200     joerg 		       CTL_CREATE, CTL_EOL);
   1575  1.200     joerg }
   1576  1.203     ozaki 
   1577  1.203     ozaki void
   1578  1.203     ozaki etherinit(void)
   1579  1.203     ozaki {
   1580  1.203     ozaki 	mutex_init(&bigpktpps_lock, MUTEX_DEFAULT, IPL_NET);
   1581  1.203     ozaki }
   1582