]> git.ipfire.org Git - thirdparty/linux.git/blame - drivers/net/phy/broadcom.c
Merge tag 'io_uring-5.7-2020-05-22' of git://git.kernel.dk/linux-block
[thirdparty/linux.git] / drivers / net / phy / broadcom.c
CommitLineData
a2443fd1 1// SPDX-License-Identifier: GPL-2.0+
c4b41c9f
MR
2/*
3 * drivers/net/phy/broadcom.c
4 *
5 * Broadcom BCM5411, BCM5421 and BCM5461 Gigabit Ethernet
6 * transceivers.
7 *
8 * Copyright (c) 2006 Maciej W. Rozycki
9 *
10 * Inspired by code written by Amy Fong.
c4b41c9f
MR
11 */
12
a1cba561 13#include "bcm-phy-lib.h"
c4b41c9f
MR
14#include <linux/module.h>
15#include <linux/phy.h>
8649f13d 16#include <linux/brcmphy.h>
b14995ac 17#include <linux/of.h>
d9221e66
MC
18
19#define BRCM_PHY_MODEL(phydev) \
20 ((phydev)->drv->phy_id & (phydev)->drv->phy_id_mask)
21
32e5a8d6
MC
22#define BRCM_PHY_REV(phydev) \
23 ((phydev)->drv->phy_id & ~((phydev)->drv->phy_id_mask))
24
c4b41c9f
MR
25MODULE_DESCRIPTION("Broadcom PHY driver");
26MODULE_AUTHOR("Maciej W. Rozycki");
27MODULE_LICENSE("GPL");
28
fea7fda7
FF
29static int bcm54xx_config_clock_delay(struct phy_device *phydev);
30
0fc9ae10
RM
31static int bcm54210e_config_init(struct phy_device *phydev)
32{
33 int val;
34
fea7fda7 35 bcm54xx_config_clock_delay(phydev);
0fc9ae10 36
2355a654
RM
37 if (phydev->dev_flags & PHY_BRCM_EN_MASTER_MODE) {
38 val = phy_read(phydev, MII_CTRL1000);
39 val |= CTL1000_AS_MASTER | CTL1000_ENABLE_MASTER;
40 phy_write(phydev, MII_CTRL1000, val);
41 }
42
0fc9ae10
RM
43 return 0;
44}
45
62e13097
RM
46static int bcm54612e_config_init(struct phy_device *phydev)
47{
69e2eccc
KY
48 int reg;
49
bea5d143 50 bcm54xx_config_clock_delay(phydev);
62e13097 51
69e2eccc
KY
52 /* Enable CLK125 MUX on LED4 if ref clock is enabled. */
53 if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) {
54 int err;
55
56 reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0);
57 err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0,
58 BCM54612E_LED4_CLK125OUT_EN | reg);
59
60 if (err < 0)
61 return err;
62 }
63
62e13097
RM
64 return 0;
65}
66
042cb564 67static int bcm54xx_config_clock_delay(struct phy_device *phydev)
b14995ac
JM
68{
69 int rc, val;
70
73333626 71 /* handling PHY's internal RX clock delay */
b14995ac 72 val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
b14995ac 73 val |= MII_BCM54XX_AUXCTL_MISC_WREN;
73333626
AS
74 if (phydev->interface == PHY_INTERFACE_MODE_RGMII ||
75 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
76 /* Disable RGMII RXC-RXD skew */
77 val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
78 }
79 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
80 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
81 /* Enable RGMII RXC-RXD skew */
82 val |= MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
83 }
b14995ac
JM
84 rc = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC,
85 val);
86 if (rc < 0)
87 return rc;
88
73333626 89 /* handling PHY's internal TX clock delay */
b14995ac 90 val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL);
73333626
AS
91 if (phydev->interface == PHY_INTERFACE_MODE_RGMII ||
92 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
93 /* Disable internal TX clock delay */
94 val &= ~BCM54810_SHD_CLK_CTL_GTXCLK_EN;
95 }
96 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
97 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
98 /* Enable internal TX clock delay */
99 val |= BCM54810_SHD_CLK_CTL_GTXCLK_EN;
100 }
b14995ac
JM
101 rc = bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val);
102 if (rc < 0)
103 return rc;
104
105 return 0;
106}
107
47b1b53b 108/* Needs SMDSP clock enabled via bcm54xx_phydsp_config() */
772638b6
MC
109static int bcm50610_a0_workaround(struct phy_device *phydev)
110{
111 int err;
112
a1cba561 113 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH0,
772638b6
MC
114 MII_BCM54XX_EXP_AADJ1CH0_SWP_ABCD_OEN |
115 MII_BCM54XX_EXP_AADJ1CH0_SWSEL_THPF);
116 if (err < 0)
47b1b53b 117 return err;
772638b6 118
a1cba561
AP
119 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH3,
120 MII_BCM54XX_EXP_AADJ1CH3_ADCCKADJ);
772638b6 121 if (err < 0)
47b1b53b 122 return err;
772638b6 123
a1cba561 124 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75,
772638b6
MC
125 MII_BCM54XX_EXP_EXP75_VDACCTRL);
126 if (err < 0)
47b1b53b 127 return err;
772638b6 128
a1cba561 129 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP96,
772638b6
MC
130 MII_BCM54XX_EXP_EXP96_MYST);
131 if (err < 0)
47b1b53b 132 return err;
772638b6 133
a1cba561 134 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP97,
772638b6
MC
135 MII_BCM54XX_EXP_EXP97_MYST);
136
47b1b53b
MC
137 return err;
138}
139
140static int bcm54xx_phydsp_config(struct phy_device *phydev)
141{
142 int err, err2;
143
144 /* Enable the SMDSP clock */
145 err = bcm54xx_auxctl_write(phydev,
146 MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL,
147 MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA |
148 MII_BCM54XX_AUXCTL_ACTL_TX_6DB);
149 if (err < 0)
150 return err;
151
219c6efe
MC
152 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
153 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) {
154 /* Clear bit 9 to fix a phy interop issue. */
a1cba561 155 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP08,
219c6efe
MC
156 MII_BCM54XX_EXP_EXP08_RJCT_2MHZ);
157 if (err < 0)
158 goto error;
159
160 if (phydev->drv->phy_id == PHY_ID_BCM50610) {
161 err = bcm50610_a0_workaround(phydev);
162 if (err < 0)
163 goto error;
164 }
165 }
47b1b53b
MC
166
167 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM57780) {
168 int val;
169
a1cba561 170 val = bcm_phy_read_exp(phydev, MII_BCM54XX_EXP_EXP75);
47b1b53b
MC
171 if (val < 0)
172 goto error;
173
174 val |= MII_BCM54XX_EXP_EXP75_CM_OSC;
a1cba561 175 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, val);
47b1b53b
MC
176 }
177
772638b6 178error:
47b1b53b
MC
179 /* Disable the SMDSP clock */
180 err2 = bcm54xx_auxctl_write(phydev,
181 MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL,
182 MII_BCM54XX_AUXCTL_ACTL_TX_6DB);
772638b6 183
47b1b53b
MC
184 /* Return the first error reported. */
185 return err ? err : err2;
772638b6
MC
186}
187
32e5a8d6
MC
188static void bcm54xx_adjust_rxrefclk(struct phy_device *phydev)
189{
5ee6f6a1
RK
190 u32 orig;
191 int val;
c704dc23 192 bool clk125en = true;
32e5a8d6
MC
193
194 /* Abort if we are using an untested phy. */
7ec4e7d3 195 if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM57780 &&
196 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610 &&
0ececcfc
FF
197 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610M &&
198 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54810)
32e5a8d6
MC
199 return;
200
a1cba561 201 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3);
32e5a8d6
MC
202 if (val < 0)
203 return;
204
205 orig = val;
206
c704dc23
MC
207 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
208 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) &&
209 BRCM_PHY_REV(phydev) >= 0x3) {
210 /*
211 * Here, bit 0 _disables_ CLK125 when set.
212 * This bit is set by default.
213 */
214 clk125en = false;
215 } else {
216 if (phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) {
32e5a8d6
MC
217 /* Here, bit 0 _enables_ CLK125 when set */
218 val &= ~BCM54XX_SHD_SCR3_DEF_CLK125;
c704dc23 219 clk125en = false;
32e5a8d6
MC
220 }
221 }
222
23677ce3 223 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
c704dc23
MC
224 val &= ~BCM54XX_SHD_SCR3_DLLAPD_DIS;
225 else
226 val |= BCM54XX_SHD_SCR3_DLLAPD_DIS;
227
cc8a677a
KL
228 if (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) {
229 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810)
230 val |= BCM54810_SHD_SCR3_TRDDAPD;
231 else
232 val |= BCM54XX_SHD_SCR3_TRDDAPD;
233 }
52fae083 234
32e5a8d6 235 if (orig != val)
a1cba561 236 bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val);
c704dc23 237
a1cba561 238 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD);
c704dc23
MC
239 if (val < 0)
240 return;
241
242 orig = val;
243
23677ce3 244 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
c704dc23
MC
245 val |= BCM54XX_SHD_APD_EN;
246 else
247 val &= ~BCM54XX_SHD_APD_EN;
248
249 if (orig != val)
a1cba561 250 bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val);
32e5a8d6
MC
251}
252
c4b41c9f
MR
253static int bcm54xx_config_init(struct phy_device *phydev)
254{
73333626 255 int reg, err, val;
c4b41c9f
MR
256
257 reg = phy_read(phydev, MII_BCM54XX_ECR);
258 if (reg < 0)
259 return reg;
260
261 /* Mask interrupts globally. */
262 reg |= MII_BCM54XX_ECR_IM;
263 err = phy_write(phydev, MII_BCM54XX_ECR, reg);
264 if (err < 0)
265 return err;
266
267 /* Unmask events we are interested in. */
268 reg = ~(MII_BCM54XX_INT_DUPLEX |
269 MII_BCM54XX_INT_SPEED |
270 MII_BCM54XX_INT_LINK);
271 err = phy_write(phydev, MII_BCM54XX_IMR, reg);
272 if (err < 0)
273 return err;
772638b6 274
63a14ce4
MC
275 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
276 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) &&
277 (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE))
a1cba561 278 bcm_phy_write_shadow(phydev, BCM54XX_SHD_RGMII_MODE, 0);
63a14ce4 279
cb64da3a 280 bcm54xx_adjust_rxrefclk(phydev);
32e5a8d6 281
0fc9ae10
RM
282 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E) {
283 err = bcm54210e_config_init(phydev);
284 if (err)
285 return err;
62e13097
RM
286 } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54612E) {
287 err = bcm54612e_config_init(phydev);
288 if (err)
289 return err;
0fc9ae10 290 } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) {
73333626
AS
291 /* For BCM54810, we need to disable BroadR-Reach function */
292 val = bcm_phy_read_exp(phydev,
293 BCM54810_EXP_BROADREACH_LRE_MISC_CTL);
294 val &= ~BCM54810_EXP_BROADREACH_LRE_MISC_CTL_EN;
295 err = bcm_phy_write_exp(phydev,
296 BCM54810_EXP_BROADREACH_LRE_MISC_CTL,
297 val);
298 if (err < 0)
b14995ac
JM
299 return err;
300 }
301
47b1b53b 302 bcm54xx_phydsp_config(phydev);
d9221e66 303
450895d0
VO
304 /* Encode link speed into LED1 and LED3 pair (green/amber).
305 * Also flash these two LEDs on activity. This means configuring
306 * them for MULTICOLOR and encoding link/activity into them.
307 */
308 val = BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_MULTICOLOR1) |
309 BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_MULTICOLOR1);
310 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1, val);
311
312 val = BCM_LED_MULTICOLOR_IN_PHASE |
313 BCM5482_SHD_LEDS1_LED1(BCM_LED_MULTICOLOR_LINK_ACT) |
314 BCM5482_SHD_LEDS1_LED3(BCM_LED_MULTICOLOR_LINK_ACT);
315 bcm_phy_write_exp(phydev, BCM_EXP_MULTICOLOR, val);
316
c4b41c9f
MR
317 return 0;
318}
319
fe26821f
FF
320static int bcm54xx_resume(struct phy_device *phydev)
321{
322 int ret;
323
324 /* Writes to register other than BMCR would be ignored
325 * unless we clear the PDOWN bit first
326 */
327 ret = genphy_resume(phydev);
328 if (ret < 0)
329 return ret;
330
331 return bcm54xx_config_init(phydev);
332}
333
cd9af3da
NC
334static int bcm5482_config_init(struct phy_device *phydev)
335{
336 int err, reg;
337
338 err = bcm54xx_config_init(phydev);
339
340 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
341 /*
342 * Enable secondary SerDes and its use as an LED source
343 */
a1cba561
AP
344 reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_SSD);
345 bcm_phy_write_shadow(phydev, BCM5482_SHD_SSD,
cd9af3da
NC
346 reg |
347 BCM5482_SHD_SSD_LEDM |
348 BCM5482_SHD_SSD_EN);
349
350 /*
351 * Enable SGMII slave mode and auto-detection
352 */
042a75b9 353 reg = BCM5482_SSD_SGMII_SLAVE | MII_BCM54XX_EXP_SEL_SSD;
a1cba561 354 err = bcm_phy_read_exp(phydev, reg);
042a75b9
MC
355 if (err < 0)
356 return err;
a1cba561 357 err = bcm_phy_write_exp(phydev, reg, err |
042a75b9
MC
358 BCM5482_SSD_SGMII_SLAVE_EN |
359 BCM5482_SSD_SGMII_SLAVE_AD);
360 if (err < 0)
361 return err;
cd9af3da
NC
362
363 /*
364 * Disable secondary SerDes powerdown
365 */
042a75b9 366 reg = BCM5482_SSD_1000BX_CTL | MII_BCM54XX_EXP_SEL_SSD;
a1cba561 367 err = bcm_phy_read_exp(phydev, reg);
042a75b9
MC
368 if (err < 0)
369 return err;
a1cba561 370 err = bcm_phy_write_exp(phydev, reg,
042a75b9
MC
371 err & ~BCM5482_SSD_1000BX_CTL_PWRDOWN);
372 if (err < 0)
373 return err;
cd9af3da
NC
374
375 /*
376 * Select 1000BASE-X register set (primary SerDes)
377 */
b9bcb953
TR
378 reg = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE);
379 bcm_phy_write_shadow(phydev, BCM54XX_SHD_MODE,
380 reg | BCM54XX_SHD_MODE_1000BX);
cd9af3da
NC
381
382 /*
383 * LED1=ACTIVITYLED, LED3=LINKSPD[2]
384 * (Use LED1 as secondary SerDes ACTIVITY LED)
385 */
a1cba561 386 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1,
cd9af3da
NC
387 BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_ACTIVITYLED) |
388 BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_LINKSPD2));
389
390 /*
391 * Auto-negotiation doesn't seem to work quite right
392 * in this mode, so we disable it and force it to the
393 * right speed/duplex setting. Only 'link status'
394 * is important.
395 */
396 phydev->autoneg = AUTONEG_DISABLE;
397 phydev->speed = SPEED_1000;
398 phydev->duplex = DUPLEX_FULL;
399 }
400
401 return err;
402}
403
404static int bcm5482_read_status(struct phy_device *phydev)
405{
406 int err;
407
408 err = genphy_read_status(phydev);
409
410 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
411 /*
412 * Only link status matters for 1000Base-X mode, so force
413 * 1000 Mbit/s full-duplex status
414 */
415 if (phydev->link) {
416 phydev->speed = SPEED_1000;
417 phydev->duplex = DUPLEX_FULL;
418 }
419 }
420
421 return err;
422}
423
57bb7e22
AV
424static int bcm5481_config_aneg(struct phy_device *phydev)
425{
b14995ac 426 struct device_node *np = phydev->mdio.dev.of_node;
57bb7e22
AV
427 int ret;
428
29f20dd6 429 /* Aneg firstly. */
57bb7e22
AV
430 ret = genphy_config_aneg(phydev);
431
432 /* Then we can set up the delay. */
042cb564 433 bcm54xx_config_clock_delay(phydev);
57bb7e22 434
b14995ac
JM
435 if (of_property_read_bool(np, "enet-phy-lane-swap")) {
436 /* Lane Swap - Undocumented register...magic! */
437 ret = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_SEL_ER + 0x9,
438 0x11B);
439 if (ret < 0)
440 return ret;
441 }
442
57bb7e22
AV
443 return ret;
444}
445
b9bcb953
TR
446static int bcm54616s_probe(struct phy_device *phydev)
447{
448 int val, intf_sel;
449
450 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE);
451 if (val < 0)
452 return val;
453
454 /* The PHY is strapped in RGMII-fiber mode when INTERF_SEL[1:0]
455 * is 01b, and the link between PHY and its link partner can be
456 * either 1000Base-X or 100Base-FX.
457 * RGMII-1000Base-X is properly supported, but RGMII-100Base-FX
458 * support is still missing as of now.
459 */
460 intf_sel = (val & BCM54XX_SHD_INTF_SEL_MASK) >> 1;
461 if (intf_sel == 1) {
462 val = bcm_phy_read_shadow(phydev, BCM54616S_SHD_100FX_CTRL);
463 if (val < 0)
464 return val;
465
466 /* Bit 0 of the SerDes 100-FX Control register, when set
467 * to 1, sets the MII/RGMII -> 100BASE-FX configuration.
468 * When this bit is set to 0, it sets the GMII/RGMII ->
469 * 1000BASE-X configuration.
470 */
471 if (!(val & BCM54616S_100FX_MODE))
472 phydev->dev_flags |= PHY_BCM_FLAGS_MODE_1000BX;
473 }
474
475 return 0;
476}
477
042cb564
TR
478static int bcm54616s_config_aneg(struct phy_device *phydev)
479{
480 int ret;
481
29f20dd6 482 /* Aneg firstly. */
b9bcb953
TR
483 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX)
484 ret = genphy_c37_config_aneg(phydev);
485 else
486 ret = genphy_config_aneg(phydev);
042cb564
TR
487
488 /* Then we can set up the delay. */
489 bcm54xx_config_clock_delay(phydev);
490
491 return ret;
492}
493
b9bcb953
TR
494static int bcm54616s_read_status(struct phy_device *phydev)
495{
496 int err;
497
498 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX)
499 err = genphy_c37_read_status(phydev);
500 else
501 err = genphy_read_status(phydev);
502
503 return err;
504}
505
d7a2ed92
MC
506static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set)
507{
508 int val;
509
510 val = phy_read(phydev, reg);
511 if (val < 0)
512 return val;
513
514 return phy_write(phydev, reg, val | set);
515}
516
517static int brcm_fet_config_init(struct phy_device *phydev)
518{
519 int reg, err, err2, brcmtest;
520
521 /* Reset the PHY to bring it to a known state. */
522 err = phy_write(phydev, MII_BMCR, BMCR_RESET);
523 if (err < 0)
524 return err;
525
526 reg = phy_read(phydev, MII_BRCM_FET_INTREG);
527 if (reg < 0)
528 return reg;
529
530 /* Unmask events we are interested in and mask interrupts globally. */
531 reg = MII_BRCM_FET_IR_DUPLEX_EN |
532 MII_BRCM_FET_IR_SPEED_EN |
533 MII_BRCM_FET_IR_LINK_EN |
534 MII_BRCM_FET_IR_ENABLE |
535 MII_BRCM_FET_IR_MASK;
536
537 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
538 if (err < 0)
539 return err;
540
541 /* Enable shadow register access */
542 brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST);
543 if (brcmtest < 0)
544 return brcmtest;
545
546 reg = brcmtest | MII_BRCM_FET_BT_SRE;
547
548 err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg);
549 if (err < 0)
550 return err;
551
552 /* Set the LED mode */
553 reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4);
554 if (reg < 0) {
555 err = reg;
556 goto done;
557 }
558
559 reg &= ~MII_BRCM_FET_SHDW_AM4_LED_MASK;
560 reg |= MII_BRCM_FET_SHDW_AM4_LED_MODE1;
561
562 err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg);
563 if (err < 0)
564 goto done;
565
566 /* Enable auto MDIX */
567 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL,
568 MII_BRCM_FET_SHDW_MC_FAME);
569 if (err < 0)
570 goto done;
571
cdd4e09d
MC
572 if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) {
573 /* Enable auto power down */
574 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2,
575 MII_BRCM_FET_SHDW_AS2_APDE);
576 }
d7a2ed92
MC
577
578done:
579 /* Disable shadow register access */
580 err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest);
581 if (!err)
582 err = err2;
583
584 return err;
585}
586
587static int brcm_fet_ack_interrupt(struct phy_device *phydev)
588{
589 int reg;
590
591 /* Clear pending interrupts. */
592 reg = phy_read(phydev, MII_BRCM_FET_INTREG);
593 if (reg < 0)
594 return reg;
595
596 return 0;
597}
598
599static int brcm_fet_config_intr(struct phy_device *phydev)
600{
601 int reg, err;
602
603 reg = phy_read(phydev, MII_BRCM_FET_INTREG);
604 if (reg < 0)
605 return reg;
606
607 if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
608 reg &= ~MII_BRCM_FET_IR_MASK;
609 else
610 reg |= MII_BRCM_FET_IR_MASK;
611
612 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
613 return err;
614}
615
28dc4c8f
FF
616struct bcm53xx_phy_priv {
617 u64 *stats;
618};
619
620static int bcm53xx_phy_probe(struct phy_device *phydev)
621{
622 struct bcm53xx_phy_priv *priv;
623
624 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
625 if (!priv)
626 return -ENOMEM;
627
628 phydev->priv = priv;
629
630 priv->stats = devm_kcalloc(&phydev->mdio.dev,
631 bcm_phy_get_sset_count(phydev), sizeof(u64),
632 GFP_KERNEL);
633 if (!priv->stats)
634 return -ENOMEM;
635
636 return 0;
637}
638
639static void bcm53xx_phy_get_stats(struct phy_device *phydev,
640 struct ethtool_stats *stats, u64 *data)
641{
642 struct bcm53xx_phy_priv *priv = phydev->priv;
643
644 bcm_phy_get_stats(phydev, priv->stats, stats, data);
645}
646
d5bf9071
CH
647static struct phy_driver broadcom_drivers[] = {
648{
fcb26ec5 649 .phy_id = PHY_ID_BCM5411,
c4b41c9f
MR
650 .phy_id_mask = 0xfffffff0,
651 .name = "Broadcom BCM5411",
dcdecdcf 652 /* PHY_GBIT_FEATURES */
c4b41c9f 653 .config_init = bcm54xx_config_init,
a1cba561
AP
654 .ack_interrupt = bcm_phy_ack_intr,
655 .config_intr = bcm_phy_config_intr,
d5bf9071 656}, {
fcb26ec5 657 .phy_id = PHY_ID_BCM5421,
c4b41c9f
MR
658 .phy_id_mask = 0xfffffff0,
659 .name = "Broadcom BCM5421",
dcdecdcf 660 /* PHY_GBIT_FEATURES */
c4b41c9f 661 .config_init = bcm54xx_config_init,
a1cba561
AP
662 .ack_interrupt = bcm_phy_ack_intr,
663 .config_intr = bcm_phy_config_intr,
0fc9ae10
RM
664}, {
665 .phy_id = PHY_ID_BCM54210E,
666 .phy_id_mask = 0xfffffff0,
667 .name = "Broadcom BCM54210E",
dcdecdcf 668 /* PHY_GBIT_FEATURES */
0fc9ae10 669 .config_init = bcm54xx_config_init,
0fc9ae10
RM
670 .ack_interrupt = bcm_phy_ack_intr,
671 .config_intr = bcm_phy_config_intr,
d5bf9071 672}, {
fcb26ec5 673 .phy_id = PHY_ID_BCM5461,
c4b41c9f
MR
674 .phy_id_mask = 0xfffffff0,
675 .name = "Broadcom BCM5461",
dcdecdcf 676 /* PHY_GBIT_FEATURES */
c4b41c9f 677 .config_init = bcm54xx_config_init,
a1cba561
AP
678 .ack_interrupt = bcm_phy_ack_intr,
679 .config_intr = bcm_phy_config_intr,
d92ead16
XW
680}, {
681 .phy_id = PHY_ID_BCM54612E,
682 .phy_id_mask = 0xfffffff0,
683 .name = "Broadcom BCM54612E",
dcdecdcf 684 /* PHY_GBIT_FEATURES */
d92ead16 685 .config_init = bcm54xx_config_init,
d92ead16
XW
686 .ack_interrupt = bcm_phy_ack_intr,
687 .config_intr = bcm_phy_config_intr,
3bca4cf6
AIB
688}, {
689 .phy_id = PHY_ID_BCM54616S,
690 .phy_id_mask = 0xfffffff0,
691 .name = "Broadcom BCM54616S",
dcdecdcf 692 /* PHY_GBIT_FEATURES */
3bca4cf6 693 .config_init = bcm54xx_config_init,
042cb564 694 .config_aneg = bcm54616s_config_aneg,
a1cba561
AP
695 .ack_interrupt = bcm_phy_ack_intr,
696 .config_intr = bcm_phy_config_intr,
b9bcb953
TR
697 .read_status = bcm54616s_read_status,
698 .probe = bcm54616s_probe,
d5bf9071 699}, {
fcb26ec5 700 .phy_id = PHY_ID_BCM5464,
b1394f96
PG
701 .phy_id_mask = 0xfffffff0,
702 .name = "Broadcom BCM5464",
dcdecdcf 703 /* PHY_GBIT_FEATURES */
b1394f96 704 .config_init = bcm54xx_config_init,
a1cba561
AP
705 .ack_interrupt = bcm_phy_ack_intr,
706 .config_intr = bcm_phy_config_intr,
283da99a
VO
707 .suspend = genphy_suspend,
708 .resume = genphy_resume,
d5bf9071 709}, {
fcb26ec5 710 .phy_id = PHY_ID_BCM5481,
57bb7e22
AV
711 .phy_id_mask = 0xfffffff0,
712 .name = "Broadcom BCM5481",
dcdecdcf 713 /* PHY_GBIT_FEATURES */
57bb7e22 714 .config_init = bcm54xx_config_init,
9753c21f 715 .config_aneg = bcm5481_config_aneg,
a1cba561
AP
716 .ack_interrupt = bcm_phy_ack_intr,
717 .config_intr = bcm_phy_config_intr,
b14995ac
JM
718}, {
719 .phy_id = PHY_ID_BCM54810,
720 .phy_id_mask = 0xfffffff0,
721 .name = "Broadcom BCM54810",
dcdecdcf 722 /* PHY_GBIT_FEATURES */
b14995ac 723 .config_init = bcm54xx_config_init,
9753c21f 724 .config_aneg = bcm5481_config_aneg,
b14995ac
JM
725 .ack_interrupt = bcm_phy_ack_intr,
726 .config_intr = bcm_phy_config_intr,
fe26821f
FF
727 .suspend = genphy_suspend,
728 .resume = bcm54xx_resume,
d5bf9071 729}, {
fcb26ec5 730 .phy_id = PHY_ID_BCM5482,
03157ac3
NC
731 .phy_id_mask = 0xfffffff0,
732 .name = "Broadcom BCM5482",
dcdecdcf 733 /* PHY_GBIT_FEATURES */
cd9af3da 734 .config_init = bcm5482_config_init,
9753c21f 735 .read_status = bcm5482_read_status,
a1cba561
AP
736 .ack_interrupt = bcm_phy_ack_intr,
737 .config_intr = bcm_phy_config_intr,
d5bf9071 738}, {
772638b6
MC
739 .phy_id = PHY_ID_BCM50610,
740 .phy_id_mask = 0xfffffff0,
741 .name = "Broadcom BCM50610",
dcdecdcf 742 /* PHY_GBIT_FEATURES */
772638b6 743 .config_init = bcm54xx_config_init,
a1cba561
AP
744 .ack_interrupt = bcm_phy_ack_intr,
745 .config_intr = bcm_phy_config_intr,
d5bf9071 746}, {
4f4598fd
MC
747 .phy_id = PHY_ID_BCM50610M,
748 .phy_id_mask = 0xfffffff0,
749 .name = "Broadcom BCM50610M",
dcdecdcf 750 /* PHY_GBIT_FEATURES */
4f4598fd 751 .config_init = bcm54xx_config_init,
a1cba561
AP
752 .ack_interrupt = bcm_phy_ack_intr,
753 .config_intr = bcm_phy_config_intr,
d5bf9071 754}, {
d9221e66 755 .phy_id = PHY_ID_BCM57780,
2fbb69aa
MC
756 .phy_id_mask = 0xfffffff0,
757 .name = "Broadcom BCM57780",
dcdecdcf 758 /* PHY_GBIT_FEATURES */
2fbb69aa 759 .config_init = bcm54xx_config_init,
a1cba561
AP
760 .ack_interrupt = bcm_phy_ack_intr,
761 .config_intr = bcm_phy_config_intr,
d5bf9071 762}, {
6a443a0f 763 .phy_id = PHY_ID_BCMAC131,
d7a2ed92
MC
764 .phy_id_mask = 0xfffffff0,
765 .name = "Broadcom BCMAC131",
dcdecdcf 766 /* PHY_BASIC_FEATURES */
d7a2ed92 767 .config_init = brcm_fet_config_init,
d7a2ed92
MC
768 .ack_interrupt = brcm_fet_ack_interrupt,
769 .config_intr = brcm_fet_config_intr,
d5bf9071 770}, {
7a938f80
DB
771 .phy_id = PHY_ID_BCM5241,
772 .phy_id_mask = 0xfffffff0,
773 .name = "Broadcom BCM5241",
dcdecdcf 774 /* PHY_BASIC_FEATURES */
7a938f80 775 .config_init = brcm_fet_config_init,
7a938f80
DB
776 .ack_interrupt = brcm_fet_ack_interrupt,
777 .config_intr = brcm_fet_config_intr,
28dc4c8f
FF
778}, {
779 .phy_id = PHY_ID_BCM5395,
780 .phy_id_mask = 0xfffffff0,
781 .name = "Broadcom BCM5395",
782 .flags = PHY_IS_INTERNAL,
dcdecdcf 783 /* PHY_GBIT_FEATURES */
28dc4c8f
FF
784 .get_sset_count = bcm_phy_get_sset_count,
785 .get_strings = bcm_phy_get_strings,
786 .get_stats = bcm53xx_phy_get_stats,
787 .probe = bcm53xx_phy_probe,
23b83922
BV
788}, {
789 .phy_id = PHY_ID_BCM89610,
790 .phy_id_mask = 0xfffffff0,
791 .name = "Broadcom BCM89610",
dcdecdcf 792 /* PHY_GBIT_FEATURES */
23b83922
BV
793 .config_init = bcm54xx_config_init,
794 .ack_interrupt = bcm_phy_ack_intr,
795 .config_intr = bcm_phy_config_intr,
d5bf9071 796} };
7a938f80 797
50fd7150 798module_phy_driver(broadcom_drivers);
4e4f10f6 799
cf93c945 800static struct mdio_device_id __maybe_unused broadcom_tbl[] = {
fcb26ec5
DB
801 { PHY_ID_BCM5411, 0xfffffff0 },
802 { PHY_ID_BCM5421, 0xfffffff0 },
0fc9ae10 803 { PHY_ID_BCM54210E, 0xfffffff0 },
fcb26ec5 804 { PHY_ID_BCM5461, 0xfffffff0 },
d92ead16 805 { PHY_ID_BCM54612E, 0xfffffff0 },
3bca4cf6 806 { PHY_ID_BCM54616S, 0xfffffff0 },
fcb26ec5 807 { PHY_ID_BCM5464, 0xfffffff0 },
3c25a860 808 { PHY_ID_BCM5481, 0xfffffff0 },
b14995ac 809 { PHY_ID_BCM54810, 0xfffffff0 },
fcb26ec5 810 { PHY_ID_BCM5482, 0xfffffff0 },
4e4f10f6
DW
811 { PHY_ID_BCM50610, 0xfffffff0 },
812 { PHY_ID_BCM50610M, 0xfffffff0 },
813 { PHY_ID_BCM57780, 0xfffffff0 },
814 { PHY_ID_BCMAC131, 0xfffffff0 },
7a938f80 815 { PHY_ID_BCM5241, 0xfffffff0 },
28dc4c8f 816 { PHY_ID_BCM5395, 0xfffffff0 },
23b83922 817 { PHY_ID_BCM89610, 0xfffffff0 },
4e4f10f6
DW
818 { }
819};
820
821MODULE_DEVICE_TABLE(mdio, broadcom_tbl);