|
@@ -133,11 +133,49 @@ static int omap_usb_power_on(struct phy *x)
|
|
|
return omap_usb_phy_power(phy, true);
|
|
|
}
|
|
|
|
|
|
+static int omap_usb2_disable_clocks(struct omap_usb *phy)
|
|
|
+{
|
|
|
+ clk_disable(phy->wkupclk);
|
|
|
+ if (!IS_ERR(phy->optclk))
|
|
|
+ clk_disable(phy->optclk);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int omap_usb2_enable_clocks(struct omap_usb *phy)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ ret = clk_enable(phy->wkupclk);
|
|
|
+ if (ret < 0) {
|
|
|
+ dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
|
|
|
+ goto err0;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!IS_ERR(phy->optclk)) {
|
|
|
+ ret = clk_enable(phy->optclk);
|
|
|
+ if (ret < 0) {
|
|
|
+ dev_err(phy->dev, "Failed to enable optclk %d\n", ret);
|
|
|
+ goto err1;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+
|
|
|
+err1:
|
|
|
+ clk_disable(phy->wkupclk);
|
|
|
+
|
|
|
+err0:
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
static int omap_usb_init(struct phy *x)
|
|
|
{
|
|
|
struct omap_usb *phy = phy_get_drvdata(x);
|
|
|
u32 val;
|
|
|
|
|
|
+ omap_usb2_enable_clocks(phy);
|
|
|
+
|
|
|
if (phy->flags & OMAP_USB2_CALIBRATE_FALSE_DISCONNECT) {
|
|
|
/*
|
|
|
*
|
|
@@ -155,8 +193,16 @@ static int omap_usb_init(struct phy *x)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static int omap_usb_exit(struct phy *x)
|
|
|
+{
|
|
|
+ struct omap_usb *phy = phy_get_drvdata(x);
|
|
|
+
|
|
|
+ return omap_usb2_disable_clocks(phy);
|
|
|
+}
|
|
|
+
|
|
|
static const struct phy_ops ops = {
|
|
|
.init = omap_usb_init,
|
|
|
+ .exit = omap_usb_exit,
|
|
|
.power_on = omap_usb_power_on,
|
|
|
.power_off = omap_usb_power_off,
|
|
|
.owner = THIS_MODULE,
|
|
@@ -376,65 +422,11 @@ static int omap_usb2_remove(struct platform_device *pdev)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-#ifdef CONFIG_PM
|
|
|
-
|
|
|
-static int omap_usb2_runtime_suspend(struct device *dev)
|
|
|
-{
|
|
|
- struct platform_device *pdev = to_platform_device(dev);
|
|
|
- struct omap_usb *phy = platform_get_drvdata(pdev);
|
|
|
-
|
|
|
- clk_disable(phy->wkupclk);
|
|
|
- if (!IS_ERR(phy->optclk))
|
|
|
- clk_disable(phy->optclk);
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int omap_usb2_runtime_resume(struct device *dev)
|
|
|
-{
|
|
|
- struct platform_device *pdev = to_platform_device(dev);
|
|
|
- struct omap_usb *phy = platform_get_drvdata(pdev);
|
|
|
- int ret;
|
|
|
-
|
|
|
- ret = clk_enable(phy->wkupclk);
|
|
|
- if (ret < 0) {
|
|
|
- dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
|
|
|
- goto err0;
|
|
|
- }
|
|
|
-
|
|
|
- if (!IS_ERR(phy->optclk)) {
|
|
|
- ret = clk_enable(phy->optclk);
|
|
|
- if (ret < 0) {
|
|
|
- dev_err(phy->dev, "Failed to enable optclk %d\n", ret);
|
|
|
- goto err1;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return 0;
|
|
|
-
|
|
|
-err1:
|
|
|
- clk_disable(phy->wkupclk);
|
|
|
-
|
|
|
-err0:
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static const struct dev_pm_ops omap_usb2_pm_ops = {
|
|
|
- SET_RUNTIME_PM_OPS(omap_usb2_runtime_suspend, omap_usb2_runtime_resume,
|
|
|
- NULL)
|
|
|
-};
|
|
|
-
|
|
|
-#define DEV_PM_OPS (&omap_usb2_pm_ops)
|
|
|
-#else
|
|
|
-#define DEV_PM_OPS NULL
|
|
|
-#endif
|
|
|
-
|
|
|
static struct platform_driver omap_usb2_driver = {
|
|
|
.probe = omap_usb2_probe,
|
|
|
.remove = omap_usb2_remove,
|
|
|
.driver = {
|
|
|
.name = "omap-usb2",
|
|
|
- .pm = DEV_PM_OPS,
|
|
|
.of_match_table = omap_usb2_id_table,
|
|
|
},
|
|
|
};
|