[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, Andrew Lunn, "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