phy: ti: phy-j721e-wiz: add resume support

Add resume support.
It has been tested on J7200 SR1.0 and SR2.0.

Co-developed-by: Théo Lebrun <theo.lebrun@bootlin.com>
Signed-off-by: Théo Lebrun <theo.lebrun@bootlin.com>
Signed-off-by: Thomas Richard <thomas.richard@bootlin.com>
Link: https://lore.kernel.org/r/20240412-j7200-phy-s2r-v1-3-f15815833974@bootlin.com
Signed-off-by: Vinod Koul <vkoul@kernel.org>

diff --git a/drivers/phy/ti/phy-j721e-wiz.c b/drivers/phy/ti/phy-j721e-wiz.c
index ba670109e7ad43b1e80cd2e44d9ac59419c1af8a..7f626c59702503dbcf480857916bbfa76e0b6cc3 100644 (file)
--- a/drivers/phy/ti/phy-j721e-wiz.c
+++ b/drivers/phy/ti/phy-j721e-wiz.c
@@ -1659,12 +1659,41 @@ static void wiz_remove(struct platform_device *pdev)
        pm_runtime_disable(dev);
 }
 
+static int wiz_resume_noirq(struct device *dev)
+{
+       struct device_node *node = dev->of_node;
+       struct wiz *wiz = dev_get_drvdata(dev);
+       int ret;
+
+       /* Enable supplemental Control override if available */
+       if (wiz->sup_legacy_clk_override)
+               regmap_field_write(wiz->sup_legacy_clk_override, 1);
+
+       wiz_clock_init(wiz);
+
+       ret = wiz_init(wiz);
+       if (ret) {
+               dev_err(dev, "WIZ initialization failed\n");
+               goto err_wiz_init;
+       }
+
+       return 0;
+
+err_wiz_init:
+       wiz_clock_cleanup(wiz, node);
+
+       return ret;
+}
+
+static DEFINE_NOIRQ_DEV_PM_OPS(wiz_pm_ops, NULL, wiz_resume_noirq);
+
 static struct platform_driver wiz_driver = {
        .probe          = wiz_probe,
        .remove_new     = wiz_remove,
        .driver         = {
                .name   = "wiz",
                .of_match_table = wiz_id_table,
+               .pm     = pm_sleep_ptr(&wiz_pm_ops),
        },
 };
 module_platform_driver(wiz_driver);