xref: /OK3568_Linux_fs/kernel/drivers/net/ethernet/smsc/smc91x.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * smc91x.c
4*4882a593Smuzhiyun  * This is a driver for SMSC's 91C9x/91C1xx single-chip Ethernet devices.
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * Copyright (C) 1996 by Erik Stahlman
7*4882a593Smuzhiyun  * Copyright (C) 2001 Standard Microsystems Corporation
8*4882a593Smuzhiyun  *	Developed by Simple Network Magic Corporation
9*4882a593Smuzhiyun  * Copyright (C) 2003 Monta Vista Software, Inc.
10*4882a593Smuzhiyun  *	Unified SMC91x driver by Nicolas Pitre
11*4882a593Smuzhiyun  *
12*4882a593Smuzhiyun  * Arguments:
13*4882a593Smuzhiyun  * 	io	= for the base address
14*4882a593Smuzhiyun  *	irq	= for the IRQ
15*4882a593Smuzhiyun  *	nowait	= 0 for normal wait states, 1 eliminates additional wait states
16*4882a593Smuzhiyun  *
17*4882a593Smuzhiyun  * original author:
18*4882a593Smuzhiyun  * 	Erik Stahlman <erik@vt.edu>
19*4882a593Smuzhiyun  *
20*4882a593Smuzhiyun  * hardware multicast code:
21*4882a593Smuzhiyun  *    Peter Cammaert <pc@denkart.be>
22*4882a593Smuzhiyun  *
23*4882a593Smuzhiyun  * contributors:
24*4882a593Smuzhiyun  * 	Daris A Nevil <dnevil@snmc.com>
25*4882a593Smuzhiyun  *      Nicolas Pitre <nico@fluxnic.net>
26*4882a593Smuzhiyun  *	Russell King <rmk@arm.linux.org.uk>
27*4882a593Smuzhiyun  *
28*4882a593Smuzhiyun  * History:
29*4882a593Smuzhiyun  *   08/20/00  Arnaldo Melo       fix kfree(skb) in smc_hardware_send_packet
30*4882a593Smuzhiyun  *   12/15/00  Christian Jullien  fix "Warning: kfree_skb on hard IRQ"
31*4882a593Smuzhiyun  *   03/16/01  Daris A Nevil      modified smc9194.c for use with LAN91C111
32*4882a593Smuzhiyun  *   08/22/01  Scott Anderson     merge changes from smc9194 to smc91111
33*4882a593Smuzhiyun  *   08/21/01  Pramod B Bhardwaj  added support for RevB of LAN91C111
34*4882a593Smuzhiyun  *   12/20/01  Jeff Sutherland    initial port to Xscale PXA with DMA support
35*4882a593Smuzhiyun  *   04/07/03  Nicolas Pitre      unified SMC91x driver, killed irq races,
36*4882a593Smuzhiyun  *                                more bus abstraction, big cleanup, etc.
37*4882a593Smuzhiyun  *   29/09/03  Russell King       - add driver model support
38*4882a593Smuzhiyun  *                                - ethtool support
39*4882a593Smuzhiyun  *                                - convert to use generic MII interface
40*4882a593Smuzhiyun  *                                - add link up/down notification
41*4882a593Smuzhiyun  *                                - don't try to handle full negotiation in
42*4882a593Smuzhiyun  *                                  smc_phy_configure
43*4882a593Smuzhiyun  *                                - clean up (and fix stack overrun) in PHY
44*4882a593Smuzhiyun  *                                  MII read/write functions
45*4882a593Smuzhiyun  *   22/09/04  Nicolas Pitre      big update (see commit log for details)
46*4882a593Smuzhiyun  */
47*4882a593Smuzhiyun static const char version[] =
48*4882a593Smuzhiyun 	"smc91x.c: v1.1, sep 22 2004 by Nicolas Pitre <nico@fluxnic.net>";
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun /* Debugging level */
51*4882a593Smuzhiyun #ifndef SMC_DEBUG
52*4882a593Smuzhiyun #define SMC_DEBUG		0
53*4882a593Smuzhiyun #endif
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun #include <linux/module.h>
57*4882a593Smuzhiyun #include <linux/kernel.h>
58*4882a593Smuzhiyun #include <linux/sched.h>
59*4882a593Smuzhiyun #include <linux/delay.h>
60*4882a593Smuzhiyun #include <linux/interrupt.h>
61*4882a593Smuzhiyun #include <linux/irq.h>
62*4882a593Smuzhiyun #include <linux/errno.h>
63*4882a593Smuzhiyun #include <linux/ioport.h>
64*4882a593Smuzhiyun #include <linux/crc32.h>
65*4882a593Smuzhiyun #include <linux/platform_device.h>
66*4882a593Smuzhiyun #include <linux/spinlock.h>
67*4882a593Smuzhiyun #include <linux/ethtool.h>
68*4882a593Smuzhiyun #include <linux/mii.h>
69*4882a593Smuzhiyun #include <linux/workqueue.h>
70*4882a593Smuzhiyun #include <linux/of.h>
71*4882a593Smuzhiyun #include <linux/of_device.h>
72*4882a593Smuzhiyun #include <linux/of_gpio.h>
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun #include <linux/netdevice.h>
75*4882a593Smuzhiyun #include <linux/etherdevice.h>
76*4882a593Smuzhiyun #include <linux/skbuff.h>
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun #include <asm/io.h>
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun #include "smc91x.h"
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun #if defined(CONFIG_ASSABET_NEPONSET)
83*4882a593Smuzhiyun #include <mach/assabet.h>
84*4882a593Smuzhiyun #include <mach/neponset.h>
85*4882a593Smuzhiyun #endif
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun #ifndef SMC_NOWAIT
88*4882a593Smuzhiyun # define SMC_NOWAIT		0
89*4882a593Smuzhiyun #endif
90*4882a593Smuzhiyun static int nowait = SMC_NOWAIT;
91*4882a593Smuzhiyun module_param(nowait, int, 0400);
92*4882a593Smuzhiyun MODULE_PARM_DESC(nowait, "set to 1 for no wait state");
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun /*
95*4882a593Smuzhiyun  * Transmit timeout, default 5 seconds.
96*4882a593Smuzhiyun  */
97*4882a593Smuzhiyun static int watchdog = 1000;
98*4882a593Smuzhiyun module_param(watchdog, int, 0400);
99*4882a593Smuzhiyun MODULE_PARM_DESC(watchdog, "transmit timeout in milliseconds");
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun MODULE_LICENSE("GPL");
102*4882a593Smuzhiyun MODULE_ALIAS("platform:smc91x");
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun /*
105*4882a593Smuzhiyun  * The internal workings of the driver.  If you are changing anything
106*4882a593Smuzhiyun  * here with the SMC stuff, you should have the datasheet and know
107*4882a593Smuzhiyun  * what you are doing.
108*4882a593Smuzhiyun  */
109*4882a593Smuzhiyun #define CARDNAME "smc91x"
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun /*
112*4882a593Smuzhiyun  * Use power-down feature of the chip
113*4882a593Smuzhiyun  */
114*4882a593Smuzhiyun #define POWER_DOWN		1
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun /*
117*4882a593Smuzhiyun  * Wait time for memory to be free.  This probably shouldn't be
118*4882a593Smuzhiyun  * tuned that much, as waiting for this means nothing else happens
119*4882a593Smuzhiyun  * in the system
120*4882a593Smuzhiyun  */
121*4882a593Smuzhiyun #define MEMORY_WAIT_TIME	16
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun /*
124*4882a593Smuzhiyun  * The maximum number of processing loops allowed for each call to the
125*4882a593Smuzhiyun  * IRQ handler.
126*4882a593Smuzhiyun  */
127*4882a593Smuzhiyun #define MAX_IRQ_LOOPS		8
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun /*
130*4882a593Smuzhiyun  * This selects whether TX packets are sent one by one to the SMC91x internal
131*4882a593Smuzhiyun  * memory and throttled until transmission completes.  This may prevent
132*4882a593Smuzhiyun  * RX overruns a litle by keeping much of the memory free for RX packets
133*4882a593Smuzhiyun  * but to the expense of reduced TX throughput and increased IRQ overhead.
134*4882a593Smuzhiyun  * Note this is not a cure for a too slow data bus or too high IRQ latency.
135*4882a593Smuzhiyun  */
136*4882a593Smuzhiyun #define THROTTLE_TX_PKTS	0
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun /*
139*4882a593Smuzhiyun  * The MII clock high/low times.  2x this number gives the MII clock period
140*4882a593Smuzhiyun  * in microseconds. (was 50, but this gives 6.4ms for each MII transaction!)
141*4882a593Smuzhiyun  */
142*4882a593Smuzhiyun #define MII_DELAY		1
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun #define DBG(n, dev, fmt, ...)					\
145*4882a593Smuzhiyun 	do {							\
146*4882a593Smuzhiyun 		if (SMC_DEBUG >= (n))				\
147*4882a593Smuzhiyun 			netdev_dbg(dev, fmt, ##__VA_ARGS__);	\
148*4882a593Smuzhiyun 	} while (0)
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun #define PRINTK(dev, fmt, ...)					\
151*4882a593Smuzhiyun 	do {							\
152*4882a593Smuzhiyun 		if (SMC_DEBUG > 0)				\
153*4882a593Smuzhiyun 			netdev_info(dev, fmt, ##__VA_ARGS__);	\
154*4882a593Smuzhiyun 		else						\
155*4882a593Smuzhiyun 			netdev_dbg(dev, fmt, ##__VA_ARGS__);	\
156*4882a593Smuzhiyun 	} while (0)
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun #if SMC_DEBUG > 3
PRINT_PKT(u_char * buf,int length)159*4882a593Smuzhiyun static void PRINT_PKT(u_char *buf, int length)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun 	int i;
162*4882a593Smuzhiyun 	int remainder;
163*4882a593Smuzhiyun 	int lines;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	lines = length / 16;
166*4882a593Smuzhiyun 	remainder = length % 16;
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 	for (i = 0; i < lines ; i ++) {
169*4882a593Smuzhiyun 		int cur;
170*4882a593Smuzhiyun 		printk(KERN_DEBUG);
171*4882a593Smuzhiyun 		for (cur = 0; cur < 8; cur++) {
172*4882a593Smuzhiyun 			u_char a, b;
173*4882a593Smuzhiyun 			a = *buf++;
174*4882a593Smuzhiyun 			b = *buf++;
175*4882a593Smuzhiyun 			pr_cont("%02x%02x ", a, b);
176*4882a593Smuzhiyun 		}
177*4882a593Smuzhiyun 		pr_cont("\n");
178*4882a593Smuzhiyun 	}
179*4882a593Smuzhiyun 	printk(KERN_DEBUG);
180*4882a593Smuzhiyun 	for (i = 0; i < remainder/2 ; i++) {
181*4882a593Smuzhiyun 		u_char a, b;
182*4882a593Smuzhiyun 		a = *buf++;
183*4882a593Smuzhiyun 		b = *buf++;
184*4882a593Smuzhiyun 		pr_cont("%02x%02x ", a, b);
185*4882a593Smuzhiyun 	}
186*4882a593Smuzhiyun 	pr_cont("\n");
187*4882a593Smuzhiyun }
188*4882a593Smuzhiyun #else
PRINT_PKT(u_char * buf,int length)189*4882a593Smuzhiyun static inline void PRINT_PKT(u_char *buf, int length) { }
190*4882a593Smuzhiyun #endif
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun /* this enables an interrupt in the interrupt mask register */
194*4882a593Smuzhiyun #define SMC_ENABLE_INT(lp, x) do {					\
195*4882a593Smuzhiyun 	unsigned char mask;						\
196*4882a593Smuzhiyun 	unsigned long smc_enable_flags;					\
197*4882a593Smuzhiyun 	spin_lock_irqsave(&lp->lock, smc_enable_flags);			\
198*4882a593Smuzhiyun 	mask = SMC_GET_INT_MASK(lp);					\
199*4882a593Smuzhiyun 	mask |= (x);							\
200*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, mask);					\
201*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lp->lock, smc_enable_flags);		\
202*4882a593Smuzhiyun } while (0)
203*4882a593Smuzhiyun 
204*4882a593Smuzhiyun /* this disables an interrupt from the interrupt mask register */
205*4882a593Smuzhiyun #define SMC_DISABLE_INT(lp, x) do {					\
206*4882a593Smuzhiyun 	unsigned char mask;						\
207*4882a593Smuzhiyun 	unsigned long smc_disable_flags;				\
208*4882a593Smuzhiyun 	spin_lock_irqsave(&lp->lock, smc_disable_flags);		\
209*4882a593Smuzhiyun 	mask = SMC_GET_INT_MASK(lp);					\
210*4882a593Smuzhiyun 	mask &= ~(x);							\
211*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, mask);					\
212*4882a593Smuzhiyun 	spin_unlock_irqrestore(&lp->lock, smc_disable_flags);		\
213*4882a593Smuzhiyun } while (0)
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun /*
216*4882a593Smuzhiyun  * Wait while MMU is busy.  This is usually in the order of a few nanosecs
217*4882a593Smuzhiyun  * if at all, but let's avoid deadlocking the system if the hardware
218*4882a593Smuzhiyun  * decides to go south.
219*4882a593Smuzhiyun  */
220*4882a593Smuzhiyun #define SMC_WAIT_MMU_BUSY(lp) do {					\
221*4882a593Smuzhiyun 	if (unlikely(SMC_GET_MMU_CMD(lp) & MC_BUSY)) {		\
222*4882a593Smuzhiyun 		unsigned long timeout = jiffies + 2;			\
223*4882a593Smuzhiyun 		while (SMC_GET_MMU_CMD(lp) & MC_BUSY) {		\
224*4882a593Smuzhiyun 			if (time_after(jiffies, timeout)) {		\
225*4882a593Smuzhiyun 				netdev_dbg(dev, "timeout %s line %d\n",	\
226*4882a593Smuzhiyun 					   __FILE__, __LINE__);		\
227*4882a593Smuzhiyun 				break;					\
228*4882a593Smuzhiyun 			}						\
229*4882a593Smuzhiyun 			cpu_relax();					\
230*4882a593Smuzhiyun 		}							\
231*4882a593Smuzhiyun 	}								\
232*4882a593Smuzhiyun } while (0)
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun /*
236*4882a593Smuzhiyun  * this does a soft reset on the device
237*4882a593Smuzhiyun  */
smc_reset(struct net_device * dev)238*4882a593Smuzhiyun static void smc_reset(struct net_device *dev)
239*4882a593Smuzhiyun {
240*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
241*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
242*4882a593Smuzhiyun 	unsigned int ctl, cfg;
243*4882a593Smuzhiyun 	struct sk_buff *pending_skb;
244*4882a593Smuzhiyun 
245*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 	/* Disable all interrupts, block TX tasklet */
248*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
249*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
250*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, 0);
251*4882a593Smuzhiyun 	pending_skb = lp->pending_tx_skb;
252*4882a593Smuzhiyun 	lp->pending_tx_skb = NULL;
253*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	/* free any pending tx skb */
256*4882a593Smuzhiyun 	if (pending_skb) {
257*4882a593Smuzhiyun 		dev_kfree_skb(pending_skb);
258*4882a593Smuzhiyun 		dev->stats.tx_errors++;
259*4882a593Smuzhiyun 		dev->stats.tx_aborted_errors++;
260*4882a593Smuzhiyun 	}
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	/*
263*4882a593Smuzhiyun 	 * This resets the registers mostly to defaults, but doesn't
264*4882a593Smuzhiyun 	 * affect EEPROM.  That seems unnecessary
265*4882a593Smuzhiyun 	 */
266*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
267*4882a593Smuzhiyun 	SMC_SET_RCR(lp, RCR_SOFTRST);
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	/*
270*4882a593Smuzhiyun 	 * Setup the Configuration Register
271*4882a593Smuzhiyun 	 * This is necessary because the CONFIG_REG is not affected
272*4882a593Smuzhiyun 	 * by a soft reset
273*4882a593Smuzhiyun 	 */
274*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	cfg = CONFIG_DEFAULT;
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun 	/*
279*4882a593Smuzhiyun 	 * Setup for fast accesses if requested.  If the card/system
280*4882a593Smuzhiyun 	 * can't handle it then there will be no recovery except for
281*4882a593Smuzhiyun 	 * a hard reset or power cycle
282*4882a593Smuzhiyun 	 */
283*4882a593Smuzhiyun 	if (lp->cfg.flags & SMC91X_NOWAIT)
284*4882a593Smuzhiyun 		cfg |= CONFIG_NO_WAIT;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	/*
287*4882a593Smuzhiyun 	 * Release from possible power-down state
288*4882a593Smuzhiyun 	 * Configuration register is not affected by Soft Reset
289*4882a593Smuzhiyun 	 */
290*4882a593Smuzhiyun 	cfg |= CONFIG_EPH_POWER_EN;
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun 	SMC_SET_CONFIG(lp, cfg);
293*4882a593Smuzhiyun 
294*4882a593Smuzhiyun 	/* this should pause enough for the chip to be happy */
295*4882a593Smuzhiyun 	/*
296*4882a593Smuzhiyun 	 * elaborate?  What does the chip _need_? --jgarzik
297*4882a593Smuzhiyun 	 *
298*4882a593Smuzhiyun 	 * This seems to be undocumented, but something the original
299*4882a593Smuzhiyun 	 * driver(s) have always done.  Suspect undocumented timing
300*4882a593Smuzhiyun 	 * info/determined empirically. --rmk
301*4882a593Smuzhiyun 	 */
302*4882a593Smuzhiyun 	udelay(1);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	/* Disable transmit and receive functionality */
305*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
306*4882a593Smuzhiyun 	SMC_SET_RCR(lp, RCR_CLEAR);
307*4882a593Smuzhiyun 	SMC_SET_TCR(lp, TCR_CLEAR);
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
310*4882a593Smuzhiyun 	ctl = SMC_GET_CTL(lp) | CTL_LE_ENABLE;
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun 	/*
313*4882a593Smuzhiyun 	 * Set the control register to automatically release successfully
314*4882a593Smuzhiyun 	 * transmitted packets, to make the best use out of our limited
315*4882a593Smuzhiyun 	 * memory
316*4882a593Smuzhiyun 	 */
317*4882a593Smuzhiyun 	if(!THROTTLE_TX_PKTS)
318*4882a593Smuzhiyun 		ctl |= CTL_AUTO_RELEASE;
319*4882a593Smuzhiyun 	else
320*4882a593Smuzhiyun 		ctl &= ~CTL_AUTO_RELEASE;
321*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl);
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	/* Reset the MMU */
324*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
325*4882a593Smuzhiyun 	SMC_SET_MMU_CMD(lp, MC_RESET);
326*4882a593Smuzhiyun 	SMC_WAIT_MMU_BUSY(lp);
327*4882a593Smuzhiyun }
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun /*
330*4882a593Smuzhiyun  * Enable Interrupts, Receive, and Transmit
331*4882a593Smuzhiyun  */
smc_enable(struct net_device * dev)332*4882a593Smuzhiyun static void smc_enable(struct net_device *dev)
333*4882a593Smuzhiyun {
334*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
335*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
336*4882a593Smuzhiyun 	int mask;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
339*4882a593Smuzhiyun 
340*4882a593Smuzhiyun 	/* see the header file for options in TCR/RCR DEFAULT */
341*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
342*4882a593Smuzhiyun 	SMC_SET_TCR(lp, lp->tcr_cur_mode);
343*4882a593Smuzhiyun 	SMC_SET_RCR(lp, lp->rcr_cur_mode);
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
346*4882a593Smuzhiyun 	SMC_SET_MAC_ADDR(lp, dev->dev_addr);
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	/* now, enable interrupts */
349*4882a593Smuzhiyun 	mask = IM_EPH_INT|IM_RX_OVRN_INT|IM_RCV_INT;
350*4882a593Smuzhiyun 	if (lp->version >= (CHIP_91100 << 4))
351*4882a593Smuzhiyun 		mask |= IM_MDINT;
352*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
353*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, mask);
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun 	/*
356*4882a593Smuzhiyun 	 * From this point the register bank must _NOT_ be switched away
357*4882a593Smuzhiyun 	 * to something else than bank 2 without proper locking against
358*4882a593Smuzhiyun 	 * races with any tasklet or interrupt handlers until smc_shutdown()
359*4882a593Smuzhiyun 	 * or smc_reset() is called.
360*4882a593Smuzhiyun 	 */
361*4882a593Smuzhiyun }
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun /*
364*4882a593Smuzhiyun  * this puts the device in an inactive state
365*4882a593Smuzhiyun  */
smc_shutdown(struct net_device * dev)366*4882a593Smuzhiyun static void smc_shutdown(struct net_device *dev)
367*4882a593Smuzhiyun {
368*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
369*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
370*4882a593Smuzhiyun 	struct sk_buff *pending_skb;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	DBG(2, dev, "%s: %s\n", CARDNAME, __func__);
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	/* no more interrupts for me */
375*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
376*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
377*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, 0);
378*4882a593Smuzhiyun 	pending_skb = lp->pending_tx_skb;
379*4882a593Smuzhiyun 	lp->pending_tx_skb = NULL;
380*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
381*4882a593Smuzhiyun 	dev_kfree_skb(pending_skb);
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	/* and tell the card to stay away from that nasty outside world */
384*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
385*4882a593Smuzhiyun 	SMC_SET_RCR(lp, RCR_CLEAR);
386*4882a593Smuzhiyun 	SMC_SET_TCR(lp, TCR_CLEAR);
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun #ifdef POWER_DOWN
389*4882a593Smuzhiyun 	/* finally, shut the chip down */
390*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
391*4882a593Smuzhiyun 	SMC_SET_CONFIG(lp, SMC_GET_CONFIG(lp) & ~CONFIG_EPH_POWER_EN);
392*4882a593Smuzhiyun #endif
393*4882a593Smuzhiyun }
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun /*
396*4882a593Smuzhiyun  * This is the procedure to handle the receipt of a packet.
397*4882a593Smuzhiyun  */
smc_rcv(struct net_device * dev)398*4882a593Smuzhiyun static inline void  smc_rcv(struct net_device *dev)
399*4882a593Smuzhiyun {
400*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
401*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
402*4882a593Smuzhiyun 	unsigned int packet_number, status, packet_len;
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 	DBG(3, dev, "%s\n", __func__);
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun 	packet_number = SMC_GET_RXFIFO(lp);
407*4882a593Smuzhiyun 	if (unlikely(packet_number & RXFIFO_REMPTY)) {
408*4882a593Smuzhiyun 		PRINTK(dev, "smc_rcv with nothing on FIFO.\n");
409*4882a593Smuzhiyun 		return;
410*4882a593Smuzhiyun 	}
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 	/* read from start of packet */
413*4882a593Smuzhiyun 	SMC_SET_PTR(lp, PTR_READ | PTR_RCV | PTR_AUTOINC);
414*4882a593Smuzhiyun 
415*4882a593Smuzhiyun 	/* First two words are status and packet length */
416*4882a593Smuzhiyun 	SMC_GET_PKT_HDR(lp, status, packet_len);
417*4882a593Smuzhiyun 	packet_len &= 0x07ff;  /* mask off top bits */
418*4882a593Smuzhiyun 	DBG(2, dev, "RX PNR 0x%x STATUS 0x%04x LENGTH 0x%04x (%d)\n",
419*4882a593Smuzhiyun 	    packet_number, status, packet_len, packet_len);
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	back:
422*4882a593Smuzhiyun 	if (unlikely(packet_len < 6 || status & RS_ERRORS)) {
423*4882a593Smuzhiyun 		if (status & RS_TOOLONG && packet_len <= (1514 + 4 + 6)) {
424*4882a593Smuzhiyun 			/* accept VLAN packets */
425*4882a593Smuzhiyun 			status &= ~RS_TOOLONG;
426*4882a593Smuzhiyun 			goto back;
427*4882a593Smuzhiyun 		}
428*4882a593Smuzhiyun 		if (packet_len < 6) {
429*4882a593Smuzhiyun 			/* bloody hardware */
430*4882a593Smuzhiyun 			netdev_err(dev, "fubar (rxlen %u status %x\n",
431*4882a593Smuzhiyun 				   packet_len, status);
432*4882a593Smuzhiyun 			status |= RS_TOOSHORT;
433*4882a593Smuzhiyun 		}
434*4882a593Smuzhiyun 		SMC_WAIT_MMU_BUSY(lp);
435*4882a593Smuzhiyun 		SMC_SET_MMU_CMD(lp, MC_RELEASE);
436*4882a593Smuzhiyun 		dev->stats.rx_errors++;
437*4882a593Smuzhiyun 		if (status & RS_ALGNERR)
438*4882a593Smuzhiyun 			dev->stats.rx_frame_errors++;
439*4882a593Smuzhiyun 		if (status & (RS_TOOSHORT | RS_TOOLONG))
440*4882a593Smuzhiyun 			dev->stats.rx_length_errors++;
441*4882a593Smuzhiyun 		if (status & RS_BADCRC)
442*4882a593Smuzhiyun 			dev->stats.rx_crc_errors++;
443*4882a593Smuzhiyun 	} else {
444*4882a593Smuzhiyun 		struct sk_buff *skb;
445*4882a593Smuzhiyun 		unsigned char *data;
446*4882a593Smuzhiyun 		unsigned int data_len;
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun 		/* set multicast stats */
449*4882a593Smuzhiyun 		if (status & RS_MULTICAST)
450*4882a593Smuzhiyun 			dev->stats.multicast++;
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun 		/*
453*4882a593Smuzhiyun 		 * Actual payload is packet_len - 6 (or 5 if odd byte).
454*4882a593Smuzhiyun 		 * We want skb_reserve(2) and the final ctrl word
455*4882a593Smuzhiyun 		 * (2 bytes, possibly containing the payload odd byte).
456*4882a593Smuzhiyun 		 * Furthermore, we add 2 bytes to allow rounding up to
457*4882a593Smuzhiyun 		 * multiple of 4 bytes on 32 bit buses.
458*4882a593Smuzhiyun 		 * Hence packet_len - 6 + 2 + 2 + 2.
459*4882a593Smuzhiyun 		 */
460*4882a593Smuzhiyun 		skb = netdev_alloc_skb(dev, packet_len);
461*4882a593Smuzhiyun 		if (unlikely(skb == NULL)) {
462*4882a593Smuzhiyun 			SMC_WAIT_MMU_BUSY(lp);
463*4882a593Smuzhiyun 			SMC_SET_MMU_CMD(lp, MC_RELEASE);
464*4882a593Smuzhiyun 			dev->stats.rx_dropped++;
465*4882a593Smuzhiyun 			return;
466*4882a593Smuzhiyun 		}
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 		/* Align IP header to 32 bits */
469*4882a593Smuzhiyun 		skb_reserve(skb, 2);
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 		/* BUG: the LAN91C111 rev A never sets this bit. Force it. */
472*4882a593Smuzhiyun 		if (lp->version == 0x90)
473*4882a593Smuzhiyun 			status |= RS_ODDFRAME;
474*4882a593Smuzhiyun 
475*4882a593Smuzhiyun 		/*
476*4882a593Smuzhiyun 		 * If odd length: packet_len - 5,
477*4882a593Smuzhiyun 		 * otherwise packet_len - 6.
478*4882a593Smuzhiyun 		 * With the trailing ctrl byte it's packet_len - 4.
479*4882a593Smuzhiyun 		 */
480*4882a593Smuzhiyun 		data_len = packet_len - ((status & RS_ODDFRAME) ? 5 : 6);
481*4882a593Smuzhiyun 		data = skb_put(skb, data_len);
482*4882a593Smuzhiyun 		SMC_PULL_DATA(lp, data, packet_len - 4);
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 		SMC_WAIT_MMU_BUSY(lp);
485*4882a593Smuzhiyun 		SMC_SET_MMU_CMD(lp, MC_RELEASE);
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 		PRINT_PKT(data, packet_len - 4);
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 		skb->protocol = eth_type_trans(skb, dev);
490*4882a593Smuzhiyun 		netif_rx(skb);
491*4882a593Smuzhiyun 		dev->stats.rx_packets++;
492*4882a593Smuzhiyun 		dev->stats.rx_bytes += data_len;
493*4882a593Smuzhiyun 	}
494*4882a593Smuzhiyun }
495*4882a593Smuzhiyun 
496*4882a593Smuzhiyun #ifdef CONFIG_SMP
497*4882a593Smuzhiyun /*
498*4882a593Smuzhiyun  * On SMP we have the following problem:
499*4882a593Smuzhiyun  *
500*4882a593Smuzhiyun  * 	A = smc_hardware_send_pkt()
501*4882a593Smuzhiyun  * 	B = smc_hard_start_xmit()
502*4882a593Smuzhiyun  * 	C = smc_interrupt()
503*4882a593Smuzhiyun  *
504*4882a593Smuzhiyun  * A and B can never be executed simultaneously.  However, at least on UP,
505*4882a593Smuzhiyun  * it is possible (and even desirable) for C to interrupt execution of
506*4882a593Smuzhiyun  * A or B in order to have better RX reliability and avoid overruns.
507*4882a593Smuzhiyun  * C, just like A and B, must have exclusive access to the chip and
508*4882a593Smuzhiyun  * each of them must lock against any other concurrent access.
509*4882a593Smuzhiyun  * Unfortunately this is not possible to have C suspend execution of A or
510*4882a593Smuzhiyun  * B taking place on another CPU. On UP this is no an issue since A and B
511*4882a593Smuzhiyun  * are run from softirq context and C from hard IRQ context, and there is
512*4882a593Smuzhiyun  * no other CPU where concurrent access can happen.
513*4882a593Smuzhiyun  * If ever there is a way to force at least B and C to always be executed
514*4882a593Smuzhiyun  * on the same CPU then we could use read/write locks to protect against
515*4882a593Smuzhiyun  * any other concurrent access and C would always interrupt B. But life
516*4882a593Smuzhiyun  * isn't that easy in a SMP world...
517*4882a593Smuzhiyun  */
518*4882a593Smuzhiyun #define smc_special_trylock(lock, flags)				\
519*4882a593Smuzhiyun ({									\
520*4882a593Smuzhiyun 	int __ret;							\
521*4882a593Smuzhiyun 	local_irq_save(flags);						\
522*4882a593Smuzhiyun 	__ret = spin_trylock(lock);					\
523*4882a593Smuzhiyun 	if (!__ret)							\
524*4882a593Smuzhiyun 		local_irq_restore(flags);				\
525*4882a593Smuzhiyun 	__ret;								\
526*4882a593Smuzhiyun })
527*4882a593Smuzhiyun #define smc_special_lock(lock, flags)		spin_lock_irqsave(lock, flags)
528*4882a593Smuzhiyun #define smc_special_unlock(lock, flags) 	spin_unlock_irqrestore(lock, flags)
529*4882a593Smuzhiyun #else
530*4882a593Smuzhiyun #define smc_special_trylock(lock, flags)	((void)flags, true)
531*4882a593Smuzhiyun #define smc_special_lock(lock, flags)   	do { flags = 0; } while (0)
532*4882a593Smuzhiyun #define smc_special_unlock(lock, flags)	do { flags = 0; } while (0)
533*4882a593Smuzhiyun #endif
534*4882a593Smuzhiyun 
535*4882a593Smuzhiyun /*
536*4882a593Smuzhiyun  * This is called to actually send a packet to the chip.
537*4882a593Smuzhiyun  */
smc_hardware_send_pkt(struct tasklet_struct * t)538*4882a593Smuzhiyun static void smc_hardware_send_pkt(struct tasklet_struct *t)
539*4882a593Smuzhiyun {
540*4882a593Smuzhiyun 	struct smc_local *lp = from_tasklet(lp, t, tx_task);
541*4882a593Smuzhiyun 	struct net_device *dev = lp->dev;
542*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
543*4882a593Smuzhiyun 	struct sk_buff *skb;
544*4882a593Smuzhiyun 	unsigned int packet_no, len;
545*4882a593Smuzhiyun 	unsigned char *buf;
546*4882a593Smuzhiyun 	unsigned long flags;
547*4882a593Smuzhiyun 
548*4882a593Smuzhiyun 	DBG(3, dev, "%s\n", __func__);
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	if (!smc_special_trylock(&lp->lock, flags)) {
551*4882a593Smuzhiyun 		netif_stop_queue(dev);
552*4882a593Smuzhiyun 		tasklet_schedule(&lp->tx_task);
553*4882a593Smuzhiyun 		return;
554*4882a593Smuzhiyun 	}
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun 	skb = lp->pending_tx_skb;
557*4882a593Smuzhiyun 	if (unlikely(!skb)) {
558*4882a593Smuzhiyun 		smc_special_unlock(&lp->lock, flags);
559*4882a593Smuzhiyun 		return;
560*4882a593Smuzhiyun 	}
561*4882a593Smuzhiyun 	lp->pending_tx_skb = NULL;
562*4882a593Smuzhiyun 
563*4882a593Smuzhiyun 	packet_no = SMC_GET_AR(lp);
564*4882a593Smuzhiyun 	if (unlikely(packet_no & AR_FAILED)) {
565*4882a593Smuzhiyun 		netdev_err(dev, "Memory allocation failed.\n");
566*4882a593Smuzhiyun 		dev->stats.tx_errors++;
567*4882a593Smuzhiyun 		dev->stats.tx_fifo_errors++;
568*4882a593Smuzhiyun 		smc_special_unlock(&lp->lock, flags);
569*4882a593Smuzhiyun 		goto done;
570*4882a593Smuzhiyun 	}
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun 	/* point to the beginning of the packet */
573*4882a593Smuzhiyun 	SMC_SET_PN(lp, packet_no);
574*4882a593Smuzhiyun 	SMC_SET_PTR(lp, PTR_AUTOINC);
575*4882a593Smuzhiyun 
576*4882a593Smuzhiyun 	buf = skb->data;
577*4882a593Smuzhiyun 	len = skb->len;
578*4882a593Smuzhiyun 	DBG(2, dev, "TX PNR 0x%x LENGTH 0x%04x (%d) BUF 0x%p\n",
579*4882a593Smuzhiyun 	    packet_no, len, len, buf);
580*4882a593Smuzhiyun 	PRINT_PKT(buf, len);
581*4882a593Smuzhiyun 
582*4882a593Smuzhiyun 	/*
583*4882a593Smuzhiyun 	 * Send the packet length (+6 for status words, length, and ctl.
584*4882a593Smuzhiyun 	 * The card will pad to 64 bytes with zeroes if packet is too small.
585*4882a593Smuzhiyun 	 */
586*4882a593Smuzhiyun 	SMC_PUT_PKT_HDR(lp, 0, len + 6);
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	/* send the actual data */
589*4882a593Smuzhiyun 	SMC_PUSH_DATA(lp, buf, len & ~1);
590*4882a593Smuzhiyun 
591*4882a593Smuzhiyun 	/* Send final ctl word with the last byte if there is one */
592*4882a593Smuzhiyun 	SMC_outw(lp, ((len & 1) ? (0x2000 | buf[len - 1]) : 0), ioaddr,
593*4882a593Smuzhiyun 		 DATA_REG(lp));
594*4882a593Smuzhiyun 
595*4882a593Smuzhiyun 	/*
596*4882a593Smuzhiyun 	 * If THROTTLE_TX_PKTS is set, we stop the queue here. This will
597*4882a593Smuzhiyun 	 * have the effect of having at most one packet queued for TX
598*4882a593Smuzhiyun 	 * in the chip's memory at all time.
599*4882a593Smuzhiyun 	 *
600*4882a593Smuzhiyun 	 * If THROTTLE_TX_PKTS is not set then the queue is stopped only
601*4882a593Smuzhiyun 	 * when memory allocation (MC_ALLOC) does not succeed right away.
602*4882a593Smuzhiyun 	 */
603*4882a593Smuzhiyun 	if (THROTTLE_TX_PKTS)
604*4882a593Smuzhiyun 		netif_stop_queue(dev);
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	/* queue the packet for TX */
607*4882a593Smuzhiyun 	SMC_SET_MMU_CMD(lp, MC_ENQUEUE);
608*4882a593Smuzhiyun 	smc_special_unlock(&lp->lock, flags);
609*4882a593Smuzhiyun 
610*4882a593Smuzhiyun 	netif_trans_update(dev);
611*4882a593Smuzhiyun 	dev->stats.tx_packets++;
612*4882a593Smuzhiyun 	dev->stats.tx_bytes += len;
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun 	SMC_ENABLE_INT(lp, IM_TX_INT | IM_TX_EMPTY_INT);
615*4882a593Smuzhiyun 
616*4882a593Smuzhiyun done:	if (!THROTTLE_TX_PKTS)
617*4882a593Smuzhiyun 		netif_wake_queue(dev);
618*4882a593Smuzhiyun 
619*4882a593Smuzhiyun 	dev_consume_skb_any(skb);
620*4882a593Smuzhiyun }
621*4882a593Smuzhiyun 
622*4882a593Smuzhiyun /*
623*4882a593Smuzhiyun  * Since I am not sure if I will have enough room in the chip's ram
624*4882a593Smuzhiyun  * to store the packet, I call this routine which either sends it
625*4882a593Smuzhiyun  * now, or set the card to generates an interrupt when ready
626*4882a593Smuzhiyun  * for the packet.
627*4882a593Smuzhiyun  */
628*4882a593Smuzhiyun static netdev_tx_t
smc_hard_start_xmit(struct sk_buff * skb,struct net_device * dev)629*4882a593Smuzhiyun smc_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
630*4882a593Smuzhiyun {
631*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
632*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
633*4882a593Smuzhiyun 	unsigned int numPages, poll_count, status;
634*4882a593Smuzhiyun 	unsigned long flags;
635*4882a593Smuzhiyun 
636*4882a593Smuzhiyun 	DBG(3, dev, "%s\n", __func__);
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun 	BUG_ON(lp->pending_tx_skb != NULL);
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	/*
641*4882a593Smuzhiyun 	 * The MMU wants the number of pages to be the number of 256 bytes
642*4882a593Smuzhiyun 	 * 'pages', minus 1 (since a packet can't ever have 0 pages :))
643*4882a593Smuzhiyun 	 *
644*4882a593Smuzhiyun 	 * The 91C111 ignores the size bits, but earlier models don't.
645*4882a593Smuzhiyun 	 *
646*4882a593Smuzhiyun 	 * Pkt size for allocating is data length +6 (for additional status
647*4882a593Smuzhiyun 	 * words, length and ctl)
648*4882a593Smuzhiyun 	 *
649*4882a593Smuzhiyun 	 * If odd size then last byte is included in ctl word.
650*4882a593Smuzhiyun 	 */
651*4882a593Smuzhiyun 	numPages = ((skb->len & ~1) + (6 - 1)) >> 8;
652*4882a593Smuzhiyun 	if (unlikely(numPages > 7)) {
653*4882a593Smuzhiyun 		netdev_warn(dev, "Far too big packet error.\n");
654*4882a593Smuzhiyun 		dev->stats.tx_errors++;
655*4882a593Smuzhiyun 		dev->stats.tx_dropped++;
656*4882a593Smuzhiyun 		dev_kfree_skb_any(skb);
657*4882a593Smuzhiyun 		return NETDEV_TX_OK;
658*4882a593Smuzhiyun 	}
659*4882a593Smuzhiyun 
660*4882a593Smuzhiyun 	smc_special_lock(&lp->lock, flags);
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun 	/* now, try to allocate the memory */
663*4882a593Smuzhiyun 	SMC_SET_MMU_CMD(lp, MC_ALLOC | numPages);
664*4882a593Smuzhiyun 
665*4882a593Smuzhiyun 	/*
666*4882a593Smuzhiyun 	 * Poll the chip for a short amount of time in case the
667*4882a593Smuzhiyun 	 * allocation succeeds quickly.
668*4882a593Smuzhiyun 	 */
669*4882a593Smuzhiyun 	poll_count = MEMORY_WAIT_TIME;
670*4882a593Smuzhiyun 	do {
671*4882a593Smuzhiyun 		status = SMC_GET_INT(lp);
672*4882a593Smuzhiyun 		if (status & IM_ALLOC_INT) {
673*4882a593Smuzhiyun 			SMC_ACK_INT(lp, IM_ALLOC_INT);
674*4882a593Smuzhiyun   			break;
675*4882a593Smuzhiyun 		}
676*4882a593Smuzhiyun    	} while (--poll_count);
677*4882a593Smuzhiyun 
678*4882a593Smuzhiyun 	smc_special_unlock(&lp->lock, flags);
679*4882a593Smuzhiyun 
680*4882a593Smuzhiyun 	lp->pending_tx_skb = skb;
681*4882a593Smuzhiyun    	if (!poll_count) {
682*4882a593Smuzhiyun 		/* oh well, wait until the chip finds memory later */
683*4882a593Smuzhiyun 		netif_stop_queue(dev);
684*4882a593Smuzhiyun 		DBG(2, dev, "TX memory allocation deferred.\n");
685*4882a593Smuzhiyun 		SMC_ENABLE_INT(lp, IM_ALLOC_INT);
686*4882a593Smuzhiyun    	} else {
687*4882a593Smuzhiyun 		/*
688*4882a593Smuzhiyun 		 * Allocation succeeded: push packet to the chip's own memory
689*4882a593Smuzhiyun 		 * immediately.
690*4882a593Smuzhiyun 		 */
691*4882a593Smuzhiyun 		smc_hardware_send_pkt(&lp->tx_task);
692*4882a593Smuzhiyun 	}
693*4882a593Smuzhiyun 
694*4882a593Smuzhiyun 	return NETDEV_TX_OK;
695*4882a593Smuzhiyun }
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun /*
698*4882a593Smuzhiyun  * This handles a TX interrupt, which is only called when:
699*4882a593Smuzhiyun  * - a TX error occurred, or
700*4882a593Smuzhiyun  * - CTL_AUTO_RELEASE is not set and TX of a packet completed.
701*4882a593Smuzhiyun  */
smc_tx(struct net_device * dev)702*4882a593Smuzhiyun static void smc_tx(struct net_device *dev)
703*4882a593Smuzhiyun {
704*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
705*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
706*4882a593Smuzhiyun 	unsigned int saved_packet, packet_no, tx_status, pkt_len;
707*4882a593Smuzhiyun 
708*4882a593Smuzhiyun 	DBG(3, dev, "%s\n", __func__);
709*4882a593Smuzhiyun 
710*4882a593Smuzhiyun 	/* If the TX FIFO is empty then nothing to do */
711*4882a593Smuzhiyun 	packet_no = SMC_GET_TXFIFO(lp);
712*4882a593Smuzhiyun 	if (unlikely(packet_no & TXFIFO_TEMPTY)) {
713*4882a593Smuzhiyun 		PRINTK(dev, "smc_tx with nothing on FIFO.\n");
714*4882a593Smuzhiyun 		return;
715*4882a593Smuzhiyun 	}
716*4882a593Smuzhiyun 
717*4882a593Smuzhiyun 	/* select packet to read from */
718*4882a593Smuzhiyun 	saved_packet = SMC_GET_PN(lp);
719*4882a593Smuzhiyun 	SMC_SET_PN(lp, packet_no);
720*4882a593Smuzhiyun 
721*4882a593Smuzhiyun 	/* read the first word (status word) from this packet */
722*4882a593Smuzhiyun 	SMC_SET_PTR(lp, PTR_AUTOINC | PTR_READ);
723*4882a593Smuzhiyun 	SMC_GET_PKT_HDR(lp, tx_status, pkt_len);
724*4882a593Smuzhiyun 	DBG(2, dev, "TX STATUS 0x%04x PNR 0x%02x\n",
725*4882a593Smuzhiyun 	    tx_status, packet_no);
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun 	if (!(tx_status & ES_TX_SUC))
728*4882a593Smuzhiyun 		dev->stats.tx_errors++;
729*4882a593Smuzhiyun 
730*4882a593Smuzhiyun 	if (tx_status & ES_LOSTCARR)
731*4882a593Smuzhiyun 		dev->stats.tx_carrier_errors++;
732*4882a593Smuzhiyun 
733*4882a593Smuzhiyun 	if (tx_status & (ES_LATCOL | ES_16COL)) {
734*4882a593Smuzhiyun 		PRINTK(dev, "%s occurred on last xmit\n",
735*4882a593Smuzhiyun 		       (tx_status & ES_LATCOL) ?
736*4882a593Smuzhiyun 			"late collision" : "too many collisions");
737*4882a593Smuzhiyun 		dev->stats.tx_window_errors++;
738*4882a593Smuzhiyun 		if (!(dev->stats.tx_window_errors & 63) && net_ratelimit()) {
739*4882a593Smuzhiyun 			netdev_info(dev, "unexpectedly large number of bad collisions. Please check duplex setting.\n");
740*4882a593Smuzhiyun 		}
741*4882a593Smuzhiyun 	}
742*4882a593Smuzhiyun 
743*4882a593Smuzhiyun 	/* kill the packet */
744*4882a593Smuzhiyun 	SMC_WAIT_MMU_BUSY(lp);
745*4882a593Smuzhiyun 	SMC_SET_MMU_CMD(lp, MC_FREEPKT);
746*4882a593Smuzhiyun 
747*4882a593Smuzhiyun 	/* Don't restore Packet Number Reg until busy bit is cleared */
748*4882a593Smuzhiyun 	SMC_WAIT_MMU_BUSY(lp);
749*4882a593Smuzhiyun 	SMC_SET_PN(lp, saved_packet);
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	/* re-enable transmit */
752*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
753*4882a593Smuzhiyun 	SMC_SET_TCR(lp, lp->tcr_cur_mode);
754*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
755*4882a593Smuzhiyun }
756*4882a593Smuzhiyun 
757*4882a593Smuzhiyun 
758*4882a593Smuzhiyun /*---PHY CONTROL AND CONFIGURATION-----------------------------------------*/
759*4882a593Smuzhiyun 
smc_mii_out(struct net_device * dev,unsigned int val,int bits)760*4882a593Smuzhiyun static void smc_mii_out(struct net_device *dev, unsigned int val, int bits)
761*4882a593Smuzhiyun {
762*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
763*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
764*4882a593Smuzhiyun 	unsigned int mii_reg, mask;
765*4882a593Smuzhiyun 
766*4882a593Smuzhiyun 	mii_reg = SMC_GET_MII(lp) & ~(MII_MCLK | MII_MDOE | MII_MDO);
767*4882a593Smuzhiyun 	mii_reg |= MII_MDOE;
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun 	for (mask = 1 << (bits - 1); mask; mask >>= 1) {
770*4882a593Smuzhiyun 		if (val & mask)
771*4882a593Smuzhiyun 			mii_reg |= MII_MDO;
772*4882a593Smuzhiyun 		else
773*4882a593Smuzhiyun 			mii_reg &= ~MII_MDO;
774*4882a593Smuzhiyun 
775*4882a593Smuzhiyun 		SMC_SET_MII(lp, mii_reg);
776*4882a593Smuzhiyun 		udelay(MII_DELAY);
777*4882a593Smuzhiyun 		SMC_SET_MII(lp, mii_reg | MII_MCLK);
778*4882a593Smuzhiyun 		udelay(MII_DELAY);
779*4882a593Smuzhiyun 	}
780*4882a593Smuzhiyun }
781*4882a593Smuzhiyun 
smc_mii_in(struct net_device * dev,int bits)782*4882a593Smuzhiyun static unsigned int smc_mii_in(struct net_device *dev, int bits)
783*4882a593Smuzhiyun {
784*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
785*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
786*4882a593Smuzhiyun 	unsigned int mii_reg, mask, val;
787*4882a593Smuzhiyun 
788*4882a593Smuzhiyun 	mii_reg = SMC_GET_MII(lp) & ~(MII_MCLK | MII_MDOE | MII_MDO);
789*4882a593Smuzhiyun 	SMC_SET_MII(lp, mii_reg);
790*4882a593Smuzhiyun 
791*4882a593Smuzhiyun 	for (mask = 1 << (bits - 1), val = 0; mask; mask >>= 1) {
792*4882a593Smuzhiyun 		if (SMC_GET_MII(lp) & MII_MDI)
793*4882a593Smuzhiyun 			val |= mask;
794*4882a593Smuzhiyun 
795*4882a593Smuzhiyun 		SMC_SET_MII(lp, mii_reg);
796*4882a593Smuzhiyun 		udelay(MII_DELAY);
797*4882a593Smuzhiyun 		SMC_SET_MII(lp, mii_reg | MII_MCLK);
798*4882a593Smuzhiyun 		udelay(MII_DELAY);
799*4882a593Smuzhiyun 	}
800*4882a593Smuzhiyun 
801*4882a593Smuzhiyun 	return val;
802*4882a593Smuzhiyun }
803*4882a593Smuzhiyun 
804*4882a593Smuzhiyun /*
805*4882a593Smuzhiyun  * Reads a register from the MII Management serial interface
806*4882a593Smuzhiyun  */
smc_phy_read(struct net_device * dev,int phyaddr,int phyreg)807*4882a593Smuzhiyun static int smc_phy_read(struct net_device *dev, int phyaddr, int phyreg)
808*4882a593Smuzhiyun {
809*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
810*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
811*4882a593Smuzhiyun 	unsigned int phydata;
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 3);
814*4882a593Smuzhiyun 
815*4882a593Smuzhiyun 	/* Idle - 32 ones */
816*4882a593Smuzhiyun 	smc_mii_out(dev, 0xffffffff, 32);
817*4882a593Smuzhiyun 
818*4882a593Smuzhiyun 	/* Start code (01) + read (10) + phyaddr + phyreg */
819*4882a593Smuzhiyun 	smc_mii_out(dev, 6 << 10 | phyaddr << 5 | phyreg, 14);
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 	/* Turnaround (2bits) + phydata */
822*4882a593Smuzhiyun 	phydata = smc_mii_in(dev, 18);
823*4882a593Smuzhiyun 
824*4882a593Smuzhiyun 	/* Return to idle state */
825*4882a593Smuzhiyun 	SMC_SET_MII(lp, SMC_GET_MII(lp) & ~(MII_MCLK|MII_MDOE|MII_MDO));
826*4882a593Smuzhiyun 
827*4882a593Smuzhiyun 	DBG(3, dev, "%s: phyaddr=0x%x, phyreg=0x%x, phydata=0x%x\n",
828*4882a593Smuzhiyun 	    __func__, phyaddr, phyreg, phydata);
829*4882a593Smuzhiyun 
830*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
831*4882a593Smuzhiyun 	return phydata;
832*4882a593Smuzhiyun }
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun /*
835*4882a593Smuzhiyun  * Writes a register to the MII Management serial interface
836*4882a593Smuzhiyun  */
smc_phy_write(struct net_device * dev,int phyaddr,int phyreg,int phydata)837*4882a593Smuzhiyun static void smc_phy_write(struct net_device *dev, int phyaddr, int phyreg,
838*4882a593Smuzhiyun 			  int phydata)
839*4882a593Smuzhiyun {
840*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
841*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 3);
844*4882a593Smuzhiyun 
845*4882a593Smuzhiyun 	/* Idle - 32 ones */
846*4882a593Smuzhiyun 	smc_mii_out(dev, 0xffffffff, 32);
847*4882a593Smuzhiyun 
848*4882a593Smuzhiyun 	/* Start code (01) + write (01) + phyaddr + phyreg + turnaround + phydata */
849*4882a593Smuzhiyun 	smc_mii_out(dev, 5 << 28 | phyaddr << 23 | phyreg << 18 | 2 << 16 | phydata, 32);
850*4882a593Smuzhiyun 
851*4882a593Smuzhiyun 	/* Return to idle state */
852*4882a593Smuzhiyun 	SMC_SET_MII(lp, SMC_GET_MII(lp) & ~(MII_MCLK|MII_MDOE|MII_MDO));
853*4882a593Smuzhiyun 
854*4882a593Smuzhiyun 	DBG(3, dev, "%s: phyaddr=0x%x, phyreg=0x%x, phydata=0x%x\n",
855*4882a593Smuzhiyun 	    __func__, phyaddr, phyreg, phydata);
856*4882a593Smuzhiyun 
857*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
858*4882a593Smuzhiyun }
859*4882a593Smuzhiyun 
860*4882a593Smuzhiyun /*
861*4882a593Smuzhiyun  * Finds and reports the PHY address
862*4882a593Smuzhiyun  */
smc_phy_detect(struct net_device * dev)863*4882a593Smuzhiyun static void smc_phy_detect(struct net_device *dev)
864*4882a593Smuzhiyun {
865*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
866*4882a593Smuzhiyun 	int phyaddr;
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
869*4882a593Smuzhiyun 
870*4882a593Smuzhiyun 	lp->phy_type = 0;
871*4882a593Smuzhiyun 
872*4882a593Smuzhiyun 	/*
873*4882a593Smuzhiyun 	 * Scan all 32 PHY addresses if necessary, starting at
874*4882a593Smuzhiyun 	 * PHY#1 to PHY#31, and then PHY#0 last.
875*4882a593Smuzhiyun 	 */
876*4882a593Smuzhiyun 	for (phyaddr = 1; phyaddr < 33; ++phyaddr) {
877*4882a593Smuzhiyun 		unsigned int id1, id2;
878*4882a593Smuzhiyun 
879*4882a593Smuzhiyun 		/* Read the PHY identifiers */
880*4882a593Smuzhiyun 		id1 = smc_phy_read(dev, phyaddr & 31, MII_PHYSID1);
881*4882a593Smuzhiyun 		id2 = smc_phy_read(dev, phyaddr & 31, MII_PHYSID2);
882*4882a593Smuzhiyun 
883*4882a593Smuzhiyun 		DBG(3, dev, "phy_id1=0x%x, phy_id2=0x%x\n",
884*4882a593Smuzhiyun 		    id1, id2);
885*4882a593Smuzhiyun 
886*4882a593Smuzhiyun 		/* Make sure it is a valid identifier */
887*4882a593Smuzhiyun 		if (id1 != 0x0000 && id1 != 0xffff && id1 != 0x8000 &&
888*4882a593Smuzhiyun 		    id2 != 0x0000 && id2 != 0xffff && id2 != 0x8000) {
889*4882a593Smuzhiyun 			/* Save the PHY's address */
890*4882a593Smuzhiyun 			lp->mii.phy_id = phyaddr & 31;
891*4882a593Smuzhiyun 			lp->phy_type = id1 << 16 | id2;
892*4882a593Smuzhiyun 			break;
893*4882a593Smuzhiyun 		}
894*4882a593Smuzhiyun 	}
895*4882a593Smuzhiyun }
896*4882a593Smuzhiyun 
897*4882a593Smuzhiyun /*
898*4882a593Smuzhiyun  * Sets the PHY to a configuration as determined by the user
899*4882a593Smuzhiyun  */
smc_phy_fixed(struct net_device * dev)900*4882a593Smuzhiyun static int smc_phy_fixed(struct net_device *dev)
901*4882a593Smuzhiyun {
902*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
903*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
904*4882a593Smuzhiyun 	int phyaddr = lp->mii.phy_id;
905*4882a593Smuzhiyun 	int bmcr, cfg1;
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	DBG(3, dev, "%s\n", __func__);
908*4882a593Smuzhiyun 
909*4882a593Smuzhiyun 	/* Enter Link Disable state */
910*4882a593Smuzhiyun 	cfg1 = smc_phy_read(dev, phyaddr, PHY_CFG1_REG);
911*4882a593Smuzhiyun 	cfg1 |= PHY_CFG1_LNKDIS;
912*4882a593Smuzhiyun 	smc_phy_write(dev, phyaddr, PHY_CFG1_REG, cfg1);
913*4882a593Smuzhiyun 
914*4882a593Smuzhiyun 	/*
915*4882a593Smuzhiyun 	 * Set our fixed capabilities
916*4882a593Smuzhiyun 	 * Disable auto-negotiation
917*4882a593Smuzhiyun 	 */
918*4882a593Smuzhiyun 	bmcr = 0;
919*4882a593Smuzhiyun 
920*4882a593Smuzhiyun 	if (lp->ctl_rfduplx)
921*4882a593Smuzhiyun 		bmcr |= BMCR_FULLDPLX;
922*4882a593Smuzhiyun 
923*4882a593Smuzhiyun 	if (lp->ctl_rspeed == 100)
924*4882a593Smuzhiyun 		bmcr |= BMCR_SPEED100;
925*4882a593Smuzhiyun 
926*4882a593Smuzhiyun 	/* Write our capabilities to the phy control register */
927*4882a593Smuzhiyun 	smc_phy_write(dev, phyaddr, MII_BMCR, bmcr);
928*4882a593Smuzhiyun 
929*4882a593Smuzhiyun 	/* Re-Configure the Receive/Phy Control register */
930*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
931*4882a593Smuzhiyun 	SMC_SET_RPC(lp, lp->rpc_cur_mode);
932*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
933*4882a593Smuzhiyun 
934*4882a593Smuzhiyun 	return 1;
935*4882a593Smuzhiyun }
936*4882a593Smuzhiyun 
937*4882a593Smuzhiyun /**
938*4882a593Smuzhiyun  * smc_phy_reset - reset the phy
939*4882a593Smuzhiyun  * @dev: net device
940*4882a593Smuzhiyun  * @phy: phy address
941*4882a593Smuzhiyun  *
942*4882a593Smuzhiyun  * Issue a software reset for the specified PHY and
943*4882a593Smuzhiyun  * wait up to 100ms for the reset to complete.  We should
944*4882a593Smuzhiyun  * not access the PHY for 50ms after issuing the reset.
945*4882a593Smuzhiyun  *
946*4882a593Smuzhiyun  * The time to wait appears to be dependent on the PHY.
947*4882a593Smuzhiyun  *
948*4882a593Smuzhiyun  * Must be called with lp->lock locked.
949*4882a593Smuzhiyun  */
smc_phy_reset(struct net_device * dev,int phy)950*4882a593Smuzhiyun static int smc_phy_reset(struct net_device *dev, int phy)
951*4882a593Smuzhiyun {
952*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
953*4882a593Smuzhiyun 	unsigned int bmcr;
954*4882a593Smuzhiyun 	int timeout;
955*4882a593Smuzhiyun 
956*4882a593Smuzhiyun 	smc_phy_write(dev, phy, MII_BMCR, BMCR_RESET);
957*4882a593Smuzhiyun 
958*4882a593Smuzhiyun 	for (timeout = 2; timeout; timeout--) {
959*4882a593Smuzhiyun 		spin_unlock_irq(&lp->lock);
960*4882a593Smuzhiyun 		msleep(50);
961*4882a593Smuzhiyun 		spin_lock_irq(&lp->lock);
962*4882a593Smuzhiyun 
963*4882a593Smuzhiyun 		bmcr = smc_phy_read(dev, phy, MII_BMCR);
964*4882a593Smuzhiyun 		if (!(bmcr & BMCR_RESET))
965*4882a593Smuzhiyun 			break;
966*4882a593Smuzhiyun 	}
967*4882a593Smuzhiyun 
968*4882a593Smuzhiyun 	return bmcr & BMCR_RESET;
969*4882a593Smuzhiyun }
970*4882a593Smuzhiyun 
971*4882a593Smuzhiyun /**
972*4882a593Smuzhiyun  * smc_phy_powerdown - powerdown phy
973*4882a593Smuzhiyun  * @dev: net device
974*4882a593Smuzhiyun  *
975*4882a593Smuzhiyun  * Power down the specified PHY
976*4882a593Smuzhiyun  */
smc_phy_powerdown(struct net_device * dev)977*4882a593Smuzhiyun static void smc_phy_powerdown(struct net_device *dev)
978*4882a593Smuzhiyun {
979*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
980*4882a593Smuzhiyun 	unsigned int bmcr;
981*4882a593Smuzhiyun 	int phy = lp->mii.phy_id;
982*4882a593Smuzhiyun 
983*4882a593Smuzhiyun 	if (lp->phy_type == 0)
984*4882a593Smuzhiyun 		return;
985*4882a593Smuzhiyun 
986*4882a593Smuzhiyun 	/* We need to ensure that no calls to smc_phy_configure are
987*4882a593Smuzhiyun 	   pending.
988*4882a593Smuzhiyun 	*/
989*4882a593Smuzhiyun 	cancel_work_sync(&lp->phy_configure);
990*4882a593Smuzhiyun 
991*4882a593Smuzhiyun 	bmcr = smc_phy_read(dev, phy, MII_BMCR);
992*4882a593Smuzhiyun 	smc_phy_write(dev, phy, MII_BMCR, bmcr | BMCR_PDOWN);
993*4882a593Smuzhiyun }
994*4882a593Smuzhiyun 
995*4882a593Smuzhiyun /**
996*4882a593Smuzhiyun  * smc_phy_check_media - check the media status and adjust TCR
997*4882a593Smuzhiyun  * @dev: net device
998*4882a593Smuzhiyun  * @init: set true for initialisation
999*4882a593Smuzhiyun  *
1000*4882a593Smuzhiyun  * Select duplex mode depending on negotiation state.  This
1001*4882a593Smuzhiyun  * also updates our carrier state.
1002*4882a593Smuzhiyun  */
smc_phy_check_media(struct net_device * dev,int init)1003*4882a593Smuzhiyun static void smc_phy_check_media(struct net_device *dev, int init)
1004*4882a593Smuzhiyun {
1005*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1006*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1007*4882a593Smuzhiyun 
1008*4882a593Smuzhiyun 	if (mii_check_media(&lp->mii, netif_msg_link(lp), init)) {
1009*4882a593Smuzhiyun 		/* duplex state has changed */
1010*4882a593Smuzhiyun 		if (lp->mii.full_duplex) {
1011*4882a593Smuzhiyun 			lp->tcr_cur_mode |= TCR_SWFDUP;
1012*4882a593Smuzhiyun 		} else {
1013*4882a593Smuzhiyun 			lp->tcr_cur_mode &= ~TCR_SWFDUP;
1014*4882a593Smuzhiyun 		}
1015*4882a593Smuzhiyun 
1016*4882a593Smuzhiyun 		SMC_SELECT_BANK(lp, 0);
1017*4882a593Smuzhiyun 		SMC_SET_TCR(lp, lp->tcr_cur_mode);
1018*4882a593Smuzhiyun 	}
1019*4882a593Smuzhiyun }
1020*4882a593Smuzhiyun 
1021*4882a593Smuzhiyun /*
1022*4882a593Smuzhiyun  * Configures the specified PHY through the MII management interface
1023*4882a593Smuzhiyun  * using Autonegotiation.
1024*4882a593Smuzhiyun  * Calls smc_phy_fixed() if the user has requested a certain config.
1025*4882a593Smuzhiyun  * If RPC ANEG bit is set, the media selection is dependent purely on
1026*4882a593Smuzhiyun  * the selection by the MII (either in the MII BMCR reg or the result
1027*4882a593Smuzhiyun  * of autonegotiation.)  If the RPC ANEG bit is cleared, the selection
1028*4882a593Smuzhiyun  * is controlled by the RPC SPEED and RPC DPLX bits.
1029*4882a593Smuzhiyun  */
smc_phy_configure(struct work_struct * work)1030*4882a593Smuzhiyun static void smc_phy_configure(struct work_struct *work)
1031*4882a593Smuzhiyun {
1032*4882a593Smuzhiyun 	struct smc_local *lp =
1033*4882a593Smuzhiyun 		container_of(work, struct smc_local, phy_configure);
1034*4882a593Smuzhiyun 	struct net_device *dev = lp->dev;
1035*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1036*4882a593Smuzhiyun 	int phyaddr = lp->mii.phy_id;
1037*4882a593Smuzhiyun 	int my_phy_caps; /* My PHY capabilities */
1038*4882a593Smuzhiyun 	int my_ad_caps; /* My Advertised capabilities */
1039*4882a593Smuzhiyun 
1040*4882a593Smuzhiyun 	DBG(3, dev, "smc_program_phy()\n");
1041*4882a593Smuzhiyun 
1042*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
1043*4882a593Smuzhiyun 
1044*4882a593Smuzhiyun 	/*
1045*4882a593Smuzhiyun 	 * We should not be called if phy_type is zero.
1046*4882a593Smuzhiyun 	 */
1047*4882a593Smuzhiyun 	if (lp->phy_type == 0)
1048*4882a593Smuzhiyun 		goto smc_phy_configure_exit;
1049*4882a593Smuzhiyun 
1050*4882a593Smuzhiyun 	if (smc_phy_reset(dev, phyaddr)) {
1051*4882a593Smuzhiyun 		netdev_info(dev, "PHY reset timed out\n");
1052*4882a593Smuzhiyun 		goto smc_phy_configure_exit;
1053*4882a593Smuzhiyun 	}
1054*4882a593Smuzhiyun 
1055*4882a593Smuzhiyun 	/*
1056*4882a593Smuzhiyun 	 * Enable PHY Interrupts (for register 18)
1057*4882a593Smuzhiyun 	 * Interrupts listed here are disabled
1058*4882a593Smuzhiyun 	 */
1059*4882a593Smuzhiyun 	smc_phy_write(dev, phyaddr, PHY_MASK_REG,
1060*4882a593Smuzhiyun 		PHY_INT_LOSSSYNC | PHY_INT_CWRD | PHY_INT_SSD |
1061*4882a593Smuzhiyun 		PHY_INT_ESD | PHY_INT_RPOL | PHY_INT_JAB |
1062*4882a593Smuzhiyun 		PHY_INT_SPDDET | PHY_INT_DPLXDET);
1063*4882a593Smuzhiyun 
1064*4882a593Smuzhiyun 	/* Configure the Receive/Phy Control register */
1065*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
1066*4882a593Smuzhiyun 	SMC_SET_RPC(lp, lp->rpc_cur_mode);
1067*4882a593Smuzhiyun 
1068*4882a593Smuzhiyun 	/* If the user requested no auto neg, then go set his request */
1069*4882a593Smuzhiyun 	if (lp->mii.force_media) {
1070*4882a593Smuzhiyun 		smc_phy_fixed(dev);
1071*4882a593Smuzhiyun 		goto smc_phy_configure_exit;
1072*4882a593Smuzhiyun 	}
1073*4882a593Smuzhiyun 
1074*4882a593Smuzhiyun 	/* Copy our capabilities from MII_BMSR to MII_ADVERTISE */
1075*4882a593Smuzhiyun 	my_phy_caps = smc_phy_read(dev, phyaddr, MII_BMSR);
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 	if (!(my_phy_caps & BMSR_ANEGCAPABLE)) {
1078*4882a593Smuzhiyun 		netdev_info(dev, "Auto negotiation NOT supported\n");
1079*4882a593Smuzhiyun 		smc_phy_fixed(dev);
1080*4882a593Smuzhiyun 		goto smc_phy_configure_exit;
1081*4882a593Smuzhiyun 	}
1082*4882a593Smuzhiyun 
1083*4882a593Smuzhiyun 	my_ad_caps = ADVERTISE_CSMA; /* I am CSMA capable */
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	if (my_phy_caps & BMSR_100BASE4)
1086*4882a593Smuzhiyun 		my_ad_caps |= ADVERTISE_100BASE4;
1087*4882a593Smuzhiyun 	if (my_phy_caps & BMSR_100FULL)
1088*4882a593Smuzhiyun 		my_ad_caps |= ADVERTISE_100FULL;
1089*4882a593Smuzhiyun 	if (my_phy_caps & BMSR_100HALF)
1090*4882a593Smuzhiyun 		my_ad_caps |= ADVERTISE_100HALF;
1091*4882a593Smuzhiyun 	if (my_phy_caps & BMSR_10FULL)
1092*4882a593Smuzhiyun 		my_ad_caps |= ADVERTISE_10FULL;
1093*4882a593Smuzhiyun 	if (my_phy_caps & BMSR_10HALF)
1094*4882a593Smuzhiyun 		my_ad_caps |= ADVERTISE_10HALF;
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun 	/* Disable capabilities not selected by our user */
1097*4882a593Smuzhiyun 	if (lp->ctl_rspeed != 100)
1098*4882a593Smuzhiyun 		my_ad_caps &= ~(ADVERTISE_100BASE4|ADVERTISE_100FULL|ADVERTISE_100HALF);
1099*4882a593Smuzhiyun 
1100*4882a593Smuzhiyun 	if (!lp->ctl_rfduplx)
1101*4882a593Smuzhiyun 		my_ad_caps &= ~(ADVERTISE_100FULL|ADVERTISE_10FULL);
1102*4882a593Smuzhiyun 
1103*4882a593Smuzhiyun 	/* Update our Auto-Neg Advertisement Register */
1104*4882a593Smuzhiyun 	smc_phy_write(dev, phyaddr, MII_ADVERTISE, my_ad_caps);
1105*4882a593Smuzhiyun 	lp->mii.advertising = my_ad_caps;
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	/*
1108*4882a593Smuzhiyun 	 * Read the register back.  Without this, it appears that when
1109*4882a593Smuzhiyun 	 * auto-negotiation is restarted, sometimes it isn't ready and
1110*4882a593Smuzhiyun 	 * the link does not come up.
1111*4882a593Smuzhiyun 	 */
1112*4882a593Smuzhiyun 	smc_phy_read(dev, phyaddr, MII_ADVERTISE);
1113*4882a593Smuzhiyun 
1114*4882a593Smuzhiyun 	DBG(2, dev, "phy caps=%x\n", my_phy_caps);
1115*4882a593Smuzhiyun 	DBG(2, dev, "phy advertised caps=%x\n", my_ad_caps);
1116*4882a593Smuzhiyun 
1117*4882a593Smuzhiyun 	/* Restart auto-negotiation process in order to advertise my caps */
1118*4882a593Smuzhiyun 	smc_phy_write(dev, phyaddr, MII_BMCR, BMCR_ANENABLE | BMCR_ANRESTART);
1119*4882a593Smuzhiyun 
1120*4882a593Smuzhiyun 	smc_phy_check_media(dev, 1);
1121*4882a593Smuzhiyun 
1122*4882a593Smuzhiyun smc_phy_configure_exit:
1123*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1124*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
1125*4882a593Smuzhiyun }
1126*4882a593Smuzhiyun 
1127*4882a593Smuzhiyun /*
1128*4882a593Smuzhiyun  * smc_phy_interrupt
1129*4882a593Smuzhiyun  *
1130*4882a593Smuzhiyun  * Purpose:  Handle interrupts relating to PHY register 18. This is
1131*4882a593Smuzhiyun  *  called from the "hard" interrupt handler under our private spinlock.
1132*4882a593Smuzhiyun  */
smc_phy_interrupt(struct net_device * dev)1133*4882a593Smuzhiyun static void smc_phy_interrupt(struct net_device *dev)
1134*4882a593Smuzhiyun {
1135*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1136*4882a593Smuzhiyun 	int phyaddr = lp->mii.phy_id;
1137*4882a593Smuzhiyun 	int phy18;
1138*4882a593Smuzhiyun 
1139*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun 	if (lp->phy_type == 0)
1142*4882a593Smuzhiyun 		return;
1143*4882a593Smuzhiyun 
1144*4882a593Smuzhiyun 	for(;;) {
1145*4882a593Smuzhiyun 		smc_phy_check_media(dev, 0);
1146*4882a593Smuzhiyun 
1147*4882a593Smuzhiyun 		/* Read PHY Register 18, Status Output */
1148*4882a593Smuzhiyun 		phy18 = smc_phy_read(dev, phyaddr, PHY_INT_REG);
1149*4882a593Smuzhiyun 		if ((phy18 & PHY_INT_INT) == 0)
1150*4882a593Smuzhiyun 			break;
1151*4882a593Smuzhiyun 	}
1152*4882a593Smuzhiyun }
1153*4882a593Smuzhiyun 
1154*4882a593Smuzhiyun /*--- END PHY CONTROL AND CONFIGURATION-------------------------------------*/
1155*4882a593Smuzhiyun 
smc_10bt_check_media(struct net_device * dev,int init)1156*4882a593Smuzhiyun static void smc_10bt_check_media(struct net_device *dev, int init)
1157*4882a593Smuzhiyun {
1158*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1159*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1160*4882a593Smuzhiyun 	unsigned int old_carrier, new_carrier;
1161*4882a593Smuzhiyun 
1162*4882a593Smuzhiyun 	old_carrier = netif_carrier_ok(dev) ? 1 : 0;
1163*4882a593Smuzhiyun 
1164*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
1165*4882a593Smuzhiyun 	new_carrier = (SMC_GET_EPH_STATUS(lp) & ES_LINK_OK) ? 1 : 0;
1166*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1167*4882a593Smuzhiyun 
1168*4882a593Smuzhiyun 	if (init || (old_carrier != new_carrier)) {
1169*4882a593Smuzhiyun 		if (!new_carrier) {
1170*4882a593Smuzhiyun 			netif_carrier_off(dev);
1171*4882a593Smuzhiyun 		} else {
1172*4882a593Smuzhiyun 			netif_carrier_on(dev);
1173*4882a593Smuzhiyun 		}
1174*4882a593Smuzhiyun 		if (netif_msg_link(lp))
1175*4882a593Smuzhiyun 			netdev_info(dev, "link %s\n",
1176*4882a593Smuzhiyun 				    new_carrier ? "up" : "down");
1177*4882a593Smuzhiyun 	}
1178*4882a593Smuzhiyun }
1179*4882a593Smuzhiyun 
smc_eph_interrupt(struct net_device * dev)1180*4882a593Smuzhiyun static void smc_eph_interrupt(struct net_device *dev)
1181*4882a593Smuzhiyun {
1182*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1183*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1184*4882a593Smuzhiyun 	unsigned int ctl;
1185*4882a593Smuzhiyun 
1186*4882a593Smuzhiyun 	smc_10bt_check_media(dev, 0);
1187*4882a593Smuzhiyun 
1188*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
1189*4882a593Smuzhiyun 	ctl = SMC_GET_CTL(lp);
1190*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl & ~CTL_LE_ENABLE);
1191*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl);
1192*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1193*4882a593Smuzhiyun }
1194*4882a593Smuzhiyun 
1195*4882a593Smuzhiyun /*
1196*4882a593Smuzhiyun  * This is the main routine of the driver, to handle the device when
1197*4882a593Smuzhiyun  * it needs some attention.
1198*4882a593Smuzhiyun  */
smc_interrupt(int irq,void * dev_id)1199*4882a593Smuzhiyun static irqreturn_t smc_interrupt(int irq, void *dev_id)
1200*4882a593Smuzhiyun {
1201*4882a593Smuzhiyun 	struct net_device *dev = dev_id;
1202*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1203*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1204*4882a593Smuzhiyun 	int status, mask, timeout, card_stats;
1205*4882a593Smuzhiyun 	int saved_pointer;
1206*4882a593Smuzhiyun 
1207*4882a593Smuzhiyun 	DBG(3, dev, "%s\n", __func__);
1208*4882a593Smuzhiyun 
1209*4882a593Smuzhiyun 	spin_lock(&lp->lock);
1210*4882a593Smuzhiyun 
1211*4882a593Smuzhiyun 	/* A preamble may be used when there is a potential race
1212*4882a593Smuzhiyun 	 * between the interruptible transmit functions and this
1213*4882a593Smuzhiyun 	 * ISR. */
1214*4882a593Smuzhiyun 	SMC_INTERRUPT_PREAMBLE;
1215*4882a593Smuzhiyun 
1216*4882a593Smuzhiyun 	saved_pointer = SMC_GET_PTR(lp);
1217*4882a593Smuzhiyun 	mask = SMC_GET_INT_MASK(lp);
1218*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, 0);
1219*4882a593Smuzhiyun 
1220*4882a593Smuzhiyun 	/* set a timeout value, so I don't stay here forever */
1221*4882a593Smuzhiyun 	timeout = MAX_IRQ_LOOPS;
1222*4882a593Smuzhiyun 
1223*4882a593Smuzhiyun 	do {
1224*4882a593Smuzhiyun 		status = SMC_GET_INT(lp);
1225*4882a593Smuzhiyun 
1226*4882a593Smuzhiyun 		DBG(2, dev, "INT 0x%02x MASK 0x%02x MEM 0x%04x FIFO 0x%04x\n",
1227*4882a593Smuzhiyun 		    status, mask,
1228*4882a593Smuzhiyun 		    ({ int meminfo; SMC_SELECT_BANK(lp, 0);
1229*4882a593Smuzhiyun 		       meminfo = SMC_GET_MIR(lp);
1230*4882a593Smuzhiyun 		       SMC_SELECT_BANK(lp, 2); meminfo; }),
1231*4882a593Smuzhiyun 		    SMC_GET_FIFO(lp));
1232*4882a593Smuzhiyun 
1233*4882a593Smuzhiyun 		status &= mask;
1234*4882a593Smuzhiyun 		if (!status)
1235*4882a593Smuzhiyun 			break;
1236*4882a593Smuzhiyun 
1237*4882a593Smuzhiyun 		if (status & IM_TX_INT) {
1238*4882a593Smuzhiyun 			/* do this before RX as it will free memory quickly */
1239*4882a593Smuzhiyun 			DBG(3, dev, "TX int\n");
1240*4882a593Smuzhiyun 			smc_tx(dev);
1241*4882a593Smuzhiyun 			SMC_ACK_INT(lp, IM_TX_INT);
1242*4882a593Smuzhiyun 			if (THROTTLE_TX_PKTS)
1243*4882a593Smuzhiyun 				netif_wake_queue(dev);
1244*4882a593Smuzhiyun 		} else if (status & IM_RCV_INT) {
1245*4882a593Smuzhiyun 			DBG(3, dev, "RX irq\n");
1246*4882a593Smuzhiyun 			smc_rcv(dev);
1247*4882a593Smuzhiyun 		} else if (status & IM_ALLOC_INT) {
1248*4882a593Smuzhiyun 			DBG(3, dev, "Allocation irq\n");
1249*4882a593Smuzhiyun 			tasklet_hi_schedule(&lp->tx_task);
1250*4882a593Smuzhiyun 			mask &= ~IM_ALLOC_INT;
1251*4882a593Smuzhiyun 		} else if (status & IM_TX_EMPTY_INT) {
1252*4882a593Smuzhiyun 			DBG(3, dev, "TX empty\n");
1253*4882a593Smuzhiyun 			mask &= ~IM_TX_EMPTY_INT;
1254*4882a593Smuzhiyun 
1255*4882a593Smuzhiyun 			/* update stats */
1256*4882a593Smuzhiyun 			SMC_SELECT_BANK(lp, 0);
1257*4882a593Smuzhiyun 			card_stats = SMC_GET_COUNTER(lp);
1258*4882a593Smuzhiyun 			SMC_SELECT_BANK(lp, 2);
1259*4882a593Smuzhiyun 
1260*4882a593Smuzhiyun 			/* single collisions */
1261*4882a593Smuzhiyun 			dev->stats.collisions += card_stats & 0xF;
1262*4882a593Smuzhiyun 			card_stats >>= 4;
1263*4882a593Smuzhiyun 
1264*4882a593Smuzhiyun 			/* multiple collisions */
1265*4882a593Smuzhiyun 			dev->stats.collisions += card_stats & 0xF;
1266*4882a593Smuzhiyun 		} else if (status & IM_RX_OVRN_INT) {
1267*4882a593Smuzhiyun 			DBG(1, dev, "RX overrun (EPH_ST 0x%04x)\n",
1268*4882a593Smuzhiyun 			    ({ int eph_st; SMC_SELECT_BANK(lp, 0);
1269*4882a593Smuzhiyun 			       eph_st = SMC_GET_EPH_STATUS(lp);
1270*4882a593Smuzhiyun 			       SMC_SELECT_BANK(lp, 2); eph_st; }));
1271*4882a593Smuzhiyun 			SMC_ACK_INT(lp, IM_RX_OVRN_INT);
1272*4882a593Smuzhiyun 			dev->stats.rx_errors++;
1273*4882a593Smuzhiyun 			dev->stats.rx_fifo_errors++;
1274*4882a593Smuzhiyun 		} else if (status & IM_EPH_INT) {
1275*4882a593Smuzhiyun 			smc_eph_interrupt(dev);
1276*4882a593Smuzhiyun 		} else if (status & IM_MDINT) {
1277*4882a593Smuzhiyun 			SMC_ACK_INT(lp, IM_MDINT);
1278*4882a593Smuzhiyun 			smc_phy_interrupt(dev);
1279*4882a593Smuzhiyun 		} else if (status & IM_ERCV_INT) {
1280*4882a593Smuzhiyun 			SMC_ACK_INT(lp, IM_ERCV_INT);
1281*4882a593Smuzhiyun 			PRINTK(dev, "UNSUPPORTED: ERCV INTERRUPT\n");
1282*4882a593Smuzhiyun 		}
1283*4882a593Smuzhiyun 	} while (--timeout);
1284*4882a593Smuzhiyun 
1285*4882a593Smuzhiyun 	/* restore register states */
1286*4882a593Smuzhiyun 	SMC_SET_PTR(lp, saved_pointer);
1287*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, mask);
1288*4882a593Smuzhiyun 	spin_unlock(&lp->lock);
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun #ifndef CONFIG_NET_POLL_CONTROLLER
1291*4882a593Smuzhiyun 	if (timeout == MAX_IRQ_LOOPS)
1292*4882a593Smuzhiyun 		PRINTK(dev, "spurious interrupt (mask = 0x%02x)\n",
1293*4882a593Smuzhiyun 		       mask);
1294*4882a593Smuzhiyun #endif
1295*4882a593Smuzhiyun 	DBG(3, dev, "Interrupt done (%d loops)\n",
1296*4882a593Smuzhiyun 	    MAX_IRQ_LOOPS - timeout);
1297*4882a593Smuzhiyun 
1298*4882a593Smuzhiyun 	/*
1299*4882a593Smuzhiyun 	 * We return IRQ_HANDLED unconditionally here even if there was
1300*4882a593Smuzhiyun 	 * nothing to do.  There is a possibility that a packet might
1301*4882a593Smuzhiyun 	 * get enqueued into the chip right after TX_EMPTY_INT is raised
1302*4882a593Smuzhiyun 	 * but just before the CPU acknowledges the IRQ.
1303*4882a593Smuzhiyun 	 * Better take an unneeded IRQ in some occasions than complexifying
1304*4882a593Smuzhiyun 	 * the code for all cases.
1305*4882a593Smuzhiyun 	 */
1306*4882a593Smuzhiyun 	return IRQ_HANDLED;
1307*4882a593Smuzhiyun }
1308*4882a593Smuzhiyun 
1309*4882a593Smuzhiyun #ifdef CONFIG_NET_POLL_CONTROLLER
1310*4882a593Smuzhiyun /*
1311*4882a593Smuzhiyun  * Polling receive - used by netconsole and other diagnostic tools
1312*4882a593Smuzhiyun  * to allow network i/o with interrupts disabled.
1313*4882a593Smuzhiyun  */
smc_poll_controller(struct net_device * dev)1314*4882a593Smuzhiyun static void smc_poll_controller(struct net_device *dev)
1315*4882a593Smuzhiyun {
1316*4882a593Smuzhiyun 	disable_irq(dev->irq);
1317*4882a593Smuzhiyun 	smc_interrupt(dev->irq, dev);
1318*4882a593Smuzhiyun 	enable_irq(dev->irq);
1319*4882a593Smuzhiyun }
1320*4882a593Smuzhiyun #endif
1321*4882a593Smuzhiyun 
1322*4882a593Smuzhiyun /* Our watchdog timed out. Called by the networking layer */
smc_timeout(struct net_device * dev,unsigned int txqueue)1323*4882a593Smuzhiyun static void smc_timeout(struct net_device *dev, unsigned int txqueue)
1324*4882a593Smuzhiyun {
1325*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1326*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1327*4882a593Smuzhiyun 	int status, mask, eph_st, meminfo, fifo;
1328*4882a593Smuzhiyun 
1329*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
1330*4882a593Smuzhiyun 
1331*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
1332*4882a593Smuzhiyun 	status = SMC_GET_INT(lp);
1333*4882a593Smuzhiyun 	mask = SMC_GET_INT_MASK(lp);
1334*4882a593Smuzhiyun 	fifo = SMC_GET_FIFO(lp);
1335*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
1336*4882a593Smuzhiyun 	eph_st = SMC_GET_EPH_STATUS(lp);
1337*4882a593Smuzhiyun 	meminfo = SMC_GET_MIR(lp);
1338*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1339*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
1340*4882a593Smuzhiyun 	PRINTK(dev, "TX timeout (INT 0x%02x INTMASK 0x%02x MEM 0x%04x FIFO 0x%04x EPH_ST 0x%04x)\n",
1341*4882a593Smuzhiyun 	       status, mask, meminfo, fifo, eph_st);
1342*4882a593Smuzhiyun 
1343*4882a593Smuzhiyun 	smc_reset(dev);
1344*4882a593Smuzhiyun 	smc_enable(dev);
1345*4882a593Smuzhiyun 
1346*4882a593Smuzhiyun 	/*
1347*4882a593Smuzhiyun 	 * Reconfiguring the PHY doesn't seem like a bad idea here, but
1348*4882a593Smuzhiyun 	 * smc_phy_configure() calls msleep() which calls schedule_timeout()
1349*4882a593Smuzhiyun 	 * which calls schedule().  Hence we use a work queue.
1350*4882a593Smuzhiyun 	 */
1351*4882a593Smuzhiyun 	if (lp->phy_type != 0)
1352*4882a593Smuzhiyun 		schedule_work(&lp->phy_configure);
1353*4882a593Smuzhiyun 
1354*4882a593Smuzhiyun 	/* We can accept TX packets again */
1355*4882a593Smuzhiyun 	netif_trans_update(dev); /* prevent tx timeout */
1356*4882a593Smuzhiyun 	netif_wake_queue(dev);
1357*4882a593Smuzhiyun }
1358*4882a593Smuzhiyun 
1359*4882a593Smuzhiyun /*
1360*4882a593Smuzhiyun  * This routine will, depending on the values passed to it,
1361*4882a593Smuzhiyun  * either make it accept multicast packets, go into
1362*4882a593Smuzhiyun  * promiscuous mode (for TCPDUMP and cousins) or accept
1363*4882a593Smuzhiyun  * a select set of multicast packets
1364*4882a593Smuzhiyun  */
smc_set_multicast_list(struct net_device * dev)1365*4882a593Smuzhiyun static void smc_set_multicast_list(struct net_device *dev)
1366*4882a593Smuzhiyun {
1367*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1368*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1369*4882a593Smuzhiyun 	unsigned char multicast_table[8];
1370*4882a593Smuzhiyun 	int update_multicast = 0;
1371*4882a593Smuzhiyun 
1372*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
1373*4882a593Smuzhiyun 
1374*4882a593Smuzhiyun 	if (dev->flags & IFF_PROMISC) {
1375*4882a593Smuzhiyun 		DBG(2, dev, "RCR_PRMS\n");
1376*4882a593Smuzhiyun 		lp->rcr_cur_mode |= RCR_PRMS;
1377*4882a593Smuzhiyun 	}
1378*4882a593Smuzhiyun 
1379*4882a593Smuzhiyun /* BUG?  I never disable promiscuous mode if multicasting was turned on.
1380*4882a593Smuzhiyun    Now, I turn off promiscuous mode, but I don't do anything to multicasting
1381*4882a593Smuzhiyun    when promiscuous mode is turned on.
1382*4882a593Smuzhiyun */
1383*4882a593Smuzhiyun 
1384*4882a593Smuzhiyun 	/*
1385*4882a593Smuzhiyun 	 * Here, I am setting this to accept all multicast packets.
1386*4882a593Smuzhiyun 	 * I don't need to zero the multicast table, because the flag is
1387*4882a593Smuzhiyun 	 * checked before the table is
1388*4882a593Smuzhiyun 	 */
1389*4882a593Smuzhiyun 	else if (dev->flags & IFF_ALLMULTI || netdev_mc_count(dev) > 16) {
1390*4882a593Smuzhiyun 		DBG(2, dev, "RCR_ALMUL\n");
1391*4882a593Smuzhiyun 		lp->rcr_cur_mode |= RCR_ALMUL;
1392*4882a593Smuzhiyun 	}
1393*4882a593Smuzhiyun 
1394*4882a593Smuzhiyun 	/*
1395*4882a593Smuzhiyun 	 * This sets the internal hardware table to filter out unwanted
1396*4882a593Smuzhiyun 	 * multicast packets before they take up memory.
1397*4882a593Smuzhiyun 	 *
1398*4882a593Smuzhiyun 	 * The SMC chip uses a hash table where the high 6 bits of the CRC of
1399*4882a593Smuzhiyun 	 * address are the offset into the table.  If that bit is 1, then the
1400*4882a593Smuzhiyun 	 * multicast packet is accepted.  Otherwise, it's dropped silently.
1401*4882a593Smuzhiyun 	 *
1402*4882a593Smuzhiyun 	 * To use the 6 bits as an offset into the table, the high 3 bits are
1403*4882a593Smuzhiyun 	 * the number of the 8 bit register, while the low 3 bits are the bit
1404*4882a593Smuzhiyun 	 * within that register.
1405*4882a593Smuzhiyun 	 */
1406*4882a593Smuzhiyun 	else if (!netdev_mc_empty(dev)) {
1407*4882a593Smuzhiyun 		struct netdev_hw_addr *ha;
1408*4882a593Smuzhiyun 
1409*4882a593Smuzhiyun 		/* table for flipping the order of 3 bits */
1410*4882a593Smuzhiyun 		static const unsigned char invert3[] = {0, 4, 2, 6, 1, 5, 3, 7};
1411*4882a593Smuzhiyun 
1412*4882a593Smuzhiyun 		/* start with a table of all zeros: reject all */
1413*4882a593Smuzhiyun 		memset(multicast_table, 0, sizeof(multicast_table));
1414*4882a593Smuzhiyun 
1415*4882a593Smuzhiyun 		netdev_for_each_mc_addr(ha, dev) {
1416*4882a593Smuzhiyun 			int position;
1417*4882a593Smuzhiyun 
1418*4882a593Smuzhiyun 			/* only use the low order bits */
1419*4882a593Smuzhiyun 			position = crc32_le(~0, ha->addr, 6) & 0x3f;
1420*4882a593Smuzhiyun 
1421*4882a593Smuzhiyun 			/* do some messy swapping to put the bit in the right spot */
1422*4882a593Smuzhiyun 			multicast_table[invert3[position&7]] |=
1423*4882a593Smuzhiyun 				(1<<invert3[(position>>3)&7]);
1424*4882a593Smuzhiyun 		}
1425*4882a593Smuzhiyun 
1426*4882a593Smuzhiyun 		/* be sure I get rid of flags I might have set */
1427*4882a593Smuzhiyun 		lp->rcr_cur_mode &= ~(RCR_PRMS | RCR_ALMUL);
1428*4882a593Smuzhiyun 
1429*4882a593Smuzhiyun 		/* now, the table can be loaded into the chipset */
1430*4882a593Smuzhiyun 		update_multicast = 1;
1431*4882a593Smuzhiyun 	} else  {
1432*4882a593Smuzhiyun 		DBG(2, dev, "~(RCR_PRMS|RCR_ALMUL)\n");
1433*4882a593Smuzhiyun 		lp->rcr_cur_mode &= ~(RCR_PRMS | RCR_ALMUL);
1434*4882a593Smuzhiyun 
1435*4882a593Smuzhiyun 		/*
1436*4882a593Smuzhiyun 		 * since I'm disabling all multicast entirely, I need to
1437*4882a593Smuzhiyun 		 * clear the multicast list
1438*4882a593Smuzhiyun 		 */
1439*4882a593Smuzhiyun 		memset(multicast_table, 0, sizeof(multicast_table));
1440*4882a593Smuzhiyun 		update_multicast = 1;
1441*4882a593Smuzhiyun 	}
1442*4882a593Smuzhiyun 
1443*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
1444*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
1445*4882a593Smuzhiyun 	SMC_SET_RCR(lp, lp->rcr_cur_mode);
1446*4882a593Smuzhiyun 	if (update_multicast) {
1447*4882a593Smuzhiyun 		SMC_SELECT_BANK(lp, 3);
1448*4882a593Smuzhiyun 		SMC_SET_MCAST(lp, multicast_table);
1449*4882a593Smuzhiyun 	}
1450*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1451*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
1452*4882a593Smuzhiyun }
1453*4882a593Smuzhiyun 
1454*4882a593Smuzhiyun 
1455*4882a593Smuzhiyun /*
1456*4882a593Smuzhiyun  * Open and Initialize the board
1457*4882a593Smuzhiyun  *
1458*4882a593Smuzhiyun  * Set up everything, reset the card, etc..
1459*4882a593Smuzhiyun  */
1460*4882a593Smuzhiyun static int
smc_open(struct net_device * dev)1461*4882a593Smuzhiyun smc_open(struct net_device *dev)
1462*4882a593Smuzhiyun {
1463*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1464*4882a593Smuzhiyun 
1465*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
1466*4882a593Smuzhiyun 
1467*4882a593Smuzhiyun 	/* Setup the default Register Modes */
1468*4882a593Smuzhiyun 	lp->tcr_cur_mode = TCR_DEFAULT;
1469*4882a593Smuzhiyun 	lp->rcr_cur_mode = RCR_DEFAULT;
1470*4882a593Smuzhiyun 	lp->rpc_cur_mode = RPC_DEFAULT |
1471*4882a593Smuzhiyun 				lp->cfg.leda << RPC_LSXA_SHFT |
1472*4882a593Smuzhiyun 				lp->cfg.ledb << RPC_LSXB_SHFT;
1473*4882a593Smuzhiyun 
1474*4882a593Smuzhiyun 	/*
1475*4882a593Smuzhiyun 	 * If we are not using a MII interface, we need to
1476*4882a593Smuzhiyun 	 * monitor our own carrier signal to detect faults.
1477*4882a593Smuzhiyun 	 */
1478*4882a593Smuzhiyun 	if (lp->phy_type == 0)
1479*4882a593Smuzhiyun 		lp->tcr_cur_mode |= TCR_MON_CSN;
1480*4882a593Smuzhiyun 
1481*4882a593Smuzhiyun 	/* reset the hardware */
1482*4882a593Smuzhiyun 	smc_reset(dev);
1483*4882a593Smuzhiyun 	smc_enable(dev);
1484*4882a593Smuzhiyun 
1485*4882a593Smuzhiyun 	/* Configure the PHY, initialize the link state */
1486*4882a593Smuzhiyun 	if (lp->phy_type != 0)
1487*4882a593Smuzhiyun 		smc_phy_configure(&lp->phy_configure);
1488*4882a593Smuzhiyun 	else {
1489*4882a593Smuzhiyun 		spin_lock_irq(&lp->lock);
1490*4882a593Smuzhiyun 		smc_10bt_check_media(dev, 1);
1491*4882a593Smuzhiyun 		spin_unlock_irq(&lp->lock);
1492*4882a593Smuzhiyun 	}
1493*4882a593Smuzhiyun 
1494*4882a593Smuzhiyun 	netif_start_queue(dev);
1495*4882a593Smuzhiyun 	return 0;
1496*4882a593Smuzhiyun }
1497*4882a593Smuzhiyun 
1498*4882a593Smuzhiyun /*
1499*4882a593Smuzhiyun  * smc_close
1500*4882a593Smuzhiyun  *
1501*4882a593Smuzhiyun  * this makes the board clean up everything that it can
1502*4882a593Smuzhiyun  * and not talk to the outside world.   Caused by
1503*4882a593Smuzhiyun  * an 'ifconfig ethX down'
1504*4882a593Smuzhiyun  */
smc_close(struct net_device * dev)1505*4882a593Smuzhiyun static int smc_close(struct net_device *dev)
1506*4882a593Smuzhiyun {
1507*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1508*4882a593Smuzhiyun 
1509*4882a593Smuzhiyun 	DBG(2, dev, "%s\n", __func__);
1510*4882a593Smuzhiyun 
1511*4882a593Smuzhiyun 	netif_stop_queue(dev);
1512*4882a593Smuzhiyun 	netif_carrier_off(dev);
1513*4882a593Smuzhiyun 
1514*4882a593Smuzhiyun 	/* clear everything */
1515*4882a593Smuzhiyun 	smc_shutdown(dev);
1516*4882a593Smuzhiyun 	tasklet_kill(&lp->tx_task);
1517*4882a593Smuzhiyun 	smc_phy_powerdown(dev);
1518*4882a593Smuzhiyun 	return 0;
1519*4882a593Smuzhiyun }
1520*4882a593Smuzhiyun 
1521*4882a593Smuzhiyun /*
1522*4882a593Smuzhiyun  * Ethtool support
1523*4882a593Smuzhiyun  */
1524*4882a593Smuzhiyun static int
smc_ethtool_get_link_ksettings(struct net_device * dev,struct ethtool_link_ksettings * cmd)1525*4882a593Smuzhiyun smc_ethtool_get_link_ksettings(struct net_device *dev,
1526*4882a593Smuzhiyun 			       struct ethtool_link_ksettings *cmd)
1527*4882a593Smuzhiyun {
1528*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1529*4882a593Smuzhiyun 
1530*4882a593Smuzhiyun 	if (lp->phy_type != 0) {
1531*4882a593Smuzhiyun 		spin_lock_irq(&lp->lock);
1532*4882a593Smuzhiyun 		mii_ethtool_get_link_ksettings(&lp->mii, cmd);
1533*4882a593Smuzhiyun 		spin_unlock_irq(&lp->lock);
1534*4882a593Smuzhiyun 	} else {
1535*4882a593Smuzhiyun 		u32 supported = SUPPORTED_10baseT_Half |
1536*4882a593Smuzhiyun 				 SUPPORTED_10baseT_Full |
1537*4882a593Smuzhiyun 				 SUPPORTED_TP | SUPPORTED_AUI;
1538*4882a593Smuzhiyun 
1539*4882a593Smuzhiyun 		if (lp->ctl_rspeed == 10)
1540*4882a593Smuzhiyun 			cmd->base.speed = SPEED_10;
1541*4882a593Smuzhiyun 		else if (lp->ctl_rspeed == 100)
1542*4882a593Smuzhiyun 			cmd->base.speed = SPEED_100;
1543*4882a593Smuzhiyun 
1544*4882a593Smuzhiyun 		cmd->base.autoneg = AUTONEG_DISABLE;
1545*4882a593Smuzhiyun 		cmd->base.port = 0;
1546*4882a593Smuzhiyun 		cmd->base.duplex = lp->tcr_cur_mode & TCR_SWFDUP ?
1547*4882a593Smuzhiyun 			DUPLEX_FULL : DUPLEX_HALF;
1548*4882a593Smuzhiyun 
1549*4882a593Smuzhiyun 		ethtool_convert_legacy_u32_to_link_mode(
1550*4882a593Smuzhiyun 			cmd->link_modes.supported, supported);
1551*4882a593Smuzhiyun 	}
1552*4882a593Smuzhiyun 
1553*4882a593Smuzhiyun 	return 0;
1554*4882a593Smuzhiyun }
1555*4882a593Smuzhiyun 
1556*4882a593Smuzhiyun static int
smc_ethtool_set_link_ksettings(struct net_device * dev,const struct ethtool_link_ksettings * cmd)1557*4882a593Smuzhiyun smc_ethtool_set_link_ksettings(struct net_device *dev,
1558*4882a593Smuzhiyun 			       const struct ethtool_link_ksettings *cmd)
1559*4882a593Smuzhiyun {
1560*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1561*4882a593Smuzhiyun 	int ret;
1562*4882a593Smuzhiyun 
1563*4882a593Smuzhiyun 	if (lp->phy_type != 0) {
1564*4882a593Smuzhiyun 		spin_lock_irq(&lp->lock);
1565*4882a593Smuzhiyun 		ret = mii_ethtool_set_link_ksettings(&lp->mii, cmd);
1566*4882a593Smuzhiyun 		spin_unlock_irq(&lp->lock);
1567*4882a593Smuzhiyun 	} else {
1568*4882a593Smuzhiyun 		if (cmd->base.autoneg != AUTONEG_DISABLE ||
1569*4882a593Smuzhiyun 		    cmd->base.speed != SPEED_10 ||
1570*4882a593Smuzhiyun 		    (cmd->base.duplex != DUPLEX_HALF &&
1571*4882a593Smuzhiyun 		     cmd->base.duplex != DUPLEX_FULL) ||
1572*4882a593Smuzhiyun 		    (cmd->base.port != PORT_TP && cmd->base.port != PORT_AUI))
1573*4882a593Smuzhiyun 			return -EINVAL;
1574*4882a593Smuzhiyun 
1575*4882a593Smuzhiyun //		lp->port = cmd->base.port;
1576*4882a593Smuzhiyun 		lp->ctl_rfduplx = cmd->base.duplex == DUPLEX_FULL;
1577*4882a593Smuzhiyun 
1578*4882a593Smuzhiyun //		if (netif_running(dev))
1579*4882a593Smuzhiyun //			smc_set_port(dev);
1580*4882a593Smuzhiyun 
1581*4882a593Smuzhiyun 		ret = 0;
1582*4882a593Smuzhiyun 	}
1583*4882a593Smuzhiyun 
1584*4882a593Smuzhiyun 	return ret;
1585*4882a593Smuzhiyun }
1586*4882a593Smuzhiyun 
1587*4882a593Smuzhiyun static void
smc_ethtool_getdrvinfo(struct net_device * dev,struct ethtool_drvinfo * info)1588*4882a593Smuzhiyun smc_ethtool_getdrvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1589*4882a593Smuzhiyun {
1590*4882a593Smuzhiyun 	strlcpy(info->driver, CARDNAME, sizeof(info->driver));
1591*4882a593Smuzhiyun 	strlcpy(info->version, version, sizeof(info->version));
1592*4882a593Smuzhiyun 	strlcpy(info->bus_info, dev_name(dev->dev.parent),
1593*4882a593Smuzhiyun 		sizeof(info->bus_info));
1594*4882a593Smuzhiyun }
1595*4882a593Smuzhiyun 
smc_ethtool_nwayreset(struct net_device * dev)1596*4882a593Smuzhiyun static int smc_ethtool_nwayreset(struct net_device *dev)
1597*4882a593Smuzhiyun {
1598*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1599*4882a593Smuzhiyun 	int ret = -EINVAL;
1600*4882a593Smuzhiyun 
1601*4882a593Smuzhiyun 	if (lp->phy_type != 0) {
1602*4882a593Smuzhiyun 		spin_lock_irq(&lp->lock);
1603*4882a593Smuzhiyun 		ret = mii_nway_restart(&lp->mii);
1604*4882a593Smuzhiyun 		spin_unlock_irq(&lp->lock);
1605*4882a593Smuzhiyun 	}
1606*4882a593Smuzhiyun 
1607*4882a593Smuzhiyun 	return ret;
1608*4882a593Smuzhiyun }
1609*4882a593Smuzhiyun 
smc_ethtool_getmsglevel(struct net_device * dev)1610*4882a593Smuzhiyun static u32 smc_ethtool_getmsglevel(struct net_device *dev)
1611*4882a593Smuzhiyun {
1612*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1613*4882a593Smuzhiyun 	return lp->msg_enable;
1614*4882a593Smuzhiyun }
1615*4882a593Smuzhiyun 
smc_ethtool_setmsglevel(struct net_device * dev,u32 level)1616*4882a593Smuzhiyun static void smc_ethtool_setmsglevel(struct net_device *dev, u32 level)
1617*4882a593Smuzhiyun {
1618*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1619*4882a593Smuzhiyun 	lp->msg_enable = level;
1620*4882a593Smuzhiyun }
1621*4882a593Smuzhiyun 
smc_write_eeprom_word(struct net_device * dev,u16 addr,u16 word)1622*4882a593Smuzhiyun static int smc_write_eeprom_word(struct net_device *dev, u16 addr, u16 word)
1623*4882a593Smuzhiyun {
1624*4882a593Smuzhiyun 	u16 ctl;
1625*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1626*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1627*4882a593Smuzhiyun 
1628*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
1629*4882a593Smuzhiyun 	/* load word into GP register */
1630*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
1631*4882a593Smuzhiyun 	SMC_SET_GP(lp, word);
1632*4882a593Smuzhiyun 	/* set the address to put the data in EEPROM */
1633*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1634*4882a593Smuzhiyun 	SMC_SET_PTR(lp, addr);
1635*4882a593Smuzhiyun 	/* tell it to write */
1636*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
1637*4882a593Smuzhiyun 	ctl = SMC_GET_CTL(lp);
1638*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl | (CTL_EEPROM_SELECT | CTL_STORE));
1639*4882a593Smuzhiyun 	/* wait for it to finish */
1640*4882a593Smuzhiyun 	do {
1641*4882a593Smuzhiyun 		udelay(1);
1642*4882a593Smuzhiyun 	} while (SMC_GET_CTL(lp) & CTL_STORE);
1643*4882a593Smuzhiyun 	/* clean up */
1644*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl);
1645*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1646*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
1647*4882a593Smuzhiyun 	return 0;
1648*4882a593Smuzhiyun }
1649*4882a593Smuzhiyun 
smc_read_eeprom_word(struct net_device * dev,u16 addr,u16 * word)1650*4882a593Smuzhiyun static int smc_read_eeprom_word(struct net_device *dev, u16 addr, u16 *word)
1651*4882a593Smuzhiyun {
1652*4882a593Smuzhiyun 	u16 ctl;
1653*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1654*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1655*4882a593Smuzhiyun 
1656*4882a593Smuzhiyun 	spin_lock_irq(&lp->lock);
1657*4882a593Smuzhiyun 	/* set the EEPROM address to get the data from */
1658*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1659*4882a593Smuzhiyun 	SMC_SET_PTR(lp, addr | PTR_READ);
1660*4882a593Smuzhiyun 	/* tell it to load */
1661*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
1662*4882a593Smuzhiyun 	SMC_SET_GP(lp, 0xffff);	/* init to known */
1663*4882a593Smuzhiyun 	ctl = SMC_GET_CTL(lp);
1664*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl | (CTL_EEPROM_SELECT | CTL_RELOAD));
1665*4882a593Smuzhiyun 	/* wait for it to finish */
1666*4882a593Smuzhiyun 	do {
1667*4882a593Smuzhiyun 		udelay(1);
1668*4882a593Smuzhiyun 	} while (SMC_GET_CTL(lp) & CTL_RELOAD);
1669*4882a593Smuzhiyun 	/* read word from GP register */
1670*4882a593Smuzhiyun 	*word = SMC_GET_GP(lp);
1671*4882a593Smuzhiyun 	/* clean up */
1672*4882a593Smuzhiyun 	SMC_SET_CTL(lp, ctl);
1673*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1674*4882a593Smuzhiyun 	spin_unlock_irq(&lp->lock);
1675*4882a593Smuzhiyun 	return 0;
1676*4882a593Smuzhiyun }
1677*4882a593Smuzhiyun 
smc_ethtool_geteeprom_len(struct net_device * dev)1678*4882a593Smuzhiyun static int smc_ethtool_geteeprom_len(struct net_device *dev)
1679*4882a593Smuzhiyun {
1680*4882a593Smuzhiyun 	return 0x23 * 2;
1681*4882a593Smuzhiyun }
1682*4882a593Smuzhiyun 
smc_ethtool_geteeprom(struct net_device * dev,struct ethtool_eeprom * eeprom,u8 * data)1683*4882a593Smuzhiyun static int smc_ethtool_geteeprom(struct net_device *dev,
1684*4882a593Smuzhiyun 		struct ethtool_eeprom *eeprom, u8 *data)
1685*4882a593Smuzhiyun {
1686*4882a593Smuzhiyun 	int i;
1687*4882a593Smuzhiyun 	int imax;
1688*4882a593Smuzhiyun 
1689*4882a593Smuzhiyun 	DBG(1, dev, "Reading %d bytes at %d(0x%x)\n",
1690*4882a593Smuzhiyun 		eeprom->len, eeprom->offset, eeprom->offset);
1691*4882a593Smuzhiyun 	imax = smc_ethtool_geteeprom_len(dev);
1692*4882a593Smuzhiyun 	for (i = 0; i < eeprom->len; i += 2) {
1693*4882a593Smuzhiyun 		int ret;
1694*4882a593Smuzhiyun 		u16 wbuf;
1695*4882a593Smuzhiyun 		int offset = i + eeprom->offset;
1696*4882a593Smuzhiyun 		if (offset > imax)
1697*4882a593Smuzhiyun 			break;
1698*4882a593Smuzhiyun 		ret = smc_read_eeprom_word(dev, offset >> 1, &wbuf);
1699*4882a593Smuzhiyun 		if (ret != 0)
1700*4882a593Smuzhiyun 			return ret;
1701*4882a593Smuzhiyun 		DBG(2, dev, "Read 0x%x from 0x%x\n", wbuf, offset >> 1);
1702*4882a593Smuzhiyun 		data[i] = (wbuf >> 8) & 0xff;
1703*4882a593Smuzhiyun 		data[i+1] = wbuf & 0xff;
1704*4882a593Smuzhiyun 	}
1705*4882a593Smuzhiyun 	return 0;
1706*4882a593Smuzhiyun }
1707*4882a593Smuzhiyun 
smc_ethtool_seteeprom(struct net_device * dev,struct ethtool_eeprom * eeprom,u8 * data)1708*4882a593Smuzhiyun static int smc_ethtool_seteeprom(struct net_device *dev,
1709*4882a593Smuzhiyun 		struct ethtool_eeprom *eeprom, u8 *data)
1710*4882a593Smuzhiyun {
1711*4882a593Smuzhiyun 	int i;
1712*4882a593Smuzhiyun 	int imax;
1713*4882a593Smuzhiyun 
1714*4882a593Smuzhiyun 	DBG(1, dev, "Writing %d bytes to %d(0x%x)\n",
1715*4882a593Smuzhiyun 	    eeprom->len, eeprom->offset, eeprom->offset);
1716*4882a593Smuzhiyun 	imax = smc_ethtool_geteeprom_len(dev);
1717*4882a593Smuzhiyun 	for (i = 0; i < eeprom->len; i += 2) {
1718*4882a593Smuzhiyun 		int ret;
1719*4882a593Smuzhiyun 		u16 wbuf;
1720*4882a593Smuzhiyun 		int offset = i + eeprom->offset;
1721*4882a593Smuzhiyun 		if (offset > imax)
1722*4882a593Smuzhiyun 			break;
1723*4882a593Smuzhiyun 		wbuf = (data[i] << 8) | data[i + 1];
1724*4882a593Smuzhiyun 		DBG(2, dev, "Writing 0x%x to 0x%x\n", wbuf, offset >> 1);
1725*4882a593Smuzhiyun 		ret = smc_write_eeprom_word(dev, offset >> 1, wbuf);
1726*4882a593Smuzhiyun 		if (ret != 0)
1727*4882a593Smuzhiyun 			return ret;
1728*4882a593Smuzhiyun 	}
1729*4882a593Smuzhiyun 	return 0;
1730*4882a593Smuzhiyun }
1731*4882a593Smuzhiyun 
1732*4882a593Smuzhiyun 
1733*4882a593Smuzhiyun static const struct ethtool_ops smc_ethtool_ops = {
1734*4882a593Smuzhiyun 	.get_drvinfo	= smc_ethtool_getdrvinfo,
1735*4882a593Smuzhiyun 
1736*4882a593Smuzhiyun 	.get_msglevel	= smc_ethtool_getmsglevel,
1737*4882a593Smuzhiyun 	.set_msglevel	= smc_ethtool_setmsglevel,
1738*4882a593Smuzhiyun 	.nway_reset	= smc_ethtool_nwayreset,
1739*4882a593Smuzhiyun 	.get_link	= ethtool_op_get_link,
1740*4882a593Smuzhiyun 	.get_eeprom_len = smc_ethtool_geteeprom_len,
1741*4882a593Smuzhiyun 	.get_eeprom	= smc_ethtool_geteeprom,
1742*4882a593Smuzhiyun 	.set_eeprom	= smc_ethtool_seteeprom,
1743*4882a593Smuzhiyun 	.get_link_ksettings	= smc_ethtool_get_link_ksettings,
1744*4882a593Smuzhiyun 	.set_link_ksettings	= smc_ethtool_set_link_ksettings,
1745*4882a593Smuzhiyun };
1746*4882a593Smuzhiyun 
1747*4882a593Smuzhiyun static const struct net_device_ops smc_netdev_ops = {
1748*4882a593Smuzhiyun 	.ndo_open		= smc_open,
1749*4882a593Smuzhiyun 	.ndo_stop		= smc_close,
1750*4882a593Smuzhiyun 	.ndo_start_xmit		= smc_hard_start_xmit,
1751*4882a593Smuzhiyun 	.ndo_tx_timeout		= smc_timeout,
1752*4882a593Smuzhiyun 	.ndo_set_rx_mode	= smc_set_multicast_list,
1753*4882a593Smuzhiyun 	.ndo_validate_addr	= eth_validate_addr,
1754*4882a593Smuzhiyun 	.ndo_set_mac_address 	= eth_mac_addr,
1755*4882a593Smuzhiyun #ifdef CONFIG_NET_POLL_CONTROLLER
1756*4882a593Smuzhiyun 	.ndo_poll_controller	= smc_poll_controller,
1757*4882a593Smuzhiyun #endif
1758*4882a593Smuzhiyun };
1759*4882a593Smuzhiyun 
1760*4882a593Smuzhiyun /*
1761*4882a593Smuzhiyun  * smc_findirq
1762*4882a593Smuzhiyun  *
1763*4882a593Smuzhiyun  * This routine has a simple purpose -- make the SMC chip generate an
1764*4882a593Smuzhiyun  * interrupt, so an auto-detect routine can detect it, and find the IRQ,
1765*4882a593Smuzhiyun  */
1766*4882a593Smuzhiyun /*
1767*4882a593Smuzhiyun  * does this still work?
1768*4882a593Smuzhiyun  *
1769*4882a593Smuzhiyun  * I just deleted auto_irq.c, since it was never built...
1770*4882a593Smuzhiyun  *   --jgarzik
1771*4882a593Smuzhiyun  */
smc_findirq(struct smc_local * lp)1772*4882a593Smuzhiyun static int smc_findirq(struct smc_local *lp)
1773*4882a593Smuzhiyun {
1774*4882a593Smuzhiyun 	void __iomem *ioaddr = lp->base;
1775*4882a593Smuzhiyun 	int timeout = 20;
1776*4882a593Smuzhiyun 	unsigned long cookie;
1777*4882a593Smuzhiyun 
1778*4882a593Smuzhiyun 	DBG(2, lp->dev, "%s: %s\n", CARDNAME, __func__);
1779*4882a593Smuzhiyun 
1780*4882a593Smuzhiyun 	cookie = probe_irq_on();
1781*4882a593Smuzhiyun 
1782*4882a593Smuzhiyun 	/*
1783*4882a593Smuzhiyun 	 * What I try to do here is trigger an ALLOC_INT. This is done
1784*4882a593Smuzhiyun 	 * by allocating a small chunk of memory, which will give an interrupt
1785*4882a593Smuzhiyun 	 * when done.
1786*4882a593Smuzhiyun 	 */
1787*4882a593Smuzhiyun 	/* enable ALLOCation interrupts ONLY */
1788*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 2);
1789*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, IM_ALLOC_INT);
1790*4882a593Smuzhiyun 
1791*4882a593Smuzhiyun 	/*
1792*4882a593Smuzhiyun  	 * Allocate 512 bytes of memory.  Note that the chip was just
1793*4882a593Smuzhiyun 	 * reset so all the memory is available
1794*4882a593Smuzhiyun 	 */
1795*4882a593Smuzhiyun 	SMC_SET_MMU_CMD(lp, MC_ALLOC | 1);
1796*4882a593Smuzhiyun 
1797*4882a593Smuzhiyun 	/*
1798*4882a593Smuzhiyun 	 * Wait until positive that the interrupt has been generated
1799*4882a593Smuzhiyun 	 */
1800*4882a593Smuzhiyun 	do {
1801*4882a593Smuzhiyun 		int int_status;
1802*4882a593Smuzhiyun 		udelay(10);
1803*4882a593Smuzhiyun 		int_status = SMC_GET_INT(lp);
1804*4882a593Smuzhiyun 		if (int_status & IM_ALLOC_INT)
1805*4882a593Smuzhiyun 			break;		/* got the interrupt */
1806*4882a593Smuzhiyun 	} while (--timeout);
1807*4882a593Smuzhiyun 
1808*4882a593Smuzhiyun 	/*
1809*4882a593Smuzhiyun 	 * there is really nothing that I can do here if timeout fails,
1810*4882a593Smuzhiyun 	 * as autoirq_report will return a 0 anyway, which is what I
1811*4882a593Smuzhiyun 	 * want in this case.   Plus, the clean up is needed in both
1812*4882a593Smuzhiyun 	 * cases.
1813*4882a593Smuzhiyun 	 */
1814*4882a593Smuzhiyun 
1815*4882a593Smuzhiyun 	/* and disable all interrupts again */
1816*4882a593Smuzhiyun 	SMC_SET_INT_MASK(lp, 0);
1817*4882a593Smuzhiyun 
1818*4882a593Smuzhiyun 	/* and return what I found */
1819*4882a593Smuzhiyun 	return probe_irq_off(cookie);
1820*4882a593Smuzhiyun }
1821*4882a593Smuzhiyun 
1822*4882a593Smuzhiyun /*
1823*4882a593Smuzhiyun  * Function: smc_probe(unsigned long ioaddr)
1824*4882a593Smuzhiyun  *
1825*4882a593Smuzhiyun  * Purpose:
1826*4882a593Smuzhiyun  *	Tests to see if a given ioaddr points to an SMC91x chip.
1827*4882a593Smuzhiyun  *	Returns a 0 on success
1828*4882a593Smuzhiyun  *
1829*4882a593Smuzhiyun  * Algorithm:
1830*4882a593Smuzhiyun  *	(1) see if the high byte of BANK_SELECT is 0x33
1831*4882a593Smuzhiyun  * 	(2) compare the ioaddr with the base register's address
1832*4882a593Smuzhiyun  *	(3) see if I recognize the chip ID in the appropriate register
1833*4882a593Smuzhiyun  *
1834*4882a593Smuzhiyun  * Here I do typical initialization tasks.
1835*4882a593Smuzhiyun  *
1836*4882a593Smuzhiyun  * o  Initialize the structure if needed
1837*4882a593Smuzhiyun  * o  print out my vanity message if not done so already
1838*4882a593Smuzhiyun  * o  print out what type of hardware is detected
1839*4882a593Smuzhiyun  * o  print out the ethernet address
1840*4882a593Smuzhiyun  * o  find the IRQ
1841*4882a593Smuzhiyun  * o  set up my private data
1842*4882a593Smuzhiyun  * o  configure the dev structure with my subroutines
1843*4882a593Smuzhiyun  * o  actually GRAB the irq.
1844*4882a593Smuzhiyun  * o  GRAB the region
1845*4882a593Smuzhiyun  */
smc_probe(struct net_device * dev,void __iomem * ioaddr,unsigned long irq_flags)1846*4882a593Smuzhiyun static int smc_probe(struct net_device *dev, void __iomem *ioaddr,
1847*4882a593Smuzhiyun 		     unsigned long irq_flags)
1848*4882a593Smuzhiyun {
1849*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(dev);
1850*4882a593Smuzhiyun 	int retval;
1851*4882a593Smuzhiyun 	unsigned int val, revision_register;
1852*4882a593Smuzhiyun 	const char *version_string;
1853*4882a593Smuzhiyun 
1854*4882a593Smuzhiyun 	DBG(2, dev, "%s: %s\n", CARDNAME, __func__);
1855*4882a593Smuzhiyun 
1856*4882a593Smuzhiyun 	/* First, see if the high byte is 0x33 */
1857*4882a593Smuzhiyun 	val = SMC_CURRENT_BANK(lp);
1858*4882a593Smuzhiyun 	DBG(2, dev, "%s: bank signature probe returned 0x%04x\n",
1859*4882a593Smuzhiyun 	    CARDNAME, val);
1860*4882a593Smuzhiyun 	if ((val & 0xFF00) != 0x3300) {
1861*4882a593Smuzhiyun 		if ((val & 0xFF) == 0x33) {
1862*4882a593Smuzhiyun 			netdev_warn(dev,
1863*4882a593Smuzhiyun 				    "%s: Detected possible byte-swapped interface at IOADDR %p\n",
1864*4882a593Smuzhiyun 				    CARDNAME, ioaddr);
1865*4882a593Smuzhiyun 		}
1866*4882a593Smuzhiyun 		retval = -ENODEV;
1867*4882a593Smuzhiyun 		goto err_out;
1868*4882a593Smuzhiyun 	}
1869*4882a593Smuzhiyun 
1870*4882a593Smuzhiyun 	/*
1871*4882a593Smuzhiyun 	 * The above MIGHT indicate a device, but I need to write to
1872*4882a593Smuzhiyun 	 * further test this.
1873*4882a593Smuzhiyun 	 */
1874*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 0);
1875*4882a593Smuzhiyun 	val = SMC_CURRENT_BANK(lp);
1876*4882a593Smuzhiyun 	if ((val & 0xFF00) != 0x3300) {
1877*4882a593Smuzhiyun 		retval = -ENODEV;
1878*4882a593Smuzhiyun 		goto err_out;
1879*4882a593Smuzhiyun 	}
1880*4882a593Smuzhiyun 
1881*4882a593Smuzhiyun 	/*
1882*4882a593Smuzhiyun 	 * well, we've already written once, so hopefully another
1883*4882a593Smuzhiyun 	 * time won't hurt.  This time, I need to switch the bank
1884*4882a593Smuzhiyun 	 * register to bank 1, so I can access the base address
1885*4882a593Smuzhiyun 	 * register
1886*4882a593Smuzhiyun 	 */
1887*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
1888*4882a593Smuzhiyun 	val = SMC_GET_BASE(lp);
1889*4882a593Smuzhiyun 	val = ((val & 0x1F00) >> 3) << SMC_IO_SHIFT;
1890*4882a593Smuzhiyun 	if (((unsigned long)ioaddr & (0x3e0 << SMC_IO_SHIFT)) != val) {
1891*4882a593Smuzhiyun 		netdev_warn(dev, "%s: IOADDR %p doesn't match configuration (%x).\n",
1892*4882a593Smuzhiyun 			    CARDNAME, ioaddr, val);
1893*4882a593Smuzhiyun 	}
1894*4882a593Smuzhiyun 
1895*4882a593Smuzhiyun 	/*
1896*4882a593Smuzhiyun 	 * check if the revision register is something that I
1897*4882a593Smuzhiyun 	 * recognize.  These might need to be added to later,
1898*4882a593Smuzhiyun 	 * as future revisions could be added.
1899*4882a593Smuzhiyun 	 */
1900*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 3);
1901*4882a593Smuzhiyun 	revision_register = SMC_GET_REV(lp);
1902*4882a593Smuzhiyun 	DBG(2, dev, "%s: revision = 0x%04x\n", CARDNAME, revision_register);
1903*4882a593Smuzhiyun 	version_string = chip_ids[ (revision_register >> 4) & 0xF];
1904*4882a593Smuzhiyun 	if (!version_string || (revision_register & 0xff00) != 0x3300) {
1905*4882a593Smuzhiyun 		/* I don't recognize this chip, so... */
1906*4882a593Smuzhiyun 		netdev_warn(dev, "%s: IO %p: Unrecognized revision register 0x%04x, Contact author.\n",
1907*4882a593Smuzhiyun 			    CARDNAME, ioaddr, revision_register);
1908*4882a593Smuzhiyun 
1909*4882a593Smuzhiyun 		retval = -ENODEV;
1910*4882a593Smuzhiyun 		goto err_out;
1911*4882a593Smuzhiyun 	}
1912*4882a593Smuzhiyun 
1913*4882a593Smuzhiyun 	/* At this point I'll assume that the chip is an SMC91x. */
1914*4882a593Smuzhiyun 	pr_info_once("%s\n", version);
1915*4882a593Smuzhiyun 
1916*4882a593Smuzhiyun 	/* fill in some of the fields */
1917*4882a593Smuzhiyun 	dev->base_addr = (unsigned long)ioaddr;
1918*4882a593Smuzhiyun 	lp->base = ioaddr;
1919*4882a593Smuzhiyun 	lp->version = revision_register & 0xff;
1920*4882a593Smuzhiyun 	spin_lock_init(&lp->lock);
1921*4882a593Smuzhiyun 
1922*4882a593Smuzhiyun 	/* Get the MAC address */
1923*4882a593Smuzhiyun 	SMC_SELECT_BANK(lp, 1);
1924*4882a593Smuzhiyun 	SMC_GET_MAC_ADDR(lp, dev->dev_addr);
1925*4882a593Smuzhiyun 
1926*4882a593Smuzhiyun 	/* now, reset the chip, and put it into a known state */
1927*4882a593Smuzhiyun 	smc_reset(dev);
1928*4882a593Smuzhiyun 
1929*4882a593Smuzhiyun 	/*
1930*4882a593Smuzhiyun 	 * If dev->irq is 0, then the device has to be banged on to see
1931*4882a593Smuzhiyun 	 * what the IRQ is.
1932*4882a593Smuzhiyun 	 *
1933*4882a593Smuzhiyun 	 * This banging doesn't always detect the IRQ, for unknown reasons.
1934*4882a593Smuzhiyun 	 * a workaround is to reset the chip and try again.
1935*4882a593Smuzhiyun 	 *
1936*4882a593Smuzhiyun 	 * Interestingly, the DOS packet driver *SETS* the IRQ on the card to
1937*4882a593Smuzhiyun 	 * be what is requested on the command line.   I don't do that, mostly
1938*4882a593Smuzhiyun 	 * because the card that I have uses a non-standard method of accessing
1939*4882a593Smuzhiyun 	 * the IRQs, and because this _should_ work in most configurations.
1940*4882a593Smuzhiyun 	 *
1941*4882a593Smuzhiyun 	 * Specifying an IRQ is done with the assumption that the user knows
1942*4882a593Smuzhiyun 	 * what (s)he is doing.  No checking is done!!!!
1943*4882a593Smuzhiyun 	 */
1944*4882a593Smuzhiyun 	if (dev->irq < 1) {
1945*4882a593Smuzhiyun 		int trials;
1946*4882a593Smuzhiyun 
1947*4882a593Smuzhiyun 		trials = 3;
1948*4882a593Smuzhiyun 		while (trials--) {
1949*4882a593Smuzhiyun 			dev->irq = smc_findirq(lp);
1950*4882a593Smuzhiyun 			if (dev->irq)
1951*4882a593Smuzhiyun 				break;
1952*4882a593Smuzhiyun 			/* kick the card and try again */
1953*4882a593Smuzhiyun 			smc_reset(dev);
1954*4882a593Smuzhiyun 		}
1955*4882a593Smuzhiyun 	}
1956*4882a593Smuzhiyun 	if (dev->irq == 0) {
1957*4882a593Smuzhiyun 		netdev_warn(dev, "Couldn't autodetect your IRQ. Use irq=xx.\n");
1958*4882a593Smuzhiyun 		retval = -ENODEV;
1959*4882a593Smuzhiyun 		goto err_out;
1960*4882a593Smuzhiyun 	}
1961*4882a593Smuzhiyun 	dev->irq = irq_canonicalize(dev->irq);
1962*4882a593Smuzhiyun 
1963*4882a593Smuzhiyun 	dev->watchdog_timeo = msecs_to_jiffies(watchdog);
1964*4882a593Smuzhiyun 	dev->netdev_ops = &smc_netdev_ops;
1965*4882a593Smuzhiyun 	dev->ethtool_ops = &smc_ethtool_ops;
1966*4882a593Smuzhiyun 
1967*4882a593Smuzhiyun 	tasklet_setup(&lp->tx_task, smc_hardware_send_pkt);
1968*4882a593Smuzhiyun 	INIT_WORK(&lp->phy_configure, smc_phy_configure);
1969*4882a593Smuzhiyun 	lp->dev = dev;
1970*4882a593Smuzhiyun 	lp->mii.phy_id_mask = 0x1f;
1971*4882a593Smuzhiyun 	lp->mii.reg_num_mask = 0x1f;
1972*4882a593Smuzhiyun 	lp->mii.force_media = 0;
1973*4882a593Smuzhiyun 	lp->mii.full_duplex = 0;
1974*4882a593Smuzhiyun 	lp->mii.dev = dev;
1975*4882a593Smuzhiyun 	lp->mii.mdio_read = smc_phy_read;
1976*4882a593Smuzhiyun 	lp->mii.mdio_write = smc_phy_write;
1977*4882a593Smuzhiyun 
1978*4882a593Smuzhiyun 	/*
1979*4882a593Smuzhiyun 	 * Locate the phy, if any.
1980*4882a593Smuzhiyun 	 */
1981*4882a593Smuzhiyun 	if (lp->version >= (CHIP_91100 << 4))
1982*4882a593Smuzhiyun 		smc_phy_detect(dev);
1983*4882a593Smuzhiyun 
1984*4882a593Smuzhiyun 	/* then shut everything down to save power */
1985*4882a593Smuzhiyun 	smc_shutdown(dev);
1986*4882a593Smuzhiyun 	smc_phy_powerdown(dev);
1987*4882a593Smuzhiyun 
1988*4882a593Smuzhiyun 	/* Set default parameters */
1989*4882a593Smuzhiyun 	lp->msg_enable = NETIF_MSG_LINK;
1990*4882a593Smuzhiyun 	lp->ctl_rfduplx = 0;
1991*4882a593Smuzhiyun 	lp->ctl_rspeed = 10;
1992*4882a593Smuzhiyun 
1993*4882a593Smuzhiyun 	if (lp->version >= (CHIP_91100 << 4)) {
1994*4882a593Smuzhiyun 		lp->ctl_rfduplx = 1;
1995*4882a593Smuzhiyun 		lp->ctl_rspeed = 100;
1996*4882a593Smuzhiyun 	}
1997*4882a593Smuzhiyun 
1998*4882a593Smuzhiyun 	/* Grab the IRQ */
1999*4882a593Smuzhiyun 	retval = request_irq(dev->irq, smc_interrupt, irq_flags, dev->name, dev);
2000*4882a593Smuzhiyun       	if (retval)
2001*4882a593Smuzhiyun       		goto err_out;
2002*4882a593Smuzhiyun 
2003*4882a593Smuzhiyun #ifdef CONFIG_ARCH_PXA
2004*4882a593Smuzhiyun #  ifdef SMC_USE_PXA_DMA
2005*4882a593Smuzhiyun 	lp->cfg.flags |= SMC91X_USE_DMA;
2006*4882a593Smuzhiyun #  endif
2007*4882a593Smuzhiyun 	if (lp->cfg.flags & SMC91X_USE_DMA) {
2008*4882a593Smuzhiyun 		dma_cap_mask_t mask;
2009*4882a593Smuzhiyun 
2010*4882a593Smuzhiyun 		dma_cap_zero(mask);
2011*4882a593Smuzhiyun 		dma_cap_set(DMA_SLAVE, mask);
2012*4882a593Smuzhiyun 		lp->dma_chan = dma_request_channel(mask, NULL, NULL);
2013*4882a593Smuzhiyun 	}
2014*4882a593Smuzhiyun #endif
2015*4882a593Smuzhiyun 
2016*4882a593Smuzhiyun 	retval = register_netdev(dev);
2017*4882a593Smuzhiyun 	if (retval == 0) {
2018*4882a593Smuzhiyun 		/* now, print out the card info, in a short format.. */
2019*4882a593Smuzhiyun 		netdev_info(dev, "%s (rev %d) at %p IRQ %d",
2020*4882a593Smuzhiyun 			    version_string, revision_register & 0x0f,
2021*4882a593Smuzhiyun 			    lp->base, dev->irq);
2022*4882a593Smuzhiyun 
2023*4882a593Smuzhiyun 		if (lp->dma_chan)
2024*4882a593Smuzhiyun 			pr_cont(" DMA %p", lp->dma_chan);
2025*4882a593Smuzhiyun 
2026*4882a593Smuzhiyun 		pr_cont("%s%s\n",
2027*4882a593Smuzhiyun 			lp->cfg.flags & SMC91X_NOWAIT ? " [nowait]" : "",
2028*4882a593Smuzhiyun 			THROTTLE_TX_PKTS ? " [throttle_tx]" : "");
2029*4882a593Smuzhiyun 
2030*4882a593Smuzhiyun 		if (!is_valid_ether_addr(dev->dev_addr)) {
2031*4882a593Smuzhiyun 			netdev_warn(dev, "Invalid ethernet MAC address. Please set using ifconfig\n");
2032*4882a593Smuzhiyun 		} else {
2033*4882a593Smuzhiyun 			/* Print the Ethernet address */
2034*4882a593Smuzhiyun 			netdev_info(dev, "Ethernet addr: %pM\n",
2035*4882a593Smuzhiyun 				    dev->dev_addr);
2036*4882a593Smuzhiyun 		}
2037*4882a593Smuzhiyun 
2038*4882a593Smuzhiyun 		if (lp->phy_type == 0) {
2039*4882a593Smuzhiyun 			PRINTK(dev, "No PHY found\n");
2040*4882a593Smuzhiyun 		} else if ((lp->phy_type & 0xfffffff0) == 0x0016f840) {
2041*4882a593Smuzhiyun 			PRINTK(dev, "PHY LAN83C183 (LAN91C111 Internal)\n");
2042*4882a593Smuzhiyun 		} else if ((lp->phy_type & 0xfffffff0) == 0x02821c50) {
2043*4882a593Smuzhiyun 			PRINTK(dev, "PHY LAN83C180\n");
2044*4882a593Smuzhiyun 		}
2045*4882a593Smuzhiyun 	}
2046*4882a593Smuzhiyun 
2047*4882a593Smuzhiyun err_out:
2048*4882a593Smuzhiyun #ifdef CONFIG_ARCH_PXA
2049*4882a593Smuzhiyun 	if (retval && lp->dma_chan)
2050*4882a593Smuzhiyun 		dma_release_channel(lp->dma_chan);
2051*4882a593Smuzhiyun #endif
2052*4882a593Smuzhiyun 	return retval;
2053*4882a593Smuzhiyun }
2054*4882a593Smuzhiyun 
smc_enable_device(struct platform_device * pdev)2055*4882a593Smuzhiyun static int smc_enable_device(struct platform_device *pdev)
2056*4882a593Smuzhiyun {
2057*4882a593Smuzhiyun 	struct net_device *ndev = platform_get_drvdata(pdev);
2058*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(ndev);
2059*4882a593Smuzhiyun 	unsigned long flags;
2060*4882a593Smuzhiyun 	unsigned char ecor, ecsr;
2061*4882a593Smuzhiyun 	void __iomem *addr;
2062*4882a593Smuzhiyun 	struct resource * res;
2063*4882a593Smuzhiyun 
2064*4882a593Smuzhiyun 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-attrib");
2065*4882a593Smuzhiyun 	if (!res)
2066*4882a593Smuzhiyun 		return 0;
2067*4882a593Smuzhiyun 
2068*4882a593Smuzhiyun 	/*
2069*4882a593Smuzhiyun 	 * Map the attribute space.  This is overkill, but clean.
2070*4882a593Smuzhiyun 	 */
2071*4882a593Smuzhiyun 	addr = ioremap(res->start, ATTRIB_SIZE);
2072*4882a593Smuzhiyun 	if (!addr)
2073*4882a593Smuzhiyun 		return -ENOMEM;
2074*4882a593Smuzhiyun 
2075*4882a593Smuzhiyun 	/*
2076*4882a593Smuzhiyun 	 * Reset the device.  We must disable IRQs around this
2077*4882a593Smuzhiyun 	 * since a reset causes the IRQ line become active.
2078*4882a593Smuzhiyun 	 */
2079*4882a593Smuzhiyun 	local_irq_save(flags);
2080*4882a593Smuzhiyun 	ecor = readb(addr + (ECOR << SMC_IO_SHIFT)) & ~ECOR_RESET;
2081*4882a593Smuzhiyun 	writeb(ecor | ECOR_RESET, addr + (ECOR << SMC_IO_SHIFT));
2082*4882a593Smuzhiyun 	readb(addr + (ECOR << SMC_IO_SHIFT));
2083*4882a593Smuzhiyun 
2084*4882a593Smuzhiyun 	/*
2085*4882a593Smuzhiyun 	 * Wait 100us for the chip to reset.
2086*4882a593Smuzhiyun 	 */
2087*4882a593Smuzhiyun 	udelay(100);
2088*4882a593Smuzhiyun 
2089*4882a593Smuzhiyun 	/*
2090*4882a593Smuzhiyun 	 * The device will ignore all writes to the enable bit while
2091*4882a593Smuzhiyun 	 * reset is asserted, even if the reset bit is cleared in the
2092*4882a593Smuzhiyun 	 * same write.  Must clear reset first, then enable the device.
2093*4882a593Smuzhiyun 	 */
2094*4882a593Smuzhiyun 	writeb(ecor, addr + (ECOR << SMC_IO_SHIFT));
2095*4882a593Smuzhiyun 	writeb(ecor | ECOR_ENABLE, addr + (ECOR << SMC_IO_SHIFT));
2096*4882a593Smuzhiyun 
2097*4882a593Smuzhiyun 	/*
2098*4882a593Smuzhiyun 	 * Set the appropriate byte/word mode.
2099*4882a593Smuzhiyun 	 */
2100*4882a593Smuzhiyun 	ecsr = readb(addr + (ECSR << SMC_IO_SHIFT)) & ~ECSR_IOIS8;
2101*4882a593Smuzhiyun 	if (!SMC_16BIT(lp))
2102*4882a593Smuzhiyun 		ecsr |= ECSR_IOIS8;
2103*4882a593Smuzhiyun 	writeb(ecsr, addr + (ECSR << SMC_IO_SHIFT));
2104*4882a593Smuzhiyun 	local_irq_restore(flags);
2105*4882a593Smuzhiyun 
2106*4882a593Smuzhiyun 	iounmap(addr);
2107*4882a593Smuzhiyun 
2108*4882a593Smuzhiyun 	/*
2109*4882a593Smuzhiyun 	 * Wait for the chip to wake up.  We could poll the control
2110*4882a593Smuzhiyun 	 * register in the main register space, but that isn't mapped
2111*4882a593Smuzhiyun 	 * yet.  We know this is going to take 750us.
2112*4882a593Smuzhiyun 	 */
2113*4882a593Smuzhiyun 	msleep(1);
2114*4882a593Smuzhiyun 
2115*4882a593Smuzhiyun 	return 0;
2116*4882a593Smuzhiyun }
2117*4882a593Smuzhiyun 
smc_request_attrib(struct platform_device * pdev,struct net_device * ndev)2118*4882a593Smuzhiyun static int smc_request_attrib(struct platform_device *pdev,
2119*4882a593Smuzhiyun 			      struct net_device *ndev)
2120*4882a593Smuzhiyun {
2121*4882a593Smuzhiyun 	struct resource * res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-attrib");
2122*4882a593Smuzhiyun 	struct smc_local *lp __maybe_unused = netdev_priv(ndev);
2123*4882a593Smuzhiyun 
2124*4882a593Smuzhiyun 	if (!res)
2125*4882a593Smuzhiyun 		return 0;
2126*4882a593Smuzhiyun 
2127*4882a593Smuzhiyun 	if (!request_mem_region(res->start, ATTRIB_SIZE, CARDNAME))
2128*4882a593Smuzhiyun 		return -EBUSY;
2129*4882a593Smuzhiyun 
2130*4882a593Smuzhiyun 	return 0;
2131*4882a593Smuzhiyun }
2132*4882a593Smuzhiyun 
smc_release_attrib(struct platform_device * pdev,struct net_device * ndev)2133*4882a593Smuzhiyun static void smc_release_attrib(struct platform_device *pdev,
2134*4882a593Smuzhiyun 			       struct net_device *ndev)
2135*4882a593Smuzhiyun {
2136*4882a593Smuzhiyun 	struct resource * res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-attrib");
2137*4882a593Smuzhiyun 	struct smc_local *lp __maybe_unused = netdev_priv(ndev);
2138*4882a593Smuzhiyun 
2139*4882a593Smuzhiyun 	if (res)
2140*4882a593Smuzhiyun 		release_mem_region(res->start, ATTRIB_SIZE);
2141*4882a593Smuzhiyun }
2142*4882a593Smuzhiyun 
smc_request_datacs(struct platform_device * pdev,struct net_device * ndev)2143*4882a593Smuzhiyun static inline void smc_request_datacs(struct platform_device *pdev, struct net_device *ndev)
2144*4882a593Smuzhiyun {
2145*4882a593Smuzhiyun 	if (SMC_CAN_USE_DATACS) {
2146*4882a593Smuzhiyun 		struct resource * res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-data32");
2147*4882a593Smuzhiyun 		struct smc_local *lp = netdev_priv(ndev);
2148*4882a593Smuzhiyun 
2149*4882a593Smuzhiyun 		if (!res)
2150*4882a593Smuzhiyun 			return;
2151*4882a593Smuzhiyun 
2152*4882a593Smuzhiyun 		if(!request_mem_region(res->start, SMC_DATA_EXTENT, CARDNAME)) {
2153*4882a593Smuzhiyun 			netdev_info(ndev, "%s: failed to request datacs memory region.\n",
2154*4882a593Smuzhiyun 				    CARDNAME);
2155*4882a593Smuzhiyun 			return;
2156*4882a593Smuzhiyun 		}
2157*4882a593Smuzhiyun 
2158*4882a593Smuzhiyun 		lp->datacs = ioremap(res->start, SMC_DATA_EXTENT);
2159*4882a593Smuzhiyun 	}
2160*4882a593Smuzhiyun }
2161*4882a593Smuzhiyun 
smc_release_datacs(struct platform_device * pdev,struct net_device * ndev)2162*4882a593Smuzhiyun static void smc_release_datacs(struct platform_device *pdev, struct net_device *ndev)
2163*4882a593Smuzhiyun {
2164*4882a593Smuzhiyun 	if (SMC_CAN_USE_DATACS) {
2165*4882a593Smuzhiyun 		struct smc_local *lp = netdev_priv(ndev);
2166*4882a593Smuzhiyun 		struct resource * res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-data32");
2167*4882a593Smuzhiyun 
2168*4882a593Smuzhiyun 		if (lp->datacs)
2169*4882a593Smuzhiyun 			iounmap(lp->datacs);
2170*4882a593Smuzhiyun 
2171*4882a593Smuzhiyun 		lp->datacs = NULL;
2172*4882a593Smuzhiyun 
2173*4882a593Smuzhiyun 		if (res)
2174*4882a593Smuzhiyun 			release_mem_region(res->start, SMC_DATA_EXTENT);
2175*4882a593Smuzhiyun 	}
2176*4882a593Smuzhiyun }
2177*4882a593Smuzhiyun 
2178*4882a593Smuzhiyun static const struct acpi_device_id smc91x_acpi_match[] = {
2179*4882a593Smuzhiyun 	{ "LNRO0003", 0 },
2180*4882a593Smuzhiyun 	{ }
2181*4882a593Smuzhiyun };
2182*4882a593Smuzhiyun MODULE_DEVICE_TABLE(acpi, smc91x_acpi_match);
2183*4882a593Smuzhiyun 
2184*4882a593Smuzhiyun #if IS_BUILTIN(CONFIG_OF)
2185*4882a593Smuzhiyun static const struct of_device_id smc91x_match[] = {
2186*4882a593Smuzhiyun 	{ .compatible = "smsc,lan91c94", },
2187*4882a593Smuzhiyun 	{ .compatible = "smsc,lan91c111", },
2188*4882a593Smuzhiyun 	{},
2189*4882a593Smuzhiyun };
2190*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, smc91x_match);
2191*4882a593Smuzhiyun 
2192*4882a593Smuzhiyun /**
2193*4882a593Smuzhiyun  * of_try_set_control_gpio - configure a gpio if it exists
2194*4882a593Smuzhiyun  */
try_toggle_control_gpio(struct device * dev,struct gpio_desc ** desc,const char * name,int index,int value,unsigned int nsdelay)2195*4882a593Smuzhiyun static int try_toggle_control_gpio(struct device *dev,
2196*4882a593Smuzhiyun 				   struct gpio_desc **desc,
2197*4882a593Smuzhiyun 				   const char *name, int index,
2198*4882a593Smuzhiyun 				   int value, unsigned int nsdelay)
2199*4882a593Smuzhiyun {
2200*4882a593Smuzhiyun 	struct gpio_desc *gpio = *desc;
2201*4882a593Smuzhiyun 	enum gpiod_flags flags = value ? GPIOD_OUT_LOW : GPIOD_OUT_HIGH;
2202*4882a593Smuzhiyun 
2203*4882a593Smuzhiyun 	gpio = devm_gpiod_get_index_optional(dev, name, index, flags);
2204*4882a593Smuzhiyun 	if (IS_ERR(gpio))
2205*4882a593Smuzhiyun 		return PTR_ERR(gpio);
2206*4882a593Smuzhiyun 
2207*4882a593Smuzhiyun 	if (gpio) {
2208*4882a593Smuzhiyun 		if (nsdelay)
2209*4882a593Smuzhiyun 			usleep_range(nsdelay, 2 * nsdelay);
2210*4882a593Smuzhiyun 		gpiod_set_value_cansleep(gpio, value);
2211*4882a593Smuzhiyun 	}
2212*4882a593Smuzhiyun 	*desc = gpio;
2213*4882a593Smuzhiyun 
2214*4882a593Smuzhiyun 	return 0;
2215*4882a593Smuzhiyun }
2216*4882a593Smuzhiyun #endif
2217*4882a593Smuzhiyun 
2218*4882a593Smuzhiyun /*
2219*4882a593Smuzhiyun  * smc_init(void)
2220*4882a593Smuzhiyun  *   Input parameters:
2221*4882a593Smuzhiyun  *	dev->base_addr == 0, try to find all possible locations
2222*4882a593Smuzhiyun  *	dev->base_addr > 0x1ff, this is the address to check
2223*4882a593Smuzhiyun  *	dev->base_addr == <anything else>, return failure code
2224*4882a593Smuzhiyun  *
2225*4882a593Smuzhiyun  *   Output:
2226*4882a593Smuzhiyun  *	0 --> there is a device
2227*4882a593Smuzhiyun  *	anything else, error
2228*4882a593Smuzhiyun  */
smc_drv_probe(struct platform_device * pdev)2229*4882a593Smuzhiyun static int smc_drv_probe(struct platform_device *pdev)
2230*4882a593Smuzhiyun {
2231*4882a593Smuzhiyun 	struct smc91x_platdata *pd = dev_get_platdata(&pdev->dev);
2232*4882a593Smuzhiyun 	const struct of_device_id *match = NULL;
2233*4882a593Smuzhiyun 	struct smc_local *lp;
2234*4882a593Smuzhiyun 	struct net_device *ndev;
2235*4882a593Smuzhiyun 	struct resource *res;
2236*4882a593Smuzhiyun 	unsigned int __iomem *addr;
2237*4882a593Smuzhiyun 	unsigned long irq_flags = SMC_IRQ_FLAGS;
2238*4882a593Smuzhiyun 	unsigned long irq_resflags;
2239*4882a593Smuzhiyun 	int ret;
2240*4882a593Smuzhiyun 
2241*4882a593Smuzhiyun 	ndev = alloc_etherdev(sizeof(struct smc_local));
2242*4882a593Smuzhiyun 	if (!ndev) {
2243*4882a593Smuzhiyun 		ret = -ENOMEM;
2244*4882a593Smuzhiyun 		goto out;
2245*4882a593Smuzhiyun 	}
2246*4882a593Smuzhiyun 	SET_NETDEV_DEV(ndev, &pdev->dev);
2247*4882a593Smuzhiyun 
2248*4882a593Smuzhiyun 	/* get configuration from platform data, only allow use of
2249*4882a593Smuzhiyun 	 * bus width if both SMC_CAN_USE_xxx and SMC91X_USE_xxx are set.
2250*4882a593Smuzhiyun 	 */
2251*4882a593Smuzhiyun 
2252*4882a593Smuzhiyun 	lp = netdev_priv(ndev);
2253*4882a593Smuzhiyun 	lp->cfg.flags = 0;
2254*4882a593Smuzhiyun 
2255*4882a593Smuzhiyun 	if (pd) {
2256*4882a593Smuzhiyun 		memcpy(&lp->cfg, pd, sizeof(lp->cfg));
2257*4882a593Smuzhiyun 		lp->io_shift = SMC91X_IO_SHIFT(lp->cfg.flags);
2258*4882a593Smuzhiyun 
2259*4882a593Smuzhiyun 		if (!SMC_8BIT(lp) && !SMC_16BIT(lp)) {
2260*4882a593Smuzhiyun 			dev_err(&pdev->dev,
2261*4882a593Smuzhiyun 				"at least one of 8-bit or 16-bit access support is required.\n");
2262*4882a593Smuzhiyun 			ret = -ENXIO;
2263*4882a593Smuzhiyun 			goto out_free_netdev;
2264*4882a593Smuzhiyun 		}
2265*4882a593Smuzhiyun 	}
2266*4882a593Smuzhiyun 
2267*4882a593Smuzhiyun #if IS_BUILTIN(CONFIG_OF)
2268*4882a593Smuzhiyun 	match = of_match_device(of_match_ptr(smc91x_match), &pdev->dev);
2269*4882a593Smuzhiyun 	if (match) {
2270*4882a593Smuzhiyun 		u32 val;
2271*4882a593Smuzhiyun 
2272*4882a593Smuzhiyun 		/* Optional pwrdwn GPIO configured? */
2273*4882a593Smuzhiyun 		ret = try_toggle_control_gpio(&pdev->dev, &lp->power_gpio,
2274*4882a593Smuzhiyun 					      "power", 0, 0, 100);
2275*4882a593Smuzhiyun 		if (ret)
2276*4882a593Smuzhiyun 			goto out_free_netdev;
2277*4882a593Smuzhiyun 
2278*4882a593Smuzhiyun 		/*
2279*4882a593Smuzhiyun 		 * Optional reset GPIO configured? Minimum 100 ns reset needed
2280*4882a593Smuzhiyun 		 * according to LAN91C96 datasheet page 14.
2281*4882a593Smuzhiyun 		 */
2282*4882a593Smuzhiyun 		ret = try_toggle_control_gpio(&pdev->dev, &lp->reset_gpio,
2283*4882a593Smuzhiyun 					      "reset", 0, 0, 100);
2284*4882a593Smuzhiyun 		if (ret)
2285*4882a593Smuzhiyun 			goto out_free_netdev;
2286*4882a593Smuzhiyun 
2287*4882a593Smuzhiyun 		/*
2288*4882a593Smuzhiyun 		 * Need to wait for optional EEPROM to load, max 750 us according
2289*4882a593Smuzhiyun 		 * to LAN91C96 datasheet page 55.
2290*4882a593Smuzhiyun 		 */
2291*4882a593Smuzhiyun 		if (lp->reset_gpio)
2292*4882a593Smuzhiyun 			usleep_range(750, 1000);
2293*4882a593Smuzhiyun 
2294*4882a593Smuzhiyun 		/* Combination of IO widths supported, default to 16-bit */
2295*4882a593Smuzhiyun 		if (!device_property_read_u32(&pdev->dev, "reg-io-width",
2296*4882a593Smuzhiyun 					      &val)) {
2297*4882a593Smuzhiyun 			if (val & 1)
2298*4882a593Smuzhiyun 				lp->cfg.flags |= SMC91X_USE_8BIT;
2299*4882a593Smuzhiyun 			if ((val == 0) || (val & 2))
2300*4882a593Smuzhiyun 				lp->cfg.flags |= SMC91X_USE_16BIT;
2301*4882a593Smuzhiyun 			if (val & 4)
2302*4882a593Smuzhiyun 				lp->cfg.flags |= SMC91X_USE_32BIT;
2303*4882a593Smuzhiyun 		} else {
2304*4882a593Smuzhiyun 			lp->cfg.flags |= SMC91X_USE_16BIT;
2305*4882a593Smuzhiyun 		}
2306*4882a593Smuzhiyun 		if (!device_property_read_u32(&pdev->dev, "reg-shift",
2307*4882a593Smuzhiyun 					      &val))
2308*4882a593Smuzhiyun 			lp->io_shift = val;
2309*4882a593Smuzhiyun 		lp->cfg.pxa_u16_align4 =
2310*4882a593Smuzhiyun 			device_property_read_bool(&pdev->dev, "pxa-u16-align4");
2311*4882a593Smuzhiyun 	}
2312*4882a593Smuzhiyun #endif
2313*4882a593Smuzhiyun 
2314*4882a593Smuzhiyun 	if (!pd && !match) {
2315*4882a593Smuzhiyun 		lp->cfg.flags |= (SMC_CAN_USE_8BIT)  ? SMC91X_USE_8BIT  : 0;
2316*4882a593Smuzhiyun 		lp->cfg.flags |= (SMC_CAN_USE_16BIT) ? SMC91X_USE_16BIT : 0;
2317*4882a593Smuzhiyun 		lp->cfg.flags |= (SMC_CAN_USE_32BIT) ? SMC91X_USE_32BIT : 0;
2318*4882a593Smuzhiyun 		lp->cfg.flags |= (nowait) ? SMC91X_NOWAIT : 0;
2319*4882a593Smuzhiyun 	}
2320*4882a593Smuzhiyun 
2321*4882a593Smuzhiyun 	if (!lp->cfg.leda && !lp->cfg.ledb) {
2322*4882a593Smuzhiyun 		lp->cfg.leda = RPC_LSA_DEFAULT;
2323*4882a593Smuzhiyun 		lp->cfg.ledb = RPC_LSB_DEFAULT;
2324*4882a593Smuzhiyun 	}
2325*4882a593Smuzhiyun 
2326*4882a593Smuzhiyun 	ndev->dma = (unsigned char)-1;
2327*4882a593Smuzhiyun 
2328*4882a593Smuzhiyun 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-regs");
2329*4882a593Smuzhiyun 	if (!res)
2330*4882a593Smuzhiyun 		res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2331*4882a593Smuzhiyun 	if (!res) {
2332*4882a593Smuzhiyun 		ret = -ENODEV;
2333*4882a593Smuzhiyun 		goto out_free_netdev;
2334*4882a593Smuzhiyun 	}
2335*4882a593Smuzhiyun 
2336*4882a593Smuzhiyun 
2337*4882a593Smuzhiyun 	if (!request_mem_region(res->start, SMC_IO_EXTENT, CARDNAME)) {
2338*4882a593Smuzhiyun 		ret = -EBUSY;
2339*4882a593Smuzhiyun 		goto out_free_netdev;
2340*4882a593Smuzhiyun 	}
2341*4882a593Smuzhiyun 
2342*4882a593Smuzhiyun 	ndev->irq = platform_get_irq(pdev, 0);
2343*4882a593Smuzhiyun 	if (ndev->irq < 0) {
2344*4882a593Smuzhiyun 		ret = ndev->irq;
2345*4882a593Smuzhiyun 		goto out_release_io;
2346*4882a593Smuzhiyun 	}
2347*4882a593Smuzhiyun 	/*
2348*4882a593Smuzhiyun 	 * If this platform does not specify any special irqflags, or if
2349*4882a593Smuzhiyun 	 * the resource supplies a trigger, override the irqflags with
2350*4882a593Smuzhiyun 	 * the trigger flags from the resource.
2351*4882a593Smuzhiyun 	 */
2352*4882a593Smuzhiyun 	irq_resflags = irqd_get_trigger_type(irq_get_irq_data(ndev->irq));
2353*4882a593Smuzhiyun 	if (irq_flags == -1 || irq_resflags & IRQF_TRIGGER_MASK)
2354*4882a593Smuzhiyun 		irq_flags = irq_resflags & IRQF_TRIGGER_MASK;
2355*4882a593Smuzhiyun 
2356*4882a593Smuzhiyun 	ret = smc_request_attrib(pdev, ndev);
2357*4882a593Smuzhiyun 	if (ret)
2358*4882a593Smuzhiyun 		goto out_release_io;
2359*4882a593Smuzhiyun #if defined(CONFIG_ASSABET_NEPONSET)
2360*4882a593Smuzhiyun 	if (machine_is_assabet() && machine_has_neponset())
2361*4882a593Smuzhiyun 		neponset_ncr_set(NCR_ENET_OSC_EN);
2362*4882a593Smuzhiyun #endif
2363*4882a593Smuzhiyun 	platform_set_drvdata(pdev, ndev);
2364*4882a593Smuzhiyun 	ret = smc_enable_device(pdev);
2365*4882a593Smuzhiyun 	if (ret)
2366*4882a593Smuzhiyun 		goto out_release_attrib;
2367*4882a593Smuzhiyun 
2368*4882a593Smuzhiyun 	addr = ioremap(res->start, SMC_IO_EXTENT);
2369*4882a593Smuzhiyun 	if (!addr) {
2370*4882a593Smuzhiyun 		ret = -ENOMEM;
2371*4882a593Smuzhiyun 		goto out_release_attrib;
2372*4882a593Smuzhiyun 	}
2373*4882a593Smuzhiyun 
2374*4882a593Smuzhiyun #ifdef CONFIG_ARCH_PXA
2375*4882a593Smuzhiyun 	{
2376*4882a593Smuzhiyun 		struct smc_local *lp = netdev_priv(ndev);
2377*4882a593Smuzhiyun 		lp->device = &pdev->dev;
2378*4882a593Smuzhiyun 		lp->physaddr = res->start;
2379*4882a593Smuzhiyun 
2380*4882a593Smuzhiyun 	}
2381*4882a593Smuzhiyun #endif
2382*4882a593Smuzhiyun 
2383*4882a593Smuzhiyun 	ret = smc_probe(ndev, addr, irq_flags);
2384*4882a593Smuzhiyun 	if (ret != 0)
2385*4882a593Smuzhiyun 		goto out_iounmap;
2386*4882a593Smuzhiyun 
2387*4882a593Smuzhiyun 	smc_request_datacs(pdev, ndev);
2388*4882a593Smuzhiyun 
2389*4882a593Smuzhiyun 	return 0;
2390*4882a593Smuzhiyun 
2391*4882a593Smuzhiyun  out_iounmap:
2392*4882a593Smuzhiyun 	iounmap(addr);
2393*4882a593Smuzhiyun  out_release_attrib:
2394*4882a593Smuzhiyun 	smc_release_attrib(pdev, ndev);
2395*4882a593Smuzhiyun  out_release_io:
2396*4882a593Smuzhiyun 	release_mem_region(res->start, SMC_IO_EXTENT);
2397*4882a593Smuzhiyun  out_free_netdev:
2398*4882a593Smuzhiyun 	free_netdev(ndev);
2399*4882a593Smuzhiyun  out:
2400*4882a593Smuzhiyun 	pr_info("%s: not found (%d).\n", CARDNAME, ret);
2401*4882a593Smuzhiyun 
2402*4882a593Smuzhiyun 	return ret;
2403*4882a593Smuzhiyun }
2404*4882a593Smuzhiyun 
smc_drv_remove(struct platform_device * pdev)2405*4882a593Smuzhiyun static int smc_drv_remove(struct platform_device *pdev)
2406*4882a593Smuzhiyun {
2407*4882a593Smuzhiyun 	struct net_device *ndev = platform_get_drvdata(pdev);
2408*4882a593Smuzhiyun 	struct smc_local *lp = netdev_priv(ndev);
2409*4882a593Smuzhiyun 	struct resource *res;
2410*4882a593Smuzhiyun 
2411*4882a593Smuzhiyun 	unregister_netdev(ndev);
2412*4882a593Smuzhiyun 
2413*4882a593Smuzhiyun 	free_irq(ndev->irq, ndev);
2414*4882a593Smuzhiyun 
2415*4882a593Smuzhiyun #ifdef CONFIG_ARCH_PXA
2416*4882a593Smuzhiyun 	if (lp->dma_chan)
2417*4882a593Smuzhiyun 		dma_release_channel(lp->dma_chan);
2418*4882a593Smuzhiyun #endif
2419*4882a593Smuzhiyun 	iounmap(lp->base);
2420*4882a593Smuzhiyun 
2421*4882a593Smuzhiyun 	smc_release_datacs(pdev,ndev);
2422*4882a593Smuzhiyun 	smc_release_attrib(pdev,ndev);
2423*4882a593Smuzhiyun 
2424*4882a593Smuzhiyun 	res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "smc91x-regs");
2425*4882a593Smuzhiyun 	if (!res)
2426*4882a593Smuzhiyun 		res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2427*4882a593Smuzhiyun 	release_mem_region(res->start, SMC_IO_EXTENT);
2428*4882a593Smuzhiyun 
2429*4882a593Smuzhiyun 	free_netdev(ndev);
2430*4882a593Smuzhiyun 
2431*4882a593Smuzhiyun 	return 0;
2432*4882a593Smuzhiyun }
2433*4882a593Smuzhiyun 
smc_drv_suspend(struct device * dev)2434*4882a593Smuzhiyun static int smc_drv_suspend(struct device *dev)
2435*4882a593Smuzhiyun {
2436*4882a593Smuzhiyun 	struct net_device *ndev = dev_get_drvdata(dev);
2437*4882a593Smuzhiyun 
2438*4882a593Smuzhiyun 	if (ndev) {
2439*4882a593Smuzhiyun 		if (netif_running(ndev)) {
2440*4882a593Smuzhiyun 			netif_device_detach(ndev);
2441*4882a593Smuzhiyun 			smc_shutdown(ndev);
2442*4882a593Smuzhiyun 			smc_phy_powerdown(ndev);
2443*4882a593Smuzhiyun 		}
2444*4882a593Smuzhiyun 	}
2445*4882a593Smuzhiyun 	return 0;
2446*4882a593Smuzhiyun }
2447*4882a593Smuzhiyun 
smc_drv_resume(struct device * dev)2448*4882a593Smuzhiyun static int smc_drv_resume(struct device *dev)
2449*4882a593Smuzhiyun {
2450*4882a593Smuzhiyun 	struct platform_device *pdev = to_platform_device(dev);
2451*4882a593Smuzhiyun 	struct net_device *ndev = platform_get_drvdata(pdev);
2452*4882a593Smuzhiyun 
2453*4882a593Smuzhiyun 	if (ndev) {
2454*4882a593Smuzhiyun 		struct smc_local *lp = netdev_priv(ndev);
2455*4882a593Smuzhiyun 		smc_enable_device(pdev);
2456*4882a593Smuzhiyun 		if (netif_running(ndev)) {
2457*4882a593Smuzhiyun 			smc_reset(ndev);
2458*4882a593Smuzhiyun 			smc_enable(ndev);
2459*4882a593Smuzhiyun 			if (lp->phy_type != 0)
2460*4882a593Smuzhiyun 				smc_phy_configure(&lp->phy_configure);
2461*4882a593Smuzhiyun 			netif_device_attach(ndev);
2462*4882a593Smuzhiyun 		}
2463*4882a593Smuzhiyun 	}
2464*4882a593Smuzhiyun 	return 0;
2465*4882a593Smuzhiyun }
2466*4882a593Smuzhiyun 
2467*4882a593Smuzhiyun static const struct dev_pm_ops smc_drv_pm_ops = {
2468*4882a593Smuzhiyun 	.suspend	= smc_drv_suspend,
2469*4882a593Smuzhiyun 	.resume		= smc_drv_resume,
2470*4882a593Smuzhiyun };
2471*4882a593Smuzhiyun 
2472*4882a593Smuzhiyun static struct platform_driver smc_driver = {
2473*4882a593Smuzhiyun 	.probe		= smc_drv_probe,
2474*4882a593Smuzhiyun 	.remove		= smc_drv_remove,
2475*4882a593Smuzhiyun 	.driver		= {
2476*4882a593Smuzhiyun 		.name	= CARDNAME,
2477*4882a593Smuzhiyun 		.pm	= &smc_drv_pm_ops,
2478*4882a593Smuzhiyun 		.of_match_table   = of_match_ptr(smc91x_match),
2479*4882a593Smuzhiyun 		.acpi_match_table = smc91x_acpi_match,
2480*4882a593Smuzhiyun 	},
2481*4882a593Smuzhiyun };
2482*4882a593Smuzhiyun 
2483*4882a593Smuzhiyun module_platform_driver(smc_driver);
2484