drivers/usb/phy/phy-msm-usb.c

   1 /* Copyright (c) 2009-2011, Code Aurora Forum. All rights reserved.
   2  *
   3  * This program is free software; you can redistribute it and/or modify
   4  * it under the terms of the GNU General Public License version 2 and
   5  * only version 2 as published by the Free Software Foundation.
   6  *
   7  * This program is distributed in the hope that it will be useful,
   8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
   9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  10  * GNU General Public License for more details.
  11  *
  12  * You should have received a copy of the GNU General Public License
  13  * along with this program; if not, write to the Free Software
  14  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  15  * 02110-1301, USA.
  16  *
  17  */
  18
  19 #include <linux/module.h>
  20 #include <linux/device.h>
  21 #include <linux/platform_device.h>
  22 #include <linux/clk.h>
  23 #include <linux/slab.h>
  24 #include <linux/interrupt.h>
  25 #include <linux/err.h>
  26 #include <linux/delay.h>
  27 #include <linux/io.h>
  28 #include <linux/ioport.h>
  29 #include <linux/uaccess.h>
  30 #include <linux/debugfs.h>
  31 #include <linux/seq_file.h>
  32 #include <linux/pm_runtime.h>
  33 #include <linux/of.h>
  34 #include <linux/of_device.h>
  35 #include <linux/reset.h>
  36
  37 #include <linux/usb.h>
  38 #include <linux/usb/otg.h>
  39 #include <linux/usb/of.h>
  40 #include <linux/usb/ulpi.h>
  41 #include <linux/usb/gadget.h>
  42 #include <linux/usb/hcd.h>
  43 #include <linux/usb/msm_hsusb.h>
  44 #include <linux/usb/msm_hsusb_hw.h>
  45 #include <linux/regulator/consumer.h>
  46
  47 #define MSM_USB_BASE    (motg->regs)
  48 #define DRIVER_NAME     "msm_otg"
  49
  50 #define ULPI_IO_TIMEOUT_USEC    (10 * 1000)
  51 #define LINK_RESET_TIMEOUT_USEC (250 * 1000)
  52
  53 #define USB_PHY_3P3_VOL_MIN     3050000 /* uV */
  54 #define USB_PHY_3P3_VOL_MAX     3300000 /* uV */
  55 #define USB_PHY_3P3_HPM_LOAD    50000   /* uA */
  56 #define USB_PHY_3P3_LPM_LOAD    4000    /* uA */
  57
  58 #define USB_PHY_1P8_VOL_MIN     1800000 /* uV */
  59 #define USB_PHY_1P8_VOL_MAX     1800000 /* uV */
  60 #define USB_PHY_1P8_HPM_LOAD    50000   /* uA */
  61 #define USB_PHY_1P8_LPM_LOAD    4000    /* uA */
  62
  63 #define USB_PHY_VDD_DIG_VOL_MIN 1000000 /* uV */
  64 #define USB_PHY_VDD_DIG_VOL_MAX 1320000 /* uV */
  65 #define USB_PHY_SUSP_DIG_VOL    500000  /* uV */
  66
  67 enum vdd_levels {
  68         VDD_LEVEL_NONE = 0,
  69         VDD_LEVEL_MIN,
  70         VDD_LEVEL_MAX,
  71 };
  72
  73 static int msm_hsusb_init_vddcx(struct msm_otg *motg, int init)
  74 {
  75         int ret = 0;
  76
  77         if (init) {
  78                 ret = regulator_set_voltage(motg->vddcx,
  79                                 motg->vdd_levels[VDD_LEVEL_MIN],
  80                                 motg->vdd_levels[VDD_LEVEL_MAX]);
  81                 if (ret) {
  82                         dev_err(motg->phy.dev, "Cannot set vddcx voltage\n");
  83                         return ret;
  84                 }
  85
  86                 ret = regulator_enable(motg->vddcx);
  87                 if (ret)
  88                         dev_err(motg->phy.dev, "unable to enable hsusb vddcx\n");
  89         } else {
  90                 ret = regulator_set_voltage(motg->vddcx, 0,
  91                                 motg->vdd_levels[VDD_LEVEL_MAX]);
  92                 if (ret)
  93                         dev_err(motg->phy.dev, "Cannot set vddcx voltage\n");
  94                 ret = regulator_disable(motg->vddcx);
  95                 if (ret)
  96                         dev_err(motg->phy.dev, "unable to disable hsusb vddcx\n");
  97         }
  98
  99         return ret;
 100 }
 101
 102 static int msm_hsusb_ldo_init(struct msm_otg *motg, int init)
 103 {
 104         int rc = 0;
 105
 106         if (init) {
 107                 rc = regulator_set_voltage(motg->v3p3, USB_PHY_3P3_VOL_MIN,
 108                                 USB_PHY_3P3_VOL_MAX);
 109                 if (rc) {
 110                         dev_err(motg->phy.dev, "Cannot set v3p3 voltage\n");
 111                         goto exit;
 112                 }
 113                 rc = regulator_enable(motg->v3p3);
 114                 if (rc) {
 115                         dev_err(motg->phy.dev, "unable to enable the hsusb 3p3\n");
 116                         goto exit;
 117                 }
 118                 rc = regulator_set_voltage(motg->v1p8, USB_PHY_1P8_VOL_MIN,
 119                                 USB_PHY_1P8_VOL_MAX);
 120                 if (rc) {
 121                         dev_err(motg->phy.dev, "Cannot set v1p8 voltage\n");
 122                         goto disable_3p3;
 123                 }
 124                 rc = regulator_enable(motg->v1p8);
 125                 if (rc) {
 126                         dev_err(motg->phy.dev, "unable to enable the hsusb 1p8\n");
 127                         goto disable_3p3;
 128                 }
 129
 130                 return 0;
 131         }
 132
 133         regulator_disable(motg->v1p8);
 134 disable_3p3:
 135         regulator_disable(motg->v3p3);
 136 exit:
 137         return rc;
 138 }
 139
 140 static int msm_hsusb_ldo_set_mode(struct msm_otg *motg, int on)
 141 {
 142         int ret = 0;
 143
 144         if (on) {
 145                 ret = regulator_set_optimum_mode(motg->v1p8,
 146                                 USB_PHY_1P8_HPM_LOAD);
 147                 if (ret < 0) {
 148                         pr_err("Could not set HPM for v1p8\n");
 149                         return ret;
 150                 }
 151                 ret = regulator_set_optimum_mode(motg->v3p3,
 152                                 USB_PHY_3P3_HPM_LOAD);
 153                 if (ret < 0) {
 154                         pr_err("Could not set HPM for v3p3\n");
 155                         regulator_set_optimum_mode(motg->v1p8,
 156                                 USB_PHY_1P8_LPM_LOAD);
 157                         return ret;
 158                 }
 159         } else {
 160                 ret = regulator_set_optimum_mode(motg->v1p8,
 161                                 USB_PHY_1P8_LPM_LOAD);
 162                 if (ret < 0)
 163                         pr_err("Could not set LPM for v1p8\n");
 164                 ret = regulator_set_optimum_mode(motg->v3p3,
 165                                 USB_PHY_3P3_LPM_LOAD);
 166                 if (ret < 0)
 167                         pr_err("Could not set LPM for v3p3\n");
 168         }
 169
 170         pr_debug("reg (%s)\n", on ? "HPM" : "LPM");
 171         return ret < 0 ? ret : 0;
 172 }
 173
 174 static int ulpi_read(struct usb_phy *phy, u32 reg)
 175 {
 176         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 177         int cnt = 0;
 178
 179         /* initiate read operation */
 180         writel(ULPI_RUN | ULPI_READ | ULPI_ADDR(reg),
 181                USB_ULPI_VIEWPORT);
 182
 183         /* wait for completion */
 184         while (cnt < ULPI_IO_TIMEOUT_USEC) {
 185                 if (!(readl(USB_ULPI_VIEWPORT) & ULPI_RUN))
 186                         break;
 187                 udelay(1);
 188                 cnt++;
 189         }
 190
 191         if (cnt >= ULPI_IO_TIMEOUT_USEC) {
 192                 dev_err(phy->dev, "ulpi_read: timeout %08x\n",
 193                         readl(USB_ULPI_VIEWPORT));
 194                 return -ETIMEDOUT;
 195         }
 196         return ULPI_DATA_READ(readl(USB_ULPI_VIEWPORT));
 197 }
 198
 199 static int ulpi_write(struct usb_phy *phy, u32 val, u32 reg)
 200 {
 201         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 202         int cnt = 0;
 203
 204         /* initiate write operation */
 205         writel(ULPI_RUN | ULPI_WRITE |
 206                ULPI_ADDR(reg) | ULPI_DATA(val),
 207                USB_ULPI_VIEWPORT);
 208
 209         /* wait for completion */
 210         while (cnt < ULPI_IO_TIMEOUT_USEC) {
 211                 if (!(readl(USB_ULPI_VIEWPORT) & ULPI_RUN))
 212                         break;
 213                 udelay(1);
 214                 cnt++;
 215         }
 216
 217         if (cnt >= ULPI_IO_TIMEOUT_USEC) {
 218                 dev_err(phy->dev, "ulpi_write: timeout\n");
 219                 return -ETIMEDOUT;
 220         }
 221         return 0;
 222 }
 223
 224 static struct usb_phy_io_ops msm_otg_io_ops = {
 225         .read = ulpi_read,
 226         .write = ulpi_write,
 227 };
 228
 229 static void ulpi_init(struct msm_otg *motg)
 230 {
 231         struct msm_otg_platform_data *pdata = motg->pdata;
 232         int *seq = pdata->phy_init_seq, idx;
 233         u32 addr = ULPI_EXT_VENDOR_SPECIFIC;
 234
 235         for (idx = 0; idx < pdata->phy_init_sz; idx++) {
 236                 if (seq[idx] == -1)
 237                         continue;
 238
 239                 dev_vdbg(motg->phy.dev, "ulpi: write 0x%02x to 0x%02x\n",
 240                                 seq[idx], addr + idx);
 241                 ulpi_write(&motg->phy, seq[idx], addr + idx);
 242         }
 243 }
 244
 245 static int msm_phy_notify_disconnect(struct usb_phy *phy,
 246                                    enum usb_device_speed speed)
 247 {
 248         int val;
 249
 250         /*
 251          * Put the transceiver in non-driving mode. Otherwise host
 252          * may not detect soft-disconnection.
 253          */
 254         val = ulpi_read(phy, ULPI_FUNC_CTRL);
 255         val &= ~ULPI_FUNC_CTRL_OPMODE_MASK;
 256         val |= ULPI_FUNC_CTRL_OPMODE_NONDRIVING;
 257         ulpi_write(phy, val, ULPI_FUNC_CTRL);
 258
 259         return 0;
 260 }
 261
 262 static int msm_otg_link_clk_reset(struct msm_otg *motg, bool assert)
 263 {
 264         int ret;
 265
 266         if (motg->pdata->link_clk_reset)
 267                 ret = motg->pdata->link_clk_reset(motg->clk, assert);
 268         else if (assert)
 269                 ret = reset_control_assert(motg->link_rst);
 270         else
 271                 ret = reset_control_deassert(motg->link_rst);
 272
 273         if (ret)
 274                 dev_err(motg->phy.dev, "usb link clk reset %s failed\n",
 275                         assert ? "assert" : "deassert");
 276
 277         return ret;
 278 }
 279
 280 static int msm_otg_phy_clk_reset(struct msm_otg *motg)
 281 {
 282         int ret = 0;
 283
 284         if (motg->pdata->phy_clk_reset)
 285                 ret = motg->pdata->phy_clk_reset(motg->phy_reset_clk);
 286         else if (motg->phy_rst)
 287                 ret = reset_control_reset(motg->phy_rst);
 288
 289         if (ret)
 290                 dev_err(motg->phy.dev, "usb phy clk reset failed\n");
 291
 292         return ret;
 293 }
 294
 295 static int msm_link_reset(struct msm_otg *motg)
 296 {
 297         u32 val;
 298         int ret;
 299
 300         ret = msm_otg_link_clk_reset(motg, 1);
 301         if (ret)
 302                 return ret;
 303
 304         /* wait for 1ms delay as suggested in HPG. */
 305         usleep_range(1000, 1200);
 306
 307         ret = msm_otg_link_clk_reset(motg, 0);
 308         if (ret)
 309                 return ret;
 310
 311         if (motg->phy_number)
 312                 writel(readl(USB_PHY_CTRL2) | BIT(16), USB_PHY_CTRL2);
 313
 314         /* put transceiver in serial mode as part of reset */
 315         val = readl(USB_PORTSC) & ~PORTSC_PTS_MASK;
 316         writel(val | PORTSC_PTS_SERIAL, USB_PORTSC);
 317
 318         return 0;
 319 }
 320
 321 static int msm_otg_reset(struct usb_phy *phy)
 322 {
 323         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 324         int cnt = 0;
 325
 326         writel(USBCMD_RESET, USB_USBCMD);
 327         while (cnt < LINK_RESET_TIMEOUT_USEC) {
 328                 if (!(readl(USB_USBCMD) & USBCMD_RESET))
 329                         break;
 330                 udelay(1);
 331                 cnt++;
 332         }
 333         if (cnt >= LINK_RESET_TIMEOUT_USEC)
 334                 return -ETIMEDOUT;
 335
 336         /* select ULPI phy and clear other status/control bits in PORTSC */
 337         writel(PORTSC_PTS_ULPI, USB_PORTSC);
 338
 339         writel(0x0, USB_AHBBURST);
 340         writel(0x08, USB_AHBMODE);
 341
 342         if (motg->phy_number)
 343                 writel(readl(USB_PHY_CTRL2) | BIT(16), USB_PHY_CTRL2);
 344         return 0;
 345 }
 346
 347 static void msm_phy_reset(struct msm_otg *motg)
 348 {
 349         void __iomem *addr;
 350
 351         if (motg->pdata->phy_type != SNPS_28NM_INTEGRATED_PHY) {
 352                 msm_otg_phy_clk_reset(motg);
 353                 return;
 354         }
 355
 356         addr = USB_PHY_CTRL;
 357         if (motg->phy_number)
 358                 addr = USB_PHY_CTRL2;
 359
 360         /* Assert USB PHY_POR */
 361         writel(readl(addr) | PHY_POR_ASSERT, addr);
 362
 363         /*
 364          * wait for minimum 10 microseconds as suggested in HPG.
 365          * Use a slightly larger value since the exact value didn't
 366          * work 100% of the time.
 367          */
 368         udelay(12);
 369
 370         /* Deassert USB PHY_POR */
 371         writel(readl(addr) & ~PHY_POR_ASSERT, addr);
 372 }
 373
 374 static int msm_usb_reset(struct usb_phy *phy)
 375 {
 376         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 377         int ret;
 378
 379         if (!IS_ERR(motg->core_clk))
 380                 clk_prepare_enable(motg->core_clk);
 381
 382         ret = msm_link_reset(motg);
 383         if (ret) {
 384                 dev_err(phy->dev, "phy_reset failed\n");
 385                 return ret;
 386         }
 387
 388         ret = msm_otg_reset(&motg->phy);
 389         if (ret) {
 390                 dev_err(phy->dev, "link reset failed\n");
 391                 return ret;
 392         }
 393
 394         msleep(100);
 395
 396         /* Reset USB PHY after performing USB Link RESET */
 397         msm_phy_reset(motg);
 398
 399         if (!IS_ERR(motg->core_clk))
 400                 clk_disable_unprepare(motg->core_clk);
 401
 402         return 0;
 403 }
 404
 405 static int msm_phy_init(struct usb_phy *phy)
 406 {
 407         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 408         struct msm_otg_platform_data *pdata = motg->pdata;
 409         u32 val, ulpi_val = 0;
 410
 411         /* Program USB PHY Override registers. */
 412         ulpi_init(motg);
 413
 414         /*
 415          * It is recommended in HPG to reset USB PHY after programming
 416          * USB PHY Override registers.
 417          */
 418         msm_phy_reset(motg);
 419
 420         if (pdata->otg_control == OTG_PHY_CONTROL) {
 421                 val = readl(USB_OTGSC);
 422                 if (pdata->mode == USB_DR_MODE_OTG) {
 423                         ulpi_val = ULPI_INT_IDGRD | ULPI_INT_SESS_VALID;
 424                         val |= OTGSC_IDIE | OTGSC_BSVIE;
 425                 } else if (pdata->mode == USB_DR_MODE_PERIPHERAL) {
 426                         ulpi_val = ULPI_INT_SESS_VALID;
 427                         val |= OTGSC_BSVIE;
 428                 }
 429                 writel(val, USB_OTGSC);
 430                 ulpi_write(phy, ulpi_val, ULPI_USB_INT_EN_RISE);
 431                 ulpi_write(phy, ulpi_val, ULPI_USB_INT_EN_FALL);
 432         }
 433
 434         if (motg->phy_number)
 435                 writel(readl(USB_PHY_CTRL2) | BIT(16), USB_PHY_CTRL2);
 436
 437         return 0;
 438 }
 439
 440 #define PHY_SUSPEND_TIMEOUT_USEC        (500 * 1000)
 441 #define PHY_RESUME_TIMEOUT_USEC (100 * 1000)
 442
 443 #ifdef CONFIG_PM
 444
 445 static int msm_hsusb_config_vddcx(struct msm_otg *motg, int high)
 446 {
 447         int max_vol = motg->vdd_levels[VDD_LEVEL_MAX];
 448         int min_vol;
 449         int ret;
 450
 451         if (high)
 452                 min_vol = motg->vdd_levels[VDD_LEVEL_MIN];
 453         else
 454                 min_vol = motg->vdd_levels[VDD_LEVEL_NONE];
 455
 456         ret = regulator_set_voltage(motg->vddcx, min_vol, max_vol);
 457         if (ret) {
 458                 pr_err("Cannot set vddcx voltage\n");
 459                 return ret;
 460         }
 461
 462         pr_debug("%s: min_vol:%d max_vol:%d\n", __func__, min_vol, max_vol);
 463
 464         return ret;
 465 }
 466
 467 static int msm_otg_suspend(struct msm_otg *motg)
 468 {
 469         struct usb_phy *phy = &motg->phy;
 470         struct usb_bus *bus = phy->otg->host;
 471         struct msm_otg_platform_data *pdata = motg->pdata;
 472         void __iomem *addr;
 473         int cnt = 0;
 474
 475         if (atomic_read(&motg->in_lpm))
 476                 return 0;
 477
 478         disable_irq(motg->irq);
 479         /*
 480          * Chipidea 45-nm PHY suspend sequence:
 481          *
 482          * Interrupt Latch Register auto-clear feature is not present
 483          * in all PHY versions. Latch register is clear on read type.
 484          * Clear latch register to avoid spurious wakeup from
 485          * low power mode (LPM).
 486          *
 487          * PHY comparators are disabled when PHY enters into low power
 488          * mode (LPM). Keep PHY comparators ON in LPM only when we expect
 489          * VBUS/Id notifications from USB PHY. Otherwise turn off USB
 490          * PHY comparators. This save significant amount of power.
 491          *
 492          * PLL is not turned off when PHY enters into low power mode (LPM).
 493          * Disable PLL for maximum power savings.
 494          */
 495
 496         if (motg->pdata->phy_type == CI_45NM_INTEGRATED_PHY) {
 497                 ulpi_read(phy, 0x14);
 498                 if (pdata->otg_control == OTG_PHY_CONTROL)
 499                         ulpi_write(phy, 0x01, 0x30);
 500                 ulpi_write(phy, 0x08, 0x09);
 501         }
 502
 503         /*
 504          * PHY may take some time or even fail to enter into low power
 505          * mode (LPM). Hence poll for 500 msec and reset the PHY and link
 506          * in failure case.
 507          */
 508         writel(readl(USB_PORTSC) | PORTSC_PHCD, USB_PORTSC);
 509         while (cnt < PHY_SUSPEND_TIMEOUT_USEC) {
 510                 if (readl(USB_PORTSC) & PORTSC_PHCD)
 511                         break;
 512                 udelay(1);
 513                 cnt++;
 514         }
 515
 516         if (cnt >= PHY_SUSPEND_TIMEOUT_USEC) {
 517                 dev_err(phy->dev, "Unable to suspend PHY\n");
 518                 msm_otg_reset(phy);
 519                 enable_irq(motg->irq);
 520                 return -ETIMEDOUT;
 521         }
 522
 523         /*
 524          * PHY has capability to generate interrupt asynchronously in low
 525          * power mode (LPM). This interrupt is level triggered. So USB IRQ
 526          * line must be disabled till async interrupt enable bit is cleared
 527          * in USBCMD register. Assert STP (ULPI interface STOP signal) to
 528          * block data communication from PHY.
 529          */
 530         writel(readl(USB_USBCMD) | ASYNC_INTR_CTRL | ULPI_STP_CTRL, USB_USBCMD);
 531
 532         addr = USB_PHY_CTRL;
 533         if (motg->phy_number)
 534                 addr = USB_PHY_CTRL2;
 535
 536         if (motg->pdata->phy_type == SNPS_28NM_INTEGRATED_PHY &&
 537                         motg->pdata->otg_control == OTG_PMIC_CONTROL)
 538                 writel(readl(addr) | PHY_RETEN, addr);
 539
 540         clk_disable_unprepare(motg->pclk);
 541         clk_disable_unprepare(motg->clk);
 542         if (!IS_ERR(motg->core_clk))
 543                 clk_disable_unprepare(motg->core_clk);
 544
 545         if (motg->pdata->phy_type == SNPS_28NM_INTEGRATED_PHY &&
 546                         motg->pdata->otg_control == OTG_PMIC_CONTROL) {
 547                 msm_hsusb_ldo_set_mode(motg, 0);
 548                 msm_hsusb_config_vddcx(motg, 0);
 549         }
 550
 551         if (device_may_wakeup(phy->dev))
 552                 enable_irq_wake(motg->irq);
 553         if (bus)
 554                 clear_bit(HCD_FLAG_HW_ACCESSIBLE, &(bus_to_hcd(bus))->flags);
 555
 556         atomic_set(&motg->in_lpm, 1);
 557         enable_irq(motg->irq);
 558
 559         dev_info(phy->dev, "USB in low power mode\n");
 560
 561         return 0;
 562 }
 563
 564 static int msm_otg_resume(struct msm_otg *motg)
 565 {
 566         struct usb_phy *phy = &motg->phy;
 567         struct usb_bus *bus = phy->otg->host;
 568         void __iomem *addr;
 569         int cnt = 0;
 570         unsigned temp;
 571
 572         if (!atomic_read(&motg->in_lpm))
 573                 return 0;
 574
 575         clk_prepare_enable(motg->pclk);
 576         clk_prepare_enable(motg->clk);
 577         if (!IS_ERR(motg->core_clk))
 578                 clk_prepare_enable(motg->core_clk);
 579
 580         if (motg->pdata->phy_type == SNPS_28NM_INTEGRATED_PHY &&
 581                         motg->pdata->otg_control == OTG_PMIC_CONTROL) {
 582
 583                 addr = USB_PHY_CTRL;
 584                 if (motg->phy_number)
 585                         addr = USB_PHY_CTRL2;
 586
 587                 msm_hsusb_ldo_set_mode(motg, 1);
 588                 msm_hsusb_config_vddcx(motg, 1);
 589                 writel(readl(addr) & ~PHY_RETEN, addr);
 590         }
 591
 592         temp = readl(USB_USBCMD);
 593         temp &= ~ASYNC_INTR_CTRL;
 594         temp &= ~ULPI_STP_CTRL;
 595         writel(temp, USB_USBCMD);
 596
 597         /*
 598          * PHY comes out of low power mode (LPM) in case of wakeup
 599          * from asynchronous interrupt.
 600          */
 601         if (!(readl(USB_PORTSC) & PORTSC_PHCD))
 602                 goto skip_phy_resume;
 603
 604         writel(readl(USB_PORTSC) & ~PORTSC_PHCD, USB_PORTSC);
 605         while (cnt < PHY_RESUME_TIMEOUT_USEC) {
 606                 if (!(readl(USB_PORTSC) & PORTSC_PHCD))
 607                         break;
 608                 udelay(1);
 609                 cnt++;
 610         }
 611
 612         if (cnt >= PHY_RESUME_TIMEOUT_USEC) {
 613                 /*
 614                  * This is a fatal error. Reset the link and
 615                  * PHY. USB state can not be restored. Re-insertion
 616                  * of USB cable is the only way to get USB working.
 617                  */
 618                 dev_err(phy->dev, "Unable to resume USB. Re-plugin the cable\n");
 619                 msm_otg_reset(phy);
 620         }
 621
 622 skip_phy_resume:
 623         if (device_may_wakeup(phy->dev))
 624                 disable_irq_wake(motg->irq);
 625         if (bus)
 626                 set_bit(HCD_FLAG_HW_ACCESSIBLE, &(bus_to_hcd(bus))->flags);
 627
 628         atomic_set(&motg->in_lpm, 0);
 629
 630         if (motg->async_int) {
 631                 motg->async_int = 0;
 632                 pm_runtime_put(phy->dev);
 633                 enable_irq(motg->irq);
 634         }
 635
 636         dev_info(phy->dev, "USB exited from low power mode\n");
 637
 638         return 0;
 639 }
 640 #endif
 641
 642 static void msm_otg_notify_charger(struct msm_otg *motg, unsigned mA)
 643 {
 644         if (motg->cur_power == mA)
 645                 return;
 646
 647         /* TODO: Notify PMIC about available current */
 648         dev_info(motg->phy.dev, "Avail curr from USB = %u\n", mA);
 649         motg->cur_power = mA;
 650 }
 651
 652 static int msm_otg_set_power(struct usb_phy *phy, unsigned mA)
 653 {
 654         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 655
 656         /*
 657          * Gadget driver uses set_power method to notify about the
 658          * available current based on suspend/configured states.
 659          *
 660          * IDEV_CHG can be drawn irrespective of suspend/un-configured
 661          * states when CDP/ACA is connected.
 662          */
 663         if (motg->chg_type == USB_SDP_CHARGER)
 664                 msm_otg_notify_charger(motg, mA);
 665
 666         return 0;
 667 }
 668
 669 static void msm_otg_start_host(struct usb_phy *phy, int on)
 670 {
 671         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 672         struct msm_otg_platform_data *pdata = motg->pdata;
 673         struct usb_hcd *hcd;
 674
 675         if (!phy->otg->host)
 676                 return;
 677
 678         hcd = bus_to_hcd(phy->otg->host);
 679
 680         if (on) {
 681                 dev_dbg(phy->dev, "host on\n");
 682
 683                 if (pdata->vbus_power)
 684                         pdata->vbus_power(1);
 685                 /*
 686                  * Some boards have a switch cotrolled by gpio
 687                  * to enable/disable internal HUB. Enable internal
 688                  * HUB before kicking the host.
 689                  */
 690                 if (pdata->setup_gpio)
 691                         pdata->setup_gpio(OTG_STATE_A_HOST);
 692 #ifdef CONFIG_USB
 693                 usb_add_hcd(hcd, hcd->irq, IRQF_SHARED);
 694                 device_wakeup_enable(hcd->self.controller);
 695 #endif
 696         } else {
 697                 dev_dbg(phy->dev, "host off\n");
 698
 699 #ifdef CONFIG_USB
 700                 usb_remove_hcd(hcd);
 701 #endif
 702                 if (pdata->setup_gpio)
 703                         pdata->setup_gpio(OTG_STATE_UNDEFINED);
 704                 if (pdata->vbus_power)
 705                         pdata->vbus_power(0);
 706         }
 707 }
 708
 709 static int msm_otg_set_host(struct usb_otg *otg, struct usb_bus *host)
 710 {
 711         struct msm_otg *motg = container_of(otg->usb_phy, struct msm_otg, phy);
 712         struct usb_hcd *hcd;
 713
 714         /*
 715          * Fail host registration if this board can support
 716          * only peripheral configuration.
 717          */
 718         if (motg->pdata->mode == USB_DR_MODE_PERIPHERAL) {
 719                 dev_info(otg->usb_phy->dev, "Host mode is not supported\n");
 720                 return -ENODEV;
 721         }
 722
 723         if (!host) {
 724                 if (otg->state == OTG_STATE_A_HOST) {
 725                         pm_runtime_get_sync(otg->usb_phy->dev);
 726                         msm_otg_start_host(otg->usb_phy, 0);
 727                         otg->host = NULL;
 728                         otg->state = OTG_STATE_UNDEFINED;
 729                         schedule_work(&motg->sm_work);
 730                 } else {
 731                         otg->host = NULL;
 732                 }
 733
 734                 return 0;
 735         }
 736
 737         hcd = bus_to_hcd(host);
 738         hcd->power_budget = motg->pdata->power_budget;
 739
 740         otg->host = host;
 741         dev_dbg(otg->usb_phy->dev, "host driver registered w/ tranceiver\n");
 742
 743         /*
 744          * Kick the state machine work, if peripheral is not supported
 745          * or peripheral is already registered with us.
 746          */
 747         if (motg->pdata->mode == USB_DR_MODE_HOST || otg->gadget) {
 748                 pm_runtime_get_sync(otg->usb_phy->dev);
 749                 schedule_work(&motg->sm_work);
 750         }
 751
 752         return 0;
 753 }
 754
 755 static void msm_otg_start_peripheral(struct usb_phy *phy, int on)
 756 {
 757         struct msm_otg *motg = container_of(phy, struct msm_otg, phy);
 758         struct msm_otg_platform_data *pdata = motg->pdata;
 759
 760         if (!phy->otg->gadget)
 761                 return;
 762
 763         if (on) {
 764                 dev_dbg(phy->dev, "gadget on\n");
 765                 /*
 766                  * Some boards have a switch cotrolled by gpio
 767                  * to enable/disable internal HUB. Disable internal
 768                  * HUB before kicking the gadget.
 769                  */
 770                 if (pdata->setup_gpio)
 771                         pdata->setup_gpio(OTG_STATE_B_PERIPHERAL);
 772                 usb_gadget_vbus_connect(phy->otg->gadget);
 773         } else {
 774                 dev_dbg(phy->dev, "gadget off\n");
 775                 usb_gadget_vbus_disconnect(phy->otg->gadget);
 776                 if (pdata->setup_gpio)
 777                         pdata->setup_gpio(OTG_STATE_UNDEFINED);
 778         }
 779
 780 }
 781
 782 static int msm_otg_set_peripheral(struct usb_otg *otg,
 783                                         struct usb_gadget *gadget)
 784 {
 785         struct msm_otg *motg = container_of(otg->usb_phy, struct msm_otg, phy);
 786
 787         /*
 788          * Fail peripheral registration if this board can support
 789          * only host configuration.
 790          */
 791         if (motg->pdata->mode == USB_DR_MODE_HOST) {
 792                 dev_info(otg->usb_phy->dev, "Peripheral mode is not supported\n");
 793                 return -ENODEV;
 794         }
 795
 796         if (!gadget) {
 797                 if (otg->state == OTG_STATE_B_PERIPHERAL) {
 798                         pm_runtime_get_sync(otg->usb_phy->dev);
 799                         msm_otg_start_peripheral(otg->usb_phy, 0);
 800                         otg->gadget = NULL;
 801                         otg->state = OTG_STATE_UNDEFINED;
 802                         schedule_work(&motg->sm_work);
 803                 } else {
 804                         otg->gadget = NULL;
 805                 }
 806
 807                 return 0;
 808         }
 809         otg->gadget = gadget;
 810         dev_dbg(otg->usb_phy->dev,
 811                 "peripheral driver registered w/ tranceiver\n");
 812
 813         /*
 814          * Kick the state machine work, if host is not supported
 815          * or host is already registered with us.
 816          */
 817         if (motg->pdata->mode == USB_DR_MODE_PERIPHERAL || otg->host) {
 818                 pm_runtime_get_sync(otg->usb_phy->dev);
 819                 schedule_work(&motg->sm_work);
 820         }
 821
 822         return 0;
 823 }
 824
 825 static bool msm_chg_check_secondary_det(struct msm_otg *motg)
 826 {
 827         struct usb_phy *phy = &motg->phy;
 828         u32 chg_det;
 829         bool ret = false;
 830
 831         switch (motg->pdata->phy_type) {
 832         case CI_45NM_INTEGRATED_PHY:
 833                 chg_det = ulpi_read(phy, 0x34);
 834                 ret = chg_det & (1 << 4);
 835                 break;
 836         case SNPS_28NM_INTEGRATED_PHY:
 837                 chg_det = ulpi_read(phy, 0x87);
 838                 ret = chg_det & 1;
 839                 break;
 840         default:
 841                 break;
 842         }
 843         return ret;
 844 }
 845
 846 static void msm_chg_enable_secondary_det(struct msm_otg *motg)
 847 {
 848         struct usb_phy *phy = &motg->phy;
 849         u32 chg_det;
 850
 851         switch (motg->pdata->phy_type) {
 852         case CI_45NM_INTEGRATED_PHY:
 853                 chg_det = ulpi_read(phy, 0x34);
 854                 /* Turn off charger block */
 855                 chg_det |= ~(1 << 1);
 856                 ulpi_write(phy, chg_det, 0x34);
 857                 udelay(20);
 858                 /* control chg block via ULPI */
 859                 chg_det &= ~(1 << 3);
 860                 ulpi_write(phy, chg_det, 0x34);
 861                 /* put it in host mode for enabling D- source */
 862                 chg_det &= ~(1 << 2);
 863                 ulpi_write(phy, chg_det, 0x34);
 864                 /* Turn on chg detect block */
 865                 chg_det &= ~(1 << 1);
 866                 ulpi_write(phy, chg_det, 0x34);
 867                 udelay(20);
 868                 /* enable chg detection */
 869                 chg_det &= ~(1 << 0);
 870                 ulpi_write(phy, chg_det, 0x34);
 871                 break;
 872         case SNPS_28NM_INTEGRATED_PHY:
 873                 /*
 874                  * Configure DM as current source, DP as current sink
 875                  * and enable battery charging comparators.
 876                  */
 877                 ulpi_write(phy, 0x8, 0x85);
 878                 ulpi_write(phy, 0x2, 0x85);
 879                 ulpi_write(phy, 0x1, 0x85);
 880                 break;
 881         default:
 882                 break;
 883         }
 884 }
 885
 886 static bool msm_chg_check_primary_det(struct msm_otg *motg)
 887 {
 888         struct usb_phy *phy = &motg->phy;
 889         u32 chg_det;
 890         bool ret = false;
 891
 892         switch (motg->pdata->phy_type) {
 893         case CI_45NM_INTEGRATED_PHY:
 894                 chg_det = ulpi_read(phy, 0x34);
 895                 ret = chg_det & (1 << 4);
 896                 break;
 897         case SNPS_28NM_INTEGRATED_PHY:
 898                 chg_det = ulpi_read(phy, 0x87);
 899                 ret = chg_det & 1;
 900                 break;
 901         default:
 902                 break;
 903         }
 904         return ret;
 905 }
 906
 907 static void msm_chg_enable_primary_det(struct msm_otg *motg)
 908 {
 909         struct usb_phy *phy = &motg->phy;
 910         u32 chg_det;
 911
 912         switch (motg->pdata->phy_type) {
 913         case CI_45NM_INTEGRATED_PHY:
 914                 chg_det = ulpi_read(phy, 0x34);
 915                 /* enable chg detection */
 916                 chg_det &= ~(1 << 0);
 917                 ulpi_write(phy, chg_det, 0x34);
 918                 break;
 919         case SNPS_28NM_INTEGRATED_PHY:
 920                 /*
 921                  * Configure DP as current source, DM as current sink
 922                  * and enable battery charging comparators.
 923                  */
 924                 ulpi_write(phy, 0x2, 0x85);
 925                 ulpi_write(phy, 0x1, 0x85);
 926                 break;
 927         default:
 928                 break;
 929         }
 930 }
 931
 932 static bool msm_chg_check_dcd(struct msm_otg *motg)
 933 {
 934         struct usb_phy *phy = &motg->phy;
 935         u32 line_state;
 936         bool ret = false;
 937
 938         switch (motg->pdata->phy_type) {
 939         case CI_45NM_INTEGRATED_PHY:
 940                 line_state = ulpi_read(phy, 0x15);
 941                 ret = !(line_state & 1);
 942                 break;
 943         case SNPS_28NM_INTEGRATED_PHY:
 944                 line_state = ulpi_read(phy, 0x87);
 945                 ret = line_state & 2;
 946                 break;
 947         default:
 948                 break;
 949         }
 950         return ret;
 951 }
 952
 953 static void msm_chg_disable_dcd(struct msm_otg *motg)
 954 {
 955         struct usb_phy *phy = &motg->phy;
 956         u32 chg_det;
 957
 958         switch (motg->pdata->phy_type) {
 959         case CI_45NM_INTEGRATED_PHY:
 960                 chg_det = ulpi_read(phy, 0x34);
 961                 chg_det &= ~(1 << 5);
 962                 ulpi_write(phy, chg_det, 0x34);
 963                 break;
 964         case SNPS_28NM_INTEGRATED_PHY:
 965                 ulpi_write(phy, 0x10, 0x86);
 966                 break;
 967         default:
 968                 break;
 969         }
 970 }
 971
 972 static void msm_chg_enable_dcd(struct msm_otg *motg)
 973 {
 974         struct usb_phy *phy = &motg->phy;
 975         u32 chg_det;
 976
 977         switch (motg->pdata->phy_type) {
 978         case CI_45NM_INTEGRATED_PHY:
 979                 chg_det = ulpi_read(phy, 0x34);
 980                 /* Turn on D+ current source */
 981                 chg_det |= (1 << 5);
 982                 ulpi_write(phy, chg_det, 0x34);
 983                 break;
 984         case SNPS_28NM_INTEGRATED_PHY:
 985                 /* Data contact detection enable */
 986                 ulpi_write(phy, 0x10, 0x85);
 987                 break;
 988         default:
 989                 break;
 990         }
 991 }
 992
 993 static void msm_chg_block_on(struct msm_otg *motg)
 994 {
 995         struct usb_phy *phy = &motg->phy;
 996         u32 func_ctrl, chg_det;
 997
 998         /* put the controller in non-driving mode */
 999         func_ctrl = ulpi_read(phy, ULPI_FUNC_CTRL);
1000         func_ctrl &= ~ULPI_FUNC_CTRL_OPMODE_MASK;
1001         func_ctrl |= ULPI_FUNC_CTRL_OPMODE_NONDRIVING;
1002         ulpi_write(phy, func_ctrl, ULPI_FUNC_CTRL);
1003
1004         switch (motg->pdata->phy_type) {
1005         case CI_45NM_INTEGRATED_PHY:
1006                 chg_det = ulpi_read(phy, 0x34);
1007                 /* control chg block via ULPI */
1008                 chg_det &= ~(1 << 3);
1009                 ulpi_write(phy, chg_det, 0x34);
1010                 /* Turn on chg detect block */
1011                 chg_det &= ~(1 << 1);
1012                 ulpi_write(phy, chg_det, 0x34);
1013                 udelay(20);
1014                 break;
1015         case SNPS_28NM_INTEGRATED_PHY:
1016                 /* Clear charger detecting control bits */
1017                 ulpi_write(phy, 0x3F, 0x86);
1018                 /* Clear alt interrupt latch and enable bits */
1019                 ulpi_write(phy, 0x1F, 0x92);
1020                 ulpi_write(phy, 0x1F, 0x95);
1021                 udelay(100);
1022                 break;
1023         default:
1024                 break;
1025         }
1026 }
1027
1028 static void msm_chg_block_off(struct msm_otg *motg)
1029 {
1030         struct usb_phy *phy = &motg->phy;
1031         u32 func_ctrl, chg_det;
1032
1033         switch (motg->pdata->phy_type) {
1034         case CI_45NM_INTEGRATED_PHY:
1035                 chg_det = ulpi_read(phy, 0x34);
1036                 /* Turn off charger block */
1037                 chg_det |= ~(1 << 1);
1038                 ulpi_write(phy, chg_det, 0x34);
1039                 break;
1040         case SNPS_28NM_INTEGRATED_PHY:
1041                 /* Clear charger detecting control bits */
1042                 ulpi_write(phy, 0x3F, 0x86);
1043                 /* Clear alt interrupt latch and enable bits */
1044                 ulpi_write(phy, 0x1F, 0x92);
1045                 ulpi_write(phy, 0x1F, 0x95);
1046                 break;
1047         default:
1048                 break;
1049         }
1050
1051         /* put the controller in normal mode */
1052         func_ctrl = ulpi_read(phy, ULPI_FUNC_CTRL);
1053         func_ctrl &= ~ULPI_FUNC_CTRL_OPMODE_MASK;
1054         func_ctrl |= ULPI_FUNC_CTRL_OPMODE_NORMAL;
1055         ulpi_write(phy, func_ctrl, ULPI_FUNC_CTRL);
1056 }
1057
1058 #define MSM_CHG_DCD_POLL_TIME           (100 * HZ/1000) /* 100 msec */
1059 #define MSM_CHG_DCD_MAX_RETRIES         6 /* Tdcd_tmout = 6 * 100 msec */
1060 #define MSM_CHG_PRIMARY_DET_TIME        (40 * HZ/1000) /* TVDPSRC_ON */
1061 #define MSM_CHG_SECONDARY_DET_TIME      (40 * HZ/1000) /* TVDMSRC_ON */
1062 static void msm_chg_detect_work(struct work_struct *w)
1063 {
1064         struct msm_otg *motg = container_of(w, struct msm_otg, chg_work.work);
1065         struct usb_phy *phy = &motg->phy;
1066         bool is_dcd, tmout, vout;
1067         unsigned long delay;
1068
1069         dev_dbg(phy->dev, "chg detection work\n");
1070         switch (motg->chg_state) {
1071         case USB_CHG_STATE_UNDEFINED:
1072                 pm_runtime_get_sync(phy->dev);
1073                 msm_chg_block_on(motg);
1074                 msm_chg_enable_dcd(motg);
1075                 motg->chg_state = USB_CHG_STATE_WAIT_FOR_DCD;
1076                 motg->dcd_retries = 0;
1077                 delay = MSM_CHG_DCD_POLL_TIME;
1078                 break;
1079         case USB_CHG_STATE_WAIT_FOR_DCD:
1080                 is_dcd = msm_chg_check_dcd(motg);
1081                 tmout = ++motg->dcd_retries == MSM_CHG_DCD_MAX_RETRIES;
1082                 if (is_dcd || tmout) {
1083                         msm_chg_disable_dcd(motg);
1084                         msm_chg_enable_primary_det(motg);
1085                         delay = MSM_CHG_PRIMARY_DET_TIME;
1086                         motg->chg_state = USB_CHG_STATE_DCD_DONE;
1087                 } else {
1088                         delay = MSM_CHG_DCD_POLL_TIME;
1089                 }
1090                 break;
1091         case USB_CHG_STATE_DCD_DONE:
1092                 vout = msm_chg_check_primary_det(motg);
1093                 if (vout) {
1094                         msm_chg_enable_secondary_det(motg);
1095                         delay = MSM_CHG_SECONDARY_DET_TIME;
1096                         motg->chg_state = USB_CHG_STATE_PRIMARY_DONE;
1097                 } else {
1098                         motg->chg_type = USB_SDP_CHARGER;
1099                         motg->chg_state = USB_CHG_STATE_DETECTED;
1100                         delay = 0;
1101                 }
1102                 break;
1103         case USB_CHG_STATE_PRIMARY_DONE:
1104                 vout = msm_chg_check_secondary_det(motg);
1105                 if (vout)
1106                         motg->chg_type = USB_DCP_CHARGER;
1107                 else
1108                         motg->chg_type = USB_CDP_CHARGER;
1109                 motg->chg_state = USB_CHG_STATE_SECONDARY_DONE;
1110                 /* fall through */
1111         case USB_CHG_STATE_SECONDARY_DONE:
1112                 motg->chg_state = USB_CHG_STATE_DETECTED;
1113         case USB_CHG_STATE_DETECTED:
1114                 msm_chg_block_off(motg);
1115                 dev_dbg(phy->dev, "charger = %d\n", motg->chg_type);
1116                 schedule_work(&motg->sm_work);
1117                 return;
1118         default:
1119                 return;
1120         }
1121
1122         schedule_delayed_work(&motg->chg_work, delay);
1123 }
1124
1125 /*
1126  * We support OTG, Peripheral only and Host only configurations. In case
1127  * of OTG, mode switch (host-->peripheral/peripheral-->host) can happen
1128  * via Id pin status or user request (debugfs). Id/BSV interrupts are not
1129  * enabled when switch is controlled by user and default mode is supplied
1130  * by board file, which can be changed by userspace later.
1131  */
1132 static void msm_otg_init_sm(struct msm_otg *motg)
1133 {
1134         struct msm_otg_platform_data *pdata = motg->pdata;
1135         u32 otgsc = readl(USB_OTGSC);
1136
1137         switch (pdata->mode) {
1138         case USB_DR_MODE_OTG:
1139                 if (pdata->otg_control == OTG_PHY_CONTROL) {
1140                         if (otgsc & OTGSC_ID)
1141                                 set_bit(ID, &motg->inputs);
1142                         else
1143                                 clear_bit(ID, &motg->inputs);
1144
1145                         if (otgsc & OTGSC_BSV)
1146                                 set_bit(B_SESS_VLD, &motg->inputs);
1147                         else
1148                                 clear_bit(B_SESS_VLD, &motg->inputs);
1149                 } else if (pdata->otg_control == OTG_USER_CONTROL) {
1150                                 set_bit(ID, &motg->inputs);
1151                                 clear_bit(B_SESS_VLD, &motg->inputs);
1152                 }
1153                 break;
1154         case USB_DR_MODE_HOST:
1155                 clear_bit(ID, &motg->inputs);
1156                 break;
1157         case USB_DR_MODE_PERIPHERAL:
1158                 set_bit(ID, &motg->inputs);
1159                 if (otgsc & OTGSC_BSV)
1160                         set_bit(B_SESS_VLD, &motg->inputs);
1161                 else
1162                         clear_bit(B_SESS_VLD, &motg->inputs);
1163                 break;
1164         default:
1165                 break;
1166         }
1167 }
1168
1169 static void msm_otg_sm_work(struct work_struct *w)
1170 {
1171         struct msm_otg *motg = container_of(w, struct msm_otg, sm_work);
1172         struct usb_otg *otg = motg->phy.otg;
1173
1174         switch (otg->state) {
1175         case OTG_STATE_UNDEFINED:
1176                 dev_dbg(otg->usb_phy->dev, "OTG_STATE_UNDEFINED state\n");
1177                 msm_otg_reset(otg->usb_phy);
1178                 msm_otg_init_sm(motg);
1179                 otg->state = OTG_STATE_B_IDLE;
1180                 /* FALL THROUGH */
1181         case OTG_STATE_B_IDLE:
1182                 dev_dbg(otg->usb_phy->dev, "OTG_STATE_B_IDLE state\n");
1183                 if (!test_bit(ID, &motg->inputs) && otg->host) {
1184                         /* disable BSV bit */
1185                         writel(readl(USB_OTGSC) & ~OTGSC_BSVIE, USB_OTGSC);
1186                         msm_otg_start_host(otg->usb_phy, 1);
1187                         otg->state = OTG_STATE_A_HOST;
1188                 } else if (test_bit(B_SESS_VLD, &motg->inputs)) {
1189                         switch (motg->chg_state) {
1190                         case USB_CHG_STATE_UNDEFINED:
1191                                 msm_chg_detect_work(&motg->chg_work.work);
1192                                 break;
1193                         case USB_CHG_STATE_DETECTED:
1194                                 switch (motg->chg_type) {
1195                                 case USB_DCP_CHARGER:
1196                                         msm_otg_notify_charger(motg,
1197                                                         IDEV_CHG_MAX);
1198                                         break;
1199                                 case USB_CDP_CHARGER:
1200                                         msm_otg_notify_charger(motg,
1201                                                         IDEV_CHG_MAX);
1202                                         msm_otg_start_peripheral(otg->usb_phy,
1203                                                                  1);
1204                                         otg->state
1205                                                 = OTG_STATE_B_PERIPHERAL;
1206                                         break;
1207                                 case USB_SDP_CHARGER:
1208                                         msm_otg_notify_charger(motg, IUNIT);
1209                                         msm_otg_start_peripheral(otg->usb_phy,
1210                                                                  1);
1211                                         otg->state
1212                                                 = OTG_STATE_B_PERIPHERAL;
1213                                         break;
1214                                 default:
1215                                         break;
1216                                 }
1217                                 break;
1218                         default:
1219                                 break;
1220                         }
1221                 } else {
1222                         /*
1223                          * If charger detection work is pending, decrement
1224                          * the pm usage counter to balance with the one that
1225                          * is incremented in charger detection work.
1226                          */
1227                         if (cancel_delayed_work_sync(&motg->chg_work)) {
1228                                 pm_runtime_put_sync(otg->usb_phy->dev);
1229                                 msm_otg_reset(otg->usb_phy);
1230                         }
1231                         msm_otg_notify_charger(motg, 0);
1232                         motg->chg_state = USB_CHG_STATE_UNDEFINED;
1233                         motg->chg_type = USB_INVALID_CHARGER;
1234                 }
1235
1236                 if (otg->state == OTG_STATE_B_IDLE)
1237                         pm_runtime_put_sync(otg->usb_phy->dev);
1238                 break;
1239         case OTG_STATE_B_PERIPHERAL:
1240                 dev_dbg(otg->usb_phy->dev, "OTG_STATE_B_PERIPHERAL state\n");
1241                 if (!test_bit(B_SESS_VLD, &motg->inputs) ||
1242                                 !test_bit(ID, &motg->inputs)) {
1243                         msm_otg_notify_charger(motg, 0);
1244                         msm_otg_start_peripheral(otg->usb_phy, 0);
1245                         motg->chg_state = USB_CHG_STATE_UNDEFINED;
1246                         motg->chg_type = USB_INVALID_CHARGER;
1247                         otg->state = OTG_STATE_B_IDLE;
1248                         msm_otg_reset(otg->usb_phy);
1249                         schedule_work(w);
1250                 }
1251                 break;
1252         case OTG_STATE_A_HOST:
1253                 dev_dbg(otg->usb_phy->dev, "OTG_STATE_A_HOST state\n");
1254                 if (test_bit(ID, &motg->inputs)) {
1255                         msm_otg_start_host(otg->usb_phy, 0);
1256                         otg->state = OTG_STATE_B_IDLE;
1257                         msm_otg_reset(otg->usb_phy);
1258                         schedule_work(w);
1259                 }
1260                 break;
1261         default:
1262                 break;
1263         }
1264 }
1265
1266 static irqreturn_t msm_otg_irq(int irq, void *data)
1267 {
1268         struct msm_otg *motg = data;
1269         struct usb_phy *phy = &motg->phy;
1270         u32 otgsc = 0;
1271
1272         if (atomic_read(&motg->in_lpm)) {
1273                 disable_irq_nosync(irq);
1274                 motg->async_int = 1;
1275                 pm_runtime_get(phy->dev);
1276                 return IRQ_HANDLED;
1277         }
1278
1279         otgsc = readl(USB_OTGSC);
1280         if (!(otgsc & (OTGSC_IDIS | OTGSC_BSVIS)))
1281                 return IRQ_NONE;
1282
1283         if ((otgsc & OTGSC_IDIS) && (otgsc & OTGSC_IDIE)) {
1284                 if (otgsc & OTGSC_ID)
1285                         set_bit(ID, &motg->inputs);
1286                 else
1287                         clear_bit(ID, &motg->inputs);
1288                 dev_dbg(phy->dev, "ID set/clear\n");
1289                 pm_runtime_get_noresume(phy->dev);
1290         } else if ((otgsc & OTGSC_BSVIS) && (otgsc & OTGSC_BSVIE)) {
1291                 if (otgsc & OTGSC_BSV)
1292                         set_bit(B_SESS_VLD, &motg->inputs);
1293                 else
1294                         clear_bit(B_SESS_VLD, &motg->inputs);
1295                 dev_dbg(phy->dev, "BSV set/clear\n");
1296                 pm_runtime_get_noresume(phy->dev);
1297         }
1298
1299         writel(otgsc, USB_OTGSC);
1300         schedule_work(&motg->sm_work);
1301         return IRQ_HANDLED;
1302 }
1303
1304 static int msm_otg_mode_show(struct seq_file *s, void *unused)
1305 {
1306         struct msm_otg *motg = s->private;
1307         struct usb_otg *otg = motg->phy.otg;
1308
1309         switch (otg->state) {
1310         case OTG_STATE_A_HOST:
1311                 seq_puts(s, "host\n");
1312                 break;
1313         case OTG_STATE_B_PERIPHERAL:
1314                 seq_puts(s, "peripheral\n");
1315                 break;
1316         default:
1317                 seq_puts(s, "none\n");
1318                 break;
1319         }
1320
1321         return 0;
1322 }
1323
1324 static int msm_otg_mode_open(struct inode *inode, struct file *file)
1325 {
1326         return single_open(file, msm_otg_mode_show, inode->i_private);
1327 }
1328
1329 static ssize_t msm_otg_mode_write(struct file *file, const char __user *ubuf,
1330                                 size_t count, loff_t *ppos)
1331 {
1332         struct seq_file *s = file->private_data;
1333         struct msm_otg *motg = s->private;
1334         char buf[16];
1335         struct usb_otg *otg = motg->phy.otg;
1336         int status = count;
1337         enum usb_dr_mode req_mode;
1338
1339         memset(buf, 0x00, sizeof(buf));
1340
1341         if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count))) {
1342                 status = -EFAULT;
1343                 goto out;
1344         }
1345
1346         if (!strncmp(buf, "host", 4)) {
1347                 req_mode = USB_DR_MODE_HOST;
1348         } else if (!strncmp(buf, "peripheral", 10)) {
1349                 req_mode = USB_DR_MODE_PERIPHERAL;
1350         } else if (!strncmp(buf, "none", 4)) {
1351                 req_mode = USB_DR_MODE_UNKNOWN;
1352         } else {
1353                 status = -EINVAL;
1354                 goto out;
1355         }
1356
1357         switch (req_mode) {
1358         case USB_DR_MODE_UNKNOWN:
1359                 switch (otg->state) {
1360                 case OTG_STATE_A_HOST:
1361                 case OTG_STATE_B_PERIPHERAL:
1362                         set_bit(ID, &motg->inputs);
1363                         clear_bit(B_SESS_VLD, &motg->inputs);
1364                         break;
1365                 default:
1366                         goto out;
1367                 }
1368                 break;
1369         case USB_DR_MODE_PERIPHERAL:
1370                 switch (otg->state) {
1371                 case OTG_STATE_B_IDLE:
1372                 case OTG_STATE_A_HOST:
1373                         set_bit(ID, &motg->inputs);
1374                         set_bit(B_SESS_VLD, &motg->inputs);
1375                         break;
1376                 default:
1377                         goto out;
1378                 }
1379                 break;
1380         case USB_DR_MODE_HOST:
1381                 switch (otg->state) {
1382                 case OTG_STATE_B_IDLE:
1383                 case OTG_STATE_B_PERIPHERAL:
1384                         clear_bit(ID, &motg->inputs);
1385                         break;
1386                 default:
1387                         goto out;
1388                 }
1389                 break;
1390         default:
1391                 goto out;
1392         }
1393
1394         pm_runtime_get_sync(otg->usb_phy->dev);
1395         schedule_work(&motg->sm_work);
1396 out:
1397         return status;
1398 }
1399
1400 static const struct file_operations msm_otg_mode_fops = {
1401         .open = msm_otg_mode_open,
1402         .read = seq_read,
1403         .write = msm_otg_mode_write,
1404         .llseek = seq_lseek,
1405         .release = single_release,
1406 };
1407
1408 static struct dentry *msm_otg_dbg_root;
1409 static struct dentry *msm_otg_dbg_mode;
1410
1411 static int msm_otg_debugfs_init(struct msm_otg *motg)
1412 {
1413         msm_otg_dbg_root = debugfs_create_dir("msm_otg", NULL);
1414
1415         if (!msm_otg_dbg_root || IS_ERR(msm_otg_dbg_root))
1416                 return -ENODEV;
1417
1418         msm_otg_dbg_mode = debugfs_create_file("mode", S_IRUGO | S_IWUSR,
1419                                 msm_otg_dbg_root, motg, &msm_otg_mode_fops);
1420         if (!msm_otg_dbg_mode) {
1421                 debugfs_remove(msm_otg_dbg_root);
1422                 msm_otg_dbg_root = NULL;
1423                 return -ENODEV;
1424         }
1425
1426         return 0;
1427 }
1428
1429 static void msm_otg_debugfs_cleanup(void)
1430 {
1431         debugfs_remove(msm_otg_dbg_mode);
1432         debugfs_remove(msm_otg_dbg_root);
1433 }
1434
1435 static const struct of_device_id msm_otg_dt_match[] = {
1436         {
1437                 .compatible = "qcom,usb-otg-ci",
1438                 .data = (void *) CI_45NM_INTEGRATED_PHY
1439         },
1440         {
1441                 .compatible = "qcom,usb-otg-snps",
1442                 .data = (void *) SNPS_28NM_INTEGRATED_PHY
1443         },
1444         { }
1445 };
1446 MODULE_DEVICE_TABLE(of, msm_otg_dt_match);
1447
1448 static int msm_otg_read_dt(struct platform_device *pdev, struct msm_otg *motg)
1449 {
1450         struct msm_otg_platform_data *pdata;
1451         const struct of_device_id *id;
1452         struct device_node *node = pdev->dev.of_node;
1453         struct property *prop;
1454         int len, ret, words;
1455         u32 val, tmp[3];
1456
1457         pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
1458         if (!pdata)
1459                 return -ENOMEM;
1460
1461         motg->pdata = pdata;
1462
1463         id = of_match_device(msm_otg_dt_match, &pdev->dev);
1464         pdata->phy_type = (enum msm_usb_phy_type) id->data;
1465
1466         motg->link_rst = devm_reset_control_get(&pdev->dev, "link");
1467         if (IS_ERR(motg->link_rst))
1468                 return PTR_ERR(motg->link_rst);
1469
1470         motg->phy_rst = devm_reset_control_get(&pdev->dev, "phy");
1471         if (IS_ERR(motg->phy_rst))
1472                 motg->phy_rst = NULL;
1473
1474         pdata->mode = of_usb_get_dr_mode(node);
1475         if (pdata->mode == USB_DR_MODE_UNKNOWN)
1476                 pdata->mode = USB_DR_MODE_OTG;
1477
1478         pdata->otg_control = OTG_PHY_CONTROL;
1479         if (!of_property_read_u32(node, "qcom,otg-control", &val))
1480                 if (val == OTG_PMIC_CONTROL)
1481                         pdata->otg_control = val;
1482
1483         if (!of_property_read_u32(node, "qcom,phy-num", &val) && val < 2)
1484                 motg->phy_number = val;
1485
1486         motg->vdd_levels[VDD_LEVEL_NONE] = USB_PHY_SUSP_DIG_VOL;
1487         motg->vdd_levels[VDD_LEVEL_MIN] = USB_PHY_VDD_DIG_VOL_MIN;
1488         motg->vdd_levels[VDD_LEVEL_MAX] = USB_PHY_VDD_DIG_VOL_MAX;
1489
1490         if (of_get_property(node, "qcom,vdd-levels", &len) &&
1491             len == sizeof(tmp)) {
1492                 of_property_read_u32_array(node, "qcom,vdd-levels",
1493                                            tmp, len / sizeof(*tmp));
1494                 motg->vdd_levels[VDD_LEVEL_NONE] = tmp[VDD_LEVEL_NONE];
1495                 motg->vdd_levels[VDD_LEVEL_MIN] = tmp[VDD_LEVEL_MIN];
1496                 motg->vdd_levels[VDD_LEVEL_MAX] = tmp[VDD_LEVEL_MAX];
1497         }
1498
1499         prop = of_find_property(node, "qcom,phy-init-sequence", &len);
1500         if (!prop || !len)
1501                 return 0;
1502
1503         words = len / sizeof(u32);
1504
1505         if (words >= ULPI_EXT_VENDOR_SPECIFIC) {
1506                 dev_warn(&pdev->dev, "Too big PHY init sequence %d\n", words);
1507                 return 0;
1508         }
1509
1510         pdata->phy_init_seq = devm_kzalloc(&pdev->dev, len, GFP_KERNEL);
1511         if (!pdata->phy_init_seq)
1512                 return 0;
1513
1514         ret = of_property_read_u32_array(node, "qcom,phy-init-sequence",
1515                                          pdata->phy_init_seq, words);
1516         if (!ret)
1517                 pdata->phy_init_sz = words;
1518
1519         return 0;
1520 }
1521
1522 static int msm_otg_probe(struct platform_device *pdev)
1523 {
1524         struct regulator_bulk_data regs[3];
1525         int ret = 0;
1526         struct device_node *np = pdev->dev.of_node;
1527         struct msm_otg_platform_data *pdata;
1528         struct resource *res;
1529         struct msm_otg *motg;
1530         struct usb_phy *phy;
1531         void __iomem *phy_select;
1532
1533         motg = devm_kzalloc(&pdev->dev, sizeof(struct msm_otg), GFP_KERNEL);
1534         if (!motg)
1535                 return -ENOMEM;
1536
1537         pdata = dev_get_platdata(&pdev->dev);
1538         if (!pdata) {
1539                 if (!np)
1540                         return -ENXIO;
1541                 ret = msm_otg_read_dt(pdev, motg);
1542                 if (ret)
1543                         return ret;
1544         }
1545
1546         motg->phy.otg = devm_kzalloc(&pdev->dev, sizeof(struct usb_otg),
1547                                      GFP_KERNEL);
1548         if (!motg->phy.otg)
1549                 return -ENOMEM;
1550
1551         phy = &motg->phy;
1552         phy->dev = &pdev->dev;
1553
1554         if (motg->pdata->phy_clk_reset) {
1555                 motg->phy_reset_clk = devm_clk_get(&pdev->dev,
1556                                            np ? "phy" : "usb_phy_clk");
1557
1558                 if (IS_ERR(motg->phy_reset_clk)) {
1559                         dev_err(&pdev->dev, "failed to get usb_phy_clk\n");
1560                         return PTR_ERR(motg->phy_reset_clk);
1561                 }
1562         }
1563
1564         motg->clk = devm_clk_get(&pdev->dev, np ? "core" : "usb_hs_clk");
1565         if (IS_ERR(motg->clk)) {
1566                 dev_err(&pdev->dev, "failed to get usb_hs_clk\n");
1567                 return PTR_ERR(motg->clk);
1568         }
1569
1570         /*
1571          * If USB Core is running its protocol engine based on CORE CLK,
1572          * CORE CLK  must be running at >55Mhz for correct HSUSB
1573          * operation and USB core cannot tolerate frequency changes on
1574          * CORE CLK.
1575          */
1576         motg->pclk = devm_clk_get(&pdev->dev, np ? "iface" : "usb_hs_pclk");
1577         if (IS_ERR(motg->pclk)) {
1578                 dev_err(&pdev->dev, "failed to get usb_hs_pclk\n");
1579                 return PTR_ERR(motg->pclk);
1580         }
1581
1582         /*
1583          * USB core clock is not present on all MSM chips. This
1584          * clock is introduced to remove the dependency on AXI
1585          * bus frequency.
1586          */
1587         motg->core_clk = devm_clk_get(&pdev->dev,
1588                                       np ? "alt_core" : "usb_hs_core_clk");
1589
1590         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1591         if (!res)
1592                 return -EINVAL;
1593         motg->regs = devm_ioremap(&pdev->dev, res->start, resource_size(res));
1594         if (!motg->regs)
1595                 return -ENOMEM;
1596
1597         /*
1598          * NOTE: The PHYs can be multiplexed between the chipidea controller
1599          * and the dwc3 controller, using a single bit. It is important that
1600          * the dwc3 driver does not set this bit in an incompatible way.
1601          */
1602         if (motg->phy_number) {
1603                 phy_select = devm_ioremap_nocache(&pdev->dev, USB2_PHY_SEL, 4);
1604                 if (!phy_select)
1605                         return -ENOMEM;
1606                 /* Enable second PHY with the OTG port */
1607                 writel(0x1, phy_select);
1608         }
1609
1610         dev_info(&pdev->dev, "OTG regs = %p\n", motg->regs);
1611
1612         motg->irq = platform_get_irq(pdev, 0);
1613         if (motg->irq < 0) {
1614                 dev_err(&pdev->dev, "platform_get_irq failed\n");
1615                 return motg->irq;
1616         }
1617
1618         regs[0].supply = "vddcx";
1619         regs[1].supply = "v3p3";
1620         regs[2].supply = "v1p8";
1621
1622         ret = devm_regulator_bulk_get(motg->phy.dev, ARRAY_SIZE(regs), regs);
1623         if (ret)
1624                 return ret;
1625
1626         motg->vddcx = regs[0].consumer;
1627         motg->v3p3  = regs[1].consumer;
1628         motg->v1p8  = regs[2].consumer;
1629
1630         clk_set_rate(motg->clk, 60000000);
1631
1632         clk_prepare_enable(motg->clk);
1633         clk_prepare_enable(motg->pclk);
1634
1635         if (!IS_ERR(motg->core_clk))
1636                 clk_prepare_enable(motg->core_clk);
1637
1638         ret = msm_hsusb_init_vddcx(motg, 1);
1639         if (ret) {
1640                 dev_err(&pdev->dev, "hsusb vddcx configuration failed\n");
1641                 goto disable_clks;
1642         }
1643
1644         ret = msm_hsusb_ldo_init(motg, 1);
1645         if (ret) {
1646                 dev_err(&pdev->dev, "hsusb vreg configuration failed\n");
1647                 goto disable_vddcx;
1648         }
1649         ret = msm_hsusb_ldo_set_mode(motg, 1);
1650         if (ret) {
1651                 dev_err(&pdev->dev, "hsusb vreg enable failed\n");
1652                 goto disable_ldo;
1653         }
1654
1655         writel(0, USB_USBINTR);
1656         writel(0, USB_OTGSC);
1657
1658         INIT_WORK(&motg->sm_work, msm_otg_sm_work);
1659         INIT_DELAYED_WORK(&motg->chg_work, msm_chg_detect_work);
1660         ret = devm_request_irq(&pdev->dev, motg->irq, msm_otg_irq, IRQF_SHARED,
1661                                         "msm_otg", motg);
1662         if (ret) {
1663                 dev_err(&pdev->dev, "request irq failed\n");
1664                 goto disable_ldo;
1665         }
1666
1667         phy->init = msm_phy_init;
1668         phy->set_power = msm_otg_set_power;
1669         phy->notify_disconnect = msm_phy_notify_disconnect;
1670         phy->type = USB_PHY_TYPE_USB2;
1671
1672         phy->io_ops = &msm_otg_io_ops;
1673
1674         phy->otg->usb_phy = &motg->phy;
1675         phy->otg->set_host = msm_otg_set_host;
1676         phy->otg->set_peripheral = msm_otg_set_peripheral;
1677
1678         msm_usb_reset(phy);
1679
1680         ret = usb_add_phy_dev(&motg->phy);
1681         if (ret) {
1682                 dev_err(&pdev->dev, "usb_add_phy failed\n");
1683                 goto disable_ldo;
1684         }
1685
1686         platform_set_drvdata(pdev, motg);
1687         device_init_wakeup(&pdev->dev, 1);
1688
1689         if (motg->pdata->mode == USB_DR_MODE_OTG &&
1690                 motg->pdata->otg_control == OTG_USER_CONTROL) {
1691                 ret = msm_otg_debugfs_init(motg);
1692                 if (ret)
1693                         dev_dbg(&pdev->dev, "Can not create mode change file\n");
1694         }
1695
1696         pm_runtime_set_active(&pdev->dev);
1697         pm_runtime_enable(&pdev->dev);
1698
1699         return 0;
1700
1701 disable_ldo:
1702         msm_hsusb_ldo_init(motg, 0);
1703 disable_vddcx:
1704         msm_hsusb_init_vddcx(motg, 0);
1705 disable_clks:
1706         clk_disable_unprepare(motg->pclk);
1707         clk_disable_unprepare(motg->clk);
1708         if (!IS_ERR(motg->core_clk))
1709                 clk_disable_unprepare(motg->core_clk);
1710         return ret;
1711 }
1712
1713 static int msm_otg_remove(struct platform_device *pdev)
1714 {
1715         struct msm_otg *motg = platform_get_drvdata(pdev);
1716         struct usb_phy *phy = &motg->phy;
1717         int cnt = 0;
1718
1719         if (phy->otg->host || phy->otg->gadget)
1720                 return -EBUSY;
1721
1722         msm_otg_debugfs_cleanup();
1723         cancel_delayed_work_sync(&motg->chg_work);
1724         cancel_work_sync(&motg->sm_work);
1725
1726         pm_runtime_resume(&pdev->dev);
1727
1728         device_init_wakeup(&pdev->dev, 0);
1729         pm_runtime_disable(&pdev->dev);
1730
1731         usb_remove_phy(phy);
1732         disable_irq(motg->irq);
1733
1734         /*
1735          * Put PHY in low power mode.
1736          */
1737         ulpi_read(phy, 0x14);
1738         ulpi_write(phy, 0x08, 0x09);
1739
1740         writel(readl(USB_PORTSC) | PORTSC_PHCD, USB_PORTSC);
1741         while (cnt < PHY_SUSPEND_TIMEOUT_USEC) {
1742                 if (readl(USB_PORTSC) & PORTSC_PHCD)
1743                         break;
1744                 udelay(1);
1745                 cnt++;
1746         }
1747         if (cnt >= PHY_SUSPEND_TIMEOUT_USEC)
1748                 dev_err(phy->dev, "Unable to suspend PHY\n");
1749
1750         clk_disable_unprepare(motg->pclk);
1751         clk_disable_unprepare(motg->clk);
1752         if (!IS_ERR(motg->core_clk))
1753                 clk_disable_unprepare(motg->core_clk);
1754         msm_hsusb_ldo_init(motg, 0);
1755
1756         pm_runtime_set_suspended(&pdev->dev);
1757
1758         return 0;
1759 }
1760
1761 #ifdef CONFIG_PM
1762 static int msm_otg_runtime_idle(struct device *dev)
1763 {
1764         struct msm_otg *motg = dev_get_drvdata(dev);
1765         struct usb_otg *otg = motg->phy.otg;
1766
1767         dev_dbg(dev, "OTG runtime idle\n");
1768
1769         /*
1770          * It is observed some times that a spurious interrupt
1771          * comes when PHY is put into LPM immediately after PHY reset.
1772          * This 1 sec delay also prevents entering into LPM immediately
1773          * after asynchronous interrupt.
1774          */
1775         if (otg->state != OTG_STATE_UNDEFINED)
1776                 pm_schedule_suspend(dev, 1000);
1777
1778         return -EAGAIN;
1779 }
1780
1781 static int msm_otg_runtime_suspend(struct device *dev)
1782 {
1783         struct msm_otg *motg = dev_get_drvdata(dev);
1784
1785         dev_dbg(dev, "OTG runtime suspend\n");
1786         return msm_otg_suspend(motg);
1787 }
1788
1789 static int msm_otg_runtime_resume(struct device *dev)
1790 {
1791         struct msm_otg *motg = dev_get_drvdata(dev);
1792
1793         dev_dbg(dev, "OTG runtime resume\n");
1794         return msm_otg_resume(motg);
1795 }
1796 #endif
1797
1798 #ifdef CONFIG_PM_SLEEP
1799 static int msm_otg_pm_suspend(struct device *dev)
1800 {
1801         struct msm_otg *motg = dev_get_drvdata(dev);
1802
1803         dev_dbg(dev, "OTG PM suspend\n");
1804         return msm_otg_suspend(motg);
1805 }
1806
1807 static int msm_otg_pm_resume(struct device *dev)
1808 {
1809         struct msm_otg *motg = dev_get_drvdata(dev);
1810         int ret;
1811
1812         dev_dbg(dev, "OTG PM resume\n");
1813
1814         ret = msm_otg_resume(motg);
1815         if (ret)
1816                 return ret;
1817
1818         /*
1819          * Runtime PM Documentation recommends bringing the
1820          * device to full powered state upon resume.
1821          */
1822         pm_runtime_disable(dev);
1823         pm_runtime_set_active(dev);
1824         pm_runtime_enable(dev);
1825
1826         return 0;
1827 }
1828 #endif
1829
1830 static const struct dev_pm_ops msm_otg_dev_pm_ops = {
1831         SET_SYSTEM_SLEEP_PM_OPS(msm_otg_pm_suspend, msm_otg_pm_resume)
1832         SET_RUNTIME_PM_OPS(msm_otg_runtime_suspend, msm_otg_runtime_resume,
1833                                 msm_otg_runtime_idle)
1834 };
1835
1836 static struct platform_driver msm_otg_driver = {
1837         .probe = msm_otg_probe,
1838         .remove = msm_otg_remove,
1839         .driver = {
1840                 .name = DRIVER_NAME,
1841                 .pm = &msm_otg_dev_pm_ops,
1842                 .of_match_table = msm_otg_dt_match,
1843         },
1844 };
1845
1846 module_platform_driver(msm_otg_driver);
1847
1848 MODULE_LICENSE("GPL v2");
1849 MODULE_DESCRIPTION("MSM USB transceiver driver");