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