drivers/net/ethernet/sis/sis900.c

   1 /* sis900.c: A SiS 900/7016 PCI Fast Ethernet driver for Linux.
   2    Copyright 1999 Silicon Integrated System Corporation
   3    Revision:    1.08.10 Apr. 2 2006
   4
   5    Modified from the driver which is originally written by Donald Becker.
   6
   7    This software may be used and distributed according to the terms
   8    of the GNU General Public License (GPL), incorporated herein by reference.
   9    Drivers based on this skeleton fall under the GPL and must retain
  10    the authorship (implicit copyright) notice.
  11
  12    References:
  13    SiS 7016 Fast Ethernet PCI Bus 10/100 Mbps LAN Controller with OnNow Support,
  14    preliminary Rev. 1.0 Jan. 14, 1998
  15    SiS 900 Fast Ethernet PCI Bus 10/100 Mbps LAN Single Chip with OnNow Support,
  16    preliminary Rev. 1.0 Nov. 10, 1998
  17    SiS 7014 Single Chip 100BASE-TX/10BASE-T Physical Layer Solution,
  18    preliminary Rev. 1.0 Jan. 18, 1998
  19
  20    Rev 1.08.10 Apr.  2 2006 Daniele Venzano add vlan (jumbo packets) support
  21    Rev 1.08.09 Sep. 19 2005 Daniele Venzano add Wake on LAN support
  22    Rev 1.08.08 Jan. 22 2005 Daniele Venzano use netif_msg for debugging messages
  23    Rev 1.08.07 Nov.  2 2003 Daniele Venzano <venza@brownhat.org> add suspend/resume support
  24    Rev 1.08.06 Sep. 24 2002 Mufasa Yang bug fix for Tx timeout & add SiS963 support
  25    Rev 1.08.05 Jun.  6 2002 Mufasa Yang bug fix for read_eeprom & Tx descriptor over-boundary
  26    Rev 1.08.04 Apr. 25 2002 Mufasa Yang <mufasa@sis.com.tw> added SiS962 support
  27    Rev 1.08.03 Feb.  1 2002 Matt Domsch <Matt_Domsch@dell.com> update to use library crc32 function
  28    Rev 1.08.02 Nov. 30 2001 Hui-Fen Hsu workaround for EDB & bug fix for dhcp problem
  29    Rev 1.08.01 Aug. 25 2001 Hui-Fen Hsu update for 630ET & workaround for ICS1893 PHY
  30    Rev 1.08.00 Jun. 11 2001 Hui-Fen Hsu workaround for RTL8201 PHY and some bug fix
  31    Rev 1.07.11 Apr.  2 2001 Hui-Fen Hsu updates PCI drivers to use the new pci_set_dma_mask for kernel 2.4.3
  32    Rev 1.07.10 Mar.  1 2001 Hui-Fen Hsu <hfhsu@sis.com.tw> some bug fix & 635M/B support
  33    Rev 1.07.09 Feb.  9 2001 Dave Jones <davej@suse.de> PCI enable cleanup
  34    Rev 1.07.08 Jan.  8 2001 Lei-Chun Chang added RTL8201 PHY support
  35    Rev 1.07.07 Nov. 29 2000 Lei-Chun Chang added kernel-doc extractable documentation and 630 workaround fix
  36    Rev 1.07.06 Nov.  7 2000 Jeff Garzik <jgarzik@pobox.com> some bug fix and cleaning
  37    Rev 1.07.05 Nov.  6 2000 metapirat<metapirat@gmx.de> contribute media type select by ifconfig
  38    Rev 1.07.04 Sep.  6 2000 Lei-Chun Chang added ICS1893 PHY support
  39    Rev 1.07.03 Aug. 24 2000 Lei-Chun Chang (lcchang@sis.com.tw) modified 630E equalizer workaround rule
  40    Rev 1.07.01 Aug. 08 2000 Ollie Lho minor update for SiS 630E and SiS 630E A1
  41    Rev 1.07    Mar. 07 2000 Ollie Lho bug fix in Rx buffer ring
  42    Rev 1.06.04 Feb. 11 2000 Jeff Garzik <jgarzik@pobox.com> softnet and init for kernel 2.4
  43    Rev 1.06.03 Dec. 23 1999 Ollie Lho Third release
  44    Rev 1.06.02 Nov. 23 1999 Ollie Lho bug in mac probing fixed
  45    Rev 1.06.01 Nov. 16 1999 Ollie Lho CRC calculation provide by Joseph Zbiciak (im14u2c@primenet.com)
  46    Rev 1.06 Nov. 4 1999 Ollie Lho (ollie@sis.com.tw) Second release
  47    Rev 1.05.05 Oct. 29 1999 Ollie Lho (ollie@sis.com.tw) Single buffer Tx/Rx
  48    Chin-Shan Li (lcs@sis.com.tw) Added AMD Am79c901 HomePNA PHY support
  49    Rev 1.05 Aug. 7 1999 Jim Huang (cmhuang@sis.com.tw) Initial release
  50 */
  51
  52 #include <linux/module.h>
  53 #include <linux/moduleparam.h>
  54 #include <linux/kernel.h>
  55 #include <linux/sched.h>
  56 #include <linux/string.h>
  57 #include <linux/timer.h>
  58 #include <linux/errno.h>
  59 #include <linux/ioport.h>
  60 #include <linux/slab.h>
  61 #include <linux/interrupt.h>
  62 #include <linux/pci.h>
  63 #include <linux/netdevice.h>
  64 #include <linux/init.h>
  65 #include <linux/mii.h>
  66 #include <linux/etherdevice.h>
  67 #include <linux/skbuff.h>
  68 #include <linux/delay.h>
  69 #include <linux/ethtool.h>
  70 #include <linux/crc32.h>
  71 #include <linux/bitops.h>
  72 #include <linux/dma-mapping.h>
  73
  74 #include <asm/processor.h>      /* Processor type for cache alignment. */
  75 #include <asm/io.h>
  76 #include <asm/irq.h>
  77 #include <asm/uaccess.h>        /* User space memory access functions */
  78
  79 #include "sis900.h"
  80
  81 #define SIS900_MODULE_NAME "sis900"
  82 #define SIS900_DRV_VERSION "v1.08.10 Apr. 2 2006"
  83
  84 static const char version[] =
  85         KERN_INFO "sis900.c: " SIS900_DRV_VERSION "\n";
  86
  87 static int max_interrupt_work = 40;
  88 static int multicast_filter_limit = 128;
  89
  90 static int sis900_debug = -1; /* Use SIS900_DEF_MSG as value */
  91
  92 #define SIS900_DEF_MSG \
  93         (NETIF_MSG_DRV          | \
  94          NETIF_MSG_LINK         | \
  95          NETIF_MSG_RX_ERR       | \
  96          NETIF_MSG_TX_ERR)
  97
  98 /* Time in jiffies before concluding the transmitter is hung. */
  99 #define TX_TIMEOUT  (4*HZ)
 100
 101 enum {
 102         SIS_900 = 0,
 103         SIS_7016
 104 };
 105 static const char * card_names[] = {
 106         "SiS 900 PCI Fast Ethernet",
 107         "SiS 7016 PCI Fast Ethernet"
 108 };
 109 static DEFINE_PCI_DEVICE_TABLE(sis900_pci_tbl) = {
 110         {PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_900,
 111          PCI_ANY_ID, PCI_ANY_ID, 0, 0, SIS_900},
 112         {PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_7016,
 113          PCI_ANY_ID, PCI_ANY_ID, 0, 0, SIS_7016},
 114         {0,}
 115 };
 116 MODULE_DEVICE_TABLE (pci, sis900_pci_tbl);
 117
 118 static void sis900_read_mode(struct net_device *net_dev, int *speed, int *duplex);
 119
 120 static const struct mii_chip_info {
 121         const char * name;
 122         u16 phy_id0;
 123         u16 phy_id1;
 124         u8  phy_types;
 125 #define HOME    0x0001
 126 #define LAN     0x0002
 127 #define MIX     0x0003
 128 #define UNKNOWN 0x0
 129 } mii_chip_table[] = {
 130         { "SiS 900 Internal MII PHY",           0x001d, 0x8000, LAN },
 131         { "SiS 7014 Physical Layer Solution",   0x0016, 0xf830, LAN },
 132         { "SiS 900 on Foxconn 661 7MI",         0x0143, 0xBC70, LAN },
 133         { "Altimata AC101LF PHY",               0x0022, 0x5520, LAN },
 134         { "ADM 7001 LAN PHY",                   0x002e, 0xcc60, LAN },
 135         { "AMD 79C901 10BASE-T PHY",            0x0000, 0x6B70, LAN },
 136         { "AMD 79C901 HomePNA PHY",             0x0000, 0x6B90, HOME},
 137         { "ICS LAN PHY",                        0x0015, 0xF440, LAN },
 138         { "ICS LAN PHY",                        0x0143, 0xBC70, LAN },
 139         { "NS 83851 PHY",                       0x2000, 0x5C20, MIX },
 140         { "NS 83847 PHY",                       0x2000, 0x5C30, MIX },
 141         { "Realtek RTL8201 PHY",                0x0000, 0x8200, LAN },
 142         { "VIA 6103 PHY",                       0x0101, 0x8f20, LAN },
 143         {NULL,},
 144 };
 145
 146 struct mii_phy {
 147         struct mii_phy * next;
 148         int phy_addr;
 149         u16 phy_id0;
 150         u16 phy_id1;
 151         u16 status;
 152         u8  phy_types;
 153 };
 154
 155 typedef struct _BufferDesc {
 156         u32 link;
 157         u32 cmdsts;
 158         u32 bufptr;
 159 } BufferDesc;
 160
 161 struct sis900_private {
 162         struct pci_dev * pci_dev;
 163
 164         spinlock_t lock;
 165
 166         struct mii_phy * mii;
 167         struct mii_phy * first_mii; /* record the first mii structure */
 168         unsigned int cur_phy;
 169         struct mii_if_info mii_info;
 170
 171         void __iomem    *ioaddr;
 172
 173         struct timer_list timer; /* Link status detection timer. */
 174         u8 autong_complete; /* 1: auto-negotiate complete  */
 175
 176         u32 msg_enable;
 177
 178         unsigned int cur_rx, dirty_rx; /* producer/comsumer pointers for Tx/Rx ring */
 179         unsigned int cur_tx, dirty_tx;
 180
 181         /* The saved address of a sent/receive-in-place packet buffer */
 182         struct sk_buff *tx_skbuff[NUM_TX_DESC];
 183         struct sk_buff *rx_skbuff[NUM_RX_DESC];
 184         BufferDesc *tx_ring;
 185         BufferDesc *rx_ring;
 186
 187         dma_addr_t tx_ring_dma;
 188         dma_addr_t rx_ring_dma;
 189
 190         unsigned int tx_full; /* The Tx queue is full. */
 191         u8 host_bridge_rev;
 192         u8 chipset_rev;
 193 };
 194
 195 MODULE_AUTHOR("Jim Huang <cmhuang@sis.com.tw>, Ollie Lho <ollie@sis.com.tw>");
 196 MODULE_DESCRIPTION("SiS 900 PCI Fast Ethernet driver");
 197 MODULE_LICENSE("GPL");
 198
 199 module_param(multicast_filter_limit, int, 0444);
 200 module_param(max_interrupt_work, int, 0444);
 201 module_param(sis900_debug, int, 0444);
 202 MODULE_PARM_DESC(multicast_filter_limit, "SiS 900/7016 maximum number of filtered multicast addresses");
 203 MODULE_PARM_DESC(max_interrupt_work, "SiS 900/7016 maximum events handled per interrupt");
 204 MODULE_PARM_DESC(sis900_debug, "SiS 900/7016 bitmapped debugging message level");
 205
 206 #define sw32(reg, val)  iowrite32(val, ioaddr + (reg))
 207 #define sw8(reg, val)   iowrite8(val, ioaddr + (reg))
 208 #define sr32(reg)       ioread32(ioaddr + (reg))
 209 #define sr16(reg)       ioread16(ioaddr + (reg))
 210
 211 #ifdef CONFIG_NET_POLL_CONTROLLER
 212 static void sis900_poll(struct net_device *dev);
 213 #endif
 214 static int sis900_open(struct net_device *net_dev);
 215 static int sis900_mii_probe (struct net_device * net_dev);
 216 static void sis900_init_rxfilter (struct net_device * net_dev);
 217 static u16 read_eeprom(void __iomem *ioaddr, int location);
 218 static int mdio_read(struct net_device *net_dev, int phy_id, int location);
 219 static void mdio_write(struct net_device *net_dev, int phy_id, int location, int val);
 220 static void sis900_timer(unsigned long data);
 221 static void sis900_check_mode (struct net_device *net_dev, struct mii_phy *mii_phy);
 222 static void sis900_tx_timeout(struct net_device *net_dev);
 223 static void sis900_init_tx_ring(struct net_device *net_dev);
 224 static void sis900_init_rx_ring(struct net_device *net_dev);
 225 static netdev_tx_t sis900_start_xmit(struct sk_buff *skb,
 226                                      struct net_device *net_dev);
 227 static int sis900_rx(struct net_device *net_dev);
 228 static void sis900_finish_xmit (struct net_device *net_dev);
 229 static irqreturn_t sis900_interrupt(int irq, void *dev_instance);
 230 static int sis900_close(struct net_device *net_dev);
 231 static int mii_ioctl(struct net_device *net_dev, struct ifreq *rq, int cmd);
 232 static u16 sis900_mcast_bitnr(u8 *addr, u8 revision);
 233 static void set_rx_mode(struct net_device *net_dev);
 234 static void sis900_reset(struct net_device *net_dev);
 235 static void sis630_set_eq(struct net_device *net_dev, u8 revision);
 236 static int sis900_set_config(struct net_device *dev, struct ifmap *map);
 237 static u16 sis900_default_phy(struct net_device * net_dev);
 238 static void sis900_set_capability( struct net_device *net_dev ,struct mii_phy *phy);
 239 static u16 sis900_reset_phy(struct net_device *net_dev, int phy_addr);
 240 static void sis900_auto_negotiate(struct net_device *net_dev, int phy_addr);
 241 static void sis900_set_mode(struct sis900_private *, int speed, int duplex);
 242 static const struct ethtool_ops sis900_ethtool_ops;
 243
 244 /**
 245  *      sis900_get_mac_addr - Get MAC address for stand alone SiS900 model
 246  *      @pci_dev: the sis900 pci device
 247  *      @net_dev: the net device to get address for
 248  *
 249  *      Older SiS900 and friends, use EEPROM to store MAC address.
 250  *      MAC address is read from read_eeprom() into @net_dev->dev_addr.
 251  */
 252
 253 static int sis900_get_mac_addr(struct pci_dev *pci_dev,
 254                                struct net_device *net_dev)
 255 {
 256         struct sis900_private *sis_priv = netdev_priv(net_dev);
 257         void __iomem *ioaddr = sis_priv->ioaddr;
 258         u16 signature;
 259         int i;
 260
 261         /* check to see if we have sane EEPROM */
 262         signature = (u16) read_eeprom(ioaddr, EEPROMSignature);
 263         if (signature == 0xffff || signature == 0x0000) {
 264                 printk (KERN_WARNING "%s: Error EERPOM read %x\n",
 265                         pci_name(pci_dev), signature);
 266                 return 0;
 267         }
 268
 269         /* get MAC address from EEPROM */
 270         for (i = 0; i < 3; i++)
 271                 ((u16 *)(net_dev->dev_addr))[i] = read_eeprom(ioaddr, i+EEPROMMACAddr);
 272
 273         return 1;
 274 }
 275
 276 /**
 277  *      sis630e_get_mac_addr - Get MAC address for SiS630E model
 278  *      @pci_dev: the sis900 pci device
 279  *      @net_dev: the net device to get address for
 280  *
 281  *      SiS630E model, use APC CMOS RAM to store MAC address.
 282  *      APC CMOS RAM is accessed through ISA bridge.
 283  *      MAC address is read into @net_dev->dev_addr.
 284  */
 285
 286 static int sis630e_get_mac_addr(struct pci_dev *pci_dev,
 287                                 struct net_device *net_dev)
 288 {
 289         struct pci_dev *isa_bridge = NULL;
 290         u8 reg;
 291         int i;
 292
 293         isa_bridge = pci_get_device(PCI_VENDOR_ID_SI, 0x0008, isa_bridge);
 294         if (!isa_bridge)
 295                 isa_bridge = pci_get_device(PCI_VENDOR_ID_SI, 0x0018, isa_bridge);
 296         if (!isa_bridge) {
 297                 printk(KERN_WARNING "%s: Can not find ISA bridge\n",
 298                        pci_name(pci_dev));
 299                 return 0;
 300         }
 301         pci_read_config_byte(isa_bridge, 0x48, &reg);
 302         pci_write_config_byte(isa_bridge, 0x48, reg | 0x40);
 303
 304         for (i = 0; i < 6; i++) {
 305                 outb(0x09 + i, 0x70);
 306                 ((u8 *)(net_dev->dev_addr))[i] = inb(0x71);
 307         }
 308
 309         pci_write_config_byte(isa_bridge, 0x48, reg & ~0x40);
 310         pci_dev_put(isa_bridge);
 311
 312         return 1;
 313 }
 314
 315
 316 /**
 317  *      sis635_get_mac_addr - Get MAC address for SIS635 model
 318  *      @pci_dev: the sis900 pci device
 319  *      @net_dev: the net device to get address for
 320  *
 321  *      SiS635 model, set MAC Reload Bit to load Mac address from APC
 322  *      to rfdr. rfdr is accessed through rfcr. MAC address is read into
 323  *      @net_dev->dev_addr.
 324  */
 325
 326 static int sis635_get_mac_addr(struct pci_dev *pci_dev,
 327                                struct net_device *net_dev)
 328 {
 329         struct sis900_private *sis_priv = netdev_priv(net_dev);
 330         void __iomem *ioaddr = sis_priv->ioaddr;
 331         u32 rfcrSave;
 332         u32 i;
 333
 334         rfcrSave = sr32(rfcr);
 335
 336         sw32(cr, rfcrSave | RELOAD);
 337         sw32(cr, 0);
 338
 339         /* disable packet filtering before setting filter */
 340         sw32(rfcr, rfcrSave & ~RFEN);
 341
 342         /* load MAC addr to filter data register */
 343         for (i = 0 ; i < 3 ; i++) {
 344                 sw32(rfcr, (i << RFADDR_shift));
 345                 *( ((u16 *)net_dev->dev_addr) + i) = sr16(rfdr);
 346         }
 347
 348         /* enable packet filtering */
 349         sw32(rfcr, rfcrSave | RFEN);
 350
 351         return 1;
 352 }
 353
 354 /**
 355  *      sis96x_get_mac_addr - Get MAC address for SiS962 or SiS963 model
 356  *      @pci_dev: the sis900 pci device
 357  *      @net_dev: the net device to get address for
 358  *
 359  *      SiS962 or SiS963 model, use EEPROM to store MAC address. And EEPROM
 360  *      is shared by
 361  *      LAN and 1394. When access EEPROM, send EEREQ signal to hardware first
 362  *      and wait for EEGNT. If EEGNT is ON, EEPROM is permitted to be access
 363  *      by LAN, otherwise is not. After MAC address is read from EEPROM, send
 364  *      EEDONE signal to refuse EEPROM access by LAN.
 365  *      The EEPROM map of SiS962 or SiS963 is different to SiS900.
 366  *      The signature field in SiS962 or SiS963 spec is meaningless.
 367  *      MAC address is read into @net_dev->dev_addr.
 368  */
 369
 370 static int sis96x_get_mac_addr(struct pci_dev *pci_dev,
 371                                struct net_device *net_dev)
 372 {
 373         struct sis900_private *sis_priv = netdev_priv(net_dev);
 374         void __iomem *ioaddr = sis_priv->ioaddr;
 375         int wait, rc = 0;
 376
 377         sw32(mear, EEREQ);
 378         for (wait = 0; wait < 2000; wait++) {
 379                 if (sr32(mear) & EEGNT) {
 380                         u16 *mac = (u16 *)net_dev->dev_addr;
 381                         int i;
 382
 383                         /* get MAC address from EEPROM */
 384                         for (i = 0; i < 3; i++)
 385                                 mac[i] = read_eeprom(ioaddr, i + EEPROMMACAddr);
 386
 387                         rc = 1;
 388                         break;
 389                 }
 390                 udelay(1);
 391         }
 392         sw32(mear, EEDONE);
 393         return rc;
 394 }
 395
 396 static const struct net_device_ops sis900_netdev_ops = {
 397         .ndo_open                = sis900_open,
 398         .ndo_stop               = sis900_close,
 399         .ndo_start_xmit         = sis900_start_xmit,
 400         .ndo_set_config         = sis900_set_config,
 401         .ndo_set_rx_mode        = set_rx_mode,
 402         .ndo_change_mtu         = eth_change_mtu,
 403         .ndo_validate_addr      = eth_validate_addr,
 404         .ndo_set_mac_address    = eth_mac_addr,
 405         .ndo_do_ioctl           = mii_ioctl,
 406         .ndo_tx_timeout         = sis900_tx_timeout,
 407 #ifdef CONFIG_NET_POLL_CONTROLLER
 408         .ndo_poll_controller    = sis900_poll,
 409 #endif
 410 };
 411
 412 /**
 413  *      sis900_probe - Probe for sis900 device
 414  *      @pci_dev: the sis900 pci device
 415  *      @pci_id: the pci device ID
 416  *
 417  *      Check and probe sis900 net device for @pci_dev.
 418  *      Get mac address according to the chip revision,
 419  *      and assign SiS900-specific entries in the device structure.
 420  *      ie: sis900_open(), sis900_start_xmit(), sis900_close(), etc.
 421  */
 422
 423 static int sis900_probe(struct pci_dev *pci_dev,
 424                         const struct pci_device_id *pci_id)
 425 {
 426         struct sis900_private *sis_priv;
 427         struct net_device *net_dev;
 428         struct pci_dev *dev;
 429         dma_addr_t ring_dma;
 430         void *ring_space;
 431         void __iomem *ioaddr;
 432         int i, ret;
 433         const char *card_name = card_names[pci_id->driver_data];
 434         const char *dev_name = pci_name(pci_dev);
 435
 436 /* when built into the kernel, we only print version if device is found */
 437 #ifndef MODULE
 438         static int printed_version;
 439         if (!printed_version++)
 440                 printk(version);
 441 #endif
 442
 443         /* setup various bits in PCI command register */
 444         ret = pci_enable_device(pci_dev);
 445         if(ret) return ret;
 446
 447         i = pci_set_dma_mask(pci_dev, DMA_BIT_MASK(32));
 448         if(i){
 449                 printk(KERN_ERR "sis900.c: architecture does not support "
 450                         "32bit PCI busmaster DMA\n");
 451                 return i;
 452         }
 453
 454         pci_set_master(pci_dev);
 455
 456         net_dev = alloc_etherdev(sizeof(struct sis900_private));
 457         if (!net_dev)
 458                 return -ENOMEM;
 459         SET_NETDEV_DEV(net_dev, &pci_dev->dev);
 460
 461         /* We do a request_region() to register /proc/ioports info. */
 462         ret = pci_request_regions(pci_dev, "sis900");
 463         if (ret)
 464                 goto err_out;
 465
 466         /* IO region. */
 467         ioaddr = pci_iomap(pci_dev, 0, 0);
 468         if (!ioaddr) {
 469                 ret = -ENOMEM;
 470                 goto err_out_cleardev;
 471         }
 472
 473         sis_priv = netdev_priv(net_dev);
 474         sis_priv->ioaddr = ioaddr;
 475         sis_priv->pci_dev = pci_dev;
 476         spin_lock_init(&sis_priv->lock);
 477
 478         pci_set_drvdata(pci_dev, net_dev);
 479
 480         ring_space = pci_alloc_consistent(pci_dev, TX_TOTAL_SIZE, &ring_dma);
 481         if (!ring_space) {
 482                 ret = -ENOMEM;
 483                 goto err_out_unmap;
 484         }
 485         sis_priv->tx_ring = ring_space;
 486         sis_priv->tx_ring_dma = ring_dma;
 487
 488         ring_space = pci_alloc_consistent(pci_dev, RX_TOTAL_SIZE, &ring_dma);
 489         if (!ring_space) {
 490                 ret = -ENOMEM;
 491                 goto err_unmap_tx;
 492         }
 493         sis_priv->rx_ring = ring_space;
 494         sis_priv->rx_ring_dma = ring_dma;
 495
 496         /* The SiS900-specific entries in the device structure. */
 497         net_dev->netdev_ops = &sis900_netdev_ops;
 498         net_dev->watchdog_timeo = TX_TIMEOUT;
 499         net_dev->ethtool_ops = &sis900_ethtool_ops;
 500
 501         if (sis900_debug > 0)
 502                 sis_priv->msg_enable = sis900_debug;
 503         else
 504                 sis_priv->msg_enable = SIS900_DEF_MSG;
 505
 506         sis_priv->mii_info.dev = net_dev;
 507         sis_priv->mii_info.mdio_read = mdio_read;
 508         sis_priv->mii_info.mdio_write = mdio_write;
 509         sis_priv->mii_info.phy_id_mask = 0x1f;
 510         sis_priv->mii_info.reg_num_mask = 0x1f;
 511
 512         /* Get Mac address according to the chip revision */
 513         sis_priv->chipset_rev = pci_dev->revision;
 514         if(netif_msg_probe(sis_priv))
 515                 printk(KERN_DEBUG "%s: detected revision %2.2x, "
 516                                 "trying to get MAC address...\n",
 517                                 dev_name, sis_priv->chipset_rev);
 518
 519         ret = 0;
 520         if (sis_priv->chipset_rev == SIS630E_900_REV)
 521                 ret = sis630e_get_mac_addr(pci_dev, net_dev);
 522         else if ((sis_priv->chipset_rev > 0x81) && (sis_priv->chipset_rev <= 0x90) )
 523                 ret = sis635_get_mac_addr(pci_dev, net_dev);
 524         else if (sis_priv->chipset_rev == SIS96x_900_REV)
 525                 ret = sis96x_get_mac_addr(pci_dev, net_dev);
 526         else
 527                 ret = sis900_get_mac_addr(pci_dev, net_dev);
 528
 529         if (!ret || !is_valid_ether_addr(net_dev->dev_addr)) {
 530                 eth_hw_addr_random(net_dev);
 531                 printk(KERN_WARNING "%s: Unreadable or invalid MAC address,"
 532                                 "using random generated one\n", dev_name);
 533         }
 534
 535         /* 630ET : set the mii access mode as software-mode */
 536         if (sis_priv->chipset_rev == SIS630ET_900_REV)
 537                 sw32(cr, ACCESSMODE | sr32(cr));
 538
 539         /* probe for mii transceiver */
 540         if (sis900_mii_probe(net_dev) == 0) {
 541                 printk(KERN_WARNING "%s: Error probing MII device.\n",
 542                        dev_name);
 543                 ret = -ENODEV;
 544                 goto err_unmap_rx;
 545         }
 546
 547         /* save our host bridge revision */
 548         dev = pci_get_device(PCI_VENDOR_ID_SI, PCI_DEVICE_ID_SI_630, NULL);
 549         if (dev) {
 550                 sis_priv->host_bridge_rev = dev->revision;
 551                 pci_dev_put(dev);
 552         }
 553
 554         ret = register_netdev(net_dev);
 555         if (ret)
 556                 goto err_unmap_rx;
 557
 558         /* print some information about our NIC */
 559         printk(KERN_INFO "%s: %s at 0x%p, IRQ %d, %pM\n",
 560                net_dev->name, card_name, ioaddr, pci_dev->irq,
 561                net_dev->dev_addr);
 562
 563         /* Detect Wake on Lan support */
 564         ret = (sr32(CFGPMC) & PMESP) >> 27;
 565         if (netif_msg_probe(sis_priv) && (ret & PME_D3C) == 0)
 566                 printk(KERN_INFO "%s: Wake on LAN only available from suspend to RAM.", net_dev->name);
 567
 568         return 0;
 569
 570 err_unmap_rx:
 571         pci_free_consistent(pci_dev, RX_TOTAL_SIZE, sis_priv->rx_ring,
 572                 sis_priv->rx_ring_dma);
 573 err_unmap_tx:
 574         pci_free_consistent(pci_dev, TX_TOTAL_SIZE, sis_priv->tx_ring,
 575                 sis_priv->tx_ring_dma);
 576 err_out_unmap:
 577         pci_iounmap(pci_dev, ioaddr);
 578 err_out_cleardev:
 579         pci_set_drvdata(pci_dev, NULL);
 580         pci_release_regions(pci_dev);
 581  err_out:
 582         free_netdev(net_dev);
 583         return ret;
 584 }
 585
 586 /**
 587  *      sis900_mii_probe - Probe MII PHY for sis900
 588  *      @net_dev: the net device to probe for
 589  *
 590  *      Search for total of 32 possible mii phy addresses.
 591  *      Identify and set current phy if found one,
 592  *      return error if it failed to found.
 593  */
 594
 595 static int sis900_mii_probe(struct net_device *net_dev)
 596 {
 597         struct sis900_private *sis_priv = netdev_priv(net_dev);
 598         const char *dev_name = pci_name(sis_priv->pci_dev);
 599         u16 poll_bit = MII_STAT_LINK, status = 0;
 600         unsigned long timeout = jiffies + 5 * HZ;
 601         int phy_addr;
 602
 603         sis_priv->mii = NULL;
 604
 605         /* search for total of 32 possible mii phy addresses */
 606         for (phy_addr = 0; phy_addr < 32; phy_addr++) {
 607                 struct mii_phy * mii_phy = NULL;
 608                 u16 mii_status;
 609                 int i;
 610
 611                 mii_phy = NULL;
 612                 for(i = 0; i < 2; i++)
 613                         mii_status = mdio_read(net_dev, phy_addr, MII_STATUS);
 614
 615                 if (mii_status == 0xffff || mii_status == 0x0000) {
 616                         if (netif_msg_probe(sis_priv))
 617                                 printk(KERN_DEBUG "%s: MII at address %d"
 618                                                 " not accessible\n",
 619                                                 dev_name, phy_addr);
 620                         continue;
 621                 }
 622
 623                 if ((mii_phy = kmalloc(sizeof(struct mii_phy), GFP_KERNEL)) == NULL) {
 624                         mii_phy = sis_priv->first_mii;
 625                         while (mii_phy) {
 626                                 struct mii_phy *phy;
 627                                 phy = mii_phy;
 628                                 mii_phy = mii_phy->next;
 629                                 kfree(phy);
 630                         }
 631                         return 0;
 632                 }
 633
 634                 mii_phy->phy_id0 = mdio_read(net_dev, phy_addr, MII_PHY_ID0);
 635                 mii_phy->phy_id1 = mdio_read(net_dev, phy_addr, MII_PHY_ID1);
 636                 mii_phy->phy_addr = phy_addr;
 637                 mii_phy->status = mii_status;
 638                 mii_phy->next = sis_priv->mii;
 639                 sis_priv->mii = mii_phy;
 640                 sis_priv->first_mii = mii_phy;
 641
 642                 for (i = 0; mii_chip_table[i].phy_id1; i++)
 643                         if ((mii_phy->phy_id0 == mii_chip_table[i].phy_id0 ) &&
 644                             ((mii_phy->phy_id1 & 0xFFF0) == mii_chip_table[i].phy_id1)){
 645                                 mii_phy->phy_types = mii_chip_table[i].phy_types;
 646                                 if (mii_chip_table[i].phy_types == MIX)
 647                                         mii_phy->phy_types =
 648                                             (mii_status & (MII_STAT_CAN_TX_FDX | MII_STAT_CAN_TX)) ? LAN : HOME;
 649                                 printk(KERN_INFO "%s: %s transceiver found "
 650                                                         "at address %d.\n",
 651                                                         dev_name,
 652                                                         mii_chip_table[i].name,
 653                                                         phy_addr);
 654                                 break;
 655                         }
 656
 657                 if( !mii_chip_table[i].phy_id1 ) {
 658                         printk(KERN_INFO "%s: Unknown PHY transceiver found at address %d.\n",
 659                                dev_name, phy_addr);
 660                         mii_phy->phy_types = UNKNOWN;
 661                 }
 662         }
 663
 664         if (sis_priv->mii == NULL) {
 665                 printk(KERN_INFO "%s: No MII transceivers found!\n", dev_name);
 666                 return 0;
 667         }
 668
 669         /* select default PHY for mac */
 670         sis_priv->mii = NULL;
 671         sis900_default_phy( net_dev );
 672
 673         /* Reset phy if default phy is internal sis900 */
 674         if ((sis_priv->mii->phy_id0 == 0x001D) &&
 675             ((sis_priv->mii->phy_id1&0xFFF0) == 0x8000))
 676                 status = sis900_reset_phy(net_dev, sis_priv->cur_phy);
 677
 678         /* workaround for ICS1893 PHY */
 679         if ((sis_priv->mii->phy_id0 == 0x0015) &&
 680             ((sis_priv->mii->phy_id1&0xFFF0) == 0xF440))
 681                 mdio_write(net_dev, sis_priv->cur_phy, 0x0018, 0xD200);
 682
 683         if(status & MII_STAT_LINK){
 684                 while (poll_bit) {
 685                         yield();
 686
 687                         poll_bit ^= (mdio_read(net_dev, sis_priv->cur_phy, MII_STATUS) & poll_bit);
 688                         if (time_after_eq(jiffies, timeout)) {
 689                                 printk(KERN_WARNING "%s: reset phy and link down now\n",
 690                                        dev_name);
 691                                 return -ETIME;
 692                         }
 693                 }
 694         }
 695
 696         if (sis_priv->chipset_rev == SIS630E_900_REV) {
 697                 /* SiS 630E has some bugs on default value of PHY registers */
 698                 mdio_write(net_dev, sis_priv->cur_phy, MII_ANADV, 0x05e1);
 699                 mdio_write(net_dev, sis_priv->cur_phy, MII_CONFIG1, 0x22);
 700                 mdio_write(net_dev, sis_priv->cur_phy, MII_CONFIG2, 0xff00);
 701                 mdio_write(net_dev, sis_priv->cur_phy, MII_MASK, 0xffc0);
 702                 //mdio_write(net_dev, sis_priv->cur_phy, MII_CONTROL, 0x1000);
 703         }
 704
 705         if (sis_priv->mii->status & MII_STAT_LINK)
 706                 netif_carrier_on(net_dev);
 707         else
 708                 netif_carrier_off(net_dev);
 709
 710         return 1;
 711 }
 712
 713 /**
 714  *      sis900_default_phy - Select default PHY for sis900 mac.
 715  *      @net_dev: the net device to probe for
 716  *
 717  *      Select first detected PHY with link as default.
 718  *      If no one is link on, select PHY whose types is HOME as default.
 719  *      If HOME doesn't exist, select LAN.
 720  */
 721
 722 static u16 sis900_default_phy(struct net_device * net_dev)
 723 {
 724         struct sis900_private *sis_priv = netdev_priv(net_dev);
 725         struct mii_phy *phy = NULL, *phy_home = NULL,
 726                 *default_phy = NULL, *phy_lan = NULL;
 727         u16 status;
 728
 729         for (phy=sis_priv->first_mii; phy; phy=phy->next) {
 730                 status = mdio_read(net_dev, phy->phy_addr, MII_STATUS);
 731                 status = mdio_read(net_dev, phy->phy_addr, MII_STATUS);
 732
 733                 /* Link ON & Not select default PHY & not ghost PHY */
 734                  if ((status & MII_STAT_LINK) && !default_phy &&
 735                                         (phy->phy_types != UNKNOWN))
 736                         default_phy = phy;
 737                  else {
 738                         status = mdio_read(net_dev, phy->phy_addr, MII_CONTROL);
 739                         mdio_write(net_dev, phy->phy_addr, MII_CONTROL,
 740                                 status | MII_CNTL_AUTO | MII_CNTL_ISOLATE);
 741                         if (phy->phy_types == HOME)
 742                                 phy_home = phy;
 743                         else if(phy->phy_types == LAN)
 744                                 phy_lan = phy;
 745                  }
 746         }
 747
 748         if (!default_phy && phy_home)
 749                 default_phy = phy_home;
 750         else if (!default_phy && phy_lan)
 751                 default_phy = phy_lan;
 752         else if (!default_phy)
 753                 default_phy = sis_priv->first_mii;
 754
 755         if (sis_priv->mii != default_phy) {
 756                 sis_priv->mii = default_phy;
 757                 sis_priv->cur_phy = default_phy->phy_addr;
 758                 printk(KERN_INFO "%s: Using transceiver found at address %d as default\n",
 759                        pci_name(sis_priv->pci_dev), sis_priv->cur_phy);
 760         }
 761
 762         sis_priv->mii_info.phy_id = sis_priv->cur_phy;
 763
 764         status = mdio_read(net_dev, sis_priv->cur_phy, MII_CONTROL);
 765         status &= (~MII_CNTL_ISOLATE);
 766
 767         mdio_write(net_dev, sis_priv->cur_phy, MII_CONTROL, status);
 768         status = mdio_read(net_dev, sis_priv->cur_phy, MII_STATUS);
 769         status = mdio_read(net_dev, sis_priv->cur_phy, MII_STATUS);
 770
 771         return status;
 772 }
 773
 774
 775 /**
 776  *      sis900_set_capability - set the media capability of network adapter.
 777  *      @net_dev : the net device to probe for
 778  *      @phy : default PHY
 779  *
 780  *      Set the media capability of network adapter according to
 781  *      mii status register. It's necessary before auto-negotiate.
 782  */
 783
 784 static void sis900_set_capability(struct net_device *net_dev, struct mii_phy *phy)
 785 {
 786         u16 cap;
 787         u16 status;
 788
 789         status = mdio_read(net_dev, phy->phy_addr, MII_STATUS);
 790         status = mdio_read(net_dev, phy->phy_addr, MII_STATUS);
 791
 792         cap = MII_NWAY_CSMA_CD |
 793                 ((phy->status & MII_STAT_CAN_TX_FDX)? MII_NWAY_TX_FDX:0) |
 794                 ((phy->status & MII_STAT_CAN_TX)    ? MII_NWAY_TX:0) |
 795                 ((phy->status & MII_STAT_CAN_T_FDX) ? MII_NWAY_T_FDX:0)|
 796                 ((phy->status & MII_STAT_CAN_T)     ? MII_NWAY_T:0);
 797
 798         mdio_write(net_dev, phy->phy_addr, MII_ANADV, cap);
 799 }
 800
 801
 802 /* Delay between EEPROM clock transitions. */
 803 #define eeprom_delay()  sr32(mear)
 804
 805 /**
 806  *      read_eeprom - Read Serial EEPROM
 807  *      @ioaddr: base i/o address
 808  *      @location: the EEPROM location to read
 809  *
 810  *      Read Serial EEPROM through EEPROM Access Register.
 811  *      Note that location is in word (16 bits) unit
 812  */
 813
 814 static u16 read_eeprom(void __iomem *ioaddr, int location)
 815 {
 816         u32 read_cmd = location | EEread;
 817         int i;
 818         u16 retval = 0;
 819
 820         sw32(mear, 0);
 821         eeprom_delay();
 822         sw32(mear, EECS);
 823         eeprom_delay();
 824
 825         /* Shift the read command (9) bits out. */
 826         for (i = 8; i >= 0; i--) {
 827                 u32 dataval = (read_cmd & (1 << i)) ? EEDI | EECS : EECS;
 828
 829                 sw32(mear, dataval);
 830                 eeprom_delay();
 831                 sw32(mear, dataval | EECLK);
 832                 eeprom_delay();
 833         }
 834         sw32(mear, EECS);
 835         eeprom_delay();
 836
 837         /* read the 16-bits data in */
 838         for (i = 16; i > 0; i--) {
 839                 sw32(mear, EECS);
 840                 eeprom_delay();
 841                 sw32(mear, EECS | EECLK);
 842                 eeprom_delay();
 843                 retval = (retval << 1) | ((sr32(mear) & EEDO) ? 1 : 0);
 844                 eeprom_delay();
 845         }
 846
 847         /* Terminate the EEPROM access. */
 848         sw32(mear, 0);
 849         eeprom_delay();
 850
 851         return retval;
 852 }
 853
 854 /* Read and write the MII management registers using software-generated
 855    serial MDIO protocol. Note that the command bits and data bits are
 856    send out separately */
 857 #define mdio_delay()    sr32(mear)
 858
 859 static void mdio_idle(struct sis900_private *sp)
 860 {
 861         void __iomem *ioaddr = sp->ioaddr;
 862
 863         sw32(mear, MDIO | MDDIR);
 864         mdio_delay();
 865         sw32(mear, MDIO | MDDIR | MDC);
 866 }
 867
 868 /* Synchronize the MII management interface by shifting 32 one bits out. */
 869 static void mdio_reset(struct sis900_private *sp)
 870 {
 871         void __iomem *ioaddr = sp->ioaddr;
 872         int i;
 873
 874         for (i = 31; i >= 0; i--) {
 875                 sw32(mear, MDDIR | MDIO);
 876                 mdio_delay();
 877                 sw32(mear, MDDIR | MDIO | MDC);
 878                 mdio_delay();
 879         }
 880 }
 881
 882 /**
 883  *      mdio_read - read MII PHY register
 884  *      @net_dev: the net device to read
 885  *      @phy_id: the phy address to read
 886  *      @location: the phy regiester id to read
 887  *
 888  *      Read MII registers through MDIO and MDC
 889  *      using MDIO management frame structure and protocol(defined by ISO/IEC).
 890  *      Please see SiS7014 or ICS spec
 891  */
 892
 893 static int mdio_read(struct net_device *net_dev, int phy_id, int location)
 894 {
 895         int mii_cmd = MIIread|(phy_id<<MIIpmdShift)|(location<<MIIregShift);
 896         struct sis900_private *sp = netdev_priv(net_dev);
 897         void __iomem *ioaddr = sp->ioaddr;
 898         u16 retval = 0;
 899         int i;
 900
 901         mdio_reset(sp);
 902         mdio_idle(sp);
 903
 904         for (i = 15; i >= 0; i--) {
 905                 int dataval = (mii_cmd & (1 << i)) ? MDDIR | MDIO : MDDIR;
 906
 907                 sw32(mear, dataval);
 908                 mdio_delay();
 909                 sw32(mear, dataval | MDC);
 910                 mdio_delay();
 911         }
 912
 913         /* Read the 16 data bits. */
 914         for (i = 16; i > 0; i--) {
 915                 sw32(mear, 0);
 916                 mdio_delay();
 917                 retval = (retval << 1) | ((sr32(mear) & MDIO) ? 1 : 0);
 918                 sw32(mear, MDC);
 919                 mdio_delay();
 920         }
 921         sw32(mear, 0x00);
 922
 923         return retval;
 924 }
 925
 926 /**
 927  *      mdio_write - write MII PHY register
 928  *      @net_dev: the net device to write
 929  *      @phy_id: the phy address to write
 930  *      @location: the phy regiester id to write
 931  *      @value: the register value to write with
 932  *
 933  *      Write MII registers with @value through MDIO and MDC
 934  *      using MDIO management frame structure and protocol(defined by ISO/IEC)
 935  *      please see SiS7014 or ICS spec
 936  */
 937
 938 static void mdio_write(struct net_device *net_dev, int phy_id, int location,
 939                         int value)
 940 {
 941         int mii_cmd = MIIwrite|(phy_id<<MIIpmdShift)|(location<<MIIregShift);
 942         struct sis900_private *sp = netdev_priv(net_dev);
 943         void __iomem *ioaddr = sp->ioaddr;
 944         int i;
 945
 946         mdio_reset(sp);
 947         mdio_idle(sp);
 948
 949         /* Shift the command bits out. */
 950         for (i = 15; i >= 0; i--) {
 951                 int dataval = (mii_cmd & (1 << i)) ? MDDIR | MDIO : MDDIR;
 952
 953                 sw8(mear, dataval);
 954                 mdio_delay();
 955                 sw8(mear, dataval | MDC);
 956                 mdio_delay();
 957         }
 958         mdio_delay();
 959
 960         /* Shift the value bits out. */
 961         for (i = 15; i >= 0; i--) {
 962                 int dataval = (value & (1 << i)) ? MDDIR | MDIO : MDDIR;
 963
 964                 sw32(mear, dataval);
 965                 mdio_delay();
 966                 sw32(mear, dataval | MDC);
 967                 mdio_delay();
 968         }
 969         mdio_delay();
 970
 971         /* Clear out extra bits. */
 972         for (i = 2; i > 0; i--) {
 973                 sw8(mear, 0);
 974                 mdio_delay();
 975                 sw8(mear, MDC);
 976                 mdio_delay();
 977         }
 978         sw32(mear, 0x00);
 979 }
 980
 981
 982 /**
 983  *      sis900_reset_phy - reset sis900 mii phy.
 984  *      @net_dev: the net device to write
 985  *      @phy_addr: default phy address
 986  *
 987  *      Some specific phy can't work properly without reset.
 988  *      This function will be called during initialization and
 989  *      link status change from ON to DOWN.
 990  */
 991
 992 static u16 sis900_reset_phy(struct net_device *net_dev, int phy_addr)
 993 {
 994         int i;
 995         u16 status;
 996
 997         for (i = 0; i < 2; i++)
 998                 status = mdio_read(net_dev, phy_addr, MII_STATUS);
 999
1000         mdio_write( net_dev, phy_addr, MII_CONTROL, MII_CNTL_RESET );
1001
1002         return status;
1003 }
1004
1005 #ifdef CONFIG_NET_POLL_CONTROLLER
1006 /*
1007  * Polling 'interrupt' - used by things like netconsole to send skbs
1008  * without having to re-enable interrupts. It's not called while
1009  * the interrupt routine is executing.
1010 */
1011 static void sis900_poll(struct net_device *dev)
1012 {
1013         struct sis900_private *sp = netdev_priv(dev);
1014         const int irq = sp->pci_dev->irq;
1015
1016         disable_irq(irq);
1017         sis900_interrupt(irq, dev);
1018         enable_irq(irq);
1019 }
1020 #endif
1021
1022 /**
1023  *      sis900_open - open sis900 device
1024  *      @net_dev: the net device to open
1025  *
1026  *      Do some initialization and start net interface.
1027  *      enable interrupts and set sis900 timer.
1028  */
1029
1030 static int
1031 sis900_open(struct net_device *net_dev)
1032 {
1033         struct sis900_private *sis_priv = netdev_priv(net_dev);
1034         void __iomem *ioaddr = sis_priv->ioaddr;
1035         int ret;
1036
1037         /* Soft reset the chip. */
1038         sis900_reset(net_dev);
1039
1040         /* Equalizer workaround Rule */
1041         sis630_set_eq(net_dev, sis_priv->chipset_rev);
1042
1043         ret = request_irq(sis_priv->pci_dev->irq, sis900_interrupt, IRQF_SHARED,
1044                           net_dev->name, net_dev);
1045         if (ret)
1046                 return ret;
1047
1048         sis900_init_rxfilter(net_dev);
1049
1050         sis900_init_tx_ring(net_dev);
1051         sis900_init_rx_ring(net_dev);
1052
1053         set_rx_mode(net_dev);
1054
1055         netif_start_queue(net_dev);
1056
1057         /* Workaround for EDB */
1058         sis900_set_mode(sis_priv, HW_SPEED_10_MBPS, FDX_CAPABLE_HALF_SELECTED);
1059
1060         /* Enable all known interrupts by setting the interrupt mask. */
1061         sw32(imr, RxSOVR | RxORN | RxERR | RxOK | TxURN | TxERR | TxIDLE);
1062         sw32(cr, RxENA | sr32(cr));
1063         sw32(ier, IE);
1064
1065         sis900_check_mode(net_dev, sis_priv->mii);
1066
1067         /* Set the timer to switch to check for link beat and perhaps switch
1068            to an alternate media type. */
1069         init_timer(&sis_priv->timer);
1070         sis_priv->timer.expires = jiffies + HZ;
1071         sis_priv->timer.data = (unsigned long)net_dev;
1072         sis_priv->timer.function = sis900_timer;
1073         add_timer(&sis_priv->timer);
1074
1075         return 0;
1076 }
1077
1078 /**
1079  *      sis900_init_rxfilter - Initialize the Rx filter
1080  *      @net_dev: the net device to initialize for
1081  *
1082  *      Set receive filter address to our MAC address
1083  *      and enable packet filtering.
1084  */
1085
1086 static void
1087 sis900_init_rxfilter (struct net_device * net_dev)
1088 {
1089         struct sis900_private *sis_priv = netdev_priv(net_dev);
1090         void __iomem *ioaddr = sis_priv->ioaddr;
1091         u32 rfcrSave;
1092         u32 i;
1093
1094         rfcrSave = sr32(rfcr);
1095
1096         /* disable packet filtering before setting filter */
1097         sw32(rfcr, rfcrSave & ~RFEN);
1098
1099         /* load MAC addr to filter data register */
1100         for (i = 0 ; i < 3 ; i++) {
1101                 u32 w = (u32) *((u16 *)(net_dev->dev_addr)+i);
1102
1103                 sw32(rfcr, i << RFADDR_shift);
1104                 sw32(rfdr, w);
1105
1106                 if (netif_msg_hw(sis_priv)) {
1107                         printk(KERN_DEBUG "%s: Receive Filter Addrss[%d]=%x\n",
1108                                net_dev->name, i, sr32(rfdr));
1109                 }
1110         }
1111
1112         /* enable packet filtering */
1113         sw32(rfcr, rfcrSave | RFEN);
1114 }
1115
1116 /**
1117  *      sis900_init_tx_ring - Initialize the Tx descriptor ring
1118  *      @net_dev: the net device to initialize for
1119  *
1120  *      Initialize the Tx descriptor ring,
1121  */
1122
1123 static void
1124 sis900_init_tx_ring(struct net_device *net_dev)
1125 {
1126         struct sis900_private *sis_priv = netdev_priv(net_dev);
1127         void __iomem *ioaddr = sis_priv->ioaddr;
1128         int i;
1129
1130         sis_priv->tx_full = 0;
1131         sis_priv->dirty_tx = sis_priv->cur_tx = 0;
1132
1133         for (i = 0; i < NUM_TX_DESC; i++) {
1134                 sis_priv->tx_skbuff[i] = NULL;
1135
1136                 sis_priv->tx_ring[i].link = sis_priv->tx_ring_dma +
1137                         ((i+1)%NUM_TX_DESC)*sizeof(BufferDesc);
1138                 sis_priv->tx_ring[i].cmdsts = 0;
1139                 sis_priv->tx_ring[i].bufptr = 0;
1140         }
1141
1142         /* load Transmit Descriptor Register */
1143         sw32(txdp, sis_priv->tx_ring_dma);
1144         if (netif_msg_hw(sis_priv))
1145                 printk(KERN_DEBUG "%s: TX descriptor register loaded with: %8.8x\n",
1146                        net_dev->name, sr32(txdp));
1147 }
1148
1149 /**
1150  *      sis900_init_rx_ring - Initialize the Rx descriptor ring
1151  *      @net_dev: the net device to initialize for
1152  *
1153  *      Initialize the Rx descriptor ring,
1154  *      and pre-allocate recevie buffers (socket buffer)
1155  */
1156
1157 static void
1158 sis900_init_rx_ring(struct net_device *net_dev)
1159 {
1160         struct sis900_private *sis_priv = netdev_priv(net_dev);
1161         void __iomem *ioaddr = sis_priv->ioaddr;
1162         int i;
1163
1164         sis_priv->cur_rx = 0;
1165         sis_priv->dirty_rx = 0;
1166
1167         /* init RX descriptor */
1168         for (i = 0; i < NUM_RX_DESC; i++) {
1169                 sis_priv->rx_skbuff[i] = NULL;
1170
1171                 sis_priv->rx_ring[i].link = sis_priv->rx_ring_dma +
1172                         ((i+1)%NUM_RX_DESC)*sizeof(BufferDesc);
1173                 sis_priv->rx_ring[i].cmdsts = 0;
1174                 sis_priv->rx_ring[i].bufptr = 0;
1175         }
1176
1177         /* allocate sock buffers */
1178         for (i = 0; i < NUM_RX_DESC; i++) {
1179                 struct sk_buff *skb;
1180
1181                 if ((skb = netdev_alloc_skb(net_dev, RX_BUF_SIZE)) == NULL) {
1182                         /* not enough memory for skbuff, this makes a "hole"
1183                            on the buffer ring, it is not clear how the
1184                            hardware will react to this kind of degenerated
1185                            buffer */
1186                         break;
1187                 }
1188                 sis_priv->rx_skbuff[i] = skb;
1189                 sis_priv->rx_ring[i].cmdsts = RX_BUF_SIZE;
1190                 sis_priv->rx_ring[i].bufptr = pci_map_single(sis_priv->pci_dev,
1191                                 skb->data, RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
1192                 if (unlikely(pci_dma_mapping_error(sis_priv->pci_dev,
1193                                 sis_priv->rx_ring[i].bufptr))) {
1194                         dev_kfree_skb(skb);
1195                         sis_priv->rx_skbuff[i] = NULL;
1196                         break;
1197                 }
1198         }
1199         sis_priv->dirty_rx = (unsigned int) (i - NUM_RX_DESC);
1200
1201         /* load Receive Descriptor Register */
1202         sw32(rxdp, sis_priv->rx_ring_dma);
1203         if (netif_msg_hw(sis_priv))
1204                 printk(KERN_DEBUG "%s: RX descriptor register loaded with: %8.8x\n",
1205                        net_dev->name, sr32(rxdp));
1206 }
1207
1208 /**
1209  *      sis630_set_eq - set phy equalizer value for 630 LAN
1210  *      @net_dev: the net device to set equalizer value
1211  *      @revision: 630 LAN revision number
1212  *
1213  *      630E equalizer workaround rule(Cyrus Huang 08/15)
1214  *      PHY register 14h(Test)
1215  *      Bit 14: 0 -- Automatically detect (default)
1216  *              1 -- Manually set Equalizer filter
1217  *      Bit 13: 0 -- (Default)
1218  *              1 -- Speed up convergence of equalizer setting
1219  *      Bit 9 : 0 -- (Default)
1220  *              1 -- Disable Baseline Wander
1221  *      Bit 3~7   -- Equalizer filter setting
1222  *      Link ON: Set Bit 9, 13 to 1, Bit 14 to 0
1223  *      Then calculate equalizer value
1224  *      Then set equalizer value, and set Bit 14 to 1, Bit 9 to 0
1225  *      Link Off:Set Bit 13 to 1, Bit 14 to 0
1226  *      Calculate Equalizer value:
1227  *      When Link is ON and Bit 14 is 0, SIS900PHY will auto-detect proper equalizer value.
1228  *      When the equalizer is stable, this value is not a fixed value. It will be within
1229  *      a small range(eg. 7~9). Then we get a minimum and a maximum value(eg. min=7, max=9)
1230  *      0 <= max <= 4  --> set equalizer to max
1231  *      5 <= max <= 14 --> set equalizer to max+1 or set equalizer to max+2 if max == min
1232  *      max >= 15      --> set equalizer to max+5 or set equalizer to max+6 if max == min
1233  */
1234
1235 static void sis630_set_eq(struct net_device *net_dev, u8 revision)
1236 {
1237         struct sis900_private *sis_priv = netdev_priv(net_dev);
1238         u16 reg14h, eq_value=0, max_value=0, min_value=0;
1239         int i, maxcount=10;
1240
1241         if ( !(revision == SIS630E_900_REV || revision == SIS630EA1_900_REV ||
1242                revision == SIS630A_900_REV || revision ==  SIS630ET_900_REV) )
1243                 return;
1244
1245         if (netif_carrier_ok(net_dev)) {
1246                 reg14h = mdio_read(net_dev, sis_priv->cur_phy, MII_RESV);
1247                 mdio_write(net_dev, sis_priv->cur_phy, MII_RESV,
1248                                         (0x2200 | reg14h) & 0xBFFF);
1249                 for (i=0; i < maxcount; i++) {
1250                         eq_value = (0x00F8 & mdio_read(net_dev,
1251                                         sis_priv->cur_phy, MII_RESV)) >> 3;
1252                         if (i == 0)
1253                                 max_value=min_value=eq_value;
1254                         max_value = (eq_value > max_value) ?
1255                                                 eq_value : max_value;
1256                         min_value = (eq_value < min_value) ?
1257                                                 eq_value : min_value;
1258                 }
1259                 /* 630E rule to determine the equalizer value */
1260                 if (revision == SIS630E_900_REV || revision == SIS630EA1_900_REV ||
1261                     revision == SIS630ET_900_REV) {
1262                         if (max_value < 5)
1263                                 eq_value = max_value;
1264                         else if (max_value >= 5 && max_value < 15)
1265                                 eq_value = (max_value == min_value) ?
1266                                                 max_value+2 : max_value+1;
1267                         else if (max_value >= 15)
1268                                 eq_value=(max_value == min_value) ?
1269                                                 max_value+6 : max_value+5;
1270                 }
1271                 /* 630B0&B1 rule to determine the equalizer value */
1272                 if (revision == SIS630A_900_REV &&
1273                     (sis_priv->host_bridge_rev == SIS630B0 ||
1274                      sis_priv->host_bridge_rev == SIS630B1)) {
1275                         if (max_value == 0)
1276                                 eq_value = 3;
1277                         else
1278                                 eq_value = (max_value + min_value + 1)/2;
1279                 }
1280                 /* write equalizer value and setting */
1281                 reg14h = mdio_read(net_dev, sis_priv->cur_phy, MII_RESV);
1282                 reg14h = (reg14h & 0xFF07) | ((eq_value << 3) & 0x00F8);
1283                 reg14h = (reg14h | 0x6000) & 0xFDFF;
1284                 mdio_write(net_dev, sis_priv->cur_phy, MII_RESV, reg14h);
1285         } else {
1286                 reg14h = mdio_read(net_dev, sis_priv->cur_phy, MII_RESV);
1287                 if (revision == SIS630A_900_REV &&
1288                     (sis_priv->host_bridge_rev == SIS630B0 ||
1289                      sis_priv->host_bridge_rev == SIS630B1))
1290                         mdio_write(net_dev, sis_priv->cur_phy, MII_RESV,
1291                                                 (reg14h | 0x2200) & 0xBFFF);
1292                 else
1293                         mdio_write(net_dev, sis_priv->cur_phy, MII_RESV,
1294                                                 (reg14h | 0x2000) & 0xBFFF);
1295         }
1296 }
1297
1298 /**
1299  *      sis900_timer - sis900 timer routine
1300  *      @data: pointer to sis900 net device
1301  *
1302  *      On each timer ticks we check two things,
1303  *      link status (ON/OFF) and link mode (10/100/Full/Half)
1304  */
1305
1306 static void sis900_timer(unsigned long data)
1307 {
1308         struct net_device *net_dev = (struct net_device *)data;
1309         struct sis900_private *sis_priv = netdev_priv(net_dev);
1310         struct mii_phy *mii_phy = sis_priv->mii;
1311         static const int next_tick = 5*HZ;
1312         u16 status;
1313
1314         if (!sis_priv->autong_complete){
1315                 int uninitialized_var(speed), duplex = 0;
1316
1317                 sis900_read_mode(net_dev, &speed, &duplex);
1318                 if (duplex){
1319                         sis900_set_mode(sis_priv, speed, duplex);
1320                         sis630_set_eq(net_dev, sis_priv->chipset_rev);
1321                         netif_start_queue(net_dev);
1322                 }
1323
1324                 sis_priv->timer.expires = jiffies + HZ;
1325                 add_timer(&sis_priv->timer);
1326                 return;
1327         }
1328
1329         status = mdio_read(net_dev, sis_priv->cur_phy, MII_STATUS);
1330         status = mdio_read(net_dev, sis_priv->cur_phy, MII_STATUS);
1331
1332         /* Link OFF -> ON */
1333         if (!netif_carrier_ok(net_dev)) {
1334         LookForLink:
1335                 /* Search for new PHY */
1336                 status = sis900_default_phy(net_dev);
1337                 mii_phy = sis_priv->mii;
1338
1339                 if (status & MII_STAT_LINK){
1340                         sis900_check_mode(net_dev, mii_phy);
1341                         netif_carrier_on(net_dev);
1342                 }
1343         } else {
1344         /* Link ON -> OFF */
1345                 if (!(status & MII_STAT_LINK)){
1346                         netif_carrier_off(net_dev);
1347                         if(netif_msg_link(sis_priv))
1348                                 printk(KERN_INFO "%s: Media Link Off\n", net_dev->name);
1349
1350                         /* Change mode issue */
1351                         if ((mii_phy->phy_id0 == 0x001D) &&
1352                             ((mii_phy->phy_id1 & 0xFFF0) == 0x8000))
1353                                 sis900_reset_phy(net_dev,  sis_priv->cur_phy);
1354
1355                         sis630_set_eq(net_dev, sis_priv->chipset_rev);
1356
1357                         goto LookForLink;
1358                 }
1359         }
1360
1361         sis_priv->timer.expires = jiffies + next_tick;
1362         add_timer(&sis_priv->timer);
1363 }
1364
1365 /**
1366  *      sis900_check_mode - check the media mode for sis900
1367  *      @net_dev: the net device to be checked
1368  *      @mii_phy: the mii phy
1369  *
1370  *      Older driver gets the media mode from mii status output
1371  *      register. Now we set our media capability and auto-negotiate
1372  *      to get the upper bound of speed and duplex between two ends.
1373  *      If the types of mii phy is HOME, it doesn't need to auto-negotiate
1374  *      and autong_complete should be set to 1.
1375  */
1376
1377 static void sis900_check_mode(struct net_device *net_dev, struct mii_phy *mii_phy)
1378 {
1379         struct sis900_private *sis_priv = netdev_priv(net_dev);
1380         void __iomem *ioaddr = sis_priv->ioaddr;
1381         int speed, duplex;
1382
1383         if (mii_phy->phy_types == LAN) {
1384                 sw32(cfg, ~EXD & sr32(cfg));
1385                 sis900_set_capability(net_dev , mii_phy);
1386                 sis900_auto_negotiate(net_dev, sis_priv->cur_phy);
1387         } else {
1388                 sw32(cfg, EXD | sr32(cfg));
1389                 speed = HW_SPEED_HOME;
1390                 duplex = FDX_CAPABLE_HALF_SELECTED;
1391                 sis900_set_mode(sis_priv, speed, duplex);
1392                 sis_priv->autong_complete = 1;
1393         }
1394 }
1395
1396 /**
1397  *      sis900_set_mode - Set the media mode of mac register.
1398  *      @sp:     the device private data
1399  *      @speed : the transmit speed to be determined
1400  *      @duplex: the duplex mode to be determined
1401  *
1402  *      Set the media mode of mac register txcfg/rxcfg according to
1403  *      speed and duplex of phy. Bit EDB_MASTER_EN indicates the EDB
1404  *      bus is used instead of PCI bus. When this bit is set 1, the
1405  *      Max DMA Burst Size for TX/RX DMA should be no larger than 16
1406  *      double words.
1407  */
1408
1409 static void sis900_set_mode(struct sis900_private *sp, int speed, int duplex)
1410 {
1411         void __iomem *ioaddr = sp->ioaddr;
1412         u32 tx_flags = 0, rx_flags = 0;
1413
1414         if (sr32( cfg) & EDB_MASTER_EN) {
1415                 tx_flags = TxATP | (DMA_BURST_64 << TxMXDMA_shift) |
1416                                         (TX_FILL_THRESH << TxFILLT_shift);
1417                 rx_flags = DMA_BURST_64 << RxMXDMA_shift;
1418         } else {
1419                 tx_flags = TxATP | (DMA_BURST_512 << TxMXDMA_shift) |
1420                                         (TX_FILL_THRESH << TxFILLT_shift);
1421                 rx_flags = DMA_BURST_512 << RxMXDMA_shift;
1422         }
1423
1424         if (speed == HW_SPEED_HOME || speed == HW_SPEED_10_MBPS) {
1425                 rx_flags |= (RxDRNT_10 << RxDRNT_shift);
1426                 tx_flags |= (TxDRNT_10 << TxDRNT_shift);
1427         } else {
1428                 rx_flags |= (RxDRNT_100 << RxDRNT_shift);
1429                 tx_flags |= (TxDRNT_100 << TxDRNT_shift);
1430         }
1431
1432         if (duplex == FDX_CAPABLE_FULL_SELECTED) {
1433                 tx_flags |= (TxCSI | TxHBI);
1434                 rx_flags |= RxATX;
1435         }
1436
1437 #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
1438         /* Can accept Jumbo packet */
1439         rx_flags |= RxAJAB;
1440 #endif
1441
1442         sw32(txcfg, tx_flags);
1443         sw32(rxcfg, rx_flags);
1444 }
1445
1446 /**
1447  *      sis900_auto_negotiate - Set the Auto-Negotiation Enable/Reset bit.
1448  *      @net_dev: the net device to read mode for
1449  *      @phy_addr: mii phy address
1450  *
1451  *      If the adapter is link-on, set the auto-negotiate enable/reset bit.
1452  *      autong_complete should be set to 0 when starting auto-negotiation.
1453  *      autong_complete should be set to 1 if we didn't start auto-negotiation.
1454  *      sis900_timer will wait for link on again if autong_complete = 0.
1455  */
1456
1457 static void sis900_auto_negotiate(struct net_device *net_dev, int phy_addr)
1458 {
1459         struct sis900_private *sis_priv = netdev_priv(net_dev);
1460         int i = 0;
1461         u32 status;
1462
1463         for (i = 0; i < 2; i++)
1464                 status = mdio_read(net_dev, phy_addr, MII_STATUS);
1465
1466         if (!(status & MII_STAT_LINK)){
1467                 if(netif_msg_link(sis_priv))
1468                         printk(KERN_INFO "%s: Media Link Off\n", net_dev->name);
1469                 sis_priv->autong_complete = 1;
1470                 netif_carrier_off(net_dev);
1471                 return;
1472         }
1473
1474         /* (Re)start AutoNegotiate */
1475         mdio_write(net_dev, phy_addr, MII_CONTROL,
1476                    MII_CNTL_AUTO | MII_CNTL_RST_AUTO);
1477         sis_priv->autong_complete = 0;
1478 }
1479
1480
1481 /**
1482  *      sis900_read_mode - read media mode for sis900 internal phy
1483  *      @net_dev: the net device to read mode for
1484  *      @speed  : the transmit speed to be determined
1485  *      @duplex : the duplex mode to be determined
1486  *
1487  *      The capability of remote end will be put in mii register autorec
1488  *      after auto-negotiation. Use AND operation to get the upper bound
1489  *      of speed and duplex between two ends.
1490  */
1491
1492 static void sis900_read_mode(struct net_device *net_dev, int *speed, int *duplex)
1493 {
1494         struct sis900_private *sis_priv = netdev_priv(net_dev);
1495         struct mii_phy *phy = sis_priv->mii;
1496         int phy_addr = sis_priv->cur_phy;
1497         u32 status;
1498         u16 autoadv, autorec;
1499         int i;
1500
1501         for (i = 0; i < 2; i++)
1502                 status = mdio_read(net_dev, phy_addr, MII_STATUS);
1503
1504         if (!(status & MII_STAT_LINK))
1505                 return;
1506
1507         /* AutoNegotiate completed */
1508         autoadv = mdio_read(net_dev, phy_addr, MII_ANADV);
1509         autorec = mdio_read(net_dev, phy_addr, MII_ANLPAR);
1510         status = autoadv & autorec;
1511
1512         *speed = HW_SPEED_10_MBPS;
1513         *duplex = FDX_CAPABLE_HALF_SELECTED;
1514
1515         if (status & (MII_NWAY_TX | MII_NWAY_TX_FDX))
1516                 *speed = HW_SPEED_100_MBPS;
1517         if (status & ( MII_NWAY_TX_FDX | MII_NWAY_T_FDX))
1518                 *duplex = FDX_CAPABLE_FULL_SELECTED;
1519
1520         sis_priv->autong_complete = 1;
1521
1522         /* Workaround for Realtek RTL8201 PHY issue */
1523         if ((phy->phy_id0 == 0x0000) && ((phy->phy_id1 & 0xFFF0) == 0x8200)) {
1524                 if (mdio_read(net_dev, phy_addr, MII_CONTROL) & MII_CNTL_FDX)
1525                         *duplex = FDX_CAPABLE_FULL_SELECTED;
1526                 if (mdio_read(net_dev, phy_addr, 0x0019) & 0x01)
1527                         *speed = HW_SPEED_100_MBPS;
1528         }
1529
1530         if(netif_msg_link(sis_priv))
1531                 printk(KERN_INFO "%s: Media Link On %s %s-duplex\n",
1532                                         net_dev->name,
1533                                         *speed == HW_SPEED_100_MBPS ?
1534                                                 "100mbps" : "10mbps",
1535                                         *duplex == FDX_CAPABLE_FULL_SELECTED ?
1536                                                 "full" : "half");
1537 }
1538
1539 /**
1540  *      sis900_tx_timeout - sis900 transmit timeout routine
1541  *      @net_dev: the net device to transmit
1542  *
1543  *      print transmit timeout status
1544  *      disable interrupts and do some tasks
1545  */
1546
1547 static void sis900_tx_timeout(struct net_device *net_dev)
1548 {
1549         struct sis900_private *sis_priv = netdev_priv(net_dev);
1550         void __iomem *ioaddr = sis_priv->ioaddr;
1551         unsigned long flags;
1552         int i;
1553
1554         if (netif_msg_tx_err(sis_priv)) {
1555                 printk(KERN_INFO "%s: Transmit timeout, status %8.8x %8.8x\n",
1556                         net_dev->name, sr32(cr), sr32(isr));
1557         }
1558
1559         /* Disable interrupts by clearing the interrupt mask. */
1560         sw32(imr, 0x0000);
1561
1562         /* use spinlock to prevent interrupt handler accessing buffer ring */
1563         spin_lock_irqsave(&sis_priv->lock, flags);
1564
1565         /* discard unsent packets */
1566         sis_priv->dirty_tx = sis_priv->cur_tx = 0;
1567         for (i = 0; i < NUM_TX_DESC; i++) {
1568                 struct sk_buff *skb = sis_priv->tx_skbuff[i];
1569
1570                 if (skb) {
1571                         pci_unmap_single(sis_priv->pci_dev,
1572                                 sis_priv->tx_ring[i].bufptr, skb->len,
1573                                 PCI_DMA_TODEVICE);
1574                         dev_kfree_skb_irq(skb);
1575                         sis_priv->tx_skbuff[i] = NULL;
1576                         sis_priv->tx_ring[i].cmdsts = 0;
1577                         sis_priv->tx_ring[i].bufptr = 0;
1578                         net_dev->stats.tx_dropped++;
1579                 }
1580         }
1581         sis_priv->tx_full = 0;
1582         netif_wake_queue(net_dev);
1583
1584         spin_unlock_irqrestore(&sis_priv->lock, flags);
1585
1586         net_dev->trans_start = jiffies; /* prevent tx timeout */
1587
1588         /* load Transmit Descriptor Register */
1589         sw32(txdp, sis_priv->tx_ring_dma);
1590
1591         /* Enable all known interrupts by setting the interrupt mask. */
1592         sw32(imr, RxSOVR | RxORN | RxERR | RxOK | TxURN | TxERR | TxIDLE);
1593 }
1594
1595 /**
1596  *      sis900_start_xmit - sis900 start transmit routine
1597  *      @skb: socket buffer pointer to put the data being transmitted
1598  *      @net_dev: the net device to transmit with
1599  *
1600  *      Set the transmit buffer descriptor,
1601  *      and write TxENA to enable transmit state machine.
1602  *      tell upper layer if the buffer is full
1603  */
1604
1605 static netdev_tx_t
1606 sis900_start_xmit(struct sk_buff *skb, struct net_device *net_dev)
1607 {
1608         struct sis900_private *sis_priv = netdev_priv(net_dev);
1609         void __iomem *ioaddr = sis_priv->ioaddr;
1610         unsigned int  entry;
1611         unsigned long flags;
1612         unsigned int  index_cur_tx, index_dirty_tx;
1613         unsigned int  count_dirty_tx;
1614
1615         /* Don't transmit data before the complete of auto-negotiation */
1616         if(!sis_priv->autong_complete){
1617                 netif_stop_queue(net_dev);
1618                 return NETDEV_TX_BUSY;
1619         }
1620
1621         spin_lock_irqsave(&sis_priv->lock, flags);
1622
1623         /* Calculate the next Tx descriptor entry. */
1624         entry = sis_priv->cur_tx % NUM_TX_DESC;
1625         sis_priv->tx_skbuff[entry] = skb;
1626
1627         /* set the transmit buffer descriptor and enable Transmit State Machine */
1628         sis_priv->tx_ring[entry].bufptr = pci_map_single(sis_priv->pci_dev,
1629                 skb->data, skb->len, PCI_DMA_TODEVICE);
1630         if (unlikely(pci_dma_mapping_error(sis_priv->pci_dev,
1631                 sis_priv->tx_ring[entry].bufptr))) {
1632                         dev_kfree_skb(skb);
1633                         sis_priv->tx_skbuff[entry] = NULL;
1634                         net_dev->stats.tx_dropped++;
1635                         spin_unlock_irqrestore(&sis_priv->lock, flags);
1636                         return NETDEV_TX_OK;
1637         }
1638         sis_priv->tx_ring[entry].cmdsts = (OWN | skb->len);
1639         sw32(cr, TxENA | sr32(cr));
1640
1641         sis_priv->cur_tx ++;
1642         index_cur_tx = sis_priv->cur_tx;
1643         index_dirty_tx = sis_priv->dirty_tx;
1644
1645         for (count_dirty_tx = 0; index_cur_tx != index_dirty_tx; index_dirty_tx++)
1646                 count_dirty_tx ++;
1647
1648         if (index_cur_tx == index_dirty_tx) {
1649                 /* dirty_tx is met in the cycle of cur_tx, buffer full */
1650                 sis_priv->tx_full = 1;
1651                 netif_stop_queue(net_dev);
1652         } else if (count_dirty_tx < NUM_TX_DESC) {
1653                 /* Typical path, tell upper layer that more transmission is possible */
1654                 netif_start_queue(net_dev);
1655         } else {
1656                 /* buffer full, tell upper layer no more transmission */
1657                 sis_priv->tx_full = 1;
1658                 netif_stop_queue(net_dev);
1659         }
1660
1661         spin_unlock_irqrestore(&sis_priv->lock, flags);
1662
1663         if (netif_msg_tx_queued(sis_priv))
1664                 printk(KERN_DEBUG "%s: Queued Tx packet at %p size %d "
1665                        "to slot %d.\n",
1666                        net_dev->name, skb->data, (int)skb->len, entry);
1667
1668         return NETDEV_TX_OK;
1669 }
1670
1671 /**
1672  *      sis900_interrupt - sis900 interrupt handler
1673  *      @irq: the irq number
1674  *      @dev_instance: the client data object
1675  *
1676  *      The interrupt handler does all of the Rx thread work,
1677  *      and cleans up after the Tx thread
1678  */
1679
1680 static irqreturn_t sis900_interrupt(int irq, void *dev_instance)
1681 {
1682         struct net_device *net_dev = dev_instance;
1683         struct sis900_private *sis_priv = netdev_priv(net_dev);
1684         int boguscnt = max_interrupt_work;
1685         void __iomem *ioaddr = sis_priv->ioaddr;
1686         u32 status;
1687         unsigned int handled = 0;
1688
1689         spin_lock (&sis_priv->lock);
1690
1691         do {
1692                 status = sr32(isr);
1693
1694                 if ((status & (HIBERR|TxURN|TxERR|TxIDLE|RxORN|RxERR|RxOK)) == 0)
1695                         /* nothing intresting happened */
1696                         break;
1697                 handled = 1;
1698
1699                 /* why dow't we break after Tx/Rx case ?? keyword: full-duplex */
1700                 if (status & (RxORN | RxERR | RxOK))
1701                         /* Rx interrupt */
1702                         sis900_rx(net_dev);
1703
1704                 if (status & (TxURN | TxERR | TxIDLE))
1705                         /* Tx interrupt */
1706                         sis900_finish_xmit(net_dev);
1707
1708                 /* something strange happened !!! */
1709                 if (status & HIBERR) {
1710                         if(netif_msg_intr(sis_priv))
1711                                 printk(KERN_INFO "%s: Abnormal interrupt, "
1712                                         "status %#8.8x.\n", net_dev->name, status);
1713                         break;
1714                 }
1715                 if (--boguscnt < 0) {
1716                         if(netif_msg_intr(sis_priv))
1717                                 printk(KERN_INFO "%s: Too much work at interrupt, "
1718                                         "interrupt status = %#8.8x.\n",
1719                                         net_dev->name, status);
1720                         break;
1721                 }
1722         } while (1);
1723
1724         if(netif_msg_intr(sis_priv))
1725                 printk(KERN_DEBUG "%s: exiting interrupt, "
1726                        "interrupt status = 0x%#8.8x.\n",
1727                        net_dev->name, sr32(isr));
1728
1729         spin_unlock (&sis_priv->lock);
1730         return IRQ_RETVAL(handled);
1731 }
1732
1733 /**
1734  *      sis900_rx - sis900 receive routine
1735  *      @net_dev: the net device which receives data
1736  *
1737  *      Process receive interrupt events,
1738  *      put buffer to higher layer and refill buffer pool
1739  *      Note: This function is called by interrupt handler,
1740  *      don't do "too much" work here
1741  */
1742
1743 static int sis900_rx(struct net_device *net_dev)
1744 {
1745         struct sis900_private *sis_priv = netdev_priv(net_dev);
1746         void __iomem *ioaddr = sis_priv->ioaddr;
1747         unsigned int entry = sis_priv->cur_rx % NUM_RX_DESC;
1748         u32 rx_status = sis_priv->rx_ring[entry].cmdsts;
1749         int rx_work_limit;
1750
1751         if (netif_msg_rx_status(sis_priv))
1752                 printk(KERN_DEBUG "sis900_rx, cur_rx:%4.4d, dirty_rx:%4.4d "
1753                        "status:0x%8.8x\n",
1754                        sis_priv->cur_rx, sis_priv->dirty_rx, rx_status);
1755         rx_work_limit = sis_priv->dirty_rx + NUM_RX_DESC - sis_priv->cur_rx;
1756
1757         while (rx_status & OWN) {
1758                 unsigned int rx_size;
1759                 unsigned int data_size;
1760
1761                 if (--rx_work_limit < 0)
1762                         break;
1763
1764                 data_size = rx_status & DSIZE;
1765                 rx_size = data_size - CRC_SIZE;
1766
1767 #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
1768                 /* ``TOOLONG'' flag means jumbo packet received. */
1769                 if ((rx_status & TOOLONG) && data_size <= MAX_FRAME_SIZE)
1770                         rx_status &= (~ ((unsigned int)TOOLONG));
1771 #endif
1772
1773                 if (rx_status & (ABORT|OVERRUN|TOOLONG|RUNT|RXISERR|CRCERR|FAERR)) {
1774                         /* corrupted packet received */
1775                         if (netif_msg_rx_err(sis_priv))
1776                                 printk(KERN_DEBUG "%s: Corrupted packet "
1777                                        "received, buffer status = 0x%8.8x/%d.\n",
1778                                        net_dev->name, rx_status, data_size);
1779                         net_dev->stats.rx_errors++;
1780                         if (rx_status & OVERRUN)
1781                                 net_dev->stats.rx_over_errors++;
1782                         if (rx_status & (TOOLONG|RUNT))
1783                                 net_dev->stats.rx_length_errors++;
1784                         if (rx_status & (RXISERR | FAERR))
1785                                 net_dev->stats.rx_frame_errors++;
1786                         if (rx_status & CRCERR)
1787                                 net_dev->stats.rx_crc_errors++;
1788                         /* reset buffer descriptor state */
1789                         sis_priv->rx_ring[entry].cmdsts = RX_BUF_SIZE;
1790                 } else {
1791                         struct sk_buff * skb;
1792                         struct sk_buff * rx_skb;
1793
1794                         pci_unmap_single(sis_priv->pci_dev,
1795                                 sis_priv->rx_ring[entry].bufptr, RX_BUF_SIZE,
1796                                 PCI_DMA_FROMDEVICE);
1797
1798                         /* refill the Rx buffer, what if there is not enough
1799                          * memory for new socket buffer ?? */
1800                         if ((skb = netdev_alloc_skb(net_dev, RX_BUF_SIZE)) == NULL) {
1801                                 /*
1802                                  * Not enough memory to refill the buffer
1803                                  * so we need to recycle the old one so
1804                                  * as to avoid creating a memory hole
1805                                  * in the rx ring
1806                                  */
1807                                 skb = sis_priv->rx_skbuff[entry];
1808                                 net_dev->stats.rx_dropped++;
1809                                 goto refill_rx_ring;
1810                         }
1811
1812                         /* This situation should never happen, but due to
1813                            some unknown bugs, it is possible that
1814                            we are working on NULL sk_buff :-( */
1815                         if (sis_priv->rx_skbuff[entry] == NULL) {
1816                                 if (netif_msg_rx_err(sis_priv))
1817                                         printk(KERN_WARNING "%s: NULL pointer "
1818                                               "encountered in Rx ring\n"
1819                                               "cur_rx:%4.4d, dirty_rx:%4.4d\n",
1820                                               net_dev->name, sis_priv->cur_rx,
1821                                               sis_priv->dirty_rx);
1822                                 dev_kfree_skb(skb);
1823                                 break;
1824                         }
1825
1826                         /* give the socket buffer to upper layers */
1827                         rx_skb = sis_priv->rx_skbuff[entry];
1828                         skb_put(rx_skb, rx_size);
1829                         rx_skb->protocol = eth_type_trans(rx_skb, net_dev);
1830                         netif_rx(rx_skb);
1831
1832                         /* some network statistics */
1833                         if ((rx_status & BCAST) == MCAST)
1834                                 net_dev->stats.multicast++;
1835                         net_dev->stats.rx_bytes += rx_size;
1836                         net_dev->stats.rx_packets++;
1837                         sis_priv->dirty_rx++;
1838 refill_rx_ring:
1839                         sis_priv->rx_skbuff[entry] = skb;
1840                         sis_priv->rx_ring[entry].cmdsts = RX_BUF_SIZE;
1841                         sis_priv->rx_ring[entry].bufptr =
1842                                 pci_map_single(sis_priv->pci_dev, skb->data,
1843                                         RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
1844                         if (unlikely(pci_dma_mapping_error(sis_priv->pci_dev,
1845                                 sis_priv->rx_ring[entry].bufptr))) {
1846                                 dev_kfree_skb_irq(skb);
1847                                 sis_priv->rx_skbuff[entry] = NULL;
1848                                 break;
1849                         }
1850                 }
1851                 sis_priv->cur_rx++;
1852                 entry = sis_priv->cur_rx % NUM_RX_DESC;
1853                 rx_status = sis_priv->rx_ring[entry].cmdsts;
1854         } // while
1855
1856         /* refill the Rx buffer, what if the rate of refilling is slower
1857          * than consuming ?? */
1858         for (; sis_priv->cur_rx != sis_priv->dirty_rx; sis_priv->dirty_rx++) {
1859                 struct sk_buff *skb;
1860
1861                 entry = sis_priv->dirty_rx % NUM_RX_DESC;
1862
1863                 if (sis_priv->rx_skbuff[entry] == NULL) {
1864                         skb = netdev_alloc_skb(net_dev, RX_BUF_SIZE);
1865                         if (skb == NULL) {
1866                                 /* not enough memory for skbuff, this makes a
1867                                  * "hole" on the buffer ring, it is not clear
1868                                  * how the hardware will react to this kind
1869                                  * of degenerated buffer */
1870                                 net_dev->stats.rx_dropped++;
1871                                 break;
1872                         }
1873                         sis_priv->rx_skbuff[entry] = skb;
1874                         sis_priv->rx_ring[entry].cmdsts = RX_BUF_SIZE;
1875                         sis_priv->rx_ring[entry].bufptr =
1876                                 pci_map_single(sis_priv->pci_dev, skb->data,
1877                                         RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
1878                         if (unlikely(pci_dma_mapping_error(sis_priv->pci_dev,
1879                                         sis_priv->rx_ring[entry].bufptr))) {
1880                                 dev_kfree_skb_irq(skb);
1881                                 sis_priv->rx_skbuff[entry] = NULL;
1882                                 break;
1883                         }
1884                 }
1885         }
1886         /* re-enable the potentially idle receive state matchine */
1887         sw32(cr , RxENA | sr32(cr));
1888
1889         return 0;
1890 }
1891
1892 /**
1893  *      sis900_finish_xmit - finish up transmission of packets
1894  *      @net_dev: the net device to be transmitted on
1895  *
1896  *      Check for error condition and free socket buffer etc
1897  *      schedule for more transmission as needed
1898  *      Note: This function is called by interrupt handler,
1899  *      don't do "too much" work here
1900  */
1901
1902 static void sis900_finish_xmit (struct net_device *net_dev)
1903 {
1904         struct sis900_private *sis_priv = netdev_priv(net_dev);
1905
1906         for (; sis_priv->dirty_tx != sis_priv->cur_tx; sis_priv->dirty_tx++) {
1907                 struct sk_buff *skb;
1908                 unsigned int entry;
1909                 u32 tx_status;
1910
1911                 entry = sis_priv->dirty_tx % NUM_TX_DESC;
1912                 tx_status = sis_priv->tx_ring[entry].cmdsts;
1913
1914                 if (tx_status & OWN) {
1915                         /* The packet is not transmitted yet (owned by hardware) !
1916                          * Note: the interrupt is generated only when Tx Machine
1917                          * is idle, so this is an almost impossible case */
1918                         break;
1919                 }
1920
1921                 if (tx_status & (ABORT | UNDERRUN | OWCOLL)) {
1922                         /* packet unsuccessfully transmitted */
1923                         if (netif_msg_tx_err(sis_priv))
1924                                 printk(KERN_DEBUG "%s: Transmit "
1925                                        "error, Tx status %8.8x.\n",
1926                                        net_dev->name, tx_status);
1927                         net_dev->stats.tx_errors++;
1928                         if (tx_status & UNDERRUN)
1929                                 net_dev->stats.tx_fifo_errors++;
1930                         if (tx_status & ABORT)
1931                                 net_dev->stats.tx_aborted_errors++;
1932                         if (tx_status & NOCARRIER)
1933                                 net_dev->stats.tx_carrier_errors++;
1934                         if (tx_status & OWCOLL)
1935                                 net_dev->stats.tx_window_errors++;
1936                 } else {
1937                         /* packet successfully transmitted */
1938                         net_dev->stats.collisions += (tx_status & COLCNT) >> 16;
1939                         net_dev->stats.tx_bytes += tx_status & DSIZE;
1940                         net_dev->stats.tx_packets++;
1941                 }
1942                 /* Free the original skb. */
1943                 skb = sis_priv->tx_skbuff[entry];
1944                 pci_unmap_single(sis_priv->pci_dev,
1945                         sis_priv->tx_ring[entry].bufptr, skb->len,
1946                         PCI_DMA_TODEVICE);
1947                 dev_kfree_skb_irq(skb);
1948                 sis_priv->tx_skbuff[entry] = NULL;
1949                 sis_priv->tx_ring[entry].bufptr = 0;
1950                 sis_priv->tx_ring[entry].cmdsts = 0;
1951         }
1952
1953         if (sis_priv->tx_full && netif_queue_stopped(net_dev) &&
1954             sis_priv->cur_tx - sis_priv->dirty_tx < NUM_TX_DESC - 4) {
1955                 /* The ring is no longer full, clear tx_full and schedule
1956                  * more transmission by netif_wake_queue(net_dev) */
1957                 sis_priv->tx_full = 0;
1958                 netif_wake_queue (net_dev);
1959         }
1960 }
1961
1962 /**
1963  *      sis900_close - close sis900 device
1964  *      @net_dev: the net device to be closed
1965  *
1966  *      Disable interrupts, stop the Tx and Rx Status Machine
1967  *      free Tx and RX socket buffer
1968  */
1969
1970 static int sis900_close(struct net_device *net_dev)
1971 {
1972         struct sis900_private *sis_priv = netdev_priv(net_dev);
1973         struct pci_dev *pdev = sis_priv->pci_dev;
1974         void __iomem *ioaddr = sis_priv->ioaddr;
1975         struct sk_buff *skb;
1976         int i;
1977
1978         netif_stop_queue(net_dev);
1979
1980         /* Disable interrupts by clearing the interrupt mask. */
1981         sw32(imr, 0x0000);
1982         sw32(ier, 0x0000);
1983
1984         /* Stop the chip's Tx and Rx Status Machine */
1985         sw32(cr, RxDIS | TxDIS | sr32(cr));
1986
1987         del_timer(&sis_priv->timer);
1988
1989         free_irq(pdev->irq, net_dev);
1990
1991         /* Free Tx and RX skbuff */
1992         for (i = 0; i < NUM_RX_DESC; i++) {
1993                 skb = sis_priv->rx_skbuff[i];
1994                 if (skb) {
1995                         pci_unmap_single(pdev, sis_priv->rx_ring[i].bufptr,
1996                                          RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
1997                         dev_kfree_skb(skb);
1998                         sis_priv->rx_skbuff[i] = NULL;
1999                 }
2000         }
2001         for (i = 0; i < NUM_TX_DESC; i++) {
2002                 skb = sis_priv->tx_skbuff[i];
2003                 if (skb) {
2004                         pci_unmap_single(pdev, sis_priv->tx_ring[i].bufptr,
2005                                          skb->len, PCI_DMA_TODEVICE);
2006                         dev_kfree_skb(skb);
2007                         sis_priv->tx_skbuff[i] = NULL;
2008                 }
2009         }
2010
2011         /* Green! Put the chip in low-power mode. */
2012
2013         return 0;
2014 }
2015
2016 /**
2017  *      sis900_get_drvinfo - Return information about driver
2018  *      @net_dev: the net device to probe
2019  *      @info: container for info returned
2020  *
2021  *      Process ethtool command such as "ehtool -i" to show information
2022  */
2023
2024 static void sis900_get_drvinfo(struct net_device *net_dev,
2025                                struct ethtool_drvinfo *info)
2026 {
2027         struct sis900_private *sis_priv = netdev_priv(net_dev);
2028
2029         strlcpy(info->driver, SIS900_MODULE_NAME, sizeof(info->driver));
2030         strlcpy(info->version, SIS900_DRV_VERSION, sizeof(info->version));
2031         strlcpy(info->bus_info, pci_name(sis_priv->pci_dev),
2032                 sizeof(info->bus_info));
2033 }
2034
2035 static u32 sis900_get_msglevel(struct net_device *net_dev)
2036 {
2037         struct sis900_private *sis_priv = netdev_priv(net_dev);
2038         return sis_priv->msg_enable;
2039 }
2040
2041 static void sis900_set_msglevel(struct net_device *net_dev, u32 value)
2042 {
2043         struct sis900_private *sis_priv = netdev_priv(net_dev);
2044         sis_priv->msg_enable = value;
2045 }
2046
2047 static u32 sis900_get_link(struct net_device *net_dev)
2048 {
2049         struct sis900_private *sis_priv = netdev_priv(net_dev);
2050         return mii_link_ok(&sis_priv->mii_info);
2051 }
2052
2053 static int sis900_get_settings(struct net_device *net_dev,
2054                                 struct ethtool_cmd *cmd)
2055 {
2056         struct sis900_private *sis_priv = netdev_priv(net_dev);
2057         spin_lock_irq(&sis_priv->lock);
2058         mii_ethtool_gset(&sis_priv->mii_info, cmd);
2059         spin_unlock_irq(&sis_priv->lock);
2060         return 0;
2061 }
2062
2063 static int sis900_set_settings(struct net_device *net_dev,
2064                                 struct ethtool_cmd *cmd)
2065 {
2066         struct sis900_private *sis_priv = netdev_priv(net_dev);
2067         int rt;
2068         spin_lock_irq(&sis_priv->lock);
2069         rt = mii_ethtool_sset(&sis_priv->mii_info, cmd);
2070         spin_unlock_irq(&sis_priv->lock);
2071         return rt;
2072 }
2073
2074 static int sis900_nway_reset(struct net_device *net_dev)
2075 {
2076         struct sis900_private *sis_priv = netdev_priv(net_dev);
2077         return mii_nway_restart(&sis_priv->mii_info);
2078 }
2079
2080 /**
2081  *      sis900_set_wol - Set up Wake on Lan registers
2082  *      @net_dev: the net device to probe
2083  *      @wol: container for info passed to the driver
2084  *
2085  *      Process ethtool command "wol" to setup wake on lan features.
2086  *      SiS900 supports sending WoL events if a correct packet is received,
2087  *      but there is no simple way to filter them to only a subset (broadcast,
2088  *      multicast, unicast or arp).
2089  */
2090
2091 static int sis900_set_wol(struct net_device *net_dev, struct ethtool_wolinfo *wol)
2092 {
2093         struct sis900_private *sis_priv = netdev_priv(net_dev);
2094         void __iomem *ioaddr = sis_priv->ioaddr;
2095         u32 cfgpmcsr = 0, pmctrl_bits = 0;
2096
2097         if (wol->wolopts == 0) {
2098                 pci_read_config_dword(sis_priv->pci_dev, CFGPMCSR, &cfgpmcsr);
2099                 cfgpmcsr &= ~PME_EN;
2100                 pci_write_config_dword(sis_priv->pci_dev, CFGPMCSR, cfgpmcsr);
2101                 sw32(pmctrl, pmctrl_bits);
2102                 if (netif_msg_wol(sis_priv))
2103                         printk(KERN_DEBUG "%s: Wake on LAN disabled\n", net_dev->name);
2104                 return 0;
2105         }
2106
2107         if (wol->wolopts & (WAKE_MAGICSECURE | WAKE_UCAST | WAKE_MCAST
2108                                 | WAKE_BCAST | WAKE_ARP))
2109                 return -EINVAL;
2110
2111         if (wol->wolopts & WAKE_MAGIC)
2112                 pmctrl_bits |= MAGICPKT;
2113         if (wol->wolopts & WAKE_PHY)
2114                 pmctrl_bits |= LINKON;
2115
2116         sw32(pmctrl, pmctrl_bits);
2117
2118         pci_read_config_dword(sis_priv->pci_dev, CFGPMCSR, &cfgpmcsr);
2119         cfgpmcsr |= PME_EN;
2120         pci_write_config_dword(sis_priv->pci_dev, CFGPMCSR, cfgpmcsr);
2121         if (netif_msg_wol(sis_priv))
2122                 printk(KERN_DEBUG "%s: Wake on LAN enabled\n", net_dev->name);
2123
2124         return 0;
2125 }
2126
2127 static void sis900_get_wol(struct net_device *net_dev, struct ethtool_wolinfo *wol)
2128 {
2129         struct sis900_private *sp = netdev_priv(net_dev);
2130         void __iomem *ioaddr = sp->ioaddr;
2131         u32 pmctrl_bits;
2132
2133         pmctrl_bits = sr32(pmctrl);
2134         if (pmctrl_bits & MAGICPKT)
2135                 wol->wolopts |= WAKE_MAGIC;
2136         if (pmctrl_bits & LINKON)
2137                 wol->wolopts |= WAKE_PHY;
2138
2139         wol->supported = (WAKE_PHY | WAKE_MAGIC);
2140 }
2141
2142 static const struct ethtool_ops sis900_ethtool_ops = {
2143         .get_drvinfo    = sis900_get_drvinfo,
2144         .get_msglevel   = sis900_get_msglevel,
2145         .set_msglevel   = sis900_set_msglevel,
2146         .get_link       = sis900_get_link,
2147         .get_settings   = sis900_get_settings,
2148         .set_settings   = sis900_set_settings,
2149         .nway_reset     = sis900_nway_reset,
2150         .get_wol        = sis900_get_wol,
2151         .set_wol        = sis900_set_wol
2152 };
2153
2154 /**
2155  *      mii_ioctl - process MII i/o control command
2156  *      @net_dev: the net device to command for
2157  *      @rq: parameter for command
2158  *      @cmd: the i/o command
2159  *
2160  *      Process MII command like read/write MII register
2161  */
2162
2163 static int mii_ioctl(struct net_device *net_dev, struct ifreq *rq, int cmd)
2164 {
2165         struct sis900_private *sis_priv = netdev_priv(net_dev);
2166         struct mii_ioctl_data *data = if_mii(rq);
2167
2168         switch(cmd) {
2169         case SIOCGMIIPHY:               /* Get address of MII PHY in use. */
2170                 data->phy_id = sis_priv->mii->phy_addr;
2171                 /* Fall Through */
2172
2173         case SIOCGMIIREG:               /* Read MII PHY register. */
2174                 data->val_out = mdio_read(net_dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
2175                 return 0;
2176
2177         case SIOCSMIIREG:               /* Write MII PHY register. */
2178                 mdio_write(net_dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
2179                 return 0;
2180         default:
2181                 return -EOPNOTSUPP;
2182         }
2183 }
2184
2185 /**
2186  *      sis900_set_config - Set media type by net_device.set_config
2187  *      @dev: the net device for media type change
2188  *      @map: ifmap passed by ifconfig
2189  *
2190  *      Set media type to 10baseT, 100baseT or 0(for auto) by ifconfig
2191  *      we support only port changes. All other runtime configuration
2192  *      changes will be ignored
2193  */
2194
2195 static int sis900_set_config(struct net_device *dev, struct ifmap *map)
2196 {
2197         struct sis900_private *sis_priv = netdev_priv(dev);
2198         struct mii_phy *mii_phy = sis_priv->mii;
2199
2200         u16 status;
2201
2202         if ((map->port != (u_char)(-1)) && (map->port != dev->if_port)) {
2203                 /* we switch on the ifmap->port field. I couldn't find anything
2204                  * like a definition or standard for the values of that field.
2205                  * I think the meaning of those values is device specific. But
2206                  * since I would like to change the media type via the ifconfig
2207                  * command I use the definition from linux/netdevice.h
2208                  * (which seems to be different from the ifport(pcmcia) definition) */
2209                 switch(map->port){
2210                 case IF_PORT_UNKNOWN: /* use auto here */
2211                         dev->if_port = map->port;
2212                         /* we are going to change the media type, so the Link
2213                          * will be temporary down and we need to reflect that
2214                          * here. When the Link comes up again, it will be
2215                          * sensed by the sis_timer procedure, which also does
2216                          * all the rest for us */
2217                         netif_carrier_off(dev);
2218
2219                         /* read current state */
2220                         status = mdio_read(dev, mii_phy->phy_addr, MII_CONTROL);
2221
2222                         /* enable auto negotiation and reset the negotioation
2223                          * (I don't really know what the auto negatiotiation
2224                          * reset really means, but it sounds for me right to
2225                          * do one here) */
2226                         mdio_write(dev, mii_phy->phy_addr,
2227                                    MII_CONTROL, status | MII_CNTL_AUTO | MII_CNTL_RST_AUTO);
2228
2229                         break;
2230
2231                 case IF_PORT_10BASET: /* 10BaseT */
2232                         dev->if_port = map->port;
2233
2234                         /* we are going to change the media type, so the Link
2235                          * will be temporary down and we need to reflect that
2236                          * here. When the Link comes up again, it will be
2237                          * sensed by the sis_timer procedure, which also does
2238                          * all the rest for us */
2239                         netif_carrier_off(dev);
2240
2241                         /* set Speed to 10Mbps */
2242                         /* read current state */
2243                         status = mdio_read(dev, mii_phy->phy_addr, MII_CONTROL);
2244
2245                         /* disable auto negotiation and force 10MBit mode*/
2246                         mdio_write(dev, mii_phy->phy_addr,
2247                                    MII_CONTROL, status & ~(MII_CNTL_SPEED |
2248                                         MII_CNTL_AUTO));
2249                         break;
2250
2251                 case IF_PORT_100BASET: /* 100BaseT */
2252                 case IF_PORT_100BASETX: /* 100BaseTx */
2253                         dev->if_port = map->port;
2254
2255                         /* we are going to change the media type, so the Link
2256                          * will be temporary down and we need to reflect that
2257                          * here. When the Link comes up again, it will be
2258                          * sensed by the sis_timer procedure, which also does
2259                          * all the rest for us */
2260                         netif_carrier_off(dev);
2261
2262                         /* set Speed to 100Mbps */
2263                         /* disable auto negotiation and enable 100MBit Mode */
2264                         status = mdio_read(dev, mii_phy->phy_addr, MII_CONTROL);
2265                         mdio_write(dev, mii_phy->phy_addr,
2266                                    MII_CONTROL, (status & ~MII_CNTL_SPEED) |
2267                                    MII_CNTL_SPEED);
2268
2269                         break;
2270
2271                 case IF_PORT_10BASE2: /* 10Base2 */
2272                 case IF_PORT_AUI: /* AUI */
2273                 case IF_PORT_100BASEFX: /* 100BaseFx */
2274                         /* These Modes are not supported (are they?)*/
2275                         return -EOPNOTSUPP;
2276                         break;
2277
2278                 default:
2279                         return -EINVAL;
2280                 }
2281         }
2282         return 0;
2283 }
2284
2285 /**
2286  *      sis900_mcast_bitnr - compute hashtable index
2287  *      @addr: multicast address
2288  *      @revision: revision id of chip
2289  *
2290  *      SiS 900 uses the most sigificant 7 bits to index a 128 bits multicast
2291  *      hash table, which makes this function a little bit different from other drivers
2292  *      SiS 900 B0 & 635 M/B uses the most significat 8 bits to index 256 bits
2293  *      multicast hash table.
2294  */
2295
2296 static inline u16 sis900_mcast_bitnr(u8 *addr, u8 revision)
2297 {
2298
2299         u32 crc = ether_crc(6, addr);
2300
2301         /* leave 8 or 7 most siginifant bits */
2302         if ((revision >= SIS635A_900_REV) || (revision == SIS900B_900_REV))
2303                 return (int)(crc >> 24);
2304         else
2305                 return (int)(crc >> 25);
2306 }
2307
2308 /**
2309  *      set_rx_mode - Set SiS900 receive mode
2310  *      @net_dev: the net device to be set
2311  *
2312  *      Set SiS900 receive mode for promiscuous, multicast, or broadcast mode.
2313  *      And set the appropriate multicast filter.
2314  *      Multicast hash table changes from 128 to 256 bits for 635M/B & 900B0.
2315  */
2316
2317 static void set_rx_mode(struct net_device *net_dev)
2318 {
2319         struct sis900_private *sis_priv = netdev_priv(net_dev);
2320         void __iomem *ioaddr = sis_priv->ioaddr;
2321         u16 mc_filter[16] = {0};        /* 256/128 bits multicast hash table */
2322         int i, table_entries;
2323         u32 rx_mode;
2324
2325         /* 635 Hash Table entries = 256(2^16) */
2326         if((sis_priv->chipset_rev >= SIS635A_900_REV) ||
2327                         (sis_priv->chipset_rev == SIS900B_900_REV))
2328                 table_entries = 16;
2329         else
2330                 table_entries = 8;
2331
2332         if (net_dev->flags & IFF_PROMISC) {
2333                 /* Accept any kinds of packets */
2334                 rx_mode = RFPromiscuous;
2335                 for (i = 0; i < table_entries; i++)
2336                         mc_filter[i] = 0xffff;
2337         } else if ((netdev_mc_count(net_dev) > multicast_filter_limit) ||
2338                    (net_dev->flags & IFF_ALLMULTI)) {
2339                 /* too many multicast addresses or accept all multicast packet */
2340                 rx_mode = RFAAB | RFAAM;
2341                 for (i = 0; i < table_entries; i++)
2342                         mc_filter[i] = 0xffff;
2343         } else {
2344                 /* Accept Broadcast packet, destination address matchs our
2345                  * MAC address, use Receive Filter to reject unwanted MCAST
2346                  * packets */
2347                 struct netdev_hw_addr *ha;
2348                 rx_mode = RFAAB;
2349
2350                 netdev_for_each_mc_addr(ha, net_dev) {
2351                         unsigned int bit_nr;
2352
2353                         bit_nr = sis900_mcast_bitnr(ha->addr,
2354                                                     sis_priv->chipset_rev);
2355                         mc_filter[bit_nr >> 4] |= (1 << (bit_nr & 0xf));
2356                 }
2357         }
2358
2359         /* update Multicast Hash Table in Receive Filter */
2360         for (i = 0; i < table_entries; i++) {
2361                 /* why plus 0x04 ??, That makes the correct value for hash table. */
2362                 sw32(rfcr, (u32)(0x00000004 + i) << RFADDR_shift);
2363                 sw32(rfdr, mc_filter[i]);
2364         }
2365
2366         sw32(rfcr, RFEN | rx_mode);
2367
2368         /* sis900 is capable of looping back packets at MAC level for
2369          * debugging purpose */
2370         if (net_dev->flags & IFF_LOOPBACK) {
2371                 u32 cr_saved;
2372                 /* We must disable Tx/Rx before setting loopback mode */
2373                 cr_saved = sr32(cr);
2374                 sw32(cr, cr_saved | TxDIS | RxDIS);
2375                 /* enable loopback */
2376                 sw32(txcfg, sr32(txcfg) | TxMLB);
2377                 sw32(rxcfg, sr32(rxcfg) | RxATX);
2378                 /* restore cr */
2379                 sw32(cr, cr_saved);
2380         }
2381 }
2382
2383 /**
2384  *      sis900_reset - Reset sis900 MAC
2385  *      @net_dev: the net device to reset
2386  *
2387  *      reset sis900 MAC and wait until finished
2388  *      reset through command register
2389  *      change backoff algorithm for 900B0 & 635 M/B
2390  */
2391
2392 static void sis900_reset(struct net_device *net_dev)
2393 {
2394         struct sis900_private *sis_priv = netdev_priv(net_dev);
2395         void __iomem *ioaddr = sis_priv->ioaddr;
2396         u32 status = TxRCMP | RxRCMP;
2397         int i;
2398
2399         sw32(ier, 0);
2400         sw32(imr, 0);
2401         sw32(rfcr, 0);
2402
2403         sw32(cr, RxRESET | TxRESET | RESET | sr32(cr));
2404
2405         /* Check that the chip has finished the reset. */
2406         for (i = 0; status && (i < 1000); i++)
2407                 status ^= sr32(isr) & status;
2408
2409         if (sis_priv->chipset_rev >= SIS635A_900_REV ||
2410             sis_priv->chipset_rev == SIS900B_900_REV)
2411                 sw32(cfg, PESEL | RND_CNT);
2412         else
2413                 sw32(cfg, PESEL);
2414 }
2415
2416 /**
2417  *      sis900_remove - Remove sis900 device
2418  *      @pci_dev: the pci device to be removed
2419  *
2420  *      remove and release SiS900 net device
2421  */
2422
2423 static void sis900_remove(struct pci_dev *pci_dev)
2424 {
2425         struct net_device *net_dev = pci_get_drvdata(pci_dev);
2426         struct sis900_private *sis_priv = netdev_priv(net_dev);
2427
2428         unregister_netdev(net_dev);
2429
2430         while (sis_priv->first_mii) {
2431                 struct mii_phy *phy = sis_priv->first_mii;
2432
2433                 sis_priv->first_mii = phy->next;
2434                 kfree(phy);
2435         }
2436
2437         pci_free_consistent(pci_dev, RX_TOTAL_SIZE, sis_priv->rx_ring,
2438                 sis_priv->rx_ring_dma);
2439         pci_free_consistent(pci_dev, TX_TOTAL_SIZE, sis_priv->tx_ring,
2440                 sis_priv->tx_ring_dma);
2441         pci_iounmap(pci_dev, sis_priv->ioaddr);
2442         free_netdev(net_dev);
2443         pci_release_regions(pci_dev);
2444         pci_set_drvdata(pci_dev, NULL);
2445 }
2446
2447 #ifdef CONFIG_PM
2448
2449 static int sis900_suspend(struct pci_dev *pci_dev, pm_message_t state)
2450 {
2451         struct net_device *net_dev = pci_get_drvdata(pci_dev);
2452         struct sis900_private *sis_priv = netdev_priv(net_dev);
2453         void __iomem *ioaddr = sis_priv->ioaddr;
2454
2455         if(!netif_running(net_dev))
2456                 return 0;
2457
2458         netif_stop_queue(net_dev);
2459         netif_device_detach(net_dev);
2460
2461         /* Stop the chip's Tx and Rx Status Machine */
2462         sw32(cr, RxDIS | TxDIS | sr32(cr));
2463
2464         pci_set_power_state(pci_dev, PCI_D3hot);
2465         pci_save_state(pci_dev);
2466
2467         return 0;
2468 }
2469
2470 static int sis900_resume(struct pci_dev *pci_dev)
2471 {
2472         struct net_device *net_dev = pci_get_drvdata(pci_dev);
2473         struct sis900_private *sis_priv = netdev_priv(net_dev);
2474         void __iomem *ioaddr = sis_priv->ioaddr;
2475
2476         if(!netif_running(net_dev))
2477                 return 0;
2478         pci_restore_state(pci_dev);
2479         pci_set_power_state(pci_dev, PCI_D0);
2480
2481         sis900_init_rxfilter(net_dev);
2482
2483         sis900_init_tx_ring(net_dev);
2484         sis900_init_rx_ring(net_dev);
2485
2486         set_rx_mode(net_dev);
2487
2488         netif_device_attach(net_dev);
2489         netif_start_queue(net_dev);
2490
2491         /* Workaround for EDB */
2492         sis900_set_mode(sis_priv, HW_SPEED_10_MBPS, FDX_CAPABLE_HALF_SELECTED);
2493
2494         /* Enable all known interrupts by setting the interrupt mask. */
2495         sw32(imr, RxSOVR | RxORN | RxERR | RxOK | TxURN | TxERR | TxIDLE);
2496         sw32(cr, RxENA | sr32(cr));
2497         sw32(ier, IE);
2498
2499         sis900_check_mode(net_dev, sis_priv->mii);
2500
2501         return 0;
2502 }
2503 #endif /* CONFIG_PM */
2504
2505 static struct pci_driver sis900_pci_driver = {
2506         .name           = SIS900_MODULE_NAME,
2507         .id_table       = sis900_pci_tbl,
2508         .probe          = sis900_probe,
2509         .remove         = sis900_remove,
2510 #ifdef CONFIG_PM
2511         .suspend        = sis900_suspend,
2512         .resume         = sis900_resume,
2513 #endif /* CONFIG_PM */
2514 };
2515
2516 static int __init sis900_init_module(void)
2517 {
2518 /* when a module, this is printed whether or not devices are found in probe */
2519 #ifdef MODULE
2520         printk(version);
2521 #endif
2522
2523         return pci_register_driver(&sis900_pci_driver);
2524 }
2525
2526 static void __exit sis900_cleanup_module(void)
2527 {
2528         pci_unregister_driver(&sis900_pci_driver);
2529 }
2530
2531 module_init(sis900_init_module);
2532 module_exit(sis900_cleanup_module);
2533