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