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