Lines Matching full:phydev
19 #define BRCM_PHY_MODEL(phydev) \ argument
20 ((phydev)->drv->phy_id & (phydev)->drv->phy_id_mask)
22 #define BRCM_PHY_REV(phydev) \ argument
23 ((phydev)->drv->phy_id & ~((phydev)->drv->phy_id_mask))
29 static int bcm54xx_config_clock_delay(struct phy_device *phydev);
31 static int bcm54210e_config_init(struct phy_device *phydev) in bcm54210e_config_init() argument
35 bcm54xx_config_clock_delay(phydev); in bcm54210e_config_init()
37 if (phydev->dev_flags & PHY_BRCM_EN_MASTER_MODE) { in bcm54210e_config_init()
38 val = phy_read(phydev, MII_CTRL1000); in bcm54210e_config_init()
40 phy_write(phydev, MII_CTRL1000, val); in bcm54210e_config_init()
46 static int bcm54612e_config_init(struct phy_device *phydev) in bcm54612e_config_init() argument
50 bcm54xx_config_clock_delay(phydev); in bcm54612e_config_init()
53 if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) { in bcm54612e_config_init()
56 reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0); in bcm54612e_config_init()
57 err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0, in bcm54612e_config_init()
67 static int bcm54xx_config_clock_delay(struct phy_device *phydev) in bcm54xx_config_clock_delay() argument
72 val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); in bcm54xx_config_clock_delay()
74 if (phydev->interface == PHY_INTERFACE_MODE_RGMII || in bcm54xx_config_clock_delay()
75 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { in bcm54xx_config_clock_delay()
79 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in bcm54xx_config_clock_delay()
80 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { in bcm54xx_config_clock_delay()
84 rc = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, in bcm54xx_config_clock_delay()
90 val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL); in bcm54xx_config_clock_delay()
91 if (phydev->interface == PHY_INTERFACE_MODE_RGMII || in bcm54xx_config_clock_delay()
92 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { in bcm54xx_config_clock_delay()
96 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in bcm54xx_config_clock_delay()
97 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { in bcm54xx_config_clock_delay()
101 rc = bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val); in bcm54xx_config_clock_delay()
109 static int bcm50610_a0_workaround(struct phy_device *phydev) in bcm50610_a0_workaround() argument
113 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH0, in bcm50610_a0_workaround()
119 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH3, in bcm50610_a0_workaround()
124 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, in bcm50610_a0_workaround()
129 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP96, in bcm50610_a0_workaround()
134 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP97, in bcm50610_a0_workaround()
140 static int bcm54xx_phydsp_config(struct phy_device *phydev) in bcm54xx_phydsp_config() argument
145 err = bcm54xx_auxctl_write(phydev, in bcm54xx_phydsp_config()
152 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || in bcm54xx_phydsp_config()
153 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) { in bcm54xx_phydsp_config()
155 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP08, in bcm54xx_phydsp_config()
160 if (phydev->drv->phy_id == PHY_ID_BCM50610) { in bcm54xx_phydsp_config()
161 err = bcm50610_a0_workaround(phydev); in bcm54xx_phydsp_config()
167 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM57780) { in bcm54xx_phydsp_config()
170 val = bcm_phy_read_exp(phydev, MII_BCM54XX_EXP_EXP75); in bcm54xx_phydsp_config()
175 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, val); in bcm54xx_phydsp_config()
180 err2 = bcm54xx_auxctl_write(phydev, in bcm54xx_phydsp_config()
188 static void bcm54xx_adjust_rxrefclk(struct phy_device *phydev) in bcm54xx_adjust_rxrefclk() argument
195 if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM57780 && in bcm54xx_adjust_rxrefclk()
196 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610 && in bcm54xx_adjust_rxrefclk()
197 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610M && in bcm54xx_adjust_rxrefclk()
198 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54810 && in bcm54xx_adjust_rxrefclk()
199 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54811) in bcm54xx_adjust_rxrefclk()
202 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3); in bcm54xx_adjust_rxrefclk()
208 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || in bcm54xx_adjust_rxrefclk()
209 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) && in bcm54xx_adjust_rxrefclk()
210 BRCM_PHY_REV(phydev) >= 0x3) { in bcm54xx_adjust_rxrefclk()
217 if (phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) { in bcm54xx_adjust_rxrefclk()
218 if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54811) { in bcm54xx_adjust_rxrefclk()
226 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) in bcm54xx_adjust_rxrefclk()
231 if (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) { in bcm54xx_adjust_rxrefclk()
232 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810 || in bcm54xx_adjust_rxrefclk()
233 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54811) in bcm54xx_adjust_rxrefclk()
240 bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val); in bcm54xx_adjust_rxrefclk()
242 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD); in bcm54xx_adjust_rxrefclk()
248 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) in bcm54xx_adjust_rxrefclk()
254 bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val); in bcm54xx_adjust_rxrefclk()
257 static int bcm54xx_config_init(struct phy_device *phydev) in bcm54xx_config_init() argument
261 reg = phy_read(phydev, MII_BCM54XX_ECR); in bcm54xx_config_init()
267 err = phy_write(phydev, MII_BCM54XX_ECR, reg); in bcm54xx_config_init()
275 err = phy_write(phydev, MII_BCM54XX_IMR, reg); in bcm54xx_config_init()
279 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || in bcm54xx_config_init()
280 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) && in bcm54xx_config_init()
281 (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE)) in bcm54xx_config_init()
282 bcm_phy_write_shadow(phydev, BCM54XX_SHD_RGMII_MODE, 0); in bcm54xx_config_init()
284 bcm54xx_adjust_rxrefclk(phydev); in bcm54xx_config_init()
286 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E) { in bcm54xx_config_init()
287 err = bcm54210e_config_init(phydev); in bcm54xx_config_init()
290 } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54612E) { in bcm54xx_config_init()
291 err = bcm54612e_config_init(phydev); in bcm54xx_config_init()
294 } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) { in bcm54xx_config_init()
296 val = bcm_phy_read_exp(phydev, in bcm54xx_config_init()
299 err = bcm_phy_write_exp(phydev, in bcm54xx_config_init()
306 bcm54xx_phydsp_config(phydev); in bcm54xx_config_init()
314 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1, val); in bcm54xx_config_init()
319 bcm_phy_write_exp(phydev, BCM_EXP_MULTICOLOR, val); in bcm54xx_config_init()
324 static int bcm54xx_resume(struct phy_device *phydev) in bcm54xx_resume() argument
331 ret = genphy_resume(phydev); in bcm54xx_resume()
335 return bcm54xx_config_init(phydev); in bcm54xx_resume()
338 static int bcm54811_config_init(struct phy_device *phydev) in bcm54811_config_init() argument
343 reg = bcm_phy_read_exp(phydev, BCM54810_EXP_BROADREACH_LRE_MISC_CTL); in bcm54811_config_init()
345 err = bcm_phy_write_exp(phydev, BCM54810_EXP_BROADREACH_LRE_MISC_CTL, in bcm54811_config_init()
350 err = bcm54xx_config_init(phydev); in bcm54811_config_init()
353 if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) { in bcm54811_config_init()
354 reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0); in bcm54811_config_init()
355 err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0, in bcm54811_config_init()
364 static int bcm5482_config_init(struct phy_device *phydev) in bcm5482_config_init() argument
368 err = bcm54xx_config_init(phydev); in bcm5482_config_init()
370 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) { in bcm5482_config_init()
374 reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_SSD); in bcm5482_config_init()
375 bcm_phy_write_shadow(phydev, BCM5482_SHD_SSD, in bcm5482_config_init()
384 err = bcm_phy_read_exp(phydev, reg); in bcm5482_config_init()
387 err = bcm_phy_write_exp(phydev, reg, err | in bcm5482_config_init()
397 err = bcm_phy_read_exp(phydev, reg); in bcm5482_config_init()
400 err = bcm_phy_write_exp(phydev, reg, in bcm5482_config_init()
408 reg = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE); in bcm5482_config_init()
409 bcm_phy_write_shadow(phydev, BCM54XX_SHD_MODE, in bcm5482_config_init()
416 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1, in bcm5482_config_init()
426 phydev->autoneg = AUTONEG_DISABLE; in bcm5482_config_init()
427 phydev->speed = SPEED_1000; in bcm5482_config_init()
428 phydev->duplex = DUPLEX_FULL; in bcm5482_config_init()
434 static int bcm5482_read_status(struct phy_device *phydev) in bcm5482_read_status() argument
438 err = genphy_read_status(phydev); in bcm5482_read_status()
440 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) { in bcm5482_read_status()
445 if (phydev->link) { in bcm5482_read_status()
446 phydev->speed = SPEED_1000; in bcm5482_read_status()
447 phydev->duplex = DUPLEX_FULL; in bcm5482_read_status()
454 static int bcm5481_config_aneg(struct phy_device *phydev) in bcm5481_config_aneg() argument
456 struct device_node *np = phydev->mdio.dev.of_node; in bcm5481_config_aneg()
460 ret = genphy_config_aneg(phydev); in bcm5481_config_aneg()
463 bcm54xx_config_clock_delay(phydev); in bcm5481_config_aneg()
467 ret = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_SEL_ER + 0x9, in bcm5481_config_aneg()
476 static int bcm54616s_probe(struct phy_device *phydev) in bcm54616s_probe() argument
480 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE); in bcm54616s_probe()
492 val = bcm_phy_read_shadow(phydev, BCM54616S_SHD_100FX_CTRL); in bcm54616s_probe()
502 phydev->dev_flags |= PHY_BCM_FLAGS_MODE_1000BX; in bcm54616s_probe()
508 static int bcm54616s_config_aneg(struct phy_device *phydev) in bcm54616s_config_aneg() argument
513 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) in bcm54616s_config_aneg()
514 ret = genphy_c37_config_aneg(phydev); in bcm54616s_config_aneg()
516 ret = genphy_config_aneg(phydev); in bcm54616s_config_aneg()
519 bcm54xx_config_clock_delay(phydev); in bcm54616s_config_aneg()
524 static int bcm54616s_read_status(struct phy_device *phydev) in bcm54616s_read_status() argument
528 if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) in bcm54616s_read_status()
529 err = genphy_c37_read_status(phydev); in bcm54616s_read_status()
531 err = genphy_read_status(phydev); in bcm54616s_read_status()
536 static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set) in brcm_phy_setbits() argument
540 val = phy_read(phydev, reg); in brcm_phy_setbits()
544 return phy_write(phydev, reg, val | set); in brcm_phy_setbits()
547 static int brcm_fet_config_init(struct phy_device *phydev) in brcm_fet_config_init() argument
552 err = phy_write(phydev, MII_BMCR, BMCR_RESET); in brcm_fet_config_init()
556 reg = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_config_init()
567 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); in brcm_fet_config_init()
572 brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST); in brcm_fet_config_init()
578 err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg); in brcm_fet_config_init()
583 reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4); in brcm_fet_config_init()
592 err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg); in brcm_fet_config_init()
597 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL, in brcm_fet_config_init()
602 if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) { in brcm_fet_config_init()
604 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2, in brcm_fet_config_init()
610 err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest); in brcm_fet_config_init()
617 static int brcm_fet_ack_interrupt(struct phy_device *phydev) in brcm_fet_ack_interrupt() argument
622 reg = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_ack_interrupt()
629 static int brcm_fet_config_intr(struct phy_device *phydev) in brcm_fet_config_intr() argument
633 reg = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_config_intr()
637 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) in brcm_fet_config_intr()
642 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); in brcm_fet_config_intr()
650 static int bcm53xx_phy_probe(struct phy_device *phydev) in bcm53xx_phy_probe() argument
654 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL); in bcm53xx_phy_probe()
658 phydev->priv = priv; in bcm53xx_phy_probe()
660 priv->stats = devm_kcalloc(&phydev->mdio.dev, in bcm53xx_phy_probe()
661 bcm_phy_get_sset_count(phydev), sizeof(u64), in bcm53xx_phy_probe()
669 static void bcm53xx_phy_get_stats(struct phy_device *phydev, in bcm53xx_phy_get_stats() argument
672 struct bcm53xx_phy_priv *priv = phydev->priv; in bcm53xx_phy_get_stats()
674 bcm_phy_get_stats(phydev, priv->stats, stats, data); in bcm53xx_phy_get_stats()