au1000_eth.c 37.0 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
{
	/* WARNING: bus->phy_map[phy_addr].attached_dev == dev does
348 349
	 * _NOT_ hold (e.g. when PHY is accessed through other MAC's MII bus)
	 */
350 351
	struct net_device *const dev = bus->priv;

352 353 354 355 356
	/* make sure the MAC associated with this
	 * mii_bus is enabled
	 */
	au1000_enable_mac(dev, 0);

357
	return au1000_mdio_read(dev, phy_addr, regnum);
358
}
L
Linus Torvalds 已提交
359

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

365 366 367 368 369
	/* make sure the MAC associated with this
	 * mii_bus is enabled
	 */
	au1000_enable_mac(dev, 0);

370
	au1000_mdio_write(dev, phy_addr, regnum, value);
371
	return 0;
L
Linus Torvalds 已提交
372 373
}

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

378 379 380 381 382
	/* make sure the MAC associated with this
	 * mii_bus is enabled
	 */
	au1000_enable_mac(dev, 0);

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

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

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

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

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

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

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

static void
au1000_adjust_link(struct net_device *dev)
{
	struct au1000_private *aup = netdev_priv(dev);
	struct phy_device *phydev = aup->phy_dev;
	unsigned long flags;
420
	u32 reg;
F
Florian Fainelli 已提交
421 422 423 424 425 426 427 428

	int status_change = 0;

	BUG_ON(!aup->phy_dev);

	spin_lock_irqsave(&aup->lock, flags);

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

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

		aup->old_speed = phydev->speed;

		status_change = 1;
	}

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

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

452 453 454 455 456 457 458 459 460
		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);
461 462
		wmb(); /* drain writebuffer */
		mdelay(1);
F
Florian Fainelli 已提交
463

464
		au1000_enable_rx_tx(dev);
F
Florian Fainelli 已提交
465 466 467 468 469
		aup->old_duplex = phydev->duplex;

		status_change = 1;
	}

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

		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)
487 488
			netdev_info(dev, "link up (%d/%s)\n",
			       phydev->speed,
F
Florian Fainelli 已提交
489 490
			       DUPLEX_FULL == phydev->duplex ? "Full" : "Half");
		else
491
			netdev_info(dev, "link down\n");
F
Florian Fainelli 已提交
492 493 494
	}
}

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

501 502
	if (aup->phy_static_config) {
		BUG_ON(aup->mac_id < 0 || aup->mac_id > 1);
503

504 505 506
		if (aup->phy_addr)
			phydev = aup->mii_bus->phy_map[aup->phy_addr];
		else
507
			netdev_info(dev, "using PHY-less setup\n");
508
		return 0;
509
	}
510

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

522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548
	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 =
					aup->mii_bus->phy_map[phy_addr];

				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 */
549
			}
L
Linus Torvalds 已提交
550 551 552
		}
	}

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

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

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

	if (IS_ERR(phydev)) {
565
		netdev_err(dev, "Could not attach to PHY\n");
566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585
		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;
	aup->phy_dev = phydev;

586 587
	netdev_info(dev, "attached PHY driver [%s] "
	       "(mii_bus:phy_addr=%s, irq=%d)\n",
A
Andrew Lunn 已提交
588
	       phydev->drv->name, phydev_name(phydev), phydev->irq);
L
Linus Torvalds 已提交
589 590 591 592 593 594 595

	return 0;
}


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

F
Florian Fainelli 已提交
604
	if (pDB)
L
Linus Torvalds 已提交
605
		aup->pDBfree = pDB->pnext;
F
Florian Fainelli 已提交
606

L
Linus Torvalds 已提交
607 608 609
	return pDB;
}

F
Florian Fainelli 已提交
610
void au1000_ReleaseDB(struct au1000_private *aup, struct db_dest *pDB)
L
Linus Torvalds 已提交
611
{
F
Florian Fainelli 已提交
612
	struct db_dest *pDBfree = aup->pDBfree;
L
Linus Torvalds 已提交
613 614 615 616 617
	if (pDBfree)
		pDBfree->pnext = pDB;
	aup->pDBfree = pDB;
}

618
static void au1000_reset_mac_unlocked(struct net_device *dev)
619
{
620
	struct au1000_private *const aup = netdev_priv(dev);
621 622
	int i;

623
	au1000_hard_stop(dev);
624

625
	writel(MAC_EN_CLOCK_ENABLE, aup->enable);
626 627
	wmb(); /* drain writebuffer */
	mdelay(2);
628
	writel(0, aup->enable);
629 630
	wmb(); /* drain writebuffer */
	mdelay(2);
631

L
Linus Torvalds 已提交
632 633 634 635 636 637 638 639 640
	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;
	}
641 642 643

	aup->mac_enabled = 0;

L
Linus Torvalds 已提交
644 645
}

646
static void au1000_reset_mac(struct net_device *dev)
647
{
648
	struct au1000_private *const aup = netdev_priv(dev);
649 650
	unsigned long flags;

651 652
	netif_dbg(aup, hw, dev, "reset mac, aup %x\n",
					(unsigned)aup);
653 654 655

	spin_lock_irqsave(&aup->lock, flags);

F
Florian Fainelli 已提交
656
	au1000_reset_mac_unlocked(dev);
657 658 659

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

661
/*
L
Linus Torvalds 已提交
662 663 664 665
 * 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.
 */
666
static void
667
au1000_setup_hw_rings(struct au1000_private *aup, void __iomem *tx_base)
L
Linus Torvalds 已提交
668 669 670 671
{
	int i;

	for (i = 0; i < NUM_RX_DMA; i++) {
672 673
		aup->rx_dma_ring[i] = (struct rx_dma *)
			(tx_base + 0x100 + sizeof(struct rx_dma) * i);
L
Linus Torvalds 已提交
674 675
	}
	for (i = 0; i < NUM_TX_DMA; i++) {
676 677
		aup->tx_dma_ring[i] = (struct tx_dma *)
			(tx_base + sizeof(struct tx_dma) * i);
L
Linus Torvalds 已提交
678 679 680
	}
}

681 682 683
/*
 * ethtool operations
 */
L
Linus Torvalds 已提交
684

685
static int au1000_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
686
{
687
	struct au1000_private *aup = netdev_priv(dev);
L
Linus Torvalds 已提交
688

689 690
	if (aup->phy_dev)
		return phy_ethtool_gset(aup->phy_dev, cmd);
L
Linus Torvalds 已提交
691

692
	return -EINVAL;
L
Linus Torvalds 已提交
693 694
}

695
static int au1000_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
696
{
697
	struct au1000_private *aup = netdev_priv(dev);
L
Linus Torvalds 已提交
698

699 700
	if (!capable(CAP_NET_ADMIN))
		return -EPERM;
L
Linus Torvalds 已提交
701

702 703
	if (aup->phy_dev)
		return phy_ethtool_sset(aup->phy_dev, cmd);
L
Linus Torvalds 已提交
704

705
	return -EINVAL;
L
Linus Torvalds 已提交
706 707 708 709 710
}

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

713 714 715 716
	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 已提交
717 718
}

719 720 721 722 723 724 725 726 727 728 729 730
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;
}

731
static const struct ethtool_ops au1000_ethtool_ops = {
L
Linus Torvalds 已提交
732 733 734
	.get_settings = au1000_get_settings,
	.set_settings = au1000_set_settings,
	.get_drvinfo = au1000_get_drvinfo,
735
	.get_link = ethtool_op_get_link,
736 737
	.get_msglevel = au1000_get_msglevel,
	.set_msglevel = au1000_set_msglevel,
L
Linus Torvalds 已提交
738 739
};

F
Florian Fainelli 已提交
740 741 742 743 744 745 746 747 748 749 750

/*
 * 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 已提交
751
{
F
Florian Fainelli 已提交
752 753 754 755
	struct au1000_private *aup = netdev_priv(dev);
	unsigned long flags;
	int i;
	u32 control;
756

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

F
Florian Fainelli 已提交
759
	/* bring the device out of reset */
760
	au1000_enable_mac(dev, 1);
761

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

764
	writel(0, &aup->mac->control);
F
Florian Fainelli 已提交
765 766 767
	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 已提交
768

769 770 771 772 773
	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 已提交
774

775

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

779
	wmb(); /* drain writebuffer */
L
Linus Torvalds 已提交
780

F
Florian Fainelli 已提交
781 782 783 784 785 786 787 788 789 790 791
	control = MAC_RX_ENABLE | MAC_TX_ENABLE;
#ifndef CONFIG_CPU_LITTLE_ENDIAN
	control |= MAC_BIG_ENDIAN;
#endif
	if (aup->phy_dev) {
		if (aup->phy_dev->link && (DUPLEX_FULL == aup->phy_dev->duplex))
			control |= MAC_FULL_DUPLEX;
		else
			control |= MAC_DISABLE_RX_OWN;
	} else { /* PHY-less op, assume full-duplex */
		control |= MAC_FULL_DUPLEX;
L
Linus Torvalds 已提交
792 793
	}

794 795
	writel(control, &aup->mac->control);
	writel(0x8100, &aup->mac->vlan1_tag); /* activate vlan support */
796
	wmb(); /* drain writebuffer */
L
Linus Torvalds 已提交
797

F
Florian Fainelli 已提交
798 799 800
	spin_unlock_irqrestore(&aup->lock, flags);
	return 0;
}
L
Linus Torvalds 已提交
801

802
static inline void au1000_update_rx_stats(struct net_device *dev, u32 status)
F
Florian Fainelli 已提交
803 804
{
	struct net_device_stats *ps = &dev->stats;
L
Linus Torvalds 已提交
805

F
Florian Fainelli 已提交
806 807 808
	ps->rx_packets++;
	if (status & RX_MCAST_FRAME)
		ps->multicast++;
L
Linus Torvalds 已提交
809

F
Florian Fainelli 已提交
810 811 812 813
	if (status & RX_ERROR) {
		ps->rx_errors++;
		if (status & RX_MISSED_FRAME)
			ps->rx_missed_errors++;
814
		if (status & (RX_OVERLEN | RX_RUNT | RX_LEN_ERROR))
F
Florian Fainelli 已提交
815 816 817 818 819
			ps->rx_length_errors++;
		if (status & RX_CRC_ERROR)
			ps->rx_crc_errors++;
		if (status & RX_COLL)
			ps->collisions++;
820
	} else
F
Florian Fainelli 已提交
821
		ps->rx_bytes += status & RX_FRAME_LEN_MASK;
822

L
Linus Torvalds 已提交
823 824
}

825
/*
F
Florian Fainelli 已提交
826
 * Au1000 receive routine.
L
Linus Torvalds 已提交
827
 */
F
Florian Fainelli 已提交
828
static int au1000_rx(struct net_device *dev)
L
Linus Torvalds 已提交
829
{
830
	struct au1000_private *aup = netdev_priv(dev);
F
Florian Fainelli 已提交
831
	struct sk_buff *skb;
832
	struct rx_dma *prxd;
F
Florian Fainelli 已提交
833
	u32 buff_stat, status;
F
Florian Fainelli 已提交
834
	struct db_dest *pDB;
F
Florian Fainelli 已提交
835
	u32	frmlen;
L
Linus Torvalds 已提交
836

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

F
Florian Fainelli 已提交
839 840 841 842 843
	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];
844
		au1000_update_rx_stats(dev, status);
F
Florian Fainelli 已提交
845
		if (!(status & RX_ERROR))  {
L
Linus Torvalds 已提交
846

F
Florian Fainelli 已提交
847 848 849
			/* good frame */
			frmlen = (status & RX_FRAME_LEN_MASK);
			frmlen -= 4; /* Remove FCS */
850
			skb = netdev_alloc_skb(dev, frmlen + 2);
F
Florian Fainelli 已提交
851 852 853 854 855 856 857 858 859 860
			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 */
861
		} else {
F
Florian Fainelli 已提交
862
			if (au1000_debug > 4) {
863
				pr_err("rx_error(s):");
F
Florian Fainelli 已提交
864
				if (status & RX_MISSED_FRAME)
865
					pr_cont(" miss");
F
Florian Fainelli 已提交
866
				if (status & RX_WDOG_TIMER)
867
					pr_cont(" wdog");
F
Florian Fainelli 已提交
868
				if (status & RX_RUNT)
869
					pr_cont(" runt");
F
Florian Fainelli 已提交
870
				if (status & RX_OVERLEN)
871
					pr_cont(" overlen");
F
Florian Fainelli 已提交
872
				if (status & RX_COLL)
873
					pr_cont(" coll");
F
Florian Fainelli 已提交
874
				if (status & RX_MII_ERROR)
875
					pr_cont(" mii error");
F
Florian Fainelli 已提交
876
				if (status & RX_CRC_ERROR)
877
					pr_cont(" crc error");
F
Florian Fainelli 已提交
878
				if (status & RX_LEN_ERROR)
879
					pr_cont(" len error");
F
Florian Fainelli 已提交
880
				if (status & RX_U_CNTRL_FRAME)
881 882
					pr_cont(" u control frame");
				pr_cont("\n");
F
Florian Fainelli 已提交
883 884 885 886
			}
		}
		prxd->buff_stat = (u32)(pDB->dma_addr | RX_DMA_ENABLE);
		aup->rx_head = (aup->rx_head + 1) & (NUM_RX_DMA - 1);
887
		wmb(); /* drain writebuffer */
L
Linus Torvalds 已提交
888

F
Florian Fainelli 已提交
889 890 891
		/* next descriptor */
		prxd = aup->rx_dma_ring[aup->rx_head];
		buff_stat = prxd->buff_stat;
L
Linus Torvalds 已提交
892 893 894 895
	}
	return 0;
}

896
static void au1000_update_tx_stats(struct net_device *dev, u32 status)
L
Linus Torvalds 已提交
897
{
898
	struct au1000_private *aup = netdev_priv(dev);
F
Florian Fainelli 已提交
899
	struct net_device_stats *ps = &dev->stats;
900

F
Florian Fainelli 已提交
901 902 903 904
	if (status & TX_FRAME_ABORTED) {
		if (!aup->phy_dev || (DUPLEX_FULL == aup->phy_dev->duplex)) {
			if (status & (TX_JAB_TIMEOUT | TX_UNDERRUN)) {
				/* any other tx errors are only valid
905 906
				 * in half duplex mode
				 */
F
Florian Fainelli 已提交
907 908 909
				ps->tx_errors++;
				ps->tx_aborted_errors++;
			}
910
		} else {
F
Florian Fainelli 已提交
911 912 913 914 915 916 917
			ps->tx_errors++;
			ps->tx_aborted_errors++;
			if (status & (TX_NO_CARRIER | TX_LOSS_CARRIER))
				ps->tx_carrier_errors++;
		}
	}
}
918

F
Florian Fainelli 已提交
919 920 921 922 923 924 925 926
/*
 * 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);
927
	struct tx_dma *ptxd;
928

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

F
Florian Fainelli 已提交
931
	while (ptxd->buff_stat & TX_T_DONE) {
932
		au1000_update_tx_stats(dev, ptxd->status);
F
Florian Fainelli 已提交
933 934
		ptxd->buff_stat &= ~TX_T_DONE;
		ptxd->len = 0;
935
		wmb(); /* drain writebuffer */
936

F
Florian Fainelli 已提交
937 938
		aup->tx_tail = (aup->tx_tail + 1) & (NUM_TX_DMA - 1);
		ptxd = aup->tx_dma_ring[aup->tx_tail];
939

F
Florian Fainelli 已提交
940 941 942 943
		if (aup->tx_full) {
			aup->tx_full = 0;
			netif_wake_queue(dev);
		}
L
Linus Torvalds 已提交
944
	}
F
Florian Fainelli 已提交
945
}
L
Linus Torvalds 已提交
946

F
Florian Fainelli 已提交
947 948 949 950 951 952
/*
 * Au1000 interrupt service routine.
 */
static irqreturn_t au1000_interrupt(int irq, void *dev_id)
{
	struct net_device *dev = dev_id;
L
Linus Torvalds 已提交
953

F
Florian Fainelli 已提交
954 955 956 957 958
	/* Handle RX interrupts first to minimize chance of overrun */

	au1000_rx(dev);
	au1000_tx_ack(dev);
	return IRQ_RETVAL(1);
L
Linus Torvalds 已提交
959 960 961 962 963
}

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

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

968 969 970
	retval = request_irq(dev->irq, au1000_interrupt, 0,
					dev->name, dev);
	if (retval) {
971
		netdev_err(dev, "unable to get IRQ %d\n", dev->irq);
972 973 974
		return retval;
	}

975 976
	retval = au1000_init(dev);
	if (retval) {
977
		netdev_err(dev, "error in au1000_init\n");
L
Linus Torvalds 已提交
978 979 980 981
		free_irq(dev->irq, dev);
		return retval;
	}

982 983 984 985
	if (aup->phy_dev) {
		/* cause the PHY state machine to schedule a link state check */
		aup->phy_dev->state = PHY_CHANGELINK;
		phy_start(aup->phy_dev);
L
Linus Torvalds 已提交
986 987
	}

988
	netif_start_queue(dev);
L
Linus Torvalds 已提交
989

990
	netif_dbg(aup, drv, dev, "open: Initialization done.\n");
L
Linus Torvalds 已提交
991 992 993 994 995 996

	return 0;
}

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

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

1002 1003
	if (aup->phy_dev)
		phy_stop(aup->phy_dev);
L
Linus Torvalds 已提交
1004 1005

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

F
Florian Fainelli 已提交
1007
	au1000_reset_mac_unlocked(dev);
1008

L
Linus Torvalds 已提交
1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021
	/* 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.
 */
1022
static netdev_tx_t au1000_tx(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
1023
{
1024
	struct au1000_private *aup = netdev_priv(dev);
1025
	struct net_device_stats *ps = &dev->stats;
1026
	struct tx_dma *ptxd;
L
Linus Torvalds 已提交
1027
	u32 buff_stat;
F
Florian Fainelli 已提交
1028
	struct db_dest *pDB;
L
Linus Torvalds 已提交
1029 1030
	int i;

1031 1032
	netif_dbg(aup, tx_queued, dev, "tx: aup %x len=%d, data=%p, head %d\n",
				(unsigned)aup, skb->len,
L
Linus Torvalds 已提交
1033 1034 1035 1036 1037 1038 1039 1040
				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;
1041
		return NETDEV_TX_BUSY;
1042
	} else if (buff_stat & TX_T_DONE) {
1043
		au1000_update_tx_stats(dev, ptxd->status);
L
Linus Torvalds 已提交
1044 1045 1046 1047 1048 1049 1050 1051 1052
		ptxd->len = 0;
	}

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

	pDB = aup->tx_db_inuse[aup->tx_head];
1053
	skb_copy_from_linear_data(skb, (void *)pDB->vaddr, skb->len);
L
Linus Torvalds 已提交
1054
	if (skb->len < ETH_ZLEN) {
F
Florian Fainelli 已提交
1055
		for (i = skb->len; i < ETH_ZLEN; i++)
L
Linus Torvalds 已提交
1056
			((char *)pDB->vaddr)[i] = 0;
F
Florian Fainelli 已提交
1057

L
Linus Torvalds 已提交
1058
		ptxd->len = ETH_ZLEN;
1059
	} else
F
Florian Fainelli 已提交
1060
		ptxd->len = skb->len;
L
Linus Torvalds 已提交
1061

F
Florian Fainelli 已提交
1062 1063
	ps->tx_packets++;
	ps->tx_bytes += ptxd->len;
L
Linus Torvalds 已提交
1064

F
Florian Fainelli 已提交
1065
	ptxd->buff_stat = pDB->dma_addr | TX_DMA_ENABLE;
1066
	wmb(); /* drain writebuffer */
F
Florian Fainelli 已提交
1067 1068
	dev_kfree_skb(skb);
	aup->tx_head = (aup->tx_head + 1) & (NUM_TX_DMA - 1);
1069
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
1070 1071 1072 1073 1074 1075 1076 1077
}

/*
 * 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)
{
1078
	netdev_err(dev, "au1000_tx_timeout: dev=%p\n", dev);
1079
	au1000_reset_mac(dev);
L
Linus Torvalds 已提交
1080
	au1000_init(dev);
E
Eric Dumazet 已提交
1081
	dev->trans_start = jiffies; /* prevent tx timeout */
L
Linus Torvalds 已提交
1082 1083 1084
	netif_wake_queue(dev);
}

1085
static void au1000_multicast_list(struct net_device *dev)
L
Linus Torvalds 已提交
1086
{
1087
	struct au1000_private *aup = netdev_priv(dev);
1088
	u32 reg;
L
Linus Torvalds 已提交
1089

1090
	netif_dbg(aup, drv, dev, "%s: flags=%x\n", __func__, dev->flags);
1091
	reg = readl(&aup->mac->control);
L
Linus Torvalds 已提交
1092
	if (dev->flags & IFF_PROMISC) {			/* Set promiscuous. */
1093
		reg |= MAC_PROMISCUOUS;
L
Linus Torvalds 已提交
1094
	} else if ((dev->flags & IFF_ALLMULTI)  ||
1095
			   netdev_mc_count(dev) > MULTICAST_FILTER_LIMIT) {
1096 1097
		reg |= MAC_PASS_ALL_MULTI;
		reg &= ~MAC_PROMISCUOUS;
1098
		netdev_info(dev, "Pass all multicast\n");
L
Linus Torvalds 已提交
1099
	} else {
1100
		struct netdev_hw_addr *ha;
L
Linus Torvalds 已提交
1101 1102 1103
		u32 mc_filter[2];	/* Multicast hash filter */

		mc_filter[1] = mc_filter[0] = 0;
1104 1105
		netdev_for_each_mc_addr(ha, dev)
			set_bit(ether_crc(ETH_ALEN, ha->addr)>>26,
L
Linus Torvalds 已提交
1106
					(long *)mc_filter);
1107 1108 1109 1110
		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 已提交
1111
	}
1112
	writel(reg, &aup->mac->control);
L
Linus Torvalds 已提交
1113 1114 1115 1116
}

static int au1000_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
1117
	struct au1000_private *aup = netdev_priv(dev);
L
Linus Torvalds 已提交
1118

1119 1120
	if (!netif_running(dev))
		return -EINVAL;
L
Linus Torvalds 已提交
1121

1122 1123
	if (!aup->phy_dev)
		return -EINVAL; /* PHY not controllable */
L
Linus Torvalds 已提交
1124

1125
	return phy_mii_ioctl(aup->phy_dev, rq, cmd);
L
Linus Torvalds 已提交
1126 1127
}

1128 1129 1130 1131
static const struct net_device_ops au1000_netdev_ops = {
	.ndo_open		= au1000_open,
	.ndo_stop		= au1000_close,
	.ndo_start_xmit		= au1000_tx,
1132
	.ndo_set_rx_mode	= au1000_multicast_list,
1133 1134 1135 1136 1137 1138 1139
	.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 已提交
1140
static int au1000_probe(struct platform_device *pdev)
F
Florian Fainelli 已提交
1141 1142
{
	struct au1000_private *aup = NULL;
1143
	struct au1000_eth_platform_data *pd;
F
Florian Fainelli 已提交
1144
	struct net_device *dev = NULL;
F
Florian Fainelli 已提交
1145
	struct db_dest *pDB, *pDBfree;
1146
	int irq, i, err = 0;
1147
	struct resource *base, *macen, *macdma;
F
Florian Fainelli 已提交
1148

1149 1150
	base = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!base) {
1151
		dev_err(&pdev->dev, "failed to retrieve base register\n");
1152 1153 1154
		err = -ENODEV;
		goto out;
	}
F
Florian Fainelli 已提交
1155

1156 1157
	macen = platform_get_resource(pdev, IORESOURCE_MEM, 1);
	if (!macen) {
1158
		dev_err(&pdev->dev, "failed to retrieve MAC Enable register\n");
1159 1160 1161
		err = -ENODEV;
		goto out;
	}
F
Florian Fainelli 已提交
1162

1163 1164
	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
1165
		dev_err(&pdev->dev, "failed to retrieve IRQ\n");
1166 1167 1168
		err = -ENODEV;
		goto out;
	}
F
Florian Fainelli 已提交
1169

1170 1171 1172 1173 1174 1175 1176
	macdma = platform_get_resource(pdev, IORESOURCE_MEM, 2);
	if (!macdma) {
		dev_err(&pdev->dev, "failed to retrieve MACDMA registers\n");
		err = -ENODEV;
		goto out;
	}

1177 1178
	if (!request_mem_region(base->start, resource_size(base),
							pdev->name)) {
1179
		dev_err(&pdev->dev, "failed to request memory region for base registers\n");
1180 1181 1182 1183
		err = -ENXIO;
		goto out;
	}

1184 1185
	if (!request_mem_region(macen->start, resource_size(macen),
							pdev->name)) {
1186
		dev_err(&pdev->dev, "failed to request memory region for MAC enable register\n");
1187 1188 1189
		err = -ENXIO;
		goto err_request;
	}
F
Florian Fainelli 已提交
1190

1191 1192 1193 1194 1195 1196 1197
	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 已提交
1198 1199
	dev = alloc_etherdev(sizeof(struct au1000_private));
	if (!dev) {
1200 1201
		err = -ENOMEM;
		goto err_alloc;
F
Florian Fainelli 已提交
1202 1203
	}

1204 1205
	SET_NETDEV_DEV(dev, &pdev->dev);
	platform_set_drvdata(pdev, dev);
F
Florian Fainelli 已提交
1206 1207 1208
	aup = netdev_priv(dev);

	spin_lock_init(&aup->lock);
1209 1210
	aup->msg_enable = (au1000_debug < 4 ?
				AU1000_DEF_MSG_ENABLE : au1000_debug);
F
Florian Fainelli 已提交
1211

1212 1213 1214
	/* Allocate the data buffers
	 * Snooping works fine with eth on all au1xxx
	 */
F
Florian Fainelli 已提交
1215 1216 1217 1218
	aup->vaddr = (u32)dma_alloc_noncoherent(NULL, MAX_BUF_SIZE *
						(NUM_TX_BUFFS + NUM_RX_BUFFS),
						&aup->dma_addr,	0);
	if (!aup->vaddr) {
1219
		dev_err(&pdev->dev, "failed to allocate data buffers\n");
1220 1221
		err = -ENOMEM;
		goto err_vaddr;
F
Florian Fainelli 已提交
1222 1223 1224
	}

	/* aup->mac is the base address of the MAC's registers */
1225
	aup->mac = (struct mac_reg *)
1226
			ioremap_nocache(base->start, resource_size(base));
1227
	if (!aup->mac) {
1228
		dev_err(&pdev->dev, "failed to ioremap MAC registers\n");
1229 1230 1231
		err = -ENXIO;
		goto err_remap1;
	}
F
Florian Fainelli 已提交
1232

F
Florian Fainelli 已提交
1233
	/* Setup some variables for quick register address access */
1234
	aup->enable = (u32 *)ioremap_nocache(macen->start,
1235
						resource_size(macen));
1236
	if (!aup->enable) {
1237
		dev_err(&pdev->dev, "failed to ioremap MAC enable register\n");
1238 1239 1240 1241
		err = -ENXIO;
		goto err_remap2;
	}
	aup->mac_id = pdev->id;
F
Florian Fainelli 已提交
1242

1243 1244 1245 1246 1247 1248 1249 1250
	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 已提交
1251

1252
	writel(0, aup->enable);
F
Florian Fainelli 已提交
1253 1254
	aup->mac_enabled = 0;

1255
	pd = dev_get_platdata(&pdev->dev);
1256
	if (!pd) {
1257 1258
		dev_info(&pdev->dev, "no platform_data passed,"
					" PHY search on MAC0\n");
1259 1260
		aup->phy1_search_mac0 = 1;
	} else {
1261
		if (is_valid_ether_addr(pd->mac)) {
1262
			memcpy(dev->dev_addr, pd->mac, ETH_ALEN);
1263 1264 1265 1266
		} else {
			/* Set a random MAC since no valid provided by platform_data. */
			eth_hw_addr_random(dev);
		}
1267

1268 1269 1270 1271 1272 1273 1274 1275 1276
		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;
	}

	if (aup->phy_busid && aup->phy_busid > 0) {
1277
		dev_err(&pdev->dev, "MAC0-associated PHY attached 2nd MACs MII bus not supported yet\n");
1278 1279 1280 1281
		err = -ENODEV;
		goto err_mdiobus_alloc;
	}

F
Florian Fainelli 已提交
1282
	aup->mii_bus = mdiobus_alloc();
1283
	if (aup->mii_bus == NULL) {
1284
		dev_err(&pdev->dev, "failed to allocate mdiobus structure\n");
1285 1286 1287
		err = -ENOMEM;
		goto err_mdiobus_alloc;
	}
F
Florian Fainelli 已提交
1288 1289 1290 1291 1292 1293

	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";
1294 1295
	snprintf(aup->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
		pdev->name, aup->mac_id);
F
Florian Fainelli 已提交
1296
	aup->mii_bus->irq = kmalloc(sizeof(int)*PHY_MAX_ADDR, GFP_KERNEL);
1297 1298
	if (aup->mii_bus->irq == NULL) {
		err = -ENOMEM;
1299
		goto err_out;
1300
	}
1301

1302
	for (i = 0; i < PHY_MAX_ADDR; ++i)
F
Florian Fainelli 已提交
1303 1304
		aup->mii_bus->irq[i] = PHY_POLL;
	/* if known, set corresponding PHY IRQs */
1305 1306 1307 1308 1309 1310
	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) {
1311
		dev_err(&pdev->dev, "failed to register MDIO bus\n");
1312 1313
		goto err_mdiobus_reg;
	}
F
Florian Fainelli 已提交
1314

1315 1316
	err = au1000_mii_probe(dev);
	if (err != 0)
F
Florian Fainelli 已提交
1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330
		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;

1331
	err = -ENODEV;
F
Florian Fainelli 已提交
1332
	for (i = 0; i < NUM_RX_DMA; i++) {
1333
		pDB = au1000_GetFreeDB(aup);
F
Florian Fainelli 已提交
1334
		if (!pDB)
F
Florian Fainelli 已提交
1335
			goto err_out;
F
Florian Fainelli 已提交
1336

F
Florian Fainelli 已提交
1337 1338 1339
		aup->rx_dma_ring[i]->buff_stat = (unsigned)pDB->dma_addr;
		aup->rx_db_inuse[i] = pDB;
	}
1340 1341

	err = -ENODEV;
F
Florian Fainelli 已提交
1342
	for (i = 0; i < NUM_TX_DMA; i++) {
1343
		pDB = au1000_GetFreeDB(aup);
F
Florian Fainelli 已提交
1344
		if (!pDB)
F
Florian Fainelli 已提交
1345
			goto err_out;
F
Florian Fainelli 已提交
1346

F
Florian Fainelli 已提交
1347 1348 1349 1350 1351
		aup->tx_dma_ring[i]->buff_stat = (unsigned)pDB->dma_addr;
		aup->tx_dma_ring[i]->len = 0;
		aup->tx_db_inuse[i] = pDB;
	}

1352 1353 1354
	dev->base_addr = base->start;
	dev->irq = irq;
	dev->netdev_ops = &au1000_netdev_ops;
1355
	dev->ethtool_ops = &au1000_ethtool_ops;
1356 1357
	dev->watchdog_timeo = ETH_TX_TIMEOUT;

F
Florian Fainelli 已提交
1358 1359 1360 1361
	/*
	 * The boot code uses the ethernet controller, so reset it to start
	 * fresh.  au1000_init() expects that the device is in reset state.
	 */
1362
	au1000_reset_mac(dev);
F
Florian Fainelli 已提交
1363

1364 1365
	err = register_netdev(dev);
	if (err) {
1366
		netdev_err(dev, "Cannot register net device, aborting.\n");
1367 1368 1369
		goto err_out;
	}

1370 1371
	netdev_info(dev, "Au1xx0 Ethernet found at 0x%lx, irq %d\n",
			(unsigned long)base->start, irq);
1372 1373

	pr_info_once("%s version %s %s\n", DRV_NAME, DRV_VERSION, DRV_AUTHOR);
1374 1375

	return 0;
F
Florian Fainelli 已提交
1376 1377

err_out:
1378
	if (aup->mii_bus != NULL)
F
Florian Fainelli 已提交
1379 1380 1381
		mdiobus_unregister(aup->mii_bus);

	/* here we should have a valid dev plus aup-> register addresses
1382 1383
	 * so we can reset the mac properly.
	 */
1384
	au1000_reset_mac(dev);
F
Florian Fainelli 已提交
1385 1386 1387

	for (i = 0; i < NUM_RX_DMA; i++) {
		if (aup->rx_db_inuse[i])
1388
			au1000_ReleaseDB(aup, aup->rx_db_inuse[i]);
F
Florian Fainelli 已提交
1389 1390 1391
	}
	for (i = 0; i < NUM_TX_DMA; i++) {
		if (aup->tx_db_inuse[i])
1392
			au1000_ReleaseDB(aup, aup->tx_db_inuse[i]);
F
Florian Fainelli 已提交
1393
	}
1394 1395 1396
err_mdiobus_reg:
	mdiobus_free(aup->mii_bus);
err_mdiobus_alloc:
1397 1398
	iounmap(aup->macdma);
err_remap3:
1399 1400 1401 1402
	iounmap(aup->enable);
err_remap2:
	iounmap(aup->mac);
err_remap1:
F
Florian Fainelli 已提交
1403 1404
	dma_free_noncoherent(NULL, MAX_BUF_SIZE * (NUM_TX_BUFFS + NUM_RX_BUFFS),
			     (void *)aup->vaddr, aup->dma_addr);
1405
err_vaddr:
F
Florian Fainelli 已提交
1406
	free_netdev(dev);
1407
err_alloc:
1408 1409
	release_mem_region(macdma->start, resource_size(macdma));
err_macdma:
1410 1411 1412 1413 1414
	release_mem_region(macen->start, resource_size(macen));
err_request:
	release_mem_region(base->start, resource_size(base));
out:
	return err;
F
Florian Fainelli 已提交
1415 1416
}

B
Bill Pemberton 已提交
1417
static int au1000_remove(struct platform_device *pdev)
F
Florian Fainelli 已提交
1418
{
1419 1420 1421 1422
	struct net_device *dev = platform_get_drvdata(pdev);
	struct au1000_private *aup = netdev_priv(dev);
	int i;
	struct resource *base, *macen;
F
Florian Fainelli 已提交
1423

1424 1425 1426 1427 1428 1429
	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])
1430
			au1000_ReleaseDB(aup, aup->rx_db_inuse[i]);
1431 1432 1433

	for (i = 0; i < NUM_TX_DMA; i++)
		if (aup->tx_db_inuse[i])
1434
			au1000_ReleaseDB(aup, aup->tx_db_inuse[i]);
1435 1436 1437 1438 1439

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

1440
	iounmap(aup->macdma);
1441 1442 1443
	iounmap(aup->mac);
	iounmap(aup->enable);

1444 1445 1446
	base = platform_get_resource(pdev, IORESOURCE_MEM, 2);
	release_mem_region(base->start, resource_size(base));

1447 1448 1449 1450 1451 1452 1453
	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 已提交
1454 1455 1456 1457

	return 0;
}

1458 1459
static struct platform_driver au1000_eth_driver = {
	.probe  = au1000_probe,
B
Bill Pemberton 已提交
1460
	.remove = au1000_remove,
1461 1462 1463 1464 1465
	.driver = {
		.name   = "au1000-eth",
	},
};

1466
module_platform_driver(au1000_eth_driver);
F
Florian Fainelli 已提交
1467

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