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