au1000_eth.c 36.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4
/*
 *
 * Alchemy Au1x00 ethernet driver
 *
5
 * Copyright 2001-2003, 2006 MontaVista Software Inc.
L
Linus Torvalds 已提交
6 7 8
 * Copyright 2002 TimeSys Corp.
 * Added ethtool/mii-tool support,
 * Copyright 2004 Matt Porter <mporter@kernel.crashing.org>
9 10
 * Update: 2004 Bjoern Riemer, riemer@fokus.fraunhofer.de
 * or riemer@riemer-nt.de: fixed the link beat detection with
L
Linus Torvalds 已提交
11
 * ioctls (SIOCGMIIPHY)
12 13 14
 * Copyright 2006 Herbert Valerio Riedel <hvr@gnu.org>
 *  converted to use linux-2.6.x's PHY framework
 *
L
Linus Torvalds 已提交
15
 * Author: MontaVista Software, Inc.
F
Florian Fainelli 已提交
16
 *		ppopov@mvista.com or source@mvista.com
L
Linus Torvalds 已提交
17 18 19 20 21 22 23 24 25 26 27 28 29
 *
 * ########################################################################
 *
 *  This program is free software; you can distribute it and/or modify it
 *  under the terms of the GNU General Public License (Version 2) as
 *  published by the Free Software Foundation.
 *
 *  This program is distributed in the hope it will be useful, but WITHOUT
 *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 *  for more details.
 *
 *  You should have received a copy of the GNU General Public License along
30
 *  with this program; if not, see <http://www.gnu.org/licenses/>.
L
Linus Torvalds 已提交
31 32 33
 *
 * ########################################################################
 *
34
 *
L
Linus Torvalds 已提交
35
 */
36 37
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

38
#include <linux/capability.h>
R
Ralf Baechle 已提交
39
#include <linux/dma-mapping.h>
L
Linus Torvalds 已提交
40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/timer.h>
#include <linux/errno.h>
#include <linux/in.h>
#include <linux/ioport.h>
#include <linux/bitops.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/ethtool.h>
#include <linux/mii.h>
#include <linux/skbuff.h>
#include <linux/delay.h>
56
#include <linux/crc32.h>
57
#include <linux/phy.h>
58
#include <linux/platform_device.h>
59 60
#include <linux/cpu.h>
#include <linux/io.h>
Y
Yoichi Yuasa 已提交
61

L
Linus Torvalds 已提交
62 63 64 65
#include <asm/mipsregs.h>
#include <asm/irq.h>
#include <asm/processor.h>

Y
Yoichi Yuasa 已提交
66
#include <au1000.h>
67
#include <au1xxx_eth.h>
Y
Yoichi Yuasa 已提交
68 69
#include <prom.h>

L
Linus Torvalds 已提交
70 71 72 73 74 75 76 77
#include "au1000_eth.h"

#ifdef AU1000_ETH_DEBUG
static int au1000_debug = 5;
#else
static int au1000_debug = 3;
#endif

78 79 80 81
#define AU1000_DEF_MSG_ENABLE	(NETIF_MSG_DRV	| \
				NETIF_MSG_PROBE	| \
				NETIF_MSG_LINK)

82
#define DRV_NAME	"au1000_eth"
F
Florian Fainelli 已提交
83
#define DRV_VERSION	"1.7"
L
Linus Torvalds 已提交
84 85 86 87 88 89
#define DRV_AUTHOR	"Pete Popov <ppopov@embeddedalley.com>"
#define DRV_DESC	"Au1xxx on-chip Ethernet driver"

MODULE_AUTHOR(DRV_AUTHOR);
MODULE_DESCRIPTION(DRV_DESC);
MODULE_LICENSE("GPL");
90
MODULE_VERSION(DRV_VERSION);
L
Linus Torvalds 已提交
91

92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
/* AU1000 MAC registers and bits */
#define MAC_CONTROL		0x0
#  define MAC_RX_ENABLE		(1 << 2)
#  define MAC_TX_ENABLE		(1 << 3)
#  define MAC_DEF_CHECK		(1 << 5)
#  define MAC_SET_BL(X)		(((X) & 0x3) << 6)
#  define MAC_AUTO_PAD		(1 << 8)
#  define MAC_DISABLE_RETRY	(1 << 10)
#  define MAC_DISABLE_BCAST	(1 << 11)
#  define MAC_LATE_COL		(1 << 12)
#  define MAC_HASH_MODE		(1 << 13)
#  define MAC_HASH_ONLY		(1 << 15)
#  define MAC_PASS_ALL		(1 << 16)
#  define MAC_INVERSE_FILTER	(1 << 17)
#  define MAC_PROMISCUOUS	(1 << 18)
#  define MAC_PASS_ALL_MULTI	(1 << 19)
#  define MAC_FULL_DUPLEX	(1 << 20)
#  define MAC_NORMAL_MODE	0
#  define MAC_INT_LOOPBACK	(1 << 21)
#  define MAC_EXT_LOOPBACK	(1 << 22)
#  define MAC_DISABLE_RX_OWN	(1 << 23)
#  define MAC_BIG_ENDIAN	(1 << 30)
#  define MAC_RX_ALL		(1 << 31)
#define MAC_ADDRESS_HIGH	0x4
#define MAC_ADDRESS_LOW		0x8
#define MAC_MCAST_HIGH		0xC
#define MAC_MCAST_LOW		0x10
#define MAC_MII_CNTRL		0x14
#  define MAC_MII_BUSY		(1 << 0)
#  define MAC_MII_READ		0
#  define MAC_MII_WRITE		(1 << 1)
#  define MAC_SET_MII_SELECT_REG(X) (((X) & 0x1f) << 6)
#  define MAC_SET_MII_SELECT_PHY(X) (((X) & 0x1f) << 11)
#define MAC_MII_DATA		0x18
#define MAC_FLOW_CNTRL		0x1C
#  define MAC_FLOW_CNTRL_BUSY	(1 << 0)
#  define MAC_FLOW_CNTRL_ENABLE (1 << 1)
#  define MAC_PASS_CONTROL	(1 << 2)
#  define MAC_SET_PAUSE(X)	(((X) & 0xffff) << 16)
#define MAC_VLAN1_TAG		0x20
#define MAC_VLAN2_TAG		0x24

/* Ethernet Controller Enable */
#  define MAC_EN_CLOCK_ENABLE	(1 << 0)
#  define MAC_EN_RESET0		(1 << 1)
#  define MAC_EN_TOSS		(0 << 2)
#  define MAC_EN_CACHEABLE	(1 << 3)
#  define MAC_EN_RESET1		(1 << 4)
#  define MAC_EN_RESET2		(1 << 5)
#  define MAC_DMA_RESET		(1 << 6)

/* Ethernet Controller DMA Channels */
/* offsets from MAC_TX_RING_ADDR address */
#define MAC_TX_BUFF0_STATUS	0x0
#  define TX_FRAME_ABORTED	(1 << 0)
#  define TX_JAB_TIMEOUT	(1 << 1)
#  define TX_NO_CARRIER		(1 << 2)
#  define TX_LOSS_CARRIER	(1 << 3)
#  define TX_EXC_DEF		(1 << 4)
#  define TX_LATE_COLL_ABORT	(1 << 5)
#  define TX_EXC_COLL		(1 << 6)
#  define TX_UNDERRUN		(1 << 7)
#  define TX_DEFERRED		(1 << 8)
#  define TX_LATE_COLL		(1 << 9)
#  define TX_COLL_CNT_MASK	(0xF << 10)
#  define TX_PKT_RETRY		(1 << 31)
#define MAC_TX_BUFF0_ADDR	0x4
#  define TX_DMA_ENABLE		(1 << 0)
#  define TX_T_DONE		(1 << 1)
#  define TX_GET_DMA_BUFFER(X)	(((X) >> 2) & 0x3)
#define MAC_TX_BUFF0_LEN	0x8
#define MAC_TX_BUFF1_STATUS	0x10
#define MAC_TX_BUFF1_ADDR	0x14
#define MAC_TX_BUFF1_LEN	0x18
#define MAC_TX_BUFF2_STATUS	0x20
#define MAC_TX_BUFF2_ADDR	0x24
#define MAC_TX_BUFF2_LEN	0x28
#define MAC_TX_BUFF3_STATUS	0x30
#define MAC_TX_BUFF3_ADDR	0x34
#define MAC_TX_BUFF3_LEN	0x38

/* offsets from MAC_RX_RING_ADDR */
#define MAC_RX_BUFF0_STATUS	0x0
#  define RX_FRAME_LEN_MASK	0x3fff
#  define RX_WDOG_TIMER		(1 << 14)
#  define RX_RUNT		(1 << 15)
#  define RX_OVERLEN		(1 << 16)
#  define RX_COLL		(1 << 17)
#  define RX_ETHER		(1 << 18)
#  define RX_MII_ERROR		(1 << 19)
#  define RX_DRIBBLING		(1 << 20)
#  define RX_CRC_ERROR		(1 << 21)
#  define RX_VLAN1		(1 << 22)
#  define RX_VLAN2		(1 << 23)
#  define RX_LEN_ERROR		(1 << 24)
#  define RX_CNTRL_FRAME	(1 << 25)
#  define RX_U_CNTRL_FRAME	(1 << 26)
#  define RX_MCAST_FRAME	(1 << 27)
#  define RX_BCAST_FRAME	(1 << 28)
#  define RX_FILTER_FAIL	(1 << 29)
#  define RX_PACKET_FILTER	(1 << 30)
#  define RX_MISSED_FRAME	(1 << 31)

#  define RX_ERROR (RX_WDOG_TIMER | RX_RUNT | RX_OVERLEN |  \
		    RX_COLL | RX_MII_ERROR | RX_CRC_ERROR | \
		    RX_LEN_ERROR | RX_U_CNTRL_FRAME | RX_MISSED_FRAME)
#define MAC_RX_BUFF0_ADDR	0x4
#  define RX_DMA_ENABLE		(1 << 0)
#  define RX_T_DONE		(1 << 1)
#  define RX_GET_DMA_BUFFER(X)	(((X) >> 2) & 0x3)
#  define RX_SET_BUFF_ADDR(X)	((X) & 0xffffffc0)
#define MAC_RX_BUFF1_STATUS	0x10
#define MAC_RX_BUFF1_ADDR	0x14
#define MAC_RX_BUFF2_STATUS	0x20
#define MAC_RX_BUFF2_ADDR	0x24
#define MAC_RX_BUFF3_STATUS	0x30
#define MAC_RX_BUFF3_ADDR	0x34

L
Linus Torvalds 已提交
210 211 212
/*
 * Theory of operation
 *
213 214 215
 * The Au1000 MACs use a simple rx and tx descriptor ring scheme.
 * There are four receive and four transmit descriptors.  These
 * descriptors are not in memory; rather, they are just a set of
L
Linus Torvalds 已提交
216 217 218
 * hardware registers.
 *
 * Since the Au1000 has a coherent data cache, the receive and
219
 * transmit buffers are allocated from the KSEG0 segment. The
L
Linus Torvalds 已提交
220 221 222 223 224
 * hardware registers, however, are still mapped at KSEG1 to
 * make sure there's no out-of-order writes, and that all writes
 * complete immediately.
 */

225 226 227 228 229
/*
 * board-specific configurations
 *
 * PHY detection algorithm
 *
230
 * If phy_static_config is undefined, the PHY setup is
231 232 233
 * autodetected:
 *
 * mii_probe() first searches the current MAC's MII bus for a PHY,
234
 * selecting the first (or last, if phy_search_highest_addr is
235 236 237
 * defined) PHY address not already claimed by another netdev.
 *
 * If nothing was found that way when searching for the 2nd ethernet
238
 * controller's PHY and phy1_search_mac0 is defined, then
239 240 241 242 243 244
 * the first MII bus is searched as well for an unclaimed PHY; this is
 * needed in case of a dual-PHY accessible only through the MAC0's MII
 * bus.
 *
 * Finally, if no PHY is found, then the corresponding ethernet
 * controller is not registered to the network subsystem.
L
Linus Torvalds 已提交
245 246
 */

247
/* autodetection defaults: phy1_search_mac0 */
L
Linus Torvalds 已提交
248

249 250 251 252 253 254 255 256 257 258 259 260 261 262
/* static PHY setup
 *
 * most boards PHY setup should be detectable properly with the
 * autodetection algorithm in mii_probe(), but in some cases (e.g. if
 * you have a switch attached, or want to use the PHY's interrupt
 * notification capabilities) you can provide a static PHY
 * configuration here
 *
 * IRQs may only be set, if a PHY address was configured
 * If a PHY address is given, also a bus id is required to be set
 *
 * ps: make sure the used irqs are configured properly in the board
 * specific irq-map
 */
L
Linus Torvalds 已提交
263

264
static void au1000_enable_mac(struct net_device *dev, int force_reset)
F
Florian Fainelli 已提交
265 266 267 268 269 270
{
	unsigned long flags;
	struct au1000_private *aup = netdev_priv(dev);

	spin_lock_irqsave(&aup->lock, flags);

F
Florian Fainelli 已提交
271
	if (force_reset || (!aup->mac_enabled)) {
272
		writel(MAC_EN_CLOCK_ENABLE, aup->enable);
273 274
		wmb(); /* drain writebuffer */
		mdelay(2);
275
		writel((MAC_EN_RESET0 | MAC_EN_RESET1 | MAC_EN_RESET2
276
				| MAC_EN_CLOCK_ENABLE), aup->enable);
277 278
		wmb(); /* drain writebuffer */
		mdelay(2);
F
Florian Fainelli 已提交
279 280 281 282 283 284 285

		aup->mac_enabled = 1;
	}

	spin_unlock_irqrestore(&aup->lock, flags);
}

286 287 288
/*
 * MII operations
 */
289
static int au1000_mdio_read(struct net_device *dev, int phy_addr, int reg)
L
Linus Torvalds 已提交
290
{
291
	struct au1000_private *aup = netdev_priv(dev);
292 293
	u32 *const mii_control_reg = &aup->mac->mii_control;
	u32 *const mii_data_reg = &aup->mac->mii_data;
L
Linus Torvalds 已提交
294 295 296
	u32 timedout = 20;
	u32 mii_control;

297
	while (readl(mii_control_reg) & MAC_MII_BUSY) {
L
Linus Torvalds 已提交
298 299
		mdelay(1);
		if (--timedout == 0) {
300
			netdev_err(dev, "read_MII busy timeout!!\n");
L
Linus Torvalds 已提交
301 302 303 304
			return -1;
		}
	}

305
	mii_control = MAC_SET_MII_SELECT_REG(reg) |
306
		MAC_SET_MII_SELECT_PHY(phy_addr) | MAC_MII_READ;
L
Linus Torvalds 已提交
307

308
	writel(mii_control, mii_control_reg);
L
Linus Torvalds 已提交
309 310

	timedout = 20;
311
	while (readl(mii_control_reg) & MAC_MII_BUSY) {
L
Linus Torvalds 已提交
312 313
		mdelay(1);
		if (--timedout == 0) {
314
			netdev_err(dev, "mdio_read busy timeout!!\n");
L
Linus Torvalds 已提交
315 316 317
			return -1;
		}
	}
318
	return readl(mii_data_reg);
L
Linus Torvalds 已提交
319 320
}

321 322
static void au1000_mdio_write(struct net_device *dev, int phy_addr,
			      int reg, u16 value)
L
Linus Torvalds 已提交
323
{
324
	struct au1000_private *aup = netdev_priv(dev);
325 326
	u32 *const mii_control_reg = &aup->mac->mii_control;
	u32 *const mii_data_reg = &aup->mac->mii_data;
L
Linus Torvalds 已提交
327 328 329
	u32 timedout = 20;
	u32 mii_control;

330
	while (readl(mii_control_reg) & MAC_MII_BUSY) {
L
Linus Torvalds 已提交
331 332
		mdelay(1);
		if (--timedout == 0) {
333
			netdev_err(dev, "mdio_write busy timeout!!\n");
L
Linus Torvalds 已提交
334 335 336 337
			return;
		}
	}

338
	mii_control = MAC_SET_MII_SELECT_REG(reg) |
339
		MAC_SET_MII_SELECT_PHY(phy_addr) | MAC_MII_WRITE;
L
Linus Torvalds 已提交
340

341 342
	writel(value, mii_data_reg);
	writel(mii_control, mii_control_reg);
L
Linus Torvalds 已提交
343 344
}

345
static int au1000_mdiobus_read(struct mii_bus *bus, int phy_addr, int regnum)
346 347 348
{
	struct net_device *const dev = bus->priv;

349 350 351 352 353
	/* make sure the MAC associated with this
	 * mii_bus is enabled
	 */
	au1000_enable_mac(dev, 0);

354
	return au1000_mdio_read(dev, phy_addr, regnum);
355
}
L
Linus Torvalds 已提交
356

357 358
static int au1000_mdiobus_write(struct mii_bus *bus, int phy_addr, int regnum,
				u16 value)
L
Linus Torvalds 已提交
359
{
360
	struct net_device *const dev = bus->priv;
L
Linus Torvalds 已提交
361

362 363 364 365 366
	/* make sure the MAC associated with this
	 * mii_bus is enabled
	 */
	au1000_enable_mac(dev, 0);

367
	au1000_mdio_write(dev, phy_addr, regnum, value);
368
	return 0;
L
Linus Torvalds 已提交
369 370
}

371
static int au1000_mdiobus_reset(struct mii_bus *bus)
L
Linus Torvalds 已提交
372
{
373
	struct net_device *const dev = bus->priv;
L
Linus Torvalds 已提交
374

375 376 377 378 379
	/* make sure the MAC associated with this
	 * mii_bus is enabled
	 */
	au1000_enable_mac(dev, 0);

380 381
	return 0;
}
L
Linus Torvalds 已提交
382

383
static void au1000_hard_stop(struct net_device *dev)
F
Florian Fainelli 已提交
384 385
{
	struct au1000_private *aup = netdev_priv(dev);
386
	u32 reg;
F
Florian Fainelli 已提交
387

388
	netif_dbg(aup, drv, dev, "hard stop\n");
F
Florian Fainelli 已提交
389

390 391 392
	reg = readl(&aup->mac->control);
	reg &= ~(MAC_RX_ENABLE | MAC_TX_ENABLE);
	writel(reg, &aup->mac->control);
393 394
	wmb(); /* drain writebuffer */
	mdelay(10);
F
Florian Fainelli 已提交
395 396
}

397
static void au1000_enable_rx_tx(struct net_device *dev)
F
Florian Fainelli 已提交
398 399
{
	struct au1000_private *aup = netdev_priv(dev);
400
	u32 reg;
F
Florian Fainelli 已提交
401

402
	netif_dbg(aup, hw, dev, "enable_rx_tx\n");
F
Florian Fainelli 已提交
403

404 405 406
	reg = readl(&aup->mac->control);
	reg |= (MAC_RX_ENABLE | MAC_TX_ENABLE);
	writel(reg, &aup->mac->control);
407 408
	wmb(); /* drain writebuffer */
	mdelay(10);
F
Florian Fainelli 已提交
409 410 411 412 413 414
}

static void
au1000_adjust_link(struct net_device *dev)
{
	struct au1000_private *aup = netdev_priv(dev);
415
	struct phy_device *phydev = dev->phydev;
F
Florian Fainelli 已提交
416
	unsigned long flags;
417
	u32 reg;
F
Florian Fainelli 已提交
418 419 420

	int status_change = 0;

421
	BUG_ON(!phydev);
F
Florian Fainelli 已提交
422 423 424 425

	spin_lock_irqsave(&aup->lock, flags);

	if (phydev->link && (aup->old_speed != phydev->speed)) {
426
		/* speed changed */
F
Florian Fainelli 已提交
427

428
		switch (phydev->speed) {
F
Florian Fainelli 已提交
429 430 431 432
		case SPEED_10:
		case SPEED_100:
			break;
		default:
433 434
			netdev_warn(dev, "Speed (%d) is not 10/100 ???\n",
							phydev->speed);
F
Florian Fainelli 已提交
435 436 437 438 439 440 441 442 443
			break;
		}

		aup->old_speed = phydev->speed;

		status_change = 1;
	}

	if (phydev->link && (aup->old_duplex != phydev->duplex)) {
444
		/* duplex mode changed */
F
Florian Fainelli 已提交
445 446

		/* switching duplex mode requires to disable rx and tx! */
447
		au1000_hard_stop(dev);
F
Florian Fainelli 已提交
448

449 450 451 452 453 454 455 456 457
		reg = readl(&aup->mac->control);
		if (DUPLEX_FULL == phydev->duplex) {
			reg |= MAC_FULL_DUPLEX;
			reg &= ~MAC_DISABLE_RX_OWN;
		} else {
			reg &= ~MAC_FULL_DUPLEX;
			reg |= MAC_DISABLE_RX_OWN;
		}
		writel(reg, &aup->mac->control);
458 459
		wmb(); /* drain writebuffer */
		mdelay(1);
F
Florian Fainelli 已提交
460

461
		au1000_enable_rx_tx(dev);
F
Florian Fainelli 已提交
462 463 464 465 466
		aup->old_duplex = phydev->duplex;

		status_change = 1;
	}

467 468
	if (phydev->link != aup->old_link) {
		/* link state changed */
F
Florian Fainelli 已提交
469 470 471 472 473 474 475 476 477 478 479 480 481 482 483

		if (!phydev->link) {
			/* link went down */
			aup->old_speed = 0;
			aup->old_duplex = -1;
		}

		aup->old_link = phydev->link;
		status_change = 1;
	}

	spin_unlock_irqrestore(&aup->lock, flags);

	if (status_change) {
		if (phydev->link)
484 485
			netdev_info(dev, "link up (%d/%s)\n",
			       phydev->speed,
F
Florian Fainelli 已提交
486 487
			       DUPLEX_FULL == phydev->duplex ? "Full" : "Half");
		else
488
			netdev_info(dev, "link down\n");
F
Florian Fainelli 已提交
489 490 491
	}
}

F
Florian Fainelli 已提交
492
static int au1000_mii_probe(struct net_device *dev)
493
{
494
	struct au1000_private *const aup = netdev_priv(dev);
495
	struct phy_device *phydev = NULL;
496
	int phy_addr;
497

498 499
	if (aup->phy_static_config) {
		BUG_ON(aup->mac_id < 0 || aup->mac_id > 1);
500

501
		if (aup->phy_addr)
502
			phydev = mdiobus_get_phy(aup->mii_bus, aup->phy_addr);
503
		else
504
			netdev_info(dev, "using PHY-less setup\n");
505
		return 0;
506
	}
507

508
	/* find the first (lowest address) PHY
509 510
	 * on the current MAC's MII bus
	 */
511
	for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++)
512 513
		if (mdiobus_get_phy(aup->mii_bus, phy_addr)) {
			phydev = mdiobus_get_phy(aup->mii_bus, phy_addr);
514 515 516 517
			if (!aup->phy_search_highest_addr)
				/* break out with first one found */
				break;
		}
518

519 520 521 522 523 524 525 526 527 528 529 530
	if (aup->phy1_search_mac0) {
		/* try harder to find a PHY */
		if (!phydev && (aup->mac_id == 1)) {
			/* no PHY found, maybe we have a dual PHY? */
			dev_info(&dev->dev, ": no PHY found on MAC1, "
				"let's see if it's attached to MAC0...\n");

			/* find the first (lowest address) non-attached
			 * PHY on the MAC0 MII bus
			 */
			for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++) {
				struct phy_device *const tmp_phydev =
531 532
					mdiobus_get_phy(aup->mii_bus,
							phy_addr);
533 534 535 536 537 538 539 540 541 542 543 544 545 546

				if (aup->mac_id == 1)
					break;

				/* no PHY here... */
				if (!tmp_phydev)
					continue;

				/* already claimed by MAC0 */
				if (tmp_phydev->attached_dev)
					continue;

				phydev = tmp_phydev;
				break; /* found it */
547
			}
L
Linus Torvalds 已提交
548 549 550
		}
	}

551
	if (!phydev) {
552
		netdev_err(dev, "no PHY found\n");
L
Linus Torvalds 已提交
553 554 555
		return -1;
	}

556 557 558
	/* now we are supposed to have a proper phydev, to attach to... */
	BUG_ON(phydev->attached_dev);

A
Andrew Lunn 已提交
559
	phydev = phy_connect(dev, phydev_name(phydev),
560
			     &au1000_adjust_link, PHY_INTERFACE_MODE_MII);
561 562

	if (IS_ERR(phydev)) {
563
		netdev_err(dev, "Could not attach to PHY\n");
564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582
		return PTR_ERR(phydev);
	}

	/* mask with MAC supported features */
	phydev->supported &= (SUPPORTED_10baseT_Half
			      | SUPPORTED_10baseT_Full
			      | SUPPORTED_100baseT_Half
			      | SUPPORTED_100baseT_Full
			      | SUPPORTED_Autoneg
			      /* | SUPPORTED_Pause | SUPPORTED_Asym_Pause */
			      | SUPPORTED_MII
			      | SUPPORTED_TP);

	phydev->advertising = phydev->supported;

	aup->old_link = 0;
	aup->old_speed = 0;
	aup->old_duplex = -1;

583
	phy_attached_info(phydev);
L
Linus Torvalds 已提交
584 585 586 587 588 589 590

	return 0;
}


/*
 * Buffer allocation/deallocation routines. The buffer descriptor returned
591
 * has the virtual and dma address of a buffer suitable for
L
Linus Torvalds 已提交
592 593
 * both, receive and transmit operations.
 */
F
Florian Fainelli 已提交
594
static struct db_dest *au1000_GetFreeDB(struct au1000_private *aup)
L
Linus Torvalds 已提交
595
{
F
Florian Fainelli 已提交
596
	struct db_dest *pDB;
L
Linus Torvalds 已提交
597 598
	pDB = aup->pDBfree;

F
Florian Fainelli 已提交
599
	if (pDB)
L
Linus Torvalds 已提交
600
		aup->pDBfree = pDB->pnext;
F
Florian Fainelli 已提交
601

L
Linus Torvalds 已提交
602 603 604
	return pDB;
}

F
Florian Fainelli 已提交
605
void au1000_ReleaseDB(struct au1000_private *aup, struct db_dest *pDB)
L
Linus Torvalds 已提交
606
{
F
Florian Fainelli 已提交
607
	struct db_dest *pDBfree = aup->pDBfree;
L
Linus Torvalds 已提交
608 609 610 611 612
	if (pDBfree)
		pDBfree->pnext = pDB;
	aup->pDBfree = pDB;
}

613
static void au1000_reset_mac_unlocked(struct net_device *dev)
614
{
615
	struct au1000_private *const aup = netdev_priv(dev);
616 617
	int i;

618
	au1000_hard_stop(dev);
619

620
	writel(MAC_EN_CLOCK_ENABLE, aup->enable);
621 622
	wmb(); /* drain writebuffer */
	mdelay(2);
623
	writel(0, aup->enable);
624 625
	wmb(); /* drain writebuffer */
	mdelay(2);
626

L
Linus Torvalds 已提交
627 628 629 630 631 632 633 634 635
	aup->tx_full = 0;
	for (i = 0; i < NUM_RX_DMA; i++) {
		/* reset control bits */
		aup->rx_dma_ring[i]->buff_stat &= ~0xf;
	}
	for (i = 0; i < NUM_TX_DMA; i++) {
		/* reset control bits */
		aup->tx_dma_ring[i]->buff_stat &= ~0xf;
	}
636 637 638

	aup->mac_enabled = 0;

L
Linus Torvalds 已提交
639 640
}

641
static void au1000_reset_mac(struct net_device *dev)
642
{
643
	struct au1000_private *const aup = netdev_priv(dev);
644 645
	unsigned long flags;

646 647
	netif_dbg(aup, hw, dev, "reset mac, aup %x\n",
					(unsigned)aup);
648 649 650

	spin_lock_irqsave(&aup->lock, flags);

F
Florian Fainelli 已提交
651
	au1000_reset_mac_unlocked(dev);
652 653 654

	spin_unlock_irqrestore(&aup->lock, flags);
}
L
Linus Torvalds 已提交
655

656
/*
L
Linus Torvalds 已提交
657 658 659 660
 * Setup the receive and transmit "rings".  These pointers are the addresses
 * of the rx and tx MAC DMA registers so they are fixed by the hardware --
 * these are not descriptors sitting in memory.
 */
661
static void
662
au1000_setup_hw_rings(struct au1000_private *aup, void __iomem *tx_base)
L
Linus Torvalds 已提交
663 664 665 666
{
	int i;

	for (i = 0; i < NUM_RX_DMA; i++) {
667 668
		aup->rx_dma_ring[i] = (struct rx_dma *)
			(tx_base + 0x100 + sizeof(struct rx_dma) * i);
L
Linus Torvalds 已提交
669 670
	}
	for (i = 0; i < NUM_TX_DMA; i++) {
671 672
		aup->tx_dma_ring[i] = (struct tx_dma *)
			(tx_base + sizeof(struct tx_dma) * i);
L
Linus Torvalds 已提交
673 674 675
	}
}

676 677 678
/*
 * ethtool operations
 */
L
Linus Torvalds 已提交
679

680
static int au1000_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
681
{
682 683
	if (dev->phydev)
		return phy_ethtool_gset(dev->phydev, cmd);
L
Linus Torvalds 已提交
684

685
	return -EINVAL;
L
Linus Torvalds 已提交
686 687
}

688
static int au1000_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
689
{
690 691
	if (!capable(CAP_NET_ADMIN))
		return -EPERM;
L
Linus Torvalds 已提交
692

693 694
	if (dev->phydev)
		return phy_ethtool_sset(dev->phydev, cmd);
L
Linus Torvalds 已提交
695

696
	return -EINVAL;
L
Linus Torvalds 已提交
697 698 699 700 701
}

static void
au1000_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
{
702
	struct au1000_private *aup = netdev_priv(dev);
L
Linus Torvalds 已提交
703

704 705 706 707
	strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
	strlcpy(info->version, DRV_VERSION, sizeof(info->version));
	snprintf(info->bus_info, sizeof(info->bus_info), "%s %d", DRV_NAME,
		 aup->mac_id);
L
Linus Torvalds 已提交
708 709
}

710 711 712 713 714 715 716 717 718 719 720 721
static void au1000_set_msglevel(struct net_device *dev, u32 value)
{
	struct au1000_private *aup = netdev_priv(dev);
	aup->msg_enable = value;
}

static u32 au1000_get_msglevel(struct net_device *dev)
{
	struct au1000_private *aup = netdev_priv(dev);
	return aup->msg_enable;
}

722
static const struct ethtool_ops au1000_ethtool_ops = {
L
Linus Torvalds 已提交
723 724 725
	.get_settings = au1000_get_settings,
	.set_settings = au1000_set_settings,
	.get_drvinfo = au1000_get_drvinfo,
726
	.get_link = ethtool_op_get_link,
727 728
	.get_msglevel = au1000_get_msglevel,
	.set_msglevel = au1000_set_msglevel,
L
Linus Torvalds 已提交
729 730
};

F
Florian Fainelli 已提交
731 732 733 734 735 736 737 738 739 740 741

/*
 * Initialize the interface.
 *
 * When the device powers up, the clocks are disabled and the
 * mac is in reset state.  When the interface is closed, we
 * do the same -- reset the device and disable the clocks to
 * conserve power. Thus, whenever au1000_init() is called,
 * the device should already be in reset state.
 */
static int au1000_init(struct net_device *dev)
L
Linus Torvalds 已提交
742
{
F
Florian Fainelli 已提交
743 744 745 746
	struct au1000_private *aup = netdev_priv(dev);
	unsigned long flags;
	int i;
	u32 control;
747

748
	netif_dbg(aup, hw, dev, "au1000_init\n");
L
Linus Torvalds 已提交
749

F
Florian Fainelli 已提交
750
	/* bring the device out of reset */
751
	au1000_enable_mac(dev, 1);
752

F
Florian Fainelli 已提交
753
	spin_lock_irqsave(&aup->lock, flags);
L
Linus Torvalds 已提交
754

755
	writel(0, &aup->mac->control);
F
Florian Fainelli 已提交
756 757 758
	aup->tx_head = (aup->tx_dma_ring[0]->buff_stat & 0xC) >> 2;
	aup->tx_tail = aup->tx_head;
	aup->rx_head = (aup->rx_dma_ring[0]->buff_stat & 0xC) >> 2;
L
Linus Torvalds 已提交
759

760 761 762 763 764
	writel(dev->dev_addr[5]<<8 | dev->dev_addr[4],
					&aup->mac->mac_addr_high);
	writel(dev->dev_addr[3]<<24 | dev->dev_addr[2]<<16 |
		dev->dev_addr[1]<<8 | dev->dev_addr[0],
					&aup->mac->mac_addr_low);
F
Florian Fainelli 已提交
765

766

F
Florian Fainelli 已提交
767
	for (i = 0; i < NUM_RX_DMA; i++)
F
Florian Fainelli 已提交
768
		aup->rx_dma_ring[i]->buff_stat |= RX_DMA_ENABLE;
F
Florian Fainelli 已提交
769

770
	wmb(); /* drain writebuffer */
L
Linus Torvalds 已提交
771

F
Florian Fainelli 已提交
772 773 774 775
	control = MAC_RX_ENABLE | MAC_TX_ENABLE;
#ifndef CONFIG_CPU_LITTLE_ENDIAN
	control |= MAC_BIG_ENDIAN;
#endif
776 777
	if (dev->phydev) {
		if (dev->phydev->link && (DUPLEX_FULL == dev->phydev->duplex))
F
Florian Fainelli 已提交
778 779 780 781 782
			control |= MAC_FULL_DUPLEX;
		else
			control |= MAC_DISABLE_RX_OWN;
	} else { /* PHY-less op, assume full-duplex */
		control |= MAC_FULL_DUPLEX;
L
Linus Torvalds 已提交
783 784
	}

785 786
	writel(control, &aup->mac->control);
	writel(0x8100, &aup->mac->vlan1_tag); /* activate vlan support */
787
	wmb(); /* drain writebuffer */
L
Linus Torvalds 已提交
788

F
Florian Fainelli 已提交
789 790 791
	spin_unlock_irqrestore(&aup->lock, flags);
	return 0;
}
L
Linus Torvalds 已提交
792

793
static inline void au1000_update_rx_stats(struct net_device *dev, u32 status)
F
Florian Fainelli 已提交
794 795
{
	struct net_device_stats *ps = &dev->stats;
L
Linus Torvalds 已提交
796

F
Florian Fainelli 已提交
797 798 799
	ps->rx_packets++;
	if (status & RX_MCAST_FRAME)
		ps->multicast++;
L
Linus Torvalds 已提交
800

F
Florian Fainelli 已提交
801 802 803 804
	if (status & RX_ERROR) {
		ps->rx_errors++;
		if (status & RX_MISSED_FRAME)
			ps->rx_missed_errors++;
805
		if (status & (RX_OVERLEN | RX_RUNT | RX_LEN_ERROR))
F
Florian Fainelli 已提交
806 807 808 809 810
			ps->rx_length_errors++;
		if (status & RX_CRC_ERROR)
			ps->rx_crc_errors++;
		if (status & RX_COLL)
			ps->collisions++;
811
	} else
F
Florian Fainelli 已提交
812
		ps->rx_bytes += status & RX_FRAME_LEN_MASK;
813

L
Linus Torvalds 已提交
814 815
}

816
/*
F
Florian Fainelli 已提交
817
 * Au1000 receive routine.
L
Linus Torvalds 已提交
818
 */
F
Florian Fainelli 已提交
819
static int au1000_rx(struct net_device *dev)
L
Linus Torvalds 已提交
820
{
821
	struct au1000_private *aup = netdev_priv(dev);
F
Florian Fainelli 已提交
822
	struct sk_buff *skb;
823
	struct rx_dma *prxd;
F
Florian Fainelli 已提交
824
	u32 buff_stat, status;
F
Florian Fainelli 已提交
825
	struct db_dest *pDB;
F
Florian Fainelli 已提交
826
	u32	frmlen;
L
Linus Torvalds 已提交
827

828
	netif_dbg(aup, rx_status, dev, "au1000_rx head %d\n", aup->rx_head);
L
Linus Torvalds 已提交
829

F
Florian Fainelli 已提交
830 831 832 833 834
	prxd = aup->rx_dma_ring[aup->rx_head];
	buff_stat = prxd->buff_stat;
	while (buff_stat & RX_T_DONE)  {
		status = prxd->status;
		pDB = aup->rx_db_inuse[aup->rx_head];
835
		au1000_update_rx_stats(dev, status);
F
Florian Fainelli 已提交
836
		if (!(status & RX_ERROR))  {
L
Linus Torvalds 已提交
837

F
Florian Fainelli 已提交
838 839 840
			/* good frame */
			frmlen = (status & RX_FRAME_LEN_MASK);
			frmlen -= 4; /* Remove FCS */
841
			skb = netdev_alloc_skb(dev, frmlen + 2);
F
Florian Fainelli 已提交
842 843 844 845 846 847 848 849 850 851
			if (skb == NULL) {
				dev->stats.rx_dropped++;
				continue;
			}
			skb_reserve(skb, 2);	/* 16 byte IP header align */
			skb_copy_to_linear_data(skb,
				(unsigned char *)pDB->vaddr, frmlen);
			skb_put(skb, frmlen);
			skb->protocol = eth_type_trans(skb, dev);
			netif_rx(skb);	/* pass the packet to upper layers */
852
		} else {
F
Florian Fainelli 已提交
853
			if (au1000_debug > 4) {
854
				pr_err("rx_error(s):");
F
Florian Fainelli 已提交
855
				if (status & RX_MISSED_FRAME)
856
					pr_cont(" miss");
F
Florian Fainelli 已提交
857
				if (status & RX_WDOG_TIMER)
858
					pr_cont(" wdog");
F
Florian Fainelli 已提交
859
				if (status & RX_RUNT)
860
					pr_cont(" runt");
F
Florian Fainelli 已提交
861
				if (status & RX_OVERLEN)
862
					pr_cont(" overlen");
F
Florian Fainelli 已提交
863
				if (status & RX_COLL)
864
					pr_cont(" coll");
F
Florian Fainelli 已提交
865
				if (status & RX_MII_ERROR)
866
					pr_cont(" mii error");
F
Florian Fainelli 已提交
867
				if (status & RX_CRC_ERROR)
868
					pr_cont(" crc error");
F
Florian Fainelli 已提交
869
				if (status & RX_LEN_ERROR)
870
					pr_cont(" len error");
F
Florian Fainelli 已提交
871
				if (status & RX_U_CNTRL_FRAME)
872 873
					pr_cont(" u control frame");
				pr_cont("\n");
F
Florian Fainelli 已提交
874 875 876 877
			}
		}
		prxd->buff_stat = (u32)(pDB->dma_addr | RX_DMA_ENABLE);
		aup->rx_head = (aup->rx_head + 1) & (NUM_RX_DMA - 1);
878
		wmb(); /* drain writebuffer */
L
Linus Torvalds 已提交
879

F
Florian Fainelli 已提交
880 881 882
		/* next descriptor */
		prxd = aup->rx_dma_ring[aup->rx_head];
		buff_stat = prxd->buff_stat;
L
Linus Torvalds 已提交
883 884 885 886
	}
	return 0;
}

887
static void au1000_update_tx_stats(struct net_device *dev, u32 status)
L
Linus Torvalds 已提交
888
{
F
Florian Fainelli 已提交
889
	struct net_device_stats *ps = &dev->stats;
890

F
Florian Fainelli 已提交
891
	if (status & TX_FRAME_ABORTED) {
892
		if (!dev->phydev || (DUPLEX_FULL == dev->phydev->duplex)) {
F
Florian Fainelli 已提交
893 894
			if (status & (TX_JAB_TIMEOUT | TX_UNDERRUN)) {
				/* any other tx errors are only valid
895 896
				 * in half duplex mode
				 */
F
Florian Fainelli 已提交
897 898 899
				ps->tx_errors++;
				ps->tx_aborted_errors++;
			}
900
		} else {
F
Florian Fainelli 已提交
901 902 903 904 905 906 907
			ps->tx_errors++;
			ps->tx_aborted_errors++;
			if (status & (TX_NO_CARRIER | TX_LOSS_CARRIER))
				ps->tx_carrier_errors++;
		}
	}
}
908

F
Florian Fainelli 已提交
909 910 911 912 913 914 915 916
/*
 * Called from the interrupt service routine to acknowledge
 * the TX DONE bits.  This is a must if the irq is setup as
 * edge triggered.
 */
static void au1000_tx_ack(struct net_device *dev)
{
	struct au1000_private *aup = netdev_priv(dev);
917
	struct tx_dma *ptxd;
918

F
Florian Fainelli 已提交
919
	ptxd = aup->tx_dma_ring[aup->tx_tail];
920

F
Florian Fainelli 已提交
921
	while (ptxd->buff_stat & TX_T_DONE) {
922
		au1000_update_tx_stats(dev, ptxd->status);
F
Florian Fainelli 已提交
923 924
		ptxd->buff_stat &= ~TX_T_DONE;
		ptxd->len = 0;
925
		wmb(); /* drain writebuffer */
926

F
Florian Fainelli 已提交
927 928
		aup->tx_tail = (aup->tx_tail + 1) & (NUM_TX_DMA - 1);
		ptxd = aup->tx_dma_ring[aup->tx_tail];
929

F
Florian Fainelli 已提交
930 931 932 933
		if (aup->tx_full) {
			aup->tx_full = 0;
			netif_wake_queue(dev);
		}
L
Linus Torvalds 已提交
934
	}
F
Florian Fainelli 已提交
935
}
L
Linus Torvalds 已提交
936

F
Florian Fainelli 已提交
937 938 939 940 941 942
/*
 * Au1000 interrupt service routine.
 */
static irqreturn_t au1000_interrupt(int irq, void *dev_id)
{
	struct net_device *dev = dev_id;
L
Linus Torvalds 已提交
943

F
Florian Fainelli 已提交
944 945 946 947 948
	/* Handle RX interrupts first to minimize chance of overrun */

	au1000_rx(dev);
	au1000_tx_ack(dev);
	return IRQ_RETVAL(1);
L
Linus Torvalds 已提交
949 950 951 952 953
}

static int au1000_open(struct net_device *dev)
{
	int retval;
954
	struct au1000_private *aup = netdev_priv(dev);
L
Linus Torvalds 已提交
955

956
	netif_dbg(aup, drv, dev, "open: dev=%p\n", dev);
L
Linus Torvalds 已提交
957

958 959 960
	retval = request_irq(dev->irq, au1000_interrupt, 0,
					dev->name, dev);
	if (retval) {
961
		netdev_err(dev, "unable to get IRQ %d\n", dev->irq);
962 963 964
		return retval;
	}

965 966
	retval = au1000_init(dev);
	if (retval) {
967
		netdev_err(dev, "error in au1000_init\n");
L
Linus Torvalds 已提交
968 969 970 971
		free_irq(dev->irq, dev);
		return retval;
	}

972
	if (dev->phydev) {
973
		/* cause the PHY state machine to schedule a link state check */
974 975
		dev->phydev->state = PHY_CHANGELINK;
		phy_start(dev->phydev);
L
Linus Torvalds 已提交
976 977
	}

978
	netif_start_queue(dev);
L
Linus Torvalds 已提交
979

980
	netif_dbg(aup, drv, dev, "open: Initialization done.\n");
L
Linus Torvalds 已提交
981 982 983 984 985 986

	return 0;
}

static int au1000_close(struct net_device *dev)
{
987
	unsigned long flags;
988
	struct au1000_private *const aup = netdev_priv(dev);
L
Linus Torvalds 已提交
989

990
	netif_dbg(aup, drv, dev, "close: dev=%p\n", dev);
L
Linus Torvalds 已提交
991

992 993
	if (dev->phydev)
		phy_stop(dev->phydev);
L
Linus Torvalds 已提交
994 995

	spin_lock_irqsave(&aup->lock, flags);
996

F
Florian Fainelli 已提交
997
	au1000_reset_mac_unlocked(dev);
998

L
Linus Torvalds 已提交
999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
	/* stop the device */
	netif_stop_queue(dev);

	/* disable the interrupt */
	free_irq(dev->irq, dev);
	spin_unlock_irqrestore(&aup->lock, flags);

	return 0;
}

/*
 * Au1000 transmit routine.
 */
1012
static netdev_tx_t au1000_tx(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
1013
{
1014
	struct au1000_private *aup = netdev_priv(dev);
1015
	struct net_device_stats *ps = &dev->stats;
1016
	struct tx_dma *ptxd;
L
Linus Torvalds 已提交
1017
	u32 buff_stat;
F
Florian Fainelli 已提交
1018
	struct db_dest *pDB;
L
Linus Torvalds 已提交
1019 1020
	int i;

1021 1022
	netif_dbg(aup, tx_queued, dev, "tx: aup %x len=%d, data=%p, head %d\n",
				(unsigned)aup, skb->len,
L
Linus Torvalds 已提交
1023 1024 1025 1026 1027 1028 1029 1030
				skb->data, aup->tx_head);

	ptxd = aup->tx_dma_ring[aup->tx_head];
	buff_stat = ptxd->buff_stat;
	if (buff_stat & TX_DMA_ENABLE) {
		/* We've wrapped around and the transmitter is still busy */
		netif_stop_queue(dev);
		aup->tx_full = 1;
1031
		return NETDEV_TX_BUSY;
1032
	} else if (buff_stat & TX_T_DONE) {
1033
		au1000_update_tx_stats(dev, ptxd->status);
L
Linus Torvalds 已提交
1034 1035 1036 1037 1038 1039 1040 1041 1042
		ptxd->len = 0;
	}

	if (aup->tx_full) {
		aup->tx_full = 0;
		netif_wake_queue(dev);
	}

	pDB = aup->tx_db_inuse[aup->tx_head];
1043
	skb_copy_from_linear_data(skb, (void *)pDB->vaddr, skb->len);
L
Linus Torvalds 已提交
1044
	if (skb->len < ETH_ZLEN) {
F
Florian Fainelli 已提交
1045
		for (i = skb->len; i < ETH_ZLEN; i++)
L
Linus Torvalds 已提交
1046
			((char *)pDB->vaddr)[i] = 0;
F
Florian Fainelli 已提交
1047

L
Linus Torvalds 已提交
1048
		ptxd->len = ETH_ZLEN;
1049
	} else
F
Florian Fainelli 已提交
1050
		ptxd->len = skb->len;
L
Linus Torvalds 已提交
1051

F
Florian Fainelli 已提交
1052 1053
	ps->tx_packets++;
	ps->tx_bytes += ptxd->len;
L
Linus Torvalds 已提交
1054

F
Florian Fainelli 已提交
1055
	ptxd->buff_stat = pDB->dma_addr | TX_DMA_ENABLE;
1056
	wmb(); /* drain writebuffer */
F
Florian Fainelli 已提交
1057 1058
	dev_kfree_skb(skb);
	aup->tx_head = (aup->tx_head + 1) & (NUM_TX_DMA - 1);
1059
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
1060 1061 1062 1063 1064 1065 1066 1067
}

/*
 * The Tx ring has been full longer than the watchdog timeout
 * value. The transmitter must be hung?
 */
static void au1000_tx_timeout(struct net_device *dev)
{
1068
	netdev_err(dev, "au1000_tx_timeout: dev=%p\n", dev);
1069
	au1000_reset_mac(dev);
L
Linus Torvalds 已提交
1070
	au1000_init(dev);
1071
	netif_trans_update(dev); /* prevent tx timeout */
L
Linus Torvalds 已提交
1072 1073 1074
	netif_wake_queue(dev);
}

1075
static void au1000_multicast_list(struct net_device *dev)
L
Linus Torvalds 已提交
1076
{
1077
	struct au1000_private *aup = netdev_priv(dev);
1078
	u32 reg;
L
Linus Torvalds 已提交
1079

1080
	netif_dbg(aup, drv, dev, "%s: flags=%x\n", __func__, dev->flags);
1081
	reg = readl(&aup->mac->control);
L
Linus Torvalds 已提交
1082
	if (dev->flags & IFF_PROMISC) {			/* Set promiscuous. */
1083
		reg |= MAC_PROMISCUOUS;
L
Linus Torvalds 已提交
1084
	} else if ((dev->flags & IFF_ALLMULTI)  ||
1085
			   netdev_mc_count(dev) > MULTICAST_FILTER_LIMIT) {
1086 1087
		reg |= MAC_PASS_ALL_MULTI;
		reg &= ~MAC_PROMISCUOUS;
1088
		netdev_info(dev, "Pass all multicast\n");
L
Linus Torvalds 已提交
1089
	} else {
1090
		struct netdev_hw_addr *ha;
L
Linus Torvalds 已提交
1091 1092 1093
		u32 mc_filter[2];	/* Multicast hash filter */

		mc_filter[1] = mc_filter[0] = 0;
1094 1095
		netdev_for_each_mc_addr(ha, dev)
			set_bit(ether_crc(ETH_ALEN, ha->addr)>>26,
L
Linus Torvalds 已提交
1096
					(long *)mc_filter);
1097 1098 1099 1100
		writel(mc_filter[1], &aup->mac->multi_hash_high);
		writel(mc_filter[0], &aup->mac->multi_hash_low);
		reg &= ~MAC_PROMISCUOUS;
		reg |= MAC_HASH_MODE;
L
Linus Torvalds 已提交
1101
	}
1102
	writel(reg, &aup->mac->control);
L
Linus Torvalds 已提交
1103 1104 1105 1106
}

static int au1000_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
1107 1108
	if (!netif_running(dev))
		return -EINVAL;
L
Linus Torvalds 已提交
1109

1110
	if (!dev->phydev)
1111
		return -EINVAL; /* PHY not controllable */
L
Linus Torvalds 已提交
1112

1113
	return phy_mii_ioctl(dev->phydev, rq, cmd);
L
Linus Torvalds 已提交
1114 1115
}

1116 1117 1118 1119
static const struct net_device_ops au1000_netdev_ops = {
	.ndo_open		= au1000_open,
	.ndo_stop		= au1000_close,
	.ndo_start_xmit		= au1000_tx,
1120
	.ndo_set_rx_mode	= au1000_multicast_list,
1121 1122 1123 1124 1125 1126 1127
	.ndo_do_ioctl		= au1000_ioctl,
	.ndo_tx_timeout		= au1000_tx_timeout,
	.ndo_set_mac_address	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= eth_change_mtu,
};

B
Bill Pemberton 已提交
1128
static int au1000_probe(struct platform_device *pdev)
F
Florian Fainelli 已提交
1129 1130
{
	struct au1000_private *aup = NULL;
1131
	struct au1000_eth_platform_data *pd;
F
Florian Fainelli 已提交
1132
	struct net_device *dev = NULL;
F
Florian Fainelli 已提交
1133
	struct db_dest *pDB, *pDBfree;
1134
	int irq, i, err = 0;
1135
	struct resource *base, *macen, *macdma;
F
Florian Fainelli 已提交
1136

1137 1138
	base = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!base) {
1139
		dev_err(&pdev->dev, "failed to retrieve base register\n");
1140 1141 1142
		err = -ENODEV;
		goto out;
	}
F
Florian Fainelli 已提交
1143

1144 1145
	macen = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	if (!macen) {
1146
		dev_err(&pdev->dev, "failed to retrieve MAC Enable register\n");
1147 1148 1149
		err = -ENODEV;
		goto out;
	}
F
Florian Fainelli 已提交
1150

1151 1152
	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
1153
		dev_err(&pdev->dev, "failed to retrieve IRQ\n");
1154 1155 1156
		err = -ENODEV;
		goto out;
	}
F
Florian Fainelli 已提交
1157

1158 1159 1160 1161 1162 1163 1164
	macdma = platform_get_resource(pdev, IORESOURCE_MEM, 2);
	if (!macdma) {
		dev_err(&pdev->dev, "failed to retrieve MACDMA registers\n");
		err = -ENODEV;
		goto out;
	}

1165 1166
	if (!request_mem_region(base->start, resource_size(base),
							pdev->name)) {
1167
		dev_err(&pdev->dev, "failed to request memory region for base registers\n");
1168 1169 1170 1171
		err = -ENXIO;
		goto out;
	}

1172 1173
	if (!request_mem_region(macen->start, resource_size(macen),
							pdev->name)) {
1174
		dev_err(&pdev->dev, "failed to request memory region for MAC enable register\n");
1175 1176 1177
		err = -ENXIO;
		goto err_request;
	}
F
Florian Fainelli 已提交
1178

1179 1180 1181 1182 1183 1184 1185
	if (!request_mem_region(macdma->start, resource_size(macdma),
							pdev->name)) {
		dev_err(&pdev->dev, "failed to request MACDMA memory region\n");
		err = -ENXIO;
		goto err_macdma;
	}

F
Florian Fainelli 已提交
1186 1187
	dev = alloc_etherdev(sizeof(struct au1000_private));
	if (!dev) {
1188 1189
		err = -ENOMEM;
		goto err_alloc;
F
Florian Fainelli 已提交
1190 1191
	}

1192 1193
	SET_NETDEV_DEV(dev, &pdev->dev);
	platform_set_drvdata(pdev, dev);
F
Florian Fainelli 已提交
1194 1195 1196
	aup = netdev_priv(dev);

	spin_lock_init(&aup->lock);
1197 1198
	aup->msg_enable = (au1000_debug < 4 ?
				AU1000_DEF_MSG_ENABLE : au1000_debug);
F
Florian Fainelli 已提交
1199

1200 1201 1202
	/* Allocate the data buffers
	 * Snooping works fine with eth on all au1xxx
	 */
F
Florian Fainelli 已提交
1203 1204 1205 1206
	aup->vaddr = (u32)dma_alloc_noncoherent(NULL, MAX_BUF_SIZE *
						(NUM_TX_BUFFS + NUM_RX_BUFFS),
						&aup->dma_addr,	0);
	if (!aup->vaddr) {
1207
		dev_err(&pdev->dev, "failed to allocate data buffers\n");
1208 1209
		err = -ENOMEM;
		goto err_vaddr;
F
Florian Fainelli 已提交
1210 1211 1212
	}

	/* aup->mac is the base address of the MAC's registers */
1213
	aup->mac = (struct mac_reg *)
1214
			ioremap_nocache(base->start, resource_size(base));
1215
	if (!aup->mac) {
1216
		dev_err(&pdev->dev, "failed to ioremap MAC registers\n");
1217 1218 1219
		err = -ENXIO;
		goto err_remap1;
	}
F
Florian Fainelli 已提交
1220

F
Florian Fainelli 已提交
1221
	/* Setup some variables for quick register address access */
1222
	aup->enable = (u32 *)ioremap_nocache(macen->start,
1223
						resource_size(macen));
1224
	if (!aup->enable) {
1225
		dev_err(&pdev->dev, "failed to ioremap MAC enable register\n");
1226 1227 1228 1229
		err = -ENXIO;
		goto err_remap2;
	}
	aup->mac_id = pdev->id;
F
Florian Fainelli 已提交
1230

1231 1232 1233 1234 1235 1236 1237 1238
	aup->macdma = ioremap_nocache(macdma->start, resource_size(macdma));
	if (!aup->macdma) {
		dev_err(&pdev->dev, "failed to ioremap MACDMA registers\n");
		err = -ENXIO;
		goto err_remap3;
	}

	au1000_setup_hw_rings(aup, aup->macdma);
F
Florian Fainelli 已提交
1239

1240
	writel(0, aup->enable);
F
Florian Fainelli 已提交
1241 1242
	aup->mac_enabled = 0;

1243
	pd = dev_get_platdata(&pdev->dev);
1244
	if (!pd) {
1245 1246
		dev_info(&pdev->dev, "no platform_data passed,"
					" PHY search on MAC0\n");
1247 1248
		aup->phy1_search_mac0 = 1;
	} else {
1249
		if (is_valid_ether_addr(pd->mac)) {
1250
			memcpy(dev->dev_addr, pd->mac, ETH_ALEN);
1251 1252 1253 1254
		} else {
			/* Set a random MAC since no valid provided by platform_data. */
			eth_hw_addr_random(dev);
		}
1255

1256 1257 1258 1259 1260 1261 1262 1263
		aup->phy_static_config = pd->phy_static_config;
		aup->phy_search_highest_addr = pd->phy_search_highest_addr;
		aup->phy1_search_mac0 = pd->phy1_search_mac0;
		aup->phy_addr = pd->phy_addr;
		aup->phy_busid = pd->phy_busid;
		aup->phy_irq = pd->phy_irq;
	}

1264
	if (aup->phy_busid > 0) {
1265
		dev_err(&pdev->dev, "MAC0-associated PHY attached 2nd MACs MII bus not supported yet\n");
1266 1267 1268 1269
		err = -ENODEV;
		goto err_mdiobus_alloc;
	}

F
Florian Fainelli 已提交
1270
	aup->mii_bus = mdiobus_alloc();
1271
	if (aup->mii_bus == NULL) {
1272
		dev_err(&pdev->dev, "failed to allocate mdiobus structure\n");
1273 1274 1275
		err = -ENOMEM;
		goto err_mdiobus_alloc;
	}
F
Florian Fainelli 已提交
1276 1277 1278 1279 1280 1281

	aup->mii_bus->priv = dev;
	aup->mii_bus->read = au1000_mdiobus_read;
	aup->mii_bus->write = au1000_mdiobus_write;
	aup->mii_bus->reset = au1000_mdiobus_reset;
	aup->mii_bus->name = "au1000_eth_mii";
1282 1283
	snprintf(aup->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
		pdev->name, aup->mac_id);
1284

F
Florian Fainelli 已提交
1285
	/* if known, set corresponding PHY IRQs */
1286 1287 1288 1289 1290 1291
	if (aup->phy_static_config)
		if (aup->phy_irq && aup->phy_busid == aup->mac_id)
			aup->mii_bus->irq[aup->phy_addr] = aup->phy_irq;

	err = mdiobus_register(aup->mii_bus);
	if (err) {
1292
		dev_err(&pdev->dev, "failed to register MDIO bus\n");
1293 1294
		goto err_mdiobus_reg;
	}
F
Florian Fainelli 已提交
1295

1296 1297
	err = au1000_mii_probe(dev);
	if (err != 0)
F
Florian Fainelli 已提交
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
		goto err_out;

	pDBfree = NULL;
	/* setup the data buffer descriptors and attach a buffer to each one */
	pDB = aup->db;
	for (i = 0; i < (NUM_TX_BUFFS+NUM_RX_BUFFS); i++) {
		pDB->pnext = pDBfree;
		pDBfree = pDB;
		pDB->vaddr = (u32 *)((unsigned)aup->vaddr + MAX_BUF_SIZE*i);
		pDB->dma_addr = (dma_addr_t)virt_to_bus(pDB->vaddr);
		pDB++;
	}
	aup->pDBfree = pDBfree;

1312
	err = -ENODEV;
F
Florian Fainelli 已提交
1313
	for (i = 0; i < NUM_RX_DMA; i++) {
1314
		pDB = au1000_GetFreeDB(aup);
F
Florian Fainelli 已提交
1315
		if (!pDB)
F
Florian Fainelli 已提交
1316
			goto err_out;
F
Florian Fainelli 已提交
1317

F
Florian Fainelli 已提交
1318 1319 1320
		aup->rx_dma_ring[i]->buff_stat = (unsigned)pDB->dma_addr;
		aup->rx_db_inuse[i] = pDB;
	}
1321 1322

	err = -ENODEV;
F
Florian Fainelli 已提交
1323
	for (i = 0; i < NUM_TX_DMA; i++) {
1324
		pDB = au1000_GetFreeDB(aup);
F
Florian Fainelli 已提交
1325
		if (!pDB)
F
Florian Fainelli 已提交
1326
			goto err_out;
F
Florian Fainelli 已提交
1327

F
Florian Fainelli 已提交
1328 1329 1330 1331 1332
		aup->tx_dma_ring[i]->buff_stat = (unsigned)pDB->dma_addr;
		aup->tx_dma_ring[i]->len = 0;
		aup->tx_db_inuse[i] = pDB;
	}

1333 1334 1335
	dev->base_addr = base->start;
	dev->irq = irq;
	dev->netdev_ops = &au1000_netdev_ops;
1336
	dev->ethtool_ops = &au1000_ethtool_ops;
1337 1338
	dev->watchdog_timeo = ETH_TX_TIMEOUT;

F
Florian Fainelli 已提交
1339 1340 1341 1342
	/*
	 * The boot code uses the ethernet controller, so reset it to start
	 * fresh.  au1000_init() expects that the device is in reset state.
	 */
1343
	au1000_reset_mac(dev);
F
Florian Fainelli 已提交
1344

1345 1346
	err = register_netdev(dev);
	if (err) {
1347
		netdev_err(dev, "Cannot register net device, aborting.\n");
1348 1349 1350
		goto err_out;
	}

1351 1352
	netdev_info(dev, "Au1xx0 Ethernet found at 0x%lx, irq %d\n",
			(unsigned long)base->start, irq);
1353 1354

	pr_info_once("%s version %s %s\n", DRV_NAME, DRV_VERSION, DRV_AUTHOR);
1355 1356

	return 0;
F
Florian Fainelli 已提交
1357 1358

err_out:
1359
	if (aup->mii_bus != NULL)
F
Florian Fainelli 已提交
1360 1361 1362
		mdiobus_unregister(aup->mii_bus);

	/* here we should have a valid dev plus aup-> register addresses
1363 1364
	 * so we can reset the mac properly.
	 */
1365
	au1000_reset_mac(dev);
F
Florian Fainelli 已提交
1366 1367 1368

	for (i = 0; i < NUM_RX_DMA; i++) {
		if (aup->rx_db_inuse[i])
1369
			au1000_ReleaseDB(aup, aup->rx_db_inuse[i]);
F
Florian Fainelli 已提交
1370 1371 1372
	}
	for (i = 0; i < NUM_TX_DMA; i++) {
		if (aup->tx_db_inuse[i])
1373
			au1000_ReleaseDB(aup, aup->tx_db_inuse[i]);
F
Florian Fainelli 已提交
1374
	}
1375 1376 1377
err_mdiobus_reg:
	mdiobus_free(aup->mii_bus);
err_mdiobus_alloc:
1378 1379
	iounmap(aup->macdma);
err_remap3:
1380 1381 1382 1383
	iounmap(aup->enable);
err_remap2:
	iounmap(aup->mac);
err_remap1:
F
Florian Fainelli 已提交
1384 1385
	dma_free_noncoherent(NULL, MAX_BUF_SIZE * (NUM_TX_BUFFS + NUM_RX_BUFFS),
			     (void *)aup->vaddr, aup->dma_addr);
1386
err_vaddr:
F
Florian Fainelli 已提交
1387
	free_netdev(dev);
1388
err_alloc:
1389 1390
	release_mem_region(macdma->start, resource_size(macdma));
err_macdma:
1391 1392 1393 1394 1395
	release_mem_region(macen->start, resource_size(macen));
err_request:
	release_mem_region(base->start, resource_size(base));
out:
	return err;
F
Florian Fainelli 已提交
1396 1397
}

B
Bill Pemberton 已提交
1398
static int au1000_remove(struct platform_device *pdev)
F
Florian Fainelli 已提交
1399
{
1400 1401 1402 1403
	struct net_device *dev = platform_get_drvdata(pdev);
	struct au1000_private *aup = netdev_priv(dev);
	int i;
	struct resource *base, *macen;
F
Florian Fainelli 已提交
1404

1405 1406 1407 1408 1409 1410
	unregister_netdev(dev);
	mdiobus_unregister(aup->mii_bus);
	mdiobus_free(aup->mii_bus);

	for (i = 0; i < NUM_RX_DMA; i++)
		if (aup->rx_db_inuse[i])
1411
			au1000_ReleaseDB(aup, aup->rx_db_inuse[i]);
1412 1413 1414

	for (i = 0; i < NUM_TX_DMA; i++)
		if (aup->tx_db_inuse[i])
1415
			au1000_ReleaseDB(aup, aup->tx_db_inuse[i]);
1416 1417 1418 1419 1420

	dma_free_noncoherent(NULL, MAX_BUF_SIZE *
			(NUM_TX_BUFFS + NUM_RX_BUFFS),
			(void *)aup->vaddr, aup->dma_addr);

1421
	iounmap(aup->macdma);
1422 1423 1424
	iounmap(aup->mac);
	iounmap(aup->enable);

1425 1426 1427
	base = platform_get_resource(pdev, IORESOURCE_MEM, 2);
	release_mem_region(base->start, resource_size(base));

1428 1429 1430 1431 1432 1433 1434
	base = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	release_mem_region(base->start, resource_size(base));

	macen = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	release_mem_region(macen->start, resource_size(macen));

	free_netdev(dev);
F
Florian Fainelli 已提交
1435 1436 1437 1438

	return 0;
}

1439 1440
static struct platform_driver au1000_eth_driver = {
	.probe  = au1000_probe,
B
Bill Pemberton 已提交
1441
	.remove = au1000_remove,
1442 1443 1444 1445 1446
	.driver = {
		.name   = "au1000-eth",
	},
};

1447
module_platform_driver(au1000_eth_driver);
F
Florian Fainelli 已提交
1448

1449
MODULE_ALIAS("platform:au1000-eth");