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