phy: exynos5-usbdrd: Add facility for VBUS supply

Adding support to enable/disable VBUS controlled by a
regulator, to enable vbus supply on the port.

Signed-off-by: Vivek Gautam <gautam.vivek@samsung.com>
Signed-off-by: Kishon Vijay Abraham I <kishon@ti.com>

diff --git a/drivers/phy/phy-exynos5-usbdrd.c b/drivers/phy/phy-exynos5-usbdrd.c
index 8fcdd9434346e7d5e86616f4b8f587e32f08af25..76d862b2202fc92e4ad99e95db0b044f40d85ebb 100644 (file)
--- a/drivers/phy/phy-exynos5-usbdrd.c
+++ b/drivers/phy/phy-exynos5-usbdrd.c
@@ -24,6 +24,7 @@
 #include <linux/mfd/syscon.h>
 #include <linux/mfd/syscon/exynos5-pmu.h>
 #include <linux/regmap.h>
+#include <linux/regulator/consumer.h>
 
 /* Exynos USB PHY registers */
 #define EXYNOS5_FSEL_9MHZ6             0x0
@@ -170,6 +171,7 @@ struct exynos5_usbdrd_phy {
        } phys[EXYNOS5_DRDPHYS_NUM];
        u32 extrefclk;
        struct clk *ref_clk;
+       struct regulator *vbus;
 };
 
 static inline
@@ -438,6 +440,7 @@ static int exynos5_usbdrd_phy_exit(struct phy *phy)
 
 static int exynos5_usbdrd_phy_power_on(struct phy *phy)
 {
+       int ret;
        struct phy_usb_instance *inst = phy_get_drvdata(phy);
        struct exynos5_usbdrd_phy *phy_drd = to_usbdrd_phy(inst);
 
@@ -445,10 +448,24 @@ static int exynos5_usbdrd_phy_power_on(struct phy *phy)
 
        clk_prepare_enable(phy_drd->ref_clk);
 
+       /* Enable VBUS supply */
+       if (phy_drd->vbus) {
+               ret = regulator_enable(phy_drd->vbus);
+               if (ret) {
+                       dev_err(phy_drd->dev, "Failed to enable VBUS supply\n");
+                       goto fail_vbus;
+               }
+       }
+
        /* Power-on PHY*/
        inst->phy_cfg->phy_isol(inst, 0);
 
        return 0;
+
+fail_vbus:
+       clk_disable_unprepare(phy_drd->ref_clk);
+
+       return ret;
 }
 
 static int exynos5_usbdrd_phy_power_off(struct phy *phy)
@@ -461,6 +478,10 @@ static int exynos5_usbdrd_phy_power_off(struct phy *phy)
        /* Power-off the PHY */
        inst->phy_cfg->phy_isol(inst, 1);
 
+       /* Disable VBUS supply */
+       if (phy_drd->vbus)
+               regulator_disable(phy_drd->vbus);
+
        clk_disable_unprepare(phy_drd->ref_clk);
 
        return 0;
@@ -600,6 +621,17 @@ static int exynos5_usbdrd_phy_probe(struct platform_device *pdev)
                break;
        }
 
+       /* Get Vbus regulator */
+       phy_drd->vbus = devm_regulator_get(dev, "vbus");
+       if (IS_ERR(phy_drd->vbus)) {
+               ret = PTR_ERR(phy_drd->vbus);
+               if (ret == -EPROBE_DEFER)
+                       return ret;
+
+               dev_warn(dev, "Failed to get VBUS supply regulator\n");
+               phy_drd->vbus = NULL;
+       }
+
        dev_vdbg(dev, "Creating usbdrd_phy phy\n");
 
        for (i = 0; i < EXYNOS5_DRDPHYS_NUM; i++) {