1 /*- 2 * Written by: yen_cw@myson.com.tw 3 * Copyright (c) 2002 Myson Technology Inc. 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions, and the following disclaimer, 11 * without modification, immediately at the beginning of the file. 12 * 2. The name of the author may not be used to endorse or promote products 13 * derived from this software without specific prior written permission. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 19 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 * Myson fast ethernet PCI NIC driver, available at: http://www.myson.com.tw/ 28 */ 29 30 #include <sys/cdefs.h> 31 __FBSDID("$FreeBSD$"); 32 33 #include <sys/param.h> 34 #include <sys/systm.h> 35 #include <sys/sockio.h> 36 #include <sys/mbuf.h> 37 #include <sys/malloc.h> 38 #include <sys/kernel.h> 39 #include <sys/socket.h> 40 #include <sys/queue.h> 41 #include <sys/types.h> 42 #include <sys/module.h> 43 #include <sys/lock.h> 44 #include <sys/mutex.h> 45 46 #define NBPFILTER 1 47 48 #include <net/if.h> 49 #include <net/if_arp.h> 50 #include <net/ethernet.h> 51 #include <net/if_media.h> 52 #include <net/if_types.h> 53 #include <net/if_dl.h> 54 #include <net/bpf.h> 55 56 #include <vm/vm.h> /* for vtophys */ 57 #include <vm/pmap.h> /* for vtophys */ 58 #include <machine/bus.h> 59 #include <machine/resource.h> 60 #include <sys/bus.h> 61 #include <sys/rman.h> 62 63 #include <dev/pci/pcireg.h> 64 #include <dev/pci/pcivar.h> 65 66 /* 67 * #define MY_USEIOSPACE 68 */ 69 70 static int MY_USEIOSPACE = 1; 71 72 #ifdef MY_USEIOSPACE 73 #define MY_RES SYS_RES_IOPORT 74 #define MY_RID MY_PCI_LOIO 75 #else 76 #define MY_RES SYS_RES_MEMORY 77 #define MY_RID MY_PCI_LOMEM 78 #endif 79 80 81 #include <dev/my/if_myreg.h> 82 83 #ifndef lint 84 static const char rcsid[] = 85 "$Id: if_my.c,v 1.16 2003/04/15 06:37:25 mdodd Exp $"; 86 #endif 87 88 /* 89 * Various supported device vendors/types and their names. 90 */ 91 struct my_type *my_info_tmp; 92 static struct my_type my_devs[] = { 93 {MYSONVENDORID, MTD800ID, "Myson MTD80X Based Fast Ethernet Card"}, 94 {MYSONVENDORID, MTD803ID, "Myson MTD80X Based Fast Ethernet Card"}, 95 {MYSONVENDORID, MTD891ID, "Myson MTD89X Based Giga Ethernet Card"}, 96 {0, 0, NULL} 97 }; 98 99 /* 100 * Various supported PHY vendors/types and their names. Note that this driver 101 * will work with pretty much any MII-compliant PHY, so failure to positively 102 * identify the chip is not a fatal error. 103 */ 104 static struct my_type my_phys[] = { 105 {MysonPHYID0, MysonPHYID0, "<MYSON MTD981>"}, 106 {SeeqPHYID0, SeeqPHYID0, "<SEEQ 80225>"}, 107 {AhdocPHYID0, AhdocPHYID0, "<AHDOC 101>"}, 108 {MarvellPHYID0, MarvellPHYID0, "<MARVELL 88E1000>"}, 109 {LevelOnePHYID0, LevelOnePHYID0, "<LevelOne LXT1000>"}, 110 {0, 0, "<MII-compliant physical interface>"} 111 }; 112 113 static int my_probe(device_t); 114 static int my_attach(device_t); 115 static int my_detach(device_t); 116 static int my_newbuf(struct my_softc *, struct my_chain_onefrag *); 117 static int my_encap(struct my_softc *, struct my_chain *, struct mbuf *); 118 static void my_rxeof(struct my_softc *); 119 static void my_txeof(struct my_softc *); 120 static void my_txeoc(struct my_softc *); 121 static void my_intr(void *); 122 static void my_start(struct ifnet *); 123 static void my_start_locked(struct ifnet *); 124 static int my_ioctl(struct ifnet *, u_long, caddr_t); 125 static void my_init(void *); 126 static void my_init_locked(struct my_softc *); 127 static void my_stop(struct my_softc *); 128 static void my_autoneg_timeout(void *); 129 static void my_watchdog(void *); 130 static int my_shutdown(device_t); 131 static int my_ifmedia_upd(struct ifnet *); 132 static void my_ifmedia_sts(struct ifnet *, struct ifmediareq *); 133 static u_int16_t my_phy_readreg(struct my_softc *, int); 134 static void my_phy_writereg(struct my_softc *, int, int); 135 static void my_autoneg_xmit(struct my_softc *); 136 static void my_autoneg_mii(struct my_softc *, int, int); 137 static void my_setmode_mii(struct my_softc *, int); 138 static void my_getmode_mii(struct my_softc *); 139 static void my_setcfg(struct my_softc *, int); 140 static void my_setmulti(struct my_softc *); 141 static void my_reset(struct my_softc *); 142 static int my_list_rx_init(struct my_softc *); 143 static int my_list_tx_init(struct my_softc *); 144 static long my_send_cmd_to_phy(struct my_softc *, int, int); 145 146 #define MY_SETBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) | (x)) 147 #define MY_CLRBIT(sc, reg, x) CSR_WRITE_4(sc, reg, CSR_READ_4(sc, reg) & ~(x)) 148 149 static device_method_t my_methods[] = { 150 /* Device interface */ 151 DEVMETHOD(device_probe, my_probe), 152 DEVMETHOD(device_attach, my_attach), 153 DEVMETHOD(device_detach, my_detach), 154 DEVMETHOD(device_shutdown, my_shutdown), 155 156 {0, 0} 157 }; 158 159 static driver_t my_driver = { 160 "my", 161 my_methods, 162 sizeof(struct my_softc) 163 }; 164 165 static devclass_t my_devclass; 166 167 DRIVER_MODULE(my, pci, my_driver, my_devclass, 0, 0); 168 MODULE_DEPEND(my, pci, 1, 1, 1); 169 MODULE_DEPEND(my, ether, 1, 1, 1); 170 171 static long 172 my_send_cmd_to_phy(struct my_softc * sc, int opcode, int regad) 173 { 174 long miir; 175 int i; 176 int mask, data; 177 178 MY_LOCK_ASSERT(sc); 179 180 /* enable MII output */ 181 miir = CSR_READ_4(sc, MY_MANAGEMENT); 182 miir &= 0xfffffff0; 183 184 miir |= MY_MASK_MIIR_MII_WRITE + MY_MASK_MIIR_MII_MDO; 185 186 /* send 32 1's preamble */ 187 for (i = 0; i < 32; i++) { 188 /* low MDC; MDO is already high (miir) */ 189 miir &= ~MY_MASK_MIIR_MII_MDC; 190 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 191 192 /* high MDC */ 193 miir |= MY_MASK_MIIR_MII_MDC; 194 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 195 } 196 197 /* calculate ST+OP+PHYAD+REGAD+TA */ 198 data = opcode | (sc->my_phy_addr << 7) | (regad << 2); 199 200 /* sent out */ 201 mask = 0x8000; 202 while (mask) { 203 /* low MDC, prepare MDO */ 204 miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 205 if (mask & data) 206 miir |= MY_MASK_MIIR_MII_MDO; 207 208 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 209 /* high MDC */ 210 miir |= MY_MASK_MIIR_MII_MDC; 211 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 212 DELAY(30); 213 214 /* next */ 215 mask >>= 1; 216 if (mask == 0x2 && opcode == MY_OP_READ) 217 miir &= ~MY_MASK_MIIR_MII_WRITE; 218 } 219 220 return miir; 221 } 222 223 224 static u_int16_t 225 my_phy_readreg(struct my_softc * sc, int reg) 226 { 227 long miir; 228 int mask, data; 229 230 MY_LOCK_ASSERT(sc); 231 232 if (sc->my_info->my_did == MTD803ID) 233 data = CSR_READ_2(sc, MY_PHYBASE + reg * 2); 234 else { 235 miir = my_send_cmd_to_phy(sc, MY_OP_READ, reg); 236 237 /* read data */ 238 mask = 0x8000; 239 data = 0; 240 while (mask) { 241 /* low MDC */ 242 miir &= ~MY_MASK_MIIR_MII_MDC; 243 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 244 245 /* read MDI */ 246 miir = CSR_READ_4(sc, MY_MANAGEMENT); 247 if (miir & MY_MASK_MIIR_MII_MDI) 248 data |= mask; 249 250 /* high MDC, and wait */ 251 miir |= MY_MASK_MIIR_MII_MDC; 252 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 253 DELAY(30); 254 255 /* next */ 256 mask >>= 1; 257 } 258 259 /* low MDC */ 260 miir &= ~MY_MASK_MIIR_MII_MDC; 261 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 262 } 263 264 return (u_int16_t) data; 265 } 266 267 268 static void 269 my_phy_writereg(struct my_softc * sc, int reg, int data) 270 { 271 long miir; 272 int mask; 273 274 MY_LOCK_ASSERT(sc); 275 276 if (sc->my_info->my_did == MTD803ID) 277 CSR_WRITE_2(sc, MY_PHYBASE + reg * 2, data); 278 else { 279 miir = my_send_cmd_to_phy(sc, MY_OP_WRITE, reg); 280 281 /* write data */ 282 mask = 0x8000; 283 while (mask) { 284 /* low MDC, prepare MDO */ 285 miir &= ~(MY_MASK_MIIR_MII_MDC + MY_MASK_MIIR_MII_MDO); 286 if (mask & data) 287 miir |= MY_MASK_MIIR_MII_MDO; 288 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 289 DELAY(1); 290 291 /* high MDC */ 292 miir |= MY_MASK_MIIR_MII_MDC; 293 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 294 DELAY(1); 295 296 /* next */ 297 mask >>= 1; 298 } 299 300 /* low MDC */ 301 miir &= ~MY_MASK_MIIR_MII_MDC; 302 CSR_WRITE_4(sc, MY_MANAGEMENT, miir); 303 } 304 return; 305 } 306 307 308 /* 309 * Program the 64-bit multicast hash filter. 310 */ 311 static void 312 my_setmulti(struct my_softc * sc) 313 { 314 struct ifnet *ifp; 315 int h = 0; 316 u_int32_t hashes[2] = {0, 0}; 317 struct ifmultiaddr *ifma; 318 u_int32_t rxfilt; 319 int mcnt = 0; 320 321 MY_LOCK_ASSERT(sc); 322 323 ifp = sc->my_ifp; 324 325 rxfilt = CSR_READ_4(sc, MY_TCRRCR); 326 327 if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 328 rxfilt |= MY_AM; 329 CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 330 CSR_WRITE_4(sc, MY_MAR0, 0xFFFFFFFF); 331 CSR_WRITE_4(sc, MY_MAR1, 0xFFFFFFFF); 332 333 return; 334 } 335 /* first, zot all the existing hash bits */ 336 CSR_WRITE_4(sc, MY_MAR0, 0); 337 CSR_WRITE_4(sc, MY_MAR1, 0); 338 339 /* now program new ones */ 340 if_maddr_rlock(ifp); 341 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 342 if (ifma->ifma_addr->sa_family != AF_LINK) 343 continue; 344 h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 345 ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 346 if (h < 32) 347 hashes[0] |= (1 << h); 348 else 349 hashes[1] |= (1 << (h - 32)); 350 mcnt++; 351 } 352 if_maddr_runlock(ifp); 353 354 if (mcnt) 355 rxfilt |= MY_AM; 356 else 357 rxfilt &= ~MY_AM; 358 CSR_WRITE_4(sc, MY_MAR0, hashes[0]); 359 CSR_WRITE_4(sc, MY_MAR1, hashes[1]); 360 CSR_WRITE_4(sc, MY_TCRRCR, rxfilt); 361 return; 362 } 363 364 /* 365 * Initiate an autonegotiation session. 366 */ 367 static void 368 my_autoneg_xmit(struct my_softc * sc) 369 { 370 u_int16_t phy_sts = 0; 371 372 MY_LOCK_ASSERT(sc); 373 374 my_phy_writereg(sc, PHY_BMCR, PHY_BMCR_RESET); 375 DELAY(500); 376 while (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_RESET); 377 378 phy_sts = my_phy_readreg(sc, PHY_BMCR); 379 phy_sts |= PHY_BMCR_AUTONEGENBL | PHY_BMCR_AUTONEGRSTR; 380 my_phy_writereg(sc, PHY_BMCR, phy_sts); 381 382 return; 383 } 384 385 static void 386 my_autoneg_timeout(void *arg) 387 { 388 struct my_softc *sc; 389 390 sc = arg; 391 MY_LOCK_ASSERT(sc); 392 my_autoneg_mii(sc, MY_FLAG_DELAYTIMEO, 1); 393 } 394 395 /* 396 * Invoke autonegotiation on a PHY. 397 */ 398 static void 399 my_autoneg_mii(struct my_softc * sc, int flag, int verbose) 400 { 401 u_int16_t phy_sts = 0, media, advert, ability; 402 u_int16_t ability2 = 0; 403 struct ifnet *ifp; 404 struct ifmedia *ifm; 405 406 MY_LOCK_ASSERT(sc); 407 408 ifm = &sc->ifmedia; 409 ifp = sc->my_ifp; 410 411 ifm->ifm_media = IFM_ETHER | IFM_AUTO; 412 413 #ifndef FORCE_AUTONEG_TFOUR 414 /* 415 * First, see if autoneg is supported. If not, there's no point in 416 * continuing. 417 */ 418 phy_sts = my_phy_readreg(sc, PHY_BMSR); 419 if (!(phy_sts & PHY_BMSR_CANAUTONEG)) { 420 if (verbose) 421 device_printf(sc->my_dev, 422 "autonegotiation not supported\n"); 423 ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 424 return; 425 } 426 #endif 427 switch (flag) { 428 case MY_FLAG_FORCEDELAY: 429 /* 430 * XXX Never use this option anywhere but in the probe 431 * routine: making the kernel stop dead in its tracks for 432 * three whole seconds after we've gone multi-user is really 433 * bad manners. 434 */ 435 my_autoneg_xmit(sc); 436 DELAY(5000000); 437 break; 438 case MY_FLAG_SCHEDDELAY: 439 /* 440 * Wait for the transmitter to go idle before starting an 441 * autoneg session, otherwise my_start() may clobber our 442 * timeout, and we don't want to allow transmission during an 443 * autoneg session since that can screw it up. 444 */ 445 if (sc->my_cdata.my_tx_head != NULL) { 446 sc->my_want_auto = 1; 447 MY_UNLOCK(sc); 448 return; 449 } 450 my_autoneg_xmit(sc); 451 callout_reset(&sc->my_autoneg_timer, hz * 5, my_autoneg_timeout, 452 sc); 453 sc->my_autoneg = 1; 454 sc->my_want_auto = 0; 455 return; 456 case MY_FLAG_DELAYTIMEO: 457 callout_stop(&sc->my_autoneg_timer); 458 sc->my_autoneg = 0; 459 break; 460 default: 461 device_printf(sc->my_dev, "invalid autoneg flag: %d\n", flag); 462 return; 463 } 464 465 if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_AUTONEGCOMP) { 466 if (verbose) 467 device_printf(sc->my_dev, "autoneg complete, "); 468 phy_sts = my_phy_readreg(sc, PHY_BMSR); 469 } else { 470 if (verbose) 471 device_printf(sc->my_dev, "autoneg not complete, "); 472 } 473 474 media = my_phy_readreg(sc, PHY_BMCR); 475 476 /* Link is good. Report modes and set duplex mode. */ 477 if (my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT) { 478 if (verbose) 479 device_printf(sc->my_dev, "link status good. "); 480 advert = my_phy_readreg(sc, PHY_ANAR); 481 ability = my_phy_readreg(sc, PHY_LPAR); 482 if ((sc->my_pinfo->my_vid == MarvellPHYID0) || 483 (sc->my_pinfo->my_vid == LevelOnePHYID0)) { 484 ability2 = my_phy_readreg(sc, PHY_1000SR); 485 if (ability2 & PHY_1000SR_1000BTXFULL) { 486 advert = 0; 487 ability = 0; 488 /* 489 * this version did not support 1000M, 490 * ifm->ifm_media = 491 * IFM_ETHER|IFM_1000_T|IFM_FDX; 492 */ 493 ifm->ifm_media = 494 IFM_ETHER | IFM_100_TX | IFM_FDX; 495 media &= ~PHY_BMCR_SPEEDSEL; 496 media |= PHY_BMCR_1000; 497 media |= PHY_BMCR_DUPLEX; 498 printf("(full-duplex, 1000Mbps)\n"); 499 } else if (ability2 & PHY_1000SR_1000BTXHALF) { 500 advert = 0; 501 ability = 0; 502 /* 503 * this version did not support 1000M, 504 * ifm->ifm_media = IFM_ETHER|IFM_1000_T; 505 */ 506 ifm->ifm_media = IFM_ETHER | IFM_100_TX; 507 media &= ~PHY_BMCR_SPEEDSEL; 508 media &= ~PHY_BMCR_DUPLEX; 509 media |= PHY_BMCR_1000; 510 printf("(half-duplex, 1000Mbps)\n"); 511 } 512 } 513 if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) { 514 ifm->ifm_media = IFM_ETHER | IFM_100_T4; 515 media |= PHY_BMCR_SPEEDSEL; 516 media &= ~PHY_BMCR_DUPLEX; 517 printf("(100baseT4)\n"); 518 } else if (advert & PHY_ANAR_100BTXFULL && 519 ability & PHY_ANAR_100BTXFULL) { 520 ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 521 media |= PHY_BMCR_SPEEDSEL; 522 media |= PHY_BMCR_DUPLEX; 523 printf("(full-duplex, 100Mbps)\n"); 524 } else if (advert & PHY_ANAR_100BTXHALF && 525 ability & PHY_ANAR_100BTXHALF) { 526 ifm->ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 527 media |= PHY_BMCR_SPEEDSEL; 528 media &= ~PHY_BMCR_DUPLEX; 529 printf("(half-duplex, 100Mbps)\n"); 530 } else if (advert & PHY_ANAR_10BTFULL && 531 ability & PHY_ANAR_10BTFULL) { 532 ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 533 media &= ~PHY_BMCR_SPEEDSEL; 534 media |= PHY_BMCR_DUPLEX; 535 printf("(full-duplex, 10Mbps)\n"); 536 } else if (advert) { 537 ifm->ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 538 media &= ~PHY_BMCR_SPEEDSEL; 539 media &= ~PHY_BMCR_DUPLEX; 540 printf("(half-duplex, 10Mbps)\n"); 541 } 542 media &= ~PHY_BMCR_AUTONEGENBL; 543 544 /* Set ASIC's duplex mode to match the PHY. */ 545 my_phy_writereg(sc, PHY_BMCR, media); 546 my_setcfg(sc, media); 547 } else { 548 if (verbose) 549 device_printf(sc->my_dev, "no carrier\n"); 550 } 551 552 my_init_locked(sc); 553 if (sc->my_tx_pend) { 554 sc->my_autoneg = 0; 555 sc->my_tx_pend = 0; 556 my_start_locked(ifp); 557 } 558 return; 559 } 560 561 /* 562 * To get PHY ability. 563 */ 564 static void 565 my_getmode_mii(struct my_softc * sc) 566 { 567 u_int16_t bmsr; 568 struct ifnet *ifp; 569 570 MY_LOCK_ASSERT(sc); 571 ifp = sc->my_ifp; 572 bmsr = my_phy_readreg(sc, PHY_BMSR); 573 if (bootverbose) 574 device_printf(sc->my_dev, "PHY status word: %x\n", bmsr); 575 576 /* fallback */ 577 sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_HDX; 578 579 if (bmsr & PHY_BMSR_10BTHALF) { 580 if (bootverbose) 581 device_printf(sc->my_dev, 582 "10Mbps half-duplex mode supported\n"); 583 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_HDX, 584 0, NULL); 585 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T, 0, NULL); 586 } 587 if (bmsr & PHY_BMSR_10BTFULL) { 588 if (bootverbose) 589 device_printf(sc->my_dev, 590 "10Mbps full-duplex mode supported\n"); 591 592 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_10_T | IFM_FDX, 593 0, NULL); 594 sc->ifmedia.ifm_media = IFM_ETHER | IFM_10_T | IFM_FDX; 595 } 596 if (bmsr & PHY_BMSR_100BTXHALF) { 597 if (bootverbose) 598 device_printf(sc->my_dev, 599 "100Mbps half-duplex mode supported\n"); 600 ifp->if_baudrate = 100000000; 601 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX, 0, NULL); 602 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_HDX, 603 0, NULL); 604 sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_HDX; 605 } 606 if (bmsr & PHY_BMSR_100BTXFULL) { 607 if (bootverbose) 608 device_printf(sc->my_dev, 609 "100Mbps full-duplex mode supported\n"); 610 ifp->if_baudrate = 100000000; 611 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_TX | IFM_FDX, 612 0, NULL); 613 sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_TX | IFM_FDX; 614 } 615 /* Some also support 100BaseT4. */ 616 if (bmsr & PHY_BMSR_100BT4) { 617 if (bootverbose) 618 device_printf(sc->my_dev, "100baseT4 mode supported\n"); 619 ifp->if_baudrate = 100000000; 620 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_100_T4, 0, NULL); 621 sc->ifmedia.ifm_media = IFM_ETHER | IFM_100_T4; 622 #ifdef FORCE_AUTONEG_TFOUR 623 if (bootverbose) 624 device_printf(sc->my_dev, 625 "forcing on autoneg support for BT4\n"); 626 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0 NULL): 627 sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 628 #endif 629 } 630 #if 0 /* this version did not support 1000M, */ 631 if (sc->my_pinfo->my_vid == MarvellPHYID0) { 632 if (bootverbose) 633 device_printf(sc->my_dev, 634 "1000Mbps half-duplex mode supported\n"); 635 636 ifp->if_baudrate = 1000000000; 637 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T, 0, NULL); 638 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_HDX, 639 0, NULL); 640 if (bootverbose) 641 device_printf(sc->my_dev, 642 "1000Mbps full-duplex mode supported\n"); 643 ifp->if_baudrate = 1000000000; 644 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_1000_T | IFM_FDX, 645 0, NULL); 646 sc->ifmedia.ifm_media = IFM_ETHER | IFM_1000_T | IFM_FDX; 647 } 648 #endif 649 if (bmsr & PHY_BMSR_CANAUTONEG) { 650 if (bootverbose) 651 device_printf(sc->my_dev, "autoneg supported\n"); 652 ifmedia_add(&sc->ifmedia, IFM_ETHER | IFM_AUTO, 0, NULL); 653 sc->ifmedia.ifm_media = IFM_ETHER | IFM_AUTO; 654 } 655 return; 656 } 657 658 /* 659 * Set speed and duplex mode. 660 */ 661 static void 662 my_setmode_mii(struct my_softc * sc, int media) 663 { 664 u_int16_t bmcr; 665 struct ifnet *ifp; 666 667 MY_LOCK_ASSERT(sc); 668 ifp = sc->my_ifp; 669 /* 670 * If an autoneg session is in progress, stop it. 671 */ 672 if (sc->my_autoneg) { 673 device_printf(sc->my_dev, "canceling autoneg session\n"); 674 callout_stop(&sc->my_autoneg_timer); 675 sc->my_autoneg = sc->my_want_auto = 0; 676 bmcr = my_phy_readreg(sc, PHY_BMCR); 677 bmcr &= ~PHY_BMCR_AUTONEGENBL; 678 my_phy_writereg(sc, PHY_BMCR, bmcr); 679 } 680 device_printf(sc->my_dev, "selecting MII, "); 681 bmcr = my_phy_readreg(sc, PHY_BMCR); 682 bmcr &= ~(PHY_BMCR_AUTONEGENBL | PHY_BMCR_SPEEDSEL | PHY_BMCR_1000 | 683 PHY_BMCR_DUPLEX | PHY_BMCR_LOOPBK); 684 685 #if 0 /* this version did not support 1000M, */ 686 if (IFM_SUBTYPE(media) == IFM_1000_T) { 687 printf("1000Mbps/T4, half-duplex\n"); 688 bmcr &= ~PHY_BMCR_SPEEDSEL; 689 bmcr &= ~PHY_BMCR_DUPLEX; 690 bmcr |= PHY_BMCR_1000; 691 } 692 #endif 693 if (IFM_SUBTYPE(media) == IFM_100_T4) { 694 printf("100Mbps/T4, half-duplex\n"); 695 bmcr |= PHY_BMCR_SPEEDSEL; 696 bmcr &= ~PHY_BMCR_DUPLEX; 697 } 698 if (IFM_SUBTYPE(media) == IFM_100_TX) { 699 printf("100Mbps, "); 700 bmcr |= PHY_BMCR_SPEEDSEL; 701 } 702 if (IFM_SUBTYPE(media) == IFM_10_T) { 703 printf("10Mbps, "); 704 bmcr &= ~PHY_BMCR_SPEEDSEL; 705 } 706 if ((media & IFM_GMASK) == IFM_FDX) { 707 printf("full duplex\n"); 708 bmcr |= PHY_BMCR_DUPLEX; 709 } else { 710 printf("half duplex\n"); 711 bmcr &= ~PHY_BMCR_DUPLEX; 712 } 713 my_phy_writereg(sc, PHY_BMCR, bmcr); 714 my_setcfg(sc, bmcr); 715 return; 716 } 717 718 /* 719 * The Myson manual states that in order to fiddle with the 'full-duplex' and 720 * '100Mbps' bits in the netconfig register, we first have to put the 721 * transmit and/or receive logic in the idle state. 722 */ 723 static void 724 my_setcfg(struct my_softc * sc, int bmcr) 725 { 726 int i, restart = 0; 727 728 MY_LOCK_ASSERT(sc); 729 if (CSR_READ_4(sc, MY_TCRRCR) & (MY_TE | MY_RE)) { 730 restart = 1; 731 MY_CLRBIT(sc, MY_TCRRCR, (MY_TE | MY_RE)); 732 for (i = 0; i < MY_TIMEOUT; i++) { 733 DELAY(10); 734 if (!(CSR_READ_4(sc, MY_TCRRCR) & 735 (MY_TXRUN | MY_RXRUN))) 736 break; 737 } 738 if (i == MY_TIMEOUT) 739 device_printf(sc->my_dev, 740 "failed to force tx and rx to idle \n"); 741 } 742 MY_CLRBIT(sc, MY_TCRRCR, MY_PS1000); 743 MY_CLRBIT(sc, MY_TCRRCR, MY_PS10); 744 if (bmcr & PHY_BMCR_1000) 745 MY_SETBIT(sc, MY_TCRRCR, MY_PS1000); 746 else if (!(bmcr & PHY_BMCR_SPEEDSEL)) 747 MY_SETBIT(sc, MY_TCRRCR, MY_PS10); 748 if (bmcr & PHY_BMCR_DUPLEX) 749 MY_SETBIT(sc, MY_TCRRCR, MY_FD); 750 else 751 MY_CLRBIT(sc, MY_TCRRCR, MY_FD); 752 if (restart) 753 MY_SETBIT(sc, MY_TCRRCR, MY_TE | MY_RE); 754 return; 755 } 756 757 static void 758 my_reset(struct my_softc * sc) 759 { 760 register int i; 761 762 MY_LOCK_ASSERT(sc); 763 MY_SETBIT(sc, MY_BCR, MY_SWR); 764 for (i = 0; i < MY_TIMEOUT; i++) { 765 DELAY(10); 766 if (!(CSR_READ_4(sc, MY_BCR) & MY_SWR)) 767 break; 768 } 769 if (i == MY_TIMEOUT) 770 device_printf(sc->my_dev, "reset never completed!\n"); 771 772 /* Wait a little while for the chip to get its brains in order. */ 773 DELAY(1000); 774 return; 775 } 776 777 /* 778 * Probe for a Myson chip. Check the PCI vendor and device IDs against our 779 * list and return a device name if we find a match. 780 */ 781 static int 782 my_probe(device_t dev) 783 { 784 struct my_type *t; 785 786 t = my_devs; 787 while (t->my_name != NULL) { 788 if ((pci_get_vendor(dev) == t->my_vid) && 789 (pci_get_device(dev) == t->my_did)) { 790 device_set_desc(dev, t->my_name); 791 my_info_tmp = t; 792 return (BUS_PROBE_DEFAULT); 793 } 794 t++; 795 } 796 return (ENXIO); 797 } 798 799 /* 800 * Attach the interface. Allocate softc structures, do ifmedia setup and 801 * ethernet/BPF attach. 802 */ 803 static int 804 my_attach(device_t dev) 805 { 806 int i; 807 u_char eaddr[ETHER_ADDR_LEN]; 808 u_int32_t iobase; 809 struct my_softc *sc; 810 struct ifnet *ifp; 811 int media = IFM_ETHER | IFM_100_TX | IFM_FDX; 812 unsigned int round; 813 caddr_t roundptr; 814 struct my_type *p; 815 u_int16_t phy_vid, phy_did, phy_sts = 0; 816 int rid, error = 0; 817 818 sc = device_get_softc(dev); 819 sc->my_dev = dev; 820 mtx_init(&sc->my_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 821 MTX_DEF); 822 callout_init_mtx(&sc->my_autoneg_timer, &sc->my_mtx, 0); 823 callout_init_mtx(&sc->my_watchdog, &sc->my_mtx, 0); 824 825 /* 826 * Map control/status registers. 827 */ 828 pci_enable_busmaster(dev); 829 830 if (my_info_tmp->my_did == MTD800ID) { 831 iobase = pci_read_config(dev, MY_PCI_LOIO, 4); 832 if (iobase & 0x300) 833 MY_USEIOSPACE = 0; 834 } 835 836 rid = MY_RID; 837 sc->my_res = bus_alloc_resource_any(dev, MY_RES, &rid, RF_ACTIVE); 838 839 if (sc->my_res == NULL) { 840 device_printf(dev, "couldn't map ports/memory\n"); 841 error = ENXIO; 842 goto destroy_mutex; 843 } 844 sc->my_btag = rman_get_bustag(sc->my_res); 845 sc->my_bhandle = rman_get_bushandle(sc->my_res); 846 847 rid = 0; 848 sc->my_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 849 RF_SHAREABLE | RF_ACTIVE); 850 851 if (sc->my_irq == NULL) { 852 device_printf(dev, "couldn't map interrupt\n"); 853 error = ENXIO; 854 goto release_io; 855 } 856 857 sc->my_info = my_info_tmp; 858 859 /* Reset the adapter. */ 860 MY_LOCK(sc); 861 my_reset(sc); 862 MY_UNLOCK(sc); 863 864 /* 865 * Get station address 866 */ 867 for (i = 0; i < ETHER_ADDR_LEN; ++i) 868 eaddr[i] = CSR_READ_1(sc, MY_PAR0 + i); 869 870 sc->my_ldata_ptr = malloc(sizeof(struct my_list_data) + 8, 871 M_DEVBUF, M_NOWAIT); 872 if (sc->my_ldata_ptr == NULL) { 873 device_printf(dev, "no memory for list buffers!\n"); 874 error = ENXIO; 875 goto release_irq; 876 } 877 sc->my_ldata = (struct my_list_data *) sc->my_ldata_ptr; 878 round = (uintptr_t)sc->my_ldata_ptr & 0xF; 879 roundptr = sc->my_ldata_ptr; 880 for (i = 0; i < 8; i++) { 881 if (round % 8) { 882 round++; 883 roundptr++; 884 } else 885 break; 886 } 887 sc->my_ldata = (struct my_list_data *) roundptr; 888 bzero(sc->my_ldata, sizeof(struct my_list_data)); 889 890 ifp = sc->my_ifp = if_alloc(IFT_ETHER); 891 if (ifp == NULL) { 892 device_printf(dev, "can not if_alloc()\n"); 893 error = ENOSPC; 894 goto free_ldata; 895 } 896 ifp->if_softc = sc; 897 if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 898 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 899 ifp->if_ioctl = my_ioctl; 900 ifp->if_start = my_start; 901 ifp->if_init = my_init; 902 ifp->if_baudrate = 10000000; 903 IFQ_SET_MAXLEN(&ifp->if_snd, ifqmaxlen); 904 ifp->if_snd.ifq_drv_maxlen = ifqmaxlen; 905 IFQ_SET_READY(&ifp->if_snd); 906 907 if (sc->my_info->my_did == MTD803ID) 908 sc->my_pinfo = my_phys; 909 else { 910 if (bootverbose) 911 device_printf(dev, "probing for a PHY\n"); 912 MY_LOCK(sc); 913 for (i = MY_PHYADDR_MIN; i < MY_PHYADDR_MAX + 1; i++) { 914 if (bootverbose) 915 device_printf(dev, "checking address: %d\n", i); 916 sc->my_phy_addr = i; 917 phy_sts = my_phy_readreg(sc, PHY_BMSR); 918 if ((phy_sts != 0) && (phy_sts != 0xffff)) 919 break; 920 else 921 phy_sts = 0; 922 } 923 if (phy_sts) { 924 phy_vid = my_phy_readreg(sc, PHY_VENID); 925 phy_did = my_phy_readreg(sc, PHY_DEVID); 926 if (bootverbose) { 927 device_printf(dev, "found PHY at address %d, ", 928 sc->my_phy_addr); 929 printf("vendor id: %x device id: %x\n", 930 phy_vid, phy_did); 931 } 932 p = my_phys; 933 while (p->my_vid) { 934 if (phy_vid == p->my_vid) { 935 sc->my_pinfo = p; 936 break; 937 } 938 p++; 939 } 940 if (sc->my_pinfo == NULL) 941 sc->my_pinfo = &my_phys[PHY_UNKNOWN]; 942 if (bootverbose) 943 device_printf(dev, "PHY type: %s\n", 944 sc->my_pinfo->my_name); 945 } else { 946 MY_UNLOCK(sc); 947 device_printf(dev, "MII without any phy!\n"); 948 error = ENXIO; 949 goto free_if; 950 } 951 MY_UNLOCK(sc); 952 } 953 954 /* Do ifmedia setup. */ 955 ifmedia_init(&sc->ifmedia, 0, my_ifmedia_upd, my_ifmedia_sts); 956 MY_LOCK(sc); 957 my_getmode_mii(sc); 958 my_autoneg_mii(sc, MY_FLAG_FORCEDELAY, 1); 959 media = sc->ifmedia.ifm_media; 960 my_stop(sc); 961 MY_UNLOCK(sc); 962 ifmedia_set(&sc->ifmedia, media); 963 964 ether_ifattach(ifp, eaddr); 965 966 error = bus_setup_intr(dev, sc->my_irq, INTR_TYPE_NET | INTR_MPSAFE, 967 NULL, my_intr, sc, &sc->my_intrhand); 968 969 if (error) { 970 device_printf(dev, "couldn't set up irq\n"); 971 goto detach_if; 972 } 973 974 return (0); 975 976 detach_if: 977 ether_ifdetach(ifp); 978 free_if: 979 if_free(ifp); 980 free_ldata: 981 free(sc->my_ldata_ptr, M_DEVBUF); 982 release_irq: 983 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 984 release_io: 985 bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 986 destroy_mutex: 987 mtx_destroy(&sc->my_mtx); 988 return (error); 989 } 990 991 static int 992 my_detach(device_t dev) 993 { 994 struct my_softc *sc; 995 struct ifnet *ifp; 996 997 sc = device_get_softc(dev); 998 ifp = sc->my_ifp; 999 ether_ifdetach(ifp); 1000 MY_LOCK(sc); 1001 my_stop(sc); 1002 MY_UNLOCK(sc); 1003 bus_teardown_intr(dev, sc->my_irq, sc->my_intrhand); 1004 callout_drain(&sc->my_watchdog); 1005 callout_drain(&sc->my_autoneg_timer); 1006 1007 if_free(ifp); 1008 free(sc->my_ldata_ptr, M_DEVBUF); 1009 1010 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->my_irq); 1011 bus_release_resource(dev, MY_RES, MY_RID, sc->my_res); 1012 mtx_destroy(&sc->my_mtx); 1013 return (0); 1014 } 1015 1016 1017 /* 1018 * Initialize the transmit descriptors. 1019 */ 1020 static int 1021 my_list_tx_init(struct my_softc * sc) 1022 { 1023 struct my_chain_data *cd; 1024 struct my_list_data *ld; 1025 int i; 1026 1027 MY_LOCK_ASSERT(sc); 1028 cd = &sc->my_cdata; 1029 ld = sc->my_ldata; 1030 for (i = 0; i < MY_TX_LIST_CNT; i++) { 1031 cd->my_tx_chain[i].my_ptr = &ld->my_tx_list[i]; 1032 if (i == (MY_TX_LIST_CNT - 1)) 1033 cd->my_tx_chain[i].my_nextdesc = &cd->my_tx_chain[0]; 1034 else 1035 cd->my_tx_chain[i].my_nextdesc = 1036 &cd->my_tx_chain[i + 1]; 1037 } 1038 cd->my_tx_free = &cd->my_tx_chain[0]; 1039 cd->my_tx_tail = cd->my_tx_head = NULL; 1040 return (0); 1041 } 1042 1043 /* 1044 * Initialize the RX descriptors and allocate mbufs for them. Note that we 1045 * arrange the descriptors in a closed ring, so that the last descriptor 1046 * points back to the first. 1047 */ 1048 static int 1049 my_list_rx_init(struct my_softc * sc) 1050 { 1051 struct my_chain_data *cd; 1052 struct my_list_data *ld; 1053 int i; 1054 1055 MY_LOCK_ASSERT(sc); 1056 cd = &sc->my_cdata; 1057 ld = sc->my_ldata; 1058 for (i = 0; i < MY_RX_LIST_CNT; i++) { 1059 cd->my_rx_chain[i].my_ptr = 1060 (struct my_desc *) & ld->my_rx_list[i]; 1061 if (my_newbuf(sc, &cd->my_rx_chain[i]) == ENOBUFS) { 1062 MY_UNLOCK(sc); 1063 return (ENOBUFS); 1064 } 1065 if (i == (MY_RX_LIST_CNT - 1)) { 1066 cd->my_rx_chain[i].my_nextdesc = &cd->my_rx_chain[0]; 1067 ld->my_rx_list[i].my_next = vtophys(&ld->my_rx_list[0]); 1068 } else { 1069 cd->my_rx_chain[i].my_nextdesc = 1070 &cd->my_rx_chain[i + 1]; 1071 ld->my_rx_list[i].my_next = 1072 vtophys(&ld->my_rx_list[i + 1]); 1073 } 1074 } 1075 cd->my_rx_head = &cd->my_rx_chain[0]; 1076 return (0); 1077 } 1078 1079 /* 1080 * Initialize an RX descriptor and attach an MBUF cluster. 1081 */ 1082 static int 1083 my_newbuf(struct my_softc * sc, struct my_chain_onefrag * c) 1084 { 1085 struct mbuf *m_new = NULL; 1086 1087 MY_LOCK_ASSERT(sc); 1088 MGETHDR(m_new, M_NOWAIT, MT_DATA); 1089 if (m_new == NULL) { 1090 device_printf(sc->my_dev, 1091 "no memory for rx list -- packet dropped!\n"); 1092 return (ENOBUFS); 1093 } 1094 MCLGET(m_new, M_NOWAIT); 1095 if (!(m_new->m_flags & M_EXT)) { 1096 device_printf(sc->my_dev, 1097 "no memory for rx list -- packet dropped!\n"); 1098 m_freem(m_new); 1099 return (ENOBUFS); 1100 } 1101 c->my_mbuf = m_new; 1102 c->my_ptr->my_data = vtophys(mtod(m_new, caddr_t)); 1103 c->my_ptr->my_ctl = (MCLBYTES - 1) << MY_RBSShift; 1104 c->my_ptr->my_status = MY_OWNByNIC; 1105 return (0); 1106 } 1107 1108 /* 1109 * A frame has been uploaded: pass the resulting mbuf chain up to the higher 1110 * level protocols. 1111 */ 1112 static void 1113 my_rxeof(struct my_softc * sc) 1114 { 1115 struct ether_header *eh; 1116 struct mbuf *m; 1117 struct ifnet *ifp; 1118 struct my_chain_onefrag *cur_rx; 1119 int total_len = 0; 1120 u_int32_t rxstat; 1121 1122 MY_LOCK_ASSERT(sc); 1123 ifp = sc->my_ifp; 1124 while (!((rxstat = sc->my_cdata.my_rx_head->my_ptr->my_status) 1125 & MY_OWNByNIC)) { 1126 cur_rx = sc->my_cdata.my_rx_head; 1127 sc->my_cdata.my_rx_head = cur_rx->my_nextdesc; 1128 1129 if (rxstat & MY_ES) { /* error summary: give up this rx pkt */ 1130 ifp->if_ierrors++; 1131 cur_rx->my_ptr->my_status = MY_OWNByNIC; 1132 continue; 1133 } 1134 /* No errors; receive the packet. */ 1135 total_len = (rxstat & MY_FLNGMASK) >> MY_FLNGShift; 1136 total_len -= ETHER_CRC_LEN; 1137 1138 if (total_len < MINCLSIZE) { 1139 m = m_devget(mtod(cur_rx->my_mbuf, char *), 1140 total_len, 0, ifp, NULL); 1141 cur_rx->my_ptr->my_status = MY_OWNByNIC; 1142 if (m == NULL) { 1143 ifp->if_ierrors++; 1144 continue; 1145 } 1146 } else { 1147 m = cur_rx->my_mbuf; 1148 /* 1149 * Try to conjure up a new mbuf cluster. If that 1150 * fails, it means we have an out of memory condition 1151 * and should leave the buffer in place and continue. 1152 * This will result in a lost packet, but there's 1153 * little else we can do in this situation. 1154 */ 1155 if (my_newbuf(sc, cur_rx) == ENOBUFS) { 1156 ifp->if_ierrors++; 1157 cur_rx->my_ptr->my_status = MY_OWNByNIC; 1158 continue; 1159 } 1160 m->m_pkthdr.rcvif = ifp; 1161 m->m_pkthdr.len = m->m_len = total_len; 1162 } 1163 ifp->if_ipackets++; 1164 eh = mtod(m, struct ether_header *); 1165 #if NBPFILTER > 0 1166 /* 1167 * Handle BPF listeners. Let the BPF user see the packet, but 1168 * don't pass it up to the ether_input() layer unless it's a 1169 * broadcast packet, multicast packet, matches our ethernet 1170 * address or the interface is in promiscuous mode. 1171 */ 1172 if (bpf_peers_present(ifp->if_bpf)) { 1173 bpf_mtap(ifp->if_bpf, m); 1174 if (ifp->if_flags & IFF_PROMISC && 1175 (bcmp(eh->ether_dhost, IF_LLADDR(sc->my_ifp), 1176 ETHER_ADDR_LEN) && 1177 (eh->ether_dhost[0] & 1) == 0)) { 1178 m_freem(m); 1179 continue; 1180 } 1181 } 1182 #endif 1183 MY_UNLOCK(sc); 1184 (*ifp->if_input)(ifp, m); 1185 MY_LOCK(sc); 1186 } 1187 return; 1188 } 1189 1190 1191 /* 1192 * A frame was downloaded to the chip. It's safe for us to clean up the list 1193 * buffers. 1194 */ 1195 static void 1196 my_txeof(struct my_softc * sc) 1197 { 1198 struct my_chain *cur_tx; 1199 struct ifnet *ifp; 1200 1201 MY_LOCK_ASSERT(sc); 1202 ifp = sc->my_ifp; 1203 /* Clear the timeout timer. */ 1204 sc->my_timer = 0; 1205 if (sc->my_cdata.my_tx_head == NULL) { 1206 return; 1207 } 1208 /* 1209 * Go through our tx list and free mbufs for those frames that have 1210 * been transmitted. 1211 */ 1212 while (sc->my_cdata.my_tx_head->my_mbuf != NULL) { 1213 u_int32_t txstat; 1214 1215 cur_tx = sc->my_cdata.my_tx_head; 1216 txstat = MY_TXSTATUS(cur_tx); 1217 if ((txstat & MY_OWNByNIC) || txstat == MY_UNSENT) 1218 break; 1219 if (!(CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced)) { 1220 if (txstat & MY_TXERR) { 1221 ifp->if_oerrors++; 1222 if (txstat & MY_EC) /* excessive collision */ 1223 ifp->if_collisions++; 1224 if (txstat & MY_LC) /* late collision */ 1225 ifp->if_collisions++; 1226 } 1227 ifp->if_collisions += (txstat & MY_NCRMASK) >> 1228 MY_NCRShift; 1229 } 1230 ifp->if_opackets++; 1231 m_freem(cur_tx->my_mbuf); 1232 cur_tx->my_mbuf = NULL; 1233 if (sc->my_cdata.my_tx_head == sc->my_cdata.my_tx_tail) { 1234 sc->my_cdata.my_tx_head = NULL; 1235 sc->my_cdata.my_tx_tail = NULL; 1236 break; 1237 } 1238 sc->my_cdata.my_tx_head = cur_tx->my_nextdesc; 1239 } 1240 if (CSR_READ_4(sc, MY_TCRRCR) & MY_Enhanced) { 1241 ifp->if_collisions += (CSR_READ_4(sc, MY_TSR) & MY_NCRMask); 1242 } 1243 return; 1244 } 1245 1246 /* 1247 * TX 'end of channel' interrupt handler. 1248 */ 1249 static void 1250 my_txeoc(struct my_softc * sc) 1251 { 1252 struct ifnet *ifp; 1253 1254 MY_LOCK_ASSERT(sc); 1255 ifp = sc->my_ifp; 1256 sc->my_timer = 0; 1257 if (sc->my_cdata.my_tx_head == NULL) { 1258 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1259 sc->my_cdata.my_tx_tail = NULL; 1260 if (sc->my_want_auto) 1261 my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 1262 } else { 1263 if (MY_TXOWN(sc->my_cdata.my_tx_head) == MY_UNSENT) { 1264 MY_TXOWN(sc->my_cdata.my_tx_head) = MY_OWNByNIC; 1265 sc->my_timer = 5; 1266 CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); 1267 } 1268 } 1269 return; 1270 } 1271 1272 static void 1273 my_intr(void *arg) 1274 { 1275 struct my_softc *sc; 1276 struct ifnet *ifp; 1277 u_int32_t status; 1278 1279 sc = arg; 1280 MY_LOCK(sc); 1281 ifp = sc->my_ifp; 1282 if (!(ifp->if_flags & IFF_UP)) { 1283 MY_UNLOCK(sc); 1284 return; 1285 } 1286 /* Disable interrupts. */ 1287 CSR_WRITE_4(sc, MY_IMR, 0x00000000); 1288 1289 for (;;) { 1290 status = CSR_READ_4(sc, MY_ISR); 1291 status &= MY_INTRS; 1292 if (status) 1293 CSR_WRITE_4(sc, MY_ISR, status); 1294 else 1295 break; 1296 1297 if (status & MY_RI) /* receive interrupt */ 1298 my_rxeof(sc); 1299 1300 if ((status & MY_RBU) || (status & MY_RxErr)) { 1301 /* rx buffer unavailable or rx error */ 1302 ifp->if_ierrors++; 1303 #ifdef foo 1304 my_stop(sc); 1305 my_reset(sc); 1306 my_init_locked(sc); 1307 #endif 1308 } 1309 if (status & MY_TI) /* tx interrupt */ 1310 my_txeof(sc); 1311 if (status & MY_ETI) /* tx early interrupt */ 1312 my_txeof(sc); 1313 if (status & MY_TBU) /* tx buffer unavailable */ 1314 my_txeoc(sc); 1315 1316 #if 0 /* 90/1/18 delete */ 1317 if (status & MY_FBE) { 1318 my_reset(sc); 1319 my_init_locked(sc); 1320 } 1321 #endif 1322 1323 } 1324 1325 /* Re-enable interrupts. */ 1326 CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 1327 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1328 my_start_locked(ifp); 1329 MY_UNLOCK(sc); 1330 return; 1331 } 1332 1333 /* 1334 * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 1335 * pointers to the fragment pointers. 1336 */ 1337 static int 1338 my_encap(struct my_softc * sc, struct my_chain * c, struct mbuf * m_head) 1339 { 1340 struct my_desc *f = NULL; 1341 int total_len; 1342 struct mbuf *m, *m_new = NULL; 1343 1344 MY_LOCK_ASSERT(sc); 1345 /* calculate the total tx pkt length */ 1346 total_len = 0; 1347 for (m = m_head; m != NULL; m = m->m_next) 1348 total_len += m->m_len; 1349 /* 1350 * Start packing the mbufs in this chain into the fragment pointers. 1351 * Stop when we run out of fragments or hit the end of the mbuf 1352 * chain. 1353 */ 1354 m = m_head; 1355 MGETHDR(m_new, M_NOWAIT, MT_DATA); 1356 if (m_new == NULL) { 1357 device_printf(sc->my_dev, "no memory for tx list"); 1358 return (1); 1359 } 1360 if (m_head->m_pkthdr.len > MHLEN) { 1361 MCLGET(m_new, M_NOWAIT); 1362 if (!(m_new->m_flags & M_EXT)) { 1363 m_freem(m_new); 1364 device_printf(sc->my_dev, "no memory for tx list"); 1365 return (1); 1366 } 1367 } 1368 m_copydata(m_head, 0, m_head->m_pkthdr.len, mtod(m_new, caddr_t)); 1369 m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 1370 m_freem(m_head); 1371 m_head = m_new; 1372 f = &c->my_ptr->my_frag[0]; 1373 f->my_status = 0; 1374 f->my_data = vtophys(mtod(m_new, caddr_t)); 1375 total_len = m_new->m_len; 1376 f->my_ctl = MY_TXFD | MY_TXLD | MY_CRCEnable | MY_PADEnable; 1377 f->my_ctl |= total_len << MY_PKTShift; /* pkt size */ 1378 f->my_ctl |= total_len; /* buffer size */ 1379 /* 89/12/29 add, for mtd891 *//* [ 89? ] */ 1380 if (sc->my_info->my_did == MTD891ID) 1381 f->my_ctl |= MY_ETIControl | MY_RetryTxLC; 1382 c->my_mbuf = m_head; 1383 c->my_lastdesc = 0; 1384 MY_TXNEXT(c) = vtophys(&c->my_nextdesc->my_ptr->my_frag[0]); 1385 return (0); 1386 } 1387 1388 /* 1389 * Main transmit routine. To avoid having to do mbuf copies, we put pointers 1390 * to the mbuf data regions directly in the transmit lists. We also save a 1391 * copy of the pointers since the transmit list fragment pointers are 1392 * physical addresses. 1393 */ 1394 static void 1395 my_start(struct ifnet * ifp) 1396 { 1397 struct my_softc *sc; 1398 1399 sc = ifp->if_softc; 1400 MY_LOCK(sc); 1401 my_start_locked(ifp); 1402 MY_UNLOCK(sc); 1403 } 1404 1405 static void 1406 my_start_locked(struct ifnet * ifp) 1407 { 1408 struct my_softc *sc; 1409 struct mbuf *m_head = NULL; 1410 struct my_chain *cur_tx = NULL, *start_tx; 1411 1412 sc = ifp->if_softc; 1413 MY_LOCK_ASSERT(sc); 1414 if (sc->my_autoneg) { 1415 sc->my_tx_pend = 1; 1416 return; 1417 } 1418 /* 1419 * Check for an available queue slot. If there are none, punt. 1420 */ 1421 if (sc->my_cdata.my_tx_free->my_mbuf != NULL) { 1422 ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1423 return; 1424 } 1425 start_tx = sc->my_cdata.my_tx_free; 1426 while (sc->my_cdata.my_tx_free->my_mbuf == NULL) { 1427 IFQ_DRV_DEQUEUE(&ifp->if_snd, m_head); 1428 if (m_head == NULL) 1429 break; 1430 1431 /* Pick a descriptor off the free list. */ 1432 cur_tx = sc->my_cdata.my_tx_free; 1433 sc->my_cdata.my_tx_free = cur_tx->my_nextdesc; 1434 1435 /* Pack the data into the descriptor. */ 1436 my_encap(sc, cur_tx, m_head); 1437 1438 if (cur_tx != start_tx) 1439 MY_TXOWN(cur_tx) = MY_OWNByNIC; 1440 #if NBPFILTER > 0 1441 /* 1442 * If there's a BPF listener, bounce a copy of this frame to 1443 * him. 1444 */ 1445 BPF_MTAP(ifp, cur_tx->my_mbuf); 1446 #endif 1447 } 1448 /* 1449 * If there are no packets queued, bail. 1450 */ 1451 if (cur_tx == NULL) { 1452 return; 1453 } 1454 /* 1455 * Place the request for the upload interrupt in the last descriptor 1456 * in the chain. This way, if we're chaining several packets at once, 1457 * we'll only get an interrupt once for the whole chain rather than 1458 * once for each packet. 1459 */ 1460 MY_TXCTL(cur_tx) |= MY_TXIC; 1461 cur_tx->my_ptr->my_frag[0].my_ctl |= MY_TXIC; 1462 sc->my_cdata.my_tx_tail = cur_tx; 1463 if (sc->my_cdata.my_tx_head == NULL) 1464 sc->my_cdata.my_tx_head = start_tx; 1465 MY_TXOWN(start_tx) = MY_OWNByNIC; 1466 CSR_WRITE_4(sc, MY_TXPDR, 0xFFFFFFFF); /* tx polling demand */ 1467 1468 /* 1469 * Set a timeout in case the chip goes out to lunch. 1470 */ 1471 sc->my_timer = 5; 1472 return; 1473 } 1474 1475 static void 1476 my_init(void *xsc) 1477 { 1478 struct my_softc *sc = xsc; 1479 1480 MY_LOCK(sc); 1481 my_init_locked(sc); 1482 MY_UNLOCK(sc); 1483 } 1484 1485 static void 1486 my_init_locked(struct my_softc *sc) 1487 { 1488 struct ifnet *ifp = sc->my_ifp; 1489 u_int16_t phy_bmcr = 0; 1490 1491 MY_LOCK_ASSERT(sc); 1492 if (sc->my_autoneg) { 1493 return; 1494 } 1495 if (sc->my_pinfo != NULL) 1496 phy_bmcr = my_phy_readreg(sc, PHY_BMCR); 1497 /* 1498 * Cancel pending I/O and free all RX/TX buffers. 1499 */ 1500 my_stop(sc); 1501 my_reset(sc); 1502 1503 /* 1504 * Set cache alignment and burst length. 1505 */ 1506 #if 0 /* 89/9/1 modify, */ 1507 CSR_WRITE_4(sc, MY_BCR, MY_RPBLE512); 1508 CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF); 1509 #endif 1510 CSR_WRITE_4(sc, MY_BCR, MY_PBL8); 1511 CSR_WRITE_4(sc, MY_TCRRCR, MY_TFTSF | MY_RBLEN | MY_RPBLE512); 1512 /* 1513 * 89/12/29 add, for mtd891, 1514 */ 1515 if (sc->my_info->my_did == MTD891ID) { 1516 MY_SETBIT(sc, MY_BCR, MY_PROG); 1517 MY_SETBIT(sc, MY_TCRRCR, MY_Enhanced); 1518 } 1519 my_setcfg(sc, phy_bmcr); 1520 /* Init circular RX list. */ 1521 if (my_list_rx_init(sc) == ENOBUFS) { 1522 device_printf(sc->my_dev, "init failed: no memory for rx buffers\n"); 1523 my_stop(sc); 1524 return; 1525 } 1526 /* Init TX descriptors. */ 1527 my_list_tx_init(sc); 1528 1529 /* If we want promiscuous mode, set the allframes bit. */ 1530 if (ifp->if_flags & IFF_PROMISC) 1531 MY_SETBIT(sc, MY_TCRRCR, MY_PROM); 1532 else 1533 MY_CLRBIT(sc, MY_TCRRCR, MY_PROM); 1534 1535 /* 1536 * Set capture broadcast bit to capture broadcast frames. 1537 */ 1538 if (ifp->if_flags & IFF_BROADCAST) 1539 MY_SETBIT(sc, MY_TCRRCR, MY_AB); 1540 else 1541 MY_CLRBIT(sc, MY_TCRRCR, MY_AB); 1542 1543 /* 1544 * Program the multicast filter, if necessary. 1545 */ 1546 my_setmulti(sc); 1547 1548 /* 1549 * Load the address of the RX list. 1550 */ 1551 MY_CLRBIT(sc, MY_TCRRCR, MY_RE); 1552 CSR_WRITE_4(sc, MY_RXLBA, vtophys(&sc->my_ldata->my_rx_list[0])); 1553 1554 /* 1555 * Enable interrupts. 1556 */ 1557 CSR_WRITE_4(sc, MY_IMR, MY_INTRS); 1558 CSR_WRITE_4(sc, MY_ISR, 0xFFFFFFFF); 1559 1560 /* Enable receiver and transmitter. */ 1561 MY_SETBIT(sc, MY_TCRRCR, MY_RE); 1562 MY_CLRBIT(sc, MY_TCRRCR, MY_TE); 1563 CSR_WRITE_4(sc, MY_TXLBA, vtophys(&sc->my_ldata->my_tx_list[0])); 1564 MY_SETBIT(sc, MY_TCRRCR, MY_TE); 1565 1566 /* Restore state of BMCR */ 1567 if (sc->my_pinfo != NULL) 1568 my_phy_writereg(sc, PHY_BMCR, phy_bmcr); 1569 ifp->if_drv_flags |= IFF_DRV_RUNNING; 1570 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1571 1572 callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 1573 return; 1574 } 1575 1576 /* 1577 * Set media options. 1578 */ 1579 1580 static int 1581 my_ifmedia_upd(struct ifnet * ifp) 1582 { 1583 struct my_softc *sc; 1584 struct ifmedia *ifm; 1585 1586 sc = ifp->if_softc; 1587 MY_LOCK(sc); 1588 ifm = &sc->ifmedia; 1589 if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER) { 1590 MY_UNLOCK(sc); 1591 return (EINVAL); 1592 } 1593 if (IFM_SUBTYPE(ifm->ifm_media) == IFM_AUTO) 1594 my_autoneg_mii(sc, MY_FLAG_SCHEDDELAY, 1); 1595 else 1596 my_setmode_mii(sc, ifm->ifm_media); 1597 MY_UNLOCK(sc); 1598 return (0); 1599 } 1600 1601 /* 1602 * Report current media status. 1603 */ 1604 1605 static void 1606 my_ifmedia_sts(struct ifnet * ifp, struct ifmediareq * ifmr) 1607 { 1608 struct my_softc *sc; 1609 u_int16_t advert = 0, ability = 0; 1610 1611 sc = ifp->if_softc; 1612 MY_LOCK(sc); 1613 ifmr->ifm_active = IFM_ETHER; 1614 if (!(my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_AUTONEGENBL)) { 1615 #if 0 /* this version did not support 1000M, */ 1616 if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_1000) 1617 ifmr->ifm_active = IFM_ETHER | IFM_1000TX; 1618 #endif 1619 if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_SPEEDSEL) 1620 ifmr->ifm_active = IFM_ETHER | IFM_100_TX; 1621 else 1622 ifmr->ifm_active = IFM_ETHER | IFM_10_T; 1623 if (my_phy_readreg(sc, PHY_BMCR) & PHY_BMCR_DUPLEX) 1624 ifmr->ifm_active |= IFM_FDX; 1625 else 1626 ifmr->ifm_active |= IFM_HDX; 1627 1628 MY_UNLOCK(sc); 1629 return; 1630 } 1631 ability = my_phy_readreg(sc, PHY_LPAR); 1632 advert = my_phy_readreg(sc, PHY_ANAR); 1633 1634 #if 0 /* this version did not support 1000M, */ 1635 if (sc->my_pinfo->my_vid = MarvellPHYID0) { 1636 ability2 = my_phy_readreg(sc, PHY_1000SR); 1637 if (ability2 & PHY_1000SR_1000BTXFULL) { 1638 advert = 0; 1639 ability = 0; 1640 ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_FDX; 1641 } else if (ability & PHY_1000SR_1000BTXHALF) { 1642 advert = 0; 1643 ability = 0; 1644 ifmr->ifm_active = IFM_ETHER|IFM_1000_T|IFM_HDX; 1645 } 1646 } 1647 #endif 1648 if (advert & PHY_ANAR_100BT4 && ability & PHY_ANAR_100BT4) 1649 ifmr->ifm_active = IFM_ETHER | IFM_100_T4; 1650 else if (advert & PHY_ANAR_100BTXFULL && ability & PHY_ANAR_100BTXFULL) 1651 ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_FDX; 1652 else if (advert & PHY_ANAR_100BTXHALF && ability & PHY_ANAR_100BTXHALF) 1653 ifmr->ifm_active = IFM_ETHER | IFM_100_TX | IFM_HDX; 1654 else if (advert & PHY_ANAR_10BTFULL && ability & PHY_ANAR_10BTFULL) 1655 ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_FDX; 1656 else if (advert & PHY_ANAR_10BTHALF && ability & PHY_ANAR_10BTHALF) 1657 ifmr->ifm_active = IFM_ETHER | IFM_10_T | IFM_HDX; 1658 MY_UNLOCK(sc); 1659 return; 1660 } 1661 1662 static int 1663 my_ioctl(struct ifnet * ifp, u_long command, caddr_t data) 1664 { 1665 struct my_softc *sc = ifp->if_softc; 1666 struct ifreq *ifr = (struct ifreq *) data; 1667 int error; 1668 1669 switch (command) { 1670 case SIOCSIFFLAGS: 1671 MY_LOCK(sc); 1672 if (ifp->if_flags & IFF_UP) 1673 my_init_locked(sc); 1674 else if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1675 my_stop(sc); 1676 MY_UNLOCK(sc); 1677 error = 0; 1678 break; 1679 case SIOCADDMULTI: 1680 case SIOCDELMULTI: 1681 MY_LOCK(sc); 1682 my_setmulti(sc); 1683 MY_UNLOCK(sc); 1684 error = 0; 1685 break; 1686 case SIOCGIFMEDIA: 1687 case SIOCSIFMEDIA: 1688 error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command); 1689 break; 1690 default: 1691 error = ether_ioctl(ifp, command, data); 1692 break; 1693 } 1694 return (error); 1695 } 1696 1697 static void 1698 my_watchdog(void *arg) 1699 { 1700 struct my_softc *sc; 1701 struct ifnet *ifp; 1702 1703 sc = arg; 1704 MY_LOCK_ASSERT(sc); 1705 callout_reset(&sc->my_watchdog, hz, my_watchdog, sc); 1706 if (sc->my_timer == 0 || --sc->my_timer > 0) 1707 return; 1708 1709 ifp = sc->my_ifp; 1710 ifp->if_oerrors++; 1711 if_printf(ifp, "watchdog timeout\n"); 1712 if (!(my_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 1713 if_printf(ifp, "no carrier - transceiver cable problem?\n"); 1714 my_stop(sc); 1715 my_reset(sc); 1716 my_init_locked(sc); 1717 if (!IFQ_DRV_IS_EMPTY(&ifp->if_snd)) 1718 my_start_locked(ifp); 1719 } 1720 1721 1722 /* 1723 * Stop the adapter and free any mbufs allocated to the RX and TX lists. 1724 */ 1725 static void 1726 my_stop(struct my_softc * sc) 1727 { 1728 register int i; 1729 struct ifnet *ifp; 1730 1731 MY_LOCK_ASSERT(sc); 1732 ifp = sc->my_ifp; 1733 1734 callout_stop(&sc->my_autoneg_timer); 1735 callout_stop(&sc->my_watchdog); 1736 1737 MY_CLRBIT(sc, MY_TCRRCR, (MY_RE | MY_TE)); 1738 CSR_WRITE_4(sc, MY_IMR, 0x00000000); 1739 CSR_WRITE_4(sc, MY_TXLBA, 0x00000000); 1740 CSR_WRITE_4(sc, MY_RXLBA, 0x00000000); 1741 1742 /* 1743 * Free data in the RX lists. 1744 */ 1745 for (i = 0; i < MY_RX_LIST_CNT; i++) { 1746 if (sc->my_cdata.my_rx_chain[i].my_mbuf != NULL) { 1747 m_freem(sc->my_cdata.my_rx_chain[i].my_mbuf); 1748 sc->my_cdata.my_rx_chain[i].my_mbuf = NULL; 1749 } 1750 } 1751 bzero((char *)&sc->my_ldata->my_rx_list, 1752 sizeof(sc->my_ldata->my_rx_list)); 1753 /* 1754 * Free the TX list buffers. 1755 */ 1756 for (i = 0; i < MY_TX_LIST_CNT; i++) { 1757 if (sc->my_cdata.my_tx_chain[i].my_mbuf != NULL) { 1758 m_freem(sc->my_cdata.my_tx_chain[i].my_mbuf); 1759 sc->my_cdata.my_tx_chain[i].my_mbuf = NULL; 1760 } 1761 } 1762 bzero((char *)&sc->my_ldata->my_tx_list, 1763 sizeof(sc->my_ldata->my_tx_list)); 1764 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 1765 return; 1766 } 1767 1768 /* 1769 * Stop all chip I/O so that the kernel's probe routines don't get confused 1770 * by errant DMAs when rebooting. 1771 */ 1772 static int 1773 my_shutdown(device_t dev) 1774 { 1775 struct my_softc *sc; 1776 1777 sc = device_get_softc(dev); 1778 MY_LOCK(sc); 1779 my_stop(sc); 1780 MY_UNLOCK(sc); 1781 return 0; 1782 } 1783