macb.c 36.4 KB
Newer Older
1
/*
J
Jamie Iles 已提交
2
 * Cadence MACB/GEM Ethernet Controller driver
3 4 5 6 7 8 9 10
 *
 * Copyright (C) 2004-2006 Atmel Corporation
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

11
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
12 13 14 15 16 17 18
#include <linux/clk.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/init.h>
19
#include <linux/interrupt.h>
20 21 22
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/dma-mapping.h>
23
#include <linux/platform_data/macb.h>
24
#include <linux/platform_device.h>
F
frederic RODO 已提交
25
#include <linux/phy.h>
26
#include <linux/of.h>
27 28
#include <linux/of_device.h>
#include <linux/of_net.h>
29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64

#include "macb.h"

#define RX_BUFFER_SIZE		128
#define RX_RING_SIZE		512
#define RX_RING_BYTES		(sizeof(struct dma_desc) * RX_RING_SIZE)

/* Make the IP header word-aligned (the ethernet header is 14 bytes) */
#define RX_OFFSET		2

#define TX_RING_SIZE		128
#define DEF_TX_RING_PENDING	(TX_RING_SIZE - 1)
#define TX_RING_BYTES		(sizeof(struct dma_desc) * TX_RING_SIZE)

#define TX_RING_GAP(bp)						\
	(TX_RING_SIZE - (bp)->tx_pending)
#define TX_BUFFS_AVAIL(bp)					\
	(((bp)->tx_tail <= (bp)->tx_head) ?			\
	 (bp)->tx_tail + (bp)->tx_pending - (bp)->tx_head :	\
	 (bp)->tx_tail - (bp)->tx_head - TX_RING_GAP(bp))
#define NEXT_TX(n)		(((n) + 1) & (TX_RING_SIZE - 1))

#define NEXT_RX(n)		(((n) + 1) & (RX_RING_SIZE - 1))

/* minimum number of free TX descriptors before waking up TX process */
#define MACB_TX_WAKEUP_THRESH	(TX_RING_SIZE / 4)

#define MACB_RX_INT_FLAGS	(MACB_BIT(RCOMP) | MACB_BIT(RXUBR)	\
				 | MACB_BIT(ISR_ROVR))

static void __macb_set_hwaddr(struct macb *bp)
{
	u32 bottom;
	u16 top;

	bottom = cpu_to_le32(*((u32 *)bp->dev->dev_addr));
J
Jamie Iles 已提交
65
	macb_or_gem_writel(bp, SA1B, bottom);
66
	top = cpu_to_le16(*((u16 *)(bp->dev->dev_addr + 4)));
J
Jamie Iles 已提交
67
	macb_or_gem_writel(bp, SA1T, top);
68 69 70 71 72 73 74 75
}

static void __init macb_get_hwaddr(struct macb *bp)
{
	u32 bottom;
	u16 top;
	u8 addr[6];

J
Jamie Iles 已提交
76 77
	bottom = macb_or_gem_readl(bp, SA1B);
	top = macb_or_gem_readl(bp, SA1T);
78 79 80 81 82 83 84 85

	addr[0] = bottom & 0xff;
	addr[1] = (bottom >> 8) & 0xff;
	addr[2] = (bottom >> 16) & 0xff;
	addr[3] = (bottom >> 24) & 0xff;
	addr[4] = top & 0xff;
	addr[5] = (top >> 8) & 0xff;

86
	if (is_valid_ether_addr(addr)) {
87
		memcpy(bp->dev->dev_addr, addr, sizeof(addr));
88
	} else {
89
		netdev_info(bp->dev, "invalid hw address, using random\n");
90 91
		random_ether_addr(bp->dev->dev_addr);
	}
92 93
}

F
frederic RODO 已提交
94
static int macb_mdio_read(struct mii_bus *bus, int mii_id, int regnum)
95
{
F
frederic RODO 已提交
96
	struct macb *bp = bus->priv;
97 98 99 100
	int value;

	macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_SOF)
			      | MACB_BF(RW, MACB_MAN_READ)
F
frederic RODO 已提交
101 102
			      | MACB_BF(PHYA, mii_id)
			      | MACB_BF(REGA, regnum)
103 104
			      | MACB_BF(CODE, MACB_MAN_CODE)));

F
frederic RODO 已提交
105 106 107
	/* wait for end of transfer */
	while (!MACB_BFEXT(IDLE, macb_readl(bp, NSR)))
		cpu_relax();
108 109 110 111 112 113

	value = MACB_BFEXT(DATA, macb_readl(bp, MAN));

	return value;
}

F
frederic RODO 已提交
114 115
static int macb_mdio_write(struct mii_bus *bus, int mii_id, int regnum,
			   u16 value)
116
{
F
frederic RODO 已提交
117
	struct macb *bp = bus->priv;
118 119 120

	macb_writel(bp, MAN, (MACB_BF(SOF, MACB_MAN_SOF)
			      | MACB_BF(RW, MACB_MAN_WRITE)
F
frederic RODO 已提交
121 122
			      | MACB_BF(PHYA, mii_id)
			      | MACB_BF(REGA, regnum)
123
			      | MACB_BF(CODE, MACB_MAN_CODE)
F
frederic RODO 已提交
124
			      | MACB_BF(DATA, value)));
125

F
frederic RODO 已提交
126 127 128 129 130 131
	/* wait for end of transfer */
	while (!MACB_BFEXT(IDLE, macb_readl(bp, NSR)))
		cpu_relax();

	return 0;
}
132

F
frederic RODO 已提交
133 134 135
static int macb_mdio_reset(struct mii_bus *bus)
{
	return 0;
136 137
}

F
frederic RODO 已提交
138
static void macb_handle_link_change(struct net_device *dev)
139
{
F
frederic RODO 已提交
140 141 142
	struct macb *bp = netdev_priv(dev);
	struct phy_device *phydev = bp->phy_dev;
	unsigned long flags;
143

F
frederic RODO 已提交
144
	int status_change = 0;
145

F
frederic RODO 已提交
146 147 148 149 150 151 152 153 154 155 156 157
	spin_lock_irqsave(&bp->lock, flags);

	if (phydev->link) {
		if ((bp->speed != phydev->speed) ||
		    (bp->duplex != phydev->duplex)) {
			u32 reg;

			reg = macb_readl(bp, NCFGR);
			reg &= ~(MACB_BIT(SPD) | MACB_BIT(FD));

			if (phydev->duplex)
				reg |= MACB_BIT(FD);
A
Atsushi Nemoto 已提交
158
			if (phydev->speed == SPEED_100)
F
frederic RODO 已提交
159 160 161 162 163 164 165 166
				reg |= MACB_BIT(SPD);

			macb_writel(bp, NCFGR, reg);

			bp->speed = phydev->speed;
			bp->duplex = phydev->duplex;
			status_change = 1;
		}
167 168
	}

F
frederic RODO 已提交
169
	if (phydev->link != bp->link) {
170
		if (!phydev->link) {
F
frederic RODO 已提交
171 172 173 174
			bp->speed = 0;
			bp->duplex = -1;
		}
		bp->link = phydev->link;
175

F
frederic RODO 已提交
176 177
		status_change = 1;
	}
178

F
frederic RODO 已提交
179 180 181 182
	spin_unlock_irqrestore(&bp->lock, flags);

	if (status_change) {
		if (phydev->link)
183 184 185 186
			netdev_info(dev, "link up (%d/%s)\n",
				    phydev->speed,
				    phydev->duplex == DUPLEX_FULL ?
				    "Full" : "Half");
F
frederic RODO 已提交
187
		else
188
			netdev_info(dev, "link down\n");
F
frederic RODO 已提交
189
	}
190 191
}

F
frederic RODO 已提交
192 193
/* based on au1000_eth. c*/
static int macb_mii_probe(struct net_device *dev)
194
{
F
frederic RODO 已提交
195
	struct macb *bp = netdev_priv(dev);
196 197
	struct phy_device *phydev;
	int ret;
F
frederic RODO 已提交
198

199
	phydev = phy_find_first(bp->mii_bus);
F
frederic RODO 已提交
200
	if (!phydev) {
201
		netdev_err(dev, "no PHY found\n");
F
frederic RODO 已提交
202 203 204 205 206 207
		return -1;
	}

	/* TODO : add pin_irq */

	/* attach the mac to the phy */
208
	ret = phy_connect_direct(dev, phydev, &macb_handle_link_change, 0,
209
				 bp->phy_interface);
210
	if (ret) {
211
		netdev_err(dev, "Could not attach to PHY\n");
212
		return ret;
F
frederic RODO 已提交
213 214 215 216 217 218 219 220 221 222 223 224 225
	}

	/* mask with MAC supported features */
	phydev->supported &= PHY_BASIC_FEATURES;

	phydev->advertising = phydev->supported;

	bp->link = 0;
	bp->speed = 0;
	bp->duplex = -1;
	bp->phy_dev = phydev;

	return 0;
226 227
}

F
frederic RODO 已提交
228
static int macb_mii_init(struct macb *bp)
229
{
230
	struct macb_platform_data *pdata;
F
frederic RODO 已提交
231
	int err = -ENXIO, i;
232

233
	/* Enable management port */
F
frederic RODO 已提交
234
	macb_writel(bp, NCR, MACB_BIT(MPE));
235

236 237 238 239 240 241 242 243 244 245
	bp->mii_bus = mdiobus_alloc();
	if (bp->mii_bus == NULL) {
		err = -ENOMEM;
		goto err_out;
	}

	bp->mii_bus->name = "MACB_mii_bus";
	bp->mii_bus->read = &macb_mdio_read;
	bp->mii_bus->write = &macb_mdio_write;
	bp->mii_bus->reset = &macb_mdio_reset;
246 247
	snprintf(bp->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
		bp->pdev->name, bp->pdev->id);
248 249
	bp->mii_bus->priv = bp;
	bp->mii_bus->parent = &bp->dev->dev;
F
frederic RODO 已提交
250
	pdata = bp->pdev->dev.platform_data;
251

F
frederic RODO 已提交
252
	if (pdata)
253
		bp->mii_bus->phy_mask = pdata->phy_mask;
254

255 256
	bp->mii_bus->irq = kmalloc(sizeof(int)*PHY_MAX_ADDR, GFP_KERNEL);
	if (!bp->mii_bus->irq) {
F
frederic RODO 已提交
257
		err = -ENOMEM;
258
		goto err_out_free_mdiobus;
259 260
	}

F
frederic RODO 已提交
261
	for (i = 0; i < PHY_MAX_ADDR; i++)
262
		bp->mii_bus->irq[i] = PHY_POLL;
263

264
	dev_set_drvdata(&bp->dev->dev, bp->mii_bus);
265

266
	if (mdiobus_register(bp->mii_bus))
F
frederic RODO 已提交
267
		goto err_out_free_mdio_irq;
268

F
frederic RODO 已提交
269 270 271
	if (macb_mii_probe(bp->dev) != 0) {
		goto err_out_unregister_bus;
	}
272

F
frederic RODO 已提交
273
	return 0;
274

F
frederic RODO 已提交
275
err_out_unregister_bus:
276
	mdiobus_unregister(bp->mii_bus);
F
frederic RODO 已提交
277
err_out_free_mdio_irq:
278 279 280
	kfree(bp->mii_bus->irq);
err_out_free_mdiobus:
	mdiobus_free(bp->mii_bus);
F
frederic RODO 已提交
281 282
err_out:
	return err;
283 284 285 286 287
}

static void macb_update_stats(struct macb *bp)
{
	u32 __iomem *reg = bp->regs + MACB_PFR;
288 289
	u32 *p = &bp->hw_stats.macb.rx_pause_frames;
	u32 *end = &bp->hw_stats.macb.tx_pause_frames + 1;
290 291 292 293

	WARN_ON((unsigned long)(end - p - 1) != (MACB_TPF - MACB_PFR) / 4);

	for(; p < end; p++, reg++)
294
		*p += __raw_readl(reg);
295 296 297 298 299 300 301 302 303 304 305
}

static void macb_tx(struct macb *bp)
{
	unsigned int tail;
	unsigned int head;
	u32 status;

	status = macb_readl(bp, TSR);
	macb_writel(bp, TSR, status);

306
	netdev_dbg(bp->dev, "macb_tx status = %02lx\n", (unsigned long)status);
307

308
	if (status & (MACB_BIT(UND) | MACB_BIT(TSR_RLE))) {
309
		int i;
310 311 312
		netdev_err(bp->dev, "TX %s, resetting buffers\n",
			   status & MACB_BIT(UND) ?
			   "underrun" : "retry limit exceeded");
313

314 315 316 317
		/* Transfer ongoing, disable transmitter, to avoid confusion */
		if (status & MACB_BIT(TGO))
			macb_writel(bp, NCR, macb_readl(bp, NCR) & ~MACB_BIT(TE));

318 319 320 321 322 323
		head = bp->tx_head;

		/*Mark all the buffer as used to avoid sending a lost buffer*/
		for (i = 0; i < TX_RING_SIZE; i++)
			bp->tx_ring[i].ctrl = MACB_BIT(TX_USED);

324 325 326
		/* Add wrap bit */
		bp->tx_ring[TX_RING_SIZE - 1].ctrl |= MACB_BIT(TX_WRAP);

327 328 329 330 331 332 333 334 335 336 337 338 339 340 341
		/* free transmit buffer in upper layer*/
		for (tail = bp->tx_tail; tail != head; tail = NEXT_TX(tail)) {
			struct ring_info *rp = &bp->tx_skb[tail];
			struct sk_buff *skb = rp->skb;

			BUG_ON(skb == NULL);

			rmb();

			dma_unmap_single(&bp->pdev->dev, rp->mapping, skb->len,
							 DMA_TO_DEVICE);
			rp->skb = NULL;
			dev_kfree_skb_irq(skb);
		}

342
		bp->tx_head = bp->tx_tail = 0;
343 344 345 346

		/* Enable the transmitter again */
		if (status & MACB_BIT(TGO))
			macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(TE));
347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370
	}

	if (!(status & MACB_BIT(COMP)))
		/*
		 * This may happen when a buffer becomes complete
		 * between reading the ISR and scanning the
		 * descriptors.  Nothing to worry about.
		 */
		return;

	head = bp->tx_head;
	for (tail = bp->tx_tail; tail != head; tail = NEXT_TX(tail)) {
		struct ring_info *rp = &bp->tx_skb[tail];
		struct sk_buff *skb = rp->skb;
		u32 bufstat;

		BUG_ON(skb == NULL);

		rmb();
		bufstat = bp->tx_ring[tail].ctrl;

		if (!(bufstat & MACB_BIT(TX_USED)))
			break;

371 372
		netdev_dbg(bp->dev, "skb %u (data %p) TX complete\n",
			   tail, skb->data);
373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396
		dma_unmap_single(&bp->pdev->dev, rp->mapping, skb->len,
				 DMA_TO_DEVICE);
		bp->stats.tx_packets++;
		bp->stats.tx_bytes += skb->len;
		rp->skb = NULL;
		dev_kfree_skb_irq(skb);
	}

	bp->tx_tail = tail;
	if (netif_queue_stopped(bp->dev) &&
	    TX_BUFFS_AVAIL(bp) > MACB_TX_WAKEUP_THRESH)
		netif_wake_queue(bp->dev);
}

static int macb_rx_frame(struct macb *bp, unsigned int first_frag,
			 unsigned int last_frag)
{
	unsigned int len;
	unsigned int frag;
	unsigned int offset = 0;
	struct sk_buff *skb;

	len = MACB_BFEXT(RX_FRMLEN, bp->rx_ring[last_frag].ctrl);

397 398
	netdev_dbg(bp->dev, "macb_rx_frame frags %u - %u (len %u)\n",
		   first_frag, last_frag, len);
399 400 401 402 403 404 405 406 407 408 409 410 411 412

	skb = dev_alloc_skb(len + RX_OFFSET);
	if (!skb) {
		bp->stats.rx_dropped++;
		for (frag = first_frag; ; frag = NEXT_RX(frag)) {
			bp->rx_ring[frag].addr &= ~MACB_BIT(RX_USED);
			if (frag == last_frag)
				break;
		}
		wmb();
		return 1;
	}

	skb_reserve(skb, RX_OFFSET);
413
	skb_checksum_none_assert(skb);
414 415 416 417 418 419 420 421 422
	skb_put(skb, len);

	for (frag = first_frag; ; frag = NEXT_RX(frag)) {
		unsigned int frag_len = RX_BUFFER_SIZE;

		if (offset + frag_len > len) {
			BUG_ON(frag != last_frag);
			frag_len = len - offset;
		}
423 424 425 426
		skb_copy_to_linear_data_offset(skb, offset,
					       (bp->rx_buffers +
					        (RX_BUFFER_SIZE * frag)),
					       frag_len);
427 428 429 430 431 432 433 434 435 436 437 438
		offset += RX_BUFFER_SIZE;
		bp->rx_ring[frag].addr &= ~MACB_BIT(RX_USED);
		wmb();

		if (frag == last_frag)
			break;
	}

	skb->protocol = eth_type_trans(skb, bp->dev);

	bp->stats.rx_packets++;
	bp->stats.rx_bytes += len;
439 440
	netdev_dbg(bp->dev, "received skb of length %u, csum: %08x\n",
		   skb->len, skb->csum);
441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505
	netif_receive_skb(skb);

	return 0;
}

/* Mark DMA descriptors from begin up to and not including end as unused */
static void discard_partial_frame(struct macb *bp, unsigned int begin,
				  unsigned int end)
{
	unsigned int frag;

	for (frag = begin; frag != end; frag = NEXT_RX(frag))
		bp->rx_ring[frag].addr &= ~MACB_BIT(RX_USED);
	wmb();

	/*
	 * When this happens, the hardware stats registers for
	 * whatever caused this is updated, so we don't have to record
	 * anything.
	 */
}

static int macb_rx(struct macb *bp, int budget)
{
	int received = 0;
	unsigned int tail = bp->rx_tail;
	int first_frag = -1;

	for (; budget > 0; tail = NEXT_RX(tail)) {
		u32 addr, ctrl;

		rmb();
		addr = bp->rx_ring[tail].addr;
		ctrl = bp->rx_ring[tail].ctrl;

		if (!(addr & MACB_BIT(RX_USED)))
			break;

		if (ctrl & MACB_BIT(RX_SOF)) {
			if (first_frag != -1)
				discard_partial_frame(bp, first_frag, tail);
			first_frag = tail;
		}

		if (ctrl & MACB_BIT(RX_EOF)) {
			int dropped;
			BUG_ON(first_frag == -1);

			dropped = macb_rx_frame(bp, first_frag, tail);
			first_frag = -1;
			if (!dropped) {
				received++;
				budget--;
			}
		}
	}

	if (first_frag != -1)
		bp->rx_tail = first_frag;
	else
		bp->rx_tail = tail;

	return received;
}

506
static int macb_poll(struct napi_struct *napi, int budget)
507
{
508 509
	struct macb *bp = container_of(napi, struct macb, napi);
	int work_done;
510 511 512 513 514
	u32 status;

	status = macb_readl(bp, RSR);
	macb_writel(bp, RSR, status);

515
	work_done = 0;
516

517 518
	netdev_dbg(bp->dev, "poll: status = %08lx, budget = %d\n",
		   (unsigned long)status, budget);
519

520
	work_done = macb_rx(bp, budget);
521
	if (work_done < budget) {
522
		napi_complete(napi);
523

524 525 526 527 528 529
		/*
		 * We've done what we can to clean the buffers. Make sure we
		 * get notified when new packets arrive.
		 */
		macb_writel(bp, IER, MACB_RX_INT_FLAGS);
	}
530 531 532

	/* TODO: Handle errors */

533
	return work_done;
534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556
}

static irqreturn_t macb_interrupt(int irq, void *dev_id)
{
	struct net_device *dev = dev_id;
	struct macb *bp = netdev_priv(dev);
	u32 status;

	status = macb_readl(bp, ISR);

	if (unlikely(!status))
		return IRQ_NONE;

	spin_lock(&bp->lock);

	while (status) {
		/* close possible race with dev_close */
		if (unlikely(!netif_running(dev))) {
			macb_writel(bp, IDR, ~0UL);
			break;
		}

		if (status & MACB_RX_INT_FLAGS) {
557 558 559 560 561 562 563 564 565
			/*
			 * There's no point taking any more interrupts
			 * until we have processed the buffers. The
			 * scheduling call may fail if the poll routine
			 * is already scheduled, so disable interrupts
			 * now.
			 */
			macb_writel(bp, IDR, MACB_RX_INT_FLAGS);

566
			if (napi_schedule_prep(&bp->napi)) {
567
				netdev_dbg(bp->dev, "scheduling RX softirq\n");
568
				__napi_schedule(&bp->napi);
569 570 571
			}
		}

572 573
		if (status & (MACB_BIT(TCOMP) | MACB_BIT(ISR_TUND) |
			    MACB_BIT(ISR_RLE)))
574 575 576 577 578 579 580
			macb_tx(bp);

		/*
		 * Link change detection isn't possible with RMII, so we'll
		 * add that if/when we get our hands on a full-blown MII PHY.
		 */

A
Alexander Stein 已提交
581 582
		if (status & MACB_BIT(ISR_ROVR)) {
			/* We missed at least one packet */
J
Jamie Iles 已提交
583 584 585 586
			if (macb_is_gem(bp))
				bp->hw_stats.gem.rx_overruns++;
			else
				bp->hw_stats.macb.rx_overruns++;
A
Alexander Stein 已提交
587 588
		}

589 590
		if (status & MACB_BIT(HRESP)) {
			/*
591 592 593
			 * TODO: Reset the hardware, and maybe move the
			 * netdev_err to a lower-priority context as well
			 * (work queue?)
594
			 */
595
			netdev_err(dev, "DMA bus error: HRESP not OK\n");
596 597 598 599 600 601 602 603 604 605
		}

		status = macb_readl(bp, ISR);
	}

	spin_unlock(&bp->lock);

	return IRQ_HANDLED;
}

606 607 608 609 610 611 612 613 614 615 616 617 618 619 620
#ifdef CONFIG_NET_POLL_CONTROLLER
/*
 * Polling receive - used by netconsole and other diagnostic tools
 * to allow network i/o with interrupts disabled.
 */
static void macb_poll_controller(struct net_device *dev)
{
	unsigned long flags;

	local_irq_save(flags);
	macb_interrupt(dev->irq, dev);
	local_irq_restore(flags);
}
#endif

621 622 623 624 625 626
static int macb_start_xmit(struct sk_buff *skb, struct net_device *dev)
{
	struct macb *bp = netdev_priv(dev);
	dma_addr_t mapping;
	unsigned int len, entry;
	u32 ctrl;
627
	unsigned long flags;
628 629

#ifdef DEBUG
630 631 632 633 634 635
	netdev_dbg(bp->dev,
		   "start_xmit: len %u head %p data %p tail %p end %p\n",
		   skb->len, skb->head, skb->data,
		   skb_tail_pointer(skb), skb_end_pointer(skb));
	print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_OFFSET, 16, 1,
		       skb->data, 16, true);
636 637 638
#endif

	len = skb->len;
639
	spin_lock_irqsave(&bp->lock, flags);
640 641 642 643

	/* This is a hard error, log it. */
	if (TX_BUFFS_AVAIL(bp) < 1) {
		netif_stop_queue(dev);
644
		spin_unlock_irqrestore(&bp->lock, flags);
645 646 647
		netdev_err(bp->dev, "BUG! Tx Ring full when queue awake!\n");
		netdev_dbg(bp->dev, "tx_head = %u, tx_tail = %u\n",
			   bp->tx_head, bp->tx_tail);
648
		return NETDEV_TX_BUSY;
649 650 651
	}

	entry = bp->tx_head;
652
	netdev_dbg(bp->dev, "Allocated ring entry %u\n", entry);
653 654 655 656
	mapping = dma_map_single(&bp->pdev->dev, skb->data,
				 len, DMA_TO_DEVICE);
	bp->tx_skb[entry].skb = skb;
	bp->tx_skb[entry].mapping = mapping;
657 658
	netdev_dbg(bp->dev, "Mapped skb data %p to DMA addr %08lx\n",
		   skb->data, (unsigned long)mapping);
659 660 661 662 663 664 665 666 667 668 669 670 671

	ctrl = MACB_BF(TX_FRMLEN, len);
	ctrl |= MACB_BIT(TX_LAST);
	if (entry == (TX_RING_SIZE - 1))
		ctrl |= MACB_BIT(TX_WRAP);

	bp->tx_ring[entry].addr = mapping;
	bp->tx_ring[entry].ctrl = ctrl;
	wmb();

	entry = NEXT_TX(entry);
	bp->tx_head = entry;

672 673
	skb_tx_timestamp(skb);

674 675 676 677 678
	macb_writel(bp, NCR, macb_readl(bp, NCR) | MACB_BIT(TSTART));

	if (TX_BUFFS_AVAIL(bp) < 1)
		netif_stop_queue(dev);

679
	spin_unlock_irqrestore(&bp->lock, flags);
680

681
	return NETDEV_TX_OK;
682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721
}

static void macb_free_consistent(struct macb *bp)
{
	if (bp->tx_skb) {
		kfree(bp->tx_skb);
		bp->tx_skb = NULL;
	}
	if (bp->rx_ring) {
		dma_free_coherent(&bp->pdev->dev, RX_RING_BYTES,
				  bp->rx_ring, bp->rx_ring_dma);
		bp->rx_ring = NULL;
	}
	if (bp->tx_ring) {
		dma_free_coherent(&bp->pdev->dev, TX_RING_BYTES,
				  bp->tx_ring, bp->tx_ring_dma);
		bp->tx_ring = NULL;
	}
	if (bp->rx_buffers) {
		dma_free_coherent(&bp->pdev->dev,
				  RX_RING_SIZE * RX_BUFFER_SIZE,
				  bp->rx_buffers, bp->rx_buffers_dma);
		bp->rx_buffers = NULL;
	}
}

static int macb_alloc_consistent(struct macb *bp)
{
	int size;

	size = TX_RING_SIZE * sizeof(struct ring_info);
	bp->tx_skb = kmalloc(size, GFP_KERNEL);
	if (!bp->tx_skb)
		goto out_err;

	size = RX_RING_BYTES;
	bp->rx_ring = dma_alloc_coherent(&bp->pdev->dev, size,
					 &bp->rx_ring_dma, GFP_KERNEL);
	if (!bp->rx_ring)
		goto out_err;
722 723 724
	netdev_dbg(bp->dev,
		   "Allocated RX ring of %d bytes at %08lx (mapped %p)\n",
		   size, (unsigned long)bp->rx_ring_dma, bp->rx_ring);
725 726 727 728 729 730

	size = TX_RING_BYTES;
	bp->tx_ring = dma_alloc_coherent(&bp->pdev->dev, size,
					 &bp->tx_ring_dma, GFP_KERNEL);
	if (!bp->tx_ring)
		goto out_err;
731 732 733
	netdev_dbg(bp->dev,
		   "Allocated TX ring of %d bytes at %08lx (mapped %p)\n",
		   size, (unsigned long)bp->tx_ring_dma, bp->tx_ring);
734 735 736 737 738 739

	size = RX_RING_SIZE * RX_BUFFER_SIZE;
	bp->rx_buffers = dma_alloc_coherent(&bp->pdev->dev, size,
					    &bp->rx_buffers_dma, GFP_KERNEL);
	if (!bp->rx_buffers)
		goto out_err;
740 741 742
	netdev_dbg(bp->dev,
		   "Allocated RX buffers of %d bytes at %08lx (mapped %p)\n",
		   size, (unsigned long)bp->rx_buffers_dma, bp->rx_buffers);
743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795

	return 0;

out_err:
	macb_free_consistent(bp);
	return -ENOMEM;
}

static void macb_init_rings(struct macb *bp)
{
	int i;
	dma_addr_t addr;

	addr = bp->rx_buffers_dma;
	for (i = 0; i < RX_RING_SIZE; i++) {
		bp->rx_ring[i].addr = addr;
		bp->rx_ring[i].ctrl = 0;
		addr += RX_BUFFER_SIZE;
	}
	bp->rx_ring[RX_RING_SIZE - 1].addr |= MACB_BIT(RX_WRAP);

	for (i = 0; i < TX_RING_SIZE; i++) {
		bp->tx_ring[i].addr = 0;
		bp->tx_ring[i].ctrl = MACB_BIT(TX_USED);
	}
	bp->tx_ring[TX_RING_SIZE - 1].ctrl |= MACB_BIT(TX_WRAP);

	bp->rx_tail = bp->tx_head = bp->tx_tail = 0;
}

static void macb_reset_hw(struct macb *bp)
{
	/* Make sure we have the write buffer for ourselves */
	wmb();

	/*
	 * Disable RX and TX (XXX: Should we halt the transmission
	 * more gracefully?)
	 */
	macb_writel(bp, NCR, 0);

	/* Clear the stats registers (XXX: Update stats first?) */
	macb_writel(bp, NCR, MACB_BIT(CLRSTAT));

	/* Clear all status flags */
	macb_writel(bp, TSR, ~0UL);
	macb_writel(bp, RSR, ~0UL);

	/* Disable all interrupts */
	macb_writel(bp, IDR, ~0UL);
	macb_readl(bp, ISR);
}

796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837
static u32 gem_mdc_clk_div(struct macb *bp)
{
	u32 config;
	unsigned long pclk_hz = clk_get_rate(bp->pclk);

	if (pclk_hz <= 20000000)
		config = GEM_BF(CLK, GEM_CLK_DIV8);
	else if (pclk_hz <= 40000000)
		config = GEM_BF(CLK, GEM_CLK_DIV16);
	else if (pclk_hz <= 80000000)
		config = GEM_BF(CLK, GEM_CLK_DIV32);
	else if (pclk_hz <= 120000000)
		config = GEM_BF(CLK, GEM_CLK_DIV48);
	else if (pclk_hz <= 160000000)
		config = GEM_BF(CLK, GEM_CLK_DIV64);
	else
		config = GEM_BF(CLK, GEM_CLK_DIV96);

	return config;
}

static u32 macb_mdc_clk_div(struct macb *bp)
{
	u32 config;
	unsigned long pclk_hz;

	if (macb_is_gem(bp))
		return gem_mdc_clk_div(bp);

	pclk_hz = clk_get_rate(bp->pclk);
	if (pclk_hz <= 20000000)
		config = MACB_BF(CLK, MACB_CLK_DIV8);
	else if (pclk_hz <= 40000000)
		config = MACB_BF(CLK, MACB_CLK_DIV16);
	else if (pclk_hz <= 80000000)
		config = MACB_BF(CLK, MACB_CLK_DIV32);
	else
		config = MACB_BF(CLK, MACB_CLK_DIV64);

	return config;
}

838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
/*
 * Get the DMA bus width field of the network configuration register that we
 * should program.  We find the width from decoding the design configuration
 * register to find the maximum supported data bus width.
 */
static u32 macb_dbw(struct macb *bp)
{
	if (!macb_is_gem(bp))
		return 0;

	switch (GEM_BFEXT(DBWDEF, gem_readl(bp, DCFG1))) {
	case 4:
		return GEM_BF(DBW, GEM_DBW128);
	case 2:
		return GEM_BF(DBW, GEM_DBW64);
	case 1:
	default:
		return GEM_BF(DBW, GEM_DBW32);
	}
}

859 860 861 862 863 864 865 866 867 868 869 870 871 872 873
/*
 * Configure the receive DMA engine to use the correct receive buffer size.
 * This is a configurable parameter for GEM.
 */
static void macb_configure_dma(struct macb *bp)
{
	u32 dmacfg;

	if (macb_is_gem(bp)) {
		dmacfg = gem_readl(bp, DMACFG) & ~GEM_BF(RXBS, -1L);
		dmacfg |= GEM_BF(RXBS, RX_BUFFER_SIZE / 64);
		gem_writel(bp, DMACFG, dmacfg);
	}
}

874 875 876 877 878 879 880
static void macb_init_hw(struct macb *bp)
{
	u32 config;

	macb_reset_hw(bp);
	__macb_set_hwaddr(bp);

881
	config = macb_mdc_clk_div(bp);
882 883
	config |= MACB_BIT(PAE);		/* PAuse Enable */
	config |= MACB_BIT(DRFCS);		/* Discard Rx FCS */
884
	config |= MACB_BIT(BIG);		/* Receive oversized frames */
885 886 887 888
	if (bp->dev->flags & IFF_PROMISC)
		config |= MACB_BIT(CAF);	/* Copy All Frames */
	if (!(bp->dev->flags & IFF_BROADCAST))
		config |= MACB_BIT(NBC);	/* No BroadCast */
889
	config |= macb_dbw(bp);
890 891
	macb_writel(bp, NCFGR, config);

892 893
	macb_configure_dma(bp);

894 895 896 897 898
	/* Initialize TX and RX buffers */
	macb_writel(bp, RBQP, bp->rx_ring_dma);
	macb_writel(bp, TBQP, bp->tx_ring_dma);

	/* Enable TX and RX */
F
frederic RODO 已提交
899
	macb_writel(bp, NCR, MACB_BIT(RE) | MACB_BIT(TE) | MACB_BIT(MPE));
900 901 902 903 904 905 906 907 908 909 910 911 912

	/* Enable interrupts */
	macb_writel(bp, IER, (MACB_BIT(RCOMP)
			      | MACB_BIT(RXUBR)
			      | MACB_BIT(ISR_TUND)
			      | MACB_BIT(ISR_RLE)
			      | MACB_BIT(TXERR)
			      | MACB_BIT(TCOMP)
			      | MACB_BIT(ISR_ROVR)
			      | MACB_BIT(HRESP)));

}

P
Patrice Vilchez 已提交
913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976
/*
 * The hash address register is 64 bits long and takes up two
 * locations in the memory map.  The least significant bits are stored
 * in EMAC_HSL and the most significant bits in EMAC_HSH.
 *
 * The unicast hash enable and the multicast hash enable bits in the
 * network configuration register enable the reception of hash matched
 * frames. The destination address is reduced to a 6 bit index into
 * the 64 bit hash register using the following hash function.  The
 * hash function is an exclusive or of every sixth bit of the
 * destination address.
 *
 * hi[5] = da[5] ^ da[11] ^ da[17] ^ da[23] ^ da[29] ^ da[35] ^ da[41] ^ da[47]
 * hi[4] = da[4] ^ da[10] ^ da[16] ^ da[22] ^ da[28] ^ da[34] ^ da[40] ^ da[46]
 * hi[3] = da[3] ^ da[09] ^ da[15] ^ da[21] ^ da[27] ^ da[33] ^ da[39] ^ da[45]
 * hi[2] = da[2] ^ da[08] ^ da[14] ^ da[20] ^ da[26] ^ da[32] ^ da[38] ^ da[44]
 * hi[1] = da[1] ^ da[07] ^ da[13] ^ da[19] ^ da[25] ^ da[31] ^ da[37] ^ da[43]
 * hi[0] = da[0] ^ da[06] ^ da[12] ^ da[18] ^ da[24] ^ da[30] ^ da[36] ^ da[42]
 *
 * da[0] represents the least significant bit of the first byte
 * received, that is, the multicast/unicast indicator, and da[47]
 * represents the most significant bit of the last byte received.  If
 * the hash index, hi[n], points to a bit that is set in the hash
 * register then the frame will be matched according to whether the
 * frame is multicast or unicast.  A multicast match will be signalled
 * if the multicast hash enable bit is set, da[0] is 1 and the hash
 * index points to a bit set in the hash register.  A unicast match
 * will be signalled if the unicast hash enable bit is set, da[0] is 0
 * and the hash index points to a bit set in the hash register.  To
 * receive all multicast frames, the hash register should be set with
 * all ones and the multicast hash enable bit should be set in the
 * network configuration register.
 */

static inline int hash_bit_value(int bitnr, __u8 *addr)
{
	if (addr[bitnr / 8] & (1 << (bitnr % 8)))
		return 1;
	return 0;
}

/*
 * Return the hash index value for the specified address.
 */
static int hash_get_index(__u8 *addr)
{
	int i, j, bitval;
	int hash_index = 0;

	for (j = 0; j < 6; j++) {
		for (i = 0, bitval = 0; i < 8; i++)
			bitval ^= hash_bit_value(i*6 + j, addr);

		hash_index |= (bitval << j);
	}

	return hash_index;
}

/*
 * Add multicast addresses to the internal multicast-hash table.
 */
static void macb_sethashtable(struct net_device *dev)
{
977
	struct netdev_hw_addr *ha;
P
Patrice Vilchez 已提交
978
	unsigned long mc_filter[2];
979
	unsigned int bitnr;
P
Patrice Vilchez 已提交
980 981 982 983
	struct macb *bp = netdev_priv(dev);

	mc_filter[0] = mc_filter[1] = 0;

984 985
	netdev_for_each_mc_addr(ha, dev) {
		bitnr = hash_get_index(ha->addr);
P
Patrice Vilchez 已提交
986 987 988
		mc_filter[bitnr >> 5] |= 1 << (bitnr & 31);
	}

J
Jamie Iles 已提交
989 990
	macb_or_gem_writel(bp, HRB, mc_filter[0]);
	macb_or_gem_writel(bp, HRT, mc_filter[1]);
P
Patrice Vilchez 已提交
991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
}

/*
 * Enable/Disable promiscuous and multicast modes.
 */
static void macb_set_rx_mode(struct net_device *dev)
{
	unsigned long cfg;
	struct macb *bp = netdev_priv(dev);

	cfg = macb_readl(bp, NCFGR);

	if (dev->flags & IFF_PROMISC)
		/* Enable promiscuous mode */
		cfg |= MACB_BIT(CAF);
	else if (dev->flags & (~IFF_PROMISC))
		 /* Disable promiscuous mode */
		cfg &= ~MACB_BIT(CAF);

	if (dev->flags & IFF_ALLMULTI) {
		/* Enable all multicast mode */
J
Jamie Iles 已提交
1012 1013
		macb_or_gem_writel(bp, HRB, -1);
		macb_or_gem_writel(bp, HRT, -1);
P
Patrice Vilchez 已提交
1014
		cfg |= MACB_BIT(NCFGR_MTI);
1015
	} else if (!netdev_mc_empty(dev)) {
P
Patrice Vilchez 已提交
1016 1017 1018 1019 1020
		/* Enable specific multicasts */
		macb_sethashtable(dev);
		cfg |= MACB_BIT(NCFGR_MTI);
	} else if (dev->flags & (~IFF_ALLMULTI)) {
		/* Disable all multicast mode */
J
Jamie Iles 已提交
1021 1022
		macb_or_gem_writel(bp, HRB, 0);
		macb_or_gem_writel(bp, HRT, 0);
P
Patrice Vilchez 已提交
1023 1024 1025 1026 1027 1028
		cfg &= ~MACB_BIT(NCFGR_MTI);
	}

	macb_writel(bp, NCFGR, cfg);
}

1029 1030 1031 1032 1033
static int macb_open(struct net_device *dev)
{
	struct macb *bp = netdev_priv(dev);
	int err;

1034
	netdev_dbg(bp->dev, "open\n");
1035

F
frederic RODO 已提交
1036 1037 1038 1039
	/* if the phy is not yet register, retry later*/
	if (!bp->phy_dev)
		return -EAGAIN;

1040 1041 1042 1043 1044
	if (!is_valid_ether_addr(dev->dev_addr))
		return -EADDRNOTAVAIL;

	err = macb_alloc_consistent(bp);
	if (err) {
1045 1046
		netdev_err(dev, "Unable to allocate DMA memory (error %d)\n",
			   err);
1047 1048 1049
		return err;
	}

1050 1051
	napi_enable(&bp->napi);

1052 1053 1054
	macb_init_rings(bp);
	macb_init_hw(bp);

F
frederic RODO 已提交
1055 1056
	/* schedule a link state check */
	phy_start(bp->phy_dev);
1057

F
frederic RODO 已提交
1058
	netif_start_queue(dev);
1059 1060 1061 1062 1063 1064 1065 1066 1067 1068

	return 0;
}

static int macb_close(struct net_device *dev)
{
	struct macb *bp = netdev_priv(dev);
	unsigned long flags;

	netif_stop_queue(dev);
1069
	napi_disable(&bp->napi);
1070

F
frederic RODO 已提交
1071 1072 1073
	if (bp->phy_dev)
		phy_stop(bp->phy_dev);

1074 1075 1076 1077 1078 1079 1080 1081 1082 1083
	spin_lock_irqsave(&bp->lock, flags);
	macb_reset_hw(bp);
	netif_carrier_off(dev);
	spin_unlock_irqrestore(&bp->lock, flags);

	macb_free_consistent(bp);

	return 0;
}

1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131
static void gem_update_stats(struct macb *bp)
{
	u32 __iomem *reg = bp->regs + GEM_OTX;
	u32 *p = &bp->hw_stats.gem.tx_octets_31_0;
	u32 *end = &bp->hw_stats.gem.rx_udp_checksum_errors + 1;

	for (; p < end; p++, reg++)
		*p += __raw_readl(reg);
}

static struct net_device_stats *gem_get_stats(struct macb *bp)
{
	struct gem_stats *hwstat = &bp->hw_stats.gem;
	struct net_device_stats *nstat = &bp->stats;

	gem_update_stats(bp);

	nstat->rx_errors = (hwstat->rx_frame_check_sequence_errors +
			    hwstat->rx_alignment_errors +
			    hwstat->rx_resource_errors +
			    hwstat->rx_overruns +
			    hwstat->rx_oversize_frames +
			    hwstat->rx_jabbers +
			    hwstat->rx_undersized_frames +
			    hwstat->rx_length_field_frame_errors);
	nstat->tx_errors = (hwstat->tx_late_collisions +
			    hwstat->tx_excessive_collisions +
			    hwstat->tx_underrun +
			    hwstat->tx_carrier_sense_errors);
	nstat->multicast = hwstat->rx_multicast_frames;
	nstat->collisions = (hwstat->tx_single_collision_frames +
			     hwstat->tx_multiple_collision_frames +
			     hwstat->tx_excessive_collisions);
	nstat->rx_length_errors = (hwstat->rx_oversize_frames +
				   hwstat->rx_jabbers +
				   hwstat->rx_undersized_frames +
				   hwstat->rx_length_field_frame_errors);
	nstat->rx_over_errors = hwstat->rx_resource_errors;
	nstat->rx_crc_errors = hwstat->rx_frame_check_sequence_errors;
	nstat->rx_frame_errors = hwstat->rx_alignment_errors;
	nstat->rx_fifo_errors = hwstat->rx_overruns;
	nstat->tx_aborted_errors = hwstat->tx_excessive_collisions;
	nstat->tx_carrier_errors = hwstat->tx_carrier_sense_errors;
	nstat->tx_fifo_errors = hwstat->tx_underrun;

	return nstat;
}

1132 1133 1134 1135
static struct net_device_stats *macb_get_stats(struct net_device *dev)
{
	struct macb *bp = netdev_priv(dev);
	struct net_device_stats *nstat = &bp->stats;
1136 1137 1138 1139
	struct macb_stats *hwstat = &bp->hw_stats.macb;

	if (macb_is_gem(bp))
		return gem_get_stats(bp);
1140

F
frederic RODO 已提交
1141 1142 1143
	/* read stats from hardware */
	macb_update_stats(bp);

1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164
	/* Convert HW stats into netdevice stats */
	nstat->rx_errors = (hwstat->rx_fcs_errors +
			    hwstat->rx_align_errors +
			    hwstat->rx_resource_errors +
			    hwstat->rx_overruns +
			    hwstat->rx_oversize_pkts +
			    hwstat->rx_jabbers +
			    hwstat->rx_undersize_pkts +
			    hwstat->sqe_test_errors +
			    hwstat->rx_length_mismatch);
	nstat->tx_errors = (hwstat->tx_late_cols +
			    hwstat->tx_excessive_cols +
			    hwstat->tx_underruns +
			    hwstat->tx_carrier_errors);
	nstat->collisions = (hwstat->tx_single_cols +
			     hwstat->tx_multiple_cols +
			     hwstat->tx_excessive_cols);
	nstat->rx_length_errors = (hwstat->rx_oversize_pkts +
				   hwstat->rx_jabbers +
				   hwstat->rx_undersize_pkts +
				   hwstat->rx_length_mismatch);
A
Alexander Stein 已提交
1165 1166
	nstat->rx_over_errors = hwstat->rx_resource_errors +
				   hwstat->rx_overruns;
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181
	nstat->rx_crc_errors = hwstat->rx_fcs_errors;
	nstat->rx_frame_errors = hwstat->rx_align_errors;
	nstat->rx_fifo_errors = hwstat->rx_overruns;
	/* XXX: What does "missed" mean? */
	nstat->tx_aborted_errors = hwstat->tx_excessive_cols;
	nstat->tx_carrier_errors = hwstat->tx_carrier_errors;
	nstat->tx_fifo_errors = hwstat->tx_underruns;
	/* Don't know about heartbeat or window errors... */

	return nstat;
}

static int macb_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
	struct macb *bp = netdev_priv(dev);
F
frederic RODO 已提交
1182 1183 1184 1185
	struct phy_device *phydev = bp->phy_dev;

	if (!phydev)
		return -ENODEV;
1186

F
frederic RODO 已提交
1187
	return phy_ethtool_gset(phydev, cmd);
1188 1189 1190 1191 1192
}

static int macb_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
	struct macb *bp = netdev_priv(dev);
F
frederic RODO 已提交
1193
	struct phy_device *phydev = bp->phy_dev;
1194

F
frederic RODO 已提交
1195 1196 1197 1198
	if (!phydev)
		return -ENODEV;

	return phy_ethtool_sset(phydev, cmd);
1199 1200
}

F
frederic RODO 已提交
1201 1202
static void macb_get_drvinfo(struct net_device *dev,
			     struct ethtool_drvinfo *info)
1203 1204 1205 1206 1207
{
	struct macb *bp = netdev_priv(dev);

	strcpy(info->driver, bp->pdev->dev.driver->name);
	strcpy(info->version, "$Revision: 1.14 $");
1208
	strcpy(info->bus_info, dev_name(&bp->pdev->dev));
1209 1210
}

1211
static const struct ethtool_ops macb_ethtool_ops = {
1212 1213 1214 1215 1216 1217 1218 1219 1220
	.get_settings		= macb_get_settings,
	.set_settings		= macb_set_settings,
	.get_drvinfo		= macb_get_drvinfo,
	.get_link		= ethtool_op_get_link,
};

static int macb_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
	struct macb *bp = netdev_priv(dev);
F
frederic RODO 已提交
1221
	struct phy_device *phydev = bp->phy_dev;
1222 1223 1224 1225

	if (!netif_running(dev))
		return -EINVAL;

F
frederic RODO 已提交
1226 1227
	if (!phydev)
		return -ENODEV;
1228

1229
	return phy_mii_ioctl(phydev, rq, cmd);
1230 1231
}

1232 1233 1234 1235
static const struct net_device_ops macb_netdev_ops = {
	.ndo_open		= macb_open,
	.ndo_stop		= macb_close,
	.ndo_start_xmit		= macb_start_xmit,
1236
	.ndo_set_rx_mode	= macb_set_rx_mode,
1237 1238 1239 1240 1241
	.ndo_get_stats		= macb_get_stats,
	.ndo_do_ioctl		= macb_ioctl,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= eth_change_mtu,
	.ndo_set_mac_address	= eth_mac_addr,
1242 1243 1244
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= macb_poll_controller,
#endif
1245 1246
};

1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292
#if defined(CONFIG_OF)
static const struct of_device_id macb_dt_ids[] = {
	{ .compatible = "cdns,at32ap7000-macb" },
	{ .compatible = "cdns,at91sam9260-macb" },
	{ .compatible = "cdns,macb" },
	{ .compatible = "cdns,pc302-gem" },
	{ .compatible = "cdns,gem" },
	{ /* sentinel */ }
};

MODULE_DEVICE_TABLE(of, macb_dt_ids);

static int __devinit macb_get_phy_mode_dt(struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;

	if (np)
		return of_get_phy_mode(np);

	return -ENODEV;
}

static int __devinit macb_get_hwaddr_dt(struct macb *bp)
{
	struct device_node *np = bp->pdev->dev.of_node;
	if (np) {
		const char *mac = of_get_mac_address(np);
		if (mac) {
			memcpy(bp->dev->dev_addr, mac, ETH_ALEN);
			return 0;
		}
	}

	return -ENODEV;
}
#else
static int __devinit macb_get_phy_mode_dt(struct platform_device *pdev)
{
	return -ENODEV;
}
static int __devinit macb_get_hwaddr_dt(struct macb *bp)
{
	return -ENODEV;
}
#endif

1293
static int __init macb_probe(struct platform_device *pdev)
1294
{
1295
	struct macb_platform_data *pdata;
1296 1297 1298
	struct resource *regs;
	struct net_device *dev;
	struct macb *bp;
F
frederic RODO 已提交
1299
	struct phy_device *phydev;
1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326
	u32 config;
	int err = -ENXIO;

	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!regs) {
		dev_err(&pdev->dev, "no mmio resource defined\n");
		goto err_out;
	}

	err = -ENOMEM;
	dev = alloc_etherdev(sizeof(*bp));
	if (!dev) {
		dev_err(&pdev->dev, "etherdev alloc failed, aborting.\n");
		goto err_out;
	}

	SET_NETDEV_DEV(dev, &pdev->dev);

	/* TODO: Actually, we have some interesting features... */
	dev->features |= 0;

	bp = netdev_priv(dev);
	bp->pdev = pdev;
	bp->dev = dev;

	spin_lock_init(&bp->lock);

J
Jamie Iles 已提交
1327
	bp->pclk = clk_get(&pdev->dev, "pclk");
A
Andrew Victor 已提交
1328 1329 1330 1331 1332
	if (IS_ERR(bp->pclk)) {
		dev_err(&pdev->dev, "failed to get macb_clk\n");
		goto err_out_free_dev;
	}
	clk_enable(bp->pclk);
J
Jamie Iles 已提交
1333

1334 1335 1336 1337 1338 1339 1340
	bp->hclk = clk_get(&pdev->dev, "hclk");
	if (IS_ERR(bp->hclk)) {
		dev_err(&pdev->dev, "failed to get hclk\n");
		goto err_out_put_pclk;
	}
	clk_enable(bp->hclk);

1341
	bp->regs = ioremap(regs->start, resource_size(regs));
1342 1343 1344 1345 1346 1347 1348
	if (!bp->regs) {
		dev_err(&pdev->dev, "failed to map registers, aborting.\n");
		err = -ENOMEM;
		goto err_out_disable_clocks;
	}

	dev->irq = platform_get_irq(pdev, 0);
1349
	err = request_irq(dev->irq, macb_interrupt, 0, dev->name, dev);
1350
	if (err) {
1351 1352
		dev_err(&pdev->dev, "Unable to request IRQ %d (error %d)\n",
			dev->irq, err);
1353 1354 1355
		goto err_out_iounmap;
	}

1356
	dev->netdev_ops = &macb_netdev_ops;
1357
	netif_napi_add(dev, &bp->napi, macb_poll, 64);
1358 1359 1360 1361 1362
	dev->ethtool_ops = &macb_ethtool_ops;

	dev->base_addr = regs->start;

	/* Set MII management clock divider */
1363
	config = macb_mdc_clk_div(bp);
1364
	config |= macb_dbw(bp);
1365 1366
	macb_writel(bp, NCFGR, config);

1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380
	err = macb_get_hwaddr_dt(bp);
	if (err < 0)
		macb_get_hwaddr(bp);

	err = macb_get_phy_mode_dt(pdev);
	if (err < 0) {
		pdata = pdev->dev.platform_data;
		if (pdata && pdata->is_rmii)
			bp->phy_interface = PHY_INTERFACE_MODE_RMII;
		else
			bp->phy_interface = PHY_INTERFACE_MODE_MII;
	} else {
		bp->phy_interface = err;
	}
F
frederic RODO 已提交
1381

1382
	if (bp->phy_interface == PHY_INTERFACE_MODE_RMII)
A
Andrew Victor 已提交
1383
#if defined(CONFIG_ARCH_AT91)
J
Jamie Iles 已提交
1384 1385
		macb_or_gem_writel(bp, USRIO, (MACB_BIT(RMII) |
					       MACB_BIT(CLKEN)));
A
Andrew Victor 已提交
1386
#else
J
Jamie Iles 已提交
1387
		macb_or_gem_writel(bp, USRIO, 0);
A
Andrew Victor 已提交
1388
#endif
1389
	else
A
Andrew Victor 已提交
1390
#if defined(CONFIG_ARCH_AT91)
J
Jamie Iles 已提交
1391
		macb_or_gem_writel(bp, USRIO, MACB_BIT(CLKEN));
A
Andrew Victor 已提交
1392
#else
J
Jamie Iles 已提交
1393
		macb_or_gem_writel(bp, USRIO, MACB_BIT(MII));
A
Andrew Victor 已提交
1394
#endif
1395 1396 1397 1398 1399 1400 1401 1402 1403

	bp->tx_pending = DEF_TX_RING_PENDING;

	err = register_netdev(dev);
	if (err) {
		dev_err(&pdev->dev, "Cannot register net device, aborting.\n");
		goto err_out_free_irq;
	}

F
frederic RODO 已提交
1404 1405 1406
	if (macb_mii_init(bp) != 0) {
		goto err_out_unregister_netdev;
	}
1407

F
frederic RODO 已提交
1408
	platform_set_drvdata(pdev, dev);
1409

J
Jamie Iles 已提交
1410 1411 1412
	netdev_info(dev, "Cadence %s at 0x%08lx irq %d (%pM)\n",
		    macb_is_gem(bp) ? "GEM" : "MACB", dev->base_addr,
		    dev->irq, dev->dev_addr);
1413

F
frederic RODO 已提交
1414
	phydev = bp->phy_dev;
1415 1416
	netdev_info(dev, "attached PHY driver [%s] (mii_bus:phy_addr=%s, irq=%d)\n",
		    phydev->drv->name, dev_name(&phydev->dev), phydev->irq);
F
frederic RODO 已提交
1417

1418 1419
	return 0;

F
frederic RODO 已提交
1420 1421
err_out_unregister_netdev:
	unregister_netdev(dev);
1422 1423 1424 1425 1426 1427 1428
err_out_free_irq:
	free_irq(dev->irq, dev);
err_out_iounmap:
	iounmap(bp->regs);
err_out_disable_clocks:
	clk_disable(bp->hclk);
	clk_put(bp->hclk);
A
Andrew Victor 已提交
1429
	clk_disable(bp->pclk);
1430 1431 1432 1433 1434 1435 1436 1437 1438
err_out_put_pclk:
	clk_put(bp->pclk);
err_out_free_dev:
	free_netdev(dev);
err_out:
	platform_set_drvdata(pdev, NULL);
	return err;
}

1439
static int __exit macb_remove(struct platform_device *pdev)
1440 1441 1442 1443 1444 1445 1446 1447
{
	struct net_device *dev;
	struct macb *bp;

	dev = platform_get_drvdata(pdev);

	if (dev) {
		bp = netdev_priv(dev);
1448 1449
		if (bp->phy_dev)
			phy_disconnect(bp->phy_dev);
1450 1451 1452
		mdiobus_unregister(bp->mii_bus);
		kfree(bp->mii_bus->irq);
		mdiobus_free(bp->mii_bus);
1453 1454 1455 1456 1457
		unregister_netdev(dev);
		free_irq(dev->irq, dev);
		iounmap(bp->regs);
		clk_disable(bp->hclk);
		clk_put(bp->hclk);
A
Andrew Victor 已提交
1458
		clk_disable(bp->pclk);
1459 1460 1461 1462 1463 1464 1465 1466
		clk_put(bp->pclk);
		free_netdev(dev);
		platform_set_drvdata(pdev, NULL);
	}

	return 0;
}

1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497
#ifdef CONFIG_PM
static int macb_suspend(struct platform_device *pdev, pm_message_t state)
{
	struct net_device *netdev = platform_get_drvdata(pdev);
	struct macb *bp = netdev_priv(netdev);

	netif_device_detach(netdev);

	clk_disable(bp->hclk);
	clk_disable(bp->pclk);

	return 0;
}

static int macb_resume(struct platform_device *pdev)
{
	struct net_device *netdev = platform_get_drvdata(pdev);
	struct macb *bp = netdev_priv(netdev);

	clk_enable(bp->pclk);
	clk_enable(bp->hclk);

	netif_device_attach(netdev);

	return 0;
}
#else
#define macb_suspend	NULL
#define macb_resume	NULL
#endif

1498
static struct platform_driver macb_driver = {
1499
	.remove		= __exit_p(macb_remove),
1500 1501
	.suspend	= macb_suspend,
	.resume		= macb_resume,
1502 1503
	.driver		= {
		.name		= "macb",
1504
		.owner	= THIS_MODULE,
1505
		.of_match_table	= of_match_ptr(macb_dt_ids),
1506 1507 1508 1509 1510
	},
};

static int __init macb_init(void)
{
1511
	return platform_driver_probe(&macb_driver, macb_probe);
1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522
}

static void __exit macb_exit(void)
{
	platform_driver_unregister(&macb_driver);
}

module_init(macb_init);
module_exit(macb_exit);

MODULE_LICENSE("GPL");
J
Jamie Iles 已提交
1523
MODULE_DESCRIPTION("Cadence MACB/GEM Ethernet driver");
J
Jean Delvare 已提交
1524
MODULE_AUTHOR("Haavard Skinnemoen (Atmel)");
1525
MODULE_ALIAS("platform:macb");