usb: xhci: tegra: Add runtime PM support

Add runtime PM support to the Tegra XHCI driver and move the function
calls to enable/disable the clocks, regulators and PHY into the runtime
PM callbacks.

Signed-off-by: Jon Hunter <jonathanh@nvidia.com>
Acked-by: Thierry Reding <treding@nvidia.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

diff --git a/drivers/usb/host/xhci-tegra.c b/drivers/usb/host/xhci-tegra.c
index 02b0b24faa583783f794051f01bc6d54f7289081..437e080105872f9eec5c6938b3130d0155460fa7 100644 (file)
--- a/drivers/usb/host/xhci-tegra.c
+++ b/drivers/usb/host/xhci-tegra.c
@@ -18,6 +18,7 @@
 #include <linux/phy/tegra/xusb.h>
 #include <linux/platform_device.h>
 #include <linux/pm.h>
+#include <linux/pm_runtime.h>
 #include <linux/regulator/consumer.h>
 #include <linux/reset.h>
 #include <linux/slab.h>
@@ -761,6 +762,49 @@ static void tegra_xusb_phy_disable(struct tegra_xusb *tegra)
        }
 }
 
+static int tegra_xusb_runtime_suspend(struct device *dev)
+{
+       struct tegra_xusb *tegra = dev_get_drvdata(dev);
+
+       tegra_xusb_phy_disable(tegra);
+       regulator_bulk_disable(tegra->soc->num_supplies, tegra->supplies);
+       tegra_xusb_clk_disable(tegra);
+
+       return 0;
+}
+
+static int tegra_xusb_runtime_resume(struct device *dev)
+{
+       struct tegra_xusb *tegra = dev_get_drvdata(dev);
+       int err;
+
+       err = tegra_xusb_clk_enable(tegra);
+       if (err) {
+               dev_err(dev, "failed to enable clocks: %d\n", err);
+               return err;
+       }
+
+       err = regulator_bulk_enable(tegra->soc->num_supplies, tegra->supplies);
+       if (err) {
+               dev_err(dev, "failed to enable regulators: %d\n", err);
+               goto disable_clk;
+       }
+
+       err = tegra_xusb_phy_enable(tegra);
+       if (err < 0) {
+               dev_err(dev, "failed to enable PHYs: %d\n", err);
+               goto disable_regulator;
+       }
+
+       return 0;
+
+disable_regulator:
+       regulator_bulk_disable(tegra->soc->num_supplies, tegra->supplies);
+disable_clk:
+       tegra_xusb_clk_disable(tegra);
+       return err;
+}
+
 static int tegra_xusb_load_firmware(struct tegra_xusb *tegra)
 {
        unsigned int code_tag_blocks, code_size_blocks, code_blocks;
@@ -1067,22 +1111,15 @@ static int tegra_xusb_probe(struct platform_device *pdev)
         */
        platform_set_drvdata(pdev, tegra);
 
-       err = tegra_xusb_clk_enable(tegra);
-       if (err) {
-               dev_err(&pdev->dev, "failed to enable clocks: %d\n", err);
-               goto put_usb2;
-       }
-
-       err = regulator_bulk_enable(tegra->soc->num_supplies, tegra->supplies);
-       if (err) {
-               dev_err(&pdev->dev, "failed to enable regulators: %d\n", err);
-               goto disable_clk;
-       }
+       pm_runtime_enable(&pdev->dev);
+       if (!pm_runtime_enabled(&pdev->dev))
+               err = pm_runtime_get_sync(&pdev->dev);
+       else
+               err = tegra_xusb_runtime_resume(&pdev->dev);
 
-       err = tegra_xusb_phy_enable(tegra);
        if (err < 0) {
-               dev_err(&pdev->dev, "failed to enable PHYs: %d\n", err);
-               goto disable_regulator;
+               dev_err(&pdev->dev, "failed to enable device: %d\n", err);
+               goto disable_rpm;
        }
 
        tegra_xusb_ipfs_config(tegra, regs);
@@ -1090,7 +1127,7 @@ static int tegra_xusb_probe(struct platform_device *pdev)
        err = tegra_xusb_load_firmware(tegra);
        if (err < 0) {
                dev_err(&pdev->dev, "failed to load firmware: %d\n", err);
-               goto disable_phy;
+               goto put_rpm;
        }
 
        tegra->hcd->regs = tegra->regs;
@@ -1100,7 +1137,7 @@ static int tegra_xusb_probe(struct platform_device *pdev)
        err = usb_add_hcd(tegra->hcd, tegra->xhci_irq, IRQF_SHARED);
        if (err < 0) {
                dev_err(&pdev->dev, "failed to add USB HCD: %d\n", err);
-               goto disable_phy;
+               goto put_rpm;
        }
 
        device_wakeup_enable(tegra->hcd->self.controller);
@@ -1155,13 +1192,11 @@ put_usb3:
        usb_put_hcd(xhci->shared_hcd);
 remove_usb2:
        usb_remove_hcd(tegra->hcd);
-disable_phy:
-       tegra_xusb_phy_disable(tegra);
-disable_regulator:
-       regulator_bulk_disable(tegra->soc->num_supplies, tegra->supplies);
-disable_clk:
-       tegra_xusb_clk_disable(tegra);
-put_usb2:
+put_rpm:
+       if (!pm_runtime_status_suspended(&pdev->dev))
+               tegra_xusb_runtime_suspend(&pdev->dev);
+disable_rpm:
+       pm_runtime_disable(&pdev->dev);
        usb_put_hcd(tegra->hcd);
 put_padctl:
        tegra_xusb_padctl_put(tegra->padctl);
@@ -1181,9 +1216,8 @@ static int tegra_xusb_remove(struct platform_device *pdev)
        dma_free_coherent(&pdev->dev, tegra->fw.size, tegra->fw.virt,
                          tegra->fw.phys);
 
-       tegra_xusb_phy_disable(tegra);
-       regulator_bulk_disable(tegra->soc->num_supplies, tegra->supplies);
-       tegra_xusb_clk_disable(tegra);
+       pm_runtime_put_sync(&pdev->dev);
+       pm_runtime_disable(&pdev->dev);
 
        tegra_xusb_padctl_put(tegra->padctl);
 
@@ -1211,6 +1245,8 @@ static int tegra_xusb_resume(struct device *dev)
 #endif
 
 static const struct dev_pm_ops tegra_xusb_pm_ops = {
+       SET_RUNTIME_PM_OPS(tegra_xusb_runtime_suspend,
+                          tegra_xusb_runtime_resume, NULL)
        SET_SYSTEM_SLEEP_PM_OPS(tegra_xusb_suspend, tegra_xusb_resume)
 };