phy: ti: gmii-sel: add resume support

The resume callback restores the submode of each PHY.

It uses the submode stored in struct phy_gmii_sel_phy_priv (variable
phy_if_mode). The submode was saved by the set_mode PHY operation.

Signed-off-by: Thomas Richard <[email protected]>
Link: https://lore.kernel.org/r/[email protected]
Signed-off-by: Vinod Koul <[email protected]>

diff --git a/drivers/phy/ti/phy-gmii-sel.c b/drivers/phy/ti/phy-gmii-sel.c
index 0f4818adb440022d0d9b21a723e36ca062091268..81dd1c3449d9539b858982d6310348fe852b6532 100644 (file)
--- a/drivers/phy/ti/phy-gmii-sel.c
+++ b/drivers/phy/ti/phy-gmii-sel.c
@@ -494,11 +494,35 @@ static int phy_gmii_sel_probe(struct platform_device *pdev)
        return 0;
 }
 
+static int phy_gmii_sel_resume_noirq(struct device *dev)
+{
+       struct phy_gmii_sel_priv *priv = dev_get_drvdata(dev);
+       struct phy_gmii_sel_phy_priv *if_phys = priv->if_phys;
+       int ret, i;
+
+       for (i = 0; i < priv->num_ports; i++) {
+               if (if_phys[i].phy_if_mode) {
+                       ret = phy_gmii_sel_mode(if_phys[i].if_phy,
+                                               PHY_MODE_ETHERNET, if_phys[i].phy_if_mode);
+                       if (ret) {
+                               dev_err(dev, "port%u: restore mode fail %d\n",
+                                       if_phys[i].if_phy->id, ret);
+                               return ret;
+                       }
+               }
+       }
+
+       return 0;
+}
+
+static DEFINE_NOIRQ_DEV_PM_OPS(phy_gmii_sel_pm_ops, NULL, phy_gmii_sel_resume_noirq);
+
 static struct platform_driver phy_gmii_sel_driver = {
        .probe          = phy_gmii_sel_probe,
        .driver         = {
                .name   = "phy-gmii-sel",
                .of_match_table = phy_gmii_sel_id_table,
+               .pm = pm_sleep_ptr(&phy_gmii_sel_pm_ops),
        },
 };
 module_platform_driver(phy_gmii_sel_driver);