?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge remote-tracking branch 'cleancache/linux-next'
[linux-2.6/next.git] / drivers / net / pci-skeleton.c
blobc0f23376a462a20fe1a7450782dabe9eca2fe95c
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
46 I. Board Compatibility
47
48 This device driver is designed for the RealTek RTL8139 series, the RealTek
49 Fast Ethernet controllers for PCI and CardBus. This chip is used on many
50 low-end boards, sometimes with its markings changed.
51
52
53 II. Board-specific settings
54
55 PCI bus devices are configured by the system at boot time, so no jumpers
56 need to be set on the board. The system BIOS will assign the
57 PCI INTA signal to a (preferably otherwise unused) system IRQ line.
58
59 III. Driver operation
60
61 IIIa. Rx Ring buffers
62
63 The receive unit uses a single linear ring buffer rather than the more
64 common (and more efficient) descriptor-based architecture. Incoming frames
65 are sequentially stored into the Rx region, and the host copies them into
66 skbuffs.
67
68 Comment: While it is theoretically possible to process many frames in place,
69 any delay in Rx processing would cause us to drop frames. More importantly,
70 the Linux protocol stack is not designed to operate in this manner.
71
72 IIIb. Tx operation
73
74 The RTL8139 uses a fixed set of four Tx descriptors in register space.
75 In a stunningly bad design choice, Tx frames must be 32 bit aligned. Linux
76 aligns the IP header on word boundaries, and 14 byte ethernet header means
77 that almost all frames will need to be copied to an alignment buffer.
78
79 IVb. References
80
81 http://www.realtek.com.tw/
82 http://www.scyld.com/expert/NWay.html
83
84 IVc. 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
107 static 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...) \
127 do { \
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 */
146 static int media[] = {-1, -1, -1, -1, -1, -1, -1, -1};
147
148 /* Maximum events (Rx packets, etc.) to handle at each interrupt. */
149 static 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. */
153 static 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
188 enum {
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
198 typedef 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 */
209 static 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
221 static 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 };
230 MODULE_DEVICE_TABLE(pci, netdrv_pci_tbl);
231
232
233 /* The rest of these values should never change. */
234
235 /* Symbolic offsets to registers. */
236 enum 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
277 enum ClearBitMasks {
278 MultiIntrClear = 0xF000,
279 ChipCmdClear = 0xE2,
280 Config1Clear = (1 << 7) | (1 << 6) | (1 << 3) | (1 << 2) | (1 << 1),
281 };
282
283 enum ChipCmdBits {
284 CmdReset = 0x10,
285 CmdRxEnb = 0x08,
286 CmdTxEnb = 0x04,
287 RxBufEmpty = 0x01,
288 };
289
290 /* Interrupt register bits, using my own meaningful names. */
291 enum 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 };
302 enum TxStatusBits {
303 TxHostOwns = 0x2000,
304 TxUnderrun = 0x4000,
305 TxStatOK = 0x8000,
306 TxOutOfWindow = 0x20000000,
307 TxAborted = 0x40000000,
308 TxCarrierLost = 0x80000000,
309 };
310 enum 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. */
323 enum 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. */
333 enum 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 */
345 enum 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
356 enum 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. */
382 enum CSCRBits {
383 CSCR_LinkOKBit = 0x0400,
384 CSCR_LinkChangeBit = 0x0800,
385 CSCR_LinkStatusBits = 0x0f000,
386 CSCR_LinkDownOffCmd = 0x003c0,
387 CSCR_LinkDownCmd = 0x0f3c0,
388 };
389
390
391 enum 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
400 static 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
407 struct ring_info {
408 struct sk_buff *skb;
409 dma_addr_t mapping;
410 };
411
412
413 typedef 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 */
424 static 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
462 struct 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
491 MODULE_AUTHOR("Jeff Garzik <jgarzik@pobox.com>");
492 MODULE_DESCRIPTION("Skeleton for a PCI Fast Ethernet driver");
493 MODULE_LICENSE("GPL");
494 module_param(multicast_filter_limit, int, 0);
495 module_param(max_interrupt_work, int, 0);
496 module_param_array(media, int, NULL, 0);
497 MODULE_PARM_DESC(multicast_filter_limit,
498 MODNAME " maximum number of filtered multicast addresses");
499 MODULE_PARM_DESC(max_interrupt_work,
500 MODNAME " maximum events handled per interrupt");
501 MODULE_PARM_DESC(media,
502 MODNAME " Bits 0-3: media type, bit 17: full duplex");
503
504 static int read_eeprom(void *ioaddr, int location, int addr_len);
505 static int netdrv_open(struct net_device *dev);
506 static int mdio_read(struct net_device *dev, int phy_id, int location);
507 static void mdio_write(struct net_device *dev, int phy_id, int location,
508 int val);
509 static void netdrv_timer(unsigned long data);
510 static void netdrv_tx_timeout(struct net_device *dev);
511 static void netdrv_init_ring(struct net_device *dev);
512 static int netdrv_start_xmit(struct sk_buff *skb,
513 struct net_device *dev);
514 static irqreturn_t netdrv_interrupt(int irq, void *dev_instance);
515 static int netdrv_close(struct net_device *dev);
516 static int netdrv_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
517 static void netdrv_set_rx_mode(struct net_device *dev);
518 static 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) \
550 do { \
551 writeb((val8), ioaddr + (reg)); \
552 readb(ioaddr + (reg)); \
553 } while (0)
554 #define NETDRV_W16_F(reg, val16) \
555 do { \
556 writew((val16), ioaddr + (reg)); \
557 readw(ioaddr + (reg)); \
558 } while (0)
559 #define NETDRV_W32_F(reg, val32) \
560 do { \
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
590 static const u16 netdrv_intr_mask =
591 PCIErr | PCSTimeout | RxUnderrun | RxOverflow | RxFIFOOver |
592 TxErr | TxOK | RxErr | RxOK;
593
594 static const unsigned int netdrv_rx_config =
595 RxCfgEarlyRxNone | RxCfgRcv32K | RxNoWrap |
596 (RX_FIFO_THRESH << RxCfgFIFOShift) |
597 (RX_DMA_BURST << RxCfgDMAShift);
598
599
600 static 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
726 match:
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
739 err_out_unmap:
740 #ifndef USE_IO_OPS
741 iounmap(ioaddr);
742 err_out_free_res:
743 #endif
744 pci_release_regions(pdev);
745 err_out:
746 free_netdev(dev);
747 DPRINTK("EXIT, returning %d\n", rc);
748 return rc;
749 }
750
751 static 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
763 static 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
854 static 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
906 static 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
964 static 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. */
977 static 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
994 static 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
1035 static 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
1079 static 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. */
1137 static 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. */
1207 static 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
1228 static 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
1266 static 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
1291 static 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
1337 static 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
1368 static 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 */
1453 static 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. */
1502 static 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
1586 static 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. */
1641 static 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
1702 static 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
1752 static 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
1790 static 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
1846 static 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
1876 static 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
1894 static 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
1906 static 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
1916 static void __exit netdrv_cleanup_module(void)
1917 {
1918 pci_unregister_driver(&netdrv_pci_driver);
1919 }
1920
1921
1922 module_init(netdrv_init_module);
1923 module_exit(netdrv_cleanup_module);
linux-next