| /* Copyright (c) 2009-2012, Code Aurora Forum. 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. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/device.h> |
| #include <linux/platform_device.h> |
| #include <linux/clk.h> |
| #include <linux/slab.h> |
| #include <linux/interrupt.h> |
| #include <linux/err.h> |
| #include <linux/delay.h> |
| #include <linux/io.h> |
| #include <linux/ioport.h> |
| #include <linux/uaccess.h> |
| #include <linux/debugfs.h> |
| #include <linux/seq_file.h> |
| #include <linux/pm_runtime.h> |
| #include <linux/of.h> |
| #include <linux/dma-mapping.h> |
| |
| #include <linux/usb.h> |
| #include <linux/usb/otg.h> |
| #include <linux/usb/ulpi.h> |
| #include <linux/usb/gadget.h> |
| #include <linux/usb/hcd.h> |
| #include <linux/usb/msm_hsusb.h> |
| #include <linux/usb/msm_hsusb_hw.h> |
| #include <linux/regulator/consumer.h> |
| #include <linux/mfd/pm8xxx/pm8921-charger.h> |
| #include <linux/pm_qos_params.h> |
| #include <linux/power_supply.h> |
| |
| #include <mach/clk.h> |
| #include <mach/msm_xo.h> |
| |
| #define MSM_USB_BASE (motg->regs) |
| #define DRIVER_NAME "msm_otg" |
| |
| #define ID_TIMER_FREQ (jiffies + msecs_to_jiffies(2000)) |
| #define ULPI_IO_TIMEOUT_USEC (10 * 1000) |
| |
| #define USB_PHY_3P3_VOL_MIN 3050000 /* uV */ |
| #define USB_PHY_3P3_VOL_MAX 3300000 /* uV */ |
| #define USB_PHY_3P3_HPM_LOAD 50000 /* uA */ |
| #define USB_PHY_3P3_LPM_LOAD 4000 /* uA */ |
| |
| #define USB_PHY_1P8_VOL_MIN 1800000 /* uV */ |
| #define USB_PHY_1P8_VOL_MAX 1800000 /* uV */ |
| #define USB_PHY_1P8_HPM_LOAD 50000 /* uA */ |
| #define USB_PHY_1P8_LPM_LOAD 4000 /* uA */ |
| |
| #define USB_PHY_VDD_DIG_VOL_MIN 1045000 /* uV */ |
| #define USB_PHY_VDD_DIG_VOL_MAX 1320000 /* uV */ |
| |
| static DECLARE_COMPLETION(pmic_vbus_init); |
| static struct msm_otg *the_msm_otg; |
| static bool debug_aca_enabled; |
| |
| /* Prevent idle power collapse(pc) while operating in peripheral mode */ |
| static void otg_pm_qos_update_latency(struct msm_otg *dev, int vote) |
| { |
| struct msm_otg_platform_data *pdata = dev->pdata; |
| u32 swfi_latency = 0; |
| |
| if (!pdata || !pdata->swfi_latency) |
| return; |
| |
| swfi_latency = pdata->swfi_latency + 1; |
| |
| if (vote) |
| pm_qos_update_request(&dev->pm_qos_req_dma, |
| swfi_latency); |
| else |
| pm_qos_update_request(&dev->pm_qos_req_dma, |
| PM_QOS_DEFAULT_VALUE); |
| } |
| |
| static struct regulator *hsusb_3p3; |
| static struct regulator *hsusb_1p8; |
| static struct regulator *hsusb_vddcx; |
| static struct regulator *vbus_otg; |
| |
| static bool aca_id_turned_on; |
| static inline bool aca_enabled(void) |
| { |
| #ifdef CONFIG_USB_MSM_ACA |
| return true; |
| #else |
| return debug_aca_enabled; |
| #endif |
| } |
| |
| static int msm_hsusb_init_vddcx(struct msm_otg *motg, int init) |
| { |
| int ret = 0; |
| |
| if (init) { |
| hsusb_vddcx = regulator_get(motg->otg.dev, "HSUSB_VDDCX"); |
| if (IS_ERR(hsusb_vddcx)) { |
| dev_err(motg->otg.dev, "unable to get hsusb vddcx\n"); |
| return PTR_ERR(hsusb_vddcx); |
| } |
| |
| ret = regulator_set_voltage(hsusb_vddcx, |
| USB_PHY_VDD_DIG_VOL_MIN, |
| USB_PHY_VDD_DIG_VOL_MAX); |
| if (ret) { |
| dev_err(motg->otg.dev, "unable to set the voltage " |
| "for hsusb vddcx\n"); |
| regulator_put(hsusb_vddcx); |
| return ret; |
| } |
| |
| ret = regulator_enable(hsusb_vddcx); |
| if (ret) { |
| regulator_set_voltage(hsusb_vddcx, 0, |
| USB_PHY_VDD_DIG_VOL_MIN); |
| regulator_put(hsusb_vddcx); |
| dev_err(motg->otg.dev, "unable to enable the hsusb vddcx\n"); |
| return ret; |
| } |
| |
| } else { |
| |
| ret = regulator_disable(hsusb_vddcx); |
| if (ret) { |
| dev_err(motg->otg.dev, "unable to disable hsusb vddcx\n"); |
| return ret; |
| } |
| |
| ret = regulator_set_voltage(hsusb_vddcx, 0, |
| USB_PHY_VDD_DIG_VOL_MIN); |
| if (ret) { |
| dev_err(motg->otg.dev, "unable to set the voltage" |
| "for hsusb vddcx\n"); |
| return ret; |
| } |
| |
| regulator_put(hsusb_vddcx); |
| } |
| |
| return ret; |
| } |
| |
| static int msm_hsusb_ldo_init(struct msm_otg *motg, int init) |
| { |
| int rc = 0; |
| |
| if (init) { |
| hsusb_3p3 = regulator_get(motg->otg.dev, "HSUSB_3p3"); |
| if (IS_ERR(hsusb_3p3)) { |
| dev_err(motg->otg.dev, "unable to get hsusb 3p3\n"); |
| return PTR_ERR(hsusb_3p3); |
| } |
| |
| rc = regulator_set_voltage(hsusb_3p3, USB_PHY_3P3_VOL_MIN, |
| USB_PHY_3P3_VOL_MAX); |
| if (rc) { |
| dev_err(motg->otg.dev, "unable to set voltage level for" |
| "hsusb 3p3\n"); |
| goto put_3p3; |
| } |
| hsusb_1p8 = regulator_get(motg->otg.dev, "HSUSB_1p8"); |
| if (IS_ERR(hsusb_1p8)) { |
| dev_err(motg->otg.dev, "unable to get hsusb 1p8\n"); |
| rc = PTR_ERR(hsusb_1p8); |
| goto put_3p3_lpm; |
| } |
| rc = regulator_set_voltage(hsusb_1p8, USB_PHY_1P8_VOL_MIN, |
| USB_PHY_1P8_VOL_MAX); |
| if (rc) { |
| dev_err(motg->otg.dev, "unable to set voltage level for" |
| "hsusb 1p8\n"); |
| goto put_1p8; |
| } |
| |
| return 0; |
| } |
| |
| put_1p8: |
| regulator_set_voltage(hsusb_1p8, 0, USB_PHY_1P8_VOL_MAX); |
| regulator_put(hsusb_1p8); |
| put_3p3_lpm: |
| regulator_set_voltage(hsusb_3p3, 0, USB_PHY_3P3_VOL_MAX); |
| put_3p3: |
| regulator_put(hsusb_3p3); |
| return rc; |
| } |
| |
| #ifdef CONFIG_PM_SLEEP |
| #define USB_PHY_SUSP_DIG_VOL 500000 |
| static int msm_hsusb_config_vddcx(int high) |
| { |
| int max_vol = USB_PHY_VDD_DIG_VOL_MAX; |
| int min_vol; |
| int ret; |
| |
| if (high) |
| min_vol = USB_PHY_VDD_DIG_VOL_MIN; |
| else |
| min_vol = USB_PHY_SUSP_DIG_VOL; |
| |
| ret = regulator_set_voltage(hsusb_vddcx, min_vol, max_vol); |
| if (ret) { |
| pr_err("%s: unable to set the voltage for regulator " |
| "HSUSB_VDDCX\n", __func__); |
| return ret; |
| } |
| |
| pr_debug("%s: min_vol:%d max_vol:%d\n", __func__, min_vol, max_vol); |
| |
| return ret; |
| } |
| #else |
| static int msm_hsusb_config_vddcx(int high) |
| { |
| return 0; |
| } |
| #endif |
| |
| static int msm_hsusb_ldo_enable(struct msm_otg *motg, int on) |
| { |
| int ret = 0; |
| |
| if (IS_ERR(hsusb_1p8)) { |
| pr_err("%s: HSUSB_1p8 is not initialized\n", __func__); |
| return -ENODEV; |
| } |
| |
| if (IS_ERR(hsusb_3p3)) { |
| pr_err("%s: HSUSB_3p3 is not initialized\n", __func__); |
| return -ENODEV; |
| } |
| |
| if (on) { |
| ret = regulator_set_optimum_mode(hsusb_1p8, |
| USB_PHY_1P8_HPM_LOAD); |
| if (ret < 0) { |
| pr_err("%s: Unable to set HPM of the regulator:" |
| "HSUSB_1p8\n", __func__); |
| return ret; |
| } |
| |
| ret = regulator_enable(hsusb_1p8); |
| if (ret) { |
| dev_err(motg->otg.dev, "%s: unable to enable the hsusb 1p8\n", |
| __func__); |
| regulator_set_optimum_mode(hsusb_1p8, 0); |
| return ret; |
| } |
| |
| ret = regulator_set_optimum_mode(hsusb_3p3, |
| USB_PHY_3P3_HPM_LOAD); |
| if (ret < 0) { |
| pr_err("%s: Unable to set HPM of the regulator:" |
| "HSUSB_3p3\n", __func__); |
| regulator_set_optimum_mode(hsusb_1p8, 0); |
| regulator_disable(hsusb_1p8); |
| return ret; |
| } |
| |
| ret = regulator_enable(hsusb_3p3); |
| if (ret) { |
| dev_err(motg->otg.dev, "%s: unable to enable the hsusb 3p3\n", |
| __func__); |
| regulator_set_optimum_mode(hsusb_3p3, 0); |
| regulator_set_optimum_mode(hsusb_1p8, 0); |
| regulator_disable(hsusb_1p8); |
| return ret; |
| } |
| |
| } else { |
| ret = regulator_disable(hsusb_1p8); |
| if (ret) { |
| dev_err(motg->otg.dev, "%s: unable to disable the hsusb 1p8\n", |
| __func__); |
| return ret; |
| } |
| |
| ret = regulator_set_optimum_mode(hsusb_1p8, 0); |
| if (ret < 0) |
| pr_err("%s: Unable to set LPM of the regulator:" |
| "HSUSB_1p8\n", __func__); |
| |
| ret = regulator_disable(hsusb_3p3); |
| if (ret) { |
| dev_err(motg->otg.dev, "%s: unable to disable the hsusb 3p3\n", |
| __func__); |
| return ret; |
| } |
| ret = regulator_set_optimum_mode(hsusb_3p3, 0); |
| if (ret < 0) |
| pr_err("%s: Unable to set LPM of the regulator:" |
| "HSUSB_3p3\n", __func__); |
| } |
| |
| pr_debug("reg (%s)\n", on ? "HPM" : "LPM"); |
| return ret < 0 ? ret : 0; |
| } |
| |
| static void msm_hsusb_mhl_switch_enable(struct msm_otg *motg, bool on) |
| { |
| static struct regulator *mhl_analog_switch; |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| |
| if (!pdata->mhl_enable) |
| return; |
| |
| if (on) { |
| mhl_analog_switch = regulator_get(motg->otg.dev, |
| "mhl_ext_3p3v"); |
| if (IS_ERR(mhl_analog_switch)) { |
| pr_err("Unable to get mhl_analog_switch\n"); |
| return; |
| } |
| |
| if (regulator_enable(mhl_analog_switch)) { |
| pr_err("unable to enable mhl_analog_switch\n"); |
| goto put_analog_switch; |
| } |
| return; |
| } |
| |
| regulator_disable(mhl_analog_switch); |
| put_analog_switch: |
| regulator_put(mhl_analog_switch); |
| } |
| |
| static int ulpi_read(struct otg_transceiver *otg, u32 reg) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| int cnt = 0; |
| |
| /* initiate read operation */ |
| writel(ULPI_RUN | ULPI_READ | ULPI_ADDR(reg), |
| USB_ULPI_VIEWPORT); |
| |
| /* wait for completion */ |
| while (cnt < ULPI_IO_TIMEOUT_USEC) { |
| if (!(readl(USB_ULPI_VIEWPORT) & ULPI_RUN)) |
| break; |
| udelay(1); |
| cnt++; |
| } |
| |
| if (cnt >= ULPI_IO_TIMEOUT_USEC) { |
| dev_err(otg->dev, "ulpi_read: timeout %08x\n", |
| readl(USB_ULPI_VIEWPORT)); |
| return -ETIMEDOUT; |
| } |
| return ULPI_DATA_READ(readl(USB_ULPI_VIEWPORT)); |
| } |
| |
| static int ulpi_write(struct otg_transceiver *otg, u32 val, u32 reg) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| int cnt = 0; |
| |
| /* initiate write operation */ |
| writel(ULPI_RUN | ULPI_WRITE | |
| ULPI_ADDR(reg) | ULPI_DATA(val), |
| USB_ULPI_VIEWPORT); |
| |
| /* wait for completion */ |
| while (cnt < ULPI_IO_TIMEOUT_USEC) { |
| if (!(readl(USB_ULPI_VIEWPORT) & ULPI_RUN)) |
| break; |
| udelay(1); |
| cnt++; |
| } |
| |
| if (cnt >= ULPI_IO_TIMEOUT_USEC) { |
| dev_err(otg->dev, "ulpi_write: timeout\n"); |
| return -ETIMEDOUT; |
| } |
| return 0; |
| } |
| |
| static struct otg_io_access_ops msm_otg_io_ops = { |
| .read = ulpi_read, |
| .write = ulpi_write, |
| }; |
| |
| static void ulpi_init(struct msm_otg *motg) |
| { |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| int *seq = pdata->phy_init_seq; |
| |
| if (!seq) |
| return; |
| |
| while (seq[0] >= 0) { |
| dev_vdbg(motg->otg.dev, "ulpi: write 0x%02x to 0x%02x\n", |
| seq[0], seq[1]); |
| ulpi_write(&motg->otg, seq[0], seq[1]); |
| seq += 2; |
| } |
| } |
| |
| static int msm_otg_link_clk_reset(struct msm_otg *motg, bool assert) |
| { |
| int ret; |
| |
| if (assert) { |
| ret = clk_reset(motg->clk, CLK_RESET_ASSERT); |
| if (ret) |
| dev_err(motg->otg.dev, "usb hs_clk assert failed\n"); |
| } else { |
| ret = clk_reset(motg->clk, CLK_RESET_DEASSERT); |
| if (ret) |
| dev_err(motg->otg.dev, "usb hs_clk deassert failed\n"); |
| } |
| return ret; |
| } |
| |
| static int msm_otg_phy_clk_reset(struct msm_otg *motg) |
| { |
| int ret; |
| |
| if (IS_ERR(motg->phy_reset_clk)) |
| return 0; |
| |
| ret = clk_reset(motg->phy_reset_clk, CLK_RESET_ASSERT); |
| if (ret) { |
| dev_err(motg->otg.dev, "usb phy clk assert failed\n"); |
| return ret; |
| } |
| usleep_range(10000, 12000); |
| ret = clk_reset(motg->phy_reset_clk, CLK_RESET_DEASSERT); |
| if (ret) |
| dev_err(motg->otg.dev, "usb phy clk deassert failed\n"); |
| return ret; |
| } |
| |
| static int msm_otg_phy_reset(struct msm_otg *motg) |
| { |
| u32 val; |
| int ret; |
| int retries; |
| |
| ret = msm_otg_link_clk_reset(motg, 1); |
| if (ret) |
| return ret; |
| ret = msm_otg_phy_clk_reset(motg); |
| if (ret) |
| return ret; |
| ret = msm_otg_link_clk_reset(motg, 0); |
| if (ret) |
| return ret; |
| |
| val = readl(USB_PORTSC) & ~PORTSC_PTS_MASK; |
| writel(val | PORTSC_PTS_ULPI, USB_PORTSC); |
| |
| for (retries = 3; retries > 0; retries--) { |
| ret = ulpi_write(&motg->otg, ULPI_FUNC_CTRL_SUSPENDM, |
| ULPI_CLR(ULPI_FUNC_CTRL)); |
| if (!ret) |
| break; |
| ret = msm_otg_phy_clk_reset(motg); |
| if (ret) |
| return ret; |
| } |
| if (!retries) |
| return -ETIMEDOUT; |
| |
| /* This reset calibrates the phy, if the above write succeeded */ |
| ret = msm_otg_phy_clk_reset(motg); |
| if (ret) |
| return ret; |
| |
| for (retries = 3; retries > 0; retries--) { |
| ret = ulpi_read(&motg->otg, ULPI_DEBUG); |
| if (ret != -ETIMEDOUT) |
| break; |
| ret = msm_otg_phy_clk_reset(motg); |
| if (ret) |
| return ret; |
| } |
| if (!retries) |
| return -ETIMEDOUT; |
| |
| dev_info(motg->otg.dev, "phy_reset: success\n"); |
| return 0; |
| } |
| |
| #define LINK_RESET_TIMEOUT_USEC (250 * 1000) |
| static int msm_otg_link_reset(struct msm_otg *motg) |
| { |
| int cnt = 0; |
| |
| writel_relaxed(USBCMD_RESET, USB_USBCMD); |
| while (cnt < LINK_RESET_TIMEOUT_USEC) { |
| if (!(readl_relaxed(USB_USBCMD) & USBCMD_RESET)) |
| break; |
| udelay(1); |
| cnt++; |
| } |
| if (cnt >= LINK_RESET_TIMEOUT_USEC) |
| return -ETIMEDOUT; |
| |
| /* select ULPI phy */ |
| writel_relaxed(0x80000000, USB_PORTSC); |
| writel_relaxed(0x0, USB_AHBBURST); |
| writel_relaxed(0x00, USB_AHBMODE); |
| |
| return 0; |
| } |
| |
| static int msm_otg_reset(struct otg_transceiver *otg) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| int ret; |
| u32 val = 0; |
| u32 ulpi_val = 0; |
| |
| /* |
| * USB PHY and Link reset also reset the USB BAM. |
| * Thus perform reset operation only once to avoid |
| * USB BAM reset on other cases e.g. USB cable disconnections. |
| */ |
| if (pdata->disable_reset_on_disconnect) { |
| if (motg->reset_counter) |
| return 0; |
| else |
| motg->reset_counter++; |
| } |
| |
| clk_enable(motg->clk); |
| ret = msm_otg_phy_reset(motg); |
| if (ret) { |
| dev_err(otg->dev, "phy_reset failed\n"); |
| return ret; |
| } |
| |
| aca_id_turned_on = false; |
| ret = msm_otg_link_reset(motg); |
| if (ret) { |
| dev_err(otg->dev, "link reset failed\n"); |
| return ret; |
| } |
| msleep(100); |
| |
| ulpi_init(motg); |
| |
| /* Ensure that RESET operation is completed before turning off clock */ |
| mb(); |
| |
| clk_disable(motg->clk); |
| |
| if (pdata->otg_control == OTG_PHY_CONTROL) { |
| val = readl_relaxed(USB_OTGSC); |
| if (pdata->mode == USB_OTG) { |
| ulpi_val = ULPI_INT_IDGRD | ULPI_INT_SESS_VALID; |
| val |= OTGSC_IDIE | OTGSC_BSVIE; |
| } else if (pdata->mode == USB_PERIPHERAL) { |
| ulpi_val = ULPI_INT_SESS_VALID; |
| val |= OTGSC_BSVIE; |
| } |
| writel_relaxed(val, USB_OTGSC); |
| ulpi_write(otg, ulpi_val, ULPI_USB_INT_EN_RISE); |
| ulpi_write(otg, ulpi_val, ULPI_USB_INT_EN_FALL); |
| } |
| |
| return 0; |
| } |
| |
| static int msm_otg_set_suspend(struct otg_transceiver *otg, int suspend) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| |
| /* |
| * Allow bus suspend only for host mode. Device mode bus suspend |
| * is not implemented yet. |
| */ |
| if (!test_bit(ID, &motg->inputs) || test_bit(ID_A, &motg->inputs)) { |
| /* |
| * ID_GND --> ID_A transition can not be detected in LPM. |
| * Disallow host bus suspend when ACA is enabled. |
| */ |
| if (suspend && !aca_enabled()) |
| pm_runtime_put(otg->dev); |
| else |
| pm_runtime_resume(otg->dev); |
| } |
| |
| return 0; |
| } |
| |
| #define PHY_SUSPEND_TIMEOUT_USEC (500 * 1000) |
| #define PHY_RESUME_TIMEOUT_USEC (100 * 1000) |
| |
| #ifdef CONFIG_PM_SLEEP |
| static int msm_otg_suspend(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| struct usb_bus *bus = otg->host; |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| int cnt = 0; |
| bool host_bus_suspend; |
| u32 phy_ctrl_val = 0, cmd_val; |
| u32 portsc; |
| |
| if (atomic_read(&motg->in_lpm)) |
| return 0; |
| |
| disable_irq(motg->irq); |
| host_bus_suspend = otg->host && !test_bit(ID, &motg->inputs); |
| /* |
| * Chipidea 45-nm PHY suspend sequence: |
| * |
| * Interrupt Latch Register auto-clear feature is not present |
| * in all PHY versions. Latch register is clear on read type. |
| * Clear latch register to avoid spurious wakeup from |
| * low power mode (LPM). |
| * |
| * PHY comparators are disabled when PHY enters into low power |
| * mode (LPM). Keep PHY comparators ON in LPM only when we expect |
| * VBUS/Id notifications from USB PHY. Otherwise turn off USB |
| * PHY comparators. This save significant amount of power. |
| * |
| * PLL is not turned off when PHY enters into low power mode (LPM). |
| * Disable PLL for maximum power savings. |
| */ |
| |
| if (motg->pdata->phy_type == CI_45NM_INTEGRATED_PHY) { |
| ulpi_read(otg, 0x14); |
| if (pdata->otg_control == OTG_PHY_CONTROL) |
| ulpi_write(otg, 0x01, 0x30); |
| ulpi_write(otg, 0x08, 0x09); |
| } |
| |
| /* |
| * Turn off the OTG comparators, if depends on PMIC for |
| * VBUS and ID notifications. |
| */ |
| if ((motg->caps & ALLOW_PHY_COMP_DISABLE) && !host_bus_suspend) { |
| ulpi_write(otg, OTG_COMP_DISABLE, |
| ULPI_SET(ULPI_PWR_CLK_MNG_REG)); |
| motg->lpm_flags |= PHY_OTG_COMP_DISABLED; |
| } |
| |
| /* Set the PHCD bit, only if it is not set by the controller. |
| * PHY may take some time or even fail to enter into low power |
| * mode (LPM). Hence poll for 500 msec and reset the PHY and link |
| * in failure case. |
| */ |
| portsc = readl_relaxed(USB_PORTSC); |
| if (!(portsc & PORTSC_PHCD)) { |
| writel_relaxed(portsc | PORTSC_PHCD, |
| USB_PORTSC); |
| while (cnt < PHY_SUSPEND_TIMEOUT_USEC) { |
| if (readl_relaxed(USB_PORTSC) & PORTSC_PHCD) |
| break; |
| udelay(1); |
| cnt++; |
| } |
| } |
| |
| if (cnt >= PHY_SUSPEND_TIMEOUT_USEC) { |
| dev_err(otg->dev, "Unable to suspend PHY\n"); |
| msm_otg_reset(otg); |
| enable_irq(motg->irq); |
| return -ETIMEDOUT; |
| } |
| |
| /* |
| * PHY has capability to generate interrupt asynchronously in low |
| * power mode (LPM). This interrupt is level triggered. So USB IRQ |
| * line must be disabled till async interrupt enable bit is cleared |
| * in USBCMD register. Assert STP (ULPI interface STOP signal) to |
| * block data communication from PHY. |
| */ |
| cmd_val = readl_relaxed(USB_USBCMD); |
| if (host_bus_suspend) |
| cmd_val |= ASYNC_INTR_CTRL | ULPI_STP_CTRL; |
| else |
| cmd_val |= ULPI_STP_CTRL; |
| writel_relaxed(cmd_val, USB_USBCMD); |
| |
| if (motg->caps & ALLOW_PHY_RETENTION && !host_bus_suspend) { |
| phy_ctrl_val = readl_relaxed(USB_PHY_CTRL); |
| if (motg->pdata->otg_control == OTG_PHY_CONTROL) |
| /* Enable PHY HV interrupts to wake MPM/Link */ |
| phy_ctrl_val |= |
| (PHY_IDHV_INTEN | PHY_OTGSESSVLDHV_INTEN); |
| |
| writel_relaxed(phy_ctrl_val & ~PHY_RETEN, USB_PHY_CTRL); |
| motg->lpm_flags |= PHY_RETENTIONED; |
| } |
| |
| /* Ensure that above operation is completed before turning off clocks */ |
| mb(); |
| clk_disable(motg->pclk); |
| clk_disable(motg->core_clk); |
| |
| /* usb phy no more require TCXO clock, hence vote for TCXO disable */ |
| clk_disable_unprepare(motg->xo_handle); |
| |
| if (motg->caps & ALLOW_PHY_POWER_COLLAPSE && !host_bus_suspend) { |
| msm_hsusb_ldo_enable(motg, 0); |
| motg->lpm_flags |= PHY_PWR_COLLAPSED; |
| } |
| |
| if (motg->lpm_flags & PHY_RETENTIONED) { |
| msm_hsusb_config_vddcx(0); |
| msm_hsusb_mhl_switch_enable(motg, 0); |
| } |
| |
| if (device_may_wakeup(otg->dev)) { |
| enable_irq_wake(motg->irq); |
| if (motg->pdata->pmic_id_irq) |
| enable_irq_wake(motg->pdata->pmic_id_irq); |
| } |
| if (bus) |
| clear_bit(HCD_FLAG_HW_ACCESSIBLE, &(bus_to_hcd(bus))->flags); |
| |
| atomic_set(&motg->in_lpm, 1); |
| enable_irq(motg->irq); |
| wake_unlock(&motg->wlock); |
| |
| dev_info(otg->dev, "USB in low power mode\n"); |
| |
| return 0; |
| } |
| |
| static int msm_otg_resume(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| struct usb_bus *bus = otg->host; |
| int cnt = 0; |
| unsigned temp; |
| u32 phy_ctrl_val = 0; |
| unsigned ret; |
| |
| if (!atomic_read(&motg->in_lpm)) |
| return 0; |
| |
| wake_lock(&motg->wlock); |
| |
| /* Vote for TCXO when waking up the phy */ |
| ret = clk_prepare_enable(motg->xo_handle); |
| if (ret) |
| dev_err(otg->dev, "%s failed to vote for " |
| "TCXO D0 buffer%d\n", __func__, ret); |
| |
| clk_enable(motg->core_clk); |
| |
| clk_enable(motg->pclk); |
| |
| if (motg->lpm_flags & PHY_PWR_COLLAPSED) { |
| msm_hsusb_ldo_enable(motg, 1); |
| motg->lpm_flags &= ~PHY_PWR_COLLAPSED; |
| } |
| |
| if (motg->lpm_flags & PHY_RETENTIONED) { |
| msm_hsusb_mhl_switch_enable(motg, 1); |
| msm_hsusb_config_vddcx(1); |
| phy_ctrl_val = readl_relaxed(USB_PHY_CTRL); |
| phy_ctrl_val |= PHY_RETEN; |
| if (motg->pdata->otg_control == OTG_PHY_CONTROL) |
| /* Disable PHY HV interrupts */ |
| phy_ctrl_val &= |
| ~(PHY_IDHV_INTEN | PHY_OTGSESSVLDHV_INTEN); |
| writel_relaxed(phy_ctrl_val, USB_PHY_CTRL); |
| motg->lpm_flags &= ~PHY_RETENTIONED; |
| } |
| |
| temp = readl(USB_USBCMD); |
| temp &= ~ASYNC_INTR_CTRL; |
| temp &= ~ULPI_STP_CTRL; |
| writel(temp, USB_USBCMD); |
| |
| /* |
| * PHY comes out of low power mode (LPM) in case of wakeup |
| * from asynchronous interrupt. |
| */ |
| if (!(readl(USB_PORTSC) & PORTSC_PHCD)) |
| goto skip_phy_resume; |
| |
| writel(readl(USB_PORTSC) & ~PORTSC_PHCD, USB_PORTSC); |
| while (cnt < PHY_RESUME_TIMEOUT_USEC) { |
| if (!(readl(USB_PORTSC) & PORTSC_PHCD)) |
| break; |
| udelay(1); |
| cnt++; |
| } |
| |
| if (cnt >= PHY_RESUME_TIMEOUT_USEC) { |
| /* |
| * This is a fatal error. Reset the link and |
| * PHY. USB state can not be restored. Re-insertion |
| * of USB cable is the only way to get USB working. |
| */ |
| dev_err(otg->dev, "Unable to resume USB." |
| "Re-plugin the cable\n"); |
| msm_otg_reset(otg); |
| } |
| |
| skip_phy_resume: |
| /* Turn on the OTG comparators on resume */ |
| if (motg->lpm_flags & PHY_OTG_COMP_DISABLED) { |
| ulpi_write(otg, OTG_COMP_DISABLE, |
| ULPI_CLR(ULPI_PWR_CLK_MNG_REG)); |
| motg->lpm_flags &= ~PHY_OTG_COMP_DISABLED; |
| } |
| if (device_may_wakeup(otg->dev)) { |
| disable_irq_wake(motg->irq); |
| if (motg->pdata->pmic_id_irq) |
| disable_irq_wake(motg->pdata->pmic_id_irq); |
| } |
| if (bus) |
| set_bit(HCD_FLAG_HW_ACCESSIBLE, &(bus_to_hcd(bus))->flags); |
| |
| atomic_set(&motg->in_lpm, 0); |
| |
| if (motg->async_int) { |
| motg->async_int = 0; |
| enable_irq(motg->irq); |
| } |
| |
| dev_info(otg->dev, "USB exited from low power mode\n"); |
| |
| return 0; |
| } |
| #endif |
| |
| static int msm_otg_notify_chg_type(struct msm_otg *motg) |
| { |
| static int charger_type; |
| /* |
| * TODO |
| * Unify OTG driver charger types and power supply charger types |
| */ |
| if (charger_type == motg->chg_type) |
| return 0; |
| |
| if (motg->chg_type == USB_SDP_CHARGER) |
| charger_type = POWER_SUPPLY_TYPE_USB; |
| else if (motg->chg_type == USB_CDP_CHARGER) |
| charger_type = POWER_SUPPLY_TYPE_USB_CDP; |
| else if (motg->chg_type == USB_DCP_CHARGER) |
| charger_type = POWER_SUPPLY_TYPE_USB_DCP; |
| else if ((motg->chg_type == USB_ACA_DOCK_CHARGER || |
| motg->chg_type == USB_ACA_A_CHARGER || |
| motg->chg_type == USB_ACA_B_CHARGER || |
| motg->chg_type == USB_ACA_C_CHARGER)) |
| charger_type = POWER_SUPPLY_TYPE_USB_ACA; |
| else |
| charger_type = POWER_SUPPLY_TYPE_BATTERY; |
| |
| return pm8921_set_usb_power_supply_type(charger_type); |
| } |
| |
| static int msm_otg_notify_power_supply(struct msm_otg *motg, unsigned mA) |
| { |
| struct power_supply *psy; |
| |
| psy = power_supply_get_by_name("usb"); |
| if (!psy) |
| goto psy_not_supported; |
| |
| if (motg->cur_power == 0 && mA > 0) { |
| /* Enable charging */ |
| if (power_supply_set_online(psy, true)) |
| goto psy_not_supported; |
| } else if (motg->cur_power > 0 && mA == 0) { |
| /* Disable charging */ |
| if (power_supply_set_online(psy, false)) |
| goto psy_not_supported; |
| return 0; |
| } |
| /* Set max current limit */ |
| if (power_supply_set_current_limit(psy, 1000*mA)) |
| goto psy_not_supported; |
| |
| return 0; |
| |
| psy_not_supported: |
| dev_dbg(motg->otg.dev, "Power Supply doesn't support USB charger\n"); |
| return -ENXIO; |
| } |
| |
| static void msm_otg_notify_charger(struct msm_otg *motg, unsigned mA) |
| { |
| if ((motg->chg_type == USB_ACA_DOCK_CHARGER || |
| motg->chg_type == USB_ACA_A_CHARGER || |
| motg->chg_type == USB_ACA_B_CHARGER || |
| motg->chg_type == USB_ACA_C_CHARGER) && |
| mA > IDEV_ACA_CHG_LIMIT) |
| mA = IDEV_ACA_CHG_LIMIT; |
| |
| if (msm_otg_notify_chg_type(motg)) |
| dev_err(motg->otg.dev, |
| "Failed notifying %d charger type to PMIC\n", |
| motg->chg_type); |
| |
| if (motg->cur_power == mA) |
| return; |
| |
| dev_info(motg->otg.dev, "Avail curr from USB = %u\n", mA); |
| |
| /* |
| * Use Power Supply API if supported, otherwise fallback |
| * to legacy pm8921 API. |
| */ |
| if (msm_otg_notify_power_supply(motg, mA)) |
| pm8921_charger_vbus_draw(mA); |
| |
| motg->cur_power = mA; |
| } |
| |
| static int msm_otg_set_power(struct otg_transceiver *otg, unsigned mA) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| |
| /* |
| * Gadget driver uses set_power method to notify about the |
| * available current based on suspend/configured states. |
| * |
| * IDEV_CHG can be drawn irrespective of suspend/un-configured |
| * states when CDP/ACA is connected. |
| */ |
| if (motg->chg_type == USB_SDP_CHARGER) |
| msm_otg_notify_charger(motg, mA); |
| |
| return 0; |
| } |
| |
| static void msm_otg_start_host(struct otg_transceiver *otg, int on) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| struct usb_hcd *hcd; |
| |
| if (!otg->host) |
| return; |
| |
| hcd = bus_to_hcd(otg->host); |
| |
| if (on) { |
| dev_dbg(otg->dev, "host on\n"); |
| |
| /* |
| * Some boards have a switch cotrolled by gpio |
| * to enable/disable internal HUB. Enable internal |
| * HUB before kicking the host. |
| */ |
| if (pdata->setup_gpio) |
| pdata->setup_gpio(OTG_STATE_A_HOST); |
| usb_add_hcd(hcd, hcd->irq, IRQF_SHARED); |
| } else { |
| dev_dbg(otg->dev, "host off\n"); |
| |
| usb_remove_hcd(hcd); |
| /* HCD core reset all bits of PORTSC. select ULPI phy */ |
| writel_relaxed(0x80000000, USB_PORTSC); |
| |
| if (pdata->setup_gpio) |
| pdata->setup_gpio(OTG_STATE_UNDEFINED); |
| } |
| } |
| |
| static int msm_otg_usbdev_notify(struct notifier_block *self, |
| unsigned long action, void *priv) |
| { |
| struct msm_otg *motg = container_of(self, struct msm_otg, usbdev_nb); |
| struct usb_device *udev = priv; |
| |
| if (!aca_enabled()) |
| goto out; |
| |
| if (action == USB_BUS_ADD || action == USB_BUS_REMOVE) |
| goto out; |
| |
| if (udev->bus != motg->otg.host) |
| goto out; |
| /* |
| * Interested in devices connected directly to the root hub. |
| * ACA dock can supply IDEV_CHG irrespective devices connected |
| * on the accessory port. |
| */ |
| if (!udev->parent || udev->parent->parent || |
| motg->chg_type == USB_ACA_DOCK_CHARGER) |
| goto out; |
| |
| switch (action) { |
| case USB_DEVICE_ADD: |
| usb_disable_autosuspend(udev); |
| /* fall through */ |
| case USB_DEVICE_CONFIG: |
| if (udev->actconfig) |
| motg->mA_port = udev->actconfig->desc.bMaxPower * 2; |
| else |
| motg->mA_port = IUNIT; |
| break; |
| case USB_DEVICE_REMOVE: |
| motg->mA_port = IUNIT; |
| break; |
| default: |
| break; |
| } |
| if (test_bit(ID_A, &motg->inputs)) |
| msm_otg_notify_charger(motg, IDEV_ACA_CHG_MAX - |
| motg->mA_port); |
| out: |
| return NOTIFY_OK; |
| } |
| |
| static void msm_hsusb_vbus_power(struct msm_otg *motg, bool on) |
| { |
| int ret; |
| static bool vbus_is_on; |
| |
| if (vbus_is_on == on) |
| return; |
| |
| if (motg->pdata->vbus_power) { |
| ret = motg->pdata->vbus_power(on); |
| if (!ret) |
| vbus_is_on = on; |
| return; |
| } |
| |
| if (!vbus_otg) { |
| pr_err("vbus_otg is NULL."); |
| return; |
| } |
| |
| /* |
| * if entering host mode tell the charger to not draw any current |
| * from usb - if exiting host mode let the charger draw current |
| */ |
| pm8921_disable_source_current(on); |
| if (on) { |
| ret = regulator_enable(vbus_otg); |
| if (ret) { |
| pr_err("unable to enable vbus_otg\n"); |
| return; |
| } |
| vbus_is_on = true; |
| } else { |
| ret = regulator_disable(vbus_otg); |
| if (ret) { |
| pr_err("unable to disable vbus_otg\n"); |
| return; |
| } |
| vbus_is_on = false; |
| } |
| } |
| |
| static int msm_otg_set_host(struct otg_transceiver *otg, struct usb_bus *host) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| struct usb_hcd *hcd; |
| |
| /* |
| * Fail host registration if this board can support |
| * only peripheral configuration. |
| */ |
| if (motg->pdata->mode == USB_PERIPHERAL) { |
| dev_info(otg->dev, "Host mode is not supported\n"); |
| return -ENODEV; |
| } |
| |
| if (!motg->pdata->vbus_power && host) { |
| vbus_otg = regulator_get(motg->otg.dev, "vbus_otg"); |
| if (IS_ERR(vbus_otg)) { |
| pr_err("Unable to get vbus_otg\n"); |
| return -ENODEV; |
| } |
| } |
| |
| if (!host) { |
| if (otg->state == OTG_STATE_A_HOST) { |
| pm_runtime_get_sync(otg->dev); |
| usb_unregister_notify(&motg->usbdev_nb); |
| msm_otg_start_host(otg, 0); |
| msm_hsusb_vbus_power(motg, 0); |
| otg->host = NULL; |
| otg->state = OTG_STATE_UNDEFINED; |
| schedule_work(&motg->sm_work); |
| } else { |
| otg->host = NULL; |
| } |
| |
| if (vbus_otg) |
| regulator_put(vbus_otg); |
| |
| return 0; |
| } |
| |
| hcd = bus_to_hcd(host); |
| hcd->power_budget = motg->pdata->power_budget; |
| |
| motg->usbdev_nb.notifier_call = msm_otg_usbdev_notify; |
| usb_register_notify(&motg->usbdev_nb); |
| otg->host = host; |
| dev_dbg(otg->dev, "host driver registered w/ tranceiver\n"); |
| |
| /* |
| * Kick the state machine work, if peripheral is not supported |
| * or peripheral is already registered with us. |
| */ |
| if (motg->pdata->mode == USB_HOST || otg->gadget) { |
| pm_runtime_get_sync(otg->dev); |
| schedule_work(&motg->sm_work); |
| } |
| |
| return 0; |
| } |
| |
| static void msm_otg_start_peripheral(struct otg_transceiver *otg, int on) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| |
| if (!otg->gadget) |
| return; |
| |
| if (on) { |
| dev_dbg(otg->dev, "gadget on\n"); |
| /* |
| * Some boards have a switch cotrolled by gpio |
| * to enable/disable internal HUB. Disable internal |
| * HUB before kicking the gadget. |
| */ |
| if (pdata->setup_gpio) |
| pdata->setup_gpio(OTG_STATE_B_PERIPHERAL); |
| /* |
| * vote for minimum dma_latency to prevent idle |
| * power collapse(pc) while running in peripheral mode. |
| */ |
| otg_pm_qos_update_latency(motg, 1); |
| usb_gadget_vbus_connect(otg->gadget); |
| } else { |
| dev_dbg(otg->dev, "gadget off\n"); |
| usb_gadget_vbus_disconnect(otg->gadget); |
| otg_pm_qos_update_latency(motg, 0); |
| if (pdata->setup_gpio) |
| pdata->setup_gpio(OTG_STATE_UNDEFINED); |
| } |
| |
| } |
| |
| static int msm_otg_set_peripheral(struct otg_transceiver *otg, |
| struct usb_gadget *gadget) |
| { |
| struct msm_otg *motg = container_of(otg, struct msm_otg, otg); |
| |
| /* |
| * Fail peripheral registration if this board can support |
| * only host configuration. |
| */ |
| if (motg->pdata->mode == USB_HOST) { |
| dev_info(otg->dev, "Peripheral mode is not supported\n"); |
| return -ENODEV; |
| } |
| |
| if (!gadget) { |
| if (otg->state == OTG_STATE_B_PERIPHERAL) { |
| pm_runtime_get_sync(otg->dev); |
| msm_otg_start_peripheral(otg, 0); |
| otg->gadget = NULL; |
| otg->state = OTG_STATE_UNDEFINED; |
| schedule_work(&motg->sm_work); |
| } else { |
| otg->gadget = NULL; |
| } |
| |
| return 0; |
| } |
| otg->gadget = gadget; |
| dev_dbg(otg->dev, "peripheral driver registered w/ tranceiver\n"); |
| |
| /* |
| * Kick the state machine work, if host is not supported |
| * or host is already registered with us. |
| */ |
| if (motg->pdata->mode == USB_PERIPHERAL || otg->host) { |
| pm_runtime_get_sync(otg->dev); |
| schedule_work(&motg->sm_work); |
| } |
| |
| return 0; |
| } |
| |
| static bool msm_chg_aca_detect(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 int_sts; |
| bool ret = false; |
| |
| if (!aca_enabled()) |
| goto out; |
| |
| if (motg->pdata->phy_type == CI_45NM_INTEGRATED_PHY) |
| goto out; |
| |
| int_sts = ulpi_read(otg, 0x87); |
| switch (int_sts & 0x1C) { |
| case 0x08: |
| if (!test_and_set_bit(ID_A, &motg->inputs)) { |
| dev_dbg(otg->dev, "ID_A\n"); |
| motg->chg_type = USB_ACA_A_CHARGER; |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| clear_bit(ID_B, &motg->inputs); |
| clear_bit(ID_C, &motg->inputs); |
| set_bit(ID, &motg->inputs); |
| ret = true; |
| } |
| break; |
| case 0x0C: |
| if (!test_and_set_bit(ID_B, &motg->inputs)) { |
| dev_dbg(otg->dev, "ID_B\n"); |
| motg->chg_type = USB_ACA_B_CHARGER; |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| clear_bit(ID_A, &motg->inputs); |
| clear_bit(ID_C, &motg->inputs); |
| set_bit(ID, &motg->inputs); |
| ret = true; |
| } |
| break; |
| case 0x10: |
| if (!test_and_set_bit(ID_C, &motg->inputs)) { |
| dev_dbg(otg->dev, "ID_C\n"); |
| motg->chg_type = USB_ACA_C_CHARGER; |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| clear_bit(ID_A, &motg->inputs); |
| clear_bit(ID_B, &motg->inputs); |
| set_bit(ID, &motg->inputs); |
| ret = true; |
| } |
| break; |
| case 0x04: |
| if (test_and_clear_bit(ID, &motg->inputs)) { |
| dev_dbg(otg->dev, "ID_GND\n"); |
| motg->chg_type = USB_INVALID_CHARGER; |
| motg->chg_state = USB_CHG_STATE_UNDEFINED; |
| clear_bit(ID_A, &motg->inputs); |
| clear_bit(ID_B, &motg->inputs); |
| clear_bit(ID_C, &motg->inputs); |
| ret = true; |
| } |
| break; |
| default: |
| ret = test_and_clear_bit(ID_A, &motg->inputs) | |
| test_and_clear_bit(ID_B, &motg->inputs) | |
| test_and_clear_bit(ID_C, &motg->inputs) | |
| !test_and_set_bit(ID, &motg->inputs); |
| if (ret) { |
| dev_dbg(otg->dev, "ID A/B/C/GND is no more\n"); |
| motg->chg_type = USB_INVALID_CHARGER; |
| motg->chg_state = USB_CHG_STATE_UNDEFINED; |
| } |
| } |
| out: |
| return ret; |
| } |
| |
| static void msm_chg_enable_aca_det(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| |
| if (!aca_enabled()) |
| return; |
| |
| switch (motg->pdata->phy_type) { |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* Disable ID_GND in link and PHY */ |
| writel_relaxed(readl_relaxed(USB_OTGSC) & ~(OTGSC_IDPU | |
| OTGSC_IDIE), USB_OTGSC); |
| ulpi_write(otg, 0x01, 0x0C); |
| ulpi_write(otg, 0x10, 0x0F); |
| ulpi_write(otg, 0x10, 0x12); |
| /* Enable ACA ID detection */ |
| ulpi_write(otg, 0x20, 0x85); |
| aca_id_turned_on = true; |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void msm_chg_enable_aca_intr(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| |
| if (!aca_enabled()) |
| return; |
| |
| switch (motg->pdata->phy_type) { |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* Enable ACA Detection interrupt (on any RID change) */ |
| ulpi_write(otg, 0x01, 0x94); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void msm_chg_disable_aca_intr(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| |
| if (!aca_enabled()) |
| return; |
| |
| switch (motg->pdata->phy_type) { |
| case SNPS_28NM_INTEGRATED_PHY: |
| ulpi_write(otg, 0x01, 0x95); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static bool msm_chg_check_aca_intr(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| bool ret = false; |
| |
| if (!aca_enabled()) |
| return ret; |
| |
| switch (motg->pdata->phy_type) { |
| case SNPS_28NM_INTEGRATED_PHY: |
| if (ulpi_read(otg, 0x91) & 1) { |
| dev_dbg(otg->dev, "RID change\n"); |
| ulpi_write(otg, 0x01, 0x92); |
| ret = msm_chg_aca_detect(motg); |
| } |
| default: |
| break; |
| } |
| return ret; |
| } |
| |
| static void msm_otg_id_timer_func(unsigned long data) |
| { |
| struct msm_otg *motg = (struct msm_otg *) data; |
| |
| if (!aca_enabled()) |
| return; |
| |
| if (atomic_read(&motg->in_lpm)) { |
| dev_dbg(motg->otg.dev, "timer: in lpm\n"); |
| return; |
| } |
| |
| if (msm_chg_check_aca_intr(motg)) { |
| dev_dbg(motg->otg.dev, "timer: aca work\n"); |
| schedule_work(&motg->sm_work); |
| } |
| |
| if (!test_bit(ID, &motg->inputs) || test_bit(ID_A, &motg->inputs)) |
| mod_timer(&motg->id_timer, ID_TIMER_FREQ); |
| } |
| |
| static bool msm_chg_check_secondary_det(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 chg_det; |
| bool ret = false; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| ret = chg_det & (1 << 4); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x87); |
| ret = chg_det & 1; |
| break; |
| default: |
| break; |
| } |
| return ret; |
| } |
| |
| static void msm_chg_enable_secondary_det(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 chg_det; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| /* Turn off charger block */ |
| chg_det |= ~(1 << 1); |
| ulpi_write(otg, chg_det, 0x34); |
| udelay(20); |
| /* control chg block via ULPI */ |
| chg_det &= ~(1 << 3); |
| ulpi_write(otg, chg_det, 0x34); |
| /* put it in host mode for enabling D- source */ |
| chg_det &= ~(1 << 2); |
| ulpi_write(otg, chg_det, 0x34); |
| /* Turn on chg detect block */ |
| chg_det &= ~(1 << 1); |
| ulpi_write(otg, chg_det, 0x34); |
| udelay(20); |
| /* enable chg detection */ |
| chg_det &= ~(1 << 0); |
| ulpi_write(otg, chg_det, 0x34); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* |
| * Configure DM as current source, DP as current sink |
| * and enable battery charging comparators. |
| */ |
| ulpi_write(otg, 0x8, 0x85); |
| ulpi_write(otg, 0x2, 0x85); |
| ulpi_write(otg, 0x1, 0x85); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static bool msm_chg_check_primary_det(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 chg_det; |
| bool ret = false; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| ret = chg_det & (1 << 4); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x87); |
| ret = chg_det & 1; |
| break; |
| default: |
| break; |
| } |
| return ret; |
| } |
| |
| static void msm_chg_enable_primary_det(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 chg_det; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| /* enable chg detection */ |
| chg_det &= ~(1 << 0); |
| ulpi_write(otg, chg_det, 0x34); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* |
| * Configure DP as current source, DM as current sink |
| * and enable battery charging comparators. |
| */ |
| ulpi_write(otg, 0x2, 0x85); |
| ulpi_write(otg, 0x1, 0x85); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static bool msm_chg_check_dcd(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 line_state; |
| bool ret = false; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| line_state = ulpi_read(otg, 0x15); |
| ret = !(line_state & 1); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| line_state = ulpi_read(otg, 0x87); |
| ret = line_state & 2; |
| break; |
| default: |
| break; |
| } |
| return ret; |
| } |
| |
| static void msm_chg_disable_dcd(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 chg_det; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| chg_det &= ~(1 << 5); |
| ulpi_write(otg, chg_det, 0x34); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| ulpi_write(otg, 0x10, 0x86); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void msm_chg_enable_dcd(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 chg_det; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| /* Turn on D+ current source */ |
| chg_det |= (1 << 5); |
| ulpi_write(otg, chg_det, 0x34); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* Data contact detection enable */ |
| ulpi_write(otg, 0x10, 0x85); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void msm_chg_block_on(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 func_ctrl, chg_det; |
| |
| /* put the controller in non-driving mode */ |
| func_ctrl = ulpi_read(otg, ULPI_FUNC_CTRL); |
| func_ctrl &= ~ULPI_FUNC_CTRL_OPMODE_MASK; |
| func_ctrl |= ULPI_FUNC_CTRL_OPMODE_NONDRIVING; |
| ulpi_write(otg, func_ctrl, ULPI_FUNC_CTRL); |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| /* control chg block via ULPI */ |
| chg_det &= ~(1 << 3); |
| ulpi_write(otg, chg_det, 0x34); |
| /* Turn on chg detect block */ |
| chg_det &= ~(1 << 1); |
| ulpi_write(otg, chg_det, 0x34); |
| udelay(20); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* Clear charger detecting control bits */ |
| ulpi_write(otg, 0x1F, 0x86); |
| /* Clear alt interrupt latch and enable bits */ |
| ulpi_write(otg, 0x1F, 0x92); |
| ulpi_write(otg, 0x1F, 0x95); |
| udelay(100); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void msm_chg_block_off(struct msm_otg *motg) |
| { |
| struct otg_transceiver *otg = &motg->otg; |
| u32 func_ctrl, chg_det; |
| |
| switch (motg->pdata->phy_type) { |
| case CI_45NM_INTEGRATED_PHY: |
| chg_det = ulpi_read(otg, 0x34); |
| /* Turn off charger block */ |
| chg_det |= ~(1 << 1); |
| ulpi_write(otg, chg_det, 0x34); |
| break; |
| case SNPS_28NM_INTEGRATED_PHY: |
| /* Clear charger detecting control bits */ |
| ulpi_write(otg, 0x3F, 0x86); |
| /* Clear alt interrupt latch and enable bits */ |
| ulpi_write(otg, 0x1F, 0x92); |
| ulpi_write(otg, 0x1F, 0x95); |
| break; |
| default: |
| break; |
| } |
| |
| /* put the controller in normal mode */ |
| func_ctrl = ulpi_read(otg, ULPI_FUNC_CTRL); |
| func_ctrl &= ~ULPI_FUNC_CTRL_OPMODE_MASK; |
| func_ctrl |= ULPI_FUNC_CTRL_OPMODE_NORMAL; |
| ulpi_write(otg, func_ctrl, ULPI_FUNC_CTRL); |
| } |
| |
| static const char *chg_to_string(enum usb_chg_type chg_type) |
| { |
| switch (chg_type) { |
| case USB_SDP_CHARGER: return "USB_SDP_CHARGER"; |
| case USB_DCP_CHARGER: return "USB_DCP_CHARGER"; |
| case USB_CDP_CHARGER: return "USB_CDP_CHARGER"; |
| case USB_ACA_A_CHARGER: return "USB_ACA_A_CHARGER"; |
| case USB_ACA_B_CHARGER: return "USB_ACA_B_CHARGER"; |
| case USB_ACA_C_CHARGER: return "USB_ACA_C_CHARGER"; |
| case USB_ACA_DOCK_CHARGER: return "USB_ACA_DOCK_CHARGER"; |
| default: return "INVALID_CHARGER"; |
| } |
| } |
| |
| #define MSM_CHG_DCD_POLL_TIME (100 * HZ/1000) /* 100 msec */ |
| #define MSM_CHG_DCD_MAX_RETRIES 6 /* Tdcd_tmout = 6 * 100 msec */ |
| #define MSM_CHG_PRIMARY_DET_TIME (40 * HZ/1000) /* TVDPSRC_ON */ |
| #define MSM_CHG_SECONDARY_DET_TIME (40 * HZ/1000) /* TVDMSRC_ON */ |
| static void msm_chg_detect_work(struct work_struct *w) |
| { |
| struct msm_otg *motg = container_of(w, struct msm_otg, chg_work.work); |
| struct otg_transceiver *otg = &motg->otg; |
| bool is_dcd = false, tmout, vout, is_aca; |
| unsigned long delay; |
| |
| dev_dbg(otg->dev, "chg detection work\n"); |
| switch (motg->chg_state) { |
| case USB_CHG_STATE_UNDEFINED: |
| msm_chg_block_on(motg); |
| if (motg->pdata->enable_dcd) |
| msm_chg_enable_dcd(motg); |
| msm_chg_enable_aca_det(motg); |
| motg->chg_state = USB_CHG_STATE_WAIT_FOR_DCD; |
| motg->dcd_retries = 0; |
| delay = MSM_CHG_DCD_POLL_TIME; |
| break; |
| case USB_CHG_STATE_WAIT_FOR_DCD: |
| is_aca = msm_chg_aca_detect(motg); |
| if (is_aca) { |
| /* |
| * ID_A can be ACA dock too. continue |
| * primary detection after DCD. |
| */ |
| if (test_bit(ID_A, &motg->inputs)) { |
| motg->chg_state = USB_CHG_STATE_WAIT_FOR_DCD; |
| } else { |
| delay = 0; |
| break; |
| } |
| } |
| if (motg->pdata->enable_dcd) |
| is_dcd = msm_chg_check_dcd(motg); |
| tmout = ++motg->dcd_retries == MSM_CHG_DCD_MAX_RETRIES; |
| if (is_dcd || tmout) { |
| if (motg->pdata->enable_dcd) |
| msm_chg_disable_dcd(motg); |
| msm_chg_enable_primary_det(motg); |
| delay = MSM_CHG_PRIMARY_DET_TIME; |
| motg->chg_state = USB_CHG_STATE_DCD_DONE; |
| } else { |
| delay = MSM_CHG_DCD_POLL_TIME; |
| } |
| break; |
| case USB_CHG_STATE_DCD_DONE: |
| vout = msm_chg_check_primary_det(motg); |
| if (vout) { |
| if (test_bit(ID_A, &motg->inputs)) { |
| motg->chg_type = USB_ACA_DOCK_CHARGER; |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| delay = 0; |
| break; |
| } |
| msm_chg_enable_secondary_det(motg); |
| delay = MSM_CHG_SECONDARY_DET_TIME; |
| motg->chg_state = USB_CHG_STATE_PRIMARY_DONE; |
| } else { |
| if (test_bit(ID_A, &motg->inputs)) { |
| motg->chg_type = USB_ACA_A_CHARGER; |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| delay = 0; |
| break; |
| } |
| motg->chg_type = USB_SDP_CHARGER; |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| delay = 0; |
| } |
| break; |
| case USB_CHG_STATE_PRIMARY_DONE: |
| vout = msm_chg_check_secondary_det(motg); |
| if (vout) |
| motg->chg_type = USB_DCP_CHARGER; |
| else |
| motg->chg_type = USB_CDP_CHARGER; |
| motg->chg_state = USB_CHG_STATE_SECONDARY_DONE; |
| /* fall through */ |
| case USB_CHG_STATE_SECONDARY_DONE: |
| motg->chg_state = USB_CHG_STATE_DETECTED; |
| case USB_CHG_STATE_DETECTED: |
| msm_chg_block_off(motg); |
| msm_chg_enable_aca_det(motg); |
| msm_chg_enable_aca_intr(motg); |
| dev_dbg(otg->dev, "chg_type = %s\n", |
| chg_to_string(motg->chg_type)); |
| schedule_work(&motg->sm_work); |
| return; |
| default: |
| return; |
| } |
| |
| schedule_delayed_work(&motg->chg_work, delay); |
| } |
| |
| /* |
| * We support OTG, Peripheral only and Host only configurations. In case |
| * of OTG, mode switch (host-->peripheral/peripheral-->host) can happen |
| * via Id pin status or user request (debugfs). Id/BSV interrupts are not |
| * enabled when switch is controlled by user and default mode is supplied |
| * by board file, which can be changed by userspace later. |
| */ |
| static void msm_otg_init_sm(struct msm_otg *motg) |
| { |
| struct msm_otg_platform_data *pdata = motg->pdata; |
| u32 otgsc = readl(USB_OTGSC); |
| |
| switch (pdata->mode) { |
| case USB_OTG: |
| if (pdata->otg_control == OTG_USER_CONTROL) { |
| if (pdata->default_mode == USB_HOST) { |
| clear_bit(ID, &motg->inputs); |
| } else if (pdata->default_mode == USB_PERIPHERAL) { |
| set_bit(ID, &motg->inputs); |
| set_bit(B_SESS_VLD, &motg->inputs); |
| } else { |
| set_bit(ID, &motg->inputs); |
| clear_bit(B_SESS_VLD, &motg->inputs); |
| } |
| } else if (pdata->otg_control == OTG_PHY_CONTROL) { |
| if (otgsc & OTGSC_ID) |
| set_bit(ID, &motg->inputs); |
| else |
| clear_bit(ID, &motg->inputs); |
| if (otgsc & OTGSC_BSV) |
| set_bit(B_SESS_VLD, &motg->inputs); |
| else |
| clear_bit(B_SESS_VLD, &motg->inputs); |
| } else if (pdata->otg_control == OTG_PMIC_CONTROL) { |
| if (pdata->pmic_id_irq) { |
| if (irq_read_line(pdata->pmic_id_irq)) |
| set_bit(ID, &motg->inputs); |
| else |
| clear_bit(ID, &motg->inputs); |
| } |
| /* |
| * VBUS initial state is reported after PMIC |
| * driver initialization. Wait for it. |
| */ |
| wait_for_completion(&pmic_vbus_init); |
| } |
| break; |
| case USB_HOST: |
| clear_bit(ID, &motg->inputs); |
| break; |
| case USB_PERIPHERAL: |
| set_bit(ID, &motg->inputs); |
| if (pdata->otg_control == OTG_PHY_CONTROL) { |
| if (otgsc & OTGSC_BSV) |
| set_bit(B_SESS_VLD, &motg->inputs); |
| else |
| clear_bit(B_SESS_VLD, &motg->inputs); |
| } else if (pdata->otg_control == OTG_PMIC_CONTROL) { |
| /* |
| * VBUS initial state is reported after PMIC |
| * driver initialization. Wait for it. |
| */ |
| wait_for_completion(&pmic_vbus_init); |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static void msm_otg_sm_work(struct work_struct *w) |
| { |
| struct msm_otg *motg = container_of(w, struct msm_otg, sm_work); |
| struct otg_transceiver *otg = &motg->otg; |
| |
| pm_runtime_resume(otg->dev); |
| switch (otg->state) { |
| case OTG_STATE_UNDEFINED: |
| dev_dbg(otg->dev, "OTG_STATE_UNDEFINED state\n"); |
| msm_otg_reset(otg); |
| msm_otg_init_sm(motg); |
| otg->state = OTG_STATE_B_IDLE; |
| if (!test_bit(B_SESS_VLD, &motg->inputs) && |
| test_bit(ID, &motg->inputs)) { |
| pm_runtime_put_noidle(otg->dev); |
| pm_runtime_suspend(otg->dev); |
| break; |
| } |
| /* FALL THROUGH */ |
| case OTG_STATE_B_IDLE: |
| dev_dbg(otg->dev, "OTG_STATE_B_IDLE state\n"); |
| if ((!test_bit(ID, &motg->inputs) || |
| test_bit(ID_A, &motg->inputs)) && otg->host) { |
| if (motg->chg_type == USB_ACA_DOCK_CHARGER) |
| msm_otg_notify_charger(motg, |
| IDEV_ACA_CHG_MAX); |
| else if (test_bit(ID_A, &motg->inputs)) |
| msm_otg_notify_charger(motg, |
| IDEV_ACA_CHG_MAX - IUNIT); |
| else |
| msm_hsusb_vbus_power(motg, 1); |
| msm_otg_start_host(otg, 1); |
| /* |
| * Link can not generate PHY_ALT interrupt |
| * in host mode when no device is attached |
| * to the port. It is also observed PHY_ALT |
| * interrupt missing upon Micro-A cable disconnect. |
| * Hence disable PHY_ALT interrupt and perform |
| * polling to detect RID change. |
| */ |
| msm_chg_enable_aca_det(motg); |
| msm_chg_disable_aca_intr(motg); |
| mod_timer(&motg->id_timer, ID_TIMER_FREQ); |
| otg->state = OTG_STATE_A_HOST; |
| } else if (test_bit(B_SESS_VLD, &motg->inputs)) { |
| switch (motg->chg_state) { |
| case USB_CHG_STATE_UNDEFINED: |
| msm_chg_detect_work(&motg->chg_work.work); |
| break; |
| case USB_CHG_STATE_DETECTED: |
| switch (motg->chg_type) { |
| case USB_DCP_CHARGER: |
| msm_otg_notify_charger(motg, |
| IDEV_CHG_MAX); |
| pm_runtime_put_noidle(otg->dev); |
| pm_runtime_suspend(otg->dev); |
| break; |
| case USB_ACA_B_CHARGER: |
| msm_otg_notify_charger(motg, |
| IDEV_ACA_CHG_MAX); |
| /* |
| * (ID_B --> ID_C) PHY_ALT interrupt can |
| * not be detected in LPM. |
| */ |
| break; |
| case USB_CDP_CHARGER: |
| msm_otg_notify_charger(motg, |
| IDEV_CHG_MAX); |
| msm_otg_start_peripheral(otg, 1); |
| otg->state = OTG_STATE_B_PERIPHERAL; |
| break; |
| case USB_ACA_C_CHARGER: |
| msm_otg_notify_charger(motg, |
| IDEV_ACA_CHG_MAX); |
| msm_otg_start_peripheral(otg, 1); |
| otg->state = OTG_STATE_B_PERIPHERAL; |
| break; |
| case USB_SDP_CHARGER: |
| msm_otg_start_peripheral(otg, 1); |
| otg->state = OTG_STATE_B_PERIPHERAL; |
| break; |
| default: |
| break; |
| } |
| break; |
| default: |
| break; |
| } |
| } else { |
| cancel_delayed_work_sync(&motg->chg_work); |
| msm_otg_notify_charger(motg, 0); |
| motg->chg_state = USB_CHG_STATE_UNDEFINED; |
| motg->chg_type = USB_INVALID_CHARGER; |
| msm_otg_reset(otg); |
| pm_runtime_put_noidle(otg->dev); |
| pm_runtime_suspend(otg->dev); |
| } |
| break; |
| case OTG_STATE_B_PERIPHERAL: |
| dev_dbg(otg->dev, "OTG_STATE_B_PERIPHERAL state\n"); |
| if (!test_bit(B_SESS_VLD, &motg->inputs) || |
| !test_bit(ID, &motg->inputs) || |
| !test_bit(ID_C, &motg->inputs)) { |
| msm_otg_start_peripheral(otg, 0); |
| otg->state = OTG_STATE_B_IDLE; |
| schedule_work(w); |
| } else if (test_bit(ID_C, &motg->inputs)) { |
| msm_otg_notify_charger(motg, IDEV_ACA_CHG_MAX); |
| } |
| break; |
| case OTG_STATE_A_HOST: |
| dev_dbg(otg->dev, "OTG_STATE_A_HOST state\n"); |
| if (test_bit(ID, &motg->inputs) && |
| !test_bit(ID_A, &motg->inputs)) { |
| msm_otg_start_host(otg, 0); |
| msm_hsusb_vbus_power(motg, 0); |
| msleep(100); /* TA_WAIT_VFALL */ |
| /* |
| * Exit point of host mode. |
| * |
| * 1. Micro-A cable disconnect: Just schedule |
| * the work. PHY is reset in B_IDLE and LPM |
| * is allowed. |
| * 2. ID_GND --> ID_B: No need to reset the PHY. |
| * HCD core clears all PORTSC bits and initializes |
| * the controller to host mode in remove_hcd. |
| * Restore PORTSC transceiver select bits (ULPI) |
| * and reset the controller to change MODE bits. |
| * PHY_ALT interrupt can not occur in host mode. |
| */ |
| del_timer_sync(&motg->id_timer); |
| if (motg->chg_state != USB_CHG_STATE_UNDEFINED) { |
| msm_otg_link_reset(motg); |
| msm_chg_enable_aca_intr(motg); |
| } |
| otg->state = OTG_STATE_B_IDLE; |
| schedule_work(w); |
| } else if (test_bit(ID_A, &motg->inputs)) { |
| msm_hsusb_vbus_power(motg, 0); |
| msm_otg_notify_charger(motg, |
| IDEV_ACA_CHG_MAX - motg->mA_port); |
| } else if (!test_bit(ID, &motg->inputs)) { |
| msm_otg_notify_charger(motg, 0); |
| msm_hsusb_vbus_power(motg, 1); |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| |
| static irqreturn_t msm_otg_irq(int irq, void *data) |
| { |
| struct msm_otg *motg = data; |
| struct otg_transceiver *otg = &motg->otg; |
| u32 otgsc = 0, usbsts; |
| |
| if (atomic_read(&motg->in_lpm)) { |
| pr_debug("OTG IRQ: in LPM\n"); |
| disable_irq_nosync(irq); |
| motg->async_int = 1; |
| pm_request_resume(otg->dev); |
| return IRQ_HANDLED; |
| } |
| |
| usbsts = readl(USB_USBSTS); |
| if ((usbsts & PHY_ALT_INT)) { |
| dev_dbg(otg->dev, "PHY_ALT interrupt\n"); |
| writel(PHY_ALT_INT, USB_USBSTS); |
| if (msm_chg_check_aca_intr(motg)) { |
| dev_dbg(otg->dev, "ACA work from IRQ\n"); |
| schedule_work(&motg->sm_work); |
| } |
| return IRQ_HANDLED; |
| } |
| |
| otgsc = readl(USB_OTGSC); |
| if (!(otgsc & (OTGSC_IDIS | OTGSC_BSVIS))) |
| return IRQ_NONE; |
| |
| if ((otgsc & OTGSC_IDIS) && (otgsc & OTGSC_IDIE)) { |
| if (otgsc & OTGSC_ID) { |
| dev_dbg(otg->dev, "ID set\n"); |
| set_bit(ID, &motg->inputs); |
| } else { |
| dev_dbg(otg->dev, "ID clear\n"); |
| clear_bit(ID, &motg->inputs); |
| msm_chg_enable_aca_det(motg); |
| } |
| schedule_work(&motg->sm_work); |
| } else if ((otgsc & OTGSC_BSVIS) && (otgsc & OTGSC_BSVIE)) { |
| if (otgsc & OTGSC_BSV) { |
| dev_dbg(otg->dev, "BSV set\n"); |
| set_bit(B_SESS_VLD, &motg->inputs); |
| } else { |
| dev_dbg(otg->dev, "BSV clear\n"); |
| clear_bit(B_SESS_VLD, &motg->inputs); |
| msm_chg_check_aca_intr(motg); |
| } |
| schedule_work(&motg->sm_work); |
| } |
| |
| writel(otgsc, USB_OTGSC); |
| return IRQ_HANDLED; |
| } |
| |
| static void msm_otg_set_vbus_state(int online) |
| { |
| static bool init; |
| struct msm_otg *motg = the_msm_otg; |
| |
| if (online) { |
| pr_debug("PMIC: BSV set\n"); |
| set_bit(B_SESS_VLD, &motg->inputs); |
| } else { |
| pr_debug("PMIC: BSV clear\n"); |
| clear_bit(B_SESS_VLD, &motg->inputs); |
| } |
| |
| if (!init) { |
| init = true; |
| complete(&pmic_vbus_init); |
| pr_debug("PMIC: BSV init complete\n"); |
| return; |
| } |
| |
| schedule_work(&motg->sm_work); |
| } |
| |
| static irqreturn_t msm_pmic_id_irq(int irq, void *data) |
| { |
| struct msm_otg *motg = data; |
| |
| if (aca_id_turned_on) |
| return IRQ_HANDLED; |
| |
| if (irq_read_line(motg->pdata->pmic_id_irq)) { |
| pr_debug("PMIC: ID set\n"); |
| set_bit(ID, &motg->inputs); |
| } else { |
| pr_debug("PMIC: ID clear\n"); |
| clear_bit(ID, &motg->inputs); |
| } |
| |
| if (motg->otg.state != OTG_STATE_UNDEFINED) |
| schedule_work(&motg->sm_work); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static int msm_otg_mode_show(struct seq_file *s, void *unused) |
| { |
| struct msm_otg *motg = s->private; |
| struct otg_transceiver *otg = &motg->otg; |
| |
| switch (otg->state) { |
| case OTG_STATE_A_HOST: |
| seq_printf(s, "host\n"); |
| break; |
| case OTG_STATE_B_PERIPHERAL: |
| seq_printf(s, "peripheral\n"); |
| break; |
| default: |
| seq_printf(s, "none\n"); |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int msm_otg_mode_open(struct inode *inode, struct file *file) |
| { |
| return single_open(file, msm_otg_mode_show, inode->i_private); |
| } |
| |
| static ssize_t msm_otg_mode_write(struct file *file, const char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| struct seq_file *s = file->private_data; |
| struct msm_otg *motg = s->private; |
| char buf[16]; |
| struct otg_transceiver *otg = &motg->otg; |
| int status = count; |
| enum usb_mode_type req_mode; |
| |
| memset(buf, 0x00, sizeof(buf)); |
| |
| if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count))) { |
| status = -EFAULT; |
| goto out; |
| } |
| |
| if (!strncmp(buf, "host", 4)) { |
| req_mode = USB_HOST; |
| } else if (!strncmp(buf, "peripheral", 10)) { |
| req_mode = USB_PERIPHERAL; |
| } else if (!strncmp(buf, "none", 4)) { |
| req_mode = USB_NONE; |
| } else { |
| status = -EINVAL; |
| goto out; |
| } |
| |
| switch (req_mode) { |
| case USB_NONE: |
| switch (otg->state) { |
| case OTG_STATE_A_HOST: |
| case OTG_STATE_B_PERIPHERAL: |
| set_bit(ID, &motg->inputs); |
| clear_bit(B_SESS_VLD, &motg->inputs); |
| break; |
| default: |
| goto out; |
| } |
| break; |
| case USB_PERIPHERAL: |
| switch (otg->state) { |
| case OTG_STATE_B_IDLE: |
| case OTG_STATE_A_HOST: |
| set_bit(ID, &motg->inputs); |
| set_bit(B_SESS_VLD, &motg->inputs); |
| break; |
| default: |
| goto out; |
| } |
| break; |
| case USB_HOST: |
| switch (otg->state) { |
| case OTG_STATE_B_IDLE: |
| case OTG_STATE_B_PERIPHERAL: |
| clear_bit(ID, &motg->inputs); |
| break; |
| default: |
| goto out; |
| } |
| break; |
| default: |
| goto out; |
| } |
| |
| pm_runtime_resume(otg->dev); |
| schedule_work(&motg->sm_work); |
| out: |
| return status; |
| } |
| |
| const struct file_operations msm_otg_mode_fops = { |
| .open = msm_otg_mode_open, |
| .read = seq_read, |
| .write = msm_otg_mode_write, |
| .llseek = seq_lseek, |
| .release = single_release, |
| }; |
| |
| static int msm_otg_show_chg_type(struct seq_file *s, void *unused) |
| { |
| struct msm_otg *motg = s->private; |
| |
| seq_printf(s, "%s\n", chg_to_string(motg->chg_type)); |
| return 0; |
| } |
| |
| static int msm_otg_chg_open(struct inode *inode, struct file *file) |
| { |
| return single_open(file, msm_otg_show_chg_type, inode->i_private); |
| } |
| |
| const struct file_operations msm_otg_chg_fops = { |
| .open = msm_otg_chg_open, |
| .read = seq_read, |
| .llseek = seq_lseek, |
| .release = single_release, |
| }; |
| |
| static int msm_otg_aca_show(struct seq_file *s, void *unused) |
| { |
| if (debug_aca_enabled) |
| seq_printf(s, "enabled\n"); |
| else |
| seq_printf(s, "disabled\n"); |
| |
| return 0; |
| } |
| |
| static int msm_otg_aca_open(struct inode *inode, struct file *file) |
| { |
| return single_open(file, msm_otg_aca_show, inode->i_private); |
| } |
| |
| static ssize_t msm_otg_aca_write(struct file *file, const char __user *ubuf, |
| size_t count, loff_t *ppos) |
| { |
| char buf[8]; |
| |
| memset(buf, 0x00, sizeof(buf)); |
| |
| if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count))) |
| return -EFAULT; |
| |
| if (!strncmp(buf, "enable", 6)) |
| debug_aca_enabled = true; |
| else |
| debug_aca_enabled = false; |
| |
| return count; |
| } |
| |
| const struct file_operations msm_otg_aca_fops = { |
| .open = msm_otg_aca_open, |
| .read = seq_read, |
| .write = msm_otg_aca_write, |
| .llseek = seq_lseek, |
| .release = single_release, |
| }; |
| |
| static struct dentry *msm_otg_dbg_root; |
| static struct dentry *msm_otg_dbg_mode; |
| static struct dentry *msm_otg_chg_type; |
| static struct dentry *msm_otg_dbg_aca; |
| |
| static int msm_otg_debugfs_init(struct msm_otg *motg) |
| { |
| |
| msm_otg_dbg_root = debugfs_create_dir("msm_otg", NULL); |
| |
| if (!msm_otg_dbg_root || IS_ERR(msm_otg_dbg_root)) |
| return -ENODEV; |
| |
| if (motg->pdata->mode == USB_OTG && |
| motg->pdata->otg_control == OTG_USER_CONTROL) { |
| |
| msm_otg_dbg_mode = debugfs_create_file("mode", S_IRUGO | |
| S_IWUSR, msm_otg_dbg_root, motg, |
| &msm_otg_mode_fops); |
| |
| if (!msm_otg_dbg_mode) { |
| debugfs_remove(msm_otg_dbg_root); |
| msm_otg_dbg_root = NULL; |
| return -ENODEV; |
| } |
| } |
| |
| msm_otg_chg_type = debugfs_create_file("chg_type", S_IRUGO, |
| msm_otg_dbg_root, motg, |
| &msm_otg_chg_fops); |
| |
| if (!msm_otg_chg_type) { |
| debugfs_remove_recursive(msm_otg_dbg_root); |
| return -ENODEV; |
| } |
| |
| msm_otg_dbg_aca = debugfs_create_file("aca", S_IRUGO | S_IWUSR, |
| msm_otg_dbg_root, motg, |
| &msm_otg_aca_fops); |
| |
| if (!msm_otg_dbg_aca) { |
| debugfs_remove_recursive(msm_otg_dbg_root); |
| return -ENODEV; |
| } |
| |
| return 0; |
| } |
| |
| static void msm_otg_debugfs_cleanup(void) |
| { |
| debugfs_remove_recursive(msm_otg_dbg_root); |
| } |
| |
| static u64 msm_otg_dma_mask = DMA_BIT_MASK(64); |
| static struct platform_device *msm_otg_add_pdev( |
| struct platform_device *ofdev, const char *name) |
| { |
| struct platform_device *pdev; |
| const struct resource *res = ofdev->resource; |
| unsigned int num = ofdev->num_resources; |
| int retval; |
| |
| pdev = platform_device_alloc(name, -1); |
| if (!pdev) { |
| retval = -ENOMEM; |
| goto error; |
| } |
| |
| pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32); |
| pdev->dev.dma_mask = &msm_otg_dma_mask; |
| |
| if (num) { |
| retval = platform_device_add_resources(pdev, res, num); |
| if (retval) |
| goto error; |
| } |
| |
| retval = platform_device_add(pdev); |
| if (retval) |
| goto error; |
| |
| return pdev; |
| |
| error: |
| platform_device_put(pdev); |
| return ERR_PTR(retval); |
| } |
| |
| static int msm_otg_setup_devices(struct platform_device *ofdev, |
| enum usb_mode_type mode, bool init) |
| { |
| const char *gadget_name = "msm_hsusb"; |
| const char *host_name = "msm_hsusb_host"; |
| static struct platform_device *gadget_pdev; |
| static struct platform_device *host_pdev; |
| int retval = 0; |
| |
| if (!init) { |
| if (gadget_pdev) |
| platform_device_unregister(gadget_pdev); |
| if (host_pdev) |
| platform_device_unregister(host_pdev); |
| return 0; |
| } |
| |
| switch (mode) { |
| case USB_OTG: |
| /* fall through */ |
| case USB_PERIPHERAL: |
| gadget_pdev = msm_otg_add_pdev(ofdev, gadget_name); |
| if (IS_ERR(gadget_pdev)) { |
| retval = PTR_ERR(gadget_pdev); |
| break; |
| } |
| if (mode == USB_PERIPHERAL) |
| break; |
| /* fall through */ |
| case USB_HOST: |
| host_pdev = msm_otg_add_pdev(ofdev, host_name); |
| if (IS_ERR(host_pdev)) { |
| retval = PTR_ERR(host_pdev); |
| if (mode == USB_OTG) |
| platform_device_unregister(gadget_pdev); |
| } |
| break; |
| default: |
| break; |
| } |
| |
| return retval; |
| } |
| |
| struct msm_otg_platform_data *msm_otg_dt_to_pdata(struct platform_device *pdev) |
| { |
| struct device_node *node = pdev->dev.of_node; |
| struct msm_otg_platform_data *pdata; |
| int len = 0; |
| |
| pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); |
| if (!pdata) { |
| pr_err("unable to allocate platform data\n"); |
| return NULL; |
| } |
| of_get_property(node, "qcom,hsusb-otg-phy-init-seq", &len); |
| if (len) { |
| pdata->phy_init_seq = devm_kzalloc(&pdev->dev, len, GFP_KERNEL); |
| if (!pdata->phy_init_seq) |
| return NULL; |
| of_property_read_u32_array(node, "qcom,hsusb-otg-phy-init-seq", |
| pdata->phy_init_seq, |
| len/sizeof(*pdata->phy_init_seq)); |
| } |
| of_property_read_u32(node, "qcom,hsusb-otg-power-budget", |
| &pdata->power_budget); |
| of_property_read_u32(node, "qcom,hsusb-otg-mode", |
| &pdata->mode); |
| of_property_read_u32(node, "qcom,hsusb-otg-otg-control", |
| &pdata->otg_control); |
| of_property_read_u32(node, "qcom,hsusb-otg-default-mode", |
| &pdata->default_mode); |
| of_property_read_u32(node, "qcom,hsusb-otg-phy-type", |
| &pdata->phy_type); |
| of_property_read_u32(node, "qcom,hsusb-otg-pmic-id-irq", |
| &pdata->pmic_id_irq); |
| return pdata; |
| } |
| |
| static int __init msm_otg_probe(struct platform_device *pdev) |
| { |
| int ret = 0; |
| struct resource *res; |
| struct msm_otg *motg; |
| struct otg_transceiver *otg; |
| struct msm_otg_platform_data *pdata; |
| |
| dev_info(&pdev->dev, "msm_otg probe\n"); |
| |
| if (pdev->dev.of_node) { |
| dev_dbg(&pdev->dev, "device tree enabled\n"); |
| pdata = msm_otg_dt_to_pdata(pdev); |
| if (!pdata) |
| return -ENOMEM; |
| ret = msm_otg_setup_devices(pdev, pdata->mode, true); |
| if (ret) { |
| dev_err(&pdev->dev, "devices setup failed\n"); |
| return ret; |
| } |
| } else if (!pdev->dev.platform_data) { |
| dev_err(&pdev->dev, "No platform data given. Bailing out\n"); |
| return -ENODEV; |
| } else { |
| pdata = pdev->dev.platform_data; |
| } |
| |
| motg = kzalloc(sizeof(struct msm_otg), GFP_KERNEL); |
| if (!motg) { |
| dev_err(&pdev->dev, "unable to allocate msm_otg\n"); |
| return -ENOMEM; |
| } |
| |
| the_msm_otg = motg; |
| motg->pdata = pdata; |
| otg = &motg->otg; |
| otg->dev = &pdev->dev; |
| |
| /* |
| * ACA ID_GND threshold range is overlapped with OTG ID_FLOAT. Hence |
| * PHY treat ACA ID_GND as float and no interrupt is generated. But |
| * PMIC can detect ACA ID_GND and generate an interrupt. |
| */ |
| if (aca_enabled() && motg->pdata->otg_control != OTG_PMIC_CONTROL) { |
| dev_err(&pdev->dev, "ACA can not be enabled without PMIC\n"); |
| ret = -EINVAL; |
| goto free_motg; |
| } |
| |
| /* initialize reset counter */ |
| motg->reset_counter = 0; |
| |
| /* Some targets don't support PHY clock. */ |
| motg->phy_reset_clk = clk_get(&pdev->dev, "phy_clk"); |
| if (IS_ERR(motg->phy_reset_clk)) |
| dev_err(&pdev->dev, "failed to get phy_clk\n"); |
| |
| motg->clk = clk_get(&pdev->dev, "alt_core_clk"); |
| if (IS_ERR(motg->clk)) { |
| dev_err(&pdev->dev, "failed to get alt_core_clk\n"); |
| ret = PTR_ERR(motg->clk); |
| goto put_phy_reset_clk; |
| } |
| clk_set_rate(motg->clk, 60000000); |
| |
| /* pm qos request to prevent apps idle power collapse */ |
| if (motg->pdata->swfi_latency) |
| pm_qos_add_request(&motg->pm_qos_req_dma, |
| PM_QOS_CPU_DMA_LATENCY, PM_QOS_DEFAULT_VALUE); |
| |
| /* |
| * USB Core is running its protocol engine based on CORE CLK, |
| * CORE CLK must be running at >55Mhz for correct HSUSB |
| * operation and USB core cannot tolerate frequency changes on |
| * CORE CLK. For such USB cores, vote for maximum clk frequency |
| * on pclk source |
| */ |
| motg->core_clk = clk_get(&pdev->dev, "core_clk"); |
| if (IS_ERR(motg->core_clk)) { |
| motg->core_clk = NULL; |
| dev_err(&pdev->dev, "failed to get core_clk\n"); |
| ret = PTR_ERR(motg->clk); |
| goto put_clk; |
| } |
| clk_set_rate(motg->core_clk, INT_MAX); |
| |
| motg->pclk = clk_get(&pdev->dev, "iface_clk"); |
| if (IS_ERR(motg->pclk)) { |
| dev_err(&pdev->dev, "failed to get iface_clk\n"); |
| ret = PTR_ERR(motg->pclk); |
| goto put_core_clk; |
| } |
| |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| if (!res) { |
| dev_err(&pdev->dev, "failed to get platform resource mem\n"); |
| ret = -ENODEV; |
| goto put_pclk; |
| } |
| |
| motg->regs = ioremap(res->start, resource_size(res)); |
| if (!motg->regs) { |
| dev_err(&pdev->dev, "ioremap failed\n"); |
| ret = -ENOMEM; |
| goto put_pclk; |
| } |
| dev_info(&pdev->dev, "OTG regs = %p\n", motg->regs); |
| |
| motg->irq = platform_get_irq(pdev, 0); |
| if (!motg->irq) { |
| dev_err(&pdev->dev, "platform_get_irq failed\n"); |
| ret = -ENODEV; |
| goto free_regs; |
| } |
| |
| motg->xo_handle = clk_get(&pdev->dev, "xo"); |
| if (IS_ERR(motg->xo_handle)) { |
| dev_err(&pdev->dev, "%s not able to get the handle " |
| "to vote for TCXO D0 buffer\n", __func__); |
| ret = PTR_ERR(motg->xo_handle); |
| goto free_regs; |
| } |
| |
| ret = clk_prepare_enable(motg->xo_handle); |
| if (ret) { |
| dev_err(&pdev->dev, "%s failed to vote for TCXO " |
| "D0 buffer%d\n", __func__, ret); |
| goto free_xo_handle; |
| } |
| |
| clk_enable(motg->pclk); |
| |
| ret = msm_hsusb_init_vddcx(motg, 1); |
| if (ret) { |
| dev_err(&pdev->dev, "hsusb vddcx init failed\n"); |
| goto devote_xo_handle; |
| } |
| |
| ret = msm_hsusb_config_vddcx(1); |
| if (ret) { |
| dev_err(&pdev->dev, "hsusb vddcx configuration failed\n"); |
| goto free_init_vddcx; |
| } |
| |
| ret = msm_hsusb_ldo_init(motg, 1); |
| if (ret) { |
| dev_err(&pdev->dev, "hsusb vreg configuration failed\n"); |
| goto free_init_vddcx; |
| } |
| |
| ret = msm_hsusb_ldo_enable(motg, 1); |
| if (ret) { |
| dev_err(&pdev->dev, "hsusb vreg enable failed\n"); |
| goto free_ldo_init; |
| } |
| clk_enable(motg->core_clk); |
| |
| writel(0, USB_USBINTR); |
| writel(0, USB_OTGSC); |
| /* Ensure that above STOREs are completed before enabling interrupts */ |
| mb(); |
| |
| wake_lock_init(&motg->wlock, WAKE_LOCK_SUSPEND, "msm_otg"); |
| INIT_WORK(&motg->sm_work, msm_otg_sm_work); |
| INIT_DELAYED_WORK(&motg->chg_work, msm_chg_detect_work); |
| setup_timer(&motg->id_timer, msm_otg_id_timer_func, |
| (unsigned long) motg); |
| ret = request_irq(motg->irq, msm_otg_irq, IRQF_SHARED, |
| "msm_otg", motg); |
| if (ret) { |
| dev_err(&pdev->dev, "request irq failed\n"); |
| goto destroy_wlock; |
| } |
| |
| otg->init = msm_otg_reset; |
| otg->set_host = msm_otg_set_host; |
| otg->set_peripheral = msm_otg_set_peripheral; |
| otg->set_power = msm_otg_set_power; |
| otg->set_suspend = msm_otg_set_suspend; |
| |
| otg->io_ops = &msm_otg_io_ops; |
| |
| ret = otg_set_transceiver(&motg->otg); |
| if (ret) { |
| dev_err(&pdev->dev, "otg_set_transceiver failed\n"); |
| goto free_irq; |
| } |
| |
| if (motg->pdata->mode == USB_OTG && |
| motg->pdata->otg_control == OTG_PMIC_CONTROL) { |
| if (motg->pdata->pmic_id_irq) { |
| ret = request_irq(motg->pdata->pmic_id_irq, |
| msm_pmic_id_irq, |
| IRQF_TRIGGER_RISING | |
| IRQF_TRIGGER_FALLING, |
| "msm_otg", motg); |
| if (ret) { |
| dev_err(&pdev->dev, "request irq failed for PMIC ID\n"); |
| goto remove_otg; |
| } |
| } else { |
| ret = -ENODEV; |
| dev_err(&pdev->dev, "PMIC IRQ for ID notifications doesn't exist\n"); |
| goto remove_otg; |
| } |
| } |
| |
| msm_hsusb_mhl_switch_enable(motg, 1); |
| |
| platform_set_drvdata(pdev, motg); |
| device_init_wakeup(&pdev->dev, 1); |
| motg->mA_port = IUNIT; |
| |
| ret = msm_otg_debugfs_init(motg); |
| if (ret) |
| dev_dbg(&pdev->dev, "mode debugfs file is" |
| "not available\n"); |
| |
| if (motg->pdata->otg_control == OTG_PMIC_CONTROL) |
| pm8921_charger_register_vbus_sn(&msm_otg_set_vbus_state); |
| |
| if (motg->pdata->phy_type == SNPS_28NM_INTEGRATED_PHY) { |
| if (motg->pdata->otg_control == OTG_PMIC_CONTROL && |
| (!(motg->pdata->mode == USB_OTG) || |
| motg->pdata->pmic_id_irq)) |
| motg->caps = ALLOW_PHY_POWER_COLLAPSE | |
| ALLOW_PHY_RETENTION | |
| ALLOW_PHY_COMP_DISABLE; |
| |
| if (motg->pdata->otg_control == OTG_PHY_CONTROL) |
| motg->caps = ALLOW_PHY_RETENTION; |
| } |
| |
| wake_lock(&motg->wlock); |
| pm_runtime_set_active(&pdev->dev); |
| pm_runtime_enable(&pdev->dev); |
| |
| return 0; |
| |
| remove_otg: |
| otg_set_transceiver(NULL); |
| free_irq: |
| free_irq(motg->irq, motg); |
| destroy_wlock: |
| wake_lock_destroy(&motg->wlock); |
| clk_disable(motg->core_clk); |
| msm_hsusb_ldo_enable(motg, 0); |
| free_ldo_init: |
| msm_hsusb_ldo_init(motg, 0); |
| free_init_vddcx: |
| msm_hsusb_init_vddcx(motg, 0); |
| devote_xo_handle: |
| clk_disable(motg->pclk); |
| clk_disable_unprepare(motg->xo_handle); |
| free_xo_handle: |
| clk_put(motg->xo_handle); |
| free_regs: |
| iounmap(motg->regs); |
| put_pclk: |
| clk_put(motg->pclk); |
| put_core_clk: |
| clk_put(motg->core_clk); |
| put_clk: |
| clk_put(motg->clk); |
| put_phy_reset_clk: |
| if (!IS_ERR(motg->phy_reset_clk)) |
| clk_put(motg->phy_reset_clk); |
| free_motg: |
| if (motg->pdata->swfi_latency) |
| pm_qos_remove_request(&motg->pm_qos_req_dma); |
| kfree(motg); |
| return ret; |
| } |
| |
| static int __devexit msm_otg_remove(struct platform_device *pdev) |
| { |
| struct msm_otg *motg = platform_get_drvdata(pdev); |
| struct otg_transceiver *otg = &motg->otg; |
| int cnt = 0; |
| |
| if (otg->host || otg->gadget) |
| return -EBUSY; |
| |
| if (pdev->dev.of_node) |
| msm_otg_setup_devices(pdev, motg->pdata->mode, false); |
| if (motg->pdata->otg_control == OTG_PMIC_CONTROL) |
| pm8921_charger_unregister_vbus_sn(0); |
| msm_otg_debugfs_cleanup(); |
| cancel_delayed_work_sync(&motg->chg_work); |
| cancel_work_sync(&motg->sm_work); |
| |
| pm_runtime_resume(&pdev->dev); |
| |
| device_init_wakeup(&pdev->dev, 0); |
| pm_runtime_disable(&pdev->dev); |
| wake_lock_destroy(&motg->wlock); |
| |
| msm_hsusb_mhl_switch_enable(motg, 0); |
| if (motg->pdata->pmic_id_irq) |
| free_irq(motg->pdata->pmic_id_irq, motg); |
| otg_set_transceiver(NULL); |
| free_irq(motg->irq, motg); |
| |
| /* |
| * Put PHY in low power mode. |
| */ |
| ulpi_read(otg, 0x14); |
| ulpi_write(otg, 0x08, 0x09); |
| |
| writel(readl(USB_PORTSC) | PORTSC_PHCD, USB_PORTSC); |
| while (cnt < PHY_SUSPEND_TIMEOUT_USEC) { |
| if (readl(USB_PORTSC) & PORTSC_PHCD) |
| break; |
| udelay(1); |
| cnt++; |
| } |
| if (cnt >= PHY_SUSPEND_TIMEOUT_USEC) |
| dev_err(otg->dev, "Unable to suspend PHY\n"); |
| |
| clk_disable(motg->pclk); |
| clk_disable(motg->core_clk); |
| clk_put(motg->xo_handle); |
| msm_hsusb_ldo_enable(motg, 0); |
| msm_hsusb_ldo_init(motg, 0); |
| msm_hsusb_init_vddcx(motg, 0); |
| |
| iounmap(motg->regs); |
| pm_runtime_set_suspended(&pdev->dev); |
| |
| if (!IS_ERR(motg->phy_reset_clk)) |
| clk_put(motg->phy_reset_clk); |
| clk_put(motg->pclk); |
| clk_put(motg->clk); |
| clk_put(motg->core_clk); |
| |
| if (motg->pdata->swfi_latency) |
| pm_qos_remove_request(&motg->pm_qos_req_dma); |
| |
| kfree(motg); |
| return 0; |
| } |
| |
| #ifdef CONFIG_PM_RUNTIME |
| static int msm_otg_runtime_idle(struct device *dev) |
| { |
| struct msm_otg *motg = dev_get_drvdata(dev); |
| struct otg_transceiver *otg = &motg->otg; |
| |
| dev_dbg(dev, "OTG runtime idle\n"); |
| |
| if (otg->state == OTG_STATE_UNDEFINED) |
| return -EAGAIN; |
| else |
| return 0; |
| } |
| |
| static int msm_otg_runtime_suspend(struct device *dev) |
| { |
| struct msm_otg *motg = dev_get_drvdata(dev); |
| |
| dev_dbg(dev, "OTG runtime suspend\n"); |
| return msm_otg_suspend(motg); |
| } |
| |
| static int msm_otg_runtime_resume(struct device *dev) |
| { |
| struct msm_otg *motg = dev_get_drvdata(dev); |
| |
| dev_dbg(dev, "OTG runtime resume\n"); |
| pm_runtime_get_noresume(dev); |
| return msm_otg_resume(motg); |
| } |
| #endif |
| |
| #ifdef CONFIG_PM_SLEEP |
| static int msm_otg_pm_suspend(struct device *dev) |
| { |
| int ret; |
| |
| dev_dbg(dev, "OTG PM suspend\n"); |
| |
| #ifdef CONFIG_PM_RUNTIME |
| ret = pm_runtime_suspend(dev); |
| if (ret > 0) |
| ret = 0; |
| #else |
| ret = msm_otg_suspend(dev_get_drvdata(dev)); |
| #endif |
| return ret; |
| } |
| |
| static int msm_otg_pm_resume(struct device *dev) |
| { |
| struct msm_otg *motg = dev_get_drvdata(dev); |
| |
| dev_dbg(dev, "OTG PM resume\n"); |
| |
| #ifdef CONFIG_PM_RUNTIME |
| /* |
| * Do not resume hardware as part of system resume, |
| * rather, wait for the ASYNC INT from the h/w |
| */ |
| return 0; |
| #endif |
| |
| return msm_otg_resume(motg); |
| } |
| #endif |
| |
| #ifdef CONFIG_PM |
| static const struct dev_pm_ops msm_otg_dev_pm_ops = { |
| SET_SYSTEM_SLEEP_PM_OPS(msm_otg_pm_suspend, msm_otg_pm_resume) |
| SET_RUNTIME_PM_OPS(msm_otg_runtime_suspend, msm_otg_runtime_resume, |
| msm_otg_runtime_idle) |
| }; |
| #endif |
| |
| static struct of_device_id msm_otg_dt_match[] = { |
| { .compatible = "qcom,hsusb-otg", |
| }, |
| {} |
| }; |
| |
| static struct platform_driver msm_otg_driver = { |
| .remove = __devexit_p(msm_otg_remove), |
| .driver = { |
| .name = DRIVER_NAME, |
| .owner = THIS_MODULE, |
| #ifdef CONFIG_PM |
| .pm = &msm_otg_dev_pm_ops, |
| #endif |
| .of_match_table = msm_otg_dt_match, |
| }, |
| }; |
| |
| static int __init msm_otg_init(void) |
| { |
| return platform_driver_probe(&msm_otg_driver, msm_otg_probe); |
| } |
| |
| static void __exit msm_otg_exit(void) |
| { |
| platform_driver_unregister(&msm_otg_driver); |
| } |
| |
| module_init(msm_otg_init); |
| module_exit(msm_otg_exit); |
| |
| MODULE_LICENSE("GPL v2"); |
| MODULE_DESCRIPTION("MSM USB transceiver driver"); |