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
27
28
29
30
31
32#define DRV_NAME "via-rhine"
33#define DRV_VERSION "1.4.3"
34#define DRV_RELDATE "2007-03-06"
35
36
37
38
39
40static int debug = 1;
41static int max_interrupt_work = 20;
42
43
44
45#if defined(__alpha__) || defined(__arm__) || defined(__hppa__) \
46 || defined(CONFIG_SPARC) || defined(__ia64__) \
47 || defined(__sh__) || defined(__mips__)
48static int rx_copybreak = 1518;
49#else
50static int rx_copybreak;
51#endif
52
53
54
55static int avoid_D3;
56
57
58
59
60
61
62
63
64static const int multicast_filter_limit = 32;
65
66
67
68
69
70
71
72
73
74#define TX_RING_SIZE 16
75#define TX_QUEUE_LEN 10
76#define RX_RING_SIZE 64
77
78
79
80
81#define TX_TIMEOUT (2*HZ)
82
83#define PKT_BUF_SZ 1536
84
85#include <linux/module.h>
86#include <linux/moduleparam.h>
87#include <linux/kernel.h>
88#include <linux/string.h>
89#include <linux/timer.h>
90#include <linux/errno.h>
91#include <linux/ioport.h>
92#include <linux/slab.h>
93#include <linux/interrupt.h>
94#include <linux/pci.h>
95#include <linux/dma-mapping.h>
96#include <linux/netdevice.h>
97#include <linux/etherdevice.h>
98#include <linux/skbuff.h>
99#include <linux/init.h>
100#include <linux/delay.h>
101#include <linux/mii.h>
102#include <linux/ethtool.h>
103#include <linux/crc32.h>
104#include <linux/bitops.h>
105#include <asm/processor.h>
106#include <asm/io.h>
107#include <asm/irq.h>
108#include <asm/uaccess.h>
109#include <linux/dmi.h>
110
111
112static char version[] __devinitdata =
113KERN_INFO DRV_NAME ".c:v1.10-LK" DRV_VERSION " " DRV_RELDATE " Written by Donald Becker\n";
114
115
116
117#ifdef CONFIG_VIA_RHINE_MMIO
118#define USE_MMIO
119#else
120#endif
121
122MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
123MODULE_DESCRIPTION("VIA Rhine PCI Fast Ethernet driver");
124MODULE_LICENSE("GPL");
125
126module_param(max_interrupt_work, int, 0);
127module_param(debug, int, 0);
128module_param(rx_copybreak, int, 0);
129module_param(avoid_D3, bool, 0);
130MODULE_PARM_DESC(max_interrupt_work, "VIA Rhine maximum events handled per interrupt");
131MODULE_PARM_DESC(debug, "VIA Rhine debug level (0-7)");
132MODULE_PARM_DESC(rx_copybreak, "VIA Rhine copy breakpoint for copy-only-tiny-frames");
133MODULE_PARM_DESC(avoid_D3, "Avoid power state D3 (work-around for broken BIOSes)");
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
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234enum rhine_revs {
235 VT86C100A = 0x00,
236 VTunknown0 = 0x20,
237 VT6102 = 0x40,
238 VT8231 = 0x50,
239 VT8233 = 0x60,
240 VT8235 = 0x74,
241 VT8237 = 0x78,
242 VTunknown1 = 0x7C,
243 VT6105 = 0x80,
244 VT6105_B0 = 0x83,
245 VT6105L = 0x8A,
246 VT6107 = 0x8C,
247 VTunknown2 = 0x8E,
248 VT6105M = 0x90,
249};
250
251enum rhine_quirks {
252 rqWOL = 0x0001,
253 rqForceReset = 0x0002,
254 rq6patterns = 0x0040,
255 rqStatusWBRace = 0x0080,
256 rqRhineI = 0x0100,
257};
258
259
260
261
262
263
264
265#define IOSYNC do { ioread8(ioaddr + StationAddr); } while (0)
266
267static const struct pci_device_id rhine_pci_tbl[] = {
268 { 0x1106, 0x3043, PCI_ANY_ID, PCI_ANY_ID, },
269 { 0x1106, 0x3065, PCI_ANY_ID, PCI_ANY_ID, },
270 { 0x1106, 0x3106, PCI_ANY_ID, PCI_ANY_ID, },
271 { 0x1106, 0x3053, PCI_ANY_ID, PCI_ANY_ID, },
272 { }
273};
274MODULE_DEVICE_TABLE(pci, rhine_pci_tbl);
275
276
277
278enum register_offsets {
279 StationAddr=0x00, RxConfig=0x06, TxConfig=0x07, ChipCmd=0x08,
280 ChipCmd1=0x09,
281 IntrStatus=0x0C, IntrEnable=0x0E,
282 MulticastFilter0=0x10, MulticastFilter1=0x14,
283 RxRingPtr=0x18, TxRingPtr=0x1C, GFIFOTest=0x54,
284 MIIPhyAddr=0x6C, MIIStatus=0x6D, PCIBusConfig=0x6E,
285 MIICmd=0x70, MIIRegAddr=0x71, MIIData=0x72, MACRegEEcsr=0x74,
286 ConfigA=0x78, ConfigB=0x79, ConfigC=0x7A, ConfigD=0x7B,
287 RxMissed=0x7C, RxCRCErrs=0x7E, MiscCmd=0x81,
288 StickyHW=0x83, IntrStatus2=0x84,
289 WOLcrSet=0xA0, PwcfgSet=0xA1, WOLcgSet=0xA3, WOLcrClr=0xA4,
290 WOLcrClr1=0xA6, WOLcgClr=0xA7,
291 PwrcsrSet=0xA8, PwrcsrSet1=0xA9, PwrcsrClr=0xAC, PwrcsrClr1=0xAD,
292};
293
294
295enum backoff_bits {
296 BackOptional=0x01, BackModify=0x02,
297 BackCaptureEffect=0x04, BackRandom=0x08
298};
299
300#ifdef USE_MMIO
301
302static const int mmio_verify_registers[] = {
303 RxConfig, TxConfig, IntrEnable, ConfigA, ConfigB, ConfigC, ConfigD,
304 0
305};
306#endif
307
308
309enum intr_status_bits {
310 IntrRxDone=0x0001, IntrRxErr=0x0004, IntrRxEmpty=0x0020,
311 IntrTxDone=0x0002, IntrTxError=0x0008, IntrTxUnderrun=0x0210,
312 IntrPCIErr=0x0040,
313 IntrStatsMax=0x0080, IntrRxEarly=0x0100,
314 IntrRxOverflow=0x0400, IntrRxDropped=0x0800, IntrRxNoBuf=0x1000,
315 IntrTxAborted=0x2000, IntrLinkChange=0x4000,
316 IntrRxWakeUp=0x8000,
317 IntrNormalSummary=0x0003, IntrAbnormalSummary=0xC260,
318 IntrTxDescRace=0x080000,
319 IntrTxErrSummary=0x082218,
320};
321
322
323enum wol_bits {
324 WOLucast = 0x10,
325 WOLmagic = 0x20,
326 WOLbmcast = 0x30,
327 WOLlnkon = 0x40,
328 WOLlnkoff = 0x80,
329};
330
331
332struct rx_desc {
333 __le32 rx_status;
334 __le32 desc_length;
335 __le32 addr;
336 __le32 next_desc;
337};
338struct tx_desc {
339 __le32 tx_status;
340 __le32 desc_length;
341 __le32 addr;
342 __le32 next_desc;
343};
344
345
346#define TXDESC 0x00e08000
347
348enum rx_status_bits {
349 RxOK=0x8000, RxWholePkt=0x0300, RxErr=0x008F
350};
351
352
353enum desc_status_bits {
354 DescOwn=0x80000000
355};
356
357
358enum chip_cmd_bits {
359 CmdInit=0x01, CmdStart=0x02, CmdStop=0x04, CmdRxOn=0x08,
360 CmdTxOn=0x10, Cmd1TxDemand=0x20, CmdRxDemand=0x40,
361 Cmd1EarlyRx=0x01, Cmd1EarlyTx=0x02, Cmd1FDuplex=0x04,
362 Cmd1NoTxPoll=0x08, Cmd1Reset=0x80,
363};
364
365struct rhine_private {
366
367 struct rx_desc *rx_ring;
368 struct tx_desc *tx_ring;
369 dma_addr_t rx_ring_dma;
370 dma_addr_t tx_ring_dma;
371
372
373 struct sk_buff *rx_skbuff[RX_RING_SIZE];
374 dma_addr_t rx_skbuff_dma[RX_RING_SIZE];
375
376
377 struct sk_buff *tx_skbuff[TX_RING_SIZE];
378 dma_addr_t tx_skbuff_dma[TX_RING_SIZE];
379
380
381 unsigned char *tx_buf[TX_RING_SIZE];
382 unsigned char *tx_bufs;
383 dma_addr_t tx_bufs_dma;
384
385 struct pci_dev *pdev;
386 long pioaddr;
387 struct net_device *dev;
388 struct napi_struct napi;
389 struct net_device_stats stats;
390 spinlock_t lock;
391
392
393 u32 quirks;
394 struct rx_desc *rx_head_desc;
395 unsigned int cur_rx, dirty_rx;
396 unsigned int cur_tx, dirty_tx;
397 unsigned int rx_buf_sz;
398 u8 wolopts;
399
400 u8 tx_thresh, rx_thresh;
401
402 struct mii_if_info mii_if;
403 void __iomem *base;
404};
405
406static int mdio_read(struct net_device *dev, int phy_id, int location);
407static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
408static int rhine_open(struct net_device *dev);
409static void rhine_tx_timeout(struct net_device *dev);
410static int rhine_start_tx(struct sk_buff *skb, struct net_device *dev);
411static irqreturn_t rhine_interrupt(int irq, void *dev_instance);
412static void rhine_tx(struct net_device *dev);
413static int rhine_rx(struct net_device *dev, int limit);
414static void rhine_error(struct net_device *dev, int intr_status);
415static void rhine_set_rx_mode(struct net_device *dev);
416static struct net_device_stats *rhine_get_stats(struct net_device *dev);
417static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
418static const struct ethtool_ops netdev_ethtool_ops;
419static int rhine_close(struct net_device *dev);
420static void rhine_shutdown (struct pci_dev *pdev);
421
422#define RHINE_WAIT_FOR(condition) do { \
423 int i=1024; \
424 while (!(condition) && --i) \
425 ; \
426 if (debug > 1 && i < 512) \
427 printk(KERN_INFO "%s: %4d cycles used @ %s:%d\n", \
428 DRV_NAME, 1024-i, __func__, __LINE__); \
429} while(0)
430
431static inline u32 get_intr_status(struct net_device *dev)
432{
433 struct rhine_private *rp = netdev_priv(dev);
434 void __iomem *ioaddr = rp->base;
435 u32 intr_status;
436
437 intr_status = ioread16(ioaddr + IntrStatus);
438
439 if (rp->quirks & rqStatusWBRace)
440 intr_status |= ioread8(ioaddr + IntrStatus2) << 16;
441 return intr_status;
442}
443
444
445
446
447
448static void rhine_power_init(struct net_device *dev)
449{
450 struct rhine_private *rp = netdev_priv(dev);
451 void __iomem *ioaddr = rp->base;
452 u16 wolstat;
453
454 if (rp->quirks & rqWOL) {
455
456 iowrite8(ioread8(ioaddr + StickyHW) & 0xFC, ioaddr + StickyHW);
457
458
459 iowrite8(0x80, ioaddr + WOLcgClr);
460
461
462 iowrite8(0xFF, ioaddr + WOLcrClr);
463
464 if (rp->quirks & rq6patterns)
465 iowrite8(0x03, ioaddr + WOLcrClr1);
466
467
468 wolstat = ioread8(ioaddr + PwrcsrSet);
469 if (rp->quirks & rq6patterns)
470 wolstat |= (ioread8(ioaddr + PwrcsrSet1) & 0x03) << 8;
471
472
473 iowrite8(0xFF, ioaddr + PwrcsrClr);
474 if (rp->quirks & rq6patterns)
475 iowrite8(0x03, ioaddr + PwrcsrClr1);
476
477 if (wolstat) {
478 char *reason;
479 switch (wolstat) {
480 case WOLmagic:
481 reason = "Magic packet";
482 break;
483 case WOLlnkon:
484 reason = "Link went up";
485 break;
486 case WOLlnkoff:
487 reason = "Link went down";
488 break;
489 case WOLucast:
490 reason = "Unicast packet";
491 break;
492 case WOLbmcast:
493 reason = "Multicast/broadcast packet";
494 break;
495 default:
496 reason = "Unknown";
497 }
498 printk(KERN_INFO "%s: Woke system up. Reason: %s.\n",
499 DRV_NAME, reason);
500 }
501 }
502}
503
504static void rhine_chip_reset(struct net_device *dev)
505{
506 struct rhine_private *rp = netdev_priv(dev);
507 void __iomem *ioaddr = rp->base;
508
509 iowrite8(Cmd1Reset, ioaddr + ChipCmd1);
510 IOSYNC;
511
512 if (ioread8(ioaddr + ChipCmd1) & Cmd1Reset) {
513 printk(KERN_INFO "%s: Reset not complete yet. "
514 "Trying harder.\n", DRV_NAME);
515
516
517 if (rp->quirks & rqForceReset)
518 iowrite8(0x40, ioaddr + MiscCmd);
519
520
521 RHINE_WAIT_FOR(!(ioread8(ioaddr + ChipCmd1) & Cmd1Reset));
522 }
523
524 if (debug > 1)
525 printk(KERN_INFO "%s: Reset %s.\n", dev->name,
526 (ioread8(ioaddr + ChipCmd1) & Cmd1Reset) ?
527 "failed" : "succeeded");
528}
529
530#ifdef USE_MMIO
531static void enable_mmio(long pioaddr, u32 quirks)
532{
533 int n;
534 if (quirks & rqRhineI) {
535
536 n = inb(pioaddr + ConfigA) | 0x20;
537 outb(n, pioaddr + ConfigA);
538 } else {
539 n = inb(pioaddr + ConfigD) | 0x80;
540 outb(n, pioaddr + ConfigD);
541 }
542}
543#endif
544
545
546
547
548
549static void __devinit rhine_reload_eeprom(long pioaddr, struct net_device *dev)
550{
551 struct rhine_private *rp = netdev_priv(dev);
552 void __iomem *ioaddr = rp->base;
553
554 outb(0x20, pioaddr + MACRegEEcsr);
555 RHINE_WAIT_FOR(!(inb(pioaddr + MACRegEEcsr) & 0x20));
556
557#ifdef USE_MMIO
558
559
560
561
562
563 enable_mmio(pioaddr, rp->quirks);
564#endif
565
566
567 if (rp->quirks & rqWOL)
568 iowrite8(ioread8(ioaddr + ConfigA) & 0xFC, ioaddr + ConfigA);
569
570}
571
572#ifdef CONFIG_NET_POLL_CONTROLLER
573static void rhine_poll(struct net_device *dev)
574{
575 disable_irq(dev->irq);
576 rhine_interrupt(dev->irq, (void *)dev);
577 enable_irq(dev->irq);
578}
579#endif
580
581static int rhine_napipoll(struct napi_struct *napi, int budget)
582{
583 struct rhine_private *rp = container_of(napi, struct rhine_private, napi);
584 struct net_device *dev = rp->dev;
585 void __iomem *ioaddr = rp->base;
586 int work_done;
587
588 work_done = rhine_rx(dev, budget);
589
590 if (work_done < budget) {
591 netif_rx_complete(dev, napi);
592
593 iowrite16(IntrRxDone | IntrRxErr | IntrRxEmpty| IntrRxOverflow |
594 IntrRxDropped | IntrRxNoBuf | IntrTxAborted |
595 IntrTxDone | IntrTxError | IntrTxUnderrun |
596 IntrPCIErr | IntrStatsMax | IntrLinkChange,
597 ioaddr + IntrEnable);
598 }
599 return work_done;
600}
601
602static void __devinit rhine_hw_init(struct net_device *dev, long pioaddr)
603{
604 struct rhine_private *rp = netdev_priv(dev);
605
606
607 rhine_chip_reset(dev);
608
609
610 if (rp->quirks & rqRhineI)
611 msleep(5);
612
613
614 rhine_reload_eeprom(pioaddr, dev);
615}
616
617static int __devinit rhine_init_one(struct pci_dev *pdev,
618 const struct pci_device_id *ent)
619{
620 struct net_device *dev;
621 struct rhine_private *rp;
622 int i, rc;
623 u32 quirks;
624 long pioaddr;
625 long memaddr;
626 void __iomem *ioaddr;
627 int io_size, phy_id;
628 const char *name;
629#ifdef USE_MMIO
630 int bar = 1;
631#else
632 int bar = 0;
633#endif
634 DECLARE_MAC_BUF(mac);
635
636
637#ifndef MODULE
638 static int printed_version;
639 if (!printed_version++)
640 printk(version);
641#endif
642
643 io_size = 256;
644 phy_id = 0;
645 quirks = 0;
646 name = "Rhine";
647 if (pdev->revision < VTunknown0) {
648 quirks = rqRhineI;
649 io_size = 128;
650 }
651 else if (pdev->revision >= VT6102) {
652 quirks = rqWOL | rqForceReset;
653 if (pdev->revision < VT6105) {
654 name = "Rhine II";
655 quirks |= rqStatusWBRace;
656 }
657 else {
658 phy_id = 1;
659 if (pdev->revision >= VT6105_B0)
660 quirks |= rq6patterns;
661 if (pdev->revision < VT6105M)
662 name = "Rhine III";
663 else
664 name = "Rhine III (Management Adapter)";
665 }
666 }
667
668 rc = pci_enable_device(pdev);
669 if (rc)
670 goto err_out;
671
672
673 rc = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
674 if (rc) {
675 printk(KERN_ERR "32-bit PCI DMA addresses not supported by "
676 "the card!?\n");
677 goto err_out;
678 }
679
680
681 if ((pci_resource_len(pdev, 0) < io_size) ||
682 (pci_resource_len(pdev, 1) < io_size)) {
683 rc = -EIO;
684 printk(KERN_ERR "Insufficient PCI resources, aborting\n");
685 goto err_out;
686 }
687
688 pioaddr = pci_resource_start(pdev, 0);
689 memaddr = pci_resource_start(pdev, 1);
690
691 pci_set_master(pdev);
692
693 dev = alloc_etherdev(sizeof(struct rhine_private));
694 if (!dev) {
695 rc = -ENOMEM;
696 printk(KERN_ERR "alloc_etherdev failed\n");
697 goto err_out;
698 }
699 SET_NETDEV_DEV(dev, &pdev->dev);
700
701 rp = netdev_priv(dev);
702 rp->dev = dev;
703 rp->quirks = quirks;
704 rp->pioaddr = pioaddr;
705 rp->pdev = pdev;
706
707 rc = pci_request_regions(pdev, DRV_NAME);
708 if (rc)
709 goto err_out_free_netdev;
710
711 ioaddr = pci_iomap(pdev, bar, io_size);
712 if (!ioaddr) {
713 rc = -EIO;
714 printk(KERN_ERR "ioremap failed for device %s, region 0x%X "
715 "@ 0x%lX\n", pci_name(pdev), io_size, memaddr);
716 goto err_out_free_res;
717 }
718
719#ifdef USE_MMIO
720 enable_mmio(pioaddr, quirks);
721
722
723 i = 0;
724 while (mmio_verify_registers[i]) {
725 int reg = mmio_verify_registers[i++];
726 unsigned char a = inb(pioaddr+reg);
727 unsigned char b = readb(ioaddr+reg);
728 if (a != b) {
729 rc = -EIO;
730 printk(KERN_ERR "MMIO do not match PIO [%02x] "
731 "(%02x != %02x)\n", reg, a, b);
732 goto err_out_unmap;
733 }
734 }
735#endif
736
737 dev->base_addr = (unsigned long)ioaddr;
738 rp->base = ioaddr;
739
740
741 rhine_power_init(dev);
742 rhine_hw_init(dev, pioaddr);
743
744 for (i = 0; i < 6; i++)
745 dev->dev_addr[i] = ioread8(ioaddr + StationAddr + i);
746 memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
747
748 if (!is_valid_ether_addr(dev->perm_addr)) {
749 rc = -EIO;
750 printk(KERN_ERR "Invalid MAC address\n");
751 goto err_out_unmap;
752 }
753
754
755 if (!phy_id)
756 phy_id = ioread8(ioaddr + 0x6C);
757
758 dev->irq = pdev->irq;
759
760 spin_lock_init(&rp->lock);
761 rp->mii_if.dev = dev;
762 rp->mii_if.mdio_read = mdio_read;
763 rp->mii_if.mdio_write = mdio_write;
764 rp->mii_if.phy_id_mask = 0x1f;
765 rp->mii_if.reg_num_mask = 0x1f;
766
767
768 dev->open = rhine_open;
769 dev->hard_start_xmit = rhine_start_tx;
770 dev->stop = rhine_close;
771 dev->get_stats = rhine_get_stats;
772 dev->set_multicast_list = rhine_set_rx_mode;
773 dev->do_ioctl = netdev_ioctl;
774 dev->ethtool_ops = &netdev_ethtool_ops;
775 dev->tx_timeout = rhine_tx_timeout;
776 dev->watchdog_timeo = TX_TIMEOUT;
777#ifdef CONFIG_NET_POLL_CONTROLLER
778 dev->poll_controller = rhine_poll;
779#endif
780 netif_napi_add(dev, &rp->napi, rhine_napipoll, 64);
781
782 if (rp->quirks & rqRhineI)
783 dev->features |= NETIF_F_SG|NETIF_F_HW_CSUM;
784
785
786 rc = register_netdev(dev);
787 if (rc)
788 goto err_out_unmap;
789
790 printk(KERN_INFO "%s: VIA %s at 0x%lx, %s, IRQ %d.\n",
791 dev->name, name,
792#ifdef USE_MMIO
793 memaddr,
794#else
795 (long)ioaddr,
796#endif
797 print_mac(mac, dev->dev_addr), pdev->irq);
798
799 pci_set_drvdata(pdev, dev);
800
801 {
802 u16 mii_cmd;
803 int mii_status = mdio_read(dev, phy_id, 1);
804 mii_cmd = mdio_read(dev, phy_id, MII_BMCR) & ~BMCR_ISOLATE;
805 mdio_write(dev, phy_id, MII_BMCR, mii_cmd);
806 if (mii_status != 0xffff && mii_status != 0x0000) {
807 rp->mii_if.advertising = mdio_read(dev, phy_id, 4);
808 printk(KERN_INFO "%s: MII PHY found at address "
809 "%d, status 0x%4.4x advertising %4.4x "
810 "Link %4.4x.\n", dev->name, phy_id,
811 mii_status, rp->mii_if.advertising,
812 mdio_read(dev, phy_id, 5));
813
814
815 if (mii_status & BMSR_LSTATUS)
816 netif_carrier_on(dev);
817 else
818 netif_carrier_off(dev);
819
820 }
821 }
822 rp->mii_if.phy_id = phy_id;
823 if (debug > 1 && avoid_D3)
824 printk(KERN_INFO "%s: No D3 power state at shutdown.\n",
825 dev->name);
826
827 return 0;
828
829err_out_unmap:
830 pci_iounmap(pdev, ioaddr);
831err_out_free_res:
832 pci_release_regions(pdev);
833err_out_free_netdev:
834 free_netdev(dev);
835err_out:
836 return rc;
837}
838
839static int alloc_ring(struct net_device* dev)
840{
841 struct rhine_private *rp = netdev_priv(dev);
842 void *ring;
843 dma_addr_t ring_dma;
844
845 ring = pci_alloc_consistent(rp->pdev,
846 RX_RING_SIZE * sizeof(struct rx_desc) +
847 TX_RING_SIZE * sizeof(struct tx_desc),
848 &ring_dma);
849 if (!ring) {
850 printk(KERN_ERR "Could not allocate DMA memory.\n");
851 return -ENOMEM;
852 }
853 if (rp->quirks & rqRhineI) {
854 rp->tx_bufs = pci_alloc_consistent(rp->pdev,
855 PKT_BUF_SZ * TX_RING_SIZE,
856 &rp->tx_bufs_dma);
857 if (rp->tx_bufs == NULL) {
858 pci_free_consistent(rp->pdev,
859 RX_RING_SIZE * sizeof(struct rx_desc) +
860 TX_RING_SIZE * sizeof(struct tx_desc),
861 ring, ring_dma);
862 return -ENOMEM;
863 }
864 }
865
866 rp->rx_ring = ring;
867 rp->tx_ring = ring + RX_RING_SIZE * sizeof(struct rx_desc);
868 rp->rx_ring_dma = ring_dma;
869 rp->tx_ring_dma = ring_dma + RX_RING_SIZE * sizeof(struct rx_desc);
870
871 return 0;
872}
873
874static void free_ring(struct net_device* dev)
875{
876 struct rhine_private *rp = netdev_priv(dev);
877
878 pci_free_consistent(rp->pdev,
879 RX_RING_SIZE * sizeof(struct rx_desc) +
880 TX_RING_SIZE * sizeof(struct tx_desc),
881 rp->rx_ring, rp->rx_ring_dma);
882 rp->tx_ring = NULL;
883
884 if (rp->tx_bufs)
885 pci_free_consistent(rp->pdev, PKT_BUF_SZ * TX_RING_SIZE,
886 rp->tx_bufs, rp->tx_bufs_dma);
887
888 rp->tx_bufs = NULL;
889
890}
891
892static void alloc_rbufs(struct net_device *dev)
893{
894 struct rhine_private *rp = netdev_priv(dev);
895 dma_addr_t next;
896 int i;
897
898 rp->dirty_rx = rp->cur_rx = 0;
899
900 rp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
901 rp->rx_head_desc = &rp->rx_ring[0];
902 next = rp->rx_ring_dma;
903
904
905 for (i = 0; i < RX_RING_SIZE; i++) {
906 rp->rx_ring[i].rx_status = 0;
907 rp->rx_ring[i].desc_length = cpu_to_le32(rp->rx_buf_sz);
908 next += sizeof(struct rx_desc);
909 rp->rx_ring[i].next_desc = cpu_to_le32(next);
910 rp->rx_skbuff[i] = NULL;
911 }
912
913 rp->rx_ring[i-1].next_desc = cpu_to_le32(rp->rx_ring_dma);
914
915
916 for (i = 0; i < RX_RING_SIZE; i++) {
917 struct sk_buff *skb = netdev_alloc_skb(dev, rp->rx_buf_sz);
918 rp->rx_skbuff[i] = skb;
919 if (skb == NULL)
920 break;
921 skb->dev = dev;
922
923 rp->rx_skbuff_dma[i] =
924 pci_map_single(rp->pdev, skb->data, rp->rx_buf_sz,
925 PCI_DMA_FROMDEVICE);
926
927 rp->rx_ring[i].addr = cpu_to_le32(rp->rx_skbuff_dma[i]);
928 rp->rx_ring[i].rx_status = cpu_to_le32(DescOwn);
929 }
930 rp->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
931}
932
933static void free_rbufs(struct net_device* dev)
934{
935 struct rhine_private *rp = netdev_priv(dev);
936 int i;
937
938
939 for (i = 0; i < RX_RING_SIZE; i++) {
940 rp->rx_ring[i].rx_status = 0;
941 rp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0);
942 if (rp->rx_skbuff[i]) {
943 pci_unmap_single(rp->pdev,
944 rp->rx_skbuff_dma[i],
945 rp->rx_buf_sz, PCI_DMA_FROMDEVICE);
946 dev_kfree_skb(rp->rx_skbuff[i]);
947 }
948 rp->rx_skbuff[i] = NULL;
949 }
950}
951
952static void alloc_tbufs(struct net_device* dev)
953{
954 struct rhine_private *rp = netdev_priv(dev);
955 dma_addr_t next;
956 int i;
957
958 rp->dirty_tx = rp->cur_tx = 0;
959 next = rp->tx_ring_dma;
960 for (i = 0; i < TX_RING_SIZE; i++) {
961 rp->tx_skbuff[i] = NULL;
962 rp->tx_ring[i].tx_status = 0;
963 rp->tx_ring[i].desc_length = cpu_to_le32(TXDESC);
964 next += sizeof(struct tx_desc);
965 rp->tx_ring[i].next_desc = cpu_to_le32(next);
966 if (rp->quirks & rqRhineI)
967 rp->tx_buf[i] = &rp->tx_bufs[i * PKT_BUF_SZ];
968 }
969 rp->tx_ring[i-1].next_desc = cpu_to_le32(rp->tx_ring_dma);
970
971}
972
973static void free_tbufs(struct net_device* dev)
974{
975 struct rhine_private *rp = netdev_priv(dev);
976 int i;
977
978 for (i = 0; i < TX_RING_SIZE; i++) {
979 rp->tx_ring[i].tx_status = 0;
980 rp->tx_ring[i].desc_length = cpu_to_le32(TXDESC);
981 rp->tx_ring[i].addr = cpu_to_le32(0xBADF00D0);
982 if (rp->tx_skbuff[i]) {
983 if (rp->tx_skbuff_dma[i]) {
984 pci_unmap_single(rp->pdev,
985 rp->tx_skbuff_dma[i],
986 rp->tx_skbuff[i]->len,
987 PCI_DMA_TODEVICE);
988 }
989 dev_kfree_skb(rp->tx_skbuff[i]);
990 }
991 rp->tx_skbuff[i] = NULL;
992 rp->tx_buf[i] = NULL;
993 }
994}
995
996static void rhine_check_media(struct net_device *dev, unsigned int init_media)
997{
998 struct rhine_private *rp = netdev_priv(dev);
999 void __iomem *ioaddr = rp->base;
1000
1001 mii_check_media(&rp->mii_if, debug, init_media);
1002
1003 if (rp->mii_if.full_duplex)
1004 iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1FDuplex,
1005 ioaddr + ChipCmd1);
1006 else
1007 iowrite8(ioread8(ioaddr + ChipCmd1) & ~Cmd1FDuplex,
1008 ioaddr + ChipCmd1);
1009 if (debug > 1)
1010 printk(KERN_INFO "%s: force_media %d, carrier %d\n", dev->name,
1011 rp->mii_if.force_media, netif_carrier_ok(dev));
1012}
1013
1014
1015static void rhine_set_carrier(struct mii_if_info *mii)
1016{
1017 if (mii->force_media) {
1018
1019 if (!netif_carrier_ok(mii->dev))
1020 netif_carrier_on(mii->dev);
1021 }
1022 else
1023 rhine_check_media(mii->dev, 0);
1024 if (debug > 1)
1025 printk(KERN_INFO "%s: force_media %d, carrier %d\n",
1026 mii->dev->name, mii->force_media,
1027 netif_carrier_ok(mii->dev));
1028}
1029
1030static void init_registers(struct net_device *dev)
1031{
1032 struct rhine_private *rp = netdev_priv(dev);
1033 void __iomem *ioaddr = rp->base;
1034 int i;
1035
1036 for (i = 0; i < 6; i++)
1037 iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i);
1038
1039
1040 iowrite16(0x0006, ioaddr + PCIBusConfig);
1041
1042 iowrite8(0x20, ioaddr + TxConfig);
1043 rp->tx_thresh = 0x20;
1044 rp->rx_thresh = 0x60;
1045
1046 iowrite32(rp->rx_ring_dma, ioaddr + RxRingPtr);
1047 iowrite32(rp->tx_ring_dma, ioaddr + TxRingPtr);
1048
1049 rhine_set_rx_mode(dev);
1050
1051 napi_enable(&rp->napi);
1052
1053
1054 iowrite16(IntrRxDone | IntrRxErr | IntrRxEmpty| IntrRxOverflow |
1055 IntrRxDropped | IntrRxNoBuf | IntrTxAborted |
1056 IntrTxDone | IntrTxError | IntrTxUnderrun |
1057 IntrPCIErr | IntrStatsMax | IntrLinkChange,
1058 ioaddr + IntrEnable);
1059
1060 iowrite16(CmdStart | CmdTxOn | CmdRxOn | (Cmd1NoTxPoll << 8),
1061 ioaddr + ChipCmd);
1062 rhine_check_media(dev, 1);
1063}
1064
1065
1066static void rhine_enable_linkmon(void __iomem *ioaddr)
1067{
1068 iowrite8(0, ioaddr + MIICmd);
1069 iowrite8(MII_BMSR, ioaddr + MIIRegAddr);
1070 iowrite8(0x80, ioaddr + MIICmd);
1071
1072 RHINE_WAIT_FOR((ioread8(ioaddr + MIIRegAddr) & 0x20));
1073
1074 iowrite8(MII_BMSR | 0x40, ioaddr + MIIRegAddr);
1075}
1076
1077
1078static void rhine_disable_linkmon(void __iomem *ioaddr, u32 quirks)
1079{
1080 iowrite8(0, ioaddr + MIICmd);
1081
1082 if (quirks & rqRhineI) {
1083 iowrite8(0x01, ioaddr + MIIRegAddr);
1084
1085
1086 mdelay(1);
1087
1088
1089 iowrite8(0x80, ioaddr + MIICmd);
1090
1091 RHINE_WAIT_FOR(ioread8(ioaddr + MIIRegAddr) & 0x20);
1092
1093
1094 iowrite8(0, ioaddr + MIICmd);
1095 }
1096 else
1097 RHINE_WAIT_FOR(ioread8(ioaddr + MIIRegAddr) & 0x80);
1098}
1099
1100
1101
1102static int mdio_read(struct net_device *dev, int phy_id, int regnum)
1103{
1104 struct rhine_private *rp = netdev_priv(dev);
1105 void __iomem *ioaddr = rp->base;
1106 int result;
1107
1108 rhine_disable_linkmon(ioaddr, rp->quirks);
1109
1110
1111 iowrite8(phy_id, ioaddr + MIIPhyAddr);
1112 iowrite8(regnum, ioaddr + MIIRegAddr);
1113 iowrite8(0x40, ioaddr + MIICmd);
1114 RHINE_WAIT_FOR(!(ioread8(ioaddr + MIICmd) & 0x40));
1115 result = ioread16(ioaddr + MIIData);
1116
1117 rhine_enable_linkmon(ioaddr);
1118 return result;
1119}
1120
1121static void mdio_write(struct net_device *dev, int phy_id, int regnum, int value)
1122{
1123 struct rhine_private *rp = netdev_priv(dev);
1124 void __iomem *ioaddr = rp->base;
1125
1126 rhine_disable_linkmon(ioaddr, rp->quirks);
1127
1128
1129 iowrite8(phy_id, ioaddr + MIIPhyAddr);
1130 iowrite8(regnum, ioaddr + MIIRegAddr);
1131 iowrite16(value, ioaddr + MIIData);
1132 iowrite8(0x20, ioaddr + MIICmd);
1133 RHINE_WAIT_FOR(!(ioread8(ioaddr + MIICmd) & 0x20));
1134
1135 rhine_enable_linkmon(ioaddr);
1136}
1137
1138static int rhine_open(struct net_device *dev)
1139{
1140 struct rhine_private *rp = netdev_priv(dev);
1141 void __iomem *ioaddr = rp->base;
1142 int rc;
1143
1144 rc = request_irq(rp->pdev->irq, &rhine_interrupt, IRQF_SHARED, dev->name,
1145 dev);
1146 if (rc)
1147 return rc;
1148
1149 if (debug > 1)
1150 printk(KERN_DEBUG "%s: rhine_open() irq %d.\n",
1151 dev->name, rp->pdev->irq);
1152
1153 rc = alloc_ring(dev);
1154 if (rc) {
1155 free_irq(rp->pdev->irq, dev);
1156 return rc;
1157 }
1158 alloc_rbufs(dev);
1159 alloc_tbufs(dev);
1160 rhine_chip_reset(dev);
1161 init_registers(dev);
1162 if (debug > 2)
1163 printk(KERN_DEBUG "%s: Done rhine_open(), status %4.4x "
1164 "MII status: %4.4x.\n",
1165 dev->name, ioread16(ioaddr + ChipCmd),
1166 mdio_read(dev, rp->mii_if.phy_id, MII_BMSR));
1167
1168 netif_start_queue(dev);
1169
1170 return 0;
1171}
1172
1173static void rhine_tx_timeout(struct net_device *dev)
1174{
1175 struct rhine_private *rp = netdev_priv(dev);
1176 void __iomem *ioaddr = rp->base;
1177
1178 printk(KERN_WARNING "%s: Transmit timed out, status %4.4x, PHY status "
1179 "%4.4x, resetting...\n",
1180 dev->name, ioread16(ioaddr + IntrStatus),
1181 mdio_read(dev, rp->mii_if.phy_id, MII_BMSR));
1182
1183
1184 disable_irq(rp->pdev->irq);
1185
1186 napi_disable(&rp->napi);
1187
1188 spin_lock(&rp->lock);
1189
1190
1191 free_tbufs(dev);
1192 free_rbufs(dev);
1193 alloc_tbufs(dev);
1194 alloc_rbufs(dev);
1195
1196
1197 rhine_chip_reset(dev);
1198 init_registers(dev);
1199
1200 spin_unlock(&rp->lock);
1201 enable_irq(rp->pdev->irq);
1202
1203 dev->trans_start = jiffies;
1204 rp->stats.tx_errors++;
1205 netif_wake_queue(dev);
1206}
1207
1208static int rhine_start_tx(struct sk_buff *skb, struct net_device *dev)
1209{
1210 struct rhine_private *rp = netdev_priv(dev);
1211 void __iomem *ioaddr = rp->base;
1212 unsigned entry;
1213
1214
1215
1216
1217
1218 entry = rp->cur_tx % TX_RING_SIZE;
1219
1220 if (skb_padto(skb, ETH_ZLEN))
1221 return 0;
1222
1223 rp->tx_skbuff[entry] = skb;
1224
1225 if ((rp->quirks & rqRhineI) &&
1226 (((unsigned long)skb->data & 3) || skb_shinfo(skb)->nr_frags != 0 || skb->ip_summed == CHECKSUM_PARTIAL)) {
1227
1228 if (skb->len > PKT_BUF_SZ) {
1229
1230 dev_kfree_skb(skb);
1231 rp->tx_skbuff[entry] = NULL;
1232 rp->stats.tx_dropped++;
1233 return 0;
1234 }
1235
1236
1237 skb_copy_and_csum_dev(skb, rp->tx_buf[entry]);
1238 if (skb->len < ETH_ZLEN)
1239 memset(rp->tx_buf[entry] + skb->len, 0,
1240 ETH_ZLEN - skb->len);
1241 rp->tx_skbuff_dma[entry] = 0;
1242 rp->tx_ring[entry].addr = cpu_to_le32(rp->tx_bufs_dma +
1243 (rp->tx_buf[entry] -
1244 rp->tx_bufs));
1245 } else {
1246 rp->tx_skbuff_dma[entry] =
1247 pci_map_single(rp->pdev, skb->data, skb->len,
1248 PCI_DMA_TODEVICE);
1249 rp->tx_ring[entry].addr = cpu_to_le32(rp->tx_skbuff_dma[entry]);
1250 }
1251
1252 rp->tx_ring[entry].desc_length =
1253 cpu_to_le32(TXDESC | (skb->len >= ETH_ZLEN ? skb->len : ETH_ZLEN));
1254
1255
1256 spin_lock_irq(&rp->lock);
1257 wmb();
1258 rp->tx_ring[entry].tx_status = cpu_to_le32(DescOwn);
1259 wmb();
1260
1261 rp->cur_tx++;
1262
1263
1264
1265
1266 iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1TxDemand,
1267 ioaddr + ChipCmd1);
1268 IOSYNC;
1269
1270 if (rp->cur_tx == rp->dirty_tx + TX_QUEUE_LEN)
1271 netif_stop_queue(dev);
1272
1273 dev->trans_start = jiffies;
1274
1275 spin_unlock_irq(&rp->lock);
1276
1277 if (debug > 4) {
1278 printk(KERN_DEBUG "%s: Transmit frame #%d queued in slot %d.\n",
1279 dev->name, rp->cur_tx-1, entry);
1280 }
1281 return 0;
1282}
1283
1284
1285
1286static irqreturn_t rhine_interrupt(int irq, void *dev_instance)
1287{
1288 struct net_device *dev = dev_instance;
1289 struct rhine_private *rp = netdev_priv(dev);
1290 void __iomem *ioaddr = rp->base;
1291 u32 intr_status;
1292 int boguscnt = max_interrupt_work;
1293 int handled = 0;
1294
1295 while ((intr_status = get_intr_status(dev))) {
1296 handled = 1;
1297
1298
1299 if (intr_status & IntrTxDescRace)
1300 iowrite8(0x08, ioaddr + IntrStatus2);
1301 iowrite16(intr_status & 0xffff, ioaddr + IntrStatus);
1302 IOSYNC;
1303
1304 if (debug > 4)
1305 printk(KERN_DEBUG "%s: Interrupt, status %8.8x.\n",
1306 dev->name, intr_status);
1307
1308 if (intr_status & (IntrRxDone | IntrRxErr | IntrRxDropped |
1309 IntrRxWakeUp | IntrRxEmpty | IntrRxNoBuf)) {
1310 iowrite16(IntrTxAborted |
1311 IntrTxDone | IntrTxError | IntrTxUnderrun |
1312 IntrPCIErr | IntrStatsMax | IntrLinkChange,
1313 ioaddr + IntrEnable);
1314
1315 netif_rx_schedule(dev, &rp->napi);
1316 }
1317
1318 if (intr_status & (IntrTxErrSummary | IntrTxDone)) {
1319 if (intr_status & IntrTxErrSummary) {
1320
1321 RHINE_WAIT_FOR(!(ioread8(ioaddr+ChipCmd) & CmdTxOn));
1322 if (debug > 2 &&
1323 ioread8(ioaddr+ChipCmd) & CmdTxOn)
1324 printk(KERN_WARNING "%s: "
1325 "rhine_interrupt() Tx engine "
1326 "still on.\n", dev->name);
1327 }
1328 rhine_tx(dev);
1329 }
1330
1331
1332 if (intr_status & (IntrPCIErr | IntrLinkChange |
1333 IntrStatsMax | IntrTxError | IntrTxAborted |
1334 IntrTxUnderrun | IntrTxDescRace))
1335 rhine_error(dev, intr_status);
1336
1337 if (--boguscnt < 0) {
1338 printk(KERN_WARNING "%s: Too much work at interrupt, "
1339 "status=%#8.8x.\n",
1340 dev->name, intr_status);
1341 break;
1342 }
1343 }
1344
1345 if (debug > 3)
1346 printk(KERN_DEBUG "%s: exiting interrupt, status=%8.8x.\n",
1347 dev->name, ioread16(ioaddr + IntrStatus));
1348 return IRQ_RETVAL(handled);
1349}
1350
1351
1352
1353static void rhine_tx(struct net_device *dev)
1354{
1355 struct rhine_private *rp = netdev_priv(dev);
1356 int txstatus = 0, entry = rp->dirty_tx % TX_RING_SIZE;
1357
1358 spin_lock(&rp->lock);
1359
1360
1361 while (rp->dirty_tx != rp->cur_tx) {
1362 txstatus = le32_to_cpu(rp->tx_ring[entry].tx_status);
1363 if (debug > 6)
1364 printk(KERN_DEBUG "Tx scavenge %d status %8.8x.\n",
1365 entry, txstatus);
1366 if (txstatus & DescOwn)
1367 break;
1368 if (txstatus & 0x8000) {
1369 if (debug > 1)
1370 printk(KERN_DEBUG "%s: Transmit error, "
1371 "Tx status %8.8x.\n",
1372 dev->name, txstatus);
1373 rp->stats.tx_errors++;
1374 if (txstatus & 0x0400) rp->stats.tx_carrier_errors++;
1375 if (txstatus & 0x0200) rp->stats.tx_window_errors++;
1376 if (txstatus & 0x0100) rp->stats.tx_aborted_errors++;
1377 if (txstatus & 0x0080) rp->stats.tx_heartbeat_errors++;
1378 if (((rp->quirks & rqRhineI) && txstatus & 0x0002) ||
1379 (txstatus & 0x0800) || (txstatus & 0x1000)) {
1380 rp->stats.tx_fifo_errors++;
1381 rp->tx_ring[entry].tx_status = cpu_to_le32(DescOwn);
1382 break;
1383 }
1384
1385 } else {
1386 if (rp->quirks & rqRhineI)
1387 rp->stats.collisions += (txstatus >> 3) & 0x0F;
1388 else
1389 rp->stats.collisions += txstatus & 0x0F;
1390 if (debug > 6)
1391 printk(KERN_DEBUG "collisions: %1.1x:%1.1x\n",
1392 (txstatus >> 3) & 0xF,
1393 txstatus & 0xF);
1394 rp->stats.tx_bytes += rp->tx_skbuff[entry]->len;
1395 rp->stats.tx_packets++;
1396 }
1397
1398 if (rp->tx_skbuff_dma[entry]) {
1399 pci_unmap_single(rp->pdev,
1400 rp->tx_skbuff_dma[entry],
1401 rp->tx_skbuff[entry]->len,
1402 PCI_DMA_TODEVICE);
1403 }
1404 dev_kfree_skb_irq(rp->tx_skbuff[entry]);
1405 rp->tx_skbuff[entry] = NULL;
1406 entry = (++rp->dirty_tx) % TX_RING_SIZE;
1407 }
1408 if ((rp->cur_tx - rp->dirty_tx) < TX_QUEUE_LEN - 4)
1409 netif_wake_queue(dev);
1410
1411 spin_unlock(&rp->lock);
1412}
1413
1414
1415static int rhine_rx(struct net_device *dev, int limit)
1416{
1417 struct rhine_private *rp = netdev_priv(dev);
1418 int count;
1419 int entry = rp->cur_rx % RX_RING_SIZE;
1420
1421 if (debug > 4) {
1422 printk(KERN_DEBUG "%s: rhine_rx(), entry %d status %8.8x.\n",
1423 dev->name, entry,
1424 le32_to_cpu(rp->rx_head_desc->rx_status));
1425 }
1426
1427
1428 for (count = 0; count < limit; ++count) {
1429 struct rx_desc *desc = rp->rx_head_desc;
1430 u32 desc_status = le32_to_cpu(desc->rx_status);
1431 int data_size = desc_status >> 16;
1432
1433 if (desc_status & DescOwn)
1434 break;
1435
1436 if (debug > 4)
1437 printk(KERN_DEBUG "rhine_rx() status is %8.8x.\n",
1438 desc_status);
1439
1440 if ((desc_status & (RxWholePkt | RxErr)) != RxWholePkt) {
1441 if ((desc_status & RxWholePkt) != RxWholePkt) {
1442 printk(KERN_WARNING "%s: Oversized Ethernet "
1443 "frame spanned multiple buffers, entry "
1444 "%#x length %d status %8.8x!\n",
1445 dev->name, entry, data_size,
1446 desc_status);
1447 printk(KERN_WARNING "%s: Oversized Ethernet "
1448 "frame %p vs %p.\n", dev->name,
1449 rp->rx_head_desc, &rp->rx_ring[entry]);
1450 rp->stats.rx_length_errors++;
1451 } else if (desc_status & RxErr) {
1452
1453 if (debug > 2)
1454 printk(KERN_DEBUG "rhine_rx() Rx "
1455 "error was %8.8x.\n",
1456 desc_status);
1457 rp->stats.rx_errors++;
1458 if (desc_status & 0x0030) rp->stats.rx_length_errors++;
1459 if (desc_status & 0x0048) rp->stats.rx_fifo_errors++;
1460 if (desc_status & 0x0004) rp->stats.rx_frame_errors++;
1461 if (desc_status & 0x0002) {
1462
1463 spin_lock(&rp->lock);
1464 rp->stats.rx_crc_errors++;
1465 spin_unlock(&rp->lock);
1466 }
1467 }
1468 } else {
1469 struct sk_buff *skb;
1470
1471 int pkt_len = data_size - 4;
1472
1473
1474
1475 if (pkt_len < rx_copybreak &&
1476 (skb = netdev_alloc_skb(dev, pkt_len + NET_IP_ALIGN)) != NULL) {
1477 skb_reserve(skb, NET_IP_ALIGN);
1478 pci_dma_sync_single_for_cpu(rp->pdev,
1479 rp->rx_skbuff_dma[entry],
1480 rp->rx_buf_sz,
1481 PCI_DMA_FROMDEVICE);
1482
1483 skb_copy_to_linear_data(skb,
1484 rp->rx_skbuff[entry]->data,
1485 pkt_len);
1486 skb_put(skb, pkt_len);
1487 pci_dma_sync_single_for_device(rp->pdev,
1488 rp->rx_skbuff_dma[entry],
1489 rp->rx_buf_sz,
1490 PCI_DMA_FROMDEVICE);
1491 } else {
1492 skb = rp->rx_skbuff[entry];
1493 if (skb == NULL) {
1494 printk(KERN_ERR "%s: Inconsistent Rx "
1495 "descriptor chain.\n",
1496 dev->name);
1497 break;
1498 }
1499 rp->rx_skbuff[entry] = NULL;
1500 skb_put(skb, pkt_len);
1501 pci_unmap_single(rp->pdev,
1502 rp->rx_skbuff_dma[entry],
1503 rp->rx_buf_sz,
1504 PCI_DMA_FROMDEVICE);
1505 }
1506 skb->protocol = eth_type_trans(skb, dev);
1507 netif_receive_skb(skb);
1508 dev->last_rx = jiffies;
1509 rp->stats.rx_bytes += pkt_len;
1510 rp->stats.rx_packets++;
1511 }
1512 entry = (++rp->cur_rx) % RX_RING_SIZE;
1513 rp->rx_head_desc = &rp->rx_ring[entry];
1514 }
1515
1516
1517 for (; rp->cur_rx - rp->dirty_rx > 0; rp->dirty_rx++) {
1518 struct sk_buff *skb;
1519 entry = rp->dirty_rx % RX_RING_SIZE;
1520 if (rp->rx_skbuff[entry] == NULL) {
1521 skb = netdev_alloc_skb(dev, rp->rx_buf_sz);
1522 rp->rx_skbuff[entry] = skb;
1523 if (skb == NULL)
1524 break;
1525 skb->dev = dev;
1526 rp->rx_skbuff_dma[entry] =
1527 pci_map_single(rp->pdev, skb->data,
1528 rp->rx_buf_sz,
1529 PCI_DMA_FROMDEVICE);
1530 rp->rx_ring[entry].addr = cpu_to_le32(rp->rx_skbuff_dma[entry]);
1531 }
1532 rp->rx_ring[entry].rx_status = cpu_to_le32(DescOwn);
1533 }
1534
1535 return count;
1536}
1537
1538
1539
1540
1541
1542
1543
1544static inline void clear_tally_counters(void __iomem *ioaddr)
1545{
1546 iowrite32(0, ioaddr + RxMissed);
1547 ioread16(ioaddr + RxCRCErrs);
1548 ioread16(ioaddr + RxMissed);
1549}
1550
1551static void rhine_restart_tx(struct net_device *dev) {
1552 struct rhine_private *rp = netdev_priv(dev);
1553 void __iomem *ioaddr = rp->base;
1554 int entry = rp->dirty_tx % TX_RING_SIZE;
1555 u32 intr_status;
1556
1557
1558
1559
1560
1561 intr_status = get_intr_status(dev);
1562
1563 if ((intr_status & IntrTxErrSummary) == 0) {
1564
1565
1566 iowrite32(rp->tx_ring_dma + entry * sizeof(struct tx_desc),
1567 ioaddr + TxRingPtr);
1568
1569 iowrite8(ioread8(ioaddr + ChipCmd) | CmdTxOn,
1570 ioaddr + ChipCmd);
1571 iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1TxDemand,
1572 ioaddr + ChipCmd1);
1573 IOSYNC;
1574 }
1575 else {
1576
1577 if (debug > 1)
1578 printk(KERN_WARNING "%s: rhine_restart_tx() "
1579 "Another error occured %8.8x.\n",
1580 dev->name, intr_status);
1581 }
1582
1583}
1584
1585static void rhine_error(struct net_device *dev, int intr_status)
1586{
1587 struct rhine_private *rp = netdev_priv(dev);
1588 void __iomem *ioaddr = rp->base;
1589
1590 spin_lock(&rp->lock);
1591
1592 if (intr_status & IntrLinkChange)
1593 rhine_check_media(dev, 0);
1594 if (intr_status & IntrStatsMax) {
1595 rp->stats.rx_crc_errors += ioread16(ioaddr + RxCRCErrs);
1596 rp->stats.rx_missed_errors += ioread16(ioaddr + RxMissed);
1597 clear_tally_counters(ioaddr);
1598 }
1599 if (intr_status & IntrTxAborted) {
1600 if (debug > 1)
1601 printk(KERN_INFO "%s: Abort %8.8x, frame dropped.\n",
1602 dev->name, intr_status);
1603 }
1604 if (intr_status & IntrTxUnderrun) {
1605 if (rp->tx_thresh < 0xE0)
1606 iowrite8(rp->tx_thresh += 0x20, ioaddr + TxConfig);
1607 if (debug > 1)
1608 printk(KERN_INFO "%s: Transmitter underrun, Tx "
1609 "threshold now %2.2x.\n",
1610 dev->name, rp->tx_thresh);
1611 }
1612 if (intr_status & IntrTxDescRace) {
1613 if (debug > 2)
1614 printk(KERN_INFO "%s: Tx descriptor write-back race.\n",
1615 dev->name);
1616 }
1617 if ((intr_status & IntrTxError) &&
1618 (intr_status & (IntrTxAborted |
1619 IntrTxUnderrun | IntrTxDescRace)) == 0) {
1620 if (rp->tx_thresh < 0xE0) {
1621 iowrite8(rp->tx_thresh += 0x20, ioaddr + TxConfig);
1622 }
1623 if (debug > 1)
1624 printk(KERN_INFO "%s: Unspecified error. Tx "
1625 "threshold now %2.2x.\n",
1626 dev->name, rp->tx_thresh);
1627 }
1628 if (intr_status & (IntrTxAborted | IntrTxUnderrun | IntrTxDescRace |
1629 IntrTxError))
1630 rhine_restart_tx(dev);
1631
1632 if (intr_status & ~(IntrLinkChange | IntrStatsMax | IntrTxUnderrun |
1633 IntrTxError | IntrTxAborted | IntrNormalSummary |
1634 IntrTxDescRace)) {
1635 if (debug > 1)
1636 printk(KERN_ERR "%s: Something Wicked happened! "
1637 "%8.8x.\n", dev->name, intr_status);
1638 }
1639
1640 spin_unlock(&rp->lock);
1641}
1642
1643static struct net_device_stats *rhine_get_stats(struct net_device *dev)
1644{
1645 struct rhine_private *rp = netdev_priv(dev);
1646 void __iomem *ioaddr = rp->base;
1647 unsigned long flags;
1648
1649 spin_lock_irqsave(&rp->lock, flags);
1650 rp->stats.rx_crc_errors += ioread16(ioaddr + RxCRCErrs);
1651 rp->stats.rx_missed_errors += ioread16(ioaddr + RxMissed);
1652 clear_tally_counters(ioaddr);
1653 spin_unlock_irqrestore(&rp->lock, flags);
1654
1655 return &rp->stats;
1656}
1657
1658static void rhine_set_rx_mode(struct net_device *dev)
1659{
1660 struct rhine_private *rp = netdev_priv(dev);
1661 void __iomem *ioaddr = rp->base;
1662 u32 mc_filter[2];
1663 u8 rx_mode;
1664
1665 if (dev->flags & IFF_PROMISC) {
1666 rx_mode = 0x1C;
1667 iowrite32(0xffffffff, ioaddr + MulticastFilter0);
1668 iowrite32(0xffffffff, ioaddr + MulticastFilter1);
1669 } else if ((dev->mc_count > multicast_filter_limit)
1670 || (dev->flags & IFF_ALLMULTI)) {
1671
1672 iowrite32(0xffffffff, ioaddr + MulticastFilter0);
1673 iowrite32(0xffffffff, ioaddr + MulticastFilter1);
1674 rx_mode = 0x0C;
1675 } else {
1676 struct dev_mc_list *mclist;
1677 int i;
1678 memset(mc_filter, 0, sizeof(mc_filter));
1679 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1680 i++, mclist = mclist->next) {
1681 int bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26;
1682
1683 mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
1684 }
1685 iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1686 iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1687 rx_mode = 0x0C;
1688 }
1689 iowrite8(rp->rx_thresh | rx_mode, ioaddr + RxConfig);
1690}
1691
1692static void netdev_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1693{
1694 struct rhine_private *rp = netdev_priv(dev);
1695
1696 strcpy(info->driver, DRV_NAME);
1697 strcpy(info->version, DRV_VERSION);
1698 strcpy(info->bus_info, pci_name(rp->pdev));
1699}
1700
1701static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1702{
1703 struct rhine_private *rp = netdev_priv(dev);
1704 int rc;
1705
1706 spin_lock_irq(&rp->lock);
1707 rc = mii_ethtool_gset(&rp->mii_if, cmd);
1708 spin_unlock_irq(&rp->lock);
1709
1710 return rc;
1711}
1712
1713static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1714{
1715 struct rhine_private *rp = netdev_priv(dev);
1716 int rc;
1717
1718 spin_lock_irq(&rp->lock);
1719 rc = mii_ethtool_sset(&rp->mii_if, cmd);
1720 spin_unlock_irq(&rp->lock);
1721 rhine_set_carrier(&rp->mii_if);
1722
1723 return rc;
1724}
1725
1726static int netdev_nway_reset(struct net_device *dev)
1727{
1728 struct rhine_private *rp = netdev_priv(dev);
1729
1730 return mii_nway_restart(&rp->mii_if);
1731}
1732
1733static u32 netdev_get_link(struct net_device *dev)
1734{
1735 struct rhine_private *rp = netdev_priv(dev);
1736
1737 return mii_link_ok(&rp->mii_if);
1738}
1739
1740static u32 netdev_get_msglevel(struct net_device *dev)
1741{
1742 return debug;
1743}
1744
1745static void netdev_set_msglevel(struct net_device *dev, u32 value)
1746{
1747 debug = value;
1748}
1749
1750static void rhine_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
1751{
1752 struct rhine_private *rp = netdev_priv(dev);
1753
1754 if (!(rp->quirks & rqWOL))
1755 return;
1756
1757 spin_lock_irq(&rp->lock);
1758 wol->supported = WAKE_PHY | WAKE_MAGIC |
1759 WAKE_UCAST | WAKE_MCAST | WAKE_BCAST;
1760 wol->wolopts = rp->wolopts;
1761 spin_unlock_irq(&rp->lock);
1762}
1763
1764static int rhine_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
1765{
1766 struct rhine_private *rp = netdev_priv(dev);
1767 u32 support = WAKE_PHY | WAKE_MAGIC |
1768 WAKE_UCAST | WAKE_MCAST | WAKE_BCAST;
1769
1770 if (!(rp->quirks & rqWOL))
1771 return -EINVAL;
1772
1773 if (wol->wolopts & ~support)
1774 return -EINVAL;
1775
1776 spin_lock_irq(&rp->lock);
1777 rp->wolopts = wol->wolopts;
1778 spin_unlock_irq(&rp->lock);
1779
1780 return 0;
1781}
1782
1783static const struct ethtool_ops netdev_ethtool_ops = {
1784 .get_drvinfo = netdev_get_drvinfo,
1785 .get_settings = netdev_get_settings,
1786 .set_settings = netdev_set_settings,
1787 .nway_reset = netdev_nway_reset,
1788 .get_link = netdev_get_link,
1789 .get_msglevel = netdev_get_msglevel,
1790 .set_msglevel = netdev_set_msglevel,
1791 .get_wol = rhine_get_wol,
1792 .set_wol = rhine_set_wol,
1793};
1794
1795static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1796{
1797 struct rhine_private *rp = netdev_priv(dev);
1798 int rc;
1799
1800 if (!netif_running(dev))
1801 return -EINVAL;
1802
1803 spin_lock_irq(&rp->lock);
1804 rc = generic_mii_ioctl(&rp->mii_if, if_mii(rq), cmd, NULL);
1805 spin_unlock_irq(&rp->lock);
1806 rhine_set_carrier(&rp->mii_if);
1807
1808 return rc;
1809}
1810
1811static int rhine_close(struct net_device *dev)
1812{
1813 struct rhine_private *rp = netdev_priv(dev);
1814 void __iomem *ioaddr = rp->base;
1815
1816 spin_lock_irq(&rp->lock);
1817
1818 netif_stop_queue(dev);
1819 napi_disable(&rp->napi);
1820
1821 if (debug > 1)
1822 printk(KERN_DEBUG "%s: Shutting down ethercard, "
1823 "status was %4.4x.\n",
1824 dev->name, ioread16(ioaddr + ChipCmd));
1825
1826
1827 iowrite8(rp->tx_thresh | 0x02, ioaddr + TxConfig);
1828
1829
1830 iowrite16(0x0000, ioaddr + IntrEnable);
1831
1832
1833 iowrite16(CmdStop, ioaddr + ChipCmd);
1834
1835 spin_unlock_irq(&rp->lock);
1836
1837 free_irq(rp->pdev->irq, dev);
1838 free_rbufs(dev);
1839 free_tbufs(dev);
1840 free_ring(dev);
1841
1842 return 0;
1843}
1844
1845
1846static void __devexit rhine_remove_one(struct pci_dev *pdev)
1847{
1848 struct net_device *dev = pci_get_drvdata(pdev);
1849 struct rhine_private *rp = netdev_priv(dev);
1850
1851 unregister_netdev(dev);
1852
1853 pci_iounmap(pdev, rp->base);
1854 pci_release_regions(pdev);
1855
1856 free_netdev(dev);
1857 pci_disable_device(pdev);
1858 pci_set_drvdata(pdev, NULL);
1859}
1860
1861static void rhine_shutdown (struct pci_dev *pdev)
1862{
1863 struct net_device *dev = pci_get_drvdata(pdev);
1864 struct rhine_private *rp = netdev_priv(dev);
1865 void __iomem *ioaddr = rp->base;
1866
1867 if (!(rp->quirks & rqWOL))
1868 return;
1869
1870 rhine_power_init(dev);
1871
1872
1873 if (rp->quirks & rq6patterns)
1874 iowrite8(0x04, ioaddr + WOLcgClr);
1875
1876 if (rp->wolopts & WAKE_MAGIC) {
1877 iowrite8(WOLmagic, ioaddr + WOLcrSet);
1878
1879
1880
1881
1882 iowrite8(ioread8(ioaddr + ConfigA) | 0x03, ioaddr + ConfigA);
1883 }
1884
1885 if (rp->wolopts & (WAKE_BCAST|WAKE_MCAST))
1886 iowrite8(WOLbmcast, ioaddr + WOLcgSet);
1887
1888 if (rp->wolopts & WAKE_PHY)
1889 iowrite8(WOLlnkon | WOLlnkoff, ioaddr + WOLcrSet);
1890
1891 if (rp->wolopts & WAKE_UCAST)
1892 iowrite8(WOLucast, ioaddr + WOLcrSet);
1893
1894 if (rp->wolopts) {
1895
1896 iowrite8(0x01, ioaddr + PwcfgSet);
1897 iowrite8(ioread8(ioaddr + StickyHW) | 0x04, ioaddr + StickyHW);
1898 }
1899
1900
1901 if (!avoid_D3)
1902 iowrite8(ioread8(ioaddr + StickyHW) | 0x03, ioaddr + StickyHW);
1903
1904
1905
1906}
1907
1908#ifdef CONFIG_PM
1909static int rhine_suspend(struct pci_dev *pdev, pm_message_t state)
1910{
1911 struct net_device *dev = pci_get_drvdata(pdev);
1912 struct rhine_private *rp = netdev_priv(dev);
1913 unsigned long flags;
1914
1915 if (!netif_running(dev))
1916 return 0;
1917
1918 napi_disable(&rp->napi);
1919
1920 netif_device_detach(dev);
1921 pci_save_state(pdev);
1922
1923 spin_lock_irqsave(&rp->lock, flags);
1924 rhine_shutdown(pdev);
1925 spin_unlock_irqrestore(&rp->lock, flags);
1926
1927 free_irq(dev->irq, dev);
1928 return 0;
1929}
1930
1931static int rhine_resume(struct pci_dev *pdev)
1932{
1933 struct net_device *dev = pci_get_drvdata(pdev);
1934 struct rhine_private *rp = netdev_priv(dev);
1935 unsigned long flags;
1936 int ret;
1937
1938 if (!netif_running(dev))
1939 return 0;
1940
1941 if (request_irq(dev->irq, rhine_interrupt, IRQF_SHARED, dev->name, dev))
1942 printk(KERN_ERR "via-rhine %s: request_irq failed\n", dev->name);
1943
1944 ret = pci_set_power_state(pdev, PCI_D0);
1945 if (debug > 1)
1946 printk(KERN_INFO "%s: Entering power state D0 %s (%d).\n",
1947 dev->name, ret ? "failed" : "succeeded", ret);
1948
1949 pci_restore_state(pdev);
1950
1951 spin_lock_irqsave(&rp->lock, flags);
1952#ifdef USE_MMIO
1953 enable_mmio(rp->pioaddr, rp->quirks);
1954#endif
1955 rhine_power_init(dev);
1956 free_tbufs(dev);
1957 free_rbufs(dev);
1958 alloc_tbufs(dev);
1959 alloc_rbufs(dev);
1960 init_registers(dev);
1961 spin_unlock_irqrestore(&rp->lock, flags);
1962
1963 netif_device_attach(dev);
1964
1965 return 0;
1966}
1967#endif
1968
1969static struct pci_driver rhine_driver = {
1970 .name = DRV_NAME,
1971 .id_table = rhine_pci_tbl,
1972 .probe = rhine_init_one,
1973 .remove = __devexit_p(rhine_remove_one),
1974#ifdef CONFIG_PM
1975 .suspend = rhine_suspend,
1976 .resume = rhine_resume,
1977#endif
1978 .shutdown = rhine_shutdown,
1979};
1980
1981static struct dmi_system_id __initdata rhine_dmi_table[] = {
1982 {
1983 .ident = "EPIA-M",
1984 .matches = {
1985 DMI_MATCH(DMI_BIOS_VENDOR, "Award Software International, Inc."),
1986 DMI_MATCH(DMI_BIOS_VERSION, "6.00 PG"),
1987 },
1988 },
1989 {
1990 .ident = "KV7",
1991 .matches = {
1992 DMI_MATCH(DMI_BIOS_VENDOR, "Phoenix Technologies, LTD"),
1993 DMI_MATCH(DMI_BIOS_VERSION, "6.00 PG"),
1994 },
1995 },
1996 { NULL }
1997};
1998
1999static int __init rhine_init(void)
2000{
2001
2002#ifdef MODULE
2003 printk(version);
2004#endif
2005 if (dmi_check_system(rhine_dmi_table)) {
2006
2007 avoid_D3 = 1;
2008 printk(KERN_WARNING "%s: Broken BIOS detected, avoid_D3 "
2009 "enabled.\n",
2010 DRV_NAME);
2011 }
2012 else if (avoid_D3)
2013 printk(KERN_INFO "%s: avoid_D3 set.\n", DRV_NAME);
2014
2015 return pci_register_driver(&rhine_driver);
2016}
2017
2018
2019static void __exit rhine_cleanup(void)
2020{
2021 pci_unregister_driver(&rhine_driver);
2022}
2023
2024
2025module_init(rhine_init);
2026module_exit(rhine_cleanup);
2027