fec_main.c 53.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4
/*
 * Fast Ethernet Controller (FEC) driver for Motorola MPC8xx.
 * Copyright (c) 1997 Dan Malek (dmalek@jlc.net)
 *
5
 * Right now, I am very wasteful with the buffers.  I allocate memory
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13 14
 * pages and then divide them into 2K frame buffers.  This way I know I
 * have buffers large enough to hold one frame within one buffer descriptor.
 * Once I get this working, I will use 64 or 128 byte CPM buffers, which
 * will be much more memory efficient and will easily handle lots of
 * small packets.
 *
 * Much better multiple PHY support by Magnus Damm.
 * Copyright (c) 2000 Ericsson Radio Systems AB.
 *
15 16
 * Support for FEC controller of ColdFire processors.
 * Copyright (c) 2001-2005 Greg Ungerer (gerg@snapgear.com)
17 18
 *
 * Bug fixes and cleanup by Philippe De Muyter (phdm@macqel.be)
19
 * Copyright (c) 2004-2006 Macq Electronique SA.
20
 *
S
Shawn Guo 已提交
21
 * Copyright (C) 2010-2011 Freescale Semiconductor, Inc.
L
Linus Torvalds 已提交
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/ptrace.h>
#include <linux/errno.h>
#include <linux/ioport.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
37 38 39 40 41 42
#include <linux/in.h>
#include <linux/ip.h>
#include <net/ip.h>
#include <linux/tcp.h>
#include <linux/udp.h>
#include <linux/icmp.h>
L
Linus Torvalds 已提交
43 44 45
#include <linux/spinlock.h>
#include <linux/workqueue.h>
#include <linux/bitops.h>
46 47
#include <linux/io.h>
#include <linux/irq.h>
48
#include <linux/clk.h>
49
#include <linux/platform_device.h>
50
#include <linux/phy.h>
51
#include <linux/fec.h>
52 53 54 55
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/of_gpio.h>
#include <linux/of_net.h>
56
#include <linux/regulator/consumer.h>
L
Linus Torvalds 已提交
57

58
#include <asm/cacheflush.h>
59

L
Linus Torvalds 已提交
60 61
#include "fec.h"

62
#if defined(CONFIG_ARM)
63 64 65 66 67
#define FEC_ALIGNMENT	0xf
#else
#define FEC_ALIGNMENT	0x3
#endif

68
#define DRIVER_NAME	"fec"
69
#define FEC_NAPI_WEIGHT	64
70

71 72 73 74 75 76 77 78
/* Pause frame feild and FIFO threshold */
#define FEC_ENET_FCE	(1 << 5)
#define FEC_ENET_RSEM_V	0x84
#define FEC_ENET_RSFL_V	16
#define FEC_ENET_RAEM_V	0x8
#define FEC_ENET_RAFL_V	0x8
#define FEC_ENET_OPD_V	0xFFF0

79 80 81 82
/* Controller is ENET-MAC */
#define FEC_QUIRK_ENET_MAC		(1 << 0)
/* Controller needs driver to swap frame */
#define FEC_QUIRK_SWAP_FRAME		(1 << 1)
83 84
/* Controller uses gasket */
#define FEC_QUIRK_USE_GASKET		(1 << 2)
S
Shawn Guo 已提交
85 86
/* Controller has GBIT support */
#define FEC_QUIRK_HAS_GBIT		(1 << 3)
87 88
/* Controller has extend desc buffer */
#define FEC_QUIRK_HAS_BUFDESC_EX	(1 << 4)
89 90
/* Controller has hardware checksum support */
#define FEC_QUIRK_HAS_CSUM		(1 << 5)
91 92 93

static struct platform_device_id fec_devtype[] = {
	{
94
		/* keep it for coldfire */
95 96
		.name = DRIVER_NAME,
		.driver_data = 0,
97 98 99 100 101 102
	}, {
		.name = "imx25-fec",
		.driver_data = FEC_QUIRK_USE_GASKET,
	}, {
		.name = "imx27-fec",
		.driver_data = 0,
103 104 105
	}, {
		.name = "imx28-fec",
		.driver_data = FEC_QUIRK_ENET_MAC | FEC_QUIRK_SWAP_FRAME,
S
Shawn Guo 已提交
106 107
	}, {
		.name = "imx6q-fec",
108
		.driver_data = FEC_QUIRK_ENET_MAC | FEC_QUIRK_HAS_GBIT |
109
				FEC_QUIRK_HAS_BUFDESC_EX | FEC_QUIRK_HAS_CSUM,
110
	}, {
111
		.name = "mvf600-fec",
112
		.driver_data = FEC_QUIRK_ENET_MAC,
113 114 115
	}, {
		/* sentinel */
	}
116
};
117
MODULE_DEVICE_TABLE(platform, fec_devtype);
118

119
enum imx_fec_type {
L
Lothar Waßmann 已提交
120
	IMX25_FEC = 1,	/* runs on i.mx25/50/53 */
121 122
	IMX27_FEC,	/* runs on i.mx27/35/51 */
	IMX28_FEC,
S
Shawn Guo 已提交
123
	IMX6Q_FEC,
124
	MVF600_FEC,
125 126 127 128 129 130
};

static const struct of_device_id fec_dt_ids[] = {
	{ .compatible = "fsl,imx25-fec", .data = &fec_devtype[IMX25_FEC], },
	{ .compatible = "fsl,imx27-fec", .data = &fec_devtype[IMX27_FEC], },
	{ .compatible = "fsl,imx28-fec", .data = &fec_devtype[IMX28_FEC], },
S
Shawn Guo 已提交
131
	{ .compatible = "fsl,imx6q-fec", .data = &fec_devtype[IMX6Q_FEC], },
132
	{ .compatible = "fsl,mvf600-fec", .data = &fec_devtype[MVF600_FEC], },
133 134 135 136
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, fec_dt_ids);

137 138 139
static unsigned char macaddr[ETH_ALEN];
module_param_array(macaddr, byte, NULL, 0);
MODULE_PARM_DESC(macaddr, "FEC Ethernet MAC address");
L
Linus Torvalds 已提交
140

141
#if defined(CONFIG_M5272)
L
Linus Torvalds 已提交
142 143 144 145 146 147 148 149 150 151
/*
 * Some hardware gets it MAC address out of local flash memory.
 * if this is non-zero then assume it is the address to get MAC from.
 */
#if defined(CONFIG_NETtel)
#define	FEC_FLASHMAC	0xf0006006
#elif defined(CONFIG_GILBARCONAP) || defined(CONFIG_SCALES)
#define	FEC_FLASHMAC	0xf0006000
#elif defined(CONFIG_CANCam)
#define	FEC_FLASHMAC	0xf0020000
152 153 154
#elif defined (CONFIG_M5272C3)
#define	FEC_FLASHMAC	(0xffe04000 + 4)
#elif defined(CONFIG_MOD5272)
L
Lothar Waßmann 已提交
155
#define FEC_FLASHMAC	0xffc0406b
L
Linus Torvalds 已提交
156 157 158
#else
#define	FEC_FLASHMAC	0
#endif
159
#endif /* CONFIG_M5272 */
160

161
#if (((RX_RING_SIZE + TX_RING_SIZE) * 32) > PAGE_SIZE)
162
#error "FEC: descriptor ring size constants too large"
163 164
#endif

S
Sascha Hauer 已提交
165
/* Interrupt events/masks. */
L
Linus Torvalds 已提交
166 167 168 169 170 171 172 173 174 175 176
#define FEC_ENET_HBERR	((uint)0x80000000)	/* Heartbeat error */
#define FEC_ENET_BABR	((uint)0x40000000)	/* Babbling receiver */
#define FEC_ENET_BABT	((uint)0x20000000)	/* Babbling transmitter */
#define FEC_ENET_GRA	((uint)0x10000000)	/* Graceful stop complete */
#define FEC_ENET_TXF	((uint)0x08000000)	/* Full frame transmitted */
#define FEC_ENET_TXB	((uint)0x04000000)	/* A buffer was transmitted */
#define FEC_ENET_RXF	((uint)0x02000000)	/* Full frame received */
#define FEC_ENET_RXB	((uint)0x01000000)	/* A buffer was received */
#define FEC_ENET_MII	((uint)0x00800000)	/* MII interrupt */
#define FEC_ENET_EBERR	((uint)0x00400000)	/* SDMA bus error */

177
#define FEC_DEFAULT_IMASK (FEC_ENET_TXF | FEC_ENET_RXF | FEC_ENET_MII)
178
#define FEC_RX_DISABLED_IMASK (FEC_DEFAULT_IMASK & (~FEC_ENET_RXF))
179

L
Linus Torvalds 已提交
180 181 182 183 184 185
/* The FEC stores dest/src/type, data, and checksum for receive packets.
 */
#define PKT_MAXBUF_SIZE		1518
#define PKT_MINBUF_SIZE		64
#define PKT_MAXBLR_SIZE		1520

186 187 188 189 190
/* FEC receive acceleration */
#define FEC_RACC_IPDIS		(1 << 1)
#define FEC_RACC_PRODIS		(1 << 2)
#define FEC_RACC_OPTIONS	(FEC_RACC_IPDIS | FEC_RACC_PRODIS)

L
Linus Torvalds 已提交
191
/*
192
 * The 5270/5271/5280/5282/532x RX control register also contains maximum frame
L
Linus Torvalds 已提交
193 194 195
 * size bits. Other FEC hardware does not, so we need to take that into
 * account when setting it.
 */
196
#if defined(CONFIG_M523x) || defined(CONFIG_M527x) || defined(CONFIG_M528x) || \
197
    defined(CONFIG_M520x) || defined(CONFIG_M532x) || defined(CONFIG_ARM)
L
Linus Torvalds 已提交
198 199 200 201 202
#define	OPT_FRAME_SIZE	(PKT_MAXBUF_SIZE << 16)
#else
#define	OPT_FRAME_SIZE	0
#endif

203 204 205 206 207 208 209 210
/* FEC MII MMFR bits definition */
#define FEC_MMFR_ST		(1 << 30)
#define FEC_MMFR_OP_READ	(2 << 28)
#define FEC_MMFR_OP_WRITE	(1 << 28)
#define FEC_MMFR_PA(v)		((v & 0x1f) << 23)
#define FEC_MMFR_RA(v)		((v & 0x1f) << 18)
#define FEC_MMFR_TA		(2 << 16)
#define FEC_MMFR_DATA(v)	(v & 0xffff)
L
Linus Torvalds 已提交
211

212
#define FEC_MII_TIMEOUT		30000 /* us */
L
Linus Torvalds 已提交
213

S
Sascha Hauer 已提交
214 215
/* Transmitter timeout */
#define TX_TIMEOUT (2 * HZ)
L
Linus Torvalds 已提交
216

217 218 219
#define FEC_PAUSE_FLAG_AUTONEG	0x1
#define FEC_PAUSE_FLAG_ENABLE	0x2

L
Lothar Waßmann 已提交
220 221
static int mii_cnt;

222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
static struct bufdesc *fec_enet_get_nextdesc(struct bufdesc *bdp, int is_ex)
{
	struct bufdesc_ex *ex = (struct bufdesc_ex *)bdp;
	if (is_ex)
		return (struct bufdesc *)(ex + 1);
	else
		return bdp + 1;
}

static struct bufdesc *fec_enet_get_prevdesc(struct bufdesc *bdp, int is_ex)
{
	struct bufdesc_ex *ex = (struct bufdesc_ex *)bdp;
	if (is_ex)
		return (struct bufdesc *)(ex - 1);
	else
		return bdp - 1;
}

240 241 242 243 244
static void *swap_buffer(void *bufaddr, int len)
{
	int i;
	unsigned int *buf = bufaddr;

F
Fabio Estevam 已提交
245
	for (i = 0; i < DIV_ROUND_UP(len, 4); i++, buf++)
246 247 248 249 250
		*buf = cpu_to_be32(*buf);

	return bufaddr;
}

251 252 253 254 255 256 257 258 259 260 261 262 263 264 265
static int
fec_enet_clear_csum(struct sk_buff *skb, struct net_device *ndev)
{
	/* Only run for packets requiring a checksum. */
	if (skb->ip_summed != CHECKSUM_PARTIAL)
		return 0;

	if (unlikely(skb_cow_head(skb, 0)))
		return -1;

	*(__sum16 *)(skb->head + skb->csum_start + skb->csum_offset) = 0;

	return 0;
}

266
static netdev_tx_t
267
fec_enet_start_xmit(struct sk_buff *skb, struct net_device *ndev)
L
Linus Torvalds 已提交
268
{
269
	struct fec_enet_private *fep = netdev_priv(ndev);
270 271
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
S
Sascha Hauer 已提交
272
	struct bufdesc *bdp;
273
	void *bufaddr;
274
	unsigned short	status;
275
	unsigned int index;
L
Linus Torvalds 已提交
276 277

	if (!fep->link) {
278
		/* Link is down or auto-negotiation is in progress. */
279
		return NETDEV_TX_BUSY;
L
Linus Torvalds 已提交
280 281 282 283 284
	}

	/* Fill in a Tx ring entry */
	bdp = fep->cur_tx;

285
	status = bdp->cbd_sc;
S
Sascha Hauer 已提交
286

287
	if (status & BD_ENET_TX_READY) {
L
Linus Torvalds 已提交
288
		/* Ooops.  All transmit buffers are full.  Bail out.
289
		 * This should not happen, since ndev->tbusy should be set.
L
Linus Torvalds 已提交
290
		 */
291
		netdev_err(ndev, "tx queue full!\n");
292
		return NETDEV_TX_BUSY;
L
Linus Torvalds 已提交
293 294
	}

295 296 297 298 299 300
	/* Protocol checksum off-load for TCP and UDP. */
	if (fec_enet_clear_csum(skb, ndev)) {
		kfree_skb(skb);
		return NETDEV_TX_OK;
	}

S
Sascha Hauer 已提交
301
	/* Clear all of the status flags */
302
	status &= ~BD_ENET_TX_STATS;
L
Linus Torvalds 已提交
303

S
Sascha Hauer 已提交
304
	/* Set buffer length and buffer pointer */
305
	bufaddr = skb->data;
L
Linus Torvalds 已提交
306 307 308
	bdp->cbd_datlen = skb->len;

	/*
S
Sascha Hauer 已提交
309 310 311
	 * On some FEC implementations data must be aligned on
	 * 4-byte boundaries. Use bounce buffers to copy data
	 * and get it aligned. Ugh.
L
Linus Torvalds 已提交
312
	 */
313 314 315 316 317 318
	if (fep->bufdesc_ex)
		index = (struct bufdesc_ex *)bdp -
			(struct bufdesc_ex *)fep->tx_bd_base;
	else
		index = bdp - fep->tx_bd_base;

319
	if (((unsigned long) bufaddr) & FEC_ALIGNMENT) {
320
		memcpy(fep->tx_bounce[index], skb->data, skb->len);
321
		bufaddr = fep->tx_bounce[index];
L
Linus Torvalds 已提交
322 323
	}

324 325 326 327 328 329 330 331
	/*
	 * Some design made an incorrect assumption on endian mode of
	 * the system that it's running on. As the result, driver has to
	 * swap every frame going to and coming from the controller.
	 */
	if (id_entry->driver_data & FEC_QUIRK_SWAP_FRAME)
		swap_buffer(bufaddr, skb->len);

S
Sascha Hauer 已提交
332
	/* Save skb pointer */
333
	fep->tx_skbuff[index] = skb;
334

L
Linus Torvalds 已提交
335 336 337
	/* Push the data cache so the CPM does not get stale memory
	 * data.
	 */
338
	bdp->cbd_bufaddr = dma_map_single(&fep->pdev->dev, bufaddr,
S
Sascha Hauer 已提交
339
			FEC_ENET_TX_FRSIZE, DMA_TO_DEVICE);
L
Linus Torvalds 已提交
340

341 342
	/* Send it on its way.  Tell FEC it's ready, interrupt when done,
	 * it's the last BD of the frame, and to put the CRC on the end.
L
Linus Torvalds 已提交
343
	 */
344
	status |= (BD_ENET_TX_READY | BD_ENET_TX_INTR
L
Linus Torvalds 已提交
345
			| BD_ENET_TX_LAST | BD_ENET_TX_TC);
346
	bdp->cbd_sc = status;
L
Linus Torvalds 已提交
347

348 349 350 351 352
	if (fep->bufdesc_ex) {

		struct bufdesc_ex *ebdp = (struct bufdesc_ex *)bdp;
		ebdp->cbd_bdu = 0;
		if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP &&
353
			fep->hwts_tx_en)) {
354
			ebdp->cbd_esc = (BD_ENET_TX_TS | BD_ENET_TX_INT);
355
			skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
356 357
		} else {
			ebdp->cbd_esc = BD_ENET_TX_INT;
358 359 360 361 362 363 364

			/* Enable protocol checksum flags
			 * We do not bother with the IP Checksum bits as they
			 * are done by the kernel
			 */
			if (skb->ip_summed == CHECKSUM_PARTIAL)
				ebdp->cbd_esc |= BD_ENET_TX_PINS;
365
		}
366
	}
S
Sascha Hauer 已提交
367 368
	/* If this was the last BD in the ring, start at the beginning again. */
	if (status & BD_ENET_TX_WRAP)
L
Linus Torvalds 已提交
369
		bdp = fep->tx_bd_base;
S
Sascha Hauer 已提交
370
	else
371
		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
L
Linus Torvalds 已提交
372

373 374 375
	fep->cur_tx = bdp;

	if (fep->cur_tx == fep->dirty_tx)
376
		netif_stop_queue(ndev);
L
Linus Torvalds 已提交
377

378 379
	/* Trigger transmission start */
	writel(0, fep->hwp + FEC_X_DES_ACTIVE);
L
Linus Torvalds 已提交
380

381 382
	skb_tx_timestamp(skb);

383
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
384 385
}

386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432
/* Init RX & TX buffer descriptors
 */
static void fec_enet_bd_init(struct net_device *dev)
{
	struct fec_enet_private *fep = netdev_priv(dev);
	struct bufdesc *bdp;
	unsigned int i;

	/* Initialize the receive buffer descriptors. */
	bdp = fep->rx_bd_base;
	for (i = 0; i < RX_RING_SIZE; i++) {

		/* Initialize the BD for every fragment in the page. */
		if (bdp->cbd_bufaddr)
			bdp->cbd_sc = BD_ENET_RX_EMPTY;
		else
			bdp->cbd_sc = 0;
		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
	}

	/* Set the last buffer to wrap */
	bdp = fec_enet_get_prevdesc(bdp, fep->bufdesc_ex);
	bdp->cbd_sc |= BD_SC_WRAP;

	fep->cur_rx = fep->rx_bd_base;

	/* ...and the same for transmit */
	bdp = fep->tx_bd_base;
	fep->cur_tx = bdp;
	for (i = 0; i < TX_RING_SIZE; i++) {

		/* Initialize the BD for every fragment in the page. */
		bdp->cbd_sc = 0;
		if (bdp->cbd_bufaddr && fep->tx_skbuff[i]) {
			dev_kfree_skb_any(fep->tx_skbuff[i]);
			fep->tx_skbuff[i] = NULL;
		}
		bdp->cbd_bufaddr = 0;
		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
	}

	/* Set the last buffer to wrap */
	bdp = fec_enet_get_prevdesc(bdp, fep->bufdesc_ex);
	bdp->cbd_sc |= BD_SC_WRAP;
	fep->dirty_tx = bdp;
}

433 434 435 436
/* This function is called to start or restart the FEC during a link
 * change.  This only happens when switching between half and full
 * duplex.
 */
L
Linus Torvalds 已提交
437
static void
438
fec_restart(struct net_device *ndev, int duplex)
L
Linus Torvalds 已提交
439
{
440
	struct fec_enet_private *fep = netdev_priv(ndev);
441 442 443
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
	int i;
444
	u32 val;
445 446
	u32 temp_mac[2];
	u32 rcntl = OPT_FRAME_SIZE | 0x04;
S
Shawn Guo 已提交
447
	u32 ecntl = 0x2; /* ETHEREN */
L
Linus Torvalds 已提交
448

449 450 451 452
	if (netif_running(ndev)) {
		netif_device_detach(ndev);
		napi_disable(&fep->napi);
		netif_stop_queue(ndev);
F
Fabio Estevam 已提交
453
		netif_tx_lock_bh(ndev);
454 455
	}

456 457 458
	/* Whack a reset.  We should wait for this. */
	writel(1, fep->hwp + FEC_ECNTRL);
	udelay(10);
L
Linus Torvalds 已提交
459

460 461 462 463 464 465 466 467 468
	/*
	 * enet-mac reset will reset mac address registers too,
	 * so need to reconfigure it.
	 */
	if (id_entry->driver_data & FEC_QUIRK_ENET_MAC) {
		memcpy(&temp_mac, ndev->dev_addr, ETH_ALEN);
		writel(cpu_to_be32(temp_mac[0]), fep->hwp + FEC_ADDR_LOW);
		writel(cpu_to_be32(temp_mac[1]), fep->hwp + FEC_ADDR_HIGH);
	}
L
Linus Torvalds 已提交
469

470 471
	/* Clear any outstanding interrupt. */
	writel(0xffc00000, fep->hwp + FEC_IEVENT);
L
Linus Torvalds 已提交
472

473 474 475 476 477 478 479
	/* Reset all multicast.	*/
	writel(0, fep->hwp + FEC_GRP_HASH_TABLE_HIGH);
	writel(0, fep->hwp + FEC_GRP_HASH_TABLE_LOW);
#ifndef CONFIG_M5272
	writel(0, fep->hwp + FEC_HASH_TABLE_HIGH);
	writel(0, fep->hwp + FEC_HASH_TABLE_LOW);
#endif
L
Linus Torvalds 已提交
480

481 482
	/* Set maximum receive buffer size. */
	writel(PKT_MAXBLR_SIZE, fep->hwp + FEC_R_BUFF_SIZE);
L
Linus Torvalds 已提交
483

484 485
	fec_enet_bd_init(ndev);

486 487
	/* Set receive and transmit descriptor base. */
	writel(fep->bd_dma, fep->hwp + FEC_R_DES_START);
488 489 490 491 492 493
	if (fep->bufdesc_ex)
		writel((unsigned long)fep->bd_dma + sizeof(struct bufdesc_ex)
			* RX_RING_SIZE, fep->hwp + FEC_X_DES_START);
	else
		writel((unsigned long)fep->bd_dma + sizeof(struct bufdesc)
			* RX_RING_SIZE,	fep->hwp + FEC_X_DES_START);
494 495 496 497 498 499


	for (i = 0; i <= TX_RING_MOD_MASK; i++) {
		if (fep->tx_skbuff[i]) {
			dev_kfree_skb_any(fep->tx_skbuff[i]);
			fep->tx_skbuff[i] = NULL;
L
Linus Torvalds 已提交
500
		}
501
	}
502

503 504
	/* Enable MII mode */
	if (duplex) {
505
		/* FD enable */
506 507
		writel(0x04, fep->hwp + FEC_X_CNTRL);
	} else {
508 509
		/* No Rcv on Xmit */
		rcntl |= 0x02;
510 511
		writel(0x0, fep->hwp + FEC_X_CNTRL);
	}
512

513 514 515 516 517
	fep->full_duplex = duplex;

	/* Set MII speed */
	writel(fep->phy_speed, fep->hwp + FEC_MII_SPEED);

518 519 520 521 522 523 524 525
	/* set RX checksum */
	val = readl(fep->hwp + FEC_RACC);
	if (fep->csum_flags & FLAG_RX_CSUM_ENABLED)
		val |= FEC_RACC_OPTIONS;
	else
		val &= ~FEC_RACC_OPTIONS;
	writel(val, fep->hwp + FEC_RACC);

526 527 528 529 530
	/*
	 * The phy interface and speed need to get configured
	 * differently on enet-mac.
	 */
	if (id_entry->driver_data & FEC_QUIRK_ENET_MAC) {
531 532
		/* Enable flow control and length check */
		rcntl |= 0x40000000 | 0x00000020;
533

S
Shawn Guo 已提交
534 535 536 537
		/* RGMII, RMII or MII */
		if (fep->phy_interface == PHY_INTERFACE_MODE_RGMII)
			rcntl |= (1 << 6);
		else if (fep->phy_interface == PHY_INTERFACE_MODE_RMII)
538
			rcntl |= (1 << 8);
539
		else
540
			rcntl &= ~(1 << 8);
541

S
Shawn Guo 已提交
542 543 544 545 546 547 548 549 550
		/* 1G, 100M or 10M */
		if (fep->phy_dev) {
			if (fep->phy_dev->speed == SPEED_1000)
				ecntl |= (1 << 5);
			else if (fep->phy_dev->speed == SPEED_100)
				rcntl &= ~(1 << 9);
			else
				rcntl |= (1 << 9);
		}
551 552
	} else {
#ifdef FEC_MIIGSK_ENR
553
		if (id_entry->driver_data & FEC_QUIRK_USE_GASKET) {
554
			u32 cfgr;
555 556 557 558 559 560 561 562
			/* disable the gasket and wait */
			writel(0, fep->hwp + FEC_MIIGSK_ENR);
			while (readl(fep->hwp + FEC_MIIGSK_ENR) & 4)
				udelay(1);

			/*
			 * configure the gasket:
			 *   RMII, 50 MHz, no loopback, no echo
563
			 *   MII, 25 MHz, no loopback, no echo
564
			 */
565 566 567 568 569
			cfgr = (fep->phy_interface == PHY_INTERFACE_MODE_RMII)
				? BM_MIIGSK_CFGR_RMII : BM_MIIGSK_CFGR_MII;
			if (fep->phy_dev && fep->phy_dev->speed == SPEED_10)
				cfgr |= BM_MIIGSK_CFGR_FRCONT_10M;
			writel(cfgr, fep->hwp + FEC_MIIGSK_CFGR);
570 571 572

			/* re-enable the gasket */
			writel(2, fep->hwp + FEC_MIIGSK_ENR);
573
		}
574 575
#endif
	}
576 577 578 579 580 581 582

	/* enable pause frame*/
	if ((fep->pause_flag & FEC_PAUSE_FLAG_ENABLE) ||
	    ((fep->pause_flag & FEC_PAUSE_FLAG_AUTONEG) &&
	     fep->phy_dev && fep->phy_dev->pause)) {
		rcntl |= FEC_ENET_FCE;

583
		/* set FIFO threshold parameter to reduce overrun */
584 585 586 587 588 589 590 591 592 593 594
		writel(FEC_ENET_RSEM_V, fep->hwp + FEC_R_FIFO_RSEM);
		writel(FEC_ENET_RSFL_V, fep->hwp + FEC_R_FIFO_RSFL);
		writel(FEC_ENET_RAEM_V, fep->hwp + FEC_R_FIFO_RAEM);
		writel(FEC_ENET_RAFL_V, fep->hwp + FEC_R_FIFO_RAFL);

		/* OPD */
		writel(FEC_ENET_OPD_V, fep->hwp + FEC_OPD);
	} else {
		rcntl &= ~FEC_ENET_FCE;
	}

595
	writel(rcntl, fep->hwp + FEC_R_CNTRL);
596

S
Shawn Guo 已提交
597 598 599 600 601 602 603
	if (id_entry->driver_data & FEC_QUIRK_ENET_MAC) {
		/* enable ENET endian swap */
		ecntl |= (1 << 8);
		/* enable ENET store and forward mode */
		writel(1 << 8, fep->hwp + FEC_X_WMRK);
	}

604 605
	if (fep->bufdesc_ex)
		ecntl |= (1 << 4);
606

607
	/* And last, enable the transmit and receive processing */
S
Shawn Guo 已提交
608
	writel(ecntl, fep->hwp + FEC_ECNTRL);
609 610
	writel(0, fep->hwp + FEC_R_DES_ACTIVE);

611 612 613
	if (fep->bufdesc_ex)
		fec_ptp_start_cyclecounter(ndev);

614 615
	/* Enable interrupts we wish to service */
	writel(FEC_DEFAULT_IMASK, fep->hwp + FEC_IMASK);
616 617

	if (netif_running(ndev)) {
F
Fabio Estevam 已提交
618
		netif_tx_unlock_bh(ndev);
619
		netif_wake_queue(ndev);
620 621
		napi_enable(&fep->napi);
		netif_device_attach(ndev);
622
	}
623 624 625 626 627 628
}

static void
fec_stop(struct net_device *ndev)
{
	struct fec_enet_private *fep = netdev_priv(ndev);
S
Shawn Guo 已提交
629 630
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
631
	u32 rmii_mode = readl(fep->hwp + FEC_R_CNTRL) & (1 << 8);
632 633 634 635 636 637

	/* We cannot expect a graceful transmit stop without link !!! */
	if (fep->link) {
		writel(1, fep->hwp + FEC_X_CNTRL); /* Graceful transmit stop */
		udelay(10);
		if (!(readl(fep->hwp + FEC_IEVENT) & FEC_ENET_GRA))
638
			netdev_err(ndev, "Graceful transmit stop did not complete!\n");
639 640 641 642 643 644 645
	}

	/* Whack a reset.  We should wait for this. */
	writel(1, fep->hwp + FEC_ECNTRL);
	udelay(10);
	writel(fep->phy_speed, fep->hwp + FEC_MII_SPEED);
	writel(FEC_DEFAULT_IMASK, fep->hwp + FEC_IMASK);
S
Shawn Guo 已提交
646 647

	/* We have to keep ENET enabled to have MII interrupt stay working */
648
	if (id_entry->driver_data & FEC_QUIRK_ENET_MAC) {
S
Shawn Guo 已提交
649
		writel(2, fep->hwp + FEC_ECNTRL);
650 651
		writel(rmii_mode, fep->hwp + FEC_R_CNTRL);
	}
L
Linus Torvalds 已提交
652 653 654
}


655 656 657 658 659 660 661
static void
fec_timeout(struct net_device *ndev)
{
	struct fec_enet_private *fep = netdev_priv(ndev);

	ndev->stats.tx_errors++;

662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
	fep->delay_work.timeout = true;
	schedule_delayed_work(&(fep->delay_work.delay_work), 0);
}

static void fec_enet_work(struct work_struct *work)
{
	struct fec_enet_private *fep =
		container_of(work,
			     struct fec_enet_private,
			     delay_work.delay_work.work);

	if (fep->delay_work.timeout) {
		fep->delay_work.timeout = false;
		fec_restart(fep->netdev, fep->full_duplex);
		netif_wake_queue(fep->netdev);
	}
678 679
}

L
Linus Torvalds 已提交
680
static void
681
fec_enet_tx(struct net_device *ndev)
L
Linus Torvalds 已提交
682 683
{
	struct	fec_enet_private *fep;
S
Sascha Hauer 已提交
684
	struct bufdesc *bdp;
685
	unsigned short status;
L
Linus Torvalds 已提交
686
	struct	sk_buff	*skb;
687
	int	index = 0;
L
Linus Torvalds 已提交
688

689
	fep = netdev_priv(ndev);
L
Linus Torvalds 已提交
690 691
	bdp = fep->dirty_tx;

692 693 694 695 696 697
	/* get next bdp of dirty_tx */
	if (bdp->cbd_sc & BD_ENET_TX_WRAP)
		bdp = fep->tx_bd_base;
	else
		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);

698
	while (((status = bdp->cbd_sc) & BD_ENET_TX_READY) == 0) {
699 700 701

		/* current queue is empty */
		if (bdp == fep->cur_tx)
S
Sascha Hauer 已提交
702 703
			break;

704 705 706 707 708 709
		if (fep->bufdesc_ex)
			index = (struct bufdesc_ex *)bdp -
				(struct bufdesc_ex *)fep->tx_bd_base;
		else
			index = bdp - fep->tx_bd_base;

710 711
		dma_unmap_single(&fep->pdev->dev, bdp->cbd_bufaddr,
				FEC_ENET_TX_FRSIZE, DMA_TO_DEVICE);
S
Sascha Hauer 已提交
712
		bdp->cbd_bufaddr = 0;
L
Linus Torvalds 已提交
713

714 715
		skb = fep->tx_skbuff[index];

L
Linus Torvalds 已提交
716
		/* Check for errors. */
717
		if (status & (BD_ENET_TX_HB | BD_ENET_TX_LC |
L
Linus Torvalds 已提交
718 719
				   BD_ENET_TX_RL | BD_ENET_TX_UN |
				   BD_ENET_TX_CSL)) {
720
			ndev->stats.tx_errors++;
721
			if (status & BD_ENET_TX_HB)  /* No heartbeat */
722
				ndev->stats.tx_heartbeat_errors++;
723
			if (status & BD_ENET_TX_LC)  /* Late collision */
724
				ndev->stats.tx_window_errors++;
725
			if (status & BD_ENET_TX_RL)  /* Retrans limit */
726
				ndev->stats.tx_aborted_errors++;
727
			if (status & BD_ENET_TX_UN)  /* Underrun */
728
				ndev->stats.tx_fifo_errors++;
729
			if (status & BD_ENET_TX_CSL) /* Carrier lost */
730
				ndev->stats.tx_carrier_errors++;
L
Linus Torvalds 已提交
731
		} else {
732
			ndev->stats.tx_packets++;
L
Linus Torvalds 已提交
733 734
		}

735 736
		if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_IN_PROGRESS) &&
			fep->bufdesc_ex) {
737 738
			struct skb_shared_hwtstamps shhwtstamps;
			unsigned long flags;
739
			struct bufdesc_ex *ebdp = (struct bufdesc_ex *)bdp;
740 741 742 743

			memset(&shhwtstamps, 0, sizeof(shhwtstamps));
			spin_lock_irqsave(&fep->tmreg_lock, flags);
			shhwtstamps.hwtstamp = ns_to_ktime(
744
				timecounter_cyc2time(&fep->tc, ebdp->ts));
745 746 747
			spin_unlock_irqrestore(&fep->tmreg_lock, flags);
			skb_tstamp_tx(skb, &shhwtstamps);
		}
748

749
		if (status & BD_ENET_TX_READY)
750
			netdev_err(ndev, "HEY! Enet xmit interrupt and TX_READY\n");
S
Sascha Hauer 已提交
751

L
Linus Torvalds 已提交
752 753 754
		/* Deferred means some collisions occurred during transmit,
		 * but we eventually sent the packet OK.
		 */
755
		if (status & BD_ENET_TX_DEF)
756
			ndev->stats.collisions++;
757

S
Sascha Hauer 已提交
758
		/* Free the sk buffer associated with this last transmit */
L
Linus Torvalds 已提交
759
		dev_kfree_skb_any(skb);
760 761 762
		fep->tx_skbuff[index] = NULL;

		fep->dirty_tx = bdp;
763

S
Sascha Hauer 已提交
764
		/* Update pointer to next buffer descriptor to be transmitted */
765
		if (status & BD_ENET_TX_WRAP)
L
Linus Torvalds 已提交
766 767
			bdp = fep->tx_bd_base;
		else
768
			bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
769

S
Sascha Hauer 已提交
770
		/* Since we have freed up a buffer, the ring is no longer full
L
Linus Torvalds 已提交
771
		 */
772
		if (fep->dirty_tx != fep->cur_tx) {
773 774
			if (netif_queue_stopped(ndev))
				netif_wake_queue(ndev);
L
Linus Torvalds 已提交
775 776
		}
	}
777
	return;
L
Linus Torvalds 已提交
778 779 780 781 782 783 784 785
}


/* During a receive, the cur_rx points to the current incoming buffer.
 * When we update through the ring, if the next incoming buffer has
 * not been given to the system, we just set the empty indicator,
 * effectively tossing the packet.
 */
786 787
static int
fec_enet_rx(struct net_device *ndev, int budget)
L
Linus Torvalds 已提交
788
{
789
	struct fec_enet_private *fep = netdev_priv(ndev);
790 791
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
S
Sascha Hauer 已提交
792
	struct bufdesc *bdp;
793
	unsigned short status;
L
Linus Torvalds 已提交
794 795 796
	struct	sk_buff	*skb;
	ushort	pkt_len;
	__u8 *data;
797
	int	pkt_received = 0;
798

799 800
#ifdef CONFIG_M532x
	flush_cache_all();
801
#endif
L
Linus Torvalds 已提交
802 803 804 805 806 807

	/* First, grab all of the stats for the incoming packet.
	 * These get messed up if we get called due to a busy condition.
	 */
	bdp = fep->cur_rx;

S
Sascha Hauer 已提交
808
	while (!((status = bdp->cbd_sc) & BD_ENET_RX_EMPTY)) {
L
Linus Torvalds 已提交
809

810 811 812 813
		if (pkt_received >= budget)
			break;
		pkt_received++;

S
Sascha Hauer 已提交
814 815 816 817
		/* Since we have allocated space to hold a complete frame,
		 * the last indicator should be set.
		 */
		if ((status & BD_ENET_RX_LAST) == 0)
818
			netdev_err(ndev, "rcv is not +last\n");
L
Linus Torvalds 已提交
819

S
Sascha Hauer 已提交
820 821
		if (!fep->opened)
			goto rx_processing_done;
L
Linus Torvalds 已提交
822

S
Sascha Hauer 已提交
823 824
		/* Check for errors. */
		if (status & (BD_ENET_RX_LG | BD_ENET_RX_SH | BD_ENET_RX_NO |
L
Linus Torvalds 已提交
825
			   BD_ENET_RX_CR | BD_ENET_RX_OV)) {
826
			ndev->stats.rx_errors++;
S
Sascha Hauer 已提交
827 828
			if (status & (BD_ENET_RX_LG | BD_ENET_RX_SH)) {
				/* Frame too long or too short. */
829
				ndev->stats.rx_length_errors++;
S
Sascha Hauer 已提交
830 831
			}
			if (status & BD_ENET_RX_NO)	/* Frame alignment */
832
				ndev->stats.rx_frame_errors++;
S
Sascha Hauer 已提交
833
			if (status & BD_ENET_RX_CR)	/* CRC Error */
834
				ndev->stats.rx_crc_errors++;
S
Sascha Hauer 已提交
835
			if (status & BD_ENET_RX_OV)	/* FIFO overrun */
836
				ndev->stats.rx_fifo_errors++;
L
Linus Torvalds 已提交
837 838
		}

S
Sascha Hauer 已提交
839 840 841 842 843
		/* Report late collisions as a frame error.
		 * On this error, the BD is closed, but we don't know what we
		 * have in the buffer.  So, just drop this frame on the floor.
		 */
		if (status & BD_ENET_RX_CL) {
844 845
			ndev->stats.rx_errors++;
			ndev->stats.rx_frame_errors++;
S
Sascha Hauer 已提交
846 847
			goto rx_processing_done;
		}
L
Linus Torvalds 已提交
848

S
Sascha Hauer 已提交
849
		/* Process the incoming frame. */
850
		ndev->stats.rx_packets++;
S
Sascha Hauer 已提交
851
		pkt_len = bdp->cbd_datlen;
852
		ndev->stats.rx_bytes += pkt_len;
S
Sascha Hauer 已提交
853
		data = (__u8*)__va(bdp->cbd_bufaddr);
L
Linus Torvalds 已提交
854

855 856
		dma_unmap_single(&fep->pdev->dev, bdp->cbd_bufaddr,
				FEC_ENET_TX_FRSIZE, DMA_FROM_DEVICE);
857

858 859 860
		if (id_entry->driver_data & FEC_QUIRK_SWAP_FRAME)
			swap_buffer(data, pkt_len);

S
Sascha Hauer 已提交
861 862 863 864 865
		/* This does 16 byte alignment, exactly what we need.
		 * The packet length includes FCS, but we don't want to
		 * include that when passing upstream as it messes up
		 * bridging applications.
		 */
866
		skb = netdev_alloc_skb(ndev, pkt_len - 4 + NET_IP_ALIGN);
L
Linus Torvalds 已提交
867

S
Sascha Hauer 已提交
868
		if (unlikely(!skb)) {
869
			ndev->stats.rx_dropped++;
S
Sascha Hauer 已提交
870
		} else {
S
Sascha Hauer 已提交
871
			skb_reserve(skb, NET_IP_ALIGN);
S
Sascha Hauer 已提交
872 873
			skb_put(skb, pkt_len - 4);	/* Make room */
			skb_copy_to_linear_data(skb, data, pkt_len - 4);
874
			skb->protocol = eth_type_trans(skb, ndev);
875

876
			/* Get receive timestamp from the skb */
877
			if (fep->hwts_rx_en && fep->bufdesc_ex) {
878 879 880
				struct skb_shared_hwtstamps *shhwtstamps =
							    skb_hwtstamps(skb);
				unsigned long flags;
881 882
				struct bufdesc_ex *ebdp =
					(struct bufdesc_ex *)bdp;
883 884 885 886 887

				memset(shhwtstamps, 0, sizeof(*shhwtstamps));

				spin_lock_irqsave(&fep->tmreg_lock, flags);
				shhwtstamps->hwtstamp = ns_to_ktime(
888
				    timecounter_cyc2time(&fep->tc, ebdp->ts));
889 890
				spin_unlock_irqrestore(&fep->tmreg_lock, flags);
			}
891

892 893 894 895 896 897 898 899 900 901 902 903
			if (fep->bufdesc_ex &&
				(fep->csum_flags & FLAG_RX_CSUM_ENABLED)) {
				struct bufdesc_ex *ebdp =
					(struct bufdesc_ex *)bdp;
				if (!(ebdp->cbd_esc & FLAG_RX_CSUM_ERROR)) {
					/* don't check it */
					skb->ip_summed = CHECKSUM_UNNECESSARY;
				} else {
					skb_checksum_none_assert(skb);
				}
			}

904
			if (!skb_defer_rx_timestamp(skb))
905
				napi_gro_receive(&fep->napi, skb);
S
Sascha Hauer 已提交
906
		}
S
Sascha Hauer 已提交
907

908 909
		bdp->cbd_bufaddr = dma_map_single(&fep->pdev->dev, data,
				FEC_ENET_TX_FRSIZE, DMA_FROM_DEVICE);
S
Sascha Hauer 已提交
910 911 912
rx_processing_done:
		/* Clear the status flags for this buffer */
		status &= ~BD_ENET_RX_STATS;
L
Linus Torvalds 已提交
913

S
Sascha Hauer 已提交
914 915 916
		/* Mark the buffer empty */
		status |= BD_ENET_RX_EMPTY;
		bdp->cbd_sc = status;
917

918 919 920 921 922 923 924
		if (fep->bufdesc_ex) {
			struct bufdesc_ex *ebdp = (struct bufdesc_ex *)bdp;

			ebdp->cbd_esc = BD_ENET_RX_INT;
			ebdp->cbd_prot = 0;
			ebdp->cbd_bdu = 0;
		}
925

S
Sascha Hauer 已提交
926 927 928 929
		/* Update BD pointer to next entry */
		if (status & BD_ENET_RX_WRAP)
			bdp = fep->rx_bd_base;
		else
930
			bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
S
Sascha Hauer 已提交
931 932 933 934 935 936
		/* Doing this here will keep the FEC running while we process
		 * incoming frames.  On a heavily loaded network, we should be
		 * able to keep up at the expense of system resources.
		 */
		writel(0, fep->hwp + FEC_R_DES_ACTIVE);
	}
S
Sascha Hauer 已提交
937
	fep->cur_rx = bdp;
L
Linus Torvalds 已提交
938

939
	return pkt_received;
L
Linus Torvalds 已提交
940 941
}

942 943 944 945 946 947 948 949 950 951 952 953
static irqreturn_t
fec_enet_interrupt(int irq, void *dev_id)
{
	struct net_device *ndev = dev_id;
	struct fec_enet_private *fep = netdev_priv(ndev);
	uint int_events;
	irqreturn_t ret = IRQ_NONE;

	do {
		int_events = readl(fep->hwp + FEC_IEVENT);
		writel(int_events, fep->hwp + FEC_IEVENT);

954
		if (int_events & (FEC_ENET_RXF | FEC_ENET_TXF)) {
955
			ret = IRQ_HANDLED;
956 957 958 959 960 961 962

			/* Disable the RX interrupt */
			if (napi_schedule_prep(&fep->napi)) {
				writel(FEC_RX_DISABLED_IMASK,
					fep->hwp + FEC_IMASK);
				__napi_schedule(&fep->napi);
			}
963 964 965 966 967 968 969 970 971 972 973
		}

		if (int_events & FEC_ENET_MII) {
			ret = IRQ_HANDLED;
			complete(&fep->mdio_done);
		}
	} while (int_events);

	return ret;
}

974 975 976 977 978
static int fec_enet_rx_napi(struct napi_struct *napi, int budget)
{
	struct net_device *ndev = napi->dev;
	int pkts = fec_enet_rx(ndev, budget);
	struct fec_enet_private *fep = netdev_priv(ndev);
979

980 981
	fec_enet_tx(ndev);

982 983 984 985 986 987
	if (pkts < budget) {
		napi_complete(napi);
		writel(FEC_DEFAULT_IMASK, fep->hwp + FEC_IMASK);
	}
	return pkts;
}
988

989
/* ------------------------------------------------------------------------- */
990
static void fec_get_mac(struct net_device *ndev)
L
Linus Torvalds 已提交
991
{
992
	struct fec_enet_private *fep = netdev_priv(ndev);
993
	struct fec_platform_data *pdata = fep->pdev->dev.platform_data;
994
	unsigned char *iap, tmpaddr[ETH_ALEN];
L
Linus Torvalds 已提交
995

996 997 998 999 1000 1001 1002 1003
	/*
	 * try to get mac address in following order:
	 *
	 * 1) module parameter via kernel command line in form
	 *    fec.macaddr=0x00,0x04,0x9f,0x01,0x30,0xe0
	 */
	iap = macaddr;

1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015
	/*
	 * 2) from device tree data
	 */
	if (!is_valid_ether_addr(iap)) {
		struct device_node *np = fep->pdev->dev.of_node;
		if (np) {
			const char *mac = of_get_mac_address(np);
			if (mac)
				iap = (unsigned char *) mac;
		}
	}

1016
	/*
1017
	 * 3) from flash or fuse (via platform data)
1018 1019 1020 1021 1022 1023 1024
	 */
	if (!is_valid_ether_addr(iap)) {
#ifdef CONFIG_M5272
		if (FEC_FLASHMAC)
			iap = (unsigned char *)FEC_FLASHMAC;
#else
		if (pdata)
1025
			iap = (unsigned char *)&pdata->mac;
1026 1027 1028 1029
#endif
	}

	/*
1030
	 * 4) FEC mac registers set by bootloader
1031 1032 1033 1034 1035 1036
	 */
	if (!is_valid_ether_addr(iap)) {
		*((unsigned long *) &tmpaddr[0]) =
			be32_to_cpu(readl(fep->hwp + FEC_ADDR_LOW));
		*((unsigned short *) &tmpaddr[4]) =
			be16_to_cpu(readl(fep->hwp + FEC_ADDR_HIGH) >> 16);
1037
		iap = &tmpaddr[0];
L
Linus Torvalds 已提交
1038 1039
	}

1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
	/*
	 * 5) random mac address
	 */
	if (!is_valid_ether_addr(iap)) {
		/* Report it and use a random ethernet address instead */
		netdev_err(ndev, "Invalid MAC address: %pM\n", iap);
		eth_hw_addr_random(ndev);
		netdev_info(ndev, "Using random MAC address: %pM\n",
			    ndev->dev_addr);
		return;
	}

1052
	memcpy(ndev->dev_addr, iap, ETH_ALEN);
L
Linus Torvalds 已提交
1053

1054 1055
	/* Adjust MAC if using macaddr */
	if (iap == macaddr)
S
Shawn Guo 已提交
1056
		 ndev->dev_addr[ETH_ALEN-1] = macaddr[ETH_ALEN-1] + fep->dev_id;
L
Linus Torvalds 已提交
1057 1058
}

1059
/* ------------------------------------------------------------------------- */
L
Linus Torvalds 已提交
1060

1061 1062 1063
/*
 * Phy section
 */
1064
static void fec_enet_adjust_link(struct net_device *ndev)
L
Linus Torvalds 已提交
1065
{
1066
	struct fec_enet_private *fep = netdev_priv(ndev);
1067 1068
	struct phy_device *phy_dev = fep->phy_dev;
	int status_change = 0;
L
Linus Torvalds 已提交
1069

1070 1071 1072
	/* Prevent a state halted on mii error */
	if (fep->mii_timeout && phy_dev->state == PHY_HALTED) {
		phy_dev->state = PHY_RESUMING;
1073
		return;
1074
	}
L
Linus Torvalds 已提交
1075

1076
	if (phy_dev->link) {
1077
		if (!fep->link) {
1078
			fep->link = phy_dev->link;
1079 1080
			status_change = 1;
		}
L
Linus Torvalds 已提交
1081

1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
		if (fep->full_duplex != phy_dev->duplex)
			status_change = 1;

		if (phy_dev->speed != fep->speed) {
			fep->speed = phy_dev->speed;
			status_change = 1;
		}

		/* if any of the above changed restart the FEC */
		if (status_change)
1092
			fec_restart(ndev, phy_dev->duplex);
1093 1094
	} else {
		if (fep->link) {
1095
			fec_stop(ndev);
1096
			fep->link = phy_dev->link;
1097 1098
			status_change = 1;
		}
L
Linus Torvalds 已提交
1099
	}
1100

1101 1102 1103
	if (status_change)
		phy_print_status(phy_dev);
}
L
Linus Torvalds 已提交
1104

1105
static int fec_enet_mdio_read(struct mii_bus *bus, int mii_id, int regnum)
L
Linus Torvalds 已提交
1106
{
1107
	struct fec_enet_private *fep = bus->priv;
1108
	unsigned long time_left;
L
Linus Torvalds 已提交
1109

1110
	fep->mii_timeout = 0;
1111
	init_completion(&fep->mdio_done);
1112 1113 1114 1115 1116 1117 1118

	/* start a read op */
	writel(FEC_MMFR_ST | FEC_MMFR_OP_READ |
		FEC_MMFR_PA(mii_id) | FEC_MMFR_RA(regnum) |
		FEC_MMFR_TA, fep->hwp + FEC_MII_DATA);

	/* wait for end of transfer */
1119 1120 1121 1122
	time_left = wait_for_completion_timeout(&fep->mdio_done,
			usecs_to_jiffies(FEC_MII_TIMEOUT));
	if (time_left == 0) {
		fep->mii_timeout = 1;
1123
		netdev_err(fep->netdev, "MDIO read timeout\n");
1124
		return -ETIMEDOUT;
L
Linus Torvalds 已提交
1125 1126
	}

1127 1128
	/* return value */
	return FEC_MMFR_DATA(readl(fep->hwp + FEC_MII_DATA));
1129
}
1130

1131 1132
static int fec_enet_mdio_write(struct mii_bus *bus, int mii_id, int regnum,
			   u16 value)
L
Linus Torvalds 已提交
1133
{
1134
	struct fec_enet_private *fep = bus->priv;
1135
	unsigned long time_left;
L
Linus Torvalds 已提交
1136

1137
	fep->mii_timeout = 0;
1138
	init_completion(&fep->mdio_done);
L
Linus Torvalds 已提交
1139

1140 1141
	/* start a write op */
	writel(FEC_MMFR_ST | FEC_MMFR_OP_WRITE |
1142 1143 1144 1145 1146
		FEC_MMFR_PA(mii_id) | FEC_MMFR_RA(regnum) |
		FEC_MMFR_TA | FEC_MMFR_DATA(value),
		fep->hwp + FEC_MII_DATA);

	/* wait for end of transfer */
1147 1148 1149 1150
	time_left = wait_for_completion_timeout(&fep->mdio_done,
			usecs_to_jiffies(FEC_MII_TIMEOUT));
	if (time_left == 0) {
		fep->mii_timeout = 1;
1151
		netdev_err(fep->netdev, "MDIO write timeout\n");
1152
		return -ETIMEDOUT;
1153
	}
L
Linus Torvalds 已提交
1154

1155 1156
	return 0;
}
L
Linus Torvalds 已提交
1157

1158
static int fec_enet_mdio_reset(struct mii_bus *bus)
L
Linus Torvalds 已提交
1159
{
1160
	return 0;
L
Linus Torvalds 已提交
1161 1162
}

1163
static int fec_enet_mii_probe(struct net_device *ndev)
1164
{
1165
	struct fec_enet_private *fep = netdev_priv(ndev);
S
Shawn Guo 已提交
1166 1167
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
1168
	struct phy_device *phy_dev = NULL;
1169 1170 1171
	char mdio_bus_id[MII_BUS_ID_SIZE];
	char phy_name[MII_BUS_ID_SIZE + 3];
	int phy_id;
S
Shawn Guo 已提交
1172
	int dev_id = fep->dev_id;
1173

1174 1175
	fep->phy_dev = NULL;

1176 1177 1178 1179 1180 1181 1182 1183
	/* check for attached phy */
	for (phy_id = 0; (phy_id < PHY_MAX_ADDR); phy_id++) {
		if ((fep->mii_bus->phy_mask & (1 << phy_id)))
			continue;
		if (fep->mii_bus->phy_map[phy_id] == NULL)
			continue;
		if (fep->mii_bus->phy_map[phy_id]->phy_id == 0)
			continue;
1184 1185
		if (dev_id--)
			continue;
1186 1187
		strncpy(mdio_bus_id, fep->mii_bus->id, MII_BUS_ID_SIZE);
		break;
1188
	}
L
Linus Torvalds 已提交
1189

1190
	if (phy_id >= PHY_MAX_ADDR) {
1191
		netdev_info(ndev, "no PHY, assuming direct connection to switch\n");
1192
		strncpy(mdio_bus_id, "fixed-0", MII_BUS_ID_SIZE);
1193 1194 1195
		phy_id = 0;
	}

1196
	snprintf(phy_name, sizeof(phy_name), PHY_ID_FMT, mdio_bus_id, phy_id);
1197
	phy_dev = phy_connect(ndev, phy_name, &fec_enet_adjust_link,
S
Shawn Guo 已提交
1198
			      fep->phy_interface);
1199
	if (IS_ERR(phy_dev)) {
1200
		netdev_err(ndev, "could not attach to PHY\n");
1201
		return PTR_ERR(phy_dev);
1202
	}
L
Linus Torvalds 已提交
1203

1204
	/* mask with MAC supported features */
1205
	if (id_entry->driver_data & FEC_QUIRK_HAS_GBIT) {
S
Shawn Guo 已提交
1206
		phy_dev->supported &= PHY_GBIT_FEATURES;
1207 1208
		phy_dev->supported |= SUPPORTED_Pause;
	}
S
Shawn Guo 已提交
1209 1210 1211
	else
		phy_dev->supported &= PHY_BASIC_FEATURES;

1212
	phy_dev->advertising = phy_dev->supported;
L
Linus Torvalds 已提交
1213

1214 1215 1216
	fep->phy_dev = phy_dev;
	fep->link = 0;
	fep->full_duplex = 0;
L
Linus Torvalds 已提交
1217

1218 1219 1220
	netdev_info(ndev, "Freescale FEC PHY driver [%s] (mii_bus:phy_addr=%s, irq=%d)\n",
		    fep->phy_dev->drv->name, dev_name(&fep->phy_dev->dev),
		    fep->phy_dev->irq);
1221

1222
	return 0;
L
Linus Torvalds 已提交
1223 1224
}

1225
static int fec_enet_mii_init(struct platform_device *pdev)
1226
{
1227
	static struct mii_bus *fec0_mii_bus;
1228 1229
	struct net_device *ndev = platform_get_drvdata(pdev);
	struct fec_enet_private *fep = netdev_priv(ndev);
1230 1231
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
1232
	int err = -ENXIO, i;
1233

1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249
	/*
	 * The dual fec interfaces are not equivalent with enet-mac.
	 * Here are the differences:
	 *
	 *  - fec0 supports MII & RMII modes while fec1 only supports RMII
	 *  - fec0 acts as the 1588 time master while fec1 is slave
	 *  - external phys can only be configured by fec0
	 *
	 * That is to say fec1 can not work independently. It only works
	 * when fec0 is working. The reason behind this design is that the
	 * second interface is added primarily for Switch mode.
	 *
	 * Because of the last point above, both phys are attached on fec0
	 * mdio interface in board design, and need to be configured by
	 * fec0 mii_bus.
	 */
S
Shawn Guo 已提交
1250
	if ((id_entry->driver_data & FEC_QUIRK_ENET_MAC) && fep->dev_id > 0) {
1251
		/* fec1 uses fec0 mii_bus */
L
Lothar Waßmann 已提交
1252 1253 1254 1255 1256 1257
		if (mii_cnt && fec0_mii_bus) {
			fep->mii_bus = fec0_mii_bus;
			mii_cnt++;
			return 0;
		}
		return -ENOENT;
1258 1259
	}

1260
	fep->mii_timeout = 0;
L
Linus Torvalds 已提交
1261

1262 1263
	/*
	 * Set MII speed to 2.5 MHz (= clk_get_rate() / 2 * phy_speed)
S
Shawn Guo 已提交
1264 1265 1266 1267 1268
	 *
	 * The formula for FEC MDC is 'ref_freq / (MII_SPEED x 2)' while
	 * for ENET-MAC is 'ref_freq / ((MII_SPEED + 1) x 2)'.  The i.MX28
	 * Reference Manual has an error on this, and gets fixed on i.MX6Q
	 * document.
1269
	 */
1270
	fep->phy_speed = DIV_ROUND_UP(clk_get_rate(fep->clk_ahb), 5000000);
S
Shawn Guo 已提交
1271 1272 1273
	if (id_entry->driver_data & FEC_QUIRK_ENET_MAC)
		fep->phy_speed--;
	fep->phy_speed <<= 1;
1274
	writel(fep->phy_speed, fep->hwp + FEC_MII_SPEED);
L
Linus Torvalds 已提交
1275

1276 1277 1278 1279
	fep->mii_bus = mdiobus_alloc();
	if (fep->mii_bus == NULL) {
		err = -ENOMEM;
		goto err_out;
L
Linus Torvalds 已提交
1280 1281
	}

1282 1283 1284 1285
	fep->mii_bus->name = "fec_enet_mii_bus";
	fep->mii_bus->read = fec_enet_mdio_read;
	fep->mii_bus->write = fec_enet_mdio_write;
	fep->mii_bus->reset = fec_enet_mdio_reset;
1286 1287
	snprintf(fep->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
		pdev->name, fep->dev_id + 1);
1288 1289 1290 1291 1292 1293 1294
	fep->mii_bus->priv = fep;
	fep->mii_bus->parent = &pdev->dev;

	fep->mii_bus->irq = kmalloc(sizeof(int) * PHY_MAX_ADDR, GFP_KERNEL);
	if (!fep->mii_bus->irq) {
		err = -ENOMEM;
		goto err_out_free_mdiobus;
L
Linus Torvalds 已提交
1295 1296
	}

1297 1298
	for (i = 0; i < PHY_MAX_ADDR; i++)
		fep->mii_bus->irq[i] = PHY_POLL;
L
Linus Torvalds 已提交
1299

1300 1301
	if (mdiobus_register(fep->mii_bus))
		goto err_out_free_mdio_irq;
L
Linus Torvalds 已提交
1302

L
Lothar Waßmann 已提交
1303 1304
	mii_cnt++;

1305 1306 1307 1308
	/* save fec0 mii_bus */
	if (id_entry->driver_data & FEC_QUIRK_ENET_MAC)
		fec0_mii_bus = fep->mii_bus;

1309
	return 0;
L
Linus Torvalds 已提交
1310

1311 1312 1313 1314 1315 1316
err_out_free_mdio_irq:
	kfree(fep->mii_bus->irq);
err_out_free_mdiobus:
	mdiobus_free(fep->mii_bus);
err_out:
	return err;
L
Linus Torvalds 已提交
1317 1318
}

1319
static void fec_enet_mii_remove(struct fec_enet_private *fep)
L
Linus Torvalds 已提交
1320
{
L
Lothar Waßmann 已提交
1321 1322 1323 1324 1325
	if (--mii_cnt == 0) {
		mdiobus_unregister(fep->mii_bus);
		kfree(fep->mii_bus->irq);
		mdiobus_free(fep->mii_bus);
	}
L
Linus Torvalds 已提交
1326 1327
}

1328
static int fec_enet_get_settings(struct net_device *ndev,
1329
				  struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
1330
{
1331
	struct fec_enet_private *fep = netdev_priv(ndev);
1332
	struct phy_device *phydev = fep->phy_dev;
L
Linus Torvalds 已提交
1333

1334 1335
	if (!phydev)
		return -ENODEV;
L
Linus Torvalds 已提交
1336

1337
	return phy_ethtool_gset(phydev, cmd);
L
Linus Torvalds 已提交
1338 1339
}

1340
static int fec_enet_set_settings(struct net_device *ndev,
1341
				 struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
1342
{
1343
	struct fec_enet_private *fep = netdev_priv(ndev);
1344
	struct phy_device *phydev = fep->phy_dev;
L
Linus Torvalds 已提交
1345

1346 1347
	if (!phydev)
		return -ENODEV;
L
Linus Torvalds 已提交
1348

1349
	return phy_ethtool_sset(phydev, cmd);
L
Linus Torvalds 已提交
1350 1351
}

1352
static void fec_enet_get_drvinfo(struct net_device *ndev,
1353
				 struct ethtool_drvinfo *info)
L
Linus Torvalds 已提交
1354
{
1355
	struct fec_enet_private *fep = netdev_priv(ndev);
1356

1357 1358 1359 1360
	strlcpy(info->driver, fep->pdev->dev.driver->name,
		sizeof(info->driver));
	strlcpy(info->version, "Revision: 1.0", sizeof(info->version));
	strlcpy(info->bus_info, dev_name(&ndev->dev), sizeof(info->bus_info));
L
Linus Torvalds 已提交
1361 1362
}

1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391
static int fec_enet_get_ts_info(struct net_device *ndev,
				struct ethtool_ts_info *info)
{
	struct fec_enet_private *fep = netdev_priv(ndev);

	if (fep->bufdesc_ex) {

		info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE |
					SOF_TIMESTAMPING_RX_SOFTWARE |
					SOF_TIMESTAMPING_SOFTWARE |
					SOF_TIMESTAMPING_TX_HARDWARE |
					SOF_TIMESTAMPING_RX_HARDWARE |
					SOF_TIMESTAMPING_RAW_HARDWARE;
		if (fep->ptp_clock)
			info->phc_index = ptp_clock_index(fep->ptp_clock);
		else
			info->phc_index = -1;

		info->tx_types = (1 << HWTSTAMP_TX_OFF) |
				 (1 << HWTSTAMP_TX_ON);

		info->rx_filters = (1 << HWTSTAMP_FILTER_NONE) |
				   (1 << HWTSTAMP_FILTER_ALL);
		return 0;
	} else {
		return ethtool_op_get_ts_info(ndev, info);
	}
}

1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437
static void fec_enet_get_pauseparam(struct net_device *ndev,
				    struct ethtool_pauseparam *pause)
{
	struct fec_enet_private *fep = netdev_priv(ndev);

	pause->autoneg = (fep->pause_flag & FEC_PAUSE_FLAG_AUTONEG) != 0;
	pause->tx_pause = (fep->pause_flag & FEC_PAUSE_FLAG_ENABLE) != 0;
	pause->rx_pause = pause->tx_pause;
}

static int fec_enet_set_pauseparam(struct net_device *ndev,
				   struct ethtool_pauseparam *pause)
{
	struct fec_enet_private *fep = netdev_priv(ndev);

	if (pause->tx_pause != pause->rx_pause) {
		netdev_info(ndev,
			"hardware only support enable/disable both tx and rx");
		return -EINVAL;
	}

	fep->pause_flag = 0;

	/* tx pause must be same as rx pause */
	fep->pause_flag |= pause->rx_pause ? FEC_PAUSE_FLAG_ENABLE : 0;
	fep->pause_flag |= pause->autoneg ? FEC_PAUSE_FLAG_AUTONEG : 0;

	if (pause->rx_pause || pause->autoneg) {
		fep->phy_dev->supported |= ADVERTISED_Pause;
		fep->phy_dev->advertising |= ADVERTISED_Pause;
	} else {
		fep->phy_dev->supported &= ~ADVERTISED_Pause;
		fep->phy_dev->advertising &= ~ADVERTISED_Pause;
	}

	if (pause->autoneg) {
		if (netif_running(ndev))
			fec_stop(ndev);
		phy_start_aneg(fep->phy_dev);
	}
	if (netif_running(ndev))
		fec_restart(ndev, 0);

	return 0;
}

S
stephen hemminger 已提交
1438
static const struct ethtool_ops fec_enet_ethtool_ops = {
1439 1440
	.get_pauseparam		= fec_enet_get_pauseparam,
	.set_pauseparam		= fec_enet_set_pauseparam,
1441 1442 1443 1444
	.get_settings		= fec_enet_get_settings,
	.set_settings		= fec_enet_set_settings,
	.get_drvinfo		= fec_enet_get_drvinfo,
	.get_link		= ethtool_op_get_link,
1445
	.get_ts_info		= fec_enet_get_ts_info,
1446
};
L
Linus Torvalds 已提交
1447

1448
static int fec_enet_ioctl(struct net_device *ndev, struct ifreq *rq, int cmd)
L
Linus Torvalds 已提交
1449
{
1450
	struct fec_enet_private *fep = netdev_priv(ndev);
1451
	struct phy_device *phydev = fep->phy_dev;
L
Linus Torvalds 已提交
1452

1453
	if (!netif_running(ndev))
1454
		return -EINVAL;
L
Linus Torvalds 已提交
1455

1456 1457 1458
	if (!phydev)
		return -ENODEV;

1459
	if (cmd == SIOCSHWTSTAMP && fep->bufdesc_ex)
1460
		return fec_ptp_ioctl(ndev, rq, cmd);
1461

1462
	return phy_mii_ioctl(phydev, rq, cmd);
L
Linus Torvalds 已提交
1463 1464
}

1465
static void fec_enet_free_buffers(struct net_device *ndev)
S
Sascha Hauer 已提交
1466
{
1467
	struct fec_enet_private *fep = netdev_priv(ndev);
1468
	unsigned int i;
S
Sascha Hauer 已提交
1469 1470 1471 1472 1473 1474 1475 1476
	struct sk_buff *skb;
	struct bufdesc	*bdp;

	bdp = fep->rx_bd_base;
	for (i = 0; i < RX_RING_SIZE; i++) {
		skb = fep->rx_skbuff[i];

		if (bdp->cbd_bufaddr)
1477
			dma_unmap_single(&fep->pdev->dev, bdp->cbd_bufaddr,
S
Sascha Hauer 已提交
1478 1479 1480
					FEC_ENET_RX_FRSIZE, DMA_FROM_DEVICE);
		if (skb)
			dev_kfree_skb(skb);
1481
		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
S
Sascha Hauer 已提交
1482 1483 1484 1485 1486 1487 1488
	}

	bdp = fep->tx_bd_base;
	for (i = 0; i < TX_RING_SIZE; i++)
		kfree(fep->tx_bounce[i]);
}

1489
static int fec_enet_alloc_buffers(struct net_device *ndev)
S
Sascha Hauer 已提交
1490
{
1491
	struct fec_enet_private *fep = netdev_priv(ndev);
1492
	unsigned int i;
S
Sascha Hauer 已提交
1493 1494 1495 1496 1497
	struct sk_buff *skb;
	struct bufdesc	*bdp;

	bdp = fep->rx_bd_base;
	for (i = 0; i < RX_RING_SIZE; i++) {
1498
		skb = netdev_alloc_skb(ndev, FEC_ENET_RX_FRSIZE);
S
Sascha Hauer 已提交
1499
		if (!skb) {
1500
			fec_enet_free_buffers(ndev);
S
Sascha Hauer 已提交
1501 1502 1503 1504
			return -ENOMEM;
		}
		fep->rx_skbuff[i] = skb;

1505
		bdp->cbd_bufaddr = dma_map_single(&fep->pdev->dev, skb->data,
S
Sascha Hauer 已提交
1506 1507
				FEC_ENET_RX_FRSIZE, DMA_FROM_DEVICE);
		bdp->cbd_sc = BD_ENET_RX_EMPTY;
1508 1509 1510 1511 1512 1513 1514

		if (fep->bufdesc_ex) {
			struct bufdesc_ex *ebdp = (struct bufdesc_ex *)bdp;
			ebdp->cbd_esc = BD_ENET_RX_INT;
		}

		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
S
Sascha Hauer 已提交
1515 1516 1517
	}

	/* Set the last buffer to wrap. */
1518
	bdp = fec_enet_get_prevdesc(bdp, fep->bufdesc_ex);
S
Sascha Hauer 已提交
1519 1520 1521 1522 1523 1524 1525 1526
	bdp->cbd_sc |= BD_SC_WRAP;

	bdp = fep->tx_bd_base;
	for (i = 0; i < TX_RING_SIZE; i++) {
		fep->tx_bounce[i] = kmalloc(FEC_ENET_TX_FRSIZE, GFP_KERNEL);

		bdp->cbd_sc = 0;
		bdp->cbd_bufaddr = 0;
1527

1528 1529
		if (fep->bufdesc_ex) {
			struct bufdesc_ex *ebdp = (struct bufdesc_ex *)bdp;
1530
			ebdp->cbd_esc = BD_ENET_TX_INT;
1531 1532 1533
		}

		bdp = fec_enet_get_nextdesc(bdp, fep->bufdesc_ex);
S
Sascha Hauer 已提交
1534 1535 1536
	}

	/* Set the last buffer to wrap. */
1537
	bdp = fec_enet_get_prevdesc(bdp, fep->bufdesc_ex);
S
Sascha Hauer 已提交
1538 1539 1540 1541 1542
	bdp->cbd_sc |= BD_SC_WRAP;

	return 0;
}

L
Linus Torvalds 已提交
1543
static int
1544
fec_enet_open(struct net_device *ndev)
L
Linus Torvalds 已提交
1545
{
1546
	struct fec_enet_private *fep = netdev_priv(ndev);
S
Sascha Hauer 已提交
1547
	int ret;
L
Linus Torvalds 已提交
1548

1549 1550
	napi_enable(&fep->napi);

L
Linus Torvalds 已提交
1551 1552 1553 1554
	/* I should reset the ring buffers here, but I don't yet know
	 * a simple way to do that.
	 */

1555
	ret = fec_enet_alloc_buffers(ndev);
S
Sascha Hauer 已提交
1556 1557 1558
	if (ret)
		return ret;

1559
	/* Probe and connect to PHY when open the interface */
1560
	ret = fec_enet_mii_probe(ndev);
1561
	if (ret) {
1562
		fec_enet_free_buffers(ndev);
1563 1564
		return ret;
	}
1565
	phy_start(fep->phy_dev);
1566
	netif_start_queue(ndev);
L
Linus Torvalds 已提交
1567
	fep->opened = 1;
S
Sascha Hauer 已提交
1568
	return 0;
L
Linus Torvalds 已提交
1569 1570 1571
}

static int
1572
fec_enet_close(struct net_device *ndev)
L
Linus Torvalds 已提交
1573
{
1574
	struct fec_enet_private *fep = netdev_priv(ndev);
L
Linus Torvalds 已提交
1575

S
Sascha Hauer 已提交
1576
	/* Don't know what to do yet. */
1577
	napi_disable(&fep->napi);
L
Linus Torvalds 已提交
1578
	fep->opened = 0;
1579 1580
	netif_stop_queue(ndev);
	fec_stop(ndev);
L
Linus Torvalds 已提交
1581

1582 1583
	if (fep->phy_dev) {
		phy_stop(fep->phy_dev);
1584
		phy_disconnect(fep->phy_dev);
1585
	}
1586

1587
	fec_enet_free_buffers(ndev);
S
Sascha Hauer 已提交
1588

L
Linus Torvalds 已提交
1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604
	return 0;
}

/* Set or clear the multicast filter for this adaptor.
 * Skeleton taken from sunlance driver.
 * The CPM Ethernet implementation allows Multicast as well as individual
 * MAC address filtering.  Some of the drivers check to make sure it is
 * a group multicast address, and discard those that are not.  I guess I
 * will do the same for now, but just remove the test if you want
 * individual filtering as well (do the upper net layers want or support
 * this kind of feature?).
 */

#define HASH_BITS	6		/* #bits in hash */
#define CRC32_POLY	0xEDB88320

1605
static void set_multicast_list(struct net_device *ndev)
L
Linus Torvalds 已提交
1606
{
1607
	struct fec_enet_private *fep = netdev_priv(ndev);
1608
	struct netdev_hw_addr *ha;
1609
	unsigned int i, bit, data, crc, tmp;
L
Linus Torvalds 已提交
1610 1611
	unsigned char hash;

1612
	if (ndev->flags & IFF_PROMISC) {
S
Sascha Hauer 已提交
1613 1614 1615
		tmp = readl(fep->hwp + FEC_R_CNTRL);
		tmp |= 0x8;
		writel(tmp, fep->hwp + FEC_R_CNTRL);
1616 1617
		return;
	}
L
Linus Torvalds 已提交
1618

1619 1620 1621 1622
	tmp = readl(fep->hwp + FEC_R_CNTRL);
	tmp &= ~0x8;
	writel(tmp, fep->hwp + FEC_R_CNTRL);

1623
	if (ndev->flags & IFF_ALLMULTI) {
1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637
		/* Catch all multicast addresses, so set the
		 * filter to all 1's
		 */
		writel(0xffffffff, fep->hwp + FEC_GRP_HASH_TABLE_HIGH);
		writel(0xffffffff, fep->hwp + FEC_GRP_HASH_TABLE_LOW);

		return;
	}

	/* Clear filter and add the addresses in hash register
	 */
	writel(0, fep->hwp + FEC_GRP_HASH_TABLE_HIGH);
	writel(0, fep->hwp + FEC_GRP_HASH_TABLE_LOW);

1638
	netdev_for_each_mc_addr(ha, ndev) {
1639 1640 1641
		/* calculate crc32 value of mac address */
		crc = 0xffffffff;

1642
		for (i = 0; i < ndev->addr_len; i++) {
1643
			data = ha->addr[i];
1644 1645 1646
			for (bit = 0; bit < 8; bit++, data >>= 1) {
				crc = (crc >> 1) ^
				(((crc ^ data) & 1) ? CRC32_POLY : 0);
L
Linus Torvalds 已提交
1647 1648
			}
		}
1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663

		/* only upper 6 bits (HASH_BITS) are used
		 * which point to specific bit in he hash registers
		 */
		hash = (crc >> (32 - HASH_BITS)) & 0x3f;

		if (hash > 31) {
			tmp = readl(fep->hwp + FEC_GRP_HASH_TABLE_HIGH);
			tmp |= 1 << (hash - 32);
			writel(tmp, fep->hwp + FEC_GRP_HASH_TABLE_HIGH);
		} else {
			tmp = readl(fep->hwp + FEC_GRP_HASH_TABLE_LOW);
			tmp |= 1 << hash;
			writel(tmp, fep->hwp + FEC_GRP_HASH_TABLE_LOW);
		}
L
Linus Torvalds 已提交
1664 1665 1666
	}
}

S
Sascha Hauer 已提交
1667
/* Set a MAC change in hardware. */
S
Sascha Hauer 已提交
1668
static int
1669
fec_set_mac_address(struct net_device *ndev, void *p)
L
Linus Torvalds 已提交
1670
{
1671
	struct fec_enet_private *fep = netdev_priv(ndev);
S
Sascha Hauer 已提交
1672 1673 1674 1675 1676
	struct sockaddr *addr = p;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

1677
	memcpy(ndev->dev_addr, addr->sa_data, ndev->addr_len);
L
Linus Torvalds 已提交
1678

1679 1680
	writel(ndev->dev_addr[3] | (ndev->dev_addr[2] << 8) |
		(ndev->dev_addr[1] << 16) | (ndev->dev_addr[0] << 24),
S
Sascha Hauer 已提交
1681
		fep->hwp + FEC_ADDR_LOW);
1682
	writel((ndev->dev_addr[5] << 16) | (ndev->dev_addr[4] << 24),
1683
		fep->hwp + FEC_ADDR_HIGH);
S
Sascha Hauer 已提交
1684
	return 0;
L
Linus Torvalds 已提交
1685 1686
}

1687
#ifdef CONFIG_NET_POLL_CONTROLLER
1688 1689
/**
 * fec_poll_controller - FEC Poll controller function
1690 1691 1692 1693 1694
 * @dev: The FEC network adapter
 *
 * Polled functionality used by netconsole and others in non interrupt mode
 *
 */
1695
static void fec_poll_controller(struct net_device *dev)
1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709
{
	int i;
	struct fec_enet_private *fep = netdev_priv(dev);

	for (i = 0; i < FEC_IRQ_NUM; i++) {
		if (fep->irq[i] > 0) {
			disable_irq(fep->irq[i]);
			fec_enet_interrupt(fep->irq[i], dev);
			enable_irq(fep->irq[i]);
		}
	}
}
#endif

1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736
static int fec_set_features(struct net_device *netdev,
	netdev_features_t features)
{
	struct fec_enet_private *fep = netdev_priv(netdev);
	netdev_features_t changed = features ^ netdev->features;

	netdev->features = features;

	/* Receive checksum has been changed */
	if (changed & NETIF_F_RXCSUM) {
		if (features & NETIF_F_RXCSUM)
			fep->csum_flags |= FLAG_RX_CSUM_ENABLED;
		else
			fep->csum_flags &= ~FLAG_RX_CSUM_ENABLED;

		if (netif_running(netdev)) {
			fec_stop(netdev);
			fec_restart(netdev, fep->phy_dev->duplex);
			netif_wake_queue(netdev);
		} else {
			fec_restart(netdev, fep->phy_dev->duplex);
		}
	}

	return 0;
}

S
Sascha Hauer 已提交
1737 1738 1739 1740
static const struct net_device_ops fec_netdev_ops = {
	.ndo_open		= fec_enet_open,
	.ndo_stop		= fec_enet_close,
	.ndo_start_xmit		= fec_enet_start_xmit,
1741
	.ndo_set_rx_mode	= set_multicast_list,
1742
	.ndo_change_mtu		= eth_change_mtu,
S
Sascha Hauer 已提交
1743 1744 1745
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_tx_timeout		= fec_timeout,
	.ndo_set_mac_address	= fec_set_mac_address,
1746
	.ndo_do_ioctl		= fec_enet_ioctl,
1747 1748 1749
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= fec_poll_controller,
#endif
1750
	.ndo_set_features	= fec_set_features,
S
Sascha Hauer 已提交
1751 1752
};

L
Linus Torvalds 已提交
1753 1754
 /*
  * XXX:  We need to clean up on failure exits here.
1755
  *
L
Linus Torvalds 已提交
1756
  */
1757
static int fec_enet_init(struct net_device *ndev)
L
Linus Torvalds 已提交
1758
{
1759
	struct fec_enet_private *fep = netdev_priv(ndev);
1760 1761
	const struct platform_device_id *id_entry =
				platform_get_device_id(fep->pdev);
S
Sascha Hauer 已提交
1762
	struct bufdesc *cbd_base;
L
Linus Torvalds 已提交
1763

S
Sascha Hauer 已提交
1764 1765
	/* Allocate memory for buffer descriptors. */
	cbd_base = dma_alloc_coherent(NULL, PAGE_SIZE, &fep->bd_dma,
1766 1767
				      GFP_KERNEL);
	if (!cbd_base)
1768 1769
		return -ENOMEM;

1770
	memset(cbd_base, 0, PAGE_SIZE);
1771

1772
	fep->netdev = ndev;
L
Linus Torvalds 已提交
1773

1774
	/* Get the Ethernet address */
1775
	fec_get_mac(ndev);
L
Linus Torvalds 已提交
1776

S
Sascha Hauer 已提交
1777
	/* Set receive and transmit descriptor base. */
L
Linus Torvalds 已提交
1778
	fep->rx_bd_base = cbd_base;
1779 1780 1781 1782 1783
	if (fep->bufdesc_ex)
		fep->tx_bd_base = (struct bufdesc *)
			(((struct bufdesc_ex *)cbd_base) + RX_RING_SIZE);
	else
		fep->tx_bd_base = cbd_base + RX_RING_SIZE;
L
Linus Torvalds 已提交
1784

S
Sascha Hauer 已提交
1785
	/* The FEC Ethernet specific entries in the device structure */
1786 1787 1788
	ndev->watchdog_timeo = TX_TIMEOUT;
	ndev->netdev_ops = &fec_netdev_ops;
	ndev->ethtool_ops = &fec_enet_ethtool_ops;
1789

1790 1791 1792
	writel(FEC_RX_DISABLED_IMASK, fep->hwp + FEC_IMASK);
	netif_napi_add(ndev, &fep->napi, fec_enet_rx_napi, FEC_NAPI_WEIGHT);

1793 1794 1795 1796 1797 1798 1799 1800
	if (id_entry->driver_data & FEC_QUIRK_HAS_CSUM) {
		/* enable hw accelerator */
		ndev->features |= (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM
				| NETIF_F_RXCSUM);
		ndev->hw_features |= (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM
				| NETIF_F_RXCSUM);
		fep->csum_flags |= FLAG_RX_CSUM_ENABLED;
	}
1801

1802
	fec_restart(ndev, 0);
L
Linus Torvalds 已提交
1803 1804 1805 1806

	return 0;
}

1807
#ifdef CONFIG_OF
1808
static void fec_reset_phy(struct platform_device *pdev)
1809 1810
{
	int err, phy_reset;
1811
	int msec = 1;
1812 1813 1814
	struct device_node *np = pdev->dev.of_node;

	if (!np)
1815
		return;
1816

1817 1818 1819 1820 1821
	of_property_read_u32(np, "phy-reset-duration", &msec);
	/* A sane reset duration should not be longer than 1s */
	if (msec > 1000)
		msec = 1;

1822
	phy_reset = of_get_named_gpio(np, "phy-reset-gpios", 0);
1823 1824 1825
	if (!gpio_is_valid(phy_reset))
		return;

1826 1827
	err = devm_gpio_request_one(&pdev->dev, phy_reset,
				    GPIOF_OUT_INIT_LOW, "phy-reset");
1828
	if (err) {
1829
		dev_err(&pdev->dev, "failed to get phy-reset-gpios: %d\n", err);
1830
		return;
1831
	}
1832
	msleep(msec);
1833 1834 1835
	gpio_set_value(phy_reset, 1);
}
#else /* CONFIG_OF */
1836
static void fec_reset_phy(struct platform_device *pdev)
1837 1838 1839 1840 1841 1842 1843 1844
{
	/*
	 * In case of platform probe, the reset has been done
	 * by machine code.
	 */
}
#endif /* CONFIG_OF */

1845
static int
1846 1847 1848
fec_probe(struct platform_device *pdev)
{
	struct fec_enet_private *fep;
1849
	struct fec_platform_data *pdata;
1850 1851 1852
	struct net_device *ndev;
	int i, irq, ret = 0;
	struct resource *r;
1853
	const struct of_device_id *of_id;
S
Shawn Guo 已提交
1854
	static int dev_id;
1855 1856 1857 1858

	of_id = of_match_device(fec_dt_ids, &pdev->dev);
	if (of_id)
		pdev->id_entry = of_id->data;
1859 1860 1861 1862 1863 1864 1865

	r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!r)
		return -ENXIO;

	/* Init network device */
	ndev = alloc_etherdev(sizeof(struct fec_enet_private));
1866 1867
	if (!ndev)
		return -ENOMEM;
1868 1869 1870 1871 1872 1873

	SET_NETDEV_DEV(ndev, &pdev->dev);

	/* setup board info structure */
	fep = netdev_priv(ndev);

1874 1875 1876 1877 1878
	/* default enable pause frame auto negotiation */
	if (pdev->id_entry &&
	    (pdev->id_entry->driver_data & FEC_QUIRK_HAS_GBIT))
		fep->pause_flag |= FEC_PAUSE_FLAG_AUTONEG;

1879
	fep->hwp = devm_request_and_ioremap(&pdev->dev, r);
1880
	fep->pdev = pdev;
S
Shawn Guo 已提交
1881
	fep->dev_id = dev_id++;
1882

1883 1884
	fep->bufdesc_ex = 0;

1885
	if (!fep->hwp) {
1886 1887 1888 1889 1890 1891
		ret = -ENOMEM;
		goto failed_ioremap;
	}

	platform_set_drvdata(pdev, ndev);

1892
	ret = of_get_phy_mode(pdev->dev.of_node);
1893 1894 1895 1896 1897 1898 1899 1900 1901 1902
	if (ret < 0) {
		pdata = pdev->dev.platform_data;
		if (pdata)
			fep->phy_interface = pdata->phy;
		else
			fep->phy_interface = PHY_INTERFACE_MODE_MII;
	} else {
		fep->phy_interface = ret;
	}

1903 1904 1905
	fep->clk_ipg = devm_clk_get(&pdev->dev, "ipg");
	if (IS_ERR(fep->clk_ipg)) {
		ret = PTR_ERR(fep->clk_ipg);
1906 1907
		goto failed_clk;
	}
1908 1909 1910 1911 1912 1913 1914

	fep->clk_ahb = devm_clk_get(&pdev->dev, "ahb");
	if (IS_ERR(fep->clk_ahb)) {
		ret = PTR_ERR(fep->clk_ahb);
		goto failed_clk;
	}

1915 1916 1917 1918 1919
	/* enet_out is optional, depends on board */
	fep->clk_enet_out = devm_clk_get(&pdev->dev, "enet_out");
	if (IS_ERR(fep->clk_enet_out))
		fep->clk_enet_out = NULL;

1920
	fep->clk_ptp = devm_clk_get(&pdev->dev, "ptp");
F
Fabio Estevam 已提交
1921 1922
	fep->bufdesc_ex =
		pdev->id_entry->driver_data & FEC_QUIRK_HAS_BUFDESC_EX;
1923
	if (IS_ERR(fep->clk_ptp)) {
1924
		fep->clk_ptp = NULL;
1925
		fep->bufdesc_ex = 0;
1926 1927
	}

1928 1929
	clk_prepare_enable(fep->clk_ahb);
	clk_prepare_enable(fep->clk_ipg);
1930
	clk_prepare_enable(fep->clk_enet_out);
1931
	clk_prepare_enable(fep->clk_ptp);
1932

1933 1934 1935
	fep->reg_phy = devm_regulator_get(&pdev->dev, "phy");
	if (!IS_ERR(fep->reg_phy)) {
		ret = regulator_enable(fep->reg_phy);
1936 1937 1938 1939 1940
		if (ret) {
			dev_err(&pdev->dev,
				"Failed to enable phy regulator: %d\n", ret);
			goto failed_regulator;
		}
1941 1942
	} else {
		fep->reg_phy = NULL;
1943 1944
	}

1945 1946
	fec_reset_phy(pdev);

F
Fabio Estevam 已提交
1947
	if (fep->bufdesc_ex)
1948
		fec_ptp_init(pdev);
F
Fabio Estevam 已提交
1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971

	ret = fec_enet_init(ndev);
	if (ret)
		goto failed_init;

	for (i = 0; i < FEC_IRQ_NUM; i++) {
		irq = platform_get_irq(pdev, i);
		if (irq < 0) {
			if (i)
				break;
			ret = irq;
			goto failed_irq;
		}
		ret = request_irq(irq, fec_enet_interrupt, IRQF_DISABLED, pdev->name, ndev);
		if (ret) {
			while (--i >= 0) {
				irq = platform_get_irq(pdev, i);
				free_irq(irq, ndev);
			}
			goto failed_irq;
		}
	}

1972 1973 1974 1975
	ret = fec_enet_mii_init(pdev);
	if (ret)
		goto failed_mii_init;

1976 1977 1978
	/* Carrier starts down, phylib will bring it up */
	netif_carrier_off(ndev);

1979 1980 1981 1982
	ret = register_netdev(ndev);
	if (ret)
		goto failed_register;

F
Fabio Estevam 已提交
1983 1984 1985
	if (fep->bufdesc_ex && fep->ptp_clock)
		netdev_info(ndev, "registered PHC device %d\n", fep->dev_id);

1986
	INIT_DELAYED_WORK(&(fep->delay_work.delay_work), fec_enet_work);
1987 1988 1989
	return 0;

failed_register:
1990 1991
	fec_enet_mii_remove(fep);
failed_mii_init:
1992
failed_irq:
F
Fabio Estevam 已提交
1993 1994 1995 1996 1997
	for (i = 0; i < FEC_IRQ_NUM; i++) {
		irq = platform_get_irq(pdev, i);
		if (irq > 0)
			free_irq(irq, ndev);
	}
1998
failed_init:
1999 2000
	if (fep->reg_phy)
		regulator_disable(fep->reg_phy);
2001
failed_regulator:
2002 2003
	clk_disable_unprepare(fep->clk_ahb);
	clk_disable_unprepare(fep->clk_ipg);
2004
	clk_disable_unprepare(fep->clk_enet_out);
2005
	clk_disable_unprepare(fep->clk_ptp);
2006 2007 2008 2009 2010 2011 2012
failed_clk:
failed_ioremap:
	free_netdev(ndev);

	return ret;
}

2013
static int
2014 2015 2016 2017
fec_drv_remove(struct platform_device *pdev)
{
	struct net_device *ndev = platform_get_drvdata(pdev);
	struct fec_enet_private *fep = netdev_priv(ndev);
L
Lothar Waßmann 已提交
2018
	int i;
2019

2020
	cancel_delayed_work_sync(&(fep->delay_work.delay_work));
L
Lothar Waßmann 已提交
2021
	unregister_netdev(ndev);
2022
	fec_enet_mii_remove(fep);
2023
	del_timer_sync(&fep->time_keep);
F
Fabio Estevam 已提交
2024 2025 2026 2027 2028
	for (i = 0; i < FEC_IRQ_NUM; i++) {
		int irq = platform_get_irq(pdev, i);
		if (irq > 0)
			free_irq(irq, ndev);
	}
2029 2030
	if (fep->reg_phy)
		regulator_disable(fep->reg_phy);
2031 2032 2033
	clk_disable_unprepare(fep->clk_ptp);
	if (fep->ptp_clock)
		ptp_clock_unregister(fep->ptp_clock);
2034
	clk_disable_unprepare(fep->clk_enet_out);
2035 2036
	clk_disable_unprepare(fep->clk_ahb);
	clk_disable_unprepare(fep->clk_ipg);
2037
	free_netdev(ndev);
2038

2039 2040 2041
	return 0;
}

F
Fabio Estevam 已提交
2042
#ifdef CONFIG_PM_SLEEP
2043
static int
E
Eric Benard 已提交
2044
fec_suspend(struct device *dev)
2045
{
E
Eric Benard 已提交
2046
	struct net_device *ndev = dev_get_drvdata(dev);
2047
	struct fec_enet_private *fep = netdev_priv(ndev);
2048

2049 2050 2051
	if (netif_running(ndev)) {
		fec_stop(ndev);
		netif_device_detach(ndev);
2052
	}
2053
	clk_disable_unprepare(fep->clk_enet_out);
2054 2055
	clk_disable_unprepare(fep->clk_ahb);
	clk_disable_unprepare(fep->clk_ipg);
2056

2057 2058 2059
	if (fep->reg_phy)
		regulator_disable(fep->reg_phy);

2060 2061 2062 2063
	return 0;
}

static int
E
Eric Benard 已提交
2064
fec_resume(struct device *dev)
2065
{
E
Eric Benard 已提交
2066
	struct net_device *ndev = dev_get_drvdata(dev);
2067
	struct fec_enet_private *fep = netdev_priv(ndev);
2068 2069 2070 2071 2072 2073 2074
	int ret;

	if (fep->reg_phy) {
		ret = regulator_enable(fep->reg_phy);
		if (ret)
			return ret;
	}
2075

2076
	clk_prepare_enable(fep->clk_enet_out);
2077 2078
	clk_prepare_enable(fep->clk_ahb);
	clk_prepare_enable(fep->clk_ipg);
2079 2080 2081
	if (netif_running(ndev)) {
		fec_restart(ndev, fep->full_duplex);
		netif_device_attach(ndev);
2082
	}
2083

2084 2085
	return 0;
}
F
Fabio Estevam 已提交
2086
#endif /* CONFIG_PM_SLEEP */
2087

F
Fabio Estevam 已提交
2088
static SIMPLE_DEV_PM_OPS(fec_pm_ops, fec_suspend, fec_resume);
2089

2090 2091
static struct platform_driver fec_driver = {
	.driver	= {
2092
		.name	= DRIVER_NAME,
E
Eric Benard 已提交
2093 2094
		.owner	= THIS_MODULE,
		.pm	= &fec_pm_ops,
2095
		.of_match_table = fec_dt_ids,
2096
	},
2097
	.id_table = fec_devtype,
E
Eric Benard 已提交
2098
	.probe	= fec_probe,
2099
	.remove	= fec_drv_remove,
2100 2101
};

2102
module_platform_driver(fec_driver);
L
Linus Torvalds 已提交
2103 2104

MODULE_LICENSE("GPL");