]> git.proxmox.com Git - mirror_ubuntu-jammy-kernel.git/blame - drivers/net/phy/broadcom.c
net: phy: broadcom: Allow BCM54810 to use bcm54xx_adjust_rxrefclk()
[mirror_ubuntu-jammy-kernel.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
52fae083
MC
228 if (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY)
229 val |= BCM54XX_SHD_SCR3_TRDDAPD;
230
32e5a8d6 231 if (orig != val)
a1cba561 232 bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val);
c704dc23 233
a1cba561 234 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD);
c704dc23
MC
235 if (val < 0)
236 return;
237
238 orig = val;
239
23677ce3 240 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
c704dc23
MC
241 val |= BCM54XX_SHD_APD_EN;
242 else
243 val &= ~BCM54XX_SHD_APD_EN;
244
245 if (orig != val)
a1cba561 246 bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val);
32e5a8d6
MC
247}
248
c4b41c9f
MR
249static int bcm54xx_config_init(struct phy_device *phydev)
250{
73333626 251 int reg, err, val;
c4b41c9f
MR
252
253 reg = phy_read(phydev, MII_BCM54XX_ECR);
254 if (reg < 0)
255 return reg;
256
257 /* Mask interrupts globally. */
258 reg |= MII_BCM54XX_ECR_IM;
259 err = phy_write(phydev, MII_BCM54XX_ECR, reg);
260 if (err < 0)
261 return err;
262
263 /* Unmask events we are interested in. */
264 reg = ~(MII_BCM54XX_INT_DUPLEX |
265 MII_BCM54XX_INT_SPEED |
266 MII_BCM54XX_INT_LINK);
267 err = phy_write(phydev, MII_BCM54XX_IMR, reg);
268 if (err < 0)
269 return err;
772638b6 270
63a14ce4
MC
271 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
272 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) &&
273 (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE))
a1cba561 274 bcm_phy_write_shadow(phydev, BCM54XX_SHD_RGMII_MODE, 0);
63a14ce4 275
c704dc23 276 if ((phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) ||
52fae083 277 (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) ||
c704dc23 278 (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
32e5a8d6
MC
279 bcm54xx_adjust_rxrefclk(phydev);
280
0fc9ae10
RM
281 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E) {
282 err = bcm54210e_config_init(phydev);
283 if (err)
284 return err;
62e13097
RM
285 } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54612E) {
286 err = bcm54612e_config_init(phydev);
287 if (err)
288 return err;
0fc9ae10 289 } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) {
73333626
AS
290 /* For BCM54810, we need to disable BroadR-Reach function */
291 val = bcm_phy_read_exp(phydev,
292 BCM54810_EXP_BROADREACH_LRE_MISC_CTL);
293 val &= ~BCM54810_EXP_BROADREACH_LRE_MISC_CTL_EN;
294 err = bcm_phy_write_exp(phydev,
295 BCM54810_EXP_BROADREACH_LRE_MISC_CTL,
296 val);
297 if (err < 0)
b14995ac
JM
298 return err;
299 }
300
47b1b53b 301 bcm54xx_phydsp_config(phydev);
d9221e66 302
450895d0
VO
303 /* Encode link speed into LED1 and LED3 pair (green/amber).
304 * Also flash these two LEDs on activity. This means configuring
305 * them for MULTICOLOR and encoding link/activity into them.
306 */
307 val = BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_MULTICOLOR1) |
308 BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_MULTICOLOR1);
309 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1, val);
310
311 val = BCM_LED_MULTICOLOR_IN_PHASE |
312 BCM5482_SHD_LEDS1_LED1(BCM_LED_MULTICOLOR_LINK_ACT) |
313 BCM5482_SHD_LEDS1_LED3(BCM_LED_MULTICOLOR_LINK_ACT);
314 bcm_phy_write_exp(phydev, BCM_EXP_MULTICOLOR, val);
315
c4b41c9f
MR
316 return 0;
317}
318
cd9af3da
NC
319static int bcm5482_config_init(struct phy_device *phydev)
320{
321 int err, reg;
322
323 err = bcm54xx_config_init(phydev);
324
325 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
326 /*
327 * Enable secondary SerDes and its use as an LED source
328 */
a1cba561
AP
329 reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_SSD);
330 bcm_phy_write_shadow(phydev, BCM5482_SHD_SSD,
cd9af3da
NC
331 reg |
332 BCM5482_SHD_SSD_LEDM |
333 BCM5482_SHD_SSD_EN);
334
335 /*
336 * Enable SGMII slave mode and auto-detection
337 */
042a75b9 338 reg = BCM5482_SSD_SGMII_SLAVE | MII_BCM54XX_EXP_SEL_SSD;
a1cba561 339 err = bcm_phy_read_exp(phydev, reg);
042a75b9
MC
340 if (err < 0)
341 return err;
a1cba561 342 err = bcm_phy_write_exp(phydev, reg, err |
042a75b9
MC
343 BCM5482_SSD_SGMII_SLAVE_EN |
344 BCM5482_SSD_SGMII_SLAVE_AD);
345 if (err < 0)
346 return err;
cd9af3da
NC
347
348 /*
349 * Disable secondary SerDes powerdown
350 */
042a75b9 351 reg = BCM5482_SSD_1000BX_CTL | MII_BCM54XX_EXP_SEL_SSD;
a1cba561 352 err = bcm_phy_read_exp(phydev, reg);
042a75b9
MC
353 if (err < 0)
354 return err;
a1cba561 355 err = bcm_phy_write_exp(phydev, reg,
042a75b9
MC
356 err & ~BCM5482_SSD_1000BX_CTL_PWRDOWN);
357 if (err < 0)
358 return err;
cd9af3da
NC
359
360 /*
361 * Select 1000BASE-X register set (primary SerDes)
362 */
b9bcb953
TR
363 reg = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE);
364 bcm_phy_write_shadow(phydev, BCM54XX_SHD_MODE,
365 reg | BCM54XX_SHD_MODE_1000BX);
cd9af3da
NC
366
367 /*
368 * LED1=ACTIVITYLED, LED3=LINKSPD[2]
369 * (Use LED1 as secondary SerDes ACTIVITY LED)
370 */
a1cba561 371 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1,
cd9af3da
NC
372 BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_ACTIVITYLED) |
373 BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_LINKSPD2));
374
375 /*
376 * Auto-negotiation doesn't seem to work quite right
377 * in this mode, so we disable it and force it to the
378 * right speed/duplex setting. Only 'link status'
379 * is important.
380 */
381 phydev->autoneg = AUTONEG_DISABLE;
382 phydev->speed = SPEED_1000;
383 phydev->duplex = DUPLEX_FULL;
384 }
385
386 return err;
387}
388
389static int bcm5482_read_status(struct phy_device *phydev)
390{
391 int err;
392
393 err = genphy_read_status(phydev);
394
395 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
396 /*
397 * Only link status matters for 1000Base-X mode, so force
398 * 1000 Mbit/s full-duplex status
399 */
400 if (phydev->link) {
401 phydev->speed = SPEED_1000;
402 phydev->duplex = DUPLEX_FULL;
403 }
404 }
405
406 return err;
407}
408
57bb7e22
AV
409static int bcm5481_config_aneg(struct phy_device *phydev)
410{
b14995ac 411 struct device_node *np = phydev->mdio.dev.of_node;
57bb7e22
AV
412 int ret;
413
414 /* Aneg firsly. */
415 ret = genphy_config_aneg(phydev);
416
417 /* Then we can set up the delay. */
042cb564 418 bcm54xx_config_clock_delay(phydev);
57bb7e22 419
b14995ac
JM
420 if (of_property_read_bool(np, "enet-phy-lane-swap")) {
421 /* Lane Swap - Undocumented register...magic! */
422 ret = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_SEL_ER + 0x9,
423 0x11B);
424 if (ret < 0)
425 return ret;
426 }
427
57bb7e22
AV
428 return ret;
429}
430
b9bcb953
TR
431static int bcm54616s_probe(struct phy_device *phydev)
432{
433 int val, intf_sel;
434
435 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE);
436 if (val < 0)
437 return val;
438
439 /* The PHY is strapped in RGMII-fiber mode when INTERF_SEL[1:0]
440 * is 01b, and the link between PHY and its link partner can be
441 * either 1000Base-X or 100Base-FX.
442 * RGMII-1000Base-X is properly supported, but RGMII-100Base-FX
443 * support is still missing as of now.
444 */
445 intf_sel = (val & BCM54XX_SHD_INTF_SEL_MASK) >> 1;
446 if (intf_sel == 1) {
447 val = bcm_phy_read_shadow(phydev, BCM54616S_SHD_100FX_CTRL);
448 if (val < 0)
449 return val;
450
451 /* Bit 0 of the SerDes 100-FX Control register, when set
452 * to 1, sets the MII/RGMII -> 100BASE-FX configuration.
453 * When this bit is set to 0, it sets the GMII/RGMII ->
454 * 1000BASE-X configuration.
455 */
456 if (!(val & BCM54616S_100FX_MODE))
457 phydev->dev_flags |= PHY_BCM_FLAGS_MODE_1000BX;
458 }
459
460 return 0;
461}
462
042cb564
TR
463static int bcm54616s_config_aneg(struct phy_device *phydev)
464{
465 int ret;
466
467 /* Aneg firsly. */
b9bcb953
TR
468 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX)
469 ret = genphy_c37_config_aneg(phydev);
470 else
471 ret = genphy_config_aneg(phydev);
042cb564
TR
472
473 /* Then we can set up the delay. */
474 bcm54xx_config_clock_delay(phydev);
475
476 return ret;
477}
478
b9bcb953
TR
479static int bcm54616s_read_status(struct phy_device *phydev)
480{
481 int err;
482
483 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX)
484 err = genphy_c37_read_status(phydev);
485 else
486 err = genphy_read_status(phydev);
487
488 return err;
489}
490
d7a2ed92
MC
491static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set)
492{
493 int val;
494
495 val = phy_read(phydev, reg);
496 if (val < 0)
497 return val;
498
499 return phy_write(phydev, reg, val | set);
500}
501
502static int brcm_fet_config_init(struct phy_device *phydev)
503{
504 int reg, err, err2, brcmtest;
505
506 /* Reset the PHY to bring it to a known state. */
507 err = phy_write(phydev, MII_BMCR, BMCR_RESET);
508 if (err < 0)
509 return err;
510
511 reg = phy_read(phydev, MII_BRCM_FET_INTREG);
512 if (reg < 0)
513 return reg;
514
515 /* Unmask events we are interested in and mask interrupts globally. */
516 reg = MII_BRCM_FET_IR_DUPLEX_EN |
517 MII_BRCM_FET_IR_SPEED_EN |
518 MII_BRCM_FET_IR_LINK_EN |
519 MII_BRCM_FET_IR_ENABLE |
520 MII_BRCM_FET_IR_MASK;
521
522 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
523 if (err < 0)
524 return err;
525
526 /* Enable shadow register access */
527 brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST);
528 if (brcmtest < 0)
529 return brcmtest;
530
531 reg = brcmtest | MII_BRCM_FET_BT_SRE;
532
533 err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg);
534 if (err < 0)
535 return err;
536
537 /* Set the LED mode */
538 reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4);
539 if (reg < 0) {
540 err = reg;
541 goto done;
542 }
543
544 reg &= ~MII_BRCM_FET_SHDW_AM4_LED_MASK;
545 reg |= MII_BRCM_FET_SHDW_AM4_LED_MODE1;
546
547 err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg);
548 if (err < 0)
549 goto done;
550
551 /* Enable auto MDIX */
552 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL,
553 MII_BRCM_FET_SHDW_MC_FAME);
554 if (err < 0)
555 goto done;
556
cdd4e09d
MC
557 if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) {
558 /* Enable auto power down */
559 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2,
560 MII_BRCM_FET_SHDW_AS2_APDE);
561 }
d7a2ed92
MC
562
563done:
564 /* Disable shadow register access */
565 err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest);
566 if (!err)
567 err = err2;
568
569 return err;
570}
571
572static int brcm_fet_ack_interrupt(struct phy_device *phydev)
573{
574 int reg;
575
576 /* Clear pending interrupts. */
577 reg = phy_read(phydev, MII_BRCM_FET_INTREG);
578 if (reg < 0)
579 return reg;
580
581 return 0;
582}
583
584static int brcm_fet_config_intr(struct phy_device *phydev)
585{
586 int reg, err;
587
588 reg = phy_read(phydev, MII_BRCM_FET_INTREG);
589 if (reg < 0)
590 return reg;
591
592 if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
593 reg &= ~MII_BRCM_FET_IR_MASK;
594 else
595 reg |= MII_BRCM_FET_IR_MASK;
596
597 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
598 return err;
599}
600
28dc4c8f
FF
601struct bcm53xx_phy_priv {
602 u64 *stats;
603};
604
605static int bcm53xx_phy_probe(struct phy_device *phydev)
606{
607 struct bcm53xx_phy_priv *priv;
608
609 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
610 if (!priv)
611 return -ENOMEM;
612
613 phydev->priv = priv;
614
615 priv->stats = devm_kcalloc(&phydev->mdio.dev,
616 bcm_phy_get_sset_count(phydev), sizeof(u64),
617 GFP_KERNEL);
618 if (!priv->stats)
619 return -ENOMEM;
620
621 return 0;
622}
623
624static void bcm53xx_phy_get_stats(struct phy_device *phydev,
625 struct ethtool_stats *stats, u64 *data)
626{
627 struct bcm53xx_phy_priv *priv = phydev->priv;
628
629 bcm_phy_get_stats(phydev, priv->stats, stats, data);
630}
631
d5bf9071
CH
632static struct phy_driver broadcom_drivers[] = {
633{
fcb26ec5 634 .phy_id = PHY_ID_BCM5411,
c4b41c9f
MR
635 .phy_id_mask = 0xfffffff0,
636 .name = "Broadcom BCM5411",
dcdecdcf 637 /* PHY_GBIT_FEATURES */
c4b41c9f 638 .config_init = bcm54xx_config_init,
a1cba561
AP
639 .ack_interrupt = bcm_phy_ack_intr,
640 .config_intr = bcm_phy_config_intr,
d5bf9071 641}, {
fcb26ec5 642 .phy_id = PHY_ID_BCM5421,
c4b41c9f
MR
643 .phy_id_mask = 0xfffffff0,
644 .name = "Broadcom BCM5421",
dcdecdcf 645 /* PHY_GBIT_FEATURES */
c4b41c9f 646 .config_init = bcm54xx_config_init,
a1cba561
AP
647 .ack_interrupt = bcm_phy_ack_intr,
648 .config_intr = bcm_phy_config_intr,
0fc9ae10
RM
649}, {
650 .phy_id = PHY_ID_BCM54210E,
651 .phy_id_mask = 0xfffffff0,
652 .name = "Broadcom BCM54210E",
dcdecdcf 653 /* PHY_GBIT_FEATURES */
0fc9ae10 654 .config_init = bcm54xx_config_init,
0fc9ae10
RM
655 .ack_interrupt = bcm_phy_ack_intr,
656 .config_intr = bcm_phy_config_intr,
d5bf9071 657}, {
fcb26ec5 658 .phy_id = PHY_ID_BCM5461,
c4b41c9f
MR
659 .phy_id_mask = 0xfffffff0,
660 .name = "Broadcom BCM5461",
dcdecdcf 661 /* PHY_GBIT_FEATURES */
c4b41c9f 662 .config_init = bcm54xx_config_init,
a1cba561
AP
663 .ack_interrupt = bcm_phy_ack_intr,
664 .config_intr = bcm_phy_config_intr,
d92ead16
XW
665}, {
666 .phy_id = PHY_ID_BCM54612E,
667 .phy_id_mask = 0xfffffff0,
668 .name = "Broadcom BCM54612E",
dcdecdcf 669 /* PHY_GBIT_FEATURES */
d92ead16 670 .config_init = bcm54xx_config_init,
d92ead16
XW
671 .ack_interrupt = bcm_phy_ack_intr,
672 .config_intr = bcm_phy_config_intr,
3bca4cf6
AIB
673}, {
674 .phy_id = PHY_ID_BCM54616S,
675 .phy_id_mask = 0xfffffff0,
676 .name = "Broadcom BCM54616S",
dcdecdcf 677 /* PHY_GBIT_FEATURES */
3bca4cf6 678 .config_init = bcm54xx_config_init,
042cb564 679 .config_aneg = bcm54616s_config_aneg,
a1cba561
AP
680 .ack_interrupt = bcm_phy_ack_intr,
681 .config_intr = bcm_phy_config_intr,
b9bcb953
TR
682 .read_status = bcm54616s_read_status,
683 .probe = bcm54616s_probe,
d5bf9071 684}, {
fcb26ec5 685 .phy_id = PHY_ID_BCM5464,
b1394f96
PG
686 .phy_id_mask = 0xfffffff0,
687 .name = "Broadcom BCM5464",
dcdecdcf 688 /* PHY_GBIT_FEATURES */
b1394f96 689 .config_init = bcm54xx_config_init,
a1cba561
AP
690 .ack_interrupt = bcm_phy_ack_intr,
691 .config_intr = bcm_phy_config_intr,
283da99a
VO
692 .suspend = genphy_suspend,
693 .resume = genphy_resume,
d5bf9071 694}, {
fcb26ec5 695 .phy_id = PHY_ID_BCM5481,
57bb7e22
AV
696 .phy_id_mask = 0xfffffff0,
697 .name = "Broadcom BCM5481",
dcdecdcf 698 /* PHY_GBIT_FEATURES */
57bb7e22 699 .config_init = bcm54xx_config_init,
9753c21f 700 .config_aneg = bcm5481_config_aneg,
a1cba561
AP
701 .ack_interrupt = bcm_phy_ack_intr,
702 .config_intr = bcm_phy_config_intr,
b14995ac
JM
703}, {
704 .phy_id = PHY_ID_BCM54810,
705 .phy_id_mask = 0xfffffff0,
706 .name = "Broadcom BCM54810",
dcdecdcf 707 /* PHY_GBIT_FEATURES */
b14995ac 708 .config_init = bcm54xx_config_init,
9753c21f 709 .config_aneg = bcm5481_config_aneg,
b14995ac
JM
710 .ack_interrupt = bcm_phy_ack_intr,
711 .config_intr = bcm_phy_config_intr,
d5bf9071 712}, {
fcb26ec5 713 .phy_id = PHY_ID_BCM5482,
03157ac3
NC
714 .phy_id_mask = 0xfffffff0,
715 .name = "Broadcom BCM5482",
dcdecdcf 716 /* PHY_GBIT_FEATURES */
cd9af3da 717 .config_init = bcm5482_config_init,
9753c21f 718 .read_status = bcm5482_read_status,
a1cba561
AP
719 .ack_interrupt = bcm_phy_ack_intr,
720 .config_intr = bcm_phy_config_intr,
d5bf9071 721}, {
772638b6
MC
722 .phy_id = PHY_ID_BCM50610,
723 .phy_id_mask = 0xfffffff0,
724 .name = "Broadcom BCM50610",
dcdecdcf 725 /* PHY_GBIT_FEATURES */
772638b6 726 .config_init = bcm54xx_config_init,
a1cba561
AP
727 .ack_interrupt = bcm_phy_ack_intr,
728 .config_intr = bcm_phy_config_intr,
d5bf9071 729}, {
4f4598fd
MC
730 .phy_id = PHY_ID_BCM50610M,
731 .phy_id_mask = 0xfffffff0,
732 .name = "Broadcom BCM50610M",
dcdecdcf 733 /* PHY_GBIT_FEATURES */
4f4598fd 734 .config_init = bcm54xx_config_init,
a1cba561
AP
735 .ack_interrupt = bcm_phy_ack_intr,
736 .config_intr = bcm_phy_config_intr,
d5bf9071 737}, {
d9221e66 738 .phy_id = PHY_ID_BCM57780,
2fbb69aa
MC
739 .phy_id_mask = 0xfffffff0,
740 .name = "Broadcom BCM57780",
dcdecdcf 741 /* PHY_GBIT_FEATURES */
2fbb69aa 742 .config_init = bcm54xx_config_init,
a1cba561
AP
743 .ack_interrupt = bcm_phy_ack_intr,
744 .config_intr = bcm_phy_config_intr,
d5bf9071 745}, {
6a443a0f 746 .phy_id = PHY_ID_BCMAC131,
d7a2ed92
MC
747 .phy_id_mask = 0xfffffff0,
748 .name = "Broadcom BCMAC131",
dcdecdcf 749 /* PHY_BASIC_FEATURES */
d7a2ed92 750 .config_init = brcm_fet_config_init,
d7a2ed92
MC
751 .ack_interrupt = brcm_fet_ack_interrupt,
752 .config_intr = brcm_fet_config_intr,
d5bf9071 753}, {
7a938f80
DB
754 .phy_id = PHY_ID_BCM5241,
755 .phy_id_mask = 0xfffffff0,
756 .name = "Broadcom BCM5241",
dcdecdcf 757 /* PHY_BASIC_FEATURES */
7a938f80 758 .config_init = brcm_fet_config_init,
7a938f80
DB
759 .ack_interrupt = brcm_fet_ack_interrupt,
760 .config_intr = brcm_fet_config_intr,
28dc4c8f
FF
761}, {
762 .phy_id = PHY_ID_BCM5395,
763 .phy_id_mask = 0xfffffff0,
764 .name = "Broadcom BCM5395",
765 .flags = PHY_IS_INTERNAL,
dcdecdcf 766 /* PHY_GBIT_FEATURES */
28dc4c8f
FF
767 .get_sset_count = bcm_phy_get_sset_count,
768 .get_strings = bcm_phy_get_strings,
769 .get_stats = bcm53xx_phy_get_stats,
770 .probe = bcm53xx_phy_probe,
23b83922
BV
771}, {
772 .phy_id = PHY_ID_BCM89610,
773 .phy_id_mask = 0xfffffff0,
774 .name = "Broadcom BCM89610",
dcdecdcf 775 /* PHY_GBIT_FEATURES */
23b83922
BV
776 .config_init = bcm54xx_config_init,
777 .ack_interrupt = bcm_phy_ack_intr,
778 .config_intr = bcm_phy_config_intr,
d5bf9071 779} };
7a938f80 780
50fd7150 781module_phy_driver(broadcom_drivers);
4e4f10f6 782
cf93c945 783static struct mdio_device_id __maybe_unused broadcom_tbl[] = {
fcb26ec5
DB
784 { PHY_ID_BCM5411, 0xfffffff0 },
785 { PHY_ID_BCM5421, 0xfffffff0 },
0fc9ae10 786 { PHY_ID_BCM54210E, 0xfffffff0 },
fcb26ec5 787 { PHY_ID_BCM5461, 0xfffffff0 },
d92ead16 788 { PHY_ID_BCM54612E, 0xfffffff0 },
3bca4cf6 789 { PHY_ID_BCM54616S, 0xfffffff0 },
fcb26ec5 790 { PHY_ID_BCM5464, 0xfffffff0 },
3c25a860 791 { PHY_ID_BCM5481, 0xfffffff0 },
b14995ac 792 { PHY_ID_BCM54810, 0xfffffff0 },
fcb26ec5 793 { PHY_ID_BCM5482, 0xfffffff0 },
4e4f10f6
DW
794 { PHY_ID_BCM50610, 0xfffffff0 },
795 { PHY_ID_BCM50610M, 0xfffffff0 },
796 { PHY_ID_BCM57780, 0xfffffff0 },
797 { PHY_ID_BCMAC131, 0xfffffff0 },
7a938f80 798 { PHY_ID_BCM5241, 0xfffffff0 },
28dc4c8f 799 { PHY_ID_BCM5395, 0xfffffff0 },
23b83922 800 { PHY_ID_BCM89610, 0xfffffff0 },
4e4f10f6
DW
801 { }
802};
803
804MODULE_DEVICE_TABLE(mdio, broadcom_tbl);