[RFC][PATCH 1/2 v2] usb: host: ehci-platform: add platform specific .power callback

[kuninori . morimoto . gx]

This patch enables to call platform specific power callback function.

Signed-off-by: Kuninori Morimoto <kuninori.morimoto...@renesas.com>
---
 drivers/usb/host/ehci-platform.c |   33 +++++++++++++++++++++++++++++----
 include/linux/usb/ehci_pdriver.h |    2 ++
 2 files changed, 31 insertions(+), 4 deletions(-)

diff --git a/drivers/usb/host/ehci-platform.c b/drivers/usb/host/ehci-platform.c
index 4b1d896..679aa16 100644
--- a/drivers/usb/host/ehci-platform.c
+++ b/drivers/usb/host/ehci-platform.c
@@ -82,10 +82,11 @@ static int __devinit ehci_platform_probe(struct 
platform_device *dev)
 {
        struct usb_hcd *hcd;
        struct resource *res_mem;
+       struct usb_ehci_pdata *pdata = dev->dev.platform_data;
        int irq;
        int err = -ENOMEM;
 
-       BUG_ON(!dev->dev.platform_data);
+       BUG_ON(!pdata);
 
        if (usb_disabled())
                return -ENODEV;
@@ -101,10 +102,15 @@ static int __devinit ehci_platform_probe(struct 
platform_device *dev)
                return -ENXIO;
        }
 
+       if (pdata->power) /* power enable */
+               pdata->power(&dev->dev, 0, 1);
+
        hcd = usb_create_hcd(&ehci_platform_hc_driver, &dev->dev,
                             dev_name(&dev->dev));
-       if (!hcd)
-               return -ENOMEM;
+       if (!hcd) {
+               err = -ENOMEM;
+               goto err_power;
+       }
 
        hcd->rsrc_start = res_mem->start;
        hcd->rsrc_len = resource_size(res_mem);
@@ -132,12 +138,17 @@ err_release_region:
        release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
 err_put_hcd:
        usb_put_hcd(hcd);
+err_power:
+       if (pdata->power) /* power disable */
+               pdata->power(&dev->dev, 0, 0);
+
        return err;
 }
 
 static int __devexit ehci_platform_remove(struct platform_device *dev)
 {
        struct usb_hcd *hcd = platform_get_drvdata(dev);
+       struct usb_ehci_pdata *pdata = dev->dev.platform_data;
 
        usb_remove_hcd(hcd);
        iounmap(hcd->regs);
@@ -145,6 +156,9 @@ static int __devexit ehci_platform_remove(struct 
platform_device *dev)
        usb_put_hcd(hcd);
        platform_set_drvdata(dev, NULL);
 
+       if (pdata->power) /* power disable */
+               pdata->power(&dev->dev, 0, 0);
+
        return 0;
 }
 
@@ -153,14 +167,25 @@ static int __devexit ehci_platform_remove(struct 
platform_device *dev)
 static int ehci_platform_suspend(struct device *dev)
 {
        struct usb_hcd *hcd = dev_get_drvdata(dev);
+       struct usb_ehci_pdata *pdata = dev->platform_data;
        bool do_wakeup = device_may_wakeup(dev);
+       int ret;
 
-       return ehci_suspend(hcd, do_wakeup);
+       ret = ehci_suspend(hcd, do_wakeup);
+
+       if (pdata->power) /* power disable */
+               pdata->power(dev, 1, 0);
+
+       return ret;
 }
 
 static int ehci_platform_resume(struct device *dev)
 {
        struct usb_hcd *hcd = dev_get_drvdata(dev);
+       struct usb_ehci_pdata *pdata = dev->platform_data;
+
+       if (pdata->power) /* power enable */
+               pdata->power(dev, 1, 1);
 
        ehci_resume(hcd, false);
        return 0;
diff --git a/include/linux/usb/ehci_pdriver.h b/include/linux/usb/ehci_pdriver.h
index 1894f42..9164000 100644
--- a/include/linux/usb/ehci_pdriver.h
+++ b/include/linux/usb/ehci_pdriver.h
@@ -41,6 +41,8 @@ struct usb_ehci_pdata {
        unsigned        big_endian_mmio:1;
        unsigned        port_power_on:1;
        unsigned        port_power_off:1;
+
+       void (*power)(struct device *dev, int in_pm, int enable);
 };
 
 #endif /* __USB_CORE_EHCI_PDRIVER_H */
-- 
1.7.5.4

--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html