static int msm_otg_suspend(struct msm_otg *dev)
{
unsigned long timeout;
int vbus = 0;
disable_irq(dev->irq);
if (atomic_read(&dev->in_lpm))
goto out;
ulpi_read(dev, 0x14);/* clear PHY interrupt latch register */
/* If there is no pmic notify support turn on phy comparators. */
if (!dev->pmic_notif_supp)
ulpi_write(dev, 0x01, 0x30);
ulpi_write(dev, 0x08, 0x09);/* turn off PLL on integrated phy */
timeout = jiffies + msecs_to_jiffies(500);
disable_phy_clk();
while (!is_phy_clk_disabled()) {
if (time_after(jiffies, timeout)) {
pr_err("%s: Unable to suspend phy\n", __func__);
/* Reset both phy and link */
otg_reset(dev, 1);
goto out;
}
msleep(1);
}
writel(readl(USB_USBCMD) | ASYNC_INTR_CTRL | ULPI_STP_CTRL, USB_USBCMD);
if (dev->hs_pclk)
clk_disable(dev->hs_pclk);
if (dev->hs_cclk)
clk_disable(dev->hs_cclk);
if (device_may_wakeup(dev->otg.dev)) {
enable_irq_wake(dev->irq);
if (dev->vbus_on_irq)
enable_irq_wake(dev->vbus_on_irq);
}
atomic_set(&dev->in_lpm, 1);
if (!vbus && dev->pmic_notif_supp)
dev->pdata->pmic_enable_ldo(0);
pr_info("%s: usb in low power mode\n", __func__);
out:
enable_irq(dev->irq);
/* TBD: as there is no bus suspend implemented as of now
* it should be dummy check
*/
return 0;
}
static int msm_otg_suspend(struct msm_otg *dev)
{
unsigned long timeout;
int vbus = 0;
disable_irq(dev->irq);
if (dev->in_lpm)
goto out;
otg_reset(dev);
ulpi_read(dev, 0x14);/* clear PHY interrupt latch register */
ulpi_write(dev, 0x01, 0x30);/* PHY comparators on in LPM */
ulpi_write(dev, 0x08, 0x09);/* turn off PLL on integrated phy */
timeout = jiffies + msecs_to_jiffies(500);
disable_phy_clk();
while (!is_phy_clk_disabled()) {
if (time_after(jiffies, timeout)) {
pr_err("%s: Unable to suspend phy\n", __func__);
otg_reset(dev);
goto out;
}
msleep(1);
}
writel(readl(USB_USBCMD) | ASYNC_INTR_CTRL | ULPI_STP_CTRL, USB_USBCMD);
clk_disable(dev->clk);
clk_disable(dev->pclk);
if (device_may_wakeup(dev->otg.dev))
enable_irq_wake(dev->irq);
dev->in_lpm = 1;
/* TBD: as there is no bus suspend implemented as of now
* it should be dummy check
*/
if (!vbus || release_wlocks)
wake_unlock(&dev->wlock);
pr_info("%s: usb in low power mode\n", __func__);
out:
enable_irq(dev->irq);
return 0;
}
static int msm_otg_suspend(struct msm_otg *dev)
{
unsigned long timeout;
int vbus = 0;
unsigned otgsc;
disable_irq(dev->irq);
if (dev->in_lpm)
goto out;
/* Don't reset if mini-A cable is connected */
if (!is_host())
otg_reset(dev);
/* In case of fast plug-in and plug-out inside the otg_reset() the
* servicing of BSV is missed (in the window of after phy and link
* reset). Handle it if any missing bsv is detected */
if (is_b_sess_vld() && !is_host()) {
otgsc = readl(USB_OTGSC);
writel(otgsc, USB_OTGSC);
pr_info("%s:Process mising BSV\n", __func__);
msm_otg_start_peripheral(&dev->otg, 1);
enable_irq(dev->irq);
return -1;
}
ulpi_read(dev, 0x14);/* clear PHY interrupt latch register */
/* If there is no pmic notify support turn on phy comparators. */
if (!dev->pmic_notif_supp)
ulpi_write(dev, 0x01, 0x30);
ulpi_write(dev, 0x08, 0x09);/* turn off PLL on integrated phy */
timeout = jiffies + msecs_to_jiffies(500);
disable_phy_clk();
while (!is_phy_clk_disabled()) {
if (time_after(jiffies, timeout)) {
pr_err("%s: Unable to suspend phy\n", __func__);
otg_reset(dev);
goto out;
}
msleep(1);
}
writel(readl(USB_USBCMD) | ASYNC_INTR_CTRL | ULPI_STP_CTRL, USB_USBCMD);
clk_disable(dev->pclk);
if (dev->cclk)
clk_disable(dev->cclk);
if (device_may_wakeup(dev->otg.dev)) {
enable_irq_wake(dev->irq);
if (dev->vbus_on_irq)
enable_irq_wake(dev->vbus_on_irq);
}
dev->in_lpm = 1;
if (!vbus && dev->pmic_notif_supp)
dev->pmic_enable_ldo(0);
pr_info("%s: usb in low power mode\n", __func__);
out:
enable_irq(dev->irq);
/* TBD: as there is no bus suspend implemented as of now
* it should be dummy check
*/
return 0;
}
