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 ðer_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