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