From 28393daa686ef43966e3fa1652bcd8d860698ef4 Mon Sep 17 00:00:00 2001 From: Yuichi Kusakabe Date: Thu, 18 May 2017 18:00:39 +0900 Subject: [PATCH 15/15] Add rcar-usbphy hibernation code Signed-off-by: Yuichi Kusakabe --- drivers/usb/phy/phy-rcar-gen2-usb.c | 35 +++++++++++++++++++++++++++++++++++ 1 file changed, 35 insertions(+) diff --git a/drivers/usb/phy/phy-rcar-gen2-usb.c b/drivers/usb/phy/phy-rcar-gen2-usb.c index 9e7205d..05849e7 100644 --- a/drivers/usb/phy/phy-rcar-gen2-usb.c +++ b/drivers/usb/phy/phy-rcar-gen2-usb.c @@ -148,6 +148,7 @@ static int rcar_gen2_usb_phy_set_suspend(struct usb_phy *phy, int suspend) devm_release_mem_region(&pdev->dev, res->start, resource_size(res)); devm_iounmap(&pdev->dev, priv->base); + priv->base = NULL; spin_unlock_irqrestore(&priv->lock, flags); @@ -178,6 +179,7 @@ static int rcar_gen2_usb_phy_init(struct usb_phy *phy) devm_release_mem_region(&pdev->dev, res->start, resource_size(res)); devm_iounmap(&pdev->dev, priv->base); + priv->base = NULL; spin_unlock_irqrestore(&priv->lock, flags); } return 0; @@ -209,6 +211,7 @@ static void rcar_gen2_usb_phy_shutdown(struct usb_phy *phy) devm_release_mem_region(&pdev->dev, res->start, resource_size(res)); devm_iounmap(&pdev->dev, priv->base); + priv->base = NULL; } out: spin_unlock_irqrestore(&priv->lock, flags); @@ -431,9 +434,41 @@ static int phy_rcar_gen2_pm_resume(struct device *dev) return 0; } +static int phy_rcar_gen2_pm_freeze(struct device *dev) +{ + struct rcar_gen2_usb_phy_priv *priv = dev_get_drvdata(dev); + pr_info("freeze: %p\n", priv->base); + + return phy_rcar_gen2_pm_suspend(dev); +} + +static int phy_rcar_gen2_pm_restore(struct device *dev) +{ + struct rcar_gen2_usb_phy_priv *priv = dev_get_drvdata(dev); + struct resource *res; + + res = platform_get_resource(to_platform_device(dev), IORESOURCE_MEM, 0); + priv->base = devm_ioremap_resource(dev, res); + if (IS_ERR(priv->base)) { + pr_info("restore: pointer error %ld\n", PTR_ERR(priv->base)); + return PTR_ERR(priv->base); + } + pr_info("restore: %p\n", priv->base); + __rcar_gen2_usb_phy_init(priv); + devm_release_mem_region(dev, res->start, + resource_size(res)); + devm_iounmap(dev, priv->base); + priv->base = NULL; + return phy_rcar_gen2_pm_resume(dev); +} + static const struct dev_pm_ops phy_rcar_gen2_dev_pm_ops = { .suspend = phy_rcar_gen2_pm_suspend, .resume = phy_rcar_gen2_pm_resume, + .freeze_noirq = phy_rcar_gen2_pm_freeze, + .restore = phy_rcar_gen2_pm_restore, + .thaw = phy_rcar_gen2_pm_resume, + .poweroff = phy_rcar_gen2_pm_suspend, }; #endif -- 1.8.3.1