xref: /openbmc/u-boot/drivers/qe/uec_phy.c (revision 0cf4fd3c)
1 /*
2  * Copyright (C) 2005 Freescale Semiconductor, Inc.
3  *
4  * Author: Shlomi Gridish
5  *
6  * Description: UCC GETH Driver -- PHY handling
7  *		Driver for UEC on QE
8  *		Based on 8260_io/fcc_enet.c
9  *
10  * This program is free software; you can redistribute	it and/or modify it
11  * under  the terms of	the GNU General	 Public License as published by the
12  * Free Software Foundation;  either version 2 of the  License, or (at your
13  * option) any later version.
14  *
15  */
16 
17 #include "common.h"
18 #include "net.h"
19 #include "malloc.h"
20 #include "asm/errno.h"
21 #include "asm/immap_qe.h"
22 #include "asm/io.h"
23 #include "qe.h"
24 #include "uccf.h"
25 #include "uec.h"
26 #include "uec_phy.h"
27 #include "miiphy.h"
28 
29 #define ugphy_printk(format, arg...)  \
30 	printf(format "\n", ## arg)
31 
32 #define ugphy_dbg(format, arg...)	     \
33 	ugphy_printk(format , ## arg)
34 #define ugphy_err(format, arg...)	     \
35 	ugphy_printk(format , ## arg)
36 #define ugphy_info(format, arg...)	     \
37 	ugphy_printk(format , ## arg)
38 #define ugphy_warn(format, arg...)	     \
39 	ugphy_printk(format , ## arg)
40 
41 #ifdef UEC_VERBOSE_DEBUG
42 #define ugphy_vdbg ugphy_dbg
43 #else
44 #define ugphy_vdbg(ugeth, fmt, args...) do { } while (0)
45 #endif /* UEC_VERBOSE_DEBUG */
46 
47 static void config_genmii_advert (struct uec_mii_info *mii_info);
48 static void genmii_setup_forced (struct uec_mii_info *mii_info);
49 static void genmii_restart_aneg (struct uec_mii_info *mii_info);
50 static int gbit_config_aneg (struct uec_mii_info *mii_info);
51 static int genmii_config_aneg (struct uec_mii_info *mii_info);
52 static int genmii_update_link (struct uec_mii_info *mii_info);
53 static int genmii_read_status (struct uec_mii_info *mii_info);
54 u16 phy_read (struct uec_mii_info *mii_info, u16 regnum);
55 void phy_write (struct uec_mii_info *mii_info, u16 regnum, u16 val);
56 
57 /* Write value to the PHY for this device to the register at regnum, */
58 /* waiting until the write is done before it returns.  All PHY */
59 /* configuration has to be done through the TSEC1 MIIM regs */
60 void uec_write_phy_reg (struct eth_device *dev, int mii_id, int regnum, int value)
61 {
62 	uec_private_t *ugeth = (uec_private_t *) dev->priv;
63 	uec_mii_t *ug_regs;
64 	enet_tbi_mii_reg_e mii_reg = (enet_tbi_mii_reg_e) regnum;
65 	u32 tmp_reg;
66 
67 	ug_regs = ugeth->uec_mii_regs;
68 
69 	/* Stop the MII management read cycle */
70 	out_be32 (&ug_regs->miimcom, 0);
71 	/* Setting up the MII Mangement Address Register */
72 	tmp_reg = ((u32) mii_id << MIIMADD_PHY_ADDRESS_SHIFT) | mii_reg;
73 	out_be32 (&ug_regs->miimadd, tmp_reg);
74 
75 	/* Setting up the MII Mangement Control Register with the value */
76 	out_be32 (&ug_regs->miimcon, (u32) value);
77 	sync();
78 
79 	/* Wait till MII management write is complete */
80 	while ((in_be32 (&ug_regs->miimind)) & MIIMIND_BUSY);
81 }
82 
83 /* Reads from register regnum in the PHY for device dev, */
84 /* returning the value.  Clears miimcom first.  All PHY */
85 /* configuration has to be done through the TSEC1 MIIM regs */
86 int uec_read_phy_reg (struct eth_device *dev, int mii_id, int regnum)
87 {
88 	uec_private_t *ugeth = (uec_private_t *) dev->priv;
89 	uec_mii_t *ug_regs;
90 	enet_tbi_mii_reg_e mii_reg = (enet_tbi_mii_reg_e) regnum;
91 	u32 tmp_reg;
92 	u16 value;
93 
94 	ug_regs = ugeth->uec_mii_regs;
95 
96 	/* Setting up the MII Mangement Address Register */
97 	tmp_reg = ((u32) mii_id << MIIMADD_PHY_ADDRESS_SHIFT) | mii_reg;
98 	out_be32 (&ug_regs->miimadd, tmp_reg);
99 
100 	/* clear MII management command cycle */
101 	out_be32 (&ug_regs->miimcom, 0);
102 	sync();
103 
104 	/* Perform an MII management read cycle */
105 	out_be32 (&ug_regs->miimcom, MIIMCOM_READ_CYCLE);
106 
107 	/* Wait till MII management write is complete */
108 	while ((in_be32 (&ug_regs->miimind)) &
109 	       (MIIMIND_NOT_VALID | MIIMIND_BUSY));
110 
111 	/* Read MII management status  */
112 	value = (u16) in_be32 (&ug_regs->miimstat);
113 	if (value == 0xffff)
114 		ugphy_vdbg
115 			("read wrong value : mii_id %d,mii_reg %d, base %08x",
116 			 mii_id, mii_reg, (u32) & (ug_regs->miimcfg));
117 
118 	return (value);
119 }
120 
121 void mii_clear_phy_interrupt (struct uec_mii_info *mii_info)
122 {
123 	if (mii_info->phyinfo->ack_interrupt)
124 		mii_info->phyinfo->ack_interrupt (mii_info);
125 }
126 
127 void mii_configure_phy_interrupt (struct uec_mii_info *mii_info,
128 				  u32 interrupts)
129 {
130 	mii_info->interrupts = interrupts;
131 	if (mii_info->phyinfo->config_intr)
132 		mii_info->phyinfo->config_intr (mii_info);
133 }
134 
135 /* Writes MII_ADVERTISE with the appropriate values, after
136  * sanitizing advertise to make sure only supported features
137  * are advertised
138  */
139 static void config_genmii_advert (struct uec_mii_info *mii_info)
140 {
141 	u32 advertise;
142 	u16 adv;
143 
144 	/* Only allow advertising what this PHY supports */
145 	mii_info->advertising &= mii_info->phyinfo->features;
146 	advertise = mii_info->advertising;
147 
148 	/* Setup standard advertisement */
149 	adv = phy_read (mii_info, PHY_ANAR);
150 	adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4);
151 	if (advertise & ADVERTISED_10baseT_Half)
152 		adv |= ADVERTISE_10HALF;
153 	if (advertise & ADVERTISED_10baseT_Full)
154 		adv |= ADVERTISE_10FULL;
155 	if (advertise & ADVERTISED_100baseT_Half)
156 		adv |= ADVERTISE_100HALF;
157 	if (advertise & ADVERTISED_100baseT_Full)
158 		adv |= ADVERTISE_100FULL;
159 	phy_write (mii_info, PHY_ANAR, adv);
160 }
161 
162 static void genmii_setup_forced (struct uec_mii_info *mii_info)
163 {
164 	u16 ctrl;
165 	u32 features = mii_info->phyinfo->features;
166 
167 	ctrl = phy_read (mii_info, PHY_BMCR);
168 
169 	ctrl &= ~(PHY_BMCR_DPLX | PHY_BMCR_100_MBPS |
170 		  PHY_BMCR_1000_MBPS | PHY_BMCR_AUTON);
171 	ctrl |= PHY_BMCR_RESET;
172 
173 	switch (mii_info->speed) {
174 	case SPEED_1000:
175 		if (features & (SUPPORTED_1000baseT_Half
176 				| SUPPORTED_1000baseT_Full)) {
177 			ctrl |= PHY_BMCR_1000_MBPS;
178 			break;
179 		}
180 		mii_info->speed = SPEED_100;
181 	case SPEED_100:
182 		if (features & (SUPPORTED_100baseT_Half
183 				| SUPPORTED_100baseT_Full)) {
184 			ctrl |= PHY_BMCR_100_MBPS;
185 			break;
186 		}
187 		mii_info->speed = SPEED_10;
188 	case SPEED_10:
189 		if (features & (SUPPORTED_10baseT_Half
190 				| SUPPORTED_10baseT_Full))
191 			break;
192 	default:		/* Unsupported speed! */
193 		ugphy_err ("%s: Bad speed!", mii_info->dev->name);
194 		break;
195 	}
196 
197 	phy_write (mii_info, PHY_BMCR, ctrl);
198 }
199 
200 /* Enable and Restart Autonegotiation */
201 static void genmii_restart_aneg (struct uec_mii_info *mii_info)
202 {
203 	u16 ctl;
204 
205 	ctl = phy_read (mii_info, PHY_BMCR);
206 	ctl |= (PHY_BMCR_AUTON | PHY_BMCR_RST_NEG);
207 	phy_write (mii_info, PHY_BMCR, ctl);
208 }
209 
210 static int gbit_config_aneg (struct uec_mii_info *mii_info)
211 {
212 	u16 adv;
213 	u32 advertise;
214 
215 	if (mii_info->autoneg) {
216 		/* Configure the ADVERTISE register */
217 		config_genmii_advert (mii_info);
218 		advertise = mii_info->advertising;
219 
220 		adv = phy_read (mii_info, MII_1000BASETCONTROL);
221 		adv &= ~(MII_1000BASETCONTROL_FULLDUPLEXCAP |
222 			 MII_1000BASETCONTROL_HALFDUPLEXCAP);
223 		if (advertise & SUPPORTED_1000baseT_Half)
224 			adv |= MII_1000BASETCONTROL_HALFDUPLEXCAP;
225 		if (advertise & SUPPORTED_1000baseT_Full)
226 			adv |= MII_1000BASETCONTROL_FULLDUPLEXCAP;
227 		phy_write (mii_info, MII_1000BASETCONTROL, adv);
228 
229 		/* Start/Restart aneg */
230 		genmii_restart_aneg (mii_info);
231 	} else
232 		genmii_setup_forced (mii_info);
233 
234 	return 0;
235 }
236 
237 static int marvell_config_aneg (struct uec_mii_info *mii_info)
238 {
239 	/* The Marvell PHY has an errata which requires
240 	 * that certain registers get written in order
241 	 * to restart autonegotiation */
242 	phy_write (mii_info, PHY_BMCR, PHY_BMCR_RESET);
243 
244 	phy_write (mii_info, 0x1d, 0x1f);
245 	phy_write (mii_info, 0x1e, 0x200c);
246 	phy_write (mii_info, 0x1d, 0x5);
247 	phy_write (mii_info, 0x1e, 0);
248 	phy_write (mii_info, 0x1e, 0x100);
249 
250 	gbit_config_aneg (mii_info);
251 
252 	return 0;
253 }
254 
255 static int genmii_config_aneg (struct uec_mii_info *mii_info)
256 {
257 	if (mii_info->autoneg) {
258 		config_genmii_advert (mii_info);
259 		genmii_restart_aneg (mii_info);
260 	} else
261 		genmii_setup_forced (mii_info);
262 
263 	return 0;
264 }
265 
266 static int genmii_update_link (struct uec_mii_info *mii_info)
267 {
268 	u16 status;
269 
270 	/* Status is read once to clear old link state */
271 	phy_read (mii_info, PHY_BMSR);
272 
273 	/*
274 	 * Wait if the link is up, and autonegotiation is in progress
275 	 * (ie - we're capable and it's not done)
276 	 */
277 	status = phy_read(mii_info, PHY_BMSR);
278 	if ((status & PHY_BMSR_LS) && (status & PHY_BMSR_AUTN_ABLE)
279 	    && !(status & PHY_BMSR_AUTN_COMP)) {
280 		int i = 0;
281 
282 		while (!(status & PHY_BMSR_AUTN_COMP)) {
283 			/*
284 			 * Timeout reached ?
285 			 */
286 			if (i > UGETH_AN_TIMEOUT) {
287 				mii_info->link = 0;
288 				return 0;
289 			}
290 
291 			i++;
292 			udelay(1000);	/* 1 ms */
293 			status = phy_read(mii_info, PHY_BMSR);
294 		}
295 		mii_info->link = 1;
296 		udelay(500000);	/* another 500 ms (results in faster booting) */
297 	} else {
298 		if (status & PHY_BMSR_LS)
299 			mii_info->link = 1;
300 		else
301 			mii_info->link = 0;
302 	}
303 
304 	return 0;
305 }
306 
307 static int genmii_read_status (struct uec_mii_info *mii_info)
308 {
309 	u16 status;
310 	int err;
311 
312 	/* Update the link, but return if there
313 	 * was an error */
314 	err = genmii_update_link (mii_info);
315 	if (err)
316 		return err;
317 
318 	if (mii_info->autoneg) {
319 		status = phy_read(mii_info, MII_1000BASETSTATUS);
320 
321 		if (status & (LPA_1000FULL | LPA_1000HALF)) {
322 			mii_info->speed = SPEED_1000;
323 			if (status & LPA_1000FULL)
324 				mii_info->duplex = DUPLEX_FULL;
325 			else
326 				mii_info->duplex = DUPLEX_HALF;
327 		} else {
328 			status = phy_read(mii_info, PHY_ANLPAR);
329 
330 			if (status & (PHY_ANLPAR_10FD | PHY_ANLPAR_TXFD))
331 				mii_info->duplex = DUPLEX_FULL;
332 			else
333 				mii_info->duplex = DUPLEX_HALF;
334 			if (status & (PHY_ANLPAR_TXFD | PHY_ANLPAR_TX))
335 				mii_info->speed = SPEED_100;
336 			else
337 				mii_info->speed = SPEED_10;
338 		}
339 		mii_info->pause = 0;
340 	}
341 	/* On non-aneg, we assume what we put in BMCR is the speed,
342 	 * though magic-aneg shouldn't prevent this case from occurring
343 	 */
344 
345 	return 0;
346 }
347 
348 static int bcm_init(struct uec_mii_info *mii_info)
349 {
350 	struct eth_device *edev = mii_info->dev;
351 	uec_private_t *uec = edev->priv;
352 
353 	gbit_config_aneg(mii_info);
354 
355 	if (uec->uec_info->enet_interface == ENET_1000_RGMII_RXID) {
356 		u16 val;
357 		int cnt = 50;
358 
359 		/* Wait for aneg to complete. */
360 		do
361 			val = phy_read(mii_info, PHY_BMSR);
362 		while (--cnt && !(val & PHY_BMSR_AUTN_COMP));
363 
364 		/* Set RDX clk delay. */
365 		phy_write(mii_info, 0x18, 0x7 | (7 << 12));
366 
367 		val = phy_read(mii_info, 0x18);
368 		/* Set RDX-RXC skew. */
369 		val |= (1 << 8);
370 		val |= (7 | (7 << 12));
371 		/* Write bits 14:0. */
372 		val |= (1 << 15);
373 		phy_write(mii_info, 0x18, val);
374 	}
375 
376 	 return 0;
377 }
378 
379 static int marvell_read_status (struct uec_mii_info *mii_info)
380 {
381 	u16 status;
382 	int err;
383 
384 	/* Update the link, but return if there
385 	 * was an error */
386 	err = genmii_update_link (mii_info);
387 	if (err)
388 		return err;
389 
390 	/* If the link is up, read the speed and duplex */
391 	/* If we aren't autonegotiating, assume speeds
392 	 * are as set */
393 	if (mii_info->autoneg && mii_info->link) {
394 		int speed;
395 
396 		status = phy_read (mii_info, MII_M1011_PHY_SPEC_STATUS);
397 
398 		/* Get the duplexity */
399 		if (status & MII_M1011_PHY_SPEC_STATUS_FULLDUPLEX)
400 			mii_info->duplex = DUPLEX_FULL;
401 		else
402 			mii_info->duplex = DUPLEX_HALF;
403 
404 		/* Get the speed */
405 		speed = status & MII_M1011_PHY_SPEC_STATUS_SPD_MASK;
406 		switch (speed) {
407 		case MII_M1011_PHY_SPEC_STATUS_1000:
408 			mii_info->speed = SPEED_1000;
409 			break;
410 		case MII_M1011_PHY_SPEC_STATUS_100:
411 			mii_info->speed = SPEED_100;
412 			break;
413 		default:
414 			mii_info->speed = SPEED_10;
415 			break;
416 		}
417 		mii_info->pause = 0;
418 	}
419 
420 	return 0;
421 }
422 
423 static int marvell_ack_interrupt (struct uec_mii_info *mii_info)
424 {
425 	/* Clear the interrupts by reading the reg */
426 	phy_read (mii_info, MII_M1011_IEVENT);
427 
428 	return 0;
429 }
430 
431 static int marvell_config_intr (struct uec_mii_info *mii_info)
432 {
433 	if (mii_info->interrupts == MII_INTERRUPT_ENABLED)
434 		phy_write (mii_info, MII_M1011_IMASK, MII_M1011_IMASK_INIT);
435 	else
436 		phy_write (mii_info, MII_M1011_IMASK, MII_M1011_IMASK_CLEAR);
437 
438 	return 0;
439 }
440 
441 static int dm9161_init (struct uec_mii_info *mii_info)
442 {
443 	/* Reset the PHY */
444 	phy_write (mii_info, PHY_BMCR, phy_read (mii_info, PHY_BMCR) |
445 		   PHY_BMCR_RESET);
446 	/* PHY and MAC connect */
447 	phy_write (mii_info, PHY_BMCR, phy_read (mii_info, PHY_BMCR) &
448 		   ~PHY_BMCR_ISO);
449 
450 	phy_write (mii_info, MII_DM9161_SCR, MII_DM9161_SCR_INIT);
451 
452 	config_genmii_advert (mii_info);
453 	/* Start/restart aneg */
454 	genmii_config_aneg (mii_info);
455 
456 	return 0;
457 }
458 
459 static int dm9161_config_aneg (struct uec_mii_info *mii_info)
460 {
461 	return 0;
462 }
463 
464 static int dm9161_read_status (struct uec_mii_info *mii_info)
465 {
466 	u16 status;
467 	int err;
468 
469 	/* Update the link, but return if there was an error */
470 	err = genmii_update_link (mii_info);
471 	if (err)
472 		return err;
473 	/* If the link is up, read the speed and duplex
474 	   If we aren't autonegotiating assume speeds are as set */
475 	if (mii_info->autoneg && mii_info->link) {
476 		status = phy_read (mii_info, MII_DM9161_SCSR);
477 		if (status & (MII_DM9161_SCSR_100F | MII_DM9161_SCSR_100H))
478 			mii_info->speed = SPEED_100;
479 		else
480 			mii_info->speed = SPEED_10;
481 
482 		if (status & (MII_DM9161_SCSR_100F | MII_DM9161_SCSR_10F))
483 			mii_info->duplex = DUPLEX_FULL;
484 		else
485 			mii_info->duplex = DUPLEX_HALF;
486 	}
487 
488 	return 0;
489 }
490 
491 static int dm9161_ack_interrupt (struct uec_mii_info *mii_info)
492 {
493 	/* Clear the interrupt by reading the reg */
494 	phy_read (mii_info, MII_DM9161_INTR);
495 
496 	return 0;
497 }
498 
499 static int dm9161_config_intr (struct uec_mii_info *mii_info)
500 {
501 	if (mii_info->interrupts == MII_INTERRUPT_ENABLED)
502 		phy_write (mii_info, MII_DM9161_INTR, MII_DM9161_INTR_INIT);
503 	else
504 		phy_write (mii_info, MII_DM9161_INTR, MII_DM9161_INTR_STOP);
505 
506 	return 0;
507 }
508 
509 static void dm9161_close (struct uec_mii_info *mii_info)
510 {
511 }
512 
513 static struct phy_info phy_info_dm9161 = {
514 	.phy_id = 0x0181b880,
515 	.phy_id_mask = 0x0ffffff0,
516 	.name = "Davicom DM9161E",
517 	.init = dm9161_init,
518 	.config_aneg = dm9161_config_aneg,
519 	.read_status = dm9161_read_status,
520 	.close = dm9161_close,
521 };
522 
523 static struct phy_info phy_info_dm9161a = {
524 	.phy_id = 0x0181b8a0,
525 	.phy_id_mask = 0x0ffffff0,
526 	.name = "Davicom DM9161A",
527 	.features = MII_BASIC_FEATURES,
528 	.init = dm9161_init,
529 	.config_aneg = dm9161_config_aneg,
530 	.read_status = dm9161_read_status,
531 	.ack_interrupt = dm9161_ack_interrupt,
532 	.config_intr = dm9161_config_intr,
533 	.close = dm9161_close,
534 };
535 
536 static struct phy_info phy_info_marvell = {
537 	.phy_id = 0x01410c00,
538 	.phy_id_mask = 0xffffff00,
539 	.name = "Marvell 88E11x1",
540 	.features = MII_GBIT_FEATURES,
541 	.config_aneg = &marvell_config_aneg,
542 	.read_status = &marvell_read_status,
543 	.ack_interrupt = &marvell_ack_interrupt,
544 	.config_intr = &marvell_config_intr,
545 };
546 
547 static struct phy_info phy_info_bcm5481 = {
548 	.phy_id = 0x0143bca0,
549 	.phy_id_mask = 0xffffff0,
550 	.name = "Broadcom 5481",
551 	.features = MII_GBIT_FEATURES,
552 	.read_status = genmii_read_status,
553 	.init = bcm_init,
554 };
555 
556 static struct phy_info phy_info_genmii = {
557 	.phy_id = 0x00000000,
558 	.phy_id_mask = 0x00000000,
559 	.name = "Generic MII",
560 	.features = MII_BASIC_FEATURES,
561 	.config_aneg = genmii_config_aneg,
562 	.read_status = genmii_read_status,
563 };
564 
565 static struct phy_info *phy_info[] = {
566 	&phy_info_dm9161,
567 	&phy_info_dm9161a,
568 	&phy_info_marvell,
569 	&phy_info_bcm5481,
570 	&phy_info_genmii,
571 	NULL
572 };
573 
574 u16 phy_read (struct uec_mii_info *mii_info, u16 regnum)
575 {
576 	return mii_info->mdio_read (mii_info->dev, mii_info->mii_id, regnum);
577 }
578 
579 void phy_write (struct uec_mii_info *mii_info, u16 regnum, u16 val)
580 {
581 	mii_info->mdio_write (mii_info->dev, mii_info->mii_id, regnum, val);
582 }
583 
584 /* Use the PHY ID registers to determine what type of PHY is attached
585  * to device dev.  return a struct phy_info structure describing that PHY
586  */
587 struct phy_info *uec_get_phy_info (struct uec_mii_info *mii_info)
588 {
589 	u16 phy_reg;
590 	u32 phy_ID;
591 	int i;
592 	struct phy_info *theInfo = NULL;
593 
594 	/* Grab the bits from PHYIR1, and put them in the upper half */
595 	phy_reg = phy_read (mii_info, PHY_PHYIDR1);
596 	phy_ID = (phy_reg & 0xffff) << 16;
597 
598 	/* Grab the bits from PHYIR2, and put them in the lower half */
599 	phy_reg = phy_read (mii_info, PHY_PHYIDR2);
600 	phy_ID |= (phy_reg & 0xffff);
601 
602 	/* loop through all the known PHY types, and find one that */
603 	/* matches the ID we read from the PHY. */
604 	for (i = 0; phy_info[i]; i++)
605 		if (phy_info[i]->phy_id ==
606 		    (phy_ID & phy_info[i]->phy_id_mask)) {
607 			theInfo = phy_info[i];
608 			break;
609 		}
610 
611 	/* This shouldn't happen, as we have generic PHY support */
612 	if (theInfo == NULL) {
613 		ugphy_info ("UEC: PHY id %x is not supported!", phy_ID);
614 		return NULL;
615 	} else {
616 		ugphy_info ("UEC: PHY is %s (%x)", theInfo->name, phy_ID);
617 	}
618 
619 	return theInfo;
620 }
621 
622 void marvell_phy_interface_mode (struct eth_device *dev,
623 				 enet_interface_e mode)
624 {
625 	uec_private_t *uec = (uec_private_t *) dev->priv;
626 	struct uec_mii_info *mii_info;
627 	u16 status;
628 
629 	if (!uec->mii_info) {
630 		printf ("%s: the PHY not initialized\n", __FUNCTION__);
631 		return;
632 	}
633 	mii_info = uec->mii_info;
634 
635 	if (mode == ENET_100_RGMII) {
636 		phy_write (mii_info, 0x00, 0x9140);
637 		phy_write (mii_info, 0x1d, 0x001f);
638 		phy_write (mii_info, 0x1e, 0x200c);
639 		phy_write (mii_info, 0x1d, 0x0005);
640 		phy_write (mii_info, 0x1e, 0x0000);
641 		phy_write (mii_info, 0x1e, 0x0100);
642 		phy_write (mii_info, 0x09, 0x0e00);
643 		phy_write (mii_info, 0x04, 0x01e1);
644 		phy_write (mii_info, 0x00, 0x9140);
645 		phy_write (mii_info, 0x00, 0x1000);
646 		udelay (100000);
647 		phy_write (mii_info, 0x00, 0x2900);
648 		phy_write (mii_info, 0x14, 0x0cd2);
649 		phy_write (mii_info, 0x00, 0xa100);
650 		phy_write (mii_info, 0x09, 0x0000);
651 		phy_write (mii_info, 0x1b, 0x800b);
652 		phy_write (mii_info, 0x04, 0x05e1);
653 		phy_write (mii_info, 0x00, 0xa100);
654 		phy_write (mii_info, 0x00, 0x2100);
655 		udelay (1000000);
656 	} else if (mode == ENET_10_RGMII) {
657 		phy_write (mii_info, 0x14, 0x8e40);
658 		phy_write (mii_info, 0x1b, 0x800b);
659 		phy_write (mii_info, 0x14, 0x0c82);
660 		phy_write (mii_info, 0x00, 0x8100);
661 		udelay (1000000);
662 	}
663 
664 	/* handle 88e1111 rev.B2 erratum 5.6 */
665 	if (mii_info->autoneg) {
666 		status = phy_read (mii_info, PHY_BMCR);
667 		phy_write (mii_info, PHY_BMCR, status | PHY_BMCR_AUTON);
668 	}
669 	/* now the B2 will correctly report autoneg completion status */
670 }
671 
672 void change_phy_interface_mode (struct eth_device *dev, enet_interface_e mode)
673 {
674 #ifdef CONFIG_PHY_MODE_NEED_CHANGE
675 	marvell_phy_interface_mode (dev, mode);
676 #endif
677 }
678