Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm / ea1c8d08bc9e71723869f7e754aa1d57c56f55ce / . / drivers / usb / otg / msm72k_otg.c
blob: 84b847242c15426186455ae12586a4c08be09778 [file] [log] [blame]
/* Copyright (c) 2009-2011, 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/interrupt.h>
#include <linux/err.h>
#include <linux/delay.h>
#include <linux/io.h>
#include <linux/ioport.h>
#include <linux/pm_runtime.h>
#include <linux/device.h>
#include <linux/pm_qos_params.h>
#include <mach/msm_hsusb_hw.h>
#include <mach/msm72k_otg.h>
#include <mach/msm_hsusb.h>
#include <linux/debugfs.h>
#include <linux/uaccess.h>
#include <mach/clk.h>
#include <mach/msm_xo.h>
#define MSM_USB_BASE (dev->regs)
#define USB_LINK_RESET_TIMEOUT (msecs_to_jiffies(10))
#define DRIVER_NAME "msm_otg"
static void otg_reset(struct otg_transceiver *xceiv, int phy_reset);
static void msm_otg_set_vbus_state(int online);
static void msm_otg_set_id_state(int online);
struct msm_otg *the_msm_otg;
static int is_host(void)
{
struct msm_otg *dev = the_msm_otg;
if (dev->pmic_id_notif_supp)
return dev->pmic_id_status ? 0 : 1;
else if (dev->pdata->otg_mode == OTG_ID)
return (OTGSC_ID & readl(USB_OTGSC)) ? 0 : 1;
else
return !test_bit(ID, &dev->inputs);
}
static int is_b_sess_vld(void)
{
struct msm_otg *dev = the_msm_otg;
if (dev->pdata->otg_mode == OTG_ID)
return (OTGSC_BSV & readl(USB_OTGSC)) ? 1 : 0;
else
return test_bit(B_SESS_VLD, &dev->inputs);
}
static unsigned ulpi_read(struct msm_otg *dev, unsigned reg)
{
unsigned ret, timeout = 100000;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
/* initiate read operation */
writel(ULPI_RUN | ULPI_READ | ULPI_ADDR(reg),
USB_ULPI_VIEWPORT);
/* wait for completion */
while ((readl(USB_ULPI_VIEWPORT) & ULPI_RUN) && (--timeout))
cpu_relax();
if (timeout == 0) {
pr_err("%s: timeout %08x\n", __func__,
readl(USB_ULPI_VIEWPORT));
spin_unlock_irqrestore(&dev->lock, flags);
return 0xffffffff;
}
ret = ULPI_DATA_READ(readl(USB_ULPI_VIEWPORT));
spin_unlock_irqrestore(&dev->lock, flags);
return ret;
}
static int ulpi_write(struct msm_otg *dev, unsigned val, unsigned reg)
{
unsigned timeout = 10000;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
/* initiate write operation */
writel(ULPI_RUN | ULPI_WRITE |
ULPI_ADDR(reg) | ULPI_DATA(val),
USB_ULPI_VIEWPORT);
/* wait for completion */
while ((readl(USB_ULPI_VIEWPORT) & ULPI_RUN) && (--timeout))
;
if (timeout == 0) {
pr_err("%s: timeout\n", __func__);
spin_unlock_irqrestore(&dev->lock, flags);
return -1;
}
spin_unlock_irqrestore(&dev->lock, flags);
return 0;
}
static int usb_ulpi_write(struct otg_transceiver *xceiv, u32 val, u32 reg)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
return ulpi_write(dev, val, reg);
}
static int usb_ulpi_read(struct otg_transceiver *xceiv, u32 reg)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
return ulpi_read(dev, reg);
}
#ifdef CONFIG_USB_EHCI_MSM_72K
static void enable_idgnd(struct msm_otg *dev)
{
/* Do nothing if instead of ID pin, USER controls mode switch */
if (dev->pdata->otg_mode == OTG_USER_CONTROL)
return;
ulpi_write(dev, (1<<4), 0x0E);
ulpi_write(dev, (1<<4), 0x11);
writel(readl(USB_OTGSC) | OTGSC_IDIE, USB_OTGSC);
}
static void disable_idgnd(struct msm_otg *dev)
{
/* Do nothing if instead of ID pin, USER controls mode switch */
if (dev->pdata->otg_mode == OTG_USER_CONTROL)
return;
ulpi_write(dev, (1<<4), 0x0F);
ulpi_write(dev, (1<<4), 0x12);
writel(readl(USB_OTGSC) & ~OTGSC_IDIE, USB_OTGSC);
}
#endif
static void enable_idabc(struct msm_otg *dev)
{
#ifdef CONFIG_USB_MSM_ACA
ulpi_write(dev, (1<<5), 0x0E);
ulpi_write(dev, (1<<5), 0x11);
#endif
}
static void disable_idabc(struct msm_otg *dev)
{
#ifdef CONFIG_USB_MSM_ACA
ulpi_write(dev, (1<<5), 0x0F);
ulpi_write(dev, (1<<5), 0x12);
#endif
}
static void enable_sess_valid(struct msm_otg *dev)
{
/* Do nothing if instead of ID pin, USER controls mode switch */
if (dev->pdata->otg_mode == OTG_USER_CONTROL)
return;
ulpi_write(dev, (1<<2), 0x0E);
ulpi_write(dev, (1<<2), 0x11);
writel(readl(USB_OTGSC) | OTGSC_BSVIE, USB_OTGSC);
}
static void disable_sess_valid(struct msm_otg *dev)
{
/* Do nothing if instead of ID pin, USER controls mode switch */
if (dev->pdata->otg_mode == OTG_USER_CONTROL)
return;
ulpi_write(dev, (1<<2), 0x0F);
ulpi_write(dev, (1<<2), 0x12);
writel(readl(USB_OTGSC) & ~OTGSC_BSVIE, USB_OTGSC);
}
#ifdef CONFIG_USB_MSM_ACA
static void set_aca_id_inputs(struct msm_otg *dev)
{
u8 phy_ints;
phy_ints = ulpi_read(dev, 0x13);
if (phy_ints == -ETIMEDOUT)
return;
pr_debug("phy_ints = %x\n", phy_ints);
clear_bit(ID_A, &dev->inputs);
clear_bit(ID_B, &dev->inputs);
clear_bit(ID_C, &dev->inputs);
if (phy_id_state_a(phy_ints)) {
pr_debug("ID_A set\n");
set_bit(ID_A, &dev->inputs);
set_bit(A_BUS_REQ, &dev->inputs);
} else if (phy_id_state_b(phy_ints)) {
pr_debug("ID_B set\n");
set_bit(ID_B, &dev->inputs);
} else if (phy_id_state_c(phy_ints)) {
pr_debug("ID_C set\n");
set_bit(ID_C, &dev->inputs);
}
if (is_b_sess_vld())
set_bit(B_SESS_VLD, &dev->inputs);
else
clear_bit(B_SESS_VLD, &dev->inputs);
}
#define get_aca_bmaxpower(dev) (dev->b_max_power)
#define set_aca_bmaxpower(dev, power) (dev->b_max_power = power)
#else
#define get_aca_bmaxpower(dev) 0
#define set_aca_bmaxpower(dev, power)
#endif
static inline void set_pre_emphasis_level(struct msm_otg *dev)
{
unsigned res = 0;
if (!dev->pdata || dev->pdata->pemp_level == PRE_EMPHASIS_DEFAULT)
return;
res = ulpi_read(dev, ULPI_CONFIG_REG3);
res &= ~(ULPI_PRE_EMPHASIS_MASK);
if (dev->pdata->pemp_level != PRE_EMPHASIS_DISABLE)
res |= dev->pdata->pemp_level;
ulpi_write(dev, res, ULPI_CONFIG_REG3);
}
static inline void set_hsdrv_slope(struct msm_otg *dev)
{
unsigned res = 0;
if (!dev->pdata || dev->pdata->hsdrvslope == HS_DRV_SLOPE_DEFAULT)
return;
res = ulpi_read(dev, ULPI_CONFIG_REG3);
res &= ~(ULPI_HSDRVSLOPE_MASK);
res |= (dev->pdata->hsdrvslope & ULPI_HSDRVSLOPE_MASK);
ulpi_write(dev, res, ULPI_CONFIG_REG3);
}
static inline void set_cdr_auto_reset(struct msm_otg *dev)
{
unsigned res = 0;
if (!dev->pdata || dev->pdata->cdr_autoreset == CDR_AUTO_RESET_DEFAULT)
return;
res = ulpi_read(dev, ULPI_DIGOUT_CTRL);
if (dev->pdata->cdr_autoreset == CDR_AUTO_RESET_ENABLE)
res &= ~ULPI_CDR_AUTORESET;
else
res |= ULPI_CDR_AUTORESET;
ulpi_write(dev, res, ULPI_DIGOUT_CTRL);
}
static inline void set_se1_gating(struct msm_otg *dev)
{
unsigned res = 0;
if (!dev->pdata || dev->pdata->se1_gating == SE1_GATING_DEFAULT)
return;
res = ulpi_read(dev, ULPI_DIGOUT_CTRL);
if (dev->pdata->se1_gating == SE1_GATING_ENABLE)
res &= ~ULPI_SE1_GATE;
else
res |= ULPI_SE1_GATE;
ulpi_write(dev, res, ULPI_DIGOUT_CTRL);
}
static inline void set_driver_amplitude(struct msm_otg *dev)
{
unsigned res = 0;
if (!dev->pdata || dev->pdata->drv_ampl == HS_DRV_AMPLITUDE_DEFAULT)
return;
res = ulpi_read(dev, ULPI_CONFIG_REG2);
res &= ~ULPI_DRV_AMPL_MASK;
if (dev->pdata->drv_ampl != HS_DRV_AMPLITUDE_ZERO_PERCENT)
res |= dev->pdata->drv_ampl;
ulpi_write(dev, res, ULPI_CONFIG_REG2);
}
static const char *state_string(enum usb_otg_state state)
{
switch (state) {
case OTG_STATE_A_IDLE: return "a_idle";
case OTG_STATE_A_WAIT_VRISE: return "a_wait_vrise";
case OTG_STATE_A_WAIT_BCON: return "a_wait_bcon";
case OTG_STATE_A_HOST: return "a_host";
case OTG_STATE_A_SUSPEND: return "a_suspend";
case OTG_STATE_A_PERIPHERAL: return "a_peripheral";
case OTG_STATE_A_WAIT_VFALL: return "a_wait_vfall";
case OTG_STATE_A_VBUS_ERR: return "a_vbus_err";
case OTG_STATE_B_IDLE: return "b_idle";
case OTG_STATE_B_SRP_INIT: return "b_srp_init";
case OTG_STATE_B_PERIPHERAL: return "b_peripheral";
case OTG_STATE_B_WAIT_ACON: return "b_wait_acon";
case OTG_STATE_B_HOST: return "b_host";
default: return "UNDEFINED";
}
}
static const char *timer_string(int bit)
{
switch (bit) {
case A_WAIT_VRISE: return "a_wait_vrise";
case A_WAIT_VFALL: return "a_wait_vfall";
case B_SRP_FAIL: return "b_srp_fail";
case A_WAIT_BCON: return "a_wait_bcon";
case A_AIDL_BDIS: return "a_aidl_bdis";
case A_BIDL_ADIS: return "a_bidl_adis";
case B_ASE0_BRST: return "b_ase0_brst";
default: return "UNDEFINED";
}
}
/* 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)
swfi_latency = pdata->swfi_latency + 1;
if (vote)
pm_qos_update_request(&pdata->pm_qos_req_dma,
swfi_latency);
else
pm_qos_update_request(&pdata->pm_qos_req_dma,
PM_QOS_DEFAULT_VALUE);
}
/* If USB Core is running its protocol engine based on PCLK,
* PCLK must be running at >60Mhz for correct HSUSB operation and
* USB core cannot tolerate frequency changes on PCLK. For such
* USB cores, vote for maximum clk frequency on pclk source
*/
static void msm_otg_vote_for_pclk_source(struct msm_otg *dev, int vote)
{
if (dev->pclk_src && pclk_requires_voting(&dev->otg)) {
if (vote)
clk_enable(dev->pclk_src);
else
clk_disable(dev->pclk_src);
}
}
/* Controller gives interrupt for every 1 mesc if 1MSIE is set in OTGSC.
* This interrupt can be used as a timer source and OTG timers can be
* implemented. But hrtimers on MSM hardware can give atleast 1/32 KHZ
* precision. This precision is more than enough for OTG timers.
*/
static enum hrtimer_restart msm_otg_timer_func(struct hrtimer *_timer)
{
struct msm_otg *dev = container_of(_timer, struct msm_otg, timer);
/* Phy lockup issues are observed when VBUS Valid interrupt is
* enabled. Hence set A_VBUS_VLD upon timer exipration.
*/
if (dev->active_tmout == A_WAIT_VRISE)
set_bit(A_VBUS_VLD, &dev->inputs);
else
set_bit(dev->active_tmout, &dev->tmouts);
pr_debug("expired %s timer\n", timer_string(dev->active_tmout));
queue_work(dev->wq, &dev->sm_work);
return HRTIMER_NORESTART;
}
static void msm_otg_del_timer(struct msm_otg *dev)
{
int bit = dev->active_tmout;
pr_debug("deleting %s timer. remaining %lld msec \n", timer_string(bit),
div_s64(ktime_to_us(hrtimer_get_remaining(&dev->timer)),
1000));
hrtimer_cancel(&dev->timer);
clear_bit(bit, &dev->tmouts);
}
static void msm_otg_start_timer(struct msm_otg *dev, int time, int bit)
{
clear_bit(bit, &dev->tmouts);
dev->active_tmout = bit;
pr_debug("starting %s timer\n", timer_string(bit));
hrtimer_start(&dev->timer,
ktime_set(time / 1000, (time % 1000) * 1000000),
HRTIMER_MODE_REL);
}
/* No two otg timers run in parallel. So one hrtimer is sufficient */
static void msm_otg_init_timer(struct msm_otg *dev)
{
hrtimer_init(&dev->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
dev->timer.function = msm_otg_timer_func;
}
static const char *event_string(enum usb_otg_event event)
{
switch (event) {
case OTG_EVENT_DEV_CONN_TMOUT:
return "DEV_CONN_TMOUT";
case OTG_EVENT_NO_RESP_FOR_HNP_ENABLE:
return "NO_RESP_FOR_HNP_ENABLE";
case OTG_EVENT_HUB_NOT_SUPPORTED:
return "HUB_NOT_SUPPORTED";
case OTG_EVENT_DEV_NOT_SUPPORTED:
return "DEV_NOT_SUPPORTED,";
case OTG_EVENT_HNP_FAILED:
return "HNP_FAILED";
case OTG_EVENT_NO_RESP_FOR_SRP:
return "NO_RESP_FOR_SRP";
default:
return "UNDEFINED";
}
}
static int msm_otg_send_event(struct otg_transceiver *xceiv,
enum usb_otg_event event)
{
char module_name[16];
char udev_event[128];
char *envp[] = { module_name, udev_event, NULL };
int ret;
pr_debug("sending %s event\n", event_string(event));
snprintf(module_name, 16, "MODULE=%s", DRIVER_NAME);
snprintf(udev_event, 128, "EVENT=%s", event_string(event));
ret = kobject_uevent_env(&xceiv->dev->kobj, KOBJ_CHANGE, envp);
if (ret < 0)
pr_info("uevent sending failed with ret = %d\n", ret);
return ret;
}
static int msm_otg_start_hnp(struct otg_transceiver *xceiv)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
enum usb_otg_state state;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
if (state != OTG_STATE_A_HOST) {
pr_err("HNP can not be initiated in %s state\n",
state_string(state));
return -EINVAL;
}
pr_debug("A-Host: HNP initiated\n");
clear_bit(A_BUS_REQ, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
return 0;
}
static int msm_otg_start_srp(struct otg_transceiver *xceiv)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
u32 val;
int ret = 0;
enum usb_otg_state state;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
if (state != OTG_STATE_B_IDLE) {
pr_err("SRP can not be initiated in %s state\n",
state_string(state));
ret = -EINVAL;
goto out;
}
if ((jiffies - dev->b_last_se0_sess) < msecs_to_jiffies(TB_SRP_INIT)) {
pr_debug("initial conditions of SRP are not met. Try again"
"after some time\n");
ret = -EAGAIN;
goto out;
}
/* Harware auto assist data pulsing: Data pulse is given
* for 7msec; wait for vbus
*/
val = readl(USB_OTGSC);
writel((val & ~OTGSC_INTR_STS_MASK) | OTGSC_HADP, USB_OTGSC);
/* VBUS plusing is obsoleted in OTG 2.0 supplement */
out:
return ret;
}
static int msm_otg_set_power(struct otg_transceiver *xceiv, unsigned mA)
{
static enum chg_type curr_chg = USB_CHG_TYPE__INVALID;
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
struct msm_otg_platform_data *pdata = dev->pdata;
enum chg_type new_chg = atomic_read(&dev->chg_type);
unsigned charge = mA;
/* Call chg_connected only if the charger has changed */
if (new_chg != curr_chg && pdata->chg_connected) {
curr_chg = new_chg;
pdata->chg_connected(new_chg);
}
/* Always use USB_IDCHG_MAX for charging in ID_B and ID_C */
if (test_bit(ID_C, &dev->inputs) ||
test_bit(ID_B, &dev->inputs))
charge = USB_IDCHG_MAX;
pr_debug("Charging with %dmA current\n", charge);
/* Call vbus_draw only if the charger is of known type and also
* ignore request to stop charging as a result of suspend interrupt
* when wall-charger is used.
*/
if (pdata->chg_vbus_draw && new_chg != USB_CHG_TYPE__INVALID &&
(charge || new_chg != USB_CHG_TYPE__WALLCHARGER))
pdata->chg_vbus_draw(charge);
if (new_chg == USB_CHG_TYPE__WALLCHARGER) {
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
return 0;
}
static int msm_otg_set_clk(struct otg_transceiver *xceiv, int on)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
if (!dev || (dev != the_msm_otg))
return -ENODEV;
if (on)
/* enable clocks */
clk_enable(dev->hs_clk);
else
clk_disable(dev->hs_clk);
return 0;
}
static void msm_otg_start_peripheral(struct otg_transceiver *xceiv, int on)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
struct msm_otg_platform_data *pdata = dev->pdata;
if (!xceiv->gadget)
return;
if (on) {
if (pdata->setup_gpio)
pdata->setup_gpio(USB_SWITCH_PERIPHERAL);
/* vote for minimum dma_latency to prevent idle
* power collapse(pc) while running in peripheral mode.
*/
otg_pm_qos_update_latency(dev, 1);
/* increment the clk reference count so that
* it would be still on when disabled from
* low power mode routine
*/
if (dev->pdata->pclk_required_during_lpm)
clk_enable(dev->hs_pclk);
usb_gadget_vbus_connect(xceiv->gadget);
} else {
atomic_set(&dev->chg_type, USB_CHG_TYPE__INVALID);
usb_gadget_vbus_disconnect(xceiv->gadget);
/* decrement the clk reference count so that
* it would be off when disabled from
* low power mode routine
*/
if (dev->pdata->pclk_required_during_lpm)
clk_disable(dev->hs_pclk);
otg_pm_qos_update_latency(dev, 0);
if (pdata->setup_gpio)
pdata->setup_gpio(USB_SWITCH_DISABLE);
}
}
static void msm_otg_start_host(struct otg_transceiver *xceiv, int on)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
struct msm_otg_platform_data *pdata = dev->pdata;
if (!xceiv->host)
return;
if (dev->start_host) {
/* Some targets, e.g. ST1.5, use GPIO to choose b/w connector */
if (on && pdata->setup_gpio)
pdata->setup_gpio(USB_SWITCH_HOST);
/* increment or decrement the clk reference count
* to avoid usb h/w lockup issues when low power
* mode is initiated and vbus is on.
*/
if (dev->pdata->pclk_required_during_lpm) {
if (on)
clk_enable(dev->hs_pclk);
else
clk_disable(dev->hs_pclk);
}
dev->start_host(xceiv->host, on);
if (!on && pdata->setup_gpio)
pdata->setup_gpio(USB_SWITCH_DISABLE);
}
}
static int msm_otg_suspend(struct msm_otg *dev)
{
unsigned long timeout;
bool host_bus_suspend;
unsigned ret;
enum chg_type chg_type = atomic_read(&dev->chg_type);
unsigned long flags;
disable_irq(dev->irq);
if (atomic_read(&dev->in_lpm))
goto out;
#ifdef CONFIG_USB_MSM_ACA
/*
* ACA interrupts are disabled before entering into LPM.
* If LPM is allowed in host mode with accessory charger
* connected or only accessory charger is connected,
* there is a chance that charger is removed and we will
* not know about it.
*
* REVISIT
*
* Allowing LPM in case of gadget bus suspend is tricky.
* Bus suspend can happen in two states.
* 1. ID_float: Allowing LPM has pros and cons. If LPM is allowed
* and accessory charger is connected, we miss ID_float --> ID_C
* transition where we could draw large amount of current
* compared to the suspend current.
* 2. ID_C: We can not allow LPM. If accessory charger is removed
* we should not draw more than what host could supply which will
* be less compared to accessory charger.
*
* For simplicity, LPM is not allowed in bus suspend.
*/
#ifndef CONFIG_USB_MSM_STANDARD_ACA
/*
* RID_A and IdGnd states are only possible with standard ACA. We can
* exit from low power mode with !BSV or IdGnd interrupt. Hence LPM
* is allowed.
*/
if ((test_bit(ID, &dev->inputs) && test_bit(B_SESS_VLD, &dev->inputs) &&
chg_type != USB_CHG_TYPE__WALLCHARGER) ||
test_bit(ID_A, &dev->inputs))
goto out;
#endif
/* Disable ID_abc interrupts else it causes spurious interrupt */
disable_idabc(dev);
#endif
ulpi_read(dev, 0x14);/* clear PHY interrupt latch register */
/*
* Turn on PHY comparators if,
* 1. USB wall charger is connected (bus suspend is not supported)
* 2. Host bus suspend
* 3. host is supported, but, id is not routed to pmic
* 4. peripheral is supported, but, vbus is not routed to pmic
*/
host_bus_suspend = dev->otg.host && is_host();
if ((dev->otg.gadget && chg_type == USB_CHG_TYPE__WALLCHARGER) ||
host_bus_suspend ||
(dev->otg.host && !dev->pmic_id_notif_supp) ||
(dev->otg.gadget && !dev->pmic_vbus_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__);
/*
* Start otg state machine in default state upon
* phy suspend failure*/
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_UNDEFINED;
spin_unlock_irqrestore(&dev->lock, flags);
queue_work(dev->wq, &dev->sm_work);
goto out;
}
msleep(1);
/* check if there are any pending interrupts*/
if (((readl(USB_OTGSC) & OTGSC_INTR_MASK) >> 8) &
readl(USB_OTGSC)) {
enable_idabc(dev);
goto out;
}
}
writel(readl(USB_USBCMD) | ASYNC_INTR_CTRL | ULPI_STP_CTRL, USB_USBCMD);
/* Ensure that above operation is completed before turning off clocks */
mb();
if (dev->hs_pclk)
clk_disable(dev->hs_pclk);
if (dev->hs_cclk)
clk_disable(dev->hs_cclk);
/* usb phy no more require TCXO clock, hence vote for TCXO disable*/
ret = msm_xo_mode_vote(dev->xo_handle, MSM_XO_MODE_OFF);
if (ret)
pr_err("%s failed to devote for"
"TCXO D1 buffer%d\n", __func__, ret);
if (device_may_wakeup(dev->otg.dev)) {
enable_irq_wake(dev->irq);
if (dev->vbus_on_irq)
enable_irq_wake(dev->vbus_on_irq);
if (dev->id_irq)
enable_irq_wake(dev->id_irq);
}
msm_otg_vote_for_pclk_source(dev, 0);
atomic_set(&dev->in_lpm, 1);
/*
* TODO: put regulators in low power mode by assuming that
* regulators are brought back to active state before PHY
* becomes active. But this assumption becomes wrong in case of
* ACA charger where PHY itself will generate the wakeup
* interrupt. This creates a small window where PHY regulators
* are in LPM but PHY is in active state and this patch assumes
* that there is no harm with this. Till hw folks confirms this
* put regulators in lpm.
*/
if (!host_bus_suspend && dev->pmic_vbus_notif_supp) {
pr_debug("phy can power collapse: (%d)\n",
can_phy_power_collapse(dev));
if (can_phy_power_collapse(dev) && dev->pdata->ldo_enable) {
pr_debug("disabling the regulators\n");
dev->pdata->ldo_enable(0);
}
}
/* phy can interrupts when vddcx is at 0.75, so irrespective
* of pmic notification support, configure vddcx @0.75
*/
if (dev->pdata->config_vddcx)
dev->pdata->config_vddcx(0);
pr_info("%s: usb in low power mode\n", __func__);
out:
enable_irq(dev->irq);
return 0;
}
static int msm_otg_resume(struct msm_otg *dev)
{
unsigned temp;
unsigned ret;
if (!atomic_read(&dev->in_lpm))
return 0;
/* vote for vddcx, as PHY cannot tolerate vddcx below 1.0V */
if (dev->pdata->config_vddcx) {
ret = dev->pdata->config_vddcx(1);
if (ret) {
pr_err("%s: unable to enable vddcx digital core:%d\n",
__func__, ret);
}
}
if (dev->pdata->ldo_set_voltage)
dev->pdata->ldo_set_voltage(3400);
/* Vote for TCXO when waking up the phy */
ret = msm_xo_mode_vote(dev->xo_handle, MSM_XO_MODE_ON);
if (ret)
pr_err("%s failed to vote for"
"TCXO D1 buffer%d\n", __func__, ret);
msm_otg_vote_for_pclk_source(dev, 1);
if (dev->hs_pclk)
clk_enable(dev->hs_pclk);
if (dev->hs_cclk)
clk_enable(dev->hs_cclk);
temp = readl(USB_USBCMD);
temp &= ~ASYNC_INTR_CTRL;
temp &= ~ULPI_STP_CTRL;
writel(temp, USB_USBCMD);
if (device_may_wakeup(dev->otg.dev)) {
disable_irq_wake(dev->irq);
if (dev->vbus_on_irq)
disable_irq_wake(dev->vbus_on_irq);
if (dev->id_irq)
disable_irq_wake(dev->id_irq);
}
atomic_set(&dev->in_lpm, 0);
pr_info("%s: usb exited from low power mode\n", __func__);
return 0;
}
static void msm_otg_get_resume(struct msm_otg *dev)
{
#ifdef CONFIG_PM_RUNTIME
pm_runtime_get_noresume(dev->otg.dev);
pm_runtime_resume(dev->otg.dev);
#else
msm_otg_resume(dev);
#endif
}
static void msm_otg_put_suspend(struct msm_otg *dev)
{
#ifdef CONFIG_PM_RUNTIME
pm_runtime_put_sync(dev->otg.dev);
if (!atomic_read(&dev->in_lpm))
pm_runtime_get_sync(dev->otg.dev);
#else
msm_otg_suspend(dev);
#endif
}
static void msm_otg_resume_w(struct work_struct *w)
{
struct msm_otg *dev = container_of(w, struct msm_otg, otg_resume_work);
unsigned long timeout;
if (can_phy_power_collapse(dev) && dev->pdata->ldo_enable)
dev->pdata->ldo_enable(1);
msm_otg_get_resume(dev);
if (!is_phy_clk_disabled())
goto phy_resumed;
timeout = jiffies + usecs_to_jiffies(100);
enable_phy_clk();
while (is_phy_clk_disabled() || !is_phy_active()) {
if (time_after(jiffies, timeout)) {
pr_err("%s: Unable to wakeup phy. is_phy_active: %x\n",
__func__, !!is_phy_active());
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
break;
}
udelay(10);
}
phy_resumed:
/* Enable Idabc interrupts as these were disabled before entering LPM */
enable_idabc(dev);
/* If resume signalling finishes before lpm exit, PCD is not set in
* USBSTS register. Drive resume signal to the downstream device now
* so that host driver can process the upcoming port change interrupt.*/
if (is_host() || test_bit(ID_A, &dev->inputs)) {
writel(readl(USB_PORTSC) | PORTSC_FPR, USB_PORTSC);
msm_otg_start_host(&dev->otg, REQUEST_RESUME);
}
/* Enable irq which was disabled before scheduling this work.
* But don't release wake_lock, as we got async interrupt and
* there will be some work pending for OTG state machine.
*/
enable_irq(dev->irq);
}
static int msm_otg_set_suspend(struct otg_transceiver *xceiv, int suspend)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
enum usb_otg_state state;
unsigned long flags;
if (!dev || (dev != the_msm_otg))
return -ENODEV;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
pr_debug("suspend request in state: %s\n",
state_string(state));
if (suspend) {
switch (state) {
#ifndef CONFIG_MSM_OTG_ENABLE_A_WAIT_BCON_TIMEOUT
case OTG_STATE_A_WAIT_BCON:
if (test_bit(ID_A, &dev->inputs))
msm_otg_set_power(xceiv, USB_IDCHG_MIN - 100);
msm_otg_put_suspend(dev);
break;
#endif
case OTG_STATE_A_HOST:
clear_bit(A_BUS_REQ, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
break;
case OTG_STATE_B_PERIPHERAL:
if (xceiv->gadget->b_hnp_enable) {
set_bit(A_BUS_SUSPEND, &dev->inputs);
set_bit(B_BUS_REQ, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
break;
case OTG_STATE_A_PERIPHERAL:
msm_otg_start_timer(dev, TA_BIDL_ADIS,
A_BIDL_ADIS);
break;
default:
break;
}
} else {
unsigned long timeout;
switch (state) {
case OTG_STATE_A_PERIPHERAL:
/* A-peripheral observed activity on bus.
* clear A_BIDL_ADIS timer.
*/
msm_otg_del_timer(dev);
break;
case OTG_STATE_A_SUSPEND:
/* Remote wakeup or resume */
set_bit(A_BUS_REQ, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_HOST;
spin_unlock_irqrestore(&dev->lock, flags);
if (test_bit(ID_A, &dev->inputs) &&
(get_aca_bmaxpower(dev) < USB_IDCHG_MIN))
msm_otg_set_power(xceiv,
USB_IDCHG_MIN - get_aca_bmaxpower(dev));
break;
default:
break;
}
if (suspend == atomic_read(&dev->in_lpm))
return 0;
disable_irq(dev->irq);
if (dev->pmic_vbus_notif_supp)
if (can_phy_power_collapse(dev) &&
dev->pdata->ldo_enable)
dev->pdata->ldo_enable(1);
msm_otg_get_resume(dev);
if (!is_phy_clk_disabled())
goto out;
timeout = jiffies + usecs_to_jiffies(100);
enable_phy_clk();
while (is_phy_clk_disabled() || !is_phy_active()) {
if (time_after(jiffies, timeout)) {
pr_err("%s: Unable to wakeup phy. "
"is_phy_active: %x\n",
__func__, !!is_phy_active());
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
break;
}
udelay(10);
}
out:
enable_idabc(dev);
enable_irq(dev->irq);
}
return 0;
}
static int msm_otg_set_peripheral(struct otg_transceiver *xceiv,
struct usb_gadget *gadget)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
if (!dev || (dev != the_msm_otg))
return -ENODEV;
if (!gadget) {
msm_otg_start_peripheral(xceiv, 0);
dev->otg.gadget = 0;
disable_sess_valid(dev);
if (!dev->otg.host)
disable_idabc(dev);
return 0;
}
dev->otg.gadget = gadget;
pr_info("peripheral driver registered w/ tranceiver\n");
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
return 0;
}
#ifdef CONFIG_USB_EHCI_MSM_72K
static int usbdev_notify(struct notifier_block *self,
unsigned long action, void *device)
{
enum usb_otg_state state;
struct msm_otg *dev = container_of(self, struct msm_otg, usbdev_nb);
struct usb_device *udev = device;
int work = 1;
unsigned long flags;
/* Interested in only devices directly connected
* to root hub directly.
*/
if (!udev->parent || udev->parent->parent)
goto out;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
switch (state) {
case OTG_STATE_A_WAIT_BCON:
if (action == USB_DEVICE_ADD) {
pr_debug("B_CONN set\n");
set_bit(B_CONN, &dev->inputs);
if (udev->actconfig) {
set_aca_bmaxpower(dev,
udev->actconfig->desc.bMaxPower * 2);
goto do_work;
}
if (udev->portnum == udev->bus->otg_port)
set_aca_bmaxpower(dev, USB_IB_UNCFG);
else
set_aca_bmaxpower(dev, 100);
}
break;
case OTG_STATE_A_HOST:
if (action == USB_DEVICE_REMOVE) {
pr_debug("B_CONN clear\n");
clear_bit(B_CONN, &dev->inputs);
set_aca_bmaxpower(dev, 0);
}
break;
default:
work = 0;
break;
}
do_work:
if (work) {
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
out:
return NOTIFY_OK;
}
static int msm_otg_set_host(struct otg_transceiver *xceiv, struct usb_bus *host)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
if (!dev || (dev != the_msm_otg))
return -ENODEV;
if (!dev->start_host)
return -ENODEV;
if (!host) {
msm_otg_start_host(xceiv, REQUEST_STOP);
usb_unregister_notify(&dev->usbdev_nb);
dev->otg.host = 0;
dev->start_host = 0;
disable_idgnd(dev);
if (!dev->otg.gadget)
disable_idabc(dev);
return 0;
}
#ifdef CONFIG_USB_OTG
host->otg_port = 1;
#endif
dev->usbdev_nb.notifier_call = usbdev_notify;
usb_register_notify(&dev->usbdev_nb);
dev->otg.host = host;
pr_info("host driver registered w/ tranceiver\n");
#ifndef CONFIG_USB_MSM_72K
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
#endif
return 0;
}
#endif
void msm_otg_set_id_state(int id)
{
struct msm_otg *dev = the_msm_otg;
unsigned long flags;
if (id == dev->pmic_id_status)
return;
if (id) {
set_bit(ID, &dev->inputs);
dev->pmic_id_status = 1;
} else {
clear_bit(ID, &dev->inputs);
set_bit(A_BUS_REQ, &dev->inputs);
dev->pmic_id_status = 0;
}
spin_lock_irqsave(&dev->lock, flags);
if (dev->otg.state != OTG_STATE_UNDEFINED) {
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
spin_unlock_irqrestore(&dev->lock, flags);
}
void msm_otg_set_vbus_state(int online)
{
struct msm_otg *dev = the_msm_otg;
if (!atomic_read(&dev->in_lpm) || !online)
return;
wake_lock(&dev->wlock);
set_bit(B_SESS_VLD, &dev->inputs);
queue_work(dev->wq, &dev->sm_work);
}
static irqreturn_t msm_otg_irq(int irq, void *data)
{
struct msm_otg *dev = data;
u32 otgsc, sts, pc, sts_mask;
irqreturn_t ret = IRQ_HANDLED;
int work = 0;
enum usb_otg_state state;
unsigned long flags;
if (atomic_read(&dev->in_lpm)) {
disable_irq_nosync(dev->irq);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->otg_resume_work);
goto out;
}
/* Return immediately if instead of ID pin, USER controls mode switch */
if (dev->pdata->otg_mode == OTG_USER_CONTROL)
return IRQ_NONE;
otgsc = readl(USB_OTGSC);
sts = readl(USB_USBSTS);
sts_mask = (otgsc & OTGSC_INTR_MASK) >> 8;
if (!((otgsc & sts_mask) || (sts & STS_PCI))) {
ret = IRQ_NONE;
goto out;
}
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
pr_debug("IRQ state: %s\n", state_string(state));
pr_debug("otgsc = %x\n", otgsc);
if ((otgsc & OTGSC_IDIE) && (otgsc & OTGSC_IDIS)) {
if (otgsc & OTGSC_ID) {
pr_debug("Id set\n");
set_bit(ID, &dev->inputs);
} else {
pr_debug("Id clear\n");
/* Assert a_bus_req to supply power on
* VBUS when Micro/Mini-A cable is connected
* with out user intervention.
*/
set_bit(A_BUS_REQ, &dev->inputs);
clear_bit(ID, &dev->inputs);
}
writel(otgsc, USB_OTGSC);
work = 1;
} else if (otgsc & OTGSC_BSVIS) {
writel(otgsc, USB_OTGSC);
/* BSV interrupt comes when operating as an A-device
* (VBUS on/off).
* But, handle BSV when charger is removed from ACA in ID_A
*/
if ((state >= OTG_STATE_A_IDLE) &&
!test_bit(ID_A, &dev->inputs))
goto out;
if (otgsc & OTGSC_BSV) {
pr_debug("BSV set\n");
set_bit(B_SESS_VLD, &dev->inputs);
} else {
pr_debug("BSV clear\n");
clear_bit(B_SESS_VLD, &dev->inputs);
}
work = 1;
} else if (otgsc & OTGSC_DPIS) {
pr_debug("DPIS detected\n");
writel(otgsc, USB_OTGSC);
set_bit(A_SRP_DET, &dev->inputs);
set_bit(A_BUS_REQ, &dev->inputs);
work = 1;
} else if (sts & STS_PCI) {
pc = readl(USB_PORTSC);
pr_debug("portsc = %x\n", pc);
ret = IRQ_NONE;
/* HCD Acks PCI interrupt. We use this to switch
* between different OTG states.
*/
work = 1;
switch (state) {
case OTG_STATE_A_SUSPEND:
if (dev->otg.host->b_hnp_enable && (pc & PORTSC_CSC) &&
!(pc & PORTSC_CCS)) {
pr_debug("B_CONN clear\n");
clear_bit(B_CONN, &dev->inputs);
}
break;
case OTG_STATE_B_WAIT_ACON:
if ((pc & PORTSC_CSC) && (pc & PORTSC_CCS)) {
pr_debug("A_CONN set\n");
set_bit(A_CONN, &dev->inputs);
/* Clear ASE0_BRST timer */
msm_otg_del_timer(dev);
}
break;
case OTG_STATE_B_HOST:
if ((pc & PORTSC_CSC) && !(pc & PORTSC_CCS)) {
pr_debug("A_CONN clear\n");
clear_bit(A_CONN, &dev->inputs);
}
break;
default:
work = 0;
break;
}
}
if (work) {
#ifdef CONFIG_USB_MSM_ACA
/* With ACA, ID can change bcoz of BSVIS as well, so update */
if ((otgsc & OTGSC_IDIS) || (otgsc & OTGSC_BSVIS))
set_aca_id_inputs(dev);
#endif
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
out:
return ret;
}
#define ULPI_VERIFY_MAX_LOOP_COUNT 5
#define PHY_CALIB_RETRY_COUNT 10
static void phy_clk_reset(struct msm_otg *dev)
{
unsigned rc;
enum clk_reset_action assert = CLK_RESET_ASSERT;
if (dev->pdata->phy_reset_sig_inverted)
assert = CLK_RESET_DEASSERT;
rc = clk_reset(dev->phy_reset_clk, assert);
if (rc) {
pr_err("%s: phy clk assert failed\n", __func__);
return;
}
msleep(1);
rc = clk_reset(dev->phy_reset_clk, !assert);
if (rc) {
pr_err("%s: phy clk deassert failed\n", __func__);
return;
}
msleep(1);
}
static unsigned ulpi_read_with_reset(struct msm_otg *dev, unsigned reg)
{
int temp;
unsigned res;
for (temp = 0; temp < ULPI_VERIFY_MAX_LOOP_COUNT; temp++) {
res = ulpi_read(dev, reg);
if (res != 0xffffffff)
return res;
phy_clk_reset(dev);
}
pr_err("%s: ulpi read failed for %d times\n",
__func__, ULPI_VERIFY_MAX_LOOP_COUNT);
return -1;
}
static int ulpi_write_with_reset(struct msm_otg *dev,
unsigned val, unsigned reg)
{
int temp, res;
for (temp = 0; temp < ULPI_VERIFY_MAX_LOOP_COUNT; temp++) {
res = ulpi_write(dev, val, reg);
if (!res)
return 0;
phy_clk_reset(dev);
}
pr_err("%s: ulpi write failed for %d times\n",
__func__, ULPI_VERIFY_MAX_LOOP_COUNT);
return -1;
}
/* some of the older targets does not turn off the PLL
* if onclock bit is set and clocksuspendM bit is on,
* hence clear them too and initiate the suspend mode
* by clearing SupendM bit.
*/
static inline int turn_off_phy_pll(struct msm_otg *dev)
{
unsigned res;
res = ulpi_read_with_reset(dev, ULPI_CONFIG_REG1);
if (res == 0xffffffff)
return -ETIMEDOUT;
res = ulpi_write_with_reset(dev,
res & ~(ULPI_ONCLOCK), ULPI_CONFIG_REG1);
if (res)
return -ETIMEDOUT;
res = ulpi_write_with_reset(dev,
ULPI_CLOCK_SUSPENDM, ULPI_IFC_CTRL_CLR);
if (res)
return -ETIMEDOUT;
/*Clear SuspendM bit to initiate suspend mode */
res = ulpi_write_with_reset(dev,
ULPI_SUSPENDM, ULPI_FUNC_CTRL_CLR);
if (res)
return -ETIMEDOUT;
return res;
}
static inline int check_phy_caliberation(struct msm_otg *dev)
{
unsigned res;
res = ulpi_read_with_reset(dev, ULPI_DEBUG);
if (res == 0xffffffff)
return -ETIMEDOUT;
if (!(res & ULPI_CALIB_STS) && ULPI_CALIB_VAL(res))
return 0;
return -1;
}
static int msm_otg_phy_caliberate(struct msm_otg *dev)
{
int i = 0;
unsigned long res;
do {
res = turn_off_phy_pll(dev);
if (res)
return -ETIMEDOUT;
/* bring phy out of suspend */
phy_clk_reset(dev);
res = check_phy_caliberation(dev);
if (!res)
return res;
i++;
} while (i < PHY_CALIB_RETRY_COUNT);
return res;
}
static int msm_otg_phy_reset(struct msm_otg *dev)
{
unsigned rc;
unsigned temp;
unsigned long timeout;
rc = clk_reset(dev->hs_clk, CLK_RESET_ASSERT);
if (rc) {
pr_err("%s: usb hs clk assert failed\n", __func__);
return -1;
}
phy_clk_reset(dev);
rc = clk_reset(dev->hs_clk, CLK_RESET_DEASSERT);
if (rc) {
pr_err("%s: usb hs clk deassert failed\n", __func__);
return -1;
}
/* Observing ulpi timeouts as part of PHY calibration. On resetting
* the HW link explicity by setting the RESET bit in the USBCMD
* register before PHY calibration fixes the ulpi timeout issue.
* This workaround is required for unicorn target
*/
writel_relaxed(USBCMD_RESET, USB_USBCMD);
timeout = jiffies + USB_LINK_RESET_TIMEOUT;
do {
if (time_after(jiffies, timeout)) {
pr_err("msm_otg: usb link reset timeout\n");
break;
}
usleep_range(1000, 1200);
} while (readl_relaxed(USB_USBCMD) & USBCMD_RESET);
/* select ULPI phy */
temp = (readl(USB_PORTSC) & ~PORTSC_PTS);
writel(temp | PORTSC_PTS_ULPI, USB_PORTSC);
if (atomic_read(&dev->chg_type) !=
USB_CHG_TYPE__WALLCHARGER) {
rc = msm_otg_phy_caliberate(dev);
if (rc)
return rc;
}
/* TBD: There are two link resets. One is below and other one
* is done immediately after this function. See if we can
* eliminate one of these.
*/
writel(USBCMD_RESET, USB_USBCMD);
timeout = jiffies + USB_LINK_RESET_TIMEOUT;
do {
if (time_after(jiffies, timeout)) {
pr_err("msm_otg: usb link reset timeout\n");
break;
}
msleep(1);
} while (readl(USB_USBCMD) & USBCMD_RESET);
if (readl(USB_USBCMD) & USBCMD_RESET) {
pr_err("%s: usb core reset failed\n", __func__);
return -1;
}
return 0;
}
static void otg_reset(struct otg_transceiver *xceiv, int phy_reset)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
unsigned long timeout;
u32 mode, work = 0;
clk_enable(dev->hs_clk);
if (!phy_reset)
goto reset_link;
if (dev->pdata->phy_reset)
dev->pdata->phy_reset(dev->regs);
else
msm_otg_phy_reset(dev);
/*disable all phy interrupts*/
ulpi_write(dev, 0xFF, 0x0F);
ulpi_write(dev, 0xFF, 0x12);
msleep(100);
reset_link:
writel(USBCMD_RESET, USB_USBCMD);
timeout = jiffies + USB_LINK_RESET_TIMEOUT;
do {
if (time_after(jiffies, timeout)) {
pr_err("msm_otg: usb link reset timeout\n");
break;
}
msleep(1);
} while (readl(USB_USBCMD) & USBCMD_RESET);
/* select ULPI phy */
writel(0x80000000, USB_PORTSC);
set_pre_emphasis_level(dev);
set_hsdrv_slope(dev);
set_cdr_auto_reset(dev);
set_driver_amplitude(dev);
set_se1_gating(dev);
writel(0x0, USB_AHB_BURST);
writel(0x00, USB_AHB_MODE);
if (dev->pdata->bam_disable) {
writel_relaxed((readl_relaxed(USB_GEN_CONFIG) |
USB_BAM_DISABLE), USB_GEN_CONFIG);
pr_debug("%s(): USB_GEN_CONFIG = %x\n",
__func__, readl_relaxed(USB_GEN_CONFIG));
}
/* Ensure that RESET operation is completed before turning off clock */
mb();
clk_disable(dev->hs_clk);
if ((xceiv->gadget && xceiv->gadget->is_a_peripheral) ||
test_bit(ID, &dev->inputs))
mode = USBMODE_SDIS | USBMODE_DEVICE;
else
mode = USBMODE_SDIS | USBMODE_HOST;
writel(mode, USB_USBMODE);
writel_relaxed((readl_relaxed(USB_OTGSC) | OTGSC_IDPU), USB_OTGSC);
if (dev->otg.gadget) {
enable_sess_valid(dev);
/* Due to the above 100ms delay, interrupts from PHY are
* sometimes missed during fast plug-in/plug-out of cable.
* Check for such cases here.
*/
if (is_b_sess_vld() && !test_bit(B_SESS_VLD, &dev->inputs)) {
pr_debug("%s: handle missing BSV event\n", __func__);
set_bit(B_SESS_VLD, &dev->inputs);
work = 1;
} else if (!is_b_sess_vld() && test_bit(B_SESS_VLD,
&dev->inputs)) {
pr_debug("%s: handle missing !BSV event\n", __func__);
clear_bit(B_SESS_VLD, &dev->inputs);
work = 1;
}
}
#ifdef CONFIG_USB_EHCI_MSM_72K
if (dev->otg.host && !dev->pmic_id_notif_supp) {
enable_idgnd(dev);
/* Handle missing ID_GND interrupts during fast PIPO */
if (is_host() && test_bit(ID, &dev->inputs)) {
pr_debug("%s: handle missing ID_GND event\n", __func__);
clear_bit(ID, &dev->inputs);
work = 1;
} else if (!is_host() && !test_bit(ID, &dev->inputs)) {
pr_debug("%s: handle missing !ID_GND event\n",
__func__);
set_bit(ID, &dev->inputs);
work = 1;
}
} else {
disable_idgnd(dev);
}
#endif
enable_idabc(dev);
if (work) {
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
}
static void msm_otg_sm_work(struct work_struct *w)
{
struct msm_otg *dev = container_of(w, struct msm_otg, sm_work);
enum chg_type chg_type = atomic_read(&dev->chg_type);
int ret;
int work = 0;
enum usb_otg_state state;
unsigned long flags;
if (atomic_read(&dev->in_lpm))
msm_otg_set_suspend(&dev->otg, 0);
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
switch (state) {
case OTG_STATE_UNDEFINED:
/*
* We can come here when LPM fails with wall charger
* connected. Change the state to B_PERIPHERAL and
* schedule the work which takes care of resetting the
* PHY and putting the hardware in low power mode.
*/
if (atomic_read(&dev->chg_type) ==
USB_CHG_TYPE__WALLCHARGER) {
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_PERIPHERAL;
spin_unlock_irqrestore(&dev->lock, flags);
work = 1;
break;
}
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
#ifdef CONFIG_USB_MSM_ACA
set_aca_id_inputs(dev);
#endif
if (dev->pdata->otg_mode == OTG_USER_CONTROL) {
if ((dev->pdata->usb_mode == USB_PERIPHERAL_MODE) ||
!dev->otg.host) {
set_bit(ID, &dev->inputs);
set_bit(B_SESS_VLD, &dev->inputs);
}
} else {
if (!dev->otg.host || !is_host())
set_bit(ID, &dev->inputs);
if (dev->otg.gadget && is_b_sess_vld())
set_bit(B_SESS_VLD, &dev->inputs);
}
spin_lock_irqsave(&dev->lock, flags);
if ((test_bit(ID, &dev->inputs)) &&
!test_bit(ID_A, &dev->inputs)) {
dev->otg.state = OTG_STATE_B_IDLE;
} else {
set_bit(A_BUS_REQ, &dev->inputs);
dev->otg.state = OTG_STATE_A_IDLE;
}
spin_unlock_irqrestore(&dev->lock, flags);
work = 1;
break;
case OTG_STATE_B_IDLE:
dev->otg.default_a = 0;
if (!test_bit(ID, &dev->inputs) ||
test_bit(ID_A, &dev->inputs)) {
pr_debug("!id || id_A\n");
clear_bit(B_BUS_REQ, &dev->inputs);
otg_reset(&dev->otg, 0);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_set_power(&dev->otg, 0);
work = 1;
} else if (test_bit(B_SESS_VLD, &dev->inputs) &&
!test_bit(ID_B, &dev->inputs)) {
pr_debug("b_sess_vld\n");
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_PERIPHERAL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_set_power(&dev->otg, 0);
msm_otg_start_peripheral(&dev->otg, 1);
} else if (test_bit(B_BUS_REQ, &dev->inputs)) {
pr_debug("b_sess_end && b_bus_req\n");
ret = msm_otg_start_srp(&dev->otg);
if (ret < 0) {
/* notify user space */
clear_bit(B_BUS_REQ, &dev->inputs);
work = 1;
break;
}
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_SRP_INIT;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_timer(dev, TB_SRP_FAIL, B_SRP_FAIL);
break;
} else if (test_bit(ID_B, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg, USB_IDCHG_MAX);
} else {
msm_otg_set_power(&dev->otg, 0);
pr_debug("entering into lpm\n");
msm_otg_put_suspend(dev);
if (dev->pdata->ldo_set_voltage)
dev->pdata->ldo_set_voltage(3075);
}
break;
case OTG_STATE_B_SRP_INIT:
if (!test_bit(ID, &dev->inputs) ||
test_bit(ID_A, &dev->inputs) ||
test_bit(ID_C, &dev->inputs) ||
(test_bit(B_SESS_VLD, &dev->inputs) &&
!test_bit(ID_B, &dev->inputs))) {
pr_debug("!id || id_a/c || b_sess_vld+!id_b\n");
msm_otg_del_timer(dev);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
work = 1;
} else if (test_bit(B_SRP_FAIL, &dev->tmouts)) {
pr_debug("b_srp_fail\n");
/* notify user space */
msm_otg_send_event(&dev->otg,
OTG_EVENT_NO_RESP_FOR_SRP);
clear_bit(B_BUS_REQ, &dev->inputs);
clear_bit(B_SRP_FAIL, &dev->tmouts);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
dev->b_last_se0_sess = jiffies;
work = 1;
}
break;
case OTG_STATE_B_PERIPHERAL:
if (!test_bit(ID, &dev->inputs) ||
test_bit(ID_A, &dev->inputs) ||
test_bit(ID_B, &dev->inputs) ||
!test_bit(B_SESS_VLD, &dev->inputs)) {
pr_debug("!id || id_a/b || !b_sess_vld\n");
clear_bit(B_BUS_REQ, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_peripheral(&dev->otg, 0);
dev->b_last_se0_sess = jiffies;
/* Workaround: Reset phy after session */
otg_reset(&dev->otg, 1);
work = 1;
} else if (test_bit(B_BUS_REQ, &dev->inputs) &&
dev->otg.gadget->b_hnp_enable &&
test_bit(A_BUS_SUSPEND, &dev->inputs)) {
pr_debug("b_bus_req && b_hnp_en && a_bus_suspend\n");
msm_otg_start_timer(dev, TB_ASE0_BRST, B_ASE0_BRST);
msm_otg_start_peripheral(&dev->otg, 0);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_WAIT_ACON;
spin_unlock_irqrestore(&dev->lock, flags);
/* start HCD even before A-device enable
* pull-up to meet HNP timings.
*/
dev->otg.host->is_b_host = 1;
msm_otg_start_host(&dev->otg, REQUEST_START);
} else if (test_bit(ID_C, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg, USB_IDCHG_MAX);
} else if (chg_type == USB_CHG_TYPE__WALLCHARGER) {
#ifdef CONFIG_USB_MSM_ACA
del_timer_sync(&dev->id_timer);
#endif
/* Workaround: Reset PHY in SE1 state */
otg_reset(&dev->otg, 1);
pr_debug("entering into lpm with wall-charger\n");
msm_otg_put_suspend(dev);
/* Allow idle power collapse */
otg_pm_qos_update_latency(dev, 0);
}
break;
case OTG_STATE_B_WAIT_ACON:
if (!test_bit(ID, &dev->inputs) ||
test_bit(ID_A, &dev->inputs) ||
test_bit(ID_B, &dev->inputs) ||
!test_bit(B_SESS_VLD, &dev->inputs)) {
pr_debug("!id || id_a/b || !b_sess_vld\n");
msm_otg_del_timer(dev);
/* A-device is physically disconnected during
* HNP. Remove HCD.
*/
msm_otg_start_host(&dev->otg, REQUEST_STOP);
dev->otg.host->is_b_host = 0;
clear_bit(B_BUS_REQ, &dev->inputs);
clear_bit(A_BUS_SUSPEND, &dev->inputs);
dev->b_last_se0_sess = jiffies;
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
/* Workaround: Reset phy after session */
otg_reset(&dev->otg, 1);
work = 1;
} else if (test_bit(A_CONN, &dev->inputs)) {
pr_debug("a_conn\n");
clear_bit(A_BUS_SUSPEND, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_HOST;
spin_unlock_irqrestore(&dev->lock, flags);
if (test_bit(ID_C, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg, USB_IDCHG_MAX);
}
} else if (test_bit(B_ASE0_BRST, &dev->tmouts)) {
/* TODO: A-device may send reset after
* enabling HNP; a_bus_resume case is
* not handled for now.
*/
pr_debug("b_ase0_brst_tmout\n");
msm_otg_send_event(&dev->otg,
OTG_EVENT_HNP_FAILED);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
dev->otg.host->is_b_host = 0;
clear_bit(B_ASE0_BRST, &dev->tmouts);
clear_bit(A_BUS_SUSPEND, &dev->inputs);
clear_bit(B_BUS_REQ, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_PERIPHERAL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_peripheral(&dev->otg, 1);
} else if (test_bit(ID_C, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg, USB_IDCHG_MAX);
}
break;
case OTG_STATE_B_HOST:
/* B_BUS_REQ is not exposed to user space. So
* it must be A_CONN for now.
*/
if (!test_bit(B_BUS_REQ, &dev->inputs) ||
!test_bit(A_CONN, &dev->inputs)) {
pr_debug("!b_bus_req || !a_conn\n");
clear_bit(A_CONN, &dev->inputs);
clear_bit(B_BUS_REQ, &dev->inputs);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
dev->otg.host->is_b_host = 0;
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
/* Workaround: Reset phy after session */
otg_reset(&dev->otg, 1);
work = 1;
} else if (test_bit(ID_C, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg, USB_IDCHG_MAX);
}
break;
case OTG_STATE_A_IDLE:
dev->otg.default_a = 1;
if (test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) {
pr_debug("id && !id_a\n");
dev->otg.default_a = 0;
otg_reset(&dev->otg, 0);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_B_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_set_power(&dev->otg, 0);
work = 1;
} else if (!test_bit(A_BUS_DROP, &dev->inputs) &&
(test_bit(A_SRP_DET, &dev->inputs) ||
test_bit(A_BUS_REQ, &dev->inputs))) {
pr_debug("!a_bus_drop && (a_srp_det || a_bus_req)\n");
clear_bit(A_SRP_DET, &dev->inputs);
/* Disable SRP detection */
writel((readl(USB_OTGSC) & ~OTGSC_INTR_STS_MASK) &
~OTGSC_DPIE, USB_OTGSC);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VRISE;
spin_unlock_irqrestore(&dev->lock, flags);
/* ACA: ID_A: Stop charging untill enumeration */
if (test_bit(ID_A, &dev->inputs))
msm_otg_set_power(&dev->otg, 0);
else
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 1);
msm_otg_start_timer(dev, TA_WAIT_VRISE, A_WAIT_VRISE);
/* no need to schedule work now */
} else {
pr_debug("No session requested\n");
/* A-device is not providing power on VBUS.
* Enable SRP detection.
*/
writel((readl(USB_OTGSC) & ~OTGSC_INTR_STS_MASK) |
OTGSC_DPIE, USB_OTGSC);
msm_otg_put_suspend(dev);
}
break;
case OTG_STATE_A_WAIT_VRISE:
if ((test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) ||
test_bit(A_BUS_DROP, &dev->inputs) ||
test_bit(A_WAIT_VRISE, &dev->tmouts)) {
pr_debug("id || a_bus_drop || a_wait_vrise_tmout\n");
clear_bit(A_BUS_REQ, &dev->inputs);
msm_otg_del_timer(dev);
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VFALL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_timer(dev, TA_WAIT_VFALL, A_WAIT_VFALL);
} else if (test_bit(A_VBUS_VLD, &dev->inputs)) {
pr_debug("a_vbus_vld\n");
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_BCON;
spin_unlock_irqrestore(&dev->lock, flags);
if (TA_WAIT_BCON > 0)
msm_otg_start_timer(dev, TA_WAIT_BCON,
A_WAIT_BCON);
/* Start HCD to detect peripherals. */
msm_otg_start_host(&dev->otg, REQUEST_START);
}
break;
case OTG_STATE_A_WAIT_BCON:
if ((test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) ||
test_bit(A_BUS_DROP, &dev->inputs) ||
test_bit(A_WAIT_BCON, &dev->tmouts)) {
pr_debug("id_f/b/c || a_bus_drop ||"
"a_wait_bcon_tmout\n");
if (test_bit(A_WAIT_BCON, &dev->tmouts))
msm_otg_send_event(&dev->otg,
OTG_EVENT_DEV_CONN_TMOUT);
msm_otg_del_timer(dev);
clear_bit(A_BUS_REQ, &dev->inputs);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
/* ACA: ID_A with NO accessory, just the A plug is
* attached to ACA: Use IDCHG_MAX for charging
*/
if (test_bit(ID_A, &dev->inputs))
msm_otg_set_power(&dev->otg, USB_IDCHG_MAX);
else
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VFALL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_timer(dev, TA_WAIT_VFALL, A_WAIT_VFALL);
} else if (test_bit(B_CONN, &dev->inputs)) {
pr_debug("b_conn\n");
msm_otg_del_timer(dev);
/* HCD is added already. just move to
* A_HOST state.
*/
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_HOST;
spin_unlock_irqrestore(&dev->lock, flags);
if (test_bit(ID_A, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg,
USB_IDCHG_MIN - get_aca_bmaxpower(dev));
}
} else if (!test_bit(A_VBUS_VLD, &dev->inputs)) {
pr_debug("!a_vbus_vld\n");
msm_otg_del_timer(dev);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_VBUS_ERR;
spin_unlock_irqrestore(&dev->lock, flags);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
} else if (test_bit(ID_A, &dev->inputs)) {
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
} else if (!test_bit(ID, &dev->inputs)) {
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 1);
}
break;
case OTG_STATE_A_HOST:
if ((test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) ||
test_bit(A_BUS_DROP, &dev->inputs)) {
pr_debug("id_f/b/c || a_bus_drop\n");
clear_bit(B_CONN, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VFALL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
if (!test_bit(ID_A, &dev->inputs))
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
msm_otg_start_timer(dev, TA_WAIT_VFALL, A_WAIT_VFALL);
msm_otg_set_power(&dev->otg, 0);
} else if (!test_bit(A_VBUS_VLD, &dev->inputs)) {
pr_debug("!a_vbus_vld\n");
clear_bit(B_CONN, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_VBUS_ERR;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
/* no work */
} else if (!test_bit(A_BUS_REQ, &dev->inputs)) {
/* a_bus_req is de-asserted when root hub is
* suspended or HNP is in progress.
*/
pr_debug("!a_bus_req\n");
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_SUSPEND;
spin_unlock_irqrestore(&dev->lock, flags);
if (dev->otg.host->b_hnp_enable) {
msm_otg_start_timer(dev, TA_AIDL_BDIS,
A_AIDL_BDIS);
} else {
/* No HNP. Root hub suspended */
msm_otg_put_suspend(dev);
}
if (test_bit(ID_A, &dev->inputs))
msm_otg_set_power(&dev->otg,
USB_IDCHG_MIN - USB_IB_UNCFG);
} else if (!test_bit(B_CONN, &dev->inputs)) {
pr_debug("!b_conn\n");
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_BCON;
spin_unlock_irqrestore(&dev->lock, flags);
if (TA_WAIT_BCON > 0)
msm_otg_start_timer(dev, TA_WAIT_BCON,
A_WAIT_BCON);
} else if (test_bit(ID_A, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
msm_otg_set_power(&dev->otg,
USB_IDCHG_MIN - get_aca_bmaxpower(dev));
} else if (!test_bit(ID, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__INVALID);
msm_otg_set_power(&dev->otg, 0);
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 1);
}
break;
case OTG_STATE_A_SUSPEND:
if ((test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) ||
test_bit(A_BUS_DROP, &dev->inputs) ||
test_bit(A_AIDL_BDIS, &dev->tmouts)) {
pr_debug("id_f/b/c || a_bus_drop ||"
"a_aidl_bdis_tmout\n");
if (test_bit(A_AIDL_BDIS, &dev->tmouts))
msm_otg_send_event(&dev->otg,
OTG_EVENT_HNP_FAILED);
msm_otg_del_timer(dev);
clear_bit(B_CONN, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VFALL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
if (!test_bit(ID_A, &dev->inputs))
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
msm_otg_start_timer(dev, TA_WAIT_VFALL, A_WAIT_VFALL);
msm_otg_set_power(&dev->otg, 0);
} else if (!test_bit(A_VBUS_VLD, &dev->inputs)) {
pr_debug("!a_vbus_vld\n");
msm_otg_del_timer(dev);
clear_bit(B_CONN, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_VBUS_ERR;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_host(&dev->otg, REQUEST_STOP);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
} else if (!test_bit(B_CONN, &dev->inputs) &&
dev->otg.host->b_hnp_enable) {
pr_debug("!b_conn && b_hnp_enable");
/* Clear AIDL_BDIS timer */
msm_otg_del_timer(dev);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_PERIPHERAL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_host(&dev->otg, REQUEST_HNP_SUSPEND);
/* We may come here even when B-dev is physically
* disconnected during HNP. We go back to host
* role if bus is idle for BIDL_ADIS time.
*/
dev->otg.gadget->is_a_peripheral = 1;
msm_otg_start_peripheral(&dev->otg, 1);
/* If ID_A: we can charge in a_peripheral as well */
if (test_bit(ID_A, &dev->inputs)) {
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg,
USB_IDCHG_MIN - USB_IB_UNCFG);
}
} else if (!test_bit(B_CONN, &dev->inputs) &&
!dev->otg.host->b_hnp_enable) {
pr_debug("!b_conn && !b_hnp_enable");
/* bus request is dropped during suspend.
* acquire again for next device.
*/
set_bit(A_BUS_REQ, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_BCON;
spin_unlock_irqrestore(&dev->lock, flags);
if (TA_WAIT_BCON > 0)
msm_otg_start_timer(dev, TA_WAIT_BCON,
A_WAIT_BCON);
msm_otg_set_power(&dev->otg, 0);
} else if (test_bit(ID_A, &dev->inputs)) {
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg,
USB_IDCHG_MIN - USB_IB_UNCFG);
} else if (!test_bit(ID, &dev->inputs)) {
msm_otg_set_power(&dev->otg, 0);
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 1);
}
break;
case OTG_STATE_A_PERIPHERAL:
if ((test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) ||
test_bit(A_BUS_DROP, &dev->inputs)) {
pr_debug("id _f/b/c || a_bus_drop\n");
/* Clear BIDL_ADIS timer */
msm_otg_del_timer(dev);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VFALL;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_peripheral(&dev->otg, 0);
dev->otg.gadget->is_a_peripheral = 0;
/* HCD was suspended before. Stop it now */
msm_otg_start_host(&dev->otg, REQUEST_STOP);
/* Reset both phy and link */
otg_reset(&dev->otg, 1);
if (!test_bit(ID_A, &dev->inputs))
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
msm_otg_start_timer(dev, TA_WAIT_VFALL, A_WAIT_VFALL);
msm_otg_set_power(&dev->otg, 0);
} else if (!test_bit(A_VBUS_VLD, &dev->inputs)) {
pr_debug("!a_vbus_vld\n");
/* Clear BIDL_ADIS timer */
msm_otg_del_timer(dev);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_VBUS_ERR;
spin_unlock_irqrestore(&dev->lock, flags);
msm_otg_start_peripheral(&dev->otg, 0);
dev->otg.gadget->is_a_peripheral = 0;
/* HCD was suspended before. Stop it now */
msm_otg_start_host(&dev->otg, REQUEST_STOP);
} else if (test_bit(A_BIDL_ADIS, &dev->tmouts)) {
pr_debug("a_bidl_adis_tmout\n");
msm_otg_start_peripheral(&dev->otg, 0);
dev->otg.gadget->is_a_peripheral = 0;
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_BCON;
spin_unlock_irqrestore(&dev->lock, flags);
set_bit(A_BUS_REQ, &dev->inputs);
msm_otg_start_host(&dev->otg, REQUEST_HNP_RESUME);
if (TA_WAIT_BCON > 0)
msm_otg_start_timer(dev, TA_WAIT_BCON,
A_WAIT_BCON);
msm_otg_set_power(&dev->otg, 0);
} else if (test_bit(ID_A, &dev->inputs)) {
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
atomic_set(&dev->chg_type, USB_CHG_TYPE__SDP);
msm_otg_set_power(&dev->otg,
USB_IDCHG_MIN - USB_IB_UNCFG);
} else if (!test_bit(ID, &dev->inputs)) {
msm_otg_set_power(&dev->otg, 0);
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 1);
}
break;
case OTG_STATE_A_WAIT_VFALL:
if (test_bit(A_WAIT_VFALL, &dev->tmouts)) {
clear_bit(A_VBUS_VLD, &dev->inputs);
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_IDLE;
spin_unlock_irqrestore(&dev->lock, flags);
work = 1;
}
break;
case OTG_STATE_A_VBUS_ERR:
if ((test_bit(ID, &dev->inputs) &&
!test_bit(ID_A, &dev->inputs)) ||
test_bit(A_BUS_DROP, &dev->inputs) ||
test_bit(A_CLR_ERR, &dev->inputs)) {
spin_lock_irqsave(&dev->lock, flags);
dev->otg.state = OTG_STATE_A_WAIT_VFALL;
spin_unlock_irqrestore(&dev->lock, flags);
if (!test_bit(ID_A, &dev->inputs))
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
msm_otg_start_timer(dev, TA_WAIT_VFALL, A_WAIT_VFALL);
msm_otg_set_power(&dev->otg, 0);
}
break;
default:
pr_err("invalid OTG state\n");
}
if (work)
queue_work(dev->wq, &dev->sm_work);
#ifdef CONFIG_USB_MSM_ACA
/* Start id_polling if (ID_FLOAT&BSV) || ID_A/B/C */
if ((test_bit(ID, &dev->inputs) &&
test_bit(B_SESS_VLD, &dev->inputs) &&
chg_type != USB_CHG_TYPE__WALLCHARGER) ||
test_bit(ID_A, &dev->inputs)) {
mod_timer(&dev->id_timer, jiffies +
msecs_to_jiffies(OTG_ID_POLL_MS));
return;
}
del_timer(&dev->id_timer);
#endif
/* IRQ/sysfs may queue work. Check work_pending. otherwise
* we might endup releasing wakelock after it is acquired
* in IRQ/sysfs.
*/
if (!work_pending(&dev->sm_work) && !hrtimer_active(&dev->timer) &&
!work_pending(&dev->otg_resume_work))
wake_unlock(&dev->wlock);
}
#ifdef CONFIG_USB_MSM_ACA
static void msm_otg_id_func(unsigned long _dev)
{
struct msm_otg *dev = (struct msm_otg *) _dev;
u8 phy_ints;
#ifdef CONFIG_USB_MSM_STANDARD_ACA
/*
* When standard ACA is attached RID_A and RID_GND states are only
* possible. RID_A-->RID_GND transition generates IdGnd interrupt
* from PHY. Hence polling is disabled.
*/
if (test_bit(ID_A, &dev->inputs))
goto out;
#endif
if (atomic_read(&dev->in_lpm))
msm_otg_set_suspend(&dev->otg, 0);
phy_ints = ulpi_read(dev, 0x13);
/*
* ACA timer will be kicked again after the PHY
* state is recovered.
*/
if (phy_ints == -ETIMEDOUT)
return;
/* If id_gnd happened then stop and let isr take care of this */
if (phy_id_state_gnd(phy_ints))
goto out;
if ((test_bit(ID_A, &dev->inputs) == phy_id_state_a(phy_ints)) &&
(test_bit(ID_B, &dev->inputs) == phy_id_state_b(phy_ints)) &&
(test_bit(ID_C, &dev->inputs) == phy_id_state_c(phy_ints))) {
mod_timer(&dev->id_timer,
jiffies + msecs_to_jiffies(OTG_ID_POLL_MS));
goto out;
} else {
set_aca_id_inputs(dev);
}
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
out:
/* OOPS: runing while !BSV, schedule work to initiate LPM */
if (!is_b_sess_vld()) {
clear_bit(B_SESS_VLD, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
return;
}
#endif
#ifdef CONFIG_USB_OTG
static ssize_t
set_pwr_down(struct device *_dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct msm_otg *dev = the_msm_otg;
int value;
enum usb_otg_state state;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
/* Applicable for only A-Device */
if (state <= OTG_STATE_A_IDLE)
return -EINVAL;
sscanf(buf, "%d", &value);
if (test_bit(A_BUS_DROP, &dev->inputs) != !!value) {
change_bit(A_BUS_DROP, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
return count;
}
static DEVICE_ATTR(pwr_down, S_IRUGO | S_IWUSR, NULL, set_pwr_down);
static ssize_t
set_srp_req(struct device *_dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct msm_otg *dev = the_msm_otg;
enum usb_otg_state state;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
if (state != OTG_STATE_B_IDLE)
return -EINVAL;
set_bit(B_BUS_REQ, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
return count;
}
static DEVICE_ATTR(srp_req, S_IRUGO | S_IWUSR, NULL, set_srp_req);
static ssize_t
set_clr_err(struct device *_dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct msm_otg *dev = the_msm_otg;
enum usb_otg_state state;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
state = dev->otg.state;
spin_unlock_irqrestore(&dev->lock, flags);
if (state == OTG_STATE_A_VBUS_ERR) {
set_bit(A_CLR_ERR, &dev->inputs);
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
return count;
}
static DEVICE_ATTR(clr_err, S_IRUGO | S_IWUSR, NULL, set_clr_err);
static struct attribute *msm_otg_attrs[] = {
&dev_attr_pwr_down.attr,
&dev_attr_srp_req.attr,
&dev_attr_clr_err.attr,
NULL,
};
static struct attribute_group msm_otg_attr_grp = {
.attrs = msm_otg_attrs,
};
#endif
#ifdef CONFIG_DEBUG_FS
static int otg_open(struct inode *inode, struct file *file)
{
file->private_data = inode->i_private;
return 0;
}
static ssize_t otg_mode_write(struct file *file, const char __user *buf,
size_t count, loff_t *ppos)
{
struct msm_otg *dev = file->private_data;
int ret = count;
int work = 0;
unsigned long flags;
spin_lock_irqsave(&dev->lock, flags);
dev->pdata->otg_mode = OTG_USER_CONTROL;
if (!memcmp(buf, "none", 4)) {
clear_bit(B_SESS_VLD, &dev->inputs);
set_bit(ID, &dev->inputs);
work = 1;
} else if (!memcmp(buf, "peripheral", 10)) {
set_bit(B_SESS_VLD, &dev->inputs);
set_bit(ID, &dev->inputs);
work = 1;
} else if (!memcmp(buf, "host", 4)) {
clear_bit(B_SESS_VLD, &dev->inputs);
clear_bit(ID, &dev->inputs);
set_bit(A_BUS_REQ, &dev->inputs);
work = 1;
} else {
pr_info("%s: unknown mode specified\n", __func__);
ret = -EINVAL;
}
spin_unlock_irqrestore(&dev->lock, flags);
if (work) {
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
}
return ret;
}
const struct file_operations otgfs_fops = {
.open = otg_open,
.write = otg_mode_write,
};
#define OTG_INFO_SIZE 512
static ssize_t otg_info_read(struct file *file, char __user *ubuf,
size_t count, loff_t *ppos)
{
char *buf;
int temp = 0;
int ret;
struct msm_otg *dev = file->private_data;
buf = kzalloc(sizeof(char) * OTG_INFO_SIZE, GFP_KERNEL);
if (!buf)
return -ENOMEM;
temp += scnprintf(buf + temp, OTG_INFO_SIZE - temp,
"OTG State: %s\n"
"OTG Mode: %d\n"
"OTG Inputs: 0x%lx\n"
"Charger Type: %d\n"
"PMIC VBUS Support: %u\n"
"PMIC ID Support: %u\n"
"Core Clock: %u\n"
"USB In SPS: %d\n"
"pre_emphasis_level: 0x%x\n"
"cdr_auto_reset: 0x%x\n"
"hs_drv_amplitude: 0x%x\n"
"se1_gate_state: 0x%x\n"
"swfi_latency: 0x%x\n"
"PHY Powercollapse: 0x%x\n"
"PCLK Voting: 0x%x\n",
state_string(dev->otg.state),
dev->pdata->otg_mode,
dev->inputs,
atomic_read(&dev->chg_type),
dev->pmic_vbus_notif_supp,
dev->pmic_id_notif_supp,
dev->pdata->core_clk,
dev->pdata->usb_in_sps,
dev->pdata->pemp_level,
dev->pdata->cdr_autoreset,
dev->pdata->drv_ampl,
dev->pdata->se1_gating,
dev->pdata->swfi_latency,
dev->pdata->phy_can_powercollapse,
pclk_requires_voting(&dev->otg));
ret = simple_read_from_buffer(ubuf, count, ppos, buf, temp);
kfree(buf);
return ret;
}
const struct file_operations otgfs_info_fops = {
.open = otg_open,
.read = otg_info_read,
};
struct dentry *otg_debug_root;
struct dentry *otg_debug_mode;
struct dentry *otg_debug_info;
#endif
static int otg_debugfs_init(struct msm_otg *dev)
{
#ifdef CONFIG_DEBUG_FS
otg_debug_root = debugfs_create_dir("otg", NULL);
if (!otg_debug_root)
return -ENOENT;
otg_debug_mode = debugfs_create_file("mode", 0222,
otg_debug_root, dev,
&otgfs_fops);
if (!otg_debug_mode)
goto free_root;
otg_debug_info = debugfs_create_file("info", 0444,
otg_debug_root, dev,
&otgfs_info_fops);
if (!otg_debug_info)
goto free_mode;
return 0;
free_mode:
debugfs_remove(otg_debug_mode);
otg_debug_mode = NULL;
free_root:
debugfs_remove(otg_debug_root);
otg_debug_root = NULL;
return -ENOENT;
#endif
return 0;
}
static void otg_debugfs_cleanup(void)
{
#ifdef CONFIG_DEBUG_FS
debugfs_remove(otg_debug_info);
debugfs_remove(otg_debug_mode);
debugfs_remove(otg_debug_root);
#endif
}
struct otg_io_access_ops msm_otg_io_ops = {
.read = usb_ulpi_read,
.write = usb_ulpi_write,
};
static int __init msm_otg_probe(struct platform_device *pdev)
{
int ret = 0;
struct resource *res;
struct msm_otg *dev;
dev = kzalloc(sizeof(struct msm_otg), GFP_KERNEL);
if (!dev)
return -ENOMEM;
the_msm_otg = dev;
dev->otg.dev = &pdev->dev;
dev->pdata = pdev->dev.platform_data;
if (!dev->pdata) {
ret = -ENODEV;
goto free_dev;
}
#ifdef CONFIG_USB_EHCI_MSM_72K
if (!dev->pdata->vbus_power) {
ret = -ENODEV;
goto free_dev;
} else
dev->pdata->vbus_power(USB_PHY_INTEGRATED, 0);
#endif
if (dev->pdata->rpc_connect) {
ret = dev->pdata->rpc_connect(1);
pr_debug("%s: rpc_connect(%d)\n", __func__, ret);
if (ret) {
pr_err("%s: rpc connect failed\n", __func__);
ret = -ENODEV;
goto free_dev;
}
}
dev->hs_clk = clk_get(&pdev->dev, "usb_hs_clk");
if (IS_ERR(dev->hs_clk)) {
pr_err("%s: failed to get usb_hs_clk\n", __func__);
ret = PTR_ERR(dev->hs_clk);
goto rpc_fail;
}
clk_set_rate(dev->hs_clk, 60000000);
/* pm qos request to prevent apps idle power collapse */
pm_qos_add_request(&dev->pdata->pm_qos_req_dma, PM_QOS_CPU_DMA_LATENCY,
PM_QOS_DEFAULT_VALUE);
/* If USB Core is running its protocol engine based on PCLK,
* PCLK must be running at >60Mhz for correct HSUSB operation and
* USB core cannot tolerate frequency changes on PCLK. For such
* USB cores, vote for maximum clk frequency on pclk source
*/
if (dev->pdata->pclk_src_name) {
dev->pclk_src = clk_get(0, dev->pdata->pclk_src_name);
if (IS_ERR(dev->pclk_src))
goto put_hs_clk;
clk_set_rate(dev->pclk_src, INT_MAX);
msm_otg_vote_for_pclk_source(dev, 1);
}
if (!dev->pdata->pclk_is_hw_gated) {
dev->hs_pclk = clk_get(&pdev->dev, "usb_hs_pclk");
if (IS_ERR(dev->hs_pclk)) {
pr_err("%s: failed to get usb_hs_pclk\n", __func__);
ret = PTR_ERR(dev->hs_pclk);
goto put_pclk_src;
}
clk_enable(dev->hs_pclk);
}
if (dev->pdata->core_clk) {
dev->hs_cclk = clk_get(&pdev->dev, "usb_hs_core_clk");
if (IS_ERR(dev->hs_cclk)) {
pr_err("%s: failed to get usb_hs_core_clk\n", __func__);
ret = PTR_ERR(dev->hs_cclk);
goto put_hs_pclk;
}
clk_enable(dev->hs_cclk);
}
if (!dev->pdata->phy_reset) {
dev->phy_reset_clk = clk_get(&pdev->dev, "usb_phy_clk");
if (IS_ERR(dev->phy_reset_clk)) {
pr_err("%s: failed to get usb_phy_clk\n", __func__);
ret = PTR_ERR(dev->phy_reset_clk);
goto put_hs_cclk;
}
}
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (!res) {
pr_err("%s: failed to get platform resource mem\n", __func__);
ret = -ENODEV;
goto put_phy_clk;
}
dev->regs = ioremap(res->start, resource_size(res));
if (!dev->regs) {
pr_err("%s: ioremap failed\n", __func__);
ret = -ENOMEM;
goto put_phy_clk;
}
dev->irq = platform_get_irq(pdev, 0);
if (!dev->irq) {
pr_err("%s: platform_get_irq failed\n", __func__);
ret = -ENODEV;
goto free_regs;
}
dev->xo_handle = msm_xo_get(MSM_XO_TCXO_D1, "usb");
if (IS_ERR(dev->xo_handle)) {
pr_err(" %s not able to get the handle"
"to vote for TCXO D1 buffer\n", __func__);
ret = PTR_ERR(dev->xo_handle);
goto free_regs;
}
ret = msm_xo_mode_vote(dev->xo_handle, MSM_XO_MODE_ON);
if (ret) {
pr_err("%s failed to vote for TCXO"
"D1 buffer%d\n", __func__, ret);
goto free_xo_handle;
}
msm_otg_init_timer(dev);
INIT_WORK(&dev->sm_work, msm_otg_sm_work);
INIT_WORK(&dev->otg_resume_work, msm_otg_resume_w);
spin_lock_init(&dev->lock);
wake_lock_init(&dev->wlock, WAKE_LOCK_SUSPEND, "msm_otg");
dev->wq = alloc_workqueue("k_otg", WQ_NON_REENTRANT, 0);
if (!dev->wq) {
ret = -ENOMEM;
goto free_wlock;
}
if (dev->pdata->init_gpio) {
ret = dev->pdata->init_gpio(1);
if (ret) {
pr_err("%s: gpio init failed with err:%d\n",
__func__, ret);
goto free_wq;
}
}
/* To reduce phy power consumption and to avoid external LDO
* on the board, PMIC comparators can be used to detect VBUS
* session change.
*/
if (dev->pdata->pmic_vbus_notif_init) {
ret = dev->pdata->pmic_vbus_notif_init
(&msm_otg_set_vbus_state, 1);
if (!ret) {
dev->pmic_vbus_notif_supp = 1;
} else if (ret != -ENOTSUPP) {
pr_err("%s: pmic_vbus_notif_init() failed, err:%d\n",
__func__, ret);
goto free_gpio;
}
}
if (dev->pdata->pmic_id_notif_init) {
ret = dev->pdata->pmic_id_notif_init(&msm_otg_set_id_state, 1);
if (!ret) {
dev->pmic_id_notif_supp = 1;
} else if (ret != -ENOTSUPP) {
pr_err("%s: pmic_id_ notif_init failed err:%d",
__func__, ret);
goto free_pmic_vbus_notif;
}
}
if (dev->pdata->pmic_vbus_irq)
dev->vbus_on_irq = dev->pdata->pmic_vbus_irq;
if (dev->pdata->pmic_id_irq)
dev->id_irq = dev->pdata->pmic_id_irq;
/* vote for vddcx, as PHY cannot tolerate vddcx below 1.0V */
if (dev->pdata->init_vddcx) {
ret = dev->pdata->init_vddcx(1);
if (ret) {
pr_err("%s: unable to enable vddcx digital core:%d\n",
__func__, ret);
goto free_pmic_id_notif;
}
}
if (dev->pdata->ldo_init) {
ret = dev->pdata->ldo_init(1);
if (ret) {
pr_err("%s: ldo_init failed with err:%d\n",
__func__, ret);
goto free_config_vddcx;
}
}
if (dev->pdata->ldo_enable) {
ret = dev->pdata->ldo_enable(1);
if (ret) {
pr_err("%s: ldo_enable failed with err:%d\n",
__func__, ret);
goto free_ldo_init;
}
}
/* ACk all pending interrupts and clear interrupt enable registers */
writel((readl(USB_OTGSC) & ~OTGSC_INTR_MASK), USB_OTGSC);
writel(readl(USB_USBSTS), USB_USBSTS);
writel(0, USB_USBINTR);
/* Ensure that above STOREs are completed before enabling interrupts */
mb();
ret = request_irq(dev->irq, msm_otg_irq, IRQF_SHARED,
"msm_otg", dev);
if (ret) {
pr_err("%s: request irq failed\n", __func__);
goto free_ldo_enable;
}
dev->otg.set_peripheral = msm_otg_set_peripheral;
#ifdef CONFIG_USB_EHCI_MSM_72K
dev->otg.set_host = msm_otg_set_host;
#endif
dev->otg.set_suspend = msm_otg_set_suspend;
dev->otg.start_hnp = msm_otg_start_hnp;
dev->otg.send_event = msm_otg_send_event;
dev->otg.set_power = msm_otg_set_power;
dev->set_clk = msm_otg_set_clk;
dev->reset = otg_reset;
dev->otg.io_ops = &msm_otg_io_ops;
if (otg_set_transceiver(&dev->otg)) {
WARN_ON(1);
goto free_otg_irq;
}
#ifdef CONFIG_USB_MSM_ACA
/* Link doesnt support id_a/b/c interrupts, hence polling
* needs to be done to support ACA charger
*/
init_timer(&dev->id_timer);
dev->id_timer.function = msm_otg_id_func;
dev->id_timer.data = (unsigned long) dev;
#endif
atomic_set(&dev->chg_type, USB_CHG_TYPE__INVALID);
if (dev->pdata->chg_init && dev->pdata->chg_init(1))
pr_err("%s: chg_init failed\n", __func__);
device_init_wakeup(&pdev->dev, 1);
ret = pm_runtime_set_active(&pdev->dev);
if (ret < 0)
pr_err("%s: pm_runtime: Fail to set active\n", __func__);
ret = 0;
pm_runtime_enable(&pdev->dev);
pm_runtime_get(&pdev->dev);
ret = otg_debugfs_init(dev);
if (ret) {
pr_err("%s: otg_debugfs_init failed\n", __func__);
goto chg_deinit;
}
#ifdef CONFIG_USB_OTG
ret = sysfs_create_group(&pdev->dev.kobj, &msm_otg_attr_grp);
if (ret < 0) {
pr_err("%s: Failed to create the sysfs entry\n", __func__);
otg_debugfs_cleanup();
goto chg_deinit;
}
#endif
return 0;
chg_deinit:
if (dev->pdata->chg_init)
dev->pdata->chg_init(0);
free_otg_irq:
free_irq(dev->irq, dev);
free_ldo_enable:
if (dev->pdata->ldo_enable)
dev->pdata->ldo_enable(0);
if (dev->pdata->setup_gpio)
dev->pdata->setup_gpio(USB_SWITCH_DISABLE);
free_ldo_init:
if (dev->pdata->ldo_init)
dev->pdata->ldo_init(0);
free_config_vddcx:
if (dev->pdata->init_vddcx)
dev->pdata->init_vddcx(0);
free_pmic_id_notif:
if (dev->pdata->pmic_id_notif_init && dev->pmic_id_notif_supp)
dev->pdata->pmic_id_notif_init(&msm_otg_set_id_state, 0);
free_pmic_vbus_notif:
if (dev->pdata->pmic_vbus_notif_init && dev->pmic_vbus_notif_supp)
dev->pdata->pmic_vbus_notif_init(&msm_otg_set_vbus_state, 0);
free_gpio:
if (dev->pdata->init_gpio)
dev->pdata->init_gpio(0);
free_wq:
destroy_workqueue(dev->wq);
free_wlock:
wake_lock_destroy(&dev->wlock);
free_xo_handle:
msm_xo_put(dev->xo_handle);
free_regs:
iounmap(dev->regs);
put_phy_clk:
if (dev->phy_reset_clk)
clk_put(dev->phy_reset_clk);
put_hs_cclk:
if (dev->hs_cclk) {
clk_disable(dev->hs_cclk);
clk_put(dev->hs_cclk);
}
put_hs_pclk:
if (dev->hs_pclk) {
clk_disable(dev->hs_pclk);
clk_put(dev->hs_pclk);
}
put_pclk_src:
if (dev->pclk_src) {
msm_otg_vote_for_pclk_source(dev, 0);
clk_put(dev->pclk_src);
}
put_hs_clk:
if (dev->hs_clk)
clk_put(dev->hs_clk);
rpc_fail:
if (dev->pdata->rpc_connect)
dev->pdata->rpc_connect(0);
free_dev:
kfree(dev);
return ret;
}
static int __exit msm_otg_remove(struct platform_device *pdev)
{
struct msm_otg *dev = the_msm_otg;
otg_debugfs_cleanup();
#ifdef CONFIG_USB_OTG
sysfs_remove_group(&pdev->dev.kobj, &msm_otg_attr_grp);
#endif
destroy_workqueue(dev->wq);
wake_lock_destroy(&dev->wlock);
if (dev->pdata->setup_gpio)
dev->pdata->setup_gpio(USB_SWITCH_DISABLE);
if (dev->pdata->init_vddcx)
dev->pdata->init_vddcx(0);
if (dev->pdata->ldo_enable)
dev->pdata->ldo_enable(0);
if (dev->pdata->ldo_init)
dev->pdata->ldo_init(0);
if (dev->pmic_vbus_notif_supp)
dev->pdata->pmic_vbus_notif_init(&msm_otg_set_vbus_state, 0);
if (dev->pmic_id_notif_supp)
dev->pdata->pmic_id_notif_init(&msm_otg_set_id_state, 0);
#ifdef CONFIG_USB_MSM_ACA
del_timer_sync(&dev->id_timer);
#endif
if (dev->pdata->chg_init)
dev->pdata->chg_init(0);
free_irq(dev->irq, pdev);
iounmap(dev->regs);
if (dev->hs_cclk) {
clk_disable(dev->hs_cclk);
clk_put(dev->hs_cclk);
}
if (dev->hs_pclk) {
clk_disable(dev->hs_pclk);
clk_put(dev->hs_pclk);
}
if (dev->hs_clk)
clk_put(dev->hs_clk);
if (dev->phy_reset_clk)
clk_put(dev->phy_reset_clk);
if (dev->pdata->rpc_connect)
dev->pdata->rpc_connect(0);
if (dev->pclk_src) {
msm_otg_vote_for_pclk_source(dev, 0);
clk_put(dev->pclk_src);
}
msm_xo_put(dev->xo_handle);
pm_qos_remove_request(&dev->pdata->pm_qos_req_dma);
pm_runtime_put(&pdev->dev);
pm_runtime_disable(&pdev->dev);
kfree(dev);
return 0;
}
static int msm_otg_runtime_suspend(struct device *dev)
{
struct msm_otg *otg = the_msm_otg;
dev_dbg(dev, "pm_runtime: suspending...\n");
msm_otg_suspend(otg);
return 0;
}
static int msm_otg_runtime_resume(struct device *dev)
{
struct msm_otg *otg = the_msm_otg;
dev_dbg(dev, "pm_runtime: resuming...\n");
msm_otg_resume(otg);
return 0;
}
static int msm_otg_runtime_idle(struct device *dev)
{
dev_dbg(dev, "pm_runtime: idling...\n");
return 0;
}
static struct dev_pm_ops msm_otg_dev_pm_ops = {
.runtime_suspend = msm_otg_runtime_suspend,
.runtime_resume = msm_otg_runtime_resume,
.runtime_idle = msm_otg_runtime_idle,
};
static struct platform_driver msm_otg_driver = {
.remove = __exit_p(msm_otg_remove),
.driver = {
.name = DRIVER_NAME,
.owner = THIS_MODULE,
.pm = &msm_otg_dev_pm_ops,
},
};
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");
MODULE_VERSION("1.00");