if_wb.c revision 213894
1/*- 2 * Copyright (c) 1997, 1998 3 * Bill Paul <wpaul@ctr.columbia.edu>. All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. All advertising materials mentioning features or use of this software 14 * must display the following acknowledgement: 15 * This product includes software developed by Bill Paul. 16 * 4. Neither the name of the author nor the names of any co-contributors 17 * may be used to endorse or promote products derived from this software 18 * without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD 24 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 25 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 26 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 27 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF 30 * THE POSSIBILITY OF SUCH DAMAGE. 31 */ 32 33#include <sys/cdefs.h> 34__FBSDID("$FreeBSD: head/sys/dev/wb/if_wb.c 213894 2010-10-15 15:00:30Z marius $"); 35 36/* 37 * Winbond fast ethernet PCI NIC driver 38 * 39 * Supports various cheap network adapters based on the Winbond W89C840F 40 * fast ethernet controller chip. This includes adapters manufactured by 41 * Winbond itself and some made by Linksys. 42 * 43 * Written by Bill Paul <wpaul@ctr.columbia.edu> 44 * Electrical Engineering Department 45 * Columbia University, New York City 46 */ 47/* 48 * The Winbond W89C840F chip is a bus master; in some ways it resembles 49 * a DEC 'tulip' chip, only not as complicated. Unfortunately, it has 50 * one major difference which is that while the registers do many of 51 * the same things as a tulip adapter, the offsets are different: where 52 * tulip registers are typically spaced 8 bytes apart, the Winbond 53 * registers are spaced 4 bytes apart. The receiver filter is also 54 * programmed differently. 55 * 56 * Like the tulip, the Winbond chip uses small descriptors containing 57 * a status word, a control word and 32-bit areas that can either be used 58 * to point to two external data blocks, or to point to a single block 59 * and another descriptor in a linked list. Descriptors can be grouped 60 * together in blocks to form fixed length rings or can be chained 61 * together in linked lists. A single packet may be spread out over 62 * several descriptors if necessary. 63 * 64 * For the receive ring, this driver uses a linked list of descriptors, 65 * each pointing to a single mbuf cluster buffer, which us large enough 66 * to hold an entire packet. The link list is looped back to created a 67 * closed ring. 68 * 69 * For transmission, the driver creates a linked list of 'super descriptors' 70 * which each contain several individual descriptors linked toghether. 71 * Each 'super descriptor' contains WB_MAXFRAGS descriptors, which we 72 * abuse as fragment pointers. This allows us to use a buffer managment 73 * scheme very similar to that used in the ThunderLAN and Etherlink XL 74 * drivers. 75 * 76 * Autonegotiation is performed using the external PHY via the MII bus. 77 * The sample boards I have all use a Davicom PHY. 78 * 79 * Note: the author of the Linux driver for the Winbond chip alludes 80 * to some sort of flaw in the chip's design that seems to mandate some 81 * drastic workaround which signigicantly impairs transmit performance. 82 * I have no idea what he's on about: transmit performance with all 83 * three of my test boards seems fine. 84 */ 85 86#include <sys/param.h> 87#include <sys/systm.h> 88#include <sys/sockio.h> 89#include <sys/mbuf.h> 90#include <sys/malloc.h> 91#include <sys/module.h> 92#include <sys/kernel.h> 93#include <sys/socket.h> 94#include <sys/queue.h> 95 96#include <net/if.h> 97#include <net/if_arp.h> 98#include <net/ethernet.h> 99#include <net/if_dl.h> 100#include <net/if_media.h> 101#include <net/if_types.h> 102 103#include <net/bpf.h> 104 105#include <vm/vm.h> /* for vtophys */ 106#include <vm/pmap.h> /* for vtophys */ 107#include <machine/bus.h> 108#include <machine/resource.h> 109#include <sys/bus.h> 110#include <sys/rman.h> 111 112#include <dev/pci/pcireg.h> 113#include <dev/pci/pcivar.h> 114 115#include <dev/mii/mii.h> 116#include <dev/mii/miivar.h> 117 118/* "device miibus" required. See GENERIC if you get errors here. */ 119#include "miibus_if.h" 120 121#define WB_USEIOSPACE 122 123#include <dev/wb/if_wbreg.h> 124 125MODULE_DEPEND(wb, pci, 1, 1, 1); 126MODULE_DEPEND(wb, ether, 1, 1, 1); 127MODULE_DEPEND(wb, miibus, 1, 1, 1); 128 129/* 130 * Various supported device vendors/types and their names. 131 */ 132static struct wb_type wb_devs[] = { 133 { WB_VENDORID, WB_DEVICEID_840F, 134 "Winbond W89C840F 10/100BaseTX" }, 135 { CP_VENDORID, CP_DEVICEID_RL100, 136 "Compex RL100-ATX 10/100baseTX" }, 137 { 0, 0, NULL } 138}; 139 140static int wb_probe(device_t); 141static int wb_attach(device_t); 142static int wb_detach(device_t); 143 144static void wb_bfree(void *addr, void *args); 145static int wb_newbuf(struct wb_softc *, struct wb_chain_onefrag *, 146 struct mbuf *); 147static int wb_encap(struct wb_softc *, struct wb_chain *, struct mbuf *); 148 149static void wb_rxeof(struct wb_softc *); 150static void wb_rxeoc(struct wb_softc *); 151static void wb_txeof(struct wb_softc *); 152static void wb_txeoc(struct wb_softc *); 153static void wb_intr(void *); 154static void wb_tick(void *); 155static void wb_start(struct ifnet *); 156static void wb_start_locked(struct ifnet *); 157static int wb_ioctl(struct ifnet *, u_long, caddr_t); 158static void wb_init(void *); 159static void wb_init_locked(struct wb_softc *); 160static void wb_stop(struct wb_softc *); 161static void wb_watchdog(struct wb_softc *); 162static int wb_shutdown(device_t); 163static int wb_ifmedia_upd(struct ifnet *); 164static void wb_ifmedia_sts(struct ifnet *, struct ifmediareq *); 165 166static void wb_eeprom_putbyte(struct wb_softc *, int); 167static void wb_eeprom_getword(struct wb_softc *, int, u_int16_t *); 168static void wb_read_eeprom(struct wb_softc *, caddr_t, int, int, int); 169static void wb_mii_sync(struct wb_softc *); 170static void wb_mii_send(struct wb_softc *, u_int32_t, int); 171static int wb_mii_readreg(struct wb_softc *, struct wb_mii_frame *); 172static int wb_mii_writereg(struct wb_softc *, struct wb_mii_frame *); 173 174static void wb_setcfg(struct wb_softc *, u_int32_t); 175static void wb_setmulti(struct wb_softc *); 176static void wb_reset(struct wb_softc *); 177static void wb_fixmedia(struct wb_softc *); 178static int wb_list_rx_init(struct wb_softc *); 179static int wb_list_tx_init(struct wb_softc *); 180 181static int wb_miibus_readreg(device_t, int, int); 182static int wb_miibus_writereg(device_t, int, int, int); 183static void wb_miibus_statchg(device_t); 184 185#ifdef WB_USEIOSPACE 186#define WB_RES SYS_RES_IOPORT 187#define WB_RID WB_PCI_LOIO 188#else 189#define WB_RES SYS_RES_MEMORY 190#define WB_RID WB_PCI_LOMEM 191#endif 192 193static device_method_t wb_methods[] = { 194 /* Device interface */ 195 DEVMETHOD(device_probe, wb_probe), 196 DEVMETHOD(device_attach, wb_attach), 197 DEVMETHOD(device_detach, wb_detach), 198 DEVMETHOD(device_shutdown, wb_shutdown), 199 200 /* bus interface, for miibus */ 201 DEVMETHOD(bus_print_child, bus_generic_print_child), 202 DEVMETHOD(bus_driver_added, bus_generic_driver_added), 203 204 /* MII interface */ 205 DEVMETHOD(miibus_readreg, wb_miibus_readreg), 206 DEVMETHOD(miibus_writereg, wb_miibus_writereg), 207 DEVMETHOD(miibus_statchg, wb_miibus_statchg), 208 { 0, 0 } 209}; 210 211static driver_t wb_driver = { 212 "wb", 213 wb_methods, 214 sizeof(struct wb_softc) 215}; 216 217static devclass_t wb_devclass; 218 219DRIVER_MODULE(wb, pci, wb_driver, wb_devclass, 0, 0); 220DRIVER_MODULE(miibus, wb, miibus_driver, miibus_devclass, 0, 0); 221 222#define WB_SETBIT(sc, reg, x) \ 223 CSR_WRITE_4(sc, reg, \ 224 CSR_READ_4(sc, reg) | (x)) 225 226#define WB_CLRBIT(sc, reg, x) \ 227 CSR_WRITE_4(sc, reg, \ 228 CSR_READ_4(sc, reg) & ~(x)) 229 230#define SIO_SET(x) \ 231 CSR_WRITE_4(sc, WB_SIO, \ 232 CSR_READ_4(sc, WB_SIO) | (x)) 233 234#define SIO_CLR(x) \ 235 CSR_WRITE_4(sc, WB_SIO, \ 236 CSR_READ_4(sc, WB_SIO) & ~(x)) 237 238/* 239 * Send a read command and address to the EEPROM, check for ACK. 240 */ 241static void 242wb_eeprom_putbyte(sc, addr) 243 struct wb_softc *sc; 244 int addr; 245{ 246 register int d, i; 247 248 d = addr | WB_EECMD_READ; 249 250 /* 251 * Feed in each bit and stobe the clock. 252 */ 253 for (i = 0x400; i; i >>= 1) { 254 if (d & i) { 255 SIO_SET(WB_SIO_EE_DATAIN); 256 } else { 257 SIO_CLR(WB_SIO_EE_DATAIN); 258 } 259 DELAY(100); 260 SIO_SET(WB_SIO_EE_CLK); 261 DELAY(150); 262 SIO_CLR(WB_SIO_EE_CLK); 263 DELAY(100); 264 } 265 266 return; 267} 268 269/* 270 * Read a word of data stored in the EEPROM at address 'addr.' 271 */ 272static void 273wb_eeprom_getword(sc, addr, dest) 274 struct wb_softc *sc; 275 int addr; 276 u_int16_t *dest; 277{ 278 register int i; 279 u_int16_t word = 0; 280 281 /* Enter EEPROM access mode. */ 282 CSR_WRITE_4(sc, WB_SIO, WB_SIO_EESEL|WB_SIO_EE_CS); 283 284 /* 285 * Send address of word we want to read. 286 */ 287 wb_eeprom_putbyte(sc, addr); 288 289 CSR_WRITE_4(sc, WB_SIO, WB_SIO_EESEL|WB_SIO_EE_CS); 290 291 /* 292 * Start reading bits from EEPROM. 293 */ 294 for (i = 0x8000; i; i >>= 1) { 295 SIO_SET(WB_SIO_EE_CLK); 296 DELAY(100); 297 if (CSR_READ_4(sc, WB_SIO) & WB_SIO_EE_DATAOUT) 298 word |= i; 299 SIO_CLR(WB_SIO_EE_CLK); 300 DELAY(100); 301 } 302 303 /* Turn off EEPROM access mode. */ 304 CSR_WRITE_4(sc, WB_SIO, 0); 305 306 *dest = word; 307 308 return; 309} 310 311/* 312 * Read a sequence of words from the EEPROM. 313 */ 314static void 315wb_read_eeprom(sc, dest, off, cnt, swap) 316 struct wb_softc *sc; 317 caddr_t dest; 318 int off; 319 int cnt; 320 int swap; 321{ 322 int i; 323 u_int16_t word = 0, *ptr; 324 325 for (i = 0; i < cnt; i++) { 326 wb_eeprom_getword(sc, off + i, &word); 327 ptr = (u_int16_t *)(dest + (i * 2)); 328 if (swap) 329 *ptr = ntohs(word); 330 else 331 *ptr = word; 332 } 333 334 return; 335} 336 337/* 338 * Sync the PHYs by setting data bit and strobing the clock 32 times. 339 */ 340static void 341wb_mii_sync(sc) 342 struct wb_softc *sc; 343{ 344 register int i; 345 346 SIO_SET(WB_SIO_MII_DIR|WB_SIO_MII_DATAIN); 347 348 for (i = 0; i < 32; i++) { 349 SIO_SET(WB_SIO_MII_CLK); 350 DELAY(1); 351 SIO_CLR(WB_SIO_MII_CLK); 352 DELAY(1); 353 } 354 355 return; 356} 357 358/* 359 * Clock a series of bits through the MII. 360 */ 361static void 362wb_mii_send(sc, bits, cnt) 363 struct wb_softc *sc; 364 u_int32_t bits; 365 int cnt; 366{ 367 int i; 368 369 SIO_CLR(WB_SIO_MII_CLK); 370 371 for (i = (0x1 << (cnt - 1)); i; i >>= 1) { 372 if (bits & i) { 373 SIO_SET(WB_SIO_MII_DATAIN); 374 } else { 375 SIO_CLR(WB_SIO_MII_DATAIN); 376 } 377 DELAY(1); 378 SIO_CLR(WB_SIO_MII_CLK); 379 DELAY(1); 380 SIO_SET(WB_SIO_MII_CLK); 381 } 382} 383 384/* 385 * Read an PHY register through the MII. 386 */ 387static int 388wb_mii_readreg(sc, frame) 389 struct wb_softc *sc; 390 struct wb_mii_frame *frame; 391 392{ 393 int i, ack; 394 395 /* 396 * Set up frame for RX. 397 */ 398 frame->mii_stdelim = WB_MII_STARTDELIM; 399 frame->mii_opcode = WB_MII_READOP; 400 frame->mii_turnaround = 0; 401 frame->mii_data = 0; 402 403 CSR_WRITE_4(sc, WB_SIO, 0); 404 405 /* 406 * Turn on data xmit. 407 */ 408 SIO_SET(WB_SIO_MII_DIR); 409 410 wb_mii_sync(sc); 411 412 /* 413 * Send command/address info. 414 */ 415 wb_mii_send(sc, frame->mii_stdelim, 2); 416 wb_mii_send(sc, frame->mii_opcode, 2); 417 wb_mii_send(sc, frame->mii_phyaddr, 5); 418 wb_mii_send(sc, frame->mii_regaddr, 5); 419 420 /* Idle bit */ 421 SIO_CLR((WB_SIO_MII_CLK|WB_SIO_MII_DATAIN)); 422 DELAY(1); 423 SIO_SET(WB_SIO_MII_CLK); 424 DELAY(1); 425 426 /* Turn off xmit. */ 427 SIO_CLR(WB_SIO_MII_DIR); 428 /* Check for ack */ 429 SIO_CLR(WB_SIO_MII_CLK); 430 DELAY(1); 431 ack = CSR_READ_4(sc, WB_SIO) & WB_SIO_MII_DATAOUT; 432 SIO_SET(WB_SIO_MII_CLK); 433 DELAY(1); 434 SIO_CLR(WB_SIO_MII_CLK); 435 DELAY(1); 436 SIO_SET(WB_SIO_MII_CLK); 437 DELAY(1); 438 439 /* 440 * Now try reading data bits. If the ack failed, we still 441 * need to clock through 16 cycles to keep the PHY(s) in sync. 442 */ 443 if (ack) { 444 for(i = 0; i < 16; i++) { 445 SIO_CLR(WB_SIO_MII_CLK); 446 DELAY(1); 447 SIO_SET(WB_SIO_MII_CLK); 448 DELAY(1); 449 } 450 goto fail; 451 } 452 453 for (i = 0x8000; i; i >>= 1) { 454 SIO_CLR(WB_SIO_MII_CLK); 455 DELAY(1); 456 if (!ack) { 457 if (CSR_READ_4(sc, WB_SIO) & WB_SIO_MII_DATAOUT) 458 frame->mii_data |= i; 459 DELAY(1); 460 } 461 SIO_SET(WB_SIO_MII_CLK); 462 DELAY(1); 463 } 464 465fail: 466 467 SIO_CLR(WB_SIO_MII_CLK); 468 DELAY(1); 469 SIO_SET(WB_SIO_MII_CLK); 470 DELAY(1); 471 472 if (ack) 473 return(1); 474 return(0); 475} 476 477/* 478 * Write to a PHY register through the MII. 479 */ 480static int 481wb_mii_writereg(sc, frame) 482 struct wb_softc *sc; 483 struct wb_mii_frame *frame; 484 485{ 486 487 /* 488 * Set up frame for TX. 489 */ 490 491 frame->mii_stdelim = WB_MII_STARTDELIM; 492 frame->mii_opcode = WB_MII_WRITEOP; 493 frame->mii_turnaround = WB_MII_TURNAROUND; 494 495 /* 496 * Turn on data output. 497 */ 498 SIO_SET(WB_SIO_MII_DIR); 499 500 wb_mii_sync(sc); 501 502 wb_mii_send(sc, frame->mii_stdelim, 2); 503 wb_mii_send(sc, frame->mii_opcode, 2); 504 wb_mii_send(sc, frame->mii_phyaddr, 5); 505 wb_mii_send(sc, frame->mii_regaddr, 5); 506 wb_mii_send(sc, frame->mii_turnaround, 2); 507 wb_mii_send(sc, frame->mii_data, 16); 508 509 /* Idle bit. */ 510 SIO_SET(WB_SIO_MII_CLK); 511 DELAY(1); 512 SIO_CLR(WB_SIO_MII_CLK); 513 DELAY(1); 514 515 /* 516 * Turn off xmit. 517 */ 518 SIO_CLR(WB_SIO_MII_DIR); 519 520 return(0); 521} 522 523static int 524wb_miibus_readreg(dev, phy, reg) 525 device_t dev; 526 int phy, reg; 527{ 528 struct wb_softc *sc; 529 struct wb_mii_frame frame; 530 531 sc = device_get_softc(dev); 532 533 bzero((char *)&frame, sizeof(frame)); 534 535 frame.mii_phyaddr = phy; 536 frame.mii_regaddr = reg; 537 wb_mii_readreg(sc, &frame); 538 539 return(frame.mii_data); 540} 541 542static int 543wb_miibus_writereg(dev, phy, reg, data) 544 device_t dev; 545 int phy, reg, data; 546{ 547 struct wb_softc *sc; 548 struct wb_mii_frame frame; 549 550 sc = device_get_softc(dev); 551 552 bzero((char *)&frame, sizeof(frame)); 553 554 frame.mii_phyaddr = phy; 555 frame.mii_regaddr = reg; 556 frame.mii_data = data; 557 558 wb_mii_writereg(sc, &frame); 559 560 return(0); 561} 562 563static void 564wb_miibus_statchg(dev) 565 device_t dev; 566{ 567 struct wb_softc *sc; 568 struct mii_data *mii; 569 570 sc = device_get_softc(dev); 571 mii = device_get_softc(sc->wb_miibus); 572 wb_setcfg(sc, mii->mii_media_active); 573 574 return; 575} 576 577/* 578 * Program the 64-bit multicast hash filter. 579 */ 580static void 581wb_setmulti(sc) 582 struct wb_softc *sc; 583{ 584 struct ifnet *ifp; 585 int h = 0; 586 u_int32_t hashes[2] = { 0, 0 }; 587 struct ifmultiaddr *ifma; 588 u_int32_t rxfilt; 589 int mcnt = 0; 590 591 ifp = sc->wb_ifp; 592 593 rxfilt = CSR_READ_4(sc, WB_NETCFG); 594 595 if (ifp->if_flags & IFF_ALLMULTI || ifp->if_flags & IFF_PROMISC) { 596 rxfilt |= WB_NETCFG_RX_MULTI; 597 CSR_WRITE_4(sc, WB_NETCFG, rxfilt); 598 CSR_WRITE_4(sc, WB_MAR0, 0xFFFFFFFF); 599 CSR_WRITE_4(sc, WB_MAR1, 0xFFFFFFFF); 600 return; 601 } 602 603 /* first, zot all the existing hash bits */ 604 CSR_WRITE_4(sc, WB_MAR0, 0); 605 CSR_WRITE_4(sc, WB_MAR1, 0); 606 607 /* now program new ones */ 608 if_maddr_rlock(ifp); 609 TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) { 610 if (ifma->ifma_addr->sa_family != AF_LINK) 611 continue; 612 h = ~ether_crc32_be(LLADDR((struct sockaddr_dl *) 613 ifma->ifma_addr), ETHER_ADDR_LEN) >> 26; 614 if (h < 32) 615 hashes[0] |= (1 << h); 616 else 617 hashes[1] |= (1 << (h - 32)); 618 mcnt++; 619 } 620 if_maddr_runlock(ifp); 621 622 if (mcnt) 623 rxfilt |= WB_NETCFG_RX_MULTI; 624 else 625 rxfilt &= ~WB_NETCFG_RX_MULTI; 626 627 CSR_WRITE_4(sc, WB_MAR0, hashes[0]); 628 CSR_WRITE_4(sc, WB_MAR1, hashes[1]); 629 CSR_WRITE_4(sc, WB_NETCFG, rxfilt); 630 631 return; 632} 633 634/* 635 * The Winbond manual states that in order to fiddle with the 636 * 'full-duplex' and '100Mbps' bits in the netconfig register, we 637 * first have to put the transmit and/or receive logic in the idle state. 638 */ 639static void 640wb_setcfg(sc, media) 641 struct wb_softc *sc; 642 u_int32_t media; 643{ 644 int i, restart = 0; 645 646 if (CSR_READ_4(sc, WB_NETCFG) & (WB_NETCFG_TX_ON|WB_NETCFG_RX_ON)) { 647 restart = 1; 648 WB_CLRBIT(sc, WB_NETCFG, (WB_NETCFG_TX_ON|WB_NETCFG_RX_ON)); 649 650 for (i = 0; i < WB_TIMEOUT; i++) { 651 DELAY(10); 652 if ((CSR_READ_4(sc, WB_ISR) & WB_ISR_TX_IDLE) && 653 (CSR_READ_4(sc, WB_ISR) & WB_ISR_RX_IDLE)) 654 break; 655 } 656 657 if (i == WB_TIMEOUT) 658 device_printf(sc->wb_dev, 659 "failed to force tx and rx to idle state\n"); 660 } 661 662 if (IFM_SUBTYPE(media) == IFM_10_T) 663 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_100MBPS); 664 else 665 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_100MBPS); 666 667 if ((media & IFM_GMASK) == IFM_FDX) 668 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_FULLDUPLEX); 669 else 670 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_FULLDUPLEX); 671 672 if (restart) 673 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_TX_ON|WB_NETCFG_RX_ON); 674 675 return; 676} 677 678static void 679wb_reset(sc) 680 struct wb_softc *sc; 681{ 682 register int i; 683 struct mii_data *mii; 684 685 CSR_WRITE_4(sc, WB_NETCFG, 0); 686 CSR_WRITE_4(sc, WB_BUSCTL, 0); 687 CSR_WRITE_4(sc, WB_TXADDR, 0); 688 CSR_WRITE_4(sc, WB_RXADDR, 0); 689 690 WB_SETBIT(sc, WB_BUSCTL, WB_BUSCTL_RESET); 691 WB_SETBIT(sc, WB_BUSCTL, WB_BUSCTL_RESET); 692 693 for (i = 0; i < WB_TIMEOUT; i++) { 694 DELAY(10); 695 if (!(CSR_READ_4(sc, WB_BUSCTL) & WB_BUSCTL_RESET)) 696 break; 697 } 698 if (i == WB_TIMEOUT) 699 device_printf(sc->wb_dev, "reset never completed!\n"); 700 701 /* Wait a little while for the chip to get its brains in order. */ 702 DELAY(1000); 703 704 if (sc->wb_miibus == NULL) 705 return; 706 707 mii = device_get_softc(sc->wb_miibus); 708 if (mii == NULL) 709 return; 710 711 if (mii->mii_instance) { 712 struct mii_softc *miisc; 713 LIST_FOREACH(miisc, &mii->mii_phys, mii_list) 714 mii_phy_reset(miisc); 715 } 716 717 return; 718} 719 720static void 721wb_fixmedia(sc) 722 struct wb_softc *sc; 723{ 724 struct mii_data *mii = NULL; 725 struct ifnet *ifp; 726 u_int32_t media; 727 728 if (sc->wb_miibus == NULL) 729 return; 730 731 mii = device_get_softc(sc->wb_miibus); 732 ifp = sc->wb_ifp; 733 734 mii_pollstat(mii); 735 if (IFM_SUBTYPE(mii->mii_media_active) == IFM_10_T) { 736 media = mii->mii_media_active & ~IFM_10_T; 737 media |= IFM_100_TX; 738 } else if (IFM_SUBTYPE(mii->mii_media_active) == IFM_100_TX) { 739 media = mii->mii_media_active & ~IFM_100_TX; 740 media |= IFM_10_T; 741 } else 742 return; 743 744 ifmedia_set(&mii->mii_media, media); 745 746 return; 747} 748 749/* 750 * Probe for a Winbond chip. Check the PCI vendor and device 751 * IDs against our list and return a device name if we find a match. 752 */ 753static int 754wb_probe(dev) 755 device_t dev; 756{ 757 struct wb_type *t; 758 759 t = wb_devs; 760 761 while(t->wb_name != NULL) { 762 if ((pci_get_vendor(dev) == t->wb_vid) && 763 (pci_get_device(dev) == t->wb_did)) { 764 device_set_desc(dev, t->wb_name); 765 return (BUS_PROBE_DEFAULT); 766 } 767 t++; 768 } 769 770 return(ENXIO); 771} 772 773/* 774 * Attach the interface. Allocate softc structures, do ifmedia 775 * setup and ethernet/BPF attach. 776 */ 777static int 778wb_attach(dev) 779 device_t dev; 780{ 781 u_char eaddr[ETHER_ADDR_LEN]; 782 struct wb_softc *sc; 783 struct ifnet *ifp; 784 int error = 0, rid; 785 786 sc = device_get_softc(dev); 787 sc->wb_dev = dev; 788 789 mtx_init(&sc->wb_mtx, device_get_nameunit(dev), MTX_NETWORK_LOCK, 790 MTX_DEF); 791 callout_init_mtx(&sc->wb_stat_callout, &sc->wb_mtx, 0); 792 793 /* 794 * Map control/status registers. 795 */ 796 pci_enable_busmaster(dev); 797 798 rid = WB_RID; 799 sc->wb_res = bus_alloc_resource_any(dev, WB_RES, &rid, RF_ACTIVE); 800 801 if (sc->wb_res == NULL) { 802 device_printf(dev, "couldn't map ports/memory\n"); 803 error = ENXIO; 804 goto fail; 805 } 806 807 /* Allocate interrupt */ 808 rid = 0; 809 sc->wb_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid, 810 RF_SHAREABLE | RF_ACTIVE); 811 812 if (sc->wb_irq == NULL) { 813 device_printf(dev, "couldn't map interrupt\n"); 814 error = ENXIO; 815 goto fail; 816 } 817 818 /* Save the cache line size. */ 819 sc->wb_cachesize = pci_read_config(dev, WB_PCI_CACHELEN, 4) & 0xFF; 820 821 /* Reset the adapter. */ 822 wb_reset(sc); 823 824 /* 825 * Get station address from the EEPROM. 826 */ 827 wb_read_eeprom(sc, (caddr_t)&eaddr, 0, 3, 0); 828 829 sc->wb_ldata = contigmalloc(sizeof(struct wb_list_data) + 8, M_DEVBUF, 830 M_NOWAIT, 0, 0xffffffff, PAGE_SIZE, 0); 831 832 if (sc->wb_ldata == NULL) { 833 device_printf(dev, "no memory for list buffers!\n"); 834 error = ENXIO; 835 goto fail; 836 } 837 838 bzero(sc->wb_ldata, sizeof(struct wb_list_data)); 839 840 ifp = sc->wb_ifp = if_alloc(IFT_ETHER); 841 if (ifp == NULL) { 842 device_printf(dev, "can not if_alloc()\n"); 843 error = ENOSPC; 844 goto fail; 845 } 846 ifp->if_softc = sc; 847 if_initname(ifp, device_get_name(dev), device_get_unit(dev)); 848 ifp->if_mtu = ETHERMTU; 849 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST; 850 ifp->if_ioctl = wb_ioctl; 851 ifp->if_start = wb_start; 852 ifp->if_init = wb_init; 853 ifp->if_snd.ifq_maxlen = WB_TX_LIST_CNT - 1; 854 855 /* 856 * Do MII setup. 857 */ 858 error = mii_attach(dev, &sc->wb_miibus, ifp, wb_ifmedia_upd, 859 wb_ifmedia_sts, BMSR_DEFCAPMASK, MII_PHY_ANY, MII_OFFSET_ANY, 0); 860 if (error != 0) { 861 device_printf(dev, "attaching PHYs failed\n"); 862 goto fail; 863 } 864 865 /* 866 * Call MI attach routine. 867 */ 868 ether_ifattach(ifp, eaddr); 869 870 /* Hook interrupt last to avoid having to lock softc */ 871 error = bus_setup_intr(dev, sc->wb_irq, INTR_TYPE_NET | INTR_MPSAFE, 872 NULL, wb_intr, sc, &sc->wb_intrhand); 873 874 if (error) { 875 device_printf(dev, "couldn't set up irq\n"); 876 ether_ifdetach(ifp); 877 goto fail; 878 } 879 880fail: 881 if (error) 882 wb_detach(dev); 883 884 return(error); 885} 886 887/* 888 * Shutdown hardware and free up resources. This can be called any 889 * time after the mutex has been initialized. It is called in both 890 * the error case in attach and the normal detach case so it needs 891 * to be careful about only freeing resources that have actually been 892 * allocated. 893 */ 894static int 895wb_detach(dev) 896 device_t dev; 897{ 898 struct wb_softc *sc; 899 struct ifnet *ifp; 900 901 sc = device_get_softc(dev); 902 KASSERT(mtx_initialized(&sc->wb_mtx), ("wb mutex not initialized")); 903 ifp = sc->wb_ifp; 904 905 /* 906 * Delete any miibus and phy devices attached to this interface. 907 * This should only be done if attach succeeded. 908 */ 909 if (device_is_attached(dev)) { 910 ether_ifdetach(ifp); 911 WB_LOCK(sc); 912 wb_stop(sc); 913 WB_UNLOCK(sc); 914 callout_drain(&sc->wb_stat_callout); 915 } 916 if (sc->wb_miibus) 917 device_delete_child(dev, sc->wb_miibus); 918 bus_generic_detach(dev); 919 920 if (sc->wb_intrhand) 921 bus_teardown_intr(dev, sc->wb_irq, sc->wb_intrhand); 922 if (sc->wb_irq) 923 bus_release_resource(dev, SYS_RES_IRQ, 0, sc->wb_irq); 924 if (sc->wb_res) 925 bus_release_resource(dev, WB_RES, WB_RID, sc->wb_res); 926 927 if (ifp) 928 if_free(ifp); 929 930 if (sc->wb_ldata) { 931 contigfree(sc->wb_ldata, sizeof(struct wb_list_data) + 8, 932 M_DEVBUF); 933 } 934 935 mtx_destroy(&sc->wb_mtx); 936 937 return(0); 938} 939 940/* 941 * Initialize the transmit descriptors. 942 */ 943static int 944wb_list_tx_init(sc) 945 struct wb_softc *sc; 946{ 947 struct wb_chain_data *cd; 948 struct wb_list_data *ld; 949 int i; 950 951 cd = &sc->wb_cdata; 952 ld = sc->wb_ldata; 953 954 for (i = 0; i < WB_TX_LIST_CNT; i++) { 955 cd->wb_tx_chain[i].wb_ptr = &ld->wb_tx_list[i]; 956 if (i == (WB_TX_LIST_CNT - 1)) { 957 cd->wb_tx_chain[i].wb_nextdesc = 958 &cd->wb_tx_chain[0]; 959 } else { 960 cd->wb_tx_chain[i].wb_nextdesc = 961 &cd->wb_tx_chain[i + 1]; 962 } 963 } 964 965 cd->wb_tx_free = &cd->wb_tx_chain[0]; 966 cd->wb_tx_tail = cd->wb_tx_head = NULL; 967 968 return(0); 969} 970 971 972/* 973 * Initialize the RX descriptors and allocate mbufs for them. Note that 974 * we arrange the descriptors in a closed ring, so that the last descriptor 975 * points back to the first. 976 */ 977static int 978wb_list_rx_init(sc) 979 struct wb_softc *sc; 980{ 981 struct wb_chain_data *cd; 982 struct wb_list_data *ld; 983 int i; 984 985 cd = &sc->wb_cdata; 986 ld = sc->wb_ldata; 987 988 for (i = 0; i < WB_RX_LIST_CNT; i++) { 989 cd->wb_rx_chain[i].wb_ptr = 990 (struct wb_desc *)&ld->wb_rx_list[i]; 991 cd->wb_rx_chain[i].wb_buf = (void *)&ld->wb_rxbufs[i]; 992 if (wb_newbuf(sc, &cd->wb_rx_chain[i], NULL) == ENOBUFS) 993 return(ENOBUFS); 994 if (i == (WB_RX_LIST_CNT - 1)) { 995 cd->wb_rx_chain[i].wb_nextdesc = &cd->wb_rx_chain[0]; 996 ld->wb_rx_list[i].wb_next = 997 vtophys(&ld->wb_rx_list[0]); 998 } else { 999 cd->wb_rx_chain[i].wb_nextdesc = 1000 &cd->wb_rx_chain[i + 1]; 1001 ld->wb_rx_list[i].wb_next = 1002 vtophys(&ld->wb_rx_list[i + 1]); 1003 } 1004 } 1005 1006 cd->wb_rx_head = &cd->wb_rx_chain[0]; 1007 1008 return(0); 1009} 1010 1011static void 1012wb_bfree(buf, args) 1013 void *buf; 1014 void *args; 1015{ 1016 return; 1017} 1018 1019/* 1020 * Initialize an RX descriptor and attach an MBUF cluster. 1021 */ 1022static int 1023wb_newbuf(sc, c, m) 1024 struct wb_softc *sc; 1025 struct wb_chain_onefrag *c; 1026 struct mbuf *m; 1027{ 1028 struct mbuf *m_new = NULL; 1029 1030 if (m == NULL) { 1031 MGETHDR(m_new, M_DONTWAIT, MT_DATA); 1032 if (m_new == NULL) 1033 return(ENOBUFS); 1034 m_new->m_data = c->wb_buf; 1035 m_new->m_pkthdr.len = m_new->m_len = WB_BUFBYTES; 1036 MEXTADD(m_new, c->wb_buf, WB_BUFBYTES, wb_bfree, c->wb_buf, 1037 NULL, 0, EXT_NET_DRV); 1038 } else { 1039 m_new = m; 1040 m_new->m_len = m_new->m_pkthdr.len = WB_BUFBYTES; 1041 m_new->m_data = m_new->m_ext.ext_buf; 1042 } 1043 1044 m_adj(m_new, sizeof(u_int64_t)); 1045 1046 c->wb_mbuf = m_new; 1047 c->wb_ptr->wb_data = vtophys(mtod(m_new, caddr_t)); 1048 c->wb_ptr->wb_ctl = WB_RXCTL_RLINK | 1536; 1049 c->wb_ptr->wb_status = WB_RXSTAT; 1050 1051 return(0); 1052} 1053 1054/* 1055 * A frame has been uploaded: pass the resulting mbuf chain up to 1056 * the higher level protocols. 1057 */ 1058static void 1059wb_rxeof(sc) 1060 struct wb_softc *sc; 1061{ 1062 struct mbuf *m = NULL; 1063 struct ifnet *ifp; 1064 struct wb_chain_onefrag *cur_rx; 1065 int total_len = 0; 1066 u_int32_t rxstat; 1067 1068 WB_LOCK_ASSERT(sc); 1069 1070 ifp = sc->wb_ifp; 1071 1072 while(!((rxstat = sc->wb_cdata.wb_rx_head->wb_ptr->wb_status) & 1073 WB_RXSTAT_OWN)) { 1074 struct mbuf *m0 = NULL; 1075 1076 cur_rx = sc->wb_cdata.wb_rx_head; 1077 sc->wb_cdata.wb_rx_head = cur_rx->wb_nextdesc; 1078 1079 m = cur_rx->wb_mbuf; 1080 1081 if ((rxstat & WB_RXSTAT_MIIERR) || 1082 (WB_RXBYTES(cur_rx->wb_ptr->wb_status) < WB_MIN_FRAMELEN) || 1083 (WB_RXBYTES(cur_rx->wb_ptr->wb_status) > 1536) || 1084 !(rxstat & WB_RXSTAT_LASTFRAG) || 1085 !(rxstat & WB_RXSTAT_RXCMP)) { 1086 ifp->if_ierrors++; 1087 wb_newbuf(sc, cur_rx, m); 1088 device_printf(sc->wb_dev, 1089 "receiver babbling: possible chip bug," 1090 " forcing reset\n"); 1091 wb_fixmedia(sc); 1092 wb_reset(sc); 1093 wb_init_locked(sc); 1094 return; 1095 } 1096 1097 if (rxstat & WB_RXSTAT_RXERR) { 1098 ifp->if_ierrors++; 1099 wb_newbuf(sc, cur_rx, m); 1100 break; 1101 } 1102 1103 /* No errors; receive the packet. */ 1104 total_len = WB_RXBYTES(cur_rx->wb_ptr->wb_status); 1105 1106 /* 1107 * XXX The Winbond chip includes the CRC with every 1108 * received frame, and there's no way to turn this 1109 * behavior off (at least, I can't find anything in 1110 * the manual that explains how to do it) so we have 1111 * to trim off the CRC manually. 1112 */ 1113 total_len -= ETHER_CRC_LEN; 1114 1115 m0 = m_devget(mtod(m, char *), total_len, ETHER_ALIGN, ifp, 1116 NULL); 1117 wb_newbuf(sc, cur_rx, m); 1118 if (m0 == NULL) { 1119 ifp->if_ierrors++; 1120 break; 1121 } 1122 m = m0; 1123 1124 ifp->if_ipackets++; 1125 WB_UNLOCK(sc); 1126 (*ifp->if_input)(ifp, m); 1127 WB_LOCK(sc); 1128 } 1129} 1130 1131static void 1132wb_rxeoc(sc) 1133 struct wb_softc *sc; 1134{ 1135 wb_rxeof(sc); 1136 1137 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_RX_ON); 1138 CSR_WRITE_4(sc, WB_RXADDR, vtophys(&sc->wb_ldata->wb_rx_list[0])); 1139 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_RX_ON); 1140 if (CSR_READ_4(sc, WB_ISR) & WB_RXSTATE_SUSPEND) 1141 CSR_WRITE_4(sc, WB_RXSTART, 0xFFFFFFFF); 1142 1143 return; 1144} 1145 1146/* 1147 * A frame was downloaded to the chip. It's safe for us to clean up 1148 * the list buffers. 1149 */ 1150static void 1151wb_txeof(sc) 1152 struct wb_softc *sc; 1153{ 1154 struct wb_chain *cur_tx; 1155 struct ifnet *ifp; 1156 1157 ifp = sc->wb_ifp; 1158 1159 /* Clear the timeout timer. */ 1160 sc->wb_timer = 0; 1161 1162 if (sc->wb_cdata.wb_tx_head == NULL) 1163 return; 1164 1165 /* 1166 * Go through our tx list and free mbufs for those 1167 * frames that have been transmitted. 1168 */ 1169 while(sc->wb_cdata.wb_tx_head->wb_mbuf != NULL) { 1170 u_int32_t txstat; 1171 1172 cur_tx = sc->wb_cdata.wb_tx_head; 1173 txstat = WB_TXSTATUS(cur_tx); 1174 1175 if ((txstat & WB_TXSTAT_OWN) || txstat == WB_UNSENT) 1176 break; 1177 1178 if (txstat & WB_TXSTAT_TXERR) { 1179 ifp->if_oerrors++; 1180 if (txstat & WB_TXSTAT_ABORT) 1181 ifp->if_collisions++; 1182 if (txstat & WB_TXSTAT_LATECOLL) 1183 ifp->if_collisions++; 1184 } 1185 1186 ifp->if_collisions += (txstat & WB_TXSTAT_COLLCNT) >> 3; 1187 1188 ifp->if_opackets++; 1189 m_freem(cur_tx->wb_mbuf); 1190 cur_tx->wb_mbuf = NULL; 1191 1192 if (sc->wb_cdata.wb_tx_head == sc->wb_cdata.wb_tx_tail) { 1193 sc->wb_cdata.wb_tx_head = NULL; 1194 sc->wb_cdata.wb_tx_tail = NULL; 1195 break; 1196 } 1197 1198 sc->wb_cdata.wb_tx_head = cur_tx->wb_nextdesc; 1199 } 1200 1201 return; 1202} 1203 1204/* 1205 * TX 'end of channel' interrupt handler. 1206 */ 1207static void 1208wb_txeoc(sc) 1209 struct wb_softc *sc; 1210{ 1211 struct ifnet *ifp; 1212 1213 ifp = sc->wb_ifp; 1214 1215 sc->wb_timer = 0; 1216 1217 if (sc->wb_cdata.wb_tx_head == NULL) { 1218 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1219 sc->wb_cdata.wb_tx_tail = NULL; 1220 } else { 1221 if (WB_TXOWN(sc->wb_cdata.wb_tx_head) == WB_UNSENT) { 1222 WB_TXOWN(sc->wb_cdata.wb_tx_head) = WB_TXSTAT_OWN; 1223 sc->wb_timer = 5; 1224 CSR_WRITE_4(sc, WB_TXSTART, 0xFFFFFFFF); 1225 } 1226 } 1227 1228 return; 1229} 1230 1231static void 1232wb_intr(arg) 1233 void *arg; 1234{ 1235 struct wb_softc *sc; 1236 struct ifnet *ifp; 1237 u_int32_t status; 1238 1239 sc = arg; 1240 WB_LOCK(sc); 1241 ifp = sc->wb_ifp; 1242 1243 if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) { 1244 WB_UNLOCK(sc); 1245 return; 1246 } 1247 1248 /* Disable interrupts. */ 1249 CSR_WRITE_4(sc, WB_IMR, 0x00000000); 1250 1251 for (;;) { 1252 1253 status = CSR_READ_4(sc, WB_ISR); 1254 if (status) 1255 CSR_WRITE_4(sc, WB_ISR, status); 1256 1257 if ((status & WB_INTRS) == 0) 1258 break; 1259 1260 if ((status & WB_ISR_RX_NOBUF) || (status & WB_ISR_RX_ERR)) { 1261 ifp->if_ierrors++; 1262 wb_reset(sc); 1263 if (status & WB_ISR_RX_ERR) 1264 wb_fixmedia(sc); 1265 wb_init_locked(sc); 1266 continue; 1267 } 1268 1269 if (status & WB_ISR_RX_OK) 1270 wb_rxeof(sc); 1271 1272 if (status & WB_ISR_RX_IDLE) 1273 wb_rxeoc(sc); 1274 1275 if (status & WB_ISR_TX_OK) 1276 wb_txeof(sc); 1277 1278 if (status & WB_ISR_TX_NOBUF) 1279 wb_txeoc(sc); 1280 1281 if (status & WB_ISR_TX_IDLE) { 1282 wb_txeof(sc); 1283 if (sc->wb_cdata.wb_tx_head != NULL) { 1284 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_TX_ON); 1285 CSR_WRITE_4(sc, WB_TXSTART, 0xFFFFFFFF); 1286 } 1287 } 1288 1289 if (status & WB_ISR_TX_UNDERRUN) { 1290 ifp->if_oerrors++; 1291 wb_txeof(sc); 1292 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_TX_ON); 1293 /* Jack up TX threshold */ 1294 sc->wb_txthresh += WB_TXTHRESH_CHUNK; 1295 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_TX_THRESH); 1296 WB_SETBIT(sc, WB_NETCFG, WB_TXTHRESH(sc->wb_txthresh)); 1297 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_TX_ON); 1298 } 1299 1300 if (status & WB_ISR_BUS_ERR) { 1301 wb_reset(sc); 1302 wb_init_locked(sc); 1303 } 1304 1305 } 1306 1307 /* Re-enable interrupts. */ 1308 CSR_WRITE_4(sc, WB_IMR, WB_INTRS); 1309 1310 if (ifp->if_snd.ifq_head != NULL) { 1311 wb_start_locked(ifp); 1312 } 1313 1314 WB_UNLOCK(sc); 1315 1316 return; 1317} 1318 1319static void 1320wb_tick(xsc) 1321 void *xsc; 1322{ 1323 struct wb_softc *sc; 1324 struct mii_data *mii; 1325 1326 sc = xsc; 1327 WB_LOCK_ASSERT(sc); 1328 mii = device_get_softc(sc->wb_miibus); 1329 1330 mii_tick(mii); 1331 1332 if (sc->wb_timer > 0 && --sc->wb_timer == 0) 1333 wb_watchdog(sc); 1334 callout_reset(&sc->wb_stat_callout, hz, wb_tick, sc); 1335 1336 return; 1337} 1338 1339/* 1340 * Encapsulate an mbuf chain in a descriptor by coupling the mbuf data 1341 * pointers to the fragment pointers. 1342 */ 1343static int 1344wb_encap(sc, c, m_head) 1345 struct wb_softc *sc; 1346 struct wb_chain *c; 1347 struct mbuf *m_head; 1348{ 1349 int frag = 0; 1350 struct wb_desc *f = NULL; 1351 int total_len; 1352 struct mbuf *m; 1353 1354 /* 1355 * Start packing the mbufs in this chain into 1356 * the fragment pointers. Stop when we run out 1357 * of fragments or hit the end of the mbuf chain. 1358 */ 1359 m = m_head; 1360 total_len = 0; 1361 1362 for (m = m_head, frag = 0; m != NULL; m = m->m_next) { 1363 if (m->m_len != 0) { 1364 if (frag == WB_MAXFRAGS) 1365 break; 1366 total_len += m->m_len; 1367 f = &c->wb_ptr->wb_frag[frag]; 1368 f->wb_ctl = WB_TXCTL_TLINK | m->m_len; 1369 if (frag == 0) { 1370 f->wb_ctl |= WB_TXCTL_FIRSTFRAG; 1371 f->wb_status = 0; 1372 } else 1373 f->wb_status = WB_TXSTAT_OWN; 1374 f->wb_next = vtophys(&c->wb_ptr->wb_frag[frag + 1]); 1375 f->wb_data = vtophys(mtod(m, vm_offset_t)); 1376 frag++; 1377 } 1378 } 1379 1380 /* 1381 * Handle special case: we used up all 16 fragments, 1382 * but we have more mbufs left in the chain. Copy the 1383 * data into an mbuf cluster. Note that we don't 1384 * bother clearing the values in the other fragment 1385 * pointers/counters; it wouldn't gain us anything, 1386 * and would waste cycles. 1387 */ 1388 if (m != NULL) { 1389 struct mbuf *m_new = NULL; 1390 1391 MGETHDR(m_new, M_DONTWAIT, MT_DATA); 1392 if (m_new == NULL) 1393 return(1); 1394 if (m_head->m_pkthdr.len > MHLEN) { 1395 MCLGET(m_new, M_DONTWAIT); 1396 if (!(m_new->m_flags & M_EXT)) { 1397 m_freem(m_new); 1398 return(1); 1399 } 1400 } 1401 m_copydata(m_head, 0, m_head->m_pkthdr.len, 1402 mtod(m_new, caddr_t)); 1403 m_new->m_pkthdr.len = m_new->m_len = m_head->m_pkthdr.len; 1404 m_freem(m_head); 1405 m_head = m_new; 1406 f = &c->wb_ptr->wb_frag[0]; 1407 f->wb_status = 0; 1408 f->wb_data = vtophys(mtod(m_new, caddr_t)); 1409 f->wb_ctl = total_len = m_new->m_len; 1410 f->wb_ctl |= WB_TXCTL_TLINK|WB_TXCTL_FIRSTFRAG; 1411 frag = 1; 1412 } 1413 1414 if (total_len < WB_MIN_FRAMELEN) { 1415 f = &c->wb_ptr->wb_frag[frag]; 1416 f->wb_ctl = WB_MIN_FRAMELEN - total_len; 1417 f->wb_data = vtophys(&sc->wb_cdata.wb_pad); 1418 f->wb_ctl |= WB_TXCTL_TLINK; 1419 f->wb_status = WB_TXSTAT_OWN; 1420 frag++; 1421 } 1422 1423 c->wb_mbuf = m_head; 1424 c->wb_lastdesc = frag - 1; 1425 WB_TXCTL(c) |= WB_TXCTL_LASTFRAG; 1426 WB_TXNEXT(c) = vtophys(&c->wb_nextdesc->wb_ptr->wb_frag[0]); 1427 1428 return(0); 1429} 1430 1431/* 1432 * Main transmit routine. To avoid having to do mbuf copies, we put pointers 1433 * to the mbuf data regions directly in the transmit lists. We also save a 1434 * copy of the pointers since the transmit list fragment pointers are 1435 * physical addresses. 1436 */ 1437 1438static void 1439wb_start(ifp) 1440 struct ifnet *ifp; 1441{ 1442 struct wb_softc *sc; 1443 1444 sc = ifp->if_softc; 1445 WB_LOCK(sc); 1446 wb_start_locked(ifp); 1447 WB_UNLOCK(sc); 1448} 1449 1450static void 1451wb_start_locked(ifp) 1452 struct ifnet *ifp; 1453{ 1454 struct wb_softc *sc; 1455 struct mbuf *m_head = NULL; 1456 struct wb_chain *cur_tx = NULL, *start_tx; 1457 1458 sc = ifp->if_softc; 1459 WB_LOCK_ASSERT(sc); 1460 1461 /* 1462 * Check for an available queue slot. If there are none, 1463 * punt. 1464 */ 1465 if (sc->wb_cdata.wb_tx_free->wb_mbuf != NULL) { 1466 ifp->if_drv_flags |= IFF_DRV_OACTIVE; 1467 return; 1468 } 1469 1470 start_tx = sc->wb_cdata.wb_tx_free; 1471 1472 while(sc->wb_cdata.wb_tx_free->wb_mbuf == NULL) { 1473 IF_DEQUEUE(&ifp->if_snd, m_head); 1474 if (m_head == NULL) 1475 break; 1476 1477 /* Pick a descriptor off the free list. */ 1478 cur_tx = sc->wb_cdata.wb_tx_free; 1479 sc->wb_cdata.wb_tx_free = cur_tx->wb_nextdesc; 1480 1481 /* Pack the data into the descriptor. */ 1482 wb_encap(sc, cur_tx, m_head); 1483 1484 if (cur_tx != start_tx) 1485 WB_TXOWN(cur_tx) = WB_TXSTAT_OWN; 1486 1487 /* 1488 * If there's a BPF listener, bounce a copy of this frame 1489 * to him. 1490 */ 1491 BPF_MTAP(ifp, cur_tx->wb_mbuf); 1492 } 1493 1494 /* 1495 * If there are no packets queued, bail. 1496 */ 1497 if (cur_tx == NULL) 1498 return; 1499 1500 /* 1501 * Place the request for the upload interrupt 1502 * in the last descriptor in the chain. This way, if 1503 * we're chaining several packets at once, we'll only 1504 * get an interrupt once for the whole chain rather than 1505 * once for each packet. 1506 */ 1507 WB_TXCTL(cur_tx) |= WB_TXCTL_FINT; 1508 cur_tx->wb_ptr->wb_frag[0].wb_ctl |= WB_TXCTL_FINT; 1509 sc->wb_cdata.wb_tx_tail = cur_tx; 1510 1511 if (sc->wb_cdata.wb_tx_head == NULL) { 1512 sc->wb_cdata.wb_tx_head = start_tx; 1513 WB_TXOWN(start_tx) = WB_TXSTAT_OWN; 1514 CSR_WRITE_4(sc, WB_TXSTART, 0xFFFFFFFF); 1515 } else { 1516 /* 1517 * We need to distinguish between the case where 1518 * the own bit is clear because the chip cleared it 1519 * and where the own bit is clear because we haven't 1520 * set it yet. The magic value WB_UNSET is just some 1521 * ramdomly chosen number which doesn't have the own 1522 * bit set. When we actually transmit the frame, the 1523 * status word will have _only_ the own bit set, so 1524 * the txeoc handler will be able to tell if it needs 1525 * to initiate another transmission to flush out pending 1526 * frames. 1527 */ 1528 WB_TXOWN(start_tx) = WB_UNSENT; 1529 } 1530 1531 /* 1532 * Set a timeout in case the chip goes out to lunch. 1533 */ 1534 sc->wb_timer = 5; 1535 1536 return; 1537} 1538 1539static void 1540wb_init(xsc) 1541 void *xsc; 1542{ 1543 struct wb_softc *sc = xsc; 1544 1545 WB_LOCK(sc); 1546 wb_init_locked(sc); 1547 WB_UNLOCK(sc); 1548} 1549 1550static void 1551wb_init_locked(sc) 1552 struct wb_softc *sc; 1553{ 1554 struct ifnet *ifp = sc->wb_ifp; 1555 int i; 1556 struct mii_data *mii; 1557 1558 WB_LOCK_ASSERT(sc); 1559 mii = device_get_softc(sc->wb_miibus); 1560 1561 /* 1562 * Cancel pending I/O and free all RX/TX buffers. 1563 */ 1564 wb_stop(sc); 1565 wb_reset(sc); 1566 1567 sc->wb_txthresh = WB_TXTHRESH_INIT; 1568 1569 /* 1570 * Set cache alignment and burst length. 1571 */ 1572#ifdef foo 1573 CSR_WRITE_4(sc, WB_BUSCTL, WB_BUSCTL_CONFIG); 1574 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_TX_THRESH); 1575 WB_SETBIT(sc, WB_NETCFG, WB_TXTHRESH(sc->wb_txthresh)); 1576#endif 1577 1578 CSR_WRITE_4(sc, WB_BUSCTL, WB_BUSCTL_MUSTBEONE|WB_BUSCTL_ARBITRATION); 1579 WB_SETBIT(sc, WB_BUSCTL, WB_BURSTLEN_16LONG); 1580 switch(sc->wb_cachesize) { 1581 case 32: 1582 WB_SETBIT(sc, WB_BUSCTL, WB_CACHEALIGN_32LONG); 1583 break; 1584 case 16: 1585 WB_SETBIT(sc, WB_BUSCTL, WB_CACHEALIGN_16LONG); 1586 break; 1587 case 8: 1588 WB_SETBIT(sc, WB_BUSCTL, WB_CACHEALIGN_8LONG); 1589 break; 1590 case 0: 1591 default: 1592 WB_SETBIT(sc, WB_BUSCTL, WB_CACHEALIGN_NONE); 1593 break; 1594 } 1595 1596 /* This doesn't tend to work too well at 100Mbps. */ 1597 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_TX_EARLY_ON); 1598 1599 /* Init our MAC address */ 1600 for (i = 0; i < ETHER_ADDR_LEN; i++) { 1601 CSR_WRITE_1(sc, WB_NODE0 + i, IF_LLADDR(sc->wb_ifp)[i]); 1602 } 1603 1604 /* Init circular RX list. */ 1605 if (wb_list_rx_init(sc) == ENOBUFS) { 1606 device_printf(sc->wb_dev, 1607 "initialization failed: no memory for rx buffers\n"); 1608 wb_stop(sc); 1609 return; 1610 } 1611 1612 /* Init TX descriptors. */ 1613 wb_list_tx_init(sc); 1614 1615 /* If we want promiscuous mode, set the allframes bit. */ 1616 if (ifp->if_flags & IFF_PROMISC) { 1617 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_RX_ALLPHYS); 1618 } else { 1619 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_RX_ALLPHYS); 1620 } 1621 1622 /* 1623 * Set capture broadcast bit to capture broadcast frames. 1624 */ 1625 if (ifp->if_flags & IFF_BROADCAST) { 1626 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_RX_BROAD); 1627 } else { 1628 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_RX_BROAD); 1629 } 1630 1631 /* 1632 * Program the multicast filter, if necessary. 1633 */ 1634 wb_setmulti(sc); 1635 1636 /* 1637 * Load the address of the RX list. 1638 */ 1639 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_RX_ON); 1640 CSR_WRITE_4(sc, WB_RXADDR, vtophys(&sc->wb_ldata->wb_rx_list[0])); 1641 1642 /* 1643 * Enable interrupts. 1644 */ 1645 CSR_WRITE_4(sc, WB_IMR, WB_INTRS); 1646 CSR_WRITE_4(sc, WB_ISR, 0xFFFFFFFF); 1647 1648 /* Enable receiver and transmitter. */ 1649 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_RX_ON); 1650 CSR_WRITE_4(sc, WB_RXSTART, 0xFFFFFFFF); 1651 1652 WB_CLRBIT(sc, WB_NETCFG, WB_NETCFG_TX_ON); 1653 CSR_WRITE_4(sc, WB_TXADDR, vtophys(&sc->wb_ldata->wb_tx_list[0])); 1654 WB_SETBIT(sc, WB_NETCFG, WB_NETCFG_TX_ON); 1655 1656 mii_mediachg(mii); 1657 1658 ifp->if_drv_flags |= IFF_DRV_RUNNING; 1659 ifp->if_drv_flags &= ~IFF_DRV_OACTIVE; 1660 1661 callout_reset(&sc->wb_stat_callout, hz, wb_tick, sc); 1662 1663 return; 1664} 1665 1666/* 1667 * Set media options. 1668 */ 1669static int 1670wb_ifmedia_upd(ifp) 1671 struct ifnet *ifp; 1672{ 1673 struct wb_softc *sc; 1674 1675 sc = ifp->if_softc; 1676 1677 WB_LOCK(sc); 1678 if (ifp->if_flags & IFF_UP) 1679 wb_init_locked(sc); 1680 WB_UNLOCK(sc); 1681 1682 return(0); 1683} 1684 1685/* 1686 * Report current media status. 1687 */ 1688static void 1689wb_ifmedia_sts(ifp, ifmr) 1690 struct ifnet *ifp; 1691 struct ifmediareq *ifmr; 1692{ 1693 struct wb_softc *sc; 1694 struct mii_data *mii; 1695 1696 sc = ifp->if_softc; 1697 1698 WB_LOCK(sc); 1699 mii = device_get_softc(sc->wb_miibus); 1700 1701 mii_pollstat(mii); 1702 ifmr->ifm_active = mii->mii_media_active; 1703 ifmr->ifm_status = mii->mii_media_status; 1704 WB_UNLOCK(sc); 1705 1706 return; 1707} 1708 1709static int 1710wb_ioctl(ifp, command, data) 1711 struct ifnet *ifp; 1712 u_long command; 1713 caddr_t data; 1714{ 1715 struct wb_softc *sc = ifp->if_softc; 1716 struct mii_data *mii; 1717 struct ifreq *ifr = (struct ifreq *) data; 1718 int error = 0; 1719 1720 switch(command) { 1721 case SIOCSIFFLAGS: 1722 WB_LOCK(sc); 1723 if (ifp->if_flags & IFF_UP) { 1724 wb_init_locked(sc); 1725 } else { 1726 if (ifp->if_drv_flags & IFF_DRV_RUNNING) 1727 wb_stop(sc); 1728 } 1729 WB_UNLOCK(sc); 1730 error = 0; 1731 break; 1732 case SIOCADDMULTI: 1733 case SIOCDELMULTI: 1734 WB_LOCK(sc); 1735 wb_setmulti(sc); 1736 WB_UNLOCK(sc); 1737 error = 0; 1738 break; 1739 case SIOCGIFMEDIA: 1740 case SIOCSIFMEDIA: 1741 mii = device_get_softc(sc->wb_miibus); 1742 error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command); 1743 break; 1744 default: 1745 error = ether_ioctl(ifp, command, data); 1746 break; 1747 } 1748 1749 return(error); 1750} 1751 1752static void 1753wb_watchdog(sc) 1754 struct wb_softc *sc; 1755{ 1756 struct ifnet *ifp; 1757 1758 WB_LOCK_ASSERT(sc); 1759 ifp = sc->wb_ifp; 1760 ifp->if_oerrors++; 1761 if_printf(ifp, "watchdog timeout\n"); 1762#ifdef foo 1763 if (!(wb_phy_readreg(sc, PHY_BMSR) & PHY_BMSR_LINKSTAT)) 1764 if_printf(ifp, "no carrier - transceiver cable problem?\n"); 1765#endif 1766 wb_stop(sc); 1767 wb_reset(sc); 1768 wb_init_locked(sc); 1769 1770 if (ifp->if_snd.ifq_head != NULL) 1771 wb_start_locked(ifp); 1772 1773 return; 1774} 1775 1776/* 1777 * Stop the adapter and free any mbufs allocated to the 1778 * RX and TX lists. 1779 */ 1780static void 1781wb_stop(sc) 1782 struct wb_softc *sc; 1783{ 1784 register int i; 1785 struct ifnet *ifp; 1786 1787 WB_LOCK_ASSERT(sc); 1788 ifp = sc->wb_ifp; 1789 sc->wb_timer = 0; 1790 1791 callout_stop(&sc->wb_stat_callout); 1792 1793 WB_CLRBIT(sc, WB_NETCFG, (WB_NETCFG_RX_ON|WB_NETCFG_TX_ON)); 1794 CSR_WRITE_4(sc, WB_IMR, 0x00000000); 1795 CSR_WRITE_4(sc, WB_TXADDR, 0x00000000); 1796 CSR_WRITE_4(sc, WB_RXADDR, 0x00000000); 1797 1798 /* 1799 * Free data in the RX lists. 1800 */ 1801 for (i = 0; i < WB_RX_LIST_CNT; i++) { 1802 if (sc->wb_cdata.wb_rx_chain[i].wb_mbuf != NULL) { 1803 m_freem(sc->wb_cdata.wb_rx_chain[i].wb_mbuf); 1804 sc->wb_cdata.wb_rx_chain[i].wb_mbuf = NULL; 1805 } 1806 } 1807 bzero((char *)&sc->wb_ldata->wb_rx_list, 1808 sizeof(sc->wb_ldata->wb_rx_list)); 1809 1810 /* 1811 * Free the TX list buffers. 1812 */ 1813 for (i = 0; i < WB_TX_LIST_CNT; i++) { 1814 if (sc->wb_cdata.wb_tx_chain[i].wb_mbuf != NULL) { 1815 m_freem(sc->wb_cdata.wb_tx_chain[i].wb_mbuf); 1816 sc->wb_cdata.wb_tx_chain[i].wb_mbuf = NULL; 1817 } 1818 } 1819 1820 bzero((char *)&sc->wb_ldata->wb_tx_list, 1821 sizeof(sc->wb_ldata->wb_tx_list)); 1822 1823 ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE); 1824 1825 return; 1826} 1827 1828/* 1829 * Stop all chip I/O so that the kernel's probe routines don't 1830 * get confused by errant DMAs when rebooting. 1831 */ 1832static int 1833wb_shutdown(dev) 1834 device_t dev; 1835{ 1836 struct wb_softc *sc; 1837 1838 sc = device_get_softc(dev); 1839 1840 WB_LOCK(sc); 1841 wb_stop(sc); 1842 WB_UNLOCK(sc); 1843 1844 return (0); 1845} 1846