On Mon, Aug 29, 2011 at 2:51 AM, Sebastian Andrzej Siewior
<sebastian@xxxxxxxxxxxxx> wrote:
> This generic add function could be used by platform drivers.
>
> Signed-off-by: Sebastian Andrzej Siewior <sebastian@xxxxxxxxxxxxx>
> ---
> drivers/usb/host/Makefile | 1 +
> drivers/usb/host/ehci-platform.c | 70 ++++++++++++++++++++++++++++++++++++++
> drivers/usb/host/ehci.h | 4 ++
> 3 files changed, 75 insertions(+), 0 deletions(-)
> create mode 100644 drivers/usb/host/ehci-platform.c
>
> diff --git a/drivers/usb/host/Makefile b/drivers/usb/host/Makefile
> index 82679f3..29f5abc 100644
> --- a/drivers/usb/host/Makefile
> +++ b/drivers/usb/host/Makefile
> @@ -19,6 +19,7 @@ obj-$(CONFIG_USB_WHCI_HCD) += whci/
> obj-$(CONFIG_PCI) += pci-quirks.o
>
> ehci-hcd-y := ehci.o
> +ehci-hcd-y += ehci-platform.o
> ehci-hcd-$(CONFIG_PCI) += ehci-pci.o
> ehci-hcd-$(CONFIG_PPC_PS3) += ehci-ps3.o
> ehci-hcd-$(CONFIG_USB_EHCI_HCD_PPC_OF) += ehci-ppc-of.o
> diff --git a/drivers/usb/host/ehci-platform.c b/drivers/usb/host/ehci-platform.c
> new file mode 100644
> index 0000000..d9d3351
> --- /dev/null
> +++ b/drivers/usb/host/ehci-platform.c
> @@ -0,0 +1,70 @@
> +#include <linux/usb/hcd.h>
> +#include <linux/platform_device.h>
> +#include <linux/io.h>
> +#include "ehci.h"
> +
> +struct usb_hcd *ehci_hcd_plat_add(struct platform_device *pdev,
> + const struct hc_driver *hc_drv)
> +{
> + struct usb_hcd *hcd;
> + struct resource *res;
> + int ret;
> + int irq;
> +
> + if (usb_disabled())
> + return ERR_PTR(-ENODEV);
> +
> + irq = platform_get_irq(pdev, 0);
> + if (irq < 0)
> + return ERR_PTR(irq);
> +
> + hcd = usb_create_hcd(hc_drv, &pdev->dev, dev_name(&pdev->dev));
> + if (!hcd) {
> + ret = -ENOMEM;
> + goto err_create_hcd;
> + }
> +
> + res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> + if (!res) {
> + ret = -ENODEV;
> + goto err_get_res;
> + }
> +
> + hcd->rsrc_start = res->start;
> + hcd->rsrc_len = resource_size(res);
> + if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len,
> + hc_drv->description)) {
> + ret = -EBUSY;
> + goto err_get_res;
> + }
> +
> + hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
> + if (hcd->regs == NULL) {
> + dev_dbg(&pdev->dev, "error mapping memory\n");
> + ret = -ENOMEM;
> + goto err_iomap;
> + }
> +
> + ret = usb_add_hcd(hcd, irq, IRQF_SHARED);
the irqflag should be always IRQF_SHARED?
> + if (ret)
> + goto err_add_hcd;
> +
> + return hcd;
> +
> +err_add_hcd:
> + iounmap(hcd->regs);
> +err_iomap:
> + release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
> +err_get_res:
> + usb_put_hcd(hcd);
> +err_create_hcd:
> + return ERR_PTR(ret);
> +}
> +
> +void ehci_hcd_plat_cleanup(struct platform_device *pdev, struct usb_hcd *hcd)
> +{
> + usb_remove_hcd(hcd);
> + iounmap(hcd->regs);
> + release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
> + usb_put_hcd(hcd);
> +}
> diff --git a/drivers/usb/host/ehci.h b/drivers/usb/host/ehci.h
> index 35fc8ce..bde996d 100644
> --- a/drivers/usb/host/ehci.h
> +++ b/drivers/usb/host/ehci.h
> @@ -789,6 +789,10 @@ void ehci_work(struct ehci_hcd *ehci);
> int ehci_lpm_set_da(struct ehci_hcd *ehci, int dev_addr, int port_num);
> int ehci_lpm_check(struct ehci_hcd *ehci, int port);
>
> +struct usb_hcd *ehci_hcd_plat_add(struct platform_device *pdev,
> + const struct hc_driver *hc_drv);
> +void ehci_hcd_plat_cleanup(struct platform_device *pdev, struct usb_hcd *hcd);
> +
> #ifdef CONFIG_PCI
> int ehci_register_pci(void);
> void ehci_unregister_pci(void);
> --
> 1.7.5.4
>
> --
> To unsubscribe from this list: send the line "unsubscribe linux-usb" in
> the body of a message to majordomo@xxxxxxxxxxxxxxx
> More majordomo info at http://vger.kernel.org/majordomo-info.html
>
--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
