The udc has three supplies: vdda (3.3V), vddi (1.2V) and vddosc (1.8-3.3V).
Turn these on and off on start and stop calls.

Signed-off-by: Heiko Stuebner <[email protected]>
---
 drivers/usb/gadget/s3c-hsudc.c |   43 ++++++++++++++++++++++++++++++++++++---
 1 files changed, 39 insertions(+), 4 deletions(-)

diff --git a/drivers/usb/gadget/s3c-hsudc.c b/drivers/usb/gadget/s3c-hsudc.c
index a47bfa0..584a80f 100644
--- a/drivers/usb/gadget/s3c-hsudc.c
+++ b/drivers/usb/gadget/s3c-hsudc.c
@@ -29,6 +29,7 @@
 #include <linux/usb/otg.h>
 #include <linux/prefetch.h>
 #include <linux/usb/s3c-hsudc.h>
+#include <linux/regulator/consumer.h>
 
 #include <mach/regs-s3c2443-clock.h>
 
@@ -87,6 +88,12 @@
 #define DATA_STATE_XMIT                        (1)
 #define DATA_STATE_RECV                        (2)
 
+static const char * const s3c_hsudc_supply_names[] = {
+       "vdda",         /* analog phy supply, 3.3V */
+       "vddi",         /* digital phy supply, 1.2V */
+       "vddosc",       /* oscillator supply, 1.8V - 3.3V */
+};
+
 /**
  * struct s3c_hsudc_ep - Endpoint representation used by driver.
  * @ep: USB gadget layer representation of device endpoint.
@@ -139,6 +146,7 @@ struct s3c_hsudc {
        struct device *dev;
        struct s3c24xx_hsudc_platdata *pd;
        struct otg_transceiver *transceiver;
+       struct regulator_bulk_data supplies[ARRAY_SIZE(s3c_hsudc_supply_names)];
        spinlock_t lock;
        void __iomem *regs;
        struct resource *mem_rsrc;
@@ -1150,15 +1158,20 @@ static int s3c_hsudc_start(struct usb_gadget *g,
        hsudc->driver = driver;
        hsudc->gadget.dev.driver = &driver->driver;
 
+       ret = regulator_bulk_enable(ARRAY_SIZE(hsudc->supplies),
+                                   hsudc->supplies);
+       if (ret != 0) {
+               dev_err(hsudc->dev, "failed to enable supplies: %d\n", ret);
+               goto err_supplies;
+       }
+
        /* connect to bus through transceiver */
        if (hsudc->transceiver) {
                ret = otg_set_peripheral(hsudc->transceiver, &hsudc->gadget);
                if (ret) {
                        dev_err(hsudc->dev, "%s: can't bind to transceiver\n",
                                        hsudc->gadget.name);
-                       hsudc->driver = NULL;
-                       hsudc->gadget.dev.driver = NULL;
-                       return ret;
+                       goto err_otg;
                }
        }
 
@@ -1171,6 +1184,12 @@ static int s3c_hsudc_start(struct usb_gadget *g,
                hsudc->pd->gpio_init();
 
        return 0;
+err_otg:
+       regulator_bulk_disable(ARRAY_SIZE(hsudc->supplies), hsudc->supplies);
+err_supplies:
+       hsudc->driver = NULL;
+       hsudc->gadget.dev.driver = NULL;
+       return ret;
 }
 
 static int s3c_hsudc_stop(struct usb_gadget *g,
@@ -1200,6 +1219,8 @@ static int s3c_hsudc_stop(struct usb_gadget *g,
 
        disable_irq(hsudc->irq);
 
+       regulator_bulk_disable(ARRAY_SIZE(hsudc->supplies), hsudc->supplies);
+
        dev_info(hsudc->dev, "unregistered gadget driver '%s'\n",
                        driver->driver.name);
        return 0;
@@ -1248,7 +1269,7 @@ static int __devinit s3c_hsudc_probe(struct 
platform_device *pdev)
        struct resource *res;
        struct s3c_hsudc *hsudc;
        struct s3c24xx_hsudc_platdata *pd = pdev->dev.platform_data;
-       int ret;
+       int ret, i;
 
        hsudc = kzalloc(sizeof(struct s3c_hsudc) +
                        sizeof(struct s3c_hsudc_ep) * pd->epnum,
@@ -1265,6 +1286,16 @@ static int __devinit s3c_hsudc_probe(struct 
platform_device *pdev)
 
        hsudc->transceiver = otg_get_transceiver();
 
+       for (i = 0; i < ARRAY_SIZE(hsudc->supplies); i++)
+               hsudc->supplies[i].supply = s3c_hsudc_supply_names[i];
+
+       ret = regulator_bulk_get(dev, ARRAY_SIZE(hsudc->supplies),
+                                hsudc->supplies);
+       if (ret != 0) {
+               dev_err(dev, "failed to request supplies: %d\n", ret);
+               goto err_supplies;
+       }
+
        res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
        if (!res) {
                dev_err(dev, "unable to obtain driver resource data\n");
@@ -1360,6 +1391,8 @@ err_res:
        if (hsudc->transceiver)
                otg_put_transceiver(hsudc->transceiver);
 
+       regulator_bulk_free(ARRAY_SIZE(hsudc->supplies), hsudc->supplies);
+err_supplies:
        kfree(hsudc);
        return ret;
 }
@@ -1382,6 +1415,8 @@ static int __devexit s3c_hsudc_remove(struct 
platform_device *pdev)
        release_resource(hsudc->mem_rsrc);
        kfree(hsudc->mem_rsrc);
 
+       regulator_bulk_free(ARRAY_SIZE(hsudc->supplies), hsudc->supplies);
+
        if (hsudc->transceiver)
                otg_put_transceiver(hsudc->transceiver);
 
-- 
1.7.2.3

--
To unsubscribe from this list: send the line "unsubscribe linux-samsung-soc" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to