?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Merge remote-tracking branch 'moduleh/module.h-split'
[linux-2.6/next.git] / drivers / net / ethernet / packetengines / yellowfin.c
blobdb44e9af03c317ca1cd5e713fd8ccf781d09683f
1 /* yellowfin.c: A Packet Engines G-NIC ethernet driver for linux. */
2 /*
3 Written 1997-2001 by Donald Becker.
4
5 This software may be used and distributed according to the terms of
6 the GNU General Public License (GPL), incorporated herein by reference.
7 Drivers based on or derived from this code fall under the GPL and must
8 retain the authorship, copyright and license notice. This file is not
9 a complete program and may only be used when the entire operating
10 system is licensed under the GPL.
11
12 This driver is for the Packet Engines G-NIC PCI Gigabit Ethernet adapter.
13 It also supports the Symbios Logic version of the same chip core.
14
15 The author may be reached as becker@scyld.com, or C/O
16 Scyld Computing Corporation
17 410 Severn Ave., Suite 210
18 Annapolis MD 21403
19
20 Support and updates available at
21 http://www.scyld.com/network/yellowfin.html
22 [link no longer provides useful info -jgarzik]
23
24 */
25
26 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
27
28 #define DRV_NAME "yellowfin"
29 #define DRV_VERSION "2.1"
30 #define DRV_RELDATE "Sep 11, 2006"
31
32 /* The user-configurable values.
33 These may be modified when a driver module is loaded.*/
34
35 static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */
36 /* Maximum events (Rx packets, etc.) to handle at each interrupt. */
37 static int max_interrupt_work = 20;
38 static int mtu;
39 #ifdef YF_PROTOTYPE /* Support for prototype hardware errata. */
40 /* System-wide count of bogus-rx frames. */
41 static int bogus_rx;
42 static int dma_ctrl = 0x004A0263; /* Constrained by errata */
43 static int fifo_cfg = 0x0020; /* Bypass external Tx FIFO. */
44 #elif defined(YF_NEW) /* A future perfect board :->. */
45 static int dma_ctrl = 0x00CAC277; /* Override when loading module! */
46 static int fifo_cfg = 0x0028;
47 #else
48 static const int dma_ctrl = 0x004A0263; /* Constrained by errata */
49 static const int fifo_cfg = 0x0020; /* Bypass external Tx FIFO. */
50 #endif
51
52 /* Set the copy breakpoint for the copy-only-tiny-frames scheme.
53 Setting to > 1514 effectively disables this feature. */
54 static int rx_copybreak;
55
56 /* Used to pass the media type, etc.
57 No media types are currently defined. These exist for driver
58 interoperability.
59 */
60 #define MAX_UNITS 8 /* More are supported, limit only on options */
61 static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
62 static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
63
64 /* Do ugly workaround for GX server chipset errata. */
65 static int gx_fix;
66
67 /* Operational parameters that are set at compile time. */
68
69 /* Keep the ring sizes a power of two for efficiency.
70 Making the Tx ring too long decreases the effectiveness of channel
71 bonding and packet priority.
72 There are no ill effects from too-large receive rings. */
73 #define TX_RING_SIZE 16
74 #define TX_QUEUE_SIZE 12 /* Must be > 4 && <= TX_RING_SIZE */
75 #define RX_RING_SIZE 64
76 #define STATUS_TOTAL_SIZE TX_RING_SIZE*sizeof(struct tx_status_words)
77 #define TX_TOTAL_SIZE 2*TX_RING_SIZE*sizeof(struct yellowfin_desc)
78 #define RX_TOTAL_SIZE RX_RING_SIZE*sizeof(struct yellowfin_desc)
79
80 /* Operational parameters that usually are not changed. */
81 /* Time in jiffies before concluding the transmitter is hung. */
82 #define TX_TIMEOUT (2*HZ)
83 #define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
84
85 #define yellowfin_debug debug
86
87 #include <linux/module.h>
88 #include <linux/kernel.h>
89 #include <linux/string.h>
90 #include <linux/timer.h>
91 #include <linux/errno.h>
92 #include <linux/ioport.h>
93 #include <linux/interrupt.h>
94 #include <linux/pci.h>
95 #include <linux/init.h>
96 #include <linux/mii.h>
97 #include <linux/netdevice.h>
98 #include <linux/etherdevice.h>
99 #include <linux/skbuff.h>
100 #include <linux/ethtool.h>
101 #include <linux/crc32.h>
102 #include <linux/bitops.h>
103 #include <asm/uaccess.h>
104 #include <asm/processor.h> /* Processor type for cache alignment. */
105 #include <asm/unaligned.h>
106 #include <asm/io.h>
107
108 /* These identify the driver base version and may not be removed. */
109 static const char version[] __devinitconst =
110 KERN_INFO DRV_NAME ".c:v1.05 1/09/2001 Written by Donald Becker <becker@scyld.com>\n"
111 " (unofficial 2.4.x port, " DRV_VERSION ", " DRV_RELDATE ")\n";
112
113 MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
114 MODULE_DESCRIPTION("Packet Engines Yellowfin G-NIC Gigabit Ethernet driver");
115 MODULE_LICENSE("GPL");
116
117 module_param(max_interrupt_work, int, 0);
118 module_param(mtu, int, 0);
119 module_param(debug, int, 0);
120 module_param(rx_copybreak, int, 0);
121 module_param_array(options, int, NULL, 0);
122 module_param_array(full_duplex, int, NULL, 0);
123 module_param(gx_fix, int, 0);
124 MODULE_PARM_DESC(max_interrupt_work, "G-NIC maximum events handled per interrupt");
125 MODULE_PARM_DESC(mtu, "G-NIC MTU (all boards)");
126 MODULE_PARM_DESC(debug, "G-NIC debug level (0-7)");
127 MODULE_PARM_DESC(rx_copybreak, "G-NIC copy breakpoint for copy-only-tiny-frames");
128 MODULE_PARM_DESC(options, "G-NIC: Bits 0-3: media type, bit 17: full duplex");
129 MODULE_PARM_DESC(full_duplex, "G-NIC full duplex setting(s) (1)");
130 MODULE_PARM_DESC(gx_fix, "G-NIC: enable GX server chipset bug workaround (0-1)");
131
132 /*
133 Theory of Operation
134
135 I. Board Compatibility
136
137 This device driver is designed for the Packet Engines "Yellowfin" Gigabit
138 Ethernet adapter. The G-NIC 64-bit PCI card is supported, as well as the
139 Symbios 53C885E dual function chip.
140
141 II. Board-specific settings
142
143 PCI bus devices are configured by the system at boot time, so no jumpers
144 need to be set on the board. The system BIOS preferably should assign the
145 PCI INTA signal to an otherwise unused system IRQ line.
146 Note: Kernel versions earlier than 1.3.73 do not support shared PCI
147 interrupt lines.
148
149 III. Driver operation
150
151 IIIa. Ring buffers
152
153 The Yellowfin uses the Descriptor Based DMA Architecture specified by Apple.
154 This is a descriptor list scheme similar to that used by the EEPro100 and
155 Tulip. This driver uses two statically allocated fixed-size descriptor lists
156 formed into rings by a branch from the final descriptor to the beginning of
157 the list. The ring sizes are set at compile time by RX/TX_RING_SIZE.
158
159 The driver allocates full frame size skbuffs for the Rx ring buffers at
160 open() time and passes the skb->data field to the Yellowfin as receive data
161 buffers. When an incoming frame is less than RX_COPYBREAK bytes long,
162 a fresh skbuff is allocated and the frame is copied to the new skbuff.
163 When the incoming frame is larger, the skbuff is passed directly up the
164 protocol stack and replaced by a newly allocated skbuff.
165
166 The RX_COPYBREAK value is chosen to trade-off the memory wasted by
167 using a full-sized skbuff for small frames vs. the copying costs of larger
168 frames. For small frames the copying cost is negligible (esp. considering
169 that we are pre-loading the cache with immediately useful header
170 information). For large frames the copying cost is non-trivial, and the
171 larger copy might flush the cache of useful data.
172
173 IIIC. Synchronization
174
175 The driver runs as two independent, single-threaded flows of control. One
176 is the send-packet routine, which enforces single-threaded use by the
177 dev->tbusy flag. The other thread is the interrupt handler, which is single
178 threaded by the hardware and other software.
179
180 The send packet thread has partial control over the Tx ring and 'dev->tbusy'
181 flag. It sets the tbusy flag whenever it's queuing a Tx packet. If the next
182 queue slot is empty, it clears the tbusy flag when finished otherwise it sets
183 the 'yp->tx_full' flag.
184
185 The interrupt handler has exclusive control over the Rx ring and records stats
186 from the Tx ring. After reaping the stats, it marks the Tx queue entry as
187 empty by incrementing the dirty_tx mark. Iff the 'yp->tx_full' flag is set, it
188 clears both the tx_full and tbusy flags.
189
190 IV. Notes
191
192 Thanks to Kim Stearns of Packet Engines for providing a pair of G-NIC boards.
193 Thanks to Bruce Faust of Digitalscape for providing both their SYM53C885 board
194 and an AlphaStation to verifty the Alpha port!
195
196 IVb. References
197
198 Yellowfin Engineering Design Specification, 4/23/97 Preliminary/Confidential
199 Symbios SYM53C885 PCI-SCSI/Fast Ethernet Multifunction Controller Preliminary
200 Data Manual v3.0
201 http://cesdis.gsfc.nasa.gov/linux/misc/NWay.html
202 http://cesdis.gsfc.nasa.gov/linux/misc/100mbps.html
203
204 IVc. Errata
205
206 See Packet Engines confidential appendix (prototype chips only).
207 */
208
209
210
211 enum capability_flags {
212 HasMII=1, FullTxStatus=2, IsGigabit=4, HasMulticastBug=8, FullRxStatus=16,
213 HasMACAddrBug=32, /* Only on early revs. */
214 DontUseEeprom=64, /* Don't read the MAC from the EEPROm. */
215 };
216
217 /* The PCI I/O space extent. */
218 enum {
219 YELLOWFIN_SIZE = 0x100,
220 };
221
222 struct pci_id_info {
223 const char *name;
224 struct match_info {
225 int pci, pci_mask, subsystem, subsystem_mask;
226 int revision, revision_mask; /* Only 8 bits. */
227 } id;
228 int drv_flags; /* Driver use, intended as capability flags. */
229 };
230
231 static const struct pci_id_info pci_id_tbl[] = {
232 {"Yellowfin G-NIC Gigabit Ethernet", { 0x07021000, 0xffffffff},
233 FullTxStatus | IsGigabit | HasMulticastBug | HasMACAddrBug | DontUseEeprom},
234 {"Symbios SYM83C885", { 0x07011000, 0xffffffff},
235 HasMII | DontUseEeprom },
236 { }
237 };
238
239 static DEFINE_PCI_DEVICE_TABLE(yellowfin_pci_tbl) = {
240 { 0x1000, 0x0702, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
241 { 0x1000, 0x0701, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
242 { }
243 };
244 MODULE_DEVICE_TABLE (pci, yellowfin_pci_tbl);
245
246
247 /* Offsets to the Yellowfin registers. Various sizes and alignments. */
248 enum yellowfin_offsets {
249 TxCtrl=0x00, TxStatus=0x04, TxPtr=0x0C,
250 TxIntrSel=0x10, TxBranchSel=0x14, TxWaitSel=0x18,
251 RxCtrl=0x40, RxStatus=0x44, RxPtr=0x4C,
252 RxIntrSel=0x50, RxBranchSel=0x54, RxWaitSel=0x58,
253 EventStatus=0x80, IntrEnb=0x82, IntrClear=0x84, IntrStatus=0x86,
254 ChipRev=0x8C, DMACtrl=0x90, TxThreshold=0x94,
255 Cnfg=0xA0, FrameGap0=0xA2, FrameGap1=0xA4,
256 MII_Cmd=0xA6, MII_Addr=0xA8, MII_Wr_Data=0xAA, MII_Rd_Data=0xAC,
257 MII_Status=0xAE,
258 RxDepth=0xB8, FlowCtrl=0xBC,
259 AddrMode=0xD0, StnAddr=0xD2, HashTbl=0xD8, FIFOcfg=0xF8,
260 EEStatus=0xF0, EECtrl=0xF1, EEAddr=0xF2, EERead=0xF3, EEWrite=0xF4,
261 EEFeature=0xF5,
262 };
263
264 /* The Yellowfin Rx and Tx buffer descriptors.
265 Elements are written as 32 bit for endian portability. */
266 struct yellowfin_desc {
267 __le32 dbdma_cmd;
268 __le32 addr;
269 __le32 branch_addr;
270 __le32 result_status;
271 };
272
273 struct tx_status_words {
274 #ifdef __BIG_ENDIAN
275 u16 tx_errs;
276 u16 tx_cnt;
277 u16 paused;
278 u16 total_tx_cnt;
279 #else /* Little endian chips. */
280 u16 tx_cnt;
281 u16 tx_errs;
282 u16 total_tx_cnt;
283 u16 paused;
284 #endif /* __BIG_ENDIAN */
285 };
286
287 /* Bits in yellowfin_desc.cmd */
288 enum desc_cmd_bits {
289 CMD_TX_PKT=0x10000000, CMD_RX_BUF=0x20000000, CMD_TXSTATUS=0x30000000,
290 CMD_NOP=0x60000000, CMD_STOP=0x70000000,
291 BRANCH_ALWAYS=0x0C0000, INTR_ALWAYS=0x300000, WAIT_ALWAYS=0x030000,
292 BRANCH_IFTRUE=0x040000,
293 };
294
295 /* Bits in yellowfin_desc.status */
296 enum desc_status_bits { RX_EOP=0x0040, };
297
298 /* Bits in the interrupt status/mask registers. */
299 enum intr_status_bits {
300 IntrRxDone=0x01, IntrRxInvalid=0x02, IntrRxPCIFault=0x04,IntrRxPCIErr=0x08,
301 IntrTxDone=0x10, IntrTxInvalid=0x20, IntrTxPCIFault=0x40,IntrTxPCIErr=0x80,
302 IntrEarlyRx=0x100, IntrWakeup=0x200, };
303
304 #define PRIV_ALIGN 31 /* Required alignment mask */
305 #define MII_CNT 4
306 struct yellowfin_private {
307 /* Descriptor rings first for alignment.
308 Tx requires a second descriptor for status. */
309 struct yellowfin_desc *rx_ring;
310 struct yellowfin_desc *tx_ring;
311 struct sk_buff* rx_skbuff[RX_RING_SIZE];
312 struct sk_buff* tx_skbuff[TX_RING_SIZE];
313 dma_addr_t rx_ring_dma;
314 dma_addr_t tx_ring_dma;
315
316 struct tx_status_words *tx_status;
317 dma_addr_t tx_status_dma;
318
319 struct timer_list timer; /* Media selection timer. */
320 /* Frequently used and paired value: keep adjacent for cache effect. */
321 int chip_id, drv_flags;
322 struct pci_dev *pci_dev;
323 unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */
324 unsigned int rx_buf_sz; /* Based on MTU+slack. */
325 struct tx_status_words *tx_tail_desc;
326 unsigned int cur_tx, dirty_tx;
327 int tx_threshold;
328 unsigned int tx_full:1; /* The Tx queue is full. */
329 unsigned int full_duplex:1; /* Full-duplex operation requested. */
330 unsigned int duplex_lock:1;
331 unsigned int medialock:1; /* Do not sense media. */
332 unsigned int default_port:4; /* Last dev->if_port value. */
333 /* MII transceiver section. */
334 int mii_cnt; /* MII device addresses. */
335 u16 advertising; /* NWay media advertisement */
336 unsigned char phys[MII_CNT]; /* MII device addresses, only first one used */
337 spinlock_t lock;
338 void __iomem *base;
339 };
340
341 static int read_eeprom(void __iomem *ioaddr, int location);
342 static int mdio_read(void __iomem *ioaddr, int phy_id, int location);
343 static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value);
344 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
345 static int yellowfin_open(struct net_device *dev);
346 static void yellowfin_timer(unsigned long data);
347 static void yellowfin_tx_timeout(struct net_device *dev);
348 static int yellowfin_init_ring(struct net_device *dev);
349 static netdev_tx_t yellowfin_start_xmit(struct sk_buff *skb,
350 struct net_device *dev);
351 static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance);
352 static int yellowfin_rx(struct net_device *dev);
353 static void yellowfin_error(struct net_device *dev, int intr_status);
354 static int yellowfin_close(struct net_device *dev);
355 static void set_rx_mode(struct net_device *dev);
356 static const struct ethtool_ops ethtool_ops;
357
358 static const struct net_device_ops netdev_ops = {
359 .ndo_open = yellowfin_open,
360 .ndo_stop = yellowfin_close,
361 .ndo_start_xmit = yellowfin_start_xmit,
362 .ndo_set_rx_mode = set_rx_mode,
363 .ndo_change_mtu = eth_change_mtu,
364 .ndo_validate_addr = eth_validate_addr,
365 .ndo_set_mac_address = eth_mac_addr,
366 .ndo_do_ioctl = netdev_ioctl,
367 .ndo_tx_timeout = yellowfin_tx_timeout,
368 };
369
370 static int __devinit yellowfin_init_one(struct pci_dev *pdev,
371 const struct pci_device_id *ent)
372 {
373 struct net_device *dev;
374 struct yellowfin_private *np;
375 int irq;
376 int chip_idx = ent->driver_data;
377 static int find_cnt;
378 void __iomem *ioaddr;
379 int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0;
380 int drv_flags = pci_id_tbl[chip_idx].drv_flags;
381 void *ring_space;
382 dma_addr_t ring_dma;
383 #ifdef USE_IO_OPS
384 int bar = 0;
385 #else
386 int bar = 1;
387 #endif
388
389 /* when built into the kernel, we only print version if device is found */
390 #ifndef MODULE
391 static int printed_version;
392 if (!printed_version++)
393 printk(version);
394 #endif
395
396 i = pci_enable_device(pdev);
397 if (i) return i;
398
399 dev = alloc_etherdev(sizeof(*np));
400 if (!dev) {
401 pr_err("cannot allocate ethernet device\n");
402 return -ENOMEM;
403 }
404 SET_NETDEV_DEV(dev, &pdev->dev);
405
406 np = netdev_priv(dev);
407
408 if (pci_request_regions(pdev, DRV_NAME))
409 goto err_out_free_netdev;
410
411 pci_set_master (pdev);
412
413 ioaddr = pci_iomap(pdev, bar, YELLOWFIN_SIZE);
414 if (!ioaddr)
415 goto err_out_free_res;
416
417 irq = pdev->irq;
418
419 if (drv_flags & DontUseEeprom)
420 for (i = 0; i < 6; i++)
421 dev->dev_addr[i] = ioread8(ioaddr + StnAddr + i);
422 else {
423 int ee_offset = (read_eeprom(ioaddr, 6) == 0xff ? 0x100 : 0);
424 for (i = 0; i < 6; i++)
425 dev->dev_addr[i] = read_eeprom(ioaddr, ee_offset + i);
426 }
427
428 /* Reset the chip. */
429 iowrite32(0x80000000, ioaddr + DMACtrl);
430
431 dev->base_addr = (unsigned long)ioaddr;
432 dev->irq = irq;
433
434 pci_set_drvdata(pdev, dev);
435 spin_lock_init(&np->lock);
436
437 np->pci_dev = pdev;
438 np->chip_id = chip_idx;
439 np->drv_flags = drv_flags;
440 np->base = ioaddr;
441
442 ring_space = pci_alloc_consistent(pdev, TX_TOTAL_SIZE, &ring_dma);
443 if (!ring_space)
444 goto err_out_cleardev;
445 np->tx_ring = ring_space;
446 np->tx_ring_dma = ring_dma;
447
448 ring_space = pci_alloc_consistent(pdev, RX_TOTAL_SIZE, &ring_dma);
449 if (!ring_space)
450 goto err_out_unmap_tx;
451 np->rx_ring = ring_space;
452 np->rx_ring_dma = ring_dma;
453
454 ring_space = pci_alloc_consistent(pdev, STATUS_TOTAL_SIZE, &ring_dma);
455 if (!ring_space)
456 goto err_out_unmap_rx;
457 np->tx_status = ring_space;
458 np->tx_status_dma = ring_dma;
459
460 if (dev->mem_start)
461 option = dev->mem_start;
462
463 /* The lower four bits are the media type. */
464 if (option > 0) {
465 if (option & 0x200)
466 np->full_duplex = 1;
467 np->default_port = option & 15;
468 if (np->default_port)
469 np->medialock = 1;
470 }
471 if (find_cnt < MAX_UNITS && full_duplex[find_cnt] > 0)
472 np->full_duplex = 1;
473
474 if (np->full_duplex)
475 np->duplex_lock = 1;
476
477 /* The Yellowfin-specific entries in the device structure. */
478 dev->netdev_ops = &netdev_ops;
479 SET_ETHTOOL_OPS(dev, &ethtool_ops);
480 dev->watchdog_timeo = TX_TIMEOUT;
481
482 if (mtu)
483 dev->mtu = mtu;
484
485 i = register_netdev(dev);
486 if (i)
487 goto err_out_unmap_status;
488
489 netdev_info(dev, "%s type %8x at %p, %pM, IRQ %d\n",
490 pci_id_tbl[chip_idx].name,
491 ioread32(ioaddr + ChipRev), ioaddr,
492 dev->dev_addr, irq);
493
494 if (np->drv_flags & HasMII) {
495 int phy, phy_idx = 0;
496 for (phy = 0; phy < 32 && phy_idx < MII_CNT; phy++) {
497 int mii_status = mdio_read(ioaddr, phy, 1);
498 if (mii_status != 0xffff && mii_status != 0x0000) {
499 np->phys[phy_idx++] = phy;
500 np->advertising = mdio_read(ioaddr, phy, 4);
501 netdev_info(dev, "MII PHY found at address %d, status 0x%04x advertising %04x\n",
502 phy, mii_status, np->advertising);
503 }
504 }
505 np->mii_cnt = phy_idx;
506 }
507
508 find_cnt++;
509
510 return 0;
511
512 err_out_unmap_status:
513 pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status,
514 np->tx_status_dma);
515 err_out_unmap_rx:
516 pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
517 err_out_unmap_tx:
518 pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
519 err_out_cleardev:
520 pci_set_drvdata(pdev, NULL);
521 pci_iounmap(pdev, ioaddr);
522 err_out_free_res:
523 pci_release_regions(pdev);
524 err_out_free_netdev:
525 free_netdev (dev);
526 return -ENODEV;
527 }
528
529 static int __devinit read_eeprom(void __iomem *ioaddr, int location)
530 {
531 int bogus_cnt = 10000; /* Typical 33Mhz: 1050 ticks */
532
533 iowrite8(location, ioaddr + EEAddr);
534 iowrite8(0x30 | ((location >> 8) & 7), ioaddr + EECtrl);
535 while ((ioread8(ioaddr + EEStatus) & 0x80) && --bogus_cnt > 0)
536 ;
537 return ioread8(ioaddr + EERead);
538 }
539
540 /* MII Managemen Data I/O accesses.
541 These routines assume the MDIO controller is idle, and do not exit until
542 the command is finished. */
543
544 static int mdio_read(void __iomem *ioaddr, int phy_id, int location)
545 {
546 int i;
547
548 iowrite16((phy_id<<8) + location, ioaddr + MII_Addr);
549 iowrite16(1, ioaddr + MII_Cmd);
550 for (i = 10000; i >= 0; i--)
551 if ((ioread16(ioaddr + MII_Status) & 1) == 0)
552 break;
553 return ioread16(ioaddr + MII_Rd_Data);
554 }
555
556 static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value)
557 {
558 int i;
559
560 iowrite16((phy_id<<8) + location, ioaddr + MII_Addr);
561 iowrite16(value, ioaddr + MII_Wr_Data);
562
563 /* Wait for the command to finish. */
564 for (i = 10000; i >= 0; i--)
565 if ((ioread16(ioaddr + MII_Status) & 1) == 0)
566 break;
567 }
568
569
570 static int yellowfin_open(struct net_device *dev)
571 {
572 struct yellowfin_private *yp = netdev_priv(dev);
573 void __iomem *ioaddr = yp->base;
574 int i, ret;
575
576 /* Reset the chip. */
577 iowrite32(0x80000000, ioaddr + DMACtrl);
578
579 ret = request_irq(dev->irq, yellowfin_interrupt, IRQF_SHARED, dev->name, dev);
580 if (ret)
581 return ret;
582
583 if (yellowfin_debug > 1)
584 netdev_printk(KERN_DEBUG, dev, "%s() irq %d\n",
585 __func__, dev->irq);
586
587 ret = yellowfin_init_ring(dev);
588 if (ret) {
589 free_irq(dev->irq, dev);
590 return ret;
591 }
592
593 iowrite32(yp->rx_ring_dma, ioaddr + RxPtr);
594 iowrite32(yp->tx_ring_dma, ioaddr + TxPtr);
595
596 for (i = 0; i < 6; i++)
597 iowrite8(dev->dev_addr[i], ioaddr + StnAddr + i);
598
599 /* Set up various condition 'select' registers.
600 There are no options here. */
601 iowrite32(0x00800080, ioaddr + TxIntrSel); /* Interrupt on Tx abort */
602 iowrite32(0x00800080, ioaddr + TxBranchSel); /* Branch on Tx abort */
603 iowrite32(0x00400040, ioaddr + TxWaitSel); /* Wait on Tx status */
604 iowrite32(0x00400040, ioaddr + RxIntrSel); /* Interrupt on Rx done */
605 iowrite32(0x00400040, ioaddr + RxBranchSel); /* Branch on Rx error */
606 iowrite32(0x00400040, ioaddr + RxWaitSel); /* Wait on Rx done */
607
608 /* Initialize other registers: with so many this eventually this will
609 converted to an offset/value list. */
610 iowrite32(dma_ctrl, ioaddr + DMACtrl);
611 iowrite16(fifo_cfg, ioaddr + FIFOcfg);
612 /* Enable automatic generation of flow control frames, period 0xffff. */
613 iowrite32(0x0030FFFF, ioaddr + FlowCtrl);
614
615 yp->tx_threshold = 32;
616 iowrite32(yp->tx_threshold, ioaddr + TxThreshold);
617
618 if (dev->if_port == 0)
619 dev->if_port = yp->default_port;
620
621 netif_start_queue(dev);
622
623 /* Setting the Rx mode will start the Rx process. */
624 if (yp->drv_flags & IsGigabit) {
625 /* We are always in full-duplex mode with gigabit! */
626 yp->full_duplex = 1;
627 iowrite16(0x01CF, ioaddr + Cnfg);
628 } else {
629 iowrite16(0x0018, ioaddr + FrameGap0); /* 0060/4060 for non-MII 10baseT */
630 iowrite16(0x1018, ioaddr + FrameGap1);
631 iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg);
632 }
633 set_rx_mode(dev);
634
635 /* Enable interrupts by setting the interrupt mask. */
636 iowrite16(0x81ff, ioaddr + IntrEnb); /* See enum intr_status_bits */
637 iowrite16(0x0000, ioaddr + EventStatus); /* Clear non-interrupting events */
638 iowrite32(0x80008000, ioaddr + RxCtrl); /* Start Rx and Tx channels. */
639 iowrite32(0x80008000, ioaddr + TxCtrl);
640
641 if (yellowfin_debug > 2) {
642 netdev_printk(KERN_DEBUG, dev, "Done %s()\n", __func__);
643 }
644
645 /* Set the timer to check for link beat. */
646 init_timer(&yp->timer);
647 yp->timer.expires = jiffies + 3*HZ;
648 yp->timer.data = (unsigned long)dev;
649 yp->timer.function = yellowfin_timer; /* timer handler */
650 add_timer(&yp->timer);
651
652 return 0;
653 }
654
655 static void yellowfin_timer(unsigned long data)
656 {
657 struct net_device *dev = (struct net_device *)data;
658 struct yellowfin_private *yp = netdev_priv(dev);
659 void __iomem *ioaddr = yp->base;
660 int next_tick = 60*HZ;
661
662 if (yellowfin_debug > 3) {
663 netdev_printk(KERN_DEBUG, dev, "Yellowfin timer tick, status %08x\n",
664 ioread16(ioaddr + IntrStatus));
665 }
666
667 if (yp->mii_cnt) {
668 int bmsr = mdio_read(ioaddr, yp->phys[0], MII_BMSR);
669 int lpa = mdio_read(ioaddr, yp->phys[0], MII_LPA);
670 int negotiated = lpa & yp->advertising;
671 if (yellowfin_debug > 1)
672 netdev_printk(KERN_DEBUG, dev, "MII #%d status register is %04x, link partner capability %04x\n",
673 yp->phys[0], bmsr, lpa);
674
675 yp->full_duplex = mii_duplex(yp->duplex_lock, negotiated);
676
677 iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg);
678
679 if (bmsr & BMSR_LSTATUS)
680 next_tick = 60*HZ;
681 else
682 next_tick = 3*HZ;
683 }
684
685 yp->timer.expires = jiffies + next_tick;
686 add_timer(&yp->timer);
687 }
688
689 static void yellowfin_tx_timeout(struct net_device *dev)
690 {
691 struct yellowfin_private *yp = netdev_priv(dev);
692 void __iomem *ioaddr = yp->base;
693
694 netdev_warn(dev, "Yellowfin transmit timed out at %d/%d Tx status %04x, Rx status %04x, resetting...\n",
695 yp->cur_tx, yp->dirty_tx,
696 ioread32(ioaddr + TxStatus),
697 ioread32(ioaddr + RxStatus));
698
699 /* Note: these should be KERN_DEBUG. */
700 if (yellowfin_debug) {
701 int i;
702 pr_warning(" Rx ring %p: ", yp->rx_ring);
703 for (i = 0; i < RX_RING_SIZE; i++)
704 pr_cont(" %08x", yp->rx_ring[i].result_status);
705 pr_cont("\n");
706 pr_warning(" Tx ring %p: ", yp->tx_ring);
707 for (i = 0; i < TX_RING_SIZE; i++)
708 pr_cont(" %04x /%08x",
709 yp->tx_status[i].tx_errs,
710 yp->tx_ring[i].result_status);
711 pr_cont("\n");
712 }
713
714 /* If the hardware is found to hang regularly, we will update the code
715 to reinitialize the chip here. */
716 dev->if_port = 0;
717
718 /* Wake the potentially-idle transmit channel. */
719 iowrite32(0x10001000, yp->base + TxCtrl);
720 if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE)
721 netif_wake_queue (dev); /* Typical path */
722
723 dev->trans_start = jiffies; /* prevent tx timeout */
724 dev->stats.tx_errors++;
725 }
726
727 /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
728 static int yellowfin_init_ring(struct net_device *dev)
729 {
730 struct yellowfin_private *yp = netdev_priv(dev);
731 int i, j;
732
733 yp->tx_full = 0;
734 yp->cur_rx = yp->cur_tx = 0;
735 yp->dirty_tx = 0;
736
737 yp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
738
739 for (i = 0; i < RX_RING_SIZE; i++) {
740 yp->rx_ring[i].dbdma_cmd =
741 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz);
742 yp->rx_ring[i].branch_addr = cpu_to_le32(yp->rx_ring_dma +
743 ((i+1)%RX_RING_SIZE)*sizeof(struct yellowfin_desc));
744 }
745
746 for (i = 0; i < RX_RING_SIZE; i++) {
747 struct sk_buff *skb = dev_alloc_skb(yp->rx_buf_sz + 2);
748 yp->rx_skbuff[i] = skb;
749 if (skb == NULL)
750 break;
751 skb->dev = dev; /* Mark as being used by this device. */
752 skb_reserve(skb, 2); /* 16 byte align the IP header. */
753 yp->rx_ring[i].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
754 skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE));
755 }
756 if (i != RX_RING_SIZE) {
757 for (j = 0; j < i; j++)
758 dev_kfree_skb(yp->rx_skbuff[j]);
759 return -ENOMEM;
760 }
761 yp->rx_ring[i-1].dbdma_cmd = cpu_to_le32(CMD_STOP);
762 yp->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
763
764 #define NO_TXSTATS
765 #ifdef NO_TXSTATS
766 /* In this mode the Tx ring needs only a single descriptor. */
767 for (i = 0; i < TX_RING_SIZE; i++) {
768 yp->tx_skbuff[i] = NULL;
769 yp->tx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP);
770 yp->tx_ring[i].branch_addr = cpu_to_le32(yp->tx_ring_dma +
771 ((i+1)%TX_RING_SIZE)*sizeof(struct yellowfin_desc));
772 }
773 /* Wrap ring */
774 yp->tx_ring[--i].dbdma_cmd = cpu_to_le32(CMD_STOP | BRANCH_ALWAYS);
775 #else
776 {
777 /* Tx ring needs a pair of descriptors, the second for the status. */
778 for (i = 0; i < TX_RING_SIZE; i++) {
779 j = 2*i;
780 yp->tx_skbuff[i] = 0;
781 /* Branch on Tx error. */
782 yp->tx_ring[j].dbdma_cmd = cpu_to_le32(CMD_STOP);
783 yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma +
784 (j+1)*sizeof(struct yellowfin_desc));
785 j++;
786 if (yp->flags & FullTxStatus) {
787 yp->tx_ring[j].dbdma_cmd =
788 cpu_to_le32(CMD_TXSTATUS | sizeof(*yp->tx_status));
789 yp->tx_ring[j].request_cnt = sizeof(*yp->tx_status);
790 yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma +
791 i*sizeof(struct tx_status_words));
792 } else {
793 /* Symbios chips write only tx_errs word. */
794 yp->tx_ring[j].dbdma_cmd =
795 cpu_to_le32(CMD_TXSTATUS | INTR_ALWAYS | 2);
796 yp->tx_ring[j].request_cnt = 2;
797 /* Om pade ummmmm... */
798 yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma +
799 i*sizeof(struct tx_status_words) +
800 &(yp->tx_status[0].tx_errs) -
801 &(yp->tx_status[0]));
802 }
803 yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma +
804 ((j+1)%(2*TX_RING_SIZE))*sizeof(struct yellowfin_desc));
805 }
806 /* Wrap ring */
807 yp->tx_ring[++j].dbdma_cmd |= cpu_to_le32(BRANCH_ALWAYS | INTR_ALWAYS);
808 }
809 #endif
810 yp->tx_tail_desc = &yp->tx_status[0];
811 return 0;
812 }
813
814 static netdev_tx_t yellowfin_start_xmit(struct sk_buff *skb,
815 struct net_device *dev)
816 {
817 struct yellowfin_private *yp = netdev_priv(dev);
818 unsigned entry;
819 int len = skb->len;
820
821 netif_stop_queue (dev);
822
823 /* Note: Ordering is important here, set the field with the
824 "ownership" bit last, and only then increment cur_tx. */
825
826 /* Calculate the next Tx descriptor entry. */
827 entry = yp->cur_tx % TX_RING_SIZE;
828
829 if (gx_fix) { /* Note: only works for paddable protocols e.g. IP. */
830 int cacheline_end = ((unsigned long)skb->data + skb->len) % 32;
831 /* Fix GX chipset errata. */
832 if (cacheline_end > 24 || cacheline_end == 0) {
833 len = skb->len + 32 - cacheline_end + 1;
834 if (skb_padto(skb, len)) {
835 yp->tx_skbuff[entry] = NULL;
836 netif_wake_queue(dev);
837 return NETDEV_TX_OK;
838 }
839 }
840 }
841 yp->tx_skbuff[entry] = skb;
842
843 #ifdef NO_TXSTATS
844 yp->tx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
845 skb->data, len, PCI_DMA_TODEVICE));
846 yp->tx_ring[entry].result_status = 0;
847 if (entry >= TX_RING_SIZE-1) {
848 /* New stop command. */
849 yp->tx_ring[0].dbdma_cmd = cpu_to_le32(CMD_STOP);
850 yp->tx_ring[TX_RING_SIZE-1].dbdma_cmd =
851 cpu_to_le32(CMD_TX_PKT|BRANCH_ALWAYS | len);
852 } else {
853 yp->tx_ring[entry+1].dbdma_cmd = cpu_to_le32(CMD_STOP);
854 yp->tx_ring[entry].dbdma_cmd =
855 cpu_to_le32(CMD_TX_PKT | BRANCH_IFTRUE | len);
856 }
857 yp->cur_tx++;
858 #else
859 yp->tx_ring[entry<<1].request_cnt = len;
860 yp->tx_ring[entry<<1].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
861 skb->data, len, PCI_DMA_TODEVICE));
862 /* The input_last (status-write) command is constant, but we must
863 rewrite the subsequent 'stop' command. */
864
865 yp->cur_tx++;
866 {
867 unsigned next_entry = yp->cur_tx % TX_RING_SIZE;
868 yp->tx_ring[next_entry<<1].dbdma_cmd = cpu_to_le32(CMD_STOP);
869 }
870 /* Final step -- overwrite the old 'stop' command. */
871
872 yp->tx_ring[entry<<1].dbdma_cmd =
873 cpu_to_le32( ((entry % 6) == 0 ? CMD_TX_PKT|INTR_ALWAYS|BRANCH_IFTRUE :
874 CMD_TX_PKT | BRANCH_IFTRUE) | len);
875 #endif
876
877 /* Non-x86 Todo: explicitly flush cache lines here. */
878
879 /* Wake the potentially-idle transmit channel. */
880 iowrite32(0x10001000, yp->base + TxCtrl);
881
882 if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE)
883 netif_start_queue (dev); /* Typical path */
884 else
885 yp->tx_full = 1;
886
887 if (yellowfin_debug > 4) {
888 netdev_printk(KERN_DEBUG, dev, "Yellowfin transmit frame #%d queued in slot %d\n",
889 yp->cur_tx, entry);
890 }
891 return NETDEV_TX_OK;
892 }
893
894 /* The interrupt handler does all of the Rx thread work and cleans up
895 after the Tx thread. */
896 static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance)
897 {
898 struct net_device *dev = dev_instance;
899 struct yellowfin_private *yp;
900 void __iomem *ioaddr;
901 int boguscnt = max_interrupt_work;
902 unsigned int handled = 0;
903
904 yp = netdev_priv(dev);
905 ioaddr = yp->base;
906
907 spin_lock (&yp->lock);
908
909 do {
910 u16 intr_status = ioread16(ioaddr + IntrClear);
911
912 if (yellowfin_debug > 4)
913 netdev_printk(KERN_DEBUG, dev, "Yellowfin interrupt, status %04x\n",
914 intr_status);
915
916 if (intr_status == 0)
917 break;
918 handled = 1;
919
920 if (intr_status & (IntrRxDone | IntrEarlyRx)) {
921 yellowfin_rx(dev);
922 iowrite32(0x10001000, ioaddr + RxCtrl); /* Wake Rx engine. */
923 }
924
925 #ifdef NO_TXSTATS
926 for (; yp->cur_tx - yp->dirty_tx > 0; yp->dirty_tx++) {
927 int entry = yp->dirty_tx % TX_RING_SIZE;
928 struct sk_buff *skb;
929
930 if (yp->tx_ring[entry].result_status == 0)
931 break;
932 skb = yp->tx_skbuff[entry];
933 dev->stats.tx_packets++;
934 dev->stats.tx_bytes += skb->len;
935 /* Free the original skb. */
936 pci_unmap_single(yp->pci_dev, le32_to_cpu(yp->tx_ring[entry].addr),
937 skb->len, PCI_DMA_TODEVICE);
938 dev_kfree_skb_irq(skb);
939 yp->tx_skbuff[entry] = NULL;
940 }
941 if (yp->tx_full &&
942 yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE - 4) {
943 /* The ring is no longer full, clear tbusy. */
944 yp->tx_full = 0;
945 netif_wake_queue(dev);
946 }
947 #else
948 if ((intr_status & IntrTxDone) || (yp->tx_tail_desc->tx_errs)) {
949 unsigned dirty_tx = yp->dirty_tx;
950
951 for (dirty_tx = yp->dirty_tx; yp->cur_tx - dirty_tx > 0;
952 dirty_tx++) {
953 /* Todo: optimize this. */
954 int entry = dirty_tx % TX_RING_SIZE;
955 u16 tx_errs = yp->tx_status[entry].tx_errs;
956 struct sk_buff *skb;
957
958 #ifndef final_version
959 if (yellowfin_debug > 5)
960 netdev_printk(KERN_DEBUG, dev, "Tx queue %d check, Tx status %04x %04x %04x %04x\n",
961 entry,
962 yp->tx_status[entry].tx_cnt,
963 yp->tx_status[entry].tx_errs,
964 yp->tx_status[entry].total_tx_cnt,
965 yp->tx_status[entry].paused);
966 #endif
967 if (tx_errs == 0)
968 break; /* It still hasn't been Txed */
969 skb = yp->tx_skbuff[entry];
970 if (tx_errs & 0xF810) {
971 /* There was an major error, log it. */
972 #ifndef final_version
973 if (yellowfin_debug > 1)
974 netdev_printk(KERN_DEBUG, dev, "Transmit error, Tx status %04x\n",
975 tx_errs);
976 #endif
977 dev->stats.tx_errors++;
978 if (tx_errs & 0xF800) dev->stats.tx_aborted_errors++;
979 if (tx_errs & 0x0800) dev->stats.tx_carrier_errors++;
980 if (tx_errs & 0x2000) dev->stats.tx_window_errors++;
981 if (tx_errs & 0x8000) dev->stats.tx_fifo_errors++;
982 } else {
983 #ifndef final_version
984 if (yellowfin_debug > 4)
985 netdev_printk(KERN_DEBUG, dev, "Normal transmit, Tx status %04x\n",
986 tx_errs);
987 #endif
988 dev->stats.tx_bytes += skb->len;
989 dev->stats.collisions += tx_errs & 15;
990 dev->stats.tx_packets++;
991 }
992 /* Free the original skb. */
993 pci_unmap_single(yp->pci_dev,
994 yp->tx_ring[entry<<1].addr, skb->len,
995 PCI_DMA_TODEVICE);
996 dev_kfree_skb_irq(skb);
997 yp->tx_skbuff[entry] = 0;
998 /* Mark status as empty. */
999 yp->tx_status[entry].tx_errs = 0;
1000 }
1001
1002 #ifndef final_version
1003 if (yp->cur_tx - dirty_tx > TX_RING_SIZE) {
1004 netdev_err(dev, "Out-of-sync dirty pointer, %d vs. %d, full=%d\n",
1005 dirty_tx, yp->cur_tx, yp->tx_full);
1006 dirty_tx += TX_RING_SIZE;
1007 }
1008 #endif
1009
1010 if (yp->tx_full &&
1011 yp->cur_tx - dirty_tx < TX_QUEUE_SIZE - 2) {
1012 /* The ring is no longer full, clear tbusy. */
1013 yp->tx_full = 0;
1014 netif_wake_queue(dev);
1015 }
1016
1017 yp->dirty_tx = dirty_tx;
1018 yp->tx_tail_desc = &yp->tx_status[dirty_tx % TX_RING_SIZE];
1019 }
1020 #endif
1021
1022 /* Log errors and other uncommon events. */
1023 if (intr_status & 0x2ee) /* Abnormal error summary. */
1024 yellowfin_error(dev, intr_status);
1025
1026 if (--boguscnt < 0) {
1027 netdev_warn(dev, "Too much work at interrupt, status=%#04x\n",
1028 intr_status);
1029 break;
1030 }
1031 } while (1);
1032
1033 if (yellowfin_debug > 3)
1034 netdev_printk(KERN_DEBUG, dev, "exiting interrupt, status=%#04x\n",
1035 ioread16(ioaddr + IntrStatus));
1036
1037 spin_unlock (&yp->lock);
1038 return IRQ_RETVAL(handled);
1039 }
1040
1041 /* This routine is logically part of the interrupt handler, but separated
1042 for clarity and better register allocation. */
1043 static int yellowfin_rx(struct net_device *dev)
1044 {
1045 struct yellowfin_private *yp = netdev_priv(dev);
1046 int entry = yp->cur_rx % RX_RING_SIZE;
1047 int boguscnt = yp->dirty_rx + RX_RING_SIZE - yp->cur_rx;
1048
1049 if (yellowfin_debug > 4) {
1050 printk(KERN_DEBUG " In yellowfin_rx(), entry %d status %08x\n",
1051 entry, yp->rx_ring[entry].result_status);
1052 printk(KERN_DEBUG " #%d desc. %08x %08x %08x\n",
1053 entry, yp->rx_ring[entry].dbdma_cmd, yp->rx_ring[entry].addr,
1054 yp->rx_ring[entry].result_status);
1055 }
1056
1057 /* If EOP is set on the next entry, it's a new packet. Send it up. */
1058 while (1) {
1059 struct yellowfin_desc *desc = &yp->rx_ring[entry];
1060 struct sk_buff *rx_skb = yp->rx_skbuff[entry];
1061 s16 frame_status;
1062 u16 desc_status;
1063 int data_size;
1064 u8 *buf_addr;
1065
1066 if(!desc->result_status)
1067 break;
1068 pci_dma_sync_single_for_cpu(yp->pci_dev, le32_to_cpu(desc->addr),
1069 yp->rx_buf_sz, PCI_DMA_FROMDEVICE);
1070 desc_status = le32_to_cpu(desc->result_status) >> 16;
1071 buf_addr = rx_skb->data;
1072 data_size = (le32_to_cpu(desc->dbdma_cmd) -
1073 le32_to_cpu(desc->result_status)) & 0xffff;
1074 frame_status = get_unaligned_le16(&(buf_addr[data_size - 2]));
1075 if (yellowfin_debug > 4)
1076 printk(KERN_DEBUG " %s() status was %04x\n",
1077 __func__, frame_status);
1078 if (--boguscnt < 0)
1079 break;
1080 if ( ! (desc_status & RX_EOP)) {
1081 if (data_size != 0)
1082 netdev_warn(dev, "Oversized Ethernet frame spanned multiple buffers, status %04x, data_size %d!\n",
1083 desc_status, data_size);
1084 dev->stats.rx_length_errors++;
1085 } else if ((yp->drv_flags & IsGigabit) && (frame_status & 0x0038)) {
1086 /* There was a error. */
1087 if (yellowfin_debug > 3)
1088 printk(KERN_DEBUG " %s() Rx error was %04x\n",
1089 __func__, frame_status);
1090 dev->stats.rx_errors++;
1091 if (frame_status & 0x0060) dev->stats.rx_length_errors++;
1092 if (frame_status & 0x0008) dev->stats.rx_frame_errors++;
1093 if (frame_status & 0x0010) dev->stats.rx_crc_errors++;
1094 if (frame_status < 0) dev->stats.rx_dropped++;
1095 } else if ( !(yp->drv_flags & IsGigabit) &&
1096 ((buf_addr[data_size-1] & 0x85) || buf_addr[data_size-2] & 0xC0)) {
1097 u8 status1 = buf_addr[data_size-2];
1098 u8 status2 = buf_addr[data_size-1];
1099 dev->stats.rx_errors++;
1100 if (status1 & 0xC0) dev->stats.rx_length_errors++;
1101 if (status2 & 0x03) dev->stats.rx_frame_errors++;
1102 if (status2 & 0x04) dev->stats.rx_crc_errors++;
1103 if (status2 & 0x80) dev->stats.rx_dropped++;
1104 #ifdef YF_PROTOTYPE /* Support for prototype hardware errata. */
1105 } else if ((yp->flags & HasMACAddrBug) &&
1106 memcmp(le32_to_cpu(yp->rx_ring_dma +
1107 entry*sizeof(struct yellowfin_desc)),
1108 dev->dev_addr, 6) != 0 &&
1109 memcmp(le32_to_cpu(yp->rx_ring_dma +
1110 entry*sizeof(struct yellowfin_desc)),
1111 "\377\377\377\377\377\377", 6) != 0) {
1112 if (bogus_rx++ == 0)
1113 netdev_warn(dev, "Bad frame to %pM\n",
1114 buf_addr);
1115 #endif
1116 } else {
1117 struct sk_buff *skb;
1118 int pkt_len = data_size -
1119 (yp->chip_id ? 7 : 8 + buf_addr[data_size - 8]);
1120 /* To verify: Yellowfin Length should omit the CRC! */
1121
1122 #ifndef final_version
1123 if (yellowfin_debug > 4)
1124 printk(KERN_DEBUG " %s() normal Rx pkt length %d of %d, bogus_cnt %d\n",
1125 __func__, pkt_len, data_size, boguscnt);
1126 #endif
1127 /* Check if the packet is long enough to just pass up the skbuff
1128 without copying to a properly sized skbuff. */
1129 if (pkt_len > rx_copybreak) {
1130 skb_put(skb = rx_skb, pkt_len);
1131 pci_unmap_single(yp->pci_dev,
1132 le32_to_cpu(yp->rx_ring[entry].addr),
1133 yp->rx_buf_sz,
1134 PCI_DMA_FROMDEVICE);
1135 yp->rx_skbuff[entry] = NULL;
1136 } else {
1137 skb = dev_alloc_skb(pkt_len + 2);
1138 if (skb == NULL)
1139 break;
1140 skb_reserve(skb, 2); /* 16 byte align the IP header */
1141 skb_copy_to_linear_data(skb, rx_skb->data, pkt_len);
1142 skb_put(skb, pkt_len);
1143 pci_dma_sync_single_for_device(yp->pci_dev,
1144 le32_to_cpu(desc->addr),
1145 yp->rx_buf_sz,
1146 PCI_DMA_FROMDEVICE);
1147 }
1148 skb->protocol = eth_type_trans(skb, dev);
1149 netif_rx(skb);
1150 dev->stats.rx_packets++;
1151 dev->stats.rx_bytes += pkt_len;
1152 }
1153 entry = (++yp->cur_rx) % RX_RING_SIZE;
1154 }
1155
1156 /* Refill the Rx ring buffers. */
1157 for (; yp->cur_rx - yp->dirty_rx > 0; yp->dirty_rx++) {
1158 entry = yp->dirty_rx % RX_RING_SIZE;
1159 if (yp->rx_skbuff[entry] == NULL) {
1160 struct sk_buff *skb = dev_alloc_skb(yp->rx_buf_sz + 2);
1161 if (skb == NULL)
1162 break; /* Better luck next round. */
1163 yp->rx_skbuff[entry] = skb;
1164 skb->dev = dev; /* Mark as being used by this device. */
1165 skb_reserve(skb, 2); /* Align IP on 16 byte boundaries */
1166 yp->rx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
1167 skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE));
1168 }
1169 yp->rx_ring[entry].dbdma_cmd = cpu_to_le32(CMD_STOP);
1170 yp->rx_ring[entry].result_status = 0; /* Clear complete bit. */
1171 if (entry != 0)
1172 yp->rx_ring[entry - 1].dbdma_cmd =
1173 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz);
1174 else
1175 yp->rx_ring[RX_RING_SIZE - 1].dbdma_cmd =
1176 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | BRANCH_ALWAYS
1177 | yp->rx_buf_sz);
1178 }
1179
1180 return 0;
1181 }
1182
1183 static void yellowfin_error(struct net_device *dev, int intr_status)
1184 {
1185 netdev_err(dev, "Something Wicked happened! %04x\n", intr_status);
1186 /* Hmmmmm, it's not clear what to do here. */
1187 if (intr_status & (IntrTxPCIErr | IntrTxPCIFault))
1188 dev->stats.tx_errors++;
1189 if (intr_status & (IntrRxPCIErr | IntrRxPCIFault))
1190 dev->stats.rx_errors++;
1191 }
1192
1193 static int yellowfin_close(struct net_device *dev)
1194 {
1195 struct yellowfin_private *yp = netdev_priv(dev);
1196 void __iomem *ioaddr = yp->base;
1197 int i;
1198
1199 netif_stop_queue (dev);
1200
1201 if (yellowfin_debug > 1) {
1202 netdev_printk(KERN_DEBUG, dev, "Shutting down ethercard, status was Tx %04x Rx %04x Int %02x\n",
1203 ioread16(ioaddr + TxStatus),
1204 ioread16(ioaddr + RxStatus),
1205 ioread16(ioaddr + IntrStatus));
1206 netdev_printk(KERN_DEBUG, dev, "Queue pointers were Tx %d / %d, Rx %d / %d\n",
1207 yp->cur_tx, yp->dirty_tx,
1208 yp->cur_rx, yp->dirty_rx);
1209 }
1210
1211 /* Disable interrupts by clearing the interrupt mask. */
1212 iowrite16(0x0000, ioaddr + IntrEnb);
1213
1214 /* Stop the chip's Tx and Rx processes. */
1215 iowrite32(0x80000000, ioaddr + RxCtrl);
1216 iowrite32(0x80000000, ioaddr + TxCtrl);
1217
1218 del_timer(&yp->timer);
1219
1220 #if defined(__i386__)
1221 if (yellowfin_debug > 2) {
1222 printk(KERN_DEBUG " Tx ring at %08llx:\n",
1223 (unsigned long long)yp->tx_ring_dma);
1224 for (i = 0; i < TX_RING_SIZE*2; i++)
1225 printk(KERN_DEBUG " %c #%d desc. %08x %08x %08x %08x\n",
1226 ioread32(ioaddr + TxPtr) == (long)&yp->tx_ring[i] ? '>' : ' ',
1227 i, yp->tx_ring[i].dbdma_cmd, yp->tx_ring[i].addr,
1228 yp->tx_ring[i].branch_addr, yp->tx_ring[i].result_status);
1229 printk(KERN_DEBUG " Tx status %p:\n", yp->tx_status);
1230 for (i = 0; i < TX_RING_SIZE; i++)
1231 printk(KERN_DEBUG " #%d status %04x %04x %04x %04x\n",
1232 i, yp->tx_status[i].tx_cnt, yp->tx_status[i].tx_errs,
1233 yp->tx_status[i].total_tx_cnt, yp->tx_status[i].paused);
1234
1235 printk(KERN_DEBUG " Rx ring %08llx:\n",
1236 (unsigned long long)yp->rx_ring_dma);
1237 for (i = 0; i < RX_RING_SIZE; i++) {
1238 printk(KERN_DEBUG " %c #%d desc. %08x %08x %08x\n",
1239 ioread32(ioaddr + RxPtr) == (long)&yp->rx_ring[i] ? '>' : ' ',
1240 i, yp->rx_ring[i].dbdma_cmd, yp->rx_ring[i].addr,
1241 yp->rx_ring[i].result_status);
1242 if (yellowfin_debug > 6) {
1243 if (get_unaligned((u8*)yp->rx_ring[i].addr) != 0x69) {
1244 int j;
1245
1246 printk(KERN_DEBUG);
1247 for (j = 0; j < 0x50; j++)
1248 pr_cont(" %04x",
1249 get_unaligned(((u16*)yp->rx_ring[i].addr) + j));
1250 pr_cont("\n");
1251 }
1252 }
1253 }
1254 }
1255 #endif /* __i386__ debugging only */
1256
1257 free_irq(dev->irq, dev);
1258
1259 /* Free all the skbuffs in the Rx queue. */
1260 for (i = 0; i < RX_RING_SIZE; i++) {
1261 yp->rx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP);
1262 yp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */
1263 if (yp->rx_skbuff[i]) {
1264 dev_kfree_skb(yp->rx_skbuff[i]);
1265 }
1266 yp->rx_skbuff[i] = NULL;
1267 }
1268 for (i = 0; i < TX_RING_SIZE; i++) {
1269 if (yp->tx_skbuff[i])
1270 dev_kfree_skb(yp->tx_skbuff[i]);
1271 yp->tx_skbuff[i] = NULL;
1272 }
1273
1274 #ifdef YF_PROTOTYPE /* Support for prototype hardware errata. */
1275 if (yellowfin_debug > 0) {
1276 netdev_printk(KERN_DEBUG, dev, "Received %d frames that we should not have\n",
1277 bogus_rx);
1278 }
1279 #endif
1280
1281 return 0;
1282 }
1283
1284 /* Set or clear the multicast filter for this adaptor. */
1285
1286 static void set_rx_mode(struct net_device *dev)
1287 {
1288 struct yellowfin_private *yp = netdev_priv(dev);
1289 void __iomem *ioaddr = yp->base;
1290 u16 cfg_value = ioread16(ioaddr + Cnfg);
1291
1292 /* Stop the Rx process to change any value. */
1293 iowrite16(cfg_value & ~0x1000, ioaddr + Cnfg);
1294 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
1295 iowrite16(0x000F, ioaddr + AddrMode);
1296 } else if ((netdev_mc_count(dev) > 64) ||
1297 (dev->flags & IFF_ALLMULTI)) {
1298 /* Too many to filter well, or accept all multicasts. */
1299 iowrite16(0x000B, ioaddr + AddrMode);
1300 } else if (!netdev_mc_empty(dev)) { /* Must use the multicast hash table. */
1301 struct netdev_hw_addr *ha;
1302 u16 hash_table[4];
1303 int i;
1304
1305 memset(hash_table, 0, sizeof(hash_table));
1306 netdev_for_each_mc_addr(ha, dev) {
1307 unsigned int bit;
1308
1309 /* Due to a bug in the early chip versions, multiple filter
1310 slots must be set for each address. */
1311 if (yp->drv_flags & HasMulticastBug) {
1312 bit = (ether_crc_le(3, ha->addr) >> 3) & 0x3f;
1313 hash_table[bit >> 4] |= (1 << bit);
1314 bit = (ether_crc_le(4, ha->addr) >> 3) & 0x3f;
1315 hash_table[bit >> 4] |= (1 << bit);
1316 bit = (ether_crc_le(5, ha->addr) >> 3) & 0x3f;
1317 hash_table[bit >> 4] |= (1 << bit);
1318 }
1319 bit = (ether_crc_le(6, ha->addr) >> 3) & 0x3f;
1320 hash_table[bit >> 4] |= (1 << bit);
1321 }
1322 /* Copy the hash table to the chip. */
1323 for (i = 0; i < 4; i++)
1324 iowrite16(hash_table[i], ioaddr + HashTbl + i*2);
1325 iowrite16(0x0003, ioaddr + AddrMode);
1326 } else { /* Normal, unicast/broadcast-only mode. */
1327 iowrite16(0x0001, ioaddr + AddrMode);
1328 }
1329 /* Restart the Rx process. */
1330 iowrite16(cfg_value | 0x1000, ioaddr + Cnfg);
1331 }
1332
1333 static void yellowfin_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1334 {
1335 struct yellowfin_private *np = netdev_priv(dev);
1336 strcpy(info->driver, DRV_NAME);
1337 strcpy(info->version, DRV_VERSION);
1338 strcpy(info->bus_info, pci_name(np->pci_dev));
1339 }
1340
1341 static const struct ethtool_ops ethtool_ops = {
1342 .get_drvinfo = yellowfin_get_drvinfo
1343 };
1344
1345 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1346 {
1347 struct yellowfin_private *np = netdev_priv(dev);
1348 void __iomem *ioaddr = np->base;
1349 struct mii_ioctl_data *data = if_mii(rq);
1350
1351 switch(cmd) {
1352 case SIOCGMIIPHY: /* Get address of MII PHY in use. */
1353 data->phy_id = np->phys[0] & 0x1f;
1354 /* Fall Through */
1355
1356 case SIOCGMIIREG: /* Read MII PHY register. */
1357 data->val_out = mdio_read(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f);
1358 return 0;
1359
1360 case SIOCSMIIREG: /* Write MII PHY register. */
1361 if (data->phy_id == np->phys[0]) {
1362 u16 value = data->val_in;
1363 switch (data->reg_num) {
1364 case 0:
1365 /* Check for autonegotiation on or reset. */
1366 np->medialock = (value & 0x9000) ? 0 : 1;
1367 if (np->medialock)
1368 np->full_duplex = (value & 0x0100) ? 1 : 0;
1369 break;
1370 case 4: np->advertising = value; break;
1371 }
1372 /* Perhaps check_duplex(dev), depending on chip semantics. */
1373 }
1374 mdio_write(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1375 return 0;
1376 default:
1377 return -EOPNOTSUPP;
1378 }
1379 }
1380
1381
1382 static void __devexit yellowfin_remove_one (struct pci_dev *pdev)
1383 {
1384 struct net_device *dev = pci_get_drvdata(pdev);
1385 struct yellowfin_private *np;
1386
1387 BUG_ON(!dev);
1388 np = netdev_priv(dev);
1389
1390 pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status,
1391 np->tx_status_dma);
1392 pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
1393 pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
1394 unregister_netdev (dev);
1395
1396 pci_iounmap(pdev, np->base);
1397
1398 pci_release_regions (pdev);
1399
1400 free_netdev (dev);
1401 pci_set_drvdata(pdev, NULL);
1402 }
1403
1404
1405 static struct pci_driver yellowfin_driver = {
1406 .name = DRV_NAME,
1407 .id_table = yellowfin_pci_tbl,
1408 .probe = yellowfin_init_one,
1409 .remove = __devexit_p(yellowfin_remove_one),
1410 };
1411
1412
1413 static int __init yellowfin_init (void)
1414 {
1415 /* when a module, this is printed whether or not devices are found in probe */
1416 #ifdef MODULE
1417 printk(version);
1418 #endif
1419 return pci_register_driver(&yellowfin_driver);
1420 }
1421
1422
1423 static void __exit yellowfin_cleanup (void)
1424 {
1425 pci_unregister_driver (&yellowfin_driver);
1426 }
1427
1428
1429 module_init(yellowfin_init);
1430 module_exit(yellowfin_cleanup);
linux-next