Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
9cd31f07 | 14 | Written 1997-2000 by Donald Becker. |
1da177e4 LT |
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/cn/cn.html | |
82 | http://www.scyld.com/expert/NWay.html | |
83 | ||
84 | IVc. Errata | |
85 | ||
86 | */ | |
87 | ||
9cd31f07 JP |
88 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
89 | ||
1da177e4 LT |
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> | |
9cd31f07 | 101 | #include <linux/io.h> |
1da177e4 | 102 | |
d5b20697 | 103 | #define NETDRV_VERSION "1.0.1" |
1da177e4 LT |
104 | #define MODNAME "netdrv" |
105 | #define NETDRV_DRIVER_LOAD_MSG "MyVendor Fast Ethernet driver " NETDRV_VERSION " loaded" | |
1da177e4 LT |
106 | |
107 | static char version[] __devinitdata = | |
9cd31f07 JP |
108 | KERN_INFO NETDRV_DRIVER_LOAD_MSG "\n" |
109 | " Support available from http://foo.com/bar/baz.html\n"; | |
1da177e4 LT |
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 */ | |
9cd31f07 JP |
123 | #define DPRINTK(fmt, args...) \ |
124 | printk(KERN_DEBUG "%s: " fmt, __func__ , ## args) | |
1da177e4 | 125 | #else |
9cd31f07 JP |
126 | #define DPRINTK(fmt, args...) \ |
127 | do { \ | |
128 | if (0) \ | |
129 | printk(KERN_DEBUG fmt, ##args); \ | |
130 | } while (0) | |
1da177e4 LT |
131 | #endif |
132 | ||
133 | #ifdef NETDRV_NDEBUG | |
9cd31f07 | 134 | #define assert(expr) do {} while (0) |
1da177e4 | 135 | #else |
9cd31f07 JP |
136 | #define assert(expr) \ |
137 | if (!(expr)) { \ | |
138 | printk("Assertion failed! %s,%s,%s,line=%d\n", \ | |
139 | #expr, __FILE__, __func__, __LINE__); \ | |
140 | } | |
1da177e4 LT |
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 */ | |
9cd31f07 JP |
157 | #define RX_BUF_LEN (8192 << RX_BUF_LEN_IDX) |
158 | #define RX_BUF_PAD 16 | |
1da177e4 | 159 | #define RX_BUF_WRAP_PAD 2048 /* spare padding to handle lack of packet wrap */ |
9cd31f07 | 160 | #define RX_BUF_TOT_LEN (RX_BUF_LEN + RX_BUF_PAD + RX_BUF_WRAP_PAD) |
1da177e4 LT |
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. */ | |
9cd31f07 | 174 | #define TX_FIFO_THRESH 256 /* In bytes, rounded down to 32 byte units. */ |
1da177e4 | 175 | |
9cd31f07 JP |
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 | */ | |
1da177e4 LT |
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. */ | |
9cd31f07 | 186 | #define TX_TIMEOUT (6 * HZ) |
1da177e4 LT |
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 | ||
9cd31f07 | 196 | #define NETDRV_CAPS (HAS_CHIP_XCVR | HAS_LNK_CHNG) |
1da177e4 LT |
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 Technolgy 8139 10/100BaseTX" }, | |
218 | }; | |
219 | ||
220 | ||
a3aa1884 | 221 | static DEFINE_PCI_DEVICE_TABLE(netdrv_pci_tbl) = { |
1da177e4 LT |
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 | }; | |
9cd31f07 | 230 | MODULE_DEVICE_TABLE(pci, netdrv_pci_tbl); |
1da177e4 LT |
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, | |
9cd31f07 | 280 | Config1Clear = (1 << 7) | (1 << 6) | (1 << 3) | (1 << 2) | (1 << 1), |
1da177e4 LT |
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) */ | |
9cd31f07 | 339 | TxDMAShift = 8, /* DMA burst value(0-7) is shift this many bits */ |
1da177e4 LT |
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 */ | |
3c6bee1d | 424 | static const struct { |
1da177e4 LT |
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; | |
1da177e4 LT |
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 | ||
9cd31f07 JP |
491 | MODULE_AUTHOR("Jeff Garzik <jgarzik@pobox.com>"); |
492 | MODULE_DESCRIPTION("Skeleton for a PCI Fast Ethernet driver"); | |
1da177e4 | 493 | MODULE_LICENSE("GPL"); |
2f761478 VF |
494 | module_param(multicast_filter_limit, int, 0); |
495 | module_param(max_interrupt_work, int, 0); | |
496 | module_param_array(media, int, NULL, 0); | |
9cd31f07 JP |
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); | |
1da177e4 LT |
519 | |
520 | ||
521 | #ifdef USE_IO_OPS | |
522 | ||
9cd31f07 JP |
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)) | |
1da177e4 LT |
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)) | |
9cd31f07 JP |
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)) | |
1da177e4 LT |
544 | |
545 | #else | |
546 | ||
547 | /* write MMIO register, with flush */ | |
548 | /* Flush avoids rtl8139 bug w/ posted MMIO writes */ | |
9cd31f07 JP |
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) | |
1da177e4 LT |
564 | |
565 | ||
44911bfe | 566 | #ifdef MMIO_FLUSH_AUDIT_COMPLETE |
1da177e4 LT |
567 | |
568 | /* write MMIO register */ | |
9cd31f07 JP |
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)) | |
1da177e4 LT |
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 */ | |
9cd31f07 JP |
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))) | |
1da177e4 LT |
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 = | |
9cd31f07 JP |
595 | RxCfgEarlyRxNone | RxCfgRcv32K | RxNoWrap | |
596 | (RX_FIFO_THRESH << RxCfgFIFOShift) | | |
597 | (RX_DMA_BURST << RxCfgDMAShift); | |
1da177e4 LT |
598 | |
599 | ||
9cd31f07 JP |
600 | static int __devinit netdrv_init_board(struct pci_dev *pdev, |
601 | struct net_device **dev_out, | |
602 | void **ioaddr_out) | |
1da177e4 LT |
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 | ||
9cd31f07 | 612 | DPRINTK("ENTER\n"); |
1da177e4 | 613 | |
9cd31f07 JP |
614 | assert(pdev != NULL); |
615 | assert(ioaddr_out != NULL); | |
1da177e4 LT |
616 | |
617 | *ioaddr_out = NULL; | |
618 | *dev_out = NULL; | |
619 | ||
620 | /* dev zeroed in alloc_etherdev */ | |
9cd31f07 | 621 | dev = alloc_etherdev(sizeof(*tp)); |
1da177e4 | 622 | if (dev == NULL) { |
9b91cf9d | 623 | dev_err(&pdev->dev, "unable to alloc new ethernet\n"); |
9cd31f07 | 624 | DPRINTK("EXIT, returning -ENOMEM\n"); |
1da177e4 LT |
625 | return -ENOMEM; |
626 | } | |
1da177e4 | 627 | SET_NETDEV_DEV(dev, &pdev->dev); |
44911bfe | 628 | tp = netdev_priv(dev); |
1da177e4 | 629 | |
9cd31f07 JP |
630 | /* enable device(incl. PCI PM wakeup), and bus-mastering */ |
631 | rc = pci_enable_device(pdev); | |
1da177e4 LT |
632 | if (rc) |
633 | goto err_out; | |
634 | ||
9cd31f07 JP |
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); | |
1da177e4 | 639 | |
9cd31f07 JP |
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); | |
1da177e4 LT |
644 | |
645 | /* set this immediately, we need to know before | |
646 | * we talk to the chip directly */ | |
9cd31f07 JP |
647 | DPRINTK("PIO region size == %#02X\n", pio_len); |
648 | DPRINTK("MMIO region size == %#02lX\n", mmio_len); | |
1da177e4 LT |
649 | |
650 | /* make sure PCI base addr 0 is PIO */ | |
651 | if (!(pio_flags & IORESOURCE_IO)) { | |
9b91cf9d | 652 | dev_err(&pdev->dev, "region #0 not a PIO resource, aborting\n"); |
1da177e4 LT |
653 | rc = -ENODEV; |
654 | goto err_out; | |
655 | } | |
656 | ||
657 | /* make sure PCI base addr 1 is MMIO */ | |
658 | if (!(mmio_flags & IORESOURCE_MEM)) { | |
9b91cf9d | 659 | dev_err(&pdev->dev, "region #1 not an MMIO resource, aborting\n"); |
1da177e4 LT |
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)) { | |
9b91cf9d | 667 | dev_err(&pdev->dev, "Invalid PCI region size(s), aborting\n"); |
1da177e4 LT |
668 | rc = -ENODEV; |
669 | goto err_out; | |
670 | } | |
671 | ||
9cd31f07 | 672 | rc = pci_request_regions(pdev, MODNAME); |
1da177e4 LT |
673 | if (rc) |
674 | goto err_out; | |
675 | ||
9cd31f07 | 676 | pci_set_master(pdev); |
1da177e4 LT |
677 | |
678 | #ifdef USE_IO_OPS | |
9cd31f07 | 679 | ioaddr = (void *)pio_start; |
1da177e4 LT |
680 | #else |
681 | /* ioremap MMIO region */ | |
9cd31f07 | 682 | ioaddr = ioremap(mmio_start, mmio_len); |
1da177e4 | 683 | if (ioaddr == NULL) { |
9b91cf9d | 684 | dev_err(&pdev->dev, "cannot remap MMIO, aborting\n"); |
1da177e4 LT |
685 | rc = -EIO; |
686 | goto err_out_free_res; | |
687 | } | |
688 | #endif /* USE_IO_OPS */ | |
689 | ||
690 | /* Soft reset the chip. */ | |
9cd31f07 | 691 | NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | CmdReset); |
1da177e4 LT |
692 | |
693 | /* Check that the chip has finished the reset. */ | |
694 | for (i = 1000; i > 0; i--) | |
9cd31f07 | 695 | if ((NETDRV_R8(ChipCmd) & CmdReset) == 0) |
1da177e4 LT |
696 | break; |
697 | else | |
9cd31f07 | 698 | udelay(10); |
1da177e4 LT |
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 */ | |
9cd31f07 JP |
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)); | |
1da177e4 LT |
709 | #endif /* !USE_IO_OPS */ |
710 | ||
711 | /* identify chip attached to board */ | |
9cd31f07 JP |
712 | tmp = NETDRV_R8(ChipVersion); |
713 | for (i = ARRAY_SIZE(rtl_chip_info) - 1; i >= 0; i--) | |
1da177e4 LT |
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 */ | |
9cd31f07 JP |
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)); | |
1da177e4 LT |
724 | tp->chipset = 0; |
725 | ||
726 | match: | |
9cd31f07 JP |
727 | DPRINTK("chipset id(%d) == index %d, '%s'\n", |
728 | tmp, tp->chipset, rtl_chip_info[tp->chipset].name); | |
1da177e4 | 729 | |
9cd31f07 | 730 | rc = register_netdev(dev); |
5c4851cc | 731 | if (rc) |
1da177e4 LT |
732 | goto err_out_unmap; |
733 | ||
9cd31f07 | 734 | DPRINTK("EXIT, returning 0\n"); |
1da177e4 LT |
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 | |
9cd31f07 | 744 | pci_release_regions(pdev); |
1da177e4 | 745 | err_out: |
9cd31f07 JP |
746 | free_netdev(dev); |
747 | DPRINTK("EXIT, returning %d\n", rc); | |
1da177e4 LT |
748 | return rc; |
749 | } | |
750 | ||
1ec847f6 AB |
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 | }; | |
1da177e4 | 762 | |
9cd31f07 JP |
763 | static int __devinit netdrv_init_one(struct pci_dev *pdev, |
764 | const struct pci_device_id *ent) | |
1da177e4 LT |
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 | ||
9cd31f07 | 779 | DPRINTK("ENTER\n"); |
1da177e4 | 780 | |
9cd31f07 JP |
781 | assert(pdev != NULL); |
782 | assert(ent != NULL); | |
1da177e4 LT |
783 | |
784 | board_idx++; | |
785 | ||
9cd31f07 | 786 | i = netdrv_init_board(pdev, &dev, &ioaddr); |
1da177e4 | 787 | if (i < 0) { |
9cd31f07 | 788 | DPRINTK("EXIT, returning %d\n", i); |
1da177e4 LT |
789 | return i; |
790 | } | |
791 | ||
44911bfe | 792 | tp = netdev_priv(dev); |
1da177e4 | 793 | |
9cd31f07 JP |
794 | assert(ioaddr != NULL); |
795 | assert(dev != NULL); | |
796 | assert(tp != NULL); | |
1da177e4 | 797 | |
9cd31f07 | 798 | addr_len = read_eeprom(ioaddr, 0, 8) == 0x8129 ? 8 : 6; |
1da177e4 | 799 | for (i = 0; i < 3; i++) |
9cd31f07 JP |
800 | ((u16 *)(dev->dev_addr))[i] = |
801 | le16_to_cpu(read_eeprom(ioaddr, i + 7, addr_len)); | |
1da177e4 | 802 | |
1ec847f6 | 803 | dev->netdev_ops = &netdrv_netdev_ops; |
1da177e4 LT |
804 | dev->watchdog_timeo = TX_TIMEOUT; |
805 | ||
806 | dev->irq = pdev->irq; | |
807 | dev->base_addr = (unsigned long) ioaddr; | |
808 | ||
b74ca3a8 | 809 | /* netdev_priv()/tp zeroed and aligned in alloc_etherdev */ |
44911bfe | 810 | tp = netdev_priv(dev); |
1da177e4 LT |
811 | |
812 | /* note: tp->chipset set in netdrv_init_board */ | |
813 | tp->drv_flags = PCI_COMMAND_IO | PCI_COMMAND_MEMORY | | |
9cd31f07 | 814 | PCI_COMMAND_MASTER | NETDRV_CAPS; |
1da177e4 LT |
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 | ||
9cd31f07 JP |
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); | |
1da177e4 | 827 | |
9cd31f07 JP |
828 | netdev_printk(KERN_DEBUG, dev, "Identified 8139 chip type '%s'\n", |
829 | rtl_chip_info[tp->chipset].name); | |
1da177e4 LT |
830 | |
831 | /* Put the chip into low-power mode. */ | |
9cd31f07 | 832 | NETDRV_W8_F(Cfg9346, Cfg9346_Unlock); |
1da177e4 LT |
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) { | |
9cd31f07 JP |
844 | netdev_info(dev, "Media type forced to Full Duplex\n"); |
845 | mdio_write(dev, tp->phys[0], MII_ADVERTISE, ADVERTISE_FULL); | |
1da177e4 LT |
846 | tp->duplex_lock = 1; |
847 | } | |
848 | ||
9cd31f07 | 849 | DPRINTK("EXIT - returning 0\n"); |
1da177e4 LT |
850 | return 0; |
851 | } | |
852 | ||
853 | ||
9cd31f07 | 854 | static void __devexit netdrv_remove_one(struct pci_dev *pdev) |
1da177e4 | 855 | { |
9cd31f07 | 856 | struct net_device *dev = pci_get_drvdata(pdev); |
1da177e4 LT |
857 | struct netdrv_private *np; |
858 | ||
9cd31f07 | 859 | DPRINTK("ENTER\n"); |
1da177e4 | 860 | |
9cd31f07 | 861 | assert(dev != NULL); |
1da177e4 | 862 | |
44911bfe | 863 | np = netdev_priv(dev); |
9cd31f07 | 864 | assert(np != NULL); |
1da177e4 | 865 | |
9cd31f07 | 866 | unregister_netdev(dev); |
1da177e4 LT |
867 | |
868 | #ifndef USE_IO_OPS | |
9cd31f07 | 869 | iounmap(np->mmio_addr); |
1da177e4 LT |
870 | #endif /* !USE_IO_OPS */ |
871 | ||
9cd31f07 | 872 | pci_release_regions(pdev); |
1da177e4 | 873 | |
9cd31f07 | 874 | free_netdev(dev); |
1da177e4 | 875 | |
9cd31f07 | 876 | pci_set_drvdata(pdev, NULL); |
1da177e4 | 877 | |
9cd31f07 | 878 | pci_disable_device(pdev); |
1da177e4 | 879 | |
9cd31f07 | 880 | DPRINTK("EXIT\n"); |
1da177e4 LT |
881 | } |
882 | ||
883 | ||
884 | /* Serial EEPROM section. */ | |
885 | ||
886 | /* EEPROM_Ctrl bits. */ | |
887 | #define EE_SHIFT_CLK 0x04 /* EEPROM shift clock. */ | |
9cd31f07 | 888 | #define EE_CS 0x08 /* EEPROM chip select. */ |
1da177e4 | 889 | #define EE_DATA_WRITE 0x02 /* EEPROM chip data in. */ |
9cd31f07 JP |
890 | #define EE_WRITE_0 0x00 |
891 | #define EE_WRITE_1 0x02 | |
1da177e4 | 892 | #define EE_DATA_READ 0x01 /* EEPROM chip data out. */ |
9cd31f07 | 893 | #define EE_ENB (0x80 | EE_CS) |
1da177e4 LT |
894 | |
895 | /* Delay between EEPROM clock transitions. | |
896 | No extra delay is needed with 33Mhz PCI, but 66Mhz may change this. | |
9cd31f07 | 897 | */ |
1da177e4 LT |
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) | |
9cd31f07 | 903 | #define EE_READ_CMD (6) |
1da177e4 LT |
904 | #define EE_ERASE_CMD (7) |
905 | ||
9cd31f07 | 906 | static int __devinit read_eeprom(void *ioaddr, int location, int addr_len) |
1da177e4 LT |
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 | ||
9cd31f07 | 913 | DPRINTK("ENTER\n"); |
1da177e4 | 914 | |
9cd31f07 JP |
915 | writeb(EE_ENB & ~EE_CS, ee_addr); |
916 | writeb(EE_ENB, ee_addr); | |
917 | eeprom_delay(); | |
1da177e4 LT |
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; | |
9cd31f07 JP |
922 | writeb(EE_ENB | dataval, ee_addr); |
923 | eeprom_delay(); | |
924 | writeb(EE_ENB | dataval | EE_SHIFT_CLK, ee_addr); | |
925 | eeprom_delay(); | |
1da177e4 | 926 | } |
9cd31f07 JP |
927 | writeb(EE_ENB, ee_addr); |
928 | eeprom_delay(); | |
1da177e4 LT |
929 | |
930 | for (i = 16; i > 0; i--) { | |
9cd31f07 JP |
931 | writeb(EE_ENB | EE_SHIFT_CLK, ee_addr); |
932 | eeprom_delay(); | |
1da177e4 | 933 | retval = |
9cd31f07 JP |
934 | (retval << 1) | ((readb(ee_addr) & EE_DATA_READ) ? 1 : |
935 | 0); | |
936 | writeb(EE_ENB, ee_addr); | |
937 | eeprom_delay(); | |
1da177e4 LT |
938 | } |
939 | ||
940 | /* Terminate the EEPROM access. */ | |
9cd31f07 JP |
941 | writeb(~EE_CS, ee_addr); |
942 | eeprom_delay(); | |
1da177e4 | 943 | |
9cd31f07 | 944 | DPRINTK("EXIT - returning %d\n", retval); |
1da177e4 LT |
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. */ | |
9cd31f07 | 954 | #define MDIO_DIR 0x80 |
1da177e4 LT |
955 | #define MDIO_DATA_OUT 0x04 |
956 | #define MDIO_DATA_IN 0x02 | |
9cd31f07 JP |
957 | #define MDIO_CLK 0x01 |
958 | #define MDIO_WRITE0 (MDIO_DIR) | |
959 | #define MDIO_WRITE1 (MDIO_DIR | MDIO_DATA_OUT) | |
1da177e4 LT |
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. */ | |
9cd31f07 | 977 | static void mdio_sync(void *mdio_addr) |
1da177e4 LT |
978 | { |
979 | int i; | |
980 | ||
9cd31f07 | 981 | DPRINTK("ENTER\n"); |
1da177e4 LT |
982 | |
983 | for (i = 32; i >= 0; i--) { | |
9cd31f07 JP |
984 | writeb(MDIO_WRITE1, mdio_addr); |
985 | mdio_delay(); | |
986 | writeb(MDIO_WRITE1 | MDIO_CLK, mdio_addr); | |
987 | mdio_delay(); | |
1da177e4 LT |
988 | } |
989 | ||
9cd31f07 | 990 | DPRINTK("EXIT\n"); |
1da177e4 LT |
991 | } |
992 | ||
993 | ||
9cd31f07 | 994 | static int mdio_read(struct net_device *dev, int phy_id, int location) |
1da177e4 | 995 | { |
44911bfe | 996 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
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 | ||
9cd31f07 | 1002 | DPRINTK("ENTER\n"); |
1da177e4 LT |
1003 | |
1004 | if (phy_id > 31) { /* Really a 8139. Use internal registers. */ | |
9cd31f07 | 1005 | DPRINTK("EXIT after directly using 8139 internal regs\n"); |
1da177e4 | 1006 | return location < 8 && mii_2_8139_map[location] ? |
9cd31f07 | 1007 | readw(tp->mmio_addr + mii_2_8139_map[location]) : 0; |
1da177e4 | 1008 | } |
9cd31f07 | 1009 | mdio_sync(mdio_addr); |
1da177e4 LT |
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 | ||
9cd31f07 JP |
1014 | writeb(MDIO_DIR | dataval, mdio_addr); |
1015 | mdio_delay(); | |
1016 | writeb(MDIO_DIR | dataval | MDIO_CLK, mdio_addr); | |
1017 | mdio_delay(); | |
1da177e4 LT |
1018 | } |
1019 | ||
1020 | /* Read the two transition, 16 data, and wire-idle bits. */ | |
1021 | for (i = 19; i > 0; i--) { | |
9cd31f07 JP |
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(); | |
1da177e4 LT |
1028 | } |
1029 | ||
9cd31f07 | 1030 | DPRINTK("EXIT, returning %d\n", (retval >> 1) & 0xffff); |
1da177e4 LT |
1031 | return (retval >> 1) & 0xffff; |
1032 | } | |
1033 | ||
1034 | ||
9cd31f07 JP |
1035 | static void mdio_write(struct net_device *dev, int phy_id, int location, |
1036 | int value) | |
1da177e4 | 1037 | { |
44911bfe | 1038 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1039 | void *mdio_addr = tp->mmio_addr + Config4; |
1040 | int mii_cmd = | |
9cd31f07 | 1041 | (0x5002 << 16) | (phy_id << 23) | (location << 18) | value; |
1da177e4 LT |
1042 | int i; |
1043 | ||
9cd31f07 | 1044 | DPRINTK("ENTER\n"); |
1da177e4 LT |
1045 | |
1046 | if (phy_id > 31) { /* Really a 8139. Use internal registers. */ | |
1047 | if (location < 8 && mii_2_8139_map[location]) { | |
9cd31f07 JP |
1048 | writew(value, |
1049 | tp->mmio_addr + mii_2_8139_map[location]); | |
1050 | readw(tp->mmio_addr + mii_2_8139_map[location]); | |
1da177e4 | 1051 | } |
9cd31f07 | 1052 | DPRINTK("EXIT after directly using 8139 internal regs\n"); |
1da177e4 LT |
1053 | return; |
1054 | } | |
9cd31f07 | 1055 | mdio_sync(mdio_addr); |
1da177e4 LT |
1056 | |
1057 | /* Shift the command bits out. */ | |
1058 | for (i = 31; i >= 0; i--) { | |
1059 | int dataval = | |
9cd31f07 JP |
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(); | |
1da177e4 LT |
1065 | } |
1066 | ||
1067 | /* Clear out extra bits. */ | |
1068 | for (i = 2; i > 0; i--) { | |
9cd31f07 JP |
1069 | writeb(0, mdio_addr); |
1070 | mdio_delay(); | |
1071 | writeb(MDIO_CLK, mdio_addr); | |
1072 | mdio_delay(); | |
1da177e4 LT |
1073 | } |
1074 | ||
9cd31f07 | 1075 | DPRINTK("EXIT\n"); |
1da177e4 LT |
1076 | } |
1077 | ||
1078 | ||
9cd31f07 | 1079 | static int netdrv_open(struct net_device *dev) |
1da177e4 | 1080 | { |
44911bfe | 1081 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 | 1082 | int retval; |
1da177e4 | 1083 | void *ioaddr = tp->mmio_addr; |
1da177e4 | 1084 | |
9cd31f07 | 1085 | DPRINTK("ENTER\n"); |
1da177e4 | 1086 | |
9cd31f07 | 1087 | retval = request_irq(dev->irq, netdrv_interrupt, IRQF_SHARED, dev->name, dev); |
1da177e4 | 1088 | if (retval) { |
9cd31f07 | 1089 | DPRINTK("EXIT, returning %d\n", retval); |
1da177e4 LT |
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 | ||
9cd31f07 | 1107 | DPRINTK("EXIT, returning -ENOMEM\n"); |
1da177e4 LT |
1108 | return -ENOMEM; |
1109 | ||
1110 | } | |
1111 | ||
1112 | tp->full_duplex = tp->duplex_lock; | |
1113 | tp->tx_flag = (TX_FIFO_THRESH << 11) & 0x003f0000; | |
1114 | ||
9cd31f07 JP |
1115 | netdrv_init_ring(dev); |
1116 | netdrv_hw_start(dev); | |
1da177e4 | 1117 | |
9cd31f07 JP |
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"); | |
1da177e4 LT |
1122 | |
1123 | /* Set the timer to switch to check for link beat and perhaps switch | |
1124 | to an alternate media type. */ | |
9cd31f07 | 1125 | init_timer(&tp->timer); |
1da177e4 LT |
1126 | tp->timer.expires = jiffies + 3 * HZ; |
1127 | tp->timer.data = (unsigned long) dev; | |
1128 | tp->timer.function = &netdrv_timer; | |
9cd31f07 | 1129 | add_timer(&tp->timer); |
1da177e4 | 1130 | |
9cd31f07 | 1131 | DPRINTK("EXIT, returning 0\n"); |
1da177e4 LT |
1132 | return 0; |
1133 | } | |
1134 | ||
1135 | ||
1136 | /* Start the hardware at open or resume. */ | |
9cd31f07 | 1137 | static void netdrv_hw_start(struct net_device *dev) |
1da177e4 | 1138 | { |
44911bfe | 1139 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1140 | void *ioaddr = tp->mmio_addr; |
1141 | u32 i; | |
1142 | ||
9cd31f07 | 1143 | DPRINTK("ENTER\n"); |
1da177e4 LT |
1144 | |
1145 | /* Soft reset the chip. */ | |
9cd31f07 JP |
1146 | NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | CmdReset); |
1147 | udelay(100); | |
1da177e4 LT |
1148 | |
1149 | /* Check that the chip has finished the reset. */ | |
1150 | for (i = 1000; i > 0; i--) | |
9cd31f07 | 1151 | if ((NETDRV_R8(ChipCmd) & CmdReset) == 0) |
1da177e4 LT |
1152 | break; |
1153 | ||
1154 | /* Restore our idea of the MAC address. */ | |
9cd31f07 JP |
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))); | |
1da177e4 LT |
1157 | |
1158 | /* Must enable Tx/Rx before setting transfer thresholds! */ | |
9cd31f07 JP |
1159 | NETDRV_W8_F(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | |
1160 | CmdRxEnb | CmdTxEnb); | |
1da177e4 LT |
1161 | |
1162 | i = netdrv_rx_config | | |
9cd31f07 JP |
1163 | (NETDRV_R32(RxConfig) & rtl_chip_info[tp->chipset].RxConfigMask); |
1164 | NETDRV_W32_F(RxConfig, i); | |
1da177e4 LT |
1165 | |
1166 | /* Check this value: the documentation for IFG contradicts ifself. */ | |
9cd31f07 | 1167 | NETDRV_W32(TxConfig, (TX_DMA_BURST << TxDMAShift)); |
1da177e4 LT |
1168 | |
1169 | /* unlock Config[01234] and BMCR register writes */ | |
9cd31f07 JP |
1170 | NETDRV_W8_F(Cfg9346, Cfg9346_Unlock); |
1171 | udelay(10); | |
1da177e4 LT |
1172 | |
1173 | tp->cur_rx = 0; | |
1174 | ||
1175 | /* Lock Config[01234] and BMCR register writes */ | |
9cd31f07 JP |
1176 | NETDRV_W8_F(Cfg9346, Cfg9346_Lock); |
1177 | udelay(10); | |
1da177e4 LT |
1178 | |
1179 | /* init Rx ring buffer DMA address */ | |
9cd31f07 | 1180 | NETDRV_W32_F(RxBuf, tp->rx_ring_dma); |
1da177e4 LT |
1181 | |
1182 | /* init Tx buffer DMA addresses */ | |
1183 | for (i = 0; i < NUM_TX_DESC; i++) | |
9cd31f07 | 1184 | NETDRV_W32_F(TxAddr0 + (i * 4), tp->tx_bufs_dma + (tp->tx_buf[i] - tp->tx_bufs)); |
1da177e4 | 1185 | |
9cd31f07 | 1186 | NETDRV_W32_F(RxMissed, 0); |
1da177e4 | 1187 | |
9cd31f07 | 1188 | netdrv_set_rx_mode(dev); |
1da177e4 LT |
1189 | |
1190 | /* no early-rx interrupts */ | |
9cd31f07 | 1191 | NETDRV_W16(MultiIntr, NETDRV_R16(MultiIntr) & MultiIntrClear); |
1da177e4 LT |
1192 | |
1193 | /* make sure RxTx has started */ | |
9cd31f07 JP |
1194 | NETDRV_W8_F(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear) | |
1195 | CmdRxEnb | CmdTxEnb); | |
1da177e4 LT |
1196 | |
1197 | /* Enable all known interrupts by setting the interrupt mask. */ | |
9cd31f07 | 1198 | NETDRV_W16_F(IntrMask, netdrv_intr_mask); |
1da177e4 | 1199 | |
9cd31f07 | 1200 | netif_start_queue(dev); |
1da177e4 | 1201 | |
9cd31f07 | 1202 | DPRINTK("EXIT\n"); |
1da177e4 LT |
1203 | } |
1204 | ||
1205 | ||
1206 | /* Initialize the Rx and Tx rings, along with various 'dev' bits. */ | |
9cd31f07 | 1207 | static void netdrv_init_ring(struct net_device *dev) |
1da177e4 | 1208 | { |
44911bfe | 1209 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1210 | int i; |
1211 | ||
9cd31f07 | 1212 | DPRINTK("ENTER\n"); |
1da177e4 LT |
1213 | |
1214 | tp->cur_rx = 0; | |
9cd31f07 JP |
1215 | atomic_set(&tp->cur_tx, 0); |
1216 | atomic_set(&tp->dirty_tx, 0); | |
1da177e4 LT |
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 | ||
9cd31f07 | 1224 | DPRINTK("EXIT\n"); |
1da177e4 LT |
1225 | } |
1226 | ||
1227 | ||
9cd31f07 | 1228 | static void netdrv_timer(unsigned long data) |
1da177e4 LT |
1229 | { |
1230 | struct net_device *dev = (struct net_device *) data; | |
44911bfe | 1231 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1232 | void *ioaddr = tp->mmio_addr; |
1233 | int next_tick = 60 * HZ; | |
1234 | int mii_lpa; | |
1235 | ||
9cd31f07 | 1236 | mii_lpa = mdio_read(dev, tp->phys[0], MII_LPA); |
1da177e4 LT |
1237 | |
1238 | if (!tp->duplex_lock && mii_lpa != 0xffff) { | |
8e95a202 | 1239 | int duplex = ((mii_lpa & LPA_100FULL) || |
9cd31f07 | 1240 | (mii_lpa & 0x01C0) == 0x0040); |
1da177e4 LT |
1241 | if (tp->full_duplex != duplex) { |
1242 | tp->full_duplex = duplex; | |
9cd31f07 JP |
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); | |
1da177e4 LT |
1249 | } |
1250 | } | |
1251 | ||
9cd31f07 JP |
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)); | |
1da177e4 LT |
1260 | |
1261 | tp->timer.expires = jiffies + next_tick; | |
9cd31f07 | 1262 | add_timer(&tp->timer); |
1da177e4 LT |
1263 | } |
1264 | ||
1265 | ||
9cd31f07 | 1266 | static void netdrv_tx_clear(struct net_device *dev) |
1da177e4 LT |
1267 | { |
1268 | int i; | |
44911bfe | 1269 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 | 1270 | |
9cd31f07 JP |
1271 | atomic_set(&tp->cur_tx, 0); |
1272 | atomic_set(&tp->dirty_tx, 0); | |
1da177e4 LT |
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) { | |
9cd31f07 JP |
1278 | pci_unmap_single(tp->pci_dev, rp->mapping, |
1279 | rp->skb->len, PCI_DMA_TODEVICE); | |
1da177e4 LT |
1280 | rp->mapping = 0; |
1281 | } | |
1282 | if (rp->skb) { | |
9cd31f07 | 1283 | dev_kfree_skb(rp->skb); |
1da177e4 | 1284 | rp->skb = NULL; |
09f75cd7 | 1285 | dev->stats.tx_dropped++; |
1da177e4 LT |
1286 | } |
1287 | } | |
1288 | } | |
1289 | ||
1290 | ||
9cd31f07 | 1291 | static void netdrv_tx_timeout(struct net_device *dev) |
1da177e4 | 1292 | { |
44911bfe | 1293 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1294 | void *ioaddr = tp->mmio_addr; |
1295 | int i; | |
1296 | u8 tmp8; | |
1297 | unsigned long flags; | |
1298 | ||
9cd31f07 JP |
1299 | netdev_dbg(dev, "Transmit timeout, status %02x %04x media %02x\n", |
1300 | NETDRV_R8(ChipCmd), | |
1301 | NETDRV_R16(IntrStatus), | |
1302 | NETDRV_R8(MediaStatus)); | |
1da177e4 LT |
1303 | |
1304 | /* disable Tx ASAP, if not already */ | |
9cd31f07 | 1305 | tmp8 = NETDRV_R8(ChipCmd); |
1da177e4 | 1306 | if (tmp8 & CmdTxEnb) |
9cd31f07 | 1307 | NETDRV_W8(ChipCmd, tmp8 & ~CmdTxEnb); |
1da177e4 LT |
1308 | |
1309 | /* Disable interrupts by clearing the interrupt mask. */ | |
9cd31f07 | 1310 | NETDRV_W16(IntrMask, 0x0000); |
1da177e4 LT |
1311 | |
1312 | /* Emit info to figure out what went wrong. */ | |
9cd31f07 JP |
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)); | |
1da177e4 | 1316 | for (i = 0; i < NUM_TX_DESC; i++) |
9cd31f07 JP |
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)" : ""); | |
1da177e4 LT |
1321 | |
1322 | /* Stop a shared interrupt from scavenging while we are. */ | |
9cd31f07 | 1323 | spin_lock_irqsave(&tp->lock, flags); |
6aa20a22 | 1324 | |
9cd31f07 | 1325 | netdrv_tx_clear(dev); |
1da177e4 | 1326 | |
9cd31f07 | 1327 | spin_unlock_irqrestore(&tp->lock, flags); |
1da177e4 LT |
1328 | |
1329 | /* ...and finally, reset everything */ | |
9cd31f07 | 1330 | netdrv_hw_start(dev); |
1da177e4 | 1331 | |
9cd31f07 | 1332 | netif_wake_queue(dev); |
1da177e4 LT |
1333 | } |
1334 | ||
1335 | ||
1336 | ||
9cd31f07 | 1337 | static int netdrv_start_xmit(struct sk_buff *skb, struct net_device *dev) |
1da177e4 | 1338 | { |
44911bfe | 1339 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1340 | void *ioaddr = tp->mmio_addr; |
1341 | int entry; | |
1342 | ||
1343 | /* Calculate the next Tx descriptor entry. */ | |
9cd31f07 | 1344 | entry = atomic_read(&tp->cur_tx) % NUM_TX_DESC; |
1da177e4 | 1345 | |
9cd31f07 JP |
1346 | assert(tp->tx_info[entry].skb == NULL); |
1347 | assert(tp->tx_info[entry].mapping == 0); | |
1da177e4 LT |
1348 | |
1349 | tp->tx_info[entry].skb = skb; | |
1350 | /* tp->tx_info[entry].mapping = 0; */ | |
d626f62b | 1351 | skb_copy_from_linear_data(skb, tp->tx_buf[entry], skb->len); |
1da177e4 LT |
1352 | |
1353 | /* Note: the chip doesn't have auto-pad! */ | |
9cd31f07 JP |
1354 | NETDRV_W32(TxStatus0 + (entry * sizeof(u32)), |
1355 | tp->tx_flag | (skb->len >= ETH_ZLEN ? skb->len : ETH_ZLEN)); | |
1da177e4 | 1356 | |
9cd31f07 JP |
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); | |
1da177e4 | 1360 | |
9cd31f07 JP |
1361 | netdev_dbg(dev, "Queued Tx packet at %p size %u to slot %d\n", |
1362 | skb->data, skb->len, entry); | |
1da177e4 | 1363 | |
6ed10654 | 1364 | return NETDEV_TX_OK; |
1da177e4 LT |
1365 | } |
1366 | ||
1367 | ||
9cd31f07 JP |
1368 | static void netdrv_tx_interrupt(struct net_device *dev, |
1369 | struct netdrv_private *tp, | |
1370 | void *ioaddr) | |
1da177e4 LT |
1371 | { |
1372 | int cur_tx, dirty_tx, tx_left; | |
1373 | ||
9cd31f07 JP |
1374 | assert(dev != NULL); |
1375 | assert(tp != NULL); | |
1376 | assert(ioaddr != NULL); | |
1da177e4 | 1377 | |
9cd31f07 | 1378 | dirty_tx = atomic_read(&tp->dirty_tx); |
1da177e4 | 1379 | |
9cd31f07 | 1380 | cur_tx = atomic_read(&tp->cur_tx); |
1da177e4 LT |
1381 | tx_left = cur_tx - dirty_tx; |
1382 | while (tx_left > 0) { | |
1383 | int entry = dirty_tx % NUM_TX_DESC; | |
1384 | int txstatus; | |
1385 | ||
9cd31f07 | 1386 | txstatus = NETDRV_R32(TxStatus0 + (entry * sizeof(u32))); |
1da177e4 LT |
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. */ | |
9cd31f07 JP |
1394 | netdev_dbg(dev, "Transmit error, Tx status %#08x\n", |
1395 | txstatus); | |
09f75cd7 | 1396 | dev->stats.tx_errors++; |
1da177e4 | 1397 | if (txstatus & TxAborted) { |
09f75cd7 | 1398 | dev->stats.tx_aborted_errors++; |
9cd31f07 | 1399 | NETDRV_W32(TxConfig, TxClearAbt | (TX_DMA_BURST << TxDMAShift)); |
1da177e4 LT |
1400 | } |
1401 | if (txstatus & TxCarrierLost) | |
09f75cd7 | 1402 | dev->stats.tx_carrier_errors++; |
1da177e4 | 1403 | if (txstatus & TxOutOfWindow) |
09f75cd7 | 1404 | dev->stats.tx_window_errors++; |
1da177e4 LT |
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; | |
09f75cd7 | 1410 | dev->stats.tx_fifo_errors++; |
1da177e4 | 1411 | } |
09f75cd7 JG |
1412 | dev->stats.collisions += (txstatus >> 24) & 15; |
1413 | dev->stats.tx_bytes += txstatus & 0x7ff; | |
1414 | dev->stats.tx_packets++; | |
1da177e4 LT |
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 | } | |
9cd31f07 | 1425 | dev_kfree_skb_irq(tp->tx_info[entry].skb); |
1da177e4 LT |
1426 | tp->tx_info[entry].skb = NULL; |
1427 | dirty_tx++; | |
1428 | if (dirty_tx < 0) { /* handle signed int overflow */ | |
9cd31f07 | 1429 | atomic_sub(cur_tx, &tp->cur_tx); /* XXX racy? */ |
1da177e4 LT |
1430 | dirty_tx = cur_tx - tx_left + 1; |
1431 | } | |
9cd31f07 JP |
1432 | if (netif_queue_stopped(dev)) |
1433 | netif_wake_queue(dev); | |
1da177e4 | 1434 | |
9cd31f07 | 1435 | cur_tx = atomic_read(&tp->cur_tx); |
1da177e4 LT |
1436 | tx_left = cur_tx - dirty_tx; |
1437 | ||
1438 | } | |
1439 | ||
1440 | #ifndef NETDRV_NDEBUG | |
9cd31f07 JP |
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)); | |
1da177e4 LT |
1444 | dirty_tx += NUM_TX_DESC; |
1445 | } | |
1446 | #endif /* NETDRV_NDEBUG */ | |
1447 | ||
9cd31f07 | 1448 | atomic_set(&tp->dirty_tx, dirty_tx); |
1da177e4 LT |
1449 | } |
1450 | ||
1451 | ||
1452 | /* TODO: clean this up! Rx reset need not be this intensive */ | |
9cd31f07 JP |
1453 | static void netdrv_rx_err(u32 rx_status, struct net_device *dev, |
1454 | struct netdrv_private *tp, void *ioaddr) | |
1da177e4 LT |
1455 | { |
1456 | u8 tmp8; | |
1457 | int tmp_work = 1000; | |
1458 | ||
9cd31f07 JP |
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); | |
1da177e4 | 1463 | /* A.C.: The chip hangs here. */ |
09f75cd7 | 1464 | dev->stats.rx_errors++; |
1da177e4 | 1465 | if (rx_status & (RxBadSymbol | RxBadAlign)) |
09f75cd7 | 1466 | dev->stats.rx_frame_errors++; |
1da177e4 | 1467 | if (rx_status & (RxRunt | RxTooLong)) |
09f75cd7 | 1468 | dev->stats.rx_length_errors++; |
1da177e4 | 1469 | if (rx_status & RxCRCErr) |
09f75cd7 | 1470 | dev->stats.rx_crc_errors++; |
9cd31f07 | 1471 | /* Reset the receiver, based on RealTek recommendation.(Bug?) */ |
1da177e4 LT |
1472 | tp->cur_rx = 0; |
1473 | ||
1474 | /* disable receive */ | |
9cd31f07 JP |
1475 | tmp8 = NETDRV_R8(ChipCmd) & ChipCmdClear; |
1476 | NETDRV_W8_F(ChipCmd, tmp8 | CmdTxEnb); | |
1da177e4 LT |
1477 | |
1478 | /* A.C.: Reset the multicast list. */ | |
9cd31f07 | 1479 | netdrv_set_rx_mode(dev); |
1da177e4 LT |
1480 | |
1481 | /* XXX potentially temporary hack to | |
1482 | * restart hung receiver */ | |
1483 | while (--tmp_work > 0) { | |
9cd31f07 | 1484 | tmp8 = NETDRV_R8(ChipCmd); |
1da177e4 LT |
1485 | if ((tmp8 & CmdRxEnb) && (tmp8 & CmdTxEnb)) |
1486 | break; | |
9cd31f07 JP |
1487 | NETDRV_W8_F(ChipCmd, |
1488 | (tmp8 & ChipCmdClear) | CmdRxEnb | CmdTxEnb); | |
1da177e4 LT |
1489 | } |
1490 | ||
1491 | /* G.S.: Re-enable receiver */ | |
1492 | /* XXX temporary hack to work around receiver hang */ | |
9cd31f07 | 1493 | netdrv_set_rx_mode(dev); |
1da177e4 LT |
1494 | |
1495 | if (tmp_work <= 0) | |
9cd31f07 | 1496 | netdev_warn(dev, "tx/rx enable wait too long\n"); |
1da177e4 LT |
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. */ | |
9cd31f07 JP |
1502 | static void netdrv_rx_interrupt(struct net_device *dev, |
1503 | struct netdrv_private *tp, void *ioaddr) | |
1da177e4 LT |
1504 | { |
1505 | unsigned char *rx_ring; | |
1506 | u16 cur_rx; | |
1507 | ||
9cd31f07 JP |
1508 | assert(dev != NULL); |
1509 | assert(tp != NULL); | |
1510 | assert(ioaddr != NULL); | |
1da177e4 LT |
1511 | |
1512 | rx_ring = tp->rx_ring; | |
1513 | cur_rx = tp->cur_rx; | |
1514 | ||
9cd31f07 JP |
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)); | |
1da177e4 | 1518 | |
9cd31f07 | 1519 | while ((NETDRV_R8(ChipCmd) & RxBufEmpty) == 0) { |
1da177e4 LT |
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 */ | |
9cd31f07 | 1527 | rx_status = le32_to_cpu(*(u32 *)(rx_ring + ring_offset)); |
1da177e4 LT |
1528 | rx_size = rx_status >> 16; |
1529 | pkt_size = rx_size - 4; | |
1530 | ||
9cd31f07 JP |
1531 | netdev_dbg(dev, "netdrv_rx() status %04x, size %04x, cur %04x\n", |
1532 | rx_status, rx_size, cur_rx); | |
44911bfe | 1533 | #if defined(NETDRV_DEBUG) && (NETDRV_DEBUG > 2) |
9cd31f07 JP |
1534 | print_hex_dump_bytes("Frame contents: ", HEX_DUMP_OFFSET, |
1535 | &rx_ring[ring_offset], 70); | |
1da177e4 LT |
1536 | #endif |
1537 | ||
1538 | /* If Rx err or invalid rx_size/rx_status received | |
9cd31f07 | 1539 | *(which happens if we get lost in the ring), |
1da177e4 LT |
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))) { | |
9cd31f07 | 1545 | netdrv_rx_err(rx_status, dev, tp, ioaddr); |
1da177e4 LT |
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 | ||
9cd31f07 | 1558 | skb = dev_alloc_skb(pkt_size + 2); |
1da177e4 | 1559 | if (skb) { |
9cd31f07 | 1560 | skb_reserve(skb, 2); /* 16 byte align the IP fields. */ |
1da177e4 | 1561 | |
9cd31f07 JP |
1562 | skb_copy_to_linear_data(skb, &rx_ring[ring_offset + 4], pkt_size); |
1563 | skb_put(skb, pkt_size); | |
1da177e4 | 1564 | |
9cd31f07 JP |
1565 | skb->protocol = eth_type_trans(skb, dev); |
1566 | netif_rx(skb); | |
09f75cd7 JG |
1567 | dev->stats.rx_bytes += pkt_size; |
1568 | dev->stats.rx_packets++; | |
1da177e4 | 1569 | } else { |
9cd31f07 | 1570 | netdev_warn(dev, "Memory squeeze, dropping packet\n"); |
09f75cd7 | 1571 | dev->stats.rx_dropped++; |
1da177e4 LT |
1572 | } |
1573 | ||
1574 | cur_rx = (cur_rx + rx_size + 4 + 3) & ~3; | |
9cd31f07 | 1575 | NETDRV_W16_F(RxBufPtr, cur_rx - 16); |
1da177e4 LT |
1576 | } |
1577 | ||
9cd31f07 JP |
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)); | |
1da177e4 LT |
1581 | |
1582 | tp->cur_rx = cur_rx; | |
1583 | } | |
1584 | ||
1585 | ||
9cd31f07 JP |
1586 | static void netdrv_weird_interrupt(struct net_device *dev, |
1587 | struct netdrv_private *tp, | |
1588 | void *ioaddr, | |
1589 | int status, int link_changed) | |
1da177e4 | 1590 | { |
9cd31f07 JP |
1591 | netdev_printk(KERN_DEBUG, dev, "Abnormal interrupt, status %08x\n", |
1592 | status); | |
1da177e4 | 1593 | |
9cd31f07 JP |
1594 | assert(dev != NULL); |
1595 | assert(tp != NULL); | |
1596 | assert(ioaddr != NULL); | |
1da177e4 LT |
1597 | |
1598 | /* Update the error count. */ | |
9cd31f07 JP |
1599 | dev->stats.rx_missed_errors += NETDRV_R32(RxMissed); |
1600 | NETDRV_W32(RxMissed, 0); | |
1da177e4 LT |
1601 | |
1602 | if ((status & RxUnderrun) && link_changed && | |
1603 | (tp->drv_flags & HAS_LNK_CHNG)) { | |
1604 | /* Really link-change on new chips. */ | |
9cd31f07 | 1605 | int lpar = NETDRV_R16(NWayLPAR); |
8e95a202 | 1606 | int duplex = ((lpar & 0x0100) || (lpar & 0x01C0) == 0x0040 || |
9cd31f07 | 1607 | tp->duplex_lock); |
1da177e4 LT |
1608 | if (tp->full_duplex != duplex) { |
1609 | tp->full_duplex = duplex; | |
9cd31f07 JP |
1610 | NETDRV_W8(Cfg9346, Cfg9346_Unlock); |
1611 | NETDRV_W8(Config1, tp->full_duplex ? 0x60 : 0x20); | |
1612 | NETDRV_W8(Cfg9346, Cfg9346_Lock); | |
1da177e4 LT |
1613 | } |
1614 | status &= ~RxUnderrun; | |
1615 | } | |
1616 | ||
1617 | /* XXX along with netdrv_rx_err, are we double-counting errors? */ | |
9cd31f07 | 1618 | if (status & (RxUnderrun | RxOverflow | RxErr | RxFIFOOver)) |
09f75cd7 | 1619 | dev->stats.rx_errors++; |
1da177e4 LT |
1620 | |
1621 | if (status & (PCSTimeout)) | |
09f75cd7 | 1622 | dev->stats.rx_length_errors++; |
1da177e4 | 1623 | if (status & (RxUnderrun | RxFIFOOver)) |
09f75cd7 | 1624 | dev->stats.rx_fifo_errors++; |
1da177e4 | 1625 | if (status & RxOverflow) { |
09f75cd7 | 1626 | dev->stats.rx_over_errors++; |
9cd31f07 JP |
1627 | tp->cur_rx = NETDRV_R16(RxBufAddr) % RX_BUF_LEN; |
1628 | NETDRV_W16_F(RxBufPtr, tp->cur_rx - 16); | |
1da177e4 LT |
1629 | } |
1630 | if (status & PCIErr) { | |
1631 | u16 pci_cmd_status; | |
9cd31f07 | 1632 | pci_read_config_word(tp->pci_dev, PCI_STATUS, &pci_cmd_status); |
1da177e4 | 1633 | |
9cd31f07 | 1634 | netdev_err(dev, "PCI Bus error %04x\n", pci_cmd_status); |
1da177e4 LT |
1635 | } |
1636 | } | |
1637 | ||
1638 | ||
1639 | /* The interrupt handler does all of the Rx thread work and cleans up | |
1640 | after the Tx thread. */ | |
9cd31f07 | 1641 | static irqreturn_t netdrv_interrupt(int irq, void *dev_instance) |
1da177e4 LT |
1642 | { |
1643 | struct net_device *dev = (struct net_device *) dev_instance; | |
44911bfe | 1644 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
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 | ||
9cd31f07 | 1650 | spin_lock(&tp->lock); |
1da177e4 LT |
1651 | |
1652 | do { | |
9cd31f07 | 1653 | status = NETDRV_R16(IntrStatus); |
1da177e4 | 1654 | |
9cd31f07 | 1655 | /* h/w no longer present(hotplug?) or major error, bail */ |
1da177e4 LT |
1656 | if (status == 0xFFFF) |
1657 | break; | |
1658 | ||
1659 | handled = 1; | |
1660 | /* Acknowledge all of the current interrupt sources ASAP */ | |
9cd31f07 | 1661 | NETDRV_W16_F(IntrStatus, status); |
1da177e4 | 1662 | |
9cd31f07 JP |
1663 | netdev_dbg(dev, "interrupt status=%#04x new intstat=%#04x\n", |
1664 | status, NETDRV_R16(IntrStatus)); | |
1da177e4 LT |
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 | | |
9cd31f07 JP |
1673 | RxFIFOOver | TxErr | RxErr)) |
1674 | netdrv_weird_interrupt(dev, tp, ioaddr, | |
1675 | status, link_changed); | |
1da177e4 LT |
1676 | |
1677 | if (status & (RxOK | RxUnderrun | RxOverflow | RxFIFOOver)) /* Rx interrupt */ | |
9cd31f07 | 1678 | netdrv_rx_interrupt(dev, tp, ioaddr); |
1da177e4 LT |
1679 | |
1680 | if (status & (TxOK | TxErr)) | |
9cd31f07 | 1681 | netdrv_tx_interrupt(dev, tp, ioaddr); |
1da177e4 LT |
1682 | |
1683 | boguscnt--; | |
1684 | } while (boguscnt > 0); | |
1685 | ||
1686 | if (boguscnt <= 0) { | |
9cd31f07 JP |
1687 | netdev_warn(dev, "Too much work at interrupt, IntrStatus=%#04x\n", |
1688 | status); | |
1da177e4 LT |
1689 | |
1690 | /* Clear all interrupt sources. */ | |
9cd31f07 | 1691 | NETDRV_W16(IntrStatus, 0xffff); |
1da177e4 LT |
1692 | } |
1693 | ||
9cd31f07 | 1694 | spin_unlock(&tp->lock); |
1da177e4 | 1695 | |
9cd31f07 JP |
1696 | netdev_dbg(dev, "exiting interrupt, intr_status=%#04x\n", |
1697 | NETDRV_R16(IntrStatus)); | |
1da177e4 LT |
1698 | return IRQ_RETVAL(handled); |
1699 | } | |
1700 | ||
1701 | ||
9cd31f07 | 1702 | static int netdrv_close(struct net_device *dev) |
1da177e4 | 1703 | { |
44911bfe | 1704 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1705 | void *ioaddr = tp->mmio_addr; |
1706 | unsigned long flags; | |
1707 | ||
9cd31f07 | 1708 | DPRINTK("ENTER\n"); |
1da177e4 | 1709 | |
9cd31f07 | 1710 | netif_stop_queue(dev); |
1da177e4 | 1711 | |
9cd31f07 JP |
1712 | netdev_dbg(dev, "Shutting down ethercard, status was %#04x\n", |
1713 | NETDRV_R16(IntrStatus)); | |
1da177e4 | 1714 | |
9cd31f07 | 1715 | del_timer_sync(&tp->timer); |
1da177e4 | 1716 | |
9cd31f07 | 1717 | spin_lock_irqsave(&tp->lock, flags); |
1da177e4 LT |
1718 | |
1719 | /* Stop the chip's Tx and Rx DMA processes. */ | |
9cd31f07 | 1720 | NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear)); |
1da177e4 LT |
1721 | |
1722 | /* Disable interrupts by clearing the interrupt mask. */ | |
9cd31f07 | 1723 | NETDRV_W16(IntrMask, 0x0000); |
1da177e4 LT |
1724 | |
1725 | /* Update the error counts. */ | |
9cd31f07 JP |
1726 | dev->stats.rx_missed_errors += NETDRV_R32(RxMissed); |
1727 | NETDRV_W32(RxMissed, 0); | |
1da177e4 | 1728 | |
9cd31f07 | 1729 | spin_unlock_irqrestore(&tp->lock, flags); |
1da177e4 | 1730 | |
9cd31f07 | 1731 | free_irq(dev->irq, dev); |
1da177e4 | 1732 | |
9cd31f07 | 1733 | netdrv_tx_clear(dev); |
1da177e4 LT |
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. */ | |
9cd31f07 JP |
1743 | NETDRV_W8(Cfg9346, Cfg9346_Unlock); |
1744 | NETDRV_W8(Config1, 0x03); | |
1745 | NETDRV_W8(Cfg9346, Cfg9346_Lock); | |
1da177e4 | 1746 | |
9cd31f07 | 1747 | DPRINTK("EXIT\n"); |
1da177e4 LT |
1748 | return 0; |
1749 | } | |
1750 | ||
1751 | ||
9cd31f07 | 1752 | static int netdrv_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) |
1da177e4 | 1753 | { |
44911bfe | 1754 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1755 | struct mii_ioctl_data *data = if_mii(rq); |
1756 | unsigned long flags; | |
1757 | int rc = 0; | |
1758 | ||
9cd31f07 | 1759 | DPRINTK("ENTER\n"); |
1da177e4 LT |
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. */ | |
9cd31f07 JP |
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); | |
1da177e4 LT |
1770 | break; |
1771 | ||
1772 | case SIOCSMIIREG: /* Write MII PHY register. */ | |
9cd31f07 JP |
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); | |
1da177e4 LT |
1776 | break; |
1777 | ||
1778 | default: | |
1779 | rc = -EOPNOTSUPP; | |
1780 | break; | |
1781 | } | |
1782 | ||
9cd31f07 | 1783 | DPRINTK("EXIT, returning %d\n", rc); |
1da177e4 LT |
1784 | return rc; |
1785 | } | |
1786 | ||
1da177e4 LT |
1787 | /* Set or clear the multicast filter for this adaptor. |
1788 | This routine is not state sensitive and need not be SMP locked. */ | |
1789 | ||
9cd31f07 | 1790 | static void netdrv_set_rx_mode(struct net_device *dev) |
1da177e4 | 1791 | { |
44911bfe | 1792 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1793 | void *ioaddr = tp->mmio_addr; |
1794 | u32 mc_filter[2]; /* Multicast hash filter */ | |
f9dcbcc9 | 1795 | int rx_mode; |
1da177e4 LT |
1796 | u32 tmp; |
1797 | ||
9cd31f07 | 1798 | DPRINTK("ENTER\n"); |
1da177e4 | 1799 | |
9cd31f07 JP |
1800 | netdev_dbg(dev, "%s(%04x) done -- Rx config %08lx\n", |
1801 | __func__, dev->flags, NETDRV_R32(RxConfig)); | |
1da177e4 LT |
1802 | |
1803 | /* Note: do not reorder, GCC is clever about common statements. */ | |
1804 | if (dev->flags & IFF_PROMISC) { | |
1da177e4 | 1805 | rx_mode = |
9cd31f07 JP |
1806 | AcceptBroadcast | AcceptMulticast | AcceptMyPhys | |
1807 | AcceptAllPhys; | |
1da177e4 | 1808 | mc_filter[1] = mc_filter[0] = 0xffffffff; |
4cd24eaf | 1809 | } else if ((netdev_mc_count(dev) > multicast_filter_limit) || |
8e95a202 | 1810 | (dev->flags & IFF_ALLMULTI)) { |
1da177e4 LT |
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 { | |
22bedad3 | 1815 | struct netdev_hw_addr *ha; |
f9dcbcc9 | 1816 | |
1da177e4 LT |
1817 | rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys; |
1818 | mc_filter[1] = mc_filter[0] = 0; | |
22bedad3 JP |
1819 | netdev_for_each_mc_addr(ha, dev) { |
1820 | int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26; | |
1da177e4 LT |
1821 | |
1822 | mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31); | |
1823 | } | |
1824 | } | |
1825 | ||
1826 | /* if called from irq handler, lock already acquired */ | |
9cd31f07 JP |
1827 | if (!in_irq()) |
1828 | spin_lock_irq(&tp->lock); | |
1da177e4 LT |
1829 | |
1830 | /* We can safely update without stopping the chip. */ | |
1831 | tmp = netdrv_rx_config | rx_mode | | |
9cd31f07 JP |
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]); | |
1da177e4 | 1836 | |
9cd31f07 JP |
1837 | if (!in_irq()) |
1838 | spin_unlock_irq(&tp->lock); | |
1da177e4 | 1839 | |
9cd31f07 | 1840 | DPRINTK("EXIT\n"); |
1da177e4 LT |
1841 | } |
1842 | ||
1843 | ||
1844 | #ifdef CONFIG_PM | |
1845 | ||
9cd31f07 | 1846 | static int netdrv_suspend(struct pci_dev *pdev, pm_message_t state) |
1da177e4 | 1847 | { |
9cd31f07 | 1848 | struct net_device *dev = pci_get_drvdata(pdev); |
44911bfe | 1849 | struct netdrv_private *tp = netdev_priv(dev); |
1da177e4 LT |
1850 | void *ioaddr = tp->mmio_addr; |
1851 | unsigned long flags; | |
1852 | ||
1853 | if (!netif_running(dev)) | |
1854 | return 0; | |
9cd31f07 | 1855 | netif_device_detach(dev); |
1da177e4 | 1856 | |
9cd31f07 | 1857 | spin_lock_irqsave(&tp->lock, flags); |
1da177e4 LT |
1858 | |
1859 | /* Disable interrupts, stop Tx and Rx. */ | |
9cd31f07 JP |
1860 | NETDRV_W16(IntrMask, 0x0000); |
1861 | NETDRV_W8(ChipCmd, (NETDRV_R8(ChipCmd) & ChipCmdClear)); | |
1da177e4 LT |
1862 | |
1863 | /* Update the error counts. */ | |
9cd31f07 JP |
1864 | dev->stats.rx_missed_errors += NETDRV_R32(RxMissed); |
1865 | NETDRV_W32(RxMissed, 0); | |
1da177e4 | 1866 | |
9cd31f07 | 1867 | spin_unlock_irqrestore(&tp->lock, flags); |
1da177e4 | 1868 | |
9cd31f07 JP |
1869 | pci_save_state(pdev); |
1870 | pci_set_power_state(pdev, PCI_D3hot); | |
1da177e4 LT |
1871 | |
1872 | return 0; | |
1873 | } | |
1874 | ||
1875 | ||
9cd31f07 | 1876 | static int netdrv_resume(struct pci_dev *pdev) |
1da177e4 | 1877 | { |
9cd31f07 | 1878 | struct net_device *dev = pci_get_drvdata(pdev); |
44911bfe | 1879 | /*struct netdrv_private *tp = netdev_priv(dev);*/ |
1da177e4 LT |
1880 | |
1881 | if (!netif_running(dev)) | |
1882 | return 0; | |
9cd31f07 JP |
1883 | pci_set_power_state(pdev, PCI_D0); |
1884 | pci_restore_state(pdev); | |
1885 | netif_device_attach(dev); | |
1886 | netdrv_hw_start(dev); | |
1da177e4 LT |
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 | ||
9cd31f07 | 1906 | static int __init netdrv_init_module(void) |
1da177e4 LT |
1907 | { |
1908 | /* when a module, this is printed whether or not devices are found in probe */ | |
1909 | #ifdef MODULE | |
1910 | printk(version); | |
1911 | #endif | |
29917620 | 1912 | return pci_register_driver(&netdrv_pci_driver); |
1da177e4 LT |
1913 | } |
1914 | ||
1915 | ||
9cd31f07 | 1916 | static void __exit netdrv_cleanup_module(void) |
1da177e4 | 1917 | { |
9cd31f07 | 1918 | pci_unregister_driver(&netdrv_pci_driver); |
1da177e4 LT |
1919 | } |
1920 | ||
1921 | ||
1922 | module_init(netdrv_init_module); | |
1923 | module_exit(netdrv_cleanup_module); |