Loading drivers/usb/gadget/Makefile +2 −0 Original line number Diff line number Diff line Loading @@ -15,3 +15,5 @@ g_android-y := android.o obj-$(CONFIG_USB_GADGET) += udc/ function/ legacy/ obj-$(CONFIG_USB_G_ANDROID) += g_android.o obj-$(CONFIG_USB_CI13XXX_MSM) += ci13xxx_msm.o drivers/usb/gadget/ci13xxx_msm.c 0 → 100644 +526 −0 Original line number Diff line number Diff line /* Copyright (c) 2010-2015, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. */ #include <linux/module.h> #include <linux/platform_device.h> #include <linux/pm_runtime.h> #include <linux/usb/msm_hsusb_hw.h> #include <linux/usb/ulpi.h> #include <linux/gpio.h> #include <linux/pinctrl/consumer.h> #include "ci13xxx_udc.c" #define MSM_USB_BASE (udc->regs) #define CI13XXX_MSM_MAX_LOG2_ITC 7 struct ci13xxx_udc_context { int irq; void __iomem *regs; int wake_gpio; int wake_irq; bool wake_irq_state; struct pinctrl *ci13xxx_pinctrl; }; static struct ci13xxx_udc_context _udc_ctxt; static irqreturn_t msm_udc_irq(int irq, void *data) { return udc_irq(); } static void ci13xxx_msm_suspend(void) { struct device *dev = _udc->gadget.dev.parent; dev_dbg(dev, "ci13xxx_msm_suspend\n"); if (_udc_ctxt.wake_irq && !_udc_ctxt.wake_irq_state) { enable_irq_wake(_udc_ctxt.wake_irq); enable_irq(_udc_ctxt.wake_irq); _udc_ctxt.wake_irq_state = true; } } static void ci13xxx_msm_resume(void) { struct device *dev = _udc->gadget.dev.parent; dev_dbg(dev, "ci13xxx_msm_resume\n"); if (_udc_ctxt.wake_irq && _udc_ctxt.wake_irq_state) { disable_irq_wake(_udc_ctxt.wake_irq); disable_irq_nosync(_udc_ctxt.wake_irq); _udc_ctxt.wake_irq_state = false; } } static void ci13xxx_msm_disconnect(void) { struct ci13xxx *udc = _udc; struct usb_phy *phy = udc->transceiver; if (phy && (phy->flags & ENABLE_DP_MANUAL_PULLUP)) { u32 temp; usb_phy_io_write(phy, ULPI_MISC_A_VBUSVLDEXT | ULPI_MISC_A_VBUSVLDEXTSEL, ULPI_CLR(ULPI_MISC_A)); /* Notify LINK of VBUS LOW */ temp = readl_relaxed(USB_USBCMD); temp &= ~USBCMD_SESS_VLD_CTRL; writel_relaxed(temp, USB_USBCMD); /* * Add memory barrier as it is must to complete * above USB PHY and Link register writes before * moving ahead with USB peripheral mode enumeration, * otherwise USB peripheral mode may not work. */ mb(); } } /* Link power management will reduce power consumption by * short time HW suspend/resume. */ static void ci13xxx_msm_set_l1(struct ci13xxx *udc) { int temp; struct device *dev = udc->gadget.dev.parent; dev_dbg(dev, "Enable link power management\n"); /* Enable remote wakeup and L1 for IN EPs */ writel_relaxed(0xffff0000, USB_L1_EP_CTRL); temp = readl_relaxed(USB_L1_CONFIG); temp |= L1_CONFIG_LPM_EN | L1_CONFIG_REMOTE_WAKEUP | L1_CONFIG_GATE_SYS_CLK | L1_CONFIG_PHY_LPM | L1_CONFIG_PLL; writel_relaxed(temp, USB_L1_CONFIG); } static void ci13xxx_msm_connect(void) { struct ci13xxx *udc = _udc; struct usb_phy *phy = udc->transceiver; if (phy && (phy->flags & ENABLE_DP_MANUAL_PULLUP)) { int temp; usb_phy_io_write(phy, ULPI_MISC_A_VBUSVLDEXT | ULPI_MISC_A_VBUSVLDEXTSEL, ULPI_SET(ULPI_MISC_A)); temp = readl_relaxed(USB_GENCONFIG2); temp |= GENCFG2_SESS_VLD_CTRL_EN; writel_relaxed(temp, USB_GENCONFIG2); temp = readl_relaxed(USB_USBCMD); temp |= USBCMD_SESS_VLD_CTRL; writel_relaxed(temp, USB_USBCMD); /* * Add memory barrier as it is must to complete * above USB PHY and Link register writes before * moving ahead with USB peripheral mode enumeration, * otherwise USB peripheral mode may not work. */ mb(); } } static void ci13xxx_msm_reset(void) { struct ci13xxx *udc = _udc; struct usb_phy *phy = udc->transceiver; struct device *dev = udc->gadget.dev.parent; int temp; writel_relaxed(0, USB_AHBBURST); writel_relaxed(0x08, USB_AHBMODE); /* workaround for rx buffer collision issue */ temp = readl_relaxed(USB_GENCONFIG); temp &= ~GENCONFIG_TXFIFO_IDLE_FORCE_DISABLE; writel_relaxed(temp, USB_GENCONFIG); if (udc->gadget.l1_supported) ci13xxx_msm_set_l1(udc); if (phy && (phy->flags & ENABLE_SECONDARY_PHY)) { int temp; dev_dbg(dev, "using secondary hsphy\n"); temp = readl_relaxed(USB_PHY_CTRL2); temp |= (1<<16); writel_relaxed(temp, USB_PHY_CTRL2); /* * Add memory barrier to make sure above LINK writes are * complete before moving ahead with USB peripheral mode * enumeration. */ mb(); } } static void ci13xxx_msm_mark_err_event(void) { struct ci13xxx *udc = _udc; struct msm_otg *otg; if (udc == NULL) return; if (udc->transceiver == NULL) return; otg = container_of(udc->transceiver, struct msm_otg, phy); /* This will trigger hardware reset before next connection */ otg->err_event_seen = true; } static void ci13xxx_msm_notify_event(struct ci13xxx *udc, unsigned event) { struct device *dev = udc->gadget.dev.parent; switch (event) { case CI13XXX_CONTROLLER_RESET_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_RESET_EVENT received\n"); ci13xxx_msm_reset(); break; case CI13XXX_CONTROLLER_DISCONNECT_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_DISCONNECT_EVENT received\n"); ci13xxx_msm_disconnect(); ci13xxx_msm_resume(); break; case CI13XXX_CONTROLLER_CONNECT_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_CONNECT_EVENT received\n"); ci13xxx_msm_connect(); break; case CI13XXX_CONTROLLER_SUSPEND_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_SUSPEND_EVENT received\n"); ci13xxx_msm_suspend(); break; case CI13XXX_CONTROLLER_RESUME_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_RESUME_EVENT received\n"); ci13xxx_msm_resume(); break; case CI13XXX_CONTROLLER_ERROR_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_ERROR_EVENT received\n"); ci13xxx_msm_mark_err_event(); break; default: dev_dbg(dev, "unknown ci13xxx_udc event\n"); break; } } static bool ci13xxx_cancel_pending_suspend(struct ci13xxx *udc) { struct msm_otg *otg; if (udc == NULL) return false; if (udc->transceiver == NULL) return false; otg = container_of(udc->transceiver, struct msm_otg, phy); return cancel_delayed_work_sync(&otg->suspend_work); } static bool ci13xxx_msm_in_lpm(struct ci13xxx *udc) { struct msm_otg *otg; if (udc == NULL) return false; if (udc->transceiver == NULL) return false; otg = container_of(udc->transceiver, struct msm_otg, phy); return (atomic_read(&otg->in_lpm) != 0); } static void ci13xxx_msm_set_fpr_flag(struct ci13xxx *udc) { struct msm_otg *otg; if (udc == NULL) return; if (udc->transceiver == NULL) return; otg = container_of(udc->transceiver, struct msm_otg, phy); atomic_set(&otg->set_fpr_with_lpm_exit, 1); } static irqreturn_t ci13xxx_msm_resume_irq(int irq, void *data) { struct ci13xxx *udc = _udc; if (udc->transceiver && udc->vbus_active && udc->suspended) usb_phy_set_suspend(udc->transceiver, 0); else if (!udc->suspended) ci13xxx_msm_resume(); return IRQ_HANDLED; } static struct ci13xxx_udc_driver ci13xxx_msm_udc_driver = { .name = "ci13xxx_msm", .flags = CI13XXX_REGS_SHARED | CI13XXX_REQUIRE_TRANSCEIVER | CI13XXX_PULLUP_ON_VBUS | CI13XXX_ZERO_ITC | CI13XXX_DISABLE_STREAMING, .nz_itc = 0, .notify_event = ci13xxx_msm_notify_event, .cancel_pending_suspend = ci13xxx_cancel_pending_suspend, .in_lpm = ci13xxx_msm_in_lpm, .set_fpr_flag = ci13xxx_msm_set_fpr_flag, }; static int ci13xxx_msm_install_wake_gpio(struct platform_device *pdev, struct resource *res) { int wake_irq; int ret; struct pinctrl_state *set_state; dev_dbg(&pdev->dev, "ci13xxx_msm_install_wake_gpio\n"); _udc_ctxt.wake_gpio = res->start; if (_udc_ctxt.ci13xxx_pinctrl) { set_state = pinctrl_lookup_state(_udc_ctxt.ci13xxx_pinctrl, "ci13xxx_active"); if (IS_ERR(set_state)) { pr_err("cannot get ci13xxx pinctrl active state\n"); return PTR_ERR(set_state); } pinctrl_select_state(_udc_ctxt.ci13xxx_pinctrl, set_state); } gpio_request(_udc_ctxt.wake_gpio, "USB_RESUME"); gpio_direction_input(_udc_ctxt.wake_gpio); wake_irq = gpio_to_irq(_udc_ctxt.wake_gpio); if (wake_irq < 0) { dev_err(&pdev->dev, "could not register USB_RESUME GPIO.\n"); return -ENXIO; } dev_dbg(&pdev->dev, "_udc_ctxt.gpio_irq = %d and irq = %d\n", _udc_ctxt.wake_gpio, wake_irq); ret = request_irq(wake_irq, ci13xxx_msm_resume_irq, IRQF_TRIGGER_RISING | IRQF_ONESHOT, "usb resume", NULL); if (ret < 0) { dev_err(&pdev->dev, "could not register USB_RESUME IRQ.\n"); goto gpio_free; } disable_irq(wake_irq); _udc_ctxt.wake_irq = wake_irq; return 0; gpio_free: gpio_free(_udc_ctxt.wake_gpio); if (_udc_ctxt.ci13xxx_pinctrl) { set_state = pinctrl_lookup_state(_udc_ctxt.ci13xxx_pinctrl, "ci13xxx_sleep"); if (IS_ERR(set_state)) pr_err("cannot get ci13xxx pinctrl sleep state\n"); else pinctrl_select_state(_udc_ctxt.ci13xxx_pinctrl, set_state); } _udc_ctxt.wake_gpio = 0; return ret; } static void ci13xxx_msm_uninstall_wake_gpio(struct platform_device *pdev) { struct pinctrl_state *set_state; dev_dbg(&pdev->dev, "ci13xxx_msm_uninstall_wake_gpio\n"); if (_udc_ctxt.wake_gpio) { gpio_free(_udc_ctxt.wake_gpio); if (_udc_ctxt.ci13xxx_pinctrl) { set_state = pinctrl_lookup_state(_udc_ctxt.ci13xxx_pinctrl, "ci13xxx_sleep"); if (IS_ERR(set_state)) pr_err("cannot get ci13xxx pinctrl sleep state\n"); else pinctrl_select_state(_udc_ctxt.ci13xxx_pinctrl, set_state); } _udc_ctxt.wake_gpio = 0; } } static int ci13xxx_msm_probe(struct platform_device *pdev) { struct resource *res; int ret; struct ci13xxx_platform_data *pdata = pdev->dev.platform_data; bool is_l1_supported = false; dev_dbg(&pdev->dev, "ci13xxx_msm_probe\n"); if (pdata) { /* Acceptable values for nz_itc are: 0,1,2,4,8,16,32,64 */ if (pdata->log2_itc > CI13XXX_MSM_MAX_LOG2_ITC || pdata->log2_itc <= 0) ci13xxx_msm_udc_driver.nz_itc = 0; else ci13xxx_msm_udc_driver.nz_itc = 1 << (pdata->log2_itc-1); is_l1_supported = pdata->l1_supported; /* Set ahb2ahb bypass flag if it is requested. */ if (pdata->enable_ahb2ahb_bypass) ci13xxx_msm_udc_driver.flags |= CI13XXX_ENABLE_AHB2AHB_BYPASS; /* Clear disable streaming flag if is requested. */ if (pdata->enable_streaming) ci13xxx_msm_udc_driver.flags &= ~CI13XXX_DISABLE_STREAMING; } res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { dev_err(&pdev->dev, "failed to get platform resource mem\n"); return -ENXIO; } _udc_ctxt.regs = ioremap(res->start, resource_size(res)); if (!_udc_ctxt.regs) { dev_err(&pdev->dev, "ioremap failed\n"); return -ENOMEM; } ret = udc_probe(&ci13xxx_msm_udc_driver, &pdev->dev, _udc_ctxt.regs); if (ret < 0) { dev_err(&pdev->dev, "udc_probe failed\n"); goto iounmap; } _udc->gadget.l1_supported = is_l1_supported; _udc_ctxt.irq = platform_get_irq(pdev, 0); if (_udc_ctxt.irq < 0) { dev_err(&pdev->dev, "IRQ not found\n"); ret = -ENXIO; goto udc_remove; } res = platform_get_resource_byname(pdev, IORESOURCE_IO, "USB_RESUME"); /* Get pinctrl if target uses pinctrl */ _udc_ctxt.ci13xxx_pinctrl = devm_pinctrl_get(&pdev->dev); if (IS_ERR(_udc_ctxt.ci13xxx_pinctrl)) { if (of_property_read_bool(pdev->dev.of_node, "pinctrl-names")) { dev_err(&pdev->dev, "Error encountered while getting pinctrl"); ret = PTR_ERR(_udc_ctxt.ci13xxx_pinctrl); goto udc_remove; } dev_dbg(&pdev->dev, "Target does not use pinctrl\n"); _udc_ctxt.ci13xxx_pinctrl = NULL; } if (res) { ret = ci13xxx_msm_install_wake_gpio(pdev, res); if (ret < 0) { dev_err(&pdev->dev, "gpio irq install failed\n"); goto udc_remove; } } ret = request_irq(_udc_ctxt.irq, msm_udc_irq, IRQF_SHARED, pdev->name, pdev); if (ret < 0) { dev_err(&pdev->dev, "request_irq failed\n"); goto gpio_uninstall; } pm_runtime_no_callbacks(&pdev->dev); pm_runtime_enable(&pdev->dev); return 0; gpio_uninstall: ci13xxx_msm_uninstall_wake_gpio(pdev); udc_remove: udc_remove(); iounmap: iounmap(_udc_ctxt.regs); return ret; } int ci13xxx_msm_remove(struct platform_device *pdev) { pm_runtime_disable(&pdev->dev); free_irq(_udc_ctxt.irq, pdev); ci13xxx_msm_uninstall_wake_gpio(pdev); udc_remove(); iounmap(_udc_ctxt.regs); return 0; } void ci13xxx_msm_shutdown(struct platform_device *pdev) { ci13xxx_pullup(&_udc->gadget, 0); } void msm_hw_bam_disable(bool bam_disable) { u32 val; struct ci13xxx *udc = _udc; if (bam_disable) val = readl_relaxed(USB_GENCONFIG) | GENCONFIG_BAM_DISABLE; else val = readl_relaxed(USB_GENCONFIG) & ~GENCONFIG_BAM_DISABLE; writel_relaxed(val, USB_GENCONFIG); } static struct platform_driver ci13xxx_msm_driver = { .probe = ci13xxx_msm_probe, .driver = { .name = "msm_hsusb", }, .remove = ci13xxx_msm_remove, .shutdown = ci13xxx_msm_shutdown, }; MODULE_ALIAS("platform:msm_hsusb"); static int __init ci13xxx_msm_init(void) { return platform_driver_register(&ci13xxx_msm_driver); } module_init(ci13xxx_msm_init); static void __exit ci13xxx_msm_exit(void) { platform_driver_unregister(&ci13xxx_msm_driver); } module_exit(ci13xxx_msm_exit); MODULE_LICENSE("GPL v2"); Loading
drivers/usb/gadget/Makefile +2 −0 Original line number Diff line number Diff line Loading @@ -15,3 +15,5 @@ g_android-y := android.o obj-$(CONFIG_USB_GADGET) += udc/ function/ legacy/ obj-$(CONFIG_USB_G_ANDROID) += g_android.o obj-$(CONFIG_USB_CI13XXX_MSM) += ci13xxx_msm.o
drivers/usb/gadget/ci13xxx_msm.c 0 → 100644 +526 −0 Original line number Diff line number Diff line /* Copyright (c) 2010-2015, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. */ #include <linux/module.h> #include <linux/platform_device.h> #include <linux/pm_runtime.h> #include <linux/usb/msm_hsusb_hw.h> #include <linux/usb/ulpi.h> #include <linux/gpio.h> #include <linux/pinctrl/consumer.h> #include "ci13xxx_udc.c" #define MSM_USB_BASE (udc->regs) #define CI13XXX_MSM_MAX_LOG2_ITC 7 struct ci13xxx_udc_context { int irq; void __iomem *regs; int wake_gpio; int wake_irq; bool wake_irq_state; struct pinctrl *ci13xxx_pinctrl; }; static struct ci13xxx_udc_context _udc_ctxt; static irqreturn_t msm_udc_irq(int irq, void *data) { return udc_irq(); } static void ci13xxx_msm_suspend(void) { struct device *dev = _udc->gadget.dev.parent; dev_dbg(dev, "ci13xxx_msm_suspend\n"); if (_udc_ctxt.wake_irq && !_udc_ctxt.wake_irq_state) { enable_irq_wake(_udc_ctxt.wake_irq); enable_irq(_udc_ctxt.wake_irq); _udc_ctxt.wake_irq_state = true; } } static void ci13xxx_msm_resume(void) { struct device *dev = _udc->gadget.dev.parent; dev_dbg(dev, "ci13xxx_msm_resume\n"); if (_udc_ctxt.wake_irq && _udc_ctxt.wake_irq_state) { disable_irq_wake(_udc_ctxt.wake_irq); disable_irq_nosync(_udc_ctxt.wake_irq); _udc_ctxt.wake_irq_state = false; } } static void ci13xxx_msm_disconnect(void) { struct ci13xxx *udc = _udc; struct usb_phy *phy = udc->transceiver; if (phy && (phy->flags & ENABLE_DP_MANUAL_PULLUP)) { u32 temp; usb_phy_io_write(phy, ULPI_MISC_A_VBUSVLDEXT | ULPI_MISC_A_VBUSVLDEXTSEL, ULPI_CLR(ULPI_MISC_A)); /* Notify LINK of VBUS LOW */ temp = readl_relaxed(USB_USBCMD); temp &= ~USBCMD_SESS_VLD_CTRL; writel_relaxed(temp, USB_USBCMD); /* * Add memory barrier as it is must to complete * above USB PHY and Link register writes before * moving ahead with USB peripheral mode enumeration, * otherwise USB peripheral mode may not work. */ mb(); } } /* Link power management will reduce power consumption by * short time HW suspend/resume. */ static void ci13xxx_msm_set_l1(struct ci13xxx *udc) { int temp; struct device *dev = udc->gadget.dev.parent; dev_dbg(dev, "Enable link power management\n"); /* Enable remote wakeup and L1 for IN EPs */ writel_relaxed(0xffff0000, USB_L1_EP_CTRL); temp = readl_relaxed(USB_L1_CONFIG); temp |= L1_CONFIG_LPM_EN | L1_CONFIG_REMOTE_WAKEUP | L1_CONFIG_GATE_SYS_CLK | L1_CONFIG_PHY_LPM | L1_CONFIG_PLL; writel_relaxed(temp, USB_L1_CONFIG); } static void ci13xxx_msm_connect(void) { struct ci13xxx *udc = _udc; struct usb_phy *phy = udc->transceiver; if (phy && (phy->flags & ENABLE_DP_MANUAL_PULLUP)) { int temp; usb_phy_io_write(phy, ULPI_MISC_A_VBUSVLDEXT | ULPI_MISC_A_VBUSVLDEXTSEL, ULPI_SET(ULPI_MISC_A)); temp = readl_relaxed(USB_GENCONFIG2); temp |= GENCFG2_SESS_VLD_CTRL_EN; writel_relaxed(temp, USB_GENCONFIG2); temp = readl_relaxed(USB_USBCMD); temp |= USBCMD_SESS_VLD_CTRL; writel_relaxed(temp, USB_USBCMD); /* * Add memory barrier as it is must to complete * above USB PHY and Link register writes before * moving ahead with USB peripheral mode enumeration, * otherwise USB peripheral mode may not work. */ mb(); } } static void ci13xxx_msm_reset(void) { struct ci13xxx *udc = _udc; struct usb_phy *phy = udc->transceiver; struct device *dev = udc->gadget.dev.parent; int temp; writel_relaxed(0, USB_AHBBURST); writel_relaxed(0x08, USB_AHBMODE); /* workaround for rx buffer collision issue */ temp = readl_relaxed(USB_GENCONFIG); temp &= ~GENCONFIG_TXFIFO_IDLE_FORCE_DISABLE; writel_relaxed(temp, USB_GENCONFIG); if (udc->gadget.l1_supported) ci13xxx_msm_set_l1(udc); if (phy && (phy->flags & ENABLE_SECONDARY_PHY)) { int temp; dev_dbg(dev, "using secondary hsphy\n"); temp = readl_relaxed(USB_PHY_CTRL2); temp |= (1<<16); writel_relaxed(temp, USB_PHY_CTRL2); /* * Add memory barrier to make sure above LINK writes are * complete before moving ahead with USB peripheral mode * enumeration. */ mb(); } } static void ci13xxx_msm_mark_err_event(void) { struct ci13xxx *udc = _udc; struct msm_otg *otg; if (udc == NULL) return; if (udc->transceiver == NULL) return; otg = container_of(udc->transceiver, struct msm_otg, phy); /* This will trigger hardware reset before next connection */ otg->err_event_seen = true; } static void ci13xxx_msm_notify_event(struct ci13xxx *udc, unsigned event) { struct device *dev = udc->gadget.dev.parent; switch (event) { case CI13XXX_CONTROLLER_RESET_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_RESET_EVENT received\n"); ci13xxx_msm_reset(); break; case CI13XXX_CONTROLLER_DISCONNECT_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_DISCONNECT_EVENT received\n"); ci13xxx_msm_disconnect(); ci13xxx_msm_resume(); break; case CI13XXX_CONTROLLER_CONNECT_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_CONNECT_EVENT received\n"); ci13xxx_msm_connect(); break; case CI13XXX_CONTROLLER_SUSPEND_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_SUSPEND_EVENT received\n"); ci13xxx_msm_suspend(); break; case CI13XXX_CONTROLLER_RESUME_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_RESUME_EVENT received\n"); ci13xxx_msm_resume(); break; case CI13XXX_CONTROLLER_ERROR_EVENT: dev_info(dev, "CI13XXX_CONTROLLER_ERROR_EVENT received\n"); ci13xxx_msm_mark_err_event(); break; default: dev_dbg(dev, "unknown ci13xxx_udc event\n"); break; } } static bool ci13xxx_cancel_pending_suspend(struct ci13xxx *udc) { struct msm_otg *otg; if (udc == NULL) return false; if (udc->transceiver == NULL) return false; otg = container_of(udc->transceiver, struct msm_otg, phy); return cancel_delayed_work_sync(&otg->suspend_work); } static bool ci13xxx_msm_in_lpm(struct ci13xxx *udc) { struct msm_otg *otg; if (udc == NULL) return false; if (udc->transceiver == NULL) return false; otg = container_of(udc->transceiver, struct msm_otg, phy); return (atomic_read(&otg->in_lpm) != 0); } static void ci13xxx_msm_set_fpr_flag(struct ci13xxx *udc) { struct msm_otg *otg; if (udc == NULL) return; if (udc->transceiver == NULL) return; otg = container_of(udc->transceiver, struct msm_otg, phy); atomic_set(&otg->set_fpr_with_lpm_exit, 1); } static irqreturn_t ci13xxx_msm_resume_irq(int irq, void *data) { struct ci13xxx *udc = _udc; if (udc->transceiver && udc->vbus_active && udc->suspended) usb_phy_set_suspend(udc->transceiver, 0); else if (!udc->suspended) ci13xxx_msm_resume(); return IRQ_HANDLED; } static struct ci13xxx_udc_driver ci13xxx_msm_udc_driver = { .name = "ci13xxx_msm", .flags = CI13XXX_REGS_SHARED | CI13XXX_REQUIRE_TRANSCEIVER | CI13XXX_PULLUP_ON_VBUS | CI13XXX_ZERO_ITC | CI13XXX_DISABLE_STREAMING, .nz_itc = 0, .notify_event = ci13xxx_msm_notify_event, .cancel_pending_suspend = ci13xxx_cancel_pending_suspend, .in_lpm = ci13xxx_msm_in_lpm, .set_fpr_flag = ci13xxx_msm_set_fpr_flag, }; static int ci13xxx_msm_install_wake_gpio(struct platform_device *pdev, struct resource *res) { int wake_irq; int ret; struct pinctrl_state *set_state; dev_dbg(&pdev->dev, "ci13xxx_msm_install_wake_gpio\n"); _udc_ctxt.wake_gpio = res->start; if (_udc_ctxt.ci13xxx_pinctrl) { set_state = pinctrl_lookup_state(_udc_ctxt.ci13xxx_pinctrl, "ci13xxx_active"); if (IS_ERR(set_state)) { pr_err("cannot get ci13xxx pinctrl active state\n"); return PTR_ERR(set_state); } pinctrl_select_state(_udc_ctxt.ci13xxx_pinctrl, set_state); } gpio_request(_udc_ctxt.wake_gpio, "USB_RESUME"); gpio_direction_input(_udc_ctxt.wake_gpio); wake_irq = gpio_to_irq(_udc_ctxt.wake_gpio); if (wake_irq < 0) { dev_err(&pdev->dev, "could not register USB_RESUME GPIO.\n"); return -ENXIO; } dev_dbg(&pdev->dev, "_udc_ctxt.gpio_irq = %d and irq = %d\n", _udc_ctxt.wake_gpio, wake_irq); ret = request_irq(wake_irq, ci13xxx_msm_resume_irq, IRQF_TRIGGER_RISING | IRQF_ONESHOT, "usb resume", NULL); if (ret < 0) { dev_err(&pdev->dev, "could not register USB_RESUME IRQ.\n"); goto gpio_free; } disable_irq(wake_irq); _udc_ctxt.wake_irq = wake_irq; return 0; gpio_free: gpio_free(_udc_ctxt.wake_gpio); if (_udc_ctxt.ci13xxx_pinctrl) { set_state = pinctrl_lookup_state(_udc_ctxt.ci13xxx_pinctrl, "ci13xxx_sleep"); if (IS_ERR(set_state)) pr_err("cannot get ci13xxx pinctrl sleep state\n"); else pinctrl_select_state(_udc_ctxt.ci13xxx_pinctrl, set_state); } _udc_ctxt.wake_gpio = 0; return ret; } static void ci13xxx_msm_uninstall_wake_gpio(struct platform_device *pdev) { struct pinctrl_state *set_state; dev_dbg(&pdev->dev, "ci13xxx_msm_uninstall_wake_gpio\n"); if (_udc_ctxt.wake_gpio) { gpio_free(_udc_ctxt.wake_gpio); if (_udc_ctxt.ci13xxx_pinctrl) { set_state = pinctrl_lookup_state(_udc_ctxt.ci13xxx_pinctrl, "ci13xxx_sleep"); if (IS_ERR(set_state)) pr_err("cannot get ci13xxx pinctrl sleep state\n"); else pinctrl_select_state(_udc_ctxt.ci13xxx_pinctrl, set_state); } _udc_ctxt.wake_gpio = 0; } } static int ci13xxx_msm_probe(struct platform_device *pdev) { struct resource *res; int ret; struct ci13xxx_platform_data *pdata = pdev->dev.platform_data; bool is_l1_supported = false; dev_dbg(&pdev->dev, "ci13xxx_msm_probe\n"); if (pdata) { /* Acceptable values for nz_itc are: 0,1,2,4,8,16,32,64 */ if (pdata->log2_itc > CI13XXX_MSM_MAX_LOG2_ITC || pdata->log2_itc <= 0) ci13xxx_msm_udc_driver.nz_itc = 0; else ci13xxx_msm_udc_driver.nz_itc = 1 << (pdata->log2_itc-1); is_l1_supported = pdata->l1_supported; /* Set ahb2ahb bypass flag if it is requested. */ if (pdata->enable_ahb2ahb_bypass) ci13xxx_msm_udc_driver.flags |= CI13XXX_ENABLE_AHB2AHB_BYPASS; /* Clear disable streaming flag if is requested. */ if (pdata->enable_streaming) ci13xxx_msm_udc_driver.flags &= ~CI13XXX_DISABLE_STREAMING; } res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { dev_err(&pdev->dev, "failed to get platform resource mem\n"); return -ENXIO; } _udc_ctxt.regs = ioremap(res->start, resource_size(res)); if (!_udc_ctxt.regs) { dev_err(&pdev->dev, "ioremap failed\n"); return -ENOMEM; } ret = udc_probe(&ci13xxx_msm_udc_driver, &pdev->dev, _udc_ctxt.regs); if (ret < 0) { dev_err(&pdev->dev, "udc_probe failed\n"); goto iounmap; } _udc->gadget.l1_supported = is_l1_supported; _udc_ctxt.irq = platform_get_irq(pdev, 0); if (_udc_ctxt.irq < 0) { dev_err(&pdev->dev, "IRQ not found\n"); ret = -ENXIO; goto udc_remove; } res = platform_get_resource_byname(pdev, IORESOURCE_IO, "USB_RESUME"); /* Get pinctrl if target uses pinctrl */ _udc_ctxt.ci13xxx_pinctrl = devm_pinctrl_get(&pdev->dev); if (IS_ERR(_udc_ctxt.ci13xxx_pinctrl)) { if (of_property_read_bool(pdev->dev.of_node, "pinctrl-names")) { dev_err(&pdev->dev, "Error encountered while getting pinctrl"); ret = PTR_ERR(_udc_ctxt.ci13xxx_pinctrl); goto udc_remove; } dev_dbg(&pdev->dev, "Target does not use pinctrl\n"); _udc_ctxt.ci13xxx_pinctrl = NULL; } if (res) { ret = ci13xxx_msm_install_wake_gpio(pdev, res); if (ret < 0) { dev_err(&pdev->dev, "gpio irq install failed\n"); goto udc_remove; } } ret = request_irq(_udc_ctxt.irq, msm_udc_irq, IRQF_SHARED, pdev->name, pdev); if (ret < 0) { dev_err(&pdev->dev, "request_irq failed\n"); goto gpio_uninstall; } pm_runtime_no_callbacks(&pdev->dev); pm_runtime_enable(&pdev->dev); return 0; gpio_uninstall: ci13xxx_msm_uninstall_wake_gpio(pdev); udc_remove: udc_remove(); iounmap: iounmap(_udc_ctxt.regs); return ret; } int ci13xxx_msm_remove(struct platform_device *pdev) { pm_runtime_disable(&pdev->dev); free_irq(_udc_ctxt.irq, pdev); ci13xxx_msm_uninstall_wake_gpio(pdev); udc_remove(); iounmap(_udc_ctxt.regs); return 0; } void ci13xxx_msm_shutdown(struct platform_device *pdev) { ci13xxx_pullup(&_udc->gadget, 0); } void msm_hw_bam_disable(bool bam_disable) { u32 val; struct ci13xxx *udc = _udc; if (bam_disable) val = readl_relaxed(USB_GENCONFIG) | GENCONFIG_BAM_DISABLE; else val = readl_relaxed(USB_GENCONFIG) & ~GENCONFIG_BAM_DISABLE; writel_relaxed(val, USB_GENCONFIG); } static struct platform_driver ci13xxx_msm_driver = { .probe = ci13xxx_msm_probe, .driver = { .name = "msm_hsusb", }, .remove = ci13xxx_msm_remove, .shutdown = ci13xxx_msm_shutdown, }; MODULE_ALIAS("platform:msm_hsusb"); static int __init ci13xxx_msm_init(void) { return platform_driver_register(&ci13xxx_msm_driver); } module_init(ci13xxx_msm_init); static void __exit ci13xxx_msm_exit(void) { platform_driver_unregister(&ci13xxx_msm_driver); } module_exit(ci13xxx_msm_exit); MODULE_LICENSE("GPL v2");
