Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
fork

Configure Feed

Select the types of activity you want to include in your feed.

at v2.6.39-rc7 1923 lines 51 kB view raw
1/* 2 3 drivers/net/pci-skeleton.c 4 5 Maintained by Jeff Garzik <jgarzik@pobox.com> 6 7 Original code came from 8139too.c, which in turns was based 8 originally on Donald Becker's rtl8139.c driver, versions 1.11 9 and older. This driver was originally based on rtl8139.c 10 version 1.07. Header of rtl8139.c version 1.11: 11 12 -----<snip>----- 13 14 Written 1997-2000 by Donald Becker. 15 This software may be used and distributed according to the 16 terms of the GNU General Public License (GPL), incorporated 17 herein by reference. Drivers based on or derived from this 18 code fall under the GPL and must retain the authorship, 19 copyright and license notice. This file is not a complete 20 program and may only be used when the entire operating 21 system is licensed under the GPL. 22 23 This driver is for boards based on the RTL8129 and RTL8139 24 PCI ethernet chips. 25 26 The author may be reached as becker@scyld.com, or C/O Scyld 27 Computing Corporation 410 Severn Ave., Suite 210 Annapolis 28 MD 21403 29 30 Support and updates available at 31 http://www.scyld.com/network/rtl8139.html 32 33 Twister-tuning table provided by Kinston 34 <shangh@realtek.com.tw>. 35 36 -----<snip>----- 37 38 This software may be used and distributed according to the terms 39 of the GNU General Public License, incorporated herein by reference. 40 41 42----------------------------------------------------------------------------- 43 44 Theory of Operation 45 46I. Board Compatibility 47 48This device driver is designed for the RealTek RTL8139 series, the RealTek 49Fast Ethernet controllers for PCI and CardBus. This chip is used on many 50low-end boards, sometimes with its markings changed. 51 52 53II. Board-specific settings 54 55PCI bus devices are configured by the system at boot time, so no jumpers 56need to be set on the board. The system BIOS will assign the 57PCI INTA signal to a (preferably otherwise unused) system IRQ line. 58 59III. Driver operation 60 61IIIa. Rx Ring buffers 62 63The receive unit uses a single linear ring buffer rather than the more 64common (and more efficient) descriptor-based architecture. Incoming frames 65are sequentially stored into the Rx region, and the host copies them into 66skbuffs. 67 68Comment: While it is theoretically possible to process many frames in place, 69any delay in Rx processing would cause us to drop frames. More importantly, 70the Linux protocol stack is not designed to operate in this manner. 71 72IIIb. Tx operation 73 74The RTL8139 uses a fixed set of four Tx descriptors in register space. 75In a stunningly bad design choice, Tx frames must be 32 bit aligned. Linux 76aligns the IP header on word boundaries, and 14 byte ethernet header means 77that almost all frames will need to be copied to an alignment buffer. 78 79IVb. References 80 81http://www.realtek.com.tw/ 82http://www.scyld.com/expert/NWay.html 83 84IVc. Errata 85 86*/ 87 88#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 89 90#include <linux/module.h> 91#include <linux/kernel.h> 92#include <linux/pci.h> 93#include <linux/init.h> 94#include <linux/ioport.h> 95#include <linux/netdevice.h> 96#include <linux/etherdevice.h> 97#include <linux/delay.h> 98#include <linux/ethtool.h> 99#include <linux/mii.h> 100#include <linux/crc32.h> 101#include <linux/io.h> 102 103#define NETDRV_VERSION "1.0.1" 104#define MODNAME "netdrv" 105#define NETDRV_DRIVER_LOAD_MSG "MyVendor Fast Ethernet driver " NETDRV_VERSION " loaded" 106 107static char version[] __devinitdata = 108 KERN_INFO NETDRV_DRIVER_LOAD_MSG "\n" 109 " Support available from http://foo.com/bar/baz.html\n"; 110 111/* define to 1 to enable PIO instead of MMIO */ 112#undef USE_IO_OPS 113 114/* define to 1 to enable copious debugging info */ 115#undef NETDRV_DEBUG 116 117/* define to 1 to disable lightweight runtime debugging checks */ 118#undef NETDRV_NDEBUG 119 120 121#ifdef NETDRV_DEBUG 122/* note: prints function name for you */ 123#define DPRINTK(fmt, args...) \ 124 printk(KERN_DEBUG "%s: " fmt, __func__ , ## args) 125#else 126#define DPRINTK(fmt, args...) \ 127do { \ 128 if (0) \ 129 printk(KERN_DEBUG fmt, ##args); \ 130} while (0) 131#endif 132 133#ifdef NETDRV_NDEBUG 134#define assert(expr) do {} while (0) 135#else 136#define assert(expr) \ 137 if (!(expr)) { \ 138 printk("Assertion failed! %s,%s,%s,line=%d\n", \ 139 #expr, __FILE__, __func__, __LINE__); \ 140 } 141#endif 142 143 144/* A few user-configurable values. */ 145/* media options */ 146static int media[] = {-1, -1, -1, -1, -1, -1, -1, -1}; 147 148/* Maximum events (Rx packets, etc.) to handle at each interrupt. */ 149static int max_interrupt_work = 20; 150 151/* Maximum number of multicast addresses to filter (vs. Rx-all-multicast). 152 The RTL chips use a 64 element hash table based on the Ethernet CRC. */ 153static int multicast_filter_limit = 32; 154 155/* Size of the in-memory receive ring. */ 156#define RX_BUF_LEN_IDX 2 /* 0==8K, 1==16K, 2==32K, 3==64K */ 157#define RX_BUF_LEN (8192 << RX_BUF_LEN_IDX) 158#define RX_BUF_PAD 16 159#define RX_BUF_WRAP_PAD 2048 /* spare padding to handle lack of packet wrap */ 160#define RX_BUF_TOT_LEN (RX_BUF_LEN + RX_BUF_PAD + RX_BUF_WRAP_PAD) 161 162/* Number of Tx descriptor registers. */ 163#define NUM_TX_DESC 4 164 165/* max supported ethernet frame size -- must be at least (dev->mtu+14+4).*/ 166#define MAX_ETH_FRAME_SIZE 1536 167 168/* Size of the Tx bounce buffers -- must be at least (dev->mtu+14+4). */ 169#define TX_BUF_SIZE MAX_ETH_FRAME_SIZE 170#define TX_BUF_TOT_LEN (TX_BUF_SIZE * NUM_TX_DESC) 171 172/* PCI Tuning Parameters 173 Threshold is bytes transferred to chip before transmission starts. */ 174#define TX_FIFO_THRESH 256 /* In bytes, rounded down to 32 byte units. */ 175 176/* The following settings are log_2(bytes)-4: 177 0==16 bytes 1==32 2==64 3==128 4==256 5==512 6==1024 7==end of packet. 178*/ 179#define RX_FIFO_THRESH 6 /* Rx buffer level before first PCI xfer. */ 180#define RX_DMA_BURST 6 /* Maximum PCI burst, '6' is 1024 */ 181#define TX_DMA_BURST 6 /* Maximum PCI burst, '6' is 1024 */ 182 183 184/* Operational parameters that usually are not changed. */ 185/* Time in jiffies before concluding the transmitter is hung. */ 186#define TX_TIMEOUT (6 * HZ) 187 188enum { 189 HAS_CHIP_XCVR = 0x020000, 190 HAS_LNK_CHNG = 0x040000, 191}; 192 193#define NETDRV_MIN_IO_SIZE 0x80 194#define RTL8139B_IO_SIZE 256 195 196#define NETDRV_CAPS (HAS_CHIP_XCVR | HAS_LNK_CHNG) 197 198typedef enum { 199 RTL8139 = 0, 200 NETDRV_CB, 201 SMC1211TX, 202 /*MPX5030,*/ 203 DELTA8139, 204 ADDTRON8139, 205} board_t; 206 207 208/* indexed by board_t, above */ 209static struct { 210 const char *name; 211} board_info[] __devinitdata = { 212 { "RealTek RTL8139 Fast Ethernet" }, 213 { "RealTek RTL8139B PCI/CardBus" }, 214 { "SMC1211TX EZCard 10/100 (RealTek RTL8139)" }, 215/* { MPX5030, "Accton MPX5030 (RealTek RTL8139)" },*/ 216 { "Delta Electronics 8139 10/100BaseTX" }, 217 { "Addtron Technology 8139 10/100BaseTX" }, 218}; 219 220 221static DEFINE_PCI_DEVICE_TABLE(netdrv_pci_tbl) = { 222 {0x10ec, 0x8139, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 }, 223 {0x10ec, 0x8138, PCI_ANY_ID, PCI_ANY_ID, 0, 0, NETDRV_CB }, 224 {0x1113, 0x1211, PCI_ANY_ID, PCI_ANY_ID, 0, 0, SMC1211TX }, 225/* {0x1113, 0x1211, PCI_ANY_ID, PCI_ANY_ID, 0, 0, MPX5030 },*/ 226 {0x1500, 0x1360, PCI_ANY_ID, PCI_ANY_ID, 0, 0, DELTA8139 }, 227 {0x4033, 0x1360, PCI_ANY_ID, PCI_ANY_ID, 0, 0, ADDTRON8139 }, 228 {0,} 229}; 230MODULE_DEVICE_TABLE(pci, netdrv_pci_tbl); 231 232 233/* The rest of these values should never change. */ 234 235/* Symbolic offsets to registers. */ 236enum NETDRV_registers { 237 MAC0 = 0, /* Ethernet hardware address. */ 238 MAR0 = 8, /* Multicast filter. */ 239 TxStatus0 = 0x10, /* Transmit status (Four 32bit registers). */ 240 TxAddr0 = 0x20, /* Tx descriptors (also four 32bit). */ 241 RxBuf = 0x30, 242 RxEarlyCnt = 0x34, 243 RxEarlyStatus = 0x36, 244 ChipCmd = 0x37, 245 RxBufPtr = 0x38, 246 RxBufAddr = 0x3A, 247 IntrMask = 0x3C, 248 IntrStatus = 0x3E, 249 TxConfig = 0x40, 250 ChipVersion = 0x43, 251 RxConfig = 0x44, 252 Timer = 0x48, /* A general-purpose counter. */ 253 RxMissed = 0x4C, /* 24 bits valid, write clears. */ 254 Cfg9346 = 0x50, 255 Config0 = 0x51, 256 Config1 = 0x52, 257 FlashReg = 0x54, 258 MediaStatus = 0x58, 259 Config3 = 0x59, 260 Config4 = 0x5A, /* absent on RTL-8139A */ 261 HltClk = 0x5B, 262 MultiIntr = 0x5C, 263 TxSummary = 0x60, 264 BasicModeCtrl = 0x62, 265 BasicModeStatus = 0x64, 266 NWayAdvert = 0x66, 267 NWayLPAR = 0x68, 268 NWayExpansion = 0x6A, 269 /* Undocumented registers, but required for proper operation. */ 270 FIFOTMS = 0x70, /* FIFO Control and test. */ 271 CSCR = 0x74, /* Chip Status and Configuration Register. */ 272 PARA78 = 0x78, 273 PARA7c = 0x7c, /* Magic transceiver parameter register. */ 274 Config5 = 0xD8, /* absent on RTL-8139A */ 275}; 276 277enum ClearBitMasks { 278 MultiIntrClear = 0xF000, 279 ChipCmdClear = 0xE2, 280 Config1Clear = (1 << 7) | (1 << 6) | (1 << 3) | (1 << 2) | (1 << 1), 281}; 282 283enum ChipCmdBits { 284 CmdReset = 0x10, 285 CmdRxEnb = 0x08, 286 CmdTxEnb = 0x04, 287 RxBufEmpty = 0x01, 288}; 289 290/* Interrupt register bits, using my own meaningful names. */ 291enum IntrStatusBits { 292 PCIErr = 0x8000, 293 PCSTimeout = 0x4000, 294 RxFIFOOver = 0x40, 295 RxUnderrun = 0x20, 296 RxOverflow = 0x10, 297 TxErr = 0x08, 298 TxOK = 0x04, 299 RxErr = 0x02, 300 RxOK = 0x01, 301}; 302enum TxStatusBits { 303 TxHostOwns = 0x2000, 304 TxUnderrun = 0x4000, 305 TxStatOK = 0x8000, 306 TxOutOfWindow = 0x20000000, 307 TxAborted = 0x40000000, 308 TxCarrierLost = 0x80000000, 309}; 310enum RxStatusBits { 311 RxMulticast = 0x8000, 312 RxPhysical = 0x4000, 313 RxBroadcast = 0x2000, 314 RxBadSymbol = 0x0020, 315 RxRunt = 0x0010, 316 RxTooLong = 0x0008, 317 RxCRCErr = 0x0004, 318 RxBadAlign = 0x0002, 319 RxStatusOK = 0x0001, 320}; 321 322/* Bits in RxConfig. */ 323enum rx_mode_bits { 324 AcceptErr = 0x20, 325 AcceptRunt = 0x10, 326 AcceptBroadcast = 0x08, 327 AcceptMulticast = 0x04, 328 AcceptMyPhys = 0x02, 329 AcceptAllPhys = 0x01, 330}; 331 332/* Bits in TxConfig. */ 333enum tx_config_bits { 334 TxIFG1 = (1 << 25), /* Interframe Gap Time */ 335 TxIFG0 = (1 << 24), /* Enabling these bits violates IEEE 802.3 */ 336 TxLoopBack = (1 << 18) | (1 << 17), /* enable loopback test mode */ 337 TxCRC = (1 << 16), /* DISABLE appending CRC to end of Tx packets */ 338 TxClearAbt = (1 << 0), /* Clear abort (WO) */ 339 TxDMAShift = 8, /* DMA burst value(0-7) is shift this many bits */ 340 341 TxVersionMask = 0x7C800000, /* mask out version bits 30-26, 23 */ 342}; 343 344/* Bits in Config1 */ 345enum Config1Bits { 346 Cfg1_PM_Enable = 0x01, 347 Cfg1_VPD_Enable = 0x02, 348 Cfg1_PIO = 0x04, 349 Cfg1_MMIO = 0x08, 350 Cfg1_LWAKE = 0x10, 351 Cfg1_Driver_Load = 0x20, 352 Cfg1_LED0 = 0x40, 353 Cfg1_LED1 = 0x80, 354}; 355 356enum RxConfigBits { 357 /* Early Rx threshold, none or X/16 */ 358 RxCfgEarlyRxNone = 0, 359 RxCfgEarlyRxShift = 24, 360 361 /* rx fifo threshold */ 362 RxCfgFIFOShift = 13, 363 RxCfgFIFONone = (7 << RxCfgFIFOShift), 364 365 /* Max DMA burst */ 366 RxCfgDMAShift = 8, 367 RxCfgDMAUnlimited = (7 << RxCfgDMAShift), 368 369 /* rx ring buffer length */ 370 RxCfgRcv8K = 0, 371 RxCfgRcv16K = (1 << 11), 372 RxCfgRcv32K = (1 << 12), 373 RxCfgRcv64K = (1 << 11) | (1 << 12), 374 375 /* Disable packet wrap at end of Rx buffer */ 376 RxNoWrap = (1 << 7), 377}; 378 379 380/* Twister tuning parameters from RealTek. 381 Completely undocumented, but required to tune bad links. */ 382enum CSCRBits { 383 CSCR_LinkOKBit = 0x0400, 384 CSCR_LinkChangeBit = 0x0800, 385 CSCR_LinkStatusBits = 0x0f000, 386 CSCR_LinkDownOffCmd = 0x003c0, 387 CSCR_LinkDownCmd = 0x0f3c0, 388}; 389 390 391enum Cfg9346Bits { 392 Cfg9346_Lock = 0x00, 393 Cfg9346_Unlock = 0xC0, 394}; 395 396 397#define PARA78_default 0x78fa8388 398#define PARA7c_default 0xcb38de43 /* param[0][3] */ 399#define PARA7c_xxx 0xcb38de43 400static const unsigned long param[4][4] = { 401 {0xcb39de43, 0xcb39ce43, 0xfb38de03, 0xcb38de43}, 402 {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83}, 403 {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83}, 404 {0xbb39de43, 0xbb39ce43, 0xbb39ce83, 0xbb39ce83} 405}; 406 407struct ring_info { 408 struct sk_buff *skb; 409 dma_addr_t mapping; 410}; 411 412 413typedef enum { 414 CH_8139 = 0, 415 CH_8139_K, 416 CH_8139A, 417 CH_8139B, 418 CH_8130, 419 CH_8139C, 420} chip_t; 421 422 423/* directly indexed by chip_t, above */ 424static const struct { 425 const char *name; 426 u8 version; /* from RTL8139C docs */ 427 u32 RxConfigMask; /* should clear the bits supported by this chip */ 428} rtl_chip_info[] = { 429 { "RTL-8139", 430 0x40, 431 0xf0fe0040, /* XXX copied from RTL8139A, verify */ 432 }, 433 434 { "RTL-8139 rev K", 435 0x60, 436 0xf0fe0040, 437 }, 438 439 { "RTL-8139A", 440 0x70, 441 0xf0fe0040, 442 }, 443 444 { "RTL-8139B", 445 0x78, 446 0xf0fc0040 447 }, 448 449 { "RTL-8130", 450 0x7C, 451 0xf0fe0040, /* XXX copied from RTL8139A, verify */ 452 }, 453 454 { "RTL-8139C", 455 0x74, 456 0xf0fc0040, /* XXX copied from RTL8139B, verify */ 457 }, 458 459}; 460 461 462struct netdrv_private { 463 board_t board; 464 void *mmio_addr; 465 int drv_flags; 466 struct pci_dev *pci_dev; 467 struct timer_list timer; /* Media selection timer. */ 468 unsigned char *rx_ring; 469 unsigned int cur_rx; /* Index into the Rx buffer of next Rx pkt. */ 470 unsigned int tx_flag; 471 atomic_t cur_tx; 472 atomic_t dirty_tx; 473 /* The saved address of a sent-in-place packet/buffer, for skfree(). */ 474 struct ring_info tx_info[NUM_TX_DESC]; 475 unsigned char *tx_buf[NUM_TX_DESC]; /* Tx bounce buffers */ 476 unsigned char *tx_bufs; /* Tx bounce buffer region. */ 477 dma_addr_t rx_ring_dma; 478 dma_addr_t tx_bufs_dma; 479 char phys[4]; /* MII device addresses. */ 480 char twistie, twist_row, twist_col; /* Twister tune state. */ 481 unsigned int full_duplex:1; /* Full-duplex operation requested. */ 482 unsigned int duplex_lock:1; 483 unsigned int default_port:4; /* Last dev->if_port value. */ 484 unsigned int media2:4; /* Secondary monitored media port. */ 485 unsigned int medialock:1; /* Don't sense media type. */ 486 unsigned int mediasense:1; /* Media sensing in progress. */ 487 spinlock_t lock; 488 chip_t chipset; 489}; 490 491MODULE_AUTHOR("Jeff Garzik <jgarzik@pobox.com>"); 492MODULE_DESCRIPTION("Skeleton for a PCI Fast Ethernet driver"); 493MODULE_LICENSE("GPL"); 494module_param(multicast_filter_limit, int, 0); 495module_param(max_interrupt_work, int, 0); 496module_param_array(media, int, NULL, 0); 497MODULE_PARM_DESC(multicast_filter_limit, 498 MODNAME " maximum number of filtered multicast addresses"); 499MODULE_PARM_DESC(max_interrupt_work, 500 MODNAME " maximum events handled per interrupt"); 501MODULE_PARM_DESC(media, 502 MODNAME " Bits 0-3: media type, bit 17: full duplex"); 503 504static int read_eeprom(void *ioaddr, int location, int addr_len); 505static int netdrv_open(struct net_device *dev); 506static int mdio_read(struct net_device *dev, int phy_id, int location); 507static void mdio_write(struct net_device *dev, int phy_id, int location, 508 int val); 509static void netdrv_timer(unsigned long data); 510static void netdrv_tx_timeout(struct net_device *dev); 511static void netdrv_init_ring(struct net_device *dev); 512static int netdrv_start_xmit(struct sk_buff *skb, 513 struct net_device *dev); 514static irqreturn_t netdrv_interrupt(int irq, void *dev_instance); 515static int netdrv_close(struct net_device *dev); 516static int netdrv_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); 517static void netdrv_set_rx_mode(struct net_device *dev); 518static void netdrv_hw_start(struct net_device *dev); 519 520 521#ifdef USE_IO_OPS 522 523#define NETDRV_R8(reg) inb(((unsigned long)ioaddr) + (reg)) 524#define NETDRV_R16(reg) inw(((unsigned long)ioaddr) + (reg)) 525#define NETDRV_R32(reg) ((unsigned long)inl(((unsigned long)ioaddr) + (reg))) 526#define NETDRV_W8(reg, val8) outb((val8), ((unsigned long)ioaddr) + (reg)) 527#define NETDRV_W16(reg, val16) outw((val16), ((unsigned long)ioaddr) + (reg)) 528#define NETDRV_W32(reg, val32) outl((val32), ((unsigned long)ioaddr) + (reg)) 529#define NETDRV_W8_F NETDRV_W8 530#define NETDRV_W16_F NETDRV_W16 531#define NETDRV_W32_F NETDRV_W32 532#undef readb 533#undef readw 534#undef readl 535#undef writeb 536#undef writew 537#undef writel 538#define readb(addr) inb((unsigned long)(addr)) 539#define readw(addr) inw((unsigned long)(addr)) 540#define readl(addr) inl((unsigned long)(addr)) 541#define writeb(val, addr) outb((val), (unsigned long)(addr)) 542#define writew(val, addr) outw((val), (unsigned long)(addr)) 543#define writel(val, addr) outl((val), (unsigned long)(addr)) 544 545#else 546 547/* write MMIO register, with flush */ 548/* Flush avoids rtl8139 bug w/ posted MMIO writes */ 549#define NETDRV_W8_F(reg, val8) \ 550do { \ 551 writeb((val8), ioaddr + (reg)); \ 552 readb(ioaddr + (reg)); \ 553} while (0) 554#define NETDRV_W16_F(reg, val16) \ 555do { \ 556 writew((val16), ioaddr + (reg)); \ 557 readw(ioaddr + (reg)); \ 558} while (0) 559#define NETDRV_W32_F(reg, val32) \ 560do { \ 561 writel((val32), ioaddr + (reg)); \ 562 readl(ioaddr + (reg)); \ 563} while (0) 564 565 566#ifdef MMIO_FLUSH_AUDIT_COMPLETE 567 568/* write MMIO register */ 569#define NETDRV_W8(reg, val8) writeb((val8), ioaddr + (reg)) 570#define NETDRV_W16(reg, val16) writew((val16), ioaddr + (reg)) 571#define NETDRV_W32(reg, val32) writel((val32), ioaddr + (reg)) 572 573#else 574 575/* write MMIO register, then flush */ 576#define NETDRV_W8 NETDRV_W8_F 577#define NETDRV_W16 NETDRV_W16_F 578#define NETDRV_W32 NETDRV_W32_F 579 580#endif /* MMIO_FLUSH_AUDIT_COMPLETE */ 581 582/* read MMIO register */ 583#define NETDRV_R8(reg) readb(ioaddr + (reg)) 584#define NETDRV_R16(reg) readw(ioaddr + (reg)) 585#define NETDRV_R32(reg) ((unsigned long) readl(ioaddr + (reg))) 586 587#endif /* USE_IO_OPS */ 588 589 590static const u16 netdrv_intr_mask = 591 PCIErr | PCSTimeout | RxUnderrun | RxOverflow | RxFIFOOver | 592 TxErr | TxOK | RxErr | RxOK; 593 594static const unsigned int netdrv_rx_config = 595 RxCfgEarlyRxNone | RxCfgRcv32K | RxNoWrap | 596 (RX_FIFO_THRESH << RxCfgFIFOShift) | 597 (RX_DMA_BURST << RxCfgDMAShift); 598 599 600static int __devinit netdrv_init_board(struct pci_dev *pdev, 601 struct net_device **dev_out, 602 void **ioaddr_out) 603{ 604 void *ioaddr = NULL; 605 struct net_device *dev; 606 struct netdrv_private *tp; 607 int rc, i; 608 u32 pio_start, pio_end, pio_flags, pio_len; 609 unsigned long mmio_start, mmio_end, mmio_flags, mmio_len; 610 u32 tmp; 611 612 DPRINTK("ENTER\n"); 613 614 assert(pdev != NULL); 615 assert(ioaddr_out != NULL); 616 617 *ioaddr_out = NULL; 618 *dev_out = NULL; 619 620 /* dev zeroed in alloc_etherdev */ 621 dev = alloc_etherdev(sizeof(*tp)); 622 if (dev == NULL) { 623 dev_err(&pdev->dev, "unable to alloc new ethernet\n"); 624 DPRINTK("EXIT, returning -ENOMEM\n"); 625 return -ENOMEM; 626 } 627 SET_NETDEV_DEV(dev, &pdev->dev); 628 tp = netdev_priv(dev); 629 630 /* enable device(incl. PCI PM wakeup), and bus-mastering */ 631 rc = pci_enable_device(pdev); 632 if (rc) 633 goto err_out; 634 635 pio_start = pci_resource_start(pdev, 0); 636 pio_end = pci_resource_end(pdev, 0); 637 pio_flags = pci_resource_flags(pdev, 0); 638 pio_len = pci_resource_len(pdev, 0); 639 640 mmio_start = pci_resource_start(pdev, 1); 641 mmio_end = pci_resource_end(pdev, 1); 642 mmio_flags = pci_resource_flags(pdev, 1); 643 mmio_len = pci_resource_len(pdev, 1); 644 645 /* set this immediately, we need to know before 646 * we talk to the chip directly */ 647 DPRINTK("PIO region size == %#02X\n", pio_len); 648 DPRINTK("MMIO region size == %#02lX\n", mmio_len); 649 650 /* make sure PCI base addr 0 is PIO */ 651 if (!(pio_flags & IORESOURCE_IO)) { 652 dev_err(&pdev->dev, "region #0 not a PIO resource, aborting\n"); 653 rc = -ENODEV; 654 goto err_out; 655 } 656 657 /* make sure PCI base addr 1 is MMIO */ 658 if (!(mmio_flags & IORESOURCE_MEM)) { 659 dev_err(&pdev->dev, "region #1 not an MMIO resource, aborting\n"); 660 rc = -ENODEV; 661 goto err_out; 662 } 663 664 /* check for weird/broken PCI region reporting */ 665 if ((pio_len < NETDRV_MIN_IO_SIZE) || 666 (mmio_len < NETDRV_MIN_IO_SIZE)) { 667 dev_err(&pdev->dev, "Invalid PCI region size(s), aborting\n"); 668 rc = -ENODEV; 669 goto err_out; 670 } 671 672 rc = pci_request_regions(pdev, MODNAME); 673 if (rc) 674 goto err_out; 675 676 pci_set_master(pdev); 677 678#ifdef USE_IO_OPS 679 ioaddr = (void *)pio_start; 680#else 681 /* ioremap MMIO region */ 682 ioaddr = ioremap(mmio_start, mmio_len); 683 if (ioaddr == NULL) { 684 dev_err(&pdev->dev, "cannot remap MMIO, aborting\n"); 685 rc = -EIO; 686 goto err_out_free_res; 687 } 688#endif /* USE_IO_OPS */ 689 690 /* Soft reset the chip. */ 691 NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | CmdReset); 692 693 /* Check that the chip has finished the reset. */ 694 for (i = 1000; i > 0; i--) 695 if ((NETDRV_R8(ChipCmd) & CmdReset) == 0) 696 break; 697 else 698 udelay(10); 699 700 /* Bring the chip out of low-power mode. */ 701 /* <insert device-specific code here> */ 702 703#ifndef USE_IO_OPS 704 /* sanity checks -- ensure PIO and MMIO registers agree */ 705 assert(inb(pio_start+Config0) == readb(ioaddr+Config0)); 706 assert(inb(pio_start+Config1) == readb(ioaddr+Config1)); 707 assert(inb(pio_start+TxConfig) == readb(ioaddr+TxConfig)); 708 assert(inb(pio_start+RxConfig) == readb(ioaddr+RxConfig)); 709#endif /* !USE_IO_OPS */ 710 711 /* identify chip attached to board */ 712 tmp = NETDRV_R8(ChipVersion); 713 for (i = ARRAY_SIZE(rtl_chip_info) - 1; i >= 0; i--) 714 if (tmp == rtl_chip_info[i].version) { 715 tp->chipset = i; 716 goto match; 717 } 718 719 /* if unknown chip, assume array element #0, original RTL-8139 in this case */ 720 dev_printk(KERN_DEBUG, &pdev->dev, 721 "unknown chip version, assuming RTL-8139\n"); 722 dev_printk(KERN_DEBUG, &pdev->dev, "TxConfig = %#lx\n", 723 NETDRV_R32(TxConfig)); 724 tp->chipset = 0; 725 726match: 727 DPRINTK("chipset id(%d) == index %d, '%s'\n", 728 tmp, tp->chipset, rtl_chip_info[tp->chipset].name); 729 730 rc = register_netdev(dev); 731 if (rc) 732 goto err_out_unmap; 733 734 DPRINTK("EXIT, returning 0\n"); 735 *ioaddr_out = ioaddr; 736 *dev_out = dev; 737 return 0; 738 739err_out_unmap: 740#ifndef USE_IO_OPS 741 iounmap(ioaddr); 742err_out_free_res: 743#endif 744 pci_release_regions(pdev); 745err_out: 746 free_netdev(dev); 747 DPRINTK("EXIT, returning %d\n", rc); 748 return rc; 749} 750 751static const struct net_device_ops netdrv_netdev_ops = { 752 .ndo_open = netdrv_open, 753 .ndo_stop = netdrv_close, 754 .ndo_start_xmit = netdrv_start_xmit, 755 .ndo_set_multicast_list = netdrv_set_rx_mode, 756 .ndo_do_ioctl = netdrv_ioctl, 757 .ndo_tx_timeout = netdrv_tx_timeout, 758 .ndo_change_mtu = eth_change_mtu, 759 .ndo_validate_addr = eth_validate_addr, 760 .ndo_set_mac_address = eth_mac_addr, 761}; 762 763static int __devinit netdrv_init_one(struct pci_dev *pdev, 764 const struct pci_device_id *ent) 765{ 766 struct net_device *dev = NULL; 767 struct netdrv_private *tp; 768 int i, addr_len, option; 769 void *ioaddr = NULL; 770 static int board_idx = -1; 771 772/* when built into the kernel, we only print version if device is found */ 773#ifndef MODULE 774 static int printed_version; 775 if (!printed_version++) 776 printk(version); 777#endif 778 779 DPRINTK("ENTER\n"); 780 781 assert(pdev != NULL); 782 assert(ent != NULL); 783 784 board_idx++; 785 786 i = netdrv_init_board(pdev, &dev, &ioaddr); 787 if (i < 0) { 788 DPRINTK("EXIT, returning %d\n", i); 789 return i; 790 } 791 792 tp = netdev_priv(dev); 793 794 assert(ioaddr != NULL); 795 assert(dev != NULL); 796 assert(tp != NULL); 797 798 addr_len = read_eeprom(ioaddr, 0, 8) == 0x8129 ? 8 : 6; 799 for (i = 0; i < 3; i++) 800 ((u16 *)(dev->dev_addr))[i] = 801 le16_to_cpu(read_eeprom(ioaddr, i + 7, addr_len)); 802 803 dev->netdev_ops = &netdrv_netdev_ops; 804 dev->watchdog_timeo = TX_TIMEOUT; 805 806 dev->irq = pdev->irq; 807 dev->base_addr = (unsigned long) ioaddr; 808 809 /* netdev_priv()/tp zeroed and aligned in alloc_etherdev */ 810 tp = netdev_priv(dev); 811 812 /* note: tp->chipset set in netdrv_init_board */ 813 tp->drv_flags = PCI_COMMAND_IO | PCI_COMMAND_MEMORY | 814 PCI_COMMAND_MASTER | NETDRV_CAPS; 815 tp->pci_dev = pdev; 816 tp->board = ent->driver_data; 817 tp->mmio_addr = ioaddr; 818 spin_lock_init(&tp->lock); 819 820 pci_set_drvdata(pdev, dev); 821 822 tp->phys[0] = 32; 823 824 netdev_info(dev, "%s at %#lx, %pM IRQ %d\n", 825 board_info[ent->driver_data].name, 826 dev->base_addr, dev->dev_addr, dev->irq); 827 828 netdev_printk(KERN_DEBUG, dev, "Identified 8139 chip type '%s'\n", 829 rtl_chip_info[tp->chipset].name); 830 831 /* Put the chip into low-power mode. */ 832 NETDRV_W8_F(Cfg9346, Cfg9346_Unlock); 833 834 /* The lower four bits are the media type. */ 835 option = (board_idx > 7) ? 0 : media[board_idx]; 836 if (option > 0) { 837 tp->full_duplex = (option & 0x200) ? 1 : 0; 838 tp->default_port = option & 15; 839 if (tp->default_port) 840 tp->medialock = 1; 841 } 842 843 if (tp->full_duplex) { 844 netdev_info(dev, "Media type forced to Full Duplex\n"); 845 mdio_write(dev, tp->phys[0], MII_ADVERTISE, ADVERTISE_FULL); 846 tp->duplex_lock = 1; 847 } 848 849 DPRINTK("EXIT - returning 0\n"); 850 return 0; 851} 852 853 854static void __devexit netdrv_remove_one(struct pci_dev *pdev) 855{ 856 struct net_device *dev = pci_get_drvdata(pdev); 857 struct netdrv_private *np; 858 859 DPRINTK("ENTER\n"); 860 861 assert(dev != NULL); 862 863 np = netdev_priv(dev); 864 assert(np != NULL); 865 866 unregister_netdev(dev); 867 868#ifndef USE_IO_OPS 869 iounmap(np->mmio_addr); 870#endif /* !USE_IO_OPS */ 871 872 pci_release_regions(pdev); 873 874 free_netdev(dev); 875 876 pci_set_drvdata(pdev, NULL); 877 878 pci_disable_device(pdev); 879 880 DPRINTK("EXIT\n"); 881} 882 883 884/* Serial EEPROM section. */ 885 886/* EEPROM_Ctrl bits. */ 887#define EE_SHIFT_CLK 0x04 /* EEPROM shift clock. */ 888#define EE_CS 0x08 /* EEPROM chip select. */ 889#define EE_DATA_WRITE 0x02 /* EEPROM chip data in. */ 890#define EE_WRITE_0 0x00 891#define EE_WRITE_1 0x02 892#define EE_DATA_READ 0x01 /* EEPROM chip data out. */ 893#define EE_ENB (0x80 | EE_CS) 894 895/* Delay between EEPROM clock transitions. 896 No extra delay is needed with 33Mhz PCI, but 66Mhz may change this. 897*/ 898 899#define eeprom_delay() readl(ee_addr) 900 901/* The EEPROM commands include the alway-set leading bit. */ 902#define EE_WRITE_CMD (5) 903#define EE_READ_CMD (6) 904#define EE_ERASE_CMD (7) 905 906static int __devinit read_eeprom(void *ioaddr, int location, int addr_len) 907{ 908 int i; 909 unsigned retval = 0; 910 void *ee_addr = ioaddr + Cfg9346; 911 int read_cmd = location | (EE_READ_CMD << addr_len); 912 913 DPRINTK("ENTER\n"); 914 915 writeb(EE_ENB & ~EE_CS, ee_addr); 916 writeb(EE_ENB, ee_addr); 917 eeprom_delay(); 918 919 /* Shift the read command bits out. */ 920 for (i = 4 + addr_len; i >= 0; i--) { 921 int dataval = (read_cmd & (1 << i)) ? EE_DATA_WRITE : 0; 922 writeb(EE_ENB | dataval, ee_addr); 923 eeprom_delay(); 924 writeb(EE_ENB | dataval | EE_SHIFT_CLK, ee_addr); 925 eeprom_delay(); 926 } 927 writeb(EE_ENB, ee_addr); 928 eeprom_delay(); 929 930 for (i = 16; i > 0; i--) { 931 writeb(EE_ENB | EE_SHIFT_CLK, ee_addr); 932 eeprom_delay(); 933 retval = 934 (retval << 1) | ((readb(ee_addr) & EE_DATA_READ) ? 1 : 935 0); 936 writeb(EE_ENB, ee_addr); 937 eeprom_delay(); 938 } 939 940 /* Terminate the EEPROM access. */ 941 writeb(~EE_CS, ee_addr); 942 eeprom_delay(); 943 944 DPRINTK("EXIT - returning %d\n", retval); 945 return retval; 946} 947 948/* MII serial management: mostly bogus for now. */ 949/* Read and write the MII management registers using software-generated 950 serial MDIO protocol. 951 The maximum data clock rate is 2.5 Mhz. The minimum timing is usually 952 met by back-to-back PCI I/O cycles, but we insert a delay to avoid 953 "overclocking" issues. */ 954#define MDIO_DIR 0x80 955#define MDIO_DATA_OUT 0x04 956#define MDIO_DATA_IN 0x02 957#define MDIO_CLK 0x01 958#define MDIO_WRITE0 (MDIO_DIR) 959#define MDIO_WRITE1 (MDIO_DIR | MDIO_DATA_OUT) 960 961#define mdio_delay() readb(mdio_addr) 962 963 964static char mii_2_8139_map[8] = { 965 BasicModeCtrl, 966 BasicModeStatus, 967 0, 968 0, 969 NWayAdvert, 970 NWayLPAR, 971 NWayExpansion, 972 0 973}; 974 975 976/* Syncronize the MII management interface by shifting 32 one bits out. */ 977static void mdio_sync(void *mdio_addr) 978{ 979 int i; 980 981 DPRINTK("ENTER\n"); 982 983 for (i = 32; i >= 0; i--) { 984 writeb(MDIO_WRITE1, mdio_addr); 985 mdio_delay(); 986 writeb(MDIO_WRITE1 | MDIO_CLK, mdio_addr); 987 mdio_delay(); 988 } 989 990 DPRINTK("EXIT\n"); 991} 992 993 994static int mdio_read(struct net_device *dev, int phy_id, int location) 995{ 996 struct netdrv_private *tp = netdev_priv(dev); 997 void *mdio_addr = tp->mmio_addr + Config4; 998 int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location; 999 int retval = 0; 1000 int i; 1001 1002 DPRINTK("ENTER\n"); 1003 1004 if (phy_id > 31) { /* Really a 8139. Use internal registers. */ 1005 DPRINTK("EXIT after directly using 8139 internal regs\n"); 1006 return location < 8 && mii_2_8139_map[location] ? 1007 readw(tp->mmio_addr + mii_2_8139_map[location]) : 0; 1008 } 1009 mdio_sync(mdio_addr); 1010 /* Shift the read command bits out. */ 1011 for (i = 15; i >= 0; i--) { 1012 int dataval = (mii_cmd & (1 << i)) ? MDIO_DATA_OUT : 0; 1013 1014 writeb(MDIO_DIR | dataval, mdio_addr); 1015 mdio_delay(); 1016 writeb(MDIO_DIR | dataval | MDIO_CLK, mdio_addr); 1017 mdio_delay(); 1018 } 1019 1020 /* Read the two transition, 16 data, and wire-idle bits. */ 1021 for (i = 19; i > 0; i--) { 1022 writeb(0, mdio_addr); 1023 mdio_delay(); 1024 retval = ((retval << 1) | ((readb(mdio_addr) & MDIO_DATA_IN)) 1025 ? 1 : 0); 1026 writeb(MDIO_CLK, mdio_addr); 1027 mdio_delay(); 1028 } 1029 1030 DPRINTK("EXIT, returning %d\n", (retval >> 1) & 0xffff); 1031 return (retval >> 1) & 0xffff; 1032} 1033 1034 1035static void mdio_write(struct net_device *dev, int phy_id, int location, 1036 int value) 1037{ 1038 struct netdrv_private *tp = netdev_priv(dev); 1039 void *mdio_addr = tp->mmio_addr + Config4; 1040 int mii_cmd = 1041 (0x5002 << 16) | (phy_id << 23) | (location << 18) | value; 1042 int i; 1043 1044 DPRINTK("ENTER\n"); 1045 1046 if (phy_id > 31) { /* Really a 8139. Use internal registers. */ 1047 if (location < 8 && mii_2_8139_map[location]) { 1048 writew(value, 1049 tp->mmio_addr + mii_2_8139_map[location]); 1050 readw(tp->mmio_addr + mii_2_8139_map[location]); 1051 } 1052 DPRINTK("EXIT after directly using 8139 internal regs\n"); 1053 return; 1054 } 1055 mdio_sync(mdio_addr); 1056 1057 /* Shift the command bits out. */ 1058 for (i = 31; i >= 0; i--) { 1059 int dataval = 1060 (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0; 1061 writeb(dataval, mdio_addr); 1062 mdio_delay(); 1063 writeb(dataval | MDIO_CLK, mdio_addr); 1064 mdio_delay(); 1065 } 1066 1067 /* Clear out extra bits. */ 1068 for (i = 2; i > 0; i--) { 1069 writeb(0, mdio_addr); 1070 mdio_delay(); 1071 writeb(MDIO_CLK, mdio_addr); 1072 mdio_delay(); 1073 } 1074 1075 DPRINTK("EXIT\n"); 1076} 1077 1078 1079static int netdrv_open(struct net_device *dev) 1080{ 1081 struct netdrv_private *tp = netdev_priv(dev); 1082 int retval; 1083 void *ioaddr = tp->mmio_addr; 1084 1085 DPRINTK("ENTER\n"); 1086 1087 retval = request_irq(dev->irq, netdrv_interrupt, IRQF_SHARED, dev->name, dev); 1088 if (retval) { 1089 DPRINTK("EXIT, returning %d\n", retval); 1090 return retval; 1091 } 1092 1093 tp->tx_bufs = pci_alloc_consistent(tp->pci_dev, TX_BUF_TOT_LEN, 1094 &tp->tx_bufs_dma); 1095 tp->rx_ring = pci_alloc_consistent(tp->pci_dev, RX_BUF_TOT_LEN, 1096 &tp->rx_ring_dma); 1097 if (tp->tx_bufs == NULL || tp->rx_ring == NULL) { 1098 free_irq(dev->irq, dev); 1099 1100 if (tp->tx_bufs) 1101 pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN, 1102 tp->tx_bufs, tp->tx_bufs_dma); 1103 if (tp->rx_ring) 1104 pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN, 1105 tp->rx_ring, tp->rx_ring_dma); 1106 1107 DPRINTK("EXIT, returning -ENOMEM\n"); 1108 return -ENOMEM; 1109 1110 } 1111 1112 tp->full_duplex = tp->duplex_lock; 1113 tp->tx_flag = (TX_FIFO_THRESH << 11) & 0x003f0000; 1114 1115 netdrv_init_ring(dev); 1116 netdrv_hw_start(dev); 1117 1118 netdev_dbg(dev, "ioaddr %#llx IRQ %d GP Pins %02x %s-duplex\n", 1119 (unsigned long long)pci_resource_start(tp->pci_dev, 1), 1120 dev->irq, NETDRV_R8(MediaStatus), 1121 tp->full_duplex ? "full" : "half"); 1122 1123 /* Set the timer to switch to check for link beat and perhaps switch 1124 to an alternate media type. */ 1125 init_timer(&tp->timer); 1126 tp->timer.expires = jiffies + 3 * HZ; 1127 tp->timer.data = (unsigned long) dev; 1128 tp->timer.function = netdrv_timer; 1129 add_timer(&tp->timer); 1130 1131 DPRINTK("EXIT, returning 0\n"); 1132 return 0; 1133} 1134 1135 1136/* Start the hardware at open or resume. */ 1137static void netdrv_hw_start(struct net_device *dev) 1138{ 1139 struct netdrv_private *tp = netdev_priv(dev); 1140 void *ioaddr = tp->mmio_addr; 1141 u32 i; 1142 1143 DPRINTK("ENTER\n"); 1144 1145 /* Soft reset the chip. */ 1146 NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | CmdReset); 1147 udelay(100); 1148 1149 /* Check that the chip has finished the reset. */ 1150 for (i = 1000; i > 0; i--) 1151 if ((NETDRV_R8(ChipCmd) & CmdReset) == 0) 1152 break; 1153 1154 /* Restore our idea of the MAC address. */ 1155 NETDRV_W32_F(MAC0 + 0, cpu_to_le32(*(u32 *)(dev->dev_addr + 0))); 1156 NETDRV_W32_F(MAC0 + 4, cpu_to_le32(*(u32 *)(dev->dev_addr + 4))); 1157 1158 /* Must enable Tx/Rx before setting transfer thresholds! */ 1159 NETDRV_W8_F(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | 1160 CmdRxEnb | CmdTxEnb); 1161 1162 i = netdrv_rx_config | 1163 (NETDRV_R32(RxConfig) & rtl_chip_info[tp->chipset].RxConfigMask); 1164 NETDRV_W32_F(RxConfig, i); 1165 1166 /* Check this value: the documentation for IFG contradicts ifself. */ 1167 NETDRV_W32(TxConfig, (TX_DMA_BURST << TxDMAShift)); 1168 1169 /* unlock Config[01234] and BMCR register writes */ 1170 NETDRV_W8_F(Cfg9346, Cfg9346_Unlock); 1171 udelay(10); 1172 1173 tp->cur_rx = 0; 1174 1175 /* Lock Config[01234] and BMCR register writes */ 1176 NETDRV_W8_F(Cfg9346, Cfg9346_Lock); 1177 udelay(10); 1178 1179 /* init Rx ring buffer DMA address */ 1180 NETDRV_W32_F(RxBuf, tp->rx_ring_dma); 1181 1182 /* init Tx buffer DMA addresses */ 1183 for (i = 0; i < NUM_TX_DESC; i++) 1184 NETDRV_W32_F(TxAddr0 + (i * 4), tp->tx_bufs_dma + (tp->tx_buf[i] - tp->tx_bufs)); 1185 1186 NETDRV_W32_F(RxMissed, 0); 1187 1188 netdrv_set_rx_mode(dev); 1189 1190 /* no early-rx interrupts */ 1191 NETDRV_W16(MultiIntr, NETDRV_R16(MultiIntr) & MultiIntrClear); 1192 1193 /* make sure RxTx has started */ 1194 NETDRV_W8_F(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | 1195 CmdRxEnb | CmdTxEnb); 1196 1197 /* Enable all known interrupts by setting the interrupt mask. */ 1198 NETDRV_W16_F(IntrMask, netdrv_intr_mask); 1199 1200 netif_start_queue(dev); 1201 1202 DPRINTK("EXIT\n"); 1203} 1204 1205 1206/* Initialize the Rx and Tx rings, along with various 'dev' bits. */ 1207static void netdrv_init_ring(struct net_device *dev) 1208{ 1209 struct netdrv_private *tp = netdev_priv(dev); 1210 int i; 1211 1212 DPRINTK("ENTER\n"); 1213 1214 tp->cur_rx = 0; 1215 atomic_set(&tp->cur_tx, 0); 1216 atomic_set(&tp->dirty_tx, 0); 1217 1218 for (i = 0; i < NUM_TX_DESC; i++) { 1219 tp->tx_info[i].skb = NULL; 1220 tp->tx_info[i].mapping = 0; 1221 tp->tx_buf[i] = &tp->tx_bufs[i * TX_BUF_SIZE]; 1222 } 1223 1224 DPRINTK("EXIT\n"); 1225} 1226 1227 1228static void netdrv_timer(unsigned long data) 1229{ 1230 struct net_device *dev = (struct net_device *) data; 1231 struct netdrv_private *tp = netdev_priv(dev); 1232 void *ioaddr = tp->mmio_addr; 1233 int next_tick = 60 * HZ; 1234 int mii_lpa; 1235 1236 mii_lpa = mdio_read(dev, tp->phys[0], MII_LPA); 1237 1238 if (!tp->duplex_lock && mii_lpa != 0xffff) { 1239 int duplex = ((mii_lpa & LPA_100FULL) || 1240 (mii_lpa & 0x01C0) == 0x0040); 1241 if (tp->full_duplex != duplex) { 1242 tp->full_duplex = duplex; 1243 netdev_info(dev, "Setting %s-duplex based on MII #%d link partner ability of %04x\n", 1244 tp->full_duplex ? "full" : "half", 1245 tp->phys[0], mii_lpa); 1246 NETDRV_W8(Cfg9346, Cfg9346_Unlock); 1247 NETDRV_W8(Config1, tp->full_duplex ? 0x60 : 0x20); 1248 NETDRV_W8(Cfg9346, Cfg9346_Lock); 1249 } 1250 } 1251 1252 netdev_dbg(dev, "Media selection tick, Link partner %04x\n", 1253 NETDRV_R16(NWayLPAR)); 1254 netdev_dbg(dev, "Other registers are IntMask %04x IntStatus %04x RxStatus %04lx\n", 1255 NETDRV_R16(IntrMask), 1256 NETDRV_R16(IntrStatus), 1257 NETDRV_R32(RxEarlyStatus)); 1258 netdev_dbg(dev, "Chip config %02x %02x\n", 1259 NETDRV_R8(Config0), NETDRV_R8(Config1)); 1260 1261 tp->timer.expires = jiffies + next_tick; 1262 add_timer(&tp->timer); 1263} 1264 1265 1266static void netdrv_tx_clear(struct net_device *dev) 1267{ 1268 int i; 1269 struct netdrv_private *tp = netdev_priv(dev); 1270 1271 atomic_set(&tp->cur_tx, 0); 1272 atomic_set(&tp->dirty_tx, 0); 1273 1274 /* Dump the unsent Tx packets. */ 1275 for (i = 0; i < NUM_TX_DESC; i++) { 1276 struct ring_info *rp = &tp->tx_info[i]; 1277 if (rp->mapping != 0) { 1278 pci_unmap_single(tp->pci_dev, rp->mapping, 1279 rp->skb->len, PCI_DMA_TODEVICE); 1280 rp->mapping = 0; 1281 } 1282 if (rp->skb) { 1283 dev_kfree_skb(rp->skb); 1284 rp->skb = NULL; 1285 dev->stats.tx_dropped++; 1286 } 1287 } 1288} 1289 1290 1291static void netdrv_tx_timeout(struct net_device *dev) 1292{ 1293 struct netdrv_private *tp = netdev_priv(dev); 1294 void *ioaddr = tp->mmio_addr; 1295 int i; 1296 u8 tmp8; 1297 unsigned long flags; 1298 1299 netdev_dbg(dev, "Transmit timeout, status %02x %04x media %02x\n", 1300 NETDRV_R8(ChipCmd), 1301 NETDRV_R16(IntrStatus), 1302 NETDRV_R8(MediaStatus)); 1303 1304 /* disable Tx ASAP, if not already */ 1305 tmp8 = NETDRV_R8(ChipCmd); 1306 if (tmp8 & CmdTxEnb) 1307 NETDRV_W8(ChipCmd, tmp8 & ~CmdTxEnb); 1308 1309 /* Disable interrupts by clearing the interrupt mask. */ 1310 NETDRV_W16(IntrMask, 0x0000); 1311 1312 /* Emit info to figure out what went wrong. */ 1313 netdev_dbg(dev, "Tx queue start entry %d dirty entry %d\n", 1314 atomic_read(&tp->cur_tx), 1315 atomic_read(&tp->dirty_tx)); 1316 for (i = 0; i < NUM_TX_DESC; i++) 1317 netdev_dbg(dev, "Tx descriptor %d is %08lx%s\n", 1318 i, NETDRV_R32(TxStatus0 + (i * 4)), 1319 i == atomic_read(&tp->dirty_tx) % NUM_TX_DESC ? 1320 "(queue head)" : ""); 1321 1322 /* Stop a shared interrupt from scavenging while we are. */ 1323 spin_lock_irqsave(&tp->lock, flags); 1324 1325 netdrv_tx_clear(dev); 1326 1327 spin_unlock_irqrestore(&tp->lock, flags); 1328 1329 /* ...and finally, reset everything */ 1330 netdrv_hw_start(dev); 1331 1332 netif_wake_queue(dev); 1333} 1334 1335 1336 1337static int netdrv_start_xmit(struct sk_buff *skb, struct net_device *dev) 1338{ 1339 struct netdrv_private *tp = netdev_priv(dev); 1340 void *ioaddr = tp->mmio_addr; 1341 int entry; 1342 1343 /* Calculate the next Tx descriptor entry. */ 1344 entry = atomic_read(&tp->cur_tx) % NUM_TX_DESC; 1345 1346 assert(tp->tx_info[entry].skb == NULL); 1347 assert(tp->tx_info[entry].mapping == 0); 1348 1349 tp->tx_info[entry].skb = skb; 1350 /* tp->tx_info[entry].mapping = 0; */ 1351 skb_copy_from_linear_data(skb, tp->tx_buf[entry], skb->len); 1352 1353 /* Note: the chip doesn't have auto-pad! */ 1354 NETDRV_W32(TxStatus0 + (entry * sizeof(u32)), 1355 tp->tx_flag | (skb->len >= ETH_ZLEN ? skb->len : ETH_ZLEN)); 1356 1357 atomic_inc(&tp->cur_tx); 1358 if ((atomic_read(&tp->cur_tx) - atomic_read(&tp->dirty_tx)) >= NUM_TX_DESC) 1359 netif_stop_queue(dev); 1360 1361 netdev_dbg(dev, "Queued Tx packet at %p size %u to slot %d\n", 1362 skb->data, skb->len, entry); 1363 1364 return NETDEV_TX_OK; 1365} 1366 1367 1368static void netdrv_tx_interrupt(struct net_device *dev, 1369 struct netdrv_private *tp, 1370 void *ioaddr) 1371{ 1372 int cur_tx, dirty_tx, tx_left; 1373 1374 assert(dev != NULL); 1375 assert(tp != NULL); 1376 assert(ioaddr != NULL); 1377 1378 dirty_tx = atomic_read(&tp->dirty_tx); 1379 1380 cur_tx = atomic_read(&tp->cur_tx); 1381 tx_left = cur_tx - dirty_tx; 1382 while (tx_left > 0) { 1383 int entry = dirty_tx % NUM_TX_DESC; 1384 int txstatus; 1385 1386 txstatus = NETDRV_R32(TxStatus0 + (entry * sizeof(u32))); 1387 1388 if (!(txstatus & (TxStatOK | TxUnderrun | TxAborted))) 1389 break; /* It still hasn't been Txed */ 1390 1391 /* Note: TxCarrierLost is always asserted at 100mbps. */ 1392 if (txstatus & (TxOutOfWindow | TxAborted)) { 1393 /* There was an major error, log it. */ 1394 netdev_dbg(dev, "Transmit error, Tx status %#08x\n", 1395 txstatus); 1396 dev->stats.tx_errors++; 1397 if (txstatus & TxAborted) { 1398 dev->stats.tx_aborted_errors++; 1399 NETDRV_W32(TxConfig, TxClearAbt | (TX_DMA_BURST << TxDMAShift)); 1400 } 1401 if (txstatus & TxCarrierLost) 1402 dev->stats.tx_carrier_errors++; 1403 if (txstatus & TxOutOfWindow) 1404 dev->stats.tx_window_errors++; 1405 } else { 1406 if (txstatus & TxUnderrun) { 1407 /* Add 64 to the Tx FIFO threshold. */ 1408 if (tp->tx_flag < 0x00300000) 1409 tp->tx_flag += 0x00020000; 1410 dev->stats.tx_fifo_errors++; 1411 } 1412 dev->stats.collisions += (txstatus >> 24) & 15; 1413 dev->stats.tx_bytes += txstatus & 0x7ff; 1414 dev->stats.tx_packets++; 1415 } 1416 1417 /* Free the original skb. */ 1418 if (tp->tx_info[entry].mapping != 0) { 1419 pci_unmap_single(tp->pci_dev, 1420 tp->tx_info[entry].mapping, 1421 tp->tx_info[entry].skb->len, 1422 PCI_DMA_TODEVICE); 1423 tp->tx_info[entry].mapping = 0; 1424 } 1425 dev_kfree_skb_irq(tp->tx_info[entry].skb); 1426 tp->tx_info[entry].skb = NULL; 1427 dirty_tx++; 1428 if (dirty_tx < 0) { /* handle signed int overflow */ 1429 atomic_sub(cur_tx, &tp->cur_tx); /* XXX racy? */ 1430 dirty_tx = cur_tx - tx_left + 1; 1431 } 1432 if (netif_queue_stopped(dev)) 1433 netif_wake_queue(dev); 1434 1435 cur_tx = atomic_read(&tp->cur_tx); 1436 tx_left = cur_tx - dirty_tx; 1437 1438 } 1439 1440#ifndef NETDRV_NDEBUG 1441 if (atomic_read(&tp->cur_tx) - dirty_tx > NUM_TX_DESC) { 1442 netdev_err(dev, "Out-of-sync dirty pointer, %d vs. %d\n", 1443 dirty_tx, atomic_read(&tp->cur_tx)); 1444 dirty_tx += NUM_TX_DESC; 1445 } 1446#endif /* NETDRV_NDEBUG */ 1447 1448 atomic_set(&tp->dirty_tx, dirty_tx); 1449} 1450 1451 1452/* TODO: clean this up! Rx reset need not be this intensive */ 1453static void netdrv_rx_err(u32 rx_status, struct net_device *dev, 1454 struct netdrv_private *tp, void *ioaddr) 1455{ 1456 u8 tmp8; 1457 int tmp_work = 1000; 1458 1459 netdev_dbg(dev, "Ethernet frame had errors, status %08x\n", rx_status); 1460 if (rx_status & RxTooLong) 1461 netdev_dbg(dev, "Oversized Ethernet frame, status %04x!\n", 1462 rx_status); 1463 /* A.C.: The chip hangs here. */ 1464 dev->stats.rx_errors++; 1465 if (rx_status & (RxBadSymbol | RxBadAlign)) 1466 dev->stats.rx_frame_errors++; 1467 if (rx_status & (RxRunt | RxTooLong)) 1468 dev->stats.rx_length_errors++; 1469 if (rx_status & RxCRCErr) 1470 dev->stats.rx_crc_errors++; 1471 /* Reset the receiver, based on RealTek recommendation.(Bug?) */ 1472 tp->cur_rx = 0; 1473 1474 /* disable receive */ 1475 tmp8 = NETDRV_R8(ChipCmd) & ChipCmdClear; 1476 NETDRV_W8_F(ChipCmd, tmp8 | CmdTxEnb); 1477 1478 /* A.C.: Reset the multicast list. */ 1479 netdrv_set_rx_mode(dev); 1480 1481 /* XXX potentially temporary hack to 1482 * restart hung receiver */ 1483 while (--tmp_work > 0) { 1484 tmp8 = NETDRV_R8(ChipCmd); 1485 if ((tmp8 & CmdRxEnb) && (tmp8 & CmdTxEnb)) 1486 break; 1487 NETDRV_W8_F(ChipCmd, 1488 (tmp8 & ChipCmdClear) | CmdRxEnb | CmdTxEnb); 1489 } 1490 1491 /* G.S.: Re-enable receiver */ 1492 /* XXX temporary hack to work around receiver hang */ 1493 netdrv_set_rx_mode(dev); 1494 1495 if (tmp_work <= 0) 1496 netdev_warn(dev, "tx/rx enable wait too long\n"); 1497} 1498 1499 1500/* The data sheet doesn't describe the Rx ring at all, so I'm guessing at the 1501 field alignments and semantics. */ 1502static void netdrv_rx_interrupt(struct net_device *dev, 1503 struct netdrv_private *tp, void *ioaddr) 1504{ 1505 unsigned char *rx_ring; 1506 u16 cur_rx; 1507 1508 assert(dev != NULL); 1509 assert(tp != NULL); 1510 assert(ioaddr != NULL); 1511 1512 rx_ring = tp->rx_ring; 1513 cur_rx = tp->cur_rx; 1514 1515 netdev_dbg(dev, "In netdrv_rx(), current %04x BufAddr %04x, free to %04x, Cmd %02x\n", 1516 cur_rx, NETDRV_R16(RxBufAddr), 1517 NETDRV_R16(RxBufPtr), NETDRV_R8(ChipCmd)); 1518 1519 while ((NETDRV_R8(ChipCmd) & RxBufEmpty) == 0) { 1520 int ring_offset = cur_rx % RX_BUF_LEN; 1521 u32 rx_status; 1522 unsigned int rx_size; 1523 unsigned int pkt_size; 1524 struct sk_buff *skb; 1525 1526 /* read size+status of next frame from DMA ring buffer */ 1527 rx_status = le32_to_cpu(*(u32 *)(rx_ring + ring_offset)); 1528 rx_size = rx_status >> 16; 1529 pkt_size = rx_size - 4; 1530 1531 netdev_dbg(dev, "netdrv_rx() status %04x, size %04x, cur %04x\n", 1532 rx_status, rx_size, cur_rx); 1533#if defined(NETDRV_DEBUG) && (NETDRV_DEBUG > 2) 1534 print_hex_dump_bytes("Frame contents: ", HEX_DUMP_OFFSET, 1535 &rx_ring[ring_offset], 70); 1536#endif 1537 1538 /* If Rx err or invalid rx_size/rx_status received 1539 *(which happens if we get lost in the ring), 1540 * Rx process gets reset, so we abort any further 1541 * Rx processing. 1542 */ 1543 if ((rx_size > (MAX_ETH_FRAME_SIZE+4)) || 1544 (!(rx_status & RxStatusOK))) { 1545 netdrv_rx_err(rx_status, dev, tp, ioaddr); 1546 return; 1547 } 1548 1549 /* Malloc up new buffer, compatible with net-2e. */ 1550 /* Omit the four octet CRC from the length. */ 1551 1552 /* TODO: consider allocating skb's outside of 1553 * interrupt context, both to speed interrupt processing, 1554 * and also to reduce the chances of having to 1555 * drop packets here under memory pressure. 1556 */ 1557 1558 skb = dev_alloc_skb(pkt_size + 2); 1559 if (skb) { 1560 skb_reserve(skb, 2); /* 16 byte align the IP fields. */ 1561 1562 skb_copy_to_linear_data(skb, &rx_ring[ring_offset + 4], pkt_size); 1563 skb_put(skb, pkt_size); 1564 1565 skb->protocol = eth_type_trans(skb, dev); 1566 netif_rx(skb); 1567 dev->stats.rx_bytes += pkt_size; 1568 dev->stats.rx_packets++; 1569 } else { 1570 netdev_warn(dev, "Memory squeeze, dropping packet\n"); 1571 dev->stats.rx_dropped++; 1572 } 1573 1574 cur_rx = (cur_rx + rx_size + 4 + 3) & ~3; 1575 NETDRV_W16_F(RxBufPtr, cur_rx - 16); 1576 } 1577 1578 netdev_dbg(dev, "Done netdrv_rx(), current %04x BufAddr %04x, free to %04x, Cmd %02x\n", 1579 cur_rx, NETDRV_R16(RxBufAddr), 1580 NETDRV_R16(RxBufPtr), NETDRV_R8(ChipCmd)); 1581 1582 tp->cur_rx = cur_rx; 1583} 1584 1585 1586static void netdrv_weird_interrupt(struct net_device *dev, 1587 struct netdrv_private *tp, 1588 void *ioaddr, 1589 int status, int link_changed) 1590{ 1591 netdev_printk(KERN_DEBUG, dev, "Abnormal interrupt, status %08x\n", 1592 status); 1593 1594 assert(dev != NULL); 1595 assert(tp != NULL); 1596 assert(ioaddr != NULL); 1597 1598 /* Update the error count. */ 1599 dev->stats.rx_missed_errors += NETDRV_R32(RxMissed); 1600 NETDRV_W32(RxMissed, 0); 1601 1602 if ((status & RxUnderrun) && link_changed && 1603 (tp->drv_flags & HAS_LNK_CHNG)) { 1604 /* Really link-change on new chips. */ 1605 int lpar = NETDRV_R16(NWayLPAR); 1606 int duplex = ((lpar & 0x0100) || (lpar & 0x01C0) == 0x0040 || 1607 tp->duplex_lock); 1608 if (tp->full_duplex != duplex) { 1609 tp->full_duplex = duplex; 1610 NETDRV_W8(Cfg9346, Cfg9346_Unlock); 1611 NETDRV_W8(Config1, tp->full_duplex ? 0x60 : 0x20); 1612 NETDRV_W8(Cfg9346, Cfg9346_Lock); 1613 } 1614 status &= ~RxUnderrun; 1615 } 1616 1617 /* XXX along with netdrv_rx_err, are we double-counting errors? */ 1618 if (status & (RxUnderrun | RxOverflow | RxErr | RxFIFOOver)) 1619 dev->stats.rx_errors++; 1620 1621 if (status & (PCSTimeout)) 1622 dev->stats.rx_length_errors++; 1623 if (status & (RxUnderrun | RxFIFOOver)) 1624 dev->stats.rx_fifo_errors++; 1625 if (status & RxOverflow) { 1626 dev->stats.rx_over_errors++; 1627 tp->cur_rx = NETDRV_R16(RxBufAddr) % RX_BUF_LEN; 1628 NETDRV_W16_F(RxBufPtr, tp->cur_rx - 16); 1629 } 1630 if (status & PCIErr) { 1631 u16 pci_cmd_status; 1632 pci_read_config_word(tp->pci_dev, PCI_STATUS, &pci_cmd_status); 1633 1634 netdev_err(dev, "PCI Bus error %04x\n", pci_cmd_status); 1635 } 1636} 1637 1638 1639/* The interrupt handler does all of the Rx thread work and cleans up 1640 after the Tx thread. */ 1641static irqreturn_t netdrv_interrupt(int irq, void *dev_instance) 1642{ 1643 struct net_device *dev = (struct net_device *) dev_instance; 1644 struct netdrv_private *tp = netdev_priv(dev); 1645 int boguscnt = max_interrupt_work; 1646 void *ioaddr = tp->mmio_addr; 1647 int status = 0, link_changed = 0; /* avoid bogus "uninit" warning */ 1648 int handled = 0; 1649 1650 spin_lock(&tp->lock); 1651 1652 do { 1653 status = NETDRV_R16(IntrStatus); 1654 1655 /* h/w no longer present(hotplug?) or major error, bail */ 1656 if (status == 0xFFFF) 1657 break; 1658 1659 handled = 1; 1660 /* Acknowledge all of the current interrupt sources ASAP */ 1661 NETDRV_W16_F(IntrStatus, status); 1662 1663 netdev_dbg(dev, "interrupt status=%#04x new intstat=%#04x\n", 1664 status, NETDRV_R16(IntrStatus)); 1665 1666 if ((status & 1667 (PCIErr | PCSTimeout | RxUnderrun | RxOverflow | 1668 RxFIFOOver | TxErr | TxOK | RxErr | RxOK)) == 0) 1669 break; 1670 1671 /* Check uncommon events with one test. */ 1672 if (status & (PCIErr | PCSTimeout | RxUnderrun | RxOverflow | 1673 RxFIFOOver | TxErr | RxErr)) 1674 netdrv_weird_interrupt(dev, tp, ioaddr, 1675 status, link_changed); 1676 1677 if (status & (RxOK | RxUnderrun | RxOverflow | RxFIFOOver)) /* Rx interrupt */ 1678 netdrv_rx_interrupt(dev, tp, ioaddr); 1679 1680 if (status & (TxOK | TxErr)) 1681 netdrv_tx_interrupt(dev, tp, ioaddr); 1682 1683 boguscnt--; 1684 } while (boguscnt > 0); 1685 1686 if (boguscnt <= 0) { 1687 netdev_warn(dev, "Too much work at interrupt, IntrStatus=%#04x\n", 1688 status); 1689 1690 /* Clear all interrupt sources. */ 1691 NETDRV_W16(IntrStatus, 0xffff); 1692 } 1693 1694 spin_unlock(&tp->lock); 1695 1696 netdev_dbg(dev, "exiting interrupt, intr_status=%#04x\n", 1697 NETDRV_R16(IntrStatus)); 1698 return IRQ_RETVAL(handled); 1699} 1700 1701 1702static int netdrv_close(struct net_device *dev) 1703{ 1704 struct netdrv_private *tp = netdev_priv(dev); 1705 void *ioaddr = tp->mmio_addr; 1706 unsigned long flags; 1707 1708 DPRINTK("ENTER\n"); 1709 1710 netif_stop_queue(dev); 1711 1712 netdev_dbg(dev, "Shutting down ethercard, status was %#04x\n", 1713 NETDRV_R16(IntrStatus)); 1714 1715 del_timer_sync(&tp->timer); 1716 1717 spin_lock_irqsave(&tp->lock, flags); 1718 1719 /* Stop the chip's Tx and Rx DMA processes. */ 1720 NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear)); 1721 1722 /* Disable interrupts by clearing the interrupt mask. */ 1723 NETDRV_W16(IntrMask, 0x0000); 1724 1725 /* Update the error counts. */ 1726 dev->stats.rx_missed_errors += NETDRV_R32(RxMissed); 1727 NETDRV_W32(RxMissed, 0); 1728 1729 spin_unlock_irqrestore(&tp->lock, flags); 1730 1731 free_irq(dev->irq, dev); 1732 1733 netdrv_tx_clear(dev); 1734 1735 pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN, 1736 tp->rx_ring, tp->rx_ring_dma); 1737 pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN, 1738 tp->tx_bufs, tp->tx_bufs_dma); 1739 tp->rx_ring = NULL; 1740 tp->tx_bufs = NULL; 1741 1742 /* Green! Put the chip in low-power mode. */ 1743 NETDRV_W8(Cfg9346, Cfg9346_Unlock); 1744 NETDRV_W8(Config1, 0x03); 1745 NETDRV_W8(Cfg9346, Cfg9346_Lock); 1746 1747 DPRINTK("EXIT\n"); 1748 return 0; 1749} 1750 1751 1752static int netdrv_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) 1753{ 1754 struct netdrv_private *tp = netdev_priv(dev); 1755 struct mii_ioctl_data *data = if_mii(rq); 1756 unsigned long flags; 1757 int rc = 0; 1758 1759 DPRINTK("ENTER\n"); 1760 1761 switch (cmd) { 1762 case SIOCGMIIPHY: /* Get address of MII PHY in use. */ 1763 data->phy_id = tp->phys[0] & 0x3f; 1764 /* Fall Through */ 1765 1766 case SIOCGMIIREG: /* Read MII PHY register. */ 1767 spin_lock_irqsave(&tp->lock, flags); 1768 data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f); 1769 spin_unlock_irqrestore(&tp->lock, flags); 1770 break; 1771 1772 case SIOCSMIIREG: /* Write MII PHY register. */ 1773 spin_lock_irqsave(&tp->lock, flags); 1774 mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in); 1775 spin_unlock_irqrestore(&tp->lock, flags); 1776 break; 1777 1778 default: 1779 rc = -EOPNOTSUPP; 1780 break; 1781 } 1782 1783 DPRINTK("EXIT, returning %d\n", rc); 1784 return rc; 1785} 1786 1787/* Set or clear the multicast filter for this adaptor. 1788 This routine is not state sensitive and need not be SMP locked. */ 1789 1790static void netdrv_set_rx_mode(struct net_device *dev) 1791{ 1792 struct netdrv_private *tp = netdev_priv(dev); 1793 void *ioaddr = tp->mmio_addr; 1794 u32 mc_filter[2]; /* Multicast hash filter */ 1795 int rx_mode; 1796 u32 tmp; 1797 1798 DPRINTK("ENTER\n"); 1799 1800 netdev_dbg(dev, "%s(%04x) done -- Rx config %08lx\n", 1801 __func__, dev->flags, NETDRV_R32(RxConfig)); 1802 1803 /* Note: do not reorder, GCC is clever about common statements. */ 1804 if (dev->flags & IFF_PROMISC) { 1805 rx_mode = 1806 AcceptBroadcast | AcceptMulticast | AcceptMyPhys | 1807 AcceptAllPhys; 1808 mc_filter[1] = mc_filter[0] = 0xffffffff; 1809 } else if ((netdev_mc_count(dev) > multicast_filter_limit) || 1810 (dev->flags & IFF_ALLMULTI)) { 1811 /* Too many to filter perfectly -- accept all multicasts. */ 1812 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys; 1813 mc_filter[1] = mc_filter[0] = 0xffffffff; 1814 } else { 1815 struct netdev_hw_addr *ha; 1816 1817 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys; 1818 mc_filter[1] = mc_filter[0] = 0; 1819 netdev_for_each_mc_addr(ha, dev) { 1820 int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26; 1821 1822 mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31); 1823 } 1824 } 1825 1826 /* if called from irq handler, lock already acquired */ 1827 if (!in_irq()) 1828 spin_lock_irq(&tp->lock); 1829 1830 /* We can safely update without stopping the chip. */ 1831 tmp = netdrv_rx_config | rx_mode | 1832 (NETDRV_R32(RxConfig) & rtl_chip_info[tp->chipset].RxConfigMask); 1833 NETDRV_W32_F(RxConfig, tmp); 1834 NETDRV_W32_F(MAR0 + 0, mc_filter[0]); 1835 NETDRV_W32_F(MAR0 + 4, mc_filter[1]); 1836 1837 if (!in_irq()) 1838 spin_unlock_irq(&tp->lock); 1839 1840 DPRINTK("EXIT\n"); 1841} 1842 1843 1844#ifdef CONFIG_PM 1845 1846static int netdrv_suspend(struct pci_dev *pdev, pm_message_t state) 1847{ 1848 struct net_device *dev = pci_get_drvdata(pdev); 1849 struct netdrv_private *tp = netdev_priv(dev); 1850 void *ioaddr = tp->mmio_addr; 1851 unsigned long flags; 1852 1853 if (!netif_running(dev)) 1854 return 0; 1855 netif_device_detach(dev); 1856 1857 spin_lock_irqsave(&tp->lock, flags); 1858 1859 /* Disable interrupts, stop Tx and Rx. */ 1860 NETDRV_W16(IntrMask, 0x0000); 1861 NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear)); 1862 1863 /* Update the error counts. */ 1864 dev->stats.rx_missed_errors += NETDRV_R32(RxMissed); 1865 NETDRV_W32(RxMissed, 0); 1866 1867 spin_unlock_irqrestore(&tp->lock, flags); 1868 1869 pci_save_state(pdev); 1870 pci_set_power_state(pdev, PCI_D3hot); 1871 1872 return 0; 1873} 1874 1875 1876static int netdrv_resume(struct pci_dev *pdev) 1877{ 1878 struct net_device *dev = pci_get_drvdata(pdev); 1879 /*struct netdrv_private *tp = netdev_priv(dev);*/ 1880 1881 if (!netif_running(dev)) 1882 return 0; 1883 pci_set_power_state(pdev, PCI_D0); 1884 pci_restore_state(pdev); 1885 netif_device_attach(dev); 1886 netdrv_hw_start(dev); 1887 1888 return 0; 1889} 1890 1891#endif /* CONFIG_PM */ 1892 1893 1894static struct pci_driver netdrv_pci_driver = { 1895 .name = MODNAME, 1896 .id_table = netdrv_pci_tbl, 1897 .probe = netdrv_init_one, 1898 .remove = __devexit_p(netdrv_remove_one), 1899#ifdef CONFIG_PM 1900 .suspend = netdrv_suspend, 1901 .resume = netdrv_resume, 1902#endif /* CONFIG_PM */ 1903}; 1904 1905 1906static int __init netdrv_init_module(void) 1907{ 1908/* when a module, this is printed whether or not devices are found in probe */ 1909#ifdef MODULE 1910 printk(version); 1911#endif 1912 return pci_register_driver(&netdrv_pci_driver); 1913} 1914 1915 1916static void __exit netdrv_cleanup_module(void) 1917{ 1918 pci_unregister_driver(&netdrv_pci_driver); 1919} 1920 1921 1922module_init(netdrv_init_module); 1923module_exit(netdrv_cleanup_module);