xref: /openbmc/u-boot/drivers/net/phy/marvell.c (revision 3c03f492)
1 /*
2  * Marvell PHY drivers
3  *
4  * SPDX-License-Identifier:	GPL-2.0+
5  *
6  * Copyright 2010-2011 Freescale Semiconductor, Inc.
7  * author Andy Fleming
8  */
9 #include <config.h>
10 #include <common.h>
11 #include <errno.h>
12 #include <phy.h>
13 
14 #define PHY_AUTONEGOTIATE_TIMEOUT 5000
15 
16 /* 88E1011 PHY Status Register */
17 #define MIIM_88E1xxx_PHY_STATUS		0x11
18 #define MIIM_88E1xxx_PHYSTAT_SPEED	0xc000
19 #define MIIM_88E1xxx_PHYSTAT_GBIT	0x8000
20 #define MIIM_88E1xxx_PHYSTAT_100	0x4000
21 #define MIIM_88E1xxx_PHYSTAT_DUPLEX	0x2000
22 #define MIIM_88E1xxx_PHYSTAT_SPDDONE	0x0800
23 #define MIIM_88E1xxx_PHYSTAT_LINK	0x0400
24 
25 #define MIIM_88E1xxx_PHY_SCR		0x10
26 #define MIIM_88E1xxx_PHY_MDI_X_AUTO	0x0060
27 
28 /* 88E1111 PHY LED Control Register */
29 #define MIIM_88E1111_PHY_LED_CONTROL	24
30 #define MIIM_88E1111_PHY_LED_DIRECT	0x4100
31 #define MIIM_88E1111_PHY_LED_COMBINE	0x411C
32 
33 /* 88E1111 Extended PHY Specific Control Register */
34 #define MIIM_88E1111_PHY_EXT_CR		0x14
35 #define MIIM_88E1111_RX_DELAY		0x80
36 #define MIIM_88E1111_TX_DELAY		0x2
37 
38 /* 88E1111 Extended PHY Specific Status Register */
39 #define MIIM_88E1111_PHY_EXT_SR		0x1b
40 #define MIIM_88E1111_HWCFG_MODE_MASK		0xf
41 #define MIIM_88E1111_HWCFG_MODE_COPPER_RGMII	0xb
42 #define MIIM_88E1111_HWCFG_MODE_FIBER_RGMII	0x3
43 #define MIIM_88E1111_HWCFG_MODE_SGMII_NO_CLK	0x4
44 #define MIIM_88E1111_HWCFG_MODE_COPPER_RTBI	0x9
45 #define MIIM_88E1111_HWCFG_FIBER_COPPER_AUTO	0x8000
46 #define MIIM_88E1111_HWCFG_FIBER_COPPER_RES	0x2000
47 
48 #define MIIM_88E1111_COPPER		0
49 #define MIIM_88E1111_FIBER		1
50 
51 /* 88E1118 PHY defines */
52 #define MIIM_88E1118_PHY_PAGE		22
53 #define MIIM_88E1118_PHY_LED_PAGE	3
54 
55 /* 88E1121 PHY LED Control Register */
56 #define MIIM_88E1121_PHY_LED_CTRL	16
57 #define MIIM_88E1121_PHY_LED_PAGE	3
58 #define MIIM_88E1121_PHY_LED_DEF	0x0030
59 
60 /* 88E1121 PHY IRQ Enable/Status Register */
61 #define MIIM_88E1121_PHY_IRQ_EN		18
62 #define MIIM_88E1121_PHY_IRQ_STATUS	19
63 
64 #define MIIM_88E1121_PHY_PAGE		22
65 
66 /* 88E1145 Extended PHY Specific Control Register */
67 #define MIIM_88E1145_PHY_EXT_CR 20
68 #define MIIM_M88E1145_RGMII_RX_DELAY	0x0080
69 #define MIIM_M88E1145_RGMII_TX_DELAY	0x0002
70 
71 #define MIIM_88E1145_PHY_LED_CONTROL	24
72 #define MIIM_88E1145_PHY_LED_DIRECT	0x4100
73 
74 #define MIIM_88E1145_PHY_PAGE	29
75 #define MIIM_88E1145_PHY_CAL_OV 30
76 
77 #define MIIM_88E1149_PHY_PAGE	29
78 
79 /* 88E1310 PHY defines */
80 #define MIIM_88E1310_PHY_LED_CTRL	16
81 #define MIIM_88E1310_PHY_IRQ_EN		18
82 #define MIIM_88E1310_PHY_RGMII_CTRL	21
83 #define MIIM_88E1310_PHY_PAGE		22
84 
85 /* 88E151x PHY defines */
86 /* Page 3 registers */
87 #define MIIM_88E151x_LED_FUNC_CTRL	16
88 #define MIIM_88E151x_LED_FLD_SZ		4
89 #define MIIM_88E151x_LED0_OFFS		(0 * MIIM_88E151x_LED_FLD_SZ)
90 #define MIIM_88E151x_LED1_OFFS		(1 * MIIM_88E151x_LED_FLD_SZ)
91 #define MIIM_88E151x_LED0_ACT		3
92 #define MIIM_88E151x_LED1_100_1000_LINK	6
93 #define MIIM_88E151x_LED_TIMER_CTRL	18
94 #define MIIM_88E151x_INT_EN_OFFS	7
95 /* Page 18 registers */
96 #define MIIM_88E151x_GENERAL_CTRL	20
97 #define MIIM_88E151x_MODE_SGMII		1
98 #define MIIM_88E151x_RESET_OFFS		15
99 
100 /* Marvell 88E1011S */
101 static int m88e1011s_config(struct phy_device *phydev)
102 {
103 	/* Reset and configure the PHY */
104 	phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, BMCR_RESET);
105 
106 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1d, 0x1f);
107 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1e, 0x200c);
108 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1d, 0x5);
109 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1e, 0);
110 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1e, 0x100);
111 
112 	phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, BMCR_RESET);
113 
114 	genphy_config_aneg(phydev);
115 
116 	return 0;
117 }
118 
119 /* Parse the 88E1011's status register for speed and duplex
120  * information
121  */
122 static int m88e1xxx_parse_status(struct phy_device *phydev)
123 {
124 	unsigned int speed;
125 	unsigned int mii_reg;
126 
127 	mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1xxx_PHY_STATUS);
128 
129 	if ((mii_reg & MIIM_88E1xxx_PHYSTAT_LINK) &&
130 		!(mii_reg & MIIM_88E1xxx_PHYSTAT_SPDDONE)) {
131 		int i = 0;
132 
133 		puts("Waiting for PHY realtime link");
134 		while (!(mii_reg & MIIM_88E1xxx_PHYSTAT_SPDDONE)) {
135 			/* Timeout reached ? */
136 			if (i > PHY_AUTONEGOTIATE_TIMEOUT) {
137 				puts(" TIMEOUT !\n");
138 				phydev->link = 0;
139 				return -ETIMEDOUT;
140 			}
141 
142 			if ((i++ % 1000) == 0)
143 				putc('.');
144 			udelay(1000);
145 			mii_reg = phy_read(phydev, MDIO_DEVAD_NONE,
146 					MIIM_88E1xxx_PHY_STATUS);
147 		}
148 		puts(" done\n");
149 		udelay(500000);	/* another 500 ms (results in faster booting) */
150 	} else {
151 		if (mii_reg & MIIM_88E1xxx_PHYSTAT_LINK)
152 			phydev->link = 1;
153 		else
154 			phydev->link = 0;
155 	}
156 
157 	if (mii_reg & MIIM_88E1xxx_PHYSTAT_DUPLEX)
158 		phydev->duplex = DUPLEX_FULL;
159 	else
160 		phydev->duplex = DUPLEX_HALF;
161 
162 	speed = mii_reg & MIIM_88E1xxx_PHYSTAT_SPEED;
163 
164 	switch (speed) {
165 	case MIIM_88E1xxx_PHYSTAT_GBIT:
166 		phydev->speed = SPEED_1000;
167 		break;
168 	case MIIM_88E1xxx_PHYSTAT_100:
169 		phydev->speed = SPEED_100;
170 		break;
171 	default:
172 		phydev->speed = SPEED_10;
173 		break;
174 	}
175 
176 	return 0;
177 }
178 
179 static int m88e1011s_startup(struct phy_device *phydev)
180 {
181 	int ret;
182 
183 	ret = genphy_update_link(phydev);
184 	if (ret)
185 		return ret;
186 
187 	return m88e1xxx_parse_status(phydev);
188 }
189 
190 /* Marvell 88E1111S */
191 static int m88e1111s_config(struct phy_device *phydev)
192 {
193 	int reg;
194 
195 	if (phy_interface_is_rgmii(phydev)) {
196 		reg = phy_read(phydev,
197 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_CR);
198 		if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) ||
199 			(phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)) {
200 			reg |= (MIIM_88E1111_RX_DELAY | MIIM_88E1111_TX_DELAY);
201 		} else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
202 			reg &= ~MIIM_88E1111_TX_DELAY;
203 			reg |= MIIM_88E1111_RX_DELAY;
204 		} else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
205 			reg &= ~MIIM_88E1111_RX_DELAY;
206 			reg |= MIIM_88E1111_TX_DELAY;
207 		}
208 
209 		phy_write(phydev,
210 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_CR, reg);
211 
212 		reg = phy_read(phydev,
213 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_SR);
214 
215 		reg &= ~(MIIM_88E1111_HWCFG_MODE_MASK);
216 
217 		if (reg & MIIM_88E1111_HWCFG_FIBER_COPPER_RES)
218 			reg |= MIIM_88E1111_HWCFG_MODE_FIBER_RGMII;
219 		else
220 			reg |= MIIM_88E1111_HWCFG_MODE_COPPER_RGMII;
221 
222 		phy_write(phydev,
223 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_SR, reg);
224 	}
225 
226 	if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
227 		reg = phy_read(phydev,
228 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_SR);
229 
230 		reg &= ~(MIIM_88E1111_HWCFG_MODE_MASK);
231 		reg |= MIIM_88E1111_HWCFG_MODE_SGMII_NO_CLK;
232 		reg |= MIIM_88E1111_HWCFG_FIBER_COPPER_AUTO;
233 
234 		phy_write(phydev, MDIO_DEVAD_NONE,
235 			MIIM_88E1111_PHY_EXT_SR, reg);
236 	}
237 
238 	if (phydev->interface == PHY_INTERFACE_MODE_RTBI) {
239 		reg = phy_read(phydev,
240 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_CR);
241 		reg |= (MIIM_88E1111_RX_DELAY | MIIM_88E1111_TX_DELAY);
242 		phy_write(phydev,
243 			MDIO_DEVAD_NONE, MIIM_88E1111_PHY_EXT_CR, reg);
244 
245 		reg = phy_read(phydev, MDIO_DEVAD_NONE,
246 			MIIM_88E1111_PHY_EXT_SR);
247 		reg &= ~(MIIM_88E1111_HWCFG_MODE_MASK |
248 			MIIM_88E1111_HWCFG_FIBER_COPPER_RES);
249 		reg |= 0x7 | MIIM_88E1111_HWCFG_FIBER_COPPER_AUTO;
250 		phy_write(phydev, MDIO_DEVAD_NONE,
251 			MIIM_88E1111_PHY_EXT_SR, reg);
252 
253 		/* soft reset */
254 		phy_reset(phydev);
255 
256 		reg = phy_read(phydev, MDIO_DEVAD_NONE,
257 			MIIM_88E1111_PHY_EXT_SR);
258 		reg &= ~(MIIM_88E1111_HWCFG_MODE_MASK |
259 			MIIM_88E1111_HWCFG_FIBER_COPPER_RES);
260 		reg |= MIIM_88E1111_HWCFG_MODE_COPPER_RTBI |
261 			MIIM_88E1111_HWCFG_FIBER_COPPER_AUTO;
262 		phy_write(phydev, MDIO_DEVAD_NONE,
263 			MIIM_88E1111_PHY_EXT_SR, reg);
264 	}
265 
266 	/* soft reset */
267 	phy_reset(phydev);
268 
269 	genphy_config_aneg(phydev);
270 	genphy_restart_aneg(phydev);
271 
272 	return 0;
273 }
274 
275 /**
276  * m88e1518_phy_writebits - write bits to a register
277  */
278 void m88e1518_phy_writebits(struct phy_device *phydev,
279 		   u8 reg_num, u16 offset, u16 len, u16 data)
280 {
281 	u16 reg, mask;
282 
283 	if ((len + offset) >= 16)
284 		mask = 0 - (1 << offset);
285 	else
286 		mask = (1 << (len + offset)) - (1 << offset);
287 
288 	reg = phy_read(phydev, MDIO_DEVAD_NONE, reg_num);
289 
290 	reg &= ~mask;
291 	reg |= data << offset;
292 
293 	phy_write(phydev, MDIO_DEVAD_NONE, reg_num, reg);
294 }
295 
296 static int m88e1518_config(struct phy_device *phydev)
297 {
298 	/*
299 	 * As per Marvell Release Notes - Alaska 88E1510/88E1518/88E1512
300 	 * /88E1514 Rev A0, Errata Section 3.1
301 	 */
302 
303 	/* EEE initialization */
304 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x00ff);
305 	phy_write(phydev, MDIO_DEVAD_NONE, 17, 0x214B);
306 	phy_write(phydev, MDIO_DEVAD_NONE, 16, 0x2144);
307 	phy_write(phydev, MDIO_DEVAD_NONE, 17, 0x0C28);
308 	phy_write(phydev, MDIO_DEVAD_NONE, 16, 0x2146);
309 	phy_write(phydev, MDIO_DEVAD_NONE, 17, 0xB233);
310 	phy_write(phydev, MDIO_DEVAD_NONE, 16, 0x214D);
311 	phy_write(phydev, MDIO_DEVAD_NONE, 17, 0xCC0C);
312 	phy_write(phydev, MDIO_DEVAD_NONE, 16, 0x2159);
313 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0000);
314 
315 	/* SGMII-to-Copper mode initialization */
316 	if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
317 		/* Select page 18 */
318 		phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 18);
319 
320 		/* In reg 20, write MODE[2:0] = 0x1 (SGMII to Copper) */
321 		m88e1518_phy_writebits(phydev, MIIM_88E151x_GENERAL_CTRL,
322 				       0, 3, MIIM_88E151x_MODE_SGMII);
323 
324 		/* PHY reset is necessary after changing MODE[2:0] */
325 		m88e1518_phy_writebits(phydev, MIIM_88E151x_GENERAL_CTRL,
326 				       MIIM_88E151x_RESET_OFFS, 1, 1);
327 
328 		/* Reset page selection */
329 		phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0);
330 
331 		udelay(100);
332 	}
333 
334 	return m88e1111s_config(phydev);
335 }
336 
337 /* Marvell 88E1510 */
338 static int m88e1510_config(struct phy_device *phydev)
339 {
340 	/* Select page 3 */
341 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE,
342 		  MIIM_88E1118_PHY_LED_PAGE);
343 
344 	/* Enable INTn output on LED[2] */
345 	m88e1518_phy_writebits(phydev, MIIM_88E151x_LED_TIMER_CTRL,
346 			       MIIM_88E151x_INT_EN_OFFS, 1, 1);
347 
348 	/* Configure LEDs */
349 	/* LED[0]:0011 (ACT) */
350 	m88e1518_phy_writebits(phydev, MIIM_88E151x_LED_FUNC_CTRL,
351 			       MIIM_88E151x_LED0_OFFS, MIIM_88E151x_LED_FLD_SZ,
352 			       MIIM_88E151x_LED0_ACT);
353 	/* LED[1]:0110 (LINK 100/1000 Mbps) */
354 	m88e1518_phy_writebits(phydev, MIIM_88E151x_LED_FUNC_CTRL,
355 			       MIIM_88E151x_LED1_OFFS, MIIM_88E151x_LED_FLD_SZ,
356 			       MIIM_88E151x_LED1_100_1000_LINK);
357 
358 	/* Reset page selection */
359 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0);
360 
361 	return m88e1518_config(phydev);
362 }
363 
364 /* Marvell 88E1118 */
365 static int m88e1118_config(struct phy_device *phydev)
366 {
367 	/* Change Page Number */
368 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0002);
369 	/* Delay RGMII TX and RX */
370 	phy_write(phydev, MDIO_DEVAD_NONE, 0x15, 0x1070);
371 	/* Change Page Number */
372 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0003);
373 	/* Adjust LED control */
374 	phy_write(phydev, MDIO_DEVAD_NONE, 0x10, 0x021e);
375 	/* Change Page Number */
376 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0000);
377 
378 	return genphy_config_aneg(phydev);
379 }
380 
381 static int m88e1118_startup(struct phy_device *phydev)
382 {
383 	int ret;
384 
385 	/* Change Page Number */
386 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0000);
387 
388 	ret = genphy_update_link(phydev);
389 	if (ret)
390 		return ret;
391 
392 	return m88e1xxx_parse_status(phydev);
393 }
394 
395 /* Marvell 88E1121R */
396 static int m88e1121_config(struct phy_device *phydev)
397 {
398 	int pg;
399 
400 	/* Configure the PHY */
401 	genphy_config_aneg(phydev);
402 
403 	/* Switch the page to access the led register */
404 	pg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1121_PHY_PAGE);
405 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1121_PHY_PAGE,
406 			MIIM_88E1121_PHY_LED_PAGE);
407 	/* Configure leds */
408 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1121_PHY_LED_CTRL,
409 			MIIM_88E1121_PHY_LED_DEF);
410 	/* Restore the page pointer */
411 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1121_PHY_PAGE, pg);
412 
413 	/* Disable IRQs and de-assert interrupt */
414 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1121_PHY_IRQ_EN, 0);
415 	phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1121_PHY_IRQ_STATUS);
416 
417 	return 0;
418 }
419 
420 /* Marvell 88E1145 */
421 static int m88e1145_config(struct phy_device *phydev)
422 {
423 	int reg;
424 
425 	/* Errata E0, E1 */
426 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_PAGE, 0x001b);
427 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_CAL_OV, 0x418f);
428 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_PAGE, 0x0016);
429 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_CAL_OV, 0xa2da);
430 
431 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1xxx_PHY_SCR,
432 			MIIM_88E1xxx_PHY_MDI_X_AUTO);
433 
434 	reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_EXT_CR);
435 	if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
436 		reg |= MIIM_M88E1145_RGMII_RX_DELAY |
437 			MIIM_M88E1145_RGMII_TX_DELAY;
438 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_EXT_CR, reg);
439 
440 	genphy_config_aneg(phydev);
441 
442 	phy_reset(phydev);
443 
444 	return 0;
445 }
446 
447 static int m88e1145_startup(struct phy_device *phydev)
448 {
449 	int ret;
450 
451 	ret = genphy_update_link(phydev);
452 	if (ret)
453 		return ret;
454 
455 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1145_PHY_LED_CONTROL,
456 			MIIM_88E1145_PHY_LED_DIRECT);
457 	return m88e1xxx_parse_status(phydev);
458 }
459 
460 /* Marvell 88E1149S */
461 static int m88e1149_config(struct phy_device *phydev)
462 {
463 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1149_PHY_PAGE, 0x1f);
464 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1e, 0x200c);
465 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1149_PHY_PAGE, 0x5);
466 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1e, 0x0);
467 	phy_write(phydev, MDIO_DEVAD_NONE, 0x1e, 0x100);
468 
469 	genphy_config_aneg(phydev);
470 
471 	phy_reset(phydev);
472 
473 	return 0;
474 }
475 
476 /* Marvell 88E1310 */
477 static int m88e1310_config(struct phy_device *phydev)
478 {
479 	u16 reg;
480 
481 	/* LED link and activity */
482 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_PAGE, 0x0003);
483 	reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_LED_CTRL);
484 	reg = (reg & ~0xf) | 0x1;
485 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_LED_CTRL, reg);
486 
487 	/* Set LED2/INT to INT mode, low active */
488 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_PAGE, 0x0003);
489 	reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_IRQ_EN);
490 	reg = (reg & 0x77ff) | 0x0880;
491 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_IRQ_EN, reg);
492 
493 	/* Set RGMII delay */
494 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_PAGE, 0x0002);
495 	reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_RGMII_CTRL);
496 	reg |= 0x0030;
497 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_RGMII_CTRL, reg);
498 
499 	/* Ensure to return to page 0 */
500 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1310_PHY_PAGE, 0x0000);
501 
502 	return genphy_config_aneg(phydev);
503 }
504 
505 static int m88e1680_config(struct phy_device *phydev)
506 {
507 	/*
508 	 * As per Marvell Release Notes - Alaska V 88E1680 Rev A2
509 	 * Errata Section 4.1
510 	 */
511 	u16 reg;
512 	int res;
513 
514 	/* Matrix LED mode (not neede if single LED mode is used */
515 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0004);
516 	reg = phy_read(phydev, MDIO_DEVAD_NONE, 27);
517 	reg |= (1 << 5);
518 	phy_write(phydev, MDIO_DEVAD_NONE, 27, reg);
519 
520 	/* QSGMII TX amplitude change */
521 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x00fd);
522 	phy_write(phydev, MDIO_DEVAD_NONE,  8, 0x0b53);
523 	phy_write(phydev, MDIO_DEVAD_NONE,  7, 0x200d);
524 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0000);
525 
526 	/* EEE initialization */
527 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x00ff);
528 	phy_write(phydev, MDIO_DEVAD_NONE, 17, 0xb030);
529 	phy_write(phydev, MDIO_DEVAD_NONE, 16, 0x215c);
530 	phy_write(phydev, MDIO_DEVAD_NONE, 22, 0x00fc);
531 	phy_write(phydev, MDIO_DEVAD_NONE, 24, 0x888c);
532 	phy_write(phydev, MDIO_DEVAD_NONE, 25, 0x888c);
533 	phy_write(phydev, MDIO_DEVAD_NONE, MIIM_88E1118_PHY_PAGE, 0x0000);
534 	phy_write(phydev, MDIO_DEVAD_NONE,  0, 0x9140);
535 
536 	res = genphy_config_aneg(phydev);
537 	if (res < 0)
538 		return res;
539 
540 	/* soft reset */
541 	reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
542 	reg |= BMCR_RESET;
543 	phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, reg);
544 
545 	return 0;
546 }
547 
548 static struct phy_driver M88E1011S_driver = {
549 	.name = "Marvell 88E1011S",
550 	.uid = 0x1410c60,
551 	.mask = 0xffffff0,
552 	.features = PHY_GBIT_FEATURES,
553 	.config = &m88e1011s_config,
554 	.startup = &m88e1011s_startup,
555 	.shutdown = &genphy_shutdown,
556 };
557 
558 static struct phy_driver M88E1111S_driver = {
559 	.name = "Marvell 88E1111S",
560 	.uid = 0x1410cc0,
561 	.mask = 0xffffff0,
562 	.features = PHY_GBIT_FEATURES,
563 	.config = &m88e1111s_config,
564 	.startup = &m88e1011s_startup,
565 	.shutdown = &genphy_shutdown,
566 };
567 
568 static struct phy_driver M88E1118_driver = {
569 	.name = "Marvell 88E1118",
570 	.uid = 0x1410e10,
571 	.mask = 0xffffff0,
572 	.features = PHY_GBIT_FEATURES,
573 	.config = &m88e1118_config,
574 	.startup = &m88e1118_startup,
575 	.shutdown = &genphy_shutdown,
576 };
577 
578 static struct phy_driver M88E1118R_driver = {
579 	.name = "Marvell 88E1118R",
580 	.uid = 0x1410e40,
581 	.mask = 0xffffff0,
582 	.features = PHY_GBIT_FEATURES,
583 	.config = &m88e1118_config,
584 	.startup = &m88e1118_startup,
585 	.shutdown = &genphy_shutdown,
586 };
587 
588 static struct phy_driver M88E1121R_driver = {
589 	.name = "Marvell 88E1121R",
590 	.uid = 0x1410cb0,
591 	.mask = 0xffffff0,
592 	.features = PHY_GBIT_FEATURES,
593 	.config = &m88e1121_config,
594 	.startup = &genphy_startup,
595 	.shutdown = &genphy_shutdown,
596 };
597 
598 static struct phy_driver M88E1145_driver = {
599 	.name = "Marvell 88E1145",
600 	.uid = 0x1410cd0,
601 	.mask = 0xffffff0,
602 	.features = PHY_GBIT_FEATURES,
603 	.config = &m88e1145_config,
604 	.startup = &m88e1145_startup,
605 	.shutdown = &genphy_shutdown,
606 };
607 
608 static struct phy_driver M88E1149S_driver = {
609 	.name = "Marvell 88E1149S",
610 	.uid = 0x1410ca0,
611 	.mask = 0xffffff0,
612 	.features = PHY_GBIT_FEATURES,
613 	.config = &m88e1149_config,
614 	.startup = &m88e1011s_startup,
615 	.shutdown = &genphy_shutdown,
616 };
617 
618 static struct phy_driver M88E1510_driver = {
619 	.name = "Marvell 88E1510",
620 	.uid = 0x1410dd0,
621 	.mask = 0xfffffff,
622 	.features = PHY_GBIT_FEATURES,
623 	.config = &m88e1510_config,
624 	.startup = &m88e1011s_startup,
625 	.shutdown = &genphy_shutdown,
626 };
627 
628 /*
629  * This supports:
630  *  88E1518, uid 0x1410dd1
631  *  88E1512, uid 0x1410dd4
632  */
633 static struct phy_driver M88E1518_driver = {
634 	.name = "Marvell 88E1518",
635 	.uid = 0x1410dd0,
636 	.mask = 0xffffffa,
637 	.features = PHY_GBIT_FEATURES,
638 	.config = &m88e1518_config,
639 	.startup = &m88e1011s_startup,
640 	.shutdown = &genphy_shutdown,
641 };
642 
643 static struct phy_driver M88E1310_driver = {
644 	.name = "Marvell 88E1310",
645 	.uid = 0x01410e90,
646 	.mask = 0xffffff0,
647 	.features = PHY_GBIT_FEATURES,
648 	.config = &m88e1310_config,
649 	.startup = &m88e1011s_startup,
650 	.shutdown = &genphy_shutdown,
651 };
652 
653 static struct phy_driver M88E1680_driver = {
654 	.name = "Marvell 88E1680",
655 	.uid = 0x1410ed0,
656 	.mask = 0xffffff0,
657 	.features = PHY_GBIT_FEATURES,
658 	.config = &m88e1680_config,
659 	.startup = &genphy_startup,
660 	.shutdown = &genphy_shutdown,
661 };
662 
663 int phy_marvell_init(void)
664 {
665 	phy_register(&M88E1310_driver);
666 	phy_register(&M88E1149S_driver);
667 	phy_register(&M88E1145_driver);
668 	phy_register(&M88E1121R_driver);
669 	phy_register(&M88E1118_driver);
670 	phy_register(&M88E1118R_driver);
671 	phy_register(&M88E1111S_driver);
672 	phy_register(&M88E1011S_driver);
673 	phy_register(&M88E1510_driver);
674 	phy_register(&M88E1518_driver);
675 	phy_register(&M88E1680_driver);
676 
677 	return 0;
678 }
679