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