Lines Matching refs: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) in bcm54xx_config_clock_delay() argument
34 val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); in bcm54xx_config_clock_delay()
36 if (phydev->interface == PHY_INTERFACE_MODE_RGMII || in bcm54xx_config_clock_delay()
37 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { in bcm54xx_config_clock_delay()
41 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in bcm54xx_config_clock_delay()
42 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { in bcm54xx_config_clock_delay()
46 rc = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, in bcm54xx_config_clock_delay()
52 val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL); in bcm54xx_config_clock_delay()
53 if (phydev->interface == PHY_INTERFACE_MODE_RGMII || in bcm54xx_config_clock_delay()
54 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { in bcm54xx_config_clock_delay()
58 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in bcm54xx_config_clock_delay()
59 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { in bcm54xx_config_clock_delay()
63 rc = bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val); in bcm54xx_config_clock_delay()
70 static int bcm54210e_config_init(struct phy_device *phydev) in bcm54210e_config_init() argument
74 bcm54xx_config_clock_delay(phydev); in bcm54210e_config_init()
76 if (phydev->dev_flags & PHY_BRCM_EN_MASTER_MODE) { in bcm54210e_config_init()
77 val = phy_read(phydev, MII_CTRL1000); in bcm54210e_config_init()
79 phy_write(phydev, MII_CTRL1000, val); in bcm54210e_config_init()
85 static int bcm54612e_config_init(struct phy_device *phydev) in bcm54612e_config_init() argument
89 bcm54xx_config_clock_delay(phydev); in bcm54612e_config_init()
92 if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) { in bcm54612e_config_init()
95 reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0); in bcm54612e_config_init()
96 err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0, in bcm54612e_config_init()
106 static int bcm54616s_config_init(struct phy_device *phydev) in bcm54616s_config_init() argument
110 if (phydev->interface != PHY_INTERFACE_MODE_SGMII && in bcm54616s_config_init()
111 phydev->interface != PHY_INTERFACE_MODE_1000BASEX) in bcm54616s_config_init()
116 val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); in bcm54616s_config_init()
121 rc = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, in bcm54616s_config_init()
127 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE); in bcm54616s_config_init()
131 rc = bcm_phy_write_shadow(phydev, BCM54XX_SHD_MODE, val); in bcm54616s_config_init()
136 rc = phy_set_bits(phydev, MII_BMCR, BMCR_PDOWN); in bcm54616s_config_init()
142 val |= phydev->interface == PHY_INTERFACE_MODE_SGMII ? in bcm54616s_config_init()
145 rc = bcm_phy_write_shadow(phydev, BCM54XX_SHD_MODE, val); in bcm54616s_config_init()
150 rc = phy_clear_bits(phydev, MII_BMCR, BMCR_PDOWN); in bcm54616s_config_init()
156 rc = bcm_phy_write_shadow(phydev, BCM54XX_SHD_MODE, val); in bcm54616s_config_init()
161 return phy_clear_bits(phydev, MII_BMCR, BMCR_PDOWN); in bcm54616s_config_init()
165 static int bcm50610_a0_workaround(struct phy_device *phydev) in bcm50610_a0_workaround() argument
169 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH0, in bcm50610_a0_workaround()
175 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH3, in bcm50610_a0_workaround()
180 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, in bcm50610_a0_workaround()
185 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP96, in bcm50610_a0_workaround()
190 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP97, in bcm50610_a0_workaround()
196 static int bcm54xx_phydsp_config(struct phy_device *phydev) in bcm54xx_phydsp_config() argument
201 err = bcm54xx_auxctl_write(phydev, in bcm54xx_phydsp_config()
208 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || in bcm54xx_phydsp_config()
209 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) { in bcm54xx_phydsp_config()
211 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP08, in bcm54xx_phydsp_config()
216 if (phydev->drv->phy_id == PHY_ID_BCM50610) { in bcm54xx_phydsp_config()
217 err = bcm50610_a0_workaround(phydev); in bcm54xx_phydsp_config()
223 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM57780) { in bcm54xx_phydsp_config()
226 val = bcm_phy_read_exp(phydev, MII_BCM54XX_EXP_EXP75); in bcm54xx_phydsp_config()
231 err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, val); in bcm54xx_phydsp_config()
236 err2 = bcm54xx_auxctl_write(phydev, in bcm54xx_phydsp_config()
244 static void bcm54xx_adjust_rxrefclk(struct phy_device *phydev) in bcm54xx_adjust_rxrefclk() argument
251 if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM57780 && in bcm54xx_adjust_rxrefclk()
252 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610 && in bcm54xx_adjust_rxrefclk()
253 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610M && in bcm54xx_adjust_rxrefclk()
254 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54210E && in bcm54xx_adjust_rxrefclk()
255 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54810 && in bcm54xx_adjust_rxrefclk()
256 BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54811) in bcm54xx_adjust_rxrefclk()
259 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3); in bcm54xx_adjust_rxrefclk()
265 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || in bcm54xx_adjust_rxrefclk()
266 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) && in bcm54xx_adjust_rxrefclk()
267 BRCM_PHY_REV(phydev) >= 0x3) { in bcm54xx_adjust_rxrefclk()
274 if (phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) { in bcm54xx_adjust_rxrefclk()
275 if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM54811) { in bcm54xx_adjust_rxrefclk()
283 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) in bcm54xx_adjust_rxrefclk()
288 if (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) { in bcm54xx_adjust_rxrefclk()
289 if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E || in bcm54xx_adjust_rxrefclk()
290 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810 || in bcm54xx_adjust_rxrefclk()
291 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54811) in bcm54xx_adjust_rxrefclk()
298 bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val); in bcm54xx_adjust_rxrefclk()
300 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD); in bcm54xx_adjust_rxrefclk()
306 if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) in bcm54xx_adjust_rxrefclk()
312 bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val); in bcm54xx_adjust_rxrefclk()
315 static int bcm54xx_config_init(struct phy_device *phydev) in bcm54xx_config_init() argument
319 reg = phy_read(phydev, MII_BCM54XX_ECR); in bcm54xx_config_init()
325 err = phy_write(phydev, MII_BCM54XX_ECR, reg); in bcm54xx_config_init()
333 err = phy_write(phydev, MII_BCM54XX_IMR, reg); in bcm54xx_config_init()
337 if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || in bcm54xx_config_init()
338 BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) && in bcm54xx_config_init()
339 (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE)) in bcm54xx_config_init()
340 bcm_phy_write_shadow(phydev, BCM54XX_SHD_RGMII_MODE, 0); in bcm54xx_config_init()
342 bcm54xx_adjust_rxrefclk(phydev); in bcm54xx_config_init()
344 switch (BRCM_PHY_MODEL(phydev)) { in bcm54xx_config_init()
347 err = bcm54xx_config_clock_delay(phydev); in bcm54xx_config_init()
350 err = bcm54210e_config_init(phydev); in bcm54xx_config_init()
353 err = bcm54612e_config_init(phydev); in bcm54xx_config_init()
356 err = bcm54616s_config_init(phydev); in bcm54xx_config_init()
360 val = bcm_phy_read_exp(phydev, in bcm54xx_config_init()
363 err = bcm_phy_write_exp(phydev, in bcm54xx_config_init()
371 bcm54xx_phydsp_config(phydev); in bcm54xx_config_init()
381 if (!phy_on_sfp(phydev)) { in bcm54xx_config_init()
384 bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1, val); in bcm54xx_config_init()
389 bcm_phy_write_exp(phydev, BCM_EXP_MULTICOLOR, val); in bcm54xx_config_init()
395 static int bcm54xx_iddq_set(struct phy_device *phydev, bool enable) in bcm54xx_iddq_set() argument
399 if (!(phydev->dev_flags & PHY_BRCM_IDDQ_SUSPEND)) in bcm54xx_iddq_set()
402 ret = bcm_phy_read_exp(phydev, BCM54XX_TOP_MISC_IDDQ_CTRL); in bcm54xx_iddq_set()
411 ret = bcm_phy_write_exp(phydev, BCM54XX_TOP_MISC_IDDQ_CTRL, ret); in bcm54xx_iddq_set()
416 static int bcm54xx_suspend(struct phy_device *phydev) in bcm54xx_suspend() argument
424 ret = phy_write(phydev, MII_BMCR, BMCR_PDOWN); in bcm54xx_suspend()
428 return bcm54xx_iddq_set(phydev, true); in bcm54xx_suspend()
431 static int bcm54xx_resume(struct phy_device *phydev) in bcm54xx_resume() argument
435 ret = bcm54xx_iddq_set(phydev, false); in bcm54xx_resume()
442 ret = genphy_resume(phydev); in bcm54xx_resume()
454 if (phydev->dev_flags & PHY_BRCM_IDDQ_SUSPEND) { in bcm54xx_resume()
455 ret = genphy_soft_reset(phydev); in bcm54xx_resume()
460 return bcm54xx_config_init(phydev); in bcm54xx_resume()
463 static int bcm54811_config_init(struct phy_device *phydev) in bcm54811_config_init() argument
468 reg = bcm_phy_read_exp(phydev, BCM54810_EXP_BROADREACH_LRE_MISC_CTL); in bcm54811_config_init()
470 err = bcm_phy_write_exp(phydev, BCM54810_EXP_BROADREACH_LRE_MISC_CTL, in bcm54811_config_init()
475 err = bcm54xx_config_init(phydev); in bcm54811_config_init()
478 if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) { in bcm54811_config_init()
479 reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0); in bcm54811_config_init()
480 err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0, in bcm54811_config_init()
489 static int bcm5481_config_aneg(struct phy_device *phydev) in bcm5481_config_aneg() argument
491 struct device_node *np = phydev->mdio.dev.of_node; in bcm5481_config_aneg()
495 ret = genphy_config_aneg(phydev); in bcm5481_config_aneg()
498 bcm54xx_config_clock_delay(phydev); in bcm5481_config_aneg()
502 ret = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_SEL_ER + 0x9, in bcm5481_config_aneg()
515 static int bcm54616s_probe(struct phy_device *phydev) in bcm54616s_probe() argument
520 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL); in bcm54616s_probe()
524 phydev->priv = priv; in bcm54616s_probe()
526 val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_MODE); in bcm54616s_probe()
537 val = bcm_phy_read_shadow(phydev, BCM54616S_SHD_100FX_CTRL); in bcm54616s_probe()
549 phydev->port = PORT_FIBRE; in bcm54616s_probe()
555 static int bcm54616s_config_aneg(struct phy_device *phydev) in bcm54616s_config_aneg() argument
557 struct bcm54616s_phy_priv *priv = phydev->priv; in bcm54616s_config_aneg()
562 ret = genphy_c37_config_aneg(phydev); in bcm54616s_config_aneg()
564 ret = genphy_config_aneg(phydev); in bcm54616s_config_aneg()
567 bcm54xx_config_clock_delay(phydev); in bcm54616s_config_aneg()
572 static int bcm54616s_read_status(struct phy_device *phydev) in bcm54616s_read_status() argument
574 struct bcm54616s_phy_priv *priv = phydev->priv; in bcm54616s_read_status()
578 err = genphy_c37_read_status(phydev); in bcm54616s_read_status()
580 err = genphy_read_status(phydev); in bcm54616s_read_status()
585 static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set) in brcm_phy_setbits() argument
589 val = phy_read(phydev, reg); in brcm_phy_setbits()
593 return phy_write(phydev, reg, val | set); in brcm_phy_setbits()
596 static int brcm_fet_config_init(struct phy_device *phydev) in brcm_fet_config_init() argument
601 err = phy_write(phydev, MII_BMCR, BMCR_RESET); in brcm_fet_config_init()
605 reg = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_config_init()
616 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); in brcm_fet_config_init()
621 brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST); in brcm_fet_config_init()
627 err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg); in brcm_fet_config_init()
632 reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4); in brcm_fet_config_init()
641 err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg); in brcm_fet_config_init()
646 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL, in brcm_fet_config_init()
651 if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) { in brcm_fet_config_init()
653 err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2, in brcm_fet_config_init()
659 err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest); in brcm_fet_config_init()
666 static int brcm_fet_ack_interrupt(struct phy_device *phydev) in brcm_fet_ack_interrupt() argument
671 reg = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_ack_interrupt()
678 static int brcm_fet_config_intr(struct phy_device *phydev) in brcm_fet_config_intr() argument
682 reg = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_config_intr()
686 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { in brcm_fet_config_intr()
687 err = brcm_fet_ack_interrupt(phydev); in brcm_fet_config_intr()
692 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); in brcm_fet_config_intr()
695 err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); in brcm_fet_config_intr()
699 err = brcm_fet_ack_interrupt(phydev); in brcm_fet_config_intr()
705 static irqreturn_t brcm_fet_handle_interrupt(struct phy_device *phydev) in brcm_fet_handle_interrupt() argument
709 irq_status = phy_read(phydev, MII_BRCM_FET_INTREG); in brcm_fet_handle_interrupt()
711 phy_error(phydev); in brcm_fet_handle_interrupt()
718 phy_trigger_machine(phydev); in brcm_fet_handle_interrupt()
727 static int bcm54xx_phy_probe(struct phy_device *phydev) in bcm54xx_phy_probe() argument
731 priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL); in bcm54xx_phy_probe()
735 phydev->priv = priv; in bcm54xx_phy_probe()
737 priv->stats = devm_kcalloc(&phydev->mdio.dev, in bcm54xx_phy_probe()
738 bcm_phy_get_sset_count(phydev), sizeof(u64), in bcm54xx_phy_probe()
746 static void bcm54xx_get_stats(struct phy_device *phydev, in bcm54xx_get_stats() argument
749 struct bcm54xx_phy_priv *priv = phydev->priv; in bcm54xx_get_stats()
751 bcm_phy_get_stats(phydev, priv->stats, stats, data); in bcm54xx_get_stats()
754 static void bcm54xx_link_change_notify(struct phy_device *phydev) in bcm54xx_link_change_notify() argument
760 if (phydev->state != PHY_RUNNING) in bcm54xx_link_change_notify()
766 if (!(phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) in bcm54xx_link_change_notify()
769 ret = bcm_phy_read_exp(phydev, MII_BCM54XX_EXP_EXP08); in bcm54xx_link_change_notify()
777 if (phydev->speed == SPEED_10) in bcm54xx_link_change_notify()
781 bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP08, ret); in bcm54xx_link_change_notify()