v2.4.9.9 -> v2.4.9.10
[opensuse:kernel.git] / drivers / net / dl2k.c
1 /*  D-Link DL2000-based Gigabit Ethernet Adapter Linux driver */
2 /*
3     Copyright (c) 2001 by D-Link Corporation
4     Written by Edward Peng.<edward_peng@dlink.com.tw>
5     Created 03-May-2001, base on Linux' sundance.c.
6
7     This program is free software; you can redistribute it and/or modify
8     it under the terms of the GNU General Public License as published by
9     the Free Software Foundation; either version 2 of the License, or
10     (at your option) any later version.
11 */
12 /*
13     Rev         Date            Description
14     ==========================================================================
15     0.01        2001/05/03      Create DL2000-based linux driver
16     0.02        2001/05/21      Add VLAN and hardware checksum support.
17     1.00        2001/06/26      Add jumbo frame support.
18 */
19
20 #include "dl2k.h"
21
22
23 static char version[] __devinitdata =
24 KERN_INFO "D-Link DL2000-based linux driver v1.00 2001/06/26\n";
25
26
27
28 #define MAX_UNITS 8
29 static int mtu[MAX_UNITS];
30 static int vlan[MAX_UNITS];
31 static int jumbo[MAX_UNITS];
32 static char *media[MAX_UNITS];
33 static int copy_thresh;
34
35 MODULE_AUTHOR ("Edward Peng");
36 MODULE_DESCRIPTION ("D-Link DL2000-based Gigabit Ethernet Adapter");
37 MODULE_PARM (mtu, "1-" __MODULE_STRING (MAX_UNITS) "i");
38 MODULE_PARM (media, "1-" __MODULE_STRING (MAX_UNITS) "s");
39 MODULE_PARM (vlan, "1-" __MODULE_STRING (MAX_UNITS) "i");
40 MODULE_PARM (jumbo, "1-" __MODULE_STRING (MAX_UNITS) "i");
41 MODULE_PARM (copy_thresh, "i");
42
43 /* Enable the default interrupts */
44 #define EnableInt() \
45 writew(RxComplete| RxDMAComplete | HostError | IntRequested | TxComplete| \
46        TxDMAComplete| UpdateStats | LinkEvent, ioaddr + IntEnable)
47 static int max_intrloop = 25;
48 static int multicast_filter_limit = 0x40;
49
50 static int rio_open (struct net_device *dev);
51 static void tx_timeout (struct net_device *dev);
52 static void alloc_list (struct net_device *dev);
53 static int start_xmit (struct sk_buff *skb, struct net_device *dev);
54 static void rio_interrupt (int irq, void *dev_instance, struct pt_regs *regs);
55 static void tx_error (struct net_device *dev, int tx_status);
56 static int receive_packet (struct net_device *dev);
57 static void rio_error (struct net_device *dev, int int_status);
58 static int change_mtu (struct net_device *dev, int new_mtu);
59 static void set_multicast (struct net_device *dev);
60 static struct net_device_stats *get_stats (struct net_device *dev);
61 static int rio_ioctl (struct net_device *dev, struct ifreq *rq, int cmd);
62 static int rio_close (struct net_device *dev);
63 static int find_miiphy (struct net_device *dev);
64 static int parse_eeprom (struct net_device *dev);
65 static int read_eeprom (long ioaddr, int eep_addr);
66 static unsigned get_crc (unsigned char *p, int len);
67 static int mii_wait_link (struct net_device *dev, int wait);
68 static int mii_set_media (struct net_device *dev);
69 static int mii_get_media (struct net_device *dev);
70 static int mii_read (struct net_device *dev, int phy_addr, int reg_num);
71 static int mii_write (struct net_device *dev, int phy_addr, int reg_num,
72                       u16 data);
73 #ifdef RIO_DEBUG
74 static int rio_ioctl_ext (struct net_device *dev, struct ioctl_data *iodata);
75 #endif
76
77 static int __devinit
78 rio_probe1 (struct pci_dev *pdev, const struct pci_device_id *ent)
79 {
80         struct net_device *dev;
81         struct netdev_private *np;
82         static int card_idx;
83         int chip_idx = ent->driver_data;
84         int err, irq = pdev->irq;
85         long ioaddr;
86         static int version_printed;
87         void *ring_space;
88         dma_addr_t ring_dma;
89
90         if (!version_printed++)
91                 printk ("%s", version);
92
93         err = pci_enable_device (pdev);
94         if (err)
95                 return err;
96
97         err = pci_request_regions (pdev, "dl2k");
98         if (err)
99                 goto err_out_disable;
100
101         pci_set_master (pdev);
102
103         dev = alloc_etherdev (sizeof (*np));
104         if (!dev) {
105                 err = -ENOMEM;
106                 goto err_out_res;
107         }
108         SET_MODULE_OWNER (dev);
109
110 #ifdef USE_IO_OPS
111         ioaddr = pci_resource_start (pdev, 0);
112 #else
113         ioaddr = pci_resource_start (pdev, 1);
114         ioaddr = (long) ioremap (ioaddr, RIO_IO_SIZE);
115         if (!ioaddr) {
116                 err = -ENOMEM;
117                 goto err_out_dev;
118         }
119 #endif
120         dev->base_addr = ioaddr;
121         dev->irq = irq;
122         np = dev->priv;
123         np->chip_id = chip_idx;
124         np->pdev = pdev;
125         spin_lock_init (&np->lock);
126
127         /* Parse manual configuration */
128         np->an_enable = 1;
129         if (card_idx < MAX_UNITS) {
130                 if (media[card_idx] != NULL) {
131                         np->an_enable = 0;
132                         if (strcmp (media[card_idx], "100mbps_fd") == 0 ||
133                             strcmp (media[card_idx], "4") == 0) {
134                                 np->speed = 100;
135                                 np->full_duplex = 1;
136                         } else if (strcmp (media[card_idx], "100mbps_hd") == 0
137                                    || strcmp (media[card_idx], "3") == 0) {
138                                 np->speed = 100;
139                                 np->full_duplex = 0;
140                         } else if (strcmp (media[card_idx], "10mbps_fd") == 0 ||
141                                    strcmp (media[card_idx], "2") == 0) {
142                                 np->speed = 10;
143                                 np->full_duplex = 1;
144                         } else if (strcmp (media[card_idx], "10mbps_hd") == 0 ||
145                                    strcmp (media[card_idx], "1") == 0) {
146                                 np->speed = 10;
147                                 np->full_duplex = 0;
148                         }
149                         /* Auto-Negotiation is mandatory for 1000BASE-T,
150                            IEEE 802.3ab Annex 28D page 14 */
151                         else if (strcmp (media[card_idx], "1000mbps_fd") == 0 ||
152                                  strcmp (media[card_idx], "5") == 0 ||
153                                  strcmp (media[card_idx], "1000mbps_hd") == 0 ||
154                                  strcmp (media[card_idx], "6") == 0) {
155                                 np->speed = 1000;
156                                 np->full_duplex = 1;
157                                 np->an_enable = 1;
158                         } else {
159                                 np->an_enable = 1;
160                         }
161                 }
162                 if (jumbo[card_idx] != 0) {
163                         np->jumbo = 1;
164                         dev->mtu = 9000;
165                 } else {
166                         np->jumbo = 0;
167                         if (mtu[card_idx] > 0 && mtu[card_idx] < PACKET_SIZE)
168                                 dev->mtu = mtu[card_idx];
169                 }
170                 np->vlan = (vlan[card_idx] > 0 && vlan[card_idx] < 4096) ?
171                     vlan[card_idx] : 0;
172         }
173         dev->open = &rio_open;
174         dev->hard_start_xmit = &start_xmit;
175         dev->stop = &rio_close;
176         dev->get_stats = &get_stats;
177         dev->set_multicast_list = &set_multicast;
178         dev->do_ioctl = &rio_ioctl;
179         dev->tx_timeout = &tx_timeout;
180         dev->watchdog_timeo = TX_TIMEOUT;
181         dev->change_mtu = &change_mtu;
182 #ifdef TX_HW_CHECKSUM
183         dev->features = NETIF_F_SG | NETIF_F_HW_CSUM;
184 #endif
185         pci_set_drvdata (pdev, dev);
186
187         ring_space = pci_alloc_consistent(pdev, TX_TOTAL_SIZE, &ring_dma);
188         if (!ring_space)
189                 goto err_out_iounmap;
190         np->tx_ring = (struct netdev_desc *)ring_space;
191         np->tx_ring_dma = ring_dma;
192
193         ring_space = pci_alloc_consistent(pdev, RX_TOTAL_SIZE, &ring_dma);
194         if (!ring_space)
195                 goto err_out_unmap_tx;
196         np->rx_ring = (struct netdev_desc *)ring_space;
197         np->rx_ring_dma = ring_dma;
198
199         /* Parse eeprom data */
200         parse_eeprom (dev);
201
202         /* Find PHY address */
203         err = find_miiphy (dev);
204         if (err)
205                 goto err_out_unmap_rx;
206
207         /* Set media and reset PHY */
208         mii_set_media (dev);
209
210         /* Reset all logic functions */
211         writew (GlobalReset | DMAReset | FIFOReset | NetworkReset | HostReset,
212                 ioaddr + ASICCtrl + 2);
213
214         err = register_netdev (dev);
215         if (err)
216                 goto err_out_unmap_rx;
217
218         card_idx++;
219
220         printk (KERN_INFO "%s: %s, %2x:%2x:%2x:%2x:%2x:%2x, IRQ %d\n",
221                 dev->name, np->name,
222                 dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
223                 dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5],
224                 irq);
225         return 0;
226
227 err_out_unmap_rx:
228         pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma);
229 err_out_unmap_tx:
230         pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma);
231 err_out_iounmap:
232 #ifndef USE_IO_OPS
233         iounmap ((void *) ioaddr);
234
235 err_out_dev:
236 #endif
237         kfree (dev);
238
239 err_out_res:
240         pci_release_regions (pdev);
241
242 err_out_disable:
243         pci_disable_device (pdev);
244         return err;
245 }
246
247 int
248 find_miiphy (struct net_device *dev)
249 {
250         int i, phy_found = 0;
251         struct netdev_private *np;
252         long ioaddr;
253         np = dev->priv;
254         ioaddr = dev->base_addr;
255         np->phy_addr = 1;
256
257         for (i = 31; i >= 0; i--) {
258                 int mii_status = mii_read (dev, i, 1);
259                 if (mii_status != 0xffff && mii_status != 0x0000) {
260                         np->phy_addr = i;
261                         phy_found++;
262                 }
263         }
264         if (!phy_found) {
265                 printk (KERN_ERR "%s: No MII PHY found!\n", dev->name);
266                 return -ENODEV;
267         }
268         return 0;
269 }
270
271 int
272 parse_eeprom (struct net_device *dev)
273 {
274         int i, j;
275         long ioaddr = dev->base_addr;
276         u8 sromdata[256];
277         u8 *psib;
278         u32 crc;
279         PSROM_t psrom = (PSROM_t) sromdata;
280         struct netdev_private *np = dev->priv;
281
282         int cid, next;
283
284         /* Read eeprom */
285         for (i = 0; i < 128; i++) {
286                 ((u16 *) sromdata)[i] = le16_to_cpu (read_eeprom (ioaddr, i));
287         }
288
289         /* Check CRC */
290         crc = ~get_crc (sromdata, 256 - 4);
291         if (psrom->crc != ~get_crc (sromdata, 256 - 4)) {
292                 printk (KERN_ERR "%s: EEPROM data CRC error.\n", dev->name);
293                 return -1;
294         }
295
296         /* Set MAC address */
297         for (i = 0; i < 6; i++)
298                 dev->dev_addr[i] = psrom->mac_addr[i];
299
300         /* Parse Software Infomation Block */
301         i = 0x30;
302         psib = (u8 *) sromdata;
303         do {
304                 cid = psib[i++];
305                 next = psib[i++];
306                 if ((cid == 0 && next == 0) || (cid == 0xff && next == 0xff)) {
307                         printk (KERN_ERR "Cell data error\n");
308                         return -1;
309                 }
310                 switch (cid) {
311                 case 0: /* Format version */
312                         break;
313                 case 1: /* End of cell */
314                         return 0;
315                 case 2: /* Duplex Polarity */
316                         np->duplex_polarity = psib[i];
317                         writeb (readb (ioaddr + PhyCtrl) | psib[i],
318                                 ioaddr + PhyCtrl);
319                         break;
320                 case 3: /* Wake Polarity */
321                         np->wake_polarity = psib[i];
322                         break;
323                 case 9: /* Adapter description */
324                         j = (next - i > 255) ? 255 : next - i;
325                         memcpy (np->name, &(psib[i]), j);
326                         break;
327                 case 4:
328                 case 5:
329                 case 6:
330                 case 7:
331                 case 8: /* Reversed */
332                         break;
333                 default:        /* Unknown cell */
334                         return -1;
335                 }
336                 i = next;
337         } while (1);
338
339         return 0;
340 }
341
342 static int
343 rio_open (struct net_device *dev)
344 {
345         struct netdev_private *np = dev->priv;
346         long ioaddr = dev->base_addr;
347         int i;
348
349         i = request_irq (dev->irq, &rio_interrupt, SA_SHIRQ, dev->name, dev);
350         if (i)
351                 return i;
352
353         /* DebugCtrl bit 4, 5, 9 must set */
354         writel (readl (ioaddr + DebugCtrl) | 0x0230, ioaddr + DebugCtrl);
355
356         /* Jumbo frame */
357         if (np->jumbo != 0)
358                 writew (9014, ioaddr + MaxFrameSize);
359
360         alloc_list (dev);
361
362         /* Get station address */
363         for (i = 0; i < 6; i++)
364                 writeb (dev->dev_addr[i], ioaddr + StationAddr0 + i);
365
366         set_multicast (dev);
367
368         /* Set RIO to poll every N*320nsec. */
369         writeb (0xff, ioaddr + RxDMAPollPeriod);
370         writeb (0xff, ioaddr + TxDMAPollPeriod);
371         netif_start_queue (dev);
372         writel (StatsEnable | RxEnable | TxEnable, ioaddr + MACCtrl);
373
374         /* VLAN supported */
375         if (np->vlan) {
376                 /* priority field in RxDMAIntCtrl  */
377                 writel (0x7 << 10, ioaddr + RxDMAIntCtrl);
378                 /* VLANId */
379                 writew (np->vlan, ioaddr + VLANId);
380                 /* Length/Type should be 0x8100 */
381                 writel (0x8100 << 16 | np->vlan, ioaddr + VLANTag);
382                 /* Enable AutoVLANuntagging, but disable AutoVLANtagging.
383                    VLAN information tagged by TFC' VID, CFI fields. */
384                 writel (readl (ioaddr + MACCtrl) | AutoVLANuntagging,
385                         ioaddr + MACCtrl);
386         }
387
388         /* Enable default interrupts */
389         EnableInt ();
390
391         /* clear statistics */
392         get_stats (dev);
393         return 0;
394 }
395
396 static void
397 tx_timeout (struct net_device *dev)
398 {
399         struct netdev_private *np = dev->priv;
400         long ioaddr = dev->base_addr;
401
402         printk (KERN_WARNING "%s: Transmit timed out, TxStatus %4.4x.\n",
403                 dev->name, readl (ioaddr + TxStatus));
404         dev->if_port = 0;
405         dev->trans_start = jiffies;
406         np->stats.tx_errors++;
407         if (!np->tx_full)
408                 netif_wake_queue (dev);
409 }
410
411  /* allocate and initialize Tx and Rx descriptors */
412 static void
413 alloc_list (struct net_device *dev)
414 {
415         struct netdev_private *np = dev->priv;
416         int i;
417
418         np->tx_full = 0;
419         np->cur_rx = np->cur_tx = 0;
420         np->old_rx = np->old_tx = 0;
421         np->rx_buf_sz = (dev->mtu <= 1500 ? PACKET_SIZE : dev->mtu + 32);
422
423         /* Initialize Tx descriptors, TFDListPtr leaves in start_xmit(). */
424         for (i = 0; i < TX_RING_SIZE; i++) {
425                 np->tx_skbuff[i] = 0;
426                 np->tx_ring[i].status = 0;
427         }
428
429         /* Initialize Rx descriptors */
430         for (i = 0; i < RX_RING_SIZE; i++) {
431                 np->rx_ring[i].next_desc = cpu_to_le64(np->rx_ring_dma +
432                         ((i+1)%RX_RING_SIZE)*sizeof(struct netdev_desc));
433                 np->rx_ring[i].status = 0;
434                 np->rx_ring[i].fraginfo = 0;
435                 np->rx_skbuff[i] = 0;
436         }
437
438         /* Allocate the rx buffers */
439         for (i = 0; i < RX_RING_SIZE; i++) {
440                 /* Allocated fixed size of skbuff */
441                 struct sk_buff *skb = dev_alloc_skb (np->rx_buf_sz);
442                 np->rx_skbuff[i] = skb;
443                 if (skb == NULL) {
444                         printk (KERN_ERR
445                                 "%s: alloc_list: allocate Rx buffer error! ",
446                                 dev->name);
447                         break;
448                 }
449                 skb->dev = dev; /* Mark as being used by this device. */
450                 skb_reserve (skb, 2);   /* 16 byte align the IP header. */
451                 /* Rubicon now supports 40 bits of addressing space. */
452                 np->rx_ring[i].fraginfo = cpu_to_le64(pci_map_single(
453                         np->pdev, skb->tail, np->rx_buf_sz, 
454                         PCI_DMA_FROMDEVICE));
455                 np->rx_ring[i].fraginfo |= cpu_to_le64 (np->rx_buf_sz) << 48;
456         }
457
458         /* Set RFDListPtr */
459         writel (cpu_to_le32 (np->rx_ring_dma), dev->base_addr + RFDListPtr0);
460         writel (0, dev->base_addr + RFDListPtr1);
461
462         return;
463 }
464
465 static int
466 start_xmit (struct sk_buff *skb, struct net_device *dev)
467 {
468         struct netdev_private *np = dev->priv;
469         struct netdev_desc *txdesc;
470         unsigned entry;
471         u32 ioaddr;
472         int tx_shift;
473         unsigned long flags;
474
475         ioaddr = dev->base_addr;
476         entry = np->cur_tx % TX_RING_SIZE;
477         np->tx_skbuff[entry] = skb;
478         txdesc = &np->tx_ring[entry];
479         txdesc->next_desc = 0;
480
481         /* Set TFDDone to avoid TxDMA gather this descriptor */
482         txdesc->status = cpu_to_le64 (TFDDone);
483         txdesc->status |=
484             cpu_to_le64 (entry | WordAlignDisable | (1 << FragCountShift));
485 #ifdef TX_HW_CHECKSUM
486         if (skb->ip_summed == CHECKSUM_HW) {
487                 txdesc->status |=
488                     cpu_to_le64 (TCPChecksumEnable | UDPChecksumEnable |
489                                  IPChecksumEnable);
490         }
491 #endif
492         if (np->vlan) {
493                 txdesc->status |=
494                         cpu_to_le64 (VLANTagInsert) |
495                         (cpu_to_le64 (np->vlan) << 32) |
496                         (cpu_to_le64 (skb->priority) << 45);
497         }
498
499         /* Send one packet each time at 10Mbps mode */
500         if (entry % 0x08 == 0 || np->speed == 10)
501                 txdesc->status |= cpu_to_le64 (TxIndicate);
502         txdesc->fraginfo = cpu_to_le64 (pci_map_single(np->pdev, skb->data, 
503                 skb->len, PCI_DMA_TODEVICE));
504         txdesc->fraginfo |= cpu_to_le64 (skb->len) << 48;
505
506         /* Chain the last descriptor's pointer to this one */
507         if (np->last_tx)
508                 np->last_tx->next_desc = cpu_to_le64 (np->tx_ring_dma +
509                         entry*sizeof(struct netdev_desc));
510         np->last_tx = txdesc;
511
512         /* Clear TFDDone, then TxDMA start to send this descriptor */
513         txdesc->status &= ~cpu_to_le64 (TFDDone);
514
515         DEBUG_TFD_DUMP (np);
516
517         /* TxDMAPollNow */
518         writel (readl (ioaddr + DMACtrl) | 0x00001000, ioaddr + DMACtrl);
519         np->cur_tx++;
520
521         if (np->cur_tx - np->old_tx < TX_QUEUE_LEN - 1 && np->speed != 10) {
522                 /* do nothing */
523         } else {
524                 np->tx_full = 1;
525                 netif_stop_queue (dev);
526         }
527
528         /* The first TFDListPtr */
529         if (readl (dev->base_addr + TFDListPtr0) == 0) {
530                 writel (np->tx_ring_dma + entry*sizeof(struct netdev_desc),
531                         dev->base_addr + TFDListPtr0);
532                 writel (0, dev->base_addr + TFDListPtr1);
533         }
534         
535         spin_lock_irqsave (&np->lock, flags);
536         if (np->old_tx > TX_RING_SIZE) {
537                 tx_shift = TX_RING_SIZE;
538                 np->old_tx -= tx_shift;
539                 np->cur_tx -= tx_shift;
540         }
541         spin_unlock_irqrestore (&np->lock, flags);      
542         
543         /* NETDEV WATCHDOG timer */
544         dev->trans_start = jiffies;
545         return 0;
546 }
547
548 static void
549 rio_interrupt (int irq, void *dev_instance, struct pt_regs *rgs)
550 {
551         struct net_device *dev = dev_instance;
552         struct netdev_private *np;
553         unsigned int_status;
554         long ioaddr;
555         int cnt = max_intrloop;
556
557         ioaddr = dev->base_addr;
558         np = dev->priv;
559         spin_lock (&np->lock);
560         while (1) {
561                 int_status = readw (ioaddr + IntStatus);
562                 writew (int_status & (HostError | TxComplete | RxComplete |
563                                       IntRequested | UpdateStats | LinkEvent |
564                                       TxDMAComplete | RxDMAComplete | RFDListEnd
565                                       | RxDMAPriority), ioaddr + IntStatus);
566                 if (int_status == 0)
567                         break;
568                 /* Processing received packets */
569                 receive_packet (dev);
570                 /* TxComplete interrupt */
571                 if (int_status & TxComplete) {
572                         int cnt = 20;
573                         int tx_status = readl (ioaddr + TxStatus);
574                         while (tx_status & 0x80) {      /* TxComplete */
575                                 /* Handle TxError */
576                                 if (tx_status & 0x01)
577                                         tx_error (dev, tx_status);
578                                 tx_status = readl (ioaddr + TxStatus);
579                                 /* too much TxError */
580                                 if (--cnt < 0)
581                                         break;
582                         }
583                         /* Send one packet each time at 10Mbps mode */
584                         if (np->speed == 10) {
585                                 np->tx_full = 0;
586                                 netif_wake_queue (dev);
587                         }
588                 }
589                 /* Free used tx skbuffs */
590                 for (; np->cur_tx - np->old_tx > 0; np->old_tx++) {
591                         int entry = np->old_tx % TX_RING_SIZE;
592                         struct sk_buff *skb;
593
594                         if (!(np->tx_ring[entry].status & TFDDone))
595                                 break;
596                         skb = np->tx_skbuff[entry];
597                         pci_unmap_single(np->pdev, np->tx_ring[entry].fraginfo,
598                                 skb->len, PCI_DMA_TODEVICE);
599                         dev_kfree_skb_irq (skb);
600                         np->tx_skbuff[entry] = 0;
601                 }
602                 /* If the ring is no longer full, clear tx_full and 
603                    call netif_wake_queue() */
604                 if (np->tx_full && np->cur_tx - np->old_tx < TX_QUEUE_LEN - 1) {
605                         np->tx_full = 0;
606                         netif_wake_queue (dev);
607                 }
608
609                 /* Handle uncommon events */
610                 if (int_status &
611                     (IntRequested | HostError | LinkEvent | UpdateStats))
612                         rio_error (dev, int_status);
613                 /* If too much interrupts here, disable all interrupts except 
614                    IntRequest. When CountDown down to 0, IntRequest will 
615                    be caught by rio_error() to recovery the interrupts */
616                 if (--cnt < 0) {
617                         get_stats (dev);
618                         writel (1000, ioaddr + CountDown);
619                         writew (IntRequested, ioaddr + IntEnable);
620                         break;
621                 }
622         }
623         spin_unlock (&np->lock);
624 }
625
626 static void
627 tx_error (struct net_device *dev, int tx_status)
628 {
629         struct netdev_private *np;
630         long ioaddr = dev->base_addr;
631         int frame_id;
632         int i;
633
634         np = dev->priv;
635
636         frame_id = (tx_status & 0xffff0000) >> 16;
637         printk (KERN_ERR "%s: Transmit error, TxStatus %4.4x, FrameId %d.\n",
638                 dev->name, tx_status, frame_id);
639         np->stats.tx_errors++;
640         np->stats.tx_dropped++;
641         /* Ttransmit Underrun */
642         if (tx_status & 0x10) {
643                 np->stats.tx_fifo_errors++;
644                 /* Transmit Underrun need to set TxReset, DMARest, FIFOReset */
645                 writew (TxReset | DMAReset | FIFOReset, ioaddr + ASICCtrl + 2);
646                 /* Wait for ResetBusy bit clear */
647                 for (i = 50; i > 0; i--) {
648                         if ((readw (ioaddr + ASICCtrl + 2) & ResetBusy) == 0)
649                                 break;
650                         mdelay (1);
651                 }
652                 /* Reset TFDListPtr */
653                 writel (np->tx_ring_dma + frame_id*sizeof(struct netdev_desc),
654                         dev->base_addr + TFDListPtr0);
655                 writel (0, dev->base_addr + TFDListPtr1);
656
657                 /* Let TxStartThresh stay default value */
658         }
659         /* Late Collision */
660         if (tx_status & 0x04) {
661                 np->stats.tx_fifo_errors++;
662                 /* TxReset and clear FIFO */
663                 writew (TxReset | FIFOReset, ioaddr + ASICCtrl + 2);
664                 /* Wait reset done */
665                 for (i = 50; i > 0; i--) {
666                         if ((readw (ioaddr + ASICCtrl + 2) & ResetBusy) == 0)
667                                 break;
668                         mdelay (1);
669                 }
670                 /* Let TxStartThresh stay default value */
671         }
672         /* Maximum Collisions */
673 #ifdef ETHER_STATS
674         if (tx_status & 0x08)
675                 np->stats.collisions16++;
676 #else
677         if (tx_status & 0x08)
678                 np->stats.collisions++;
679 #endif
680
681         /* Restart the Tx. */
682         writel (readw (dev->base_addr + MACCtrl) | TxEnable, ioaddr + MACCtrl);
683 }
684
685 /* Every interrupts go into here to see if any packet need to process, this
686    ensure Rx rings keep full in a critical cases of Rx rings ran out */
687 static int
688 receive_packet (struct net_device *dev)
689 {
690         struct netdev_private *np = (struct netdev_private *) dev->priv;
691         int entry = np->cur_rx % RX_RING_SIZE;
692         int cnt = np->old_rx + RX_RING_SIZE - np->cur_rx;
693         int rx_shift;
694
695         if (np->old_rx > RX_RING_SIZE) {
696                 rx_shift = RX_RING_SIZE;
697                 np->old_rx -= rx_shift;
698                 np->cur_rx -= rx_shift;
699         }
700         DEBUG_RFD_DUMP (np, 1);
701         /* If RFDDone, FrameStart and FrameEnd set, there is a new packet in. */
702         while (1) {
703                 struct netdev_desc *desc = &np->rx_ring[entry];
704                 int pkt_len;
705                 u64 frame_status; 
706
707                 if (!(desc->status & RFDDone) || 
708                         !(desc->status & FrameStart) ||
709                         !(desc->status & FrameEnd))
710                         break;
711
712                 /* Chip omits the CRC. */
713                 pkt_len = le64_to_cpu (desc->status & 0xffff);  
714                 frame_status = le64_to_cpu (desc->status);
715                 if (--cnt < 0)
716                         break;
717                 DEBUG_PKT_DUMP (np, pkt_len);
718                 pci_dma_sync_single(np->pdev, desc->fraginfo, np->rx_buf_sz,
719                         PCI_DMA_FROMDEVICE);
720                 /* Update rx error statistics, drop packet. */
721                 if (frame_status & 0x003f0000) {
722                         np->stats.rx_errors++;
723                         if (frame_status & 0x00100000)
724                                 np->stats.rx_length_errors++;
725                         if (frame_status & 0x00010000)
726                                 np->stats.rx_fifo_errors++;
727                         if (frame_status & 0x00060000)
728                                 np->stats.rx_frame_errors++;
729                         if (frame_status & 0x00080000)
730                                 np->stats.rx_crc_errors++;
731                 } else {
732                         struct sk_buff *skb;
733
734                         /* Small skbuffs for short packets */
735                         if (pkt_len > copy_thresh) {
736                                 pci_unmap_single(np->pdev, desc->fraginfo,
737                                         np->rx_buf_sz, PCI_DMA_FROMDEVICE);
738                                 skb_put (skb = np->rx_skbuff[entry], pkt_len);
739                                 np->rx_skbuff[entry] = NULL;
740                         } else if ((skb = dev_alloc_skb (pkt_len + 2)) != NULL) {
741                                 skb->dev = dev;
742                                 /* 16 byte align the IP header */
743                                 skb_reserve (skb, 2);
744                                 eth_copy_and_sum (skb,
745                                                   np->rx_skbuff[entry]->tail,
746                                                   pkt_len, 0);
747                                 skb_put (skb, pkt_len);
748                         }
749                         skb->protocol = eth_type_trans (skb, dev);
750 #ifdef RX_HW_CHECKSUM
751                         /* Checksum done by hw, but csum value unavailable. */
752                         if (!(frame_status & (TCPError | UDPError | IPError))) {
753                                 skb->ip_summed = CHECKSUM_UNNECESSARY;
754                         }
755 #endif
756                         netif_rx (skb);
757                         dev->last_rx = jiffies;
758                 }
759                 entry = (++np->cur_rx) % RX_RING_SIZE;
760         }
761
762         /* Re-allocate skbuffs to fill the descriptor ring */
763         for (; np->cur_rx - np->old_rx > 0; np->old_rx++) {
764                 struct sk_buff *skb;
765                 entry = np->old_rx % RX_RING_SIZE;
766                 /* Dropped packets don't need to re-allocate */
767                 if (np->rx_skbuff[entry] == NULL) {
768                         skb = dev_alloc_skb (np->rx_buf_sz);
769                         if (skb == NULL) {
770                                 np->rx_ring[entry].fraginfo = 0;
771                                 printk (KERN_ERR
772                                         "%s: Allocate Rx buffer error!",
773                                         dev->name);
774                                 break;
775                         }
776                         np->rx_skbuff[entry] = skb;
777                         skb->dev = dev;
778                         /* 16 byte align the IP header */
779                         skb_reserve (skb, 2);
780                         np->rx_ring[entry].fraginfo = cpu_to_le64(pci_map_single(
781                                 np->pdev, skb->tail, np->rx_buf_sz, 
782                                 PCI_DMA_FROMDEVICE));
783                 }
784                 np->rx_ring[entry].fraginfo |=
785                     cpu_to_le64 (np->rx_buf_sz) << 48;
786                 np->rx_ring[entry].status = 0;
787         }
788         /* RxDMAPollNow */
789         writel (readl (dev->base_addr + DMACtrl) | 0x00000010,
790                 dev->base_addr + DMACtrl);
791
792         DEBUG_RFD_DUMP (np, 2);
793         return 0;
794 }
795
796 static void
797 rio_error (struct net_device *dev, int int_status)
798 {
799         long ioaddr = dev->base_addr;
800         struct netdev_private *np = dev->priv;
801
802         /* Stop the down counter and recovery the interrupt */
803         if (int_status & IntRequested) {
804
805                 writew (0, ioaddr + IntEnable);
806                 writel (0, ioaddr + CountDown);
807                 /* Enable default interrupts */
808                 EnableInt ();
809         }
810
811         /* Link change event */
812         if (int_status & LinkEvent) {
813                 if (mii_wait_link (dev, 10) == 0) {
814                         printk (KERN_INFO "%s: Link up\n", dev->name);
815                         if (np->an_enable) {
816                                 /* Auto-Negotiation mode */
817                                 mii_get_media (dev);
818                                 if (np->full_duplex) {
819                                         writew (readw (dev->base_addr + MACCtrl)
820                                                 | DuplexSelect,
821                                                 ioaddr + MACCtrl);
822                                 }
823                         }
824                 } else {
825                         printk (KERN_INFO "%s: Link off\n", dev->name);
826                 }
827         }
828
829         /* UpdateStats statistics registers */
830         if (int_status & UpdateStats) {
831                 get_stats (dev);
832         }
833
834         /* PCI Error, a catastronphic error related to the bus interface 
835            occurs, set GlobalReset and HostReset to reset. */
836         if (int_status & HostError) {
837                 printk (KERN_ERR "%s: PCI Error! IntStatus %4.4x.\n",
838                         dev->name, int_status);
839                 writew (GlobalReset | HostReset, ioaddr + ASICCtrl + 2);
840                 mdelay (500);
841         }
842 }
843
844 static struct net_device_stats *
845 get_stats (struct net_device *dev)
846 {
847         long ioaddr = dev->base_addr;
848         struct netdev_private *np = dev->priv;
849         u16 temp1;
850         u16 temp2;
851         int i;
852         /* All statistics registers need to acknowledge,
853            else overflow could cause some problem */
854         np->stats.rx_packets += readl (ioaddr + FramesRcvOk);
855         np->stats.tx_packets += readl (ioaddr + FramesXmtOk);
856         np->stats.rx_bytes += readl (ioaddr + OctetRcvOk);
857         np->stats.tx_bytes += readl (ioaddr + OctetXmtOk);
858         temp1 = readw (ioaddr + FrameLostRxError);
859         np->stats.rx_errors += temp1;
860         np->stats.rx_missed_errors += temp1;
861         np->stats.tx_dropped += readw (ioaddr + FramesAbortXSColls);
862         temp1 = readl (ioaddr + SingleColFrames) +
863             readl (ioaddr + MultiColFrames) + readl (ioaddr + LateCollisions);
864         temp2 = readw (ioaddr + CarrierSenseErrors);
865         np->stats.tx_carrier_errors += temp2;
866         np->stats.tx_errors += readw (ioaddr + FramesWEXDeferal) +
867             readl (ioaddr + FramesWDeferredXmt) + temp2;
868
869         /* detailed rx_error */
870         np->stats.rx_length_errors += readw (ioaddr + InRangeLengthErrors) +
871             readw (ioaddr + FrameTooLongErrors);
872         np->stats.rx_crc_errors += readw (ioaddr + FrameCheckSeqError);
873
874         /* Clear all other statistic register. */
875         readw (ioaddr + MacControlFramesXmtd);
876         readw (ioaddr + BcstFramesXmtdOk);
877         readl (ioaddr + McstFramesXmtdOk);
878         readl (ioaddr + BcstOctetXmtOk);
879         readl (ioaddr + McstOctetXmtOk);
880         readw (ioaddr + MacControlFramesRcvd);
881         readw (ioaddr + BcstFramesRcvOk);
882         readl (ioaddr + McstFramesRcvOk);
883         readl (ioaddr + BcstOctetRcvOk);
884
885         for (i = 0x100; i <= 0x150; i += 4)
886                 readl (ioaddr + i);
887         readw (ioaddr + TxJumboFrames);
888         readw (ioaddr + RxJumboFrames);
889         readw (ioaddr + TCPCheckSumErrors);
890         readw (ioaddr + UDPCheckSumErrors);
891         readw (ioaddr + IPCheckSumErrors);
892         return &np->stats;
893 }
894
895 int
896 change_mtu (struct net_device *dev, int new_mtu)
897 {
898         struct netdev_private *np = dev->priv;
899         int max = (np->jumbo) ? 9000 : 1536;
900
901         if ((new_mtu < 68) || (new_mtu > max)) {
902                 return -EINVAL;
903         }
904
905         dev->mtu = new_mtu;
906
907         return 0;
908 }
909
910 #define CRC_POLY 0xedb88320
911 static unsigned
912 get_crc (unsigned char *p, int len)
913 {
914         int bit;
915         unsigned char byte;
916         unsigned crc = 0xffffffff;
917
918         while (--len >= 0) {
919                 byte = *p++;
920                 for (bit = 0; bit < 8; bit++, byte >>= 1) {
921                         crc = (crc >> 1) ^ (((crc ^ byte) & 1) ? CRC_POLY : 0);
922                 }
923         }
924         return crc;
925 }
926
927 static void
928 set_multicast (struct net_device *dev)
929 {
930         long ioaddr = dev->base_addr;
931         u32 hash_table[2];
932         u16 rx_mode = 0;
933         int i;
934         struct dev_mc_list *mclist;
935         struct netdev_private *np = dev->priv;
936
937         /* Default: receive broadcast and unicast */
938         rx_mode = ReceiveBroadcast | ReceiveUnicast;
939         if (dev->flags & IFF_PROMISC) {
940                 /* Receive all frames promiscuously. */
941                 rx_mode |= ReceiveAllFrames;
942         } else
943             if (((dev->flags & IFF_MULTICAST)
944                  && (dev->mc_count > multicast_filter_limit))
945                 || (dev->flags & IFF_ALLMULTI)) {
946                 /* Receive broadcast and multicast frames */
947                 rx_mode |= ReceiveBroadcast | ReceiveMulticast | ReceiveUnicast;
948         } else if ((dev->flags & IFF_MULTICAST) & (dev->mc_count > 0)) {
949                 /* Receive broadcast frames and multicast frames filtering by Hashtable */
950                 rx_mode |=
951                     ReceiveBroadcast | ReceiveMulticastHash | ReceiveUnicast;
952         }
953         if (np->vlan) {
954                 /* ReceiveVLANMatch field in ReceiveMode */
955                 rx_mode |= ReceiveVLANMatch;
956         }
957         hash_table[0] = 0x00000000;
958         hash_table[1] = 0x00000000;
959
960         for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
961              i++, mclist = mclist->next) {
962                 set_bit (get_crc (mclist->dmi_addr, ETH_ALEN) & 0x3f,
963                          hash_table);
964         }
965         writel (hash_table[0], ioaddr + HashTable0);
966         writel (hash_table[1], ioaddr + HashTable1);
967         writew (rx_mode, ioaddr + ReceiveMode);
968 }
969
970 static int
971 rio_ioctl (struct net_device *dev, struct ifreq *rq, int cmd)
972 {
973         int phy_addr;
974         struct netdev_private *np = dev->priv;
975         struct mii_data *miidata = (struct mii_data *) &rq->ifr_data;
976 #ifdef RIO_DEBUG
977         struct ioctl_data *iodata = (struct ioctl_data *) (rq->ifr_data);
978 #endif
979         u16 *data = (u16 *) & rq->ifr_data;
980         struct netdev_desc *desc;
981         int i;
982
983         phy_addr = np->phy_addr;
984         switch (cmd) {
985         case SIOCDEVPRIVATE:
986 #ifdef RIO_DEBUG
987                 if (rio_ioctl_ext (dev, iodata) != 0)
988                         return -EOPNOTSUPP;
989                 break;
990 #else
991                 return -EOPNOTSUPP;
992 #endif
993         case SIOCDEVPRIVATE + 1:
994                 miidata->out_value = mii_read (dev, phy_addr, miidata->reg_num);
995                 break;
996         case SIOCDEVPRIVATE + 2:
997                 mii_write (dev, phy_addr, miidata->reg_num, miidata->in_value);
998                 break;
999         case SIOCDEVPRIVATE + 3:
1000                 np->rx_debug = (data[0] <= 7) ? data[0] : 0;
1001                 printk ("rx_debug = %d\n", np->rx_debug);
1002                 break;
1003         case SIOCDEVPRIVATE + 4:
1004                 np->tx_debug = (data[0] <= 7) ? data[0] : 0;
1005                 printk ("tx_debug = %d\n", np->tx_debug);
1006                 break;
1007         case SIOCDEVPRIVATE + 5:
1008                 np->tx_full = 1;
1009                 netif_stop_queue (dev);
1010                 break;
1011         case SIOCDEVPRIVATE + 6:
1012                 np->tx_full = 0;
1013                 netif_wake_queue (dev);
1014                 break;
1015         case SIOCDEVPRIVATE + 7:
1016                 printk ("tx_full=%x cur_tx=%lx old_tx=%lx cur_rx=%lx old_rx=%lx\n",
1017                         np->tx_full, np->cur_tx, np->old_tx,
1018                         np->cur_rx, np->old_rx);
1019                 break;
1020         case SIOCDEVPRIVATE + 8:
1021                 for (i = 0; i < TX_RING_SIZE; i++) {
1022                         desc = &np->tx_ring[i];
1023                         printk
1024                                 ("cur:%08x next:%08x status:%08x frag1:%08x frag0:%08x",
1025                                 (u32) (np->tx_ring_dma + i*sizeof(*desc)),
1026                                 (u32) desc->next_desc,
1027                                 (u32) desc->status, (u32) (desc->fraginfo >> 32),
1028                                 (u32) desc->fraginfo);
1029                         printk ("\n");
1030                 }
1031                 printk ("\n");
1032                 break;
1033         default:
1034                 return -EOPNOTSUPP;
1035         }
1036         return 0;
1037 }
1038
1039 #ifdef RIO_DEBUG
1040 int
1041 rio_ioctl_ext (struct net_device *dev, struct ioctl_data *iodata)
1042 {
1043         struct netdev_private *np = dev->priv;
1044         int phy_addr = np->phy_addr;
1045         u32 hi, lo;
1046         int i;
1047         BMCR_t bmcr;
1048         BMSR_t bmsr;
1049
1050         if (iodata == NULL)
1051                 goto invalid_cmd;
1052         if (strcmp (iodata->signature, "rio") != 0)
1053                 goto invalid_cmd;
1054
1055         switch (iodata->cmd) {
1056         case 0:
1057                 for (i = 0; i < TX_RING_SIZE; i++) {
1058                         hi = np->tx_ring[i].status >> 32;
1059                         lo = np->tx_ring[i].status;
1060                         printk ("TFC=%08x %08x \n", hi, lo);
1061
1062                 }
1063                 break;
1064         case 1:
1065                 for (i = 0; i < RX_RING_SIZE; i++) {
1066                         hi = np->rx_ring[i].status >> 32;
1067                         lo = np->rx_ring[i].status;
1068                         printk ("RFS=%08x %08x \n", hi, lo);
1069                 }
1070                 break;
1071         case 2:
1072                 break;
1073         case 3:
1074                 if (iodata->data != NULL)
1075                         np->tx_debug = iodata->data[0];
1076                 break;
1077         case 4:
1078                 /* Soft reset PHY */
1079                 mii_write (dev, phy_addr, MII_BMCR, MII_BMCR_RESET);
1080                 bmcr.image = 0;
1081                 bmcr.bits.an_enable = 1;
1082                 bmcr.bits.reset = 1;
1083                 mii_write (dev, phy_addr, MII_BMCR, bmcr.image);
1084                 break;
1085         case 5:
1086                 mii_write (dev, phy_addr, MII_BMCR, 0x1940);
1087                 mdelay (10);
1088                 mii_write (dev, phy_addr, MII_BMCR, 0x1940);
1089                 mdelay (100);   /* wait a certain time */
1090                 break;
1091         case 6:
1092                 /* 5) Set media and Power Up */
1093                 bmcr.image = 0;
1094                 bmcr.bits.power_down = 1;
1095                 if (np->an_enable) {
1096                         bmcr.bits.an_enable = 1;
1097                 } else {
1098                         if (np->speed == 100) {
1099                                 bmcr.bits.speed100 = 1;
1100                                 bmcr.bits.speed1000 = 0;
1101                                 printk ("Manual 100 Mbps, ");
1102                         } else if (np->speed == 10) {
1103                                 bmcr.bits.speed100 = 0;
1104                                 bmcr.bits.speed1000 = 0;
1105                                 printk ("Manual 10 Mbps, ");
1106                         }
1107                         if (np->full_duplex) {
1108                                 bmcr.bits.duplex_mode = 1;
1109                                 printk ("Full duplex. \n");
1110                         } else {
1111                                 bmcr.bits.duplex_mode = 0;
1112                                 printk ("Half duplex.\n");
1113                         }
1114                 }
1115                 mii_write (dev, phy_addr, MII_BMCR, bmcr.image);
1116                 break;
1117         case 7:
1118                 bmcr.image = mii_read (dev, phy_addr, MII_BMCR);
1119                 bmsr.image = mii_read (dev, phy_addr, MII_BMSR);
1120                 printk ("BMCR=%x BMSR=%x LinkUp=%d\n",
1121                         bmcr.image, bmsr.image, bmsr.bits.link_status);
1122                 break;
1123
1124         default:
1125                 return -EOPNOTSUPP;
1126         }
1127         return 0;
1128
1129 invalid_cmd:
1130         return -1;
1131 }
1132 #endif
1133 #define EEP_READ 0x0200
1134 #define EEP_BUSY 0x8000
1135 /* Read the EEPROM word */
1136 int
1137 read_eeprom (long ioaddr, int eep_addr)
1138 {
1139         int i = 1000;
1140         writew (EEP_READ | (eep_addr & 0xff), ioaddr + EepromCtrl);
1141         while (i-- > 0) {
1142                 if (!(readw (ioaddr + EepromCtrl) & EEP_BUSY)) {
1143                         return readw (ioaddr + EepromData);
1144                 }
1145         }
1146         return 0;
1147 }
1148
1149 enum phy_ctrl_bits {
1150         MII_READ = 0x00, MII_CLK = 0x01, MII_DATA1 = 0x02, MII_WRITE = 0x04,
1151         MII_DUPLEX = 0x08,
1152 };
1153
1154 #define mii_delay() readb(ioaddr)
1155 static void
1156 mii_sendbit (struct net_device *dev, u32 data)
1157 {
1158         long ioaddr = dev->base_addr + PhyCtrl;
1159         data = (data) ? MII_DATA1 : 0;
1160         data |= MII_WRITE;
1161         data |= (readb (ioaddr) & 0xf8) | MII_WRITE;
1162         writeb (data, ioaddr);
1163         mii_delay ();
1164         writeb (data | MII_CLK, ioaddr);
1165         mii_delay ();
1166 }
1167
1168 static int
1169 mii_getbit (struct net_device *dev)
1170 {
1171         long ioaddr = dev->base_addr + PhyCtrl;
1172         u8 data;
1173
1174         data = (readb (ioaddr) & 0xf8) | MII_READ;
1175         writeb (data, ioaddr);
1176         mii_delay ();
1177         writeb (data | MII_CLK, ioaddr);
1178         mii_delay ();
1179         return ((readb (ioaddr) >> 1) & 1);
1180 }
1181
1182 static void
1183 mii_send_bits (struct net_device *dev, u32 data, int len)
1184 {
1185         int i;
1186         for (i = len - 1; i >= 0; i--) {
1187                 mii_sendbit (dev, data & (1 << i));
1188         }
1189 }
1190
1191 static int
1192 mii_read (struct net_device *dev, int phy_addr, int reg_num)
1193 {
1194         u32 cmd;
1195         int i;
1196         u32 retval = 0;
1197
1198         /* Preamble */
1199         mii_send_bits (dev, 0xffffffff, 32);
1200         /* ST(2), OP(2), ADDR(5), REG#(5), TA(2), Data(16) total 32 bits */
1201         /* ST,OP = 0110'b for read operation */
1202         cmd = (0x06 << 10 | phy_addr << 5 | reg_num);
1203         mii_send_bits (dev, cmd, 14);
1204         /* Turnaround */
1205         if (mii_getbit (dev))
1206                 goto err_out;
1207         /* Read data */
1208         for (i = 0; i < 16; i++) {
1209                 retval |= mii_getbit (dev);
1210                 retval <<= 1;
1211         }
1212         /* End cycle */
1213         mii_getbit (dev);
1214         return (retval >> 1) & 0xffff;
1215
1216 err_out:
1217         return 0;
1218 }
1219 static int
1220 mii_write (struct net_device *dev, int phy_addr, int reg_num, u16 data)
1221 {
1222         u32 cmd;
1223
1224         /* Preamble */
1225         mii_send_bits (dev, 0xffffffff, 32);
1226         /* ST(2), OP(2), ADDR(5), REG#(5), TA(2), Data(16) total 32 bits */
1227         /* ST,OP,AAAAA,RRRRR,TA = 0101xxxxxxxxxx10'b = 0x0502 for write */
1228         cmd = (0x5002 << 16) | (phy_addr << 23) | (reg_num << 18) | data;
1229         mii_send_bits (dev, cmd, 32);
1230         /* End cycle */
1231         mii_getbit (dev);
1232         return 0;
1233 }
1234 static int
1235 mii_wait_link (struct net_device *dev, int wait)
1236 {
1237         BMSR_t bmsr;
1238         int phy_addr;
1239         struct netdev_private *np;
1240
1241         np = dev->priv;
1242         phy_addr = np->phy_addr;
1243
1244         do {
1245                 bmsr.image = mii_read (dev, phy_addr, MII_BMSR);
1246                 if (bmsr.bits.link_status)
1247                         return 0;
1248                 mdelay (1);
1249         } while (--wait > 0);
1250         return -1;
1251 }
1252 static int
1253 mii_get_media (struct net_device *dev)
1254 {
1255         ANAR_t negotiate;
1256         BMSR_t bmsr;
1257         BMCR_t bmcr;
1258         MSCR_t mscr;
1259         MSSR_t mssr;
1260         int phy_addr;
1261         struct netdev_private *np;
1262
1263         np = dev->priv;
1264         phy_addr = np->phy_addr;
1265
1266         bmsr.image = mii_read (dev, phy_addr, MII_BMSR);
1267         if (np->an_enable) {
1268                 if (!bmsr.bits.an_complete) {
1269                         /* Auto-Negotiation not completed */
1270                         return -1;
1271                 }
1272                 negotiate.image = mii_read (dev, phy_addr, MII_ANAR) &
1273                     mii_read (dev, phy_addr, MII_ANLPAR);
1274                 mscr.image = mii_read (dev, phy_addr, MII_MSCR);
1275                 mssr.image = mii_read (dev, phy_addr, MII_MSSR);
1276                 if (mscr.bits.media_1000BT_FD & mssr.bits.lp_1000BT_FD) {
1277                         np->speed = 1000;
1278                         np->full_duplex = 1;
1279                         printk (KERN_INFO "Auto 1000BaseT, Full duplex.\n");
1280                 } else if (mscr.bits.media_1000BT_HD & mssr.bits.lp_1000BT_HD) {
1281                         np->speed = 1000;
1282                         np->full_duplex = 0;
1283                         printk (KERN_INFO "Auto 1000BaseT, Half duplex.\n");
1284                 } else if (negotiate.bits.media_100BX_FD) {
1285                         np->speed = 100;
1286                         np->full_duplex = 1;
1287                         printk (KERN_INFO "Auto 100BaseT, Full duplex.\n");
1288                 } else if (negotiate.bits.media_100BX_HD) {
1289                         np->speed = 100;
1290                         np->full_duplex = 0;
1291                         printk (KERN_INFO "Auto 100BaseT, Half duplex.\n");
1292                 } else if (negotiate.bits.media_10BT_FD) {
1293                         np->speed = 10;
1294                         np->full_duplex = 1;
1295                         printk (KERN_INFO "Auto 10BaseT, Full duplex.\n");
1296                 } else if (negotiate.bits.media_10BT_HD) {
1297                         np->speed = 10;
1298                         np->full_duplex = 0;
1299                         printk (KERN_INFO "Auto 10BaseT, Half duplex.\n");
1300                 }
1301         } else {
1302                 bmcr.image = mii_read (dev, phy_addr, MII_BMCR);
1303                 if (bmcr.bits.speed100 == 1 && bmcr.bits.speed1000 == 0) {
1304                         printk (KERN_INFO "Operating at 100 Mbps, ");
1305                 } else if (bmcr.bits.speed100 == 0 && bmcr.bits.speed1000 == 0) {
1306                         printk (KERN_INFO "Operating at 10 Mbps, ");
1307                 } else if (bmcr.bits.speed100 == 0 && bmcr.bits.speed1000 == 1) {
1308                         printk (KERN_INFO "Operating at 1000 Mbps, ");
1309                 }
1310                 if (bmcr.bits.duplex_mode) {
1311                         printk ("Full duplex.\n");
1312                 } else {
1313                         printk ("Half duplex.\n");
1314                 }
1315         }
1316         return 0;
1317 }
1318
1319 static int
1320 mii_set_media (struct net_device *dev)
1321 {
1322         PHY_SCR_t pscr;
1323         BMCR_t bmcr;
1324         BMSR_t bmsr;
1325         ANAR_t anar;
1326         int phy_addr;
1327         struct netdev_private *np;
1328         np = dev->priv;
1329         phy_addr = np->phy_addr;
1330
1331         /* Does user set speed? */
1332         if (np->an_enable) {
1333                 /* Reset to enable Auto-Negotiation */
1334                 bmsr.image = mii_read (dev, phy_addr, MII_BMSR);
1335                 anar.image = mii_read (dev, phy_addr, MII_ANAR);
1336                 anar.bits.media_100BX_FD = bmsr.bits.media_100BX_FD;
1337                 anar.bits.media_100BX_HD = bmsr.bits.media_100BX_HD;
1338                 anar.bits.media_100BT4 = bmsr.bits.media_100BT4;
1339                 anar.bits.media_10BT_FD = bmsr.bits.media_10BT_FD;
1340                 anar.bits.media_10BT_HD = bmsr.bits.media_10BT_HD;
1341                 mii_write (dev, phy_addr, MII_ANAR, anar.image);
1342
1343                 /* Enable Auto crossover */
1344                 pscr.image = mii_read (dev, phy_addr, MII_PHY_SCR);
1345                 pscr.bits.mdi_crossover_mode = 3;       /* 11'b */
1346                 mii_write (dev, phy_addr, MII_PHY_SCR, pscr.image);
1347                 /* Soft reset PHY */
1348                 mii_write (dev, phy_addr, MII_BMCR, MII_BMCR_RESET);
1349                 bmcr.image = 0;
1350                 bmcr.bits.an_enable = 1;
1351                 bmcr.bits.reset = 1;
1352                 mii_write (dev, phy_addr, MII_BMCR, bmcr.image);
1353                 /* Wait for Link up, link up need a certain time */
1354                 if (mii_wait_link (dev, 3200) != 0) {
1355                         printk (KERN_INFO "Link time out\n");
1356                 }
1357                 mdelay (1);
1358                 mii_get_media (dev);
1359         } else {
1360                 /* Force speed setting */
1361                 /* 1) Disable Auto crossover */
1362                 pscr.image = mii_read (dev, phy_addr, MII_PHY_SCR);
1363                 pscr.bits.mdi_crossover_mode = 0;
1364                 mii_write (dev, phy_addr, MII_PHY_SCR, pscr.image);
1365
1366                 /* 2) PHY Reset */
1367                 bmcr.image = mii_read (dev, phy_addr, MII_BMCR);
1368                 bmcr.bits.reset = 1;
1369                 mii_write (dev, phy_addr, MII_BMCR, bmcr.image);
1370
1371                 /* 3) Power Down */
1372                 bmcr.image = 0x1940;    /* must be 0x1940 */
1373                 mii_write (dev, phy_addr, MII_BMCR, bmcr.image);
1374                 mdelay (10);    /* wait a certain time */
1375
1376                 /* 4) Advertise nothing */
1377                 mii_write (dev, phy_addr, MII_ANAR, 0);
1378
1379                 /* 5) Set media and Power Up */
1380                 bmcr.image = 0;
1381                 bmcr.bits.power_down = 1;
1382                 if (np->speed == 100) {
1383                         bmcr.bits.speed100 = 1;
1384                         bmcr.bits.speed1000 = 0;
1385                         printk (KERN_INFO "Manual 100 Mbps, ");
1386                 } else if (np->speed == 10) {
1387                         bmcr.bits.speed100 = 0;
1388                         bmcr.bits.speed1000 = 0;
1389                         printk (KERN_INFO "Manual 10 Mbps, ");
1390                 }
1391                 if (np->full_duplex) {
1392                         bmcr.bits.duplex_mode = 1;
1393                         printk ("Full duplex. \n");
1394                 } else {
1395                         bmcr.bits.duplex_mode = 0;
1396                         printk ("Half duplex.\n");
1397                 }
1398 #if 0
1399                 /* Set 1000BaseT Master/Slave setting */
1400                 mscr.image = mii_read (dev, phy_addr, MII_MSCR);
1401                 mscr.bits.cfg_enable = 1;
1402                 mscr.bits.cfg_value = 0;
1403 #endif
1404                 mii_write (dev, phy_addr, MII_BMCR, bmcr.image);
1405
1406                 /* Wait for Link up, link up need a certain time */
1407                 if (mii_wait_link (dev, 3200) != 0) {
1408                         printk (KERN_INFO "Link time out\n");
1409                 }
1410                 mii_get_media (dev);
1411         }
1412         return 0;
1413 }
1414
1415 static int
1416 rio_close (struct net_device *dev)
1417 {
1418         long ioaddr = dev->base_addr;
1419         struct netdev_private *np = dev->priv;
1420         struct sk_buff *skb;
1421         int i;
1422
1423         netif_stop_queue (dev);
1424
1425         /* Disable interrupts */
1426         writew (0, ioaddr + IntEnable);
1427
1428         /* Stop Tx and Rx logics */
1429         writel (TxDisable | RxDisable | StatsDisable, ioaddr + MACCtrl);
1430         synchronize_irq ();
1431         free_irq (dev->irq, dev);
1432
1433         /* Free all the skbuffs in the queue. */
1434         for (i = 0; i < RX_RING_SIZE; i++) {
1435                 np->rx_ring[i].status = 0;
1436                 np->rx_ring[i].fraginfo = 0;
1437                 skb = np->rx_skbuff[i];
1438                 if (skb) {
1439                         pci_unmap_single(np->pdev, np->rx_ring[i].fraginfo, 
1440                                 skb->len, PCI_DMA_FROMDEVICE);
1441                         dev_kfree_skb (skb);
1442                         np->rx_skbuff[i] = 0;
1443                 }
1444         }
1445         for (i = 0; i < TX_RING_SIZE; i++) {
1446                 skb = np->tx_skbuff[i];
1447                 if (skb) {
1448                         pci_unmap_single(np->pdev, np->tx_ring[i].fraginfo, 
1449                                 skb->len, PCI_DMA_TODEVICE);
1450                         dev_kfree_skb (skb);
1451                         np->tx_skbuff[i] = 0;
1452                 }
1453         }
1454         return 0;
1455 }
1456
1457 static void __devexit
1458 rio_remove1 (struct pci_dev *pdev)
1459 {
1460         struct net_device *dev = pci_get_drvdata (pdev);
1461
1462         if (dev) {
1463                 struct netdev_private *np = dev->priv;
1464
1465                 unregister_netdev (dev);
1466                 pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, 
1467                         np->rx_ring_dma);
1468                 pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, 
1469                         np->tx_ring_dma);
1470 #ifndef USE_IO_OPS
1471                 iounmap ((char *) (dev->base_addr));
1472 #endif
1473                 kfree (dev);
1474                 pci_release_regions (pdev);
1475                 pci_disable_device (pdev);
1476         }
1477         pci_set_drvdata (pdev, NULL);
1478 }
1479
1480 static struct pci_driver rio_driver = {
1481         name:           "dl2k",
1482         id_table:       rio_pci_tbl,
1483         probe:          rio_probe1,
1484         remove:         rio_remove1,
1485 };
1486
1487 static int __init
1488 rio_init (void)
1489 {
1490 #ifdef MODULE
1491         printk ("%s", version);
1492 #endif
1493
1494         return pci_module_init (&rio_driver);
1495 }
1496
1497 static void __exit
1498 rio_exit (void)
1499 {
1500         pci_unregister_driver (&rio_driver);
1501 }
1502
1503 module_init (rio_init);
1504 module_exit (rio_exit);
1505
1506 /*
1507  
1508 Compile command: 
1509  
1510 gcc -D__KERNEL__ -DMODULE -I/usr/src/linux/include -Wall -Wstrict-prototypes -O2 -c dl2x.c
1511
1512 */