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 * Copyright 2006 Sun Microsystems, Inc. All rights reserved. 22 * Use is subject to license terms. 23 */ 24 25 #pragma ident "%Z%%M% %I% %E% SMI" 26 27 /* 28 * gld - Generic LAN Driver 29 * media dependent routines 30 */ 31 32 #include <sys/types.h> 33 #include <sys/errno.h> 34 #include <sys/stropts.h> 35 #include <sys/stream.h> 36 #include <sys/kmem.h> 37 #include <sys/stat.h> 38 #include <sys/modctl.h> 39 #include <sys/kstat.h> 40 #include <sys/debug.h> 41 42 #include <sys/byteorder.h> 43 #include <sys/strsun.h> 44 #include <sys/dlpi.h> 45 #include <sys/ethernet.h> 46 #include <sys/multidata.h> 47 #include <sys/gld.h> 48 #include <sys/gldpriv.h> 49 #include <sys/ddi.h> 50 #include <sys/sunddi.h> 51 #include <sys/sysmacros.h> 52 #include <sys/ib/clients/ibd/ibd.h> 53 #include <sys/pattr.h> 54 55 #define DLSAPLENGTH(macinfo) \ 56 ((macinfo)->gldm_addrlen + ABS((macinfo)->gldm_saplen)) 57 58 #ifdef GLD_DEBUG 59 extern int gld_debug; 60 #endif 61 62 extern void gld_bitrevcopy(caddr_t src, caddr_t target, size_t n); 63 extern char *gld_macaddr_sprintf(char *, unsigned char *, int); 64 extern gld_vlan_t *gld_find_vlan(gld_mac_info_t *, uint32_t); 65 extern uint32_t gld_global_options; 66 67 static struct llc_snap_hdr llc_snap_def = { 68 LSAP_SNAP, /* DLSAP 0xaa */ 69 LSAP_SNAP, /* SLSAP 0xaa */ 70 CNTL_LLC_UI, /* Control 0x03 */ 71 0x00, 0x00, 0x00, /* Org[3] */ 72 0x00 /* Type */ 73 }; 74 75 #define ISETHERTYPE(snaphdr) \ 76 (snaphdr->d_lsap == LSAP_SNAP && \ 77 snaphdr->s_lsap == LSAP_SNAP && \ 78 snaphdr->control == CNTL_LLC_UI && \ 79 snaphdr->org[0] == 0 && \ 80 snaphdr->org[1] == 0 && \ 81 snaphdr->org[2] == 0) 82 83 /* ======== */ 84 /* Ethernet */ 85 /* ======== */ 86 87 static mac_addr_t ether_broadcast = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; 88 89 void 90 gld_init_ether(gld_mac_info_t *macinfo) 91 { 92 struct gldkstats *sp = 93 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->kstatp->ks_data; 94 95 /* Assumptions we make for this medium */ 96 ASSERT(macinfo->gldm_type == DL_ETHER); 97 ASSERT(macinfo->gldm_addrlen == 6); 98 ASSERT(macinfo->gldm_saplen == -2); 99 #ifndef lint 100 ASSERT(sizeof (struct ether_header) == 14); 101 ASSERT(sizeof (mac_addr_t) == 6); 102 #endif 103 104 kstat_named_init(&sp->glds_frame, "align_errors", KSTAT_DATA_ULONG); 105 kstat_named_init(&sp->glds_crc, "fcs_errors", KSTAT_DATA_ULONG); 106 kstat_named_init(&sp->glds_collisions, "collisions", KSTAT_DATA_ULONG); 107 kstat_named_init(&sp->glds_nocarrier, "carrier_errors", 108 KSTAT_DATA_ULONG); 109 kstat_named_init(&sp->glds_defer, "defer_xmts", KSTAT_DATA_ULONG); 110 kstat_named_init(&sp->glds_xmtlatecoll, "tx_late_collisions", 111 KSTAT_DATA_ULONG); 112 kstat_named_init(&sp->glds_short, "runt_errors", KSTAT_DATA_ULONG); 113 kstat_named_init(&sp->glds_excoll, "ex_collisions", KSTAT_DATA_ULONG); 114 115 /* 116 * only initialize the new statistics if the driver 117 * knows about them. 118 */ 119 if (macinfo->gldm_driver_version != GLD_VERSION_200) 120 return; 121 122 kstat_named_init(&sp->glds_dot3_first_coll, 123 "first_collisions", KSTAT_DATA_UINT32); 124 kstat_named_init(&sp->glds_dot3_multi_coll, 125 "multi_collisions", KSTAT_DATA_UINT32); 126 kstat_named_init(&sp->glds_dot3_sqe_error, 127 "sqe_errors", KSTAT_DATA_UINT32); 128 kstat_named_init(&sp->glds_dot3_mac_xmt_error, 129 "macxmt_errors", KSTAT_DATA_UINT32); 130 kstat_named_init(&sp->glds_dot3_mac_rcv_error, 131 "macrcv_errors", KSTAT_DATA_UINT32); 132 kstat_named_init(&sp->glds_dot3_frame_too_long, 133 "toolong_errors", KSTAT_DATA_UINT32); 134 kstat_named_init(&sp->glds_duplex, "duplex", KSTAT_DATA_CHAR); 135 } 136 137 /*ARGSUSED*/ 138 void 139 gld_uninit_ether(gld_mac_info_t *macinfo) 140 { 141 } 142 143 int 144 gld_interpret_ether(gld_mac_info_t *macinfo, mblk_t *mp, pktinfo_t *pktinfo, 145 packet_flag_t flags) 146 { 147 struct ether_header *mh; 148 gld_mac_pvt_t *mac_pvt = (gld_mac_pvt_t *)macinfo->gldm_mac_pvt; 149 struct llc_snap_hdr *snaphdr; 150 mblk_t *pmp = NULL, *savemp = mp; 151 unsigned short typelen; 152 int ret = 0; 153 154 /* 155 * Quickly handle receive fastpath for IPQ hack. 156 */ 157 if (flags == GLD_RXQUICK) { 158 pktinfo->pktLen = msgdsize(mp); 159 /* 160 * Check whether the header is contiguous, which 161 * also implicitly makes sure the packet is big enough. 162 */ 163 if (MBLKL(mp) < sizeof (struct ether_header)) 164 return (-1); 165 mh = (struct ether_header *)mp->b_rptr; 166 pktinfo->ethertype = REF_NET_USHORT(mh->ether_type); 167 pktinfo->isForMe = mac_eq(&mh->ether_dhost, 168 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 169 pktinfo->macLen = sizeof (struct ether_header); 170 171 return (0); 172 } 173 174 bzero((void *)pktinfo, sizeof (*pktinfo)); 175 176 pktinfo->pktLen = msgdsize(mp); 177 178 /* make sure packet has at least a whole mac header */ 179 if (pktinfo->pktLen < sizeof (struct ether_header)) 180 return (-1); 181 182 /* make sure the mac header falls into contiguous memory */ 183 if (MBLKL(mp) < sizeof (struct ether_header)) { 184 if ((pmp = msgpullup(mp, -1)) == NULL) { 185 #ifdef GLD_DEBUG 186 if (gld_debug & GLDERRS) 187 cmn_err(CE_WARN, 188 "GLD: interpret_ether cannot msgpullup"); 189 #endif 190 return (-1); 191 } 192 mp = pmp; /* this mblk contains the whole mac header */ 193 } 194 195 mh = (struct ether_header *)mp->b_rptr; 196 197 /* Check to see if the mac is a broadcast or multicast address. */ 198 if (mac_eq(&mh->ether_dhost, ether_broadcast, macinfo->gldm_addrlen)) 199 pktinfo->isBroadcast = 1; 200 else if (mh->ether_dhost.ether_addr_octet[0] & 1) 201 pktinfo->isMulticast = 1; 202 203 typelen = REF_NET_USHORT(mh->ether_type); 204 /* 205 * If the hardware is capable of VLAN tag insertion 206 * strip out the VLAN tag info. Knowing hardware is 207 * capable of VLAN can be established by the presance 208 * of non null 'macinfo->gldm_send_tagged'. 209 */ 210 if (flags == GLD_TX) { 211 if ((typelen == ETHERTYPE_VLAN) && 212 (macinfo->gldm_send_tagged != NULL)) { 213 struct ether_vlan_header *evhp; 214 uint16_t tci; 215 216 if ((MBLKL(mp) < sizeof (struct ether_vlan_header)) && 217 (pullupmsg(mp, sizeof (struct ether_vlan_header)) 218 == 0)) { 219 ret = -1; 220 goto out; 221 } 222 evhp = (struct ether_vlan_header *)mp->b_rptr; 223 tci = REF_NET_USHORT(evhp->ether_tci); 224 225 /* 226 * We don't allow the VID and priority are both zero. 227 */ 228 if ((GLD_VTAG_PRI((int32_t)tci) == 0 && 229 GLD_VTAG_VID((int32_t)tci) == VLAN_VID_NONE) || 230 (GLD_VTAG_CFI((uint32_t)tci)) != VLAN_CFI_ETHER) { 231 ret = -1; 232 goto out; 233 } 234 235 /* 236 * Remember the VTAG info in order to reinsert it, 237 * Then strip the tag. This is required because some 238 * drivers do not allow the size of message (passed 239 * by the gldm_send_tagged() function) to be greater 240 * than ETHERMAX. 241 */ 242 GLD_SAVE_MBLK_VTAG(savemp, GLD_TCI2VTAG(tci)); 243 ovbcopy(mp->b_rptr, mp->b_rptr + VTAG_SIZE, 244 2 * ETHERADDRL); 245 mp->b_rptr += VTAG_SIZE; 246 } 247 goto out; /* Got all info we need for xmit case */ 248 } 249 250 ASSERT(GLDM_LOCK_HELD(macinfo)); 251 252 /* 253 * Deal with the mac header 254 */ 255 256 mac_copy(&mh->ether_dhost, pktinfo->dhost, macinfo->gldm_addrlen); 257 mac_copy(&mh->ether_shost, pktinfo->shost, macinfo->gldm_addrlen); 258 259 pktinfo->isLooped = mac_eq(pktinfo->shost, 260 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 261 pktinfo->isForMe = mac_eq(pktinfo->dhost, 262 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 263 264 pktinfo->macLen = sizeof (struct ether_header); 265 266 if (typelen > ETHERMTU) { 267 pktinfo->ethertype = typelen; /* use type interpretation */ 268 goto out; 269 } 270 271 /* 272 * Packet is 802.3 so the ether type/length field 273 * specifies the number of bytes that should be present 274 * in the data field. Additional bytes are padding, and 275 * should be removed 276 */ 277 { 278 int delta = pktinfo->pktLen - 279 (sizeof (struct ether_header) + typelen); 280 281 if (delta > 0 && adjmsg(mp, -delta)) 282 pktinfo->pktLen -= delta; 283 } 284 285 /* 286 * Before trying to look beyond the MAC header, make sure the LLC 287 * header exists, and that both it and any SNAP header are contiguous. 288 */ 289 if (pktinfo->pktLen < pktinfo->macLen + LLC_HDR1_LEN) 290 goto out; /* LLC hdr should have been there! */ 291 292 pktinfo->isLLC = 1; 293 294 if (gld_global_options & GLD_OPT_NO_ETHRXSNAP || 295 pktinfo->pktLen < pktinfo->macLen + LLC_SNAP_HDR_LEN) 296 goto out; 297 298 if (MBLKL(mp) < sizeof (struct ether_header) + LLC_SNAP_HDR_LEN && 299 MBLKL(mp) < pktinfo->pktLen) { 300 /* 301 * we don't have the entire packet within the first mblk (and 302 * therefore we didn't do the msgpullup above), AND the first 303 * mblk may not contain all the data we need to look at. 304 */ 305 ASSERT(pmp == NULL); /* couldn't have done msgpullup above */ 306 if ((pmp = msgpullup(mp, -1)) == NULL) { 307 #ifdef GLD_DEBUG 308 if (gld_debug & GLDERRS) 309 cmn_err(CE_WARN, 310 "GLD: interpret_ether cannot msgpullup2"); 311 #endif 312 goto out; /* can't interpret this pkt further */ 313 } 314 mp = pmp; /* this mblk should contain everything needed */ 315 } 316 317 /* 318 * Check SAP/SNAP information for EtherType. 319 */ 320 321 snaphdr = (struct llc_snap_hdr *)(mp->b_rptr + pktinfo->macLen); 322 if (ISETHERTYPE(snaphdr)) { 323 pktinfo->ethertype = REF_NET_USHORT(snaphdr->type); 324 pktinfo->hdrLen = LLC_SNAP_HDR_LEN; 325 } 326 out: 327 if (pmp != NULL) 328 freemsg(pmp); 329 330 return (ret); 331 } 332 333 mblk_t * 334 gld_unitdata_ether(gld_t *gld, mblk_t *mp) 335 { 336 gld_mac_info_t *macinfo = gld->gld_mac_info; 337 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_rptr; 338 struct gld_dlsap *gldp = DLSAP(dlp, dlp->dl_dest_addr_offset); 339 mac_addr_t dhost; 340 unsigned short typelen; 341 mblk_t *nmp; 342 struct ether_header *mh; 343 int hdrlen; 344 uint32_t vptag; 345 gld_vlan_t *gld_vlan; 346 347 ASSERT(macinfo); 348 349 /* extract needed info from the mblk before we maybe reuse it */ 350 mac_copy(gldp->glda_addr, dhost, macinfo->gldm_addrlen); 351 352 /* look in the unitdata request for a sap, else use bound one */ 353 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 354 REF_HOST_USHORT(gldp->glda_sap) != 0) 355 typelen = REF_HOST_USHORT(gldp->glda_sap); 356 else 357 typelen = gld->gld_sap; 358 359 /* 360 * We take values less than or equal to ETHERMTU to mean that the 361 * packet should not have an encoded EtherType and so we use the 362 * IEEE 802.3 length interpretation of the type/length field. 363 */ 364 if (typelen <= ETHERMTU) 365 typelen = msgdsize(mp); 366 367 hdrlen = sizeof (struct ether_header); 368 369 /* 370 * Check to see if VLAN is enabled on this stream 371 * if so then make the header bigger to hold a clone 372 * vlan tag. 373 */ 374 gld_vlan = (gld_vlan_t *)gld->gld_vlan; 375 if (gld_vlan && (gld_vlan->gldv_id != VLAN_VID_NONE)) { 376 hdrlen += VTAG_SIZE; 377 vptag = gld_vlan->gldv_ptag; 378 } 379 380 /* need a buffer big enough for the headers */ 381 nmp = mp->b_cont; /* where the packet payload M_DATA is */ 382 if (DB_REF(nmp) == 1 && MBLKHEAD(nmp) >= hdrlen) { 383 /* it fits at the beginning of the first M_DATA block */ 384 freeb(mp); /* don't need the M_PROTO anymore */ 385 } else if (DB_REF(mp) == 1 && MBLKSIZE(mp) >= hdrlen) { 386 /* we can reuse the dl_unitdata_req M_PROTO mblk */ 387 nmp = mp; 388 DB_TYPE(nmp) = M_DATA; 389 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 390 } else { 391 /* we need to allocate one */ 392 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 393 return (NULL); 394 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 395 linkb(nmp, mp->b_cont); 396 freeb(mp); 397 } 398 399 /* Got the space, now copy in the header components */ 400 401 nmp->b_rptr -= sizeof (typelen); 402 SET_NET_USHORT(*(uint16_t *)nmp->b_rptr, typelen); 403 if (hdrlen > sizeof (struct ether_header)) { 404 nmp->b_rptr -= sizeof (uint16_t); 405 SET_NET_USHORT(*(uint16_t *)nmp->b_rptr, vptag); 406 vptag >>= 16; 407 nmp->b_rptr -= sizeof (uint16_t); 408 SET_NET_USHORT(*(uint16_t *)nmp->b_rptr, vptag); 409 } 410 nmp->b_rptr -= (ETHERADDRL * 2); 411 mh = (struct ether_header *)nmp->b_rptr; 412 mac_copy(dhost, &mh->ether_dhost, macinfo->gldm_addrlen); 413 414 /* 415 * We access the mac address without the mutex to prevent 416 * mutex contention (BUG 4211361) 417 */ 418 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 419 &mh->ether_shost, macinfo->gldm_addrlen); 420 421 return (nmp); 422 } 423 424 /* 425 * Insert the VLAN tag into the packet. The packet now is an Ethernet header 426 * without VLAN tag information. 427 */ 428 mblk_t * 429 gld_insert_vtag_ether(mblk_t *mp, uint32_t vtag) 430 { 431 struct ether_vlan_header *evhp; 432 struct ether_header *ehp; 433 mblk_t *nmp; 434 435 if (vtag == VLAN_VID_NONE) 436 return (mp); 437 438 if (DB_REF(mp) == 1 && MBLKHEAD(mp) >= VTAG_SIZE) { 439 /* it fits at the beginning of the message block */ 440 nmp = mp; 441 ovbcopy(nmp->b_rptr, nmp->b_rptr - VTAG_SIZE, 2 * ETHERADDRL); 442 nmp->b_rptr -= VTAG_SIZE; 443 evhp = (struct ether_vlan_header *)nmp->b_rptr; 444 } else { 445 /* we need to allocate one */ 446 if ((nmp = allocb(sizeof (struct ether_vlan_header), 447 BPRI_MED)) == NULL) { 448 return (NULL); 449 } 450 nmp->b_wptr += sizeof (struct ether_vlan_header); 451 452 /* transfer the ether_header fields */ 453 evhp = (struct ether_vlan_header *)nmp->b_rptr; 454 ehp = (struct ether_header *)mp->b_rptr; 455 mac_copy(&ehp->ether_dhost, &evhp->ether_dhost, ETHERADDRL); 456 mac_copy(&ehp->ether_shost, &evhp->ether_shost, ETHERADDRL); 457 bcopy(&ehp->ether_type, &evhp->ether_type, sizeof (uint16_t)); 458 459 /* offset the mp of the MAC header length. */ 460 mp->b_rptr += sizeof (struct ether_header); 461 if (MBLKL(mp) == 0) { 462 nmp->b_cont = mp->b_cont; 463 freeb(mp); 464 } else { 465 nmp->b_cont = mp; 466 } 467 } 468 469 SET_NET_USHORT(evhp->ether_tci, vtag); 470 vtag >>= 16; 471 SET_NET_USHORT(evhp->ether_tpid, vtag); 472 return (nmp); 473 } 474 475 mblk_t * 476 gld_fastpath_ether(gld_t *gld, mblk_t *mp) 477 { 478 gld_mac_info_t *macinfo = gld->gld_mac_info; 479 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_cont->b_rptr; 480 struct gld_dlsap *gldp = DLSAP(dlp, dlp->dl_dest_addr_offset); 481 unsigned short typelen; 482 mblk_t *nmp; 483 struct ether_header *mh; 484 int hdrlen; 485 uint32_t vptag; 486 gld_vlan_t *gld_vlan; 487 488 ASSERT(macinfo); 489 490 /* look in the unitdata request for a sap, else use bound one */ 491 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 492 REF_HOST_USHORT(gldp->glda_sap) != 0) 493 typelen = REF_HOST_USHORT(gldp->glda_sap); 494 else 495 typelen = gld->gld_sap; 496 497 /* 498 * We only do fast-path for EtherType encoding because this is the only 499 * case where the media header will be consistent from packet to packet. 500 */ 501 if (typelen <= ETHERMTU) 502 return (NULL); 503 504 /* 505 * Initialize the fast path header to include the 506 * basic source address information and type field. 507 */ 508 hdrlen = sizeof (struct ether_header); 509 510 /* 511 * Check to see if VLAN is enabled on this stream 512 * if so then make the header bigger to hold a clone 513 * vlan tag. 514 */ 515 gld_vlan = (gld_vlan_t *)gld->gld_vlan; 516 if (gld_vlan && (gld_vlan->gldv_id != VLAN_VID_NONE)) { 517 hdrlen += VTAG_SIZE; 518 vptag = gld_vlan->gldv_ptag; 519 } 520 521 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 522 return (NULL); 523 524 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 525 526 /* Got the space, now copy in the header components */ 527 528 nmp->b_rptr -= sizeof (typelen); 529 SET_NET_USHORT(*(uint16_t *)nmp->b_rptr, typelen); 530 531 /* 532 * If the header is for a VLAN stream, then add 533 * in the VLAN tag to the clone header. 534 */ 535 if (hdrlen > sizeof (struct ether_header)) { 536 nmp->b_rptr -= sizeof (uint16_t); 537 SET_NET_USHORT(*(uint16_t *)nmp->b_rptr, vptag); 538 vptag >>= 16; 539 nmp->b_rptr -= sizeof (uint16_t); 540 SET_NET_USHORT(*(uint16_t *)nmp->b_rptr, vptag); 541 } 542 nmp->b_rptr -= (ETHERADDRL * 2); 543 mh = (struct ether_header *)nmp->b_rptr; 544 mac_copy(gldp->glda_addr, &mh->ether_dhost, macinfo->gldm_addrlen); 545 546 GLDM_LOCK(macinfo, RW_WRITER); 547 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 548 &mh->ether_shost, macinfo->gldm_addrlen); 549 GLDM_UNLOCK(macinfo); 550 551 return (nmp); 552 } 553 554 /* == */ 555 /* IB */ 556 /* == */ 557 558 void 559 gld_init_ib(gld_mac_info_t *macinfo) 560 { 561 /* 562 * Currently, the generic stats maintained by GLD is 563 * sufficient for IPoIB. 564 */ 565 566 /* Assumptions we make for this medium */ 567 ASSERT(macinfo->gldm_type == DL_IB); 568 ASSERT(macinfo->gldm_addrlen == IPOIB_ADDRL); 569 ASSERT(macinfo->gldm_saplen == -2); 570 } 571 572 /* ARGSUSED */ 573 void 574 gld_uninit_ib(gld_mac_info_t *macinfo) 575 { 576 } 577 578 /* 579 * The packet format sent to the driver is: 580 * IPOIB_ADDRL bytes dest addr :: 2b sap :: 2b 0s :: data 581 * The packet format received from the driver is: 582 * IPOIB_GRH_SIZE bytes pseudo GRH :: 2b sap :: 2b 0s :: data. 583 */ 584 int 585 gld_interpret_ib(gld_mac_info_t *macinfo, mblk_t *mp, pktinfo_t *pktinfo, 586 packet_flag_t flags) 587 { 588 ipoib_pgrh_t *grh; 589 ipoib_ptxhdr_t *gldp; 590 mblk_t *pmp = NULL; 591 gld_mac_pvt_t *mac_pvt = (gld_mac_pvt_t *)macinfo->gldm_mac_pvt; 592 593 /* 594 * Quickly handle receive fastpath for IPQ hack. 595 */ 596 if (flags == GLD_RXQUICK) { 597 pktinfo->pktLen = msgdsize(mp) - IPOIB_GRH_SIZE; 598 599 /* 600 * Check whether the header is contiguous, which 601 * also implicitly makes sure the packet is big enough. 602 */ 603 if (MBLKL(mp) < (IPOIB_GRH_SIZE + IPOIB_HDRSIZE)) 604 return (-1); 605 606 /* 607 * Almost all times, unicast will not have 608 * a valid pgrh; quickly identify and ask for 609 * IPQ hack optimization only in that case. 610 */ 611 grh = (ipoib_pgrh_t *)mp->b_rptr; 612 if (grh->ipoib_vertcflow == 0) { 613 struct ipoib_header *ihp = (struct ipoib_header *) 614 (mp->b_rptr + IPOIB_GRH_SIZE); 615 616 pktinfo->isForMe = 1; 617 pktinfo->ethertype = REF_NET_USHORT(ihp->ipoib_type); 618 pktinfo->macLen = IPOIB_GRH_SIZE + IPOIB_HDRSIZE; 619 return (0); 620 } else { 621 return (-1); 622 } 623 } 624 625 /* 626 * Handle the GLD_TX, GLD_RX, GLD_RXLOOP cases now. 627 */ 628 ASSERT(flags != GLD_RXQUICK); 629 bzero((void *)pktinfo, sizeof (*pktinfo)); 630 631 if (flags != GLD_RX) { 632 /* 633 * GLD_TX and GLD_RXLOOP cases. 634 */ 635 gldp = (ipoib_ptxhdr_t *)mp->b_rptr; 636 pktinfo->pktLen = msgdsize(mp); 637 638 /* make sure packet has at least a pseudo header */ 639 if (pktinfo->pktLen < sizeof (ipoib_ptxhdr_t)) 640 return (-1); 641 642 /* make sure the mac header falls into contiguous memory */ 643 if (MBLKL(mp) < sizeof (ipoib_ptxhdr_t)) { 644 if ((pmp = msgpullup(mp, -1)) == NULL) { 645 #ifdef GLD_DEBUG 646 if (gld_debug & GLDERRS) 647 cmn_err(CE_WARN, 648 "GLD: interpret_ib " 649 "cannot msgpullup"); 650 #endif 651 return (-1); 652 } 653 /* this mblk contains the whole mac header */ 654 mp = pmp; 655 } 656 657 /* 658 * Check if mac is broadcast or multicast address; all these 659 * types of address have the top 4 bytes as 0x00FFFFFF. 660 */ 661 if (mac_eq(&gldp->ipoib_dest, macinfo->gldm_broadcast_addr, 662 sizeof (uint32_t))) { 663 if (mac_eq(&gldp->ipoib_dest, 664 macinfo->gldm_broadcast_addr, IPOIB_ADDRL)) 665 pktinfo->isBroadcast = 1; 666 else 667 pktinfo->isMulticast = 1; 668 } 669 670 /* 671 * Only count bytes we will be sending over the wire 672 * or looping back. 673 */ 674 pktinfo->pktLen -= IPOIB_ADDRL; 675 if (flags == GLD_TX) 676 goto out; /* Got all info we need for xmit case */ 677 678 /* 679 * Loopback case: this is a dup'ed message. 680 */ 681 mp->b_rptr += IPOIB_ADDRL; 682 mac_copy(&gldp->ipoib_dest, pktinfo->dhost, IPOIB_ADDRL); 683 mac_copy(mac_pvt->curr_macaddr, pktinfo->shost, IPOIB_ADDRL); 684 } else { 685 /* 686 * GLD_RX case; process packet sent from driver. 687 */ 688 ipoib_mac_t *mact, *tact; 689 ib_qpn_t dqpn; 690 691 pktinfo->pktLen = msgdsize(mp); 692 /* make sure packet has at least pgrh and mac header */ 693 if (pktinfo->pktLen < (IPOIB_GRH_SIZE + IPOIB_HDRSIZE)) 694 return (-1); 695 696 /* make sure the header falls into contiguous memory */ 697 if (MBLKL(mp) < (IPOIB_GRH_SIZE + IPOIB_HDRSIZE)) { 698 if ((pmp = msgpullup(mp, -1)) == NULL) { 699 #ifdef GLD_DEBUG 700 if (gld_debug & GLDERRS) 701 cmn_err(CE_WARN, 702 "GLD: interpret_ib " 703 "cannot msgpullup2"); 704 #endif 705 return (-1); 706 } 707 /* this mblk contains the whole mac header */ 708 mp = pmp; 709 } 710 711 grh = (ipoib_pgrh_t *)mp->b_rptr; 712 mp->b_rptr += IPOIB_GRH_SIZE; 713 pktinfo->pktLen -= IPOIB_GRH_SIZE; 714 if (grh->ipoib_vertcflow) { 715 /* 716 * First, copy source address from grh. 717 */ 718 mact = (ipoib_mac_t *)pktinfo->shost; 719 mac_copy(&grh->ipoib_sqpn, &mact->ipoib_qpn, 720 IPOIB_ADDRL); 721 722 /* 723 * Then copy destination address from grh; 724 * first, the 16 bytes of GID. 725 */ 726 mact = (ipoib_mac_t *)pktinfo->dhost; 727 mac_copy(&grh->ipoib_dgid_pref, 728 &mact->ipoib_gidpref, IPOIB_ADDRL - 729 sizeof (mact->ipoib_qpn)); 730 tact = (ipoib_mac_t *)mac_pvt->curr_macaddr; 731 732 /* Is this a multicast address */ 733 if (*(uchar_t *)(grh->ipoib_dgid_pref) == 0xFF) { 734 /* 735 * Only check for hardware looping in 736 * multicast case. It is assumed higher 737 * layer code (IP) will stop unicast loops; 738 * ie will prevent a transmit to self. 739 */ 740 if (bcmp(&grh->ipoib_sqpn, tact, 741 IPOIB_ADDRL) == 0) 742 pktinfo->isLooped = 1; 743 744 tact = (ipoib_mac_t *)macinfo-> 745 gldm_broadcast_addr; 746 if (mac_eq(tact->ipoib_gidpref, 747 grh->ipoib_dgid_pref, 748 IPOIB_ADDRL - sizeof (tact->ipoib_qpn))) 749 pktinfo->isBroadcast = 1; 750 else 751 pktinfo->isMulticast = 1; 752 /* 753 * Now copy the 4 bytes QPN part of the 754 * destination address. 755 */ 756 dqpn = htonl(IB_MC_QPN); 757 mac_copy(&dqpn, &mact->ipoib_qpn, 758 sizeof (mact->ipoib_qpn)); 759 } else { 760 /* 761 * Now copy the 4 bytes QPN part of the 762 * destination address. 763 */ 764 mac_copy(&tact->ipoib_qpn, &mact->ipoib_qpn, 765 sizeof (mact->ipoib_qpn)); 766 /* 767 * Any unicast packets received on IBA are 768 * for the node. 769 */ 770 pktinfo->isForMe = 1; 771 } 772 } else { 773 /* 774 * It can not be a IBA multicast packet. 775 * Must have been unicast to us. We do not 776 * have shost information, which is used in 777 * gld_addudind(); IP/ARP does not care. 778 */ 779 pktinfo->nosource = 1; 780 mac_copy(mac_pvt->curr_macaddr, pktinfo->dhost, 781 IPOIB_ADDRL); 782 /* 783 * Any unicast packets received on IBA are 784 * for the node. 785 */ 786 pktinfo->isForMe = 1; 787 } 788 } 789 790 ASSERT((flags == GLD_RX) || (flags == GLD_RXLOOP)); 791 ASSERT(GLDM_LOCK_HELD(macinfo)); 792 pktinfo->ethertype = REF_NET_USHORT(((ipoib_hdr_t *) 793 (mp->b_rptr))->ipoib_type); 794 pktinfo->macLen = IPOIB_HDRSIZE; 795 796 out: 797 if (pmp != NULL) 798 freemsg(pmp); 799 800 return (0); 801 } 802 803 /* 804 * The packet format sent to the driver is: 2b sap :: 2b 0s :: data 805 */ 806 void 807 gld_interpret_mdt_ib(gld_mac_info_t *macinfo, mblk_t *mp, pdescinfo_t *pinfo, 808 pktinfo_t *pktinfo, mdt_packet_flag_t flags) 809 { 810 gld_mac_pvt_t *mac_pvt; 811 multidata_t *dlmdp; 812 pattrinfo_t attr_info = { PATTR_DSTADDRSAP, }; 813 pattr_t *patr; 814 ipoib_ptxhdr_t *dlap = NULL; 815 816 /* 817 * Per packet formatting. 818 */ 819 if (flags == GLD_MDT_TXPKT) { 820 ipoib_hdr_t *hptr; 821 uint_t seg; 822 823 if (PDESC_HDRL(pinfo) == 0) 824 return; 825 826 /* 827 * Update packet's link header. 828 */ 829 pinfo->hdr_rptr -= IPOIB_HDRSIZE; 830 hptr = (ipoib_hdr_t *)pinfo->hdr_rptr; 831 hptr->ipoib_mbz = htons(0); 832 hptr->ipoib_type = pktinfo->ethertype; 833 834 /* 835 * Total #bytes that will be put on wire. 836 */ 837 pktinfo->pktLen = PDESC_HDRL(pinfo); 838 for (seg = 0; seg < pinfo->pld_cnt; seg++) 839 pktinfo->pktLen += PDESC_PLDL(pinfo, seg); 840 841 return; 842 } 843 844 /* 845 * The following two cases of GLD_MDT_TX and GLD_MDT_RXLOOP are per 846 * MDT message processing. 847 */ 848 dlmdp = mmd_getmultidata(mp); 849 patr = mmd_getpattr(dlmdp, NULL, &attr_info); 850 ASSERT(patr != NULL); 851 ASSERT(macinfo->gldm_saplen == -2); 852 if (patr != NULL) 853 dlap = (ipoib_ptxhdr_t *)((pattr_addr_t *)attr_info.buf)->addr; 854 855 if (flags == GLD_MDT_TX) { 856 bzero((void *)pktinfo, sizeof (*pktinfo)); 857 if (dlap == NULL) 858 return; 859 860 /* 861 * Check if mac is broadcast or multicast address; all these 862 * types of address have the top 4 bytes as 0x00FFFFFF. 863 */ 864 if (mac_eq(dlap, macinfo->gldm_broadcast_addr, 865 sizeof (uint32_t))) { 866 if (mac_eq(dlap, macinfo->gldm_broadcast_addr, 867 IPOIB_ADDRL)) 868 pktinfo->isBroadcast = 1; 869 else 870 pktinfo->isMulticast = 1; 871 } 872 pktinfo->ethertype = REF_NET_USHORT(dlap-> 873 ipoib_rhdr.ipoib_type); 874 } else { 875 ASSERT(flags == GLD_MDT_RXLOOP); 876 pktinfo->macLen = IPOIB_HDRSIZE; 877 mac_pvt = (gld_mac_pvt_t *)macinfo->gldm_mac_pvt; 878 mac_copy(mac_pvt->curr_macaddr, pktinfo->shost, IPOIB_ADDRL); 879 if (dlap == NULL) 880 return; 881 mac_copy(&dlap->ipoib_dest, pktinfo->dhost, IPOIB_ADDRL); 882 } 883 } 884 885 mblk_t * 886 gld_unitdata_ib(gld_t *gld, mblk_t *mp) 887 { 888 gld_mac_info_t *macinfo = gld->gld_mac_info; 889 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_rptr; 890 ipoib_ptxhdr_t *gldp = IPOIBDLSAP(dlp, dlp->dl_dest_addr_offset); 891 ipoib_mac_t dhost; 892 unsigned short type; 893 mblk_t *nmp; 894 int hdrlen; 895 896 ASSERT(macinfo != NULL); 897 898 /* extract needed info from the mblk before we maybe reuse it */ 899 mac_copy(&gldp->ipoib_dest, &dhost, IPOIB_ADDRL); 900 901 /* look in the unitdata request for a sap, else use bound one */ 902 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 903 REF_HOST_USHORT(gldp->ipoib_rhdr.ipoib_type) != 0) 904 type = REF_HOST_USHORT(gldp->ipoib_rhdr.ipoib_type); 905 else 906 type = gld->gld_sap; 907 908 hdrlen = sizeof (ipoib_ptxhdr_t); 909 910 /* need a buffer big enough for the headers */ 911 nmp = mp->b_cont; /* where the packet payload M_DATA is */ 912 if (DB_REF(nmp) == 1 && MBLKHEAD(nmp) >= hdrlen) { 913 /* it fits at the beginning of the first M_DATA block */ 914 freeb(mp); /* don't need the M_PROTO anymore */ 915 } else if (DB_REF(mp) == 1 && MBLKSIZE(mp) >= hdrlen) { 916 /* we can reuse the dl_unitdata_req M_PROTO mblk */ 917 nmp = mp; 918 DB_TYPE(nmp) = M_DATA; 919 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 920 } else { 921 /* we need to allocate one */ 922 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 923 return (NULL); 924 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 925 linkb(nmp, mp->b_cont); 926 freeb(mp); 927 } 928 929 /* Got the space, now copy in the header components */ 930 931 nmp->b_rptr -= sizeof (ipoib_ptxhdr_t); 932 gldp = (ipoib_ptxhdr_t *)nmp->b_rptr; 933 SET_NET_USHORT(gldp->ipoib_rhdr.ipoib_type, type); 934 gldp->ipoib_rhdr.ipoib_mbz = 0; 935 mac_copy(&dhost, &gldp->ipoib_dest, IPOIB_ADDRL); 936 937 return (nmp); 938 } 939 940 mblk_t * 941 gld_fastpath_ib(gld_t *gld, mblk_t *mp) 942 { 943 gld_mac_info_t *macinfo = gld->gld_mac_info; 944 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_cont->b_rptr; 945 ipoib_ptxhdr_t *gldp = IPOIBDLSAP(dlp, dlp->dl_dest_addr_offset); 946 unsigned short type; 947 mblk_t *nmp; 948 ipoib_ptxhdr_t *tgldp; 949 int hdrlen; 950 951 ASSERT(macinfo != NULL); 952 953 /* look in the unitdata request for a sap, else use bound one */ 954 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 955 REF_HOST_USHORT(gldp->ipoib_rhdr.ipoib_type) != 0) 956 type = REF_HOST_USHORT(gldp->ipoib_rhdr.ipoib_type); 957 else 958 type = gld->gld_sap; 959 960 hdrlen = sizeof (ipoib_ptxhdr_t); 961 962 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 963 return (NULL); 964 965 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 966 967 /* Got the space, now copy in the header components */ 968 969 nmp->b_rptr -= sizeof (ipoib_ptxhdr_t); 970 tgldp = (ipoib_ptxhdr_t *)nmp->b_rptr; 971 tgldp->ipoib_rhdr.ipoib_type = htons(type); 972 tgldp->ipoib_rhdr.ipoib_mbz = 0; 973 mac_copy(&gldp->ipoib_dest, &tgldp->ipoib_dest, IPOIB_ADDRL); 974 975 return (nmp); 976 } 977 978 /* ==== */ 979 /* FDDI */ 980 /* ==== */ 981 982 void 983 gld_init_fddi(gld_mac_info_t *macinfo) 984 { 985 struct gldkstats *sp = 986 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->kstatp->ks_data; 987 988 /* Assumptions we make for this medium */ 989 ASSERT(macinfo->gldm_type == DL_FDDI); 990 ASSERT(macinfo->gldm_addrlen == 6); 991 ASSERT(macinfo->gldm_saplen == -2); 992 #ifndef lint 993 ASSERT(sizeof (struct fddi_mac_frm) == 13); 994 ASSERT(sizeof (mac_addr_t) == 6); 995 #endif 996 997 /* Wire address format is bit reversed from canonical format */ 998 macinfo->gldm_options |= GLDOPT_CANONICAL_ADDR; 999 1000 kstat_named_init(&sp->glds_fddi_mac_error, 1001 "mac_errors", KSTAT_DATA_UINT32); 1002 kstat_named_init(&sp->glds_fddi_mac_lost, 1003 "mac_lost_errors", KSTAT_DATA_UINT32); 1004 kstat_named_init(&sp->glds_fddi_mac_token, 1005 "mac_tokens", KSTAT_DATA_UINT32); 1006 kstat_named_init(&sp->glds_fddi_mac_tvx_expired, 1007 "mac_tvx_expired", KSTAT_DATA_UINT32); 1008 kstat_named_init(&sp->glds_fddi_mac_late, 1009 "mac_late", KSTAT_DATA_UINT32); 1010 kstat_named_init(&sp->glds_fddi_mac_ring_op, 1011 "mac_ring_ops", KSTAT_DATA_UINT32); 1012 } 1013 1014 /*ARGSUSED*/ 1015 void 1016 gld_uninit_fddi(gld_mac_info_t *macinfo) 1017 { 1018 } 1019 1020 int 1021 gld_interpret_fddi(gld_mac_info_t *macinfo, mblk_t *mp, pktinfo_t *pktinfo, 1022 packet_flag_t flags) 1023 { 1024 struct fddi_mac_frm *mh; 1025 gld_mac_pvt_t *mac_pvt; 1026 struct llc_snap_hdr *snaphdr; 1027 mblk_t *pmp = NULL; 1028 1029 /* 1030 * Quickly handle receive fastpath; FDDI does not support IPQ hack. 1031 */ 1032 if (flags == GLD_RXQUICK) { 1033 pktinfo->pktLen = msgdsize(mp); 1034 return (-1); 1035 } 1036 1037 bzero((void *)pktinfo, sizeof (*pktinfo)); 1038 1039 pktinfo->pktLen = msgdsize(mp); 1040 1041 /* make sure packet has at least a whole mac header */ 1042 if (pktinfo->pktLen < sizeof (struct fddi_mac_frm)) 1043 return (-1); 1044 1045 /* make sure the mac header falls into contiguous memory */ 1046 if (MBLKL(mp) < sizeof (struct fddi_mac_frm)) { 1047 if ((pmp = msgpullup(mp, -1)) == NULL) { 1048 #ifdef GLD_DEBUG 1049 if (gld_debug & GLDERRS) 1050 cmn_err(CE_WARN, 1051 "GLD: interpret_fddi cannot msgpullup"); 1052 #endif 1053 return (-1); 1054 } 1055 mp = pmp; /* this mblk contains the whole mac header */ 1056 } 1057 1058 mh = (struct fddi_mac_frm *)mp->b_rptr; 1059 1060 /* Check to see if the mac is a broadcast or multicast address. */ 1061 /* NB we are still in wire format (non canonical) */ 1062 /* mac_eq works because ether_broadcast is the same either way */ 1063 if (mac_eq(mh->fddi_dhost, ether_broadcast, macinfo->gldm_addrlen)) 1064 pktinfo->isBroadcast = 1; 1065 else if (mh->fddi_dhost[0] & 0x80) 1066 pktinfo->isMulticast = 1; 1067 1068 if (flags == GLD_TX) 1069 goto out; /* Got all info we need for xmit case */ 1070 1071 ASSERT(GLDM_LOCK_HELD(macinfo)); 1072 1073 /* 1074 * Deal with the mac header 1075 */ 1076 1077 cmac_copy(mh->fddi_dhost, pktinfo->dhost, 1078 macinfo->gldm_addrlen, macinfo); 1079 cmac_copy(mh->fddi_shost, pktinfo->shost, 1080 macinfo->gldm_addrlen, macinfo); 1081 1082 mac_pvt = (gld_mac_pvt_t *)macinfo->gldm_mac_pvt; 1083 pktinfo->isLooped = mac_eq(pktinfo->shost, 1084 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 1085 pktinfo->isForMe = mac_eq(pktinfo->dhost, 1086 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 1087 1088 pktinfo->macLen = sizeof (struct fddi_mac_frm); 1089 1090 /* 1091 * Before trying to look beyond the MAC header, make sure the LLC 1092 * header exists, and that both it and any SNAP header are contiguous. 1093 */ 1094 if (MBLKL(mp) < sizeof (struct fddi_mac_frm) + LLC_SNAP_HDR_LEN && 1095 MBLKL(mp) < pktinfo->pktLen) { 1096 /* 1097 * we don't have the entire packet within the first mblk (and 1098 * therefore we didn't do the msgpullup above), AND the first 1099 * mblk may not contain all the data we need to look at. 1100 */ 1101 ASSERT(pmp == NULL); /* couldn't have done msgpullup above */ 1102 if ((pmp = msgpullup(mp, -1)) == NULL) { 1103 #ifdef GLD_DEBUG 1104 if (gld_debug & GLDERRS) 1105 cmn_err(CE_WARN, 1106 "GLD: interpret_fddi cannot msgpullup2"); 1107 #endif 1108 goto out; /* can't interpret this pkt further */ 1109 } 1110 mp = pmp; /* this mblk should contain everything needed */ 1111 } 1112 1113 /* 1114 * Check SAP/SNAP information. 1115 */ 1116 if ((mh->fddi_fc & 0x70) == 0x50) { 1117 if (pktinfo->pktLen < pktinfo->macLen + LLC_HDR1_LEN) 1118 goto out; 1119 1120 pktinfo->isLLC = 1; 1121 1122 if (pktinfo->pktLen < pktinfo->macLen + LLC_SNAP_HDR_LEN) 1123 goto out; 1124 1125 snaphdr = (struct llc_snap_hdr *)(mp->b_rptr + pktinfo->macLen); 1126 if (ISETHERTYPE(snaphdr)) { 1127 pktinfo->ethertype = REF_NET_USHORT(snaphdr->type); 1128 pktinfo->hdrLen = LLC_SNAP_HDR_LEN; 1129 } 1130 } 1131 out: 1132 if (pmp != NULL) 1133 freemsg(pmp); 1134 1135 return (0); 1136 } 1137 1138 mblk_t * 1139 gld_unitdata_fddi(gld_t *gld, mblk_t *mp) 1140 { 1141 gld_mac_info_t *macinfo = gld->gld_mac_info; 1142 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_rptr; 1143 struct gld_dlsap *gldp = DLSAP(dlp, dlp->dl_dest_addr_offset); 1144 mac_addr_t dhost; 1145 unsigned short type; 1146 mblk_t *nmp; 1147 struct fddi_mac_frm *mh; 1148 int hdrlen; 1149 1150 ASSERT(macinfo); 1151 1152 /* extract needed info from the mblk before we maybe reuse it */ 1153 mac_copy(gldp->glda_addr, dhost, macinfo->gldm_addrlen); 1154 1155 /* look in the unitdata request for a sap, else use bound one */ 1156 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 1157 REF_HOST_USHORT(gldp->glda_sap) != 0) 1158 type = REF_HOST_USHORT(gldp->glda_sap); 1159 else 1160 type = gld->gld_sap; 1161 1162 1163 hdrlen = sizeof (struct fddi_mac_frm); 1164 1165 /* 1166 * Check whether we need to do EtherType encoding or whether the packet 1167 * is LLC. 1168 */ 1169 if (type > GLD_MAX_802_SAP) 1170 hdrlen += sizeof (struct llc_snap_hdr); 1171 1172 /* need a buffer big enough for the headers */ 1173 nmp = mp->b_cont; /* where the packet payload M_DATA is */ 1174 if (DB_REF(nmp) == 1 && MBLKHEAD(nmp) >= hdrlen) { 1175 /* it fits at the beginning of the first M_DATA block */ 1176 freeb(mp); /* don't need the M_PROTO anymore */ 1177 } else if (DB_REF(mp) == 1 && MBLKSIZE(mp) >= hdrlen) { 1178 /* we can reuse the dl_unitdata_req M_PROTO mblk */ 1179 nmp = mp; 1180 DB_TYPE(nmp) = M_DATA; 1181 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1182 } else { 1183 /* we need to allocate one */ 1184 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 1185 return (NULL); 1186 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1187 linkb(nmp, mp->b_cont); 1188 freeb(mp); 1189 } 1190 1191 1192 /* Got the space, now copy in the header components */ 1193 if (type > GLD_MAX_802_SAP) { 1194 /* create the snap header */ 1195 struct llc_snap_hdr *snap; 1196 nmp->b_rptr -= sizeof (struct llc_snap_hdr); 1197 snap = (struct llc_snap_hdr *)(nmp->b_rptr); 1198 *snap = llc_snap_def; 1199 SET_NET_USHORT(snap->type, type); 1200 } 1201 1202 nmp->b_rptr -= sizeof (struct fddi_mac_frm); 1203 1204 mh = (struct fddi_mac_frm *)nmp->b_rptr; 1205 1206 mh->fddi_fc = 0x50; 1207 cmac_copy(dhost, mh->fddi_dhost, macinfo->gldm_addrlen, macinfo); 1208 1209 /* 1210 * We access the mac address without the mutex to prevent 1211 * mutex contention (BUG 4211361) 1212 */ 1213 cmac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 1214 mh->fddi_shost, macinfo->gldm_addrlen, macinfo); 1215 return (nmp); 1216 } 1217 1218 mblk_t * 1219 gld_fastpath_fddi(gld_t *gld, mblk_t *mp) 1220 { 1221 gld_mac_info_t *macinfo = gld->gld_mac_info; 1222 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_cont->b_rptr; 1223 struct gld_dlsap *gldp = DLSAP(dlp, dlp->dl_dest_addr_offset); 1224 unsigned short type; 1225 mblk_t *nmp; 1226 struct fddi_mac_frm *mh; 1227 int hdrlen; 1228 1229 ASSERT(macinfo); 1230 1231 /* look in the unitdata request for a sap, else use bound one */ 1232 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 1233 REF_HOST_USHORT(gldp->glda_sap) != 0) 1234 type = REF_HOST_USHORT(gldp->glda_sap); 1235 else 1236 type = gld->gld_sap; 1237 1238 hdrlen = sizeof (struct fddi_mac_frm); 1239 1240 /* 1241 * Check whether we need to do EtherType encoding or whether the packet 1242 * will be LLC. 1243 */ 1244 if (type > GLD_MAX_802_SAP) 1245 hdrlen += sizeof (struct llc_snap_hdr); 1246 1247 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 1248 return (NULL); 1249 1250 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1251 1252 /* Got the space, now copy in the header components */ 1253 1254 if (type > GLD_MAX_802_SAP) { 1255 /* create the snap header */ 1256 struct llc_snap_hdr *snap; 1257 nmp->b_rptr -= sizeof (struct llc_snap_hdr); 1258 snap = (struct llc_snap_hdr *)(nmp->b_rptr); 1259 *snap = llc_snap_def; 1260 snap->type = htons(type); /* we know it's aligned */ 1261 } 1262 1263 nmp->b_rptr -= sizeof (struct fddi_mac_frm); 1264 1265 mh = (struct fddi_mac_frm *)nmp->b_rptr; 1266 mh->fddi_fc = 0x50; 1267 cmac_copy(gldp->glda_addr, mh->fddi_dhost, 1268 macinfo->gldm_addrlen, macinfo); 1269 1270 GLDM_LOCK(macinfo, RW_WRITER); 1271 cmac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 1272 mh->fddi_shost, macinfo->gldm_addrlen, macinfo); 1273 GLDM_UNLOCK(macinfo); 1274 1275 return (nmp); 1276 } 1277 1278 /* ========== */ 1279 /* Token Ring */ 1280 /* ========== */ 1281 1282 #define GLD_SR_VAR(macinfo) \ 1283 (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->data) 1284 1285 #define GLD_SR_HASH(macinfo) ((struct srtab **)GLD_SR_VAR(macinfo)) 1286 1287 #define GLD_SR_MUTEX(macinfo) \ 1288 (&((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->datalock) 1289 1290 static void gld_sr_clear(gld_mac_info_t *); 1291 static void gld_rcc_receive(gld_mac_info_t *, pktinfo_t *, struct gld_ri *, 1292 uchar_t *, int); 1293 static void gld_rcc_send(gld_mac_info_t *, queue_t *, uchar_t *, 1294 struct gld_ri **, uchar_t *); 1295 1296 static mac_addr_t tokenbroadcastaddr2 = { 0xc0, 0x00, 0xff, 0xff, 0xff, 0xff }; 1297 static struct gld_ri ri_ste_def; 1298 1299 void 1300 gld_init_tr(gld_mac_info_t *macinfo) 1301 { 1302 struct gldkstats *sp = 1303 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->kstatp->ks_data; 1304 1305 /* avoid endian-dependent code by initializing here instead of static */ 1306 ri_ste_def.len = 2; 1307 ri_ste_def.rt = RT_STE; 1308 ri_ste_def.mtu = RT_MTU_MAX; 1309 ri_ste_def.dir = 0; 1310 ri_ste_def.res = 0; 1311 1312 /* Assumptions we make for this medium */ 1313 ASSERT(macinfo->gldm_type == DL_TPR); 1314 ASSERT(macinfo->gldm_addrlen == 6); 1315 ASSERT(macinfo->gldm_saplen == -2); 1316 #ifndef lint 1317 ASSERT(sizeof (struct tr_mac_frm_nori) == 14); 1318 ASSERT(sizeof (mac_addr_t) == 6); 1319 #endif 1320 1321 mutex_init(GLD_SR_MUTEX(macinfo), NULL, MUTEX_DRIVER, NULL); 1322 1323 GLD_SR_VAR(macinfo) = kmem_zalloc(sizeof (struct srtab *)*SR_HASH_SIZE, 1324 KM_SLEEP); 1325 1326 /* Default is RDE enabled for this medium */ 1327 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_enabled = 1328 ddi_getprop(DDI_DEV_T_NONE, macinfo->gldm_devinfo, 0, 1329 "gld_rde_enable", 1); 1330 1331 /* 1332 * Default is to use STE for unknown paths if RDE is enabled. 1333 * If RDE is disabled, default is to use NULL RIF fields. 1334 * 1335 * It's possible to force use of STE for ALL packets: 1336 * disable RDE but enable STE. This may be useful for 1337 * non-transparent bridges, when it is not desired to run 1338 * the RDE algorithms. 1339 */ 1340 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_str_indicator_ste = 1341 ddi_getprop(DDI_DEV_T_NONE, macinfo->gldm_devinfo, 0, 1342 "gld_rde_str_indicator_ste", 1343 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_enabled); 1344 1345 /* Default 10 second route timeout on lack of activity */ 1346 { 1347 int t = ddi_getprop(DDI_DEV_T_NONE, macinfo->gldm_devinfo, 0, 1348 "gld_rde_timeout", 10); 1349 if (t < 1) 1350 t = 1; /* Let's be reasonable */ 1351 if (t > 600) 1352 t = 600; /* Let's be reasonable */ 1353 /* We're using ticks (lbolts) for our timeout -- convert from seconds */ 1354 t = drv_usectohz(1000000 * t); 1355 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_timeout = t; 1356 } 1357 1358 kstat_named_init(&sp->glds_dot5_line_error, 1359 "line_errors", KSTAT_DATA_UINT32); 1360 kstat_named_init(&sp->glds_dot5_burst_error, 1361 "burst_errors", KSTAT_DATA_UINT32); 1362 kstat_named_init(&sp->glds_dot5_signal_loss, 1363 "signal_losses", KSTAT_DATA_UINT32); 1364 1365 /* 1366 * only initialize the new statistics if the driver 1367 * knows about them. 1368 */ 1369 if (macinfo->gldm_driver_version != GLD_VERSION_200) 1370 return; 1371 1372 kstat_named_init(&sp->glds_dot5_ace_error, 1373 "ace_errors", KSTAT_DATA_UINT32); 1374 kstat_named_init(&sp->glds_dot5_internal_error, 1375 "internal_errors", KSTAT_DATA_UINT32); 1376 kstat_named_init(&sp->glds_dot5_lost_frame_error, 1377 "lost_frame_errors", KSTAT_DATA_UINT32); 1378 kstat_named_init(&sp->glds_dot5_frame_copied_error, 1379 "frame_copied_errors", KSTAT_DATA_UINT32); 1380 kstat_named_init(&sp->glds_dot5_token_error, 1381 "token_errors", KSTAT_DATA_UINT32); 1382 kstat_named_init(&sp->glds_dot5_freq_error, 1383 "freq_errors", KSTAT_DATA_UINT32); 1384 } 1385 1386 void 1387 gld_uninit_tr(gld_mac_info_t *macinfo) 1388 { 1389 mutex_destroy(GLD_SR_MUTEX(macinfo)); 1390 gld_sr_clear(macinfo); 1391 kmem_free(GLD_SR_VAR(macinfo), sizeof (struct srtab *) * SR_HASH_SIZE); 1392 } 1393 1394 int 1395 gld_interpret_tr(gld_mac_info_t *macinfo, mblk_t *mp, pktinfo_t *pktinfo, 1396 packet_flag_t flags) 1397 { 1398 struct tr_mac_frm *mh; 1399 gld_mac_pvt_t *mac_pvt; 1400 struct llc_snap_hdr *snaphdr; 1401 mblk_t *pmp = NULL; 1402 struct gld_ri *rh; 1403 1404 /* 1405 * Quickly handle receive fastpath; TR does not support IPQ hack. 1406 */ 1407 if (flags == GLD_RXQUICK) { 1408 pktinfo->pktLen = msgdsize(mp); 1409 return (-1); 1410 } 1411 1412 bzero((void *)pktinfo, sizeof (*pktinfo)); 1413 1414 pktinfo->pktLen = msgdsize(mp); 1415 1416 /* make sure packet has at least a whole mac header */ 1417 if (pktinfo->pktLen < sizeof (struct tr_mac_frm_nori)) 1418 return (-1); 1419 1420 /* make sure the mac header falls into contiguous memory */ 1421 if (MBLKL(mp) < sizeof (struct tr_mac_frm_nori)) { 1422 if ((pmp = msgpullup(mp, -1)) == NULL) { 1423 #ifdef GLD_DEBUG 1424 if (gld_debug & GLDERRS) 1425 cmn_err(CE_WARN, 1426 "GLD: interpret_tr cannot msgpullup"); 1427 #endif 1428 return (-1); 1429 } 1430 mp = pmp; /* this mblk contains the whole mac header */ 1431 } 1432 1433 mh = (struct tr_mac_frm *)mp->b_rptr; 1434 1435 /* Check to see if the mac is a broadcast or multicast address. */ 1436 if (mac_eq(mh->tr_dhost, ether_broadcast, macinfo->gldm_addrlen) || 1437 mac_eq(mh->tr_dhost, tokenbroadcastaddr2, macinfo->gldm_addrlen)) 1438 pktinfo->isBroadcast = 1; 1439 else if (mh->tr_dhost[0] & 0x80) 1440 pktinfo->isMulticast = 1; 1441 1442 if (flags == GLD_TX) 1443 goto out; /* Got all info we need for xmit case */ 1444 1445 ASSERT(GLDM_LOCK_HELD(macinfo)); 1446 1447 /* 1448 * Deal with the mac header 1449 */ 1450 1451 mac_copy(mh->tr_dhost, pktinfo->dhost, macinfo->gldm_addrlen); 1452 mac_copy(mh->tr_shost, pktinfo->shost, macinfo->gldm_addrlen); 1453 pktinfo->shost[0] &= ~0x80; /* turn off RIF indicator */ 1454 1455 mac_pvt = (gld_mac_pvt_t *)macinfo->gldm_mac_pvt; 1456 pktinfo->isLooped = mac_eq(pktinfo->shost, 1457 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 1458 pktinfo->isForMe = mac_eq(pktinfo->dhost, 1459 mac_pvt->curr_macaddr, macinfo->gldm_addrlen); 1460 1461 rh = (struct gld_ri *)NULL; 1462 pktinfo->macLen = sizeof (struct tr_mac_frm_nori); 1463 1464 /* 1465 * Before trying to look beyond the MAC header, make sure the data 1466 * structures are all contiguously where we can conveniently look at 1467 * them. We'll use a worst-case estimate of how many bytes into the 1468 * packet data we'll be needing to look. Things will be more efficient 1469 * if the driver puts at least this much into the first mblk. 1470 * 1471 * Even after this, we still will have to do checks against the total 1472 * length of the packet. A bad incoming packet may not hold all the 1473 * data structures it says it does. 1474 */ 1475 if (MBLKL(mp) < sizeof (struct tr_mac_frm) + 1476 LLC_HDR1_LEN + sizeof (struct rde_pdu) && 1477 MBLKL(mp) < pktinfo->pktLen) { 1478 /* 1479 * we don't have the entire packet within the first mblk (and 1480 * therefore we didn't do the msgpullup above), AND the first 1481 * mblk may not contain all the data we need to look at. 1482 */ 1483 ASSERT(pmp == NULL); /* couldn't have done msgpullup above */ 1484 if ((pmp = msgpullup(mp, -1)) == NULL) { 1485 #ifdef GLD_DEBUG 1486 if (gld_debug & GLDERRS) 1487 cmn_err(CE_WARN, 1488 "GLD: interpret_tr cannot msgpullup2"); 1489 #endif 1490 goto out; /* can't interpret this pkt further */ 1491 } 1492 mp = pmp; /* this mblk should contain everything needed */ 1493 mh = (struct tr_mac_frm *)mp->b_rptr; /* to look at RIF */ 1494 } 1495 1496 if (mh->tr_shost[0] & 0x80) { 1497 /* Routing Information Field (RIF) is present */ 1498 if (pktinfo->pktLen < sizeof (struct tr_mac_frm_nori) + 2) 1499 goto out; /* RIF should have been there! */ 1500 rh = (struct gld_ri *)&mh->tr_ri; 1501 if ((rh->len & 1) || rh->len < 2) { 1502 /* Bogus RIF, don't handle this packet */ 1503 #ifdef GLD_DEBUG 1504 if (gld_debug & GLDERRS) 1505 cmn_err(CE_WARN, 1506 "GLD: received TR packet with " 1507 "bogus RIF length %d", 1508 rh->len); 1509 #endif 1510 goto out; 1511 } 1512 if (pktinfo->pktLen < sizeof (struct tr_mac_frm_nori) + rh->len) 1513 goto out; /* RIF should have been there! */ 1514 pktinfo->macLen += rh->len; 1515 } 1516 1517 if ((mh->tr_fc & 0xc0) == 0x40) { 1518 if (pktinfo->pktLen < pktinfo->macLen + LLC_HDR1_LEN) 1519 goto out; 1520 1521 pktinfo->isLLC = 1; 1522 1523 if (pktinfo->pktLen < pktinfo->macLen + LLC_SNAP_HDR_LEN) 1524 goto out; 1525 1526 snaphdr = (struct llc_snap_hdr *)(mp->b_rptr + pktinfo->macLen); 1527 if (ISETHERTYPE(snaphdr)) { 1528 pktinfo->ethertype = REF_NET_USHORT(snaphdr->type); 1529 pktinfo->hdrLen = LLC_SNAP_HDR_LEN; 1530 } 1531 1532 /* Inform the Route Control Component of received LLC frame */ 1533 gld_rcc_receive(macinfo, pktinfo, rh, 1534 mp->b_rptr + pktinfo->macLen, 1535 pktinfo->pktLen - pktinfo->macLen); 1536 } 1537 out: 1538 if (pmp != NULL) 1539 freemsg(pmp); 1540 1541 return (0); 1542 } 1543 1544 mblk_t * 1545 gld_unitdata_tr(gld_t *gld, mblk_t *mp) 1546 { 1547 gld_mac_info_t *macinfo = gld->gld_mac_info; 1548 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_rptr; 1549 struct gld_dlsap *gldp = DLSAP(dlp, dlp->dl_dest_addr_offset); 1550 mac_addr_t dhost; 1551 unsigned short type; 1552 mblk_t *nmp, *llcmp, *pmp = NULL; 1553 struct tr_mac_frm_nori *mh; 1554 int hdrlen; 1555 struct gld_ri *rh; 1556 1557 ASSERT(macinfo); 1558 1559 /* extract needed info from the mblk before we maybe reuse it */ 1560 mac_copy(gldp->glda_addr, dhost, macinfo->gldm_addrlen); 1561 1562 /* look in the unitdata request for a sap, else use bound one */ 1563 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 1564 REF_HOST_USHORT(gldp->glda_sap) != 0) 1565 type = REF_HOST_USHORT(gldp->glda_sap); 1566 else 1567 type = gld->gld_sap; 1568 1569 /* includes maximum possible Routing Information Field (RIF) size */ 1570 hdrlen = sizeof (struct tr_mac_frm); 1571 1572 /* 1573 * Check whether we need to do EtherType encoding or whether the packet 1574 * is LLC. 1575 */ 1576 if (type > GLD_MAX_802_SAP) 1577 hdrlen += sizeof (struct llc_snap_hdr); 1578 1579 /* need a buffer big enough for the headers */ 1580 llcmp = nmp = mp->b_cont; /* where the packet payload M_DATA is */ 1581 1582 /* 1583 * We are going to need to look at the LLC header, so make sure it 1584 * is contiguously in a single mblk. If we're the ones who create 1585 * the LLC header (below, in the case where sap > 0xff) then we don't 1586 * have to worry about it here. 1587 */ 1588 ASSERT(nmp != NULL); /* gld_unitdata guarantees msgdsize > 0 */ 1589 if (type <= GLD_MAX_802_SAP) { 1590 if (MBLKL(llcmp) < LLC_HDR1_LEN) { 1591 llcmp = pmp = msgpullup(nmp, LLC_HDR1_LEN); 1592 if (pmp == NULL) { 1593 #ifdef GLD_DEBUG 1594 if (gld_debug & GLDERRS) 1595 cmn_err(CE_WARN, 1596 "GLD: unitdata_tr " 1597 "cannot msgpullup"); 1598 #endif 1599 return (NULL); 1600 } 1601 } 1602 } 1603 1604 if (DB_REF(nmp) == 1 && MBLKHEAD(nmp) >= hdrlen) { 1605 /* it fits at the beginning of the first M_DATA block */ 1606 freeb(mp); /* don't need the M_PROTO anymore */ 1607 } else if (DB_REF(mp) == 1 && MBLKSIZE(mp) >= hdrlen) { 1608 /* we can reuse the dl_unitdata_req M_PROTO mblk */ 1609 nmp = mp; 1610 DB_TYPE(nmp) = M_DATA; 1611 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1612 } else { 1613 /* we need to allocate one */ 1614 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) { 1615 if (pmp != NULL) 1616 freemsg(pmp); 1617 return (NULL); 1618 } 1619 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1620 linkb(nmp, mp->b_cont); 1621 freeb(mp); 1622 } 1623 1624 /* Got the space, now copy in the header components */ 1625 if (type > GLD_MAX_802_SAP) { 1626 /* create the snap header */ 1627 struct llc_snap_hdr *snap; 1628 llcmp = nmp; /* LLC header is going to be in this mblk */ 1629 nmp->b_rptr -= sizeof (struct llc_snap_hdr); 1630 snap = (struct llc_snap_hdr *)(nmp->b_rptr); 1631 *snap = llc_snap_def; 1632 SET_NET_USHORT(snap->type, type); 1633 } 1634 1635 /* Hold SR tables still while we maybe point at an entry */ 1636 mutex_enter(GLD_SR_MUTEX(macinfo)); 1637 1638 gld_rcc_send(macinfo, WR(gld->gld_qptr), dhost, &rh, llcmp->b_rptr); 1639 1640 if (rh != NULL) { 1641 /* copy in the RIF */ 1642 ASSERT(rh->len <= sizeof (struct gld_ri)); 1643 nmp->b_rptr -= rh->len; 1644 bcopy((caddr_t)rh, (caddr_t)nmp->b_rptr, rh->len); 1645 } 1646 1647 mutex_exit(GLD_SR_MUTEX(macinfo)); 1648 1649 /* no longer need the pulled-up mblk */ 1650 if (pmp != NULL) 1651 freemsg(pmp); 1652 1653 /* 1654 * fill in token ring header 1655 */ 1656 nmp->b_rptr -= sizeof (struct tr_mac_frm_nori); 1657 mh = (struct tr_mac_frm_nori *)nmp->b_rptr; 1658 mh->tr_ac = 0x10; 1659 mh->tr_fc = 0x40; 1660 mac_copy(dhost, mh->tr_dhost, macinfo->gldm_addrlen); 1661 1662 /* 1663 * We access the mac address without the mutex to prevent 1664 * mutex contention (BUG 4211361) 1665 */ 1666 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 1667 mh->tr_shost, macinfo->gldm_addrlen); 1668 1669 if (rh != NULL) 1670 mh->tr_shost[0] |= 0x80; 1671 else 1672 mh->tr_shost[0] &= ~0x80; 1673 1674 return (nmp); 1675 } 1676 1677 /* 1678 * We cannot have our client sending us "fastpath" M_DATA messages, 1679 * because to do that we must provide to him a fixed MAC header to 1680 * be prepended to each outgoing packet. But with Source Routing 1681 * media, the length and content of the MAC header changes as the 1682 * routes change, so there is no fixed header we can provide. So 1683 * we decline to accept M_DATA messages if Source Routing is enabled. 1684 */ 1685 mblk_t * 1686 gld_fastpath_tr(gld_t *gld, mblk_t *mp) 1687 { 1688 gld_mac_info_t *macinfo = gld->gld_mac_info; 1689 dl_unitdata_req_t *dlp = (dl_unitdata_req_t *)mp->b_cont->b_rptr; 1690 struct gld_dlsap *gldp = DLSAP(dlp, dlp->dl_dest_addr_offset); 1691 unsigned short type; 1692 mblk_t *nmp; 1693 struct tr_mac_frm_nori *mh; 1694 int hdrlen; 1695 1696 ASSERT(macinfo); 1697 1698 /* 1699 * If we are doing Source Routing, then we cannot provide a fixed 1700 * MAC header, so fail. 1701 */ 1702 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_enabled) 1703 return (NULL); 1704 1705 /* look in the unitdata request for a sap, else use bound one */ 1706 if (dlp->dl_dest_addr_length >= DLSAPLENGTH(macinfo) && 1707 REF_HOST_USHORT(gldp->glda_sap) != 0) 1708 type = REF_HOST_USHORT(gldp->glda_sap); 1709 else 1710 type = gld->gld_sap; 1711 1712 hdrlen = sizeof (struct tr_mac_frm_nori); 1713 1714 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_str_indicator_ste) 1715 hdrlen += ri_ste_def.len; 1716 1717 /* 1718 * Check whether we need to do EtherType encoding or whether the packet 1719 * will be LLC. 1720 */ 1721 if (type > GLD_MAX_802_SAP) 1722 hdrlen += sizeof (struct llc_snap_hdr); 1723 1724 if ((nmp = allocb(hdrlen, BPRI_MED)) == NULL) 1725 return (NULL); 1726 1727 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1728 1729 /* Got the space, now copy in the header components */ 1730 1731 if (type > GLD_MAX_802_SAP) { 1732 /* create the snap header */ 1733 struct llc_snap_hdr *snap; 1734 nmp->b_rptr -= sizeof (struct llc_snap_hdr); 1735 snap = (struct llc_snap_hdr *)(nmp->b_rptr); 1736 *snap = llc_snap_def; 1737 snap->type = htons(type); /* we know it's aligned */ 1738 } 1739 1740 /* RDE is disabled, use NULL RIF, or STE RIF */ 1741 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_str_indicator_ste) { 1742 nmp->b_rptr -= ri_ste_def.len; 1743 bcopy((caddr_t)&ri_ste_def, (caddr_t)nmp->b_rptr, 1744 ri_ste_def.len); 1745 } 1746 1747 /* 1748 * fill in token ring header 1749 */ 1750 nmp->b_rptr -= sizeof (struct tr_mac_frm_nori); 1751 mh = (struct tr_mac_frm_nori *)nmp->b_rptr; 1752 mh->tr_ac = 0x10; 1753 mh->tr_fc = 0x40; 1754 mac_copy(gldp->glda_addr, mh->tr_dhost, macinfo->gldm_addrlen); 1755 1756 GLDM_LOCK(macinfo, RW_WRITER); 1757 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 1758 mh->tr_shost, macinfo->gldm_addrlen); 1759 GLDM_UNLOCK(macinfo); 1760 1761 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_str_indicator_ste) 1762 mh->tr_shost[0] |= 0x80; 1763 else 1764 mh->tr_shost[0] &= ~0x80; 1765 1766 return (nmp); 1767 } 1768 1769 /* 1770 * Route Determination Entity (ISO 8802-2 / IEEE 802.2 : 1994, Section 9) 1771 * 1772 * RDE is an LLC layer entity. GLD is a MAC layer entity. The proper 1773 * solution to this architectural anomaly is to move RDE support out of GLD 1774 * and into LLC where it belongs. In particular, only LLC has the knowledge 1775 * necessary to reply to XID and TEST packets. If and when it comes time to 1776 * move RDE out of GLD to LLC, the LLC-to-GLD interface should be modified 1777 * to use MA_UNITDATA structures rather than DL_UNITDATA structures. Of 1778 * course, GLD will still have to continue to also support the DL_ structures 1779 * as long as IP is not layered over LLC. Another, perhaps better, idea 1780 * would be to make RDE an autopush module on top of the token ring drivers: 1781 * RDE would sit between LLC and GLD. It would then also sit between IP and 1782 * GLD, providing services to all clients of GLD/tokenring. In that case, 1783 * GLD would still have to continue to support the DL_ interface for non- 1784 * Token Ring interfaces, using the MA_ interface only for media supporting 1785 * Source Routing media. 1786 * 1787 * At present, Token Ring is the only source routing medium we support. 1788 * Since Token Ring is not at this time a strategic network medium for Sun, 1789 * rather than devote a large amount of resources to creating a proper 1790 * architecture and implementation of RDE, we do the minimum necessary to 1791 * get it to work. The interface between the above token ring code and the 1792 * below RDE code is designed to make it relatively easy to change to an 1793 * MA_UNITDATA model later should this ever become a priority. 1794 */ 1795 1796 static void gld_send_rqr(gld_mac_info_t *, uchar_t *, struct gld_ri *, 1797 struct rde_pdu *, int); 1798 static void gld_rde_pdu_req(gld_mac_info_t *, queue_t *, uchar_t *, 1799 struct gld_ri *, uchar_t, uchar_t, uchar_t); 1800 static void gld_get_route(gld_mac_info_t *, queue_t *, uchar_t *, 1801 struct gld_ri **, uchar_t, uchar_t); 1802 static void gld_reset_route(gld_mac_info_t *, queue_t *, 1803 uchar_t *, uchar_t, uchar_t); 1804 static void gld_rde_pdu_ind(gld_mac_info_t *, struct gld_ri *, struct rde_pdu *, 1805 int); 1806 static void gld_rif_ind(gld_mac_info_t *, struct gld_ri *, uchar_t *, 1807 uchar_t, uchar_t); 1808 static struct srtab **gld_sr_hash(struct srtab **, uchar_t *, int); 1809 static struct srtab *gld_sr_lookup_entry(gld_mac_info_t *, uchar_t *); 1810 static struct srtab *gld_sr_create_entry(gld_mac_info_t *, uchar_t *); 1811 1812 /* 1813 * This routine implements a modified subset of the 802.2 RDE RCC receive 1814 * actions: 1815 * we implement RCC receive events 3 to 12 (ISO 8802-2:1994 9.6.3.4); 1816 * we omit special handling for the NULL SAP; 1817 * we omit XID/TEST handling; 1818 * we pass all packets (including RDE) upstream to LLC. 1819 */ 1820 static void 1821 gld_rcc_receive(gld_mac_info_t *macinfo, pktinfo_t *pktinfo, struct gld_ri *rh, 1822 uchar_t *llcpkt, int llcpktlen) 1823 { 1824 struct llc_snap_hdr *snaphdr = (struct llc_snap_hdr *)(llcpkt); 1825 1826 if (!((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_enabled) 1827 return; 1828 1829 /* 1830 * First, ensure this packet wasn't something we received just 1831 * because we were in promiscuous mode. Since none of the below 1832 * code wants to see group addressed packets anyway, we can do 1833 * this check up front. Since we're doing that, we can omit the 1834 * checks for group addressed packets below. 1835 */ 1836 if (!pktinfo->isForMe) 1837 return; /* Event 6 */ 1838 1839 /* Process a subset of Route Determination Entity (RDE) packets */ 1840 if (snaphdr->d_lsap == LSAP_RDE) { 1841 struct rde_pdu *pdu = (struct rde_pdu *)(llcpkt + LLC_HDR1_LEN); 1842 int pdulen = llcpktlen - LLC_HDR1_LEN; 1843 1844 /* sanity check the PDU */ 1845 if ((pdulen < sizeof (struct rde_pdu)) || 1846 (snaphdr->s_lsap != LSAP_RDE)) 1847 return; 1848 1849 /* we only handle route discovery PDUs, not XID/TEST/other */ 1850 if (snaphdr->control != CNTL_LLC_UI) 1851 return; 1852 1853 switch (pdu->rde_ptype) { 1854 case RDE_RQC: /* Route Query Command; Events 8 - 11 */ 1855 gld_send_rqr(macinfo, pktinfo->shost, rh, pdu, pdulen); 1856 /* FALLTHROUGH */ 1857 case RDE_RQR: /* Route Query Response; Event 12 */ 1858 case RDE_RS: /* Route Selected; Event 7 */ 1859 gld_rde_pdu_ind(macinfo, rh, pdu, pdulen); 1860 break; 1861 default: /* ignore if unrecognized ptype */ 1862 return; 1863 } 1864 1865 return; 1866 } 1867 1868 /* Consider routes seen in other IA SRF packets */ 1869 1870 if (rh == NULL) 1871 return; /* no RIF; Event 3 */ 1872 1873 if ((rh->rt & 0x04) != 0) 1874 return; /* not SRF; Event 5 */ 1875 1876 gld_rif_ind(macinfo, rh, pktinfo->shost, snaphdr->s_lsap, 1877 snaphdr->d_lsap); /* Event 4 */ 1878 } 1879 1880 /* 1881 * Send RQR: 802.2 9.6.3.4.2(9) RCC Receive Events 8-11 1882 * 1883 * The routing processing really doesn't belong here; it should be handled in 1884 * the LLC layer above. If that were the case then RDE could just send down 1885 * an extra MA_UNITDATA_REQ with the info needed to construct the packet. But 1886 * at the time we get control here, it's not a particularly good time to be 1887 * constructing packets and trying to send them. Specifically, at this layer 1888 * we need to construct the full media packet, which means the below routine 1889 * knows that it is dealing with Token Ring media. If this were instead done 1890 * via a proper MA_UNITDATA interface, the RDE stuff could all be completely 1891 * media independent. But since TR is the only source routing medium we 1892 * support, this works even though it is not clean. 1893 * 1894 * We "know" that the only time we can get here is from the "interpret" 1895 * routine, and only when it was called at receive time. 1896 */ 1897 static void 1898 gld_send_rqr(gld_mac_info_t *macinfo, uchar_t *shost, struct gld_ri *rh, 1899 struct rde_pdu *pdu, int pdulen) 1900 { 1901 mblk_t *nmp; 1902 int nlen; 1903 struct tr_mac_frm_nori *nmh; 1904 struct gld_ri *nrh; 1905 struct llc_snap_hdr *nsnaphdr; 1906 struct rde_pdu *npdu; 1907 1908 /* We know and assume we're on the receive path */ 1909 ASSERT(GLDM_LOCK_HELD(macinfo)); 1910 1911 if (pdulen < sizeof (struct rde_pdu)) 1912 return; /* Bad incoming PDU */ 1913 1914 nlen = sizeof (struct tr_mac_frm) + LLC_HDR1_LEN + 1915 sizeof (struct rde_pdu); 1916 1917 if ((nmp = allocb(nlen, BPRI_MED)) == NULL) 1918 return; 1919 1920 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 1921 1922 nmp->b_rptr -= sizeof (struct rde_pdu); 1923 npdu = (struct rde_pdu *)(nmp->b_rptr); 1924 *npdu = *pdu; /* copy orig/target macaddr/saps */ 1925 npdu->rde_ver = 1; 1926 npdu->rde_ptype = RDE_RQR; 1927 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 1928 npdu->rde_target_mac, macinfo->gldm_addrlen); 1929 1930 nmp->b_rptr -= LLC_HDR1_LEN; 1931 nsnaphdr = (struct llc_snap_hdr *)(nmp->b_rptr); 1932 nsnaphdr->s_lsap = nsnaphdr->d_lsap = LSAP_RDE; 1933 nsnaphdr->control = CNTL_LLC_UI; 1934 1935 if (rh == NULL || (rh->rt & 0x06) == 0x06 || 1936 rh->len > sizeof (struct gld_ri)) { 1937 /* no RIF (Event 8), or RIF type STE (Event 9): send ARE RQR */ 1938 nmp->b_rptr -= 2; 1939 nrh = (struct gld_ri *)(nmp->b_rptr); 1940 nrh->len = 2; 1941 nrh->rt = RT_ARE; 1942 nrh->dir = 0; 1943 nrh->res = 0; 1944 nrh->mtu = RT_MTU_MAX; 1945 } else { 1946 /* 1947 * RIF must be ARE (Event 10) or SRF (Event 11): 1948 * send SRF (reverse) RQR 1949 */ 1950 ASSERT(rh->len <= sizeof (struct gld_ri)); 1951 nmp->b_rptr -= rh->len; 1952 nrh = (struct gld_ri *)(nmp->b_rptr); 1953 bcopy(rh, nrh, rh->len); /* copy incoming RIF */ 1954 nrh->rt = RT_SRF; /* make it SRF */ 1955 nrh->dir ^= 1; /* reverse direction */ 1956 } 1957 1958 nmp->b_rptr -= sizeof (struct tr_mac_frm_nori); 1959 nmh = (struct tr_mac_frm_nori *)(nmp->b_rptr); 1960 nmh->tr_ac = 0x10; 1961 nmh->tr_fc = 0x40; 1962 mac_copy(shost, nmh->tr_dhost, macinfo->gldm_addrlen); 1963 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 1964 nmh->tr_shost, macinfo->gldm_addrlen); 1965 nmh->tr_shost[0] |= 0x80; /* indicate RIF present */ 1966 1967 /* 1968 * Packet assembled; send it. 1969 * 1970 * As noted before, this is not really a good time to be trying to 1971 * send out packets. We have no obvious queue to use if the packet 1972 * can't be sent right away. We pick one arbitrarily. 1973 */ 1974 { 1975 gld_vlan_t *vlan; 1976 queue_t *q; 1977 1978 if ((vlan = gld_find_vlan(macinfo, VLAN_VID_NONE)) == NULL) { 1979 /* oops, no vlan on the list for this macinfo! */ 1980 /* this should not happen */ 1981 freeb(nmp); 1982 return; 1983 } 1984 q = vlan->gldv_str_next->gld_qptr; 1985 1986 /* 1987 * Queue the packet and let gld_wsrv 1988 * handle it, thus preventing a panic 1989 * caused by v2 TR in promiscuous mode 1990 * where it attempts to get the mutex 1991 * in this thread while already holding 1992 * it. 1993 */ 1994 (void) putbq(WR(q), nmp); 1995 qenable(WR(q)); 1996 } 1997 } 1998 1999 /* 2000 * This routine implements a modified subset of the 802.2 RDE RCC send actions: 2001 * we implement RCC send events 5 to 10 (ISO 8802-2:1994 9.6.3.5); 2002 * we omit special handling for the NULL SAP; 2003 * events 11 to 12 are handled by gld_rde_pdu_req below; 2004 * we require an immediate response to our GET_ROUTE_REQUEST. 2005 */ 2006 static void 2007 gld_rcc_send(gld_mac_info_t *macinfo, queue_t *q, uchar_t *dhost, 2008 struct gld_ri **rhp, uchar_t *llcpkt) 2009 { 2010 struct llc_snap_hdr *snaphdr = (struct llc_snap_hdr *)(llcpkt); 2011 2012 /* 2013 * Our caller has to take the mutex because: to avoid an extra bcopy 2014 * of the RIF on every transmit, we pass back a pointer to our sr 2015 * table entry via rhp. He has to keep the mutex until he has a 2016 * chance to copy the RIF out into the outgoing packet, so that we 2017 * don't modify the entry while he's trying to copy it. This is a 2018 * little ugly, but saves the extra bcopy. 2019 */ 2020 ASSERT(mutex_owned(GLD_SR_MUTEX(macinfo))); 2021 2022 *rhp = (struct gld_ri *)NULL; /* start off clean (no RIF) */ 2023 2024 if (!((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_enabled) { 2025 /* RDE is disabled -- use NULL or STE always */ 2026 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)-> 2027 rde_str_indicator_ste) 2028 *rhp = &ri_ste_def; /* STE option */ 2029 return; 2030 } 2031 2032 if (!(dhost[0] & 0x80)) { 2033 /* individual address; Events 7 - 10 */ 2034 if ((snaphdr->control & 0xef) == 0xe3) { 2035 /* TEST command, reset the route */ 2036 gld_reset_route(macinfo, q, 2037 dhost, snaphdr->d_lsap, snaphdr->s_lsap); 2038 } 2039 gld_get_route(macinfo, q, 2040 dhost, rhp, snaphdr->d_lsap, snaphdr->s_lsap); 2041 } 2042 2043 if (*rhp == NULL) { 2044 /* 2045 * group address (Events 5 - 6), 2046 * or no route available (Events 8 - 9): 2047 * Need to send NSR or STE, as configured. 2048 */ 2049 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)-> 2050 rde_str_indicator_ste) 2051 *rhp = &ri_ste_def; /* STE option */ 2052 } 2053 } 2054 2055 /* 2056 * RCC send events 11 - 12 2057 * 2058 * At present we only handle the RQC ptype. 2059 * 2060 * We "know" that the only time we can get here is from the "unitdata" 2061 * routine, called at wsrv time. 2062 * 2063 * If we ever implement the RS ptype (Event 13), this may no longer be true! 2064 */ 2065 static void 2066 gld_rde_pdu_req(gld_mac_info_t *macinfo, queue_t *q, uchar_t *dhost, 2067 struct gld_ri *rh, uchar_t dsap, uchar_t ssap, uchar_t ptype) 2068 { 2069 mblk_t *nmp; 2070 int nlen; 2071 struct tr_mac_frm_nori *nmh; 2072 struct gld_ri *nrh; 2073 struct llc_snap_hdr *nsnaphdr; 2074 struct rde_pdu *npdu; 2075 int srpresent = 0; 2076 2077 /* if you change this to process other types, review all code below */ 2078 ASSERT(ptype == RDE_RQC); 2079 ASSERT(rh == NULL); /* RQC never uses SRF */ 2080 2081 nlen = sizeof (struct tr_mac_frm) + LLC_HDR1_LEN + 2082 sizeof (struct rde_pdu); 2083 2084 if ((nmp = allocb(nlen, BPRI_MED)) == NULL) 2085 return; 2086 2087 nmp->b_rptr = nmp->b_wptr = DB_LIM(nmp); 2088 2089 nmp->b_rptr -= sizeof (struct rde_pdu); 2090 npdu = (struct rde_pdu *)(nmp->b_rptr); 2091 npdu->rde_ver = 1; 2092 npdu->rde_ptype = ptype; 2093 mac_copy(dhost, &npdu->rde_target_mac, 6); 2094 2095 /* 2096 * access the mac address without a mutex - take a risk - 2097 * to prevent mutex contention (BUG 4211361) 2098 */ 2099 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 2100 &npdu->rde_orig_mac, 6); 2101 npdu->rde_target_sap = dsap; 2102 npdu->rde_orig_sap = ssap; 2103 2104 nmp->b_rptr -= LLC_HDR1_LEN; 2105 nsnaphdr = (struct llc_snap_hdr *)(nmp->b_rptr); 2106 nsnaphdr->s_lsap = nsnaphdr->d_lsap = LSAP_RDE; 2107 nsnaphdr->control = CNTL_LLC_UI; 2108 2109 #if 0 /* we don't need this for now */ 2110 if (rh != NULL) { 2111 /* send an SRF frame with specified RIF */ 2112 ASSERT(rh->len <= sizeof (struct gld_ri)); 2113 nmp->b_rptr -= rh->len; 2114 nrh = (struct gld_ri *)(nmp->b_rptr); 2115 bcopy(rh, nrh, rh->len); 2116 ASSERT(nrh->rt == RT_SRF); 2117 srpresent = 1; 2118 } else 2119 #endif 2120 2121 /* Need to send NSR or STE, as configured. */ 2122 if (((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_str_indicator_ste) { 2123 /* send an STE frame */ 2124 nmp->b_rptr -= 2; 2125 nrh = (struct gld_ri *)(nmp->b_rptr); 2126 nrh->len = 2; 2127 nrh->rt = RT_STE; 2128 nrh->dir = 0; 2129 nrh->res = 0; 2130 nrh->mtu = RT_MTU_MAX; 2131 srpresent = 1; 2132 } /* else send an NSR frame */ 2133 2134 nmp->b_rptr -= sizeof (struct tr_mac_frm_nori); 2135 nmh = (struct tr_mac_frm_nori *)(nmp->b_rptr); 2136 nmh->tr_ac = 0x10; 2137 nmh->tr_fc = 0x40; 2138 mac_copy(dhost, nmh->tr_dhost, macinfo->gldm_addrlen); 2139 /* 2140 * access the mac address without a mutex - take a risk - 2141 * to prevent mutex contention - BUG 4211361 2142 */ 2143 mac_copy(((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->curr_macaddr, 2144 nmh->tr_shost, macinfo->gldm_addrlen); 2145 2146 if (srpresent) 2147 nmh->tr_shost[0] |= 0x80; 2148 else 2149 nmh->tr_shost[0] &= ~0x80; 2150 2151 /* 2152 * Packet assembled; send it. 2153 * 2154 * Since we own the SR_MUTEX, we don't want to take the maclock 2155 * mutex (since they are acquired in the opposite order on the 2156 * receive path, so deadlock could occur). We could rearrange 2157 * the code in gld_get_route() and drop the SR_MUTEX around the 2158 * call to gld_rde_pdu_req(), but that's kind of ugly. Rather, 2159 * we just refrain from calling gld_start() from here, and 2160 * instead just queue the packet for wsrv to send next. Besides, 2161 * it's more important to get the packet we're working on out 2162 * quickly than this RQC. 2163 */ 2164 (void) putbq(WR(q), nmp); 2165 qenable(WR(q)); 2166 } 2167 2168 /* 2169 * Route Determination Component (RDC) 2170 * 2171 * We do not implement separate routes for each SAP, as specified by 2172 * ISO 8802-2; instead we implement only one route per remote mac address. 2173 */ 2174 static void 2175 gld_get_route(gld_mac_info_t *macinfo, queue_t *q, uchar_t *dhost, 2176 struct gld_ri **rhp, uchar_t dsap, uchar_t ssap) 2177 { 2178 struct srtab *sr; 2179 clock_t t = ddi_get_lbolt(); 2180 2181 ASSERT(mutex_owned(GLD_SR_MUTEX(macinfo))); 2182 2183 sr = gld_sr_lookup_entry(macinfo, dhost); 2184 2185 if (sr == NULL) { 2186 /* 2187 * we have no entry -- never heard of this address: 2188 * create an empty entry and initiate RQC 2189 */ 2190 sr = gld_sr_create_entry(macinfo, dhost); 2191 gld_rde_pdu_req(macinfo, q, dhost, (struct gld_ri *)NULL, 2192 dsap, ssap, RDE_RQC); 2193 if (sr) 2194 sr->sr_timer = t; 2195 *rhp = NULL; /* we have no route yet */ 2196 return; 2197 } 2198 2199 /* we have an entry; see if we know a route yet */ 2200 2201 if (sr->sr_ri.len == 0) { 2202 /* Have asked RQC, but no reply (yet) */ 2203 if (t - sr->sr_timer > 2204 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_timeout) { 2205 /* RQR overdue, resend RQC */ 2206 gld_rde_pdu_req(macinfo, q, dhost, 2207 (struct gld_ri *)NULL, dsap, ssap, RDE_RQC); 2208 sr->sr_timer = t; 2209 } 2210 *rhp = NULL; /* we have no route yet */ 2211 return; 2212 } 2213 2214 /* we know a route, or it's local */ 2215 2216 /* if it might be stale, reset and get a new one */ 2217 if (t - sr->sr_timer > 2218 ((gld_mac_pvt_t *)macinfo->gldm_mac_pvt)->rde_timeout) { 2219 gld_rde_pdu_req(macinfo, q, dhost, 2220 (struct gld_ri *)NULL, dsap, ssap, RDE_RQC); 2221 sr->sr_ri.len = 0; 2222 sr->sr_timer = t; 2223 *rhp = NULL; /* we have no route */ 2224 return; 2225 } 2226 2227 if (sr->sr_ri.len == 2) { 2228 /* the remote site is on our local ring -- no route needed */ 2229 *rhp = NULL; 2230 return; 2231 } 2232 2233 *rhp = &sr->sr_ri; /* we have a route, return it */ 2234 } 2235 2236 /* 2237 * zap the specified entry and reinitiate RQC 2238 */ 2239 static void 2240 gld_reset_route(gld_mac_info_t *macinfo, queue_t *q, 2241 uchar_t *dhost, uchar_t dsap, uchar_t ssap) 2242 { 2243 struct srtab *sr; 2244 2245 ASSERT(mutex_owned(GLD_SR_MUTEX(macinfo))); 2246 2247 sr = gld_sr_create_entry(macinfo, dhost); 2248 gld_rde_pdu_req(macinfo, q, dhost, (struct gld_ri *)NULL, 2249 dsap, ssap, RDE_RQC); 2250 if (sr == NULL) 2251 return; 2252 2253 sr->sr_ri.len = 0; 2254 sr->sr_timer = ddi_get_lbolt(); 2255 } 2256 2257 /* 2258 * This routine is called when an RDE PDU is received from our peer. 2259 * If it is an RS (Route Selected) PDU, we adopt the specified route. 2260 * If it is an RQR (reply to our previous RQC), we evaluate the 2261 * specified route in comparison with our current known route, if any, 2262 * and we keep the "better" of the two routes. 2263 */ 2264 static void 2265 gld_rde_pdu_ind(gld_mac_info_t *macinfo, struct gld_ri *rh, struct rde_pdu *pdu, 2266 int pdulen) 2267 { 2268 struct srtab *sr; 2269 uchar_t *otherhost; 2270 2271 if (pdulen < sizeof (struct rde_pdu)) 2272 return; /* Bad incoming PDU */ 2273 2274 if (pdu->rde_ptype == RDE_RQC) 2275 return; /* ignore RQC */ 2276 2277 if (pdu->rde_ptype != RDE_RQR && pdu->rde_ptype != RDE_RS) { 2278 #ifdef GLD_DEBUG 2279 if (gld_debug & GLDERRS) 2280 cmn_err(CE_WARN, "gld: bogus RDE ptype 0x%x received", 2281 pdu->rde_ptype); 2282 #endif 2283 return; 2284 } 2285 2286 if (rh == NULL) { 2287 #ifdef GLD_DEBUG 2288 if (gld_debug & GLDERRS) 2289 cmn_err(CE_WARN, 2290 "gld: bogus NULL RIF, ptype 0x%x received", 2291 pdu->rde_ptype); 2292 #endif 2293 return; 2294 } 2295 2296 ASSERT(rh->len >= 2); 2297 ASSERT(rh->len <= sizeof (struct gld_ri)); 2298 ASSERT((rh->len & 1) == 0); 2299 2300 if (pdu->rde_ptype == RDE_RQR) { 2301 /* A reply to our RQC has his address as target mac */ 2302 otherhost = pdu->rde_target_mac; 2303 } else { 2304 ASSERT(pdu->rde_ptype == RDE_RS); 2305 /* An RS has his address as orig mac */ 2306 otherhost = pdu->rde_orig_mac; 2307 } 2308 2309 mutex_enter(GLD_SR_MUTEX(macinfo)); 2310 2311 if ((sr = gld_sr_create_entry(macinfo, otherhost)) == NULL) { 2312 mutex_exit(GLD_SR_MUTEX(macinfo)); 2313 return; /* oh well, out of memory */ 2314 } 2315 2316 if (pdu->rde_ptype == RDE_RQR) { 2317 /* see if new route is better than what we may already have */ 2318 if (sr->sr_ri.len != 0 && 2319 sr->sr_ri.len <= rh->len) { 2320 mutex_exit(GLD_SR_MUTEX(macinfo)); 2321 return; /* we have one, and new one is no shorter */ 2322 } 2323 } 2324 2325 /* adopt the new route */ 2326 bcopy((caddr_t)rh, (caddr_t)&sr->sr_ri, rh->len); /* copy incom RIF */ 2327 sr->sr_ri.rt = RT_SRF; /* make it a clean SRF */ 2328 sr->sr_ri.dir ^= 1; /* reverse direction */ 2329 sr->sr_timer = ddi_get_lbolt(); 2330 2331 mutex_exit(GLD_SR_MUTEX(macinfo)); 2332 } 2333 2334 /* 2335 * This routine is called when a packet with a RIF is received. Our 2336 * policy is to adopt the route. 2337 */ 2338 /* ARGSUSED3 */ 2339 static void 2340 gld_rif_ind(gld_mac_info_t *macinfo, struct gld_ri *rh, uchar_t *shost, 2341 uchar_t ssap, uchar_t dsap) 2342 { 2343 struct srtab *sr; 2344 2345 ASSERT(rh != NULL); /* ensure RIF */ 2346 ASSERT((rh->rt & 0x04) == 0); /* ensure SRF */ 2347 ASSERT(rh->len >= 2); 2348 ASSERT(rh->len <= sizeof (struct gld_ri)); 2349 ASSERT((rh->len & 1) == 0); 2350 2351 mutex_enter(GLD_SR_MUTEX(macinfo)); 2352 2353 if ((sr = gld_sr_create_entry(macinfo, shost)) == NULL) { 2354 mutex_exit(GLD_SR_MUTEX(macinfo)); 2355 return; /* oh well, out of memory */ 2356 } 2357 2358 /* we have an entry; fill it in */ 2359 bcopy((caddr_t)rh, (caddr_t)&sr->sr_ri, rh->len); /* copy incom RIF */ 2360 sr->sr_ri.rt = RT_SRF; /* make it a clean SRF */ 2361 sr->sr_ri.dir ^= 1; /* reverse direction */ 2362 sr->sr_timer = ddi_get_lbolt(); 2363 2364 mutex_exit(GLD_SR_MUTEX(macinfo)); 2365 } 2366 2367 static struct srtab ** 2368 gld_sr_hash(struct srtab **sr_hash_tbl, uchar_t *addr, int addr_length) 2369 { 2370 uint_t hashval = 0; 2371 2372 while (--addr_length >= 0) 2373 hashval ^= *addr++; 2374 2375 return (&sr_hash_tbl[hashval % SR_HASH_SIZE]); 2376 } 2377 2378 static struct srtab * 2379 gld_sr_lookup_entry(gld_mac_info_t *macinfo, uchar_t *macaddr) 2380 { 2381 struct srtab *sr; 2382 2383 ASSERT(mutex_owned(GLD_SR_MUTEX(macinfo))); 2384 2385 for (sr = *gld_sr_hash(GLD_SR_HASH(macinfo), macaddr, 2386 macinfo->gldm_addrlen); sr; sr = sr->sr_next) 2387 if (mac_eq(macaddr, sr->sr_mac, macinfo->gldm_addrlen)) 2388 return (sr); 2389 2390 return ((struct srtab *)0); 2391 } 2392 2393 static struct srtab * 2394 gld_sr_create_entry(gld_mac_info_t *macinfo, uchar_t *macaddr) 2395 { 2396 struct srtab *sr; 2397 struct srtab **srp; 2398 2399 ASSERT(!(macaddr[0] & 0x80)); /* no group addresses here */ 2400 ASSERT(mutex_owned(GLD_SR_MUTEX(macinfo))); 2401 2402 srp = gld_sr_hash(GLD_SR_HASH(macinfo), macaddr, macinfo->gldm_addrlen); 2403 2404 for (sr = *srp; sr; sr = sr->sr_next) 2405 if (mac_eq(macaddr, sr->sr_mac, macinfo->gldm_addrlen)) 2406 return (sr); 2407 2408 if (!(sr = kmem_zalloc(sizeof (struct srtab), KM_NOSLEEP))) { 2409 #ifdef GLD_DEBUG 2410 if (gld_debug & GLDERRS) 2411 cmn_err(CE_WARN, 2412 "gld: gld_sr_create_entry kmem_alloc failed"); 2413 #endif 2414 return ((struct srtab *)0); 2415 } 2416 2417 bcopy((caddr_t)macaddr, (caddr_t)sr->sr_mac, macinfo->gldm_addrlen); 2418 2419 sr->sr_next = *srp; 2420 *srp = sr; 2421 return (sr); 2422 } 2423 2424 static void 2425 gld_sr_clear(gld_mac_info_t *macinfo) 2426 { 2427 int i; 2428 struct srtab **sr_hash_tbl = GLD_SR_HASH(macinfo); 2429 struct srtab **srp, *sr; 2430 2431 /* 2432 * Walk through the table, deleting all entries. 2433 * 2434 * Only called from uninit, so don't need the mutex. 2435 */ 2436 for (i = 0; i < SR_HASH_SIZE; i++) { 2437 for (srp = &sr_hash_tbl[i]; (sr = *srp) != NULL; ) { 2438 *srp = sr->sr_next; 2439 kmem_free((char *)sr, sizeof (struct srtab)); 2440 } 2441 } 2442 } 2443 2444 #ifdef DEBUG 2445 void 2446 gld_sr_dump(gld_mac_info_t *macinfo) 2447 { 2448 int i, j; 2449 struct srtab **sr_hash_tbl; 2450 struct srtab *sr; 2451 2452 sr_hash_tbl = GLD_SR_HASH(macinfo); 2453 if (sr_hash_tbl == NULL) 2454 return; 2455 2456 mutex_enter(GLD_SR_MUTEX(macinfo)); 2457 2458 /* 2459 * Walk through the table, printing all entries 2460 */ 2461 cmn_err(CE_NOTE, "GLD Source Routing Table (0x%p):", (void *)macinfo); 2462 cmn_err(CE_CONT, "Addr len,rt,dir,mtu,res rng,brg0 rng,brg1...\n"); 2463 for (i = 0; i < SR_HASH_SIZE; i++) { 2464 for (sr = sr_hash_tbl[i]; sr; sr = sr->sr_next) { 2465 cmn_err(CE_CONT, 2466 "%x:%x:%x:%x:%x:%x %d,%x,%x,%x,%x ", 2467 sr->sr_mac[0], sr->sr_mac[1], sr->sr_mac[2], 2468 sr->sr_mac[3], sr->sr_mac[4], sr->sr_mac[5], 2469 sr->sr_ri.len, sr->sr_ri.rt, sr->sr_ri.dir, 2470 sr->sr_ri.mtu, sr->sr_ri.res); 2471 if (sr->sr_ri.len) 2472 for (j = 0; j < (sr->sr_ri.len - 2) / 2; j++) 2473 cmn_err(CE_CONT, "%x ", 2474 REF_NET_USHORT(*(unsigned short *) 2475 &sr->sr_ri.rd[j])); 2476 cmn_err(CE_CONT, "\n"); 2477 } 2478 } 2479 2480 mutex_exit(GLD_SR_MUTEX(macinfo)); 2481 } 2482 #endif 2483