drivers/usb/otg/langwell_otg.c

   1 /*
   2  * Intel Langwell USB OTG transceiver driver
   3  * Copyright (C) 2008 - 2009, Intel Corporation.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms and conditions of the GNU General Public License,
   7  * version 2, as published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  17  *
  18  */
  19 /* This driver helps to switch Langwell OTG controller function between host
  20  * and peripheral. It works with EHCI driver and Langwell client controller
  21  * driver together.
  22  */
  23 #include <linux/module.h>
  24 #include <linux/init.h>
  25 #include <linux/pci.h>
  26 #include <linux/errno.h>
  27 #include <linux/interrupt.h>
  28 #include <linux/kernel.h>
  29 #include <linux/device.h>
  30 #include <linux/moduleparam.h>
  31 #include <linux/usb/ch9.h>
  32 #include <linux/usb/gadget.h>
  33 #include <linux/usb.h>
  34 #include <linux/usb/otg.h>
  35 #include <linux/usb/hcd.h>
  36 #include <linux/notifier.h>
  37 #include <linux/delay.h>
  38 #include <asm/intel_scu_ipc.h>
  39
  40 #include <linux/usb/langwell_otg.h>
  41
  42 #define DRIVER_DESC             "Intel Langwell USB OTG transceiver driver"
  43 #define DRIVER_VERSION          "3.0.0.32L.0003"
  44
  45 MODULE_DESCRIPTION(DRIVER_DESC);
  46 MODULE_AUTHOR("Henry Yuan <hang.yuan@intel.com>, Hao Wu <hao.wu@intel.com>");
  47 MODULE_VERSION(DRIVER_VERSION);
  48 MODULE_LICENSE("GPL");
  49
  50 static const char driver_name[] = "langwell_otg";
  51
  52 static int langwell_otg_probe(struct pci_dev *pdev,
  53                         const struct pci_device_id *id);
  54 static void langwell_otg_remove(struct pci_dev *pdev);
  55 static int langwell_otg_suspend(struct pci_dev *pdev, pm_message_t message);
  56 static int langwell_otg_resume(struct pci_dev *pdev);
  57
  58 static int langwell_otg_set_host(struct otg_transceiver *otg,
  59                                 struct usb_bus *host);
  60 static int langwell_otg_set_peripheral(struct otg_transceiver *otg,
  61                                 struct usb_gadget *gadget);
  62 static int langwell_otg_start_srp(struct otg_transceiver *otg);
  63
  64 static const struct pci_device_id pci_ids[] = {{
  65         .class =        ((PCI_CLASS_SERIAL_USB << 8) | 0xfe),
  66         .class_mask =   ~0,
  67         .vendor =       0x8086,
  68         .device =       0x0811,
  69         .subvendor =    PCI_ANY_ID,
  70         .subdevice =    PCI_ANY_ID,
  71 }, { /* end: all zeroes */ }
  72 };
  73
  74 static struct pci_driver otg_pci_driver = {
  75         .name =         (char *) driver_name,
  76         .id_table =     pci_ids,
  77
  78         .probe =        langwell_otg_probe,
  79         .remove =       langwell_otg_remove,
  80
  81         .suspend =      langwell_otg_suspend,
  82         .resume =       langwell_otg_resume,
  83 };
  84
  85 static const char *state_string(enum usb_otg_state state)
  86 {
  87         switch (state) {
  88         case OTG_STATE_A_IDLE:
  89                 return "a_idle";
  90         case OTG_STATE_A_WAIT_VRISE:
  91                 return "a_wait_vrise";
  92         case OTG_STATE_A_WAIT_BCON:
  93                 return "a_wait_bcon";
  94         case OTG_STATE_A_HOST:
  95                 return "a_host";
  96         case OTG_STATE_A_SUSPEND:
  97                 return "a_suspend";
  98         case OTG_STATE_A_PERIPHERAL:
  99                 return "a_peripheral";
 100         case OTG_STATE_A_WAIT_VFALL:
 101                 return "a_wait_vfall";
 102         case OTG_STATE_A_VBUS_ERR:
 103                 return "a_vbus_err";
 104         case OTG_STATE_B_IDLE:
 105                 return "b_idle";
 106         case OTG_STATE_B_SRP_INIT:
 107                 return "b_srp_init";
 108         case OTG_STATE_B_PERIPHERAL:
 109                 return "b_peripheral";
 110         case OTG_STATE_B_WAIT_ACON:
 111                 return "b_wait_acon";
 112         case OTG_STATE_B_HOST:
 113                 return "b_host";
 114         default:
 115                 return "UNDEFINED";
 116         }
 117 }
 118
 119 /* HSM timers */
 120 static inline struct langwell_otg_timer *otg_timer_initializer
 121 (void (*function)(unsigned long), unsigned long expires, unsigned long data)
 122 {
 123         struct langwell_otg_timer *timer;
 124         timer = kmalloc(sizeof(struct langwell_otg_timer), GFP_KERNEL);
 125         if (timer == NULL)
 126                 return timer;
 127
 128         timer->function = function;
 129         timer->expires = expires;
 130         timer->data = data;
 131         return timer;
 132 }
 133
 134 static struct langwell_otg_timer *a_wait_vrise_tmr, *a_aidl_bdis_tmr,
 135         *b_se0_srp_tmr, *b_srp_init_tmr;
 136
 137 static struct list_head active_timers;
 138
 139 static struct langwell_otg *the_transceiver;
 140
 141 /* host/client notify transceiver when event affects HNP state */
 142 void langwell_update_transceiver(void)
 143 {
 144         struct langwell_otg *lnw = the_transceiver;
 145
 146         dev_dbg(lnw->dev, "transceiver is updated\n");
 147
 148         if (!lnw->qwork)
 149                 return ;
 150
 151         queue_work(lnw->qwork, &lnw->work);
 152 }
 153 EXPORT_SYMBOL(langwell_update_transceiver);
 154
 155 static int langwell_otg_set_host(struct otg_transceiver *otg,
 156                                         struct usb_bus *host)
 157 {
 158         otg->host = host;
 159
 160         return 0;
 161 }
 162
 163 static int langwell_otg_set_peripheral(struct otg_transceiver *otg,
 164                                         struct usb_gadget *gadget)
 165 {
 166         otg->gadget = gadget;
 167
 168         return 0;
 169 }
 170
 171 static int langwell_otg_set_power(struct otg_transceiver *otg,
 172                                 unsigned mA)
 173 {
 174         return 0;
 175 }
 176
 177 /* A-device drives vbus, controlled through PMIC CHRGCNTL register*/
 178 static int langwell_otg_set_vbus(struct otg_transceiver *otg, bool enabled)
 179 {
 180         struct langwell_otg             *lnw = the_transceiver;
 181         u8 r;
 182
 183         dev_dbg(lnw->dev, "%s <--- %s\n", __func__, enabled ? "on" : "off");
 184
 185         /* FIXME: surely we should cache this on the first read. If not use
 186            readv to avoid two transactions */
 187         if (intel_scu_ipc_ioread8(0x00, &r) < 0) {
 188                 dev_dbg(lnw->dev, "Failed to read PMIC register 0xD2");
 189                 return -EBUSY;
 190         }
 191         if ((r & 0x03) != 0x02) {
 192                 dev_dbg(lnw->dev, "not NEC PMIC attached\n");
 193                 return -EBUSY;
 194         }
 195
 196         if (intel_scu_ipc_ioread8(0x20, &r) < 0) {
 197                 dev_dbg(lnw->dev, "Failed to read PMIC register 0xD2");
 198                 return -EBUSY;
 199         }
 200
 201         if ((r & 0x20) == 0) {
 202                 dev_dbg(lnw->dev, "no battery attached\n");
 203                 return -EBUSY;
 204         }
 205
 206         /* Workaround for battery attachment issue */
 207         if (r == 0x34) {
 208                 dev_dbg(lnw->dev, "no battery attached on SH\n");
 209                 return -EBUSY;
 210         }
 211
 212         dev_dbg(lnw->dev, "battery attached. 2 reg = %x\n", r);
 213
 214         /* workaround: FW detect writing 0x20/0xc0 to d4 event.
 215          * this is only for NEC PMIC.
 216          */
 217
 218         if (intel_scu_ipc_iowrite8(0xD4, enabled ? 0x20 : 0xC0))
 219                 dev_dbg(lnw->dev, "Failed to write PMIC.\n");
 220
 221         dev_dbg(lnw->dev, "%s --->\n", __func__);
 222
 223         return 0;
 224 }
 225
 226 /* charge vbus or discharge vbus through a resistor to ground */
 227 static void langwell_otg_chrg_vbus(int on)
 228 {
 229         struct langwell_otg     *lnw = the_transceiver;
 230         u32     val;
 231
 232         val = readl(lnw->iotg.base + CI_OTGSC);
 233
 234         if (on)
 235                 writel((val & ~OTGSC_INTSTS_MASK) | OTGSC_VC,
 236                                 lnw->iotg.base + CI_OTGSC);
 237         else
 238                 writel((val & ~OTGSC_INTSTS_MASK) | OTGSC_VD,
 239                                 lnw->iotg.base + CI_OTGSC);
 240 }
 241
 242 /* Start SRP */
 243 static int langwell_otg_start_srp(struct otg_transceiver *otg)
 244 {
 245         struct langwell_otg             *lnw = the_transceiver;
 246         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 247         u32                             val;
 248
 249         dev_dbg(lnw->dev, "%s --->\n", __func__);
 250
 251         val = readl(iotg->base + CI_OTGSC);
 252
 253         writel((val & ~OTGSC_INTSTS_MASK) | OTGSC_HADP,
 254                                 iotg->base + CI_OTGSC);
 255
 256         /* Check if the data plus is finished or not */
 257         msleep(8);
 258         val = readl(iotg->base + CI_OTGSC);
 259         if (val & (OTGSC_HADP | OTGSC_DP))
 260                 dev_dbg(lnw->dev, "DataLine SRP Error\n");
 261
 262         /* Disable interrupt - b_sess_vld */
 263         val = readl(iotg->base + CI_OTGSC);
 264         val &= (~(OTGSC_BSVIE | OTGSC_BSEIE));
 265         writel(val, iotg->base + CI_OTGSC);
 266
 267         /* Start VBus SRP, drive vbus to generate VBus pulse */
 268         iotg->otg.set_vbus(&iotg->otg, true);
 269         msleep(15);
 270         iotg->otg.set_vbus(&iotg->otg, false);
 271
 272         /* Enable interrupt - b_sess_vld*/
 273         val = readl(iotg->base + CI_OTGSC);
 274         dev_dbg(lnw->dev, "after VBUS pulse otgsc = %x\n", val);
 275
 276         val |= (OTGSC_BSVIE | OTGSC_BSEIE);
 277         writel(val, iotg->base + CI_OTGSC);
 278
 279         /* If Vbus is valid, then update the hsm */
 280         if (val & OTGSC_BSV) {
 281                 dev_dbg(lnw->dev, "no b_sess_vld interrupt\n");
 282
 283                 lnw->iotg.hsm.b_sess_vld = 1;
 284                 langwell_update_transceiver();
 285         }
 286
 287         dev_dbg(lnw->dev, "%s <---\n", __func__);
 288         return 0;
 289 }
 290
 291 /* stop SOF via bus_suspend */
 292 static void langwell_otg_loc_sof(int on)
 293 {
 294         struct langwell_otg     *lnw = the_transceiver;
 295         struct usb_hcd          *hcd;
 296         int                     err;
 297
 298         dev_dbg(lnw->dev, "%s ---> %s\n", __func__, on ? "suspend" : "resume");
 299
 300         hcd = bus_to_hcd(lnw->iotg.otg.host);
 301         if (on)
 302                 err = hcd->driver->bus_resume(hcd);
 303         else
 304                 err = hcd->driver->bus_suspend(hcd);
 305
 306         if (err)
 307                 dev_dbg(lnw->dev, "Fail to resume/suspend USB bus - %d\n", err);
 308
 309         dev_dbg(lnw->dev, "%s <---\n", __func__);
 310 }
 311
 312 static int langwell_otg_check_otgsc(void)
 313 {
 314         struct langwell_otg             *lnw = the_transceiver;
 315         u32                             otgsc, usbcfg;
 316
 317         dev_dbg(lnw->dev, "check sync OTGSC and USBCFG registers\n");
 318
 319         otgsc = readl(lnw->iotg.base + CI_OTGSC);
 320         usbcfg = readl(lnw->usbcfg);
 321
 322         dev_dbg(lnw->dev, "OTGSC = %08x, USBCFG = %08x\n",
 323                                         otgsc, usbcfg);
 324         dev_dbg(lnw->dev, "OTGSC_AVV = %d\n", !!(otgsc & OTGSC_AVV));
 325         dev_dbg(lnw->dev, "USBCFG.VBUSVAL = %d\n",
 326                                         !!(usbcfg & USBCFG_VBUSVAL));
 327         dev_dbg(lnw->dev, "OTGSC_ASV = %d\n", !!(otgsc & OTGSC_ASV));
 328         dev_dbg(lnw->dev, "USBCFG.AVALID = %d\n",
 329                                         !!(usbcfg & USBCFG_AVALID));
 330         dev_dbg(lnw->dev, "OTGSC_BSV = %d\n", !!(otgsc & OTGSC_BSV));
 331         dev_dbg(lnw->dev, "USBCFG.BVALID = %d\n",
 332                                         !!(usbcfg & USBCFG_BVALID));
 333         dev_dbg(lnw->dev, "OTGSC_BSE = %d\n", !!(otgsc & OTGSC_BSE));
 334         dev_dbg(lnw->dev, "USBCFG.SESEND = %d\n",
 335                                         !!(usbcfg & USBCFG_SESEND));
 336
 337         /* Check USBCFG VBusValid/AValid/BValid/SessEnd */
 338         if (!!(otgsc & OTGSC_AVV) ^ !!(usbcfg & USBCFG_VBUSVAL)) {
 339                 dev_dbg(lnw->dev, "OTGSC.AVV != USBCFG.VBUSVAL\n");
 340                 goto err;
 341         }
 342         if (!!(otgsc & OTGSC_ASV) ^ !!(usbcfg & USBCFG_AVALID)) {
 343                 dev_dbg(lnw->dev, "OTGSC.ASV != USBCFG.AVALID\n");
 344                 goto err;
 345         }
 346         if (!!(otgsc & OTGSC_BSV) ^ !!(usbcfg & USBCFG_BVALID)) {
 347                 dev_dbg(lnw->dev, "OTGSC.BSV != USBCFG.BVALID\n");
 348                 goto err;
 349         }
 350         if (!!(otgsc & OTGSC_BSE) ^ !!(usbcfg & USBCFG_SESEND)) {
 351                 dev_dbg(lnw->dev, "OTGSC.BSE != USBCFG.SESSEN\n");
 352                 goto err;
 353         }
 354
 355         dev_dbg(lnw->dev, "OTGSC and USBCFG are synced\n");
 356
 357         return 0;
 358
 359 err:
 360         dev_warn(lnw->dev, "OTGSC isn't equal to USBCFG\n");
 361         return -EPIPE;
 362 }
 363
 364
 365 static void langwell_otg_phy_low_power(int on)
 366 {
 367         struct langwell_otg             *lnw = the_transceiver;
 368         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 369         u8                              val, phcd;
 370         int                             retval;
 371
 372         dev_dbg(lnw->dev, "%s ---> %s mode\n",
 373                         __func__, on ? "Low power" : "Normal");
 374
 375         phcd = 0x40;
 376
 377         val = readb(iotg->base + CI_HOSTPC1 + 2);
 378
 379         if (on) {
 380                 /* Due to hardware issue, after set PHCD, sync will failed
 381                  * between USBCFG and OTGSC, so before set PHCD, check if
 382                  * sync is in process now. If the answer is "yes", then do
 383                  * not touch PHCD bit */
 384                 retval = langwell_otg_check_otgsc();
 385                 if (retval) {
 386                         dev_dbg(lnw->dev, "Skip PHCD programming..\n");
 387                         return ;
 388                 }
 389
 390                 writeb(val | phcd, iotg->base + CI_HOSTPC1 + 2);
 391         } else
 392                 writeb(val & ~phcd, iotg->base + CI_HOSTPC1 + 2);
 393
 394         dev_dbg(lnw->dev, "%s <--- done\n", __func__);
 395 }
 396
 397 /* After drv vbus, add 2 ms delay to set PHCD */
 398 static void langwell_otg_phy_low_power_wait(int on)
 399 {
 400         struct langwell_otg     *lnw = the_transceiver;
 401
 402         dev_dbg(lnw->dev, "add 2ms delay before programing PHCD\n");
 403
 404         mdelay(2);
 405         langwell_otg_phy_low_power(on);
 406 }
 407
 408 /* Enable/Disable OTG interrupt */
 409 static void langwell_otg_intr(int on)
 410 {
 411         struct langwell_otg             *lnw = the_transceiver;
 412         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 413         u32                             val;
 414
 415         dev_dbg(lnw->dev, "%s ---> %s\n", __func__, on ? "on" : "off");
 416
 417         val = readl(iotg->base + CI_OTGSC);
 418
 419         /* OTGSC_INT_MASK doesn't contains 1msInt */
 420         if (on) {
 421                 val = val | (OTGSC_INT_MASK);
 422                 writel(val, iotg->base + CI_OTGSC);
 423         } else {
 424                 val = val & ~(OTGSC_INT_MASK);
 425                 writel(val, iotg->base + CI_OTGSC);
 426         }
 427
 428         dev_dbg(lnw->dev, "%s <---\n", __func__);
 429 }
 430
 431 /* set HAAR: Hardware Assist Auto-Reset */
 432 static void langwell_otg_HAAR(int on)
 433 {
 434         struct langwell_otg             *lnw = the_transceiver;
 435         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 436         u32                             val;
 437
 438         dev_dbg(lnw->dev, "%s ---> %s\n", __func__, on ? "on" : "off");
 439
 440         val = readl(iotg->base + CI_OTGSC);
 441         if (on)
 442                 writel((val & ~OTGSC_INTSTS_MASK) | OTGSC_HAAR,
 443                                         iotg->base + CI_OTGSC);
 444         else
 445                 writel((val & ~OTGSC_INTSTS_MASK) & ~OTGSC_HAAR,
 446                                         iotg->base + CI_OTGSC);
 447
 448         dev_dbg(lnw->dev, "%s <---\n", __func__);
 449 }
 450
 451 /* set HABA: Hardware Assist B-Disconnect to A-Connect */
 452 static void langwell_otg_HABA(int on)
 453 {
 454         struct langwell_otg             *lnw = the_transceiver;
 455         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 456         u32                             val;
 457
 458         dev_dbg(lnw->dev, "%s ---> %s\n", __func__, on ? "on" : "off");
 459
 460         val = readl(iotg->base + CI_OTGSC);
 461         if (on)
 462                 writel((val & ~OTGSC_INTSTS_MASK) | OTGSC_HABA,
 463                                         iotg->base + CI_OTGSC);
 464         else
 465                 writel((val & ~OTGSC_INTSTS_MASK) & ~OTGSC_HABA,
 466                                         iotg->base + CI_OTGSC);
 467
 468         dev_dbg(lnw->dev, "%s <---\n", __func__);
 469 }
 470
 471 static int langwell_otg_check_se0_srp(int on)
 472 {
 473         struct langwell_otg     *lnw = the_transceiver;
 474         int                     delay_time = TB_SE0_SRP * 10;
 475         u32                     val;
 476
 477         dev_dbg(lnw->dev, "%s --->\n", __func__);
 478
 479         do {
 480                 udelay(100);
 481                 if (!delay_time--)
 482                         break;
 483                 val = readl(lnw->iotg.base + CI_PORTSC1);
 484                 val &= PORTSC_LS;
 485         } while (!val);
 486
 487         dev_dbg(lnw->dev, "%s <---\n", __func__);
 488         return val;
 489 }
 490
 491 /* The timeout callback function to set time out bit */
 492 static void set_tmout(unsigned long indicator)
 493 {
 494         *(int *)indicator = 1;
 495 }
 496
 497 void langwell_otg_nsf_msg(unsigned long indicator)
 498 {
 499         struct langwell_otg     *lnw = the_transceiver;
 500
 501         switch (indicator) {
 502         case 2:
 503         case 4:
 504         case 6:
 505         case 7:
 506                 dev_warn(lnw->dev,
 507                         "OTG:NSF-%lu - deivce not responding\n", indicator);
 508                 break;
 509         case 3:
 510                 dev_warn(lnw->dev,
 511                         "OTG:NSF-%lu - deivce not supported\n", indicator);
 512                 break;
 513         default:
 514                 dev_warn(lnw->dev, "Do not have this kind of NSF\n");
 515                 break;
 516         }
 517 }
 518
 519 /* Initialize timers */
 520 static int langwell_otg_init_timers(struct otg_hsm *hsm)
 521 {
 522         /* HSM used timers */
 523         a_wait_vrise_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_VRISE,
 524                                 (unsigned long)&hsm->a_wait_vrise_tmout);
 525         if (a_wait_vrise_tmr == NULL)
 526                 return -ENOMEM;
 527         a_aidl_bdis_tmr = otg_timer_initializer(&set_tmout, TA_AIDL_BDIS,
 528                                 (unsigned long)&hsm->a_aidl_bdis_tmout);
 529         if (a_aidl_bdis_tmr == NULL)
 530                 return -ENOMEM;
 531         b_se0_srp_tmr = otg_timer_initializer(&set_tmout, TB_SE0_SRP,
 532                                 (unsigned long)&hsm->b_se0_srp);
 533         if (b_se0_srp_tmr == NULL)
 534                 return -ENOMEM;
 535         b_srp_init_tmr = otg_timer_initializer(&set_tmout, TB_SRP_INIT,
 536                                 (unsigned long)&hsm->b_srp_init_tmout);
 537         if (b_srp_init_tmr == NULL)
 538                 return -ENOMEM;
 539
 540         return 0;
 541 }
 542
 543 /* Free timers */
 544 static void langwell_otg_free_timers(void)
 545 {
 546         kfree(a_wait_vrise_tmr);
 547         kfree(a_aidl_bdis_tmr);
 548         kfree(b_se0_srp_tmr);
 549         kfree(b_srp_init_tmr);
 550 }
 551
 552 /* The timeout callback function to set time out bit */
 553 static void langwell_otg_timer_fn(unsigned long indicator)
 554 {
 555         struct langwell_otg *lnw = the_transceiver;
 556
 557         *(int *)indicator = 1;
 558
 559         dev_dbg(lnw->dev, "kernel timer - timeout\n");
 560
 561         langwell_update_transceiver();
 562 }
 563
 564 /* kernel timer used instead of HW based interrupt */
 565 static void langwell_otg_add_ktimer(enum langwell_otg_timer_type timers)
 566 {
 567         struct langwell_otg             *lnw = the_transceiver;
 568         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 569         unsigned long           j = jiffies;
 570         unsigned long           data, time;
 571
 572         switch (timers) {
 573         case TA_WAIT_VRISE_TMR:
 574                 iotg->hsm.a_wait_vrise_tmout = 0;
 575                 data = (unsigned long)&iotg->hsm.a_wait_vrise_tmout;
 576                 time = TA_WAIT_VRISE;
 577                 break;
 578         case TA_WAIT_BCON_TMR:
 579                 iotg->hsm.a_wait_bcon_tmout = 0;
 580                 data = (unsigned long)&iotg->hsm.a_wait_bcon_tmout;
 581                 time = TA_WAIT_BCON;
 582                 break;
 583         case TA_AIDL_BDIS_TMR:
 584                 iotg->hsm.a_aidl_bdis_tmout = 0;
 585                 data = (unsigned long)&iotg->hsm.a_aidl_bdis_tmout;
 586                 time = TA_AIDL_BDIS;
 587                 break;
 588         case TB_ASE0_BRST_TMR:
 589                 iotg->hsm.b_ase0_brst_tmout = 0;
 590                 data = (unsigned long)&iotg->hsm.b_ase0_brst_tmout;
 591                 time = TB_ASE0_BRST;
 592                 break;
 593         case TB_SRP_INIT_TMR:
 594                 iotg->hsm.b_srp_init_tmout = 0;
 595                 data = (unsigned long)&iotg->hsm.b_srp_init_tmout;
 596                 time = TB_SRP_INIT;
 597                 break;
 598         case TB_SRP_FAIL_TMR:
 599                 iotg->hsm.b_srp_fail_tmout = 0;
 600                 data = (unsigned long)&iotg->hsm.b_srp_fail_tmout;
 601                 time = TB_SRP_FAIL;
 602                 break;
 603         case TB_BUS_SUSPEND_TMR:
 604                 iotg->hsm.b_bus_suspend_tmout = 0;
 605                 data = (unsigned long)&iotg->hsm.b_bus_suspend_tmout;
 606                 time = TB_BUS_SUSPEND;
 607                 break;
 608         default:
 609                 dev_dbg(lnw->dev, "unkown timer, cannot enable it\n");
 610                 return;
 611         }
 612
 613         lnw->hsm_timer.data = data;
 614         lnw->hsm_timer.function = langwell_otg_timer_fn;
 615         lnw->hsm_timer.expires = j + time * HZ / 1000; /* milliseconds */
 616
 617         add_timer(&lnw->hsm_timer);
 618
 619         dev_dbg(lnw->dev, "add timer successfully\n");
 620 }
 621
 622 /* Add timer to timer list */
 623 static void langwell_otg_add_timer(void *gtimer)
 624 {
 625         struct langwell_otg_timer *timer = (struct langwell_otg_timer *)gtimer;
 626         struct langwell_otg_timer *tmp_timer;
 627         struct intel_mid_otg_xceiv *iotg = &the_transceiver->iotg;
 628         u32     val32;
 629
 630         /* Check if the timer is already in the active list,
 631          * if so update timer count
 632          */
 633         list_for_each_entry(tmp_timer, &active_timers, list)
 634                 if (tmp_timer == timer) {
 635                         timer->count = timer->expires;
 636                         return;
 637                 }
 638         timer->count = timer->expires;
 639
 640         if (list_empty(&active_timers)) {
 641                 val32 = readl(iotg->base + CI_OTGSC);
 642                 writel(val32 | OTGSC_1MSE, iotg->base + CI_OTGSC);
 643         }
 644
 645         list_add_tail(&timer->list, &active_timers);
 646 }
 647
 648 /* Remove timer from the timer list; clear timeout status */
 649 static void langwell_otg_del_timer(void *gtimer)
 650 {
 651         struct langwell_otg *lnw = the_transceiver;
 652         struct langwell_otg_timer *timer = (struct langwell_otg_timer *)gtimer;
 653         struct langwell_otg_timer *tmp_timer, *del_tmp;
 654         u32 val32;
 655
 656         list_for_each_entry_safe(tmp_timer, del_tmp, &active_timers, list)
 657                 if (tmp_timer == timer)
 658                         list_del(&timer->list);
 659
 660         if (list_empty(&active_timers)) {
 661                 val32 = readl(lnw->iotg.base + CI_OTGSC);
 662                 writel(val32 & ~OTGSC_1MSE, lnw->iotg.base + CI_OTGSC);
 663         }
 664 }
 665
 666 /* Reduce timer count by 1, and find timeout conditions.*/
 667 static int langwell_otg_tick_timer(u32 *int_sts)
 668 {
 669         struct langwell_otg     *lnw = the_transceiver;
 670         struct langwell_otg_timer *tmp_timer, *del_tmp;
 671         int expired = 0;
 672
 673         list_for_each_entry_safe(tmp_timer, del_tmp, &active_timers, list) {
 674                 tmp_timer->count--;
 675                 /* check if timer expires */
 676                 if (!tmp_timer->count) {
 677                         list_del(&tmp_timer->list);
 678                         tmp_timer->function(tmp_timer->data);
 679                         expired = 1;
 680                 }
 681         }
 682
 683         if (list_empty(&active_timers)) {
 684                 dev_dbg(lnw->dev, "tick timer: disable 1ms int\n");
 685                 *int_sts = *int_sts & ~OTGSC_1MSE;
 686         }
 687         return expired;
 688 }
 689
 690 static void reset_otg(void)
 691 {
 692         struct langwell_otg     *lnw = the_transceiver;
 693         int                     delay_time = 1000;
 694         u32                     val;
 695
 696         dev_dbg(lnw->dev, "reseting OTG controller ...\n");
 697         val = readl(lnw->iotg.base + CI_USBCMD);
 698         writel(val | USBCMD_RST, lnw->iotg.base + CI_USBCMD);
 699         do {
 700                 udelay(100);
 701                 if (!delay_time--)
 702                         dev_dbg(lnw->dev, "reset timeout\n");
 703                 val = readl(lnw->iotg.base + CI_USBCMD);
 704                 val &= USBCMD_RST;
 705         } while (val != 0);
 706         dev_dbg(lnw->dev, "reset done.\n");
 707 }
 708
 709 static void set_host_mode(void)
 710 {
 711         struct langwell_otg     *lnw = the_transceiver;
 712         u32                     val;
 713
 714         reset_otg();
 715         val = readl(lnw->iotg.base + CI_USBMODE);
 716         val = (val & (~USBMODE_CM)) | USBMODE_HOST;
 717         writel(val, lnw->iotg.base + CI_USBMODE);
 718 }
 719
 720 static void set_client_mode(void)
 721 {
 722         struct langwell_otg     *lnw = the_transceiver;
 723         u32                     val;
 724
 725         reset_otg();
 726         val = readl(lnw->iotg.base + CI_USBMODE);
 727         val = (val & (~USBMODE_CM)) | USBMODE_DEVICE;
 728         writel(val, lnw->iotg.base + CI_USBMODE);
 729 }
 730
 731 static void init_hsm(void)
 732 {
 733         struct langwell_otg             *lnw = the_transceiver;
 734         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 735         u32                             val32;
 736
 737         /* read OTGSC after reset */
 738         val32 = readl(lnw->iotg.base + CI_OTGSC);
 739         dev_dbg(lnw->dev, "%s: OTGSC init value = 0x%x\n", __func__, val32);
 740
 741         /* set init state */
 742         if (val32 & OTGSC_ID) {
 743                 iotg->hsm.id = 1;
 744                 iotg->otg.default_a = 0;
 745                 set_client_mode();
 746                 iotg->otg.state = OTG_STATE_B_IDLE;
 747         } else {
 748                 iotg->hsm.id = 0;
 749                 iotg->otg.default_a = 1;
 750                 set_host_mode();
 751                 iotg->otg.state = OTG_STATE_A_IDLE;
 752         }
 753
 754         /* set session indicator */
 755         if (val32 & OTGSC_BSE)
 756                 iotg->hsm.b_sess_end = 1;
 757         if (val32 & OTGSC_BSV)
 758                 iotg->hsm.b_sess_vld = 1;
 759         if (val32 & OTGSC_ASV)
 760                 iotg->hsm.a_sess_vld = 1;
 761         if (val32 & OTGSC_AVV)
 762                 iotg->hsm.a_vbus_vld = 1;
 763
 764         /* defautly power the bus */
 765         iotg->hsm.a_bus_req = 1;
 766         iotg->hsm.a_bus_drop = 0;
 767         /* defautly don't request bus as B device */
 768         iotg->hsm.b_bus_req = 0;
 769         /* no system error */
 770         iotg->hsm.a_clr_err = 0;
 771
 772         langwell_otg_phy_low_power_wait(1);
 773 }
 774
 775 static void update_hsm(void)
 776 {
 777         struct langwell_otg             *lnw = the_transceiver;
 778         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 779         u32                             val32;
 780
 781         /* read OTGSC */
 782         val32 = readl(lnw->iotg.base + CI_OTGSC);
 783         dev_dbg(lnw->dev, "%s: OTGSC value = 0x%x\n", __func__, val32);
 784
 785         iotg->hsm.id = !!(val32 & OTGSC_ID);
 786         iotg->hsm.b_sess_end = !!(val32 & OTGSC_BSE);
 787         iotg->hsm.b_sess_vld = !!(val32 & OTGSC_BSV);
 788         iotg->hsm.a_sess_vld = !!(val32 & OTGSC_ASV);
 789         iotg->hsm.a_vbus_vld = !!(val32 & OTGSC_AVV);
 790 }
 791
 792 static irqreturn_t otg_dummy_irq(int irq, void *_dev)
 793 {
 794         struct langwell_otg     *lnw = the_transceiver;
 795         void __iomem            *reg_base = _dev;
 796         u32                     val;
 797         u32                     int_mask = 0;
 798
 799         val = readl(reg_base + CI_USBMODE);
 800         if ((val & USBMODE_CM) != USBMODE_DEVICE)
 801                 return IRQ_NONE;
 802
 803         val = readl(reg_base + CI_USBSTS);
 804         int_mask = val & INTR_DUMMY_MASK;
 805
 806         if (int_mask == 0)
 807                 return IRQ_NONE;
 808
 809         /* clear hsm.b_conn here since host driver can't detect it
 810         *  otg_dummy_irq called means B-disconnect happened.
 811         */
 812         if (lnw->iotg.hsm.b_conn) {
 813                 lnw->iotg.hsm.b_conn = 0;
 814                 if (spin_trylock(&lnw->wq_lock)) {
 815                         langwell_update_transceiver();
 816                         spin_unlock(&lnw->wq_lock);
 817                 }
 818         }
 819
 820         /* Clear interrupts */
 821         writel(int_mask, reg_base + CI_USBSTS);
 822         return IRQ_HANDLED;
 823 }
 824
 825 static irqreturn_t otg_irq(int irq, void *_dev)
 826 {
 827         struct langwell_otg             *lnw = _dev;
 828         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
 829         u32                             int_sts, int_en;
 830         u32                             int_mask = 0;
 831         int                             flag = 0;
 832
 833         int_sts = readl(lnw->iotg.base + CI_OTGSC);
 834         int_en = (int_sts & OTGSC_INTEN_MASK) >> 8;
 835         int_mask = int_sts & int_en;
 836         if (int_mask == 0)
 837                 return IRQ_NONE;
 838
 839         if (int_mask & OTGSC_IDIS) {
 840                 dev_dbg(lnw->dev, "%s: id change int\n", __func__);
 841                 iotg->hsm.id = (int_sts & OTGSC_ID) ? 1 : 0;
 842                 dev_dbg(lnw->dev, "id = %d\n", iotg->hsm.id);
 843                 flag = 1;
 844         }
 845         if (int_mask & OTGSC_DPIS) {
 846                 dev_dbg(lnw->dev, "%s: data pulse int\n", __func__);
 847                 iotg->hsm.a_srp_det = (int_sts & OTGSC_DPS) ? 1 : 0;
 848                 dev_dbg(lnw->dev, "data pulse = %d\n", iotg->hsm.a_srp_det);
 849                 flag = 1;
 850         }
 851         if (int_mask & OTGSC_BSEIS) {
 852                 dev_dbg(lnw->dev, "%s: b session end int\n", __func__);
 853                 iotg->hsm.b_sess_end = (int_sts & OTGSC_BSE) ? 1 : 0;
 854                 dev_dbg(lnw->dev, "b_sess_end = %d\n", iotg->hsm.b_sess_end);
 855                 flag = 1;
 856         }
 857         if (int_mask & OTGSC_BSVIS) {
 858                 dev_dbg(lnw->dev, "%s: b session valid int\n", __func__);
 859                 iotg->hsm.b_sess_vld = (int_sts & OTGSC_BSV) ? 1 : 0;
 860                 dev_dbg(lnw->dev, "b_sess_vld = %d\n", iotg->hsm.b_sess_end);
 861                 flag = 1;
 862         }
 863         if (int_mask & OTGSC_ASVIS) {
 864                 dev_dbg(lnw->dev, "%s: a session valid int\n", __func__);
 865                 iotg->hsm.a_sess_vld = (int_sts & OTGSC_ASV) ? 1 : 0;
 866                 dev_dbg(lnw->dev, "a_sess_vld = %d\n", iotg->hsm.a_sess_vld);
 867                 flag = 1;
 868         }
 869         if (int_mask & OTGSC_AVVIS) {
 870                 dev_dbg(lnw->dev, "%s: a vbus valid int\n", __func__);
 871                 iotg->hsm.a_vbus_vld = (int_sts & OTGSC_AVV) ? 1 : 0;
 872                 dev_dbg(lnw->dev, "a_vbus_vld = %d\n", iotg->hsm.a_vbus_vld);
 873                 flag = 1;
 874         }
 875
 876         if (int_mask & OTGSC_1MSS) {
 877                 /* need to schedule otg_work if any timer is expired */
 878                 if (langwell_otg_tick_timer(&int_sts))
 879                         flag = 1;
 880         }
 881
 882         writel((int_sts & ~OTGSC_INTSTS_MASK) | int_mask,
 883                                         lnw->iotg.base + CI_OTGSC);
 884         if (flag)
 885                 langwell_update_transceiver();
 886
 887         return IRQ_HANDLED;
 888 }
 889
 890 static int langwell_otg_iotg_notify(struct notifier_block *nb,
 891                                 unsigned long action, void *data)
 892 {
 893         struct langwell_otg             *lnw = the_transceiver;
 894         struct intel_mid_otg_xceiv      *iotg = data;
 895         int                             flag = 0;
 896
 897         if (iotg == NULL)
 898                 return NOTIFY_BAD;
 899
 900         if (lnw == NULL)
 901                 return NOTIFY_BAD;
 902
 903         switch (action) {
 904         case MID_OTG_NOTIFY_CONNECT:
 905                 dev_dbg(lnw->dev, "Lnw OTG Notify Connect Event\n");
 906                 if (iotg->otg.default_a == 1)
 907                         iotg->hsm.b_conn = 1;
 908                 else
 909                         iotg->hsm.a_conn = 1;
 910                 flag = 1;
 911                 break;
 912         case MID_OTG_NOTIFY_DISCONN:
 913                 dev_dbg(lnw->dev, "Lnw OTG Notify Disconnect Event\n");
 914                 if (iotg->otg.default_a == 1)
 915                         iotg->hsm.b_conn = 0;
 916                 else
 917                         iotg->hsm.a_conn = 0;
 918                 flag = 1;
 919                 break;
 920         case MID_OTG_NOTIFY_HSUSPEND:
 921                 dev_dbg(lnw->dev, "Lnw OTG Notify Host Bus suspend Event\n");
 922                 if (iotg->otg.default_a == 1)
 923                         iotg->hsm.a_suspend_req = 1;
 924                 else
 925                         iotg->hsm.b_bus_req = 0;
 926                 flag = 1;
 927                 break;
 928         case MID_OTG_NOTIFY_HRESUME:
 929                 dev_dbg(lnw->dev, "Lnw OTG Notify Host Bus resume Event\n");
 930                 if (iotg->otg.default_a == 1)
 931                         iotg->hsm.b_bus_resume = 1;
 932                 flag = 1;
 933                 break;
 934         case MID_OTG_NOTIFY_CSUSPEND:
 935                 dev_dbg(lnw->dev, "Lnw OTG Notify Client Bus suspend Event\n");
 936                 if (iotg->otg.default_a == 1) {
 937                         if (iotg->hsm.b_bus_suspend_vld == 2) {
 938                                 iotg->hsm.b_bus_suspend = 1;
 939                                 iotg->hsm.b_bus_suspend_vld = 0;
 940                                 flag = 1;
 941                         } else {
 942                                 iotg->hsm.b_bus_suspend_vld++;
 943                                 flag = 0;
 944                         }
 945                 } else {
 946                         if (iotg->hsm.a_bus_suspend == 0) {
 947                                 iotg->hsm.a_bus_suspend = 1;
 948                                 flag = 1;
 949                         }
 950                 }
 951                 break;
 952         case MID_OTG_NOTIFY_CRESUME:
 953                 dev_dbg(lnw->dev, "Lnw OTG Notify Client Bus resume Event\n");
 954                 if (iotg->otg.default_a == 0)
 955                         iotg->hsm.a_bus_suspend = 0;
 956                 flag = 0;
 957                 break;
 958         case MID_OTG_NOTIFY_HOSTADD:
 959                 dev_dbg(lnw->dev, "Lnw OTG Nofity Host Driver Add\n");
 960                 flag = 1;
 961                 break;
 962         case MID_OTG_NOTIFY_HOSTREMOVE:
 963                 dev_dbg(lnw->dev, "Lnw OTG Nofity Host Driver remove\n");
 964                 flag = 1;
 965                 break;
 966         case MID_OTG_NOTIFY_CLIENTADD:
 967                 dev_dbg(lnw->dev, "Lnw OTG Nofity Client Driver Add\n");
 968                 flag = 1;
 969                 break;
 970         case MID_OTG_NOTIFY_CLIENTREMOVE:
 971                 dev_dbg(lnw->dev, "Lnw OTG Nofity Client Driver remove\n");
 972                 flag = 1;
 973                 break;
 974         default:
 975                 dev_dbg(lnw->dev, "Lnw OTG Nofity unknown notify message\n");
 976                 return NOTIFY_DONE;
 977         }
 978
 979         if (flag)
 980                 langwell_update_transceiver();
 981
 982         return NOTIFY_OK;
 983 }
 984
 985 static void langwell_otg_work(struct work_struct *work)
 986 {
 987         struct langwell_otg             *lnw;
 988         struct intel_mid_otg_xceiv      *iotg;
 989         int                             retval;
 990         struct pci_dev                  *pdev;
 991
 992         lnw = container_of(work, struct langwell_otg, work);
 993         iotg = &lnw->iotg;
 994         pdev = to_pci_dev(lnw->dev);
 995
 996         dev_dbg(lnw->dev, "%s: old state = %s\n", __func__,
 997                         state_string(iotg->otg.state));
 998
 999         switch (iotg->otg.state) {
1000         case OTG_STATE_UNDEFINED:
1001         case OTG_STATE_B_IDLE:
1002                 if (!iotg->hsm.id) {
1003                         langwell_otg_del_timer(b_srp_init_tmr);
1004                         del_timer_sync(&lnw->hsm_timer);
1005
1006                         iotg->otg.default_a = 1;
1007                         iotg->hsm.a_srp_det = 0;
1008
1009                         langwell_otg_chrg_vbus(0);
1010                         set_host_mode();
1011                         langwell_otg_phy_low_power(1);
1012
1013                         iotg->otg.state = OTG_STATE_A_IDLE;
1014                         langwell_update_transceiver();
1015                 } else if (iotg->hsm.b_sess_vld) {
1016                         langwell_otg_del_timer(b_srp_init_tmr);
1017                         del_timer_sync(&lnw->hsm_timer);
1018                         iotg->hsm.b_sess_end = 0;
1019                         iotg->hsm.a_bus_suspend = 0;
1020                         langwell_otg_chrg_vbus(0);
1021
1022                         if (lnw->iotg.start_peripheral) {
1023                                 lnw->iotg.start_peripheral(&lnw->iotg);
1024                                 iotg->otg.state = OTG_STATE_B_PERIPHERAL;
1025                         } else
1026                                 dev_dbg(lnw->dev, "client driver not loaded\n");
1027
1028                 } else if (iotg->hsm.b_srp_init_tmout) {
1029                         iotg->hsm.b_srp_init_tmout = 0;
1030                         dev_warn(lnw->dev, "SRP init timeout\n");
1031                 } else if (iotg->hsm.b_srp_fail_tmout) {
1032                         iotg->hsm.b_srp_fail_tmout = 0;
1033                         iotg->hsm.b_bus_req = 0;
1034
1035                         /* No silence failure */
1036                         langwell_otg_nsf_msg(6);
1037                 } else if (iotg->hsm.b_bus_req && iotg->hsm.b_sess_end) {
1038                         del_timer_sync(&lnw->hsm_timer);
1039                         /* workaround for b_se0_srp detection */
1040                         retval = langwell_otg_check_se0_srp(0);
1041                         if (retval) {
1042                                 iotg->hsm.b_bus_req = 0;
1043                                 dev_dbg(lnw->dev, "LS isn't SE0, try later\n");
1044                         } else {
1045                                 /* clear the PHCD before start srp */
1046                                 langwell_otg_phy_low_power(0);
1047
1048                                 /* Start SRP */
1049                                 langwell_otg_add_timer(b_srp_init_tmr);
1050                                 iotg->otg.start_srp(&iotg->otg);
1051                                 langwell_otg_del_timer(b_srp_init_tmr);
1052                                 langwell_otg_add_ktimer(TB_SRP_FAIL_TMR);
1053
1054                                 /* reset PHY low power mode here */
1055                                 langwell_otg_phy_low_power_wait(1);
1056                         }
1057                 }
1058                 break;
1059         case OTG_STATE_B_SRP_INIT:
1060                 if (!iotg->hsm.id) {
1061                         iotg->otg.default_a = 1;
1062                         iotg->hsm.a_srp_det = 0;
1063
1064                         /* Turn off VBus */
1065                         iotg->otg.set_vbus(&iotg->otg, false);
1066                         langwell_otg_chrg_vbus(0);
1067                         set_host_mode();
1068                         langwell_otg_phy_low_power(1);
1069                         iotg->otg.state = OTG_STATE_A_IDLE;
1070                         langwell_update_transceiver();
1071                 } else if (iotg->hsm.b_sess_vld) {
1072                         langwell_otg_chrg_vbus(0);
1073                         if (lnw->iotg.start_peripheral) {
1074                                 lnw->iotg.start_peripheral(&lnw->iotg);
1075                                 iotg->otg.state = OTG_STATE_B_PERIPHERAL;
1076                         } else
1077                                 dev_dbg(lnw->dev, "client driver not loaded\n");
1078                 }
1079                 break;
1080         case OTG_STATE_B_PERIPHERAL:
1081                 if (!iotg->hsm.id) {
1082                         iotg->otg.default_a = 1;
1083                         iotg->hsm.a_srp_det = 0;
1084
1085                         langwell_otg_chrg_vbus(0);
1086
1087                         if (lnw->iotg.stop_peripheral)
1088                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1089                         else
1090                                 dev_dbg(lnw->dev,
1091                                         "client driver has been removed.\n");
1092
1093                         set_host_mode();
1094                         langwell_otg_phy_low_power(1);
1095                         iotg->otg.state = OTG_STATE_A_IDLE;
1096                         langwell_update_transceiver();
1097                 } else if (!iotg->hsm.b_sess_vld) {
1098                         iotg->hsm.b_hnp_enable = 0;
1099
1100                         if (lnw->iotg.stop_peripheral)
1101                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1102                         else
1103                                 dev_dbg(lnw->dev,
1104                                         "client driver has been removed.\n");
1105
1106                         iotg->otg.state = OTG_STATE_B_IDLE;
1107                 } else if (iotg->hsm.b_bus_req && iotg->otg.gadget &&
1108                                         iotg->otg.gadget->b_hnp_enable &&
1109                                         iotg->hsm.a_bus_suspend) {
1110
1111                         if (lnw->iotg.stop_peripheral)
1112                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1113                         else
1114                                 dev_dbg(lnw->dev,
1115                                         "client driver has been removed.\n");
1116
1117                         langwell_otg_HAAR(1);
1118                         iotg->hsm.a_conn = 0;
1119
1120                         if (lnw->iotg.start_host) {
1121                                 lnw->iotg.start_host(&lnw->iotg);
1122                                 iotg->otg.state = OTG_STATE_B_WAIT_ACON;
1123                         } else
1124                                 dev_dbg(lnw->dev,
1125                                                 "host driver not loaded.\n");
1126
1127                         iotg->hsm.a_bus_resume = 0;
1128                         langwell_otg_add_ktimer(TB_ASE0_BRST_TMR);
1129                 }
1130                 break;
1131
1132         case OTG_STATE_B_WAIT_ACON:
1133                 if (!iotg->hsm.id) {
1134                         /* delete hsm timer for b_ase0_brst_tmr */
1135                         del_timer_sync(&lnw->hsm_timer);
1136
1137                         iotg->otg.default_a = 1;
1138                         iotg->hsm.a_srp_det = 0;
1139
1140                         langwell_otg_chrg_vbus(0);
1141
1142                         langwell_otg_HAAR(0);
1143                         if (lnw->iotg.stop_host)
1144                                 lnw->iotg.stop_host(&lnw->iotg);
1145                         else
1146                                 dev_dbg(lnw->dev,
1147                                         "host driver has been removed.\n");
1148
1149                         set_host_mode();
1150                         langwell_otg_phy_low_power(1);
1151                         iotg->otg.state = OTG_STATE_A_IDLE;
1152                         langwell_update_transceiver();
1153                 } else if (!iotg->hsm.b_sess_vld) {
1154                         /* delete hsm timer for b_ase0_brst_tmr */
1155                         del_timer_sync(&lnw->hsm_timer);
1156
1157                         iotg->hsm.b_hnp_enable = 0;
1158                         iotg->hsm.b_bus_req = 0;
1159
1160                         langwell_otg_chrg_vbus(0);
1161                         langwell_otg_HAAR(0);
1162
1163                         if (lnw->iotg.stop_host)
1164                                 lnw->iotg.stop_host(&lnw->iotg);
1165                         else
1166                                 dev_dbg(lnw->dev,
1167                                         "host driver has been removed.\n");
1168
1169                         set_client_mode();
1170                         langwell_otg_phy_low_power(1);
1171                         iotg->otg.state = OTG_STATE_B_IDLE;
1172                 } else if (iotg->hsm.a_conn) {
1173                         /* delete hsm timer for b_ase0_brst_tmr */
1174                         del_timer_sync(&lnw->hsm_timer);
1175
1176                         langwell_otg_HAAR(0);
1177                         iotg->otg.state = OTG_STATE_B_HOST;
1178                         langwell_update_transceiver();
1179                 } else if (iotg->hsm.a_bus_resume ||
1180                                 iotg->hsm.b_ase0_brst_tmout) {
1181                         /* delete hsm timer for b_ase0_brst_tmr */
1182                         del_timer_sync(&lnw->hsm_timer);
1183
1184                         langwell_otg_HAAR(0);
1185                         langwell_otg_nsf_msg(7);
1186
1187                         if (lnw->iotg.stop_host)
1188                                 lnw->iotg.stop_host(&lnw->iotg);
1189                         else
1190                                 dev_dbg(lnw->dev,
1191                                         "host driver has been removed.\n");
1192
1193                         iotg->hsm.a_bus_suspend = 0;
1194                         iotg->hsm.b_bus_req = 0;
1195
1196                         if (lnw->iotg.start_peripheral)
1197                                 lnw->iotg.start_peripheral(&lnw->iotg);
1198                         else
1199                                 dev_dbg(lnw->dev,
1200                                         "client driver not loaded.\n");
1201
1202                         iotg->otg.state = OTG_STATE_B_PERIPHERAL;
1203                 }
1204                 break;
1205
1206         case OTG_STATE_B_HOST:
1207                 if (!iotg->hsm.id) {
1208                         iotg->otg.default_a = 1;
1209                         iotg->hsm.a_srp_det = 0;
1210
1211                         langwell_otg_chrg_vbus(0);
1212
1213                         if (lnw->iotg.stop_host)
1214                                 lnw->iotg.stop_host(&lnw->iotg);
1215                         else
1216                                 dev_dbg(lnw->dev,
1217                                         "host driver has been removed.\n");
1218
1219                         set_host_mode();
1220                         langwell_otg_phy_low_power(1);
1221                         iotg->otg.state = OTG_STATE_A_IDLE;
1222                         langwell_update_transceiver();
1223                 } else if (!iotg->hsm.b_sess_vld) {
1224                         iotg->hsm.b_hnp_enable = 0;
1225                         iotg->hsm.b_bus_req = 0;
1226
1227                         langwell_otg_chrg_vbus(0);
1228                         if (lnw->iotg.stop_host)
1229                                 lnw->iotg.stop_host(&lnw->iotg);
1230                         else
1231                                 dev_dbg(lnw->dev,
1232                                         "host driver has been removed.\n");
1233
1234                         set_client_mode();
1235                         langwell_otg_phy_low_power(1);
1236                         iotg->otg.state = OTG_STATE_B_IDLE;
1237                 } else if ((!iotg->hsm.b_bus_req) ||
1238                                 (!iotg->hsm.a_conn)) {
1239                         iotg->hsm.b_bus_req = 0;
1240                         langwell_otg_loc_sof(0);
1241
1242                         if (lnw->iotg.stop_host)
1243                                 lnw->iotg.stop_host(&lnw->iotg);
1244                         else
1245                                 dev_dbg(lnw->dev,
1246                                         "host driver has been removed.\n");
1247
1248                         iotg->hsm.a_bus_suspend = 0;
1249
1250                         if (lnw->iotg.start_peripheral)
1251                                 lnw->iotg.start_peripheral(&lnw->iotg);
1252                         else
1253                                 dev_dbg(lnw->dev,
1254                                                 "client driver not loaded.\n");
1255
1256                         iotg->otg.state = OTG_STATE_B_PERIPHERAL;
1257                 }
1258                 break;
1259
1260         case OTG_STATE_A_IDLE:
1261                 iotg->otg.default_a = 1;
1262                 if (iotg->hsm.id) {
1263                         iotg->otg.default_a = 0;
1264                         iotg->hsm.b_bus_req = 0;
1265                         iotg->hsm.vbus_srp_up = 0;
1266
1267                         langwell_otg_chrg_vbus(0);
1268                         set_client_mode();
1269                         langwell_otg_phy_low_power(1);
1270                         iotg->otg.state = OTG_STATE_B_IDLE;
1271                         langwell_update_transceiver();
1272                 } else if (!iotg->hsm.a_bus_drop &&
1273                         (iotg->hsm.a_srp_det || iotg->hsm.a_bus_req)) {
1274                         langwell_otg_phy_low_power(0);
1275
1276                         /* Turn on VBus */
1277                         iotg->otg.set_vbus(&iotg->otg, true);
1278
1279                         iotg->hsm.vbus_srp_up = 0;
1280                         iotg->hsm.a_wait_vrise_tmout = 0;
1281                         langwell_otg_add_timer(a_wait_vrise_tmr);
1282                         iotg->otg.state = OTG_STATE_A_WAIT_VRISE;
1283                         langwell_update_transceiver();
1284                 } else if (!iotg->hsm.a_bus_drop && iotg->hsm.a_sess_vld) {
1285                         iotg->hsm.vbus_srp_up = 1;
1286                 } else if (!iotg->hsm.a_sess_vld && iotg->hsm.vbus_srp_up) {
1287                         msleep(10);
1288                         langwell_otg_phy_low_power(0);
1289
1290                         /* Turn on VBus */
1291                         iotg->otg.set_vbus(&iotg->otg, true);
1292                         iotg->hsm.a_srp_det = 1;
1293                         iotg->hsm.vbus_srp_up = 0;
1294                         iotg->hsm.a_wait_vrise_tmout = 0;
1295                         langwell_otg_add_timer(a_wait_vrise_tmr);
1296                         iotg->otg.state = OTG_STATE_A_WAIT_VRISE;
1297                         langwell_update_transceiver();
1298                 } else if (!iotg->hsm.a_sess_vld &&
1299                                 !iotg->hsm.vbus_srp_up) {
1300                         langwell_otg_phy_low_power(1);
1301                 }
1302                 break;
1303         case OTG_STATE_A_WAIT_VRISE:
1304                 if (iotg->hsm.id) {
1305                         langwell_otg_del_timer(a_wait_vrise_tmr);
1306                         iotg->hsm.b_bus_req = 0;
1307                         iotg->otg.default_a = 0;
1308
1309                         /* Turn off VBus */
1310                         iotg->otg.set_vbus(&iotg->otg, false);
1311                         set_client_mode();
1312                         langwell_otg_phy_low_power_wait(1);
1313                         iotg->otg.state = OTG_STATE_B_IDLE;
1314                 } else if (iotg->hsm.a_vbus_vld) {
1315                         langwell_otg_del_timer(a_wait_vrise_tmr);
1316                         iotg->hsm.b_conn = 0;
1317                         if (lnw->iotg.start_host)
1318                                 lnw->iotg.start_host(&lnw->iotg);
1319                         else {
1320                                 dev_dbg(lnw->dev, "host driver not loaded.\n");
1321                                 break;
1322                         }
1323
1324                         langwell_otg_add_ktimer(TA_WAIT_BCON_TMR);
1325                         iotg->otg.state = OTG_STATE_A_WAIT_BCON;
1326                 } else if (iotg->hsm.a_wait_vrise_tmout) {
1327                         iotg->hsm.b_conn = 0;
1328                         if (iotg->hsm.a_vbus_vld) {
1329                                 if (lnw->iotg.start_host)
1330                                         lnw->iotg.start_host(&lnw->iotg);
1331                                 else {
1332                                         dev_dbg(lnw->dev,
1333                                                 "host driver not loaded.\n");
1334                                         break;
1335                                 }
1336                                 langwell_otg_add_ktimer(TA_WAIT_BCON_TMR);
1337                                 iotg->otg.state = OTG_STATE_A_WAIT_BCON;
1338                         } else {
1339
1340                                 /* Turn off VBus */
1341                                 iotg->otg.set_vbus(&iotg->otg, false);
1342                                 langwell_otg_phy_low_power_wait(1);
1343                                 iotg->otg.state = OTG_STATE_A_VBUS_ERR;
1344                         }
1345                 }
1346                 break;
1347         case OTG_STATE_A_WAIT_BCON:
1348                 if (iotg->hsm.id) {
1349                         /* delete hsm timer for a_wait_bcon_tmr */
1350                         del_timer_sync(&lnw->hsm_timer);
1351
1352                         iotg->otg.default_a = 0;
1353                         iotg->hsm.b_bus_req = 0;
1354
1355                         if (lnw->iotg.stop_host)
1356                                 lnw->iotg.stop_host(&lnw->iotg);
1357                         else
1358                                 dev_dbg(lnw->dev,
1359                                         "host driver has been removed.\n");
1360
1361                         /* Turn off VBus */
1362                         iotg->otg.set_vbus(&iotg->otg, false);
1363                         set_client_mode();
1364                         langwell_otg_phy_low_power_wait(1);
1365                         iotg->otg.state = OTG_STATE_B_IDLE;
1366                         langwell_update_transceiver();
1367                 } else if (!iotg->hsm.a_vbus_vld) {
1368                         /* delete hsm timer for a_wait_bcon_tmr */
1369                         del_timer_sync(&lnw->hsm_timer);
1370
1371                         if (lnw->iotg.stop_host)
1372                                 lnw->iotg.stop_host(&lnw->iotg);
1373                         else
1374                                 dev_dbg(lnw->dev,
1375                                         "host driver has been removed.\n");
1376
1377                         /* Turn off VBus */
1378                         iotg->otg.set_vbus(&iotg->otg, false);
1379                         langwell_otg_phy_low_power_wait(1);
1380                         iotg->otg.state = OTG_STATE_A_VBUS_ERR;
1381                 } else if (iotg->hsm.a_bus_drop ||
1382                                 (iotg->hsm.a_wait_bcon_tmout &&
1383                                 !iotg->hsm.a_bus_req)) {
1384                         /* delete hsm timer for a_wait_bcon_tmr */
1385                         del_timer_sync(&lnw->hsm_timer);
1386
1387                         if (lnw->iotg.stop_host)
1388                                 lnw->iotg.stop_host(&lnw->iotg);
1389                         else
1390                                 dev_dbg(lnw->dev,
1391                                         "host driver has been removed.\n");
1392
1393                         /* Turn off VBus */
1394                         iotg->otg.set_vbus(&iotg->otg, false);
1395                         iotg->otg.state = OTG_STATE_A_WAIT_VFALL;
1396                 } else if (iotg->hsm.b_conn) {
1397                         /* delete hsm timer for a_wait_bcon_tmr */
1398                         del_timer_sync(&lnw->hsm_timer);
1399
1400                         iotg->hsm.a_suspend_req = 0;
1401                         iotg->otg.state = OTG_STATE_A_HOST;
1402                         if (iotg->hsm.a_srp_det && iotg->otg.host &&
1403                                         !iotg->otg.host->b_hnp_enable) {
1404                                 /* SRP capable peripheral-only device */
1405                                 iotg->hsm.a_bus_req = 1;
1406                                 iotg->hsm.a_srp_det = 0;
1407                         } else if (!iotg->hsm.a_bus_req && iotg->otg.host &&
1408                                         iotg->otg.host->b_hnp_enable) {
1409                                 /* It is not safe enough to do a fast
1410                                  * transistion from A_WAIT_BCON to
1411                                  * A_SUSPEND */
1412                                 msleep(10000);
1413                                 if (iotg->hsm.a_bus_req)
1414                                         break;
1415
1416                                 if (request_irq(pdev->irq,
1417                                         otg_dummy_irq, IRQF_SHARED,
1418                                         driver_name, iotg->base) != 0) {
1419                                         dev_dbg(lnw->dev,
1420                                                 "request interrupt %d fail\n",
1421                                                 pdev->irq);
1422                                 }
1423
1424                                 langwell_otg_HABA(1);
1425                                 iotg->hsm.b_bus_resume = 0;
1426                                 iotg->hsm.a_aidl_bdis_tmout = 0;
1427
1428                                 langwell_otg_loc_sof(0);
1429                                 /* clear PHCD to enable HW timer */
1430                                 langwell_otg_phy_low_power(0);
1431                                 langwell_otg_add_timer(a_aidl_bdis_tmr);
1432                                 iotg->otg.state = OTG_STATE_A_SUSPEND;
1433                         } else if (!iotg->hsm.a_bus_req && iotg->otg.host &&
1434                                 !iotg->otg.host->b_hnp_enable) {
1435                                 if (lnw->iotg.stop_host)
1436                                         lnw->iotg.stop_host(&lnw->iotg);
1437                                 else
1438                                         dev_dbg(lnw->dev,
1439                                                 "host driver removed.\n");
1440
1441                                 /* Turn off VBus */
1442                                 iotg->otg.set_vbus(&iotg->otg, false);
1443                                 iotg->otg.state = OTG_STATE_A_WAIT_VFALL;
1444                         }
1445                 }
1446                 break;
1447         case OTG_STATE_A_HOST:
1448                 if (iotg->hsm.id) {
1449                         iotg->otg.default_a = 0;
1450                         iotg->hsm.b_bus_req = 0;
1451
1452                         if (lnw->iotg.stop_host)
1453                                 lnw->iotg.stop_host(&lnw->iotg);
1454                         else
1455                                 dev_dbg(lnw->dev,
1456                                         "host driver has been removed.\n");
1457
1458                         /* Turn off VBus */
1459                         iotg->otg.set_vbus(&iotg->otg, false);
1460                         set_client_mode();
1461                         langwell_otg_phy_low_power_wait(1);
1462                         iotg->otg.state = OTG_STATE_B_IDLE;
1463                         langwell_update_transceiver();
1464                 } else if (iotg->hsm.a_bus_drop ||
1465                                 (iotg->otg.host &&
1466                                 !iotg->otg.host->b_hnp_enable &&
1467                                         !iotg->hsm.a_bus_req)) {
1468                         if (lnw->iotg.stop_host)
1469                                 lnw->iotg.stop_host(&lnw->iotg);
1470                         else
1471                                 dev_dbg(lnw->dev,
1472                                         "host driver has been removed.\n");
1473
1474                         /* Turn off VBus */
1475                         iotg->otg.set_vbus(&iotg->otg, false);
1476                         iotg->otg.state = OTG_STATE_A_WAIT_VFALL;
1477                 } else if (!iotg->hsm.a_vbus_vld) {
1478                         if (lnw->iotg.stop_host)
1479                                 lnw->iotg.stop_host(&lnw->iotg);
1480                         else
1481                                 dev_dbg(lnw->dev,
1482                                         "host driver has been removed.\n");
1483
1484                         /* Turn off VBus */
1485                         iotg->otg.set_vbus(&iotg->otg, false);
1486                         langwell_otg_phy_low_power_wait(1);
1487                         iotg->otg.state = OTG_STATE_A_VBUS_ERR;
1488                 } else if (iotg->otg.host &&
1489                                 iotg->otg.host->b_hnp_enable &&
1490                                 !iotg->hsm.a_bus_req) {
1491                         /* Set HABA to enable hardware assistance to signal
1492                          *  A-connect after receiver B-disconnect. Hardware
1493                          *  will then set client mode and enable URE, SLE and
1494                          *  PCE after the assistance. otg_dummy_irq is used to
1495                          *  clean these ints when client driver is not resumed.
1496                          */
1497                         if (request_irq(pdev->irq, otg_dummy_irq, IRQF_SHARED,
1498                                         driver_name, iotg->base) != 0) {
1499                                 dev_dbg(lnw->dev,
1500                                         "request interrupt %d failed\n",
1501                                                 pdev->irq);
1502                         }
1503
1504                         /* set HABA */
1505                         langwell_otg_HABA(1);
1506                         iotg->hsm.b_bus_resume = 0;
1507                         iotg->hsm.a_aidl_bdis_tmout = 0;
1508                         langwell_otg_loc_sof(0);
1509                         /* clear PHCD to enable HW timer */
1510                         langwell_otg_phy_low_power(0);
1511                         langwell_otg_add_timer(a_aidl_bdis_tmr);
1512                         iotg->otg.state = OTG_STATE_A_SUSPEND;
1513                 } else if (!iotg->hsm.b_conn || !iotg->hsm.a_bus_req) {
1514                         langwell_otg_add_ktimer(TA_WAIT_BCON_TMR);
1515                         iotg->otg.state = OTG_STATE_A_WAIT_BCON;
1516                 }
1517                 break;
1518         case OTG_STATE_A_SUSPEND:
1519                 if (iotg->hsm.id) {
1520                         langwell_otg_del_timer(a_aidl_bdis_tmr);
1521                         langwell_otg_HABA(0);
1522                         free_irq(pdev->irq, iotg->base);
1523                         iotg->otg.default_a = 0;
1524                         iotg->hsm.b_bus_req = 0;
1525
1526                         if (lnw->iotg.stop_host)
1527                                 lnw->iotg.stop_host(&lnw->iotg);
1528                         else
1529                                 dev_dbg(lnw->dev,
1530                                         "host driver has been removed.\n");
1531
1532                         /* Turn off VBus */
1533                         iotg->otg.set_vbus(&iotg->otg, false);
1534                         set_client_mode();
1535                         langwell_otg_phy_low_power(1);
1536                         iotg->otg.state = OTG_STATE_B_IDLE;
1537                         langwell_update_transceiver();
1538                 } else if (iotg->hsm.a_bus_req ||
1539                                 iotg->hsm.b_bus_resume) {
1540                         langwell_otg_del_timer(a_aidl_bdis_tmr);
1541                         langwell_otg_HABA(0);
1542                         free_irq(pdev->irq, iotg->base);
1543                         iotg->hsm.a_suspend_req = 0;
1544                         langwell_otg_loc_sof(1);
1545                         iotg->otg.state = OTG_STATE_A_HOST;
1546                 } else if (iotg->hsm.a_aidl_bdis_tmout ||
1547                                 iotg->hsm.a_bus_drop) {
1548                         langwell_otg_del_timer(a_aidl_bdis_tmr);
1549                         langwell_otg_HABA(0);
1550                         free_irq(pdev->irq, iotg->base);
1551                         if (lnw->iotg.stop_host)
1552                                 lnw->iotg.stop_host(&lnw->iotg);
1553                         else
1554                                 dev_dbg(lnw->dev,
1555                                         "host driver has been removed.\n");
1556
1557                         /* Turn off VBus */
1558                         iotg->otg.set_vbus(&iotg->otg, false);
1559                         iotg->otg.state = OTG_STATE_A_WAIT_VFALL;
1560                 } else if (!iotg->hsm.b_conn && iotg->otg.host &&
1561                                 iotg->otg.host->b_hnp_enable) {
1562                         langwell_otg_del_timer(a_aidl_bdis_tmr);
1563                         langwell_otg_HABA(0);
1564                         free_irq(pdev->irq, iotg->base);
1565
1566                         if (lnw->iotg.stop_host)
1567                                 lnw->iotg.stop_host(&lnw->iotg);
1568                         else
1569                                 dev_dbg(lnw->dev,
1570                                         "host driver has been removed.\n");
1571
1572                         iotg->hsm.b_bus_suspend = 0;
1573                         iotg->hsm.b_bus_suspend_vld = 0;
1574
1575                         /* msleep(200); */
1576                         if (lnw->iotg.start_peripheral)
1577                                 lnw->iotg.start_peripheral(&lnw->iotg);
1578                         else
1579                                 dev_dbg(lnw->dev,
1580                                         "client driver not loaded.\n");
1581
1582                         langwell_otg_add_ktimer(TB_BUS_SUSPEND_TMR);
1583                         iotg->otg.state = OTG_STATE_A_PERIPHERAL;
1584                         break;
1585                 } else if (!iotg->hsm.a_vbus_vld) {
1586                         langwell_otg_del_timer(a_aidl_bdis_tmr);
1587                         langwell_otg_HABA(0);
1588                         free_irq(pdev->irq, iotg->base);
1589                         if (lnw->iotg.stop_host)
1590                                 lnw->iotg.stop_host(&lnw->iotg);
1591                         else
1592                                 dev_dbg(lnw->dev,
1593                                         "host driver has been removed.\n");
1594
1595                         /* Turn off VBus */
1596                         iotg->otg.set_vbus(&iotg->otg, false);
1597                         langwell_otg_phy_low_power_wait(1);
1598                         iotg->otg.state = OTG_STATE_A_VBUS_ERR;
1599                 }
1600                 break;
1601         case OTG_STATE_A_PERIPHERAL:
1602                 if (iotg->hsm.id) {
1603                         /* delete hsm timer for b_bus_suspend_tmr */
1604                         del_timer_sync(&lnw->hsm_timer);
1605                         iotg->otg.default_a = 0;
1606                         iotg->hsm.b_bus_req = 0;
1607                         if (lnw->iotg.stop_peripheral)
1608                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1609                         else
1610                                 dev_dbg(lnw->dev,
1611                                         "client driver has been removed.\n");
1612
1613                         /* Turn off VBus */
1614                         iotg->otg.set_vbus(&iotg->otg, false);
1615                         set_client_mode();
1616                         langwell_otg_phy_low_power_wait(1);
1617                         iotg->otg.state = OTG_STATE_B_IDLE;
1618                         langwell_update_transceiver();
1619                 } else if (!iotg->hsm.a_vbus_vld) {
1620                         /* delete hsm timer for b_bus_suspend_tmr */
1621                         del_timer_sync(&lnw->hsm_timer);
1622
1623                         if (lnw->iotg.stop_peripheral)
1624                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1625                         else
1626                                 dev_dbg(lnw->dev,
1627                                         "client driver has been removed.\n");
1628
1629                         /* Turn off VBus */
1630                         iotg->otg.set_vbus(&iotg->otg, false);
1631                         langwell_otg_phy_low_power_wait(1);
1632                         iotg->otg.state = OTG_STATE_A_VBUS_ERR;
1633                 } else if (iotg->hsm.a_bus_drop) {
1634                         /* delete hsm timer for b_bus_suspend_tmr */
1635                         del_timer_sync(&lnw->hsm_timer);
1636
1637                         if (lnw->iotg.stop_peripheral)
1638                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1639                         else
1640                                 dev_dbg(lnw->dev,
1641                                         "client driver has been removed.\n");
1642
1643                         /* Turn off VBus */
1644                         iotg->otg.set_vbus(&iotg->otg, false);
1645                         iotg->otg.state = OTG_STATE_A_WAIT_VFALL;
1646                 } else if (iotg->hsm.b_bus_suspend) {
1647                         /* delete hsm timer for b_bus_suspend_tmr */
1648                         del_timer_sync(&lnw->hsm_timer);
1649
1650                         if (lnw->iotg.stop_peripheral)
1651                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1652                         else
1653                                 dev_dbg(lnw->dev,
1654                                         "client driver has been removed.\n");
1655
1656                         if (lnw->iotg.start_host)
1657                                 lnw->iotg.start_host(&lnw->iotg);
1658                         else
1659                                 dev_dbg(lnw->dev,
1660                                                 "host driver not loaded.\n");
1661                         langwell_otg_add_ktimer(TA_WAIT_BCON_TMR);
1662                         iotg->otg.state = OTG_STATE_A_WAIT_BCON;
1663                 } else if (iotg->hsm.b_bus_suspend_tmout) {
1664                         u32     val;
1665                         val = readl(lnw->iotg.base + CI_PORTSC1);
1666                         if (!(val & PORTSC_SUSP))
1667                                 break;
1668
1669                         if (lnw->iotg.stop_peripheral)
1670                                 lnw->iotg.stop_peripheral(&lnw->iotg);
1671                         else
1672                                 dev_dbg(lnw->dev,
1673                                         "client driver has been removed.\n");
1674
1675                         if (lnw->iotg.start_host)
1676                                 lnw->iotg.start_host(&lnw->iotg);
1677                         else
1678                                 dev_dbg(lnw->dev,
1679                                                 "host driver not loaded.\n");
1680                         langwell_otg_add_ktimer(TA_WAIT_BCON_TMR);
1681                         iotg->otg.state = OTG_STATE_A_WAIT_BCON;
1682                 }
1683                 break;
1684         case OTG_STATE_A_VBUS_ERR:
1685                 if (iotg->hsm.id) {
1686                         iotg->otg.default_a = 0;
1687                         iotg->hsm.a_clr_err = 0;
1688                         iotg->hsm.a_srp_det = 0;
1689                         set_client_mode();
1690                         langwell_otg_phy_low_power(1);
1691                         iotg->otg.state = OTG_STATE_B_IDLE;
1692                         langwell_update_transceiver();
1693                 } else if (iotg->hsm.a_clr_err) {
1694                         iotg->hsm.a_clr_err = 0;
1695                         iotg->hsm.a_srp_det = 0;
1696                         reset_otg();
1697                         init_hsm();
1698                         if (iotg->otg.state == OTG_STATE_A_IDLE)
1699                                 langwell_update_transceiver();
1700                 } else {
1701                         /* FW will clear PHCD bit when any VBus
1702                          * event detected. Reset PHCD to 1 again */
1703                         langwell_otg_phy_low_power(1);
1704                 }
1705                 break;
1706         case OTG_STATE_A_WAIT_VFALL:
1707                 if (iotg->hsm.id) {
1708                         iotg->otg.default_a = 0;
1709                         set_client_mode();
1710                         langwell_otg_phy_low_power(1);
1711                         iotg->otg.state = OTG_STATE_B_IDLE;
1712                         langwell_update_transceiver();
1713                 } else if (iotg->hsm.a_bus_req) {
1714
1715                         /* Turn on VBus */
1716                         iotg->otg.set_vbus(&iotg->otg, true);
1717                         iotg->hsm.a_wait_vrise_tmout = 0;
1718                         langwell_otg_add_timer(a_wait_vrise_tmr);
1719                         iotg->otg.state = OTG_STATE_A_WAIT_VRISE;
1720                 } else if (!iotg->hsm.a_sess_vld) {
1721                         iotg->hsm.a_srp_det = 0;
1722                         set_host_mode();
1723                         langwell_otg_phy_low_power(1);
1724                         iotg->otg.state = OTG_STATE_A_IDLE;
1725                 }
1726                 break;
1727         default:
1728                 ;
1729         }
1730
1731         dev_dbg(lnw->dev, "%s: new state = %s\n", __func__,
1732                         state_string(iotg->otg.state));
1733 }
1734
1735 static ssize_t
1736 show_registers(struct device *_dev, struct device_attribute *attr, char *buf)
1737 {
1738         struct langwell_otg     *lnw = the_transceiver;
1739         char                    *next;
1740         unsigned                size, t;
1741
1742         next = buf;
1743         size = PAGE_SIZE;
1744
1745         t = scnprintf(next, size,
1746                 "\n"
1747                 "USBCMD = 0x%08x\n"
1748                 "USBSTS = 0x%08x\n"
1749                 "USBINTR = 0x%08x\n"
1750                 "ASYNCLISTADDR = 0x%08x\n"
1751                 "PORTSC1 = 0x%08x\n"
1752                 "HOSTPC1 = 0x%08x\n"
1753                 "OTGSC = 0x%08x\n"
1754                 "USBMODE = 0x%08x\n",
1755                 readl(lnw->iotg.base + 0x30),
1756                 readl(lnw->iotg.base + 0x34),
1757                 readl(lnw->iotg.base + 0x38),
1758                 readl(lnw->iotg.base + 0x48),
1759                 readl(lnw->iotg.base + 0x74),
1760                 readl(lnw->iotg.base + 0xb4),
1761                 readl(lnw->iotg.base + 0xf4),
1762                 readl(lnw->iotg.base + 0xf8)
1763              );
1764         size -= t;
1765         next += t;
1766
1767         return PAGE_SIZE - size;
1768 }
1769 static DEVICE_ATTR(registers, S_IRUGO, show_registers, NULL);
1770
1771 static ssize_t
1772 show_hsm(struct device *_dev, struct device_attribute *attr, char *buf)
1773 {
1774         struct langwell_otg             *lnw = the_transceiver;
1775         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
1776         char                            *next;
1777         unsigned                        size, t;
1778
1779         next = buf;
1780         size = PAGE_SIZE;
1781
1782         if (iotg->otg.host)
1783                 iotg->hsm.a_set_b_hnp_en = iotg->otg.host->b_hnp_enable;
1784
1785         if (iotg->otg.gadget)
1786                 iotg->hsm.b_hnp_enable = iotg->otg.gadget->b_hnp_enable;
1787
1788         t = scnprintf(next, size,
1789                 "\n"
1790                 "current state = %s\n"
1791                 "a_bus_resume = \t%d\n"
1792                 "a_bus_suspend = \t%d\n"
1793                 "a_conn = \t%d\n"
1794                 "a_sess_vld = \t%d\n"
1795                 "a_srp_det = \t%d\n"
1796                 "a_vbus_vld = \t%d\n"
1797                 "b_bus_resume = \t%d\n"
1798                 "b_bus_suspend = \t%d\n"
1799                 "b_conn = \t%d\n"
1800                 "b_se0_srp = \t%d\n"
1801                 "b_sess_end = \t%d\n"
1802                 "b_sess_vld = \t%d\n"
1803                 "id = \t%d\n"
1804                 "a_set_b_hnp_en = \t%d\n"
1805                 "b_srp_done = \t%d\n"
1806                 "b_hnp_enable = \t%d\n"
1807                 "a_wait_vrise_tmout = \t%d\n"
1808                 "a_wait_bcon_tmout = \t%d\n"
1809                 "a_aidl_bdis_tmout = \t%d\n"
1810                 "b_ase0_brst_tmout = \t%d\n"
1811                 "a_bus_drop = \t%d\n"
1812                 "a_bus_req = \t%d\n"
1813                 "a_clr_err = \t%d\n"
1814                 "a_suspend_req = \t%d\n"
1815                 "b_bus_req = \t%d\n"
1816                 "b_bus_suspend_tmout = \t%d\n"
1817                 "b_bus_suspend_vld = \t%d\n",
1818                 state_string(iotg->otg.state),
1819                 iotg->hsm.a_bus_resume,
1820                 iotg->hsm.a_bus_suspend,
1821                 iotg->hsm.a_conn,
1822                 iotg->hsm.a_sess_vld,
1823                 iotg->hsm.a_srp_det,
1824                 iotg->hsm.a_vbus_vld,
1825                 iotg->hsm.b_bus_resume,
1826                 iotg->hsm.b_bus_suspend,
1827                 iotg->hsm.b_conn,
1828                 iotg->hsm.b_se0_srp,
1829                 iotg->hsm.b_sess_end,
1830                 iotg->hsm.b_sess_vld,
1831                 iotg->hsm.id,
1832                 iotg->hsm.a_set_b_hnp_en,
1833                 iotg->hsm.b_srp_done,
1834                 iotg->hsm.b_hnp_enable,
1835                 iotg->hsm.a_wait_vrise_tmout,
1836                 iotg->hsm.a_wait_bcon_tmout,
1837                 iotg->hsm.a_aidl_bdis_tmout,
1838                 iotg->hsm.b_ase0_brst_tmout,
1839                 iotg->hsm.a_bus_drop,
1840                 iotg->hsm.a_bus_req,
1841                 iotg->hsm.a_clr_err,
1842                 iotg->hsm.a_suspend_req,
1843                 iotg->hsm.b_bus_req,
1844                 iotg->hsm.b_bus_suspend_tmout,
1845                 iotg->hsm.b_bus_suspend_vld
1846                 );
1847         size -= t;
1848         next += t;
1849
1850         return PAGE_SIZE - size;
1851 }
1852 static DEVICE_ATTR(hsm, S_IRUGO, show_hsm, NULL);
1853
1854 static ssize_t
1855 get_a_bus_req(struct device *dev, struct device_attribute *attr, char *buf)
1856 {
1857         struct langwell_otg     *lnw = the_transceiver;
1858         char                    *next;
1859         unsigned                size, t;
1860
1861         next = buf;
1862         size = PAGE_SIZE;
1863
1864         t = scnprintf(next, size, "%d", lnw->iotg.hsm.a_bus_req);
1865         size -= t;
1866         next += t;
1867
1868         return PAGE_SIZE - size;
1869 }
1870
1871 static ssize_t
1872 set_a_bus_req(struct device *dev, struct device_attribute *attr,
1873                 const char *buf, size_t count)
1874 {
1875         struct langwell_otg             *lnw = the_transceiver;
1876         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
1877
1878         if (!iotg->otg.default_a)
1879                 return -1;
1880         if (count > 2)
1881                 return -1;
1882
1883         if (buf[0] == '0') {
1884                 iotg->hsm.a_bus_req = 0;
1885                 dev_dbg(lnw->dev, "User request: a_bus_req = 0\n");
1886         } else if (buf[0] == '1') {
1887                 /* If a_bus_drop is TRUE, a_bus_req can't be set */
1888                 if (iotg->hsm.a_bus_drop)
1889                         return -1;
1890                 iotg->hsm.a_bus_req = 1;
1891                 dev_dbg(lnw->dev, "User request: a_bus_req = 1\n");
1892         }
1893         if (spin_trylock(&lnw->wq_lock)) {
1894                 langwell_update_transceiver();
1895                 spin_unlock(&lnw->wq_lock);
1896         }
1897         return count;
1898 }
1899 static DEVICE_ATTR(a_bus_req, S_IRUGO | S_IWUGO, get_a_bus_req, set_a_bus_req);
1900
1901 static ssize_t
1902 get_a_bus_drop(struct device *dev, struct device_attribute *attr, char *buf)
1903 {
1904         struct langwell_otg     *lnw = the_transceiver;
1905         char                    *next;
1906         unsigned                size, t;
1907
1908         next = buf;
1909         size = PAGE_SIZE;
1910
1911         t = scnprintf(next, size, "%d", lnw->iotg.hsm.a_bus_drop);
1912         size -= t;
1913         next += t;
1914
1915         return PAGE_SIZE - size;
1916 }
1917
1918 static ssize_t
1919 set_a_bus_drop(struct device *dev, struct device_attribute *attr,
1920                 const char *buf, size_t count)
1921 {
1922         struct langwell_otg             *lnw = the_transceiver;
1923         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
1924
1925         if (!iotg->otg.default_a)
1926                 return -1;
1927         if (count > 2)
1928                 return -1;
1929
1930         if (buf[0] == '0') {
1931                 iotg->hsm.a_bus_drop = 0;
1932                 dev_dbg(lnw->dev, "User request: a_bus_drop = 0\n");
1933         } else if (buf[0] == '1') {
1934                 iotg->hsm.a_bus_drop = 1;
1935                 iotg->hsm.a_bus_req = 0;
1936                 dev_dbg(lnw->dev, "User request: a_bus_drop = 1\n");
1937                 dev_dbg(lnw->dev, "User request: and a_bus_req = 0\n");
1938         }
1939         if (spin_trylock(&lnw->wq_lock)) {
1940                 langwell_update_transceiver();
1941                 spin_unlock(&lnw->wq_lock);
1942         }
1943         return count;
1944 }
1945 static DEVICE_ATTR(a_bus_drop, S_IRUGO | S_IWUGO,
1946         get_a_bus_drop, set_a_bus_drop);
1947
1948 static ssize_t
1949 get_b_bus_req(struct device *dev, struct device_attribute *attr, char *buf)
1950 {
1951         struct langwell_otg     *lnw = the_transceiver;
1952         char                    *next;
1953         unsigned                size, t;
1954
1955         next = buf;
1956         size = PAGE_SIZE;
1957
1958         t = scnprintf(next, size, "%d", lnw->iotg.hsm.b_bus_req);
1959         size -= t;
1960         next += t;
1961
1962         return PAGE_SIZE - size;
1963 }
1964
1965 static ssize_t
1966 set_b_bus_req(struct device *dev, struct device_attribute *attr,
1967                 const char *buf, size_t count)
1968 {
1969         struct langwell_otg             *lnw = the_transceiver;
1970         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
1971
1972         if (iotg->otg.default_a)
1973                 return -1;
1974
1975         if (count > 2)
1976                 return -1;
1977
1978         if (buf[0] == '0') {
1979                 iotg->hsm.b_bus_req = 0;
1980                 dev_dbg(lnw->dev, "User request: b_bus_req = 0\n");
1981         } else if (buf[0] == '1') {
1982                 iotg->hsm.b_bus_req = 1;
1983                 dev_dbg(lnw->dev, "User request: b_bus_req = 1\n");
1984         }
1985         if (spin_trylock(&lnw->wq_lock)) {
1986                 langwell_update_transceiver();
1987                 spin_unlock(&lnw->wq_lock);
1988         }
1989         return count;
1990 }
1991 static DEVICE_ATTR(b_bus_req, S_IRUGO | S_IWUGO, get_b_bus_req, set_b_bus_req);
1992
1993 static ssize_t
1994 set_a_clr_err(struct device *dev, struct device_attribute *attr,
1995                 const char *buf, size_t count)
1996 {
1997         struct langwell_otg             *lnw = the_transceiver;
1998         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
1999
2000         if (!iotg->otg.default_a)
2001                 return -1;
2002         if (count > 2)
2003                 return -1;
2004
2005         if (buf[0] == '1') {
2006                 iotg->hsm.a_clr_err = 1;
2007                 dev_dbg(lnw->dev, "User request: a_clr_err = 1\n");
2008         }
2009         if (spin_trylock(&lnw->wq_lock)) {
2010                 langwell_update_transceiver();
2011                 spin_unlock(&lnw->wq_lock);
2012         }
2013         return count;
2014 }
2015 static DEVICE_ATTR(a_clr_err, S_IWUGO, NULL, set_a_clr_err);
2016
2017 static struct attribute *inputs_attrs[] = {
2018         &dev_attr_a_bus_req.attr,
2019         &dev_attr_a_bus_drop.attr,
2020         &dev_attr_b_bus_req.attr,
2021         &dev_attr_a_clr_err.attr,
2022         NULL,
2023 };
2024
2025 static struct attribute_group debug_dev_attr_group = {
2026         .name = "inputs",
2027         .attrs = inputs_attrs,
2028 };
2029
2030 static int langwell_otg_probe(struct pci_dev *pdev,
2031                 const struct pci_device_id *id)
2032 {
2033         unsigned long           resource, len;
2034         void __iomem            *base = NULL;
2035         int                     retval;
2036         u32                     val32;
2037         struct langwell_otg     *lnw;
2038         char                    qname[] = "langwell_otg_queue";
2039
2040         retval = 0;
2041         dev_dbg(&pdev->dev, "\notg controller is detected.\n");
2042         if (pci_enable_device(pdev) < 0) {
2043                 retval = -ENODEV;
2044                 goto done;
2045         }
2046
2047         lnw = kzalloc(sizeof *lnw, GFP_KERNEL);
2048         if (lnw == NULL) {
2049                 retval = -ENOMEM;
2050                 goto done;
2051         }
2052         the_transceiver = lnw;
2053
2054         /* control register: BAR 0 */
2055         resource = pci_resource_start(pdev, 0);
2056         len = pci_resource_len(pdev, 0);
2057         if (!request_mem_region(resource, len, driver_name)) {
2058                 retval = -EBUSY;
2059                 goto err;
2060         }
2061         lnw->region = 1;
2062
2063         base = ioremap_nocache(resource, len);
2064         if (base == NULL) {
2065                 retval = -EFAULT;
2066                 goto err;
2067         }
2068         lnw->iotg.base = base;
2069
2070         if (!request_mem_region(USBCFG_ADDR, USBCFG_LEN, driver_name)) {
2071                 retval = -EBUSY;
2072                 goto err;
2073         }
2074         lnw->cfg_region = 1;
2075
2076         /* For the SCCB.USBCFG register */
2077         base = ioremap_nocache(USBCFG_ADDR, USBCFG_LEN);
2078         if (base == NULL) {
2079                 retval = -EFAULT;
2080                 goto err;
2081         }
2082         lnw->usbcfg = base;
2083
2084         if (!pdev->irq) {
2085                 dev_dbg(&pdev->dev, "No IRQ.\n");
2086                 retval = -ENODEV;
2087                 goto err;
2088         }
2089
2090         lnw->qwork = create_singlethread_workqueue(qname);
2091         if (!lnw->qwork) {
2092                 dev_dbg(&pdev->dev, "cannot create workqueue %s\n", qname);
2093                 retval = -ENOMEM;
2094                 goto err;
2095         }
2096         INIT_WORK(&lnw->work, langwell_otg_work);
2097
2098         /* OTG common part */
2099         lnw->dev = &pdev->dev;
2100         lnw->iotg.otg.dev = lnw->dev;
2101         lnw->iotg.otg.label = driver_name;
2102         lnw->iotg.otg.set_host = langwell_otg_set_host;
2103         lnw->iotg.otg.set_peripheral = langwell_otg_set_peripheral;
2104         lnw->iotg.otg.set_power = langwell_otg_set_power;
2105         lnw->iotg.otg.set_vbus = langwell_otg_set_vbus;
2106         lnw->iotg.otg.start_srp = langwell_otg_start_srp;
2107         lnw->iotg.otg.state = OTG_STATE_UNDEFINED;
2108
2109         if (otg_set_transceiver(&lnw->iotg.otg)) {
2110                 dev_dbg(lnw->dev, "can't set transceiver\n");
2111                 retval = -EBUSY;
2112                 goto err;
2113         }
2114
2115         reset_otg();
2116         init_hsm();
2117
2118         spin_lock_init(&lnw->lock);
2119         spin_lock_init(&lnw->wq_lock);
2120         INIT_LIST_HEAD(&active_timers);
2121         retval = langwell_otg_init_timers(&lnw->iotg.hsm);
2122         if (retval) {
2123                 dev_dbg(&pdev->dev, "Failed to init timers\n");
2124                 goto err;
2125         }
2126
2127         init_timer(&lnw->hsm_timer);
2128         ATOMIC_INIT_NOTIFIER_HEAD(&lnw->iotg.iotg_notifier);
2129
2130         lnw->iotg_notifier.notifier_call = langwell_otg_iotg_notify;
2131
2132         retval = intel_mid_otg_register_notifier(&lnw->iotg,
2133                                                 &lnw->iotg_notifier);
2134         if (retval) {
2135                 dev_dbg(lnw->dev, "Failed to register notifier\n");
2136                 goto err;
2137         }
2138
2139         if (request_irq(pdev->irq, otg_irq, IRQF_SHARED,
2140                                 driver_name, lnw) != 0) {
2141                 dev_dbg(lnw->dev, "request interrupt %d failed\n", pdev->irq);
2142                 retval = -EBUSY;
2143                 goto err;
2144         }
2145
2146         /* enable OTGSC int */
2147         val32 = OTGSC_DPIE | OTGSC_BSEIE | OTGSC_BSVIE |
2148                 OTGSC_ASVIE | OTGSC_AVVIE | OTGSC_IDIE | OTGSC_IDPU;
2149         writel(val32, lnw->iotg.base + CI_OTGSC);
2150
2151         retval = device_create_file(&pdev->dev, &dev_attr_registers);
2152         if (retval < 0) {
2153                 dev_dbg(lnw->dev,
2154                         "Can't register sysfs attribute: %d\n", retval);
2155                 goto err;
2156         }
2157
2158         retval = device_create_file(&pdev->dev, &dev_attr_hsm);
2159         if (retval < 0) {
2160                 dev_dbg(lnw->dev, "Can't hsm sysfs attribute: %d\n", retval);
2161                 goto err;
2162         }
2163
2164         retval = sysfs_create_group(&pdev->dev.kobj, &debug_dev_attr_group);
2165         if (retval < 0) {
2166                 dev_dbg(lnw->dev,
2167                         "Can't register sysfs attr group: %d\n", retval);
2168                 goto err;
2169         }
2170
2171         if (lnw->iotg.otg.state == OTG_STATE_A_IDLE)
2172                 langwell_update_transceiver();
2173
2174         return 0;
2175
2176 err:
2177         if (the_transceiver)
2178                 langwell_otg_remove(pdev);
2179 done:
2180         return retval;
2181 }
2182
2183 static void langwell_otg_remove(struct pci_dev *pdev)
2184 {
2185         struct langwell_otg *lnw = the_transceiver;
2186
2187         if (lnw->qwork) {
2188                 flush_workqueue(lnw->qwork);
2189                 destroy_workqueue(lnw->qwork);
2190         }
2191         intel_mid_otg_unregister_notifier(&lnw->iotg, &lnw->iotg_notifier);
2192         langwell_otg_free_timers();
2193
2194         /* disable OTGSC interrupt as OTGSC doesn't change in reset */
2195         writel(0, lnw->iotg.base + CI_OTGSC);
2196
2197         if (pdev->irq)
2198                 free_irq(pdev->irq, lnw);
2199         if (lnw->usbcfg)
2200                 iounmap(lnw->usbcfg);
2201         if (lnw->cfg_region)
2202                 release_mem_region(USBCFG_ADDR, USBCFG_LEN);
2203         if (lnw->iotg.base)
2204                 iounmap(lnw->iotg.base);
2205         if (lnw->region)
2206                 release_mem_region(pci_resource_start(pdev, 0),
2207                                 pci_resource_len(pdev, 0));
2208
2209         otg_set_transceiver(NULL);
2210         pci_disable_device(pdev);
2211         sysfs_remove_group(&pdev->dev.kobj, &debug_dev_attr_group);
2212         device_remove_file(&pdev->dev, &dev_attr_hsm);
2213         device_remove_file(&pdev->dev, &dev_attr_registers);
2214         kfree(lnw);
2215         lnw = NULL;
2216 }
2217
2218 static void transceiver_suspend(struct pci_dev *pdev)
2219 {
2220         pci_save_state(pdev);
2221         pci_set_power_state(pdev, PCI_D3hot);
2222         langwell_otg_phy_low_power(1);
2223 }
2224
2225 static int langwell_otg_suspend(struct pci_dev *pdev, pm_message_t message)
2226 {
2227         struct langwell_otg             *lnw = the_transceiver;
2228         struct intel_mid_otg_xceiv      *iotg = &lnw->iotg;
2229         int                             ret = 0;
2230
2231         /* Disbale OTG interrupts */
2232         langwell_otg_intr(0);
2233
2234         if (pdev->irq)
2235                 free_irq(pdev->irq, lnw);
2236
2237         /* Prevent more otg_work */
2238         flush_workqueue(lnw->qwork);
2239         destroy_workqueue(lnw->qwork);
2240         lnw->qwork = NULL;
2241
2242         /* start actions */
2243         switch (iotg->otg.state) {
2244         case OTG_STATE_A_WAIT_VFALL:
2245                 iotg->otg.state = OTG_STATE_A_IDLE;
2246         case OTG_STATE_A_IDLE:
2247         case OTG_STATE_B_IDLE:
2248         case OTG_STATE_A_VBUS_ERR:
2249                 transceiver_suspend(pdev);
2250                 break;
2251         case OTG_STATE_A_WAIT_VRISE:
2252                 langwell_otg_del_timer(a_wait_vrise_tmr);
2253                 iotg->hsm.a_srp_det = 0;
2254
2255                 /* Turn off VBus */
2256                 iotg->otg.set_vbus(&iotg->otg, false);
2257                 iotg->otg.state = OTG_STATE_A_IDLE;
2258                 transceiver_suspend(pdev);
2259                 break;
2260         case OTG_STATE_A_WAIT_BCON:
2261                 del_timer_sync(&lnw->hsm_timer);
2262                 if (lnw->iotg.stop_host)
2263                         lnw->iotg.stop_host(&lnw->iotg);
2264                 else
2265                         dev_dbg(&pdev->dev, "host driver has been removed.\n");
2266
2267                 iotg->hsm.a_srp_det = 0;
2268
2269                 /* Turn off VBus */
2270                 iotg->otg.set_vbus(&iotg->otg, false);
2271                 iotg->otg.state = OTG_STATE_A_IDLE;
2272                 transceiver_suspend(pdev);
2273                 break;
2274         case OTG_STATE_A_HOST:
2275                 if (lnw->iotg.stop_host)
2276                         lnw->iotg.stop_host(&lnw->iotg);
2277                 else
2278                         dev_dbg(&pdev->dev, "host driver has been removed.\n");
2279
2280                 iotg->hsm.a_srp_det = 0;
2281
2282                 /* Turn off VBus */
2283                 iotg->otg.set_vbus(&iotg->otg, false);
2284
2285                 iotg->otg.state = OTG_STATE_A_IDLE;
2286                 transceiver_suspend(pdev);
2287                 break;
2288         case OTG_STATE_A_SUSPEND:
2289                 langwell_otg_del_timer(a_aidl_bdis_tmr);
2290                 langwell_otg_HABA(0);
2291                 if (lnw->iotg.stop_host)
2292                         lnw->iotg.stop_host(&lnw->iotg);
2293                 else
2294                         dev_dbg(lnw->dev, "host driver has been removed.\n");
2295                 iotg->hsm.a_srp_det = 0;
2296
2297                 /* Turn off VBus */
2298                 iotg->otg.set_vbus(&iotg->otg, false);
2299                 iotg->otg.state = OTG_STATE_A_IDLE;
2300                 transceiver_suspend(pdev);
2301                 break;
2302         case OTG_STATE_A_PERIPHERAL:
2303                 del_timer_sync(&lnw->hsm_timer);
2304
2305                 if (lnw->iotg.stop_peripheral)
2306                         lnw->iotg.stop_peripheral(&lnw->iotg);
2307                 else
2308                         dev_dbg(&pdev->dev,
2309                                 "client driver has been removed.\n");
2310                 iotg->hsm.a_srp_det = 0;
2311
2312                 /* Turn off VBus */
2313                 iotg->otg.set_vbus(&iotg->otg, false);
2314                 iotg->otg.state = OTG_STATE_A_IDLE;
2315                 transceiver_suspend(pdev);
2316                 break;
2317         case OTG_STATE_B_HOST:
2318                 if (lnw->iotg.stop_host)
2319                         lnw->iotg.stop_host(&lnw->iotg);
2320                 else
2321                         dev_dbg(&pdev->dev, "host driver has been removed.\n");
2322                 iotg->hsm.b_bus_req = 0;
2323                 iotg->otg.state = OTG_STATE_B_IDLE;
2324                 transceiver_suspend(pdev);
2325                 break;
2326         case OTG_STATE_B_PERIPHERAL:
2327                 if (lnw->iotg.stop_peripheral)
2328                         lnw->iotg.stop_peripheral(&lnw->iotg);
2329                 else
2330                         dev_dbg(&pdev->dev,
2331                                 "client driver has been removed.\n");
2332                 iotg->otg.state = OTG_STATE_B_IDLE;
2333                 transceiver_suspend(pdev);
2334                 break;
2335         case OTG_STATE_B_WAIT_ACON:
2336                 /* delete hsm timer for b_ase0_brst_tmr */
2337                 del_timer_sync(&lnw->hsm_timer);
2338
2339                 langwell_otg_HAAR(0);
2340
2341                 if (lnw->iotg.stop_host)
2342                         lnw->iotg.stop_host(&lnw->iotg);
2343                 else
2344                         dev_dbg(&pdev->dev, "host driver has been removed.\n");
2345                 iotg->hsm.b_bus_req = 0;
2346                 iotg->otg.state = OTG_STATE_B_IDLE;
2347                 transceiver_suspend(pdev);
2348                 break;
2349         default:
2350                 dev_dbg(lnw->dev, "error state before suspend\n");
2351                 break;
2352         }
2353
2354         return ret;
2355 }
2356
2357 static void transceiver_resume(struct pci_dev *pdev)
2358 {
2359         pci_restore_state(pdev);
2360         pci_set_power_state(pdev, PCI_D0);
2361 }
2362
2363 static int langwell_otg_resume(struct pci_dev *pdev)
2364 {
2365         struct langwell_otg     *lnw = the_transceiver;
2366         int                     ret = 0;
2367
2368         transceiver_resume(pdev);
2369
2370         lnw->qwork = create_singlethread_workqueue("langwell_otg_queue");
2371         if (!lnw->qwork) {
2372                 dev_dbg(&pdev->dev, "cannot create langwell otg workqueuen");
2373                 ret = -ENOMEM;
2374                 goto error;
2375         }
2376
2377         if (request_irq(pdev->irq, otg_irq, IRQF_SHARED,
2378                                 driver_name, lnw) != 0) {
2379                 dev_dbg(&pdev->dev, "request interrupt %d failed\n", pdev->irq);
2380                 ret = -EBUSY;
2381                 goto error;
2382         }
2383
2384         /* enable OTG interrupts */
2385         langwell_otg_intr(1);
2386
2387         update_hsm();
2388
2389         langwell_update_transceiver();
2390
2391         return ret;
2392 error:
2393         langwell_otg_intr(0);
2394         transceiver_suspend(pdev);
2395         return ret;
2396 }
2397
2398 static int __init langwell_otg_init(void)
2399 {
2400         return pci_register_driver(&otg_pci_driver);
2401 }
2402 module_init(langwell_otg_init);
2403
2404 static void __exit langwell_otg_cleanup(void)
2405 {
2406         pci_unregister_driver(&otg_pci_driver);
2407 }
2408 module_exit(langwell_otg_cleanup);