Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)
[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]
FreeBSD/Linux Kernel Cross Reference
sys/net/if_iso88025subr.c
Version:
- FREEBSD - FREEBSD-13-STABLE - FREEBSD-13-0 - FREEBSD-12-STABLE - FREEBSD-12-0 - FREEBSD-11-STABLE - FREEBSD-11-0 - FREEBSD-10-STABLE - FREEBSD-10-0 - FREEBSD-9-STABLE - FREEBSD-9-0 - FREEBSD-8-STABLE - FREEBSD-8-0 - FREEBSD-7-STABLE - FREEBSD-7-0 - FREEBSD-6-STABLE - FREEBSD-6-0 - FREEBSD-5-STABLE - FREEBSD-5-0 - FREEBSD-4-STABLE - FREEBSD-3-STABLE - FREEBSD22 - l41 - OPENBSD - linux-2.6 - MK84 - PLAN9 - xnu-8792
SearchContext: - none - 3 - 10
SearchContext: - none - 3 - 10
1 /*- 2 * Copyright (c) 1998, Larry Lile 3 * All rights reserved. 4 * 5 * For latest sources and information on this driver, please 6 * go to http://anarchy.stdio.com. 7 * 8 * Questions, comments or suggestions should be directed to 9 * Larry Lile <lile@stdio.com>. 10 * 11 * Redistribution and use in source and binary forms, with or without 12 * modification, are permitted provided that the following conditions 13 * are met: 14 * 1. Redistributions of source code must retain the above copyright 15 * notice unmodified, this list of conditions, and the following 16 * disclaimer. 17 * 2. Redistributions in binary form must reproduce the above copyright 18 * notice, this list of conditions and the following disclaimer in the 19 * documentation and/or other materials provided with the distribution. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 23 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 24 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 25 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 26 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 27 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 28 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 29 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 30 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * $FreeBSD: releng/5.4/sys/net/if_iso88025subr.c 145335 2005-04-20 19:11:07Z cvs2svn $ 34 * 35 */ 36 37 /* 38 * 39 * General ISO 802.5 (Token Ring) support routines 40 * 41 */ 42 43 #include "opt_inet.h" 44 #include "opt_inet6.h" 45 #include "opt_ipx.h" 46 #include "opt_mac.h" 47 48 #include <sys/param.h> 49 #include <sys/systm.h> 50 #include <sys/kernel.h> 51 #include <sys/mac.h> 52 #include <sys/malloc.h> 53 #include <sys/mbuf.h> 54 #include <sys/module.h> 55 #include <sys/socket.h> 56 #include <sys/sockio.h> 57 58 #include <net/if.h> 59 #include <net/if_dl.h> 60 #include <net/if_llc.h> 61 #include <net/if_types.h> 62 63 #include <net/netisr.h> 64 #include <net/route.h> 65 #include <net/bpf.h> 66 #include <net/iso88025.h> 67 68 #if defined(INET) || defined(INET6) 69 #include <netinet/in.h> 70 #include <netinet/in_var.h> 71 #include <netinet/if_ether.h> 72 #endif 73 #ifdef INET6 74 #include <netinet6/nd6.h> 75 #endif 76 77 #ifdef IPX 78 #include <netipx/ipx.h> 79 #include <netipx/ipx_if.h> 80 #endif 81 82 static const u_char iso88025_broadcastaddr[ISO88025_ADDR_LEN] = 83 { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 84 85 static int iso88025_resolvemulti (struct ifnet *, struct sockaddr **, 86 struct sockaddr *); 87 88 #define senderr(e) do { error = (e); goto bad; } while (0) 89 90 /* 91 * Perform common duties while attaching to interface list 92 */ 93 void 94 iso88025_ifattach(struct ifnet *ifp, int bpf) 95 { 96 struct ifaddr *ifa; 97 struct sockaddr_dl *sdl; 98 99 ifa = NULL; 100 101 ifp->if_type = IFT_ISO88025; 102 ifp->if_addrlen = ISO88025_ADDR_LEN; 103 ifp->if_hdrlen = ISO88025_HDR_LEN; 104 105 if_attach(ifp); /* Must be called before additional assignments */ 106 107 ifp->if_output = iso88025_output; 108 ifp->if_input = iso88025_input; 109 ifp->if_resolvemulti = iso88025_resolvemulti; 110 ifp->if_broadcastaddr = iso88025_broadcastaddr; 111 112 if (ifp->if_baudrate == 0) 113 ifp->if_baudrate = TR_16MBPS; /* 16Mbit should be a safe default */ 114 if (ifp->if_mtu == 0) 115 ifp->if_mtu = ISO88025_DEFAULT_MTU; 116 117 ifa = ifaddr_byindex(ifp->if_index); 118 if (ifa == 0) { 119 if_printf(ifp, "%s() no lladdr!\n", __func__); 120 return; 121 } 122 123 sdl = (struct sockaddr_dl *)ifa->ifa_addr; 124 sdl->sdl_type = IFT_ISO88025; 125 sdl->sdl_alen = ifp->if_addrlen; 126 bcopy(IFP2AC(ifp)->ac_enaddr, LLADDR(sdl), ifp->if_addrlen); 127 128 if (bpf) 129 bpfattach(ifp, DLT_IEEE802, ISO88025_HDR_LEN); 130 131 return; 132 } 133 134 /* 135 * Perform common duties while detaching a Token Ring interface 136 */ 137 void 138 iso88025_ifdetach(ifp, bpf) 139 struct ifnet *ifp; 140 int bpf; 141 { 142 143 if (bpf) 144 bpfdetach(ifp); 145 146 if_detach(ifp); 147 148 return; 149 } 150 151 int 152 iso88025_ioctl(struct ifnet *ifp, int command, caddr_t data) 153 { 154 struct ifaddr *ifa; 155 struct ifreq *ifr; 156 int error; 157 158 ifa = (struct ifaddr *) data; 159 ifr = (struct ifreq *) data; 160 error = 0; 161 162 switch (command) { 163 case SIOCSIFADDR: 164 ifp->if_flags |= IFF_UP; 165 166 switch (ifa->ifa_addr->sa_family) { 167 #ifdef INET 168 case AF_INET: 169 ifp->if_init(ifp->if_softc); /* before arpwhohas */ 170 arp_ifinit(ifp, ifa); 171 break; 172 #endif /* INET */ 173 #ifdef IPX 174 /* 175 * XXX - This code is probably wrong 176 */ 177 case AF_IPX: { 178 struct ipx_addr *ina; 179 struct arpcom *ac; 180 181 ina = &(IA_SIPX(ifa)->sipx_addr); 182 ac = IFP2AC(ifp); 183 184 if (ipx_nullhost(*ina)) 185 ina->x_host = *(union ipx_host *) 186 ac->ac_enaddr; 187 else 188 bcopy((caddr_t) ina->x_host.c_host, 189 (caddr_t) ac->ac_enaddr, 190 ISO88025_ADDR_LEN); 191 192 /* 193 * Set new address 194 */ 195 ifp->if_init(ifp->if_softc); 196 } 197 break; 198 #endif /* IPX */ 199 default: 200 ifp->if_init(ifp->if_softc); 201 break; 202 } 203 break; 204 205 case SIOCGIFADDR: { 206 struct sockaddr *sa; 207 208 sa = (struct sockaddr *) & ifr->ifr_data; 209 bcopy(IFP2AC(ifp)->ac_enaddr, 210 (caddr_t) sa->sa_data, ISO88025_ADDR_LEN); 211 } 212 break; 213 214 case SIOCSIFMTU: 215 /* 216 * Set the interface MTU. 217 */ 218 if (ifr->ifr_mtu > ISO88025_MAX_MTU) { 219 error = EINVAL; 220 } else { 221 ifp->if_mtu = ifr->ifr_mtu; 222 } 223 break; 224 default: 225 error = EINVAL; /* XXX netbsd has ENOTTY??? */ 226 break; 227 } 228 229 return (error); 230 } 231 232 /* 233 * ISO88025 encapsulation 234 */ 235 int 236 iso88025_output(ifp, m, dst, rt0) 237 struct ifnet *ifp; 238 struct mbuf *m; 239 struct sockaddr *dst; 240 struct rtentry *rt0; 241 { 242 u_int16_t snap_type = 0; 243 int loop_copy = 0, error = 0, rif_len = 0; 244 u_char edst[ISO88025_ADDR_LEN]; 245 struct iso88025_header *th; 246 struct iso88025_header gen_th; 247 struct sockaddr_dl *sdl = NULL; 248 struct rtentry *rt; 249 250 #ifdef MAC 251 error = mac_check_ifnet_transmit(ifp, m); 252 if (error) 253 senderr(error); 254 #endif 255 256 if (ifp->if_flags & IFF_MONITOR) 257 senderr(ENETDOWN); 258 if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 259 senderr(ENETDOWN); 260 getmicrotime(&ifp->if_lastchange); 261 262 /* Calculate routing info length based on arp table entry */ 263 /* XXX any better way to do this ? */ 264 error = rt_check(&rt, &rt0, dst); 265 if (error) 266 goto bad; 267 268 if (rt && (sdl = (struct sockaddr_dl *)rt->rt_gateway)) 269 if (SDL_ISO88025(sdl)->trld_rcf != 0) 270 rif_len = TR_RCF_RIFLEN(SDL_ISO88025(sdl)->trld_rcf); 271 272 /* Generate a generic 802.5 header for the packet */ 273 gen_th.ac = TR_AC; 274 gen_th.fc = TR_LLC_FRAME; 275 (void)memcpy((caddr_t)gen_th.iso88025_shost, IFP2AC(ifp)->ac_enaddr, 276 ISO88025_ADDR_LEN); 277 if (rif_len) { 278 gen_th.iso88025_shost[0] |= TR_RII; 279 if (rif_len > 2) { 280 gen_th.rcf = SDL_ISO88025(sdl)->trld_rcf; 281 (void)memcpy((caddr_t)gen_th.rd, 282 (caddr_t)SDL_ISO88025(sdl)->trld_route, 283 rif_len - 2); 284 } 285 } 286 287 switch (dst->sa_family) { 288 #ifdef INET 289 case AF_INET: 290 error = arpresolve(ifp, rt0, m, dst, edst); 291 if (error) 292 return (error == EWOULDBLOCK ? 0 : error); 293 snap_type = ETHERTYPE_IP; 294 break; 295 case AF_ARP: 296 { 297 struct arphdr *ah; 298 ah = mtod(m, struct arphdr *); 299 ah->ar_hrd = htons(ARPHRD_IEEE802); 300 301 loop_copy = -1; /* if this is for us, don't do it */ 302 303 switch(ntohs(ah->ar_op)) { 304 case ARPOP_REVREQUEST: 305 case ARPOP_REVREPLY: 306 snap_type = ETHERTYPE_REVARP; 307 break; 308 case ARPOP_REQUEST: 309 case ARPOP_REPLY: 310 default: 311 snap_type = ETHERTYPE_ARP; 312 break; 313 } 314 315 if (m->m_flags & M_BCAST) 316 bcopy(ifp->if_broadcastaddr, edst, ISO88025_ADDR_LEN); 317 else 318 bcopy(ar_tha(ah), edst, ISO88025_ADDR_LEN); 319 320 } 321 break; 322 #endif /* INET */ 323 #ifdef INET6 324 case AF_INET6: 325 error = nd6_storelladdr(ifp, rt0, m, dst, (u_char *)edst); 326 if (error) 327 return (error); 328 snap_type = ETHERTYPE_IPV6; 329 break; 330 #endif /* INET6 */ 331 #ifdef IPX 332 case AF_IPX: 333 { 334 u_int8_t *cp; 335 336 bcopy((caddr_t)&(satoipx_addr(dst).x_host), (caddr_t)edst, 337 ISO88025_ADDR_LEN); 338 339 M_PREPEND(m, 3, M_TRYWAIT); 340 if (m == 0) 341 senderr(ENOBUFS); 342 m = m_pullup(m, 3); 343 if (m == 0) 344 senderr(ENOBUFS); 345 cp = mtod(m, u_int8_t *); 346 *cp++ = ETHERTYPE_IPX_8022; 347 *cp++ = ETHERTYPE_IPX_8022; 348 *cp++ = LLC_UI; 349 } 350 break; 351 #endif /* IPX */ 352 case AF_UNSPEC: 353 { 354 struct iso88025_sockaddr_data *sd; 355 /* 356 * For AF_UNSPEC sockaddr.sa_data must contain all of the 357 * mac information needed to send the packet. This allows 358 * full mac, llc, and source routing function to be controlled. 359 * llc and source routing information must already be in the 360 * mbuf provided, ac/fc are set in sa_data. sockaddr.sa_data 361 * should be an iso88025_sockaddr_data structure see iso88025.h 362 */ 363 loop_copy = -1; 364 sd = (struct iso88025_sockaddr_data *)dst->sa_data; 365 gen_th.ac = sd->ac; 366 gen_th.fc = sd->fc; 367 (void)memcpy((caddr_t)edst, (caddr_t)sd->ether_dhost, 368 ISO88025_ADDR_LEN); 369 (void)memcpy((caddr_t)gen_th.iso88025_shost, 370 (caddr_t)sd->ether_shost, ISO88025_ADDR_LEN); 371 rif_len = 0; 372 break; 373 } 374 default: 375 if_printf(ifp, "can't handle af%d\n", dst->sa_family); 376 senderr(EAFNOSUPPORT); 377 break; 378 } 379 380 /* 381 * Add LLC header. 382 */ 383 if (snap_type != 0) { 384 struct llc *l; 385 M_PREPEND(m, LLC_SNAPFRAMELEN, M_DONTWAIT); 386 if (m == 0) 387 senderr(ENOBUFS); 388 l = mtod(m, struct llc *); 389 l->llc_control = LLC_UI; 390 l->llc_dsap = l->llc_ssap = LLC_SNAP_LSAP; 391 l->llc_snap.org_code[0] = 392 l->llc_snap.org_code[1] = 393 l->llc_snap.org_code[2] = 0; 394 l->llc_snap.ether_type = htons(snap_type); 395 } 396 397 /* 398 * Add local net header. If no space in first mbuf, 399 * allocate another. 400 */ 401 M_PREPEND(m, ISO88025_HDR_LEN + rif_len, M_DONTWAIT); 402 if (m == 0) 403 senderr(ENOBUFS); 404 th = mtod(m, struct iso88025_header *); 405 bcopy((caddr_t)edst, (caddr_t)&gen_th.iso88025_dhost, ISO88025_ADDR_LEN); 406 407 /* Copy as much of the generic header as is needed into the mbuf */ 408 memcpy(th, &gen_th, ISO88025_HDR_LEN + rif_len); 409 410 /* 411 * If a simplex interface, and the packet is being sent to our 412 * Ethernet address or a broadcast address, loopback a copy. 413 * XXX To make a simplex device behave exactly like a duplex 414 * device, we should copy in the case of sending to our own 415 * ethernet address (thus letting the original actually appear 416 * on the wire). However, we don't do that here for security 417 * reasons and compatibility with the original behavior. 418 */ 419 if ((ifp->if_flags & IFF_SIMPLEX) && (loop_copy != -1)) { 420 if ((m->m_flags & M_BCAST) || (loop_copy > 0)) { 421 struct mbuf *n; 422 n = m_copy(m, 0, (int)M_COPYALL); 423 (void) if_simloop(ifp, n, dst->sa_family, 424 ISO88025_HDR_LEN); 425 } else if (bcmp(th->iso88025_dhost, th->iso88025_shost, 426 ETHER_ADDR_LEN) == 0) { 427 (void) if_simloop(ifp, m, dst->sa_family, 428 ISO88025_HDR_LEN); 429 return(0); /* XXX */ 430 } 431 } 432 433 IFQ_HANDOFF_ADJ(ifp, m, ISO88025_HDR_LEN + LLC_SNAPFRAMELEN, error); 434 if (error) { 435 printf("iso88025_output: packet dropped QFULL.\n"); 436 ifp->if_oerrors++; 437 } 438 return (error); 439 440 bad: 441 ifp->if_oerrors++; 442 if (m) 443 m_freem(m); 444 return (error); 445 } 446 447 /* 448 * ISO 88025 de-encapsulation 449 */ 450 void 451 iso88025_input(ifp, m) 452 struct ifnet *ifp; 453 struct mbuf *m; 454 { 455 struct iso88025_header *th; 456 struct llc *l; 457 int isr; 458 int mac_hdr_len; 459 460 /* 461 * Do consistency checks to verify assumptions 462 * made by code past this point. 463 */ 464 if ((m->m_flags & M_PKTHDR) == 0) { 465 if_printf(ifp, "discard frame w/o packet header\n"); 466 ifp->if_ierrors++; 467 m_freem(m); 468 return; 469 } 470 if (m->m_pkthdr.rcvif == NULL) { 471 if_printf(ifp, "discard frame w/o interface pointer\n"); 472 ifp->if_ierrors++; 473 m_freem(m); 474 return; 475 } 476 477 m = m_pullup(m, ISO88025_HDR_LEN); 478 if (m == NULL) { 479 ifp->if_ierrors++; 480 goto dropanyway; 481 } 482 th = mtod(m, struct iso88025_header *); 483 m->m_pkthdr.header = (void *)th; 484 485 /* 486 * Discard packet if interface is not up. 487 */ 488 if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 489 goto dropanyway; 490 491 /* 492 * Give bpf a chance at the packet. 493 */ 494 BPF_MTAP(ifp, m); 495 496 /* 497 * Interface marked for monitoring; discard packet. 498 */ 499 if (ifp->if_flags & IFF_MONITOR) { 500 m_freem(m); 501 return; 502 } 503 504 #ifdef MAC 505 mac_create_mbuf_from_ifnet(ifp, m); 506 #endif 507 508 /* 509 * Update interface statistics. 510 */ 511 ifp->if_ibytes += m->m_pkthdr.len; 512 getmicrotime(&ifp->if_lastchange); 513 514 /* 515 * Discard non local unicast packets when interface 516 * is in promiscuous mode. 517 */ 518 if ((ifp->if_flags & IFF_PROMISC) && 519 ((th->iso88025_dhost[0] & 1) == 0) && 520 (bcmp(IFP2AC(ifp)->ac_enaddr, (caddr_t) th->iso88025_dhost, 521 ISO88025_ADDR_LEN) != 0)) 522 goto dropanyway; 523 524 /* 525 * Set mbuf flags for bcast/mcast. 526 */ 527 if (th->iso88025_dhost[0] & 1) { 528 if (bcmp(iso88025_broadcastaddr, th->iso88025_dhost, 529 ISO88025_ADDR_LEN) == 0) 530 m->m_flags |= M_BCAST; 531 else 532 m->m_flags |= M_MCAST; 533 ifp->if_imcasts++; 534 } 535 536 mac_hdr_len = ISO88025_HDR_LEN; 537 /* Check for source routing info */ 538 if (th->iso88025_shost[0] & TR_RII) 539 mac_hdr_len += TR_RCF_RIFLEN(th->rcf); 540 541 /* Strip off ISO88025 header. */ 542 m_adj(m, mac_hdr_len); 543 544 m = m_pullup(m, LLC_SNAPFRAMELEN); 545 if (m == 0) { 546 ifp->if_ierrors++; 547 goto dropanyway; 548 } 549 l = mtod(m, struct llc *); 550 551 switch (l->llc_dsap) { 552 #ifdef IPX 553 case ETHERTYPE_IPX_8022: /* Thanks a bunch Novell */ 554 if ((l->llc_control != LLC_UI) || 555 (l->llc_ssap != ETHERTYPE_IPX_8022)) { 556 ifp->if_noproto++; 557 goto dropanyway; 558 } 559 560 th->iso88025_shost[0] &= ~(TR_RII); 561 m_adj(m, 3); 562 isr = NETISR_IPX; 563 break; 564 #endif /* IPX */ 565 case LLC_SNAP_LSAP: { 566 u_int16_t type; 567 if ((l->llc_control != LLC_UI) || 568 (l->llc_ssap != LLC_SNAP_LSAP)) { 569 ifp->if_noproto++; 570 goto dropanyway; 571 } 572 573 if (l->llc_snap.org_code[0] != 0 || 574 l->llc_snap.org_code[1] != 0 || 575 l->llc_snap.org_code[2] != 0) { 576 ifp->if_noproto++; 577 goto dropanyway; 578 } 579 580 type = ntohs(l->llc_snap.ether_type); 581 m_adj(m, LLC_SNAPFRAMELEN); 582 switch (type) { 583 #ifdef INET 584 case ETHERTYPE_IP: 585 th->iso88025_shost[0] &= ~(TR_RII); 586 if (ip_fastforward(m)) 587 return; 588 isr = NETISR_IP; 589 break; 590 591 case ETHERTYPE_ARP: 592 if (ifp->if_flags & IFF_NOARP) 593 goto dropanyway; 594 isr = NETISR_ARP; 595 break; 596 #endif /* INET */ 597 #ifdef IPX_SNAP /* XXX: Not supported! */ 598 case ETHERTYPE_IPX: 599 th->iso88025_shost[0] &= ~(TR_RII); 600 isr = NETISR_IPX; 601 break; 602 #endif /* IPX_SNAP */ 603 #ifdef INET6 604 case ETHERTYPE_IPV6: 605 th->iso88025_shost[0] &= ~(TR_RII); 606 isr = NETISR_IPV6; 607 break; 608 #endif /* INET6 */ 609 default: 610 printf("iso88025_input: unexpected llc_snap ether_type 0x%02x\n", type); 611 ifp->if_noproto++; 612 goto dropanyway; 613 } 614 break; 615 } 616 #ifdef ISO 617 case LLC_ISO_LSAP: 618 switch (l->llc_control) { 619 case LLC_UI: 620 ifp->if_noproto++; 621 goto dropanyway; 622 break; 623 case LLC_XID: 624 case LLC_XID_P: 625 if(m->m_len < ISO88025_ADDR_LEN) 626 goto dropanyway; 627 l->llc_window = 0; 628 l->llc_fid = 9; 629 l->llc_class = 1; 630 l->llc_dsap = l->llc_ssap = 0; 631 /* Fall through to */ 632 case LLC_TEST: 633 case LLC_TEST_P: 634 { 635 struct sockaddr sa; 636 struct arpcom *ac; 637 struct iso88025_sockaddr_data *th2; 638 int i; 639 u_char c; 640 641 ac = IFP2AC(ifp); 642 c = l->llc_dsap; 643 644 if (th->iso88025_shost[0] & TR_RII) { /* XXX */ 645 printf("iso88025_input: dropping source routed LLC_TEST\n"); 646 goto dropanyway; 647 } 648 l->llc_dsap = l->llc_ssap; 649 l->llc_ssap = c; 650 if (m->m_flags & (M_BCAST | M_MCAST)) 651 bcopy((caddr_t)ac->ac_enaddr, 652 (caddr_t)th->iso88025_dhost, 653 ISO88025_ADDR_LEN); 654 sa.sa_family = AF_UNSPEC; 655 sa.sa_len = sizeof(sa); 656 th2 = (struct iso88025_sockaddr_data *)sa.sa_data; 657 for (i = 0; i < ISO88025_ADDR_LEN; i++) { 658 th2->ether_shost[i] = c = th->iso88025_dhost[i]; 659 th2->ether_dhost[i] = th->iso88025_dhost[i] = 660 th->iso88025_shost[i]; 661 th->iso88025_shost[i] = c; 662 } 663 th2->ac = TR_AC; 664 th2->fc = TR_LLC_FRAME; 665 ifp->if_output(ifp, m, &sa, NULL); 666 return; 667 } 668 default: 669 printf("iso88025_input: unexpected llc control 0x%02x\n", l->llc_control); 670 ifp->if_noproto++; 671 goto dropanyway; 672 break; 673 } 674 break; 675 #endif /* ISO */ 676 default: 677 printf("iso88025_input: unknown dsap 0x%x\n", l->llc_dsap); 678 ifp->if_noproto++; 679 goto dropanyway; 680 break; 681 } 682 683 netisr_dispatch(isr, m); 684 return; 685 686 dropanyway: 687 ifp->if_iqdrops++; 688 if (m) 689 m_freem(m); 690 return; 691 } 692 693 static int 694 iso88025_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 } 716 *llsa = 0; 717 return (0); 718 719 #ifdef INET 720 case AF_INET: 721 sin = (struct sockaddr_in *)sa; 722 if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr))) { 723 return (EADDRNOTAVAIL); 724 } 725 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR, 726 M_WAITOK|M_ZERO); 727 sdl->sdl_len = sizeof *sdl; 728 sdl->sdl_family = AF_LINK; 729 sdl->sdl_index = ifp->if_index; 730 sdl->sdl_type = IFT_ISO88025; 731 sdl->sdl_alen = ISO88025_ADDR_LEN; 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 } 753 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR, 754 M_WAITOK|M_ZERO); 755 sdl->sdl_len = sizeof *sdl; 756 sdl->sdl_family = AF_LINK; 757 sdl->sdl_index = ifp->if_index; 758 sdl->sdl_type = IFT_ISO88025; 759 sdl->sdl_alen = ISO88025_ADDR_LEN; 760 e_addr = LLADDR(sdl); 761 ETHER_MAP_IPV6_MULTICAST(&sin6->sin6_addr, e_addr); 762 *llsa = (struct sockaddr *)sdl; 763 return (0); 764 #endif 765 766 default: 767 /* 768 * Well, the text isn't quite right, but it's the name 769 * that counts... 770 */ 771 return (EAFNOSUPPORT); 772 } 773 774 return (0); 775 } 776 777 static moduledata_t iso88025_mod = { 778 "iso88025", 779 NULL, 780 0 781 }; 782 783 DECLARE_MODULE(iso88025, iso88025_mod, SI_SUB_PSEUDO, SI_ORDER_ANY); 784 MODULE_VERSION(iso88025, 1);
Cache object: 3892ab011dc3b8c8d782e240025e71f2
[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]