]> git.karo-electronics.de Git - karo-tx-linux.git/blob - drivers/net/ethernet/packetengines/yellowfin.c
arm: imx6: defconfig: update tx6 defconfigs
[karo-tx-linux.git] / drivers / net / ethernet / packetengines / yellowfin.c
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[] =
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 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                 return -ENOMEM;
402
403         SET_NETDEV_DEV(dev, &pdev->dev);
404
405         np = netdev_priv(dev);
406
407         if (pci_request_regions(pdev, DRV_NAME))
408                 goto err_out_free_netdev;
409
410         pci_set_master (pdev);
411
412         ioaddr = pci_iomap(pdev, bar, YELLOWFIN_SIZE);
413         if (!ioaddr)
414                 goto err_out_free_res;
415
416         irq = pdev->irq;
417
418         if (drv_flags & DontUseEeprom)
419                 for (i = 0; i < 6; i++)
420                         dev->dev_addr[i] = ioread8(ioaddr + StnAddr + i);
421         else {
422                 int ee_offset = (read_eeprom(ioaddr, 6) == 0xff ? 0x100 : 0);
423                 for (i = 0; i < 6; i++)
424                         dev->dev_addr[i] = read_eeprom(ioaddr, ee_offset + i);
425         }
426
427         /* Reset the chip. */
428         iowrite32(0x80000000, ioaddr + DMACtrl);
429
430         pci_set_drvdata(pdev, dev);
431         spin_lock_init(&np->lock);
432
433         np->pci_dev = pdev;
434         np->chip_id = chip_idx;
435         np->drv_flags = drv_flags;
436         np->base = ioaddr;
437
438         ring_space = pci_alloc_consistent(pdev, TX_TOTAL_SIZE, &ring_dma);
439         if (!ring_space)
440                 goto err_out_cleardev;
441         np->tx_ring = ring_space;
442         np->tx_ring_dma = ring_dma;
443
444         ring_space = pci_alloc_consistent(pdev, RX_TOTAL_SIZE, &ring_dma);
445         if (!ring_space)
446                 goto err_out_unmap_tx;
447         np->rx_ring = ring_space;
448         np->rx_ring_dma = ring_dma;
449
450         ring_space = pci_alloc_consistent(pdev, STATUS_TOTAL_SIZE, &ring_dma);
451         if (!ring_space)
452                 goto err_out_unmap_rx;
453         np->tx_status = ring_space;
454         np->tx_status_dma = ring_dma;
455
456         if (dev->mem_start)
457                 option = dev->mem_start;
458
459         /* The lower four bits are the media type. */
460         if (option > 0) {
461                 if (option & 0x200)
462                         np->full_duplex = 1;
463                 np->default_port = option & 15;
464                 if (np->default_port)
465                         np->medialock = 1;
466         }
467         if (find_cnt < MAX_UNITS  &&  full_duplex[find_cnt] > 0)
468                 np->full_duplex = 1;
469
470         if (np->full_duplex)
471                 np->duplex_lock = 1;
472
473         /* The Yellowfin-specific entries in the device structure. */
474         dev->netdev_ops = &netdev_ops;
475         SET_ETHTOOL_OPS(dev, &ethtool_ops);
476         dev->watchdog_timeo = TX_TIMEOUT;
477
478         if (mtu)
479                 dev->mtu = mtu;
480
481         i = register_netdev(dev);
482         if (i)
483                 goto err_out_unmap_status;
484
485         netdev_info(dev, "%s type %8x at %p, %pM, IRQ %d\n",
486                     pci_id_tbl[chip_idx].name,
487                     ioread32(ioaddr + ChipRev), ioaddr,
488                     dev->dev_addr, irq);
489
490         if (np->drv_flags & HasMII) {
491                 int phy, phy_idx = 0;
492                 for (phy = 0; phy < 32 && phy_idx < MII_CNT; phy++) {
493                         int mii_status = mdio_read(ioaddr, phy, 1);
494                         if (mii_status != 0xffff  &&  mii_status != 0x0000) {
495                                 np->phys[phy_idx++] = phy;
496                                 np->advertising = mdio_read(ioaddr, phy, 4);
497                                 netdev_info(dev, "MII PHY found at address %d, status 0x%04x advertising %04x\n",
498                                             phy, mii_status, np->advertising);
499                         }
500                 }
501                 np->mii_cnt = phy_idx;
502         }
503
504         find_cnt++;
505
506         return 0;
507
508 err_out_unmap_status:
509         pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status,
510                 np->tx_status_dma);
511 err_out_unmap_rx:
512         pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
513 err_out_unmap_tx:
514         pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
515 err_out_cleardev:
516         pci_iounmap(pdev, ioaddr);
517 err_out_free_res:
518         pci_release_regions(pdev);
519 err_out_free_netdev:
520         free_netdev (dev);
521         return -ENODEV;
522 }
523
524 static int read_eeprom(void __iomem *ioaddr, int location)
525 {
526         int bogus_cnt = 10000;          /* Typical 33Mhz: 1050 ticks */
527
528         iowrite8(location, ioaddr + EEAddr);
529         iowrite8(0x30 | ((location >> 8) & 7), ioaddr + EECtrl);
530         while ((ioread8(ioaddr + EEStatus) & 0x80)  &&  --bogus_cnt > 0)
531                 ;
532         return ioread8(ioaddr + EERead);
533 }
534
535 /* MII Managemen Data I/O accesses.
536    These routines assume the MDIO controller is idle, and do not exit until
537    the command is finished. */
538
539 static int mdio_read(void __iomem *ioaddr, int phy_id, int location)
540 {
541         int i;
542
543         iowrite16((phy_id<<8) + location, ioaddr + MII_Addr);
544         iowrite16(1, ioaddr + MII_Cmd);
545         for (i = 10000; i >= 0; i--)
546                 if ((ioread16(ioaddr + MII_Status) & 1) == 0)
547                         break;
548         return ioread16(ioaddr + MII_Rd_Data);
549 }
550
551 static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value)
552 {
553         int i;
554
555         iowrite16((phy_id<<8) + location, ioaddr + MII_Addr);
556         iowrite16(value, ioaddr + MII_Wr_Data);
557
558         /* Wait for the command to finish. */
559         for (i = 10000; i >= 0; i--)
560                 if ((ioread16(ioaddr + MII_Status) & 1) == 0)
561                         break;
562 }
563
564
565 static int yellowfin_open(struct net_device *dev)
566 {
567         struct yellowfin_private *yp = netdev_priv(dev);
568         const int irq = yp->pci_dev->irq;
569         void __iomem *ioaddr = yp->base;
570         int i, rc;
571
572         /* Reset the chip. */
573         iowrite32(0x80000000, ioaddr + DMACtrl);
574
575         rc = request_irq(irq, yellowfin_interrupt, IRQF_SHARED, dev->name, dev);
576         if (rc)
577                 return rc;
578
579         rc = yellowfin_init_ring(dev);
580         if (rc < 0)
581                 goto err_free_irq;
582
583         iowrite32(yp->rx_ring_dma, ioaddr + RxPtr);
584         iowrite32(yp->tx_ring_dma, ioaddr + TxPtr);
585
586         for (i = 0; i < 6; i++)
587                 iowrite8(dev->dev_addr[i], ioaddr + StnAddr + i);
588
589         /* Set up various condition 'select' registers.
590            There are no options here. */
591         iowrite32(0x00800080, ioaddr + TxIntrSel);      /* Interrupt on Tx abort */
592         iowrite32(0x00800080, ioaddr + TxBranchSel);    /* Branch on Tx abort */
593         iowrite32(0x00400040, ioaddr + TxWaitSel);      /* Wait on Tx status */
594         iowrite32(0x00400040, ioaddr + RxIntrSel);      /* Interrupt on Rx done */
595         iowrite32(0x00400040, ioaddr + RxBranchSel);    /* Branch on Rx error */
596         iowrite32(0x00400040, ioaddr + RxWaitSel);      /* Wait on Rx done */
597
598         /* Initialize other registers: with so many this eventually this will
599            converted to an offset/value list. */
600         iowrite32(dma_ctrl, ioaddr + DMACtrl);
601         iowrite16(fifo_cfg, ioaddr + FIFOcfg);
602         /* Enable automatic generation of flow control frames, period 0xffff. */
603         iowrite32(0x0030FFFF, ioaddr + FlowCtrl);
604
605         yp->tx_threshold = 32;
606         iowrite32(yp->tx_threshold, ioaddr + TxThreshold);
607
608         if (dev->if_port == 0)
609                 dev->if_port = yp->default_port;
610
611         netif_start_queue(dev);
612
613         /* Setting the Rx mode will start the Rx process. */
614         if (yp->drv_flags & IsGigabit) {
615                 /* We are always in full-duplex mode with gigabit! */
616                 yp->full_duplex = 1;
617                 iowrite16(0x01CF, ioaddr + Cnfg);
618         } else {
619                 iowrite16(0x0018, ioaddr + FrameGap0); /* 0060/4060 for non-MII 10baseT */
620                 iowrite16(0x1018, ioaddr + FrameGap1);
621                 iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg);
622         }
623         set_rx_mode(dev);
624
625         /* Enable interrupts by setting the interrupt mask. */
626         iowrite16(0x81ff, ioaddr + IntrEnb);                    /* See enum intr_status_bits */
627         iowrite16(0x0000, ioaddr + EventStatus);                /* Clear non-interrupting events */
628         iowrite32(0x80008000, ioaddr + RxCtrl);         /* Start Rx and Tx channels. */
629         iowrite32(0x80008000, ioaddr + TxCtrl);
630
631         if (yellowfin_debug > 2) {
632                 netdev_printk(KERN_DEBUG, dev, "Done %s()\n", __func__);
633         }
634
635         /* Set the timer to check for link beat. */
636         init_timer(&yp->timer);
637         yp->timer.expires = jiffies + 3*HZ;
638         yp->timer.data = (unsigned long)dev;
639         yp->timer.function = yellowfin_timer;                           /* timer handler */
640         add_timer(&yp->timer);
641 out:
642         return rc;
643
644 err_free_irq:
645         free_irq(irq, dev);
646         goto out;
647 }
648
649 static void yellowfin_timer(unsigned long data)
650 {
651         struct net_device *dev = (struct net_device *)data;
652         struct yellowfin_private *yp = netdev_priv(dev);
653         void __iomem *ioaddr = yp->base;
654         int next_tick = 60*HZ;
655
656         if (yellowfin_debug > 3) {
657                 netdev_printk(KERN_DEBUG, dev, "Yellowfin timer tick, status %08x\n",
658                               ioread16(ioaddr + IntrStatus));
659         }
660
661         if (yp->mii_cnt) {
662                 int bmsr = mdio_read(ioaddr, yp->phys[0], MII_BMSR);
663                 int lpa = mdio_read(ioaddr, yp->phys[0], MII_LPA);
664                 int negotiated = lpa & yp->advertising;
665                 if (yellowfin_debug > 1)
666                         netdev_printk(KERN_DEBUG, dev, "MII #%d status register is %04x, link partner capability %04x\n",
667                                       yp->phys[0], bmsr, lpa);
668
669                 yp->full_duplex = mii_duplex(yp->duplex_lock, negotiated);
670
671                 iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg);
672
673                 if (bmsr & BMSR_LSTATUS)
674                         next_tick = 60*HZ;
675                 else
676                         next_tick = 3*HZ;
677         }
678
679         yp->timer.expires = jiffies + next_tick;
680         add_timer(&yp->timer);
681 }
682
683 static void yellowfin_tx_timeout(struct net_device *dev)
684 {
685         struct yellowfin_private *yp = netdev_priv(dev);
686         void __iomem *ioaddr = yp->base;
687
688         netdev_warn(dev, "Yellowfin transmit timed out at %d/%d Tx status %04x, Rx status %04x, resetting...\n",
689                     yp->cur_tx, yp->dirty_tx,
690                     ioread32(ioaddr + TxStatus),
691                     ioread32(ioaddr + RxStatus));
692
693         /* Note: these should be KERN_DEBUG. */
694         if (yellowfin_debug) {
695                 int i;
696                 pr_warning("  Rx ring %p: ", yp->rx_ring);
697                 for (i = 0; i < RX_RING_SIZE; i++)
698                         pr_cont(" %08x", yp->rx_ring[i].result_status);
699                 pr_cont("\n");
700                 pr_warning("  Tx ring %p: ", yp->tx_ring);
701                 for (i = 0; i < TX_RING_SIZE; i++)
702                         pr_cont(" %04x /%08x",
703                                yp->tx_status[i].tx_errs,
704                                yp->tx_ring[i].result_status);
705                 pr_cont("\n");
706         }
707
708         /* If the hardware is found to hang regularly, we will update the code
709            to reinitialize the chip here. */
710         dev->if_port = 0;
711
712         /* Wake the potentially-idle transmit channel. */
713         iowrite32(0x10001000, yp->base + TxCtrl);
714         if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE)
715                 netif_wake_queue (dev);         /* Typical path */
716
717         dev->trans_start = jiffies; /* prevent tx timeout */
718         dev->stats.tx_errors++;
719 }
720
721 /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
722 static int yellowfin_init_ring(struct net_device *dev)
723 {
724         struct yellowfin_private *yp = netdev_priv(dev);
725         int i, j;
726
727         yp->tx_full = 0;
728         yp->cur_rx = yp->cur_tx = 0;
729         yp->dirty_tx = 0;
730
731         yp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
732
733         for (i = 0; i < RX_RING_SIZE; i++) {
734                 yp->rx_ring[i].dbdma_cmd =
735                         cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz);
736                 yp->rx_ring[i].branch_addr = cpu_to_le32(yp->rx_ring_dma +
737                         ((i+1)%RX_RING_SIZE)*sizeof(struct yellowfin_desc));
738         }
739
740         for (i = 0; i < RX_RING_SIZE; i++) {
741                 struct sk_buff *skb = netdev_alloc_skb(dev, yp->rx_buf_sz + 2);
742                 yp->rx_skbuff[i] = skb;
743                 if (skb == NULL)
744                         break;
745                 skb_reserve(skb, 2);    /* 16 byte align the IP header. */
746                 yp->rx_ring[i].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
747                         skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE));
748         }
749         if (i != RX_RING_SIZE) {
750                 for (j = 0; j < i; j++)
751                         dev_kfree_skb(yp->rx_skbuff[j]);
752                 return -ENOMEM;
753         }
754         yp->rx_ring[i-1].dbdma_cmd = cpu_to_le32(CMD_STOP);
755         yp->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
756
757 #define NO_TXSTATS
758 #ifdef NO_TXSTATS
759         /* In this mode the Tx ring needs only a single descriptor. */
760         for (i = 0; i < TX_RING_SIZE; i++) {
761                 yp->tx_skbuff[i] = NULL;
762                 yp->tx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP);
763                 yp->tx_ring[i].branch_addr = cpu_to_le32(yp->tx_ring_dma +
764                         ((i+1)%TX_RING_SIZE)*sizeof(struct yellowfin_desc));
765         }
766         /* Wrap ring */
767         yp->tx_ring[--i].dbdma_cmd = cpu_to_le32(CMD_STOP | BRANCH_ALWAYS);
768 #else
769 {
770         /* Tx ring needs a pair of descriptors, the second for the status. */
771         for (i = 0; i < TX_RING_SIZE; i++) {
772                 j = 2*i;
773                 yp->tx_skbuff[i] = 0;
774                 /* Branch on Tx error. */
775                 yp->tx_ring[j].dbdma_cmd = cpu_to_le32(CMD_STOP);
776                 yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma +
777                         (j+1)*sizeof(struct yellowfin_desc));
778                 j++;
779                 if (yp->flags & FullTxStatus) {
780                         yp->tx_ring[j].dbdma_cmd =
781                                 cpu_to_le32(CMD_TXSTATUS | sizeof(*yp->tx_status));
782                         yp->tx_ring[j].request_cnt = sizeof(*yp->tx_status);
783                         yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma +
784                                 i*sizeof(struct tx_status_words));
785                 } else {
786                         /* Symbios chips write only tx_errs word. */
787                         yp->tx_ring[j].dbdma_cmd =
788                                 cpu_to_le32(CMD_TXSTATUS | INTR_ALWAYS | 2);
789                         yp->tx_ring[j].request_cnt = 2;
790                         /* Om pade ummmmm... */
791                         yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma +
792                                 i*sizeof(struct tx_status_words) +
793                                 &(yp->tx_status[0].tx_errs) -
794                                 &(yp->tx_status[0]));
795                 }
796                 yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma +
797                         ((j+1)%(2*TX_RING_SIZE))*sizeof(struct yellowfin_desc));
798         }
799         /* Wrap ring */
800         yp->tx_ring[++j].dbdma_cmd |= cpu_to_le32(BRANCH_ALWAYS | INTR_ALWAYS);
801 }
802 #endif
803         yp->tx_tail_desc = &yp->tx_status[0];
804         return 0;
805 }
806
807 static netdev_tx_t yellowfin_start_xmit(struct sk_buff *skb,
808                                         struct net_device *dev)
809 {
810         struct yellowfin_private *yp = netdev_priv(dev);
811         unsigned entry;
812         int len = skb->len;
813
814         netif_stop_queue (dev);
815
816         /* Note: Ordering is important here, set the field with the
817            "ownership" bit last, and only then increment cur_tx. */
818
819         /* Calculate the next Tx descriptor entry. */
820         entry = yp->cur_tx % TX_RING_SIZE;
821
822         if (gx_fix) {   /* Note: only works for paddable protocols e.g.  IP. */
823                 int cacheline_end = ((unsigned long)skb->data + skb->len) % 32;
824                 /* Fix GX chipset errata. */
825                 if (cacheline_end > 24  || cacheline_end == 0) {
826                         len = skb->len + 32 - cacheline_end + 1;
827                         if (skb_padto(skb, len)) {
828                                 yp->tx_skbuff[entry] = NULL;
829                                 netif_wake_queue(dev);
830                                 return NETDEV_TX_OK;
831                         }
832                 }
833         }
834         yp->tx_skbuff[entry] = skb;
835
836 #ifdef NO_TXSTATS
837         yp->tx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
838                 skb->data, len, PCI_DMA_TODEVICE));
839         yp->tx_ring[entry].result_status = 0;
840         if (entry >= TX_RING_SIZE-1) {
841                 /* New stop command. */
842                 yp->tx_ring[0].dbdma_cmd = cpu_to_le32(CMD_STOP);
843                 yp->tx_ring[TX_RING_SIZE-1].dbdma_cmd =
844                         cpu_to_le32(CMD_TX_PKT|BRANCH_ALWAYS | len);
845         } else {
846                 yp->tx_ring[entry+1].dbdma_cmd = cpu_to_le32(CMD_STOP);
847                 yp->tx_ring[entry].dbdma_cmd =
848                         cpu_to_le32(CMD_TX_PKT | BRANCH_IFTRUE | len);
849         }
850         yp->cur_tx++;
851 #else
852         yp->tx_ring[entry<<1].request_cnt = len;
853         yp->tx_ring[entry<<1].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
854                 skb->data, len, PCI_DMA_TODEVICE));
855         /* The input_last (status-write) command is constant, but we must
856            rewrite the subsequent 'stop' command. */
857
858         yp->cur_tx++;
859         {
860                 unsigned next_entry = yp->cur_tx % TX_RING_SIZE;
861                 yp->tx_ring[next_entry<<1].dbdma_cmd = cpu_to_le32(CMD_STOP);
862         }
863         /* Final step -- overwrite the old 'stop' command. */
864
865         yp->tx_ring[entry<<1].dbdma_cmd =
866                 cpu_to_le32( ((entry % 6) == 0 ? CMD_TX_PKT|INTR_ALWAYS|BRANCH_IFTRUE :
867                                           CMD_TX_PKT | BRANCH_IFTRUE) | len);
868 #endif
869
870         /* Non-x86 Todo: explicitly flush cache lines here. */
871
872         /* Wake the potentially-idle transmit channel. */
873         iowrite32(0x10001000, yp->base + TxCtrl);
874
875         if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE)
876                 netif_start_queue (dev);                /* Typical path */
877         else
878                 yp->tx_full = 1;
879
880         if (yellowfin_debug > 4) {
881                 netdev_printk(KERN_DEBUG, dev, "Yellowfin transmit frame #%d queued in slot %d\n",
882                               yp->cur_tx, entry);
883         }
884         return NETDEV_TX_OK;
885 }
886
887 /* The interrupt handler does all of the Rx thread work and cleans up
888    after the Tx thread. */
889 static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance)
890 {
891         struct net_device *dev = dev_instance;
892         struct yellowfin_private *yp;
893         void __iomem *ioaddr;
894         int boguscnt = max_interrupt_work;
895         unsigned int handled = 0;
896
897         yp = netdev_priv(dev);
898         ioaddr = yp->base;
899
900         spin_lock (&yp->lock);
901
902         do {
903                 u16 intr_status = ioread16(ioaddr + IntrClear);
904
905                 if (yellowfin_debug > 4)
906                         netdev_printk(KERN_DEBUG, dev, "Yellowfin interrupt, status %04x\n",
907                                       intr_status);
908
909                 if (intr_status == 0)
910                         break;
911                 handled = 1;
912
913                 if (intr_status & (IntrRxDone | IntrEarlyRx)) {
914                         yellowfin_rx(dev);
915                         iowrite32(0x10001000, ioaddr + RxCtrl);         /* Wake Rx engine. */
916                 }
917
918 #ifdef NO_TXSTATS
919                 for (; yp->cur_tx - yp->dirty_tx > 0; yp->dirty_tx++) {
920                         int entry = yp->dirty_tx % TX_RING_SIZE;
921                         struct sk_buff *skb;
922
923                         if (yp->tx_ring[entry].result_status == 0)
924                                 break;
925                         skb = yp->tx_skbuff[entry];
926                         dev->stats.tx_packets++;
927                         dev->stats.tx_bytes += skb->len;
928                         /* Free the original skb. */
929                         pci_unmap_single(yp->pci_dev, le32_to_cpu(yp->tx_ring[entry].addr),
930                                 skb->len, PCI_DMA_TODEVICE);
931                         dev_kfree_skb_irq(skb);
932                         yp->tx_skbuff[entry] = NULL;
933                 }
934                 if (yp->tx_full &&
935                     yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE - 4) {
936                         /* The ring is no longer full, clear tbusy. */
937                         yp->tx_full = 0;
938                         netif_wake_queue(dev);
939                 }
940 #else
941                 if ((intr_status & IntrTxDone) || (yp->tx_tail_desc->tx_errs)) {
942                         unsigned dirty_tx = yp->dirty_tx;
943
944                         for (dirty_tx = yp->dirty_tx; yp->cur_tx - dirty_tx > 0;
945                                  dirty_tx++) {
946                                 /* Todo: optimize this. */
947                                 int entry = dirty_tx % TX_RING_SIZE;
948                                 u16 tx_errs = yp->tx_status[entry].tx_errs;
949                                 struct sk_buff *skb;
950
951 #ifndef final_version
952                                 if (yellowfin_debug > 5)
953                                         netdev_printk(KERN_DEBUG, dev, "Tx queue %d check, Tx status %04x %04x %04x %04x\n",
954                                                       entry,
955                                                       yp->tx_status[entry].tx_cnt,
956                                                       yp->tx_status[entry].tx_errs,
957                                                       yp->tx_status[entry].total_tx_cnt,
958                                                       yp->tx_status[entry].paused);
959 #endif
960                                 if (tx_errs == 0)
961                                         break;  /* It still hasn't been Txed */
962                                 skb = yp->tx_skbuff[entry];
963                                 if (tx_errs & 0xF810) {
964                                         /* There was an major error, log it. */
965 #ifndef final_version
966                                         if (yellowfin_debug > 1)
967                                                 netdev_printk(KERN_DEBUG, dev, "Transmit error, Tx status %04x\n",
968                                                               tx_errs);
969 #endif
970                                         dev->stats.tx_errors++;
971                                         if (tx_errs & 0xF800) dev->stats.tx_aborted_errors++;
972                                         if (tx_errs & 0x0800) dev->stats.tx_carrier_errors++;
973                                         if (tx_errs & 0x2000) dev->stats.tx_window_errors++;
974                                         if (tx_errs & 0x8000) dev->stats.tx_fifo_errors++;
975                                 } else {
976 #ifndef final_version
977                                         if (yellowfin_debug > 4)
978                                                 netdev_printk(KERN_DEBUG, dev, "Normal transmit, Tx status %04x\n",
979                                                               tx_errs);
980 #endif
981                                         dev->stats.tx_bytes += skb->len;
982                                         dev->stats.collisions += tx_errs & 15;
983                                         dev->stats.tx_packets++;
984                                 }
985                                 /* Free the original skb. */
986                                 pci_unmap_single(yp->pci_dev,
987                                         yp->tx_ring[entry<<1].addr, skb->len,
988                                         PCI_DMA_TODEVICE);
989                                 dev_kfree_skb_irq(skb);
990                                 yp->tx_skbuff[entry] = 0;
991                                 /* Mark status as empty. */
992                                 yp->tx_status[entry].tx_errs = 0;
993                         }
994
995 #ifndef final_version
996                         if (yp->cur_tx - dirty_tx > TX_RING_SIZE) {
997                                 netdev_err(dev, "Out-of-sync dirty pointer, %d vs. %d, full=%d\n",
998                                            dirty_tx, yp->cur_tx, yp->tx_full);
999                                 dirty_tx += TX_RING_SIZE;
1000                         }
1001 #endif
1002
1003                         if (yp->tx_full &&
1004                             yp->cur_tx - dirty_tx < TX_QUEUE_SIZE - 2) {
1005                                 /* The ring is no longer full, clear tbusy. */
1006                                 yp->tx_full = 0;
1007                                 netif_wake_queue(dev);
1008                         }
1009
1010                         yp->dirty_tx = dirty_tx;
1011                         yp->tx_tail_desc = &yp->tx_status[dirty_tx % TX_RING_SIZE];
1012                 }
1013 #endif
1014
1015                 /* Log errors and other uncommon events. */
1016                 if (intr_status & 0x2ee)        /* Abnormal error summary. */
1017                         yellowfin_error(dev, intr_status);
1018
1019                 if (--boguscnt < 0) {
1020                         netdev_warn(dev, "Too much work at interrupt, status=%#04x\n",
1021                                     intr_status);
1022                         break;
1023                 }
1024         } while (1);
1025
1026         if (yellowfin_debug > 3)
1027                 netdev_printk(KERN_DEBUG, dev, "exiting interrupt, status=%#04x\n",
1028                               ioread16(ioaddr + IntrStatus));
1029
1030         spin_unlock (&yp->lock);
1031         return IRQ_RETVAL(handled);
1032 }
1033
1034 /* This routine is logically part of the interrupt handler, but separated
1035    for clarity and better register allocation. */
1036 static int yellowfin_rx(struct net_device *dev)
1037 {
1038         struct yellowfin_private *yp = netdev_priv(dev);
1039         int entry = yp->cur_rx % RX_RING_SIZE;
1040         int boguscnt = yp->dirty_rx + RX_RING_SIZE - yp->cur_rx;
1041
1042         if (yellowfin_debug > 4) {
1043                 printk(KERN_DEBUG " In yellowfin_rx(), entry %d status %08x\n",
1044                            entry, yp->rx_ring[entry].result_status);
1045                 printk(KERN_DEBUG "   #%d desc. %08x %08x %08x\n",
1046                            entry, yp->rx_ring[entry].dbdma_cmd, yp->rx_ring[entry].addr,
1047                            yp->rx_ring[entry].result_status);
1048         }
1049
1050         /* If EOP is set on the next entry, it's a new packet. Send it up. */
1051         while (1) {
1052                 struct yellowfin_desc *desc = &yp->rx_ring[entry];
1053                 struct sk_buff *rx_skb = yp->rx_skbuff[entry];
1054                 s16 frame_status;
1055                 u16 desc_status;
1056                 int data_size;
1057                 u8 *buf_addr;
1058
1059                 if(!desc->result_status)
1060                         break;
1061                 pci_dma_sync_single_for_cpu(yp->pci_dev, le32_to_cpu(desc->addr),
1062                         yp->rx_buf_sz, PCI_DMA_FROMDEVICE);
1063                 desc_status = le32_to_cpu(desc->result_status) >> 16;
1064                 buf_addr = rx_skb->data;
1065                 data_size = (le32_to_cpu(desc->dbdma_cmd) -
1066                         le32_to_cpu(desc->result_status)) & 0xffff;
1067                 frame_status = get_unaligned_le16(&(buf_addr[data_size - 2]));
1068                 if (yellowfin_debug > 4)
1069                         printk(KERN_DEBUG "  %s() status was %04x\n",
1070                                __func__, frame_status);
1071                 if (--boguscnt < 0)
1072                         break;
1073                 if ( ! (desc_status & RX_EOP)) {
1074                         if (data_size != 0)
1075                                 netdev_warn(dev, "Oversized Ethernet frame spanned multiple buffers, status %04x, data_size %d!\n",
1076                                             desc_status, data_size);
1077                         dev->stats.rx_length_errors++;
1078                 } else if ((yp->drv_flags & IsGigabit)  &&  (frame_status & 0x0038)) {
1079                         /* There was a error. */
1080                         if (yellowfin_debug > 3)
1081                                 printk(KERN_DEBUG "  %s() Rx error was %04x\n",
1082                                        __func__, frame_status);
1083                         dev->stats.rx_errors++;
1084                         if (frame_status & 0x0060) dev->stats.rx_length_errors++;
1085                         if (frame_status & 0x0008) dev->stats.rx_frame_errors++;
1086                         if (frame_status & 0x0010) dev->stats.rx_crc_errors++;
1087                         if (frame_status < 0) dev->stats.rx_dropped++;
1088                 } else if ( !(yp->drv_flags & IsGigabit)  &&
1089                                    ((buf_addr[data_size-1] & 0x85) || buf_addr[data_size-2] & 0xC0)) {
1090                         u8 status1 = buf_addr[data_size-2];
1091                         u8 status2 = buf_addr[data_size-1];
1092                         dev->stats.rx_errors++;
1093                         if (status1 & 0xC0) dev->stats.rx_length_errors++;
1094                         if (status2 & 0x03) dev->stats.rx_frame_errors++;
1095                         if (status2 & 0x04) dev->stats.rx_crc_errors++;
1096                         if (status2 & 0x80) dev->stats.rx_dropped++;
1097 #ifdef YF_PROTOTYPE             /* Support for prototype hardware errata. */
1098                 } else if ((yp->flags & HasMACAddrBug)  &&
1099                         memcmp(le32_to_cpu(yp->rx_ring_dma +
1100                                 entry*sizeof(struct yellowfin_desc)),
1101                                 dev->dev_addr, 6) != 0 &&
1102                         memcmp(le32_to_cpu(yp->rx_ring_dma +
1103                                 entry*sizeof(struct yellowfin_desc)),
1104                                 "\377\377\377\377\377\377", 6) != 0) {
1105                         if (bogus_rx++ == 0)
1106                                 netdev_warn(dev, "Bad frame to %pM\n",
1107                                             buf_addr);
1108 #endif
1109                 } else {
1110                         struct sk_buff *skb;
1111                         int pkt_len = data_size -
1112                                 (yp->chip_id ? 7 : 8 + buf_addr[data_size - 8]);
1113                         /* To verify: Yellowfin Length should omit the CRC! */
1114
1115 #ifndef final_version
1116                         if (yellowfin_debug > 4)
1117                                 printk(KERN_DEBUG "  %s() normal Rx pkt length %d of %d, bogus_cnt %d\n",
1118                                        __func__, pkt_len, data_size, boguscnt);
1119 #endif
1120                         /* Check if the packet is long enough to just pass up the skbuff
1121                            without copying to a properly sized skbuff. */
1122                         if (pkt_len > rx_copybreak) {
1123                                 skb_put(skb = rx_skb, pkt_len);
1124                                 pci_unmap_single(yp->pci_dev,
1125                                         le32_to_cpu(yp->rx_ring[entry].addr),
1126                                         yp->rx_buf_sz,
1127                                         PCI_DMA_FROMDEVICE);
1128                                 yp->rx_skbuff[entry] = NULL;
1129                         } else {
1130                                 skb = netdev_alloc_skb(dev, pkt_len + 2);
1131                                 if (skb == NULL)
1132                                         break;
1133                                 skb_reserve(skb, 2);    /* 16 byte align the IP header */
1134                                 skb_copy_to_linear_data(skb, rx_skb->data, pkt_len);
1135                                 skb_put(skb, pkt_len);
1136                                 pci_dma_sync_single_for_device(yp->pci_dev,
1137                                                                 le32_to_cpu(desc->addr),
1138                                                                 yp->rx_buf_sz,
1139                                                                 PCI_DMA_FROMDEVICE);
1140                         }
1141                         skb->protocol = eth_type_trans(skb, dev);
1142                         netif_rx(skb);
1143                         dev->stats.rx_packets++;
1144                         dev->stats.rx_bytes += pkt_len;
1145                 }
1146                 entry = (++yp->cur_rx) % RX_RING_SIZE;
1147         }
1148
1149         /* Refill the Rx ring buffers. */
1150         for (; yp->cur_rx - yp->dirty_rx > 0; yp->dirty_rx++) {
1151                 entry = yp->dirty_rx % RX_RING_SIZE;
1152                 if (yp->rx_skbuff[entry] == NULL) {
1153                         struct sk_buff *skb = netdev_alloc_skb(dev, yp->rx_buf_sz + 2);
1154                         if (skb == NULL)
1155                                 break;                          /* Better luck next round. */
1156                         yp->rx_skbuff[entry] = skb;
1157                         skb_reserve(skb, 2);    /* Align IP on 16 byte boundaries */
1158                         yp->rx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
1159                                 skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE));
1160                 }
1161                 yp->rx_ring[entry].dbdma_cmd = cpu_to_le32(CMD_STOP);
1162                 yp->rx_ring[entry].result_status = 0;   /* Clear complete bit. */
1163                 if (entry != 0)
1164                         yp->rx_ring[entry - 1].dbdma_cmd =
1165                                 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz);
1166                 else
1167                         yp->rx_ring[RX_RING_SIZE - 1].dbdma_cmd =
1168                                 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | BRANCH_ALWAYS
1169                                                         | yp->rx_buf_sz);
1170         }
1171
1172         return 0;
1173 }
1174
1175 static void yellowfin_error(struct net_device *dev, int intr_status)
1176 {
1177         netdev_err(dev, "Something Wicked happened! %04x\n", intr_status);
1178         /* Hmmmmm, it's not clear what to do here. */
1179         if (intr_status & (IntrTxPCIErr | IntrTxPCIFault))
1180                 dev->stats.tx_errors++;
1181         if (intr_status & (IntrRxPCIErr | IntrRxPCIFault))
1182                 dev->stats.rx_errors++;
1183 }
1184
1185 static int yellowfin_close(struct net_device *dev)
1186 {
1187         struct yellowfin_private *yp = netdev_priv(dev);
1188         void __iomem *ioaddr = yp->base;
1189         int i;
1190
1191         netif_stop_queue (dev);
1192
1193         if (yellowfin_debug > 1) {
1194                 netdev_printk(KERN_DEBUG, dev, "Shutting down ethercard, status was Tx %04x Rx %04x Int %02x\n",
1195                               ioread16(ioaddr + TxStatus),
1196                               ioread16(ioaddr + RxStatus),
1197                               ioread16(ioaddr + IntrStatus));
1198                 netdev_printk(KERN_DEBUG, dev, "Queue pointers were Tx %d / %d,  Rx %d / %d\n",
1199                               yp->cur_tx, yp->dirty_tx,
1200                               yp->cur_rx, yp->dirty_rx);
1201         }
1202
1203         /* Disable interrupts by clearing the interrupt mask. */
1204         iowrite16(0x0000, ioaddr + IntrEnb);
1205
1206         /* Stop the chip's Tx and Rx processes. */
1207         iowrite32(0x80000000, ioaddr + RxCtrl);
1208         iowrite32(0x80000000, ioaddr + TxCtrl);
1209
1210         del_timer(&yp->timer);
1211
1212 #if defined(__i386__)
1213         if (yellowfin_debug > 2) {
1214                 printk(KERN_DEBUG "  Tx ring at %08llx:\n",
1215                                 (unsigned long long)yp->tx_ring_dma);
1216                 for (i = 0; i < TX_RING_SIZE*2; i++)
1217                         printk(KERN_DEBUG " %c #%d desc. %08x %08x %08x %08x\n",
1218                                    ioread32(ioaddr + TxPtr) == (long)&yp->tx_ring[i] ? '>' : ' ',
1219                                    i, yp->tx_ring[i].dbdma_cmd, yp->tx_ring[i].addr,
1220                                    yp->tx_ring[i].branch_addr, yp->tx_ring[i].result_status);
1221                 printk(KERN_DEBUG "  Tx status %p:\n", yp->tx_status);
1222                 for (i = 0; i < TX_RING_SIZE; i++)
1223                         printk(KERN_DEBUG "   #%d status %04x %04x %04x %04x\n",
1224                                    i, yp->tx_status[i].tx_cnt, yp->tx_status[i].tx_errs,
1225                                    yp->tx_status[i].total_tx_cnt, yp->tx_status[i].paused);
1226
1227                 printk(KERN_DEBUG "  Rx ring %08llx:\n",
1228                                 (unsigned long long)yp->rx_ring_dma);
1229                 for (i = 0; i < RX_RING_SIZE; i++) {
1230                         printk(KERN_DEBUG " %c #%d desc. %08x %08x %08x\n",
1231                                    ioread32(ioaddr + RxPtr) == (long)&yp->rx_ring[i] ? '>' : ' ',
1232                                    i, yp->rx_ring[i].dbdma_cmd, yp->rx_ring[i].addr,
1233                                    yp->rx_ring[i].result_status);
1234                         if (yellowfin_debug > 6) {
1235                                 if (get_unaligned((u8*)yp->rx_ring[i].addr) != 0x69) {
1236                                         int j;
1237
1238                                         printk(KERN_DEBUG);
1239                                         for (j = 0; j < 0x50; j++)
1240                                                 pr_cont(" %04x",
1241                                                         get_unaligned(((u16*)yp->rx_ring[i].addr) + j));
1242                                         pr_cont("\n");
1243                                 }
1244                         }
1245                 }
1246         }
1247 #endif /* __i386__ debugging only */
1248
1249         free_irq(yp->pci_dev->irq, dev);
1250
1251         /* Free all the skbuffs in the Rx queue. */
1252         for (i = 0; i < RX_RING_SIZE; i++) {
1253                 yp->rx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP);
1254                 yp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */
1255                 if (yp->rx_skbuff[i]) {
1256                         dev_kfree_skb(yp->rx_skbuff[i]);
1257                 }
1258                 yp->rx_skbuff[i] = NULL;
1259         }
1260         for (i = 0; i < TX_RING_SIZE; i++) {
1261                 if (yp->tx_skbuff[i])
1262                         dev_kfree_skb(yp->tx_skbuff[i]);
1263                 yp->tx_skbuff[i] = NULL;
1264         }
1265
1266 #ifdef YF_PROTOTYPE                     /* Support for prototype hardware errata. */
1267         if (yellowfin_debug > 0) {
1268                 netdev_printk(KERN_DEBUG, dev, "Received %d frames that we should not have\n",
1269                               bogus_rx);
1270         }
1271 #endif
1272
1273         return 0;
1274 }
1275
1276 /* Set or clear the multicast filter for this adaptor. */
1277
1278 static void set_rx_mode(struct net_device *dev)
1279 {
1280         struct yellowfin_private *yp = netdev_priv(dev);
1281         void __iomem *ioaddr = yp->base;
1282         u16 cfg_value = ioread16(ioaddr + Cnfg);
1283
1284         /* Stop the Rx process to change any value. */
1285         iowrite16(cfg_value & ~0x1000, ioaddr + Cnfg);
1286         if (dev->flags & IFF_PROMISC) {                 /* Set promiscuous. */
1287                 iowrite16(0x000F, ioaddr + AddrMode);
1288         } else if ((netdev_mc_count(dev) > 64) ||
1289                    (dev->flags & IFF_ALLMULTI)) {
1290                 /* Too many to filter well, or accept all multicasts. */
1291                 iowrite16(0x000B, ioaddr + AddrMode);
1292         } else if (!netdev_mc_empty(dev)) { /* Must use the multicast hash table. */
1293                 struct netdev_hw_addr *ha;
1294                 u16 hash_table[4];
1295                 int i;
1296
1297                 memset(hash_table, 0, sizeof(hash_table));
1298                 netdev_for_each_mc_addr(ha, dev) {
1299                         unsigned int bit;
1300
1301                         /* Due to a bug in the early chip versions, multiple filter
1302                            slots must be set for each address. */
1303                         if (yp->drv_flags & HasMulticastBug) {
1304                                 bit = (ether_crc_le(3, ha->addr) >> 3) & 0x3f;
1305                                 hash_table[bit >> 4] |= (1 << bit);
1306                                 bit = (ether_crc_le(4, ha->addr) >> 3) & 0x3f;
1307                                 hash_table[bit >> 4] |= (1 << bit);
1308                                 bit = (ether_crc_le(5, ha->addr) >> 3) & 0x3f;
1309                                 hash_table[bit >> 4] |= (1 << bit);
1310                         }
1311                         bit = (ether_crc_le(6, ha->addr) >> 3) & 0x3f;
1312                         hash_table[bit >> 4] |= (1 << bit);
1313                 }
1314                 /* Copy the hash table to the chip. */
1315                 for (i = 0; i < 4; i++)
1316                         iowrite16(hash_table[i], ioaddr + HashTbl + i*2);
1317                 iowrite16(0x0003, ioaddr + AddrMode);
1318         } else {                                        /* Normal, unicast/broadcast-only mode. */
1319                 iowrite16(0x0001, ioaddr + AddrMode);
1320         }
1321         /* Restart the Rx process. */
1322         iowrite16(cfg_value | 0x1000, ioaddr + Cnfg);
1323 }
1324
1325 static void yellowfin_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1326 {
1327         struct yellowfin_private *np = netdev_priv(dev);
1328
1329         strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
1330         strlcpy(info->version, DRV_VERSION, sizeof(info->version));
1331         strlcpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info));
1332 }
1333
1334 static const struct ethtool_ops ethtool_ops = {
1335         .get_drvinfo = yellowfin_get_drvinfo
1336 };
1337
1338 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1339 {
1340         struct yellowfin_private *np = netdev_priv(dev);
1341         void __iomem *ioaddr = np->base;
1342         struct mii_ioctl_data *data = if_mii(rq);
1343
1344         switch(cmd) {
1345         case SIOCGMIIPHY:               /* Get address of MII PHY in use. */
1346                 data->phy_id = np->phys[0] & 0x1f;
1347                 /* Fall Through */
1348
1349         case SIOCGMIIREG:               /* Read MII PHY register. */
1350                 data->val_out = mdio_read(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f);
1351                 return 0;
1352
1353         case SIOCSMIIREG:               /* Write MII PHY register. */
1354                 if (data->phy_id == np->phys[0]) {
1355                         u16 value = data->val_in;
1356                         switch (data->reg_num) {
1357                         case 0:
1358                                 /* Check for autonegotiation on or reset. */
1359                                 np->medialock = (value & 0x9000) ? 0 : 1;
1360                                 if (np->medialock)
1361                                         np->full_duplex = (value & 0x0100) ? 1 : 0;
1362                                 break;
1363                         case 4: np->advertising = value; break;
1364                         }
1365                         /* Perhaps check_duplex(dev), depending on chip semantics. */
1366                 }
1367                 mdio_write(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1368                 return 0;
1369         default:
1370                 return -EOPNOTSUPP;
1371         }
1372 }
1373
1374
1375 static void yellowfin_remove_one(struct pci_dev *pdev)
1376 {
1377         struct net_device *dev = pci_get_drvdata(pdev);
1378         struct yellowfin_private *np;
1379
1380         BUG_ON(!dev);
1381         np = netdev_priv(dev);
1382
1383         pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status,
1384                 np->tx_status_dma);
1385         pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
1386         pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
1387         unregister_netdev (dev);
1388
1389         pci_iounmap(pdev, np->base);
1390
1391         pci_release_regions (pdev);
1392
1393         free_netdev (dev);
1394 }
1395
1396
1397 static struct pci_driver yellowfin_driver = {
1398         .name           = DRV_NAME,
1399         .id_table       = yellowfin_pci_tbl,
1400         .probe          = yellowfin_init_one,
1401         .remove         = yellowfin_remove_one,
1402 };
1403
1404
1405 static int __init yellowfin_init (void)
1406 {
1407 /* when a module, this is printed whether or not devices are found in probe */
1408 #ifdef MODULE
1409         printk(version);
1410 #endif
1411         return pci_register_driver(&yellowfin_driver);
1412 }
1413
1414
1415 static void __exit yellowfin_cleanup (void)
1416 {
1417         pci_unregister_driver (&yellowfin_driver);
1418 }
1419
1420
1421 module_init(yellowfin_init);
1422 module_exit(yellowfin_cleanup);