1/* winbond-840.c: A Linux PCI network adapter device driver. */
2/*
3	Written 1998-2001 by Donald Becker.
4
5	This software may be used and distributed according to the terms of
6	the GNU General Public License (GPL), incorporated herein by reference.
7	Drivers based on or derived from this code fall under the GPL and must
8	retain the authorship, copyright and license notice.  This file is not
9	a complete program and may only be used when the entire operating
10	system is licensed under the GPL.
11
12	The author may be reached as becker@scyld.com, or C/O
13	Scyld Computing Corporation
14	410 Severn Ave., Suite 210
15	Annapolis MD 21403
16
17	Support and updates available at
18	http://www.scyld.com/network/drivers.html
19
20	Do not remove the copyright information.
21	Do not change the version information unless an improvement has been made.
22	Merely removing my name, as Compex has done in the past, does not count
23	as an improvement.
24
25	Changelog:
26	* ported to 2.4
27		???
28	* spin lock update, memory barriers, new style dma mappings
29		limit each tx buffer to < 1024 bytes
30		remove DescIntr from Rx descriptors (that's an Tx flag)
31		remove next pointer from Tx descriptors
32		synchronize tx_q_bytes
33		software reset in tx_timeout
34			Copyright (C) 2000 Manfred Spraul
35	* further cleanups
36		power management.
37		support for big endian descriptors
38			Copyright (C) 2001 Manfred Spraul
39  	* ethtool support (jgarzik)
40	* Replace some MII-related magic numbers with constants (jgarzik)
41
42	TODO:
43	* enable pci_power_off
44	* Wake-On-LAN
45*/
46
47#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
48
49#define DRV_NAME	"winbond-840"
50#define DRV_VERSION	"1.01-e"
51#define DRV_RELDATE	"Sep-11-2006"
52
53
54/* Automatically extracted configuration info:
55probe-func: winbond840_probe
56config-in: tristate 'Winbond W89c840 Ethernet support' CONFIG_WINBOND_840
57
58c-help-name: Winbond W89c840 PCI Ethernet support
59c-help-symbol: CONFIG_WINBOND_840
60c-help: This driver is for the Winbond W89c840 chip.  It also works with
61c-help: the TX9882 chip on the Compex RL100-ATX board.
62c-help: More specific information and updates are available from
63c-help: http://www.scyld.com/network/drivers.html
64*/
65
66/* The user-configurable values.
67   These may be modified when a driver module is loaded.*/
68
69static int debug = 1;			/* 1 normal messages, 0 quiet .. 7 verbose. */
70static int max_interrupt_work = 20;
71/* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
72   The '840 uses a 64 element hash table based on the Ethernet CRC.  */
73static int multicast_filter_limit = 32;
74
75/* Set the copy breakpoint for the copy-only-tiny-frames scheme.
76   Setting to > 1518 effectively disables this feature. */
77static int rx_copybreak;
78
79/* Used to pass the media type, etc.
80   Both 'options[]' and 'full_duplex[]' should exist for driver
81   interoperability.
82   The media type is usually passed in 'options[]'.
83*/
84#define MAX_UNITS 8		/* More are supported, limit only on options */
85static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
86static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
87
88/* Operational parameters that are set at compile time. */
89
90/* Keep the ring sizes a power of two for compile efficiency.
91   The compiler will convert <unsigned>'%'<2^N> into a bit mask.
92   Making the Tx ring too large decreases the effectiveness of channel
93   bonding and packet priority.
94   There are no ill effects from too-large receive rings. */
95#define TX_QUEUE_LEN	10		/* Limit ring entries actually used.  */
96#define TX_QUEUE_LEN_RESTART	5
97
98#define TX_BUFLIMIT	(1024-128)
99
100/* The presumed FIFO size for working around the Tx-FIFO-overflow bug.
101   To avoid overflowing we don't queue again until we have room for a
102   full-size packet.
103 */
104#define TX_FIFO_SIZE (2048)
105#define TX_BUG_FIFO_LIMIT (TX_FIFO_SIZE-1514-16)
106
107
108/* Operational parameters that usually are not changed. */
109/* Time in jiffies before concluding the transmitter is hung. */
110#define TX_TIMEOUT  (2*HZ)
111
112/* Include files, designed to support most kernel versions 2.0.0 and later. */
113#include <linux/module.h>
114#include <linux/kernel.h>
115#include <linux/string.h>
116#include <linux/timer.h>
117#include <linux/errno.h>
118#include <linux/ioport.h>
119#include <linux/interrupt.h>
120#include <linux/pci.h>
121#include <linux/dma-mapping.h>
122#include <linux/netdevice.h>
123#include <linux/etherdevice.h>
124#include <linux/skbuff.h>
125#include <linux/init.h>
126#include <linux/delay.h>
127#include <linux/ethtool.h>
128#include <linux/mii.h>
129#include <linux/rtnetlink.h>
130#include <linux/crc32.h>
131#include <linux/bitops.h>
132#include <asm/uaccess.h>
133#include <asm/processor.h>		/* Processor type for cache alignment. */
134#include <asm/io.h>
135#include <asm/irq.h>
136
137#include "tulip.h"
138
139#undef PKT_BUF_SZ			/* tulip.h also defines this */
140#define PKT_BUF_SZ		1536	/* Size of each temporary Rx buffer.*/
141
142/* These identify the driver base version and may not be removed. */
143static const char version[] __initconst =
144	"v" DRV_VERSION " (2.4 port) "
145	DRV_RELDATE "  Donald Becker <becker@scyld.com>\n"
146	"  http://www.scyld.com/network/drivers.html\n";
147
148MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
149MODULE_DESCRIPTION("Winbond W89c840 Ethernet driver");
150MODULE_LICENSE("GPL");
151MODULE_VERSION(DRV_VERSION);
152
153module_param(max_interrupt_work, int, 0);
154module_param(debug, int, 0);
155module_param(rx_copybreak, int, 0);
156module_param(multicast_filter_limit, int, 0);
157module_param_array(options, int, NULL, 0);
158module_param_array(full_duplex, int, NULL, 0);
159MODULE_PARM_DESC(max_interrupt_work, "winbond-840 maximum events handled per interrupt");
160MODULE_PARM_DESC(debug, "winbond-840 debug level (0-6)");
161MODULE_PARM_DESC(rx_copybreak, "winbond-840 copy breakpoint for copy-only-tiny-frames");
162MODULE_PARM_DESC(multicast_filter_limit, "winbond-840 maximum number of filtered multicast addresses");
163MODULE_PARM_DESC(options, "winbond-840: Bits 0-3: media type, bit 17: full duplex");
164MODULE_PARM_DESC(full_duplex, "winbond-840 full duplex setting(s) (1)");
165
166/*
167				Theory of Operation
168
169I. Board Compatibility
170
171This driver is for the Winbond w89c840 chip.
172
173II. Board-specific settings
174
175None.
176
177III. Driver operation
178
179This chip is very similar to the Digital 21*4* "Tulip" family.  The first
180twelve registers and the descriptor format are nearly identical.  Read a
181Tulip manual for operational details.
182
183A significant difference is that the multicast filter and station address are
184stored in registers rather than loaded through a pseudo-transmit packet.
185
186Unlike the Tulip, transmit buffers are limited to 1KB.  To transmit a
187full-sized packet we must use both data buffers in a descriptor.  Thus the
188driver uses ring mode where descriptors are implicitly sequential in memory,
189rather than using the second descriptor address as a chain pointer to
190subsequent descriptors.
191
192IV. Notes
193
194If you are going to almost clone a Tulip, why not go all the way and avoid
195the need for a new driver?
196
197IVb. References
198
199http://www.scyld.com/expert/100mbps.html
200http://www.scyld.com/expert/NWay.html
201http://www.winbond.com.tw/
202
203IVc. Errata
204
205A horrible bug exists in the transmit FIFO.  Apparently the chip doesn't
206correctly detect a full FIFO, and queuing more than 2048 bytes may result in
207silent data corruption.
208
209Test with 'ping -s 10000' on a fast computer.
210
211*/
212
213
214
215/*
216  PCI probe table.
217*/
218enum chip_capability_flags {
219	CanHaveMII=1, HasBrokenTx=2, AlwaysFDX=4, FDXOnNoMII=8,
220};
221
222static const struct pci_device_id w840_pci_tbl[] = {
223	{ 0x1050, 0x0840, PCI_ANY_ID, 0x8153,     0, 0, 0 },
224	{ 0x1050, 0x0840, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
225	{ 0x11f6, 0x2011, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
226	{ }
227};
228MODULE_DEVICE_TABLE(pci, w840_pci_tbl);
229
230enum {
231	netdev_res_size		= 128,	/* size of PCI BAR resource */
232};
233
234struct pci_id_info {
235        const char *name;
236        int drv_flags;		/* Driver use, intended as capability flags. */
237};
238
239static const struct pci_id_info pci_id_tbl[] = {
240	{ 				/* Sometime a Level-One switch card. */
241	  "Winbond W89c840",	CanHaveMII | HasBrokenTx | FDXOnNoMII},
242	{ "Winbond W89c840",	CanHaveMII | HasBrokenTx},
243	{ "Compex RL100-ATX",	CanHaveMII | HasBrokenTx},
244	{ }	/* terminate list. */
245};
246
247/* This driver was written to use PCI memory space, however some x86 systems
248   work only with I/O space accesses. See CONFIG_TULIP_MMIO in .config
249*/
250
251/* Offsets to the Command and Status Registers, "CSRs".
252   While similar to the Tulip, these registers are longword aligned.
253   Note: It's not useful to define symbolic names for every register bit in
254   the device.  The name can only partially document the semantics and make
255   the driver longer and more difficult to read.
256*/
257enum w840_offsets {
258	PCIBusCfg=0x00, TxStartDemand=0x04, RxStartDemand=0x08,
259	RxRingPtr=0x0C, TxRingPtr=0x10,
260	IntrStatus=0x14, NetworkConfig=0x18, IntrEnable=0x1C,
261	RxMissed=0x20, EECtrl=0x24, MIICtrl=0x24, BootRom=0x28, GPTimer=0x2C,
262	CurRxDescAddr=0x30, CurRxBufAddr=0x34,			/* Debug use */
263	MulticastFilter0=0x38, MulticastFilter1=0x3C, StationAddr=0x40,
264	CurTxDescAddr=0x4C, CurTxBufAddr=0x50,
265};
266
267/* Bits in the NetworkConfig register. */
268enum rx_mode_bits {
269	AcceptErr=0x80,
270	RxAcceptBroadcast=0x20, AcceptMulticast=0x10,
271	RxAcceptAllPhys=0x08, AcceptMyPhys=0x02,
272};
273
274enum mii_reg_bits {
275	MDIO_ShiftClk=0x10000, MDIO_DataIn=0x80000, MDIO_DataOut=0x20000,
276	MDIO_EnbOutput=0x40000, MDIO_EnbIn = 0x00000,
277};
278
279/* The Tulip Rx and Tx buffer descriptors. */
280struct w840_rx_desc {
281	s32 status;
282	s32 length;
283	u32 buffer1;
284	u32 buffer2;
285};
286
287struct w840_tx_desc {
288	s32 status;
289	s32 length;
290	u32 buffer1, buffer2;
291};
292
293#define MII_CNT		1 /* winbond only supports one MII */
294struct netdev_private {
295	struct w840_rx_desc *rx_ring;
296	dma_addr_t	rx_addr[RX_RING_SIZE];
297	struct w840_tx_desc *tx_ring;
298	dma_addr_t	tx_addr[TX_RING_SIZE];
299	dma_addr_t ring_dma_addr;
300	/* The addresses of receive-in-place skbuffs. */
301	struct sk_buff* rx_skbuff[RX_RING_SIZE];
302	/* The saved address of a sent-in-place packet/buffer, for later free(). */
303	struct sk_buff* tx_skbuff[TX_RING_SIZE];
304	struct net_device_stats stats;
305	struct timer_list timer;	/* Media monitoring timer. */
306	/* Frequently used values: keep some adjacent for cache effect. */
307	spinlock_t lock;
308	int chip_id, drv_flags;
309	struct pci_dev *pci_dev;
310	int csr6;
311	struct w840_rx_desc *rx_head_desc;
312	unsigned int cur_rx, dirty_rx;		/* Producer/consumer ring indices */
313	unsigned int rx_buf_sz;				/* Based on MTU+slack. */
314	unsigned int cur_tx, dirty_tx;
315	unsigned int tx_q_bytes;
316	unsigned int tx_full;				/* The Tx queue is full. */
317	/* MII transceiver section. */
318	int mii_cnt;						/* MII device addresses. */
319	unsigned char phys[MII_CNT];		/* MII device addresses, but only the first is used */
320	u32 mii;
321	struct mii_if_info mii_if;
322	void __iomem *base_addr;
323};
324
325static int  eeprom_read(void __iomem *ioaddr, int location);
326static int  mdio_read(struct net_device *dev, int phy_id, int location);
327static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
328static int  netdev_open(struct net_device *dev);
329static int  update_link(struct net_device *dev);
330static void netdev_timer(unsigned long data);
331static void init_rxtx_rings(struct net_device *dev);
332static void free_rxtx_rings(struct netdev_private *np);
333static void init_registers(struct net_device *dev);
334static void tx_timeout(struct net_device *dev);
335static int alloc_ringdesc(struct net_device *dev);
336static void free_ringdesc(struct netdev_private *np);
337static netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev);
338static irqreturn_t intr_handler(int irq, void *dev_instance);
339static void netdev_error(struct net_device *dev, int intr_status);
340static int  netdev_rx(struct net_device *dev);
341static u32 __set_rx_mode(struct net_device *dev);
342static void set_rx_mode(struct net_device *dev);
343static struct net_device_stats *get_stats(struct net_device *dev);
344static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
345static const struct ethtool_ops netdev_ethtool_ops;
346static int  netdev_close(struct net_device *dev);
347
348static const struct net_device_ops netdev_ops = {
349	.ndo_open		= netdev_open,
350	.ndo_stop		= netdev_close,
351	.ndo_start_xmit		= start_tx,
352	.ndo_get_stats		= get_stats,
353	.ndo_set_rx_mode	= set_rx_mode,
354	.ndo_do_ioctl		= netdev_ioctl,
355	.ndo_tx_timeout		= tx_timeout,
356	.ndo_change_mtu		= eth_change_mtu,
357	.ndo_set_mac_address	= eth_mac_addr,
358	.ndo_validate_addr	= eth_validate_addr,
359};
360
361static int w840_probe1(struct pci_dev *pdev, const struct pci_device_id *ent)
362{
363	struct net_device *dev;
364	struct netdev_private *np;
365	static int find_cnt;
366	int chip_idx = ent->driver_data;
367	int irq;
368	int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0;
369	void __iomem *ioaddr;
370
371	i = pci_enable_device(pdev);
372	if (i) return i;
373
374	pci_set_master(pdev);
375
376	irq = pdev->irq;
377
378	if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
379		pr_warn("Device %s disabled due to DMA limitations\n",
380			pci_name(pdev));
381		return -EIO;
382	}
383	dev = alloc_etherdev(sizeof(*np));
384	if (!dev)
385		return -ENOMEM;
386	SET_NETDEV_DEV(dev, &pdev->dev);
387
388	if (pci_request_regions(pdev, DRV_NAME))
389		goto err_out_netdev;
390
391	ioaddr = pci_iomap(pdev, TULIP_BAR, netdev_res_size);
392	if (!ioaddr)
393		goto err_out_free_res;
394
395	for (i = 0; i < 3; i++)
396		((__le16 *)dev->dev_addr)[i] = cpu_to_le16(eeprom_read(ioaddr, i));
397
398	/* Reset the chip to erase previous misconfiguration.
399	   No hold time required! */
400	iowrite32(0x00000001, ioaddr + PCIBusCfg);
401
402	np = netdev_priv(dev);
403	np->pci_dev = pdev;
404	np->chip_id = chip_idx;
405	np->drv_flags = pci_id_tbl[chip_idx].drv_flags;
406	spin_lock_init(&np->lock);
407	np->mii_if.dev = dev;
408	np->mii_if.mdio_read = mdio_read;
409	np->mii_if.mdio_write = mdio_write;
410	np->base_addr = ioaddr;
411
412	pci_set_drvdata(pdev, dev);
413
414	if (dev->mem_start)
415		option = dev->mem_start;
416
417	/* The lower four bits are the media type. */
418	if (option > 0) {
419		if (option & 0x200)
420			np->mii_if.full_duplex = 1;
421		if (option & 15)
422			dev_info(&dev->dev,
423				 "ignoring user supplied media type %d",
424				 option & 15);
425	}
426	if (find_cnt < MAX_UNITS  &&  full_duplex[find_cnt] > 0)
427		np->mii_if.full_duplex = 1;
428
429	if (np->mii_if.full_duplex)
430		np->mii_if.force_media = 1;
431
432	/* The chip-specific entries in the device structure. */
433	dev->netdev_ops = &netdev_ops;
434	dev->ethtool_ops = &netdev_ethtool_ops;
435	dev->watchdog_timeo = TX_TIMEOUT;
436
437	i = register_netdev(dev);
438	if (i)
439		goto err_out_cleardev;
440
441	dev_info(&dev->dev, "%s at %p, %pM, IRQ %d\n",
442		 pci_id_tbl[chip_idx].name, ioaddr, dev->dev_addr, irq);
443
444	if (np->drv_flags & CanHaveMII) {
445		int phy, phy_idx = 0;
446		for (phy = 1; phy < 32 && phy_idx < MII_CNT; phy++) {
447			int mii_status = mdio_read(dev, phy, MII_BMSR);
448			if (mii_status != 0xffff  &&  mii_status != 0x0000) {
449				np->phys[phy_idx++] = phy;
450				np->mii_if.advertising = mdio_read(dev, phy, MII_ADVERTISE);
451				np->mii = (mdio_read(dev, phy, MII_PHYSID1) << 16)+
452						mdio_read(dev, phy, MII_PHYSID2);
453				dev_info(&dev->dev,
454					 "MII PHY %08xh found at address %d, status 0x%04x advertising %04x\n",
455					 np->mii, phy, mii_status,
456					 np->mii_if.advertising);
457			}
458		}
459		np->mii_cnt = phy_idx;
460		np->mii_if.phy_id = np->phys[0];
461		if (phy_idx == 0) {
462			dev_warn(&dev->dev,
463				 "MII PHY not found -- this device may not operate correctly\n");
464		}
465	}
466
467	find_cnt++;
468	return 0;
469
470err_out_cleardev:
471	pci_iounmap(pdev, ioaddr);
472err_out_free_res:
473	pci_release_regions(pdev);
474err_out_netdev:
475	free_netdev (dev);
476	return -ENODEV;
477}
478
479
480/* Read the EEPROM and MII Management Data I/O (MDIO) interfaces.  These are
481   often serial bit streams generated by the host processor.
482   The example below is for the common 93c46 EEPROM, 64 16 bit words. */
483
484/* Delay between EEPROM clock transitions.
485   No extra delay is needed with 33Mhz PCI, but future 66Mhz access may need
486   a delay.  Note that pre-2.0.34 kernels had a cache-alignment bug that
487   made udelay() unreliable.
488   The old method of using an ISA access as a delay, __SLOW_DOWN_IO__, is
489   deprecated.
490*/
491#define eeprom_delay(ee_addr)	ioread32(ee_addr)
492
493enum EEPROM_Ctrl_Bits {
494	EE_ShiftClk=0x02, EE_Write0=0x801, EE_Write1=0x805,
495	EE_ChipSelect=0x801, EE_DataIn=0x08,
496};
497
498/* The EEPROM commands include the alway-set leading bit. */
499enum EEPROM_Cmds {
500	EE_WriteCmd=(5 << 6), EE_ReadCmd=(6 << 6), EE_EraseCmd=(7 << 6),
501};
502
503static int eeprom_read(void __iomem *addr, int location)
504{
505	int i;
506	int retval = 0;
507	void __iomem *ee_addr = addr + EECtrl;
508	int read_cmd = location | EE_ReadCmd;
509	iowrite32(EE_ChipSelect, ee_addr);
510
511	/* Shift the read command bits out. */
512	for (i = 10; i >= 0; i--) {
513		short dataval = (read_cmd & (1 << i)) ? EE_Write1 : EE_Write0;
514		iowrite32(dataval, ee_addr);
515		eeprom_delay(ee_addr);
516		iowrite32(dataval | EE_ShiftClk, ee_addr);
517		eeprom_delay(ee_addr);
518	}
519	iowrite32(EE_ChipSelect, ee_addr);
520	eeprom_delay(ee_addr);
521
522	for (i = 16; i > 0; i--) {
523		iowrite32(EE_ChipSelect | EE_ShiftClk, ee_addr);
524		eeprom_delay(ee_addr);
525		retval = (retval << 1) | ((ioread32(ee_addr) & EE_DataIn) ? 1 : 0);
526		iowrite32(EE_ChipSelect, ee_addr);
527		eeprom_delay(ee_addr);
528	}
529
530	/* Terminate the EEPROM access. */
531	iowrite32(0, ee_addr);
532	return retval;
533}
534
535/*  MII transceiver control section.
536	Read and write the MII registers using software-generated serial
537	MDIO protocol.  See the MII specifications or DP83840A data sheet
538	for details.
539
540	The maximum data clock rate is 2.5 Mhz.  The minimum timing is usually
541	met by back-to-back 33Mhz PCI cycles. */
542#define mdio_delay(mdio_addr) ioread32(mdio_addr)
543
544/* Set iff a MII transceiver on any interface requires mdio preamble.
545   This only set with older transceivers, so the extra
546   code size of a per-interface flag is not worthwhile. */
547static char mii_preamble_required = 1;
548
549#define MDIO_WRITE0 (MDIO_EnbOutput)
550#define MDIO_WRITE1 (MDIO_DataOut | MDIO_EnbOutput)
551
552/* Generate the preamble required for initial synchronization and
553   a few older transceivers. */
554static void mdio_sync(void __iomem *mdio_addr)
555{
556	int bits = 32;
557
558	/* Establish sync by sending at least 32 logic ones. */
559	while (--bits >= 0) {
560		iowrite32(MDIO_WRITE1, mdio_addr);
561		mdio_delay(mdio_addr);
562		iowrite32(MDIO_WRITE1 | MDIO_ShiftClk, mdio_addr);
563		mdio_delay(mdio_addr);
564	}
565}
566
567static int mdio_read(struct net_device *dev, int phy_id, int location)
568{
569	struct netdev_private *np = netdev_priv(dev);
570	void __iomem *mdio_addr = np->base_addr + MIICtrl;
571	int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
572	int i, retval = 0;
573
574	if (mii_preamble_required)
575		mdio_sync(mdio_addr);
576
577	/* Shift the read command bits out. */
578	for (i = 15; i >= 0; i--) {
579		int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
580
581		iowrite32(dataval, mdio_addr);
582		mdio_delay(mdio_addr);
583		iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
584		mdio_delay(mdio_addr);
585	}
586	/* Read the two transition, 16 data, and wire-idle bits. */
587	for (i = 20; i > 0; i--) {
588		iowrite32(MDIO_EnbIn, mdio_addr);
589		mdio_delay(mdio_addr);
590		retval = (retval << 1) | ((ioread32(mdio_addr) & MDIO_DataIn) ? 1 : 0);
591		iowrite32(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
592		mdio_delay(mdio_addr);
593	}
594	return (retval>>1) & 0xffff;
595}
596
597static void mdio_write(struct net_device *dev, int phy_id, int location, int value)
598{
599	struct netdev_private *np = netdev_priv(dev);
600	void __iomem *mdio_addr = np->base_addr + MIICtrl;
601	int mii_cmd = (0x5002 << 16) | (phy_id << 23) | (location<<18) | value;
602	int i;
603
604	if (location == 4  &&  phy_id == np->phys[0])
605		np->mii_if.advertising = value;
606
607	if (mii_preamble_required)
608		mdio_sync(mdio_addr);
609
610	/* Shift the command bits out. */
611	for (i = 31; i >= 0; i--) {
612		int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
613
614		iowrite32(dataval, mdio_addr);
615		mdio_delay(mdio_addr);
616		iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
617		mdio_delay(mdio_addr);
618	}
619	/* Clear out extra bits. */
620	for (i = 2; i > 0; i--) {
621		iowrite32(MDIO_EnbIn, mdio_addr);
622		mdio_delay(mdio_addr);
623		iowrite32(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
624		mdio_delay(mdio_addr);
625	}
626}
627
628
629static int netdev_open(struct net_device *dev)
630{
631	struct netdev_private *np = netdev_priv(dev);
632	void __iomem *ioaddr = np->base_addr;
633	const int irq = np->pci_dev->irq;
634	int i;
635
636	iowrite32(0x00000001, ioaddr + PCIBusCfg);		/* Reset */
637
638	netif_device_detach(dev);
639	i = request_irq(irq, intr_handler, IRQF_SHARED, dev->name, dev);
640	if (i)
641		goto out_err;
642
643	if (debug > 1)
644		netdev_dbg(dev, "w89c840_open() irq %d\n", irq);
645
646	if((i=alloc_ringdesc(dev)))
647		goto out_err;
648
649	spin_lock_irq(&np->lock);
650	netif_device_attach(dev);
651	init_registers(dev);
652	spin_unlock_irq(&np->lock);
653
654	netif_start_queue(dev);
655	if (debug > 2)
656		netdev_dbg(dev, "Done netdev_open()\n");
657
658	/* Set the timer to check for link beat. */
659	init_timer(&np->timer);
660	np->timer.expires = jiffies + 1*HZ;
661	np->timer.data = (unsigned long)dev;
662	np->timer.function = netdev_timer;				/* timer handler */
663	add_timer(&np->timer);
664	return 0;
665out_err:
666	netif_device_attach(dev);
667	return i;
668}
669
670#define MII_DAVICOM_DM9101	0x0181b800
671
672static int update_link(struct net_device *dev)
673{
674	struct netdev_private *np = netdev_priv(dev);
675	int duplex, fasteth, result, mii_reg;
676
677	/* BSMR */
678	mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
679
680	if (mii_reg == 0xffff)
681		return np->csr6;
682	/* reread: the link status bit is sticky */
683	mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
684	if (!(mii_reg & 0x4)) {
685		if (netif_carrier_ok(dev)) {
686			if (debug)
687				dev_info(&dev->dev,
688					 "MII #%d reports no link. Disabling watchdog\n",
689					 np->phys[0]);
690			netif_carrier_off(dev);
691		}
692		return np->csr6;
693	}
694	if (!netif_carrier_ok(dev)) {
695		if (debug)
696			dev_info(&dev->dev,
697				 "MII #%d link is back. Enabling watchdog\n",
698				 np->phys[0]);
699		netif_carrier_on(dev);
700	}
701
702	if ((np->mii & ~0xf) == MII_DAVICOM_DM9101) {
703		/* If the link partner doesn't support autonegotiation
704		 * the MII detects it's abilities with the "parallel detection".
705		 * Some MIIs update the LPA register to the result of the parallel
706		 * detection, some don't.
707		 * The Davicom PHY [at least 0181b800] doesn't.
708		 * Instead bit 9 and 13 of the BMCR are updated to the result
709		 * of the negotiation..
710		 */
711		mii_reg = mdio_read(dev, np->phys[0], MII_BMCR);
712		duplex = mii_reg & BMCR_FULLDPLX;
713		fasteth = mii_reg & BMCR_SPEED100;
714	} else {
715		int negotiated;
716		mii_reg	= mdio_read(dev, np->phys[0], MII_LPA);
717		negotiated = mii_reg & np->mii_if.advertising;
718
719		duplex = (negotiated & LPA_100FULL) || ((negotiated & 0x02C0) == LPA_10FULL);
720		fasteth = negotiated & 0x380;
721	}
722	duplex |= np->mii_if.force_media;
723	/* remove fastether and fullduplex */
724	result = np->csr6 & ~0x20000200;
725	if (duplex)
726		result |= 0x200;
727	if (fasteth)
728		result |= 0x20000000;
729	if (result != np->csr6 && debug)
730		dev_info(&dev->dev,
731			 "Setting %dMBit-%s-duplex based on MII#%d\n",
732			 fasteth ? 100 : 10, duplex ? "full" : "half",
733			 np->phys[0]);
734	return result;
735}
736
737#define RXTX_TIMEOUT	2000
738static inline void update_csr6(struct net_device *dev, int new)
739{
740	struct netdev_private *np = netdev_priv(dev);
741	void __iomem *ioaddr = np->base_addr;
742	int limit = RXTX_TIMEOUT;
743
744	if (!netif_device_present(dev))
745		new = 0;
746	if (new==np->csr6)
747		return;
748	/* stop both Tx and Rx processes */
749	iowrite32(np->csr6 & ~0x2002, ioaddr + NetworkConfig);
750	/* wait until they have really stopped */
751	for (;;) {
752		int csr5 = ioread32(ioaddr + IntrStatus);
753		int t;
754
755		t = (csr5 >> 17) & 0x07;
756		if (t==0||t==1) {
757			/* rx stopped */
758			t = (csr5 >> 20) & 0x07;
759			if (t==0||t==1)
760				break;
761		}
762
763		limit--;
764		if(!limit) {
765			dev_info(&dev->dev,
766				 "couldn't stop rxtx, IntrStatus %xh\n", csr5);
767			break;
768		}
769		udelay(1);
770	}
771	np->csr6 = new;
772	/* and restart them with the new configuration */
773	iowrite32(np->csr6, ioaddr + NetworkConfig);
774	if (new & 0x200)
775		np->mii_if.full_duplex = 1;
776}
777
778static void netdev_timer(unsigned long data)
779{
780	struct net_device *dev = (struct net_device *)data;
781	struct netdev_private *np = netdev_priv(dev);
782	void __iomem *ioaddr = np->base_addr;
783
784	if (debug > 2)
785		netdev_dbg(dev, "Media selection timer tick, status %08x config %08x\n",
786			   ioread32(ioaddr + IntrStatus),
787			   ioread32(ioaddr + NetworkConfig));
788	spin_lock_irq(&np->lock);
789	update_csr6(dev, update_link(dev));
790	spin_unlock_irq(&np->lock);
791	np->timer.expires = jiffies + 10*HZ;
792	add_timer(&np->timer);
793}
794
795static void init_rxtx_rings(struct net_device *dev)
796{
797	struct netdev_private *np = netdev_priv(dev);
798	int i;
799
800	np->rx_head_desc = &np->rx_ring[0];
801	np->tx_ring = (struct w840_tx_desc*)&np->rx_ring[RX_RING_SIZE];
802
803	/* Initial all Rx descriptors. */
804	for (i = 0; i < RX_RING_SIZE; i++) {
805		np->rx_ring[i].length = np->rx_buf_sz;
806		np->rx_ring[i].status = 0;
807		np->rx_skbuff[i] = NULL;
808	}
809	/* Mark the last entry as wrapping the ring. */
810	np->rx_ring[i-1].length |= DescEndRing;
811
812	/* Fill in the Rx buffers.  Handle allocation failure gracefully. */
813	for (i = 0; i < RX_RING_SIZE; i++) {
814		struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz);
815		np->rx_skbuff[i] = skb;
816		if (skb == NULL)
817			break;
818		np->rx_addr[i] = pci_map_single(np->pci_dev,skb->data,
819					np->rx_buf_sz,PCI_DMA_FROMDEVICE);
820
821		np->rx_ring[i].buffer1 = np->rx_addr[i];
822		np->rx_ring[i].status = DescOwned;
823	}
824
825	np->cur_rx = 0;
826	np->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
827
828	/* Initialize the Tx descriptors */
829	for (i = 0; i < TX_RING_SIZE; i++) {
830		np->tx_skbuff[i] = NULL;
831		np->tx_ring[i].status = 0;
832	}
833	np->tx_full = 0;
834	np->tx_q_bytes = np->dirty_tx = np->cur_tx = 0;
835
836	iowrite32(np->ring_dma_addr, np->base_addr + RxRingPtr);
837	iowrite32(np->ring_dma_addr+sizeof(struct w840_rx_desc)*RX_RING_SIZE,
838		np->base_addr + TxRingPtr);
839
840}
841
842static void free_rxtx_rings(struct netdev_private* np)
843{
844	int i;
845	/* Free all the skbuffs in the Rx queue. */
846	for (i = 0; i < RX_RING_SIZE; i++) {
847		np->rx_ring[i].status = 0;
848		if (np->rx_skbuff[i]) {
849			pci_unmap_single(np->pci_dev,
850						np->rx_addr[i],
851						np->rx_skbuff[i]->len,
852						PCI_DMA_FROMDEVICE);
853			dev_kfree_skb(np->rx_skbuff[i]);
854		}
855		np->rx_skbuff[i] = NULL;
856	}
857	for (i = 0; i < TX_RING_SIZE; i++) {
858		if (np->tx_skbuff[i]) {
859			pci_unmap_single(np->pci_dev,
860						np->tx_addr[i],
861						np->tx_skbuff[i]->len,
862						PCI_DMA_TODEVICE);
863			dev_kfree_skb(np->tx_skbuff[i]);
864		}
865		np->tx_skbuff[i] = NULL;
866	}
867}
868
869static void init_registers(struct net_device *dev)
870{
871	struct netdev_private *np = netdev_priv(dev);
872	void __iomem *ioaddr = np->base_addr;
873	int i;
874
875	for (i = 0; i < 6; i++)
876		iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i);
877
878	/* Initialize other registers. */
879#ifdef __BIG_ENDIAN
880	i = (1<<20);	/* Big-endian descriptors */
881#else
882	i = 0;
883#endif
884	i |= (0x04<<2);		/* skip length 4 u32 */
885	i |= 0x02;		/* give Rx priority */
886
887	/* Configure the PCI bus bursts and FIFO thresholds.
888	   486: Set 8 longword cache alignment, 8 longword burst.
889	   586: Set 16 longword cache alignment, no burst limit.
890	   Cache alignment bits 15:14	     Burst length 13:8
891		0000	<not allowed> 		0000 align to cache	0800 8 longwords
892		4000	8  longwords		0100 1 longword		1000 16 longwords
893		8000	16 longwords		0200 2 longwords	2000 32 longwords
894		C000	32  longwords		0400 4 longwords */
895
896#if defined (__i386__) && !defined(MODULE)
897	/* When not a module we can work around broken '486 PCI boards. */
898	if (boot_cpu_data.x86 <= 4) {
899		i |= 0x4800;
900		dev_info(&dev->dev,
901			 "This is a 386/486 PCI system, setting cache alignment to 8 longwords\n");
902	} else {
903		i |= 0xE000;
904	}
905#elif defined(__powerpc__) || defined(__i386__) || defined(__alpha__) || defined(__ia64__) || defined(__x86_64__)
906	i |= 0xE000;
907#elif defined(CONFIG_SPARC) || defined (CONFIG_PARISC) || defined(CONFIG_ARM)
908	i |= 0x4800;
909#else
910#warning Processor architecture undefined
911	i |= 0x4800;
912#endif
913	iowrite32(i, ioaddr + PCIBusCfg);
914
915	np->csr6 = 0;
916	/* 128 byte Tx threshold;
917		Transmit on; Receive on; */
918	update_csr6(dev, 0x00022002 | update_link(dev) | __set_rx_mode(dev));
919
920	/* Clear and Enable interrupts by setting the interrupt mask. */
921	iowrite32(0x1A0F5, ioaddr + IntrStatus);
922	iowrite32(0x1A0F5, ioaddr + IntrEnable);
923
924	iowrite32(0, ioaddr + RxStartDemand);
925}
926
927static void tx_timeout(struct net_device *dev)
928{
929	struct netdev_private *np = netdev_priv(dev);
930	void __iomem *ioaddr = np->base_addr;
931	const int irq = np->pci_dev->irq;
932
933	dev_warn(&dev->dev, "Transmit timed out, status %08x, resetting...\n",
934		 ioread32(ioaddr + IntrStatus));
935
936	{
937		int i;
938		printk(KERN_DEBUG "  Rx ring %p: ", np->rx_ring);
939		for (i = 0; i < RX_RING_SIZE; i++)
940			printk(KERN_CONT " %08x", (unsigned int)np->rx_ring[i].status);
941		printk(KERN_CONT "\n");
942		printk(KERN_DEBUG "  Tx ring %p: ", np->tx_ring);
943		for (i = 0; i < TX_RING_SIZE; i++)
944			printk(KERN_CONT " %08x", np->tx_ring[i].status);
945		printk(KERN_CONT "\n");
946	}
947	printk(KERN_DEBUG "Tx cur %d Tx dirty %d Tx Full %d, q bytes %d\n",
948	       np->cur_tx, np->dirty_tx, np->tx_full, np->tx_q_bytes);
949	printk(KERN_DEBUG "Tx Descriptor addr %xh\n", ioread32(ioaddr+0x4C));
950
951	disable_irq(irq);
952	spin_lock_irq(&np->lock);
953	/*
954	 * Under high load dirty_tx and the internal tx descriptor pointer
955	 * come out of sync, thus perform a software reset and reinitialize
956	 * everything.
957	 */
958
959	iowrite32(1, np->base_addr+PCIBusCfg);
960	udelay(1);
961
962	free_rxtx_rings(np);
963	init_rxtx_rings(dev);
964	init_registers(dev);
965	spin_unlock_irq(&np->lock);
966	enable_irq(irq);
967
968	netif_wake_queue(dev);
969	dev->trans_start = jiffies; /* prevent tx timeout */
970	np->stats.tx_errors++;
971}
972
973/* Initialize the Rx and Tx rings, along with various 'dev' bits. */
974static int alloc_ringdesc(struct net_device *dev)
975{
976	struct netdev_private *np = netdev_priv(dev);
977
978	np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
979
980	np->rx_ring = pci_alloc_consistent(np->pci_dev,
981			sizeof(struct w840_rx_desc)*RX_RING_SIZE +
982			sizeof(struct w840_tx_desc)*TX_RING_SIZE,
983			&np->ring_dma_addr);
984	if(!np->rx_ring)
985		return -ENOMEM;
986	init_rxtx_rings(dev);
987	return 0;
988}
989
990static void free_ringdesc(struct netdev_private *np)
991{
992	pci_free_consistent(np->pci_dev,
993			sizeof(struct w840_rx_desc)*RX_RING_SIZE +
994			sizeof(struct w840_tx_desc)*TX_RING_SIZE,
995			np->rx_ring, np->ring_dma_addr);
996
997}
998
999static netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev)
1000{
1001	struct netdev_private *np = netdev_priv(dev);
1002	unsigned entry;
1003
1004	/* Caution: the write order is important here, set the field
1005	   with the "ownership" bits last. */
1006
1007	/* Calculate the next Tx descriptor entry. */
1008	entry = np->cur_tx % TX_RING_SIZE;
1009
1010	np->tx_addr[entry] = pci_map_single(np->pci_dev,
1011				skb->data,skb->len, PCI_DMA_TODEVICE);
1012	np->tx_skbuff[entry] = skb;
1013
1014	np->tx_ring[entry].buffer1 = np->tx_addr[entry];
1015	if (skb->len < TX_BUFLIMIT) {
1016		np->tx_ring[entry].length = DescWholePkt | skb->len;
1017	} else {
1018		int len = skb->len - TX_BUFLIMIT;
1019
1020		np->tx_ring[entry].buffer2 = np->tx_addr[entry]+TX_BUFLIMIT;
1021		np->tx_ring[entry].length = DescWholePkt | (len << 11) | TX_BUFLIMIT;
1022	}
1023	if(entry == TX_RING_SIZE-1)
1024		np->tx_ring[entry].length |= DescEndRing;
1025
1026	/* Now acquire the irq spinlock.
1027	 * The difficult race is the ordering between
1028	 * increasing np->cur_tx and setting DescOwned:
1029	 * - if np->cur_tx is increased first the interrupt
1030	 *   handler could consider the packet as transmitted
1031	 *   since DescOwned is cleared.
1032	 * - If DescOwned is set first the NIC could report the
1033	 *   packet as sent, but the interrupt handler would ignore it
1034	 *   since the np->cur_tx was not yet increased.
1035	 */
1036	spin_lock_irq(&np->lock);
1037	np->cur_tx++;
1038
1039	wmb(); /* flush length, buffer1, buffer2 */
1040	np->tx_ring[entry].status = DescOwned;
1041	wmb(); /* flush status and kick the hardware */
1042	iowrite32(0, np->base_addr + TxStartDemand);
1043	np->tx_q_bytes += skb->len;
1044	/* Work around horrible bug in the chip by marking the queue as full
1045	   when we do not have FIFO room for a maximum sized packet. */
1046	if (np->cur_tx - np->dirty_tx > TX_QUEUE_LEN ||
1047		((np->drv_flags & HasBrokenTx) && np->tx_q_bytes > TX_BUG_FIFO_LIMIT)) {
1048		netif_stop_queue(dev);
1049		wmb();
1050		np->tx_full = 1;
1051	}
1052	spin_unlock_irq(&np->lock);
1053
1054	if (debug > 4) {
1055		netdev_dbg(dev, "Transmit frame #%d queued in slot %d\n",
1056			   np->cur_tx, entry);
1057	}
1058	return NETDEV_TX_OK;
1059}
1060
1061static void netdev_tx_done(struct net_device *dev)
1062{
1063	struct netdev_private *np = netdev_priv(dev);
1064	for (; np->cur_tx - np->dirty_tx > 0; np->dirty_tx++) {
1065		int entry = np->dirty_tx % TX_RING_SIZE;
1066		int tx_status = np->tx_ring[entry].status;
1067
1068		if (tx_status < 0)
1069			break;
1070		if (tx_status & 0x8000) { 	/* There was an error, log it. */
1071#ifndef final_version
1072			if (debug > 1)
1073				netdev_dbg(dev, "Transmit error, Tx status %08x\n",
1074					   tx_status);
1075#endif
1076			np->stats.tx_errors++;
1077			if (tx_status & 0x0104) np->stats.tx_aborted_errors++;
1078			if (tx_status & 0x0C80) np->stats.tx_carrier_errors++;
1079			if (tx_status & 0x0200) np->stats.tx_window_errors++;
1080			if (tx_status & 0x0002) np->stats.tx_fifo_errors++;
1081			if ((tx_status & 0x0080) && np->mii_if.full_duplex == 0)
1082				np->stats.tx_heartbeat_errors++;
1083		} else {
1084#ifndef final_version
1085			if (debug > 3)
1086				netdev_dbg(dev, "Transmit slot %d ok, Tx status %08x\n",
1087					   entry, tx_status);
1088#endif
1089			np->stats.tx_bytes += np->tx_skbuff[entry]->len;
1090			np->stats.collisions += (tx_status >> 3) & 15;
1091			np->stats.tx_packets++;
1092		}
1093		/* Free the original skb. */
1094		pci_unmap_single(np->pci_dev,np->tx_addr[entry],
1095					np->tx_skbuff[entry]->len,
1096					PCI_DMA_TODEVICE);
1097		np->tx_q_bytes -= np->tx_skbuff[entry]->len;
1098		dev_kfree_skb_irq(np->tx_skbuff[entry]);
1099		np->tx_skbuff[entry] = NULL;
1100	}
1101	if (np->tx_full &&
1102		np->cur_tx - np->dirty_tx < TX_QUEUE_LEN_RESTART &&
1103		np->tx_q_bytes < TX_BUG_FIFO_LIMIT) {
1104		/* The ring is no longer full, clear tbusy. */
1105		np->tx_full = 0;
1106		wmb();
1107		netif_wake_queue(dev);
1108	}
1109}
1110
1111/* The interrupt handler does all of the Rx thread work and cleans up
1112   after the Tx thread. */
1113static irqreturn_t intr_handler(int irq, void *dev_instance)
1114{
1115	struct net_device *dev = (struct net_device *)dev_instance;
1116	struct netdev_private *np = netdev_priv(dev);
1117	void __iomem *ioaddr = np->base_addr;
1118	int work_limit = max_interrupt_work;
1119	int handled = 0;
1120
1121	if (!netif_device_present(dev))
1122		return IRQ_NONE;
1123	do {
1124		u32 intr_status = ioread32(ioaddr + IntrStatus);
1125
1126		/* Acknowledge all of the current interrupt sources ASAP. */
1127		iowrite32(intr_status & 0x001ffff, ioaddr + IntrStatus);
1128
1129		if (debug > 4)
1130			netdev_dbg(dev, "Interrupt, status %04x\n", intr_status);
1131
1132		if ((intr_status & (NormalIntr|AbnormalIntr)) == 0)
1133			break;
1134
1135		handled = 1;
1136
1137		if (intr_status & (RxIntr | RxNoBuf))
1138			netdev_rx(dev);
1139		if (intr_status & RxNoBuf)
1140			iowrite32(0, ioaddr + RxStartDemand);
1141
1142		if (intr_status & (TxNoBuf | TxIntr) &&
1143			np->cur_tx != np->dirty_tx) {
1144			spin_lock(&np->lock);
1145			netdev_tx_done(dev);
1146			spin_unlock(&np->lock);
1147		}
1148
1149		/* Abnormal error summary/uncommon events handlers. */
1150		if (intr_status & (AbnormalIntr | TxFIFOUnderflow | SystemError |
1151						   TimerInt | TxDied))
1152			netdev_error(dev, intr_status);
1153
1154		if (--work_limit < 0) {
1155			dev_warn(&dev->dev,
1156				 "Too much work at interrupt, status=0x%04x\n",
1157				 intr_status);
1158			/* Set the timer to re-enable the other interrupts after
1159			   10*82usec ticks. */
1160			spin_lock(&np->lock);
1161			if (netif_device_present(dev)) {
1162				iowrite32(AbnormalIntr | TimerInt, ioaddr + IntrEnable);
1163				iowrite32(10, ioaddr + GPTimer);
1164			}
1165			spin_unlock(&np->lock);
1166			break;
1167		}
1168	} while (1);
1169
1170	if (debug > 3)
1171		netdev_dbg(dev, "exiting interrupt, status=%#4.4x\n",
1172			   ioread32(ioaddr + IntrStatus));
1173	return IRQ_RETVAL(handled);
1174}
1175
1176/* This routine is logically part of the interrupt handler, but separated
1177   for clarity and better register allocation. */
1178static int netdev_rx(struct net_device *dev)
1179{
1180	struct netdev_private *np = netdev_priv(dev);
1181	int entry = np->cur_rx % RX_RING_SIZE;
1182	int work_limit = np->dirty_rx + RX_RING_SIZE - np->cur_rx;
1183
1184	if (debug > 4) {
1185		netdev_dbg(dev, " In netdev_rx(), entry %d status %04x\n",
1186			   entry, np->rx_ring[entry].status);
1187	}
1188
1189	/* If EOP is set on the next entry, it's a new packet. Send it up. */
1190	while (--work_limit >= 0) {
1191		struct w840_rx_desc *desc = np->rx_head_desc;
1192		s32 status = desc->status;
1193
1194		if (debug > 4)
1195			netdev_dbg(dev, "  netdev_rx() status was %08x\n",
1196				   status);
1197		if (status < 0)
1198			break;
1199		if ((status & 0x38008300) != 0x0300) {
1200			if ((status & 0x38000300) != 0x0300) {
1201				/* Ingore earlier buffers. */
1202				if ((status & 0xffff) != 0x7fff) {
1203					dev_warn(&dev->dev,
1204						 "Oversized Ethernet frame spanned multiple buffers, entry %#x status %04x!\n",
1205						 np->cur_rx, status);
1206					np->stats.rx_length_errors++;
1207				}
1208			} else if (status & 0x8000) {
1209				/* There was a fatal error. */
1210				if (debug > 2)
1211					netdev_dbg(dev, "Receive error, Rx status %08x\n",
1212						   status);
1213				np->stats.rx_errors++; /* end of a packet.*/
1214				if (status & 0x0890) np->stats.rx_length_errors++;
1215				if (status & 0x004C) np->stats.rx_frame_errors++;
1216				if (status & 0x0002) np->stats.rx_crc_errors++;
1217			}
1218		} else {
1219			struct sk_buff *skb;
1220			/* Omit the four octet CRC from the length. */
1221			int pkt_len = ((status >> 16) & 0x7ff) - 4;
1222
1223#ifndef final_version
1224			if (debug > 4)
1225				netdev_dbg(dev, "  netdev_rx() normal Rx pkt length %d status %x\n",
1226					   pkt_len, status);
1227#endif
1228			/* Check if the packet is long enough to accept without copying
1229			   to a minimally-sized skbuff. */
1230			if (pkt_len < rx_copybreak &&
1231			    (skb = netdev_alloc_skb(dev, pkt_len + 2)) != NULL) {
1232				skb_reserve(skb, 2);	/* 16 byte align the IP header */
1233				pci_dma_sync_single_for_cpu(np->pci_dev,np->rx_addr[entry],
1234							    np->rx_skbuff[entry]->len,
1235							    PCI_DMA_FROMDEVICE);
1236				skb_copy_to_linear_data(skb, np->rx_skbuff[entry]->data, pkt_len);
1237				skb_put(skb, pkt_len);
1238				pci_dma_sync_single_for_device(np->pci_dev,np->rx_addr[entry],
1239							       np->rx_skbuff[entry]->len,
1240							       PCI_DMA_FROMDEVICE);
1241			} else {
1242				pci_unmap_single(np->pci_dev,np->rx_addr[entry],
1243							np->rx_skbuff[entry]->len,
1244							PCI_DMA_FROMDEVICE);
1245				skb_put(skb = np->rx_skbuff[entry], pkt_len);
1246				np->rx_skbuff[entry] = NULL;
1247			}
1248#ifndef final_version				/* Remove after testing. */
1249			/* You will want this info for the initial debug. */
1250			if (debug > 5)
1251				netdev_dbg(dev, "  Rx data %pM %pM %02x%02x %pI4\n",
1252					   &skb->data[0], &skb->data[6],
1253					   skb->data[12], skb->data[13],
1254					   &skb->data[14]);
1255#endif
1256			skb->protocol = eth_type_trans(skb, dev);
1257			netif_rx(skb);
1258			np->stats.rx_packets++;
1259			np->stats.rx_bytes += pkt_len;
1260		}
1261		entry = (++np->cur_rx) % RX_RING_SIZE;
1262		np->rx_head_desc = &np->rx_ring[entry];
1263	}
1264
1265	/* Refill the Rx ring buffers. */
1266	for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) {
1267		struct sk_buff *skb;
1268		entry = np->dirty_rx % RX_RING_SIZE;
1269		if (np->rx_skbuff[entry] == NULL) {
1270			skb = netdev_alloc_skb(dev, np->rx_buf_sz);
1271			np->rx_skbuff[entry] = skb;
1272			if (skb == NULL)
1273				break;			/* Better luck next round. */
1274			np->rx_addr[entry] = pci_map_single(np->pci_dev,
1275							skb->data,
1276							np->rx_buf_sz, PCI_DMA_FROMDEVICE);
1277			np->rx_ring[entry].buffer1 = np->rx_addr[entry];
1278		}
1279		wmb();
1280		np->rx_ring[entry].status = DescOwned;
1281	}
1282
1283	return 0;
1284}
1285
1286static void netdev_error(struct net_device *dev, int intr_status)
1287{
1288	struct netdev_private *np = netdev_priv(dev);
1289	void __iomem *ioaddr = np->base_addr;
1290
1291	if (debug > 2)
1292		netdev_dbg(dev, "Abnormal event, %08x\n", intr_status);
1293	if (intr_status == 0xffffffff)
1294		return;
1295	spin_lock(&np->lock);
1296	if (intr_status & TxFIFOUnderflow) {
1297		int new;
1298		/* Bump up the Tx threshold */
1299#if 0
1300		/* This causes lots of dropped packets,
1301		 * and under high load even tx_timeouts
1302		 */
1303		new = np->csr6 + 0x4000;
1304#else
1305		new = (np->csr6 >> 14)&0x7f;
1306		if (new < 64)
1307			new *= 2;
1308		 else
1309		 	new = 127; /* load full packet before starting */
1310		new = (np->csr6 & ~(0x7F << 14)) | (new<<14);
1311#endif
1312		netdev_dbg(dev, "Tx underflow, new csr6 %08x\n", new);
1313		update_csr6(dev, new);
1314	}
1315	if (intr_status & RxDied) {		/* Missed a Rx frame. */
1316		np->stats.rx_errors++;
1317	}
1318	if (intr_status & TimerInt) {
1319		/* Re-enable other interrupts. */
1320		if (netif_device_present(dev))
1321			iowrite32(0x1A0F5, ioaddr + IntrEnable);
1322	}
1323	np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1324	iowrite32(0, ioaddr + RxStartDemand);
1325	spin_unlock(&np->lock);
1326}
1327
1328static struct net_device_stats *get_stats(struct net_device *dev)
1329{
1330	struct netdev_private *np = netdev_priv(dev);
1331	void __iomem *ioaddr = np->base_addr;
1332
1333	/* The chip only need report frame silently dropped. */
1334	spin_lock_irq(&np->lock);
1335	if (netif_running(dev) && netif_device_present(dev))
1336		np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1337	spin_unlock_irq(&np->lock);
1338
1339	return &np->stats;
1340}
1341
1342
1343static u32 __set_rx_mode(struct net_device *dev)
1344{
1345	struct netdev_private *np = netdev_priv(dev);
1346	void __iomem *ioaddr = np->base_addr;
1347	u32 mc_filter[2];			/* Multicast hash filter */
1348	u32 rx_mode;
1349
1350	if (dev->flags & IFF_PROMISC) {			/* Set promiscuous. */
1351		memset(mc_filter, 0xff, sizeof(mc_filter));
1352		rx_mode = RxAcceptBroadcast | AcceptMulticast | RxAcceptAllPhys
1353			| AcceptMyPhys;
1354	} else if ((netdev_mc_count(dev) > multicast_filter_limit) ||
1355		   (dev->flags & IFF_ALLMULTI)) {
1356		/* Too many to match, or accept all multicasts. */
1357		memset(mc_filter, 0xff, sizeof(mc_filter));
1358		rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
1359	} else {
1360		struct netdev_hw_addr *ha;
1361
1362		memset(mc_filter, 0, sizeof(mc_filter));
1363		netdev_for_each_mc_addr(ha, dev) {
1364			int filbit;
1365
1366			filbit = (ether_crc(ETH_ALEN, ha->addr) >> 26) ^ 0x3F;
1367			filbit &= 0x3f;
1368			mc_filter[filbit >> 5] |= 1 << (filbit & 31);
1369		}
1370		rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
1371	}
1372	iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1373	iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1374	return rx_mode;
1375}
1376
1377static void set_rx_mode(struct net_device *dev)
1378{
1379	struct netdev_private *np = netdev_priv(dev);
1380	u32 rx_mode = __set_rx_mode(dev);
1381	spin_lock_irq(&np->lock);
1382	update_csr6(dev, (np->csr6 & ~0x00F8) | rx_mode);
1383	spin_unlock_irq(&np->lock);
1384}
1385
1386static void netdev_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info)
1387{
1388	struct netdev_private *np = netdev_priv(dev);
1389
1390	strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
1391	strlcpy(info->version, DRV_VERSION, sizeof(info->version));
1392	strlcpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info));
1393}
1394
1395static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1396{
1397	struct netdev_private *np = netdev_priv(dev);
1398	int rc;
1399
1400	spin_lock_irq(&np->lock);
1401	rc = mii_ethtool_gset(&np->mii_if, cmd);
1402	spin_unlock_irq(&np->lock);
1403
1404	return rc;
1405}
1406
1407static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1408{
1409	struct netdev_private *np = netdev_priv(dev);
1410	int rc;
1411
1412	spin_lock_irq(&np->lock);
1413	rc = mii_ethtool_sset(&np->mii_if, cmd);
1414	spin_unlock_irq(&np->lock);
1415
1416	return rc;
1417}
1418
1419static int netdev_nway_reset(struct net_device *dev)
1420{
1421	struct netdev_private *np = netdev_priv(dev);
1422	return mii_nway_restart(&np->mii_if);
1423}
1424
1425static u32 netdev_get_link(struct net_device *dev)
1426{
1427	struct netdev_private *np = netdev_priv(dev);
1428	return mii_link_ok(&np->mii_if);
1429}
1430
1431static u32 netdev_get_msglevel(struct net_device *dev)
1432{
1433	return debug;
1434}
1435
1436static void netdev_set_msglevel(struct net_device *dev, u32 value)
1437{
1438	debug = value;
1439}
1440
1441static const struct ethtool_ops netdev_ethtool_ops = {
1442	.get_drvinfo		= netdev_get_drvinfo,
1443	.get_settings		= netdev_get_settings,
1444	.set_settings		= netdev_set_settings,
1445	.nway_reset		= netdev_nway_reset,
1446	.get_link		= netdev_get_link,
1447	.get_msglevel		= netdev_get_msglevel,
1448	.set_msglevel		= netdev_set_msglevel,
1449};
1450
1451static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1452{
1453	struct mii_ioctl_data *data = if_mii(rq);
1454	struct netdev_private *np = netdev_priv(dev);
1455
1456	switch(cmd) {
1457	case SIOCGMIIPHY:		/* Get address of MII PHY in use. */
1458		data->phy_id = ((struct netdev_private *)netdev_priv(dev))->phys[0] & 0x1f;
1459		/* Fall Through */
1460
1461	case SIOCGMIIREG:		/* Read MII PHY register. */
1462		spin_lock_irq(&np->lock);
1463		data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
1464		spin_unlock_irq(&np->lock);
1465		return 0;
1466
1467	case SIOCSMIIREG:		/* Write MII PHY register. */
1468		spin_lock_irq(&np->lock);
1469		mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1470		spin_unlock_irq(&np->lock);
1471		return 0;
1472	default:
1473		return -EOPNOTSUPP;
1474	}
1475}
1476
1477static int netdev_close(struct net_device *dev)
1478{
1479	struct netdev_private *np = netdev_priv(dev);
1480	void __iomem *ioaddr = np->base_addr;
1481
1482	netif_stop_queue(dev);
1483
1484	if (debug > 1) {
1485		netdev_dbg(dev, "Shutting down ethercard, status was %08x Config %08x\n",
1486			   ioread32(ioaddr + IntrStatus),
1487			   ioread32(ioaddr + NetworkConfig));
1488		netdev_dbg(dev, "Queue pointers were Tx %d / %d,  Rx %d / %d\n",
1489			   np->cur_tx, np->dirty_tx,
1490			   np->cur_rx, np->dirty_rx);
1491	}
1492
1493 	/* Stop the chip's Tx and Rx processes. */
1494	spin_lock_irq(&np->lock);
1495	netif_device_detach(dev);
1496	update_csr6(dev, 0);
1497	iowrite32(0x0000, ioaddr + IntrEnable);
1498	spin_unlock_irq(&np->lock);
1499
1500	free_irq(np->pci_dev->irq, dev);
1501	wmb();
1502	netif_device_attach(dev);
1503
1504	if (ioread32(ioaddr + NetworkConfig) != 0xffffffff)
1505		np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1506
1507#ifdef __i386__
1508	if (debug > 2) {
1509		int i;
1510
1511		printk(KERN_DEBUG"  Tx ring at %p:\n", np->tx_ring);
1512		for (i = 0; i < TX_RING_SIZE; i++)
1513			printk(KERN_DEBUG " #%d desc. %04x %04x %08x\n",
1514			       i, np->tx_ring[i].length,
1515			       np->tx_ring[i].status, np->tx_ring[i].buffer1);
1516		printk(KERN_DEBUG "  Rx ring %p:\n", np->rx_ring);
1517		for (i = 0; i < RX_RING_SIZE; i++) {
1518			printk(KERN_DEBUG " #%d desc. %04x %04x %08x\n",
1519			       i, np->rx_ring[i].length,
1520			       np->rx_ring[i].status, np->rx_ring[i].buffer1);
1521		}
1522	}
1523#endif /* __i386__ debugging only */
1524
1525	del_timer_sync(&np->timer);
1526
1527	free_rxtx_rings(np);
1528	free_ringdesc(np);
1529
1530	return 0;
1531}
1532
1533static void w840_remove1(struct pci_dev *pdev)
1534{
1535	struct net_device *dev = pci_get_drvdata(pdev);
1536
1537	if (dev) {
1538		struct netdev_private *np = netdev_priv(dev);
1539		unregister_netdev(dev);
1540		pci_release_regions(pdev);
1541		pci_iounmap(pdev, np->base_addr);
1542		free_netdev(dev);
1543	}
1544}
1545
1546#ifdef CONFIG_PM
1547
1548/*
1549 * suspend/resume synchronization:
1550 * - open, close, do_ioctl:
1551 * 	rtnl_lock, & netif_device_detach after the rtnl_unlock.
1552 * - get_stats:
1553 * 	spin_lock_irq(np->lock), doesn't touch hw if not present
1554 * - start_xmit:
1555 * 	synchronize_irq + netif_tx_disable;
1556 * - tx_timeout:
1557 * 	netif_device_detach + netif_tx_disable;
1558 * - set_multicast_list
1559 * 	netif_device_detach + netif_tx_disable;
1560 * - interrupt handler
1561 * 	doesn't touch hw if not present, synchronize_irq waits for
1562 * 	running instances of the interrupt handler.
1563 *
1564 * Disabling hw requires clearing csr6 & IntrEnable.
1565 * update_csr6 & all function that write IntrEnable check netif_device_present
1566 * before settings any bits.
1567 *
1568 * Detach must occur under spin_unlock_irq(), interrupts from a detached
1569 * device would cause an irq storm.
1570 */
1571static int w840_suspend (struct pci_dev *pdev, pm_message_t state)
1572{
1573	struct net_device *dev = pci_get_drvdata (pdev);
1574	struct netdev_private *np = netdev_priv(dev);
1575	void __iomem *ioaddr = np->base_addr;
1576
1577	rtnl_lock();
1578	if (netif_running (dev)) {
1579		del_timer_sync(&np->timer);
1580
1581		spin_lock_irq(&np->lock);
1582		netif_device_detach(dev);
1583		update_csr6(dev, 0);
1584		iowrite32(0, ioaddr + IntrEnable);
1585		spin_unlock_irq(&np->lock);
1586
1587		synchronize_irq(np->pci_dev->irq);
1588		netif_tx_disable(dev);
1589
1590		np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1591
1592		/* no more hardware accesses behind this line. */
1593
1594		BUG_ON(np->csr6 || ioread32(ioaddr + IntrEnable));
1595
1596		/* pci_power_off(pdev, -1); */
1597
1598		free_rxtx_rings(np);
1599	} else {
1600		netif_device_detach(dev);
1601	}
1602	rtnl_unlock();
1603	return 0;
1604}
1605
1606static int w840_resume (struct pci_dev *pdev)
1607{
1608	struct net_device *dev = pci_get_drvdata (pdev);
1609	struct netdev_private *np = netdev_priv(dev);
1610	int retval = 0;
1611
1612	rtnl_lock();
1613	if (netif_device_present(dev))
1614		goto out; /* device not suspended */
1615	if (netif_running(dev)) {
1616		if ((retval = pci_enable_device(pdev))) {
1617			dev_err(&dev->dev,
1618				"pci_enable_device failed in resume\n");
1619			goto out;
1620		}
1621		spin_lock_irq(&np->lock);
1622		iowrite32(1, np->base_addr+PCIBusCfg);
1623		ioread32(np->base_addr+PCIBusCfg);
1624		udelay(1);
1625		netif_device_attach(dev);
1626		init_rxtx_rings(dev);
1627		init_registers(dev);
1628		spin_unlock_irq(&np->lock);
1629
1630		netif_wake_queue(dev);
1631
1632		mod_timer(&np->timer, jiffies + 1*HZ);
1633	} else {
1634		netif_device_attach(dev);
1635	}
1636out:
1637	rtnl_unlock();
1638	return retval;
1639}
1640#endif
1641
1642static struct pci_driver w840_driver = {
1643	.name		= DRV_NAME,
1644	.id_table	= w840_pci_tbl,
1645	.probe		= w840_probe1,
1646	.remove		= w840_remove1,
1647#ifdef CONFIG_PM
1648	.suspend	= w840_suspend,
1649	.resume		= w840_resume,
1650#endif
1651};
1652
1653static int __init w840_init(void)
1654{
1655	printk(version);
1656	return pci_register_driver(&w840_driver);
1657}
1658
1659static void __exit w840_exit(void)
1660{
1661	pci_unregister_driver(&w840_driver);
1662}
1663
1664module_init(w840_init);
1665module_exit(w840_exit);
1666