if_ethersubr.c revision 34649
1/* 2 * Copyright (c) 1982, 1989, 1993 3 * The Regents of the University of California. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * This product includes software developed by the University of 16 * California, Berkeley and its contributors. 17 * 4. Neither the name of the University nor the names of its contributors 18 * may be used to endorse or promote products derived from this software 19 * without specific prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY THE REGENTS 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 REGENTS 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 * @(#)if_ethersubr.c 8.1 (Berkeley) 6/10/93 34 * $Id: if_ethersubr.c,v 1.45 1998/02/20 13:11:49 bde Exp $ 35 */ 36 37#include "opt_atalk.h" 38#include "opt_inet.h" 39#include "opt_ipx.h" 40 41#include <sys/param.h> 42#include <sys/systm.h> 43#include <sys/kernel.h> 44#include <sys/malloc.h> 45#include <sys/mbuf.h> 46#include <sys/socket.h> 47#include <sys/sockio.h> 48#include <sys/sysctl.h> 49 50#include <net/if.h> 51#include <net/netisr.h> 52#include <net/route.h> 53#include <net/if_llc.h> 54#include <net/if_dl.h> 55#include <net/if_types.h> 56 57#ifdef INET 58#include <netinet/in.h> 59#include <netinet/in_var.h> 60#include <netinet/if_ether.h> 61#endif 62 63#ifdef IPX 64#include <netipx/ipx.h> 65#include <netipx/ipx_if.h> 66#endif 67 68#ifdef NS 69#include <netns/ns.h> 70#include <netns/ns_if.h> 71ushort ns_nettype; 72int ether_outputdebug = 0; 73int ether_inputdebug = 0; 74#endif 75 76#ifdef ISO 77#include <netiso/argo_debug.h> 78#include <netiso/iso.h> 79#include <netiso/iso_var.h> 80#include <netiso/iso_snpac.h> 81#endif 82 83/*#ifdef LLC 84#include <netccitt/dll.h> 85#include <netccitt/llc_var.h> 86#endif*/ 87 88#if defined(LLC) && defined(CCITT) 89extern struct ifqueue pkintrq; 90#endif 91 92#ifdef NETATALK 93#include <netatalk/at.h> 94#include <netatalk/at_var.h> 95#include <netatalk/at_extern.h> 96 97#define llc_snap_org_code llc_un.type_snap.org_code 98#define llc_snap_ether_type llc_un.type_snap.ether_type 99 100extern u_char at_org_code[3]; 101extern u_char aarp_org_code[3]; 102#endif /* NETATALK */ 103 104#include "vlan.h" 105#if NVLAN > 0 106#include <net/if_vlan_var.h> 107#endif /* NVLAN > 0 */ 108 109static int ether_resolvemulti __P((struct ifnet *, struct sockaddr **, 110 struct sockaddr *)); 111u_char etherbroadcastaddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 112#define senderr(e) { error = (e); goto bad;} 113 114/* 115 * Ethernet output routine. 116 * Encapsulate a packet of type family for the local net. 117 * Use trailer local net encapsulation if enough data in first 118 * packet leaves a multiple of 512 bytes of data in remainder. 119 * Assumes that ifp is actually pointer to arpcom structure. 120 */ 121int 122ether_output(ifp, m0, dst, rt0) 123 register struct ifnet *ifp; 124 struct mbuf *m0; 125 struct sockaddr *dst; 126 struct rtentry *rt0; 127{ 128 short type; 129 int s, error = 0; 130 u_char edst[6]; 131 register struct mbuf *m = m0; 132 register struct rtentry *rt; 133 struct mbuf *mcopy = (struct mbuf *)0; 134 register struct ether_header *eh; 135 int off, len = m->m_pkthdr.len; 136 struct arpcom *ac = (struct arpcom *)ifp; 137#ifdef NETATALK 138 struct at_ifaddr *aa; 139#endif NETATALK 140 141 if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 142 senderr(ENETDOWN); 143 rt = rt0; 144 if (rt) { 145 if ((rt->rt_flags & RTF_UP) == 0) { 146 rt0 = rt = rtalloc1(dst, 1, 0UL); 147 if (rt0) 148 rt->rt_refcnt--; 149 else 150 senderr(EHOSTUNREACH); 151 } 152 if (rt->rt_flags & RTF_GATEWAY) { 153 if (rt->rt_gwroute == 0) 154 goto lookup; 155 if (((rt = rt->rt_gwroute)->rt_flags & RTF_UP) == 0) { 156 rtfree(rt); rt = rt0; 157 lookup: rt->rt_gwroute = rtalloc1(rt->rt_gateway, 1, 158 0UL); 159 if ((rt = rt->rt_gwroute) == 0) 160 senderr(EHOSTUNREACH); 161 } 162 } 163 if (rt->rt_flags & RTF_REJECT) 164 if (rt->rt_rmx.rmx_expire == 0 || 165 time.tv_sec < rt->rt_rmx.rmx_expire) 166 senderr(rt == rt0 ? EHOSTDOWN : EHOSTUNREACH); 167 } 168 switch (dst->sa_family) { 169 170#ifdef INET 171 case AF_INET: 172 if (!arpresolve(ac, rt, m, dst, edst, rt0)) 173 return (0); /* if not yet resolved */ 174 /* If broadcasting on a simplex interface, loopback a copy */ 175 if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX)) 176 mcopy = m_copy(m, 0, (int)M_COPYALL); 177 off = m->m_pkthdr.len - m->m_len; 178 type = htons(ETHERTYPE_IP); 179 break; 180#endif 181#ifdef IPX 182 case AF_IPX: 183 { 184 struct ifaddr *ia; 185 186 type = htons(ETHERTYPE_IPX); 187 bcopy((caddr_t)&(((struct sockaddr_ipx *)dst)->sipx_addr.x_host), 188 (caddr_t)edst, sizeof (edst)); 189 190 for(ia = ifp->if_addrhead.tqh_first; ia != 0; 191 ia = ia->ifa_link.tqe_next) { 192 if(ia->ifa_addr->sa_family == AF_IPX && 193 !bcmp((caddr_t)edst, 194 (caddr_t)&((struct ipx_ifaddr *)ia)->ia_addr.sipx_addr.x_host, 195 sizeof(edst)) ) 196 return (looutput(ifp, m, dst, rt)); 197 } 198 199 /* If broadcasting on a simplex interface, loopback a copy */ 200 if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX)) 201 mcopy = m_copy(m, 0, (int)M_COPYALL); 202 break; 203 } 204#endif 205#ifdef NETATALK 206 case AF_APPLETALK: 207 { 208 struct sockaddr_at *sat = (struct sockaddr_at *)dst; 209 210 /* 211 * super hack.. 212 * Most of this loopback code should move into the appletalk 213 * code, but it's here for now.. remember to move it! [JRE] 214 * This may not get the same interface we started with, 215 * fix asap. XXX 216 */ 217 aa = at_ifawithnet( sat ); 218 if (aa == NULL) { 219 goto bad; 220 } 221 if( aa->aa_ifa.ifa_ifp != ifp ) { 222 (*aa->aa_ifa.ifa_ifp->if_output)(aa->aa_ifa.ifa_ifp, 223 m,dst,rt); 224 } 225 if (((sat->sat_addr.s_net == ATADDR_ANYNET) 226 && (sat->sat_addr.s_node == ATADDR_ANYNODE)) 227 || ((sat->sat_addr.s_net == aa->aa_addr.sat_addr.s_net ) 228 && (sat->sat_addr.s_node == aa->aa_addr.sat_addr.s_node))) { 229 (void) looutput(ifp, m, dst, rt); 230 return(0); 231 } 232 233 if (!aarpresolve(ac, m, (struct sockaddr_at *)dst, edst)) { 234#ifdef NETATALKDEBUG 235 extern char *prsockaddr(struct sockaddr *); 236 printf("aarpresolv: failed for %s\n", prsockaddr(dst)); 237#endif /* NETATALKDEBUG */ 238 return (0); 239 } 240 241 /* 242 * If broadcasting on a simplex interface, loopback a copy 243 */ 244 if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX)) 245 mcopy = m_copy(m, 0, (int)M_COPYALL); 246 } 247 /* 248 * In the phase 2 case, we need to prepend an mbuf for the llc header. 249 * Since we must preserve the value of m, which is passed to us by 250 * value, we m_copy() the first mbuf, and use it for our llc header. 251 */ 252 if ( aa->aa_flags & AFA_PHASE2 ) { 253 struct llc llc; 254 255 M_PREPEND(m, sizeof(struct llc), M_WAIT); 256 len += sizeof(struct llc); 257 llc.llc_dsap = llc.llc_ssap = LLC_SNAP_LSAP; 258 llc.llc_control = LLC_UI; 259 bcopy(at_org_code, llc.llc_snap_org_code, sizeof(at_org_code)); 260 llc.llc_snap_ether_type = htons( ETHERTYPE_AT ); 261 bcopy(&llc, mtod(m, caddr_t), sizeof(struct llc)); 262 type = htons(m->m_pkthdr.len); 263 } else { 264 type = htons(ETHERTYPE_AT); 265 } 266 break; 267#endif NETATALK 268#ifdef NS 269 case AF_NS: 270 switch(ns_nettype){ 271 default: 272 case 0x8137: /* Novell Ethernet_II Ethernet TYPE II */ 273 type = 0x8137; 274 break; 275 case 0x0: /* Novell 802.3 */ 276 type = htons( m->m_pkthdr.len); 277 break; 278 case 0xe0e0: /* Novell 802.2 and Token-Ring */ 279 M_PREPEND(m, 3, M_WAIT); 280 type = htons( m->m_pkthdr.len); 281 cp = mtod(m, u_char *); 282 *cp++ = 0xE0; 283 *cp++ = 0xE0; 284 *cp++ = 0x03; 285 break; 286 } 287 bcopy((caddr_t)&(((struct sockaddr_ns *)dst)->sns_addr.x_host), 288 (caddr_t)edst, sizeof (edst)); 289 if (!bcmp((caddr_t)edst, (caddr_t)&ns_thishost, sizeof(edst))){ 290 m->m_pkthdr.rcvif = ifp; 291 schednetisr(NETISR_NS); 292 inq = &nsintrq; 293 s = splimp(); 294 if (IF_QFULL(inq)) { 295 IF_DROP(inq); 296 m_freem(m); 297 } else 298 IF_ENQUEUE(inq, m); 299 splx(s); 300 return (error); 301 } 302 if (!bcmp((caddr_t)edst, (caddr_t)&ns_broadhost, sizeof(edst))){ 303 m2 = m_copy(m, 0, (int)M_COPYALL); 304 m2->m_pkthdr.rcvif = ifp; 305 schednetisr(NETISR_NS); 306 inq = &nsintrq; 307 s = splimp(); 308 if (IF_QFULL(inq)) { 309 IF_DROP(inq); 310 m_freem(m2); 311 } else 312 IF_ENQUEUE(inq, m2); 313 splx(s); 314 } 315 /* If broadcasting on a simplex interface, loopback a copy */ 316 if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX)){ 317 mcopy = m_copy(m, 0, (int)M_COPYALL); 318 } 319 break; 320#endif /* NS */ 321#ifdef ISO 322 case AF_ISO: { 323 int snpalen; 324 struct llc *l; 325 register struct sockaddr_dl *sdl; 326 327 if (rt && (sdl = (struct sockaddr_dl *)rt->rt_gateway) && 328 sdl->sdl_family == AF_LINK && sdl->sdl_alen > 0) { 329 bcopy(LLADDR(sdl), (caddr_t)edst, sizeof(edst)); 330 } else if (error = 331 iso_snparesolve(ifp, (struct sockaddr_iso *)dst, 332 (char *)edst, &snpalen)) 333 goto bad; /* Not Resolved */ 334 /* If broadcasting on a simplex interface, loopback a copy */ 335 if (*edst & 1) 336 m->m_flags |= (M_BCAST|M_MCAST); 337 if ((m->m_flags & M_BCAST) && (ifp->if_flags & IFF_SIMPLEX) && 338 (mcopy = m_copy(m, 0, (int)M_COPYALL))) { 339 M_PREPEND(mcopy, sizeof (*eh), M_DONTWAIT); 340 if (mcopy) { 341 eh = mtod(mcopy, struct ether_header *); 342 bcopy((caddr_t)edst, 343 (caddr_t)eh->ether_dhost, sizeof (edst)); 344 bcopy((caddr_t)ac->ac_enaddr, 345 (caddr_t)eh->ether_shost, sizeof (edst)); 346 } 347 } 348 M_PREPEND(m, 3, M_DONTWAIT); 349 if (m == NULL) 350 return (0); 351 type = htons(m->m_pkthdr.len); 352 l = mtod(m, struct llc *); 353 l->llc_dsap = l->llc_ssap = LLC_ISO_LSAP; 354 l->llc_control = LLC_UI; 355 len += 3; 356 IFDEBUG(D_ETHER) 357 int i; 358 printf("unoutput: sending pkt to: "); 359 for (i=0; i<6; i++) 360 printf("%x ", edst[i] & 0xff); 361 printf("\n"); 362 ENDDEBUG 363 } break; 364#endif /* ISO */ 365#ifdef LLC 366/* case AF_NSAP: */ 367 case AF_CCITT: { 368 register struct sockaddr_dl *sdl = 369 (struct sockaddr_dl *) rt -> rt_gateway; 370 371 if (sdl && sdl->sdl_family == AF_LINK 372 && sdl->sdl_alen > 0) { 373 bcopy(LLADDR(sdl), (char *)edst, 374 sizeof(edst)); 375 } else goto bad; /* Not a link interface ? Funny ... */ 376 if ((ifp->if_flags & IFF_SIMPLEX) && (*edst & 1) && 377 (mcopy = m_copy(m, 0, (int)M_COPYALL))) { 378 M_PREPEND(mcopy, sizeof (*eh), M_DONTWAIT); 379 if (mcopy) { 380 eh = mtod(mcopy, struct ether_header *); 381 bcopy((caddr_t)edst, 382 (caddr_t)eh->ether_dhost, sizeof (edst)); 383 bcopy((caddr_t)ac->ac_enaddr, 384 (caddr_t)eh->ether_shost, sizeof (edst)); 385 } 386 } 387 type = htons(m->m_pkthdr.len); 388#ifdef LLC_DEBUG 389 { 390 int i; 391 register struct llc *l = mtod(m, struct llc *); 392 393 printf("ether_output: sending LLC2 pkt to: "); 394 for (i=0; i<6; i++) 395 printf("%x ", edst[i] & 0xff); 396 printf(" len 0x%x dsap 0x%x ssap 0x%x control 0x%x\n", 397 type & 0xff, l->llc_dsap & 0xff, l->llc_ssap &0xff, 398 l->llc_control & 0xff); 399 400 } 401#endif /* LLC_DEBUG */ 402 } break; 403#endif /* LLC */ 404 405 case AF_UNSPEC: 406 eh = (struct ether_header *)dst->sa_data; 407 (void)memcpy(edst, eh->ether_dhost, sizeof (edst)); 408 type = eh->ether_type; 409 break; 410 411 default: 412 printf("%s%d: can't handle af%d\n", ifp->if_name, ifp->if_unit, 413 dst->sa_family); 414 senderr(EAFNOSUPPORT); 415 } 416 417 418 if (mcopy) 419 (void) looutput(ifp, mcopy, dst, rt); 420 /* 421 * Add local net header. If no space in first mbuf, 422 * allocate another. 423 */ 424 M_PREPEND(m, sizeof (struct ether_header), M_DONTWAIT); 425 if (m == 0) 426 senderr(ENOBUFS); 427 eh = mtod(m, struct ether_header *); 428 (void)memcpy(&eh->ether_type, &type, 429 sizeof(eh->ether_type)); 430 (void)memcpy(eh->ether_dhost, edst, sizeof (edst)); 431 (void)memcpy(eh->ether_shost, ac->ac_enaddr, 432 sizeof(eh->ether_shost)); 433 s = splimp(); 434 /* 435 * Queue message on interface, and start output if interface 436 * not yet active. 437 */ 438 if (IF_QFULL(&ifp->if_snd)) { 439 IF_DROP(&ifp->if_snd); 440 splx(s); 441 senderr(ENOBUFS); 442 } 443 IF_ENQUEUE(&ifp->if_snd, m); 444 if ((ifp->if_flags & IFF_OACTIVE) == 0) 445 (*ifp->if_start)(ifp); 446 splx(s); 447 ifp->if_obytes += len + sizeof (struct ether_header); 448 if (m->m_flags & M_MCAST) 449 ifp->if_omcasts++; 450 return (error); 451 452bad: 453 if (m) 454 m_freem(m); 455 return (error); 456} 457 458/* 459 * Process a received Ethernet packet; 460 * the packet is in the mbuf chain m without 461 * the ether header, which is provided separately. 462 */ 463void 464ether_input(ifp, eh, m) 465 struct ifnet *ifp; 466 register struct ether_header *eh; 467 struct mbuf *m; 468{ 469 register struct ifqueue *inq; 470 u_short ether_type; 471 int s; 472#if defined (ISO) || defined (LLC) || defined(NETATALK) 473 register struct llc *l; 474#endif 475 476 if ((ifp->if_flags & IFF_UP) == 0) { 477 m_freem(m); 478 return; 479 } 480 ifp->if_ibytes += m->m_pkthdr.len + sizeof (*eh); 481 if (eh->ether_dhost[0] & 1) { 482 if (bcmp((caddr_t)etherbroadcastaddr, (caddr_t)eh->ether_dhost, 483 sizeof(etherbroadcastaddr)) == 0) 484 m->m_flags |= M_BCAST; 485 else 486 m->m_flags |= M_MCAST; 487 } 488 if (m->m_flags & (M_BCAST|M_MCAST)) 489 ifp->if_imcasts++; 490 491 ether_type = ntohs(eh->ether_type); 492 493#if NVLAN > 0 494 if (ether_type == vlan_proto) { 495 if (vlan_input(eh, m) < 0) 496 ifp->if_data.ifi_noproto++; 497 return; 498 } 499#endif /* NVLAN > 0 */ 500 501 switch (ether_type) { 502#ifdef INET 503 case ETHERTYPE_IP: 504 schednetisr(NETISR_IP); 505 inq = &ipintrq; 506 break; 507 508 case ETHERTYPE_ARP: 509 schednetisr(NETISR_ARP); 510 inq = &arpintrq; 511 break; 512#endif 513#ifdef IPX 514 case ETHERTYPE_IPX: 515 schednetisr(NETISR_IPX); 516 inq = &ipxintrq; 517 break; 518#endif 519#ifdef NS 520 case 0x8137: /* Novell Ethernet_II Ethernet TYPE II */ 521 schednetisr(NETISR_NS); 522 inq = &nsintrq; 523 break; 524 525#endif /* NS */ 526#ifdef NETATALK 527 case ETHERTYPE_AT: 528 schednetisr(NETISR_ATALK); 529 inq = &atintrq1; 530 break; 531 case ETHERTYPE_AARP: 532 /* probably this should be done with a NETISR as well */ 533 aarpinput((struct arpcom *)ifp, m); /* XXX */ 534 return; 535#endif NETATALK 536 default: 537#ifdef NS 538 checksum = mtod(m, ushort *); 539 /* Novell 802.3 */ 540 if ((ether_type <= ETHERMTU) && 541 ((*checksum == 0xffff) || (*checksum == 0xE0E0))){ 542 if(*checksum == 0xE0E0) { 543 m->m_pkthdr.len -= 3; 544 m->m_len -= 3; 545 m->m_data += 3; 546 } 547 schednetisr(NETISR_NS); 548 inq = &nsintrq; 549 break; 550 } 551#endif /* NS */ 552#if defined (ISO) || defined (LLC) || defined(NETATALK) 553 if (ether_type > ETHERMTU) 554 goto dropanyway; 555 l = mtod(m, struct llc *); 556 switch (l->llc_dsap) { 557#ifdef NETATALK 558 case LLC_SNAP_LSAP: 559 switch (l->llc_control) { 560 case LLC_UI: 561 if (l->llc_ssap != LLC_SNAP_LSAP) 562 goto dropanyway; 563 564 if (Bcmp(&(l->llc_snap_org_code)[0], at_org_code, 565 sizeof(at_org_code)) == 0 && 566 ntohs(l->llc_snap_ether_type) == ETHERTYPE_AT) { 567 inq = &atintrq2; 568 m_adj( m, sizeof( struct llc )); 569 schednetisr(NETISR_ATALK); 570 break; 571 } 572 573 if (Bcmp(&(l->llc_snap_org_code)[0], aarp_org_code, 574 sizeof(aarp_org_code)) == 0 && 575 ntohs(l->llc_snap_ether_type) == ETHERTYPE_AARP) { 576 m_adj( m, sizeof( struct llc )); 577 aarpinput((struct arpcom *)ifp, m); /* XXX */ 578 return; 579 } 580 581 default: 582 goto dropanyway; 583 } 584 break; 585#endif NETATALK 586#ifdef ISO 587 case LLC_ISO_LSAP: 588 switch (l->llc_control) { 589 case LLC_UI: 590 /* LLC_UI_P forbidden in class 1 service */ 591 if ((l->llc_dsap == LLC_ISO_LSAP) && 592 (l->llc_ssap == LLC_ISO_LSAP)) { 593 /* LSAP for ISO */ 594 if (m->m_pkthdr.len > ether_type) 595 m_adj(m, ether_type - m->m_pkthdr.len); 596 m->m_data += 3; /* XXX */ 597 m->m_len -= 3; /* XXX */ 598 m->m_pkthdr.len -= 3; /* XXX */ 599 M_PREPEND(m, sizeof *eh, M_DONTWAIT); 600 if (m == 0) 601 return; 602 *mtod(m, struct ether_header *) = *eh; 603 IFDEBUG(D_ETHER) 604 printf("clnp packet"); 605 ENDDEBUG 606 schednetisr(NETISR_ISO); 607 inq = &clnlintrq; 608 break; 609 } 610 goto dropanyway; 611 612 case LLC_XID: 613 case LLC_XID_P: 614 if(m->m_len < 6) 615 goto dropanyway; 616 l->llc_window = 0; 617 l->llc_fid = 9; 618 l->llc_class = 1; 619 l->llc_dsap = l->llc_ssap = 0; 620 /* Fall through to */ 621 case LLC_TEST: 622 case LLC_TEST_P: 623 { 624 struct sockaddr sa; 625 register struct ether_header *eh2; 626 int i; 627 u_char c = l->llc_dsap; 628 629 l->llc_dsap = l->llc_ssap; 630 l->llc_ssap = c; 631 if (m->m_flags & (M_BCAST | M_MCAST)) 632 bcopy((caddr_t)ac->ac_enaddr, 633 (caddr_t)eh->ether_dhost, 6); 634 sa.sa_family = AF_UNSPEC; 635 sa.sa_len = sizeof(sa); 636 eh2 = (struct ether_header *)sa.sa_data; 637 for (i = 0; i < 6; i++) { 638 eh2->ether_shost[i] = c = eh->ether_dhost[i]; 639 eh2->ether_dhost[i] = 640 eh->ether_dhost[i] = eh->ether_shost[i]; 641 eh->ether_shost[i] = c; 642 } 643 ifp->if_output(ifp, m, &sa, NULL); 644 return; 645 } 646 default: 647 m_freem(m); 648 return; 649 } 650 break; 651#endif /* ISO */ 652#ifdef LLC 653 case LLC_X25_LSAP: 654 { 655 if (m->m_pkthdr.len > ether_type) 656 m_adj(m, ether_type - m->m_pkthdr.len); 657 M_PREPEND(m, sizeof(struct sdl_hdr) , M_DONTWAIT); 658 if (m == 0) 659 return; 660 if ( !sdl_sethdrif(ifp, eh->ether_shost, LLC_X25_LSAP, 661 eh->ether_dhost, LLC_X25_LSAP, 6, 662 mtod(m, struct sdl_hdr *))) 663 panic("ETHER cons addr failure"); 664 mtod(m, struct sdl_hdr *)->sdlhdr_len = ether_type; 665#ifdef LLC_DEBUG 666 printf("llc packet\n"); 667#endif /* LLC_DEBUG */ 668 schednetisr(NETISR_CCITT); 669 inq = &llcintrq; 670 break; 671 } 672#endif /* LLC */ 673 dropanyway: 674 default: 675 m_freem(m); 676 return; 677 } 678#else /* ISO || LLC || NETATALK */ 679 m_freem(m); 680 return; 681#endif /* ISO || LLC || NETATALK */ 682 } 683 684 s = splimp(); 685 if (IF_QFULL(inq)) { 686 IF_DROP(inq); 687 m_freem(m); 688 } else 689 IF_ENQUEUE(inq, m); 690 splx(s); 691} 692 693/* 694 * Perform common duties while attaching to interface list 695 */ 696void 697ether_ifattach(ifp) 698 register struct ifnet *ifp; 699{ 700 register struct ifaddr *ifa; 701 register struct sockaddr_dl *sdl; 702 703 ifp->if_type = IFT_ETHER; 704 ifp->if_addrlen = 6; 705 ifp->if_hdrlen = 14; 706 ifp->if_mtu = ETHERMTU; 707 ifp->if_resolvemulti = ether_resolvemulti; 708 if (ifp->if_baudrate == 0) 709 ifp->if_baudrate = 10000000; 710 ifa = ifnet_addrs[ifp->if_index - 1]; 711 if (ifa == 0) { 712 printf("ether_ifattach: no lladdr!\n"); 713 return; 714 } 715 sdl = (struct sockaddr_dl *)ifa->ifa_addr; 716 sdl->sdl_type = IFT_ETHER; 717 sdl->sdl_alen = ifp->if_addrlen; 718 bcopy(((struct arpcom *)ifp)->ac_enaddr, LLADDR(sdl), ifp->if_addrlen); 719} 720 721SYSCTL_NODE(_net_link, IFT_ETHER, ether, CTLFLAG_RW, 0, "Ethernet"); 722 723int 724ether_ioctl(ifp, command, data) 725 struct ifnet *ifp; 726 int command; 727 caddr_t data; 728{ 729 struct ifaddr *ifa = (struct ifaddr *) data; 730 struct ifreq *ifr = (struct ifreq *) data; 731 int error = 0; 732 733 switch (command) { 734 case SIOCSIFADDR: 735 ifp->if_flags |= IFF_UP; 736 737 switch (ifa->ifa_addr->sa_family) { 738#ifdef INET 739 case AF_INET: 740 ifp->if_init(ifp->if_softc); /* before arpwhohas */ 741 arp_ifinit((struct arpcom *)ifp, ifa); 742 break; 743#endif 744#ifdef IPX 745 /* 746 * XXX - This code is probably wrong 747 */ 748 case AF_IPX: 749 { 750 register struct ipx_addr *ina = &(IA_SIPX(ifa)->sipx_addr); 751 struct arpcom *ac = (struct arpcom *) (ifp->if_softc); 752 753 if (ipx_nullhost(*ina)) 754 ina->x_host = 755 *(union ipx_host *) 756 ac->ac_enaddr; 757 else { 758 bcopy((caddr_t) ina->x_host.c_host, 759 (caddr_t) ac->ac_enaddr, 760 sizeof(ac->ac_enaddr)); 761 } 762 763 /* 764 * Set new address 765 */ 766 ifp->if_init(ifp->if_softc); 767 break; 768 } 769#endif 770#ifdef NS 771 /* 772 * XXX - This code is probably wrong 773 */ 774 case AF_NS: 775 { 776 register struct ns_addr *ina = &(IA_SNS(ifa)->sns_addr); 777 struct arpcom *ac = (struct arpcom *) (ifp->if_softc); 778 779 if (ns_nullhost(*ina)) 780 ina->x_host = 781 *(union ns_host *) (ac->ac_enaddr); 782 else { 783 bcopy((caddr_t) ina->x_host.c_host, 784 (caddr_t) ac->ac_enaddr, 785 sizeof(ac->ac_enaddr)); 786 } 787 788 /* 789 * Set new address 790 */ 791 ifp->if_init(ifp->if_softc); 792 break; 793 } 794#endif 795 default: 796 ifp->if_init(ifp->if_softc); 797 break; 798 } 799 break; 800 801 case SIOCGIFADDR: 802 { 803 struct sockaddr *sa; 804 805 sa = (struct sockaddr *) & ifr->ifr_data; 806 bcopy(((struct arpcom *)ifp->if_softc)->ac_enaddr, 807 (caddr_t) sa->sa_data, ETHER_ADDR_LEN); 808 } 809 break; 810 811 case SIOCSIFMTU: 812 /* 813 * Set the interface MTU. 814 */ 815 if (ifr->ifr_mtu > ETHERMTU) { 816 error = EINVAL; 817 } else { 818 ifp->if_mtu = ifr->ifr_mtu; 819 } 820 break; 821 } 822 return (error); 823} 824 825int 826ether_resolvemulti(ifp, llsa, sa) 827 struct ifnet *ifp; 828 struct sockaddr **llsa; 829 struct sockaddr *sa; 830{ 831 struct sockaddr_dl *sdl; 832 struct sockaddr_in *sin; 833 u_char *e_addr; 834 835 switch(sa->sa_family) { 836 case AF_LINK: 837 /* 838 * No mapping needed. Just check that it's a valid MC address. 839 */ 840 sdl = (struct sockaddr_dl *)sa; 841 e_addr = LLADDR(sdl); 842 if ((e_addr[0] & 1) != 1) 843 return EADDRNOTAVAIL; 844 *llsa = 0; 845 return 0; 846 847#ifdef INET 848 case AF_INET: 849 sin = (struct sockaddr_in *)sa; 850 if (!IN_MULTICAST(ntohl(sin->sin_addr.s_addr))) 851 return EADDRNOTAVAIL; 852 MALLOC(sdl, struct sockaddr_dl *, sizeof *sdl, M_IFMADDR, 853 M_WAITOK); 854 sdl->sdl_len = sizeof *sdl; 855 sdl->sdl_family = AF_LINK; 856 sdl->sdl_index = ifp->if_index; 857 sdl->sdl_type = IFT_ETHER; 858 sdl->sdl_nlen = 0; 859 sdl->sdl_alen = ETHER_ADDR_LEN; 860 sdl->sdl_slen = 0; 861 e_addr = LLADDR(sdl); 862 ETHER_MAP_IP_MULTICAST(&sin->sin_addr, e_addr); 863 *llsa = (struct sockaddr *)sdl; 864 return 0; 865#endif 866 867 default: 868 /* 869 * Well, the text isn't quite right, but it's the name 870 * that counts... 871 */ 872 return EAFNOSUPPORT; 873 } 874} 875