xref: /xnu-11215.1.10/bsd/net/ether_if_module.c (revision 8d741a5de7ff4191bf97d57b9f54c2f6d4a15585)
1*8d741a5dSApple OSS Distributions /*
2*8d741a5dSApple OSS Distributions  * Copyright (c) 2000-2024 Apple Inc. All rights reserved.
3*8d741a5dSApple OSS Distributions  *
4*8d741a5dSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*8d741a5dSApple OSS Distributions  *
6*8d741a5dSApple OSS Distributions  * This file contains Original Code and/or Modifications of Original Code
7*8d741a5dSApple OSS Distributions  * as defined in and that are subject to the Apple Public Source License
8*8d741a5dSApple OSS Distributions  * Version 2.0 (the 'License'). You may not use this file except in
9*8d741a5dSApple OSS Distributions  * compliance with the License. The rights granted to you under the License
10*8d741a5dSApple OSS Distributions  * may not be used to create, or enable the creation or redistribution of,
11*8d741a5dSApple OSS Distributions  * unlawful or unlicensed copies of an Apple operating system, or to
12*8d741a5dSApple OSS Distributions  * circumvent, violate, or enable the circumvention or violation of, any
13*8d741a5dSApple OSS Distributions  * terms of an Apple operating system software license agreement.
14*8d741a5dSApple OSS Distributions  *
15*8d741a5dSApple OSS Distributions  * Please obtain a copy of the License at
16*8d741a5dSApple OSS Distributions  * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*8d741a5dSApple OSS Distributions  *
18*8d741a5dSApple OSS Distributions  * The Original Code and all software distributed under the License are
19*8d741a5dSApple OSS Distributions  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*8d741a5dSApple OSS Distributions  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*8d741a5dSApple OSS Distributions  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*8d741a5dSApple OSS Distributions  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*8d741a5dSApple OSS Distributions  * Please see the License for the specific language governing rights and
24*8d741a5dSApple OSS Distributions  * limitations under the License.
25*8d741a5dSApple OSS Distributions  *
26*8d741a5dSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*8d741a5dSApple OSS Distributions  */
28*8d741a5dSApple OSS Distributions /*
29*8d741a5dSApple OSS Distributions  * Copyright (c) 1982, 1989, 1993
30*8d741a5dSApple OSS Distributions  *	The Regents of the University of California.  All rights reserved.
31*8d741a5dSApple OSS Distributions  *
32*8d741a5dSApple OSS Distributions  * Redistribution and use in source and binary forms, with or without
33*8d741a5dSApple OSS Distributions  * modification, are permitted provided that the following conditions
34*8d741a5dSApple OSS Distributions  * are met:
35*8d741a5dSApple OSS Distributions  * 1. Redistributions of source code must retain the above copyright
36*8d741a5dSApple OSS Distributions  *    notice, this list of conditions and the following disclaimer.
37*8d741a5dSApple OSS Distributions  * 2. Redistributions in binary form must reproduce the above copyright
38*8d741a5dSApple OSS Distributions  *    notice, this list of conditions and the following disclaimer in the
39*8d741a5dSApple OSS Distributions  *    documentation and/or other materials provided with the distribution.
40*8d741a5dSApple OSS Distributions  * 3. All advertising materials mentioning features or use of this software
41*8d741a5dSApple OSS Distributions  *    must display the following acknowledgement:
42*8d741a5dSApple OSS Distributions  *	This product includes software developed by the University of
43*8d741a5dSApple OSS Distributions  *	California, Berkeley and its contributors.
44*8d741a5dSApple OSS Distributions  * 4. Neither the name of the University nor the names of its contributors
45*8d741a5dSApple OSS Distributions  *    may be used to endorse or promote products derived from this software
46*8d741a5dSApple OSS Distributions  *    without specific prior written permission.
47*8d741a5dSApple OSS Distributions  *
48*8d741a5dSApple OSS Distributions  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
49*8d741a5dSApple OSS Distributions  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
50*8d741a5dSApple OSS Distributions  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
51*8d741a5dSApple OSS Distributions  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
52*8d741a5dSApple OSS Distributions  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
53*8d741a5dSApple OSS Distributions  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
54*8d741a5dSApple OSS Distributions  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
55*8d741a5dSApple OSS Distributions  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
56*8d741a5dSApple OSS Distributions  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
57*8d741a5dSApple OSS Distributions  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
58*8d741a5dSApple OSS Distributions  * SUCH DAMAGE.
59*8d741a5dSApple OSS Distributions  *
60*8d741a5dSApple OSS Distributions  */
61*8d741a5dSApple OSS Distributions 
62*8d741a5dSApple OSS Distributions #include <sys/param.h>
63*8d741a5dSApple OSS Distributions #include <sys/systm.h>
64*8d741a5dSApple OSS Distributions #include <sys/kernel.h>
65*8d741a5dSApple OSS Distributions #include <sys/malloc.h>
66*8d741a5dSApple OSS Distributions #include <sys/mbuf.h>
67*8d741a5dSApple OSS Distributions #include <sys/socket.h>
68*8d741a5dSApple OSS Distributions #include <sys/sockio.h>
69*8d741a5dSApple OSS Distributions #include <sys/sysctl.h>
70*8d741a5dSApple OSS Distributions 
71*8d741a5dSApple OSS Distributions #include <pexpert/pexpert.h>
72*8d741a5dSApple OSS Distributions 
73*8d741a5dSApple OSS Distributions #define etherbroadcastaddr      fugly
74*8d741a5dSApple OSS Distributions #include <net/if.h>
75*8d741a5dSApple OSS Distributions #include <net/route.h>
76*8d741a5dSApple OSS Distributions #include <net/if_private.h>
77*8d741a5dSApple OSS Distributions #include <net/if_llc.h>
78*8d741a5dSApple OSS Distributions #include <net/if_dl.h>
79*8d741a5dSApple OSS Distributions #include <net/if_types.h>
80*8d741a5dSApple OSS Distributions #include <net/if_ether.h>
81*8d741a5dSApple OSS Distributions #include <net/if_gif.h>
82*8d741a5dSApple OSS Distributions #include <netinet/if_ether.h>
83*8d741a5dSApple OSS Distributions #include <netinet/in.h> /* For M_LOOP */
84*8d741a5dSApple OSS Distributions #include <net/kpi_interface.h>
85*8d741a5dSApple OSS Distributions #include <net/kpi_protocol.h>
86*8d741a5dSApple OSS Distributions #undef etherbroadcastaddr
87*8d741a5dSApple OSS Distributions 
88*8d741a5dSApple OSS Distributions /*
89*8d741a5dSApple OSS Distributions  #if INET
90*8d741a5dSApple OSS Distributions  #include <netinet/in.h>
91*8d741a5dSApple OSS Distributions  #include <netinet/in_var.h>
92*8d741a5dSApple OSS Distributions  *
93*8d741a5dSApple OSS Distributions  #include <netinet/in_systm.h>
94*8d741a5dSApple OSS Distributions  #include <netinet/ip.h>
95*8d741a5dSApple OSS Distributions  #endif
96*8d741a5dSApple OSS Distributions  */
97*8d741a5dSApple OSS Distributions #include <net/ether_if_module.h>
98*8d741a5dSApple OSS Distributions #include <sys/socketvar.h>
99*8d741a5dSApple OSS Distributions #include <net/if_vlan_var.h>
100*8d741a5dSApple OSS Distributions #if BOND
101*8d741a5dSApple OSS Distributions #include <net/if_bond_internal.h>
102*8d741a5dSApple OSS Distributions #endif /* BOND */
103*8d741a5dSApple OSS Distributions #if IF_BRIDGE
104*8d741a5dSApple OSS Distributions #include <net/if_bridgevar.h>
105*8d741a5dSApple OSS Distributions #endif /* IF_BRIDGE */
106*8d741a5dSApple OSS Distributions #if IF_FAKE
107*8d741a5dSApple OSS Distributions #include <net/if_fake_var.h>
108*8d741a5dSApple OSS Distributions #endif /* IF_FAKE */
109*8d741a5dSApple OSS Distributions #if IF_HEADLESS
110*8d741a5dSApple OSS Distributions extern void if_headless_init(void);
111*8d741a5dSApple OSS Distributions #endif /* IF_HEADLESS */
112*8d741a5dSApple OSS Distributions 
113*8d741a5dSApple OSS Distributions #include <net/dlil.h>
114*8d741a5dSApple OSS Distributions 
115*8d741a5dSApple OSS Distributions #include <net/sockaddr_utils.h>
116*8d741a5dSApple OSS Distributions 
117*8d741a5dSApple OSS Distributions SYSCTL_DECL(_net_link);
118*8d741a5dSApple OSS Distributions SYSCTL_NODE(_net_link, IFT_ETHER, ether, CTLFLAG_RW | CTLFLAG_LOCKED, 0,
119*8d741a5dSApple OSS Distributions     "Ethernet");
120*8d741a5dSApple OSS Distributions 
121*8d741a5dSApple OSS Distributions struct en_desc {
122*8d741a5dSApple OSS Distributions 	u_int16_t type;                 /* Type of protocol stored in data */
123*8d741a5dSApple OSS Distributions 	u_int32_t protocol_family;      /* Protocol family */
124*8d741a5dSApple OSS Distributions 	u_int32_t data[2];              /* Protocol data */
125*8d741a5dSApple OSS Distributions };
126*8d741a5dSApple OSS Distributions 
127*8d741a5dSApple OSS Distributions /* descriptors are allocated in blocks of ETHER_DESC_BLK_SIZE */
128*8d741a5dSApple OSS Distributions #if !XNU_TARGET_OS_OSX
129*8d741a5dSApple OSS Distributions #define ETHER_DESC_BLK_SIZE (2) /* IP, ARP */
130*8d741a5dSApple OSS Distributions #else /* XNU_TARGET_OS_OSX */
131*8d741a5dSApple OSS Distributions #define ETHER_DESC_BLK_SIZE (10)
132*8d741a5dSApple OSS Distributions #endif /* XNU_TARGET_OS_OSX */
133*8d741a5dSApple OSS Distributions 
134*8d741a5dSApple OSS Distributions /*
135*8d741a5dSApple OSS Distributions  * Header for the demux list, hangs off of IFP at if_family_cookie
136*8d741a5dSApple OSS Distributions  */
137*8d741a5dSApple OSS Distributions struct ether_desc_blk_str {
138*8d741a5dSApple OSS Distributions 	u_int32_t       n_max_used;
139*8d741a5dSApple OSS Distributions 	u_int32_t       n_count;
140*8d741a5dSApple OSS Distributions 	u_int32_t       n_used;
141*8d741a5dSApple OSS Distributions 	struct en_desc  block_ptr[__counted_by(n_count)];
142*8d741a5dSApple OSS Distributions };
143*8d741a5dSApple OSS Distributions 
144*8d741a5dSApple OSS Distributions static inline
145*8d741a5dSApple OSS Distributions struct ether_desc_blk_str * __single
ifnet_ether_blk_str(struct ifnet * ifp)146*8d741a5dSApple OSS Distributions ifnet_ether_blk_str(struct ifnet *ifp)
147*8d741a5dSApple OSS Distributions {
148*8d741a5dSApple OSS Distributions 	return ifp == NULL
149*8d741a5dSApple OSS Distributions 	       ? NULL
150*8d741a5dSApple OSS Distributions 	       : __unsafe_forge_single(struct ether_desc_blk_str *, ifp->if_family_cookie);
151*8d741a5dSApple OSS Distributions }
152*8d741a5dSApple OSS Distributions 
153*8d741a5dSApple OSS Distributions /* Size of the above struct before the array of struct en_desc */
154*8d741a5dSApple OSS Distributions #define ETHER_DESC_HEADER_SIZE  \
155*8d741a5dSApple OSS Distributions 	((size_t) offsetof(struct ether_desc_blk_str, block_ptr))
156*8d741a5dSApple OSS Distributions 
157*8d741a5dSApple OSS Distributions __private_extern__ u_char etherbroadcastaddr[ETHER_ADDR_LEN] =
158*8d741a5dSApple OSS Distributions { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
159*8d741a5dSApple OSS Distributions 
160*8d741a5dSApple OSS Distributions /*
161*8d741a5dSApple OSS Distributions  * Release all descriptor entries owned by this protocol (there may be several).
162*8d741a5dSApple OSS Distributions  * Setting the type to 0 releases the entry. Eventually we should compact-out
163*8d741a5dSApple OSS Distributions  * the unused entries.
164*8d741a5dSApple OSS Distributions  */
165*8d741a5dSApple OSS Distributions int
ether_del_proto(ifnet_t ifp,protocol_family_t protocol_family)166*8d741a5dSApple OSS Distributions ether_del_proto(ifnet_t ifp, protocol_family_t protocol_family)
167*8d741a5dSApple OSS Distributions {
168*8d741a5dSApple OSS Distributions 	struct ether_desc_blk_str *desc_blk = ifnet_ether_blk_str(ifp);
169*8d741a5dSApple OSS Distributions 	u_int32_t current = 0;
170*8d741a5dSApple OSS Distributions 	int found = 0;
171*8d741a5dSApple OSS Distributions 
172*8d741a5dSApple OSS Distributions 	if (desc_blk == NULL) {
173*8d741a5dSApple OSS Distributions 		return 0;
174*8d741a5dSApple OSS Distributions 	}
175*8d741a5dSApple OSS Distributions 
176*8d741a5dSApple OSS Distributions 	for (current = desc_blk->n_max_used; current > 0; current--) {
177*8d741a5dSApple OSS Distributions 		if (desc_blk->block_ptr[current - 1].protocol_family ==
178*8d741a5dSApple OSS Distributions 		    protocol_family) {
179*8d741a5dSApple OSS Distributions 			found = 1;
180*8d741a5dSApple OSS Distributions 			desc_blk->block_ptr[current - 1].type = 0;
181*8d741a5dSApple OSS Distributions 			desc_blk->n_used--;
182*8d741a5dSApple OSS Distributions 		}
183*8d741a5dSApple OSS Distributions 	}
184*8d741a5dSApple OSS Distributions 
185*8d741a5dSApple OSS Distributions 	if (desc_blk->n_used == 0) {
186*8d741a5dSApple OSS Distributions 		u_int32_t size = desc_blk->n_count * sizeof(struct en_desc) +
187*8d741a5dSApple OSS Distributions 		    ETHER_DESC_HEADER_SIZE;
188*8d741a5dSApple OSS Distributions 		kfree_data(desc_blk, size);
189*8d741a5dSApple OSS Distributions 		ifp->if_family_cookie = 0;
190*8d741a5dSApple OSS Distributions 	} else {
191*8d741a5dSApple OSS Distributions 		/* Decrement n_max_used */
192*8d741a5dSApple OSS Distributions 		for (; desc_blk->n_max_used > 0 &&
193*8d741a5dSApple OSS Distributions 		    desc_blk->block_ptr[desc_blk->n_max_used - 1].type == 0;
194*8d741a5dSApple OSS Distributions 		    desc_blk->n_max_used--) {
195*8d741a5dSApple OSS Distributions 			;
196*8d741a5dSApple OSS Distributions 		}
197*8d741a5dSApple OSS Distributions 	}
198*8d741a5dSApple OSS Distributions 
199*8d741a5dSApple OSS Distributions 	return 0;
200*8d741a5dSApple OSS Distributions }
201*8d741a5dSApple OSS Distributions 
202*8d741a5dSApple OSS Distributions static int
ether_add_proto_internal(struct ifnet * ifp,protocol_family_t protocol,const struct ifnet_demux_desc * demux)203*8d741a5dSApple OSS Distributions ether_add_proto_internal(struct ifnet *ifp, protocol_family_t protocol,
204*8d741a5dSApple OSS Distributions     const struct ifnet_demux_desc *demux)
205*8d741a5dSApple OSS Distributions {
206*8d741a5dSApple OSS Distributions 	struct en_desc *ed;
207*8d741a5dSApple OSS Distributions 	struct ether_desc_blk_str *desc_blk = ifnet_ether_blk_str(ifp);
208*8d741a5dSApple OSS Distributions 	u_int32_t i;
209*8d741a5dSApple OSS Distributions 
210*8d741a5dSApple OSS Distributions 	switch (demux->type) {
211*8d741a5dSApple OSS Distributions 	/* These types are supported */
212*8d741a5dSApple OSS Distributions 	/* Top three are preferred */
213*8d741a5dSApple OSS Distributions 	case DLIL_DESC_ETYPE2:
214*8d741a5dSApple OSS Distributions 		if (demux->datalen != 2) {
215*8d741a5dSApple OSS Distributions 			return EINVAL;
216*8d741a5dSApple OSS Distributions 		}
217*8d741a5dSApple OSS Distributions 		break;
218*8d741a5dSApple OSS Distributions 
219*8d741a5dSApple OSS Distributions 	case DLIL_DESC_SAP:
220*8d741a5dSApple OSS Distributions 		if (demux->datalen != 3) {
221*8d741a5dSApple OSS Distributions 			return EINVAL;
222*8d741a5dSApple OSS Distributions 		}
223*8d741a5dSApple OSS Distributions 		break;
224*8d741a5dSApple OSS Distributions 
225*8d741a5dSApple OSS Distributions 	case DLIL_DESC_SNAP:
226*8d741a5dSApple OSS Distributions 		if (demux->datalen != 5) {
227*8d741a5dSApple OSS Distributions 			return EINVAL;
228*8d741a5dSApple OSS Distributions 		}
229*8d741a5dSApple OSS Distributions 		break;
230*8d741a5dSApple OSS Distributions 
231*8d741a5dSApple OSS Distributions 	default:
232*8d741a5dSApple OSS Distributions 		return ENOTSUP;
233*8d741a5dSApple OSS Distributions 	}
234*8d741a5dSApple OSS Distributions 
235*8d741a5dSApple OSS Distributions 	/* Verify a matching descriptor does not exist */
236*8d741a5dSApple OSS Distributions 	if (desc_blk != NULL) {
237*8d741a5dSApple OSS Distributions 		switch (demux->type) {
238*8d741a5dSApple OSS Distributions 		case DLIL_DESC_ETYPE2:
239*8d741a5dSApple OSS Distributions 			for (i = 0; i < desc_blk->n_max_used; i++) {
240*8d741a5dSApple OSS Distributions 				if (desc_blk->block_ptr[i].type ==
241*8d741a5dSApple OSS Distributions 				    DLIL_DESC_ETYPE2 &&
242*8d741a5dSApple OSS Distributions 				    desc_blk->block_ptr[i].data[0] ==
243*8d741a5dSApple OSS Distributions 				    *(u_int16_t*)demux->data) {
244*8d741a5dSApple OSS Distributions 					return EADDRINUSE;
245*8d741a5dSApple OSS Distributions 				}
246*8d741a5dSApple OSS Distributions 			}
247*8d741a5dSApple OSS Distributions 			break;
248*8d741a5dSApple OSS Distributions 		case DLIL_DESC_SAP:
249*8d741a5dSApple OSS Distributions 		case DLIL_DESC_SNAP:
250*8d741a5dSApple OSS Distributions 			for (i = 0; i < desc_blk->n_max_used; i++) {
251*8d741a5dSApple OSS Distributions 				if (desc_blk->block_ptr[i].type == demux->type &&
252*8d741a5dSApple OSS Distributions 				    bcmp(desc_blk->block_ptr[i].data,
253*8d741a5dSApple OSS Distributions 				    demux->data, demux->datalen) == 0) {
254*8d741a5dSApple OSS Distributions 					return EADDRINUSE;
255*8d741a5dSApple OSS Distributions 				}
256*8d741a5dSApple OSS Distributions 			}
257*8d741a5dSApple OSS Distributions 			break;
258*8d741a5dSApple OSS Distributions 		}
259*8d741a5dSApple OSS Distributions 	}
260*8d741a5dSApple OSS Distributions 
261*8d741a5dSApple OSS Distributions 	/* Check for case where all of the descriptor blocks are in use */
262*8d741a5dSApple OSS Distributions 	if (desc_blk == NULL || desc_blk->n_used == desc_blk->n_count) {
263*8d741a5dSApple OSS Distributions 		struct ether_desc_blk_str *tmp;
264*8d741a5dSApple OSS Distributions 		u_int32_t new_count = ETHER_DESC_BLK_SIZE;
265*8d741a5dSApple OSS Distributions 		u_int32_t new_size;
266*8d741a5dSApple OSS Distributions 		u_int32_t old_size = 0;
267*8d741a5dSApple OSS Distributions 
268*8d741a5dSApple OSS Distributions 		i = 0;
269*8d741a5dSApple OSS Distributions 
270*8d741a5dSApple OSS Distributions 		if (desc_blk) {
271*8d741a5dSApple OSS Distributions 			new_count += desc_blk->n_count;
272*8d741a5dSApple OSS Distributions 			old_size = desc_blk->n_count * sizeof(struct en_desc) +
273*8d741a5dSApple OSS Distributions 			    ETHER_DESC_HEADER_SIZE;
274*8d741a5dSApple OSS Distributions 			i = desc_blk->n_used;
275*8d741a5dSApple OSS Distributions 		}
276*8d741a5dSApple OSS Distributions 
277*8d741a5dSApple OSS Distributions 		new_size = new_count * sizeof(struct en_desc) +
278*8d741a5dSApple OSS Distributions 		    ETHER_DESC_HEADER_SIZE;
279*8d741a5dSApple OSS Distributions 
280*8d741a5dSApple OSS Distributions 		tmp = (struct ether_desc_blk_str *)kalloc_data(new_size, Z_WAITOK);
281*8d741a5dSApple OSS Distributions 		if (tmp == NULL) {
282*8d741a5dSApple OSS Distributions 			/*
283*8d741a5dSApple OSS Distributions 			 * Remove any previous descriptors set in the call.
284*8d741a5dSApple OSS Distributions 			 */
285*8d741a5dSApple OSS Distributions 			return ENOMEM;
286*8d741a5dSApple OSS Distributions 		}
287*8d741a5dSApple OSS Distributions 
288*8d741a5dSApple OSS Distributions 		bzero(((char *)tmp) + old_size, new_size - old_size);
289*8d741a5dSApple OSS Distributions 		if (desc_blk) {
290*8d741a5dSApple OSS Distributions 			bcopy(desc_blk, tmp, old_size);
291*8d741a5dSApple OSS Distributions 			kfree_data(desc_blk, old_size);
292*8d741a5dSApple OSS Distributions 		}
293*8d741a5dSApple OSS Distributions 		desc_blk = tmp;
294*8d741a5dSApple OSS Distributions 		ifp->if_family_cookie = (uintptr_t)desc_blk;
295*8d741a5dSApple OSS Distributions 		desc_blk->n_count = new_count;
296*8d741a5dSApple OSS Distributions 	} else {
297*8d741a5dSApple OSS Distributions 		/* Find a free entry */
298*8d741a5dSApple OSS Distributions 		for (i = 0; i < desc_blk->n_count; i++) {
299*8d741a5dSApple OSS Distributions 			if (desc_blk->block_ptr[i].type == 0) {
300*8d741a5dSApple OSS Distributions 				break;
301*8d741a5dSApple OSS Distributions 			}
302*8d741a5dSApple OSS Distributions 		}
303*8d741a5dSApple OSS Distributions 	}
304*8d741a5dSApple OSS Distributions 
305*8d741a5dSApple OSS Distributions 	/* Bump n_max_used if appropriate */
306*8d741a5dSApple OSS Distributions 	if (i + 1 > desc_blk->n_max_used) {
307*8d741a5dSApple OSS Distributions 		desc_blk->n_max_used = i + 1;
308*8d741a5dSApple OSS Distributions 	}
309*8d741a5dSApple OSS Distributions 
310*8d741a5dSApple OSS Distributions 	ed = &desc_blk->block_ptr[i];
311*8d741a5dSApple OSS Distributions 	ed->protocol_family = protocol;
312*8d741a5dSApple OSS Distributions 	ed->data[0] = 0;
313*8d741a5dSApple OSS Distributions 	ed->data[1] = 0;
314*8d741a5dSApple OSS Distributions 
315*8d741a5dSApple OSS Distributions 	switch (demux->type) {
316*8d741a5dSApple OSS Distributions 	case DLIL_DESC_ETYPE2:
317*8d741a5dSApple OSS Distributions 		/* 2 byte ethernet raw protocol type is at native_type */
318*8d741a5dSApple OSS Distributions 		/* prtocol must be in network byte order */
319*8d741a5dSApple OSS Distributions 		ed->type = DLIL_DESC_ETYPE2;
320*8d741a5dSApple OSS Distributions 		ed->data[0] = *(u_int16_t*)demux->data;
321*8d741a5dSApple OSS Distributions 		break;
322*8d741a5dSApple OSS Distributions 
323*8d741a5dSApple OSS Distributions 	case DLIL_DESC_SAP:
324*8d741a5dSApple OSS Distributions 		ed->type = DLIL_DESC_SAP;
325*8d741a5dSApple OSS Distributions 		bcopy(demux->data, &ed->data[0], 3);
326*8d741a5dSApple OSS Distributions 		break;
327*8d741a5dSApple OSS Distributions 
328*8d741a5dSApple OSS Distributions 	case DLIL_DESC_SNAP: {
329*8d741a5dSApple OSS Distributions 		u_int8_t*       pDest = ((u_int8_t*)&ed->data[0]) + 3;
330*8d741a5dSApple OSS Distributions 		ed->type = DLIL_DESC_SNAP;
331*8d741a5dSApple OSS Distributions 		bcopy(demux->data, pDest, 5);
332*8d741a5dSApple OSS Distributions 		break;
333*8d741a5dSApple OSS Distributions 	}
334*8d741a5dSApple OSS Distributions 	}
335*8d741a5dSApple OSS Distributions 
336*8d741a5dSApple OSS Distributions 	desc_blk->n_used++;
337*8d741a5dSApple OSS Distributions 
338*8d741a5dSApple OSS Distributions 	return 0;
339*8d741a5dSApple OSS Distributions }
340*8d741a5dSApple OSS Distributions 
341*8d741a5dSApple OSS Distributions int
ether_add_proto(ifnet_t ifp,protocol_family_t protocol,const struct ifnet_demux_desc * demux_list __counted_by (demux_count),u_int32_t demux_count)342*8d741a5dSApple OSS Distributions ether_add_proto(ifnet_t  ifp, protocol_family_t protocol,
343*8d741a5dSApple OSS Distributions     const struct ifnet_demux_desc *demux_list __counted_by(demux_count), u_int32_t demux_count)
344*8d741a5dSApple OSS Distributions {
345*8d741a5dSApple OSS Distributions 	int error = 0;
346*8d741a5dSApple OSS Distributions 	u_int32_t i;
347*8d741a5dSApple OSS Distributions 
348*8d741a5dSApple OSS Distributions 	for (i = 0; i < demux_count; i++) {
349*8d741a5dSApple OSS Distributions 		error = ether_add_proto_internal(ifp, protocol, &demux_list[i]);
350*8d741a5dSApple OSS Distributions 		if (error) {
351*8d741a5dSApple OSS Distributions 			ether_del_proto(ifp, protocol);
352*8d741a5dSApple OSS Distributions 			break;
353*8d741a5dSApple OSS Distributions 		}
354*8d741a5dSApple OSS Distributions 	}
355*8d741a5dSApple OSS Distributions 
356*8d741a5dSApple OSS Distributions 	return error;
357*8d741a5dSApple OSS Distributions }
358*8d741a5dSApple OSS Distributions 
359*8d741a5dSApple OSS Distributions static void
_mbuf_adjust_pkthdr_and_data(mbuf_t m,int len)360*8d741a5dSApple OSS Distributions _mbuf_adjust_pkthdr_and_data(mbuf_t m, int len)
361*8d741a5dSApple OSS Distributions {
362*8d741a5dSApple OSS Distributions 	mbuf_setdata(m, mtodo(m, len), mbuf_len(m) - len);
363*8d741a5dSApple OSS Distributions 	mbuf_pkthdr_adjustlen(m, -len);
364*8d741a5dSApple OSS Distributions }
365*8d741a5dSApple OSS Distributions 
366*8d741a5dSApple OSS Distributions static bool
ether_remove_vlan_encapsulation(ifnet_t ifp,mbuf_t m,char * frame_header,uint16_t * tag_p,uint16_t * ether_type_p)367*8d741a5dSApple OSS Distributions ether_remove_vlan_encapsulation(ifnet_t ifp, mbuf_t m, char * frame_header,
368*8d741a5dSApple OSS Distributions     uint16_t * tag_p, uint16_t * ether_type_p)
369*8d741a5dSApple OSS Distributions {
370*8d741a5dSApple OSS Distributions 	struct ether_header *           eh_p;
371*8d741a5dSApple OSS Distributions 	struct ether_vlan_encap_header  encap;
372*8d741a5dSApple OSS Distributions 	struct ether_header             new_eh;
373*8d741a5dSApple OSS Distributions 	bool                            success = false;
374*8d741a5dSApple OSS Distributions 
375*8d741a5dSApple OSS Distributions 	if (m->m_pkthdr.len < ETHER_VLAN_ENCAP_LEN) {
376*8d741a5dSApple OSS Distributions 		os_log_debug(OS_LOG_DEFAULT,
377*8d741a5dSApple OSS Distributions 		    "%s: dropping short VLAN packet %d < %d",
378*8d741a5dSApple OSS Distributions 		    ifp->if_xname, m->m_pkthdr.len,
379*8d741a5dSApple OSS Distributions 		    ETHER_VLAN_ENCAP_LEN);
380*8d741a5dSApple OSS Distributions 		goto done;
381*8d741a5dSApple OSS Distributions 	}
382*8d741a5dSApple OSS Distributions 	if (frame_header < (char *)mbuf_datastart(m) ||
383*8d741a5dSApple OSS Distributions 	    frame_header > mtod(m, char *)) {
384*8d741a5dSApple OSS Distributions 		os_log_debug(OS_LOG_DEFAULT,
385*8d741a5dSApple OSS Distributions 		    "%s: dropping VLAN non-contiguous header %p, %p",
386*8d741a5dSApple OSS Distributions 		    ifp->if_xname, mbuf_data(m), frame_header);
387*8d741a5dSApple OSS Distributions 		goto done;
388*8d741a5dSApple OSS Distributions 	}
389*8d741a5dSApple OSS Distributions 	/*
390*8d741a5dSApple OSS Distributions 	 * Remove the VLAN encapsulation header by shifting the
391*8d741a5dSApple OSS Distributions 	 * ethernet destination and source addresses over by the
392*8d741a5dSApple OSS Distributions 	 * encapsulation header length (4 bytes).
393*8d741a5dSApple OSS Distributions 	 */
394*8d741a5dSApple OSS Distributions 
395*8d741a5dSApple OSS Distributions 	/* copy the VLAN encapsulation header (4 bytes) */
396*8d741a5dSApple OSS Distributions 	if (mbuf_copydata(m, 0, sizeof(encap), (caddr_t)&encap) != 0) {
397*8d741a5dSApple OSS Distributions 		os_log_debug(OS_LOG_DEFAULT,
398*8d741a5dSApple OSS Distributions 		    "%s: mbuf_copydata VLAN encap failed",
399*8d741a5dSApple OSS Distributions 		    ifp->if_xname);
400*8d741a5dSApple OSS Distributions 		goto done;
401*8d741a5dSApple OSS Distributions 	}
402*8d741a5dSApple OSS Distributions 
403*8d741a5dSApple OSS Distributions 	/* create the new ethernet header with encapsulated proto */
404*8d741a5dSApple OSS Distributions 	eh_p = (struct ether_header *)(void *)
405*8d741a5dSApple OSS Distributions 	    (m_mtod_lower_bound(m) + (frame_header - m_mtod_lower_bound(m)));
406*8d741a5dSApple OSS Distributions 	new_eh = *eh_p;
407*8d741a5dSApple OSS Distributions 	*ether_type_p = new_eh.ether_type = encap.evle_proto;
408*8d741a5dSApple OSS Distributions 
409*8d741a5dSApple OSS Distributions 	/* rollback to new ethernet header start (backward 10 bytes) */
410*8d741a5dSApple OSS Distributions #define ETHER_VLAN_ADJUST_HEADER      (ETHER_HDR_LEN - ETHER_VLAN_ENCAP_LEN)
411*8d741a5dSApple OSS Distributions 	_mbuf_adjust_pkthdr_and_data(m, -ETHER_VLAN_ADJUST_HEADER);
412*8d741a5dSApple OSS Distributions 
413*8d741a5dSApple OSS Distributions 	/* write new ether header */
414*8d741a5dSApple OSS Distributions 	if (mbuf_copyback(m, 0, sizeof(new_eh), &new_eh, MBUF_DONTWAIT) != 0) {
415*8d741a5dSApple OSS Distributions 		os_log_debug(OS_LOG_DEFAULT,
416*8d741a5dSApple OSS Distributions 		    "%s: mbuf_copyback VLAN stripped header failed",
417*8d741a5dSApple OSS Distributions 		    ifp->if_xname);
418*8d741a5dSApple OSS Distributions 		goto done;
419*8d741a5dSApple OSS Distributions 	}
420*8d741a5dSApple OSS Distributions 
421*8d741a5dSApple OSS Distributions 	/* set new frame header */
422*8d741a5dSApple OSS Distributions 	mbuf_pkthdr_setheader(m, mtod(m, void *));
423*8d741a5dSApple OSS Distributions 
424*8d741a5dSApple OSS Distributions 	/* skip ethernet header (forward 14 bytes) */
425*8d741a5dSApple OSS Distributions 	_mbuf_adjust_pkthdr_and_data(m, ETHER_HDR_LEN);
426*8d741a5dSApple OSS Distributions 
427*8d741a5dSApple OSS Distributions 	/* can't trust hardware checksum */
428*8d741a5dSApple OSS Distributions 	m->m_pkthdr.csum_flags = 0;
429*8d741a5dSApple OSS Distributions 
430*8d741a5dSApple OSS Distributions 	/* return just the VLAN ID */
431*8d741a5dSApple OSS Distributions 	*tag_p = EVL_VLANOFTAG(ntohs(encap.evle_tag));
432*8d741a5dSApple OSS Distributions 	success = true;
433*8d741a5dSApple OSS Distributions 
434*8d741a5dSApple OSS Distributions done:
435*8d741a5dSApple OSS Distributions 	return success;
436*8d741a5dSApple OSS Distributions }
437*8d741a5dSApple OSS Distributions 
438*8d741a5dSApple OSS Distributions int
ether_demux(ifnet_t ifp,mbuf_t m,char * frame_header,protocol_family_t * protocol_family)439*8d741a5dSApple OSS Distributions ether_demux(ifnet_t ifp, mbuf_t m, char *frame_header,
440*8d741a5dSApple OSS Distributions     protocol_family_t *protocol_family)
441*8d741a5dSApple OSS Distributions {
442*8d741a5dSApple OSS Distributions 	struct ether_header * __single eh = (struct ether_header *)(void *)frame_header;
443*8d741a5dSApple OSS Distributions 	u_short  ether_type = eh->ether_type;
444*8d741a5dSApple OSS Distributions 	u_int16_t type;
445*8d741a5dSApple OSS Distributions 	u_int8_t *data;
446*8d741a5dSApple OSS Distributions 	u_int32_t i = 0;
447*8d741a5dSApple OSS Distributions 	struct ether_desc_blk_str *desc_blk = ifnet_ether_blk_str(ifp);
448*8d741a5dSApple OSS Distributions 	u_int32_t maxd = desc_blk ? desc_blk->n_max_used : 0;
449*8d741a5dSApple OSS Distributions 	struct en_desc  *ed = desc_blk ? desc_blk->block_ptr : NULL;
450*8d741a5dSApple OSS Distributions 	u_int32_t extProto1 = 0;
451*8d741a5dSApple OSS Distributions 	u_int32_t extProto2 = 0;
452*8d741a5dSApple OSS Distributions 
453*8d741a5dSApple OSS Distributions 	if ((eh->ether_dhost[0] & 1) != 0) {
454*8d741a5dSApple OSS Distributions 		/* Check for broadcast */
455*8d741a5dSApple OSS Distributions 		if (_ether_cmp(etherbroadcastaddr, eh->ether_dhost) == 0) {
456*8d741a5dSApple OSS Distributions 			m->m_flags |= M_BCAST;
457*8d741a5dSApple OSS Distributions 		} else {
458*8d741a5dSApple OSS Distributions 			m->m_flags |= M_MCAST;
459*8d741a5dSApple OSS Distributions 		}
460*8d741a5dSApple OSS Distributions 	} else {
461*8d741a5dSApple OSS Distributions 		/*
462*8d741a5dSApple OSS Distributions 		 * When the driver is put into promiscuous mode we may receive
463*8d741a5dSApple OSS Distributions 		 * unicast frames that are not intended for our interfaces.
464*8d741a5dSApple OSS Distributions 		 * They are marked here as being promiscuous so the caller may
465*8d741a5dSApple OSS Distributions 		 * dispose of them after passing the packets to any interface
466*8d741a5dSApple OSS Distributions 		 * filters.
467*8d741a5dSApple OSS Distributions 		 */
468*8d741a5dSApple OSS Distributions 		if (_ether_cmp(eh->ether_dhost, IF_LLADDR(ifp))) {
469*8d741a5dSApple OSS Distributions 			m->m_flags |= M_PROMISC;
470*8d741a5dSApple OSS Distributions 		}
471*8d741a5dSApple OSS Distributions 	}
472*8d741a5dSApple OSS Distributions 
473*8d741a5dSApple OSS Distributions 	if (m->m_flags & M_HASFCS) {
474*8d741a5dSApple OSS Distributions 		/*
475*8d741a5dSApple OSS Distributions 		 * If the M_HASFCS is set by the driver we want to make sure
476*8d741a5dSApple OSS Distributions 		 * that we strip off the trailing FCS data before handing it
477*8d741a5dSApple OSS Distributions 		 * up the stack.
478*8d741a5dSApple OSS Distributions 		 */
479*8d741a5dSApple OSS Distributions 		m_adj(m, -ETHER_CRC_LEN);
480*8d741a5dSApple OSS Distributions 		m->m_flags &= ~M_HASFCS;
481*8d741a5dSApple OSS Distributions 	}
482*8d741a5dSApple OSS Distributions 
483*8d741a5dSApple OSS Distributions 	/* check for BOND */
484*8d741a5dSApple OSS Distributions 	if ((ifnet_eflags(ifp) & IFEF_BOND) != 0) {
485*8d741a5dSApple OSS Distributions 		*protocol_family = PF_BOND;
486*8d741a5dSApple OSS Distributions 		return 0;
487*8d741a5dSApple OSS Distributions 	}
488*8d741a5dSApple OSS Distributions 	/* check for VLAN */
489*8d741a5dSApple OSS Distributions 	if ((m->m_pkthdr.csum_flags & CSUM_VLAN_TAG_VALID) != 0) {
490*8d741a5dSApple OSS Distributions 		if (EVL_VLANOFTAG(m->m_pkthdr.vlan_tag) != 0) {
491*8d741a5dSApple OSS Distributions 			*protocol_family = PF_VLAN;
492*8d741a5dSApple OSS Distributions 			return 0;
493*8d741a5dSApple OSS Distributions 		}
494*8d741a5dSApple OSS Distributions 		/* the packet is just priority-tagged, clear the bit */
495*8d741a5dSApple OSS Distributions 		m->m_pkthdr.csum_flags &= ~CSUM_VLAN_TAG_VALID;
496*8d741a5dSApple OSS Distributions 		m->m_pkthdr.vlan_tag = 0;
497*8d741a5dSApple OSS Distributions 	} else if (ether_type == htons(ETHERTYPE_VLAN)) {
498*8d741a5dSApple OSS Distributions 		uint16_t        tag;
499*8d741a5dSApple OSS Distributions 
500*8d741a5dSApple OSS Distributions 		if (!ether_remove_vlan_encapsulation(ifp, m, frame_header, &tag,
501*8d741a5dSApple OSS Distributions 		    &ether_type)) {
502*8d741a5dSApple OSS Distributions 			m_freem(m);
503*8d741a5dSApple OSS Distributions 			return EJUSTRETURN;
504*8d741a5dSApple OSS Distributions 		}
505*8d741a5dSApple OSS Distributions 		/* check whether a VLAN tag is set */
506*8d741a5dSApple OSS Distributions 		if (tag != 0) {
507*8d741a5dSApple OSS Distributions 			/* make it look like it was hardware tagged */
508*8d741a5dSApple OSS Distributions 			*protocol_family = PF_VLAN;
509*8d741a5dSApple OSS Distributions 			m->m_pkthdr.csum_flags |= CSUM_VLAN_TAG_VALID;
510*8d741a5dSApple OSS Distributions 			m->m_pkthdr.vlan_tag = tag;
511*8d741a5dSApple OSS Distributions 			return 0;
512*8d741a5dSApple OSS Distributions 		}
513*8d741a5dSApple OSS Distributions 		/* just priority-tagged, let packet continue */
514*8d741a5dSApple OSS Distributions 		eh = mbuf_pkthdr_header(m);
515*8d741a5dSApple OSS Distributions 	}
516*8d741a5dSApple OSS Distributions 	if (ether_type == htons(ETHERTYPE_ARP)) {
517*8d741a5dSApple OSS Distributions 		m->m_pkthdr.pkt_flags |= PKTF_INET_RESOLVE; /* ARP packet */
518*8d741a5dSApple OSS Distributions 	}
519*8d741a5dSApple OSS Distributions 	data = mtod(m, u_int8_t*);
520*8d741a5dSApple OSS Distributions 
521*8d741a5dSApple OSS Distributions 	/*
522*8d741a5dSApple OSS Distributions 	 * Determine the packet's protocol type and stuff the protocol into
523*8d741a5dSApple OSS Distributions 	 * longs for quick compares.
524*8d741a5dSApple OSS Distributions 	 */
525*8d741a5dSApple OSS Distributions 	if (ntohs(ether_type) <= 1500) {
526*8d741a5dSApple OSS Distributions 		bcopy(data, &extProto1, sizeof(u_int32_t));
527*8d741a5dSApple OSS Distributions 
528*8d741a5dSApple OSS Distributions 		/* SAP or SNAP */
529*8d741a5dSApple OSS Distributions 		if ((extProto1 & htonl(0xFFFFFF00)) == htonl(0xAAAA0300)) {
530*8d741a5dSApple OSS Distributions 			/* SNAP */
531*8d741a5dSApple OSS Distributions 			type = DLIL_DESC_SNAP;
532*8d741a5dSApple OSS Distributions 			bcopy(data + sizeof(u_int32_t), &extProto2,
533*8d741a5dSApple OSS Distributions 			    sizeof(u_int32_t));
534*8d741a5dSApple OSS Distributions 			extProto1 &= htonl(0x000000FF);
535*8d741a5dSApple OSS Distributions 		} else {
536*8d741a5dSApple OSS Distributions 			type = DLIL_DESC_SAP;
537*8d741a5dSApple OSS Distributions 			extProto1 &= htonl(0xFFFFFF00);
538*8d741a5dSApple OSS Distributions 		}
539*8d741a5dSApple OSS Distributions 	} else {
540*8d741a5dSApple OSS Distributions 		type = DLIL_DESC_ETYPE2;
541*8d741a5dSApple OSS Distributions 	}
542*8d741a5dSApple OSS Distributions 
543*8d741a5dSApple OSS Distributions 	/*
544*8d741a5dSApple OSS Distributions 	 * Search through the connected protocols for a match.
545*8d741a5dSApple OSS Distributions 	 */
546*8d741a5dSApple OSS Distributions 	switch (type) {
547*8d741a5dSApple OSS Distributions 	case DLIL_DESC_ETYPE2:
548*8d741a5dSApple OSS Distributions 		for (i = 0; i < maxd; i++) {
549*8d741a5dSApple OSS Distributions 			if ((ed[i].type == type) &&
550*8d741a5dSApple OSS Distributions 			    (ed[i].data[0] == ether_type)) {
551*8d741a5dSApple OSS Distributions 				*protocol_family = ed[i].protocol_family;
552*8d741a5dSApple OSS Distributions 				return 0;
553*8d741a5dSApple OSS Distributions 			}
554*8d741a5dSApple OSS Distributions 		}
555*8d741a5dSApple OSS Distributions 		break;
556*8d741a5dSApple OSS Distributions 
557*8d741a5dSApple OSS Distributions 	case DLIL_DESC_SAP:
558*8d741a5dSApple OSS Distributions 		for (i = 0; i < maxd; i++) {
559*8d741a5dSApple OSS Distributions 			if ((ed[i].type == type) &&
560*8d741a5dSApple OSS Distributions 			    (ed[i].data[0] == extProto1)) {
561*8d741a5dSApple OSS Distributions 				*protocol_family = ed[i].protocol_family;
562*8d741a5dSApple OSS Distributions 				return 0;
563*8d741a5dSApple OSS Distributions 			}
564*8d741a5dSApple OSS Distributions 		}
565*8d741a5dSApple OSS Distributions 		break;
566*8d741a5dSApple OSS Distributions 
567*8d741a5dSApple OSS Distributions 	case DLIL_DESC_SNAP:
568*8d741a5dSApple OSS Distributions 		for (i = 0; i < maxd; i++) {
569*8d741a5dSApple OSS Distributions 			if ((ed[i].type == type) &&
570*8d741a5dSApple OSS Distributions 			    (ed[i].data[0] == extProto1) &&
571*8d741a5dSApple OSS Distributions 			    (ed[i].data[1] == extProto2)) {
572*8d741a5dSApple OSS Distributions 				*protocol_family = ed[i].protocol_family;
573*8d741a5dSApple OSS Distributions 				return 0;
574*8d741a5dSApple OSS Distributions 			}
575*8d741a5dSApple OSS Distributions 		}
576*8d741a5dSApple OSS Distributions 		break;
577*8d741a5dSApple OSS Distributions 	}
578*8d741a5dSApple OSS Distributions 
579*8d741a5dSApple OSS Distributions 	return ENOENT;
580*8d741a5dSApple OSS Distributions }
581*8d741a5dSApple OSS Distributions 
582*8d741a5dSApple OSS Distributions /*
583*8d741a5dSApple OSS Distributions  * On embedded, ether_frameout is practicaly ether_frameout_extended.
584*8d741a5dSApple OSS Distributions  * On non-embedded, ether_frameout has long been exposed as a public KPI,
585*8d741a5dSApple OSS Distributions  * and therefore its signature must remain the same (without the pre- and
586*8d741a5dSApple OSS Distributions  * postpend length parameters.)
587*8d741a5dSApple OSS Distributions  */
588*8d741a5dSApple OSS Distributions #if KPI_INTERFACE_EMBEDDED
589*8d741a5dSApple OSS Distributions int
ether_frameout(struct ifnet * ifp,struct mbuf ** m,const struct sockaddr * ndest,const char * edst,const char * ether_type,u_int32_t * prepend_len,u_int32_t * postpend_len)590*8d741a5dSApple OSS Distributions ether_frameout(struct ifnet *ifp, struct mbuf **m,
591*8d741a5dSApple OSS Distributions     const struct sockaddr *ndest, const char *edst,
592*8d741a5dSApple OSS Distributions     const char *ether_type, u_int32_t *prepend_len, u_int32_t *postpend_len)
593*8d741a5dSApple OSS Distributions #else /* !KPI_INTERFACE_EMBEDDED */
594*8d741a5dSApple OSS Distributions int
595*8d741a5dSApple OSS Distributions ether_frameout(struct ifnet *ifp, struct mbuf **m,
596*8d741a5dSApple OSS Distributions     const struct sockaddr *ndest, const char *edst,
597*8d741a5dSApple OSS Distributions     const char *ether_type)
598*8d741a5dSApple OSS Distributions #endif /* KPI_INTERFACE_EMBEDDED */
599*8d741a5dSApple OSS Distributions {
600*8d741a5dSApple OSS Distributions #if KPI_INTERFACE_EMBEDDED
601*8d741a5dSApple OSS Distributions 	return ether_frameout_extended(ifp, m, ndest, edst, ether_type,
602*8d741a5dSApple OSS Distributions 	           prepend_len, postpend_len);
603*8d741a5dSApple OSS Distributions #else /* !KPI_INTERFACE_EMBEDDED */
604*8d741a5dSApple OSS Distributions 	return ether_frameout_extended(ifp, m, ndest, edst, ether_type,
605*8d741a5dSApple OSS Distributions 	           NULL, NULL);
606*8d741a5dSApple OSS Distributions #endif /* !KPI_INTERFACE_EMBEDDED */
607*8d741a5dSApple OSS Distributions }
608*8d741a5dSApple OSS Distributions 
609*8d741a5dSApple OSS Distributions /*
610*8d741a5dSApple OSS Distributions  * Ethernet output routine.
611*8d741a5dSApple OSS Distributions  * Encapsulate a packet of type family for the local net.
612*8d741a5dSApple OSS Distributions  * Use trailer local net encapsulation if enough data in first
613*8d741a5dSApple OSS Distributions  * packet leaves a multiple of 512 bytes of data in remainder.
614*8d741a5dSApple OSS Distributions  */
615*8d741a5dSApple OSS Distributions int
ether_frameout_extended(struct ifnet * ifp,struct mbuf ** m,const struct sockaddr * ndest,const char * edst,const char * ether_type,u_int32_t * prepend_len,u_int32_t * postpend_len)616*8d741a5dSApple OSS Distributions ether_frameout_extended(struct ifnet *ifp, struct mbuf **m,
617*8d741a5dSApple OSS Distributions     const struct sockaddr *ndest, const char *edst,
618*8d741a5dSApple OSS Distributions     const char *ether_type, u_int32_t *prepend_len, u_int32_t *postpend_len)
619*8d741a5dSApple OSS Distributions {
620*8d741a5dSApple OSS Distributions 	struct ether_header *eh;
621*8d741a5dSApple OSS Distributions 	int hlen = ETHER_HDR_LEN; /* link layer header length */
622*8d741a5dSApple OSS Distributions 	const uint8_t *dst_laddr = dlil_link_addr(edst);
623*8d741a5dSApple OSS Distributions 	const uint8_t *frame_type = dlil_frame_type(ether_type);
624*8d741a5dSApple OSS Distributions 
625*8d741a5dSApple OSS Distributions 	/*
626*8d741a5dSApple OSS Distributions 	 * If a simplex interface, and the packet is being sent to our
627*8d741a5dSApple OSS Distributions 	 * Ethernet address or a broadcast address, loopback a copy.
628*8d741a5dSApple OSS Distributions 	 * XXX To make a simplex device behave exactly like a duplex
629*8d741a5dSApple OSS Distributions 	 * device, we should copy in the case of sending to our own
630*8d741a5dSApple OSS Distributions 	 * ethernet address (thus letting the original actually appear
631*8d741a5dSApple OSS Distributions 	 * on the wire). However, we don't do that here for security
632*8d741a5dSApple OSS Distributions 	 * reasons and compatibility with the original behavior.
633*8d741a5dSApple OSS Distributions 	 */
634*8d741a5dSApple OSS Distributions 	if ((ifp->if_flags & IFF_SIMPLEX) &&
635*8d741a5dSApple OSS Distributions 	    ((*m)->m_flags & M_LOOP) && lo_ifp != NULL) {
636*8d741a5dSApple OSS Distributions 		if ((*m)->m_flags & M_BCAST) {
637*8d741a5dSApple OSS Distributions 			struct mbuf *n = m_copy(*m, 0, (int)M_COPYALL);
638*8d741a5dSApple OSS Distributions 			if (n != NULL) {
639*8d741a5dSApple OSS Distributions 				dlil_output(lo_ifp, ndest->sa_family,
640*8d741a5dSApple OSS Distributions 				    n, NULL, ndest, DLIL_OUTPUT_FLAGS_NONE,
641*8d741a5dSApple OSS Distributions 				    NULL);
642*8d741a5dSApple OSS Distributions 			}
643*8d741a5dSApple OSS Distributions 		} else if (_ether_cmp(edst, IF_LLADDR(ifp)) == 0) {
644*8d741a5dSApple OSS Distributions 			dlil_output(lo_ifp, ndest->sa_family, *m,
645*8d741a5dSApple OSS Distributions 			    NULL, ndest, DLIL_OUTPUT_FLAGS_NONE, NULL);
646*8d741a5dSApple OSS Distributions 			return EJUSTRETURN;
647*8d741a5dSApple OSS Distributions 		}
648*8d741a5dSApple OSS Distributions 	}
649*8d741a5dSApple OSS Distributions 
650*8d741a5dSApple OSS Distributions 	/*
651*8d741a5dSApple OSS Distributions 	 * Add local net header.  If no space in first mbuf,
652*8d741a5dSApple OSS Distributions 	 * allocate another.
653*8d741a5dSApple OSS Distributions 	 */
654*8d741a5dSApple OSS Distributions 	if (ifp->if_type == IFT_L2VLAN) {
655*8d741a5dSApple OSS Distributions 		/* leave room for VLAN encapsulation */
656*8d741a5dSApple OSS Distributions 		hlen += ETHER_VLAN_ENCAP_LEN;
657*8d741a5dSApple OSS Distributions 	}
658*8d741a5dSApple OSS Distributions 	M_PREPEND(*m, hlen, M_DONTWAIT, 0);
659*8d741a5dSApple OSS Distributions 	if (*m == NULL) {
660*8d741a5dSApple OSS Distributions 		return EJUSTRETURN;
661*8d741a5dSApple OSS Distributions 	}
662*8d741a5dSApple OSS Distributions 
663*8d741a5dSApple OSS Distributions 	if (prepend_len != NULL) {
664*8d741a5dSApple OSS Distributions 		*prepend_len = ETHER_HDR_LEN;
665*8d741a5dSApple OSS Distributions 	}
666*8d741a5dSApple OSS Distributions 	if (postpend_len != NULL) {
667*8d741a5dSApple OSS Distributions 		*postpend_len = 0;
668*8d741a5dSApple OSS Distributions 	}
669*8d741a5dSApple OSS Distributions 	if (ifp->if_type == IFT_L2VLAN) {
670*8d741a5dSApple OSS Distributions 		m_adj(*m, ETHER_VLAN_ENCAP_LEN);
671*8d741a5dSApple OSS Distributions 	}
672*8d741a5dSApple OSS Distributions 	eh = mtod(*m, struct ether_header *);
673*8d741a5dSApple OSS Distributions 	(void) memcpy(&eh->ether_type, frame_type, sizeof(eh->ether_type));
674*8d741a5dSApple OSS Distributions 	(void) memcpy(eh->ether_dhost, dst_laddr, ETHER_ADDR_LEN);
675*8d741a5dSApple OSS Distributions 	(void) memcpy(eh->ether_shost, IF_LLADDR(ifp), ETHER_ADDR_LEN);
676*8d741a5dSApple OSS Distributions 
677*8d741a5dSApple OSS Distributions 	return 0;
678*8d741a5dSApple OSS Distributions }
679*8d741a5dSApple OSS Distributions 
680*8d741a5dSApple OSS Distributions errno_t
ether_check_multi(ifnet_t ifp,const struct sockaddr * proto_addr)681*8d741a5dSApple OSS Distributions ether_check_multi(ifnet_t ifp, const struct sockaddr *proto_addr)
682*8d741a5dSApple OSS Distributions {
683*8d741a5dSApple OSS Distributions #pragma unused(ifp)
684*8d741a5dSApple OSS Distributions 	errno_t result = EAFNOSUPPORT;
685*8d741a5dSApple OSS Distributions 	const u_char *e_addr;
686*8d741a5dSApple OSS Distributions 
687*8d741a5dSApple OSS Distributions 	/*
688*8d741a5dSApple OSS Distributions 	 * AF_SPEC and AF_LINK don't require translation. We do
689*8d741a5dSApple OSS Distributions 	 * want to verify that they specify a valid multicast.
690*8d741a5dSApple OSS Distributions 	 */
691*8d741a5dSApple OSS Distributions 	switch (proto_addr->sa_family) {
692*8d741a5dSApple OSS Distributions 	case AF_UNSPEC:
693*8d741a5dSApple OSS Distributions 		e_addr = (const u_char*)&proto_addr->sa_data[0];
694*8d741a5dSApple OSS Distributions 		if ((e_addr[0] & 0x01) != 0x01) {
695*8d741a5dSApple OSS Distributions 			result = EADDRNOTAVAIL;
696*8d741a5dSApple OSS Distributions 		} else {
697*8d741a5dSApple OSS Distributions 			result = 0;
698*8d741a5dSApple OSS Distributions 		}
699*8d741a5dSApple OSS Distributions 		break;
700*8d741a5dSApple OSS Distributions 
701*8d741a5dSApple OSS Distributions 	case AF_LINK:
702*8d741a5dSApple OSS Distributions 		e_addr = CONST_LLADDR(SDL(proto_addr));
703*8d741a5dSApple OSS Distributions 		if ((e_addr[0] & 0x01) != 0x01) {
704*8d741a5dSApple OSS Distributions 			result = EADDRNOTAVAIL;
705*8d741a5dSApple OSS Distributions 		} else {
706*8d741a5dSApple OSS Distributions 			result = 0;
707*8d741a5dSApple OSS Distributions 		}
708*8d741a5dSApple OSS Distributions 		break;
709*8d741a5dSApple OSS Distributions 	}
710*8d741a5dSApple OSS Distributions 
711*8d741a5dSApple OSS Distributions 	return result;
712*8d741a5dSApple OSS Distributions }
713*8d741a5dSApple OSS Distributions 
714*8d741a5dSApple OSS Distributions int
ether_ioctl(ifnet_t ifp,u_int32_t command,void * data)715*8d741a5dSApple OSS Distributions ether_ioctl(ifnet_t ifp, u_int32_t command, void *data)
716*8d741a5dSApple OSS Distributions {
717*8d741a5dSApple OSS Distributions #pragma unused(ifp, command, data)
718*8d741a5dSApple OSS Distributions 	return EOPNOTSUPP;
719*8d741a5dSApple OSS Distributions }
720*8d741a5dSApple OSS Distributions 
721*8d741a5dSApple OSS Distributions __private_extern__ int
ether_family_init(void)722*8d741a5dSApple OSS Distributions ether_family_init(void)
723*8d741a5dSApple OSS Distributions {
724*8d741a5dSApple OSS Distributions 	errno_t error = 0;
725*8d741a5dSApple OSS Distributions 
726*8d741a5dSApple OSS Distributions 	/* Register protocol registration functions */
727*8d741a5dSApple OSS Distributions 	if ((error = proto_register_plumber(PF_INET, APPLE_IF_FAM_ETHERNET,
728*8d741a5dSApple OSS Distributions 	    ether_attach_inet, ether_detach_inet)) != 0) {
729*8d741a5dSApple OSS Distributions 		printf("proto_register_plumber failed for PF_INET error=%d\n",
730*8d741a5dSApple OSS Distributions 		    error);
731*8d741a5dSApple OSS Distributions 		goto done;
732*8d741a5dSApple OSS Distributions 	}
733*8d741a5dSApple OSS Distributions 	if ((error = proto_register_plumber(PF_INET6, APPLE_IF_FAM_ETHERNET,
734*8d741a5dSApple OSS Distributions 	    ether_attach_inet6, ether_detach_inet6)) != 0) {
735*8d741a5dSApple OSS Distributions 		printf("proto_register_plumber failed for PF_INET6 error=%d\n",
736*8d741a5dSApple OSS Distributions 		    error);
737*8d741a5dSApple OSS Distributions 		goto done;
738*8d741a5dSApple OSS Distributions 	}
739*8d741a5dSApple OSS Distributions #if VLAN
740*8d741a5dSApple OSS Distributions 	vlan_family_init();
741*8d741a5dSApple OSS Distributions #endif /* VLAN */
742*8d741a5dSApple OSS Distributions #if BOND
743*8d741a5dSApple OSS Distributions 	bond_family_init();
744*8d741a5dSApple OSS Distributions #endif /* BOND */
745*8d741a5dSApple OSS Distributions #if IF_BRIDGE
746*8d741a5dSApple OSS Distributions 	bridgeattach(0);
747*8d741a5dSApple OSS Distributions #endif /* IF_BRIDGE */
748*8d741a5dSApple OSS Distributions #if IF_FAKE
749*8d741a5dSApple OSS Distributions 	if_fake_init();
750*8d741a5dSApple OSS Distributions #endif /* IF_FAKE */
751*8d741a5dSApple OSS Distributions #if IF_HEADLESS
752*8d741a5dSApple OSS Distributions 	if_headless_init();
753*8d741a5dSApple OSS Distributions #endif /* IF_HEADLESS */
754*8d741a5dSApple OSS Distributions done:
755*8d741a5dSApple OSS Distributions 
756*8d741a5dSApple OSS Distributions 	return error;
757*8d741a5dSApple OSS Distributions }
758