1 /* 2 * CDDL HEADER START 3 * 4 * The contents of this file are subject to the terms of the 5 * Common Development and Distribution License (the "License"). 6 * You may not use this file except in compliance with the License. 7 * 8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 9 * or http://www.opensolaris.org/os/licensing. 10 * See the License for the specific language governing permissions 11 * and limitations under the License. 12 * 13 * When distributing Covered Code, include this CDDL HEADER in each 14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 15 * If applicable, add the following below this CDDL HEADER, with the 16 * fields enclosed by brackets "[]" replaced with your own identifying 17 * information: Portions Copyright [yyyy] [name of copyright owner] 18 * 19 * CDDL HEADER END 20 */ 21 /* 22 * Copyright 2009 Sun Microsystems, Inc. All rights reserved. 23 * Use is subject to license terms. 24 */ 25 26 /* 27 * Data-Link Services Module 28 */ 29 30 #include <sys/sysmacros.h> 31 #include <sys/strsubr.h> 32 #include <sys/strsun.h> 33 #include <sys/vlan.h> 34 #include <sys/dld_impl.h> 35 #include <sys/sdt.h> 36 #include <sys/atomic.h> 37 38 static void dls_bpf_newzone(dls_link_t *dlp, zoneid_t zid); 39 40 static kmem_cache_t *i_dls_link_cachep; 41 mod_hash_t *i_dls_link_hash; 42 static uint_t i_dls_link_count; 43 44 #define LINK_HASHSZ 67 /* prime */ 45 #define IMPL_HASHSZ 67 /* prime */ 46 47 /* 48 * Construct a hash key encompassing both DLSAP value and VLAN idenitifier. 49 */ 50 #define MAKE_KEY(_sap) \ 51 ((mod_hash_key_t)(uintptr_t)((_sap) << VLAN_ID_SIZE)) 52 53 #define DLS_STRIP_PADDING(pktsize, p) { \ 54 if (pktsize != 0) { \ 55 ssize_t delta = pktsize - msgdsize(p); \ 56 \ 57 if (delta < 0) \ 58 (void) adjmsg(p, delta); \ 59 } \ 60 } 61 62 /* 63 * Private functions. 64 */ 65 66 /*ARGSUSED*/ 67 static int 68 i_dls_link_constructor(void *buf, void *arg, int kmflag) 69 { 70 dls_link_t *dlp = buf; 71 char name[MAXNAMELEN]; 72 73 bzero(buf, sizeof (dls_link_t)); 74 75 (void) snprintf(name, MAXNAMELEN, "dls_link_t_%p_hash", buf); 76 dlp->dl_str_hash = mod_hash_create_idhash(name, IMPL_HASHSZ, 77 mod_hash_null_valdtor); 78 79 return (0); 80 } 81 82 /*ARGSUSED*/ 83 static void 84 i_dls_link_destructor(void *buf, void *arg) 85 { 86 dls_link_t *dlp = buf; 87 88 ASSERT(dlp->dl_ref == 0); 89 ASSERT(dlp->dl_mh == NULL); 90 ASSERT(dlp->dl_mah == NULL); 91 ASSERT(dlp->dl_unknowns == 0); 92 93 mod_hash_destroy_idhash(dlp->dl_str_hash); 94 dlp->dl_str_hash = NULL; 95 96 } 97 98 /* 99 * - Parse the mac header information of the given packet. 100 * - Strip the padding and skip over the header. Note that because some 101 * DLS consumers only check the db_ref count of the first mblk, we 102 * pullup the message into a single mblk. Because the original message 103 * is freed as the result of message pulling up, dls_link_header_info() 104 * is called again to update the mhi_saddr and mhi_daddr pointers in the 105 * mhip. Further, the dls_link_header_info() function ensures that the 106 * size of the pulled message is greater than the MAC header size, 107 * therefore we can directly advance b_rptr to point at the payload. 108 * 109 * We choose to use a macro for performance reasons. 110 */ 111 #define DLS_PREPARE_PKT(dlp, mp, mhip, err) { \ 112 mblk_t *nextp = (mp)->b_next; \ 113 if (((err) = dls_link_header_info((dlp), (mp), (mhip))) == 0) { \ 114 DLS_STRIP_PADDING((mhip)->mhi_pktsize, (mp)); \ 115 if (MBLKL((mp)) < (mhip)->mhi_hdrsize) { \ 116 mblk_t *newmp; \ 117 if ((newmp = msgpullup((mp), -1)) == NULL) { \ 118 (err) = EINVAL; \ 119 } else { \ 120 (mp)->b_next = NULL; \ 121 freemsg((mp)); \ 122 (mp) = newmp; \ 123 VERIFY(dls_link_header_info((dlp), \ 124 (mp), (mhip)) == 0); \ 125 (mp)->b_next = nextp; \ 126 (mp)->b_rptr += (mhip)->mhi_hdrsize; \ 127 } \ 128 } else { \ 129 (mp)->b_rptr += (mhip)->mhi_hdrsize; \ 130 } \ 131 } \ 132 } 133 134 /* 135 * Truncate the chain starting at mp such that all packets in the chain 136 * have identical source and destination addresses, saps, and tag types 137 * (see below). It returns a pointer to the mblk following the chain, 138 * NULL if there is no further packet following the processed chain. 139 * The countp argument is set to the number of valid packets in the chain. 140 * Note that the whole MAC header (including the VLAN tag if any) in each 141 * packet will be stripped. 142 */ 143 static mblk_t * 144 i_dls_link_subchain(dls_link_t *dlp, mblk_t *mp, const mac_header_info_t *mhip, 145 uint_t *countp) 146 { 147 mblk_t *prevp; 148 uint_t npacket = 1; 149 size_t addr_size = dlp->dl_mip->mi_addr_length; 150 uint16_t vid = VLAN_ID(mhip->mhi_tci); 151 uint16_t pri = VLAN_PRI(mhip->mhi_tci); 152 153 /* 154 * Compare with subsequent headers until we find one that has 155 * differing header information. After checking each packet 156 * strip padding and skip over the header. 157 */ 158 for (prevp = mp; (mp = mp->b_next) != NULL; prevp = mp) { 159 mac_header_info_t cmhi; 160 uint16_t cvid, cpri; 161 int err; 162 163 DLS_PREPARE_PKT(dlp, mp, &cmhi, err); 164 if (err != 0) 165 break; 166 167 prevp->b_next = mp; 168 169 /* 170 * The source, destination, sap, vlan tag must all match in 171 * a given subchain. 172 */ 173 if (mhip->mhi_saddr == NULL || cmhi.mhi_saddr == NULL || 174 memcmp(mhip->mhi_daddr, cmhi.mhi_daddr, addr_size) != 0 || 175 memcmp(mhip->mhi_saddr, cmhi.mhi_saddr, addr_size) != 0 || 176 mhip->mhi_bindsap != cmhi.mhi_bindsap) { 177 /* 178 * Note that we don't need to restore the padding. 179 */ 180 mp->b_rptr -= cmhi.mhi_hdrsize; 181 break; 182 } 183 184 cvid = VLAN_ID(cmhi.mhi_tci); 185 cpri = VLAN_PRI(cmhi.mhi_tci); 186 187 /* 188 * There are several types of packets. Packets don't match 189 * if they are classified to different type or if they are 190 * VLAN packets but belong to different VLANs: 191 * 192 * packet type tagged vid pri 193 * --------------------------------------------------------- 194 * untagged No zero zero 195 * VLAN packets Yes non-zero - 196 * priority tagged Yes zero non-zero 197 * 0 tagged Yes zero zero 198 */ 199 if ((mhip->mhi_istagged != cmhi.mhi_istagged) || 200 (vid != cvid) || ((vid == VLAN_ID_NONE) && 201 (((pri == 0) && (cpri != 0)) || 202 ((pri != 0) && (cpri == 0))))) { 203 mp->b_rptr -= cmhi.mhi_hdrsize; 204 break; 205 } 206 207 npacket++; 208 } 209 210 /* 211 * Break the chain at this point and return a pointer to the next 212 * sub-chain. 213 */ 214 prevp->b_next = NULL; 215 *countp = npacket; 216 return (mp); 217 } 218 219 /* ARGSUSED */ 220 static int 221 i_dls_head_hold(mod_hash_key_t key, mod_hash_val_t val) 222 { 223 dls_head_t *dhp = (dls_head_t *)val; 224 225 /* 226 * The lock order is mod_hash's internal lock -> dh_lock as in the 227 * call to i_dls_link_rx -> mod_hash_find_cb_rval -> i_dls_head_hold 228 */ 229 mutex_enter(&dhp->dh_lock); 230 if (dhp->dh_removing) { 231 mutex_exit(&dhp->dh_lock); 232 return (-1); 233 } 234 dhp->dh_ref++; 235 mutex_exit(&dhp->dh_lock); 236 return (0); 237 } 238 239 void 240 i_dls_head_rele(dls_head_t *dhp) 241 { 242 mutex_enter(&dhp->dh_lock); 243 dhp->dh_ref--; 244 if (dhp->dh_ref == 0 && dhp->dh_removing != 0) 245 cv_broadcast(&dhp->dh_cv); 246 mutex_exit(&dhp->dh_lock); 247 } 248 249 static dls_head_t * 250 i_dls_head_alloc(mod_hash_key_t key) 251 { 252 dls_head_t *dhp; 253 254 dhp = kmem_zalloc(sizeof (dls_head_t), KM_SLEEP); 255 dhp->dh_key = key; 256 return (dhp); 257 } 258 259 static void 260 i_dls_head_free(dls_head_t *dhp) 261 { 262 ASSERT(dhp->dh_ref == 0); 263 kmem_free(dhp, sizeof (dls_head_t)); 264 } 265 266 /* 267 * Try to send mp up to the streams of the given sap and vid. Return B_TRUE 268 * if this message is sent to any streams. 269 * Note that this function will copy the message chain and the original 270 * mp will remain valid after this function 271 */ 272 static uint_t 273 i_dls_link_rx_func(dls_link_t *dlp, mac_resource_handle_t mrh, 274 mac_header_info_t *mhip, mblk_t *mp, uint32_t sap, 275 boolean_t (*acceptfunc)()) 276 { 277 mod_hash_t *hash = dlp->dl_str_hash; 278 mod_hash_key_t key; 279 dls_head_t *dhp; 280 dld_str_t *dsp; 281 mblk_t *nmp; 282 dls_rx_t ds_rx; 283 void *ds_rx_arg; 284 uint_t naccepted = 0; 285 int rval; 286 287 /* 288 * Construct a hash key from the VLAN identifier and the 289 * DLSAP that represents dld_str_t in promiscuous mode. 290 */ 291 key = MAKE_KEY(sap); 292 293 /* 294 * Search the hash table for dld_str_t eligible to receive 295 * a packet chain for this DLSAP/VLAN combination. The mod hash's 296 * internal lock serializes find/insert/remove from the mod hash list. 297 * Incrementing the dh_ref (while holding the mod hash lock) ensures 298 * dls_link_remove will wait for the upcall to finish. 299 */ 300 if (mod_hash_find_cb_rval(hash, key, (mod_hash_val_t *)&dhp, 301 i_dls_head_hold, &rval) != 0 || (rval != 0)) { 302 return (B_FALSE); 303 } 304 305 /* 306 * Find dld_str_t that will accept the sub-chain. 307 */ 308 for (dsp = dhp->dh_list; dsp != NULL; dsp = dsp->ds_next) { 309 if (!acceptfunc(dsp, mhip, &ds_rx, &ds_rx_arg)) 310 continue; 311 312 /* 313 * We have at least one acceptor. 314 */ 315 naccepted++; 316 317 /* 318 * There will normally be at least more dld_str_t 319 * (since we've yet to check for non-promiscuous 320 * dld_str_t) so dup the sub-chain. 321 */ 322 if ((nmp = copymsgchain(mp)) != NULL) 323 ds_rx(ds_rx_arg, mrh, nmp, mhip); 324 } 325 326 /* 327 * Release the hold on the dld_str_t chain now that we have 328 * finished walking it. 329 */ 330 i_dls_head_rele(dhp); 331 return (naccepted); 332 } 333 334 /* ARGSUSED */ 335 void 336 i_dls_link_rx(void *arg, mac_resource_handle_t mrh, mblk_t *mp, 337 boolean_t loopback) 338 { 339 dls_link_t *dlp = arg; 340 mod_hash_t *hash = dlp->dl_str_hash; 341 mblk_t *nextp; 342 mac_header_info_t mhi; 343 dls_head_t *dhp; 344 dld_str_t *dsp; 345 dld_str_t *ndsp; 346 mblk_t *nmp; 347 mod_hash_key_t key; 348 uint_t npacket; 349 boolean_t accepted; 350 dls_rx_t ds_rx, nds_rx; 351 void *ds_rx_arg, *nds_rx_arg; 352 uint16_t vid; 353 int err, rval; 354 355 /* 356 * Walk the packet chain. 357 */ 358 for (; mp != NULL; mp = nextp) { 359 /* 360 * Wipe the accepted state. 361 */ 362 accepted = B_FALSE; 363 364 DLS_PREPARE_PKT(dlp, mp, &mhi, err); 365 if (err != 0) { 366 atomic_add_32(&(dlp->dl_unknowns), 1); 367 nextp = mp->b_next; 368 mp->b_next = NULL; 369 freemsg(mp); 370 continue; 371 } 372 373 /* 374 * Grab the longest sub-chain we can process as a single 375 * unit. 376 */ 377 nextp = i_dls_link_subchain(dlp, mp, &mhi, &npacket); 378 ASSERT(npacket != 0); 379 380 vid = VLAN_ID(mhi.mhi_tci); 381 382 if (mhi.mhi_istagged) { 383 /* 384 * If it is tagged traffic, send it upstream to 385 * all dld_str_t which are attached to the physical 386 * link and bound to SAP 0x8100. 387 */ 388 if (i_dls_link_rx_func(dlp, mrh, &mhi, mp, 389 ETHERTYPE_VLAN, dls_accept) > 0) { 390 accepted = B_TRUE; 391 } 392 393 /* 394 * Don't pass the packets up if they are tagged 395 * packets and: 396 * - their VID and priority are both zero and the 397 * original packet isn't using the PVID (invalid 398 * packets). 399 * - their sap is ETHERTYPE_VLAN and their VID is 400 * zero as they have already been sent upstreams. 401 */ 402 if ((vid == VLAN_ID_NONE && !mhi.mhi_ispvid && 403 VLAN_PRI(mhi.mhi_tci) == 0) || 404 (mhi.mhi_bindsap == ETHERTYPE_VLAN && 405 vid == VLAN_ID_NONE)) { 406 freemsgchain(mp); 407 goto loop; 408 } 409 } 410 411 /* 412 * Construct a hash key from the VLAN identifier and the 413 * DLSAP. 414 */ 415 key = MAKE_KEY(mhi.mhi_bindsap); 416 417 /* 418 * Search the has table for dld_str_t eligible to receive 419 * a packet chain for this DLSAP/VLAN combination. 420 */ 421 if (mod_hash_find_cb_rval(hash, key, (mod_hash_val_t *)&dhp, 422 i_dls_head_hold, &rval) != 0 || (rval != 0)) { 423 freemsgchain(mp); 424 goto loop; 425 } 426 427 /* 428 * Find the first dld_str_t that will accept the sub-chain. 429 */ 430 for (dsp = dhp->dh_list; dsp != NULL; dsp = dsp->ds_next) 431 if (dls_accept(dsp, &mhi, &ds_rx, &ds_rx_arg)) 432 break; 433 434 /* 435 * If we did not find any dld_str_t willing to accept the 436 * sub-chain then throw it away. 437 */ 438 if (dsp == NULL) { 439 i_dls_head_rele(dhp); 440 freemsgchain(mp); 441 goto loop; 442 } 443 444 /* 445 * We have at least one acceptor. 446 */ 447 accepted = B_TRUE; 448 for (;;) { 449 /* 450 * Find the next dld_str_t that will accept the 451 * sub-chain. 452 */ 453 for (ndsp = dsp->ds_next; ndsp != NULL; 454 ndsp = ndsp->ds_next) 455 if (dls_accept(ndsp, &mhi, &nds_rx, 456 &nds_rx_arg)) 457 break; 458 459 /* 460 * If there are no more dld_str_t that are willing 461 * to accept the sub-chain then we don't need to dup 462 * it before handing it to the current one. 463 */ 464 if (ndsp == NULL) { 465 ds_rx(ds_rx_arg, mrh, mp, &mhi); 466 467 /* 468 * Since there are no more dld_str_t, we're 469 * done. 470 */ 471 break; 472 } 473 474 /* 475 * There are more dld_str_t so dup the sub-chain. 476 */ 477 if ((nmp = copymsgchain(mp)) != NULL) 478 ds_rx(ds_rx_arg, mrh, nmp, &mhi); 479 480 dsp = ndsp; 481 ds_rx = nds_rx; 482 ds_rx_arg = nds_rx_arg; 483 } 484 485 /* 486 * Release the hold on the dld_str_t chain now that we have 487 * finished walking it. 488 */ 489 i_dls_head_rele(dhp); 490 491 loop: 492 /* 493 * If there were no acceptors then add the packet count to the 494 * 'unknown' count. 495 */ 496 if (!accepted) 497 atomic_add_32(&(dlp->dl_unknowns), npacket); 498 } 499 } 500 501 /* ARGSUSED */ 502 void 503 dls_rx_vlan_promisc(void *arg, mac_resource_handle_t mrh, mblk_t *mp, 504 boolean_t loopback) 505 { 506 dld_str_t *dsp = arg; 507 dls_link_t *dlp = dsp->ds_dlp; 508 mac_header_info_t mhi; 509 dls_rx_t ds_rx; 510 void *ds_rx_arg; 511 int err; 512 513 DLS_PREPARE_PKT(dlp, mp, &mhi, err); 514 if (err != 0) 515 goto drop; 516 517 /* 518 * If there is promiscuous handle for vlan, we filter out the untagged 519 * pkts and pkts that are not for the primary unicast address. 520 */ 521 if (dsp->ds_vlan_mph != NULL) { 522 uint8_t prim_addr[MAXMACADDRLEN]; 523 size_t addr_length = dsp->ds_mip->mi_addr_length; 524 525 if (!(mhi.mhi_istagged)) 526 goto drop; 527 ASSERT(dsp->ds_mh != NULL); 528 mac_unicast_primary_get(dsp->ds_mh, (uint8_t *)prim_addr); 529 if (memcmp(mhi.mhi_daddr, prim_addr, addr_length) != 0) 530 goto drop; 531 532 if (!dls_accept(dsp, &mhi, &ds_rx, &ds_rx_arg)) 533 goto drop; 534 535 ds_rx(ds_rx_arg, NULL, mp, &mhi); 536 return; 537 } 538 539 drop: 540 atomic_add_32(&dlp->dl_unknowns, 1); 541 freemsg(mp); 542 } 543 544 /* ARGSUSED */ 545 void 546 dls_rx_promisc(void *arg, mac_resource_handle_t mrh, mblk_t *mp, 547 boolean_t loopback) 548 { 549 dld_str_t *dsp = arg; 550 dls_link_t *dlp = dsp->ds_dlp; 551 mac_header_info_t mhi; 552 dls_rx_t ds_rx; 553 void *ds_rx_arg; 554 int err; 555 dls_head_t *dhp; 556 mod_hash_key_t key; 557 558 DLS_PREPARE_PKT(dlp, mp, &mhi, err); 559 if (err != 0) 560 goto drop; 561 562 /* 563 * In order to filter out sap pkt that no dls channel listens, search 564 * the hash table trying to find a dld_str_t eligible to receive the pkt 565 */ 566 if ((dsp->ds_promisc & DLS_PROMISC_SAP) == 0) { 567 key = MAKE_KEY(mhi.mhi_bindsap); 568 if (mod_hash_find(dsp->ds_dlp->dl_str_hash, key, 569 (mod_hash_val_t *)&dhp) != 0) 570 goto drop; 571 } 572 573 if (!dls_accept_promisc(dsp, &mhi, &ds_rx, &ds_rx_arg, loopback)) 574 goto drop; 575 576 ds_rx(ds_rx_arg, NULL, mp, &mhi); 577 return; 578 579 drop: 580 atomic_add_32(&dlp->dl_unknowns, 1); 581 freemsg(mp); 582 } 583 584 static void 585 i_dls_link_destroy(dls_link_t *dlp) 586 { 587 ASSERT(dlp->dl_nactive == 0); 588 ASSERT(dlp->dl_impl_count == 0); 589 ASSERT(dlp->dl_zone_ref == 0); 590 591 /* 592 * Free the structure back to the cache. 593 */ 594 if (dlp->dl_mch != NULL) 595 mac_client_close(dlp->dl_mch, 0); 596 597 if (dlp->dl_mh != NULL) { 598 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 599 mac_close(dlp->dl_mh); 600 } 601 602 dlp->dl_mh = NULL; 603 dlp->dl_mch = NULL; 604 dlp->dl_mip = NULL; 605 dlp->dl_unknowns = 0; 606 kmem_cache_free(i_dls_link_cachep, dlp); 607 } 608 609 static int 610 i_dls_link_create(const char *name, dls_link_t **dlpp) 611 { 612 dls_link_t *dlp; 613 int err; 614 615 /* 616 * Allocate a new dls_link_t structure. 617 */ 618 dlp = kmem_cache_alloc(i_dls_link_cachep, KM_SLEEP); 619 620 /* 621 * Name the dls_link_t after the MAC interface it represents. 622 */ 623 (void) strlcpy(dlp->dl_name, name, sizeof (dlp->dl_name)); 624 625 /* 626 * First reference; hold open the MAC interface. 627 */ 628 ASSERT(dlp->dl_mh == NULL); 629 err = mac_open(dlp->dl_name, &dlp->dl_mh); 630 if (err != 0) 631 goto bail; 632 633 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 634 dlp->dl_mip = mac_info(dlp->dl_mh); 635 636 /* DLS is the "primary" MAC client */ 637 ASSERT(dlp->dl_mch == NULL); 638 639 err = mac_client_open(dlp->dl_mh, &dlp->dl_mch, NULL, 640 MAC_OPEN_FLAGS_USE_DATALINK_NAME); 641 if (err != 0) 642 goto bail; 643 644 DTRACE_PROBE2(dls__primary__client, char *, dlp->dl_name, void *, 645 dlp->dl_mch); 646 647 *dlpp = dlp; 648 return (0); 649 650 bail: 651 i_dls_link_destroy(dlp); 652 return (err); 653 } 654 655 /* 656 * Module initialization functions. 657 */ 658 659 void 660 dls_link_init(void) 661 { 662 /* 663 * Create a kmem_cache of dls_link_t structures. 664 */ 665 i_dls_link_cachep = kmem_cache_create("dls_link_cache", 666 sizeof (dls_link_t), 0, i_dls_link_constructor, 667 i_dls_link_destructor, NULL, NULL, NULL, 0); 668 ASSERT(i_dls_link_cachep != NULL); 669 670 /* 671 * Create a dls_link_t hash table and associated lock. 672 */ 673 i_dls_link_hash = mod_hash_create_extended("dls_link_hash", 674 IMPL_HASHSZ, mod_hash_null_keydtor, mod_hash_null_valdtor, 675 mod_hash_bystr, NULL, mod_hash_strkey_cmp, KM_SLEEP); 676 i_dls_link_count = 0; 677 } 678 679 int 680 dls_link_fini(void) 681 { 682 if (i_dls_link_count > 0) 683 return (EBUSY); 684 685 /* 686 * Destroy the kmem_cache. 687 */ 688 kmem_cache_destroy(i_dls_link_cachep); 689 690 /* 691 * Destroy the hash table and associated lock. 692 */ 693 mod_hash_destroy_hash(i_dls_link_hash); 694 return (0); 695 } 696 697 /* 698 * Exported functions. 699 */ 700 701 static int 702 dls_link_hold_common(const char *name, dls_link_t **dlpp, boolean_t create) 703 { 704 dls_link_t *dlp; 705 int err; 706 707 /* 708 * Look up a dls_link_t corresponding to the given macname in the 709 * global hash table. The i_dls_link_hash itself is protected by the 710 * mod_hash package's internal lock which synchronizes 711 * find/insert/remove into the global mod_hash list. Assumes that 712 * inserts and removes are single threaded on a per mac end point 713 * by the mac perimeter. 714 */ 715 if ((err = mod_hash_find(i_dls_link_hash, (mod_hash_key_t)name, 716 (mod_hash_val_t *)&dlp)) == 0) 717 goto done; 718 719 ASSERT(err == MH_ERR_NOTFOUND); 720 if (!create) 721 return (ENOENT); 722 723 /* 724 * We didn't find anything so we need to create one. 725 */ 726 if ((err = i_dls_link_create(name, &dlp)) != 0) 727 return (err); 728 729 /* 730 * Insert the dls_link_t. 731 */ 732 err = mod_hash_insert(i_dls_link_hash, (mod_hash_key_t)dlp->dl_name, 733 (mod_hash_val_t)dlp); 734 ASSERT(err == 0); 735 736 atomic_add_32(&i_dls_link_count, 1); 737 ASSERT(i_dls_link_count != 0); 738 739 done: 740 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 741 /* 742 * Bump the reference count and hand back the reference. 743 */ 744 dlp->dl_ref++; 745 *dlpp = dlp; 746 return (0); 747 } 748 749 int 750 dls_link_hold_create(const char *name, dls_link_t **dlpp) 751 { 752 return (dls_link_hold_common(name, dlpp, B_TRUE)); 753 } 754 755 int 756 dls_link_hold(const char *name, dls_link_t **dlpp) 757 { 758 return (dls_link_hold_common(name, dlpp, B_FALSE)); 759 } 760 761 dev_info_t * 762 dls_link_devinfo(dev_t dev) 763 { 764 dls_link_t *dlp; 765 dev_info_t *dip; 766 char macname[MAXNAMELEN]; 767 char *drv; 768 mac_perim_handle_t mph; 769 770 if ((drv = ddi_major_to_name(getmajor(dev))) == NULL) 771 return (NULL); 772 (void) snprintf(macname, MAXNAMELEN, "%s%d", drv, 773 DLS_MINOR2INST(getminor(dev))); 774 775 /* 776 * The code below assumes that the name constructed above is the 777 * macname. This is not the case for legacy devices. Currently this 778 * is ok because this function is only called in the getinfo(9e) path, 779 * which for a legacy device would directly end up in the driver's 780 * getinfo, rather than here 781 */ 782 if (mac_perim_enter_by_macname(macname, &mph) != 0) 783 return (NULL); 784 785 if (dls_link_hold(macname, &dlp) != 0) { 786 mac_perim_exit(mph); 787 return (NULL); 788 } 789 790 dip = mac_devinfo_get(dlp->dl_mh); 791 dls_link_rele(dlp); 792 mac_perim_exit(mph); 793 794 return (dip); 795 } 796 797 dev_t 798 dls_link_dev(dls_link_t *dlp) 799 { 800 return (makedevice(ddi_driver_major(mac_devinfo_get(dlp->dl_mh)), 801 mac_minor(dlp->dl_mh))); 802 } 803 804 void 805 dls_link_rele(dls_link_t *dlp) 806 { 807 mod_hash_val_t val; 808 809 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 810 /* 811 * Check if there are any more references. 812 */ 813 if (--dlp->dl_ref == 0) { 814 (void) mod_hash_remove(i_dls_link_hash, 815 (mod_hash_key_t)dlp->dl_name, &val); 816 ASSERT(dlp == (dls_link_t *)val); 817 818 /* 819 * Destroy the dls_link_t. 820 */ 821 i_dls_link_destroy(dlp); 822 ASSERT(i_dls_link_count > 0); 823 atomic_add_32(&i_dls_link_count, -1); 824 } 825 } 826 827 int 828 dls_link_rele_by_name(const char *name) 829 { 830 dls_link_t *dlp; 831 832 if (mod_hash_find(i_dls_link_hash, (mod_hash_key_t)name, 833 (mod_hash_val_t *)&dlp) != 0) 834 return (ENOENT); 835 836 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 837 838 /* 839 * Must fail detach if mac client is busy. 840 */ 841 ASSERT(dlp->dl_ref > 0 && dlp->dl_mch != NULL); 842 if (mac_link_has_flows(dlp->dl_mch)) 843 return (ENOTEMPTY); 844 845 dls_link_rele(dlp); 846 return (0); 847 } 848 849 int 850 dls_link_setzid(const char *name, zoneid_t zid) 851 { 852 dls_link_t *dlp; 853 int err = 0; 854 zoneid_t old_zid; 855 856 if ((err = dls_link_hold_create(name, &dlp)) != 0) 857 return (err); 858 859 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 860 861 if ((old_zid = dlp->dl_zid) == zid) 862 goto done; 863 864 /* 865 * Check whether this dlp is used by its own zone. If yes, we cannot 866 * change its zoneid. 867 */ 868 if (dlp->dl_zone_ref != 0) { 869 err = EBUSY; 870 goto done; 871 } 872 873 dls_bpf_newzone(dlp, zid); 874 dlp->dl_zid = zid; 875 876 if (zid == GLOBAL_ZONEID) { 877 /* 878 * The link is moving from a non-global zone to the global 879 * zone, so we need to release the reference that was held 880 * when the link was originally assigned to the non-global 881 * zone. 882 */ 883 dls_link_rele(dlp); 884 } 885 886 done: 887 /* 888 * We only keep the reference to this link open if the link has 889 * successfully moved from the global zone to a non-global zone. 890 */ 891 if (err != 0 || old_zid != GLOBAL_ZONEID) 892 dls_link_rele(dlp); 893 return (err); 894 } 895 896 897 /* 898 * When a NIC changes zone, that change needs to be communicated to BPF 899 * so that it can correctly enforce access rights on it via BPF. In the 900 * absence of a function from BPF to just change the zoneid, this is 901 * done with a detach followed by an attach. 902 */ 903 static void 904 dls_bpf_newzone(dls_link_t *dlp, zoneid_t zid) 905 { 906 if (dls_bpfdetach_fn != NULL) 907 dls_bpfdetach_fn((uintptr_t)dlp->dl_mh); 908 909 if (dls_bpfattach_fn != NULL) 910 dls_bpfattach_fn((uintptr_t)dlp->dl_mh, mac_type(dlp->dl_mh), 911 zid, BPR_MAC); 912 } 913 914 int 915 dls_link_getzid(const char *name, zoneid_t *zidp) 916 { 917 dls_link_t *dlp; 918 int err = 0; 919 920 if ((err = dls_link_hold(name, &dlp)) != 0) 921 return (err); 922 923 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 924 925 *zidp = dlp->dl_zid; 926 927 dls_link_rele(dlp); 928 return (0); 929 } 930 931 void 932 dls_link_add(dls_link_t *dlp, uint32_t sap, dld_str_t *dsp) 933 { 934 mod_hash_t *hash = dlp->dl_str_hash; 935 mod_hash_key_t key; 936 dls_head_t *dhp; 937 dld_str_t *p; 938 int err; 939 940 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 941 942 /* 943 * Generate a hash key based on the sap. 944 */ 945 key = MAKE_KEY(sap); 946 947 /* 948 * Search the table for a list head with this key. 949 */ 950 if ((err = mod_hash_find(hash, key, (mod_hash_val_t *)&dhp)) != 0) { 951 ASSERT(err == MH_ERR_NOTFOUND); 952 953 dhp = i_dls_head_alloc(key); 954 err = mod_hash_insert(hash, key, (mod_hash_val_t)dhp); 955 ASSERT(err == 0); 956 } 957 958 /* 959 * Add the dld_str_t to the head of the list. List walkers in 960 * i_dls_link_rx_* bump up dh_ref to ensure the list does not change 961 * while they walk the list. The membar below ensures that list walkers 962 * see exactly the old list or the new list. 963 */ 964 ASSERT(dsp->ds_next == NULL); 965 p = dhp->dh_list; 966 dsp->ds_next = p; 967 968 membar_producer(); 969 970 dhp->dh_list = dsp; 971 972 /* 973 * Save a pointer to the list head. 974 */ 975 dsp->ds_head = dhp; 976 dlp->dl_impl_count++; 977 } 978 979 void 980 dls_link_remove(dls_link_t *dlp, dld_str_t *dsp) 981 { 982 mod_hash_t *hash = dlp->dl_str_hash; 983 dld_str_t **pp; 984 dld_str_t *p; 985 dls_head_t *dhp; 986 987 ASSERT(MAC_PERIM_HELD(dlp->dl_mh)); 988 989 /* 990 * We set dh_removing here to tell the receive callbacks not to pass 991 * up packets anymore. Then wait till the current callbacks are done. 992 * This happens either in the close path or in processing the 993 * DL_UNBIND_REQ via a taskq thread, and it is ok to cv_wait in either. 994 * The dh_ref ensures there aren't and there won't be any upcalls 995 * walking or using the dh_list. The mod hash internal lock ensures 996 * that the insert/remove of the dls_head_t itself synchronizes with 997 * any i_dls_link_rx trying to locate it. The perimeter ensures that 998 * there isn't another simultaneous dls_link_add/remove. 999 */ 1000 dhp = dsp->ds_head; 1001 1002 mutex_enter(&dhp->dh_lock); 1003 dhp->dh_removing = B_TRUE; 1004 while (dhp->dh_ref != 0) 1005 cv_wait(&dhp->dh_cv, &dhp->dh_lock); 1006 mutex_exit(&dhp->dh_lock); 1007 1008 /* 1009 * Walk the list and remove the dld_str_t. 1010 */ 1011 for (pp = &dhp->dh_list; (p = *pp) != NULL; pp = &(p->ds_next)) { 1012 if (p == dsp) 1013 break; 1014 } 1015 ASSERT(p != NULL); 1016 *pp = p->ds_next; 1017 p->ds_next = NULL; 1018 p->ds_head = NULL; 1019 1020 ASSERT(dlp->dl_impl_count != 0); 1021 dlp->dl_impl_count--; 1022 1023 if (dhp->dh_list == NULL) { 1024 mod_hash_val_t val = NULL; 1025 1026 /* 1027 * The list is empty so remove the hash table entry. 1028 */ 1029 (void) mod_hash_remove(hash, dhp->dh_key, &val); 1030 ASSERT(dhp == (dls_head_t *)val); 1031 i_dls_head_free(dhp); 1032 } else { 1033 mutex_enter(&dhp->dh_lock); 1034 dhp->dh_removing = B_FALSE; 1035 mutex_exit(&dhp->dh_lock); 1036 } 1037 } 1038 1039 int 1040 dls_link_header_info(dls_link_t *dlp, mblk_t *mp, mac_header_info_t *mhip) 1041 { 1042 boolean_t is_ethernet = (dlp->dl_mip->mi_media == DL_ETHER); 1043 uint16_t pvid = mac_get_pvid(dlp->dl_mh); 1044 int err = 0; 1045 1046 /* 1047 * Packets should always be at least 16 bit aligned. 1048 */ 1049 ASSERT(IS_P2ALIGNED(mp->b_rptr, sizeof (uint16_t))); 1050 1051 if ((err = mac_header_info(dlp->dl_mh, mp, mhip)) != 0) 1052 return (err); 1053 1054 /* 1055 * If this is a VLAN-tagged Ethernet packet, then the SAP in the 1056 * mac_header_info_t as returned by mac_header_info() is 1057 * ETHERTYPE_VLAN. We need to grab the ethertype from the VLAN header. 1058 */ 1059 mhip->mhi_ispvid = B_FALSE; 1060 if (is_ethernet && (mhip->mhi_bindsap == ETHERTYPE_VLAN)) { 1061 struct ether_vlan_header *evhp; 1062 uint16_t sap; 1063 mblk_t *tmp = NULL; 1064 size_t size; 1065 1066 size = sizeof (struct ether_vlan_header); 1067 if (MBLKL(mp) < size) { 1068 /* 1069 * Pullup the message in order to get the MAC header 1070 * infomation. Note that this is a read-only function, 1071 * we keep the input packet intact. 1072 */ 1073 if ((tmp = msgpullup(mp, size)) == NULL) 1074 return (EINVAL); 1075 1076 mp = tmp; 1077 } 1078 evhp = (struct ether_vlan_header *)mp->b_rptr; 1079 sap = ntohs(evhp->ether_type); 1080 (void) mac_sap_verify(dlp->dl_mh, sap, &mhip->mhi_bindsap); 1081 mhip->mhi_hdrsize = sizeof (struct ether_vlan_header); 1082 mhip->mhi_tci = ntohs(evhp->ether_tci); 1083 mhip->mhi_istagged = B_TRUE; 1084 freemsg(tmp); 1085 1086 /* 1087 * If this port has a non-zero PVID, then we have to lie to the 1088 * caller about the VLAN ID. It's always zero on receive for 1089 * that VLAN. 1090 */ 1091 if (pvid != VLAN_ID_NONE && VLAN_ID(mhip->mhi_tci) == pvid) { 1092 mhip->mhi_tci &= ~(VLAN_ID_MASK << VLAN_ID_SHIFT); 1093 mhip->mhi_ispvid = B_TRUE; 1094 } 1095 1096 if (VLAN_CFI(mhip->mhi_tci) != ETHER_CFI) 1097 return (EINVAL); 1098 } else { 1099 mhip->mhi_istagged = B_FALSE; 1100 mhip->mhi_tci = 0; 1101 } 1102 1103 return (0); 1104 } 1105