[PATCH 6/7] net: phy: Add pm support to Broadcom iProc mdio mux driver
From: Arun Parameswaran <hidden>
Date: 2018-07-26 18:36:46
Also in:
linux-arm-kernel, linux-devicetree, lkml
Subsystem:
ethernet phy library, networking drivers, the rest · Maintainers:
Andrew Lunn, Heiner Kallweit, "David S. Miller", Eric Dumazet, Jakub Kicinski, Paolo Abeni, Linus Torvalds
Add support for suspend and resume to the Broadcom iProc mdio mux driver. Signed-off-by: Arun Parameswaran <redacted> --- drivers/net/phy/mdio-mux-bcm-iproc.c | 42 ++++++++++++++++++++++++++++++++++++ 1 file changed, 42 insertions(+)
diff --git a/drivers/net/phy/mdio-mux-bcm-iproc.c b/drivers/net/phy/mdio-mux-bcm-iproc.c
index 6b400dd..89c18d6 100644
--- a/drivers/net/phy/mdio-mux-bcm-iproc.c
+++ b/drivers/net/phy/mdio-mux-bcm-iproc.c@@ -51,13 +51,25 @@ #define MDIO_OPERATING_FREQUENCY 11000000 #define MDIO_RATE_ADJ_DIVIDENT 1 +#define MDIO_NUM_OF_REGS_TO_RESTORE 2 + struct iproc_mdiomux_desc { void *mux_handle; void __iomem *base; struct device *dev; struct mii_bus *mii_bus; struct clk *core_clk; +#ifdef CONFIG_PM_SLEEP + u32 restore_regs[MDIO_NUM_OF_REGS_TO_RESTORE]; +#endif +}; + +#ifdef CONFIG_PM_SLEEP +static const u16 restore_reg_offsets[MDIO_NUM_OF_REGS_TO_RESTORE] = { + MDIO_RATE_ADJ_EXT_OFFSET, + MDIO_RATE_ADJ_INT_OFFSET, }; +#endif static void mdio_mux_iproc_config_clk(struct iproc_mdiomux_desc *md) {
@@ -258,6 +270,35 @@ static int mdio_mux_iproc_remove(struct platform_device *pdev) return 0; } +#ifdef CONFIG_PM_SLEEP +static int mdio_mux_iproc_suspend(struct device *dev) +{ + int i; + struct iproc_mdiomux_desc *md = dev_get_drvdata(dev); + + for (i = 0; i < MDIO_NUM_OF_REGS_TO_RESTORE; i++) + md->restore_regs[i] = readl(md->base + + restore_reg_offsets[i]); + + return 0; +} + +static int mdio_mux_iproc_resume(struct device *dev) +{ + int i; + struct iproc_mdiomux_desc *md = dev_get_drvdata(dev); + + for (i = 0; i < MDIO_NUM_OF_REGS_TO_RESTORE; i++) + writel(md->restore_regs[i], + md->base + restore_reg_offsets[i]); + + return 0; +} +#endif + +static SIMPLE_DEV_PM_OPS(mdio_mux_iproc_pm_ops, + mdio_mux_iproc_suspend, mdio_mux_iproc_resume); + static const struct of_device_id mdio_mux_iproc_match[] = { { .compatible = "brcm,mdio-mux-iproc",
@@ -270,6 +311,7 @@ static int mdio_mux_iproc_remove(struct platform_device *pdev) .driver = { .name = "mdio-mux-iproc", .of_match_table = mdio_mux_iproc_match, + .pm = &mdio_mux_iproc_pm_ops, }, .probe = mdio_mux_iproc_probe, .remove = mdio_mux_iproc_remove,
--
1.9.1