if_ethersubr.c revision 1.30 1 1.30 matt /* $NetBSD: if_ethersubr.c,v 1.30 1998/04/29 21:37:53 matt Exp $ */
2 1.9 cgd
3 1.1 cgd /*
4 1.8 mycroft * Copyright (c) 1982, 1989, 1993
5 1.8 mycroft * The Regents of the University of California. All rights reserved.
6 1.1 cgd *
7 1.1 cgd * Redistribution and use in source and binary forms, with or without
8 1.1 cgd * modification, are permitted provided that the following conditions
9 1.1 cgd * are met:
10 1.1 cgd * 1. Redistributions of source code must retain the above copyright
11 1.1 cgd * notice, this list of conditions and the following disclaimer.
12 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 cgd * notice, this list of conditions and the following disclaimer in the
14 1.1 cgd * documentation and/or other materials provided with the distribution.
15 1.1 cgd * 3. All advertising materials mentioning features or use of this software
16 1.1 cgd * must display the following acknowledgement:
17 1.1 cgd * This product includes software developed by the University of
18 1.1 cgd * California, Berkeley and its contributors.
19 1.1 cgd * 4. Neither the name of the University nor the names of its contributors
20 1.1 cgd * may be used to endorse or promote products derived from this software
21 1.1 cgd * without specific prior written permission.
22 1.1 cgd *
23 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 1.1 cgd * SUCH DAMAGE.
34 1.1 cgd *
35 1.27 fvdl * @(#)if_ethersubr.c 8.2 (Berkeley) 4/4/96
36 1.1 cgd */
37 1.1 cgd
38 1.30 matt #include "opt_gateway.h"
39 1.30 matt
40 1.4 mycroft #include <sys/param.h>
41 1.4 mycroft #include <sys/systm.h>
42 1.4 mycroft #include <sys/kernel.h>
43 1.4 mycroft #include <sys/malloc.h>
44 1.4 mycroft #include <sys/mbuf.h>
45 1.4 mycroft #include <sys/protosw.h>
46 1.4 mycroft #include <sys/socket.h>
47 1.4 mycroft #include <sys/ioctl.h>
48 1.4 mycroft #include <sys/errno.h>
49 1.4 mycroft #include <sys/syslog.h>
50 1.4 mycroft
51 1.8 mycroft #include <machine/cpu.h>
52 1.8 mycroft
53 1.4 mycroft #include <net/if.h>
54 1.4 mycroft #include <net/netisr.h>
55 1.4 mycroft #include <net/route.h>
56 1.4 mycroft #include <net/if_llc.h>
57 1.4 mycroft #include <net/if_dl.h>
58 1.8 mycroft #include <net/if_types.h>
59 1.1 cgd
60 1.22 is #include <net/if_ether.h>
61 1.22 is
62 1.15 phil #include <netinet/in.h>
63 1.1 cgd #ifdef INET
64 1.4 mycroft #include <netinet/in_var.h>
65 1.1 cgd #endif
66 1.22 is #include <netinet/if_inarp.h>
67 1.1 cgd
68 1.1 cgd #ifdef NS
69 1.4 mycroft #include <netns/ns.h>
70 1.4 mycroft #include <netns/ns_if.h>
71 1.1 cgd #endif
72 1.1 cgd
73 1.1 cgd #ifdef ISO
74 1.4 mycroft #include <netiso/argo_debug.h>
75 1.4 mycroft #include <netiso/iso.h>
76 1.4 mycroft #include <netiso/iso_var.h>
77 1.4 mycroft #include <netiso/iso_snpac.h>
78 1.1 cgd #endif
79 1.4 mycroft
80 1.8 mycroft #ifdef LLC
81 1.8 mycroft #include <netccitt/dll.h>
82 1.8 mycroft #include <netccitt/llc_var.h>
83 1.8 mycroft #endif
84 1.8 mycroft
85 1.8 mycroft #if defined(LLC) && defined(CCITT)
86 1.8 mycroft extern struct ifqueue pkintrq;
87 1.8 mycroft #endif
88 1.1 cgd
89 1.23 christos #ifdef NETATALK
90 1.23 christos #include <netatalk/at.h>
91 1.23 christos #include <netatalk/at_var.h>
92 1.23 christos #include <netatalk/at_extern.h>
93 1.23 christos
94 1.23 christos #define llc_snap_org_code llc_un.type_snap.org_code
95 1.23 christos #define llc_snap_ether_type llc_un.type_snap.ether_type
96 1.23 christos
97 1.23 christos extern u_char at_org_code[3];
98 1.23 christos extern u_char aarp_org_code[3];
99 1.23 christos #endif /* NETATALK */
100 1.23 christos
101 1.1 cgd u_char etherbroadcastaddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
102 1.8 mycroft #define senderr(e) { error = (e); goto bad;}
103 1.1 cgd
104 1.22 is #define SIN(x) ((struct sockaddr_in *)x)
105 1.22 is
106 1.1 cgd /*
107 1.1 cgd * Ethernet output routine.
108 1.1 cgd * Encapsulate a packet of type family for the local net.
109 1.22 is * Assumes that ifp is actually pointer to ethercom structure.
110 1.1 cgd */
111 1.8 mycroft int
112 1.8 mycroft ether_output(ifp, m0, dst, rt0)
113 1.29 mrg struct ifnet *ifp;
114 1.1 cgd struct mbuf *m0;
115 1.1 cgd struct sockaddr *dst;
116 1.8 mycroft struct rtentry *rt0;
117 1.1 cgd {
118 1.10 cgd u_int16_t etype;
119 1.1 cgd int s, error = 0;
120 1.1 cgd u_char edst[6];
121 1.29 mrg struct mbuf *m = m0;
122 1.29 mrg struct rtentry *rt;
123 1.1 cgd struct mbuf *mcopy = (struct mbuf *)0;
124 1.29 mrg struct ether_header *eh;
125 1.24 christos #ifdef INET
126 1.22 is struct arphdr *ah;
127 1.24 christos #endif /* INET */
128 1.23 christos #ifdef NETATALK
129 1.23 christos struct at_ifaddr *aa;
130 1.23 christos #endif /* NETATALK */
131 1.1 cgd
132 1.8 mycroft if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING))
133 1.8 mycroft senderr(ENETDOWN);
134 1.8 mycroft ifp->if_lastchange = time;
135 1.18 christos if ((rt = rt0) != NULL) {
136 1.8 mycroft if ((rt->rt_flags & RTF_UP) == 0) {
137 1.27 fvdl if ((rt0 = rt = rtalloc1(dst, 1)) != NULL) {
138 1.8 mycroft rt->rt_refcnt--;
139 1.27 fvdl if (rt->rt_ifp != ifp)
140 1.27 fvdl return (*rt->rt_ifp->if_output)
141 1.27 fvdl (ifp, m0, dst, rt);
142 1.27 fvdl } else
143 1.8 mycroft senderr(EHOSTUNREACH);
144 1.8 mycroft }
145 1.27 fvdl if ((rt->rt_flags & RTF_GATEWAY) && dst->sa_family != AF_NS) {
146 1.8 mycroft if (rt->rt_gwroute == 0)
147 1.8 mycroft goto lookup;
148 1.8 mycroft if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) {
149 1.8 mycroft rtfree(rt); rt = rt0;
150 1.8 mycroft lookup: rt->rt_gwroute = rtalloc1(rt->rt_gateway, 1);
151 1.8 mycroft if ((rt = rt->rt_gwroute) == 0)
152 1.8 mycroft senderr(EHOSTUNREACH);
153 1.27 fvdl /* the "G" test below also prevents rt == rt0 */
154 1.27 fvdl if ((rt->rt_flags & RTF_GATEWAY) ||
155 1.27 fvdl (rt->rt_ifp != ifp)) {
156 1.27 fvdl rt->rt_refcnt--;
157 1.27 fvdl rt0->rt_gwroute = 0;
158 1.27 fvdl senderr(EHOSTUNREACH);
159 1.27 fvdl }
160 1.8 mycroft }
161 1.8 mycroft }
162 1.8 mycroft if (rt->rt_flags & RTF_REJECT)
163 1.8 mycroft if (rt->rt_rmx.rmx_expire == 0 ||
164 1.8 mycroft time.tv_sec < rt->rt_rmx.rmx_expire)
165 1.8 mycroft senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
166 1.1 cgd }
167 1.1 cgd switch (dst->sa_family) {
168 1.1 cgd
169 1.1 cgd #ifdef INET
170 1.1 cgd case AF_INET:
171 1.22 is if (m->m_flags & M_BCAST)
172 1.22 is bcopy((caddr_t)etherbroadcastaddr, (caddr_t)edst,
173 1.22 is sizeof(edst));
174 1.22 is
175 1.22 is else if (m->m_flags & M_MCAST) {
176 1.22 is ETHER_MAP_IP_MULTICAST(&SIN(dst)->sin_addr,
177 1.22 is (caddr_t)edst)
178 1.22 is
179 1.22 is } else if (!arpresolve(ifp, rt, m, dst, edst))
180 1.1 cgd return (0); /* if not yet resolved */
181 1.3 hpeyerl /* If broadcasting on a simplex interface, loopback a copy */
182 1.3 hpeyerl if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
183 1.1 cgd mcopy = m_copy(m, 0, (int)M_COPYALL);
184 1.17 mycroft etype = htons(ETHERTYPE_IP);
185 1.8 mycroft break;
186 1.22 is
187 1.22 is case AF_ARP:
188 1.22 is ah = mtod(m, struct arphdr *);
189 1.22 is if (m->m_flags & M_BCAST)
190 1.22 is bcopy((caddr_t)etherbroadcastaddr, (caddr_t)edst,
191 1.22 is sizeof(edst));
192 1.22 is else
193 1.22 is bcopy((caddr_t)ar_tha(ah),
194 1.22 is (caddr_t)edst, sizeof(edst));
195 1.22 is
196 1.22 is ah->ar_hrd = htons(ARPHRD_ETHER);
197 1.22 is
198 1.22 is switch(ntohs(ah->ar_op)) {
199 1.22 is case ARPOP_REVREQUEST:
200 1.22 is case ARPOP_REVREPLY:
201 1.22 is etype = htons(ETHERTYPE_REVARP);
202 1.22 is break;
203 1.22 is
204 1.22 is case ARPOP_REQUEST:
205 1.22 is case ARPOP_REPLY:
206 1.22 is default:
207 1.22 is etype = htons(ETHERTYPE_ARP);
208 1.22 is }
209 1.22 is
210 1.22 is break;
211 1.1 cgd #endif
212 1.23 christos #ifdef NETATALK
213 1.23 christos case AF_APPLETALK:
214 1.23 christos if (!aarpresolve(ifp, m, (struct sockaddr_at *)dst, edst)) {
215 1.23 christos #ifdef NETATALKDEBUG
216 1.23 christos printf("aarpresolv failed\n");
217 1.23 christos #endif /* NETATALKDEBUG */
218 1.23 christos return (0);
219 1.23 christos }
220 1.23 christos /*
221 1.23 christos * ifaddr is the first thing in at_ifaddr
222 1.23 christos */
223 1.23 christos aa = (struct at_ifaddr *) at_ifawithnet(
224 1.25 christos (struct sockaddr_at *)dst, ifp);
225 1.23 christos if (aa == NULL)
226 1.23 christos goto bad;
227 1.23 christos
228 1.23 christos /*
229 1.23 christos * In the phase 2 case, we need to prepend an mbuf for the
230 1.23 christos * llc header. Since we must preserve the value of m,
231 1.23 christos * which is passed to us by value, we m_copy() the first
232 1.23 christos * mbuf, and use it for our llc header.
233 1.23 christos */
234 1.23 christos if (aa->aa_flags & AFA_PHASE2) {
235 1.23 christos struct llc llc;
236 1.23 christos
237 1.23 christos M_PREPEND(m, sizeof(struct llc), M_WAIT);
238 1.23 christos llc.llc_dsap = llc.llc_ssap = LLC_SNAP_LSAP;
239 1.23 christos llc.llc_control = LLC_UI;
240 1.23 christos bcopy(at_org_code, llc.llc_snap_org_code,
241 1.23 christos sizeof(llc.llc_snap_org_code));
242 1.23 christos llc.llc_snap_ether_type = htons(ETHERTYPE_AT);
243 1.23 christos bcopy(&llc, mtod(m, caddr_t), sizeof(struct llc));
244 1.23 christos etype = htons(m->m_pkthdr.len);
245 1.23 christos } else {
246 1.23 christos etype = htons(ETHERTYPE_AT);
247 1.23 christos }
248 1.23 christos break;
249 1.23 christos #endif /* NETATALK */
250 1.1 cgd #ifdef NS
251 1.1 cgd case AF_NS:
252 1.17 mycroft etype = htons(ETHERTYPE_NS);
253 1.1 cgd bcopy((caddr_t)&(((struct sockaddr_ns *)dst)->sns_addr.x_host),
254 1.1 cgd (caddr_t)edst, sizeof (edst));
255 1.1 cgd if (!bcmp((caddr_t)edst, (caddr_t)&ns_thishost, sizeof(edst)))
256 1.1 cgd return (looutput(ifp, m, dst, rt));
257 1.3 hpeyerl /* If broadcasting on a simplex interface, loopback a copy */
258 1.3 hpeyerl if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX))
259 1.1 cgd mcopy = m_copy(m, 0, (int)M_COPYALL);
260 1.8 mycroft break;
261 1.1 cgd #endif
262 1.1 cgd #ifdef ISO
263 1.1 cgd case AF_ISO: {
264 1.1 cgd int snpalen;
265 1.1 cgd struct llc *l;
266 1.29 mrg struct sockaddr_dl *sdl;
267 1.1 cgd
268 1.8 mycroft if (rt && (sdl = (struct sockaddr_dl *)rt->rt_gateway) &&
269 1.8 mycroft sdl->sdl_family == AF_LINK && sdl->sdl_alen > 0) {
270 1.8 mycroft bcopy(LLADDR(sdl), (caddr_t)edst, sizeof(edst));
271 1.18 christos } else {
272 1.18 christos error = iso_snparesolve(ifp, (struct sockaddr_iso *)dst,
273 1.18 christos (char *)edst, &snpalen);
274 1.18 christos if (error)
275 1.18 christos goto bad; /* Not Resolved */
276 1.18 christos }
277 1.3 hpeyerl /* If broadcasting on a simplex interface, loopback a copy */
278 1.8 mycroft if (*edst & 1)
279 1.8 mycroft m->m_flags |= (M_BCAST|M_MCAST);
280 1.3 hpeyerl if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX) &&
281 1.1 cgd (mcopy = m_copy(m, 0, (int)M_COPYALL))) {
282 1.1 cgd M_PREPEND(mcopy, sizeof (*eh), M_DONTWAIT);
283 1.1 cgd if (mcopy) {
284 1.1 cgd eh = mtod(mcopy, struct ether_header *);
285 1.1 cgd bcopy((caddr_t)edst,
286 1.1 cgd (caddr_t)eh->ether_dhost, sizeof (edst));
287 1.22 is bcopy(LLADDR(ifp->if_sadl),
288 1.1 cgd (caddr_t)eh->ether_shost, sizeof (edst));
289 1.1 cgd }
290 1.1 cgd }
291 1.1 cgd M_PREPEND(m, 3, M_DONTWAIT);
292 1.1 cgd if (m == NULL)
293 1.1 cgd return (0);
294 1.17 mycroft etype = htons(m->m_pkthdr.len);
295 1.1 cgd l = mtod(m, struct llc *);
296 1.1 cgd l->llc_dsap = l->llc_ssap = LLC_ISO_LSAP;
297 1.1 cgd l->llc_control = LLC_UI;
298 1.18 christos #ifdef ARGO_DEBUG
299 1.18 christos if (argo_debug[D_ETHER]) {
300 1.1 cgd int i;
301 1.21 christos printf("unoutput: sending pkt to: ");
302 1.1 cgd for (i=0; i<6; i++)
303 1.21 christos printf("%x ", edst[i] & 0xff);
304 1.21 christos printf("\n");
305 1.18 christos }
306 1.18 christos #endif
307 1.8 mycroft } break;
308 1.8 mycroft #endif /* ISO */
309 1.8 mycroft #ifdef LLC
310 1.8 mycroft /* case AF_NSAP: */
311 1.8 mycroft case AF_CCITT: {
312 1.29 mrg struct sockaddr_dl *sdl =
313 1.8 mycroft (struct sockaddr_dl *) rt -> rt_gateway;
314 1.8 mycroft
315 1.8 mycroft if (sdl && sdl->sdl_family == AF_LINK
316 1.8 mycroft && sdl->sdl_alen > 0) {
317 1.8 mycroft bcopy(LLADDR(sdl), (char *)edst,
318 1.8 mycroft sizeof(edst));
319 1.8 mycroft } else goto bad; /* Not a link interface ? Funny ... */
320 1.8 mycroft if ((ifp->if_flags & IFF_SIMPLEX) && (*edst & 1) &&
321 1.8 mycroft (mcopy = m_copy(m, 0, (int)M_COPYALL))) {
322 1.8 mycroft M_PREPEND(mcopy, sizeof (*eh), M_DONTWAIT);
323 1.8 mycroft if (mcopy) {
324 1.8 mycroft eh = mtod(mcopy, struct ether_header *);
325 1.8 mycroft bcopy((caddr_t)edst,
326 1.8 mycroft (caddr_t)eh->ether_dhost, sizeof (edst));
327 1.22 is bcopy(LLADDR(ifp->if_sadl),
328 1.8 mycroft (caddr_t)eh->ether_shost, sizeof (edst));
329 1.8 mycroft }
330 1.3 hpeyerl }
331 1.17 mycroft etype = htons(m->m_pkthdr.len);
332 1.8 mycroft #ifdef LLC_DEBUG
333 1.8 mycroft {
334 1.8 mycroft int i;
335 1.29 mrg struct llc *l = mtod(m, struct llc *);
336 1.8 mycroft
337 1.21 christos printf("ether_output: sending LLC2 pkt to: ");
338 1.8 mycroft for (i=0; i<6; i++)
339 1.21 christos printf("%x ", edst[i] & 0xff);
340 1.21 christos printf(" len 0x%x dsap 0x%x ssap 0x%x control 0x%x\n",
341 1.17 mycroft m->m_pkthdr.len, l->llc_dsap & 0xff, l->llc_ssap &0xff,
342 1.17 mycroft l->llc_control & 0xff);
343 1.8 mycroft
344 1.8 mycroft }
345 1.8 mycroft #endif /* LLC_DEBUG */
346 1.8 mycroft } break;
347 1.8 mycroft #endif /* LLC */
348 1.1 cgd
349 1.1 cgd case AF_UNSPEC:
350 1.1 cgd eh = (struct ether_header *)dst->sa_data;
351 1.1 cgd bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, sizeof (edst));
352 1.8 mycroft /* AF_UNSPEC doesn't swap the byte order of the ether_type. */
353 1.17 mycroft etype = eh->ether_type;
354 1.8 mycroft break;
355 1.1 cgd
356 1.1 cgd default:
357 1.21 christos printf("%s: can't handle af%d\n", ifp->if_xname,
358 1.1 cgd dst->sa_family);
359 1.8 mycroft senderr(EAFNOSUPPORT);
360 1.1 cgd }
361 1.1 cgd
362 1.1 cgd if (mcopy)
363 1.1 cgd (void) looutput(ifp, mcopy, dst, rt);
364 1.16 mycroft
365 1.1 cgd /*
366 1.1 cgd * Add local net header. If no space in first mbuf,
367 1.1 cgd * allocate another.
368 1.1 cgd */
369 1.1 cgd M_PREPEND(m, sizeof (struct ether_header), M_DONTWAIT);
370 1.8 mycroft if (m == 0)
371 1.8 mycroft senderr(ENOBUFS);
372 1.1 cgd eh = mtod(m, struct ether_header *);
373 1.8 mycroft bcopy((caddr_t)&etype,(caddr_t)&eh->ether_type,
374 1.1 cgd sizeof(eh->ether_type));
375 1.1 cgd bcopy((caddr_t)edst, (caddr_t)eh->ether_dhost, sizeof (edst));
376 1.22 is bcopy(LLADDR(ifp->if_sadl), (caddr_t)eh->ether_shost,
377 1.1 cgd sizeof(eh->ether_shost));
378 1.1 cgd s = splimp();
379 1.1 cgd /*
380 1.1 cgd * Queue message on interface, and start output if interface
381 1.1 cgd * not yet active.
382 1.1 cgd */
383 1.1 cgd if (IF_QFULL(&ifp->if_snd)) {
384 1.1 cgd IF_DROP(&ifp->if_snd);
385 1.1 cgd splx(s);
386 1.8 mycroft senderr(ENOBUFS);
387 1.1 cgd }
388 1.14 mycroft ifp->if_obytes += m->m_pkthdr.len;
389 1.1 cgd IF_ENQUEUE(&ifp->if_snd, m);
390 1.1 cgd if ((ifp->if_flags & IFF_OACTIVE) == 0)
391 1.1 cgd (*ifp->if_start)(ifp);
392 1.1 cgd splx(s);
393 1.3 hpeyerl if (m->m_flags & M_MCAST)
394 1.1 cgd ifp->if_omcasts++;
395 1.1 cgd return (error);
396 1.1 cgd
397 1.1 cgd bad:
398 1.1 cgd if (m)
399 1.1 cgd m_freem(m);
400 1.1 cgd return (error);
401 1.1 cgd }
402 1.1 cgd
403 1.1 cgd /*
404 1.1 cgd * Process a received Ethernet packet;
405 1.1 cgd * the packet is in the mbuf chain m without
406 1.1 cgd * the ether header, which is provided separately.
407 1.1 cgd */
408 1.8 mycroft void
409 1.1 cgd ether_input(ifp, eh, m)
410 1.1 cgd struct ifnet *ifp;
411 1.29 mrg struct ether_header *eh;
412 1.1 cgd struct mbuf *m;
413 1.1 cgd {
414 1.29 mrg struct ifqueue *inq;
415 1.18 christos u_int16_t etype;
416 1.18 christos int s;
417 1.23 christos #if defined (ISO) || defined (LLC) || defined(NETATALK)
418 1.29 mrg struct llc *l;
419 1.18 christos #endif
420 1.1 cgd
421 1.8 mycroft if ((ifp->if_flags & IFF_UP) == 0) {
422 1.8 mycroft m_freem(m);
423 1.8 mycroft return;
424 1.8 mycroft }
425 1.1 cgd ifp->if_lastchange = time;
426 1.1 cgd ifp->if_ibytes += m->m_pkthdr.len + sizeof (*eh);
427 1.8 mycroft if (eh->ether_dhost[0] & 1) {
428 1.8 mycroft if (bcmp((caddr_t)etherbroadcastaddr, (caddr_t)eh->ether_dhost,
429 1.8 mycroft sizeof(etherbroadcastaddr)) == 0)
430 1.8 mycroft m->m_flags |= M_BCAST;
431 1.8 mycroft else
432 1.8 mycroft m->m_flags |= M_MCAST;
433 1.8 mycroft }
434 1.1 cgd if (m->m_flags & (M_BCAST|M_MCAST))
435 1.1 cgd ifp->if_imcasts++;
436 1.1 cgd
437 1.5 deraadt etype = ntohs(eh->ether_type);
438 1.5 deraadt switch (etype) {
439 1.1 cgd #ifdef INET
440 1.1 cgd case ETHERTYPE_IP:
441 1.30 matt #ifdef GATEWAY
442 1.30 matt if (ipflow_fastforward(m))
443 1.30 matt return;
444 1.30 matt #endif
445 1.1 cgd schednetisr(NETISR_IP);
446 1.1 cgd inq = &ipintrq;
447 1.1 cgd break;
448 1.1 cgd
449 1.1 cgd case ETHERTYPE_ARP:
450 1.8 mycroft schednetisr(NETISR_ARP);
451 1.8 mycroft inq = &arpintrq;
452 1.8 mycroft break;
453 1.7 glass
454 1.7 glass case ETHERTYPE_REVARP:
455 1.8 mycroft revarpinput(m); /* XXX queue? */
456 1.1 cgd return;
457 1.1 cgd #endif
458 1.1 cgd #ifdef NS
459 1.1 cgd case ETHERTYPE_NS:
460 1.1 cgd schednetisr(NETISR_NS);
461 1.1 cgd inq = &nsintrq;
462 1.1 cgd break;
463 1.1 cgd
464 1.1 cgd #endif
465 1.23 christos #ifdef NETATALK
466 1.23 christos case ETHERTYPE_AT:
467 1.23 christos schednetisr(NETISR_ATALK);
468 1.23 christos inq = &atintrq1;
469 1.23 christos break;
470 1.23 christos case ETHERTYPE_AARP:
471 1.23 christos /* probably this should be done with a NETISR as well */
472 1.23 christos aarpinput(ifp, m); /* XXX */
473 1.23 christos return;
474 1.23 christos #endif /* NETATALK */
475 1.1 cgd default:
476 1.23 christos #if defined (ISO) || defined (LLC) || defined (NETATALK)
477 1.11 mycroft if (etype > ETHERMTU)
478 1.1 cgd goto dropanyway;
479 1.1 cgd l = mtod(m, struct llc *);
480 1.8 mycroft switch (l->llc_dsap) {
481 1.23 christos #ifdef NETATALK
482 1.23 christos case LLC_SNAP_LSAP:
483 1.23 christos switch (l->llc_control) {
484 1.23 christos case LLC_UI:
485 1.23 christos if (l->llc_ssap != LLC_SNAP_LSAP) {
486 1.23 christos goto dropanyway;
487 1.23 christos }
488 1.23 christos
489 1.23 christos if (Bcmp(&(l->llc_snap_org_code)[0],
490 1.23 christos at_org_code, sizeof(at_org_code)) == 0 &&
491 1.23 christos ntohs(l->llc_snap_ether_type) ==
492 1.23 christos ETHERTYPE_AT) {
493 1.23 christos inq = &atintrq2;
494 1.23 christos m_adj(m, sizeof(struct llc));
495 1.23 christos schednetisr(NETISR_ATALK);
496 1.23 christos break;
497 1.23 christos }
498 1.23 christos
499 1.23 christos if (Bcmp(&(l->llc_snap_org_code)[0],
500 1.23 christos aarp_org_code,
501 1.23 christos sizeof(aarp_org_code)) == 0 &&
502 1.23 christos ntohs(l->llc_snap_ether_type) ==
503 1.23 christos ETHERTYPE_AARP) {
504 1.23 christos m_adj( m, sizeof(struct llc));
505 1.23 christos aarpinput(ifp, m); /* XXX */
506 1.23 christos return;
507 1.23 christos }
508 1.23 christos
509 1.23 christos default:
510 1.23 christos goto dropanyway;
511 1.23 christos }
512 1.23 christos break;
513 1.23 christos #endif /* NETATALK */
514 1.8 mycroft #ifdef ISO
515 1.8 mycroft case LLC_ISO_LSAP:
516 1.8 mycroft switch (l->llc_control) {
517 1.8 mycroft case LLC_UI:
518 1.8 mycroft /* LLC_UI_P forbidden in class 1 service */
519 1.8 mycroft if ((l->llc_dsap == LLC_ISO_LSAP) &&
520 1.8 mycroft (l->llc_ssap == LLC_ISO_LSAP)) {
521 1.8 mycroft /* LSAP for ISO */
522 1.11 mycroft if (m->m_pkthdr.len > etype)
523 1.11 mycroft m_adj(m, etype - m->m_pkthdr.len);
524 1.8 mycroft m->m_data += 3; /* XXX */
525 1.8 mycroft m->m_len -= 3; /* XXX */
526 1.8 mycroft m->m_pkthdr.len -= 3; /* XXX */
527 1.8 mycroft M_PREPEND(m, sizeof *eh, M_DONTWAIT);
528 1.8 mycroft if (m == 0)
529 1.8 mycroft return;
530 1.8 mycroft *mtod(m, struct ether_header *) = *eh;
531 1.18 christos #ifdef ARGO_DEBUG
532 1.18 christos if (argo_debug[D_ETHER])
533 1.21 christos printf("clnp packet");
534 1.18 christos #endif
535 1.8 mycroft schednetisr(NETISR_ISO);
536 1.8 mycroft inq = &clnlintrq;
537 1.8 mycroft break;
538 1.8 mycroft }
539 1.8 mycroft goto dropanyway;
540 1.8 mycroft
541 1.8 mycroft case LLC_XID:
542 1.8 mycroft case LLC_XID_P:
543 1.8 mycroft if(m->m_len < 6)
544 1.8 mycroft goto dropanyway;
545 1.8 mycroft l->llc_window = 0;
546 1.8 mycroft l->llc_fid = 9;
547 1.8 mycroft l->llc_class = 1;
548 1.8 mycroft l->llc_dsap = l->llc_ssap = 0;
549 1.8 mycroft /* Fall through to */
550 1.8 mycroft case LLC_TEST:
551 1.8 mycroft case LLC_TEST_P:
552 1.8 mycroft {
553 1.8 mycroft struct sockaddr sa;
554 1.29 mrg struct ether_header *eh2;
555 1.8 mycroft int i;
556 1.8 mycroft u_char c = l->llc_dsap;
557 1.8 mycroft
558 1.8 mycroft l->llc_dsap = l->llc_ssap;
559 1.8 mycroft l->llc_ssap = c;
560 1.8 mycroft if (m->m_flags & (M_BCAST | M_MCAST))
561 1.22 is bcopy(LLADDR(ifp->if_sadl),
562 1.8 mycroft (caddr_t)eh->ether_dhost, 6);
563 1.8 mycroft sa.sa_family = AF_UNSPEC;
564 1.8 mycroft sa.sa_len = sizeof(sa);
565 1.8 mycroft eh2 = (struct ether_header *)sa.sa_data;
566 1.8 mycroft for (i = 0; i < 6; i++) {
567 1.22 is eh2->ether_shost[i] = c =
568 1.22 is eh->ether_dhost[i];
569 1.8 mycroft eh2->ether_dhost[i] =
570 1.22 is eh->ether_dhost[i] =
571 1.22 is eh->ether_shost[i];
572 1.8 mycroft eh->ether_shost[i] = c;
573 1.8 mycroft }
574 1.8 mycroft ifp->if_output(ifp, m, &sa, NULL);
575 1.8 mycroft return;
576 1.8 mycroft }
577 1.8 mycroft default:
578 1.8 mycroft m_freem(m);
579 1.8 mycroft return;
580 1.8 mycroft }
581 1.8 mycroft break;
582 1.8 mycroft #endif /* ISO */
583 1.8 mycroft #ifdef LLC
584 1.8 mycroft case LLC_X25_LSAP:
585 1.8 mycroft {
586 1.11 mycroft if (m->m_pkthdr.len > etype)
587 1.11 mycroft m_adj(m, etype - m->m_pkthdr.len);
588 1.8 mycroft M_PREPEND(m, sizeof(struct sdl_hdr) , M_DONTWAIT);
589 1.1 cgd if (m == 0)
590 1.1 cgd return;
591 1.8 mycroft if ( !sdl_sethdrif(ifp, eh->ether_shost, LLC_X25_LSAP,
592 1.8 mycroft eh->ether_dhost, LLC_X25_LSAP, 6,
593 1.8 mycroft mtod(m, struct sdl_hdr *)))
594 1.8 mycroft panic("ETHER cons addr failure");
595 1.11 mycroft mtod(m, struct sdl_hdr *)->sdlhdr_len = etype;
596 1.8 mycroft #ifdef LLC_DEBUG
597 1.21 christos printf("llc packet\n");
598 1.8 mycroft #endif /* LLC_DEBUG */
599 1.8 mycroft schednetisr(NETISR_CCITT);
600 1.8 mycroft inq = &llcintrq;
601 1.1 cgd break;
602 1.1 cgd }
603 1.8 mycroft #endif /* LLC */
604 1.1 cgd dropanyway:
605 1.1 cgd default:
606 1.8 mycroft m_freem(m);
607 1.8 mycroft return;
608 1.8 mycroft }
609 1.23 christos #else /* ISO || LLC || NETATALK*/
610 1.1 cgd m_freem(m);
611 1.1 cgd return;
612 1.23 christos #endif /* ISO || LLC || NETATALK*/
613 1.1 cgd }
614 1.1 cgd
615 1.1 cgd s = splimp();
616 1.1 cgd if (IF_QFULL(inq)) {
617 1.1 cgd IF_DROP(inq);
618 1.1 cgd m_freem(m);
619 1.1 cgd } else
620 1.1 cgd IF_ENQUEUE(inq, m);
621 1.1 cgd splx(s);
622 1.1 cgd }
623 1.1 cgd
624 1.1 cgd /*
625 1.1 cgd * Convert Ethernet address to printable (loggable) representation.
626 1.1 cgd */
627 1.1 cgd static char digits[] = "0123456789abcdef";
628 1.1 cgd char *
629 1.1 cgd ether_sprintf(ap)
630 1.29 mrg u_char *ap;
631 1.1 cgd {
632 1.1 cgd static char etherbuf[18];
633 1.29 mrg char *cp = etherbuf;
634 1.29 mrg int i;
635 1.1 cgd
636 1.1 cgd for (i = 0; i < 6; i++) {
637 1.1 cgd *cp++ = digits[*ap >> 4];
638 1.1 cgd *cp++ = digits[*ap++ & 0xf];
639 1.1 cgd *cp++ = ':';
640 1.1 cgd }
641 1.1 cgd *--cp = 0;
642 1.1 cgd return (etherbuf);
643 1.1 cgd }
644 1.8 mycroft
645 1.8 mycroft /*
646 1.8 mycroft * Perform common duties while attaching to interface list
647 1.8 mycroft */
648 1.8 mycroft void
649 1.22 is ether_ifattach(ifp, lla)
650 1.29 mrg struct ifnet *ifp;
651 1.22 is u_int8_t * lla;
652 1.8 mycroft {
653 1.29 mrg struct sockaddr_dl *sdl;
654 1.8 mycroft
655 1.8 mycroft ifp->if_type = IFT_ETHER;
656 1.8 mycroft ifp->if_addrlen = 6;
657 1.8 mycroft ifp->if_hdrlen = 14;
658 1.8 mycroft ifp->if_mtu = ETHERMTU;
659 1.12 mycroft ifp->if_output = ether_output;
660 1.22 is if ((sdl = ifp->if_sadl) &&
661 1.22 is sdl->sdl_family == AF_LINK) {
662 1.22 is sdl->sdl_type = IFT_ETHER;
663 1.22 is sdl->sdl_alen = ifp->if_addrlen;
664 1.22 is bcopy((caddr_t)lla, LLADDR(sdl), ifp->if_addrlen);
665 1.22 is }
666 1.22 is LIST_INIT(&((struct ethercom *)ifp)->ec_multiaddrs);
667 1.26 is ifp->if_broadcastaddr = etherbroadcastaddr;
668 1.8 mycroft }
669 1.8 mycroft
670 1.3 hpeyerl u_char ether_ipmulticast_min[6] = { 0x01, 0x00, 0x5e, 0x00, 0x00, 0x00 };
671 1.3 hpeyerl u_char ether_ipmulticast_max[6] = { 0x01, 0x00, 0x5e, 0x7f, 0xff, 0xff };
672 1.3 hpeyerl /*
673 1.3 hpeyerl * Add an Ethernet multicast address or range of addresses to the list for a
674 1.3 hpeyerl * given interface.
675 1.3 hpeyerl */
676 1.3 hpeyerl int
677 1.22 is ether_addmulti(ifr, ec)
678 1.3 hpeyerl struct ifreq *ifr;
679 1.29 mrg struct ethercom *ec;
680 1.3 hpeyerl {
681 1.29 mrg struct ether_multi *enm;
682 1.24 christos #ifdef INET
683 1.3 hpeyerl struct sockaddr_in *sin;
684 1.24 christos #endif /* INET */
685 1.3 hpeyerl u_char addrlo[6];
686 1.3 hpeyerl u_char addrhi[6];
687 1.3 hpeyerl int s = splimp();
688 1.3 hpeyerl
689 1.3 hpeyerl switch (ifr->ifr_addr.sa_family) {
690 1.3 hpeyerl
691 1.3 hpeyerl case AF_UNSPEC:
692 1.3 hpeyerl bcopy(ifr->ifr_addr.sa_data, addrlo, 6);
693 1.3 hpeyerl bcopy(addrlo, addrhi, 6);
694 1.3 hpeyerl break;
695 1.3 hpeyerl
696 1.3 hpeyerl #ifdef INET
697 1.3 hpeyerl case AF_INET:
698 1.3 hpeyerl sin = (struct sockaddr_in *)&(ifr->ifr_addr);
699 1.3 hpeyerl if (sin->sin_addr.s_addr == INADDR_ANY) {
700 1.3 hpeyerl /*
701 1.3 hpeyerl * An IP address of INADDR_ANY means listen to all
702 1.3 hpeyerl * of the Ethernet multicast addresses used for IP.
703 1.3 hpeyerl * (This is for the sake of IP multicast routers.)
704 1.3 hpeyerl */
705 1.3 hpeyerl bcopy(ether_ipmulticast_min, addrlo, 6);
706 1.3 hpeyerl bcopy(ether_ipmulticast_max, addrhi, 6);
707 1.3 hpeyerl }
708 1.3 hpeyerl else {
709 1.3 hpeyerl ETHER_MAP_IP_MULTICAST(&sin->sin_addr, addrlo);
710 1.3 hpeyerl bcopy(addrlo, addrhi, 6);
711 1.3 hpeyerl }
712 1.3 hpeyerl break;
713 1.3 hpeyerl #endif
714 1.3 hpeyerl
715 1.3 hpeyerl default:
716 1.3 hpeyerl splx(s);
717 1.3 hpeyerl return (EAFNOSUPPORT);
718 1.3 hpeyerl }
719 1.3 hpeyerl
720 1.3 hpeyerl /*
721 1.3 hpeyerl * Verify that we have valid Ethernet multicast addresses.
722 1.3 hpeyerl */
723 1.3 hpeyerl if ((addrlo[0] & 0x01) != 1 || (addrhi[0] & 0x01) != 1) {
724 1.3 hpeyerl splx(s);
725 1.3 hpeyerl return (EINVAL);
726 1.3 hpeyerl }
727 1.3 hpeyerl /*
728 1.3 hpeyerl * See if the address range is already in the list.
729 1.3 hpeyerl */
730 1.22 is ETHER_LOOKUP_MULTI(addrlo, addrhi, ec, enm);
731 1.3 hpeyerl if (enm != NULL) {
732 1.3 hpeyerl /*
733 1.3 hpeyerl * Found it; just increment the reference count.
734 1.3 hpeyerl */
735 1.3 hpeyerl ++enm->enm_refcount;
736 1.3 hpeyerl splx(s);
737 1.3 hpeyerl return (0);
738 1.3 hpeyerl }
739 1.3 hpeyerl /*
740 1.3 hpeyerl * New address or range; malloc a new multicast record
741 1.3 hpeyerl * and link it into the interface's multicast list.
742 1.3 hpeyerl */
743 1.3 hpeyerl enm = (struct ether_multi *)malloc(sizeof(*enm), M_IFMADDR, M_NOWAIT);
744 1.3 hpeyerl if (enm == NULL) {
745 1.3 hpeyerl splx(s);
746 1.3 hpeyerl return (ENOBUFS);
747 1.3 hpeyerl }
748 1.3 hpeyerl bcopy(addrlo, enm->enm_addrlo, 6);
749 1.3 hpeyerl bcopy(addrhi, enm->enm_addrhi, 6);
750 1.22 is enm->enm_ec = ec;
751 1.3 hpeyerl enm->enm_refcount = 1;
752 1.22 is LIST_INSERT_HEAD(&ec->ec_multiaddrs, enm, enm_list);
753 1.22 is ec->ec_multicnt++;
754 1.3 hpeyerl splx(s);
755 1.3 hpeyerl /*
756 1.3 hpeyerl * Return ENETRESET to inform the driver that the list has changed
757 1.3 hpeyerl * and its reception filter should be adjusted accordingly.
758 1.3 hpeyerl */
759 1.3 hpeyerl return (ENETRESET);
760 1.3 hpeyerl }
761 1.3 hpeyerl
762 1.3 hpeyerl /*
763 1.3 hpeyerl * Delete a multicast address record.
764 1.3 hpeyerl */
765 1.3 hpeyerl int
766 1.22 is ether_delmulti(ifr, ec)
767 1.3 hpeyerl struct ifreq *ifr;
768 1.29 mrg struct ethercom *ec;
769 1.3 hpeyerl {
770 1.29 mrg struct ether_multi *enm;
771 1.24 christos #ifdef INET
772 1.3 hpeyerl struct sockaddr_in *sin;
773 1.24 christos #endif /* INET */
774 1.3 hpeyerl u_char addrlo[6];
775 1.3 hpeyerl u_char addrhi[6];
776 1.3 hpeyerl int s = splimp();
777 1.3 hpeyerl
778 1.3 hpeyerl switch (ifr->ifr_addr.sa_family) {
779 1.3 hpeyerl
780 1.3 hpeyerl case AF_UNSPEC:
781 1.3 hpeyerl bcopy(ifr->ifr_addr.sa_data, addrlo, 6);
782 1.3 hpeyerl bcopy(addrlo, addrhi, 6);
783 1.3 hpeyerl break;
784 1.3 hpeyerl
785 1.3 hpeyerl #ifdef INET
786 1.3 hpeyerl case AF_INET:
787 1.3 hpeyerl sin = (struct sockaddr_in *)&(ifr->ifr_addr);
788 1.3 hpeyerl if (sin->sin_addr.s_addr == INADDR_ANY) {
789 1.3 hpeyerl /*
790 1.3 hpeyerl * An IP address of INADDR_ANY means stop listening
791 1.3 hpeyerl * to the range of Ethernet multicast addresses used
792 1.3 hpeyerl * for IP.
793 1.3 hpeyerl */
794 1.3 hpeyerl bcopy(ether_ipmulticast_min, addrlo, 6);
795 1.3 hpeyerl bcopy(ether_ipmulticast_max, addrhi, 6);
796 1.3 hpeyerl }
797 1.3 hpeyerl else {
798 1.3 hpeyerl ETHER_MAP_IP_MULTICAST(&sin->sin_addr, addrlo);
799 1.3 hpeyerl bcopy(addrlo, addrhi, 6);
800 1.3 hpeyerl }
801 1.3 hpeyerl break;
802 1.3 hpeyerl #endif
803 1.3 hpeyerl
804 1.3 hpeyerl default:
805 1.3 hpeyerl splx(s);
806 1.3 hpeyerl return (EAFNOSUPPORT);
807 1.3 hpeyerl }
808 1.3 hpeyerl
809 1.3 hpeyerl /*
810 1.3 hpeyerl * Look up the address in our list.
811 1.3 hpeyerl */
812 1.22 is ETHER_LOOKUP_MULTI(addrlo, addrhi, ec, enm);
813 1.3 hpeyerl if (enm == NULL) {
814 1.3 hpeyerl splx(s);
815 1.3 hpeyerl return (ENXIO);
816 1.3 hpeyerl }
817 1.3 hpeyerl if (--enm->enm_refcount != 0) {
818 1.3 hpeyerl /*
819 1.3 hpeyerl * Still some claims to this record.
820 1.3 hpeyerl */
821 1.3 hpeyerl splx(s);
822 1.3 hpeyerl return (0);
823 1.3 hpeyerl }
824 1.3 hpeyerl /*
825 1.3 hpeyerl * No remaining claims to this record; unlink and free it.
826 1.3 hpeyerl */
827 1.13 mycroft LIST_REMOVE(enm, enm_list);
828 1.3 hpeyerl free(enm, M_IFMADDR);
829 1.22 is ec->ec_multicnt--;
830 1.3 hpeyerl splx(s);
831 1.3 hpeyerl /*
832 1.3 hpeyerl * Return ENETRESET to inform the driver that the list has changed
833 1.3 hpeyerl * and its reception filter should be adjusted accordingly.
834 1.3 hpeyerl */
835 1.3 hpeyerl return (ENETRESET);
836 1.3 hpeyerl }
837