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