1/*-
2 * Copyright (c) 1995, 1996
3 * Matt Thomas <matt@3am-software.com>. All rights reserved.
4 * Copyright (c) 1982, 1989, 1993
5 * The Regents of the University of California. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by the University of
18 * California, Berkeley and its contributors.
19 * 4. Neither the name of the University nor the names of its contributors
20 * may be used to endorse or promote products derived from this software
21 * without specific prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 * SUCH DAMAGE.
34 *
35 * from: if_ethersubr.c,v 1.5 1994/12/13 22:31:45 wollman Exp
| 1/*-
2 * Copyright (c) 1995, 1996
3 * Matt Thomas <matt@3am-software.com>. All rights reserved.
4 * Copyright (c) 1982, 1989, 1993
5 * The Regents of the University of California. All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by the University of
18 * California, Berkeley and its contributors.
19 * 4. Neither the name of the University nor the names of its contributors
20 * may be used to endorse or promote products derived from this software
21 * without specific prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33 * SUCH DAMAGE.
34 *
35 * from: if_ethersubr.c,v 1.5 1994/12/13 22:31:45 wollman Exp
|
37 */
38
39#include "opt_atalk.h"
40#include "opt_inet.h"
41#include "opt_inet6.h"
42#include "opt_ipx.h"
43#include "opt_mac.h"
44
45#include <sys/param.h>
46#include <sys/systm.h>
47#include <sys/kernel.h>
48#include <sys/malloc.h>
49#include <sys/mbuf.h>
50#include <sys/module.h>
51#include <sys/socket.h>
52#include <sys/sockio.h>
53
54#include <net/if.h>
55#include <net/if_dl.h>
56#include <net/if_llc.h>
57#include <net/if_types.h>
58
59#include <net/netisr.h>
60#include <net/route.h>
61#include <net/bpf.h>
62#include <net/fddi.h>
63
64#if defined(INET) || defined(INET6)
65#include <netinet/in.h>
66#include <netinet/in_var.h>
67#include <netinet/if_ether.h>
68#endif
69#ifdef INET6
70#include <netinet6/nd6.h>
71#endif
72
73#ifdef IPX
74#include <netipx/ipx.h>
75#include <netipx/ipx_if.h>
76#endif
77
78#ifdef DECNET
79#include <netdnet/dn.h>
80#endif
81
82#ifdef NETATALK
83#include <netatalk/at.h>
84#include <netatalk/at_var.h>
85#include <netatalk/at_extern.h>
86
87extern u_char at_org_code[ 3 ];
88extern u_char aarp_org_code[ 3 ];
89#endif /* NETATALK */
90
91#include <security/mac/mac_framework.h>
92
93static const u_char fddibroadcastaddr[FDDI_ADDR_LEN] =
94 { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
95
96static int fddi_resolvemulti(struct ifnet *, struct sockaddr **,
97 struct sockaddr *);
98static int fddi_output(struct ifnet *, struct mbuf *, struct sockaddr *,
99 struct rtentry *);
100static void fddi_input(struct ifnet *ifp, struct mbuf *m);
101
102#define senderr(e) do { error = (e); goto bad; } while (0)
103
104/*
105 * FDDI output routine.
106 * Encapsulate a packet of type family for the local net.
107 * Use trailer local net encapsulation if enough data in first
108 * packet leaves a multiple of 512 bytes of data in remainder.
109 * Assumes that ifp is actually pointer to arpcom structure.
110 */
111static int
112fddi_output(ifp, m, dst, rt0)
113 struct ifnet *ifp;
114 struct mbuf *m;
115 struct sockaddr *dst;
116 struct rtentry *rt0;
117{
118 u_int16_t type;
119 int loop_copy = 0, error = 0, hdrcmplt = 0;
120 u_char esrc[FDDI_ADDR_LEN], edst[FDDI_ADDR_LEN];
121 struct fddi_header *fh;
122
123#ifdef MAC
124 error = mac_ifnet_check_transmit(ifp, m);
125 if (error)
126 senderr(error);
127#endif
128
129 if (ifp->if_flags & IFF_MONITOR)
130 senderr(ENETDOWN);
131 if (!((ifp->if_flags & IFF_UP) &&
132 (ifp->if_drv_flags & IFF_DRV_RUNNING)))
133 senderr(ENETDOWN);
134 getmicrotime(&ifp->if_lastchange);
135
136 switch (dst->sa_family) {
137#ifdef INET
138 case AF_INET: {
139 error = arpresolve(ifp, rt0, m, dst, edst);
140 if (error)
141 return (error == EWOULDBLOCK ? 0 : error);
142 type = htons(ETHERTYPE_IP);
143 break;
144 }
145 case AF_ARP:
146 {
147 struct arphdr *ah;
148 ah = mtod(m, struct arphdr *);
149 ah->ar_hrd = htons(ARPHRD_ETHER);
150
151 loop_copy = -1; /* if this is for us, don't do it */
152
153 switch (ntohs(ah->ar_op)) {
154 case ARPOP_REVREQUEST:
155 case ARPOP_REVREPLY:
156 type = htons(ETHERTYPE_REVARP);
157 break;
158 case ARPOP_REQUEST:
159 case ARPOP_REPLY:
160 default:
161 type = htons(ETHERTYPE_ARP);
162 break;
163 }
164
165 if (m->m_flags & M_BCAST)
166 bcopy(ifp->if_broadcastaddr, edst, FDDI_ADDR_LEN);
167 else
168 bcopy(ar_tha(ah), edst, FDDI_ADDR_LEN);
169
170 }
171 break;
172#endif /* INET */
173#ifdef INET6
174 case AF_INET6:
175 error = nd6_storelladdr(ifp, rt0, m, dst, (u_char *)edst);
176 if (error)
177 return (error); /* Something bad happened */
178 type = htons(ETHERTYPE_IPV6);
179 break;
180#endif /* INET6 */
181#ifdef IPX
182 case AF_IPX:
183 type = htons(ETHERTYPE_IPX);
184 bcopy((caddr_t)&(((struct sockaddr_ipx *)dst)->sipx_addr.x_host),
185 (caddr_t)edst, FDDI_ADDR_LEN);
186 break;
187#endif /* IPX */
188#ifdef NETATALK
189 case AF_APPLETALK: {
190 struct at_ifaddr *aa;
191 if (!aarpresolve(ifp, m, (struct sockaddr_at *)dst, edst))
192 return (0);
193 /*
194 * ifaddr is the first thing in at_ifaddr
195 */
196 if ((aa = at_ifawithnet( (struct sockaddr_at *)dst)) == 0)
197 goto bad;
198
199 /*
200 * In the phase 2 case, we need to prepend an mbuf for the llc header.
201 * Since we must preserve the value of m, which is passed to us by
202 * value, we m_copy() the first mbuf, and use it for our llc header.
203 */
204 if (aa->aa_flags & AFA_PHASE2) {
205 struct llc llc;
206
| 37 */
38
39#include "opt_atalk.h"
40#include "opt_inet.h"
41#include "opt_inet6.h"
42#include "opt_ipx.h"
43#include "opt_mac.h"
44
45#include <sys/param.h>
46#include <sys/systm.h>
47#include <sys/kernel.h>
48#include <sys/malloc.h>
49#include <sys/mbuf.h>
50#include <sys/module.h>
51#include <sys/socket.h>
52#include <sys/sockio.h>
53
54#include <net/if.h>
55#include <net/if_dl.h>
56#include <net/if_llc.h>
57#include <net/if_types.h>
58
59#include <net/netisr.h>
60#include <net/route.h>
61#include <net/bpf.h>
62#include <net/fddi.h>
63
64#if defined(INET) || defined(INET6)
65#include <netinet/in.h>
66#include <netinet/in_var.h>
67#include <netinet/if_ether.h>
68#endif
69#ifdef INET6
70#include <netinet6/nd6.h>
71#endif
72
73#ifdef IPX
74#include <netipx/ipx.h>
75#include <netipx/ipx_if.h>
76#endif
77
78#ifdef DECNET
79#include <netdnet/dn.h>
80#endif
81
82#ifdef NETATALK
83#include <netatalk/at.h>
84#include <netatalk/at_var.h>
85#include <netatalk/at_extern.h>
86
87extern u_char at_org_code[ 3 ];
88extern u_char aarp_org_code[ 3 ];
89#endif /* NETATALK */
90
91#include <security/mac/mac_framework.h>
92
93static const u_char fddibroadcastaddr[FDDI_ADDR_LEN] =
94 { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
95
96static int fddi_resolvemulti(struct ifnet *, struct sockaddr **,
97 struct sockaddr *);
98static int fddi_output(struct ifnet *, struct mbuf *, struct sockaddr *,
99 struct rtentry *);
100static void fddi_input(struct ifnet *ifp, struct mbuf *m);
101
102#define senderr(e) do { error = (e); goto bad; } while (0)
103
104/*
105 * FDDI output routine.
106 * Encapsulate a packet of type family for the local net.
107 * Use trailer local net encapsulation if enough data in first
108 * packet leaves a multiple of 512 bytes of data in remainder.
109 * Assumes that ifp is actually pointer to arpcom structure.
110 */
111static int
112fddi_output(ifp, m, dst, rt0)
113 struct ifnet *ifp;
114 struct mbuf *m;
115 struct sockaddr *dst;
116 struct rtentry *rt0;
117{
118 u_int16_t type;
119 int loop_copy = 0, error = 0, hdrcmplt = 0;
120 u_char esrc[FDDI_ADDR_LEN], edst[FDDI_ADDR_LEN];
121 struct fddi_header *fh;
122
123#ifdef MAC
124 error = mac_ifnet_check_transmit(ifp, m);
125 if (error)
126 senderr(error);
127#endif
128
129 if (ifp->if_flags & IFF_MONITOR)
130 senderr(ENETDOWN);
131 if (!((ifp->if_flags & IFF_UP) &&
132 (ifp->if_drv_flags & IFF_DRV_RUNNING)))
133 senderr(ENETDOWN);
134 getmicrotime(&ifp->if_lastchange);
135
136 switch (dst->sa_family) {
137#ifdef INET
138 case AF_INET: {
139 error = arpresolve(ifp, rt0, m, dst, edst);
140 if (error)
141 return (error == EWOULDBLOCK ? 0 : error);
142 type = htons(ETHERTYPE_IP);
143 break;
144 }
145 case AF_ARP:
146 {
147 struct arphdr *ah;
148 ah = mtod(m, struct arphdr *);
149 ah->ar_hrd = htons(ARPHRD_ETHER);
150
151 loop_copy = -1; /* if this is for us, don't do it */
152
153 switch (ntohs(ah->ar_op)) {
154 case ARPOP_REVREQUEST:
155 case ARPOP_REVREPLY:
156 type = htons(ETHERTYPE_REVARP);
157 break;
158 case ARPOP_REQUEST:
159 case ARPOP_REPLY:
160 default:
161 type = htons(ETHERTYPE_ARP);
162 break;
163 }
164
165 if (m->m_flags & M_BCAST)
166 bcopy(ifp->if_broadcastaddr, edst, FDDI_ADDR_LEN);
167 else
168 bcopy(ar_tha(ah), edst, FDDI_ADDR_LEN);
169
170 }
171 break;
172#endif /* INET */
173#ifdef INET6
174 case AF_INET6:
175 error = nd6_storelladdr(ifp, rt0, m, dst, (u_char *)edst);
176 if (error)
177 return (error); /* Something bad happened */
178 type = htons(ETHERTYPE_IPV6);
179 break;
180#endif /* INET6 */
181#ifdef IPX
182 case AF_IPX:
183 type = htons(ETHERTYPE_IPX);
184 bcopy((caddr_t)&(((struct sockaddr_ipx *)dst)->sipx_addr.x_host),
185 (caddr_t)edst, FDDI_ADDR_LEN);
186 break;
187#endif /* IPX */
188#ifdef NETATALK
189 case AF_APPLETALK: {
190 struct at_ifaddr *aa;
191 if (!aarpresolve(ifp, m, (struct sockaddr_at *)dst, edst))
192 return (0);
193 /*
194 * ifaddr is the first thing in at_ifaddr
195 */
196 if ((aa = at_ifawithnet( (struct sockaddr_at *)dst)) == 0)
197 goto bad;
198
199 /*
200 * In the phase 2 case, we need to prepend an mbuf for the llc header.
201 * Since we must preserve the value of m, which is passed to us by
202 * value, we m_copy() the first mbuf, and use it for our llc header.
203 */
204 if (aa->aa_flags & AFA_PHASE2) {
205 struct llc llc;
206
|
210 llc.llc_dsap = llc.llc_ssap = LLC_SNAP_LSAP;
211 llc.llc_control = LLC_UI;
212 bcopy(at_org_code, llc.llc_snap.org_code, sizeof(at_org_code));
213 llc.llc_snap.ether_type = htons(ETHERTYPE_AT);
214 bcopy(&llc, mtod(m, caddr_t), LLC_SNAPFRAMELEN);
215 type = 0;
216 } else {
217 type = htons(ETHERTYPE_AT);
218 }
219 break;
220 }
221#endif /* NETATALK */
222
223 case pseudo_AF_HDRCMPLT:
224 {
225 struct ether_header *eh;
226 hdrcmplt = 1;
227 eh = (struct ether_header *)dst->sa_data;
228 bcopy((caddr_t)eh->ether_shost, (caddr_t)esrc, FDDI_ADDR_LEN);
229 /* FALLTHROUGH */
230 }
231
232 case AF_UNSPEC:
233 {
234 struct ether_header *eh;
235 loop_copy = -1;
236 eh = (struct ether_header *)dst->sa_data;
237 bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, FDDI_ADDR_LEN);
238 if (*edst & 1)
239 m->m_flags |= (M_BCAST|M_MCAST);
240 type = eh->ether_type;
241 break;
242 }
243
244 case AF_IMPLINK:
245 {
246 fh = mtod(m, struct fddi_header *);
247 error = EPROTONOSUPPORT;
248 switch (fh->fddi_fc & (FDDIFC_C|FDDIFC_L|FDDIFC_F)) {
249 case FDDIFC_LLC_ASYNC: {
250 /* legal priorities are 0 through 7 */
251 if ((fh->fddi_fc & FDDIFC_Z) > 7)
252 goto bad;
253 break;
254 }
255 case FDDIFC_LLC_SYNC: {
256 /* FDDIFC_Z bits reserved, must be zero */
257 if (fh->fddi_fc & FDDIFC_Z)
258 goto bad;
259 break;
260 }
261 case FDDIFC_SMT: {
262 /* FDDIFC_Z bits must be non zero */
263 if ((fh->fddi_fc & FDDIFC_Z) == 0)
264 goto bad;
265 break;
266 }
267 default: {
268 /* anything else is too dangerous */
269 goto bad;
270 }
271 }
272 error = 0;
273 if (fh->fddi_dhost[0] & 1)
274 m->m_flags |= (M_BCAST|M_MCAST);
275 goto queue_it;
276 }
277 default:
278 if_printf(ifp, "can't handle af%d\n", dst->sa_family);
279 senderr(EAFNOSUPPORT);
280 }
281
282 /*
283 * Add LLC header.
284 */
285 if (type != 0) {
286 struct llc *l;
287 M_PREPEND(m, LLC_SNAPFRAMELEN, M_DONTWAIT);
288 if (m == 0)
289 senderr(ENOBUFS);
290 l = mtod(m, struct llc *);
291 l->llc_control = LLC_UI;
292 l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP;
293 l->llc_snap.org_code[0] =
294 l->llc_snap.org_code[1] =
295 l->llc_snap.org_code[2] = 0;
296 l->llc_snap.ether_type = htons(type);
297 }
298
299 /*
300 * Add local net header. If no space in first mbuf,
301 * allocate another.
302 */
303 M_PREPEND(m, FDDI_HDR_LEN, M_DONTWAIT);
304 if (m == 0)
305 senderr(ENOBUFS);
306 fh = mtod(m, struct fddi_header *);
307 fh->fddi_fc = FDDIFC_LLC_ASYNC|FDDIFC_LLC_PRIO4;
308 bcopy((caddr_t)edst, (caddr_t)fh->fddi_dhost, FDDI_ADDR_LEN);
309 queue_it:
310 if (hdrcmplt)
311 bcopy((caddr_t)esrc, (caddr_t)fh->fddi_shost, FDDI_ADDR_LEN);
312 else
313 bcopy(IF_LLADDR(ifp), (caddr_t)fh->fddi_shost,
314 FDDI_ADDR_LEN);
315
316 /*
317 * If a simplex interface, and the packet is being sent to our
318 * Ethernet address or a broadcast address, loopback a copy.
319 * XXX To make a simplex device behave exactly like a duplex
320 * device, we should copy in the case of sending to our own
321 * ethernet address (thus letting the original actually appear
322 * on the wire). However, we don't do that here for security
323 * reasons and compatibility with the original behavior.
324 */
325 if ((ifp->if_flags & IFF_SIMPLEX) && (loop_copy != -1)) {
326 if ((m->m_flags & M_BCAST) || (loop_copy > 0)) {
327 struct mbuf *n;
328 n = m_copy(m, 0, (int)M_COPYALL);
329 (void) if_simloop(ifp, n, dst->sa_family,
330 FDDI_HDR_LEN);
331 } else if (bcmp(fh->fddi_dhost, fh->fddi_shost,
332 FDDI_ADDR_LEN) == 0) {
333 (void) if_simloop(ifp, m, dst->sa_family,
334 FDDI_HDR_LEN);
335 return (0); /* XXX */
336 }
337 }
338
339 IFQ_HANDOFF(ifp, m, error);
340 if (error)
341 ifp->if_oerrors++;
342
343 return (error);
344
345bad:
346 ifp->if_oerrors++;
347 if (m)
348 m_freem(m);
349 return (error);
350}
351
352/*
353 * Process a received FDDI packet.
354 */
355static void
356fddi_input(ifp, m)
357 struct ifnet *ifp;
358 struct mbuf *m;
359{
360 int isr;
361 struct llc *l;
362 struct fddi_header *fh;
363
364 /*
365 * Do consistency checks to verify assumptions
366 * made by code past this point.
367 */
368 if ((m->m_flags & M_PKTHDR) == 0) {
369 if_printf(ifp, "discard frame w/o packet header\n");
370 ifp->if_ierrors++;
371 m_freem(m);
372 return;
373 }
374 if (m->m_pkthdr.rcvif == NULL) {
375 if_printf(ifp, "discard frame w/o interface pointer\n");
376 ifp->if_ierrors++;
377 m_freem(m);
378 return;
379 }
380
381 m = m_pullup(m, FDDI_HDR_LEN);
382 if (m == NULL) {
383 ifp->if_ierrors++;
384 goto dropanyway;
385 }
386 fh = mtod(m, struct fddi_header *);
387 m->m_pkthdr.header = (void *)fh;
388
389 /*
390 * Discard packet if interface is not up.
391 */
392 if (!((ifp->if_flags & IFF_UP) &&
393 (ifp->if_drv_flags & IFF_DRV_RUNNING)))
394 goto dropanyway;
395
396 /*
397 * Give bpf a chance at the packet.
398 */
399 BPF_MTAP(ifp, m);
400
401 /*
402 * Interface marked for monitoring; discard packet.
403 */
404 if (ifp->if_flags & IFF_MONITOR) {
405 m_freem(m);
406 return;
407 }
408
409#ifdef MAC
410 mac_ifnet_create_mbuf(ifp, m);
411#endif
412
413 /*
414 * Update interface statistics.
415 */
416 ifp->if_ibytes += m->m_pkthdr.len;
417 getmicrotime(&ifp->if_lastchange);
418
419 /*
420 * Discard non local unicast packets when interface
421 * is in promiscuous mode.
422 */
423 if ((ifp->if_flags & IFF_PROMISC) && ((fh->fddi_dhost[0] & 1) == 0) &&
424 (bcmp(IF_LLADDR(ifp), (caddr_t)fh->fddi_dhost,
425 FDDI_ADDR_LEN) != 0))
426 goto dropanyway;
427
428 /*
429 * Set mbuf flags for bcast/mcast.
430 */
431 if (fh->fddi_dhost[0] & 1) {
432 if (bcmp(ifp->if_broadcastaddr, fh->fddi_dhost,
433 FDDI_ADDR_LEN) == 0)
434 m->m_flags |= M_BCAST;
435 else
436 m->m_flags |= M_MCAST;
437 ifp->if_imcasts++;
438 }
439
440#ifdef M_LINK0
441 /*
442 * If this has a LLC priority of 0, then mark it so upper
443 * layers have a hint that it really came via a FDDI/Ethernet
444 * bridge.
445 */
446 if ((fh->fddi_fc & FDDIFC_LLC_PRIO7) == FDDIFC_LLC_PRIO0)
447 m->m_flags |= M_LINK0;
448#endif
449
450 /* Strip off FDDI header. */
451 m_adj(m, FDDI_HDR_LEN);
452
453 m = m_pullup(m, LLC_SNAPFRAMELEN);
454 if (m == 0) {
455 ifp->if_ierrors++;
456 goto dropanyway;
457 }
458 l = mtod(m, struct llc *);
459
460 switch (l->llc_dsap) {
461 case LLC_SNAP_LSAP:
462 {
463 u_int16_t type;
464 if ((l->llc_control != LLC_UI) ||
465 (l->llc_ssap != LLC_SNAP_LSAP)) {
466 ifp->if_noproto++;
467 goto dropanyway;
468 }
469#ifdef NETATALK
470 if (bcmp(&(l->llc_snap.org_code)[0], at_org_code,
471 sizeof(at_org_code)) == 0 &&
472 ntohs(l->llc_snap.ether_type) == ETHERTYPE_AT) {
473 isr = NETISR_ATALK2;
474 m_adj(m, LLC_SNAPFRAMELEN);
475 break;
476 }
477
478 if (bcmp(&(l->llc_snap.org_code)[0], aarp_org_code,
479 sizeof(aarp_org_code)) == 0 &&
480 ntohs(l->llc_snap.ether_type) == ETHERTYPE_AARP) {
481 m_adj(m, LLC_SNAPFRAMELEN);
482 isr = NETISR_AARP;
483 break;
484 }
485#endif /* NETATALK */
486 if (l->llc_snap.org_code[0] != 0 ||
487 l->llc_snap.org_code[1] != 0 ||
488 l->llc_snap.org_code[2] != 0) {
489 ifp->if_noproto++;
490 goto dropanyway;
491 }
492
493 type = ntohs(l->llc_snap.ether_type);
494 m_adj(m, LLC_SNAPFRAMELEN);
495
496 switch (type) {
497#ifdef INET
498 case ETHERTYPE_IP:
499 if ((m = ip_fastforward(m)) == NULL)
500 return;
501 isr = NETISR_IP;
502 break;
503
504 case ETHERTYPE_ARP:
505 if (ifp->if_flags & IFF_NOARP)
506 goto dropanyway;
507 isr = NETISR_ARP;
508 break;
509#endif
510#ifdef INET6
511 case ETHERTYPE_IPV6:
512 isr = NETISR_IPV6;
513 break;
514#endif
515#ifdef IPX
516 case ETHERTYPE_IPX:
517 isr = NETISR_IPX;
518 break;
519#endif
520#ifdef DECNET
521 case ETHERTYPE_DECNET:
522 isr = NETISR_DECNET;
523 break;
524#endif
525#ifdef NETATALK
526 case ETHERTYPE_AT:
527 isr = NETISR_ATALK1;
528 break;
529 case ETHERTYPE_AARP:
530 isr = NETISR_AARP;
531 break;
532#endif /* NETATALK */
533 default:
534 /* printf("fddi_input: unknown protocol 0x%x\n", type); */
535 ifp->if_noproto++;
536 goto dropanyway;
537 }
538 break;
539 }
540
541 default:
542 /* printf("fddi_input: unknown dsap 0x%x\n", l->llc_dsap); */
543 ifp->if_noproto++;
544 goto dropanyway;
545 }
546 netisr_dispatch(isr, m);
547 return;
548
549dropanyway:
550 ifp->if_iqdrops++;
551 if (m)
552 m_freem(m);
553 return;
554}
555
556/*
557 * Perform common duties while attaching to interface list
558 */
559void
560fddi_ifattach(ifp, lla, bpf)
561 struct ifnet *ifp;
562 const u_int8_t *lla;
563 int bpf;
564{
565 struct ifaddr *ifa;
566 struct sockaddr_dl *sdl;
567
568 ifp->if_type = IFT_FDDI;
569 ifp->if_addrlen = FDDI_ADDR_LEN;
570 ifp->if_hdrlen = 21;
571
572 if_attach(ifp); /* Must be called before additional assignments */
573
574 ifp->if_mtu = FDDIMTU;
575 ifp->if_output = fddi_output;
576 ifp->if_input = fddi_input;
577 ifp->if_resolvemulti = fddi_resolvemulti;
578 ifp->if_broadcastaddr = fddibroadcastaddr;
579 ifp->if_baudrate = 100000000;
580#ifdef IFF_NOTRAILERS
581 ifp->if_flags |= IFF_NOTRAILERS;
582#endif
583 ifa = ifp->if_addr;
584 KASSERT(ifa != NULL, ("%s: no lladdr!\n", __func__));
585
586 sdl = (struct sockaddr_dl *)ifa->ifa_addr;
587 sdl->sdl_type = IFT_FDDI;
588 sdl->sdl_alen = ifp->if_addrlen;
589 bcopy(lla, LLADDR(sdl), ifp->if_addrlen);
590
591 if (bpf)
592 bpfattach(ifp, DLT_FDDI, FDDI_HDR_LEN);
593
594 return;
595}
596
597void
598fddi_ifdetach(ifp, bpf)
599 struct ifnet *ifp;
600 int bpf;
601{
602
603 if (bpf)
604 bpfdetach(ifp);
605
606 if_detach(ifp);
607
608 return;
609}
610
611int
612fddi_ioctl (ifp, command, data)
613 struct ifnet *ifp;
614 int command;
615 caddr_t data;
616{
617 struct ifaddr *ifa;
618 struct ifreq *ifr;
619 int error;
620
621 ifa = (struct ifaddr *) data;
622 ifr = (struct ifreq *) data;
623 error = 0;
624
625 switch (command) {
626 case SIOCSIFADDR:
627 ifp->if_flags |= IFF_UP;
628
629 switch (ifa->ifa_addr->sa_family) {
630#ifdef INET
631 case AF_INET: /* before arpwhohas */
632 ifp->if_init(ifp->if_softc);
633 arp_ifinit(ifp, ifa);
634 break;
635#endif
636#ifdef IPX
637 /*
638 * XXX - This code is probably wrong
639 */
640 case AF_IPX: {
641 struct ipx_addr *ina;
642
643 ina = &(IA_SIPX(ifa)->sipx_addr);
644
645 if (ipx_nullhost(*ina)) {
646 ina->x_host = *(union ipx_host *)
647 IF_LLADDR(ifp);
648 } else {
649 bcopy((caddr_t) ina->x_host.c_host,
650 (caddr_t) IF_LLADDR(ifp),
651 ETHER_ADDR_LEN);
652 }
653
654 /*
655 * Set new address
656 */
657 ifp->if_init(ifp->if_softc);
658 }
659 break;
660#endif
661 default:
662 ifp->if_init(ifp->if_softc);
663 break;
664 }
665 break;
666 case SIOCGIFADDR: {
667 struct sockaddr *sa;
668
669 sa = (struct sockaddr *) & ifr->ifr_data;
670 bcopy(IF_LLADDR(ifp),
671 (caddr_t) sa->sa_data, FDDI_ADDR_LEN);
672
673 }
674 break;
675 case SIOCSIFMTU:
676 /*
677 * Set the interface MTU.
678 */
679 if (ifr->ifr_mtu > FDDIMTU) {
680 error = EINVAL;
681 } else {
682 ifp->if_mtu = ifr->ifr_mtu;
683 }
684 break;
685 default:
686 error = EINVAL;
687 break;
688 }
689
690 return (error);
691}
692
693static int
694fddi_resolvemulti(ifp, llsa, sa)
695 struct ifnet *ifp;
696 struct sockaddr **llsa;
697 struct sockaddr *sa;
698{
699 struct sockaddr_dl *sdl;
700 struct sockaddr_in *sin;
701#ifdef INET6
702 struct sockaddr_in6 *sin6;
703#endif
704 u_char *e_addr;
705
706 switch(sa->sa_family) {
707 case AF_LINK:
708 /*
709 * No mapping needed. Just check that it's a valid MC address.
710 */
711 sdl = (struct sockaddr_dl *)sa;
712 e_addr = LLADDR(sdl);
713 if ((e_addr[0] & 1) != 1)
714 return (EADDRNOTAVAIL);
715 *llsa = 0;
716 return (0);
717
718#ifdef INET
719 case AF_INET:
720 sin = (struct sockaddr_in *)sa;
721 if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr)))
722 return (EADDRNOTAVAIL);
723 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR,
724 M_NOWAIT | M_ZERO);
725 if (sdl == NULL)
726 return (ENOMEM);
727 sdl->sdl_len = sizeof *sdl;
728 sdl->sdl_family = AF_LINK;
729 sdl->sdl_index = ifp->if_index;
730 sdl->sdl_type = IFT_FDDI;
731 sdl->sdl_nlen = 0;
732 sdl->sdl_alen = FDDI_ADDR_LEN;
733 sdl->sdl_slen = 0;
734 e_addr = LLADDR(sdl);
735 ETHER_MAP_IP_MULTICAST(&sin->sin_addr, e_addr);
736 *llsa = (struct sockaddr *)sdl;
737 return (0);
738#endif
739#ifdef INET6
740 case AF_INET6:
741 sin6 = (struct sockaddr_in6 *)sa;
742 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
743 /*
744 * An IP6 address of 0 means listen to all
745 * of the Ethernet multicast address used for IP6.
746 * (This is used for multicast routers.)
747 */
748 ifp->if_flags |= IFF_ALLMULTI;
749 *llsa = 0;
750 return (0);
751 }
752 if (!IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr))
753 return (EADDRNOTAVAIL);
754 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR,
755 M_NOWAIT | M_ZERO);
756 if (sdl == NULL)
757 return (ENOMEM);
758 sdl->sdl_len = sizeof *sdl;
759 sdl->sdl_family = AF_LINK;
760 sdl->sdl_index = ifp->if_index;
761 sdl->sdl_type = IFT_FDDI;
762 sdl->sdl_nlen = 0;
763 sdl->sdl_alen = FDDI_ADDR_LEN;
764 sdl->sdl_slen = 0;
765 e_addr = LLADDR(sdl);
766 ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, e_addr);
767 *llsa = (struct sockaddr *)sdl;
768 return (0);
769#endif
770
771 default:
772 /*
773 * Well, the text isn't quite right, but it's the name
774 * that counts...
775 */
776 return (EAFNOSUPPORT);
777 }
778
779 return (0);
780}
781
782static moduledata_t fddi_mod = {
783 "fddi", /* module name */
784 NULL, /* event handler */
785 0 /* extra data */
786};
787
788DECLARE_MODULE(fddi, fddi_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
789MODULE_VERSION(fddi, 1);
| 208 llc.llc_dsap = llc.llc_ssap = LLC_SNAP_LSAP;
209 llc.llc_control = LLC_UI;
210 bcopy(at_org_code, llc.llc_snap.org_code, sizeof(at_org_code));
211 llc.llc_snap.ether_type = htons(ETHERTYPE_AT);
212 bcopy(&llc, mtod(m, caddr_t), LLC_SNAPFRAMELEN);
213 type = 0;
214 } else {
215 type = htons(ETHERTYPE_AT);
216 }
217 break;
218 }
219#endif /* NETATALK */
220
221 case pseudo_AF_HDRCMPLT:
222 {
223 struct ether_header *eh;
224 hdrcmplt = 1;
225 eh = (struct ether_header *)dst->sa_data;
226 bcopy((caddr_t)eh->ether_shost, (caddr_t)esrc, FDDI_ADDR_LEN);
227 /* FALLTHROUGH */
228 }
229
230 case AF_UNSPEC:
231 {
232 struct ether_header *eh;
233 loop_copy = -1;
234 eh = (struct ether_header *)dst->sa_data;
235 bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, FDDI_ADDR_LEN);
236 if (*edst & 1)
237 m->m_flags |= (M_BCAST|M_MCAST);
238 type = eh->ether_type;
239 break;
240 }
241
242 case AF_IMPLINK:
243 {
244 fh = mtod(m, struct fddi_header *);
245 error = EPROTONOSUPPORT;
246 switch (fh->fddi_fc & (FDDIFC_C|FDDIFC_L|FDDIFC_F)) {
247 case FDDIFC_LLC_ASYNC: {
248 /* legal priorities are 0 through 7 */
249 if ((fh->fddi_fc & FDDIFC_Z) > 7)
250 goto bad;
251 break;
252 }
253 case FDDIFC_LLC_SYNC: {
254 /* FDDIFC_Z bits reserved, must be zero */
255 if (fh->fddi_fc & FDDIFC_Z)
256 goto bad;
257 break;
258 }
259 case FDDIFC_SMT: {
260 /* FDDIFC_Z bits must be non zero */
261 if ((fh->fddi_fc & FDDIFC_Z) == 0)
262 goto bad;
263 break;
264 }
265 default: {
266 /* anything else is too dangerous */
267 goto bad;
268 }
269 }
270 error = 0;
271 if (fh->fddi_dhost[0] & 1)
272 m->m_flags |= (M_BCAST|M_MCAST);
273 goto queue_it;
274 }
275 default:
276 if_printf(ifp, "can't handle af%d\n", dst->sa_family);
277 senderr(EAFNOSUPPORT);
278 }
279
280 /*
281 * Add LLC header.
282 */
283 if (type != 0) {
284 struct llc *l;
285 M_PREPEND(m, LLC_SNAPFRAMELEN, M_DONTWAIT);
286 if (m == 0)
287 senderr(ENOBUFS);
288 l = mtod(m, struct llc *);
289 l->llc_control = LLC_UI;
290 l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP;
291 l->llc_snap.org_code[0] =
292 l->llc_snap.org_code[1] =
293 l->llc_snap.org_code[2] = 0;
294 l->llc_snap.ether_type = htons(type);
295 }
296
297 /*
298 * Add local net header. If no space in first mbuf,
299 * allocate another.
300 */
301 M_PREPEND(m, FDDI_HDR_LEN, M_DONTWAIT);
302 if (m == 0)
303 senderr(ENOBUFS);
304 fh = mtod(m, struct fddi_header *);
305 fh->fddi_fc = FDDIFC_LLC_ASYNC|FDDIFC_LLC_PRIO4;
306 bcopy((caddr_t)edst, (caddr_t)fh->fddi_dhost, FDDI_ADDR_LEN);
307 queue_it:
308 if (hdrcmplt)
309 bcopy((caddr_t)esrc, (caddr_t)fh->fddi_shost, FDDI_ADDR_LEN);
310 else
311 bcopy(IF_LLADDR(ifp), (caddr_t)fh->fddi_shost,
312 FDDI_ADDR_LEN);
313
314 /*
315 * If a simplex interface, and the packet is being sent to our
316 * Ethernet address or a broadcast address, loopback a copy.
317 * XXX To make a simplex device behave exactly like a duplex
318 * device, we should copy in the case of sending to our own
319 * ethernet address (thus letting the original actually appear
320 * on the wire). However, we don't do that here for security
321 * reasons and compatibility with the original behavior.
322 */
323 if ((ifp->if_flags & IFF_SIMPLEX) && (loop_copy != -1)) {
324 if ((m->m_flags & M_BCAST) || (loop_copy > 0)) {
325 struct mbuf *n;
326 n = m_copy(m, 0, (int)M_COPYALL);
327 (void) if_simloop(ifp, n, dst->sa_family,
328 FDDI_HDR_LEN);
329 } else if (bcmp(fh->fddi_dhost, fh->fddi_shost,
330 FDDI_ADDR_LEN) == 0) {
331 (void) if_simloop(ifp, m, dst->sa_family,
332 FDDI_HDR_LEN);
333 return (0); /* XXX */
334 }
335 }
336
337 IFQ_HANDOFF(ifp, m, error);
338 if (error)
339 ifp->if_oerrors++;
340
341 return (error);
342
343bad:
344 ifp->if_oerrors++;
345 if (m)
346 m_freem(m);
347 return (error);
348}
349
350/*
351 * Process a received FDDI packet.
352 */
353static void
354fddi_input(ifp, m)
355 struct ifnet *ifp;
356 struct mbuf *m;
357{
358 int isr;
359 struct llc *l;
360 struct fddi_header *fh;
361
362 /*
363 * Do consistency checks to verify assumptions
364 * made by code past this point.
365 */
366 if ((m->m_flags & M_PKTHDR) == 0) {
367 if_printf(ifp, "discard frame w/o packet header\n");
368 ifp->if_ierrors++;
369 m_freem(m);
370 return;
371 }
372 if (m->m_pkthdr.rcvif == NULL) {
373 if_printf(ifp, "discard frame w/o interface pointer\n");
374 ifp->if_ierrors++;
375 m_freem(m);
376 return;
377 }
378
379 m = m_pullup(m, FDDI_HDR_LEN);
380 if (m == NULL) {
381 ifp->if_ierrors++;
382 goto dropanyway;
383 }
384 fh = mtod(m, struct fddi_header *);
385 m->m_pkthdr.header = (void *)fh;
386
387 /*
388 * Discard packet if interface is not up.
389 */
390 if (!((ifp->if_flags & IFF_UP) &&
391 (ifp->if_drv_flags & IFF_DRV_RUNNING)))
392 goto dropanyway;
393
394 /*
395 * Give bpf a chance at the packet.
396 */
397 BPF_MTAP(ifp, m);
398
399 /*
400 * Interface marked for monitoring; discard packet.
401 */
402 if (ifp->if_flags & IFF_MONITOR) {
403 m_freem(m);
404 return;
405 }
406
407#ifdef MAC
408 mac_ifnet_create_mbuf(ifp, m);
409#endif
410
411 /*
412 * Update interface statistics.
413 */
414 ifp->if_ibytes += m->m_pkthdr.len;
415 getmicrotime(&ifp->if_lastchange);
416
417 /*
418 * Discard non local unicast packets when interface
419 * is in promiscuous mode.
420 */
421 if ((ifp->if_flags & IFF_PROMISC) && ((fh->fddi_dhost[0] & 1) == 0) &&
422 (bcmp(IF_LLADDR(ifp), (caddr_t)fh->fddi_dhost,
423 FDDI_ADDR_LEN) != 0))
424 goto dropanyway;
425
426 /*
427 * Set mbuf flags for bcast/mcast.
428 */
429 if (fh->fddi_dhost[0] & 1) {
430 if (bcmp(ifp->if_broadcastaddr, fh->fddi_dhost,
431 FDDI_ADDR_LEN) == 0)
432 m->m_flags |= M_BCAST;
433 else
434 m->m_flags |= M_MCAST;
435 ifp->if_imcasts++;
436 }
437
438#ifdef M_LINK0
439 /*
440 * If this has a LLC priority of 0, then mark it so upper
441 * layers have a hint that it really came via a FDDI/Ethernet
442 * bridge.
443 */
444 if ((fh->fddi_fc & FDDIFC_LLC_PRIO7) == FDDIFC_LLC_PRIO0)
445 m->m_flags |= M_LINK0;
446#endif
447
448 /* Strip off FDDI header. */
449 m_adj(m, FDDI_HDR_LEN);
450
451 m = m_pullup(m, LLC_SNAPFRAMELEN);
452 if (m == 0) {
453 ifp->if_ierrors++;
454 goto dropanyway;
455 }
456 l = mtod(m, struct llc *);
457
458 switch (l->llc_dsap) {
459 case LLC_SNAP_LSAP:
460 {
461 u_int16_t type;
462 if ((l->llc_control != LLC_UI) ||
463 (l->llc_ssap != LLC_SNAP_LSAP)) {
464 ifp->if_noproto++;
465 goto dropanyway;
466 }
467#ifdef NETATALK
468 if (bcmp(&(l->llc_snap.org_code)[0], at_org_code,
469 sizeof(at_org_code)) == 0 &&
470 ntohs(l->llc_snap.ether_type) == ETHERTYPE_AT) {
471 isr = NETISR_ATALK2;
472 m_adj(m, LLC_SNAPFRAMELEN);
473 break;
474 }
475
476 if (bcmp(&(l->llc_snap.org_code)[0], aarp_org_code,
477 sizeof(aarp_org_code)) == 0 &&
478 ntohs(l->llc_snap.ether_type) == ETHERTYPE_AARP) {
479 m_adj(m, LLC_SNAPFRAMELEN);
480 isr = NETISR_AARP;
481 break;
482 }
483#endif /* NETATALK */
484 if (l->llc_snap.org_code[0] != 0 ||
485 l->llc_snap.org_code[1] != 0 ||
486 l->llc_snap.org_code[2] != 0) {
487 ifp->if_noproto++;
488 goto dropanyway;
489 }
490
491 type = ntohs(l->llc_snap.ether_type);
492 m_adj(m, LLC_SNAPFRAMELEN);
493
494 switch (type) {
495#ifdef INET
496 case ETHERTYPE_IP:
497 if ((m = ip_fastforward(m)) == NULL)
498 return;
499 isr = NETISR_IP;
500 break;
501
502 case ETHERTYPE_ARP:
503 if (ifp->if_flags & IFF_NOARP)
504 goto dropanyway;
505 isr = NETISR_ARP;
506 break;
507#endif
508#ifdef INET6
509 case ETHERTYPE_IPV6:
510 isr = NETISR_IPV6;
511 break;
512#endif
513#ifdef IPX
514 case ETHERTYPE_IPX:
515 isr = NETISR_IPX;
516 break;
517#endif
518#ifdef DECNET
519 case ETHERTYPE_DECNET:
520 isr = NETISR_DECNET;
521 break;
522#endif
523#ifdef NETATALK
524 case ETHERTYPE_AT:
525 isr = NETISR_ATALK1;
526 break;
527 case ETHERTYPE_AARP:
528 isr = NETISR_AARP;
529 break;
530#endif /* NETATALK */
531 default:
532 /* printf("fddi_input: unknown protocol 0x%x\n", type); */
533 ifp->if_noproto++;
534 goto dropanyway;
535 }
536 break;
537 }
538
539 default:
540 /* printf("fddi_input: unknown dsap 0x%x\n", l->llc_dsap); */
541 ifp->if_noproto++;
542 goto dropanyway;
543 }
544 netisr_dispatch(isr, m);
545 return;
546
547dropanyway:
548 ifp->if_iqdrops++;
549 if (m)
550 m_freem(m);
551 return;
552}
553
554/*
555 * Perform common duties while attaching to interface list
556 */
557void
558fddi_ifattach(ifp, lla, bpf)
559 struct ifnet *ifp;
560 const u_int8_t *lla;
561 int bpf;
562{
563 struct ifaddr *ifa;
564 struct sockaddr_dl *sdl;
565
566 ifp->if_type = IFT_FDDI;
567 ifp->if_addrlen = FDDI_ADDR_LEN;
568 ifp->if_hdrlen = 21;
569
570 if_attach(ifp); /* Must be called before additional assignments */
571
572 ifp->if_mtu = FDDIMTU;
573 ifp->if_output = fddi_output;
574 ifp->if_input = fddi_input;
575 ifp->if_resolvemulti = fddi_resolvemulti;
576 ifp->if_broadcastaddr = fddibroadcastaddr;
577 ifp->if_baudrate = 100000000;
578#ifdef IFF_NOTRAILERS
579 ifp->if_flags |= IFF_NOTRAILERS;
580#endif
581 ifa = ifp->if_addr;
582 KASSERT(ifa != NULL, ("%s: no lladdr!\n", __func__));
583
584 sdl = (struct sockaddr_dl *)ifa->ifa_addr;
585 sdl->sdl_type = IFT_FDDI;
586 sdl->sdl_alen = ifp->if_addrlen;
587 bcopy(lla, LLADDR(sdl), ifp->if_addrlen);
588
589 if (bpf)
590 bpfattach(ifp, DLT_FDDI, FDDI_HDR_LEN);
591
592 return;
593}
594
595void
596fddi_ifdetach(ifp, bpf)
597 struct ifnet *ifp;
598 int bpf;
599{
600
601 if (bpf)
602 bpfdetach(ifp);
603
604 if_detach(ifp);
605
606 return;
607}
608
609int
610fddi_ioctl (ifp, command, data)
611 struct ifnet *ifp;
612 int command;
613 caddr_t data;
614{
615 struct ifaddr *ifa;
616 struct ifreq *ifr;
617 int error;
618
619 ifa = (struct ifaddr *) data;
620 ifr = (struct ifreq *) data;
621 error = 0;
622
623 switch (command) {
624 case SIOCSIFADDR:
625 ifp->if_flags |= IFF_UP;
626
627 switch (ifa->ifa_addr->sa_family) {
628#ifdef INET
629 case AF_INET: /* before arpwhohas */
630 ifp->if_init(ifp->if_softc);
631 arp_ifinit(ifp, ifa);
632 break;
633#endif
634#ifdef IPX
635 /*
636 * XXX - This code is probably wrong
637 */
638 case AF_IPX: {
639 struct ipx_addr *ina;
640
641 ina = &(IA_SIPX(ifa)->sipx_addr);
642
643 if (ipx_nullhost(*ina)) {
644 ina->x_host = *(union ipx_host *)
645 IF_LLADDR(ifp);
646 } else {
647 bcopy((caddr_t) ina->x_host.c_host,
648 (caddr_t) IF_LLADDR(ifp),
649 ETHER_ADDR_LEN);
650 }
651
652 /*
653 * Set new address
654 */
655 ifp->if_init(ifp->if_softc);
656 }
657 break;
658#endif
659 default:
660 ifp->if_init(ifp->if_softc);
661 break;
662 }
663 break;
664 case SIOCGIFADDR: {
665 struct sockaddr *sa;
666
667 sa = (struct sockaddr *) & ifr->ifr_data;
668 bcopy(IF_LLADDR(ifp),
669 (caddr_t) sa->sa_data, FDDI_ADDR_LEN);
670
671 }
672 break;
673 case SIOCSIFMTU:
674 /*
675 * Set the interface MTU.
676 */
677 if (ifr->ifr_mtu > FDDIMTU) {
678 error = EINVAL;
679 } else {
680 ifp->if_mtu = ifr->ifr_mtu;
681 }
682 break;
683 default:
684 error = EINVAL;
685 break;
686 }
687
688 return (error);
689}
690
691static int
692fddi_resolvemulti(ifp, llsa, sa)
693 struct ifnet *ifp;
694 struct sockaddr **llsa;
695 struct sockaddr *sa;
696{
697 struct sockaddr_dl *sdl;
698 struct sockaddr_in *sin;
699#ifdef INET6
700 struct sockaddr_in6 *sin6;
701#endif
702 u_char *e_addr;
703
704 switch(sa->sa_family) {
705 case AF_LINK:
706 /*
707 * No mapping needed. Just check that it's a valid MC address.
708 */
709 sdl = (struct sockaddr_dl *)sa;
710 e_addr = LLADDR(sdl);
711 if ((e_addr[0] & 1) != 1)
712 return (EADDRNOTAVAIL);
713 *llsa = 0;
714 return (0);
715
716#ifdef INET
717 case AF_INET:
718 sin = (struct sockaddr_in *)sa;
719 if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr)))
720 return (EADDRNOTAVAIL);
721 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR,
722 M_NOWAIT | M_ZERO);
723 if (sdl == NULL)
724 return (ENOMEM);
725 sdl->sdl_len = sizeof *sdl;
726 sdl->sdl_family = AF_LINK;
727 sdl->sdl_index = ifp->if_index;
728 sdl->sdl_type = IFT_FDDI;
729 sdl->sdl_nlen = 0;
730 sdl->sdl_alen = FDDI_ADDR_LEN;
731 sdl->sdl_slen = 0;
732 e_addr = LLADDR(sdl);
733 ETHER_MAP_IP_MULTICAST(&sin->sin_addr, e_addr);
734 *llsa = (struct sockaddr *)sdl;
735 return (0);
736#endif
737#ifdef INET6
738 case AF_INET6:
739 sin6 = (struct sockaddr_in6 *)sa;
740 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
741 /*
742 * An IP6 address of 0 means listen to all
743 * of the Ethernet multicast address used for IP6.
744 * (This is used for multicast routers.)
745 */
746 ifp->if_flags |= IFF_ALLMULTI;
747 *llsa = 0;
748 return (0);
749 }
750 if (!IN6_IS_ADDR_MULTICAST(&sin6->sin6_addr))
751 return (EADDRNOTAVAIL);
752 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR,
753 M_NOWAIT | M_ZERO);
754 if (sdl == NULL)
755 return (ENOMEM);
756 sdl->sdl_len = sizeof *sdl;
757 sdl->sdl_family = AF_LINK;
758 sdl->sdl_index = ifp->if_index;
759 sdl->sdl_type = IFT_FDDI;
760 sdl->sdl_nlen = 0;
761 sdl->sdl_alen = FDDI_ADDR_LEN;
762 sdl->sdl_slen = 0;
763 e_addr = LLADDR(sdl);
764 ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, e_addr);
765 *llsa = (struct sockaddr *)sdl;
766 return (0);
767#endif
768
769 default:
770 /*
771 * Well, the text isn't quite right, but it's the name
772 * that counts...
773 */
774 return (EAFNOSUPPORT);
775 }
776
777 return (0);
778}
779
780static moduledata_t fddi_mod = {
781 "fddi", /* module name */
782 NULL, /* event handler */
783 0 /* extra data */
784};
785
786DECLARE_MODULE(fddi, fddi_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
787MODULE_VERSION(fddi, 1);
|