tsec.c 44.6 KB
Newer Older
W
wdenk 已提交
1
/*
2
 * Freescale Three Speed Ethernet Controller driver
W
wdenk 已提交
3 4 5 6 7
 *
 * This software may be used and distributed according to the
 * terms of the GNU Public License, Version 2, incorporated
 * herein by reference.
 *
A
Andy Fleming 已提交
8
 * Copyright 2004, 2007 Freescale Semiconductor, Inc.
W
wdenk 已提交
9 10 11 12 13 14 15 16 17 18
 * (C) Copyright 2003, Motorola, Inc.
 * author Andy Fleming
 *
 */

#include <config.h>
#include <common.h>
#include <malloc.h>
#include <net.h>
#include <command.h>
A
Andy Fleming 已提交
19
#include <tsec.h>
W
wdenk 已提交
20

M
Marian Balakowicz 已提交
21
#include "miiphy.h"
W
wdenk 已提交
22

23 24
DECLARE_GLOBAL_DATA_PTR;

M
Marian Balakowicz 已提交
25
#define TX_BUF_CNT		2
W
wdenk 已提交
26

27 28
static uint rxIdx;		/* index of the current RX buffer */
static uint txIdx;		/* index of the current TX buffer */
W
wdenk 已提交
29 30 31 32

typedef volatile struct rtxbd {
	txbd8_t txbd[TX_BUF_CNT];
	rxbd8_t rxbd[PKTBUFSRX];
33
} RTXBD;
W
wdenk 已提交
34

35
#define MAXCONTROLLERS	(8)
36 37 38 39

static int relocated = 0;

static struct tsec_private *privlist[MAXCONTROLLERS];
40
static int num_tsecs = 0;
41

W
wdenk 已提交
42 43 44 45 46 47
#ifdef __GNUC__
static RTXBD rtx __attribute__ ((aligned(8)));
#else
#error "rtx must be 64-bit aligned"
#endif

48 49 50 51 52 53
static int tsec_send(struct eth_device *dev,
		     volatile void *packet, int length);
static int tsec_recv(struct eth_device *dev);
static int tsec_init(struct eth_device *dev, bd_t * bd);
static void tsec_halt(struct eth_device *dev);
static void init_registers(volatile tsec_t * regs);
54 55 56 57
static void startup_tsec(struct eth_device *dev);
static int init_phy(struct eth_device *dev);
void write_phy_reg(struct tsec_private *priv, uint regnum, uint value);
uint read_phy_reg(struct tsec_private *priv, uint regnum);
58
struct phy_info *get_phy_info(struct eth_device *dev);
59 60 61
void phy_run_commands(struct tsec_private *priv, struct phy_cmd *cmd);
static void adjust_link(struct eth_device *dev);
static void relocate_cmds(void);
62 63
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) \
	&& !defined(BITBANGMII)
M
Marian Balakowicz 已提交
64
static int tsec_miiphy_write(char *devname, unsigned char addr,
65
			     unsigned char reg, unsigned short value);
M
Marian Balakowicz 已提交
66
static int tsec_miiphy_read(char *devname, unsigned char addr,
67
			    unsigned char reg, unsigned short *value);
68
#endif
D
David Updegraff 已提交
69 70 71
#ifdef CONFIG_MCAST_TFTP
static int tsec_mcast_addr (struct eth_device *dev, u8 mcast_mac, u8 set);
#endif
72

73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113
/* Default initializations for TSEC controllers. */

static struct tsec_info_struct tsec_info[] = {
#ifdef CONFIG_TSEC1
	STD_TSEC_INFO(1),	/* TSEC1 */
#endif
#ifdef CONFIG_TSEC2
	STD_TSEC_INFO(2),	/* TSEC2 */
#endif
#ifdef CONFIG_MPC85XX_FEC
	{
		.regs = (tsec_t *)(TSEC_BASE_ADDR + 0x2000),
		.miiregs = (tsec_t *)(TSEC_BASE_ADDR),
		.devname = CONFIG_MPC85XX_FEC_NAME,
		.phyaddr = FEC_PHY_ADDR,
		.flags = FEC_FLAGS
	},			/* FEC */
#endif
#ifdef CONFIG_TSEC3
	STD_TSEC_INFO(3),	/* TSEC3 */
#endif
#ifdef CONFIG_TSEC4
	STD_TSEC_INFO(4),	/* TSEC4 */
#endif
};

int tsec_eth_init(bd_t *bis, struct tsec_info_struct *tsecs, int num)
{
	int i;

	for (i = 0; i < num; i++)
		tsec_initialize(bis, &tsecs[i]);

	return 0;
}

int tsec_standard_init(bd_t *bis)
{
	return tsec_eth_init(bis, tsec_info, ARRAY_SIZE(tsec_info));
}

114 115 116
/* Initialize device structure. Returns success if PHY
 * initialization succeeded (i.e. if it recognizes the PHY)
 */
117
int tsec_initialize(bd_t * bis, struct tsec_info_struct *tsec_info)
W
wdenk 已提交
118
{
119
	struct eth_device *dev;
W
wdenk 已提交
120
	int i;
121
	struct tsec_private *priv;
W
wdenk 已提交
122

123
	dev = (struct eth_device *)malloc(sizeof *dev);
W
wdenk 已提交
124

125
	if (NULL == dev)
W
wdenk 已提交
126 127 128 129
		return 0;

	memset(dev, 0, sizeof *dev);

130
	priv = (struct tsec_private *)malloc(sizeof(*priv));
131

132
	if (NULL == priv)
133 134
		return 0;

135 136 137
	privlist[num_tsecs++] = priv;
	priv->regs = tsec_info->regs;
	priv->phyregs = tsec_info->miiregs;
138

139 140
	priv->phyaddr = tsec_info->phyaddr;
	priv->flags = tsec_info->flags;
141

142
	sprintf(dev->name, tsec_info->devname);
W
wdenk 已提交
143
	dev->iobase = 0;
144 145 146 147 148
	dev->priv = priv;
	dev->init = tsec_init;
	dev->halt = tsec_halt;
	dev->send = tsec_send;
	dev->recv = tsec_recv;
D
David Updegraff 已提交
149 150 151
#ifdef CONFIG_MCAST_TFTP
	dev->mcast = tsec_mcast_addr;
#endif
W
wdenk 已提交
152 153

	/* Tell u-boot to get the addr from the env */
154
	for (i = 0; i < 6; i++)
W
wdenk 已提交
155 156 157 158
		dev->enetaddr[i] = 0;

	eth_register(dev);

159 160
	/* Reset the MAC */
	priv->regs->maccfg1 |= MACCFG1_SOFT_RESET;
A
Andy Fleming 已提交
161
	udelay(2);  /* Soft Reset must be asserted for 3 TX clocks */
162
	priv->regs->maccfg1 &= ~(MACCFG1_SOFT_RESET);
W
wdenk 已提交
163

164
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) \
M
Marian Balakowicz 已提交
165 166 167 168
	&& !defined(BITBANGMII)
	miiphy_register(dev->name, tsec_miiphy_read, tsec_miiphy_write);
#endif

169 170
	/* Try to initialize PHY here, and return */
	return init_phy(dev);
W
wdenk 已提交
171 172 173
}

/* Initializes data structures and registers for the controller,
W
wdenk 已提交
174
 * and brings the interface up.	 Returns the link status, meaning
175
 * that it returns success if the link is up, failure otherwise.
176 177 178
 * This allows u-boot to find the first active controller.
 */
int tsec_init(struct eth_device *dev, bd_t * bd)
W
wdenk 已提交
179 180 181 182
{
	uint tempval;
	char tmpbuf[MAC_ADDR_LEN];
	int i;
183 184
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	volatile tsec_t *regs = priv->regs;
W
wdenk 已提交
185 186 187 188

	/* Make sure the controller is stopped */
	tsec_halt(dev);

189
	/* Init MACCFG2.  Defaults to GMII */
W
wdenk 已提交
190 191 192 193 194 195 196
	regs->maccfg2 = MACCFG2_INIT_SETTINGS;

	/* Init ECNTRL */
	regs->ecntrl = ECNTRL_INIT_SETTINGS;

	/* Copy the station address into the address registers.
	 * Backwards, because little endian MACS are dumb */
197
	for (i = 0; i < MAC_ADDR_LEN; i++) {
198
		tmpbuf[MAC_ADDR_LEN - 1 - i] = dev->enetaddr[i];
W
wdenk 已提交
199
	}
200
	regs->macstnaddr1 = *((uint *) (tmpbuf));
W
wdenk 已提交
201

202
	tempval = *((uint *) (tmpbuf + 4));
W
wdenk 已提交
203

W
Wolfgang Denk 已提交
204
	regs->macstnaddr2 = tempval;
W
wdenk 已提交
205 206 207 208 209 210 211 212 213

	/* reset the indices to zero */
	rxIdx = 0;
	txIdx = 0;

	/* Clear out (for the most part) the other registers */
	init_registers(regs);

	/* Ready the device for tx/rx */
214
	startup_tsec(dev);
W
wdenk 已提交
215

216
	/* If there's no link, fail */
B
Ben Warren 已提交
217
	return (priv->link ? 0 : -1);
W
wdenk 已提交
218 219
}

A
Andy Fleming 已提交
220 221 222
/* Writes the given phy's reg with value, using the specified MDIO regs */
static void tsec_local_mdio_write(volatile tsec_t *phyregs, uint addr,
		uint reg, uint value)
223
{
224
	int timeout = 1000000;
225

A
Andy Fleming 已提交
226 227
	phyregs->miimadd = (addr << 8) | reg;
	phyregs->miimcon = value;
E
Eran Liberty 已提交
228
	asm("sync");
229

230
	timeout = 1000000;
A
Andy Fleming 已提交
231
	while ((phyregs->miimind & MIIMIND_BUSY) && timeout--) ;
232 233
}

A
Andy Fleming 已提交
234 235 236

/* Provide the default behavior of writing the PHY of this ethernet device */
#define write_phy_reg(priv, regnum, value) tsec_local_mdio_write(priv->phyregs,priv->phyaddr,regnum,value)
237

238
/* Reads register regnum on the device's PHY through the
A
Andy Fleming 已提交
239
 * specified registers.	 It lowers and raises the read
240 241 242 243
 * command, and waits for the data to become valid (miimind
 * notvalid bit cleared), and the bus to cease activity (miimind
 * busy bit cleared), and then returns the value
 */
A
Andy Fleming 已提交
244
uint tsec_local_mdio_read(volatile tsec_t *phyregs, uint phyid, uint regnum)
W
wdenk 已提交
245 246 247
{
	uint value;

248 249
	/* Put the address of the phy, and the register
	 * number into MIIMADD */
A
Andy Fleming 已提交
250
	phyregs->miimadd = (phyid << 8) | regnum;
W
wdenk 已提交
251 252

	/* Clear the command register, and wait */
A
Andy Fleming 已提交
253
	phyregs->miimcom = 0;
E
Eran Liberty 已提交
254
	asm("sync");
W
wdenk 已提交
255 256

	/* Initiate a read command, and wait */
A
Andy Fleming 已提交
257
	phyregs->miimcom = MIIM_READ_COMMAND;
E
Eran Liberty 已提交
258
	asm("sync");
W
wdenk 已提交
259 260

	/* Wait for the the indication that the read is done */
A
Andy Fleming 已提交
261
	while ((phyregs->miimind & (MIIMIND_NOTVALID | MIIMIND_BUSY))) ;
W
wdenk 已提交
262 263

	/* Grab the value read from the PHY */
A
Andy Fleming 已提交
264
	value = phyregs->miimstat;
W
wdenk 已提交
265 266 267 268

	return value;
}

269
/* #define to provide old read_phy_reg functionality without duplicating code */
A
Andy Fleming 已提交
270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
#define read_phy_reg(priv,regnum) tsec_local_mdio_read(priv->phyregs,priv->phyaddr,regnum)

#define TBIANA_SETTINGS ( \
		TBIANA_ASYMMETRIC_PAUSE \
		| TBIANA_SYMMETRIC_PAUSE \
		| TBIANA_FULL_DUPLEX \
		)

#define TBICR_SETTINGS ( \
		TBICR_PHY_RESET \
		| TBICR_ANEG_ENABLE \
		| TBICR_FULL_DUPLEX \
		| TBICR_SPEED1_SET \
		)
/* Configure the TBI for SGMII operation */
static void tsec_configure_serdes(struct tsec_private *priv)
{
287 288 289
	/* Access TBI PHY registers at given TSEC register offset as opposed to the
	 * register offset used for external PHY accesses */
	tsec_local_mdio_write(priv->regs, priv->regs->tbipa, TBI_ANA,
A
Andy Fleming 已提交
290
			TBIANA_SETTINGS);
291
	tsec_local_mdio_write(priv->regs, priv->regs->tbipa, TBI_TBICON,
A
Andy Fleming 已提交
292
			TBICON_CLK_SELECT);
293
	tsec_local_mdio_write(priv->regs, priv->regs->tbipa, TBI_CR,
A
Andy Fleming 已提交
294 295
			TBICR_SETTINGS);
}
296

297 298 299 300 301
/* Discover which PHY is attached to the device, and configure it
 * properly.  If the PHY is not recognized, then return 0
 * (failure).  Otherwise, return 1
 */
static int init_phy(struct eth_device *dev)
W
wdenk 已提交
302
{
303 304
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	struct phy_info *curphy;
A
Andy Fleming 已提交
305 306
	volatile tsec_t *phyregs = priv->phyregs;
	volatile tsec_t *regs = priv->regs;
W
wdenk 已提交
307 308

	/* Assign a Physical address to the TBI */
309 310
	regs->tbipa = CONFIG_SYS_TBIPA_VALUE;
	phyregs->tbipa = CONFIG_SYS_TBIPA_VALUE;
311
	asm("sync");
W
wdenk 已提交
312 313 314

	/* Reset MII (due to new addresses) */
	priv->phyregs->miimcfg = MIIMCFG_RESET;
E
Eran Liberty 已提交
315
	asm("sync");
W
wdenk 已提交
316
	priv->phyregs->miimcfg = MIIMCFG_INIT_VALUE;
E
Eran Liberty 已提交
317
	asm("sync");
318
	while (priv->phyregs->miimind & MIIMIND_BUSY) ;
W
wdenk 已提交
319

320
	if (0 == relocated)
321
		relocate_cmds();
W
wdenk 已提交
322

323 324 325
	/* Get the cmd structure corresponding to the attached
	 * PHY */
	curphy = get_phy_info(dev);
W
wdenk 已提交
326

327 328
	if (curphy == NULL) {
		priv->phyinfo = NULL;
329
		printf("%s: No PHY found\n", dev->name);
W
wdenk 已提交
330

331 332
		return 0;
	}
W
wdenk 已提交
333

A
Andy Fleming 已提交
334 335 336
	if (regs->ecntrl & ECNTRL_SGMII_MODE)
		tsec_configure_serdes(priv);

337
	priv->phyinfo = curphy;
W
wdenk 已提交
338

339
	phy_run_commands(priv, priv->phyinfo->config);
W
wdenk 已提交
340

341 342
	return 1;
}
W
wdenk 已提交
343

344 345 346 347 348
/*
 * Returns which value to write to the control register.
 * For 10/100, the value is slightly different
 */
uint mii_cr_init(uint mii_reg, struct tsec_private * priv)
349
{
350
	if (priv->flags & TSEC_GIGABIT)
351
		return MIIM_CONTROL_INIT;
W
wdenk 已提交
352
	else
353 354
		return MIIM_CR_INIT;
}
W
wdenk 已提交
355

356
/* Parse the status register for link, and then do
357 358 359
 * auto-negotiation
 */
uint mii_parse_sr(uint mii_reg, struct tsec_private * priv)
360
{
361
	/*
A
Andy Fleming 已提交
362 363
	 * Wait if the link is up, and autonegotiation is in progress
	 * (ie - we're capable and it's not done)
364 365
	 */
	mii_reg = read_phy_reg(priv, MIIM_STATUS);
A
Andy Fleming 已提交
366
	if ((mii_reg & MIIM_STATUS_LINK) && (mii_reg & PHY_BMSR_AUTN_ABLE)
367
	    && !(mii_reg & PHY_BMSR_AUTN_COMP)) {
368 369
		int i = 0;

370
		puts("Waiting for PHY auto negotiation to complete");
A
Andy Fleming 已提交
371
		while (!(mii_reg & PHY_BMSR_AUTN_COMP)) {
372 373 374 375
			/*
			 * Timeout reached ?
			 */
			if (i > PHY_AUTONEGOTIATE_TIMEOUT) {
376
				puts(" TIMEOUT !\n");
377
				priv->link = 0;
378
				return 0;
379
			}
W
wdenk 已提交
380

381
			if ((i++ % 1000) == 0) {
382
				putc('.');
383
			}
384
			udelay(1000);	/* 1 ms */
385
			mii_reg = read_phy_reg(priv, MIIM_STATUS);
386
		}
387
		puts(" done\n");
388
		priv->link = 1;
389
		udelay(500000);	/* another 500 ms (results in faster booting) */
390
	} else {
A
Andy Fleming 已提交
391 392 393 394
		if (mii_reg & MIIM_STATUS_LINK)
			priv->link = 1;
		else
			priv->link = 0;
W
wdenk 已提交
395 396
	}

397 398
	return 0;
}
W
wdenk 已提交
399

400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469
/* Generic function which updates the speed and duplex.  If
 * autonegotiation is enabled, it uses the AND of the link
 * partner's advertised capabilities and our advertised
 * capabilities.  If autonegotiation is disabled, we use the
 * appropriate bits in the control register.
 *
 * Stolen from Linux's mii.c and phy_device.c
 */
uint mii_parse_link(uint mii_reg, struct tsec_private *priv)
{
	/* We're using autonegotiation */
	if (mii_reg & PHY_BMSR_AUTN_ABLE) {
		uint lpa = 0;
		uint gblpa = 0;

		/* Check for gigabit capability */
		if (mii_reg & PHY_BMSR_EXT) {
			/* We want a list of states supported by
			 * both PHYs in the link
			 */
			gblpa = read_phy_reg(priv, PHY_1000BTSR);
			gblpa &= read_phy_reg(priv, PHY_1000BTCR) << 2;
		}

		/* Set the baseline so we only have to set them
		 * if they're different
		 */
		priv->speed = 10;
		priv->duplexity = 0;

		/* Check the gigabit fields */
		if (gblpa & (PHY_1000BTSR_1000FD | PHY_1000BTSR_1000HD)) {
			priv->speed = 1000;

			if (gblpa & PHY_1000BTSR_1000FD)
				priv->duplexity = 1;

			/* We're done! */
			return 0;
		}

		lpa = read_phy_reg(priv, PHY_ANAR);
		lpa &= read_phy_reg(priv, PHY_ANLPAR);

		if (lpa & (PHY_ANLPAR_TXFD | PHY_ANLPAR_TX)) {
			priv->speed = 100;

			if (lpa & PHY_ANLPAR_TXFD)
				priv->duplexity = 1;

		} else if (lpa & PHY_ANLPAR_10FD)
			priv->duplexity = 1;
	} else {
		uint bmcr = read_phy_reg(priv, PHY_BMCR);

		priv->speed = 10;
		priv->duplexity = 0;

		if (bmcr & PHY_BMCR_DPLX)
			priv->duplexity = 1;

		if (bmcr & PHY_BMCR_1000_MBPS)
			priv->speed = 1000;
		else if (bmcr & PHY_BMCR_100_MBPS)
			priv->speed = 100;
	}

	return 0;
}

470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524
/*
 * Parse the BCM54xx status register for speed and duplex information.
 * The linux sungem_phy has this information, but in a table format.
 */
uint mii_parse_BCM54xx_sr(uint mii_reg, struct tsec_private *priv)
{

	switch((mii_reg & MIIM_BCM54xx_AUXSTATUS_LINKMODE_MASK) >> MIIM_BCM54xx_AUXSTATUS_LINKMODE_SHIFT){

		case 1:
			printf("Enet starting in 10BT/HD\n");
			priv->duplexity = 0;
			priv->speed = 10;
			break;

		case 2:
			printf("Enet starting in 10BT/FD\n");
			priv->duplexity = 1;
			priv->speed = 10;
			break;

		case 3:
			printf("Enet starting in 100BT/HD\n");
			priv->duplexity = 0;
			priv->speed = 100;
			break;

		case 5:
			printf("Enet starting in 100BT/FD\n");
			priv->duplexity = 1;
			priv->speed = 100;
			break;

		case 6:
			printf("Enet starting in 1000BT/HD\n");
			priv->duplexity = 0;
			priv->speed = 1000;
			break;

		case 7:
			printf("Enet starting in 1000BT/FD\n");
			priv->duplexity = 1;
			priv->speed = 1000;
			break;

		default:
			printf("Auto-neg error, defaulting to 10BT/HD\n");
			priv->duplexity = 0;
			priv->speed = 10;
			break;
	}

	return 0;

}
525
/* Parse the 88E1011's status register for speed and duplex
526 527 528
 * information
 */
uint mii_parse_88E1011_psr(uint mii_reg, struct tsec_private * priv)
529 530 531
{
	uint speed;

532 533
	mii_reg = read_phy_reg(priv, MIIM_88E1011_PHY_STATUS);

A
Andy Fleming 已提交
534 535
	if ((mii_reg & MIIM_88E1011_PHYSTAT_LINK) &&
		!(mii_reg & MIIM_88E1011_PHYSTAT_SPDDONE)) {
536 537
		int i = 0;

538
		puts("Waiting for PHY realtime link");
A
Andy Fleming 已提交
539 540
		while (!(mii_reg & MIIM_88E1011_PHYSTAT_SPDDONE)) {
			/* Timeout reached ? */
541
			if (i > PHY_AUTONEGOTIATE_TIMEOUT) {
542
				puts(" TIMEOUT !\n");
543 544 545 546 547
				priv->link = 0;
				break;
			}

			if ((i++ % 1000) == 0) {
548
				putc('.');
549
			}
550
			udelay(1000);	/* 1 ms */
551 552
			mii_reg = read_phy_reg(priv, MIIM_88E1011_PHY_STATUS);
		}
553 554
		puts(" done\n");
		udelay(500000);	/* another 500 ms (results in faster booting) */
A
Andy Fleming 已提交
555 556 557 558 559
	} else {
		if (mii_reg & MIIM_88E1011_PHYSTAT_LINK)
			priv->link = 1;
		else
			priv->link = 0;
560 561
	}

562
	if (mii_reg & MIIM_88E1011_PHYSTAT_DUPLEX)
563 564 565 566
		priv->duplexity = 1;
	else
		priv->duplexity = 0;

567
	speed = (mii_reg & MIIM_88E1011_PHYSTAT_SPEED);
568

569 570 571 572 573 574 575 576 577
	switch (speed) {
	case MIIM_88E1011_PHYSTAT_GBIT:
		priv->speed = 1000;
		break;
	case MIIM_88E1011_PHYSTAT_100:
		priv->speed = 100;
		break;
	default:
		priv->speed = 10;
W
wdenk 已提交
578 579
	}

580 581
	return 0;
}
W
wdenk 已提交
582

583 584 585 586 587 588 589 590
/* Parse the RTL8211B's status register for speed and duplex
 * information
 */
uint mii_parse_RTL8211B_sr(uint mii_reg, struct tsec_private * priv)
{
	uint speed;

	mii_reg = read_phy_reg(priv, MIIM_RTL8211B_PHY_STATUS);
591
	if (!(mii_reg & MIIM_RTL8211B_PHYSTAT_SPDDONE)) {
592 593
		int i = 0;

594 595
		/* in case of timeout ->link is cleared */
		priv->link = 1;
596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
		puts("Waiting for PHY realtime link");
		while (!(mii_reg & MIIM_RTL8211B_PHYSTAT_SPDDONE)) {
			/* Timeout reached ? */
			if (i > PHY_AUTONEGOTIATE_TIMEOUT) {
				puts(" TIMEOUT !\n");
				priv->link = 0;
				break;
			}

			if ((i++ % 1000) == 0) {
				putc('.');
			}
			udelay(1000);	/* 1 ms */
			mii_reg = read_phy_reg(priv, MIIM_RTL8211B_PHY_STATUS);
		}
		puts(" done\n");
		udelay(500000);	/* another 500 ms (results in faster booting) */
	} else {
		if (mii_reg & MIIM_RTL8211B_PHYSTAT_LINK)
			priv->link = 1;
		else
			priv->link = 0;
	}

	if (mii_reg & MIIM_RTL8211B_PHYSTAT_DUPLEX)
		priv->duplexity = 1;
	else
		priv->duplexity = 0;

	speed = (mii_reg & MIIM_RTL8211B_PHYSTAT_SPEED);

	switch (speed) {
	case MIIM_RTL8211B_PHYSTAT_GBIT:
		priv->speed = 1000;
		break;
	case MIIM_RTL8211B_PHYSTAT_100:
		priv->speed = 100;
		break;
	default:
		priv->speed = 10;
	}

	return 0;
}

641
/* Parse the cis8201's status register for speed and duplex
642 643 644
 * information
 */
uint mii_parse_cis8201(uint mii_reg, struct tsec_private * priv)
645 646 647
{
	uint speed;

648
	if (mii_reg & MIIM_CIS8201_AUXCONSTAT_DUPLEX)
649 650 651 652 653
		priv->duplexity = 1;
	else
		priv->duplexity = 0;

	speed = mii_reg & MIIM_CIS8201_AUXCONSTAT_SPEED;
654 655 656 657 658 659 660 661 662 663
	switch (speed) {
	case MIIM_CIS8201_AUXCONSTAT_GBIT:
		priv->speed = 1000;
		break;
	case MIIM_CIS8201_AUXCONSTAT_100:
		priv->speed = 100;
		break;
	default:
		priv->speed = 10;
		break;
W
wdenk 已提交
664 665
	}

666 667
	return 0;
}
668

669
/* Parse the vsc8244's status register for speed and duplex
670 671 672
 * information
 */
uint mii_parse_vsc8244(uint mii_reg, struct tsec_private * priv)
673
{
674
	uint speed;
W
wdenk 已提交
675

676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695
	if (mii_reg & MIIM_VSC8244_AUXCONSTAT_DUPLEX)
		priv->duplexity = 1;
	else
		priv->duplexity = 0;

	speed = mii_reg & MIIM_VSC8244_AUXCONSTAT_SPEED;
	switch (speed) {
	case MIIM_VSC8244_AUXCONSTAT_GBIT:
		priv->speed = 1000;
		break;
	case MIIM_VSC8244_AUXCONSTAT_100:
		priv->speed = 100;
		break;
	default:
		priv->speed = 10;
		break;
	}

	return 0;
}
696 697

/* Parse the DM9161's status register for speed and duplex
698 699 700
 * information
 */
uint mii_parse_dm9161_scsr(uint mii_reg, struct tsec_private * priv)
701
{
702
	if (mii_reg & (MIIM_DM9161_SCSR_100F | MIIM_DM9161_SCSR_100H))
703 704 705 706
		priv->speed = 100;
	else
		priv->speed = 10;

707
	if (mii_reg & (MIIM_DM9161_SCSR_100F | MIIM_DM9161_SCSR_10F))
708 709 710 711 712 713 714
		priv->duplexity = 1;
	else
		priv->duplexity = 0;

	return 0;
}

715 716 717 718
/*
 * Hack to write all 4 PHYs with the LED values
 */
uint mii_cis8204_fixled(uint mii_reg, struct tsec_private * priv)
719 720 721
{
	uint phyid;
	volatile tsec_t *regbase = priv->phyregs;
722
	int timeout = 1000000;
723

724
	for (phyid = 0; phyid < 4; phyid++) {
725 726
		regbase->miimadd = (phyid << 8) | mii_reg;
		regbase->miimcon = MIIM_CIS8204_SLEDCON_INIT;
E
Eran Liberty 已提交
727
		asm("sync");
728

729 730
		timeout = 1000000;
		while ((regbase->miimind & MIIMIND_BUSY) && timeout--) ;
W
wdenk 已提交
731 732
	}

733
	return MIIM_CIS8204_SLEDCON_INIT;
W
wdenk 已提交
734 735
}

736
uint mii_cis8204_setmode(uint mii_reg, struct tsec_private * priv)
737 738 739 740 741 742
{
	if (priv->flags & TSEC_REDUCED)
		return MIIM_CIS8204_EPHYCON_INIT | MIIM_CIS8204_EPHYCON_RGMII;
	else
		return MIIM_CIS8204_EPHYCON_INIT;
}
W
wdenk 已提交
743

744 745 746 747 748 749 750 751 752
uint mii_m88e1111s_setmode(uint mii_reg, struct tsec_private *priv)
{
	uint mii_data = read_phy_reg(priv, mii_reg);

	if (priv->flags & TSEC_REDUCED)
		mii_data = (mii_data & 0xfff0) | 0x000b;
	return mii_data;
}

753 754
/* Initialized required registers to appropriate values, zeroing
 * those we don't care about (unless zero is bad, in which case,
755 756 757
 * choose a more appropriate value)
 */
static void init_registers(volatile tsec_t * regs)
W
wdenk 已提交
758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798
{
	/* Clear IEVENT */
	regs->ievent = IEVENT_INIT_CLEAR;

	regs->imask = IMASK_INIT_CLEAR;

	regs->hash.iaddr0 = 0;
	regs->hash.iaddr1 = 0;
	regs->hash.iaddr2 = 0;
	regs->hash.iaddr3 = 0;
	regs->hash.iaddr4 = 0;
	regs->hash.iaddr5 = 0;
	regs->hash.iaddr6 = 0;
	regs->hash.iaddr7 = 0;

	regs->hash.gaddr0 = 0;
	regs->hash.gaddr1 = 0;
	regs->hash.gaddr2 = 0;
	regs->hash.gaddr3 = 0;
	regs->hash.gaddr4 = 0;
	regs->hash.gaddr5 = 0;
	regs->hash.gaddr6 = 0;
	regs->hash.gaddr7 = 0;

	regs->rctrl = 0x00000000;

	/* Init RMON mib registers */
	memset((void *)&(regs->rmon), 0, sizeof(rmon_mib_t));

	regs->rmon.cam1 = 0xffffffff;
	regs->rmon.cam2 = 0xffffffff;

	regs->mrblr = MRBLR_INIT_SETTINGS;

	regs->minflr = MINFLR_INIT_SETTINGS;

	regs->attr = ATTR_INIT_SETTINGS;
	regs->attreli = ATTRELI_INIT_SETTINGS;

}

799
/* Configure maccfg2 based on negotiated speed and duplex
800 801
 * reported by PHY handling code
 */
802 803 804 805 806
static void adjust_link(struct eth_device *dev)
{
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	volatile tsec_t *regs = priv->regs;

807 808
	if (priv->link) {
		if (priv->duplexity != 0)
809 810 811 812
			regs->maccfg2 |= MACCFG2_FULL_DUPLEX;
		else
			regs->maccfg2 &= ~(MACCFG2_FULL_DUPLEX);

813 814 815 816 817 818 819 820 821 822
		switch (priv->speed) {
		case 1000:
			regs->maccfg2 = ((regs->maccfg2 & ~(MACCFG2_IF))
					 | MACCFG2_GMII);
			break;
		case 100:
		case 10:
			regs->maccfg2 = ((regs->maccfg2 & ~(MACCFG2_IF))
					 | MACCFG2_MII);

823 824
			/* Set R100 bit in all modes although
			 * it is only used in RGMII mode
825
			 */
826
			if (priv->speed == 100)
827 828 829 830 831 832 833
				regs->ecntrl |= ECNTRL_R100;
			else
				regs->ecntrl &= ~(ECNTRL_R100);
			break;
		default:
			printf("%s: Speed was bad\n", dev->name);
			break;
834 835 836
		}

		printf("Speed: %d, %s duplex\n", priv->speed,
837
		       (priv->duplexity) ? "full" : "half");
838 839 840 841 842 843 844

	} else {
		printf("%s: No link.\n", dev->name);
	}
}

/* Set up the buffers and their descriptors, and bring up the
845 846
 * interface
 */
847
static void startup_tsec(struct eth_device *dev)
W
wdenk 已提交
848 849
{
	int i;
850 851
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	volatile tsec_t *regs = priv->regs;
W
wdenk 已提交
852 853 854 855 856 857 858 859 860

	/* Point to the buffer descriptors */
	regs->tbase = (unsigned int)(&rtx.txbd[txIdx]);
	regs->rbase = (unsigned int)(&rtx.rxbd[rxIdx]);

	/* Initialize the Rx Buffer descriptors */
	for (i = 0; i < PKTBUFSRX; i++) {
		rtx.rxbd[i].status = RXBD_EMPTY;
		rtx.rxbd[i].length = 0;
861
		rtx.rxbd[i].bufPtr = (uint) NetRxPackets[i];
W
wdenk 已提交
862
	}
863
	rtx.rxbd[PKTBUFSRX - 1].status |= RXBD_WRAP;
W
wdenk 已提交
864 865

	/* Initialize the TX Buffer Descriptors */
866
	for (i = 0; i < TX_BUF_CNT; i++) {
W
wdenk 已提交
867 868 869 870
		rtx.txbd[i].status = 0;
		rtx.txbd[i].length = 0;
		rtx.txbd[i].bufPtr = 0;
	}
871
	rtx.txbd[TX_BUF_CNT - 1].status |= TXBD_WRAP;
W
wdenk 已提交
872

873
	/* Start up the PHY */
874 875
	if(priv->phyinfo)
		phy_run_commands(priv, priv->phyinfo->startup);
876

877 878
	adjust_link(dev);

W
wdenk 已提交
879 880 881 882 883 884
	/* Enable Transmit and Receive */
	regs->maccfg1 |= (MACCFG1_RX_EN | MACCFG1_TX_EN);

	/* Tell the DMA it is clear to go */
	regs->dmactrl |= DMACTRL_INIT_SETTINGS;
	regs->tstat = TSTAT_CLEAR_THALT;
885
	regs->rstat = RSTAT_CLEAR_RHALT;
W
wdenk 已提交
886 887 888
	regs->dmactrl &= ~(DMACTRL_GRS | DMACTRL_GTS);
}

W
wdenk 已提交
889
/* This returns the status bits of the device.	The return value
W
wdenk 已提交
890
 * is never checked, and this is what the 8260 driver did, so we
W
wdenk 已提交
891
 * do the same.	 Presumably, this would be zero if there were no
892 893 894
 * errors
 */
static int tsec_send(struct eth_device *dev, volatile void *packet, int length)
W
wdenk 已提交
895 896 897
{
	int i;
	int result = 0;
898 899
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	volatile tsec_t *regs = priv->regs;
W
wdenk 已提交
900 901

	/* Find an empty buffer descriptor */
902
	for (i = 0; rtx.txbd[txIdx].status & TXBD_READY; i++) {
W
wdenk 已提交
903
		if (i >= TOUT_LOOP) {
904
			debug("%s: tsec: tx buffers full\n", dev->name);
W
wdenk 已提交
905 906 907 908
			return result;
		}
	}

909
	rtx.txbd[txIdx].bufPtr = (uint) packet;
W
wdenk 已提交
910
	rtx.txbd[txIdx].length = length;
911 912
	rtx.txbd[txIdx].status |=
	    (TXBD_READY | TXBD_LAST | TXBD_CRC | TXBD_INTERRUPT);
W
wdenk 已提交
913 914 915 916 917

	/* Tell the DMA to go */
	regs->tstat = TSTAT_CLEAR_THALT;

	/* Wait for buffer to be transmitted */
918
	for (i = 0; rtx.txbd[txIdx].status & TXBD_READY; i++) {
W
wdenk 已提交
919
		if (i >= TOUT_LOOP) {
920
			debug("%s: tsec: tx error\n", dev->name);
W
wdenk 已提交
921 922 923 924 925 926 927 928 929 930
			return result;
		}
	}

	txIdx = (txIdx + 1) % TX_BUF_CNT;
	result = rtx.txbd[txIdx].status & TXBD_STATS;

	return result;
}

931
static int tsec_recv(struct eth_device *dev)
W
wdenk 已提交
932 933
{
	int length;
934 935
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	volatile tsec_t *regs = priv->regs;
W
wdenk 已提交
936

937
	while (!(rtx.rxbd[rxIdx].status & RXBD_EMPTY)) {
W
wdenk 已提交
938 939 940 941 942 943

		length = rtx.rxbd[rxIdx].length;

		/* Send the packet up if there were no errors */
		if (!(rtx.rxbd[rxIdx].status & RXBD_STATS)) {
			NetReceive(NetRxPackets[rxIdx], length - 4);
944 945
		} else {
			printf("Got error %x\n",
946
			       (rtx.rxbd[rxIdx].status & RXBD_STATS));
W
wdenk 已提交
947 948 949 950 951
		}

		rtx.rxbd[rxIdx].length = 0;

		/* Set the wrap bit if this is the last element in the list */
952 953
		rtx.rxbd[rxIdx].status =
		    RXBD_EMPTY | (((rxIdx + 1) == PKTBUFSRX) ? RXBD_WRAP : 0);
W
wdenk 已提交
954 955 956 957

		rxIdx = (rxIdx + 1) % PKTBUFSRX;
	}

958
	if (regs->ievent & IEVENT_BSY) {
W
wdenk 已提交
959 960 961 962 963 964 965 966
		regs->ievent = IEVENT_BSY;
		regs->rstat = RSTAT_CLEAR_RHALT;
	}

	return -1;

}

967
/* Stop the interface */
968
static void tsec_halt(struct eth_device *dev)
W
wdenk 已提交
969
{
970 971
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	volatile tsec_t *regs = priv->regs;
W
wdenk 已提交
972 973 974 975

	regs->dmactrl &= ~(DMACTRL_GRS | DMACTRL_GTS);
	regs->dmactrl |= (DMACTRL_GRS | DMACTRL_GTS);

976
	while (!(regs->ievent & (IEVENT_GRSC | IEVENT_GTSC))) ;
W
wdenk 已提交
977 978 979

	regs->maccfg1 &= ~(MACCFG1_TX_EN | MACCFG1_RX_EN);

980
	/* Shut down the PHY, as needed */
981 982
	if(priv->phyinfo)
		phy_run_commands(priv, priv->phyinfo->shutdown);
983 984
}

985
struct phy_info phy_info_M88E1149S = {
986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015
	0x1410ca,
	"Marvell 88E1149S",
	4,
	(struct phy_cmd[]){     /* config */
		/* Reset and configure the PHY */
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{0x1d, 0x1f, NULL},
		{0x1e, 0x200c, NULL},
		{0x1d, 0x5, NULL},
		{0x1e, 0x0, NULL},
		{0x1e, 0x100, NULL},
		{MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
		{MIIM_ANAR, MIIM_ANAR_INIT, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
		{miim_end,}
	},
	(struct phy_cmd[]){     /* startup */
		/* Status is read once to clear old link state */
		{MIIM_STATUS, miim_read, NULL},
		/* Auto-negotiate */
		{MIIM_STATUS, miim_read, &mii_parse_sr},
		/* Read the status */
		{MIIM_88E1011_PHY_STATUS, miim_read,
		 &mii_parse_88E1011_psr},
		{miim_end,}
	},
	(struct phy_cmd[]){     /* shutdown */
		{miim_end,}
	},
1016 1017
};

1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045
/* The 5411 id is 0x206070, the 5421 is 0x2060e0 */
struct phy_info phy_info_BCM5461S = {
	0x02060c1,	/* 5461 ID */
	"Broadcom BCM5461S",
	0, /* not clear to me what minor revisions we can shift away */
	(struct phy_cmd[]) { /* config */
		/* Reset and configure the PHY */
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
		{MIIM_ANAR, MIIM_ANAR_INIT, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
		{miim_end,}
	},
	(struct phy_cmd[]) { /* startup */
		/* Status is read once to clear old link state */
		{MIIM_STATUS, miim_read, NULL},
		/* Auto-negotiate */
		{MIIM_STATUS, miim_read, &mii_parse_sr},
		/* Read the status */
		{MIIM_BCM54xx_AUXSTATUS, miim_read, &mii_parse_BCM54xx_sr},
		{miim_end,}
	},
	(struct phy_cmd[]) { /* shutdown */
		{miim_end,}
	},
};

J
Joe Hamman 已提交
1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072
struct phy_info phy_info_BCM5464S = {
	0x02060b1,	/* 5464 ID */
	"Broadcom BCM5464S",
	0, /* not clear to me what minor revisions we can shift away */
	(struct phy_cmd[]) { /* config */
		/* Reset and configure the PHY */
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
		{MIIM_ANAR, MIIM_ANAR_INIT, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
		{miim_end,}
	},
	(struct phy_cmd[]) { /* startup */
		/* Status is read once to clear old link state */
		{MIIM_STATUS, miim_read, NULL},
		/* Auto-negotiate */
		{MIIM_STATUS, miim_read, &mii_parse_sr},
		/* Read the status */
		{MIIM_BCM54xx_AUXSTATUS, miim_read, &mii_parse_BCM54xx_sr},
		{miim_end,}
	},
	(struct phy_cmd[]) { /* shutdown */
		{miim_end,}
	},
};

1073 1074 1075 1076
struct phy_info phy_info_M88E1011S = {
	0x01410c6,
	"Marvell 88E1011S",
	4,
1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103
	(struct phy_cmd[]){	/* config */
			   /* Reset and configure the PHY */
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
			   {0x1d, 0x1f, NULL},
			   {0x1e, 0x200c, NULL},
			   {0x1d, 0x5, NULL},
			   {0x1e, 0x0, NULL},
			   {0x1e, 0x100, NULL},
			   {MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
			   {MIIM_ANAR, MIIM_ANAR_INIT, NULL},
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Status is read once to clear old link state */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the status */
			   {MIIM_88E1011_PHY_STATUS, miim_read,
			    &mii_parse_88E1011_psr},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1104 1105
};

W
wdenk 已提交
1106 1107 1108 1109
struct phy_info phy_info_M88E1111S = {
	0x01410cc,
	"Marvell 88E1111S",
	4,
1110 1111 1112
	(struct phy_cmd[]){	/* config */
			   /* Reset and configure the PHY */
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
1113
			   {0x1b, 0x848f, &mii_m88e1111s_setmode},
1114
			   {0x14, 0x0cd2, NULL}, /* Delay RGMII TX and RX */
1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
			   {MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
			   {MIIM_ANAR, MIIM_ANAR_INIT, NULL},
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Status is read once to clear old link state */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the status */
			   {MIIM_88E1011_PHY_STATUS, miim_read,
			    &mii_parse_88E1011_psr},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
W
wdenk 已提交
1134 1135
};

1136 1137 1138 1139 1140 1141 1142 1143 1144
struct phy_info phy_info_M88E1118 = {
	0x01410e1,
	"Marvell 88E1118",
	4,
	(struct phy_cmd[]){	/* config */
		/* Reset and configure the PHY */
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{0x16, 0x0002, NULL}, /* Change Page Number */
		{0x15, 0x1070, NULL}, /* Delay RGMII TX and RX */
R
Ron Madrid 已提交
1145 1146 1147
		{0x16, 0x0003, NULL}, /* Change Page Number */
		{0x10, 0x021e, NULL}, /* Adjust LED control */
		{0x16, 0x0000, NULL}, /* Change Page Number */
1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158
		{MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
		{MIIM_ANAR, MIIM_ANAR_INIT, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
		{miim_end,}
		},
	(struct phy_cmd[]){	/* startup */
		{0x16, 0x0000, NULL}, /* Change Page Number */
		/* Status is read once to clear old link state */
		{MIIM_STATUS, miim_read, NULL},
		/* Auto-negotiate */
R
Ron Madrid 已提交
1159
		{MIIM_STATUS, miim_read, &mii_parse_sr},
1160 1161 1162 1163 1164 1165 1166 1167 1168 1169
		/* Read the status */
		{MIIM_88E1011_PHY_STATUS, miim_read,
		 &mii_parse_88E1011_psr},
		{miim_end,}
		},
	(struct phy_cmd[]){	/* shutdown */
		{miim_end,}
		},
};

1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203
/*
 *  Since to access LED register we need do switch the page, we
 * do LED configuring in the miim_read-like function as follows
 */
uint mii_88E1121_set_led (uint mii_reg, struct tsec_private *priv)
{
	uint pg;

	/* Switch the page to access the led register */
	pg = read_phy_reg(priv, MIIM_88E1121_PHY_PAGE);
	write_phy_reg(priv, MIIM_88E1121_PHY_PAGE, MIIM_88E1121_PHY_LED_PAGE);

	/* Configure leds */
	write_phy_reg(priv, MIIM_88E1121_PHY_LED_CTRL,
		      MIIM_88E1121_PHY_LED_DEF);

	/* Restore the page pointer */
	write_phy_reg(priv, MIIM_88E1121_PHY_PAGE, pg);
	return 0;
}

struct phy_info phy_info_M88E1121R = {
	0x01410cb,
	"Marvell 88E1121R",
	4,
	(struct phy_cmd[]){	/* config */
			   /* Reset and configure the PHY */
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
			   {MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
			   {MIIM_ANAR, MIIM_ANAR_INIT, NULL},
			   /* Configure leds */
			   {MIIM_88E1121_PHY_LED_CTRL, miim_read,
			    &mii_88E1121_set_led},
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
1204 1205 1206
			   /* Disable IRQs and de-assert interrupt */
			   {MIIM_88E1121_PHY_IRQ_EN, 0, NULL},
			   {MIIM_88E1121_PHY_IRQ_STATUS, miim_read, NULL},
1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Status is read once to clear old link state */
			   {MIIM_STATUS, miim_read, NULL},
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   {MIIM_STATUS, miim_read, &mii_parse_link},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
};

1221 1222 1223 1224 1225 1226 1227
static unsigned int m88e1145_setmode(uint mii_reg, struct tsec_private *priv)
{
	uint mii_data = read_phy_reg(priv, mii_reg);

	/* Setting MIIM_88E1145_PHY_EXT_CR */
	if (priv->flags & TSEC_REDUCED)
		return mii_data |
1228
		    MIIM_M88E1145_RGMII_RX_DELAY | MIIM_M88E1145_RGMII_TX_DELAY;
1229 1230 1231 1232 1233 1234 1235 1236
	else
		return mii_data;
}

static struct phy_info phy_info_M88E1145 = {
	0x01410cd,
	"Marvell 88E1145",
	4,
1237
	(struct phy_cmd[]){	/* config */
A
Andy Fleming 已提交
1238 1239 1240
			   /* Reset the PHY */
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},

1241 1242 1243 1244 1245 1246
			   /* Errata E0, E1 */
			   {29, 0x001b, NULL},
			   {30, 0x418f, NULL},
			   {29, 0x0016, NULL},
			   {30, 0xa2da, NULL},

A
Andy Fleming 已提交
1247
			   /* Configure the PHY */
1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271
			   {MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
			   {MIIM_ANAR, MIIM_ANAR_INIT, NULL},
			   {MIIM_88E1011_PHY_SCR, MIIM_88E1011_PHY_MDI_X_AUTO,
			    NULL},
			   {MIIM_88E1145_PHY_EXT_CR, 0, &m88e1145_setmode},
			   {MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, NULL},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Status is read once to clear old link state */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   {MIIM_88E1111_PHY_LED_CONTROL,
			    MIIM_88E1111_PHY_LED_DIRECT, NULL},
			   /* Read the Status */
			   {MIIM_88E1011_PHY_STATUS, miim_read,
			    &mii_parse_88E1011_psr},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1272 1273
};

1274 1275 1276 1277
struct phy_info phy_info_cis8204 = {
	0x3f11,
	"Cicada Cis8204",
	6,
1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302
	(struct phy_cmd[]){	/* config */
			   /* Override PHY config settings */
			   {MIIM_CIS8201_AUX_CONSTAT,
			    MIIM_CIS8201_AUXCONSTAT_INIT, NULL},
			   /* Configure some basic stuff */
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
			   {MIIM_CIS8204_SLED_CON, MIIM_CIS8204_SLEDCON_INIT,
			    &mii_cis8204_fixled},
			   {MIIM_CIS8204_EPHY_CON, MIIM_CIS8204_EPHYCON_INIT,
			    &mii_cis8204_setmode},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Read the Status (2x to make sure link is right) */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the status */
			   {MIIM_CIS8201_AUX_CONSTAT, miim_read,
			    &mii_parse_cis8201},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1303 1304 1305 1306 1307 1308 1309
};

/* Cicada 8201 */
struct phy_info phy_info_cis8201 = {
	0xfc41,
	"CIS8201",
	4,
1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333
	(struct phy_cmd[]){	/* config */
			   /* Override PHY config settings */
			   {MIIM_CIS8201_AUX_CONSTAT,
			    MIIM_CIS8201_AUXCONSTAT_INIT, NULL},
			   /* Set up the interface mode */
			   {MIIM_CIS8201_EXT_CON1, MIIM_CIS8201_EXTCON1_INIT,
			    NULL},
			   /* Configure some basic stuff */
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Read the Status (2x to make sure link is right) */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the status */
			   {MIIM_CIS8201_AUX_CONSTAT, miim_read,
			    &mii_parse_cis8201},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1334
};
1335
struct phy_info phy_info_VSC8244 = {
1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357
	0x3f1b,
	"Vitesse VSC8244",
	6,
	(struct phy_cmd[]){	/* config */
			   /* Override PHY config settings */
			   /* Configure some basic stuff */
			   {MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Read the Status (2x to make sure link is right) */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the status */
			   {MIIM_VSC8244_AUX_CONSTAT, miim_read,
			    &mii_parse_vsc8244},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1358
};
1359

1360 1361 1362 1363 1364 1365 1366 1367
struct phy_info phy_info_VSC8601 = {
		0x00007042,
		"Vitesse VSC8601",
		4,
		(struct phy_cmd[]){     /* config */
				/* Override PHY config settings */
				/* Configure some basic stuff */
				{MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
1368
#ifdef CONFIG_SYS_VSC8601_SKEWFIX
1369
				{MIIM_VSC8601_EPHY_CON,MIIM_VSC8601_EPHY_CON_INIT_SKEW,NULL},
1370
#if defined(CONFIG_SYS_VSC8601_SKEW_TX) && defined(CONFIG_SYS_VSC8601_SKEW_RX)
1371
				{MIIM_EXT_PAGE_ACCESS,1,NULL},
1372
#define VSC8101_SKEW	(CONFIG_SYS_VSC8601_SKEW_TX<<14)|(CONFIG_SYS_VSC8601_SKEW_RX<<12)
1373 1374 1375
				{MIIM_VSC8601_SKEW_CTRL,VSC8101_SKEW,NULL},
				{MIIM_EXT_PAGE_ACCESS,0,NULL},
#endif
1376
#endif
1377 1378
				{MIIM_ANAR, MIIM_ANAR_INIT, NULL},
				{MIIM_CONTROL, MIIM_CONTROL_RESTART, &mii_cr_init},
1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396
				{miim_end,}
				 },
		(struct phy_cmd[]){     /* startup */
				/* Read the Status (2x to make sure link is right) */
				{MIIM_STATUS, miim_read, NULL},
				/* Auto-negotiate */
				{MIIM_STATUS, miim_read, &mii_parse_sr},
				/* Read the status */
				{MIIM_VSC8244_AUX_CONSTAT, miim_read,
						&mii_parse_vsc8244},
				{miim_end,}
				},
		(struct phy_cmd[]){     /* shutdown */
				{miim_end,}
				},
};


1397 1398 1399 1400
struct phy_info phy_info_dm9161 = {
	0x0181b88,
	"Davicom DM9161E",
	4,
1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426
	(struct phy_cmd[]){	/* config */
			   {MIIM_CONTROL, MIIM_DM9161_CR_STOP, NULL},
			   /* Do not bypass the scrambler/descrambler */
			   {MIIM_DM9161_SCR, MIIM_DM9161_SCR_INIT, NULL},
			   /* Clear 10BTCSR to default */
			   {MIIM_DM9161_10BTCSR, MIIM_DM9161_10BTCSR_INIT,
			    NULL},
			   /* Configure some basic stuff */
			   {MIIM_CONTROL, MIIM_CR_INIT, NULL},
			   /* Restart Auto Negotiation */
			   {MIIM_CONTROL, MIIM_DM9161_CR_RSTAN, NULL},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Status is read once to clear old link state */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the status */
			   {MIIM_DM9161_SCSR, miim_read,
			    &mii_parse_dm9161_scsr},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1427
};
1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
/* a generic flavor.  */
struct phy_info phy_info_generic =  {
	0,
	"Unknown/Generic PHY",
	32,
	(struct phy_cmd[]) { /* config */
		{PHY_BMCR, PHY_BMCR_RESET, NULL},
		{PHY_BMCR, PHY_BMCR_AUTON|PHY_BMCR_RST_NEG, NULL},
		{miim_end,}
	},
	(struct phy_cmd[]) { /* startup */
		{PHY_BMSR, miim_read, NULL},
		{PHY_BMSR, miim_read, &mii_parse_sr},
		{PHY_BMSR, miim_read, &mii_parse_link},
		{miim_end,}
	},
	(struct phy_cmd[]) { /* shutdown */
		{miim_end,}
	}
};

1449

W
wdenk 已提交
1450 1451
uint mii_parse_lxt971_sr2(uint mii_reg, struct tsec_private *priv)
{
W
wdenk 已提交
1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467
	unsigned int speed;
	if (priv->link) {
		speed = mii_reg & MIIM_LXT971_SR2_SPEED_MASK;

		switch (speed) {
		case MIIM_LXT971_SR2_10HDX:
			priv->speed = 10;
			priv->duplexity = 0;
			break;
		case MIIM_LXT971_SR2_10FDX:
			priv->speed = 10;
			priv->duplexity = 1;
			break;
		case MIIM_LXT971_SR2_100HDX:
			priv->speed = 100;
			priv->duplexity = 0;
U
urwithsughosh@gmail.com 已提交
1468
			break;
W
wdenk 已提交
1469 1470 1471 1472 1473 1474 1475 1476 1477 1478
		default:
			priv->speed = 100;
			priv->duplexity = 1;
		}
	} else {
		priv->speed = 0;
		priv->duplexity = 0;
	}

	return 0;
W
wdenk 已提交
1479 1480
}

W
wdenk 已提交
1481 1482 1483 1484
static struct phy_info phy_info_lxt971 = {
	0x0001378e,
	"LXT971",
	4,
1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498
	(struct phy_cmd[]){	/* config */
			   {MIIM_CR, MIIM_CR_INIT, mii_cr_init},	/* autonegotiate */
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup - enable interrupts */
			   /* { 0x12, 0x00f2, NULL }, */
			   {MIIM_STATUS, miim_read, NULL},
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   {MIIM_LXT971_SR2, miim_read, &mii_parse_lxt971_sr2},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown - disable interrupts */
			   {miim_end,}
			   },
W
wdenk 已提交
1499 1500
};

1501
/* Parse the DP83865's link and auto-neg status register for speed and duplex
1502 1503
 * information
 */
1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533
uint mii_parse_dp83865_lanr(uint mii_reg, struct tsec_private *priv)
{
	switch (mii_reg & MIIM_DP83865_SPD_MASK) {

	case MIIM_DP83865_SPD_1000:
		priv->speed = 1000;
		break;

	case MIIM_DP83865_SPD_100:
		priv->speed = 100;
		break;

	default:
		priv->speed = 10;
		break;

	}

	if (mii_reg & MIIM_DP83865_DPX_FULL)
		priv->duplexity = 1;
	else
		priv->duplexity = 0;

	return 0;
}

struct phy_info phy_info_dp83865 = {
	0x20005c7,
	"NatSemi DP83865",
	4,
1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550
	(struct phy_cmd[]){	/* config */
			   {MIIM_CONTROL, MIIM_DP83865_CR_INIT, NULL},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* startup */
			   /* Status is read once to clear old link state */
			   {MIIM_STATUS, miim_read, NULL},
			   /* Auto-negotiate */
			   {MIIM_STATUS, miim_read, &mii_parse_sr},
			   /* Read the link and auto-neg status */
			   {MIIM_DP83865_LANR, miim_read,
			    &mii_parse_dp83865_lanr},
			   {miim_end,}
			   },
	(struct phy_cmd[]){	/* shutdown */
			   {miim_end,}
			   },
1551 1552
};

1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579
struct phy_info phy_info_rtl8211b = {
	0x001cc91,
	"RealTek RTL8211B",
	4,
	(struct phy_cmd[]){	/* config */
		/* Reset and configure the PHY */
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_GBIT_CONTROL, MIIM_GBIT_CONTROL_INIT, NULL},
		{MIIM_ANAR, MIIM_ANAR_INIT, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_RESET, NULL},
		{MIIM_CONTROL, MIIM_CONTROL_INIT, &mii_cr_init},
		{miim_end,}
	},
	(struct phy_cmd[]){	/* startup */
		/* Status is read once to clear old link state */
		{MIIM_STATUS, miim_read, NULL},
		/* Auto-negotiate */
		{MIIM_STATUS, miim_read, &mii_parse_sr},
		/* Read the status */
		{MIIM_RTL8211B_PHY_STATUS, miim_read, &mii_parse_RTL8211B_sr},
		{miim_end,}
	},
	(struct phy_cmd[]){	/* shutdown */
		{miim_end,}
	},
};

1580 1581
struct phy_info *phy_info[] = {
	&phy_info_cis8204,
1582
	&phy_info_cis8201,
1583
	&phy_info_BCM5461S,
J
Joe Hamman 已提交
1584
	&phy_info_BCM5464S,
1585
	&phy_info_M88E1011S,
W
wdenk 已提交
1586
	&phy_info_M88E1111S,
1587
	&phy_info_M88E1118,
1588
	&phy_info_M88E1121R,
1589
	&phy_info_M88E1145,
1590
	&phy_info_M88E1149S,
1591
	&phy_info_dm9161,
W
wdenk 已提交
1592
	&phy_info_lxt971,
1593
	&phy_info_VSC8244,
1594
	&phy_info_VSC8601,
1595
	&phy_info_dp83865,
1596
	&phy_info_rtl8211b,
1597
	&phy_info_generic,
1598 1599 1600 1601
	NULL
};

/* Grab the identifier of the device's PHY, and search through
W
wdenk 已提交
1602
 * all of the known PHYs to see if one matches.	 If so, return
1603 1604 1605
 * it, if not, return NULL
 */
struct phy_info *get_phy_info(struct eth_device *dev)
1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621
{
	struct tsec_private *priv = (struct tsec_private *)dev->priv;
	uint phy_reg, phy_ID;
	int i;
	struct phy_info *theInfo = NULL;

	/* Grab the bits from PHYIR1, and put them in the upper half */
	phy_reg = read_phy_reg(priv, MIIM_PHYIR1);
	phy_ID = (phy_reg & 0xffff) << 16;

	/* Grab the bits from PHYIR2, and put them in the lower half */
	phy_reg = read_phy_reg(priv, MIIM_PHYIR2);
	phy_ID |= (phy_reg & 0xffff);

	/* loop through all the known PHY types, and find one that */
	/* matches the ID we read from the PHY. */
1622
	for (i = 0; phy_info[i]; i++) {
1623
		if (phy_info[i]->id == (phy_ID >> phy_info[i]->shift)) {
1624
			theInfo = phy_info[i];
1625 1626
			break;
		}
1627 1628
	}

1629
	if (theInfo == NULL) {
1630 1631 1632
		printf("%s: PHY id %x is not supported!\n", dev->name, phy_ID);
		return NULL;
	} else {
1633
		debug("%s: PHY is %s (%x)\n", dev->name, theInfo->name, phy_ID);
1634 1635 1636
	}

	return theInfo;
W
wdenk 已提交
1637
}
W
wdenk 已提交
1638

1639
/* Execute the given series of commands on the given device's
1640 1641
 * PHY, running functions as necessary
 */
1642 1643 1644 1645 1646 1647 1648 1649 1650 1651
void phy_run_commands(struct tsec_private *priv, struct phy_cmd *cmd)
{
	int i;
	uint result;
	volatile tsec_t *phyregs = priv->phyregs;

	phyregs->miimcfg = MIIMCFG_RESET;

	phyregs->miimcfg = MIIMCFG_INIT_VALUE;

1652
	while (phyregs->miimind & MIIMIND_BUSY) ;
1653

1654 1655
	for (i = 0; cmd->mii_reg != miim_end; i++) {
		if (cmd->mii_data == miim_read) {
1656 1657
			result = read_phy_reg(priv, cmd->mii_reg);

1658 1659
			if (cmd->funct != NULL)
				(*(cmd->funct)) (result, priv);
1660 1661

		} else {
1662 1663
			if (cmd->funct != NULL)
				result = (*(cmd->funct)) (cmd->mii_reg, priv);
1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678
			else
				result = cmd->mii_data;

			write_phy_reg(priv, cmd->mii_reg, result);

		}
		cmd++;
	}
}

/* Relocate the function pointers in the phy cmd lists */
static void relocate_cmds(void)
{
	struct phy_cmd **cmdlistptr;
	struct phy_cmd *cmd;
1679
	int i, j, k;
1680

1681
	for (i = 0; phy_info[i]; i++) {
1682 1683
		/* First thing's first: relocate the pointers to the
		 * PHY command structures (the structs were done) */
1684 1685
		phy_info[i] = (struct phy_info *)((uint) phy_info[i]
						  + gd->reloc_off);
1686 1687
		phy_info[i]->name += gd->reloc_off;
		phy_info[i]->config =
1688 1689
		    (struct phy_cmd *)((uint) phy_info[i]->config
				       + gd->reloc_off);
1690
		phy_info[i]->startup =
1691 1692
		    (struct phy_cmd *)((uint) phy_info[i]->startup
				       + gd->reloc_off);
1693
		phy_info[i]->shutdown =
1694 1695
		    (struct phy_cmd *)((uint) phy_info[i]->shutdown
				       + gd->reloc_off);
1696 1697

		cmdlistptr = &phy_info[i]->config;
1698 1699 1700 1701 1702 1703
		j = 0;
		for (; cmdlistptr <= &phy_info[i]->shutdown; cmdlistptr++) {
			k = 0;
			for (cmd = *cmdlistptr;
			     cmd->mii_reg != miim_end;
			     cmd++) {
1704
				/* Only relocate non-NULL pointers */
1705
				if (cmd->funct)
1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716
					cmd->funct += gd->reloc_off;

				k++;
			}
			j++;
		}
	}

	relocated = 1;
}

1717
#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) \
M
Marian Balakowicz 已提交
1718
	&& !defined(BITBANGMII)
1719

W
wdenk 已提交
1720 1721 1722 1723
/*
 * Read a MII PHY register.
 *
 * Returns:
1724
 *  0 on success
W
wdenk 已提交
1725
 */
M
Marian Balakowicz 已提交
1726
static int tsec_miiphy_read(char *devname, unsigned char addr,
1727
			    unsigned char reg, unsigned short *value)
W
wdenk 已提交
1728
{
1729
	unsigned short ret;
1730
	struct tsec_private *priv = privlist[0];
1731

1732
	if (NULL == priv) {
1733 1734 1735
		printf("Can't read PHY at address %d\n", addr);
		return -1;
	}
W
wdenk 已提交
1736

A
Andy Fleming 已提交
1737
	ret = (unsigned short)tsec_local_mdio_read(priv->phyregs, addr, reg);
1738
	*value = ret;
W
wdenk 已提交
1739 1740 1741 1742 1743 1744 1745 1746

	return 0;
}

/*
 * Write a MII PHY register.
 *
 * Returns:
1747
 *  0 on success
W
wdenk 已提交
1748
 */
M
Marian Balakowicz 已提交
1749
static int tsec_miiphy_write(char *devname, unsigned char addr,
1750
			     unsigned char reg, unsigned short value)
W
wdenk 已提交
1751
{
1752
	struct tsec_private *priv = privlist[0];
1753

1754
	if (NULL == priv) {
1755 1756 1757
		printf("Can't write PHY at address %d\n", addr);
		return -1;
	}
W
wdenk 已提交
1758

A
Andy Fleming 已提交
1759
	tsec_local_mdio_write(priv->phyregs, addr, reg, value);
W
wdenk 已提交
1760 1761 1762

	return 0;
}
1763

1764
#endif
1765

D
David Updegraff 已提交
1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806
#ifdef CONFIG_MCAST_TFTP

/* CREDITS: linux gianfar driver, slightly adjusted... thanx. */

/* Set the appropriate hash bit for the given addr */

/* The algorithm works like so:
 * 1) Take the Destination Address (ie the multicast address), and
 * do a CRC on it (little endian), and reverse the bits of the
 * result.
 * 2) Use the 8 most significant bits as a hash into a 256-entry
 * table.  The table is controlled through 8 32-bit registers:
 * gaddr0-7.  gaddr0's MSB is entry 0, and gaddr7's LSB is
 * gaddr7.  This means that the 3 most significant bits in the
 * hash index which gaddr register to use, and the 5 other bits
 * indicate which bit (assuming an IBM numbering scheme, which
 * for PowerPC (tm) is usually the case) in the tregister holds
 * the entry. */
static int
tsec_mcast_addr (struct eth_device *dev, u8 mcast_mac, u8 set)
{
 struct tsec_private *priv = privlist[1];
 volatile tsec_t *regs = priv->regs;
 volatile u32  *reg_array, value;
 u8 result, whichbit, whichreg;

	result = (u8)((ether_crc(MAC_ADDR_LEN,mcast_mac) >> 24) & 0xff);
	whichbit = result & 0x1f;	/* the 5 LSB = which bit to set */
	whichreg = result >> 5;		/* the 3 MSB = which reg to set it in */
	value = (1 << (31-whichbit));

	reg_array = &(regs->hash.gaddr0);

	if (set) {
		reg_array[whichreg] |= value;
	} else {
		reg_array[whichreg] &= ~value;
	}
	return 0;
}
#endif /* Multicast TFTP ? */