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>

1 files changed, 32 insertions, 0 deletions

diff --git a/drivers/phy/phy-exynos5-usbdrd.c b/drivers/phy/phy-exynos5-usbdrd.c
index 8fcdd9434346..76d862b2202f 100644
--- 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++) {