xref: /freebsd/sys/net/if_ethersubr.c (revision 3c3aa8c170d199089d7b980209069f2e481eb30a)
1c398230bSWarner Losh /*-
251369649SPedro F. Giffuni  * SPDX-License-Identifier: BSD-3-Clause
351369649SPedro F. Giffuni  *
4df8bae1dSRodney W. Grimes  * Copyright (c) 1982, 1989, 1993
5df8bae1dSRodney W. Grimes  *	The Regents of the University of California.  All rights reserved.
6df8bae1dSRodney W. Grimes  *
7df8bae1dSRodney W. Grimes  * Redistribution and use in source and binary forms, with or without
8df8bae1dSRodney W. Grimes  * modification, are permitted provided that the following conditions
9df8bae1dSRodney W. Grimes  * are met:
10df8bae1dSRodney W. Grimes  * 1. Redistributions of source code must retain the above copyright
11df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer.
12df8bae1dSRodney W. Grimes  * 2. Redistributions in binary form must reproduce the above copyright
13df8bae1dSRodney W. Grimes  *    notice, this list of conditions and the following disclaimer in the
14df8bae1dSRodney W. Grimes  *    documentation and/or other materials provided with the distribution.
15fbbd9655SWarner Losh  * 3. Neither the name of the University nor the names of its contributors
16df8bae1dSRodney W. Grimes  *    may be used to endorse or promote products derived from this software
17df8bae1dSRodney W. Grimes  *    without specific prior written permission.
18df8bae1dSRodney W. Grimes  *
19df8bae1dSRodney W. Grimes  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
20df8bae1dSRodney W. Grimes  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21df8bae1dSRodney W. Grimes  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22df8bae1dSRodney W. Grimes  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
23df8bae1dSRodney W. Grimes  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24df8bae1dSRodney W. Grimes  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25df8bae1dSRodney W. Grimes  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26df8bae1dSRodney W. Grimes  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27df8bae1dSRodney W. Grimes  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28df8bae1dSRodney W. Grimes  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29df8bae1dSRodney W. Grimes  * SUCH DAMAGE.
30df8bae1dSRodney W. Grimes  *
31df8bae1dSRodney W. Grimes  *	@(#)if_ethersubr.c	8.1 (Berkeley) 6/10/93
32c3aac50fSPeter Wemm  * $FreeBSD$
33df8bae1dSRodney W. Grimes  */
34df8bae1dSRodney W. Grimes 
351d5e9e22SEivind Eklund #include "opt_inet.h"
36cfa1ca9dSYoshinobu Inoue #include "opt_inet6.h"
374cf49a43SJulian Elischer #include "opt_netgraph.h"
386eeac1d9SJulian Elischer #include "opt_mbuf_profiling.h"
397527624eSRobert Watson #include "opt_rss.h"
40430df5f4SEivind Eklund 
41df8bae1dSRodney W. Grimes #include <sys/param.h>
42df8bae1dSRodney W. Grimes #include <sys/systm.h>
438819ad85SSepherosa Ziehau #include <sys/bus.h>
448819ad85SSepherosa Ziehau #include <sys/eventhandler.h>
45*3c3aa8c1SKyle Evans #include <sys/jail.h>
46df8bae1dSRodney W. Grimes #include <sys/kernel.h>
47385195c0SMarko Zec #include <sys/lock.h>
48df8bae1dSRodney W. Grimes #include <sys/malloc.h>
4941ee9f1cSPoul-Henning Kamp #include <sys/module.h>
50df8bae1dSRodney W. Grimes #include <sys/mbuf.h>
51*3c3aa8c1SKyle Evans #include <sys/proc.h>
52f1379734SKonstantin Belousov #include <sys/priv.h>
5310b1fde0SMark Murray #include <sys/random.h>
54df8bae1dSRodney W. Grimes #include <sys/socket.h>
5551a53488SBruce Evans #include <sys/sockio.h>
56602d513cSGarrett Wollman #include <sys/sysctl.h>
57ef1f9169SMarcel Moolenaar #include <sys/uuid.h>
58df8bae1dSRodney W. Grimes 
59*3c3aa8c1SKyle Evans #include <net/ieee_oui.h>
60df8bae1dSRodney W. Grimes #include <net/if.h>
6176039bc8SGleb Smirnoff #include <net/if_var.h>
62d7647d96SDag-Erling Smørgrav #include <net/if_arp.h>
63df8bae1dSRodney W. Grimes #include <net/netisr.h>
64df8bae1dSRodney W. Grimes #include <net/route.h>
65df8bae1dSRodney W. Grimes #include <net/if_llc.h>
66df8bae1dSRodney W. Grimes #include <net/if_dl.h>
67df8bae1dSRodney W. Grimes #include <net/if_types.h>
682e2de7f2SArchie Cobbs #include <net/bpf.h>
69e1e1452dSArchie Cobbs #include <net/ethernet.h>
70fd6238a6SAndrew Thompson #include <net/if_bridgevar.h>
71c1d93b05SSam Leffler #include <net/if_vlan_var.h>
726e6b3f7cSQing Li #include <net/if_llatbl.h>
737d4317bdSAlexander V. Chernikov #include <net/pfil.h>
74b2bdc62aSAdrian Chadd #include <net/rss_config.h>
754b79449eSBjoern A. Zeeb #include <net/vnet.h>
76df8bae1dSRodney W. Grimes 
7775bf2db3SGleb Smirnoff #include <netpfil/pf/pf_mtag.h>
7875bf2db3SGleb Smirnoff 
7982cd038dSYoshinobu Inoue #if defined(INET) || defined(INET6)
80df8bae1dSRodney W. Grimes #include <netinet/in.h>
81df8bae1dSRodney W. Grimes #include <netinet/in_var.h>
82df8bae1dSRodney W. Grimes #include <netinet/if_ether.h>
8354bfbd51SWill Andrews #include <netinet/ip_carp.h>
840bcfa8e4SLuigi Rizzo #include <netinet/ip_var.h>
851d5e9e22SEivind Eklund #endif
8682cd038dSYoshinobu Inoue #ifdef INET6
8782cd038dSYoshinobu Inoue #include <netinet6/nd6.h>
8882cd038dSYoshinobu Inoue #endif
89aed55708SRobert Watson #include <security/mac/mac_framework.h>
90aed55708SRobert Watson 
91*3c3aa8c1SKyle Evans #include <crypto/sha1.h>
92*3c3aa8c1SKyle Evans 
93d54d93acSEd Maste #ifdef CTASSERT
94d54d93acSEd Maste CTASSERT(sizeof (struct ether_header) == ETHER_ADDR_LEN * 2 + 2);
95d54d93acSEd Maste CTASSERT(sizeof (struct ether_addr) == ETHER_ADDR_LEN);
96d54d93acSEd Maste #endif
97d54d93acSEd Maste 
98b252313fSGleb Smirnoff VNET_DEFINE(pfil_head_t, link_pfil_head);	/* Packet filter hooks */
997d4317bdSAlexander V. Chernikov 
100e1e1452dSArchie Cobbs /* netgraph node hooks for ng_ether(4) */
101c1d93b05SSam Leffler void	(*ng_ether_input_p)(struct ifnet *ifp, struct mbuf **mp);
102c1d93b05SSam Leffler void	(*ng_ether_input_orphan_p)(struct ifnet *ifp, struct mbuf *m);
103e1e1452dSArchie Cobbs int	(*ng_ether_output_p)(struct ifnet *ifp, struct mbuf **mp);
104e1e1452dSArchie Cobbs void	(*ng_ether_attach_p)(struct ifnet *ifp);
105e1e1452dSArchie Cobbs void	(*ng_ether_detach_p)(struct ifnet *ifp);
106e1e1452dSArchie Cobbs 
107824eb9dcSDavid E. O'Brien void	(*vlan_input_p)(struct ifnet *, struct mbuf *);
1089d4fe4b2SBrooks Davis 
109fd6238a6SAndrew Thompson /* if_bridge(4) support */
110c8b01292SAndrew Thompson void	(*bridge_dn_p)(struct mbuf *, struct ifnet *);
1118f867517SAndrew Thompson 
11218242d3bSAndrew Thompson /* if_lagg(4) support */
11318242d3bSAndrew Thompson struct mbuf *(*lagg_input_p)(struct ifnet *, struct mbuf *);
114b47888ceSAndrew Thompson 
115e589108dSRobert Watson static const u_char etherbroadcastaddr[ETHER_ADDR_LEN] =
116868d8b62SMatthew N. Dodd 			{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
117868d8b62SMatthew N. Dodd 
118929ddbbbSAlfred Perlstein static	int ether_resolvemulti(struct ifnet *, struct sockaddr **,
119929ddbbbSAlfred Perlstein 		struct sockaddr *);
120d3c351c5SMarko Zec #ifdef VIMAGE
121d3c351c5SMarko Zec static	void ether_reassign(struct ifnet *, struct vnet *, char *);
122d3c351c5SMarko Zec #endif
1234fb3a820SAlexander V. Chernikov static	int ether_requestencap(struct ifnet *, struct if_encap_req *);
124868d8b62SMatthew N. Dodd 
12569462a82SBruce M Simpson 
1264c8e8c05SJulian Elischer #define senderr(e) do { error = (e); goto bad;} while (0)
127df8bae1dSRodney W. Grimes 
12822f8ce43SAlexander V. Chernikov static void
12922f8ce43SAlexander V. Chernikov update_mbuf_csumflags(struct mbuf *src, struct mbuf *dst)
13022f8ce43SAlexander V. Chernikov {
13122f8ce43SAlexander V. Chernikov 	int csum_flags = 0;
13222f8ce43SAlexander V. Chernikov 
13322f8ce43SAlexander V. Chernikov 	if (src->m_pkthdr.csum_flags & CSUM_IP)
13422f8ce43SAlexander V. Chernikov 		csum_flags |= (CSUM_IP_CHECKED|CSUM_IP_VALID);
13522f8ce43SAlexander V. Chernikov 	if (src->m_pkthdr.csum_flags & CSUM_DELAY_DATA)
13622f8ce43SAlexander V. Chernikov 		csum_flags |= (CSUM_DATA_VALID|CSUM_PSEUDO_HDR);
13722f8ce43SAlexander V. Chernikov 	if (src->m_pkthdr.csum_flags & CSUM_SCTP)
13822f8ce43SAlexander V. Chernikov 		csum_flags |= CSUM_SCTP_VALID;
13922f8ce43SAlexander V. Chernikov 	dst->m_pkthdr.csum_flags |= csum_flags;
14022f8ce43SAlexander V. Chernikov 	if (csum_flags & CSUM_DATA_VALID)
14122f8ce43SAlexander V. Chernikov 		dst->m_pkthdr.csum_data = 0xffff;
14222f8ce43SAlexander V. Chernikov }
14322f8ce43SAlexander V. Chernikov 
144df8bae1dSRodney W. Grimes /*
1454fb3a820SAlexander V. Chernikov  * Handle link-layer encapsulation requests.
1464fb3a820SAlexander V. Chernikov  */
1474fb3a820SAlexander V. Chernikov static int
1484fb3a820SAlexander V. Chernikov ether_requestencap(struct ifnet *ifp, struct if_encap_req *req)
1494fb3a820SAlexander V. Chernikov {
1504fb3a820SAlexander V. Chernikov 	struct ether_header *eh;
1514fb3a820SAlexander V. Chernikov 	struct arphdr *ah;
1524fb3a820SAlexander V. Chernikov 	uint16_t etype;
1534fb3a820SAlexander V. Chernikov 	const u_char *lladdr;
1544fb3a820SAlexander V. Chernikov 
1554fb3a820SAlexander V. Chernikov 	if (req->rtype != IFENCAP_LL)
1564fb3a820SAlexander V. Chernikov 		return (EOPNOTSUPP);
1574fb3a820SAlexander V. Chernikov 
1584fb3a820SAlexander V. Chernikov 	if (req->bufsize < ETHER_HDR_LEN)
1594fb3a820SAlexander V. Chernikov 		return (ENOMEM);
1604fb3a820SAlexander V. Chernikov 
1614fb3a820SAlexander V. Chernikov 	eh = (struct ether_header *)req->buf;
1624fb3a820SAlexander V. Chernikov 	lladdr = req->lladdr;
1634fb3a820SAlexander V. Chernikov 	req->lladdr_off = 0;
1644fb3a820SAlexander V. Chernikov 
1654fb3a820SAlexander V. Chernikov 	switch (req->family) {
1664fb3a820SAlexander V. Chernikov 	case AF_INET:
1674fb3a820SAlexander V. Chernikov 		etype = htons(ETHERTYPE_IP);
1684fb3a820SAlexander V. Chernikov 		break;
1694fb3a820SAlexander V. Chernikov 	case AF_INET6:
1704fb3a820SAlexander V. Chernikov 		etype = htons(ETHERTYPE_IPV6);
1714fb3a820SAlexander V. Chernikov 		break;
1724fb3a820SAlexander V. Chernikov 	case AF_ARP:
1734fb3a820SAlexander V. Chernikov 		ah = (struct arphdr *)req->hdata;
1744fb3a820SAlexander V. Chernikov 		ah->ar_hrd = htons(ARPHRD_ETHER);
1754fb3a820SAlexander V. Chernikov 
1764fb3a820SAlexander V. Chernikov 		switch(ntohs(ah->ar_op)) {
1774fb3a820SAlexander V. Chernikov 		case ARPOP_REVREQUEST:
1784fb3a820SAlexander V. Chernikov 		case ARPOP_REVREPLY:
1794fb3a820SAlexander V. Chernikov 			etype = htons(ETHERTYPE_REVARP);
1804fb3a820SAlexander V. Chernikov 			break;
1814fb3a820SAlexander V. Chernikov 		case ARPOP_REQUEST:
1824fb3a820SAlexander V. Chernikov 		case ARPOP_REPLY:
1834fb3a820SAlexander V. Chernikov 		default:
1844fb3a820SAlexander V. Chernikov 			etype = htons(ETHERTYPE_ARP);
1854fb3a820SAlexander V. Chernikov 			break;
1864fb3a820SAlexander V. Chernikov 		}
1874fb3a820SAlexander V. Chernikov 
1884fb3a820SAlexander V. Chernikov 		if (req->flags & IFENCAP_FLAG_BROADCAST)
1894fb3a820SAlexander V. Chernikov 			lladdr = ifp->if_broadcastaddr;
1904fb3a820SAlexander V. Chernikov 		break;
1914fb3a820SAlexander V. Chernikov 	default:
1924fb3a820SAlexander V. Chernikov 		return (EAFNOSUPPORT);
1934fb3a820SAlexander V. Chernikov 	}
1944fb3a820SAlexander V. Chernikov 
1954fb3a820SAlexander V. Chernikov 	memcpy(&eh->ether_type, &etype, sizeof(eh->ether_type));
1964fb3a820SAlexander V. Chernikov 	memcpy(eh->ether_dhost, lladdr, ETHER_ADDR_LEN);
1974fb3a820SAlexander V. Chernikov 	memcpy(eh->ether_shost, IF_LLADDR(ifp), ETHER_ADDR_LEN);
1984fb3a820SAlexander V. Chernikov 	req->bufsize = sizeof(struct ether_header);
1994fb3a820SAlexander V. Chernikov 
2004fb3a820SAlexander V. Chernikov 	return (0);
2014fb3a820SAlexander V. Chernikov }
2024fb3a820SAlexander V. Chernikov 
2034fb3a820SAlexander V. Chernikov 
2044fb3a820SAlexander V. Chernikov static int
2054fb3a820SAlexander V. Chernikov ether_resolve_addr(struct ifnet *ifp, struct mbuf *m,
2064fb3a820SAlexander V. Chernikov 	const struct sockaddr *dst, struct route *ro, u_char *phdr,
2076d768226SGeorge V. Neville-Neil 	uint32_t *pflags, struct llentry **plle)
2084fb3a820SAlexander V. Chernikov {
2094fb3a820SAlexander V. Chernikov 	struct ether_header *eh;
2104fb3a820SAlexander V. Chernikov 	uint32_t lleflags = 0;
2114fb3a820SAlexander V. Chernikov 	int error = 0;
2124fb3a820SAlexander V. Chernikov #if defined(INET) || defined(INET6)
2134fb3a820SAlexander V. Chernikov 	uint16_t etype;
2144fb3a820SAlexander V. Chernikov #endif
2154fb3a820SAlexander V. Chernikov 
2166d768226SGeorge V. Neville-Neil 	if (plle)
2176d768226SGeorge V. Neville-Neil 		*plle = NULL;
2184fb3a820SAlexander V. Chernikov 	eh = (struct ether_header *)phdr;
2194fb3a820SAlexander V. Chernikov 
2204fb3a820SAlexander V. Chernikov 	switch (dst->sa_family) {
2214fb3a820SAlexander V. Chernikov #ifdef INET
2224fb3a820SAlexander V. Chernikov 	case AF_INET:
2234fb3a820SAlexander V. Chernikov 		if ((m->m_flags & (M_BCAST | M_MCAST)) == 0)
2246d768226SGeorge V. Neville-Neil 			error = arpresolve(ifp, 0, m, dst, phdr, &lleflags,
2256d768226SGeorge V. Neville-Neil 			    plle);
2264fb3a820SAlexander V. Chernikov 		else {
2274fb3a820SAlexander V. Chernikov 			if (m->m_flags & M_BCAST)
2284fb3a820SAlexander V. Chernikov 				memcpy(eh->ether_dhost, ifp->if_broadcastaddr,
2294fb3a820SAlexander V. Chernikov 				    ETHER_ADDR_LEN);
2304fb3a820SAlexander V. Chernikov 			else {
2314fb3a820SAlexander V. Chernikov 				const struct in_addr *a;
2324fb3a820SAlexander V. Chernikov 				a = &(((const struct sockaddr_in *)dst)->sin_addr);
2334fb3a820SAlexander V. Chernikov 				ETHER_MAP_IP_MULTICAST(a, eh->ether_dhost);
2344fb3a820SAlexander V. Chernikov 			}
2354fb3a820SAlexander V. Chernikov 			etype = htons(ETHERTYPE_IP);
2364fb3a820SAlexander V. Chernikov 			memcpy(&eh->ether_type, &etype, sizeof(etype));
2374fb3a820SAlexander V. Chernikov 			memcpy(eh->ether_shost, IF_LLADDR(ifp), ETHER_ADDR_LEN);
2384fb3a820SAlexander V. Chernikov 		}
2394fb3a820SAlexander V. Chernikov 		break;
2404fb3a820SAlexander V. Chernikov #endif
2414fb3a820SAlexander V. Chernikov #ifdef INET6
2424fb3a820SAlexander V. Chernikov 	case AF_INET6:
2434fb3a820SAlexander V. Chernikov 		if ((m->m_flags & M_MCAST) == 0)
2446d768226SGeorge V. Neville-Neil 			error = nd6_resolve(ifp, 0, m, dst, phdr, &lleflags,
2456d768226SGeorge V. Neville-Neil 			    plle);
2464fb3a820SAlexander V. Chernikov 		else {
2474fb3a820SAlexander V. Chernikov 			const struct in6_addr *a6;
2484fb3a820SAlexander V. Chernikov 			a6 = &(((const struct sockaddr_in6 *)dst)->sin6_addr);
2494fb3a820SAlexander V. Chernikov 			ETHER_MAP_IPV6_MULTICAST(a6, eh->ether_dhost);
2504fb3a820SAlexander V. Chernikov 			etype = htons(ETHERTYPE_IPV6);
2514fb3a820SAlexander V. Chernikov 			memcpy(&eh->ether_type, &etype, sizeof(etype));
2524fb3a820SAlexander V. Chernikov 			memcpy(eh->ether_shost, IF_LLADDR(ifp), ETHER_ADDR_LEN);
2534fb3a820SAlexander V. Chernikov 		}
2544fb3a820SAlexander V. Chernikov 		break;
2554fb3a820SAlexander V. Chernikov #endif
2564fb3a820SAlexander V. Chernikov 	default:
2574fb3a820SAlexander V. Chernikov 		if_printf(ifp, "can't handle af%d\n", dst->sa_family);
2584fb3a820SAlexander V. Chernikov 		if (m != NULL)
2594fb3a820SAlexander V. Chernikov 			m_freem(m);
2604fb3a820SAlexander V. Chernikov 		return (EAFNOSUPPORT);
2614fb3a820SAlexander V. Chernikov 	}
2624fb3a820SAlexander V. Chernikov 
2634fb3a820SAlexander V. Chernikov 	if (error == EHOSTDOWN) {
26436402a68SAlexander V. Chernikov 		if (ro != NULL && (ro->ro_flags & RT_HAS_GW) != 0)
2654fb3a820SAlexander V. Chernikov 			error = EHOSTUNREACH;
2664fb3a820SAlexander V. Chernikov 	}
2674fb3a820SAlexander V. Chernikov 
2684fb3a820SAlexander V. Chernikov 	if (error != 0)
2694fb3a820SAlexander V. Chernikov 		return (error);
2704fb3a820SAlexander V. Chernikov 
2714fb3a820SAlexander V. Chernikov 	*pflags = RT_MAY_LOOP;
2724fb3a820SAlexander V. Chernikov 	if (lleflags & LLE_IFADDR)
2734fb3a820SAlexander V. Chernikov 		*pflags |= RT_L2_ME;
2744fb3a820SAlexander V. Chernikov 
2754fb3a820SAlexander V. Chernikov 	return (0);
2764fb3a820SAlexander V. Chernikov }
2774fb3a820SAlexander V. Chernikov 
2784fb3a820SAlexander V. Chernikov /*
279df8bae1dSRodney W. Grimes  * Ethernet output routine.
280df8bae1dSRodney W. Grimes  * Encapsulate a packet of type family for the local net.
281df8bae1dSRodney W. Grimes  * Use trailer local net encapsulation if enough data in first
282df8bae1dSRodney W. Grimes  * packet leaves a multiple of 512 bytes of data in remainder.
283df8bae1dSRodney W. Grimes  */
284df8bae1dSRodney W. Grimes int
28572fd1b6aSDag-Erling Smørgrav ether_output(struct ifnet *ifp, struct mbuf *m,
28647e8d432SGleb Smirnoff 	const struct sockaddr *dst, struct route *ro)
287df8bae1dSRodney W. Grimes {
2884fb3a820SAlexander V. Chernikov 	int error = 0;
2894fb3a820SAlexander V. Chernikov 	char linkhdr[ETHER_HDR_LEN], *phdr;
290098a8c3bSMatthew N. Dodd 	struct ether_header *eh;
29160ee3847SMax Laier 	struct pf_mtag *t;
292c54c76ccSOleg Bulyzhin 	int loop_copy = 1;
293d32864c3SRobert Watson 	int hlen;	/* link layer header length */
2944fb3a820SAlexander V. Chernikov 	uint32_t pflags;
2956d768226SGeorge V. Neville-Neil 	struct llentry *lle = NULL;
2966d768226SGeorge V. Neville-Neil 	int addref = 0;
297df8bae1dSRodney W. Grimes 
2984fb3a820SAlexander V. Chernikov 	phdr = NULL;
2994fb3a820SAlexander V. Chernikov 	pflags = 0;
300279aa3d4SKip Macy 	if (ro != NULL) {
3016d768226SGeorge V. Neville-Neil 		/* XXX BPF uses ro_prepend */
3026d768226SGeorge V. Neville-Neil 		if (ro->ro_prepend != NULL) {
3034fb3a820SAlexander V. Chernikov 			phdr = ro->ro_prepend;
3044fb3a820SAlexander V. Chernikov 			hlen = ro->ro_plen;
3056d768226SGeorge V. Neville-Neil 		} else if (!(m->m_flags & (M_BCAST | M_MCAST))) {
3066d768226SGeorge V. Neville-Neil 			if ((ro->ro_flags & RT_LLE_CACHE) != 0) {
3076d768226SGeorge V. Neville-Neil 				lle = ro->ro_lle;
3086d768226SGeorge V. Neville-Neil 				if (lle != NULL &&
3096d768226SGeorge V. Neville-Neil 				    (lle->la_flags & LLE_VALID) == 0) {
3106d768226SGeorge V. Neville-Neil 					LLE_FREE(lle);
3116d768226SGeorge V. Neville-Neil 					lle = NULL;	/* redundant */
3126d768226SGeorge V. Neville-Neil 					ro->ro_lle = NULL;
313279aa3d4SKip Macy 				}
3146d768226SGeorge V. Neville-Neil 				if (lle == NULL) {
3156d768226SGeorge V. Neville-Neil 					/* if we lookup, keep cache */
3166d768226SGeorge V. Neville-Neil 					addref = 1;
3171435dcd9SAlexander V. Chernikov 				} else
3181435dcd9SAlexander V. Chernikov 					/*
3191435dcd9SAlexander V. Chernikov 					 * Notify LLE code that
3201435dcd9SAlexander V. Chernikov 					 * the entry was used
3211435dcd9SAlexander V. Chernikov 					 * by datapath.
3221435dcd9SAlexander V. Chernikov 					 */
3231435dcd9SAlexander V. Chernikov 					llentry_mark_used(lle);
3246d768226SGeorge V. Neville-Neil 			}
3256d768226SGeorge V. Neville-Neil 			if (lle != NULL) {
3266d768226SGeorge V. Neville-Neil 				phdr = lle->r_linkdata;
3276d768226SGeorge V. Neville-Neil 				hlen = lle->r_hdrlen;
3286d768226SGeorge V. Neville-Neil 				pflags = lle->r_flags;
3296d768226SGeorge V. Neville-Neil 			}
3306d768226SGeorge V. Neville-Neil 		}
3316d768226SGeorge V. Neville-Neil 	}
3326d768226SGeorge V. Neville-Neil 
33343b29369SRobert Watson #ifdef MAC
33430d239bcSRobert Watson 	error = mac_ifnet_check_transmit(ifp, m);
33543b29369SRobert Watson 	if (error)
33643b29369SRobert Watson 		senderr(error);
33743b29369SRobert Watson #endif
33843b29369SRobert Watson 
3396eeac1d9SJulian Elischer 	M_PROFILE(m);
340afbe3a0fSPoul-Henning Kamp 	if (ifp->if_flags & IFF_MONITOR)
341afbe3a0fSPoul-Henning Kamp 		senderr(ENETDOWN);
34213f4c340SRobert Watson 	if (!((ifp->if_flags & IFF_UP) &&
34313f4c340SRobert Watson 	    (ifp->if_drv_flags & IFF_DRV_RUNNING)))
344df8bae1dSRodney W. Grimes 		senderr(ENETDOWN);
3457f760c48SMatthew N. Dodd 
3464fb3a820SAlexander V. Chernikov 	if (phdr == NULL) {
3474fb3a820SAlexander V. Chernikov 		/* No prepend data supplied. Try to calculate ourselves. */
3484fb3a820SAlexander V. Chernikov 		phdr = linkhdr;
34984dd0fd0SJulian Elischer 		hlen = ETHER_HDR_LEN;
3506d768226SGeorge V. Neville-Neil 		error = ether_resolve_addr(ifp, m, dst, ro, phdr, &pflags,
3516d768226SGeorge V. Neville-Neil 		    addref ? &lle : NULL);
3526d768226SGeorge V. Neville-Neil 		if (addref && lle != NULL)
3536d768226SGeorge V. Neville-Neil 			ro->ro_lle = lle;
3544fb3a820SAlexander V. Chernikov 		if (error != 0)
355cd46a114SLuigi Rizzo 			return (error == EWOULDBLOCK ? 0 : error);
35643a6c75aSMatthew N. Dodd 	}
35743a6c75aSMatthew N. Dodd 
3584fb3a820SAlexander V. Chernikov 	if ((pflags & RT_L2_ME) != 0) {
35922f8ce43SAlexander V. Chernikov 		update_mbuf_csumflags(m, m);
3606e6b3f7cSQing Li 		return (if_simloop(ifp, m, dst->sa_family, 0));
3616e6b3f7cSQing Li 	}
3624fb3a820SAlexander V. Chernikov 	loop_copy = pflags & RT_MAY_LOOP;
3636e6b3f7cSQing Li 
364df8bae1dSRodney W. Grimes 	/*
365df8bae1dSRodney W. Grimes 	 * Add local net header.  If no space in first mbuf,
366df8bae1dSRodney W. Grimes 	 * allocate another.
3676cdb1854SAlexander V. Chernikov 	 *
3686cdb1854SAlexander V. Chernikov 	 * Note that we do prepend regardless of RT_HAS_HEADER flag.
3696cdb1854SAlexander V. Chernikov 	 * This is done because BPF code shifts m_data pointer
3706cdb1854SAlexander V. Chernikov 	 * to the end of ethernet header prior to calling if_output().
371df8bae1dSRodney W. Grimes 	 */
3724fb3a820SAlexander V. Chernikov 	M_PREPEND(m, hlen, M_NOWAIT);
3732166ffe8SRobert Watson 	if (m == NULL)
374df8bae1dSRodney W. Grimes 		senderr(ENOBUFS);
3754fb3a820SAlexander V. Chernikov 	if ((pflags & RT_HAS_HEADER) == 0) {
376df8bae1dSRodney W. Grimes 		eh = mtod(m, struct ether_header *);
3774fb3a820SAlexander V. Chernikov 		memcpy(eh, phdr, hlen);
378c69aeaadSAlexander V. Chernikov 	}
379ed7509acSJulian Elischer 
380ed7509acSJulian Elischer 	/*
381ed7509acSJulian Elischer 	 * If a simplex interface, and the packet is being sent to our
382ed7509acSJulian Elischer 	 * Ethernet address or a broadcast address, loopback a copy.
383ed7509acSJulian Elischer 	 * XXX To make a simplex device behave exactly like a duplex
384ed7509acSJulian Elischer 	 * device, we should copy in the case of sending to our own
385ed7509acSJulian Elischer 	 * ethernet address (thus letting the original actually appear
386ed7509acSJulian Elischer 	 * on the wire). However, we don't do that here for security
387ed7509acSJulian Elischer 	 * reasons and compatibility with the original behavior.
388ed7509acSJulian Elischer 	 */
3894fb3a820SAlexander V. Chernikov 	if ((m->m_flags & M_BCAST) && loop_copy && (ifp->if_flags & IFF_SIMPLEX) &&
39060ee3847SMax Laier 	    ((t = pf_find_mtag(m)) == NULL || !t->routed)) {
39106f684b0SMatthew N. Dodd 		struct mbuf *n;
392ed7509acSJulian Elischer 
393294dd290SLuigi Rizzo 		/*
394294dd290SLuigi Rizzo 		 * Because if_simloop() modifies the packet, we need a
395294dd290SLuigi Rizzo 		 * writable copy through m_dup() instead of a readonly
396294dd290SLuigi Rizzo 		 * one as m_copy[m] would give us. The alternative would
397294dd290SLuigi Rizzo 		 * be to modify if_simloop() to handle the readonly mbuf,
398294dd290SLuigi Rizzo 		 * but performancewise it is mostly equivalent (trading
399294dd290SLuigi Rizzo 		 * extra data copying vs. extra locking).
4009983b3c0SYaroslav Tykhiy 		 *
4019983b3c0SYaroslav Tykhiy 		 * XXX This is a local workaround.  A number of less
4029983b3c0SYaroslav Tykhiy 		 * often used kernel parts suffer from the same bug.
4039983b3c0SYaroslav Tykhiy 		 * See PR kern/105943 for a proposed general solution.
404294dd290SLuigi Rizzo 		 */
405eb1b1807SGleb Smirnoff 		if ((n = m_dup(m, M_NOWAIT)) != NULL) {
40622f8ce43SAlexander V. Chernikov 			update_mbuf_csumflags(m, n);
40706a429a3SArchie Cobbs 			(void)if_simloop(ifp, n, dst->sa_family, hlen);
408c1404dc0SArchie Cobbs 		} else
4093751dddbSGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IQDROPS, 1);
410ed7509acSJulian Elischer 	}
4112e2de7f2SArchie Cobbs 
4123f7d1396SAndrew Thompson        /*
4133f7d1396SAndrew Thompson 	* Bridges require special output handling.
4143f7d1396SAndrew Thompson 	*/
4153f7d1396SAndrew Thompson 	if (ifp->if_bridge) {
4163f7d1396SAndrew Thompson 		BRIDGE_OUTPUT(ifp, m, error);
4173f7d1396SAndrew Thompson 		return (error);
4183f7d1396SAndrew Thompson 	}
4193f7d1396SAndrew Thompson 
420259d2d54SBjoern A. Zeeb #if defined(INET) || defined(INET6)
421a9771948SGleb Smirnoff 	if (ifp->if_carp &&
42208b68b0eSGleb Smirnoff 	    (error = (*carp_output_p)(ifp, m, dst)))
423a9771948SGleb Smirnoff 		goto bad;
424a9771948SGleb Smirnoff #endif
425a9771948SGleb Smirnoff 
426e1e1452dSArchie Cobbs 	/* Handle ng_ether(4) processing, if any */
427833e8dc5SGleb Smirnoff 	if (ifp->if_l2com != NULL) {
428514bcb89SPoul-Henning Kamp 		KASSERT(ng_ether_output_p != NULL,
429514bcb89SPoul-Henning Kamp 		    ("ng_ether_output_p is NULL"));
430e1e1452dSArchie Cobbs 		if ((error = (*ng_ether_output_p)(ifp, &m)) != 0) {
431e1e1452dSArchie Cobbs bad:			if (m != NULL)
432e1e1452dSArchie Cobbs 				m_freem(m);
433e1e1452dSArchie Cobbs 			return (error);
434e1e1452dSArchie Cobbs 		}
435e1e1452dSArchie Cobbs 		if (m == NULL)
436e1e1452dSArchie Cobbs 			return (0);
437e1e1452dSArchie Cobbs 	}
438e1e1452dSArchie Cobbs 
439e1e1452dSArchie Cobbs 	/* Continue with link-layer output */
440e1e1452dSArchie Cobbs 	return ether_output_frame(ifp, m);
441e1e1452dSArchie Cobbs }
442e1e1452dSArchie Cobbs 
443f1379734SKonstantin Belousov static bool
444f1379734SKonstantin Belousov ether_set_pcp(struct mbuf **mp, struct ifnet *ifp, uint8_t pcp)
445f1379734SKonstantin Belousov {
446f1379734SKonstantin Belousov 	struct ether_header *eh;
447f1379734SKonstantin Belousov 
448f1379734SKonstantin Belousov 	eh = mtod(*mp, struct ether_header *);
449f1379734SKonstantin Belousov 	if (ntohs(eh->ether_type) == ETHERTYPE_VLAN ||
450f1379734SKonstantin Belousov 	    ether_8021q_frame(mp, ifp, ifp, 0, pcp))
451f1379734SKonstantin Belousov 		return (true);
452f1379734SKonstantin Belousov 	if_inc_counter(ifp, IFCOUNTER_OERRORS, 1);
453f1379734SKonstantin Belousov 	return (false);
454f1379734SKonstantin Belousov }
455f1379734SKonstantin Belousov 
456e1e1452dSArchie Cobbs /*
457e1e1452dSArchie Cobbs  * Ethernet link layer output routine to send a raw frame to the device.
458e1e1452dSArchie Cobbs  *
459e1e1452dSArchie Cobbs  * This assumes that the 14 byte Ethernet header is present and contiguous
460e1e1452dSArchie Cobbs  * in the first mbuf (if BRIDGE'ing).
461e1e1452dSArchie Cobbs  */
462e1e1452dSArchie Cobbs int
463c1d93b05SSam Leffler ether_output_frame(struct ifnet *ifp, struct mbuf *m)
464e1e1452dSArchie Cobbs {
465f1379734SKonstantin Belousov 	uint8_t pcp;
466f1379734SKonstantin Belousov 
467f1379734SKonstantin Belousov 	pcp = ifp->if_pcp;
46847c39432SNavdeep Parhar 	if (pcp != IFNET_PCP_NONE && ifp->if_type != IFT_L2VLAN &&
46947c39432SNavdeep Parhar 	    !ether_set_pcp(&m, ifp, pcp))
470f1379734SKonstantin Belousov 		return (0);
4712b25acc1SLuigi Rizzo 
472b252313fSGleb Smirnoff 	if (PFIL_HOOKED_OUT(V_link_pfil_head))
473b252313fSGleb Smirnoff 		switch (pfil_run_hooks(V_link_pfil_head, &m, ifp, PFIL_OUT,
474b252313fSGleb Smirnoff 		    NULL)) {
475b252313fSGleb Smirnoff 		case PFIL_DROPPED:
4767d4317bdSAlexander V. Chernikov 			return (EACCES);
477b252313fSGleb Smirnoff 		case PFIL_CONSUMED:
4787d4317bdSAlexander V. Chernikov 			return (0);
4794b984093SLuigi Rizzo 		}
4802b25acc1SLuigi Rizzo 
481201100c5SBjoern A. Zeeb #ifdef EXPERIMENTAL
482201100c5SBjoern A. Zeeb #if defined(INET6) && defined(INET)
483201100c5SBjoern A. Zeeb 	/* draft-ietf-6man-ipv6only-flag */
48421231a7aSBjoern A. Zeeb 	/* Catch ETHERTYPE_IP, and ETHERTYPE_[REV]ARP if we are v6-only. */
48521231a7aSBjoern A. Zeeb 	if ((ND_IFINFO(ifp)->flags & ND6_IFF_IPV6_ONLY_MASK) != 0) {
486201100c5SBjoern A. Zeeb 		struct ether_header *eh;
487201100c5SBjoern A. Zeeb 
488201100c5SBjoern A. Zeeb 		eh = mtod(m, struct ether_header *);
489201100c5SBjoern A. Zeeb 		switch (ntohs(eh->ether_type)) {
490201100c5SBjoern A. Zeeb 		case ETHERTYPE_IP:
491201100c5SBjoern A. Zeeb 		case ETHERTYPE_ARP:
49221231a7aSBjoern A. Zeeb 		case ETHERTYPE_REVARP:
493201100c5SBjoern A. Zeeb 			m_freem(m);
494201100c5SBjoern A. Zeeb 			return (EAFNOSUPPORT);
495201100c5SBjoern A. Zeeb 			/* NOTREACHED */
496201100c5SBjoern A. Zeeb 			break;
497201100c5SBjoern A. Zeeb 		};
498201100c5SBjoern A. Zeeb 	}
499201100c5SBjoern A. Zeeb #endif
500201100c5SBjoern A. Zeeb #endif
501201100c5SBjoern A. Zeeb 
502df8bae1dSRodney W. Grimes 	/*
503df5e1987SJonathan Lemon 	 * Queue message on interface, update output statistics if
504df5e1987SJonathan Lemon 	 * successful, and start output if interface not yet active.
505df8bae1dSRodney W. Grimes 	 */
506aea78d20SKip Macy 	return ((ifp->if_transmit)(ifp, m));
507df8bae1dSRodney W. Grimes }
508df8bae1dSRodney W. Grimes 
5094b984093SLuigi Rizzo /*
510c1d93b05SSam Leffler  * Process a received Ethernet packet; the packet is in the
511c1d93b05SSam Leffler  * mbuf chain m with the ethernet header at the front.
512df8bae1dSRodney W. Grimes  */
513c1d93b05SSam Leffler static void
5146cb52192SRobert Watson ether_input_internal(struct ifnet *ifp, struct mbuf *m)
515df8bae1dSRodney W. Grimes {
516c1d93b05SSam Leffler 	struct ether_header *eh;
517c1d93b05SSam Leffler 	u_short etype;
518df8bae1dSRodney W. Grimes 
51969462a82SBruce M Simpson 	if ((ifp->if_flags & IFF_UP) == 0) {
52069462a82SBruce M Simpson 		m_freem(m);
52169462a82SBruce M Simpson 		return;
52269462a82SBruce M Simpson 	}
52369462a82SBruce M Simpson #ifdef DIAGNOSTIC
52469462a82SBruce M Simpson 	if ((ifp->if_drv_flags & IFF_DRV_RUNNING) == 0) {
52569462a82SBruce M Simpson 		if_printf(ifp, "discard frame at !IFF_DRV_RUNNING\n");
52669462a82SBruce M Simpson 		m_freem(m);
52769462a82SBruce M Simpson 		return;
52869462a82SBruce M Simpson 	}
52969462a82SBruce M Simpson #endif
530797f247bSMatthew N. Dodd 	if (m->m_len < ETHER_HDR_LEN) {
531c1d93b05SSam Leffler 		/* XXX maybe should pullup? */
532c1d93b05SSam Leffler 		if_printf(ifp, "discard frame w/o leading ethernet "
533c1d93b05SSam Leffler 				"header (len %u pkt len %u)\n",
534c1d93b05SSam Leffler 				m->m_len, m->m_pkthdr.len);
5353751dddbSGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
536c1d93b05SSam Leffler 		m_freem(m);
537c1d93b05SSam Leffler 		return;
5382e2de7f2SArchie Cobbs 	}
539c1d93b05SSam Leffler 	eh = mtod(m, struct ether_header *);
540c1d93b05SSam Leffler 	etype = ntohs(eh->ether_type);
54119fa89e9SMark Murray 	random_harvest_queue_ether(m, sizeof(*m));
542d1b06863SMark Murray 
54321231a7aSBjoern A. Zeeb #ifdef EXPERIMENTAL
54421231a7aSBjoern A. Zeeb #if defined(INET6) && defined(INET)
54521231a7aSBjoern A. Zeeb 	/* draft-ietf-6man-ipv6only-flag */
54621231a7aSBjoern A. Zeeb 	/* Catch ETHERTYPE_IP, and ETHERTYPE_[REV]ARP if we are v6-only. */
54721231a7aSBjoern A. Zeeb 	if ((ND_IFINFO(ifp)->flags & ND6_IFF_IPV6_ONLY_MASK) != 0) {
54821231a7aSBjoern A. Zeeb 
54921231a7aSBjoern A. Zeeb 		switch (etype) {
55021231a7aSBjoern A. Zeeb 		case ETHERTYPE_IP:
55121231a7aSBjoern A. Zeeb 		case ETHERTYPE_ARP:
55221231a7aSBjoern A. Zeeb 		case ETHERTYPE_REVARP:
55321231a7aSBjoern A. Zeeb 			m_freem(m);
55421231a7aSBjoern A. Zeeb 			return;
55521231a7aSBjoern A. Zeeb 			/* NOTREACHED */
55621231a7aSBjoern A. Zeeb 			break;
55721231a7aSBjoern A. Zeeb 		};
55821231a7aSBjoern A. Zeeb 	}
55921231a7aSBjoern A. Zeeb #endif
56021231a7aSBjoern A. Zeeb #endif
56121231a7aSBjoern A. Zeeb 
56221ca7b57SMarko Zec 	CURVNET_SET_QUIET(ifp->if_vnet);
56321ca7b57SMarko Zec 
56469462a82SBruce M Simpson 	if (ETHER_IS_MULTICAST(eh->ether_dhost)) {
56569462a82SBruce M Simpson 		if (ETHER_IS_BROADCAST(eh->ether_dhost))
56669462a82SBruce M Simpson 			m->m_flags |= M_BCAST;
56769462a82SBruce M Simpson 		else
56869462a82SBruce M Simpson 			m->m_flags |= M_MCAST;
5693751dddbSGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_IMCASTS, 1);
57069462a82SBruce M Simpson 	}
57169462a82SBruce M Simpson 
572533d8562SRobert Watson #ifdef MAC
573533d8562SRobert Watson 	/*
574533d8562SRobert Watson 	 * Tag the mbuf with an appropriate MAC label before any other
575533d8562SRobert Watson 	 * consumers can get to it.
576533d8562SRobert Watson 	 */
57730d239bcSRobert Watson 	mac_ifnet_create_mbuf(ifp, m);
578533d8562SRobert Watson #endif
579533d8562SRobert Watson 
580c1d93b05SSam Leffler 	/*
58169462a82SBruce M Simpson 	 * Give bpf a chance at the packet.
582c1d93b05SSam Leffler 	 */
583d05d4616SChristian S.J. Peron 	ETHER_BPF_MTAP(ifp, m);
5842e2de7f2SArchie Cobbs 
58569462a82SBruce M Simpson 	/*
58669462a82SBruce M Simpson 	 * If the CRC is still on the packet, trim it off. We do this once
58769462a82SBruce M Simpson 	 * and once only in case we are re-entered. Nothing else on the
58869462a82SBruce M Simpson 	 * Ethernet receive path expects to see the FCS.
58969462a82SBruce M Simpson 	 */
590c1d93b05SSam Leffler 	if (m->m_flags & M_HASFCS) {
591c1d93b05SSam Leffler 		m_adj(m, -ETHER_CRC_LEN);
592c1d93b05SSam Leffler 		m->m_flags &= ~M_HASFCS;
593c1d93b05SSam Leffler 	}
594c1d93b05SSam Leffler 
5954cdc1f54SGleb Smirnoff 	if (!(ifp->if_capenable & IFCAP_HWSTATS))
5963751dddbSGleb Smirnoff 		if_inc_counter(ifp, IFCOUNTER_IBYTES, m->m_pkthdr.len);
59705463bb5SDavid Greenman 
59869462a82SBruce M Simpson 	/* Allow monitor mode to claim this frame, after stats are updated. */
599de572b37SChristian S.J. Peron 	if (ifp->if_flags & IFF_MONITOR) {
600de572b37SChristian S.J. Peron 		m_freem(m);
60121ca7b57SMarko Zec 		CURVNET_RESTORE();
602de572b37SChristian S.J. Peron 		return;
603de572b37SChristian S.J. Peron 	}
604de572b37SChristian S.J. Peron 
60518242d3bSAndrew Thompson 	/* Handle input from a lagg(4) port */
606b47888ceSAndrew Thompson 	if (ifp->if_type == IFT_IEEE8023ADLAG) {
60718242d3bSAndrew Thompson 		KASSERT(lagg_input_p != NULL,
60818242d3bSAndrew Thompson 		    ("%s: if_lagg not loaded!", __func__));
60918242d3bSAndrew Thompson 		m = (*lagg_input_p)(ifp, m);
610b47888ceSAndrew Thompson 		if (m != NULL)
611b47888ceSAndrew Thompson 			ifp = m->m_pkthdr.rcvif;
6122db13e75SMarko Zec 		else {
6132db13e75SMarko Zec 			CURVNET_RESTORE();
614b47888ceSAndrew Thompson 			return;
615b47888ceSAndrew Thompson 		}
6162db13e75SMarko Zec 	}
617b47888ceSAndrew Thompson 
61869462a82SBruce M Simpson 	/*
61969462a82SBruce M Simpson 	 * If the hardware did not process an 802.1Q tag, do this now,
62069462a82SBruce M Simpson 	 * to allow 802.1P priority frames to be passed to the main input
62169462a82SBruce M Simpson 	 * path correctly.
62269462a82SBruce M Simpson 	 * TODO: Deal with Q-in-Q frames, but not arbitrary nesting levels.
62369462a82SBruce M Simpson 	 */
62469462a82SBruce M Simpson 	if ((m->m_flags & M_VLANTAG) == 0 && etype == ETHERTYPE_VLAN) {
62569462a82SBruce M Simpson 		struct ether_vlan_header *evl;
62669462a82SBruce M Simpson 
62769462a82SBruce M Simpson 		if (m->m_len < sizeof(*evl) &&
62869462a82SBruce M Simpson 		    (m = m_pullup(m, sizeof(*evl))) == NULL) {
629402d5e27SBruce M Simpson #ifdef DIAGNOSTIC
63069462a82SBruce M Simpson 			if_printf(ifp, "cannot pullup VLAN header\n");
631402d5e27SBruce M Simpson #endif
6323751dddbSGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_IERRORS, 1);
6332db13e75SMarko Zec 			CURVNET_RESTORE();
63469462a82SBruce M Simpson 			return;
63569462a82SBruce M Simpson 		}
63669462a82SBruce M Simpson 
63769462a82SBruce M Simpson 		evl = mtod(m, struct ether_vlan_header *);
63869462a82SBruce M Simpson 		m->m_pkthdr.ether_vtag = ntohs(evl->evl_tag);
63969462a82SBruce M Simpson 		m->m_flags |= M_VLANTAG;
64069462a82SBruce M Simpson 
64169462a82SBruce M Simpson 		bcopy((char *)evl, (char *)evl + ETHER_VLAN_ENCAP_LEN,
64269462a82SBruce M Simpson 		    ETHER_HDR_LEN - ETHER_TYPE_LEN);
64369462a82SBruce M Simpson 		m_adj(m, ETHER_VLAN_ENCAP_LEN);
64497cce87fSGleb Smirnoff 		eh = mtod(m, struct ether_header *);
64569462a82SBruce M Simpson 	}
64669462a82SBruce M Simpson 
647a34c6aebSBjoern A. Zeeb 	M_SETFIB(m, ifp->if_fib);
648a34c6aebSBjoern A. Zeeb 
64969462a82SBruce M Simpson 	/* Allow ng_ether(4) to claim this frame. */
650833e8dc5SGleb Smirnoff 	if (ifp->if_l2com != NULL) {
651514bcb89SPoul-Henning Kamp 		KASSERT(ng_ether_input_p != NULL,
65269462a82SBruce M Simpson 		    ("%s: ng_ether_input_p is NULL", __func__));
65369462a82SBruce M Simpson 		m->m_flags &= ~M_PROMISC;
654c1d93b05SSam Leffler 		(*ng_ether_input_p)(ifp, &m);
65521ca7b57SMarko Zec 		if (m == NULL) {
65621ca7b57SMarko Zec 			CURVNET_RESTORE();
657e1e1452dSArchie Cobbs 			return;
658e1e1452dSArchie Cobbs 		}
6595e9a5429SGleb Smirnoff 		eh = mtod(m, struct ether_header *);
66021ca7b57SMarko Zec 	}
661e1e1452dSArchie Cobbs 
6628f867517SAndrew Thompson 	/*
66369462a82SBruce M Simpson 	 * Allow if_bridge(4) to claim this frame.
66469462a82SBruce M Simpson 	 * The BRIDGE_INPUT() macro will update ifp if the bridge changed it
66569462a82SBruce M Simpson 	 * and the frame should be delivered locally.
6668f867517SAndrew Thompson 	 */
66769462a82SBruce M Simpson 	if (ifp->if_bridge != NULL) {
66869462a82SBruce M Simpson 		m->m_flags &= ~M_PROMISC;
669fd6238a6SAndrew Thompson 		BRIDGE_INPUT(ifp, m);
67021ca7b57SMarko Zec 		if (m == NULL) {
67121ca7b57SMarko Zec 			CURVNET_RESTORE();
6728f867517SAndrew Thompson 			return;
6738f867517SAndrew Thompson 		}
6745e9a5429SGleb Smirnoff 		eh = mtod(m, struct ether_header *);
67521ca7b57SMarko Zec 	}
6768f867517SAndrew Thompson 
677259d2d54SBjoern A. Zeeb #if defined(INET) || defined(INET6)
67869462a82SBruce M Simpson 	/*
67969462a82SBruce M Simpson 	 * Clear M_PROMISC on frame so that carp(4) will see it when the
68069462a82SBruce M Simpson 	 * mbuf flows up to Layer 3.
68169462a82SBruce M Simpson 	 * FreeBSD's implementation of carp(4) uses the inprotosw
68269462a82SBruce M Simpson 	 * to dispatch IPPROTO_CARP. carp(4) also allocates its own
68369462a82SBruce M Simpson 	 * Ethernet addresses of the form 00:00:5e:00:01:xx, which
68469462a82SBruce M Simpson 	 * is outside the scope of the M_PROMISC test below.
68569462a82SBruce M Simpson 	 * TODO: Maintain a hash table of ethernet addresses other than
68669462a82SBruce M Simpson 	 * ether_dhost which may be active on this ifp.
68769462a82SBruce M Simpson 	 */
68854bfbd51SWill Andrews 	if (ifp->if_carp && (*carp_forus_p)(ifp, eh->ether_dhost)) {
68969462a82SBruce M Simpson 		m->m_flags &= ~M_PROMISC;
69069462a82SBruce M Simpson 	} else
69169462a82SBruce M Simpson #endif
69269462a82SBruce M Simpson 	{
69369462a82SBruce M Simpson 		/*
694e7f8c833SBruce M Simpson 		 * If the frame received was not for our MAC address, set the
69569462a82SBruce M Simpson 		 * M_PROMISC flag on the mbuf chain. The frame may need to
69669462a82SBruce M Simpson 		 * be seen by the rest of the Ethernet input path in case of
69769462a82SBruce M Simpson 		 * re-entry (e.g. bridge, vlan, netgraph) but should not be
69869462a82SBruce M Simpson 		 * seen by upper protocol layers.
69969462a82SBruce M Simpson 		 */
70069462a82SBruce M Simpson 		if (!ETHER_IS_MULTICAST(eh->ether_dhost) &&
701e7f8c833SBruce M Simpson 		    bcmp(IF_LLADDR(ifp), eh->ether_dhost, ETHER_ADDR_LEN) != 0)
70269462a82SBruce M Simpson 			m->m_flags |= M_PROMISC;
70369462a82SBruce M Simpson 	}
70469462a82SBruce M Simpson 
705acf032f5SRobert Watson 	ether_demux(ifp, m);
70621ca7b57SMarko Zec 	CURVNET_RESTORE();
707e1e1452dSArchie Cobbs }
708e1e1452dSArchie Cobbs 
709e1e1452dSArchie Cobbs /*
7106cb52192SRobert Watson  * Ethernet input dispatch; by default, direct dispatch here regardless of
7117527624eSRobert Watson  * global configuration.  However, if RSS is enabled, hook up RSS affinity
7127527624eSRobert Watson  * so that when deferred or hybrid dispatch is enabled, we can redistribute
7137527624eSRobert Watson  * load based on RSS.
7147527624eSRobert Watson  *
7157527624eSRobert Watson  * XXXRW: Would be nice if the ifnet passed up a flag indicating whether or
7167527624eSRobert Watson  * not it had already done work distribution via multi-queue.  Then we could
7177527624eSRobert Watson  * direct dispatch in the event load balancing was already complete and
7187527624eSRobert Watson  * handle the case of interfaces with different capabilities better.
7197527624eSRobert Watson  *
7207527624eSRobert Watson  * XXXRW: Sort of want an M_DISTRIBUTED flag to avoid multiple distributions
7217527624eSRobert Watson  * at multiple layers?
7227527624eSRobert Watson  *
7237527624eSRobert Watson  * XXXRW: For now, enable all this only if RSS is compiled in, although it
7247527624eSRobert Watson  * works fine without RSS.  Need to characterise the performance overhead
7257527624eSRobert Watson  * of the detour through the netisr code in the event the result is always
7267527624eSRobert Watson  * direct dispatch.
7276cb52192SRobert Watson  */
7286cb52192SRobert Watson static void
7296cb52192SRobert Watson ether_nh_input(struct mbuf *m)
7306cb52192SRobert Watson {
7316cb52192SRobert Watson 
732b71bed24SAndrey V. Elsukov 	M_ASSERTPKTHDR(m);
733b71bed24SAndrey V. Elsukov 	KASSERT(m->m_pkthdr.rcvif != NULL,
734b71bed24SAndrey V. Elsukov 	    ("%s: NULL interface pointer", __func__));
7356cb52192SRobert Watson 	ether_input_internal(m->m_pkthdr.rcvif, m);
7366cb52192SRobert Watson }
7376cb52192SRobert Watson 
7386cb52192SRobert Watson static struct netisr_handler	ether_nh = {
7396cb52192SRobert Watson 	.nh_name = "ether",
7406cb52192SRobert Watson 	.nh_handler = ether_nh_input,
7416cb52192SRobert Watson 	.nh_proto = NETISR_ETHER,
7427527624eSRobert Watson #ifdef RSS
7437527624eSRobert Watson 	.nh_policy = NETISR_POLICY_CPU,
7447527624eSRobert Watson 	.nh_dispatch = NETISR_DISPATCH_DIRECT,
7457527624eSRobert Watson 	.nh_m2cpuid = rss_m2cpuid,
7467527624eSRobert Watson #else
7476cb52192SRobert Watson 	.nh_policy = NETISR_POLICY_SOURCE,
7486cb52192SRobert Watson 	.nh_dispatch = NETISR_DISPATCH_DIRECT,
7497527624eSRobert Watson #endif
7506cb52192SRobert Watson };
7516cb52192SRobert Watson 
7526cb52192SRobert Watson static void
7536cb52192SRobert Watson ether_init(__unused void *arg)
7546cb52192SRobert Watson {
7556cb52192SRobert Watson 
7566cb52192SRobert Watson 	netisr_register(&ether_nh);
7576cb52192SRobert Watson }
7586cb52192SRobert Watson SYSINIT(ether, SI_SUB_INIT_IF, SI_ORDER_ANY, ether_init, NULL);
7596cb52192SRobert Watson 
7606cb52192SRobert Watson static void
7617d4317bdSAlexander V. Chernikov vnet_ether_init(__unused void *arg)
7627d4317bdSAlexander V. Chernikov {
763b252313fSGleb Smirnoff 	struct pfil_head_args args;
7647d4317bdSAlexander V. Chernikov 
765b252313fSGleb Smirnoff 	args.pa_version = PFIL_VERSION;
766b252313fSGleb Smirnoff 	args.pa_flags = PFIL_IN | PFIL_OUT;
767b252313fSGleb Smirnoff 	args.pa_type = PFIL_TYPE_ETHERNET;
768b252313fSGleb Smirnoff 	args.pa_headname = PFIL_ETHER_NAME;
769b252313fSGleb Smirnoff 	V_link_pfil_head = pfil_head_register(&args);
770b252313fSGleb Smirnoff 
771484149deSBjoern A. Zeeb #ifdef VIMAGE
772484149deSBjoern A. Zeeb 	netisr_register_vnet(&ether_nh);
773484149deSBjoern A. Zeeb #endif
7747d4317bdSAlexander V. Chernikov }
7757d4317bdSAlexander V. Chernikov VNET_SYSINIT(vnet_ether_init, SI_SUB_PROTO_IF, SI_ORDER_ANY,
7767d4317bdSAlexander V. Chernikov     vnet_ether_init, NULL);
7777d4317bdSAlexander V. Chernikov 
778484149deSBjoern A. Zeeb #ifdef VIMAGE
7797d4317bdSAlexander V. Chernikov static void
780484149deSBjoern A. Zeeb vnet_ether_pfil_destroy(__unused void *arg)
7817d4317bdSAlexander V. Chernikov {
7827d4317bdSAlexander V. Chernikov 
783b252313fSGleb Smirnoff 	pfil_head_unregister(V_link_pfil_head);
7847d4317bdSAlexander V. Chernikov }
785484149deSBjoern A. Zeeb VNET_SYSUNINIT(vnet_ether_pfil_uninit, SI_SUB_PROTO_PFIL, SI_ORDER_ANY,
786484149deSBjoern A. Zeeb     vnet_ether_pfil_destroy, NULL);
787484149deSBjoern A. Zeeb 
788484149deSBjoern A. Zeeb static void
789484149deSBjoern A. Zeeb vnet_ether_destroy(__unused void *arg)
790484149deSBjoern A. Zeeb {
791484149deSBjoern A. Zeeb 
792484149deSBjoern A. Zeeb 	netisr_unregister_vnet(&ether_nh);
793484149deSBjoern A. Zeeb }
7947d4317bdSAlexander V. Chernikov VNET_SYSUNINIT(vnet_ether_uninit, SI_SUB_PROTO_IF, SI_ORDER_ANY,
7957d4317bdSAlexander V. Chernikov     vnet_ether_destroy, NULL);
796484149deSBjoern A. Zeeb #endif
7977d4317bdSAlexander V. Chernikov 
7987d4317bdSAlexander V. Chernikov 
7997d4317bdSAlexander V. Chernikov 
8007d4317bdSAlexander V. Chernikov static void
8016cb52192SRobert Watson ether_input(struct ifnet *ifp, struct mbuf *m)
8026cb52192SRobert Watson {
8036cb52192SRobert Watson 
8044857f5fbSGeorge V. Neville-Neil 	struct mbuf *mn;
8054857f5fbSGeorge V. Neville-Neil 
8064857f5fbSGeorge V. Neville-Neil 	/*
8074857f5fbSGeorge V. Neville-Neil 	 * The drivers are allowed to pass in a chain of packets linked with
8084857f5fbSGeorge V. Neville-Neil 	 * m_nextpkt. We split them up into separate packets here and pass
8094857f5fbSGeorge V. Neville-Neil 	 * them up. This allows the drivers to amortize the receive lock.
8104857f5fbSGeorge V. Neville-Neil 	 */
8114857f5fbSGeorge V. Neville-Neil 	while (m) {
8124857f5fbSGeorge V. Neville-Neil 		mn = m->m_nextpkt;
8134857f5fbSGeorge V. Neville-Neil 		m->m_nextpkt = NULL;
8144857f5fbSGeorge V. Neville-Neil 
8156cb52192SRobert Watson 		/*
8166cb52192SRobert Watson 		 * We will rely on rcvif being set properly in the deferred context,
8176cb52192SRobert Watson 		 * so assert it is correct here.
8186cb52192SRobert Watson 		 */
819e84ef07fSBjoern A. Zeeb 		KASSERT(m->m_pkthdr.rcvif == ifp, ("%s: ifnet mismatch m %p "
820e84ef07fSBjoern A. Zeeb 		    "rcvif %p ifp %p", __func__, m, m->m_pkthdr.rcvif, ifp));
821484149deSBjoern A. Zeeb 		CURVNET_SET_QUIET(ifp->if_vnet);
8226cb52192SRobert Watson 		netisr_dispatch(NETISR_ETHER, m);
823484149deSBjoern A. Zeeb 		CURVNET_RESTORE();
8244857f5fbSGeorge V. Neville-Neil 		m = mn;
8254857f5fbSGeorge V. Neville-Neil 	}
8266cb52192SRobert Watson }
8276cb52192SRobert Watson 
8286cb52192SRobert Watson /*
829e1e1452dSArchie Cobbs  * Upper layer processing for a received Ethernet packet.
830e1e1452dSArchie Cobbs  */
831e1e1452dSArchie Cobbs void
832c1d93b05SSam Leffler ether_demux(struct ifnet *ifp, struct mbuf *m)
833e1e1452dSArchie Cobbs {
834c1d93b05SSam Leffler 	struct ether_header *eh;
8357d4317bdSAlexander V. Chernikov 	int i, isr;
836e1e1452dSArchie Cobbs 	u_short ether_type;
83769462a82SBruce M Simpson 
83869462a82SBruce M Simpson 	KASSERT(ifp != NULL, ("%s: NULL interface pointer", __func__));
83969462a82SBruce M Simpson 
8407d4317bdSAlexander V. Chernikov 	/* Do not grab PROMISC frames in case we are re-entered. */
841b252313fSGleb Smirnoff 	if (PFIL_HOOKED_IN(V_link_pfil_head) && !(m->m_flags & M_PROMISC)) {
842b252313fSGleb Smirnoff 		i = pfil_run_hooks(V_link_pfil_head, &m, ifp, PFIL_IN, NULL);
8437d4317bdSAlexander V. Chernikov 		if (i != 0 || m == NULL)
8447d4317bdSAlexander V. Chernikov 			return;
84569462a82SBruce M Simpson 	}
8467d4317bdSAlexander V. Chernikov 
847c1d93b05SSam Leffler 	eh = mtod(m, struct ether_header *);
848cd0cd014SJoerg Wunsch 	ether_type = ntohs(eh->ether_type);
849c1d93b05SSam Leffler 
850a9771948SGleb Smirnoff 	/*
85169462a82SBruce M Simpson 	 * If this frame has a VLAN tag other than 0, call vlan_input()
85269462a82SBruce M Simpson 	 * if its module is loaded. Otherwise, drop.
853a9771948SGleb Smirnoff 	 */
85469462a82SBruce M Simpson 	if ((m->m_flags & M_VLANTAG) &&
85569462a82SBruce M Simpson 	    EVL_VLANOFTAG(m->m_pkthdr.ether_vtag) != 0) {
85675ee267cSGleb Smirnoff 		if (ifp->if_vlantrunk == NULL) {
8573751dddbSGleb Smirnoff 			if_inc_counter(ifp, IFCOUNTER_NOPROTO, 1);
8586c23e6ccSRuslan Ermilov 			m_freem(m);
8596c23e6ccSRuslan Ermilov 			return;
8606c23e6ccSRuslan Ermilov 		}
86169462a82SBruce M Simpson 		KASSERT(vlan_input_p != NULL,("%s: VLAN not loaded!",
86269462a82SBruce M Simpson 		    __func__));
86369462a82SBruce M Simpson 		/* Clear before possibly re-entering ether_input(). */
86469462a82SBruce M Simpson 		m->m_flags &= ~M_PROMISC;
865c1d93b05SSam Leffler 		(*vlan_input_p)(ifp, m);
866c1d93b05SSam Leffler 		return;
867c1d93b05SSam Leffler 	}
868c1d93b05SSam Leffler 
869c1d93b05SSam Leffler 	/*
87069462a82SBruce M Simpson 	 * Pass promiscuously received frames to the upper layer if the user
87169462a82SBruce M Simpson 	 * requested this by setting IFF_PPROMISC. Otherwise, drop them.
872c1d93b05SSam Leffler 	 */
87369462a82SBruce M Simpson 	if ((ifp->if_flags & IFF_PPROMISC) == 0 && (m->m_flags & M_PROMISC)) {
874c1d93b05SSam Leffler 		m_freem(m);
875c1d93b05SSam Leffler 		return;
876c1d93b05SSam Leffler 	}
877c1d93b05SSam Leffler 
87869462a82SBruce M Simpson 	/*
87969462a82SBruce M Simpson 	 * Reset layer specific mbuf flags to avoid confusing upper layers.
88069462a82SBruce M Simpson 	 * Strip off Ethernet header.
88169462a82SBruce M Simpson 	 */
88269462a82SBruce M Simpson 	m->m_flags &= ~M_VLANTAG;
88386bd0491SAndre Oppermann 	m_clrprotoflags(m);
884797f247bSMatthew N. Dodd 	m_adj(m, ETHER_HDR_LEN);
885c1d93b05SSam Leffler 
88669462a82SBruce M Simpson 	/*
88769462a82SBruce M Simpson 	 * Dispatch frame to upper layer.
88869462a82SBruce M Simpson 	 */
889307d80beSDavid Greenman 	switch (ether_type) {
890df8bae1dSRodney W. Grimes #ifdef INET
891df8bae1dSRodney W. Grimes 	case ETHERTYPE_IP:
8921cafed39SJonathan Lemon 		isr = NETISR_IP;
893df8bae1dSRodney W. Grimes 		break;
894df8bae1dSRodney W. Grimes 
895df8bae1dSRodney W. Grimes 	case ETHERTYPE_ARP:
89608aadfbbSJonathan Lemon 		if (ifp->if_flags & IFF_NOARP) {
89708aadfbbSJonathan Lemon 			/* Discard packet if ARP is disabled on interface */
89808aadfbbSJonathan Lemon 			m_freem(m);
89908aadfbbSJonathan Lemon 			return;
90008aadfbbSJonathan Lemon 		}
9011cafed39SJonathan Lemon 		isr = NETISR_ARP;
902df8bae1dSRodney W. Grimes 		break;
903df8bae1dSRodney W. Grimes #endif
90482cd038dSYoshinobu Inoue #ifdef INET6
90582cd038dSYoshinobu Inoue 	case ETHERTYPE_IPV6:
9061cafed39SJonathan Lemon 		isr = NETISR_IPV6;
90782cd038dSYoshinobu Inoue 		break;
90882cd038dSYoshinobu Inoue #endif
909df8bae1dSRodney W. Grimes 	default:
9101cafed39SJonathan Lemon 		goto discard;
911df8bae1dSRodney W. Grimes 	}
9121cafed39SJonathan Lemon 	netisr_dispatch(isr, m);
913c1d93b05SSam Leffler 	return;
9141cafed39SJonathan Lemon 
915c1d93b05SSam Leffler discard:
916c1d93b05SSam Leffler 	/*
917c1d93b05SSam Leffler 	 * Packet is to be discarded.  If netgraph is present,
918c1d93b05SSam Leffler 	 * hand the packet to it for last chance processing;
919c1d93b05SSam Leffler 	 * otherwise dispose of it.
920c1d93b05SSam Leffler 	 */
921833e8dc5SGleb Smirnoff 	if (ifp->if_l2com != NULL) {
922514bcb89SPoul-Henning Kamp 		KASSERT(ng_ether_input_orphan_p != NULL,
923514bcb89SPoul-Henning Kamp 		    ("ng_ether_input_orphan_p is NULL"));
924c1d93b05SSam Leffler 		/*
925c1d93b05SSam Leffler 		 * Put back the ethernet header so netgraph has a
926c1d93b05SSam Leffler 		 * consistent view of inbound packets.
927c1d93b05SSam Leffler 		 */
928eb1b1807SGleb Smirnoff 		M_PREPEND(m, ETHER_HDR_LEN, M_NOWAIT);
929c1d93b05SSam Leffler 		(*ng_ether_input_orphan_p)(ifp, m);
930c1d93b05SSam Leffler 		return;
931c1d93b05SSam Leffler 	}
932c1d93b05SSam Leffler 	m_freem(m);
933c1d93b05SSam Leffler }
934c1d93b05SSam Leffler 
935c1d93b05SSam Leffler /*
936c1d93b05SSam Leffler  * Convert Ethernet address to printable (loggable) representation.
937c1d93b05SSam Leffler  * This routine is for compatibility; it's better to just use
938c1d93b05SSam Leffler  *
939c1d93b05SSam Leffler  *	printf("%6D", <pointer to address>, ":");
940c1d93b05SSam Leffler  *
941c1d93b05SSam Leffler  * since there's no static buffer involved.
942c1d93b05SSam Leffler  */
943c1d93b05SSam Leffler char *
944c1d93b05SSam Leffler ether_sprintf(const u_char *ap)
945c1d93b05SSam Leffler {
946c1d93b05SSam Leffler 	static char etherbuf[18];
947c1d93b05SSam Leffler 	snprintf(etherbuf, sizeof (etherbuf), "%6D", ap, ":");
948c1d93b05SSam Leffler 	return (etherbuf);
949df8bae1dSRodney W. Grimes }
950df8bae1dSRodney W. Grimes 
951df8bae1dSRodney W. Grimes /*
952df8bae1dSRodney W. Grimes  * Perform common duties while attaching to interface list
953df8bae1dSRodney W. Grimes  */
954df8bae1dSRodney W. Grimes void
955d09ed26fSRuslan Ermilov ether_ifattach(struct ifnet *ifp, const u_int8_t *lla)
956df8bae1dSRodney W. Grimes {
957f93dfa28SBrooks Davis 	int i;
958098a8c3bSMatthew N. Dodd 	struct ifaddr *ifa;
959098a8c3bSMatthew N. Dodd 	struct sockaddr_dl *sdl;
960df8bae1dSRodney W. Grimes 
961c1d93b05SSam Leffler 	ifp->if_addrlen = ETHER_ADDR_LEN;
962c1d93b05SSam Leffler 	ifp->if_hdrlen = ETHER_HDR_LEN;
963cfeff1b6SJonathan Lemon 	if_attach(ifp);
964df8bae1dSRodney W. Grimes 	ifp->if_mtu = ETHERMTU;
965c1d93b05SSam Leffler 	ifp->if_output = ether_output;
966c1d93b05SSam Leffler 	ifp->if_input = ether_input;
9671158dfb7SGarrett Wollman 	ifp->if_resolvemulti = ether_resolvemulti;
9684fb3a820SAlexander V. Chernikov 	ifp->if_requestencap = ether_requestencap;
969d3c351c5SMarko Zec #ifdef VIMAGE
970d3c351c5SMarko Zec 	ifp->if_reassign = ether_reassign;
971d3c351c5SMarko Zec #endif
972a330e1f1SGary Palmer 	if (ifp->if_baudrate == 0)
973c1d93b05SSam Leffler 		ifp->if_baudrate = IF_Mbps(10);		/* just a default */
974322dcb8dSMax Khon 	ifp->if_broadcastaddr = etherbroadcastaddr;
975c1d93b05SSam Leffler 
9764a0d6638SRuslan Ermilov 	ifa = ifp->if_addr;
9776e551fb6SDavid E. O'Brien 	KASSERT(ifa != NULL, ("%s: no lladdr!\n", __func__));
97859562606SGarrett Wollman 	sdl = (struct sockaddr_dl *)ifa->ifa_addr;
979df8bae1dSRodney W. Grimes 	sdl->sdl_type = IFT_ETHER;
980df8bae1dSRodney W. Grimes 	sdl->sdl_alen = ifp->if_addrlen;
981d09ed26fSRuslan Ermilov 	bcopy(lla, LLADDR(sdl), ifp->if_addrlen);
982c1d93b05SSam Leffler 
9835b1a5e45SRavi Pokala 	if (ifp->if_hw_addr != NULL)
984ddae5750SRavi Pokala 		bcopy(lla, ifp->if_hw_addr, ifp->if_addrlen);
985ddae5750SRavi Pokala 
986797f247bSMatthew N. Dodd 	bpfattach(ifp, DLT_EN10MB, ETHER_HDR_LEN);
987e1e1452dSArchie Cobbs 	if (ng_ether_attach_p != NULL)
988e1e1452dSArchie Cobbs 		(*ng_ether_attach_p)(ifp);
989e3bbbec2SMatthew N. Dodd 
990f93dfa28SBrooks Davis 	/* Announce Ethernet MAC address if non-zero. */
991f93dfa28SBrooks Davis 	for (i = 0; i < ifp->if_addrlen; i++)
992d09ed26fSRuslan Ermilov 		if (lla[i] != 0)
993f93dfa28SBrooks Davis 			break;
994f93dfa28SBrooks Davis 	if (i != ifp->if_addrlen)
995d09ed26fSRuslan Ermilov 		if_printf(ifp, "Ethernet address: %6D\n", lla, ":");
996ef1f9169SMarcel Moolenaar 
997ef1f9169SMarcel Moolenaar 	uuid_ether_add(LLADDR(sdl));
9988819ad85SSepherosa Ziehau 
9998819ad85SSepherosa Ziehau 	/* Add necessary bits are setup; announce it now. */
10008819ad85SSepherosa Ziehau 	EVENTHANDLER_INVOKE(ether_ifattach_event, ifp);
10018819ad85SSepherosa Ziehau 	if (IS_DEFAULT_VNET(curvnet))
10028819ad85SSepherosa Ziehau 		devctl_notify("ETHERNET", ifp->if_xname, "IFATTACH", NULL);
1003e1e1452dSArchie Cobbs }
1004e1e1452dSArchie Cobbs 
100521b8ebd9SArchie Cobbs /*
100621b8ebd9SArchie Cobbs  * Perform common duties while detaching an Ethernet interface
100721b8ebd9SArchie Cobbs  */
100821b8ebd9SArchie Cobbs void
1009c1d93b05SSam Leffler ether_ifdetach(struct ifnet *ifp)
101021b8ebd9SArchie Cobbs {
1011ef1f9169SMarcel Moolenaar 	struct sockaddr_dl *sdl;
1012ef1f9169SMarcel Moolenaar 
1013ef1f9169SMarcel Moolenaar 	sdl = (struct sockaddr_dl *)(ifp->if_addr->ifa_addr);
1014ef1f9169SMarcel Moolenaar 	uuid_ether_del(LLADDR(sdl));
1015ef1f9169SMarcel Moolenaar 
1016833e8dc5SGleb Smirnoff 	if (ifp->if_l2com != NULL) {
1017514bcb89SPoul-Henning Kamp 		KASSERT(ng_ether_detach_p != NULL,
1018514bcb89SPoul-Henning Kamp 		    ("ng_ether_detach_p is NULL"));
101921b8ebd9SArchie Cobbs 		(*ng_ether_detach_p)(ifp);
1020514bcb89SPoul-Henning Kamp 	}
102120a65f37SAndrew Thompson 
102221b8ebd9SArchie Cobbs 	bpfdetach(ifp);
102321b8ebd9SArchie Cobbs 	if_detach(ifp);
102421b8ebd9SArchie Cobbs }
102521b8ebd9SArchie Cobbs 
1026d3c351c5SMarko Zec #ifdef VIMAGE
1027d3c351c5SMarko Zec void
1028d3c351c5SMarko Zec ether_reassign(struct ifnet *ifp, struct vnet *new_vnet, char *unused __unused)
1029d3c351c5SMarko Zec {
1030d3c351c5SMarko Zec 
1031833e8dc5SGleb Smirnoff 	if (ifp->if_l2com != NULL) {
1032d3c351c5SMarko Zec 		KASSERT(ng_ether_detach_p != NULL,
1033d3c351c5SMarko Zec 		    ("ng_ether_detach_p is NULL"));
1034d3c351c5SMarko Zec 		(*ng_ether_detach_p)(ifp);
1035d3c351c5SMarko Zec 	}
1036d3c351c5SMarko Zec 
1037d3c351c5SMarko Zec 	if (ng_ether_attach_p != NULL) {
1038d3c351c5SMarko Zec 		CURVNET_SET_QUIET(new_vnet);
1039d3c351c5SMarko Zec 		(*ng_ether_attach_p)(ifp);
1040d3c351c5SMarko Zec 		CURVNET_RESTORE();
1041d3c351c5SMarko Zec 	}
1042d3c351c5SMarko Zec }
1043d3c351c5SMarko Zec #endif
1044d3c351c5SMarko Zec 
1045ce02431fSDoug Rabson SYSCTL_DECL(_net_link);
1046602d513cSGarrett Wollman SYSCTL_NODE(_net_link, IFT_ETHER, ether, CTLFLAG_RW, 0, "Ethernet");
104730106f6aSPoul-Henning Kamp 
104816b4a343SChristian Weisgerber #if 0
104916b4a343SChristian Weisgerber /*
105016b4a343SChristian Weisgerber  * This is for reference.  We have a table-driven version
105116b4a343SChristian Weisgerber  * of the little-endian crc32 generator, which is faster
105216b4a343SChristian Weisgerber  * than the double-loop.
105316b4a343SChristian Weisgerber  */
105416b4a343SChristian Weisgerber uint32_t
105516b4a343SChristian Weisgerber ether_crc32_le(const uint8_t *buf, size_t len)
105616b4a343SChristian Weisgerber {
105716b4a343SChristian Weisgerber 	size_t i;
105816b4a343SChristian Weisgerber 	uint32_t crc;
105916b4a343SChristian Weisgerber 	int bit;
106016b4a343SChristian Weisgerber 	uint8_t data;
106116b4a343SChristian Weisgerber 
106216b4a343SChristian Weisgerber 	crc = 0xffffffff;	/* initial value */
106316b4a343SChristian Weisgerber 
106416b4a343SChristian Weisgerber 	for (i = 0; i < len; i++) {
1065933dad75SAntoine Brodin 		for (data = *buf++, bit = 0; bit < 8; bit++, data >>= 1) {
106616b4a343SChristian Weisgerber 			carry = (crc ^ data) & 1;
106716b4a343SChristian Weisgerber 			crc >>= 1;
106816b4a343SChristian Weisgerber 			if (carry)
106916b4a343SChristian Weisgerber 				crc = (crc ^ ETHER_CRC_POLY_LE);
107016b4a343SChristian Weisgerber 		}
1071933dad75SAntoine Brodin 	}
107216b4a343SChristian Weisgerber 
107316b4a343SChristian Weisgerber 	return (crc);
107416b4a343SChristian Weisgerber }
107516b4a343SChristian Weisgerber #else
107616b4a343SChristian Weisgerber uint32_t
107716b4a343SChristian Weisgerber ether_crc32_le(const uint8_t *buf, size_t len)
107816b4a343SChristian Weisgerber {
107916b4a343SChristian Weisgerber 	static const uint32_t crctab[] = {
108016b4a343SChristian Weisgerber 		0x00000000, 0x1db71064, 0x3b6e20c8, 0x26d930ac,
108116b4a343SChristian Weisgerber 		0x76dc4190, 0x6b6b51f4, 0x4db26158, 0x5005713c,
108216b4a343SChristian Weisgerber 		0xedb88320, 0xf00f9344, 0xd6d6a3e8, 0xcb61b38c,
108316b4a343SChristian Weisgerber 		0x9b64c2b0, 0x86d3d2d4, 0xa00ae278, 0xbdbdf21c
108416b4a343SChristian Weisgerber 	};
108516b4a343SChristian Weisgerber 	size_t i;
108616b4a343SChristian Weisgerber 	uint32_t crc;
108716b4a343SChristian Weisgerber 
108816b4a343SChristian Weisgerber 	crc = 0xffffffff;	/* initial value */
108916b4a343SChristian Weisgerber 
109016b4a343SChristian Weisgerber 	for (i = 0; i < len; i++) {
109116b4a343SChristian Weisgerber 		crc ^= buf[i];
109216b4a343SChristian Weisgerber 		crc = (crc >> 4) ^ crctab[crc & 0xf];
109316b4a343SChristian Weisgerber 		crc = (crc >> 4) ^ crctab[crc & 0xf];
109416b4a343SChristian Weisgerber 	}
109516b4a343SChristian Weisgerber 
109616b4a343SChristian Weisgerber 	return (crc);
109716b4a343SChristian Weisgerber }
109816b4a343SChristian Weisgerber #endif
109916b4a343SChristian Weisgerber 
110016b4a343SChristian Weisgerber uint32_t
110116b4a343SChristian Weisgerber ether_crc32_be(const uint8_t *buf, size_t len)
110216b4a343SChristian Weisgerber {
110316b4a343SChristian Weisgerber 	size_t i;
110416b4a343SChristian Weisgerber 	uint32_t crc, carry;
110516b4a343SChristian Weisgerber 	int bit;
110616b4a343SChristian Weisgerber 	uint8_t data;
110716b4a343SChristian Weisgerber 
110816b4a343SChristian Weisgerber 	crc = 0xffffffff;	/* initial value */
110916b4a343SChristian Weisgerber 
111016b4a343SChristian Weisgerber 	for (i = 0; i < len; i++) {
111116b4a343SChristian Weisgerber 		for (data = *buf++, bit = 0; bit < 8; bit++, data >>= 1) {
111216b4a343SChristian Weisgerber 			carry = ((crc & 0x80000000) ? 1 : 0) ^ (data & 0x01);
111316b4a343SChristian Weisgerber 			crc <<= 1;
111416b4a343SChristian Weisgerber 			if (carry)
111516b4a343SChristian Weisgerber 				crc = (crc ^ ETHER_CRC_POLY_BE) | carry;
111616b4a343SChristian Weisgerber 		}
111716b4a343SChristian Weisgerber 	}
111816b4a343SChristian Weisgerber 
111916b4a343SChristian Weisgerber 	return (crc);
112016b4a343SChristian Weisgerber }
112116b4a343SChristian Weisgerber 
1122fb583156SDavid Greenman int
1123995c7fd1SYaroslav Tykhiy ether_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
112430106f6aSPoul-Henning Kamp {
112530106f6aSPoul-Henning Kamp 	struct ifaddr *ifa = (struct ifaddr *) data;
112630106f6aSPoul-Henning Kamp 	struct ifreq *ifr = (struct ifreq *) data;
1127fb583156SDavid Greenman 	int error = 0;
112830106f6aSPoul-Henning Kamp 
112930106f6aSPoul-Henning Kamp 	switch (command) {
113030106f6aSPoul-Henning Kamp 	case SIOCSIFADDR:
113130106f6aSPoul-Henning Kamp 		ifp->if_flags |= IFF_UP;
113230106f6aSPoul-Henning Kamp 
113330106f6aSPoul-Henning Kamp 		switch (ifa->ifa_addr->sa_family) {
113430106f6aSPoul-Henning Kamp #ifdef INET
113530106f6aSPoul-Henning Kamp 		case AF_INET:
113630106f6aSPoul-Henning Kamp 			ifp->if_init(ifp->if_softc);	/* before arpwhohas */
1137322dcb8dSMax Khon 			arp_ifinit(ifp, ifa);
113830106f6aSPoul-Henning Kamp 			break;
113930106f6aSPoul-Henning Kamp #endif
114030106f6aSPoul-Henning Kamp 		default:
114130106f6aSPoul-Henning Kamp 			ifp->if_init(ifp->if_softc);
114230106f6aSPoul-Henning Kamp 			break;
114330106f6aSPoul-Henning Kamp 		}
114430106f6aSPoul-Henning Kamp 		break;
114530106f6aSPoul-Henning Kamp 
114630106f6aSPoul-Henning Kamp 	case SIOCGIFADDR:
114738d958a6SBrooks Davis 		bcopy(IF_LLADDR(ifp), &ifr->ifr_addr.sa_data[0],
114838d958a6SBrooks Davis 		    ETHER_ADDR_LEN);
114930106f6aSPoul-Henning Kamp 		break;
1150fb583156SDavid Greenman 
1151fb583156SDavid Greenman 	case SIOCSIFMTU:
1152fb583156SDavid Greenman 		/*
1153fb583156SDavid Greenman 		 * Set the interface MTU.
1154fb583156SDavid Greenman 		 */
1155fb583156SDavid Greenman 		if (ifr->ifr_mtu > ETHERMTU) {
1156fb583156SDavid Greenman 			error = EINVAL;
1157fb583156SDavid Greenman 		} else {
1158fb583156SDavid Greenman 			ifp->if_mtu = ifr->ifr_mtu;
115930106f6aSPoul-Henning Kamp 		}
1160fb583156SDavid Greenman 		break;
1161f1379734SKonstantin Belousov 
1162f1379734SKonstantin Belousov 	case SIOCSLANPCP:
1163f1379734SKonstantin Belousov 		error = priv_check(curthread, PRIV_NET_SETLANPCP);
1164f1379734SKonstantin Belousov 		if (error != 0)
1165f1379734SKonstantin Belousov 			break;
1166f1379734SKonstantin Belousov 		if (ifr->ifr_lan_pcp > 7 &&
11674a381a9eSHans Petter Selasky 		    ifr->ifr_lan_pcp != IFNET_PCP_NONE) {
1168f1379734SKonstantin Belousov 			error = EINVAL;
11694a381a9eSHans Petter Selasky 		} else {
1170f1379734SKonstantin Belousov 			ifp->if_pcp = ifr->ifr_lan_pcp;
11714a381a9eSHans Petter Selasky 			/* broadcast event about PCP change */
11724a381a9eSHans Petter Selasky 			EVENTHANDLER_INVOKE(ifnet_event, ifp, IFNET_EVENT_PCP);
11734a381a9eSHans Petter Selasky 		}
1174f1379734SKonstantin Belousov 		break;
1175f1379734SKonstantin Belousov 
1176f1379734SKonstantin Belousov 	case SIOCGLANPCP:
1177f1379734SKonstantin Belousov 		ifr->ifr_lan_pcp = ifp->if_pcp;
1178f1379734SKonstantin Belousov 		break;
1179f1379734SKonstantin Belousov 
1180c1d93b05SSam Leffler 	default:
1181c1d93b05SSam Leffler 		error = EINVAL;			/* XXX netbsd has ENOTTY??? */
1182c1d93b05SSam Leffler 		break;
1183fb583156SDavid Greenman 	}
1184fb583156SDavid Greenman 	return (error);
118530106f6aSPoul-Henning Kamp }
11861158dfb7SGarrett Wollman 
118737c84183SPoul-Henning Kamp static int
118872fd1b6aSDag-Erling Smørgrav ether_resolvemulti(struct ifnet *ifp, struct sockaddr **llsa,
118972fd1b6aSDag-Erling Smørgrav 	struct sockaddr *sa)
11901158dfb7SGarrett Wollman {
11911158dfb7SGarrett Wollman 	struct sockaddr_dl *sdl;
1192d7647d96SDag-Erling Smørgrav #ifdef INET
11931158dfb7SGarrett Wollman 	struct sockaddr_in *sin;
1194d7647d96SDag-Erling Smørgrav #endif
119582cd038dSYoshinobu Inoue #ifdef INET6
119682cd038dSYoshinobu Inoue 	struct sockaddr_in6 *sin6;
119782cd038dSYoshinobu Inoue #endif
11981158dfb7SGarrett Wollman 	u_char *e_addr;
11991158dfb7SGarrett Wollman 
12001158dfb7SGarrett Wollman 	switch(sa->sa_family) {
12011158dfb7SGarrett Wollman 	case AF_LINK:
12027f33a738SJulian Elischer 		/*
12037f33a738SJulian Elischer 		 * No mapping needed. Just check that it's a valid MC address.
12047f33a738SJulian Elischer 		 */
12051158dfb7SGarrett Wollman 		sdl = (struct sockaddr_dl *)sa;
12061158dfb7SGarrett Wollman 		e_addr = LLADDR(sdl);
1207086e98c4SBruce M Simpson 		if (!ETHER_IS_MULTICAST(e_addr))
12081158dfb7SGarrett Wollman 			return EADDRNOTAVAIL;
1209155d72c4SPedro F. Giffuni 		*llsa = NULL;
12101158dfb7SGarrett Wollman 		return 0;
12111158dfb7SGarrett Wollman 
12121158dfb7SGarrett Wollman #ifdef INET
12131158dfb7SGarrett Wollman 	case AF_INET:
12141158dfb7SGarrett Wollman 		sin = (struct sockaddr_in *)sa;
12151158dfb7SGarrett Wollman 		if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr)))
12161158dfb7SGarrett Wollman 			return EADDRNOTAVAIL;
121795fbe4d0SAlexander V. Chernikov 		sdl = link_init_sdl(ifp, *llsa, IFT_ETHER);
12181158dfb7SGarrett Wollman 		sdl->sdl_alen = ETHER_ADDR_LEN;
12191158dfb7SGarrett Wollman 		e_addr = LLADDR(sdl);
12201158dfb7SGarrett Wollman 		ETHER_MAP_IP_MULTICAST(&sin->sin_addr, e_addr);
12211158dfb7SGarrett Wollman 		*llsa = (struct sockaddr *)sdl;
12221158dfb7SGarrett Wollman 		return 0;
12231158dfb7SGarrett Wollman #endif
122482cd038dSYoshinobu Inoue #ifdef INET6
122582cd038dSYoshinobu Inoue 	case AF_INET6:
122682cd038dSYoshinobu Inoue 		sin6 = (struct sockaddr_in6 *)sa;
1227595b8a1cSJun-ichiro itojun Hagino 		if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
1228595b8a1cSJun-ichiro itojun Hagino 			/*
1229595b8a1cSJun-ichiro itojun Hagino 			 * An IP6 address of 0 means listen to all
1230595b8a1cSJun-ichiro itojun Hagino 			 * of the Ethernet multicast address used for IP6.
1231595b8a1cSJun-ichiro itojun Hagino 			 * (This is used for multicast routers.)
1232595b8a1cSJun-ichiro itojun Hagino 			 */
1233595b8a1cSJun-ichiro itojun Hagino 			ifp->if_flags |= IFF_ALLMULTI;
1234155d72c4SPedro F. Giffuni 			*llsa = NULL;
1235595b8a1cSJun-ichiro itojun Hagino 			return 0;
1236595b8a1cSJun-ichiro itojun Hagino 		}
123782cd038dSYoshinobu Inoue 		if (!IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr))
123882cd038dSYoshinobu Inoue 			return EADDRNOTAVAIL;
123995fbe4d0SAlexander V. Chernikov 		sdl = link_init_sdl(ifp, *llsa, IFT_ETHER);
124082cd038dSYoshinobu Inoue 		sdl->sdl_alen = ETHER_ADDR_LEN;
124182cd038dSYoshinobu Inoue 		e_addr = LLADDR(sdl);
124282cd038dSYoshinobu Inoue 		ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, e_addr);
124382cd038dSYoshinobu Inoue 		*llsa = (struct sockaddr *)sdl;
124482cd038dSYoshinobu Inoue 		return 0;
124582cd038dSYoshinobu Inoue #endif
12461158dfb7SGarrett Wollman 
12471158dfb7SGarrett Wollman 	default:
12481158dfb7SGarrett Wollman 		/*
12491158dfb7SGarrett Wollman 		 * Well, the text isn't quite right, but it's the name
12501158dfb7SGarrett Wollman 		 * that counts...
12511158dfb7SGarrett Wollman 		 */
12521158dfb7SGarrett Wollman 		return EAFNOSUPPORT;
12531158dfb7SGarrett Wollman 	}
12541158dfb7SGarrett Wollman }
125540811c14SMatthew N. Dodd 
125640811c14SMatthew N. Dodd static moduledata_t ether_mod = {
1257833e8dc5SGleb Smirnoff 	.name = "ether",
125840811c14SMatthew N. Dodd };
125940811c14SMatthew N. Dodd 
126052f1277eSChristian S.J. Peron void
126152f1277eSChristian S.J. Peron ether_vlan_mtap(struct bpf_if *bp, struct mbuf *m, void *data, u_int dlen)
126252f1277eSChristian S.J. Peron {
126352f1277eSChristian S.J. Peron 	struct ether_vlan_header vlan;
126452f1277eSChristian S.J. Peron 	struct mbuf mv, mb;
126552f1277eSChristian S.J. Peron 
126652f1277eSChristian S.J. Peron 	KASSERT((m->m_flags & M_VLANTAG) != 0,
126752f1277eSChristian S.J. Peron 	    ("%s: vlan information not present", __func__));
126852f1277eSChristian S.J. Peron 	KASSERT(m->m_len >= sizeof(struct ether_header),
126952f1277eSChristian S.J. Peron 	    ("%s: mbuf not large enough for header", __func__));
127052f1277eSChristian S.J. Peron 	bcopy(mtod(m, char *), &vlan, sizeof(struct ether_header));
127152f1277eSChristian S.J. Peron 	vlan.evl_proto = vlan.evl_encap_proto;
127252f1277eSChristian S.J. Peron 	vlan.evl_encap_proto = htons(ETHERTYPE_VLAN);
127352f1277eSChristian S.J. Peron 	vlan.evl_tag = htons(m->m_pkthdr.ether_vtag);
127452f1277eSChristian S.J. Peron 	m->m_len -= sizeof(struct ether_header);
127552f1277eSChristian S.J. Peron 	m->m_data += sizeof(struct ether_header);
127652f1277eSChristian S.J. Peron 	/*
127752f1277eSChristian S.J. Peron 	 * If a data link has been supplied by the caller, then we will need to
127852f1277eSChristian S.J. Peron 	 * re-create a stack allocated mbuf chain with the following structure:
127952f1277eSChristian S.J. Peron 	 *
128052f1277eSChristian S.J. Peron 	 * (1) mbuf #1 will contain the supplied data link
128152f1277eSChristian S.J. Peron 	 * (2) mbuf #2 will contain the vlan header
128252f1277eSChristian S.J. Peron 	 * (3) mbuf #3 will contain the original mbuf's packet data
128352f1277eSChristian S.J. Peron 	 *
128452f1277eSChristian S.J. Peron 	 * Otherwise, submit the packet and vlan header via bpf_mtap2().
128552f1277eSChristian S.J. Peron 	 */
128652f1277eSChristian S.J. Peron 	if (data != NULL) {
128752f1277eSChristian S.J. Peron 		mv.m_next = m;
128852f1277eSChristian S.J. Peron 		mv.m_data = (caddr_t)&vlan;
128952f1277eSChristian S.J. Peron 		mv.m_len = sizeof(vlan);
129052f1277eSChristian S.J. Peron 		mb.m_next = &mv;
129152f1277eSChristian S.J. Peron 		mb.m_data = data;
129252f1277eSChristian S.J. Peron 		mb.m_len = dlen;
129352f1277eSChristian S.J. Peron 		bpf_mtap(bp, &mb);
129452f1277eSChristian S.J. Peron 	} else
129552f1277eSChristian S.J. Peron 		bpf_mtap2(bp, &vlan, sizeof(vlan), m);
129652f1277eSChristian S.J. Peron 	m->m_len += sizeof(struct ether_header);
129752f1277eSChristian S.J. Peron 	m->m_data -= sizeof(struct ether_header);
129852f1277eSChristian S.J. Peron }
129952f1277eSChristian S.J. Peron 
130060e87ca8SAndrew Thompson struct mbuf *
1301a0cf8186SAndrew Thompson ether_vlanencap(struct mbuf *m, uint16_t tag)
130260e87ca8SAndrew Thompson {
130360e87ca8SAndrew Thompson 	struct ether_vlan_header *evl;
130460e87ca8SAndrew Thompson 
1305eb1b1807SGleb Smirnoff 	M_PREPEND(m, ETHER_VLAN_ENCAP_LEN, M_NOWAIT);
130660e87ca8SAndrew Thompson 	if (m == NULL)
130760e87ca8SAndrew Thompson 		return (NULL);
130860e87ca8SAndrew Thompson 	/* M_PREPEND takes care of m_len, m_pkthdr.len for us */
130960e87ca8SAndrew Thompson 
131060e87ca8SAndrew Thompson 	if (m->m_len < sizeof(*evl)) {
131160e87ca8SAndrew Thompson 		m = m_pullup(m, sizeof(*evl));
131260e87ca8SAndrew Thompson 		if (m == NULL)
131360e87ca8SAndrew Thompson 			return (NULL);
131460e87ca8SAndrew Thompson 	}
131560e87ca8SAndrew Thompson 
131660e87ca8SAndrew Thompson 	/*
131760e87ca8SAndrew Thompson 	 * Transform the Ethernet header into an Ethernet header
131860e87ca8SAndrew Thompson 	 * with 802.1Q encapsulation.
131960e87ca8SAndrew Thompson 	 */
132060e87ca8SAndrew Thompson 	evl = mtod(m, struct ether_vlan_header *);
132160e87ca8SAndrew Thompson 	bcopy((char *)evl + ETHER_VLAN_ENCAP_LEN,
132260e87ca8SAndrew Thompson 	    (char *)evl, ETHER_HDR_LEN - ETHER_TYPE_LEN);
132360e87ca8SAndrew Thompson 	evl->evl_encap_proto = htons(ETHERTYPE_VLAN);
132460e87ca8SAndrew Thompson 	evl->evl_tag = htons(tag);
132560e87ca8SAndrew Thompson 	return (m);
132660e87ca8SAndrew Thompson }
132760e87ca8SAndrew Thompson 
1328f1379734SKonstantin Belousov static SYSCTL_NODE(_net_link, IFT_L2VLAN, vlan, CTLFLAG_RW, 0,
1329f1379734SKonstantin Belousov     "IEEE 802.1Q VLAN");
1330f1379734SKonstantin Belousov static SYSCTL_NODE(_net_link_vlan, PF_LINK, link, CTLFLAG_RW, 0,
1331f1379734SKonstantin Belousov     "for consistency");
1332f1379734SKonstantin Belousov 
13335f901c92SAndrew Turner VNET_DEFINE_STATIC(int, soft_pad);
1334f1379734SKonstantin Belousov #define	V_soft_pad	VNET(soft_pad)
1335f1379734SKonstantin Belousov SYSCTL_INT(_net_link_vlan, OID_AUTO, soft_pad, CTLFLAG_RW | CTLFLAG_VNET,
1336f1379734SKonstantin Belousov     &VNET_NAME(soft_pad), 0,
1337f1379734SKonstantin Belousov     "pad short frames before tagging");
1338f1379734SKonstantin Belousov 
1339f1379734SKonstantin Belousov /*
1340f1379734SKonstantin Belousov  * For now, make preserving PCP via an mbuf tag optional, as it increases
1341f1379734SKonstantin Belousov  * per-packet memory allocations and frees.  In the future, it would be
1342f1379734SKonstantin Belousov  * preferable to reuse ether_vtag for this, or similar.
1343f1379734SKonstantin Belousov  */
1344f1379734SKonstantin Belousov int vlan_mtag_pcp = 0;
1345f1379734SKonstantin Belousov SYSCTL_INT(_net_link_vlan, OID_AUTO, mtag_pcp, CTLFLAG_RW,
1346f1379734SKonstantin Belousov     &vlan_mtag_pcp, 0,
1347f1379734SKonstantin Belousov     "Retain VLAN PCP information as packets are passed up the stack");
1348f1379734SKonstantin Belousov 
1349f1379734SKonstantin Belousov bool
1350f1379734SKonstantin Belousov ether_8021q_frame(struct mbuf **mp, struct ifnet *ife, struct ifnet *p,
1351f1379734SKonstantin Belousov     uint16_t vid, uint8_t pcp)
1352f1379734SKonstantin Belousov {
1353f1379734SKonstantin Belousov 	struct m_tag *mtag;
1354f1379734SKonstantin Belousov 	int n;
1355f1379734SKonstantin Belousov 	uint16_t tag;
1356f1379734SKonstantin Belousov 	static const char pad[8];	/* just zeros */
1357f1379734SKonstantin Belousov 
1358f1379734SKonstantin Belousov 	/*
1359f1379734SKonstantin Belousov 	 * Pad the frame to the minimum size allowed if told to.
1360f1379734SKonstantin Belousov 	 * This option is in accord with IEEE Std 802.1Q, 2003 Ed.,
1361f1379734SKonstantin Belousov 	 * paragraph C.4.4.3.b.  It can help to work around buggy
1362f1379734SKonstantin Belousov 	 * bridges that violate paragraph C.4.4.3.a from the same
1363f1379734SKonstantin Belousov 	 * document, i.e., fail to pad short frames after untagging.
1364f1379734SKonstantin Belousov 	 * E.g., a tagged frame 66 bytes long (incl. FCS) is OK, but
1365f1379734SKonstantin Belousov 	 * untagging it will produce a 62-byte frame, which is a runt
1366f1379734SKonstantin Belousov 	 * and requires padding.  There are VLAN-enabled network
1367f1379734SKonstantin Belousov 	 * devices that just discard such runts instead or mishandle
1368f1379734SKonstantin Belousov 	 * them somehow.
1369f1379734SKonstantin Belousov 	 */
1370f1379734SKonstantin Belousov 	if (V_soft_pad && p->if_type == IFT_ETHER) {
1371f1379734SKonstantin Belousov 		for (n = ETHERMIN + ETHER_HDR_LEN - (*mp)->m_pkthdr.len;
1372f1379734SKonstantin Belousov 		     n > 0; n -= sizeof(pad)) {
1373f1379734SKonstantin Belousov 			if (!m_append(*mp, min(n, sizeof(pad)), pad))
1374f1379734SKonstantin Belousov 				break;
1375f1379734SKonstantin Belousov 		}
1376f1379734SKonstantin Belousov 		if (n > 0) {
1377f1379734SKonstantin Belousov 			m_freem(*mp);
1378f1379734SKonstantin Belousov 			*mp = NULL;
1379f1379734SKonstantin Belousov 			if_printf(ife, "cannot pad short frame");
1380f1379734SKonstantin Belousov 			return (false);
1381f1379734SKonstantin Belousov 		}
1382f1379734SKonstantin Belousov 	}
1383f1379734SKonstantin Belousov 
1384f1379734SKonstantin Belousov 	/*
1385f1379734SKonstantin Belousov 	 * If underlying interface can do VLAN tag insertion itself,
1386f1379734SKonstantin Belousov 	 * just pass the packet along. However, we need some way to
1387f1379734SKonstantin Belousov 	 * tell the interface where the packet came from so that it
1388f1379734SKonstantin Belousov 	 * knows how to find the VLAN tag to use, so we attach a
1389f1379734SKonstantin Belousov 	 * packet tag that holds it.
1390f1379734SKonstantin Belousov 	 */
1391f1379734SKonstantin Belousov 	if (vlan_mtag_pcp && (mtag = m_tag_locate(*mp, MTAG_8021Q,
1392f1379734SKonstantin Belousov 	    MTAG_8021Q_PCP_OUT, NULL)) != NULL)
1393f1379734SKonstantin Belousov 		tag = EVL_MAKETAG(vid, *(uint8_t *)(mtag + 1), 0);
1394f1379734SKonstantin Belousov 	else
1395f1379734SKonstantin Belousov 		tag = EVL_MAKETAG(vid, pcp, 0);
1396f1379734SKonstantin Belousov 	if (p->if_capenable & IFCAP_VLAN_HWTAGGING) {
1397f1379734SKonstantin Belousov 		(*mp)->m_pkthdr.ether_vtag = tag;
1398f1379734SKonstantin Belousov 		(*mp)->m_flags |= M_VLANTAG;
1399f1379734SKonstantin Belousov 	} else {
1400f1379734SKonstantin Belousov 		*mp = ether_vlanencap(*mp, tag);
1401f1379734SKonstantin Belousov 		if (*mp == NULL) {
1402f1379734SKonstantin Belousov 			if_printf(ife, "unable to prepend 802.1Q header");
1403f1379734SKonstantin Belousov 			return (false);
1404f1379734SKonstantin Belousov 		}
1405f1379734SKonstantin Belousov 	}
1406f1379734SKonstantin Belousov 	return (true);
1407f1379734SKonstantin Belousov }
1408f1379734SKonstantin Belousov 
14096b7e0c1cSKyle Evans /*
1410*3c3aa8c1SKyle Evans  * Allocate an address from the FreeBSD Foundation OUI.  This uses a
1411*3c3aa8c1SKyle Evans  * cryptographic hash function on the containing jail's UUID and the interface
1412*3c3aa8c1SKyle Evans  * name to attempt to provide a unique but stable address.  Pseudo-interfaces
1413*3c3aa8c1SKyle Evans  * which require a MAC address should use this function to allocate
1414*3c3aa8c1SKyle Evans  * non-locally-administered addresses.
14156b7e0c1cSKyle Evans  */
1416*3c3aa8c1SKyle Evans void
1417*3c3aa8c1SKyle Evans ether_gen_addr(struct ifnet *ifp, struct ether_addr *hwaddr)
1418*3c3aa8c1SKyle Evans {
1419*3c3aa8c1SKyle Evans #define	ETHER_GEN_ADDR_BUFSIZ	HOSTUUIDLEN + IFNAMSIZ + 2
1420*3c3aa8c1SKyle Evans 	SHA1_CTX ctx;
1421*3c3aa8c1SKyle Evans 	char buf[ETHER_GEN_ADDR_BUFSIZ];
1422*3c3aa8c1SKyle Evans 	char uuid[HOSTUUIDLEN + 1];
1423*3c3aa8c1SKyle Evans 	uint64_t addr;
1424*3c3aa8c1SKyle Evans 	int i, sz;
1425*3c3aa8c1SKyle Evans 	char digest[SHA1_RESULTLEN];
1426*3c3aa8c1SKyle Evans 
1427*3c3aa8c1SKyle Evans 	getcredhostuuid(curthread->td_ucred, uuid, sizeof(uuid));
1428*3c3aa8c1SKyle Evans 	sz = snprintf(buf, ETHER_GEN_ADDR_BUFSIZ, "%s-%s", uuid, ifp->if_xname);
1429*3c3aa8c1SKyle Evans 	SHA1Init(&ctx);
1430*3c3aa8c1SKyle Evans 	SHA1Update(&ctx, buf, sz);
1431*3c3aa8c1SKyle Evans 	SHA1Final(digest, &ctx);
1432*3c3aa8c1SKyle Evans 
1433*3c3aa8c1SKyle Evans 	addr = ((digest[0] << 16) | (digest[1] << 8) | digest[2]) &
1434*3c3aa8c1SKyle Evans 	    OUI_FREEBSD_GENERATED_MASK;
1435*3c3aa8c1SKyle Evans 	addr = OUI_FREEBSD(addr);
1436*3c3aa8c1SKyle Evans 	for (i = 0; i < ETHER_ADDR_LEN; ++i) {
1437*3c3aa8c1SKyle Evans 		hwaddr->octet[i] = addr >> ((ETHER_ADDR_LEN - i - 1) * 8) &
1438*3c3aa8c1SKyle Evans 		    0xFF;
1439*3c3aa8c1SKyle Evans 	}
14406b7e0c1cSKyle Evans }
14416b7e0c1cSKyle Evans 
1442fc74a9f9SBrooks Davis DECLARE_MODULE(ether, ether_mod, SI_SUB_INIT_IF, SI_ORDER_ANY);
144340811c14SMatthew N. Dodd MODULE_VERSION(ether, 1);
1444