1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#define DRV_NAME "yellowfin"
27#define DRV_VERSION "2.1"
28#define DRV_RELDATE "Sep 11, 2006"
29
30#define PFX DRV_NAME ": "
31
32
33
34
35static int debug = 1;
36
37static int max_interrupt_work = 20;
38static int mtu;
39#ifdef YF_PROTOTYPE
40
41static int bogus_rx;
42static int dma_ctrl = 0x004A0263;
43static int fifo_cfg = 0x0020;
44#elif defined(YF_NEW)
45static int dma_ctrl = 0x00CAC277;
46static int fifo_cfg = 0x0028;
47#else
48static const int dma_ctrl = 0x004A0263;
49static const int fifo_cfg = 0x0020;
50#endif
51
52
53
54static int rx_copybreak;
55
56
57
58
59
60#define MAX_UNITS 8
61static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
62static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
63
64
65static int gx_fix;
66
67
68
69
70
71
72
73#define TX_RING_SIZE 16
74#define TX_QUEUE_SIZE 12
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
81
82#define TX_TIMEOUT (2*HZ)
83#define PKT_BUF_SZ 1536
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/slab.h>
94#include <linux/interrupt.h>
95#include <linux/pci.h>
96#include <linux/init.h>
97#include <linux/mii.h>
98#include <linux/netdevice.h>
99#include <linux/etherdevice.h>
100#include <linux/skbuff.h>
101#include <linux/ethtool.h>
102#include <linux/crc32.h>
103#include <linux/bitops.h>
104#include <asm/uaccess.h>
105#include <asm/processor.h>
106#include <asm/unaligned.h>
107#include <asm/io.h>
108
109
110static char version[] __devinitdata =
111KERN_INFO DRV_NAME ".c:v1.05 1/09/2001 Written by Donald Becker <becker@scyld.com>\n"
112KERN_INFO " (unofficial 2.4.x port, " DRV_VERSION ", " DRV_RELDATE ")\n";
113
114MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
115MODULE_DESCRIPTION("Packet Engines Yellowfin G-NIC Gigabit Ethernet driver");
116MODULE_LICENSE("GPL");
117
118module_param(max_interrupt_work, int, 0);
119module_param(mtu, int, 0);
120module_param(debug, int, 0);
121module_param(rx_copybreak, int, 0);
122module_param_array(options, int, NULL, 0);
123module_param_array(full_duplex, int, NULL, 0);
124module_param(gx_fix, int, 0);
125MODULE_PARM_DESC(max_interrupt_work, "G-NIC maximum events handled per interrupt");
126MODULE_PARM_DESC(mtu, "G-NIC MTU (all boards)");
127MODULE_PARM_DESC(debug, "G-NIC debug level (0-7)");
128MODULE_PARM_DESC(rx_copybreak, "G-NIC copy breakpoint for copy-only-tiny-frames");
129MODULE_PARM_DESC(options, "G-NIC: Bits 0-3: media type, bit 17: full duplex");
130MODULE_PARM_DESC(full_duplex, "G-NIC full duplex setting(s) (1)");
131MODULE_PARM_DESC(gx_fix, "G-NIC: enable GX server chipset bug workaround (0-1)");
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212enum capability_flags {
213 HasMII=1, FullTxStatus=2, IsGigabit=4, HasMulticastBug=8, FullRxStatus=16,
214 HasMACAddrBug=32,
215 DontUseEeprom=64,
216};
217
218
219enum {
220 YELLOWFIN_SIZE = 0x100,
221};
222
223struct pci_id_info {
224 const char *name;
225 struct match_info {
226 int pci, pci_mask, subsystem, subsystem_mask;
227 int revision, revision_mask;
228 } id;
229 int drv_flags;
230};
231
232static const struct pci_id_info pci_id_tbl[] = {
233 {"Yellowfin G-NIC Gigabit Ethernet", { 0x07021000, 0xffffffff},
234 FullTxStatus | IsGigabit | HasMulticastBug | HasMACAddrBug | DontUseEeprom},
235 {"Symbios SYM83C885", { 0x07011000, 0xffffffff},
236 HasMII | DontUseEeprom },
237 { }
238};
239
240static const struct pci_device_id yellowfin_pci_tbl[] = {
241 { 0x1000, 0x0702, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
242 { 0x1000, 0x0701, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
243 { }
244};
245MODULE_DEVICE_TABLE (pci, yellowfin_pci_tbl);
246
247
248
249enum yellowfin_offsets {
250 TxCtrl=0x00, TxStatus=0x04, TxPtr=0x0C,
251 TxIntrSel=0x10, TxBranchSel=0x14, TxWaitSel=0x18,
252 RxCtrl=0x40, RxStatus=0x44, RxPtr=0x4C,
253 RxIntrSel=0x50, RxBranchSel=0x54, RxWaitSel=0x58,
254 EventStatus=0x80, IntrEnb=0x82, IntrClear=0x84, IntrStatus=0x86,
255 ChipRev=0x8C, DMACtrl=0x90, TxThreshold=0x94,
256 Cnfg=0xA0, FrameGap0=0xA2, FrameGap1=0xA4,
257 MII_Cmd=0xA6, MII_Addr=0xA8, MII_Wr_Data=0xAA, MII_Rd_Data=0xAC,
258 MII_Status=0xAE,
259 RxDepth=0xB8, FlowCtrl=0xBC,
260 AddrMode=0xD0, StnAddr=0xD2, HashTbl=0xD8, FIFOcfg=0xF8,
261 EEStatus=0xF0, EECtrl=0xF1, EEAddr=0xF2, EERead=0xF3, EEWrite=0xF4,
262 EEFeature=0xF5,
263};
264
265
266
267struct yellowfin_desc {
268 __le32 dbdma_cmd;
269 __le32 addr;
270 __le32 branch_addr;
271 __le32 result_status;
272};
273
274struct tx_status_words {
275#ifdef __BIG_ENDIAN
276 u16 tx_errs;
277 u16 tx_cnt;
278 u16 paused;
279 u16 total_tx_cnt;
280#else
281 u16 tx_cnt;
282 u16 tx_errs;
283 u16 total_tx_cnt;
284 u16 paused;
285#endif
286};
287
288
289enum desc_cmd_bits {
290 CMD_TX_PKT=0x10000000, CMD_RX_BUF=0x20000000, CMD_TXSTATUS=0x30000000,
291 CMD_NOP=0x60000000, CMD_STOP=0x70000000,
292 BRANCH_ALWAYS=0x0C0000, INTR_ALWAYS=0x300000, WAIT_ALWAYS=0x030000,
293 BRANCH_IFTRUE=0x040000,
294};
295
296
297enum desc_status_bits { RX_EOP=0x0040, };
298
299
300enum intr_status_bits {
301 IntrRxDone=0x01, IntrRxInvalid=0x02, IntrRxPCIFault=0x04,IntrRxPCIErr=0x08,
302 IntrTxDone=0x10, IntrTxInvalid=0x20, IntrTxPCIFault=0x40,IntrTxPCIErr=0x80,
303 IntrEarlyRx=0x100, IntrWakeup=0x200, };
304
305#define PRIV_ALIGN 31
306#define MII_CNT 4
307struct yellowfin_private {
308
309
310 struct yellowfin_desc *rx_ring;
311 struct yellowfin_desc *tx_ring;
312 struct sk_buff* rx_skbuff[RX_RING_SIZE];
313 struct sk_buff* tx_skbuff[TX_RING_SIZE];
314 dma_addr_t rx_ring_dma;
315 dma_addr_t tx_ring_dma;
316
317 struct tx_status_words *tx_status;
318 dma_addr_t tx_status_dma;
319
320 struct timer_list timer;
321
322 int chip_id, drv_flags;
323 struct pci_dev *pci_dev;
324 unsigned int cur_rx, dirty_rx;
325 unsigned int rx_buf_sz;
326 struct tx_status_words *tx_tail_desc;
327 unsigned int cur_tx, dirty_tx;
328 int tx_threshold;
329 unsigned int tx_full:1;
330 unsigned int full_duplex:1;
331 unsigned int duplex_lock:1;
332 unsigned int medialock:1;
333 unsigned int default_port:4;
334
335 int mii_cnt;
336 u16 advertising;
337 unsigned char phys[MII_CNT];
338 spinlock_t lock;
339 void __iomem *base;
340};
341
342static int read_eeprom(void __iomem *ioaddr, int location);
343static int mdio_read(void __iomem *ioaddr, int phy_id, int location);
344static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value);
345static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
346static int yellowfin_open(struct net_device *dev);
347static void yellowfin_timer(unsigned long data);
348static void yellowfin_tx_timeout(struct net_device *dev);
349static void yellowfin_init_ring(struct net_device *dev);
350static int yellowfin_start_xmit(struct sk_buff *skb, struct net_device *dev);
351static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance);
352static int yellowfin_rx(struct net_device *dev);
353static void yellowfin_error(struct net_device *dev, int intr_status);
354static int yellowfin_close(struct net_device *dev);
355static void set_rx_mode(struct net_device *dev);
356static const struct ethtool_ops ethtool_ops;
357
358static 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_multicast_list = 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
370static 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
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 printk (KERN_ERR PFX "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
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 = (struct yellowfin_desc *)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 = (struct yellowfin_desc *)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 = (struct tx_status_words *)ring_space;
458 np->tx_status_dma = ring_dma;
459
460 if (dev->mem_start)
461 option = dev->mem_start;
462
463
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
478 dev->netdev_ops = &netdev_ops;
479 SET_ETHTOOL_OPS(dev, ðtool_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 printk(KERN_INFO "%s: %s type %8x at %p, %pM, IRQ %d.\n",
490 dev->name, 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 printk(KERN_INFO "%s: MII PHY found at address %d, status "
502 "0x%4.4x advertising %4.4x.\n",
503 dev->name, phy, mii_status, np->advertising);
504 }
505 }
506 np->mii_cnt = phy_idx;
507 }
508
509 find_cnt++;
510
511 return 0;
512
513err_out_unmap_status:
514 pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status,
515 np->tx_status_dma);
516err_out_unmap_rx:
517 pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
518err_out_unmap_tx:
519 pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
520err_out_cleardev:
521 pci_set_drvdata(pdev, NULL);
522 pci_iounmap(pdev, ioaddr);
523err_out_free_res:
524 pci_release_regions(pdev);
525err_out_free_netdev:
526 free_netdev (dev);
527 return -ENODEV;
528}
529
530static int __devinit read_eeprom(void __iomem *ioaddr, int location)
531{
532 int bogus_cnt = 10000;
533
534 iowrite8(location, ioaddr + EEAddr);
535 iowrite8(0x30 | ((location >> 8) & 7), ioaddr + EECtrl);
536 while ((ioread8(ioaddr + EEStatus) & 0x80) && --bogus_cnt > 0)
537 ;
538 return ioread8(ioaddr + EERead);
539}
540
541
542
543
544
545static int mdio_read(void __iomem *ioaddr, int phy_id, int location)
546{
547 int i;
548
549 iowrite16((phy_id<<8) + location, ioaddr + MII_Addr);
550 iowrite16(1, ioaddr + MII_Cmd);
551 for (i = 10000; i >= 0; i--)
552 if ((ioread16(ioaddr + MII_Status) & 1) == 0)
553 break;
554 return ioread16(ioaddr + MII_Rd_Data);
555}
556
557static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value)
558{
559 int i;
560
561 iowrite16((phy_id<<8) + location, ioaddr + MII_Addr);
562 iowrite16(value, ioaddr + MII_Wr_Data);
563
564
565 for (i = 10000; i >= 0; i--)
566 if ((ioread16(ioaddr + MII_Status) & 1) == 0)
567 break;
568 return;
569}
570
571
572static int yellowfin_open(struct net_device *dev)
573{
574 struct yellowfin_private *yp = netdev_priv(dev);
575 void __iomem *ioaddr = yp->base;
576 int i;
577
578
579 iowrite32(0x80000000, ioaddr + DMACtrl);
580
581 i = request_irq(dev->irq, &yellowfin_interrupt, IRQF_SHARED, dev->name, dev);
582 if (i) return i;
583
584 if (yellowfin_debug > 1)
585 printk(KERN_DEBUG "%s: yellowfin_open() irq %d.\n",
586 dev->name, dev->irq);
587
588 yellowfin_init_ring(dev);
589
590 iowrite32(yp->rx_ring_dma, ioaddr + RxPtr);
591 iowrite32(yp->tx_ring_dma, ioaddr + TxPtr);
592
593 for (i = 0; i < 6; i++)
594 iowrite8(dev->dev_addr[i], ioaddr + StnAddr + i);
595
596
597
598 iowrite32(0x00800080, ioaddr + TxIntrSel);
599 iowrite32(0x00800080, ioaddr + TxBranchSel);
600 iowrite32(0x00400040, ioaddr + TxWaitSel);
601 iowrite32(0x00400040, ioaddr + RxIntrSel);
602 iowrite32(0x00400040, ioaddr + RxBranchSel);
603 iowrite32(0x00400040, ioaddr + RxWaitSel);
604
605
606
607 iowrite32(dma_ctrl, ioaddr + DMACtrl);
608 iowrite16(fifo_cfg, ioaddr + FIFOcfg);
609
610 iowrite32(0x0030FFFF, ioaddr + FlowCtrl);
611
612 yp->tx_threshold = 32;
613 iowrite32(yp->tx_threshold, ioaddr + TxThreshold);
614
615 if (dev->if_port == 0)
616 dev->if_port = yp->default_port;
617
618 netif_start_queue(dev);
619
620
621 if (yp->drv_flags & IsGigabit) {
622
623 yp->full_duplex = 1;
624 iowrite16(0x01CF, ioaddr + Cnfg);
625 } else {
626 iowrite16(0x0018, ioaddr + FrameGap0);
627 iowrite16(0x1018, ioaddr + FrameGap1);
628 iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg);
629 }
630 set_rx_mode(dev);
631
632
633 iowrite16(0x81ff, ioaddr + IntrEnb);
634 iowrite16(0x0000, ioaddr + EventStatus);
635 iowrite32(0x80008000, ioaddr + RxCtrl);
636 iowrite32(0x80008000, ioaddr + TxCtrl);
637
638 if (yellowfin_debug > 2) {
639 printk(KERN_DEBUG "%s: Done yellowfin_open().\n",
640 dev->name);
641 }
642
643
644 init_timer(&yp->timer);
645 yp->timer.expires = jiffies + 3*HZ;
646 yp->timer.data = (unsigned long)dev;
647 yp->timer.function = &yellowfin_timer;
648 add_timer(&yp->timer);
649
650 return 0;
651}
652
653static void yellowfin_timer(unsigned long data)
654{
655 struct net_device *dev = (struct net_device *)data;
656 struct yellowfin_private *yp = netdev_priv(dev);
657 void __iomem *ioaddr = yp->base;
658 int next_tick = 60*HZ;
659
660 if (yellowfin_debug > 3) {
661 printk(KERN_DEBUG "%s: Yellowfin timer tick, status %8.8x.\n",
662 dev->name, ioread16(ioaddr + IntrStatus));
663 }
664
665 if (yp->mii_cnt) {
666 int bmsr = mdio_read(ioaddr, yp->phys[0], MII_BMSR);
667 int lpa = mdio_read(ioaddr, yp->phys[0], MII_LPA);
668 int negotiated = lpa & yp->advertising;
669 if (yellowfin_debug > 1)
670 printk(KERN_DEBUG "%s: MII #%d status register is %4.4x, "
671 "link partner capability %4.4x.\n",
672 dev->name, yp->phys[0], bmsr, lpa);
673
674 yp->full_duplex = mii_duplex(yp->duplex_lock, negotiated);
675
676 iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg);
677
678 if (bmsr & BMSR_LSTATUS)
679 next_tick = 60*HZ;
680 else
681 next_tick = 3*HZ;
682 }
683
684 yp->timer.expires = jiffies + next_tick;
685 add_timer(&yp->timer);
686}
687
688static void yellowfin_tx_timeout(struct net_device *dev)
689{
690 struct yellowfin_private *yp = netdev_priv(dev);
691 void __iomem *ioaddr = yp->base;
692
693 printk(KERN_WARNING "%s: Yellowfin transmit timed out at %d/%d Tx "
694 "status %4.4x, Rx status %4.4x, resetting...\n",
695 dev->name, yp->cur_tx, yp->dirty_tx,
696 ioread32(ioaddr + TxStatus), ioread32(ioaddr + RxStatus));
697
698
699 if (yellowfin_debug) {
700 int i;
701 printk(KERN_WARNING " Rx ring %p: ", yp->rx_ring);
702 for (i = 0; i < RX_RING_SIZE; i++)
703 printk(" %8.8x", yp->rx_ring[i].result_status);
704 printk("\n"KERN_WARNING" Tx ring %p: ", yp->tx_ring);
705 for (i = 0; i < TX_RING_SIZE; i++)
706 printk(" %4.4x /%8.8x", yp->tx_status[i].tx_errs,
707 yp->tx_ring[i].result_status);
708 printk("\n");
709 }
710
711
712
713 dev->if_port = 0;
714
715
716 iowrite32(0x10001000, yp->base + TxCtrl);
717 if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE)
718 netif_wake_queue (dev);
719
720 dev->trans_start = jiffies;
721 dev->stats.tx_errors++;
722}
723
724
725static void yellowfin_init_ring(struct net_device *dev)
726{
727 struct yellowfin_private *yp = netdev_priv(dev);
728 int i;
729
730 yp->tx_full = 0;
731 yp->cur_rx = yp->cur_tx = 0;
732 yp->dirty_tx = 0;
733
734 yp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
735
736 for (i = 0; i < RX_RING_SIZE; i++) {
737 yp->rx_ring[i].dbdma_cmd =
738 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz);
739 yp->rx_ring[i].branch_addr = cpu_to_le32(yp->rx_ring_dma +
740 ((i+1)%RX_RING_SIZE)*sizeof(struct yellowfin_desc));
741 }
742
743 for (i = 0; i < RX_RING_SIZE; i++) {
744 struct sk_buff *skb = dev_alloc_skb(yp->rx_buf_sz);
745 yp->rx_skbuff[i] = skb;
746 if (skb == NULL)
747 break;
748 skb->dev = dev;
749 skb_reserve(skb, 2);
750 yp->rx_ring[i].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
751 skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE));
752 }
753 yp->rx_ring[i-1].dbdma_cmd = cpu_to_le32(CMD_STOP);
754 yp->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
755
756#define NO_TXSTATS
757#ifdef NO_TXSTATS
758
759 for (i = 0; i < TX_RING_SIZE; i++) {
760 yp->tx_skbuff[i] = NULL;
761 yp->tx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP);
762 yp->tx_ring[i].branch_addr = cpu_to_le32(yp->tx_ring_dma +
763 ((i+1)%TX_RING_SIZE)*sizeof(struct yellowfin_desc));
764 }
765
766 yp->tx_ring[--i].dbdma_cmd = cpu_to_le32(CMD_STOP | BRANCH_ALWAYS);
767#else
768{
769 int j;
770
771
772 for (i = 0; i < TX_RING_SIZE; i++) {
773 j = 2*i;
774 yp->tx_skbuff[i] = 0;
775
776 yp->tx_ring[j].dbdma_cmd = cpu_to_le32(CMD_STOP);
777 yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma +
778 (j+1)*sizeof(struct yellowfin_desc));
779 j++;
780 if (yp->flags & FullTxStatus) {
781 yp->tx_ring[j].dbdma_cmd =
782 cpu_to_le32(CMD_TXSTATUS | sizeof(*yp->tx_status));
783 yp->tx_ring[j].request_cnt = sizeof(*yp->tx_status);
784 yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma +
785 i*sizeof(struct tx_status_words));
786 } else {
787
788 yp->tx_ring[j].dbdma_cmd =
789 cpu_to_le32(CMD_TXSTATUS | INTR_ALWAYS | 2);
790 yp->tx_ring[j].request_cnt = 2;
791
792 yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma +
793 i*sizeof(struct tx_status_words) +
794 &(yp->tx_status[0].tx_errs) -
795 &(yp->tx_status[0]));
796 }
797 yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma +
798 ((j+1)%(2*TX_RING_SIZE))*sizeof(struct yellowfin_desc));
799 }
800
801 yp->tx_ring[++j].dbdma_cmd |= cpu_to_le32(BRANCH_ALWAYS | INTR_ALWAYS);
802}
803#endif
804 yp->tx_tail_desc = &yp->tx_status[0];
805 return;
806}
807
808static int yellowfin_start_xmit(struct sk_buff *skb, 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
817
818
819
820 entry = yp->cur_tx % TX_RING_SIZE;
821
822 if (gx_fix) {
823 int cacheline_end = ((unsigned long)skb->data + skb->len) % 32;
824
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 0;
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
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
856
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
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
871
872
873 iowrite32(0x10001000, yp->base + TxCtrl);
874
875 if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE)
876 netif_start_queue (dev);
877 else
878 yp->tx_full = 1;
879 dev->trans_start = jiffies;
880
881 if (yellowfin_debug > 4) {
882 printk(KERN_DEBUG "%s: Yellowfin transmit frame #%d queued in slot %d.\n",
883 dev->name, yp->cur_tx, entry);
884 }
885 return 0;
886}
887
888
889
890static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance)
891{
892 struct net_device *dev = dev_instance;
893 struct yellowfin_private *yp;
894 void __iomem *ioaddr;
895 int boguscnt = max_interrupt_work;
896 unsigned int handled = 0;
897
898 yp = netdev_priv(dev);
899 ioaddr = yp->base;
900
901 spin_lock (&yp->lock);
902
903 do {
904 u16 intr_status = ioread16(ioaddr + IntrClear);
905
906 if (yellowfin_debug > 4)
907 printk(KERN_DEBUG "%s: Yellowfin interrupt, status %4.4x.\n",
908 dev->name, intr_status);
909
910 if (intr_status == 0)
911 break;
912 handled = 1;
913
914 if (intr_status & (IntrRxDone | IntrEarlyRx)) {
915 yellowfin_rx(dev);
916 iowrite32(0x10001000, ioaddr + RxCtrl);
917 }
918
919#ifdef NO_TXSTATS
920 for (; yp->cur_tx - yp->dirty_tx > 0; yp->dirty_tx++) {
921 int entry = yp->dirty_tx % TX_RING_SIZE;
922 struct sk_buff *skb;
923
924 if (yp->tx_ring[entry].result_status == 0)
925 break;
926 skb = yp->tx_skbuff[entry];
927 dev->stats.tx_packets++;
928 dev->stats.tx_bytes += skb->len;
929
930 pci_unmap_single(yp->pci_dev, le32_to_cpu(yp->tx_ring[entry].addr),
931 skb->len, PCI_DMA_TODEVICE);
932 dev_kfree_skb_irq(skb);
933 yp->tx_skbuff[entry] = NULL;
934 }
935 if (yp->tx_full
936 && yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE - 4) {
937
938 yp->tx_full = 0;
939 netif_wake_queue(dev);
940 }
941#else
942 if ((intr_status & IntrTxDone) || (yp->tx_tail_desc->tx_errs)) {
943 unsigned dirty_tx = yp->dirty_tx;
944
945 for (dirty_tx = yp->dirty_tx; yp->cur_tx - dirty_tx > 0;
946 dirty_tx++) {
947
948 int entry = dirty_tx % TX_RING_SIZE;
949 u16 tx_errs = yp->tx_status[entry].tx_errs;
950 struct sk_buff *skb;
951
952#ifndef final_version
953 if (yellowfin_debug > 5)
954 printk(KERN_DEBUG "%s: Tx queue %d check, Tx status "
955 "%4.4x %4.4x %4.4x %4.4x.\n",
956 dev->name, entry,
957 yp->tx_status[entry].tx_cnt,
958 yp->tx_status[entry].tx_errs,
959 yp->tx_status[entry].total_tx_cnt,
960 yp->tx_status[entry].paused);
961#endif
962 if (tx_errs == 0)
963 break;
964 skb = yp->tx_skbuff[entry];
965 if (tx_errs & 0xF810) {
966
967#ifndef final_version
968 if (yellowfin_debug > 1)
969 printk(KERN_DEBUG "%s: Transmit error, Tx status %4.4x.\n",
970 dev->name, tx_errs);
971#endif
972 dev->stats.tx_errors++;
973 if (tx_errs & 0xF800) dev->stats.tx_aborted_errors++;
974 if (tx_errs & 0x0800) dev->stats.tx_carrier_errors++;
975 if (tx_errs & 0x2000) dev->stats.tx_window_errors++;
976 if (tx_errs & 0x8000) dev->stats.tx_fifo_errors++;
977 } else {
978#ifndef final_version
979 if (yellowfin_debug > 4)
980 printk(KERN_DEBUG "%s: Normal transmit, Tx status %4.4x.\n",
981 dev->name, tx_errs);
982#endif
983 dev->stats.tx_bytes += skb->len;
984 dev->stats.collisions += tx_errs & 15;
985 dev->stats.tx_packets++;
986 }
987
988 pci_unmap_single(yp->pci_dev,
989 yp->tx_ring[entry<<1].addr, skb->len,
990 PCI_DMA_TODEVICE);
991 dev_kfree_skb_irq(skb);
992 yp->tx_skbuff[entry] = 0;
993
994 yp->tx_status[entry].tx_errs = 0;
995 }
996
997#ifndef final_version
998 if (yp->cur_tx - dirty_tx > TX_RING_SIZE) {
999 printk(KERN_ERR "%s: Out-of-sync dirty pointer, %d vs. %d, full=%d.\n",
1000 dev->name, dirty_tx, yp->cur_tx, yp->tx_full);
1001 dirty_tx += TX_RING_SIZE;
1002 }
1003#endif
1004
1005 if (yp->tx_full
1006 && yp->cur_tx - dirty_tx < TX_QUEUE_SIZE - 2) {
1007
1008 yp->tx_full = 0;
1009 netif_wake_queue(dev);
1010 }
1011
1012 yp->dirty_tx = dirty_tx;
1013 yp->tx_tail_desc = &yp->tx_status[dirty_tx % TX_RING_SIZE];
1014 }
1015#endif
1016
1017
1018 if (intr_status & 0x2ee)
1019 yellowfin_error(dev, intr_status);
1020
1021 if (--boguscnt < 0) {
1022 printk(KERN_WARNING "%s: Too much work at interrupt, "
1023 "status=0x%4.4x.\n",
1024 dev->name, intr_status);
1025 break;
1026 }
1027 } while (1);
1028
1029 if (yellowfin_debug > 3)
1030 printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.\n",
1031 dev->name, ioread16(ioaddr + IntrStatus));
1032
1033 spin_unlock (&yp->lock);
1034 return IRQ_RETVAL(handled);
1035}
1036
1037
1038
1039static int yellowfin_rx(struct net_device *dev)
1040{
1041 struct yellowfin_private *yp = netdev_priv(dev);
1042 int entry = yp->cur_rx % RX_RING_SIZE;
1043 int boguscnt = yp->dirty_rx + RX_RING_SIZE - yp->cur_rx;
1044
1045 if (yellowfin_debug > 4) {
1046 printk(KERN_DEBUG " In yellowfin_rx(), entry %d status %8.8x.\n",
1047 entry, yp->rx_ring[entry].result_status);
1048 printk(KERN_DEBUG " #%d desc. %8.8x %8.8x %8.8x.\n",
1049 entry, yp->rx_ring[entry].dbdma_cmd, yp->rx_ring[entry].addr,
1050 yp->rx_ring[entry].result_status);
1051 }
1052
1053
1054 while (1) {
1055 struct yellowfin_desc *desc = &yp->rx_ring[entry];
1056 struct sk_buff *rx_skb = yp->rx_skbuff[entry];
1057 s16 frame_status;
1058 u16 desc_status;
1059 int data_size;
1060 u8 *buf_addr;
1061
1062 if(!desc->result_status)
1063 break;
1064 pci_dma_sync_single_for_cpu(yp->pci_dev, le32_to_cpu(desc->addr),
1065 yp->rx_buf_sz, PCI_DMA_FROMDEVICE);
1066 desc_status = le32_to_cpu(desc->result_status) >> 16;
1067 buf_addr = rx_skb->data;
1068 data_size = (le32_to_cpu(desc->dbdma_cmd) -
1069 le32_to_cpu(desc->result_status)) & 0xffff;
1070 frame_status = get_unaligned_le16(&(buf_addr[data_size - 2]));
1071 if (yellowfin_debug > 4)
1072 printk(KERN_DEBUG " yellowfin_rx() status was %4.4x.\n",
1073 frame_status);
1074 if (--boguscnt < 0)
1075 break;
1076 if ( ! (desc_status & RX_EOP)) {
1077 if (data_size != 0)
1078 printk(KERN_WARNING "%s: Oversized Ethernet frame spanned multiple buffers,"
1079 " status %4.4x, data_size %d!\n", dev->name, desc_status, data_size);
1080 dev->stats.rx_length_errors++;
1081 } else if ((yp->drv_flags & IsGigabit) && (frame_status & 0x0038)) {
1082
1083 if (yellowfin_debug > 3)
1084 printk(KERN_DEBUG " yellowfin_rx() Rx error was %4.4x.\n",
1085 frame_status);
1086 dev->stats.rx_errors++;
1087 if (frame_status & 0x0060) dev->stats.rx_length_errors++;
1088 if (frame_status & 0x0008) dev->stats.rx_frame_errors++;
1089 if (frame_status & 0x0010) dev->stats.rx_crc_errors++;
1090 if (frame_status < 0) dev->stats.rx_dropped++;
1091 } else if ( !(yp->drv_flags & IsGigabit) &&
1092 ((buf_addr[data_size-1] & 0x85) || buf_addr[data_size-2] & 0xC0)) {
1093 u8 status1 = buf_addr[data_size-2];
1094 u8 status2 = buf_addr[data_size-1];
1095 dev->stats.rx_errors++;
1096 if (status1 & 0xC0) dev->stats.rx_length_errors++;
1097 if (status2 & 0x03) dev->stats.rx_frame_errors++;
1098 if (status2 & 0x04) dev->stats.rx_crc_errors++;
1099 if (status2 & 0x80) dev->stats.rx_dropped++;
1100#ifdef YF_PROTOTYPE
1101 } else if ((yp->flags & HasMACAddrBug) &&
1102 memcmp(le32_to_cpu(yp->rx_ring_dma +
1103 entry*sizeof(struct yellowfin_desc)),
1104 dev->dev_addr, 6) != 0 &&
1105 memcmp(le32_to_cpu(yp->rx_ring_dma +
1106 entry*sizeof(struct yellowfin_desc)),
1107 "\377\377\377\377\377\377", 6) != 0) {
1108 if (bogus_rx++ == 0)
1109 printk(KERN_WARNING "%s: Bad frame to %pM\n",
1110 dev->name, buf_addr);
1111#endif
1112 } else {
1113 struct sk_buff *skb;
1114 int pkt_len = data_size -
1115 (yp->chip_id ? 7 : 8 + buf_addr[data_size - 8]);
1116
1117
1118#ifndef final_version
1119 if (yellowfin_debug > 4)
1120 printk(KERN_DEBUG " yellowfin_rx() normal Rx pkt length %d"
1121 " of %d, bogus_cnt %d.\n",
1122 pkt_len, data_size, boguscnt);
1123#endif
1124
1125
1126 if (pkt_len > rx_copybreak) {
1127 skb_put(skb = rx_skb, pkt_len);
1128 pci_unmap_single(yp->pci_dev,
1129 le32_to_cpu(yp->rx_ring[entry].addr),
1130 yp->rx_buf_sz,
1131 PCI_DMA_FROMDEVICE);
1132 yp->rx_skbuff[entry] = NULL;
1133 } else {
1134 skb = dev_alloc_skb(pkt_len + 2);
1135 if (skb == NULL)
1136 break;
1137 skb_reserve(skb, 2);
1138 skb_copy_to_linear_data(skb, rx_skb->data, pkt_len);
1139 skb_put(skb, pkt_len);
1140 pci_dma_sync_single_for_device(yp->pci_dev,
1141 le32_to_cpu(desc->addr),
1142 yp->rx_buf_sz,
1143 PCI_DMA_FROMDEVICE);
1144 }
1145 skb->protocol = eth_type_trans(skb, dev);
1146 netif_rx(skb);
1147 dev->stats.rx_packets++;
1148 dev->stats.rx_bytes += pkt_len;
1149 }
1150 entry = (++yp->cur_rx) % RX_RING_SIZE;
1151 }
1152
1153
1154 for (; yp->cur_rx - yp->dirty_rx > 0; yp->dirty_rx++) {
1155 entry = yp->dirty_rx % RX_RING_SIZE;
1156 if (yp->rx_skbuff[entry] == NULL) {
1157 struct sk_buff *skb = dev_alloc_skb(yp->rx_buf_sz);
1158 if (skb == NULL)
1159 break;
1160 yp->rx_skbuff[entry] = skb;
1161 skb->dev = dev;
1162 skb_reserve(skb, 2);
1163 yp->rx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev,
1164 skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE));
1165 }
1166 yp->rx_ring[entry].dbdma_cmd = cpu_to_le32(CMD_STOP);
1167 yp->rx_ring[entry].result_status = 0;
1168 if (entry != 0)
1169 yp->rx_ring[entry - 1].dbdma_cmd =
1170 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz);
1171 else
1172 yp->rx_ring[RX_RING_SIZE - 1].dbdma_cmd =
1173 cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | BRANCH_ALWAYS
1174 | yp->rx_buf_sz);
1175 }
1176
1177 return 0;
1178}
1179
1180static void yellowfin_error(struct net_device *dev, int intr_status)
1181{
1182 printk(KERN_ERR "%s: Something Wicked happened! %4.4x.\n",
1183 dev->name, intr_status);
1184
1185 if (intr_status & (IntrTxPCIErr | IntrTxPCIFault))
1186 dev->stats.tx_errors++;
1187 if (intr_status & (IntrRxPCIErr | IntrRxPCIFault))
1188 dev->stats.rx_errors++;
1189}
1190
1191static int yellowfin_close(struct net_device *dev)
1192{
1193 struct yellowfin_private *yp = netdev_priv(dev);
1194 void __iomem *ioaddr = yp->base;
1195 int i;
1196
1197 netif_stop_queue (dev);
1198
1199 if (yellowfin_debug > 1) {
1200 printk(KERN_DEBUG "%s: Shutting down ethercard, status was Tx %4.4x "
1201 "Rx %4.4x Int %2.2x.\n",
1202 dev->name, ioread16(ioaddr + TxStatus),
1203 ioread16(ioaddr + RxStatus),
1204 ioread16(ioaddr + IntrStatus));
1205 printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d, Rx %d / %d.\n",
1206 dev->name, yp->cur_tx, yp->dirty_tx, yp->cur_rx, yp->dirty_rx);
1207 }
1208
1209
1210 iowrite16(0x0000, ioaddr + IntrEnb);
1211
1212
1213 iowrite32(0x80000000, ioaddr + RxCtrl);
1214 iowrite32(0x80000000, ioaddr + TxCtrl);
1215
1216 del_timer(&yp->timer);
1217
1218#if defined(__i386__)
1219 if (yellowfin_debug > 2) {
1220 printk("\n"KERN_DEBUG" Tx ring at %8.8llx:\n",
1221 (unsigned long long)yp->tx_ring_dma);
1222 for (i = 0; i < TX_RING_SIZE*2; i++)
1223 printk(" %c #%d desc. %8.8x %8.8x %8.8x %8.8x.\n",
1224 ioread32(ioaddr + TxPtr) == (long)&yp->tx_ring[i] ? '>' : ' ',
1225 i, yp->tx_ring[i].dbdma_cmd, yp->tx_ring[i].addr,
1226 yp->tx_ring[i].branch_addr, yp->tx_ring[i].result_status);
1227 printk(KERN_DEBUG " Tx status %p:\n", yp->tx_status);
1228 for (i = 0; i < TX_RING_SIZE; i++)
1229 printk(" #%d status %4.4x %4.4x %4.4x %4.4x.\n",
1230 i, yp->tx_status[i].tx_cnt, yp->tx_status[i].tx_errs,
1231 yp->tx_status[i].total_tx_cnt, yp->tx_status[i].paused);
1232
1233 printk("\n"KERN_DEBUG " Rx ring %8.8llx:\n",
1234 (unsigned long long)yp->rx_ring_dma);
1235 for (i = 0; i < RX_RING_SIZE; i++) {
1236 printk(KERN_DEBUG " %c #%d desc. %8.8x %8.8x %8.8x\n",
1237 ioread32(ioaddr + RxPtr) == (long)&yp->rx_ring[i] ? '>' : ' ',
1238 i, yp->rx_ring[i].dbdma_cmd, yp->rx_ring[i].addr,
1239 yp->rx_ring[i].result_status);
1240 if (yellowfin_debug > 6) {
1241 if (get_unaligned((u8*)yp->rx_ring[i].addr) != 0x69) {
1242 int j;
1243 for (j = 0; j < 0x50; j++)
1244 printk(" %4.4x",
1245 get_unaligned(((u16*)yp->rx_ring[i].addr) + j));
1246 printk("\n");
1247 }
1248 }
1249 }
1250 }
1251#endif
1252
1253 free_irq(dev->irq, dev);
1254
1255
1256 for (i = 0; i < RX_RING_SIZE; i++) {
1257 yp->rx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP);
1258 yp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0);
1259 if (yp->rx_skbuff[i]) {
1260 dev_kfree_skb(yp->rx_skbuff[i]);
1261 }
1262 yp->rx_skbuff[i] = NULL;
1263 }
1264 for (i = 0; i < TX_RING_SIZE; i++) {
1265 if (yp->tx_skbuff[i])
1266 dev_kfree_skb(yp->tx_skbuff[i]);
1267 yp->tx_skbuff[i] = NULL;
1268 }
1269
1270#ifdef YF_PROTOTYPE
1271 if (yellowfin_debug > 0) {
1272 printk(KERN_DEBUG "%s: Received %d frames that we should not have.\n",
1273 dev->name, bogus_rx);
1274 }
1275#endif
1276
1277 return 0;
1278}
1279
1280
1281
1282static void set_rx_mode(struct net_device *dev)
1283{
1284 struct yellowfin_private *yp = netdev_priv(dev);
1285 void __iomem *ioaddr = yp->base;
1286 u16 cfg_value = ioread16(ioaddr + Cnfg);
1287
1288
1289 iowrite16(cfg_value & ~0x1000, ioaddr + Cnfg);
1290 if (dev->flags & IFF_PROMISC) {
1291 iowrite16(0x000F, ioaddr + AddrMode);
1292 } else if ((dev->mc_count > 64) || (dev->flags & IFF_ALLMULTI)) {
1293
1294 iowrite16(0x000B, ioaddr + AddrMode);
1295 } else if (dev->mc_count > 0) {
1296 struct dev_mc_list *mclist;
1297 u16 hash_table[4];
1298 int i;
1299 memset(hash_table, 0, sizeof(hash_table));
1300 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1301 i++, mclist = mclist->next) {
1302 unsigned int bit;
1303
1304
1305
1306 if (yp->drv_flags & HasMulticastBug) {
1307 bit = (ether_crc_le(3, mclist->dmi_addr) >> 3) & 0x3f;
1308 hash_table[bit >> 4] |= (1 << bit);
1309 bit = (ether_crc_le(4, mclist->dmi_addr) >> 3) & 0x3f;
1310 hash_table[bit >> 4] |= (1 << bit);
1311 bit = (ether_crc_le(5, mclist->dmi_addr) >> 3) & 0x3f;
1312 hash_table[bit >> 4] |= (1 << bit);
1313 }
1314 bit = (ether_crc_le(6, mclist->dmi_addr) >> 3) & 0x3f;
1315 hash_table[bit >> 4] |= (1 << bit);
1316 }
1317
1318 for (i = 0; i < 4; i++)
1319 iowrite16(hash_table[i], ioaddr + HashTbl + i*2);
1320 iowrite16(0x0003, ioaddr + AddrMode);
1321 } else {
1322 iowrite16(0x0001, ioaddr + AddrMode);
1323 }
1324
1325 iowrite16(cfg_value | 0x1000, ioaddr + Cnfg);
1326}
1327
1328static void yellowfin_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1329{
1330 struct yellowfin_private *np = netdev_priv(dev);
1331 strcpy(info->driver, DRV_NAME);
1332 strcpy(info->version, DRV_VERSION);
1333 strcpy(info->bus_info, pci_name(np->pci_dev));
1334}
1335
1336static const struct ethtool_ops ethtool_ops = {
1337 .get_drvinfo = yellowfin_get_drvinfo
1338};
1339
1340static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1341{
1342 struct yellowfin_private *np = netdev_priv(dev);
1343 void __iomem *ioaddr = np->base;
1344 struct mii_ioctl_data *data = if_mii(rq);
1345
1346 switch(cmd) {
1347 case SIOCGMIIPHY:
1348 data->phy_id = np->phys[0] & 0x1f;
1349
1350
1351 case SIOCGMIIREG:
1352 data->val_out = mdio_read(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f);
1353 return 0;
1354
1355 case SIOCSMIIREG:
1356 if (!capable(CAP_NET_ADMIN))
1357 return -EPERM;
1358 if (data->phy_id == np->phys[0]) {
1359 u16 value = data->val_in;
1360 switch (data->reg_num) {
1361 case 0:
1362
1363 np->medialock = (value & 0x9000) ? 0 : 1;
1364 if (np->medialock)
1365 np->full_duplex = (value & 0x0100) ? 1 : 0;
1366 break;
1367 case 4: np->advertising = value; break;
1368 }
1369
1370 }
1371 mdio_write(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1372 return 0;
1373 default:
1374 return -EOPNOTSUPP;
1375 }
1376}
1377
1378
1379static void __devexit yellowfin_remove_one (struct pci_dev *pdev)
1380{
1381 struct net_device *dev = pci_get_drvdata(pdev);
1382 struct yellowfin_private *np;
1383
1384 BUG_ON(!dev);
1385 np = netdev_priv(dev);
1386
1387 pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status,
1388 np->tx_status_dma);
1389 pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
1390 pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
1391 unregister_netdev (dev);
1392
1393 pci_iounmap(pdev, np->base);
1394
1395 pci_release_regions (pdev);
1396
1397 free_netdev (dev);
1398 pci_set_drvdata(pdev, NULL);
1399}
1400
1401
1402static struct pci_driver yellowfin_driver = {
1403 .name = DRV_NAME,
1404 .id_table = yellowfin_pci_tbl,
1405 .probe = yellowfin_init_one,
1406 .remove = __devexit_p(yellowfin_remove_one),
1407};
1408
1409
1410static int __init yellowfin_init (void)
1411{
1412
1413#ifdef MODULE
1414 printk(version);
1415#endif
1416 return pci_register_driver(&yellowfin_driver);
1417}
1418
1419
1420static void __exit yellowfin_cleanup (void)
1421{
1422 pci_unregister_driver (&yellowfin_driver);
1423}
1424
1425
1426module_init(yellowfin_init);
1427module_exit(yellowfin_cleanup);
1428