[PATCH] sis190: new PHY detection code.
[linux-2.6.git] / drivers / net / sis190.c
1 /*
2    sis190.c: Silicon Integrated Systems SiS190 ethernet driver
3
4    Copyright (c) 2003 K.M. Liu <kmliu@sis.com>
5    Copyright (c) 2003, 2004 Jeff Garzik <jgarzik@pobox.com>
6    Copyright (c) 2003, 2004, 2005 Francois Romieu <romieu@fr.zoreil.com>
7
8    Based on r8169.c, tg3.c, 8139cp.c, skge.c, epic100.c and SiS 190/191
9    genuine driver.
10
11    This software may be used and distributed according to the terms of
12    the GNU General Public License (GPL), incorporated herein by reference.
13    Drivers based on or derived from this code fall under the GPL and must
14    retain the authorship, copyright and license notice.  This file is not
15    a complete program and may only be used when the entire operating
16    system is licensed under the GPL.
17
18    See the file COPYING in this distribution for more information.
19
20  */
21
22 #include <linux/module.h>
23 #include <linux/moduleparam.h>
24 #include <linux/netdevice.h>
25 #include <linux/rtnetlink.h>
26 #include <linux/etherdevice.h>
27 #include <linux/ethtool.h>
28 #include <linux/pci.h>
29 #include <linux/mii.h>
30 #include <linux/delay.h>
31 #include <linux/crc32.h>
32 #include <linux/dma-mapping.h>
33 #include <asm/irq.h>
34
35 #define net_drv(p, arg...)      if (netif_msg_drv(p)) \
36                                         printk(arg)
37 #define net_probe(p, arg...)    if (netif_msg_probe(p)) \
38                                         printk(arg)
39 #define net_link(p, arg...)     if (netif_msg_link(p)) \
40                                         printk(arg)
41 #define net_intr(p, arg...)     if (netif_msg_intr(p)) \
42                                         printk(arg)
43 #define net_tx_err(p, arg...)   if (netif_msg_tx_err(p)) \
44                                         printk(arg)
45
46 #define PHY_MAX_ADDR            32
47 #define PHY_ID_ANY              0x1f
48 #define MII_REG_ANY             0x1f
49
50 #ifdef CONFIG_SIS190_NAPI
51 #define NAPI_SUFFIX     "-NAPI"
52 #else
53 #define NAPI_SUFFIX     ""
54 #endif
55
56 #define DRV_VERSION             "1.2" NAPI_SUFFIX
57 #define DRV_NAME                "sis190"
58 #define SIS190_DRIVER_NAME      DRV_NAME " Gigabit Ethernet driver " DRV_VERSION
59 #define PFX DRV_NAME ": "
60
61 #ifdef CONFIG_SIS190_NAPI
62 #define sis190_rx_skb                   netif_receive_skb
63 #define sis190_rx_quota(count, quota)   min(count, quota)
64 #else
65 #define sis190_rx_skb                   netif_rx
66 #define sis190_rx_quota(count, quota)   count
67 #endif
68
69 #define MAC_ADDR_LEN            6
70
71 #define NUM_TX_DESC             64      /* [8..1024] */
72 #define NUM_RX_DESC             64      /* [8..8192] */
73 #define TX_RING_BYTES           (NUM_TX_DESC * sizeof(struct TxDesc))
74 #define RX_RING_BYTES           (NUM_RX_DESC * sizeof(struct RxDesc))
75 #define RX_BUF_SIZE             1536
76 #define RX_BUF_MASK             0xfff8
77
78 #define SIS190_REGS_SIZE        0x80
79 #define SIS190_TX_TIMEOUT       (6*HZ)
80 #define SIS190_PHY_TIMEOUT      (10*HZ)
81 #define SIS190_MSG_DEFAULT      (NETIF_MSG_DRV | NETIF_MSG_PROBE | \
82                                  NETIF_MSG_LINK | NETIF_MSG_IFUP | \
83                                  NETIF_MSG_IFDOWN)
84
85 /* Enhanced PHY access register bit definitions */
86 #define EhnMIIread              0x0000
87 #define EhnMIIwrite             0x0020
88 #define EhnMIIdataShift         16
89 #define EhnMIIpmdShift          6       /* 7016 only */
90 #define EhnMIIregShift          11
91 #define EhnMIIreq               0x0010
92 #define EhnMIInotDone           0x0010
93
94 /* Write/read MMIO register */
95 #define SIS_W8(reg, val)        writeb ((val), ioaddr + (reg))
96 #define SIS_W16(reg, val)       writew ((val), ioaddr + (reg))
97 #define SIS_W32(reg, val)       writel ((val), ioaddr + (reg))
98 #define SIS_R8(reg)             readb (ioaddr + (reg))
99 #define SIS_R16(reg)            readw (ioaddr + (reg))
100 #define SIS_R32(reg)            readl (ioaddr + (reg))
101
102 #define SIS_PCI_COMMIT()        SIS_R32(IntrControl)
103
104 enum sis190_registers {
105         TxControl               = 0x00,
106         TxDescStartAddr         = 0x04,
107         rsv0                    = 0x08, // reserved
108         TxSts                   = 0x0c, // unused (Control/Status)
109         RxControl               = 0x10,
110         RxDescStartAddr         = 0x14,
111         rsv1                    = 0x18, // reserved
112         RxSts                   = 0x1c, // unused
113         IntrStatus              = 0x20,
114         IntrMask                = 0x24,
115         IntrControl             = 0x28,
116         IntrTimer               = 0x2c, // unused (Interupt Timer)
117         PMControl               = 0x30, // unused (Power Mgmt Control/Status)
118         rsv2                    = 0x34, // reserved
119         ROMControl              = 0x38,
120         ROMInterface            = 0x3c,
121         StationControl          = 0x40,
122         GMIIControl             = 0x44,
123         GIoCR                   = 0x48, // unused (GMAC IO Compensation)
124         GIoCtrl                 = 0x4c, // unused (GMAC IO Control)
125         TxMacControl            = 0x50,
126         TxLimit                 = 0x54, // unused (Tx MAC Timer/TryLimit)
127         RGDelay                 = 0x58, // unused (RGMII Tx Internal Delay)
128         rsv3                    = 0x5c, // reserved
129         RxMacControl            = 0x60,
130         RxMacAddr               = 0x62,
131         RxHashTable             = 0x68,
132         // Undocumented         = 0x6c,
133         RxWolCtrl               = 0x70,
134         RxWolData               = 0x74, // unused (Rx WOL Data Access)
135         RxMPSControl            = 0x78, // unused (Rx MPS Control)
136         rsv4                    = 0x7c, // reserved
137 };
138
139 enum sis190_register_content {
140         /* IntrStatus */
141         SoftInt                 = 0x40000000,   // unused
142         Timeup                  = 0x20000000,   // unused
143         PauseFrame              = 0x00080000,   // unused
144         MagicPacket             = 0x00040000,   // unused
145         WakeupFrame             = 0x00020000,   // unused
146         LinkChange              = 0x00010000,
147         RxQEmpty                = 0x00000080,
148         RxQInt                  = 0x00000040,
149         TxQ1Empty               = 0x00000020,   // unused
150         TxQ1Int                 = 0x00000010,
151         TxQ0Empty               = 0x00000008,   // unused
152         TxQ0Int                 = 0x00000004,
153         RxHalt                  = 0x00000002,
154         TxHalt                  = 0x00000001,
155
156         /* {Rx/Tx}CmdBits */
157         CmdReset                = 0x10,
158         CmdRxEnb                = 0x08,         // unused
159         CmdTxEnb                = 0x01,
160         RxBufEmpty              = 0x01,         // unused
161
162         /* Cfg9346Bits */
163         Cfg9346_Lock            = 0x00,         // unused
164         Cfg9346_Unlock          = 0xc0,         // unused
165
166         /* RxMacControl */
167         AcceptErr               = 0x20,         // unused
168         AcceptRunt              = 0x10,         // unused
169         AcceptBroadcast         = 0x0800,
170         AcceptMulticast         = 0x0400,
171         AcceptMyPhys            = 0x0200,
172         AcceptAllPhys           = 0x0100,
173
174         /* RxConfigBits */
175         RxCfgFIFOShift          = 13,
176         RxCfgDMAShift           = 8,            // 0x1a in RxControl ?
177
178         /* TxConfigBits */
179         TxInterFrameGapShift    = 24,
180         TxDMAShift              = 8, /* DMA burst value (0-7) is shift this many bits */
181
182         /* StationControl */
183         _1000bpsF               = 0x1c00,
184         _1000bpsH               = 0x0c00,
185         _100bpsF                = 0x1800,
186         _100bpsH                = 0x0800,
187         _10bpsF                 = 0x1400,
188         _10bpsH                 = 0x0400,
189
190         LinkStatus              = 0x02,         // unused
191         FullDup                 = 0x01,         // unused
192
193         /* TBICSRBit */
194         TBILinkOK               = 0x02000000,   // unused
195 };
196
197 struct TxDesc {
198         __le32 PSize;
199         __le32 status;
200         __le32 addr;
201         __le32 size;
202 };
203
204 struct RxDesc {
205         __le32 PSize;
206         __le32 status;
207         __le32 addr;
208         __le32 size;
209 };
210
211 enum _DescStatusBit {
212         /* _Desc.status */
213         OWNbit          = 0x80000000, // RXOWN/TXOWN
214         INTbit          = 0x40000000, // RXINT/TXINT
215         CRCbit          = 0x00020000, // CRCOFF/CRCEN
216         PADbit          = 0x00010000, // PREADD/PADEN
217         /* _Desc.size */
218         RingEnd         = 0x80000000,
219         /* TxDesc.status */
220         LSEN            = 0x08000000, // TSO ? -- FR
221         IPCS            = 0x04000000,
222         TCPCS           = 0x02000000,
223         UDPCS           = 0x01000000,
224         BSTEN           = 0x00800000,
225         EXTEN           = 0x00400000,
226         DEFEN           = 0x00200000,
227         BKFEN           = 0x00100000,
228         CRSEN           = 0x00080000,
229         COLEN           = 0x00040000,
230         THOL3           = 0x30000000,
231         THOL2           = 0x20000000,
232         THOL1           = 0x10000000,
233         THOL0           = 0x00000000,
234         /* RxDesc.status */
235         IPON            = 0x20000000,
236         TCPON           = 0x10000000,
237         UDPON           = 0x08000000,
238         Wakup           = 0x00400000,
239         Magic           = 0x00200000,
240         Pause           = 0x00100000,
241         DEFbit          = 0x00200000,
242         BCAST           = 0x000c0000,
243         MCAST           = 0x00080000,
244         UCAST           = 0x00040000,
245         /* RxDesc.PSize */
246         TAGON           = 0x80000000,
247         RxDescCountMask = 0x7f000000, // multi-desc pkt when > 1 ? -- FR
248         ABORT           = 0x00800000,
249         SHORT           = 0x00400000,
250         LIMIT           = 0x00200000,
251         MIIER           = 0x00100000,
252         OVRUN           = 0x00080000,
253         NIBON           = 0x00040000,
254         COLON           = 0x00020000,
255         CRCOK           = 0x00010000,
256         RxSizeMask      = 0x0000ffff
257         /*
258          * The asic could apparently do vlan, TSO, jumbo (sis191 only) and
259          * provide two (unused with Linux) Tx queues. No publically
260          * available documentation alas.
261          */
262 };
263
264 enum sis190_eeprom_access_register_bits {
265         EECS    = 0x00000001,   // unused
266         EECLK   = 0x00000002,   // unused
267         EEDO    = 0x00000008,   // unused
268         EEDI    = 0x00000004,   // unused
269         EEREQ   = 0x00000080,
270         EEROP   = 0x00000200,
271         EEWOP   = 0x00000100    // unused
272 };
273
274 /* EEPROM Addresses */
275 enum sis190_eeprom_address {
276         EEPROMSignature = 0x00,
277         EEPROMCLK       = 0x01, // unused
278         EEPROMInfo      = 0x02,
279         EEPROMMACAddr   = 0x03
280 };
281
282 struct sis190_private {
283         void __iomem *mmio_addr;
284         struct pci_dev *pci_dev;
285         struct net_device_stats stats;
286         spinlock_t lock;
287         u32 rx_buf_sz;
288         u32 cur_rx;
289         u32 cur_tx;
290         u32 dirty_rx;
291         u32 dirty_tx;
292         dma_addr_t rx_dma;
293         dma_addr_t tx_dma;
294         struct RxDesc *RxDescRing;
295         struct TxDesc *TxDescRing;
296         struct sk_buff *Rx_skbuff[NUM_RX_DESC];
297         struct sk_buff *Tx_skbuff[NUM_TX_DESC];
298         struct work_struct phy_task;
299         struct timer_list timer;
300         u32 msg_enable;
301         struct mii_if_info mii_if;
302         struct list_head first_phy;
303 };
304
305 struct sis190_phy {
306         struct list_head list;
307         int phy_id;
308         u16 id[2];
309         u16 status;
310         u8  type;
311 };
312
313 enum sis190_phy_type {
314         UNKNOWN = 0x00,
315         HOME    = 0x01,
316         LAN     = 0x02,
317         MIX     = 0x03
318 };
319
320 static struct mii_chip_info {
321         const char *name;
322         u16 id[2];
323         unsigned int type;
324 } mii_chip_table[] = {
325         { "Broadcom PHY BCM5461", { 0x0020, 0x60c0 }, LAN },
326         { "Agere PHY ET1101B",    { 0x0282, 0xf010 }, LAN },
327         { "Marvell PHY 88E1111",  { 0x0141, 0x0cc0 }, LAN },
328         { NULL, }
329 };
330
331 const static struct {
332         const char *name;
333         u8 version;             /* depend on docs */
334         u32 RxConfigMask;       /* clear the bits supported by this chip */
335 } sis_chip_info[] = {
336         { DRV_NAME, 0x00, 0xff7e1880, },
337 };
338
339 static struct pci_device_id sis190_pci_tbl[] __devinitdata = {
340         { PCI_DEVICE(PCI_VENDOR_ID_SI, 0x0190), 0, 0, 0 },
341         { 0, },
342 };
343
344 MODULE_DEVICE_TABLE(pci, sis190_pci_tbl);
345
346 static int rx_copybreak = 200;
347
348 static struct {
349         u32 msg_enable;
350 } debug = { -1 };
351
352 MODULE_DESCRIPTION("SiS sis190 Gigabit Ethernet driver");
353 module_param(rx_copybreak, int, 0);
354 MODULE_PARM_DESC(rx_copybreak, "Copy breakpoint for copy-only-tiny-frames");
355 module_param_named(debug, debug.msg_enable, int, 0);
356 MODULE_PARM_DESC(debug, "Debug verbosity level (0=none, ..., 16=all)");
357 MODULE_AUTHOR("K.M. Liu <kmliu@sis.com>, Ueimor <romieu@fr.zoreil.com>");
358 MODULE_VERSION(DRV_VERSION);
359 MODULE_LICENSE("GPL");
360
361 static const u32 sis190_intr_mask =
362         RxQEmpty | RxQInt | TxQ1Int | TxQ0Int | RxHalt | TxHalt;
363
364 /*
365  * Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
366  * The chips use a 64 element hash table based on the Ethernet CRC.
367  */
368 static int multicast_filter_limit = 32;
369
370 static void __mdio_cmd(void __iomem *ioaddr, u32 ctl)
371 {
372         unsigned int i;
373
374         SIS_W32(GMIIControl, ctl);
375
376         msleep(1);
377
378         for (i = 0; i < 100; i++) {
379                 if (!(SIS_R32(GMIIControl) & EhnMIInotDone))
380                         break;
381                 msleep(1);
382         }
383
384         if (i > 999)
385                 printk(KERN_ERR PFX "PHY command failed !\n");
386 }
387
388 static void mdio_write(void __iomem *ioaddr, int phy_id, int reg, int val)
389 {
390         __mdio_cmd(ioaddr, EhnMIIreq | EhnMIIwrite |
391                 (((u32) reg) << EhnMIIregShift) | (phy_id << EhnMIIpmdShift) |
392                 (((u32) val) << EhnMIIdataShift));
393 }
394
395 static int mdio_read(void __iomem *ioaddr, int phy_id, int reg)
396 {
397         __mdio_cmd(ioaddr, EhnMIIreq | EhnMIIread |
398                 (((u32) reg) << EhnMIIregShift) | (phy_id << EhnMIIpmdShift));
399
400         return (u16) (SIS_R32(GMIIControl) >> EhnMIIdataShift);
401 }
402
403 static void __mdio_write(struct net_device *dev, int phy_id, int reg, int val)
404 {
405         struct sis190_private *tp = netdev_priv(dev);
406
407         mdio_write(tp->mmio_addr, phy_id, reg, val);
408 }
409
410 static int __mdio_read(struct net_device *dev, int phy_id, int reg)
411 {
412         struct sis190_private *tp = netdev_priv(dev);
413
414         return mdio_read(tp->mmio_addr, phy_id, reg);
415 }
416
417 static u16 mdio_read_latched(void __iomem *ioaddr, int phy_id, int reg)
418 {
419         mdio_read(ioaddr, phy_id, reg);
420         return mdio_read(ioaddr, phy_id, reg);
421 }
422
423 static u16 __devinit sis190_read_eeprom(void __iomem *ioaddr, u32 reg)
424 {
425         u16 data = 0xffff;
426         unsigned int i;
427
428         if (!(SIS_R32(ROMControl) & 0x0002))
429                 return 0;
430
431         SIS_W32(ROMInterface, EEREQ | EEROP | (reg << 10));
432
433         for (i = 0; i < 200; i++) {
434                 if (!(SIS_R32(ROMInterface) & EEREQ)) {
435                         data = (SIS_R32(ROMInterface) & 0xffff0000) >> 16;
436                         break;
437                 }
438                 msleep(1);
439         }
440
441         return data;
442 }
443
444 static void sis190_irq_mask_and_ack(void __iomem *ioaddr)
445 {
446         SIS_W32(IntrMask, 0x00);
447         SIS_W32(IntrStatus, 0xffffffff);
448         SIS_PCI_COMMIT();
449 }
450
451 static void sis190_asic_down(void __iomem *ioaddr)
452 {
453         /* Stop the chip's Tx and Rx DMA processes. */
454
455         SIS_W32(TxControl, 0x1a00);
456         SIS_W32(RxControl, 0x1a00);
457
458         sis190_irq_mask_and_ack(ioaddr);
459 }
460
461 static void sis190_mark_as_last_descriptor(struct RxDesc *desc)
462 {
463         desc->size |= cpu_to_le32(RingEnd);
464 }
465
466 static inline void sis190_give_to_asic(struct RxDesc *desc, u32 rx_buf_sz)
467 {
468         u32 eor = le32_to_cpu(desc->size) & RingEnd;
469
470         desc->PSize = 0x0;
471         desc->size = cpu_to_le32((rx_buf_sz & RX_BUF_MASK) | eor);
472         wmb();
473         desc->status = cpu_to_le32(OWNbit | INTbit);
474 }
475
476 static inline void sis190_map_to_asic(struct RxDesc *desc, dma_addr_t mapping,
477                                       u32 rx_buf_sz)
478 {
479         desc->addr = cpu_to_le32(mapping);
480         sis190_give_to_asic(desc, rx_buf_sz);
481 }
482
483 static inline void sis190_make_unusable_by_asic(struct RxDesc *desc)
484 {
485         desc->PSize = 0x0;
486         desc->addr = 0xdeadbeef;
487         desc->size &= cpu_to_le32(RingEnd);
488         wmb();
489         desc->status = 0x0;
490 }
491
492 static int sis190_alloc_rx_skb(struct pci_dev *pdev, struct sk_buff **sk_buff,
493                                struct RxDesc *desc, u32 rx_buf_sz)
494 {
495         struct sk_buff *skb;
496         dma_addr_t mapping;
497         int ret = 0;
498
499         skb = dev_alloc_skb(rx_buf_sz);
500         if (!skb)
501                 goto err_out;
502
503         *sk_buff = skb;
504
505         mapping = pci_map_single(pdev, skb->data, rx_buf_sz,
506                                  PCI_DMA_FROMDEVICE);
507
508         sis190_map_to_asic(desc, mapping, rx_buf_sz);
509 out:
510         return ret;
511
512 err_out:
513         ret = -ENOMEM;
514         sis190_make_unusable_by_asic(desc);
515         goto out;
516 }
517
518 static u32 sis190_rx_fill(struct sis190_private *tp, struct net_device *dev,
519                           u32 start, u32 end)
520 {
521         u32 cur;
522
523         for (cur = start; cur < end; cur++) {
524                 int ret, i = cur % NUM_RX_DESC;
525
526                 if (tp->Rx_skbuff[i])
527                         continue;
528
529                 ret = sis190_alloc_rx_skb(tp->pci_dev, tp->Rx_skbuff + i,
530                                           tp->RxDescRing + i, tp->rx_buf_sz);
531                 if (ret < 0)
532                         break;
533         }
534         return cur - start;
535 }
536
537 static inline int sis190_try_rx_copy(struct sk_buff **sk_buff, int pkt_size,
538                                      struct RxDesc *desc, int rx_buf_sz)
539 {
540         int ret = -1;
541
542         if (pkt_size < rx_copybreak) {
543                 struct sk_buff *skb;
544
545                 skb = dev_alloc_skb(pkt_size + NET_IP_ALIGN);
546                 if (skb) {
547                         skb_reserve(skb, NET_IP_ALIGN);
548                         eth_copy_and_sum(skb, sk_buff[0]->data, pkt_size, 0);
549                         *sk_buff = skb;
550                         sis190_give_to_asic(desc, rx_buf_sz);
551                         ret = 0;
552                 }
553         }
554         return ret;
555 }
556
557 static inline int sis190_rx_pkt_err(u32 status, struct net_device_stats *stats)
558 {
559 #define ErrMask (OVRUN | SHORT | LIMIT | MIIER | NIBON | COLON | ABORT)
560
561         if ((status & CRCOK) && !(status & ErrMask))
562                 return 0;
563
564         if (!(status & CRCOK))
565                 stats->rx_crc_errors++;
566         else if (status & OVRUN)
567                 stats->rx_over_errors++;
568         else if (status & (SHORT | LIMIT))
569                 stats->rx_length_errors++;
570         else if (status & (MIIER | NIBON | COLON))
571                 stats->rx_frame_errors++;
572
573         stats->rx_errors++;
574         return -1;
575 }
576
577 static int sis190_rx_interrupt(struct net_device *dev,
578                                struct sis190_private *tp, void __iomem *ioaddr)
579 {
580         struct net_device_stats *stats = &tp->stats;
581         u32 rx_left, cur_rx = tp->cur_rx;
582         u32 delta, count;
583
584         rx_left = NUM_RX_DESC + tp->dirty_rx - cur_rx;
585         rx_left = sis190_rx_quota(rx_left, (u32) dev->quota);
586
587         for (; rx_left > 0; rx_left--, cur_rx++) {
588                 unsigned int entry = cur_rx % NUM_RX_DESC;
589                 struct RxDesc *desc = tp->RxDescRing + entry;
590                 u32 status;
591
592                 if (desc->status & OWNbit)
593                         break;
594
595                 status = le32_to_cpu(desc->PSize);
596
597                 // net_intr(tp, KERN_INFO "%s: Rx PSize = %08x.\n", dev->name,
598                 //       status);
599
600                 if (sis190_rx_pkt_err(status, stats) < 0)
601                         sis190_give_to_asic(desc, tp->rx_buf_sz);
602                 else {
603                         struct sk_buff *skb = tp->Rx_skbuff[entry];
604                         int pkt_size = (status & RxSizeMask) - 4;
605                         void (*pci_action)(struct pci_dev *, dma_addr_t,
606                                 size_t, int) = pci_dma_sync_single_for_device;
607
608                         if (unlikely(pkt_size > tp->rx_buf_sz)) {
609                                 net_intr(tp, KERN_INFO
610                                          "%s: (frag) status = %08x.\n",
611                                          dev->name, status);
612                                 stats->rx_dropped++;
613                                 stats->rx_length_errors++;
614                                 sis190_give_to_asic(desc, tp->rx_buf_sz);
615                                 continue;
616                         }
617
618                         pci_dma_sync_single_for_cpu(tp->pci_dev,
619                                 le32_to_cpu(desc->addr), tp->rx_buf_sz,
620                                 PCI_DMA_FROMDEVICE);
621
622                         if (sis190_try_rx_copy(&skb, pkt_size, desc,
623                                                tp->rx_buf_sz)) {
624                                 pci_action = pci_unmap_single;
625                                 tp->Rx_skbuff[entry] = NULL;
626                                 sis190_make_unusable_by_asic(desc);
627                         }
628
629                         pci_action(tp->pci_dev, le32_to_cpu(desc->addr),
630                                    tp->rx_buf_sz, PCI_DMA_FROMDEVICE);
631
632                         skb->dev = dev;
633                         skb_put(skb, pkt_size);
634                         skb->protocol = eth_type_trans(skb, dev);
635
636                         sis190_rx_skb(skb);
637
638                         dev->last_rx = jiffies;
639                         stats->rx_packets++;
640                         stats->rx_bytes += pkt_size;
641                         if ((status & BCAST) == MCAST)
642                                 stats->multicast++;
643                 }
644         }
645         count = cur_rx - tp->cur_rx;
646         tp->cur_rx = cur_rx;
647
648         delta = sis190_rx_fill(tp, dev, tp->dirty_rx, tp->cur_rx);
649         if (!delta && count && netif_msg_intr(tp))
650                 printk(KERN_INFO "%s: no Rx buffer allocated.\n", dev->name);
651         tp->dirty_rx += delta;
652
653         if (((tp->dirty_rx + NUM_RX_DESC) == tp->cur_rx) && netif_msg_intr(tp))
654                 printk(KERN_EMERG "%s: Rx buffers exhausted.\n", dev->name);
655
656         return count;
657 }
658
659 static void sis190_unmap_tx_skb(struct pci_dev *pdev, struct sk_buff *skb,
660                                 struct TxDesc *desc)
661 {
662         unsigned int len;
663
664         len = skb->len < ETH_ZLEN ? ETH_ZLEN : skb->len;
665
666         pci_unmap_single(pdev, le32_to_cpu(desc->addr), len, PCI_DMA_TODEVICE);
667
668         memset(desc, 0x00, sizeof(*desc));
669 }
670
671 static void sis190_tx_interrupt(struct net_device *dev,
672                                 struct sis190_private *tp, void __iomem *ioaddr)
673 {
674         u32 pending, dirty_tx = tp->dirty_tx;
675         /*
676          * It would not be needed if queueing was allowed to be enabled
677          * again too early (hint: think preempt and unclocked smp systems).
678          */
679         unsigned int queue_stopped;
680
681         smp_rmb();
682         pending = tp->cur_tx - dirty_tx;
683         queue_stopped = (pending == NUM_TX_DESC);
684
685         for (; pending; pending--, dirty_tx++) {
686                 unsigned int entry = dirty_tx % NUM_TX_DESC;
687                 struct TxDesc *txd = tp->TxDescRing + entry;
688                 struct sk_buff *skb;
689
690                 if (le32_to_cpu(txd->status) & OWNbit)
691                         break;
692
693                 skb = tp->Tx_skbuff[entry];
694
695                 tp->stats.tx_packets++;
696                 tp->stats.tx_bytes += skb->len;
697
698                 sis190_unmap_tx_skb(tp->pci_dev, skb, txd);
699                 tp->Tx_skbuff[entry] = NULL;
700                 dev_kfree_skb_irq(skb);
701         }
702
703         if (tp->dirty_tx != dirty_tx) {
704                 tp->dirty_tx = dirty_tx;
705                 smp_wmb();
706                 if (queue_stopped)
707                         netif_wake_queue(dev);
708         }
709 }
710
711 /*
712  * The interrupt handler does all of the Rx thread work and cleans up after
713  * the Tx thread.
714  */
715 static irqreturn_t sis190_interrupt(int irq, void *__dev, struct pt_regs *regs)
716 {
717         struct net_device *dev = __dev;
718         struct sis190_private *tp = netdev_priv(dev);
719         void __iomem *ioaddr = tp->mmio_addr;
720         unsigned int handled = 0;
721         u32 status;
722
723         status = SIS_R32(IntrStatus);
724
725         if ((status == 0xffffffff) || !status)
726                 goto out;
727
728         handled = 1;
729
730         if (unlikely(!netif_running(dev))) {
731                 sis190_asic_down(ioaddr);
732                 goto out;
733         }
734
735         SIS_W32(IntrStatus, status);
736
737         // net_intr(tp, KERN_INFO "%s: status = %08x.\n", dev->name, status);
738
739         if (status & LinkChange) {
740                 net_intr(tp, KERN_INFO "%s: link change.\n", dev->name);
741                 schedule_work(&tp->phy_task);
742         }
743
744         if (status & RxQInt)
745                 sis190_rx_interrupt(dev, tp, ioaddr);
746
747         if (status & TxQ0Int)
748                 sis190_tx_interrupt(dev, tp, ioaddr);
749 out:
750         return IRQ_RETVAL(handled);
751 }
752
753 #ifdef CONFIG_NET_POLL_CONTROLLER
754 static void sis190_netpoll(struct net_device *dev)
755 {
756         struct sis190_private *tp = netdev_priv(dev);
757         struct pci_dev *pdev = tp->pci_dev;
758
759         disable_irq(pdev->irq);
760         sis190_interrupt(pdev->irq, dev, NULL);
761         enable_irq(pdev->irq);
762 }
763 #endif
764
765 static void sis190_free_rx_skb(struct sis190_private *tp,
766                                struct sk_buff **sk_buff, struct RxDesc *desc)
767 {
768         struct pci_dev *pdev = tp->pci_dev;
769
770         pci_unmap_single(pdev, le32_to_cpu(desc->addr), tp->rx_buf_sz,
771                          PCI_DMA_FROMDEVICE);
772         dev_kfree_skb(*sk_buff);
773         *sk_buff = NULL;
774         sis190_make_unusable_by_asic(desc);
775 }
776
777 static void sis190_rx_clear(struct sis190_private *tp)
778 {
779         unsigned int i;
780
781         for (i = 0; i < NUM_RX_DESC; i++) {
782                 if (!tp->Rx_skbuff[i])
783                         continue;
784                 sis190_free_rx_skb(tp, tp->Rx_skbuff + i, tp->RxDescRing + i);
785         }
786 }
787
788 static void sis190_init_ring_indexes(struct sis190_private *tp)
789 {
790         tp->dirty_tx = tp->dirty_rx = tp->cur_tx = tp->cur_rx = 0;
791 }
792
793 static int sis190_init_ring(struct net_device *dev)
794 {
795         struct sis190_private *tp = netdev_priv(dev);
796
797         sis190_init_ring_indexes(tp);
798
799         memset(tp->Tx_skbuff, 0x0, NUM_TX_DESC * sizeof(struct sk_buff *));
800         memset(tp->Rx_skbuff, 0x0, NUM_RX_DESC * sizeof(struct sk_buff *));
801
802         if (sis190_rx_fill(tp, dev, 0, NUM_RX_DESC) != NUM_RX_DESC)
803                 goto err_rx_clear;
804
805         sis190_mark_as_last_descriptor(tp->RxDescRing + NUM_RX_DESC - 1);
806
807         return 0;
808
809 err_rx_clear:
810         sis190_rx_clear(tp);
811         return -ENOMEM;
812 }
813
814 static void sis190_set_rx_mode(struct net_device *dev)
815 {
816         struct sis190_private *tp = netdev_priv(dev);
817         void __iomem *ioaddr = tp->mmio_addr;
818         unsigned long flags;
819         u32 mc_filter[2];       /* Multicast hash filter */
820         u16 rx_mode;
821
822         if (dev->flags & IFF_PROMISC) {
823                 /* Unconditionally log net taps. */
824                 net_drv(tp, KERN_NOTICE "%s: Promiscuous mode enabled.\n",
825                         dev->name);
826                 rx_mode =
827                         AcceptBroadcast | AcceptMulticast | AcceptMyPhys |
828                         AcceptAllPhys;
829                 mc_filter[1] = mc_filter[0] = 0xffffffff;
830         } else if ((dev->mc_count > multicast_filter_limit) ||
831                    (dev->flags & IFF_ALLMULTI)) {
832                 /* Too many to filter perfectly -- accept all multicasts. */
833                 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
834                 mc_filter[1] = mc_filter[0] = 0xffffffff;
835         } else {
836                 struct dev_mc_list *mclist;
837                 unsigned int i;
838
839                 rx_mode = AcceptBroadcast | AcceptMyPhys;
840                 mc_filter[1] = mc_filter[0] = 0;
841                 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
842                      i++, mclist = mclist->next) {
843                         int bit_nr =
844                                 ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26;
845                         mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
846                         rx_mode |= AcceptMulticast;
847                 }
848         }
849
850         spin_lock_irqsave(&tp->lock, flags);
851
852         SIS_W16(RxMacControl, rx_mode | 0x2);
853         SIS_W32(RxHashTable, mc_filter[0]);
854         SIS_W32(RxHashTable + 4, mc_filter[1]);
855
856         spin_unlock_irqrestore(&tp->lock, flags);
857 }
858
859 static void sis190_soft_reset(void __iomem *ioaddr)
860 {
861         SIS_W32(IntrControl, 0x8000);
862         SIS_PCI_COMMIT();
863         msleep(1);
864         SIS_W32(IntrControl, 0x0);
865         sis190_asic_down(ioaddr);
866         msleep(1);
867 }
868
869 static void sis190_hw_start(struct net_device *dev)
870 {
871         struct sis190_private *tp = netdev_priv(dev);
872         void __iomem *ioaddr = tp->mmio_addr;
873
874         sis190_soft_reset(ioaddr);
875
876         SIS_W32(TxDescStartAddr, tp->tx_dma);
877         SIS_W32(RxDescStartAddr, tp->rx_dma);
878
879         SIS_W32(IntrStatus, 0xffffffff);
880         SIS_W32(IntrMask, 0x0);
881         /*
882          * Default is 100Mbps.
883          * A bit strange: 100Mbps is 0x1801 elsewhere -- FR 2005/06/09
884          */
885         SIS_W16(StationControl, 0x1901);
886         SIS_W32(GMIIControl, 0x0);
887         SIS_W32(TxMacControl, 0x60);
888         SIS_W16(RxMacControl, 0x02);
889         SIS_W32(RxHashTable, 0x0);
890         SIS_W32(0x6c, 0x0);
891         SIS_W32(RxWolCtrl, 0x0);
892         SIS_W32(RxWolData, 0x0);
893
894         SIS_PCI_COMMIT();
895
896         sis190_set_rx_mode(dev);
897
898         /* Enable all known interrupts by setting the interrupt mask. */
899         SIS_W32(IntrMask, sis190_intr_mask);
900
901         SIS_W32(TxControl, 0x1a00 | CmdTxEnb);
902         SIS_W32(RxControl, 0x1a1d);
903
904         netif_start_queue(dev);
905 }
906
907 static void sis190_phy_task(void * data)
908 {
909         struct net_device *dev = data;
910         struct sis190_private *tp = netdev_priv(dev);
911         void __iomem *ioaddr = tp->mmio_addr;
912         int phy_id = tp->mii_if.phy_id;
913         u16 val;
914
915         rtnl_lock();
916
917         val = mdio_read(ioaddr, phy_id, MII_BMCR);
918         if (val & BMCR_RESET) {
919                 // FIXME: needlessly high ?  -- FR 02/07/2005
920                 mod_timer(&tp->timer, jiffies + HZ/10);
921         } else if (!(mdio_read_latched(ioaddr, phy_id, MII_BMSR) &
922                      BMSR_ANEGCOMPLETE)) {
923                 net_link(tp, KERN_WARNING "%s: PHY reset until link up.\n",
924                          dev->name);
925                 mdio_write(ioaddr, phy_id, MII_BMCR, val | BMCR_RESET);
926                 mod_timer(&tp->timer, jiffies + SIS190_PHY_TIMEOUT);
927         } else {
928                 /* Rejoice ! */
929                 struct {
930                         int val;
931                         const char *msg;
932                         u16 ctl;
933                 } reg31[] = {
934                         { LPA_1000XFULL | LPA_SLCT,
935                                 "1000 Mbps Full Duplex",
936                                 0x01 | _1000bpsF },
937                         { LPA_1000XHALF | LPA_SLCT,
938                                 "1000 Mbps Half Duplex",
939                                 0x01 | _1000bpsH },
940                         { LPA_100FULL,
941                                 "100 Mbps Full Duplex",
942                                 0x01 | _100bpsF },
943                         { LPA_100HALF,
944                                 "100 Mbps Half Duplex",
945                                 0x01 | _100bpsH },
946                         { LPA_10FULL,
947                                 "10 Mbps Full Duplex",
948                                 0x01 | _10bpsF },
949                         { LPA_10HALF,
950                                 "10 Mbps Half Duplex",
951                                 0x01 | _10bpsH },
952                         { 0, "unknown", 0x0000 }
953                 }, *p;
954
955                 val = mdio_read(ioaddr, phy_id, 0x1f);
956                 net_link(tp, KERN_INFO "%s: mii ext = %04x.\n", dev->name, val);
957
958                 val = mdio_read(ioaddr, phy_id, MII_LPA);
959                 net_link(tp, KERN_INFO "%s: mii lpa = %04x.\n", dev->name, val);
960
961                 for (p = reg31; p->ctl; p++) {
962                         if ((val & p->val) == p->val)
963                                 break;
964                 }
965                 if (p->ctl)
966                         SIS_W16(StationControl, p->ctl);
967                 net_link(tp, KERN_INFO "%s: link on %s mode.\n", dev->name,
968                          p->msg);
969                 netif_carrier_on(dev);
970         }
971
972         rtnl_unlock();
973 }
974
975 static void sis190_phy_timer(unsigned long __opaque)
976 {
977         struct net_device *dev = (struct net_device *)__opaque;
978         struct sis190_private *tp = netdev_priv(dev);
979
980         if (likely(netif_running(dev)))
981                 schedule_work(&tp->phy_task);
982 }
983
984 static inline void sis190_delete_timer(struct net_device *dev)
985 {
986         struct sis190_private *tp = netdev_priv(dev);
987
988         del_timer_sync(&tp->timer);
989 }
990
991 static inline void sis190_request_timer(struct net_device *dev)
992 {
993         struct sis190_private *tp = netdev_priv(dev);
994         struct timer_list *timer = &tp->timer;
995
996         init_timer(timer);
997         timer->expires = jiffies + SIS190_PHY_TIMEOUT;
998         timer->data = (unsigned long)dev;
999         timer->function = sis190_phy_timer;
1000         add_timer(timer);
1001 }
1002
1003 static void sis190_set_rxbufsize(struct sis190_private *tp,
1004                                  struct net_device *dev)
1005 {
1006         unsigned int mtu = dev->mtu;
1007
1008         tp->rx_buf_sz = (mtu > RX_BUF_SIZE) ? mtu + ETH_HLEN + 8 : RX_BUF_SIZE;
1009         /* RxDesc->size has a licence to kill the lower bits */
1010         if (tp->rx_buf_sz & 0x07) {
1011                 tp->rx_buf_sz += 8;
1012                 tp->rx_buf_sz &= RX_BUF_MASK;
1013         }
1014 }
1015
1016 static int sis190_open(struct net_device *dev)
1017 {
1018         struct sis190_private *tp = netdev_priv(dev);
1019         struct pci_dev *pdev = tp->pci_dev;
1020         int rc = -ENOMEM;
1021
1022         sis190_set_rxbufsize(tp, dev);
1023
1024         /*
1025          * Rx and Tx descriptors need 256 bytes alignment.
1026          * pci_alloc_consistent() guarantees a stronger alignment.
1027          */
1028         tp->TxDescRing = pci_alloc_consistent(pdev, TX_RING_BYTES, &tp->tx_dma);
1029         if (!tp->TxDescRing)
1030                 goto out;
1031
1032         tp->RxDescRing = pci_alloc_consistent(pdev, RX_RING_BYTES, &tp->rx_dma);
1033         if (!tp->RxDescRing)
1034                 goto err_free_tx_0;
1035
1036         rc = sis190_init_ring(dev);
1037         if (rc < 0)
1038                 goto err_free_rx_1;
1039
1040         INIT_WORK(&tp->phy_task, sis190_phy_task, dev);
1041
1042         sis190_request_timer(dev);
1043
1044         rc = request_irq(dev->irq, sis190_interrupt, SA_SHIRQ, dev->name, dev);
1045         if (rc < 0)
1046                 goto err_release_timer_2;
1047
1048         sis190_hw_start(dev);
1049 out:
1050         return rc;
1051
1052 err_release_timer_2:
1053         sis190_delete_timer(dev);
1054         sis190_rx_clear(tp);
1055 err_free_rx_1:
1056         pci_free_consistent(tp->pci_dev, RX_RING_BYTES, tp->RxDescRing,
1057                 tp->rx_dma);
1058 err_free_tx_0:
1059         pci_free_consistent(tp->pci_dev, TX_RING_BYTES, tp->TxDescRing,
1060                 tp->tx_dma);
1061         goto out;
1062 }
1063
1064 static void sis190_tx_clear(struct sis190_private *tp)
1065 {
1066         unsigned int i;
1067
1068         for (i = 0; i < NUM_TX_DESC; i++) {
1069                 struct sk_buff *skb = tp->Tx_skbuff[i];
1070
1071                 if (!skb)
1072                         continue;
1073
1074                 sis190_unmap_tx_skb(tp->pci_dev, skb, tp->TxDescRing + i);
1075                 tp->Tx_skbuff[i] = NULL;
1076                 dev_kfree_skb(skb);
1077
1078                 tp->stats.tx_dropped++;
1079         }
1080         tp->cur_tx = tp->dirty_tx = 0;
1081 }
1082
1083 static void sis190_down(struct net_device *dev)
1084 {
1085         struct sis190_private *tp = netdev_priv(dev);
1086         void __iomem *ioaddr = tp->mmio_addr;
1087         unsigned int poll_locked = 0;
1088
1089         sis190_delete_timer(dev);
1090
1091         netif_stop_queue(dev);
1092
1093         flush_scheduled_work();
1094
1095         do {
1096                 spin_lock_irq(&tp->lock);
1097
1098                 sis190_asic_down(ioaddr);
1099
1100                 spin_unlock_irq(&tp->lock);
1101
1102                 synchronize_irq(dev->irq);
1103
1104                 if (!poll_locked) {
1105                         netif_poll_disable(dev);
1106                         poll_locked++;
1107                 }
1108
1109                 synchronize_sched();
1110
1111         } while (SIS_R32(IntrMask));
1112
1113         sis190_tx_clear(tp);
1114         sis190_rx_clear(tp);
1115 }
1116
1117 static int sis190_close(struct net_device *dev)
1118 {
1119         struct sis190_private *tp = netdev_priv(dev);
1120         struct pci_dev *pdev = tp->pci_dev;
1121
1122         sis190_down(dev);
1123
1124         free_irq(dev->irq, dev);
1125
1126         netif_poll_enable(dev);
1127
1128         pci_free_consistent(pdev, TX_RING_BYTES, tp->TxDescRing, tp->tx_dma);
1129         pci_free_consistent(pdev, RX_RING_BYTES, tp->RxDescRing, tp->rx_dma);
1130
1131         tp->TxDescRing = NULL;
1132         tp->RxDescRing = NULL;
1133
1134         return 0;
1135 }
1136
1137 static int sis190_start_xmit(struct sk_buff *skb, struct net_device *dev)
1138 {
1139         struct sis190_private *tp = netdev_priv(dev);
1140         void __iomem *ioaddr = tp->mmio_addr;
1141         u32 len, entry, dirty_tx;
1142         struct TxDesc *desc;
1143         dma_addr_t mapping;
1144
1145         if (unlikely(skb->len < ETH_ZLEN)) {
1146                 skb = skb_padto(skb, ETH_ZLEN);
1147                 if (!skb) {
1148                         tp->stats.tx_dropped++;
1149                         goto out;
1150                 }
1151                 len = ETH_ZLEN;
1152         } else {
1153                 len = skb->len;
1154         }
1155
1156         entry = tp->cur_tx % NUM_TX_DESC;
1157         desc = tp->TxDescRing + entry;
1158
1159         if (unlikely(le32_to_cpu(desc->status) & OWNbit)) {
1160                 netif_stop_queue(dev);
1161                 net_tx_err(tp, KERN_ERR PFX
1162                            "%s: BUG! Tx Ring full when queue awake!\n",
1163                            dev->name);
1164                 return NETDEV_TX_BUSY;
1165         }
1166
1167         mapping = pci_map_single(tp->pci_dev, skb->data, len, PCI_DMA_TODEVICE);
1168
1169         tp->Tx_skbuff[entry] = skb;
1170
1171         desc->PSize = cpu_to_le32(len);
1172         desc->addr = cpu_to_le32(mapping);
1173
1174         desc->size = cpu_to_le32(len);
1175         if (entry == (NUM_TX_DESC - 1))
1176                 desc->size |= cpu_to_le32(RingEnd);
1177
1178         wmb();
1179
1180         desc->status = cpu_to_le32(OWNbit | INTbit | DEFbit | CRCbit | PADbit);
1181
1182         tp->cur_tx++;
1183
1184         smp_wmb();
1185
1186         SIS_W32(TxControl, 0x1a00 | CmdReset | CmdTxEnb);
1187
1188         dev->trans_start = jiffies;
1189
1190         dirty_tx = tp->dirty_tx;
1191         if ((tp->cur_tx - NUM_TX_DESC) == dirty_tx) {
1192                 netif_stop_queue(dev);
1193                 smp_rmb();
1194                 if (dirty_tx != tp->dirty_tx)
1195                         netif_wake_queue(dev);
1196         }
1197 out:
1198         return NETDEV_TX_OK;
1199 }
1200
1201 static struct net_device_stats *sis190_get_stats(struct net_device *dev)
1202 {
1203         struct sis190_private *tp = netdev_priv(dev);
1204
1205         return &tp->stats;
1206 }
1207
1208 static void sis190_free_phy(struct list_head *first_phy)
1209 {
1210         struct sis190_phy *cur, *next;
1211
1212         list_for_each_entry_safe(cur, next, first_phy, list) {
1213                 kfree(cur);
1214         }
1215 }
1216
1217 /**
1218  *      sis190_default_phy - Select default PHY for sis190 mac.
1219  *      @dev: the net device to probe for
1220  *
1221  *      Select first detected PHY with link as default.
1222  *      If no one is link on, select PHY whose types is HOME as default.
1223  *      If HOME doesn't exist, select LAN.
1224  */
1225 static u16 sis190_default_phy(struct net_device *dev)
1226 {
1227         struct sis190_phy *phy, *phy_home, *phy_default, *phy_lan;
1228         struct sis190_private *tp = netdev_priv(dev);
1229         struct mii_if_info *mii_if = &tp->mii_if;
1230         void __iomem *ioaddr = tp->mmio_addr;
1231         u16 status;
1232
1233         phy_home = phy_default = phy_lan = NULL;
1234
1235         list_for_each_entry(phy, &tp->first_phy, list) {
1236                 status = mdio_read_latched(ioaddr, phy->phy_id, MII_BMSR);
1237
1238                 // Link ON & Not select default PHY & not ghost PHY.
1239                 if ((status & BMSR_LSTATUS) &&
1240                     !phy_default &&
1241                     (phy->type != UNKNOWN)) {
1242                         phy_default = phy;
1243                 } else {
1244                         status = mdio_read(ioaddr, phy->phy_id, MII_BMCR);
1245                         mdio_write(ioaddr, phy->phy_id, MII_BMCR,
1246                                    status | BMCR_ANENABLE | BMCR_ISOLATE);
1247                         if (phy->type == HOME)
1248                                 phy_home = phy;
1249                         else if (phy->type == LAN)
1250                                 phy_lan = phy;
1251                 }
1252         }
1253
1254         if (!phy_default) {
1255                 if (phy_home)
1256                         phy_default = phy_home;
1257                 else if (phy_lan)
1258                         phy_default = phy_lan;
1259                 else
1260                         phy_default = list_entry(&tp->first_phy,
1261                                                  struct sis190_phy, list);
1262         }
1263
1264         if (mii_if->phy_id != phy_default->phy_id) {
1265                 mii_if->phy_id = phy_default->phy_id;
1266                 net_probe(tp, KERN_INFO
1267                        "%s: Using transceiver at address %d as default.\n",
1268                        dev->name, mii_if->phy_id);
1269         }
1270
1271         status = mdio_read(ioaddr, mii_if->phy_id, MII_BMCR);
1272         status &= (~BMCR_ISOLATE);
1273
1274         mdio_write(ioaddr, mii_if->phy_id, MII_BMCR, status);
1275         status = mdio_read_latched(ioaddr, mii_if->phy_id, MII_BMSR);
1276
1277         return status;
1278 }
1279
1280 static void sis190_init_phy(struct net_device *dev, struct sis190_private *tp,
1281                             struct sis190_phy *phy, unsigned int phy_id,
1282                             u16 mii_status)
1283 {
1284         void __iomem *ioaddr = tp->mmio_addr;
1285         struct mii_chip_info *p;
1286
1287         INIT_LIST_HEAD(&phy->list);
1288         phy->status = mii_status;
1289         phy->phy_id = phy_id;
1290
1291         phy->id[0] = mdio_read(ioaddr, phy_id, MII_PHYSID1);
1292         phy->id[1] = mdio_read(ioaddr, phy_id, MII_PHYSID2);
1293
1294         for (p = mii_chip_table; p->type; p++) {
1295                 if ((p->id[0] == phy->id[0]) &&
1296                     (p->id[1] == (phy->id[1] & 0xfff0))) {
1297                         break;
1298                 }
1299         }
1300
1301         if (p->id[1]) {
1302                 phy->type = (p->type == MIX) ?
1303                         ((mii_status & (BMSR_100FULL | BMSR_100HALF)) ?
1304                                 LAN : HOME) : p->type;
1305         } else
1306                 phy->type = UNKNOWN;
1307
1308         net_probe(tp, KERN_INFO "%s: %s transceiver at address %d.\n",
1309                   dev->name, (phy->type == UNKNOWN) ? "Unknown PHY" : p->name,
1310                   phy_id);
1311 }
1312
1313 /**
1314  *      sis190_mii_probe - Probe MII PHY for sis190
1315  *      @dev: the net device to probe for
1316  *
1317  *      Search for total of 32 possible mii phy addresses.
1318  *      Identify and set current phy if found one,
1319  *      return error if it failed to found.
1320  */
1321 static int __devinit sis190_mii_probe(struct net_device *dev)
1322 {
1323         struct sis190_private *tp = netdev_priv(dev);
1324         struct mii_if_info *mii_if = &tp->mii_if;
1325         void __iomem *ioaddr = tp->mmio_addr;
1326         int phy_id;
1327         int rc = 0;
1328
1329         INIT_LIST_HEAD(&tp->first_phy);
1330
1331         for (phy_id = 0; phy_id < PHY_MAX_ADDR; phy_id++) {
1332                 struct sis190_phy *phy;
1333                 u16 status;
1334
1335                 status = mdio_read_latched(ioaddr, phy_id, MII_BMSR);
1336
1337                 // Try next mii if the current one is not accessible.
1338                 if (status == 0xffff || status == 0x0000)
1339                         continue;
1340
1341                 phy = kmalloc(sizeof(*phy), GFP_KERNEL);
1342                 if (!phy) {
1343                         sis190_free_phy(&tp->first_phy);
1344                         rc = -ENOMEM;
1345                         goto out;
1346                 }
1347
1348                 sis190_init_phy(dev, tp, phy, phy_id, status);
1349
1350                 list_add(&tp->first_phy, &phy->list);
1351         }
1352
1353         if (list_empty(&tp->first_phy)) {
1354                 net_probe(tp, KERN_INFO "%s: No MII transceivers found!\n",
1355                           dev->name);
1356                 rc = -EIO;
1357                 goto out;
1358         }
1359
1360         /* Select default PHY for mac */
1361         sis190_default_phy(dev);
1362
1363         mii_if->dev = dev;
1364         mii_if->mdio_read = __mdio_read;
1365         mii_if->mdio_write = __mdio_write;
1366         mii_if->phy_id_mask = PHY_ID_ANY;
1367         mii_if->reg_num_mask = MII_REG_ANY;
1368 out:
1369         return rc;
1370 }
1371
1372 static void __devexit sis190_mii_remove(struct net_device *dev)
1373 {
1374         struct sis190_private *tp = netdev_priv(dev);
1375
1376         sis190_free_phy(&tp->first_phy);
1377 }
1378
1379 static void sis190_release_board(struct pci_dev *pdev)
1380 {
1381         struct net_device *dev = pci_get_drvdata(pdev);
1382         struct sis190_private *tp = netdev_priv(dev);
1383
1384         iounmap(tp->mmio_addr);
1385         pci_release_regions(pdev);
1386         pci_disable_device(pdev);
1387         free_netdev(dev);
1388 }
1389
1390 static struct net_device * __devinit sis190_init_board(struct pci_dev *pdev)
1391 {
1392         struct sis190_private *tp;
1393         struct net_device *dev;
1394         void __iomem *ioaddr;
1395         int rc;
1396
1397         dev = alloc_etherdev(sizeof(*tp));
1398         if (!dev) {
1399                 net_drv(&debug, KERN_ERR PFX "unable to alloc new ethernet\n");
1400                 rc = -ENOMEM;
1401                 goto err_out_0;
1402         }
1403
1404         SET_MODULE_OWNER(dev);
1405         SET_NETDEV_DEV(dev, &pdev->dev);
1406
1407         tp = netdev_priv(dev);
1408         tp->msg_enable = netif_msg_init(debug.msg_enable, SIS190_MSG_DEFAULT);
1409
1410         rc = pci_enable_device(pdev);
1411         if (rc < 0) {
1412                 net_probe(tp, KERN_ERR "%s: enable failure\n", pci_name(pdev));
1413                 goto err_free_dev_1;
1414         }
1415
1416         rc = -ENODEV;
1417
1418         if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
1419                 net_probe(tp, KERN_ERR "%s: region #0 is no MMIO resource.\n",
1420                           pci_name(pdev));
1421                 goto err_pci_disable_2;
1422         }
1423         if (pci_resource_len(pdev, 0) < SIS190_REGS_SIZE) {
1424                 net_probe(tp, KERN_ERR "%s: invalid PCI region size(s).\n",
1425                           pci_name(pdev));
1426                 goto err_pci_disable_2;
1427         }
1428
1429         rc = pci_request_regions(pdev, DRV_NAME);
1430         if (rc < 0) {
1431                 net_probe(tp, KERN_ERR PFX "%s: could not request regions.\n",
1432                           pci_name(pdev));
1433                 goto err_pci_disable_2;
1434         }
1435
1436         rc = pci_set_dma_mask(pdev, DMA_32BIT_MASK);
1437         if (rc < 0) {
1438                 net_probe(tp, KERN_ERR "%s: DMA configuration failed.\n",
1439                           pci_name(pdev));
1440                 goto err_free_res_3;
1441         }
1442
1443         pci_set_master(pdev);
1444
1445         ioaddr = ioremap(pci_resource_start(pdev, 0), SIS190_REGS_SIZE);
1446         if (!ioaddr) {
1447                 net_probe(tp, KERN_ERR "%s: cannot remap MMIO, aborting\n",
1448                           pci_name(pdev));
1449                 rc = -EIO;
1450                 goto err_free_res_3;
1451         }
1452
1453         tp->pci_dev = pdev;
1454         tp->mmio_addr = ioaddr;
1455
1456         sis190_irq_mask_and_ack(ioaddr);
1457
1458         sis190_soft_reset(ioaddr);
1459 out:
1460         return dev;
1461
1462 err_free_res_3:
1463         pci_release_regions(pdev);
1464 err_pci_disable_2:
1465         pci_disable_device(pdev);
1466 err_free_dev_1:
1467         free_netdev(dev);
1468 err_out_0:
1469         dev = ERR_PTR(rc);
1470         goto out;
1471 }
1472
1473 static void sis190_tx_timeout(struct net_device *dev)
1474 {
1475         struct sis190_private *tp = netdev_priv(dev);
1476         void __iomem *ioaddr = tp->mmio_addr;
1477         u8 tmp8;
1478
1479         /* Disable Tx, if not already */
1480         tmp8 = SIS_R8(TxControl);
1481         if (tmp8 & CmdTxEnb)
1482                 SIS_W8(TxControl, tmp8 & ~CmdTxEnb);
1483
1484
1485         net_tx_err(tp, KERN_INFO "%s: Transmit timeout, status %08x %08x.\n",
1486                    dev->name, SIS_R32(TxControl), SIS_R32(TxSts));
1487
1488         /* Disable interrupts by clearing the interrupt mask. */
1489         SIS_W32(IntrMask, 0x0000);
1490
1491         /* Stop a shared interrupt from scavenging while we are. */
1492         spin_lock_irq(&tp->lock);
1493         sis190_tx_clear(tp);
1494         spin_unlock_irq(&tp->lock);
1495
1496         /* ...and finally, reset everything. */
1497         sis190_hw_start(dev);
1498
1499         netif_wake_queue(dev);
1500 }
1501
1502 static int __devinit sis190_get_mac_addr_from_eeprom(struct pci_dev *pdev,
1503                                                      struct net_device *dev)
1504 {
1505         struct sis190_private *tp = netdev_priv(dev);
1506         void __iomem *ioaddr = tp->mmio_addr;
1507         u16 sig;
1508         int i;
1509
1510         net_probe(tp, KERN_INFO "%s: Read MAC address from EEPROM\n",
1511                   pci_name(pdev));
1512
1513         /* Check to see if there is a sane EEPROM */
1514         sig = (u16) sis190_read_eeprom(ioaddr, EEPROMSignature);
1515
1516         if ((sig == 0xffff) || (sig == 0x0000)) {
1517                 net_probe(tp, KERN_INFO "%s: Error EEPROM read %x.\n",
1518                           pci_name(pdev), sig);
1519                 return -EIO;
1520         }
1521
1522         /* Get MAC address from EEPROM */
1523         for (i = 0; i < MAC_ADDR_LEN / 2; i++) {
1524                 __le16 w = sis190_read_eeprom(ioaddr, EEPROMMACAddr + i);
1525
1526                 ((u16 *)dev->dev_addr)[0] = le16_to_cpu(w);
1527         }
1528
1529         return 0;
1530 }
1531
1532 /**
1533  *      sis190_get_mac_addr_from_apc - Get MAC address for SiS965 model
1534  *      @pdev: PCI device
1535  *      @dev:  network device to get address for
1536  *
1537  *      SiS965 model, use APC CMOS RAM to store MAC address.
1538  *      APC CMOS RAM is accessed through ISA bridge.
1539  *      MAC address is read into @net_dev->dev_addr.
1540  */
1541 static int __devinit sis190_get_mac_addr_from_apc(struct pci_dev *pdev,
1542                                                   struct net_device *dev)
1543 {
1544         struct sis190_private *tp = netdev_priv(dev);
1545         struct pci_dev *isa_bridge;
1546         u8 reg, tmp8;
1547         int i;
1548
1549         net_probe(tp, KERN_INFO "%s: Read MAC address from APC.\n",
1550                   pci_name(pdev));
1551
1552         isa_bridge = pci_get_device(PCI_VENDOR_ID_SI, 0x0965, NULL);
1553         if (!isa_bridge) {
1554                 net_probe(tp, KERN_INFO "%s: Can not find ISA bridge.\n",
1555                           pci_name(pdev));
1556                 return -EIO;
1557         }
1558
1559         /* Enable port 78h & 79h to access APC Registers. */
1560         pci_read_config_byte(isa_bridge, 0x48, &tmp8);
1561         reg = (tmp8 & ~0x02);
1562         pci_write_config_byte(isa_bridge, 0x48, reg);
1563         udelay(50);
1564         pci_read_config_byte(isa_bridge, 0x48, &reg);
1565
1566         for (i = 0; i < MAC_ADDR_LEN; i++) {
1567                 outb(0x9 + i, 0x78);
1568                 dev->dev_addr[i] = inb(0x79);
1569         }
1570
1571         outb(0x12, 0x78);
1572         reg = inb(0x79);
1573
1574         /* Restore the value to ISA Bridge */
1575         pci_write_config_byte(isa_bridge, 0x48, tmp8);
1576         pci_dev_put(isa_bridge);
1577
1578         return 0;
1579 }
1580
1581 /**
1582  *      sis190_init_rxfilter - Initialize the Rx filter
1583  *      @dev: network device to initialize
1584  *
1585  *      Set receive filter address to our MAC address
1586  *      and enable packet filtering.
1587  */
1588 static inline void sis190_init_rxfilter(struct net_device *dev)
1589 {
1590         struct sis190_private *tp = netdev_priv(dev);
1591         void __iomem *ioaddr = tp->mmio_addr;
1592         u16 ctl;
1593         int i;
1594
1595         ctl = SIS_R16(RxMacControl);
1596         /*
1597          * Disable packet filtering before setting filter.
1598          * Note: SiS's driver writes 32 bits but RxMacControl is 16 bits
1599          * only and followed by RxMacAddr (6 bytes). Strange. -- FR
1600          */
1601         SIS_W16(RxMacControl, ctl & ~0x0f00);
1602
1603         for (i = 0; i < MAC_ADDR_LEN; i++)
1604                 SIS_W8(RxMacAddr + i, dev->dev_addr[i]);
1605
1606         SIS_W16(RxMacControl, ctl);
1607         SIS_PCI_COMMIT();
1608 }
1609
1610 static int sis190_get_mac_addr(struct pci_dev *pdev, struct net_device *dev)
1611 {
1612         u8 from;
1613
1614         pci_read_config_byte(pdev, 0x73, &from);
1615
1616         return (from & 0x00000001) ?
1617                 sis190_get_mac_addr_from_apc(pdev, dev) :
1618                 sis190_get_mac_addr_from_eeprom(pdev, dev);
1619 }
1620
1621 static void sis190_set_speed_auto(struct net_device *dev)
1622 {
1623         struct sis190_private *tp = netdev_priv(dev);
1624         void __iomem *ioaddr = tp->mmio_addr;
1625         int phy_id = tp->mii_if.phy_id;
1626         int val;
1627
1628         net_link(tp, KERN_INFO "%s: Enabling Auto-negotiation.\n", dev->name);
1629
1630         val = mdio_read(ioaddr, phy_id, MII_ADVERTISE);
1631
1632         // Enable 10/100 Full/Half Mode, leave MII_ADVERTISE bit4:0
1633         // unchanged.
1634         mdio_write(ioaddr, phy_id, MII_ADVERTISE, (val & ADVERTISE_SLCT) |
1635                    ADVERTISE_100FULL | ADVERTISE_10FULL |
1636                    ADVERTISE_100HALF | ADVERTISE_10HALF);
1637
1638         // Enable 1000 Full Mode.
1639         mdio_write(ioaddr, phy_id, MII_CTRL1000, ADVERTISE_1000FULL);
1640
1641         // Enable auto-negotiation and restart auto-negotiation.
1642         mdio_write(ioaddr, phy_id, MII_BMCR,
1643                    BMCR_ANENABLE | BMCR_ANRESTART | BMCR_RESET);
1644 }
1645
1646 static int sis190_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1647 {
1648         struct sis190_private *tp = netdev_priv(dev);
1649
1650         return mii_ethtool_gset(&tp->mii_if, cmd);
1651 }
1652
1653 static int sis190_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1654 {
1655         struct sis190_private *tp = netdev_priv(dev);
1656
1657         return mii_ethtool_sset(&tp->mii_if, cmd);
1658 }
1659
1660 static void sis190_get_drvinfo(struct net_device *dev,
1661                                struct ethtool_drvinfo *info)
1662 {
1663         struct sis190_private *tp = netdev_priv(dev);
1664
1665         strcpy(info->driver, DRV_NAME);
1666         strcpy(info->version, DRV_VERSION);
1667         strcpy(info->bus_info, pci_name(tp->pci_dev));
1668 }
1669
1670 static int sis190_get_regs_len(struct net_device *dev)
1671 {
1672         return SIS190_REGS_SIZE;
1673 }
1674
1675 static void sis190_get_regs(struct net_device *dev, struct ethtool_regs *regs,
1676                             void *p)
1677 {
1678         struct sis190_private *tp = netdev_priv(dev);
1679         unsigned long flags;
1680
1681         if (regs->len > SIS190_REGS_SIZE)
1682                 regs->len = SIS190_REGS_SIZE;
1683
1684         spin_lock_irqsave(&tp->lock, flags);
1685         memcpy_fromio(p, tp->mmio_addr, regs->len);
1686         spin_unlock_irqrestore(&tp->lock, flags);
1687 }
1688
1689 static int sis190_nway_reset(struct net_device *dev)
1690 {
1691         struct sis190_private *tp = netdev_priv(dev);
1692
1693         return mii_nway_restart(&tp->mii_if);
1694 }
1695
1696 static u32 sis190_get_msglevel(struct net_device *dev)
1697 {
1698         struct sis190_private *tp = netdev_priv(dev);
1699
1700         return tp->msg_enable;
1701 }
1702
1703 static void sis190_set_msglevel(struct net_device *dev, u32 value)
1704 {
1705         struct sis190_private *tp = netdev_priv(dev);
1706
1707         tp->msg_enable = value;
1708 }
1709
1710 static struct ethtool_ops sis190_ethtool_ops = {
1711         .get_settings   = sis190_get_settings,
1712         .set_settings   = sis190_set_settings,
1713         .get_drvinfo    = sis190_get_drvinfo,
1714         .get_regs_len   = sis190_get_regs_len,
1715         .get_regs       = sis190_get_regs,
1716         .get_link       = ethtool_op_get_link,
1717         .get_msglevel   = sis190_get_msglevel,
1718         .set_msglevel   = sis190_set_msglevel,
1719         .nway_reset     = sis190_nway_reset,
1720 };
1721
1722 static int sis190_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
1723 {
1724         struct sis190_private *tp = netdev_priv(dev);
1725
1726         return !netif_running(dev) ? -EINVAL :
1727                 generic_mii_ioctl(&tp->mii_if, if_mii(ifr), cmd, NULL);
1728 }
1729
1730 static int __devinit sis190_init_one(struct pci_dev *pdev,
1731                                      const struct pci_device_id *ent)
1732 {
1733         static int printed_version = 0;
1734         struct sis190_private *tp;
1735         struct net_device *dev;
1736         void __iomem *ioaddr;
1737         int rc;
1738
1739         if (!printed_version) {
1740                 net_drv(&debug, KERN_INFO SIS190_DRIVER_NAME " loaded.\n");
1741                 printed_version = 1;
1742         }
1743
1744         dev = sis190_init_board(pdev);
1745         if (IS_ERR(dev)) {
1746                 rc = PTR_ERR(dev);
1747                 goto out;
1748         }
1749
1750         tp = netdev_priv(dev);
1751         ioaddr = tp->mmio_addr;
1752
1753         rc = sis190_get_mac_addr(pdev, dev);
1754         if (rc < 0)
1755                 goto err_release_board;
1756
1757         sis190_init_rxfilter(dev);
1758
1759         INIT_WORK(&tp->phy_task, sis190_phy_task, dev);
1760
1761         dev->open = sis190_open;
1762         dev->stop = sis190_close;
1763         dev->do_ioctl = sis190_ioctl;
1764         dev->get_stats = sis190_get_stats;
1765         dev->tx_timeout = sis190_tx_timeout;
1766         dev->watchdog_timeo = SIS190_TX_TIMEOUT;
1767         dev->hard_start_xmit = sis190_start_xmit;
1768 #ifdef CONFIG_NET_POLL_CONTROLLER
1769         dev->poll_controller = sis190_netpoll;
1770 #endif
1771         dev->set_multicast_list = sis190_set_rx_mode;
1772         SET_ETHTOOL_OPS(dev, &sis190_ethtool_ops);
1773         dev->irq = pdev->irq;
1774         dev->base_addr = (unsigned long) 0xdead;
1775
1776         spin_lock_init(&tp->lock);
1777         rc = register_netdev(dev);
1778         if (rc < 0)
1779                 goto err_release_board;
1780
1781         pci_set_drvdata(pdev, dev);
1782
1783         rc = sis190_mii_probe(dev);
1784         if (rc < 0)
1785                 goto err_unregister_dev;
1786
1787         net_probe(tp, KERN_INFO "%s: %s at %p (IRQ: %d), "
1788                "%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x\n",
1789                pci_name(pdev), sis_chip_info[ent->driver_data].name,
1790                ioaddr, dev->irq,
1791                dev->dev_addr[0], dev->dev_addr[1],
1792                dev->dev_addr[2], dev->dev_addr[3],
1793                dev->dev_addr[4], dev->dev_addr[5]);
1794
1795         netif_carrier_off(dev);
1796
1797         sis190_set_speed_auto(dev);
1798 out:
1799         return rc;
1800
1801 err_unregister_dev:
1802         unregister_netdev(dev);
1803 err_release_board:
1804         sis190_release_board(pdev);
1805         goto out;
1806 }
1807
1808 static void __devexit sis190_remove_one(struct pci_dev *pdev)
1809 {
1810         struct net_device *dev = pci_get_drvdata(pdev);
1811
1812         sis190_mii_remove(dev);
1813         unregister_netdev(dev);
1814         sis190_release_board(pdev);
1815         pci_set_drvdata(pdev, NULL);
1816 }
1817
1818 static struct pci_driver sis190_pci_driver = {
1819         .name           = DRV_NAME,
1820         .id_table       = sis190_pci_tbl,
1821         .probe          = sis190_init_one,
1822         .remove         = __devexit_p(sis190_remove_one),
1823 };
1824
1825 static int __init sis190_init_module(void)
1826 {
1827         return pci_module_init(&sis190_pci_driver);
1828 }
1829
1830 static void __exit sis190_cleanup_module(void)
1831 {
1832         pci_unregister_driver(&sis190_pci_driver);
1833 }
1834
1835 module_init(sis190_init_module);
1836 module_exit(sis190_cleanup_module);