drivers/usb/dwc2/core.c

   1 // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
   2 /*
   3  * core.c - DesignWare HS OTG Controller common routines
   4  *
   5  * Copyright (C) 2004-2013 Synopsys, Inc.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions, and the following disclaimer,
  12  *    without modification.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  * 3. The names of the above-listed copyright holders may not be used
  17  *    to endorse or promote products derived from this software without
  18  *    specific prior written permission.
  19  *
  20  * ALTERNATIVELY, this software may be distributed under the terms of the
  21  * GNU General Public License ("GPL") as published by the Free Software
  22  * Foundation; either version 2 of the License, or (at your option) any
  23  * later version.
  24  *
  25  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
  26  * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  27  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  28  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  29  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  30  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  31  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
  32  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
  33  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
  34  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  35  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  36  */
  37
  38 /*
  39  * The Core code provides basic services for accessing and managing the
  40  * DWC_otg hardware. These services are used by both the Host Controller
  41  * Driver and the Peripheral Controller Driver.
  42  */
  43 #include <linux/kernel.h>
  44 #include <linux/module.h>
  45 #include <linux/moduleparam.h>
  46 #include <linux/spinlock.h>
  47 #include <linux/interrupt.h>
  48 #include <linux/dma-mapping.h>
  49 #include <linux/delay.h>
  50 #include <linux/io.h>
  51 #include <linux/slab.h>
  52 #include <linux/usb.h>
  53
  54 #include <linux/usb/hcd.h>
  55 #include <linux/usb/ch11.h>
  56
  57 #include "core.h"
  58 #include "hcd.h"
  59
  60 /**
  61  * dwc2_backup_global_registers() - Backup global controller registers.
  62  * When suspending usb bus, registers needs to be backuped
  63  * if controller power is disabled once suspended.
  64  *
  65  * @hsotg: Programming view of the DWC_otg controller
  66  */
  67 int dwc2_backup_global_registers(struct dwc2_hsotg *hsotg)
  68 {
  69         struct dwc2_gregs_backup *gr;
  70
  71         dev_dbg(hsotg->dev, "%s\n", __func__);
  72
  73         /* Backup global regs */
  74         gr = &hsotg->gr_backup;
  75
  76         gr->gotgctl = dwc2_readl(hsotg, GOTGCTL);
  77         gr->gintmsk = dwc2_readl(hsotg, GINTMSK);
  78         gr->gahbcfg = dwc2_readl(hsotg, GAHBCFG);
  79         gr->gusbcfg = dwc2_readl(hsotg, GUSBCFG);
  80         gr->grxfsiz = dwc2_readl(hsotg, GRXFSIZ);
  81         gr->gnptxfsiz = dwc2_readl(hsotg, GNPTXFSIZ);
  82         gr->gdfifocfg = dwc2_readl(hsotg, GDFIFOCFG);
  83         gr->pcgcctl1 = dwc2_readl(hsotg, PCGCCTL1);
  84         gr->glpmcfg = dwc2_readl(hsotg, GLPMCFG);
  85         gr->gi2cctl = dwc2_readl(hsotg, GI2CCTL);
  86         gr->pcgcctl = dwc2_readl(hsotg, PCGCTL);
  87
  88         gr->valid = true;
  89         return 0;
  90 }
  91
  92 /**
  93  * dwc2_restore_global_registers() - Restore controller global registers.
  94  * When resuming usb bus, device registers needs to be restored
  95  * if controller power were disabled.
  96  *
  97  * @hsotg: Programming view of the DWC_otg controller
  98  */
  99 int dwc2_restore_global_registers(struct dwc2_hsotg *hsotg)
 100 {
 101         struct dwc2_gregs_backup *gr;
 102
 103         dev_dbg(hsotg->dev, "%s\n", __func__);
 104
 105         /* Restore global regs */
 106         gr = &hsotg->gr_backup;
 107         if (!gr->valid) {
 108                 dev_err(hsotg->dev, "%s: no global registers to restore\n",
 109                         __func__);
 110                 return -EINVAL;
 111         }
 112         gr->valid = false;
 113
 114         dwc2_writel(hsotg, 0xffffffff, GINTSTS);
 115         dwc2_writel(hsotg, gr->gotgctl, GOTGCTL);
 116         dwc2_writel(hsotg, gr->gintmsk, GINTMSK);
 117         dwc2_writel(hsotg, gr->gusbcfg, GUSBCFG);
 118         dwc2_writel(hsotg, gr->gahbcfg, GAHBCFG);
 119         dwc2_writel(hsotg, gr->grxfsiz, GRXFSIZ);
 120         dwc2_writel(hsotg, gr->gnptxfsiz, GNPTXFSIZ);
 121         dwc2_writel(hsotg, gr->gdfifocfg, GDFIFOCFG);
 122         dwc2_writel(hsotg, gr->pcgcctl1, PCGCCTL1);
 123         dwc2_writel(hsotg, gr->glpmcfg, GLPMCFG);
 124         dwc2_writel(hsotg, gr->pcgcctl, PCGCTL);
 125         dwc2_writel(hsotg, gr->gi2cctl, GI2CCTL);
 126
 127         return 0;
 128 }
 129
 130 /**
 131  * dwc2_exit_partial_power_down() - Exit controller from Partial Power Down.
 132  *
 133  * @hsotg: Programming view of the DWC_otg controller
 134  * @restore: Controller registers need to be restored
 135  */
 136 int dwc2_exit_partial_power_down(struct dwc2_hsotg *hsotg, bool restore)
 137 {
 138         u32 pcgcctl;
 139         int ret = 0;
 140
 141         if (hsotg->params.power_down != DWC2_POWER_DOWN_PARAM_PARTIAL)
 142                 return -ENOTSUPP;
 143
 144         pcgcctl = dwc2_readl(hsotg, PCGCTL);
 145         pcgcctl &= ~PCGCTL_STOPPCLK;
 146         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 147
 148         pcgcctl = dwc2_readl(hsotg, PCGCTL);
 149         pcgcctl &= ~PCGCTL_PWRCLMP;
 150         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 151
 152         pcgcctl = dwc2_readl(hsotg, PCGCTL);
 153         pcgcctl &= ~PCGCTL_RSTPDWNMODULE;
 154         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 155
 156         udelay(100);
 157         if (restore) {
 158                 ret = dwc2_restore_global_registers(hsotg);
 159                 if (ret) {
 160                         dev_err(hsotg->dev, "%s: failed to restore registers\n",
 161                                 __func__);
 162                         return ret;
 163                 }
 164                 if (dwc2_is_host_mode(hsotg)) {
 165                         ret = dwc2_restore_host_registers(hsotg);
 166                         if (ret) {
 167                                 dev_err(hsotg->dev, "%s: failed to restore host registers\n",
 168                                         __func__);
 169                                 return ret;
 170                         }
 171                 } else {
 172                         ret = dwc2_restore_device_registers(hsotg, 0);
 173                         if (ret) {
 174                                 dev_err(hsotg->dev, "%s: failed to restore device registers\n",
 175                                         __func__);
 176                                 return ret;
 177                         }
 178                 }
 179         }
 180
 181         return ret;
 182 }
 183
 184 /**
 185  * dwc2_enter_partial_power_down() - Put controller in Partial Power Down.
 186  *
 187  * @hsotg: Programming view of the DWC_otg controller
 188  */
 189 int dwc2_enter_partial_power_down(struct dwc2_hsotg *hsotg)
 190 {
 191         u32 pcgcctl;
 192         int ret = 0;
 193
 194         if (!hsotg->params.power_down)
 195                 return -ENOTSUPP;
 196
 197         /* Backup all registers */
 198         ret = dwc2_backup_global_registers(hsotg);
 199         if (ret) {
 200                 dev_err(hsotg->dev, "%s: failed to backup global registers\n",
 201                         __func__);
 202                 return ret;
 203         }
 204
 205         if (dwc2_is_host_mode(hsotg)) {
 206                 ret = dwc2_backup_host_registers(hsotg);
 207                 if (ret) {
 208                         dev_err(hsotg->dev, "%s: failed to backup host registers\n",
 209                                 __func__);
 210                         return ret;
 211                 }
 212         } else {
 213                 ret = dwc2_backup_device_registers(hsotg);
 214                 if (ret) {
 215                         dev_err(hsotg->dev, "%s: failed to backup device registers\n",
 216                                 __func__);
 217                         return ret;
 218                 }
 219         }
 220
 221         /*
 222          * Clear any pending interrupts since dwc2 will not be able to
 223          * clear them after entering partial_power_down.
 224          */
 225         dwc2_writel(hsotg, 0xffffffff, GINTSTS);
 226
 227         /* Put the controller in low power state */
 228         pcgcctl = dwc2_readl(hsotg, PCGCTL);
 229
 230         pcgcctl |= PCGCTL_PWRCLMP;
 231         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 232         ndelay(20);
 233
 234         pcgcctl |= PCGCTL_RSTPDWNMODULE;
 235         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 236         ndelay(20);
 237
 238         pcgcctl |= PCGCTL_STOPPCLK;
 239         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 240
 241         return ret;
 242 }
 243
 244 /**
 245  * dwc2_restore_essential_regs() - Restore essiential regs of core.
 246  *
 247  * @hsotg: Programming view of the DWC_otg controller
 248  * @rmode: Restore mode, enabled in case of remote-wakeup.
 249  * @is_host: Host or device mode.
 250  */
 251 static void dwc2_restore_essential_regs(struct dwc2_hsotg *hsotg, int rmode,
 252                                         int is_host)
 253 {
 254         u32 pcgcctl;
 255         struct dwc2_gregs_backup *gr;
 256         struct dwc2_dregs_backup *dr;
 257         struct dwc2_hregs_backup *hr;
 258
 259         gr = &hsotg->gr_backup;
 260         dr = &hsotg->dr_backup;
 261         hr = &hsotg->hr_backup;
 262
 263         dev_dbg(hsotg->dev, "%s: restoring essential regs\n", __func__);
 264
 265         /* Load restore values for [31:14] bits */
 266         pcgcctl = (gr->pcgcctl & 0xffffc000);
 267         /* If High Speed */
 268         if (is_host) {
 269                 if (!(pcgcctl & PCGCTL_P2HD_PRT_SPD_MASK))
 270                         pcgcctl |= BIT(17);
 271         } else {
 272                 if (!(pcgcctl & PCGCTL_P2HD_DEV_ENUM_SPD_MASK))
 273                         pcgcctl |= BIT(17);
 274         }
 275         dwc2_writel(hsotg, pcgcctl, PCGCTL);
 276
 277         /* Umnask global Interrupt in GAHBCFG and restore it */
 278         dwc2_writel(hsotg, gr->gahbcfg | GAHBCFG_GLBL_INTR_EN, GAHBCFG);
 279
 280         /* Clear all pending interupts */
 281         dwc2_writel(hsotg, 0xffffffff, GINTSTS);
 282
 283         /* Unmask restore done interrupt */
 284         dwc2_writel(hsotg, GINTSTS_RESTOREDONE, GINTMSK);
 285
 286         /* Restore GUSBCFG and HCFG/DCFG */
 287         dwc2_writel(hsotg, gr->gusbcfg, GUSBCFG);
 288
 289         if (is_host) {
 290                 dwc2_writel(hsotg, hr->hcfg, HCFG);
 291                 if (rmode)
 292                         pcgcctl |= PCGCTL_RESTOREMODE;
 293                 dwc2_writel(hsotg, pcgcctl, PCGCTL);
 294                 udelay(10);
 295
 296                 pcgcctl |= PCGCTL_ESS_REG_RESTORED;
 297                 dwc2_writel(hsotg, pcgcctl, PCGCTL);
 298                 udelay(10);
 299         } else {
 300                 dwc2_writel(hsotg, dr->dcfg, DCFG);
 301                 if (!rmode)
 302                         pcgcctl |= PCGCTL_RESTOREMODE | PCGCTL_RSTPDWNMODULE;
 303                 dwc2_writel(hsotg, pcgcctl, PCGCTL);
 304                 udelay(10);
 305
 306                 pcgcctl |= PCGCTL_ESS_REG_RESTORED;
 307                 dwc2_writel(hsotg, pcgcctl, PCGCTL);
 308                 udelay(10);
 309         }
 310 }
 311
 312 /**
 313  * dwc2_hib_restore_common() - Common part of restore routine.
 314  *
 315  * @hsotg: Programming view of the DWC_otg controller
 316  * @rem_wakeup: Remote-wakeup, enabled in case of remote-wakeup.
 317  * @is_host: Host or device mode.
 318  */
 319 void dwc2_hib_restore_common(struct dwc2_hsotg *hsotg, int rem_wakeup,
 320                              int is_host)
 321 {
 322         u32 gpwrdn;
 323
 324         /* Switch-on voltage to the core */
 325         gpwrdn = dwc2_readl(hsotg, GPWRDN);
 326         gpwrdn &= ~GPWRDN_PWRDNSWTCH;
 327         dwc2_writel(hsotg, gpwrdn, GPWRDN);
 328         udelay(10);
 329
 330         /* Reset core */
 331         gpwrdn = dwc2_readl(hsotg, GPWRDN);
 332         gpwrdn &= ~GPWRDN_PWRDNRSTN;
 333         dwc2_writel(hsotg, gpwrdn, GPWRDN);
 334         udelay(10);
 335
 336         /* Enable restore from PMU */
 337         gpwrdn = dwc2_readl(hsotg, GPWRDN);
 338         gpwrdn |= GPWRDN_RESTORE;
 339         dwc2_writel(hsotg, gpwrdn, GPWRDN);
 340         udelay(10);
 341
 342         /* Disable Power Down Clamp */
 343         gpwrdn = dwc2_readl(hsotg, GPWRDN);
 344         gpwrdn &= ~GPWRDN_PWRDNCLMP;
 345         dwc2_writel(hsotg, gpwrdn, GPWRDN);
 346         udelay(50);
 347
 348         if (!is_host && rem_wakeup)
 349                 udelay(70);
 350
 351         /* Deassert reset core */
 352         gpwrdn = dwc2_readl(hsotg, GPWRDN);
 353         gpwrdn |= GPWRDN_PWRDNRSTN;
 354         dwc2_writel(hsotg, gpwrdn, GPWRDN);
 355         udelay(10);
 356
 357         /* Disable PMU interrupt */
 358         gpwrdn = dwc2_readl(hsotg, GPWRDN);
 359         gpwrdn &= ~GPWRDN_PMUINTSEL;
 360         dwc2_writel(hsotg, gpwrdn, GPWRDN);
 361         udelay(10);
 362
 363         /* Set Restore Essential Regs bit in PCGCCTL register */
 364         dwc2_restore_essential_regs(hsotg, rem_wakeup, is_host);
 365
 366         /*
 367          * Wait For Restore_done Interrupt. This mechanism of polling the
 368          * interrupt is introduced to avoid any possible race conditions
 369          */
 370         if (dwc2_hsotg_wait_bit_set(hsotg, GINTSTS, GINTSTS_RESTOREDONE,
 371                                     20000)) {
 372                 dev_dbg(hsotg->dev,
 373                         "%s: Restore Done wan't generated here\n",
 374                         __func__);
 375         } else {
 376                 dev_dbg(hsotg->dev, "restore done  generated here\n");
 377         }
 378 }
 379
 380 /**
 381  * dwc2_wait_for_mode() - Waits for the controller mode.
 382  * @hsotg:      Programming view of the DWC_otg controller.
 383  * @host_mode:  If true, waits for host mode, otherwise device mode.
 384  */
 385 static void dwc2_wait_for_mode(struct dwc2_hsotg *hsotg,
 386                                bool host_mode)
 387 {
 388         ktime_t start;
 389         ktime_t end;
 390         unsigned int timeout = 110;
 391
 392         dev_vdbg(hsotg->dev, "Waiting for %s mode\n",
 393                  host_mode ? "host" : "device");
 394
 395         start = ktime_get();
 396
 397         while (1) {
 398                 s64 ms;
 399
 400                 if (dwc2_is_host_mode(hsotg) == host_mode) {
 401                         dev_vdbg(hsotg->dev, "%s mode set\n",
 402                                  host_mode ? "Host" : "Device");
 403                         break;
 404                 }
 405
 406                 end = ktime_get();
 407                 ms = ktime_to_ms(ktime_sub(end, start));
 408
 409                 if (ms >= (s64)timeout) {
 410                         dev_warn(hsotg->dev, "%s: Couldn't set %s mode\n",
 411                                  __func__, host_mode ? "host" : "device");
 412                         break;
 413                 }
 414
 415                 usleep_range(1000, 2000);
 416         }
 417 }
 418
 419 /**
 420  * dwc2_iddig_filter_enabled() - Returns true if the IDDIG debounce
 421  * filter is enabled.
 422  *
 423  * @hsotg: Programming view of DWC_otg controller
 424  */
 425 static bool dwc2_iddig_filter_enabled(struct dwc2_hsotg *hsotg)
 426 {
 427         u32 gsnpsid;
 428         u32 ghwcfg4;
 429
 430         if (!dwc2_hw_is_otg(hsotg))
 431                 return false;
 432
 433         /* Check if core configuration includes the IDDIG filter. */
 434         ghwcfg4 = dwc2_readl(hsotg, GHWCFG4);
 435         if (!(ghwcfg4 & GHWCFG4_IDDIG_FILT_EN))
 436                 return false;
 437
 438         /*
 439          * Check if the IDDIG debounce filter is bypassed. Available
 440          * in core version >= 3.10a.
 441          */
 442         gsnpsid = dwc2_readl(hsotg, GSNPSID);
 443         if (gsnpsid >= DWC2_CORE_REV_3_10a) {
 444                 u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);
 445
 446                 if (gotgctl & GOTGCTL_DBNCE_FLTR_BYPASS)
 447                         return false;
 448         }
 449
 450         return true;
 451 }
 452
 453 /*
 454  * dwc2_enter_hibernation() - Common function to enter hibernation.
 455  *
 456  * @hsotg: Programming view of the DWC_otg controller
 457  * @is_host: True if core is in host mode.
 458  *
 459  * Return: 0 if successful, negative error code otherwise
 460  */
 461 int dwc2_enter_hibernation(struct dwc2_hsotg *hsotg, int is_host)
 462 {
 463         if (hsotg->params.power_down != DWC2_POWER_DOWN_PARAM_HIBERNATION)
 464                 return -ENOTSUPP;
 465
 466         if (is_host)
 467                 return dwc2_host_enter_hibernation(hsotg);
 468         else
 469                 return dwc2_gadget_enter_hibernation(hsotg);
 470 }
 471
 472 /*
 473  * dwc2_exit_hibernation() - Common function to exit from hibernation.
 474  *
 475  * @hsotg: Programming view of the DWC_otg controller
 476  * @rem_wakeup: Remote-wakeup, enabled in case of remote-wakeup.
 477  * @reset: Enabled in case of restore with reset.
 478  * @is_host: True if core is in host mode.
 479  *
 480  * Return: 0 if successful, negative error code otherwise
 481  */
 482 int dwc2_exit_hibernation(struct dwc2_hsotg *hsotg, int rem_wakeup,
 483                           int reset, int is_host)
 484 {
 485         if (is_host)
 486                 return dwc2_host_exit_hibernation(hsotg, rem_wakeup, reset);
 487         else
 488                 return dwc2_gadget_exit_hibernation(hsotg, rem_wakeup, reset);
 489 }
 490
 491 /*
 492  * Do core a soft reset of the core.  Be careful with this because it
 493  * resets all the internal state machines of the core.
 494  */
 495 int dwc2_core_reset(struct dwc2_hsotg *hsotg, bool skip_wait)
 496 {
 497         u32 greset;
 498         bool wait_for_host_mode = false;
 499
 500         dev_vdbg(hsotg->dev, "%s()\n", __func__);
 501
 502         /*
 503          * If the current mode is host, either due to the force mode
 504          * bit being set (which persists after core reset) or the
 505          * connector id pin, a core soft reset will temporarily reset
 506          * the mode to device. A delay from the IDDIG debounce filter
 507          * will occur before going back to host mode.
 508          *
 509          * Determine whether we will go back into host mode after a
 510          * reset and account for this delay after the reset.
 511          */
 512         if (dwc2_iddig_filter_enabled(hsotg)) {
 513                 u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);
 514                 u32 gusbcfg = dwc2_readl(hsotg, GUSBCFG);
 515
 516                 if (!(gotgctl & GOTGCTL_CONID_B) ||
 517                     (gusbcfg & GUSBCFG_FORCEHOSTMODE)) {
 518                         wait_for_host_mode = true;
 519                 }
 520         }
 521
 522         /* Core Soft Reset */
 523         greset = dwc2_readl(hsotg, GRSTCTL);
 524         greset |= GRSTCTL_CSFTRST;
 525         dwc2_writel(hsotg, greset, GRSTCTL);
 526
 527         if (dwc2_hsotg_wait_bit_clear(hsotg, GRSTCTL, GRSTCTL_CSFTRST, 10000)) {
 528                 dev_warn(hsotg->dev, "%s: HANG! Soft Reset timeout GRSTCTL GRSTCTL_CSFTRST\n",
 529                          __func__);
 530                 return -EBUSY;
 531         }
 532
 533         /* Wait for AHB master IDLE state */
 534         if (dwc2_hsotg_wait_bit_set(hsotg, GRSTCTL, GRSTCTL_AHBIDLE, 10000)) {
 535                 dev_warn(hsotg->dev, "%s: HANG! AHB Idle timeout GRSTCTL GRSTCTL_AHBIDLE\n",
 536                          __func__);
 537                 return -EBUSY;
 538         }
 539
 540         if (wait_for_host_mode && !skip_wait)
 541                 dwc2_wait_for_mode(hsotg, true);
 542
 543         return 0;
 544 }
 545
 546 /**
 547  * dwc2_force_mode() - Force the mode of the controller.
 548  *
 549  * Forcing the mode is needed for two cases:
 550  *
 551  * 1) If the dr_mode is set to either HOST or PERIPHERAL we force the
 552  * controller to stay in a particular mode regardless of ID pin
 553  * changes. We do this once during probe.
 554  *
 555  * 2) During probe we want to read reset values of the hw
 556  * configuration registers that are only available in either host or
 557  * device mode. We may need to force the mode if the current mode does
 558  * not allow us to access the register in the mode that we want.
 559  *
 560  * In either case it only makes sense to force the mode if the
 561  * controller hardware is OTG capable.
 562  *
 563  * Checks are done in this function to determine whether doing a force
 564  * would be valid or not.
 565  *
 566  * If a force is done, it requires a IDDIG debounce filter delay if
 567  * the filter is configured and enabled. We poll the current mode of
 568  * the controller to account for this delay.
 569  *
 570  * @hsotg: Programming view of DWC_otg controller
 571  * @host: Host mode flag
 572  */
 573 void dwc2_force_mode(struct dwc2_hsotg *hsotg, bool host)
 574 {
 575         u32 gusbcfg;
 576         u32 set;
 577         u32 clear;
 578
 579         dev_dbg(hsotg->dev, "Forcing mode to %s\n", host ? "host" : "device");
 580
 581         /*
 582          * Force mode has no effect if the hardware is not OTG.
 583          */
 584         if (!dwc2_hw_is_otg(hsotg))
 585                 return;
 586
 587         /*
 588          * If dr_mode is either peripheral or host only, there is no
 589          * need to ever force the mode to the opposite mode.
 590          */
 591         if (WARN_ON(host && hsotg->dr_mode == USB_DR_MODE_PERIPHERAL))
 592                 return;
 593
 594         if (WARN_ON(!host && hsotg->dr_mode == USB_DR_MODE_HOST))
 595                 return;
 596
 597         gusbcfg = dwc2_readl(hsotg, GUSBCFG);
 598
 599         set = host ? GUSBCFG_FORCEHOSTMODE : GUSBCFG_FORCEDEVMODE;
 600         clear = host ? GUSBCFG_FORCEDEVMODE : GUSBCFG_FORCEHOSTMODE;
 601
 602         gusbcfg &= ~clear;
 603         gusbcfg |= set;
 604         dwc2_writel(hsotg, gusbcfg, GUSBCFG);
 605
 606         dwc2_wait_for_mode(hsotg, host);
 607         return;
 608 }
 609
 610 /**
 611  * dwc2_clear_force_mode() - Clears the force mode bits.
 612  *
 613  * After clearing the bits, wait up to 100 ms to account for any
 614  * potential IDDIG filter delay. We can't know if we expect this delay
 615  * or not because the value of the connector ID status is affected by
 616  * the force mode. We only need to call this once during probe if
 617  * dr_mode == OTG.
 618  *
 619  * @hsotg: Programming view of DWC_otg controller
 620  */
 621 static void dwc2_clear_force_mode(struct dwc2_hsotg *hsotg)
 622 {
 623         u32 gusbcfg;
 624
 625         if (!dwc2_hw_is_otg(hsotg))
 626                 return;
 627
 628         dev_dbg(hsotg->dev, "Clearing force mode bits\n");
 629
 630         gusbcfg = dwc2_readl(hsotg, GUSBCFG);
 631         gusbcfg &= ~GUSBCFG_FORCEHOSTMODE;
 632         gusbcfg &= ~GUSBCFG_FORCEDEVMODE;
 633         dwc2_writel(hsotg, gusbcfg, GUSBCFG);
 634
 635         if (dwc2_iddig_filter_enabled(hsotg))
 636                 msleep(100);
 637 }
 638
 639 /*
 640  * Sets or clears force mode based on the dr_mode parameter.
 641  */
 642 void dwc2_force_dr_mode(struct dwc2_hsotg *hsotg)
 643 {
 644         switch (hsotg->dr_mode) {
 645         case USB_DR_MODE_HOST:
 646                 /*
 647                  * NOTE: This is required for some rockchip soc based
 648                  * platforms on their host-only dwc2.
 649                  */
 650                 if (!dwc2_hw_is_otg(hsotg))
 651                         msleep(50);
 652
 653                 break;
 654         case USB_DR_MODE_PERIPHERAL:
 655                 dwc2_force_mode(hsotg, false);
 656                 break;
 657         case USB_DR_MODE_OTG:
 658                 dwc2_clear_force_mode(hsotg);
 659                 break;
 660         default:
 661                 dev_warn(hsotg->dev, "%s() Invalid dr_mode=%d\n",
 662                          __func__, hsotg->dr_mode);
 663                 break;
 664         }
 665 }
 666
 667 /*
 668  * dwc2_enable_acg - enable active clock gating feature
 669  */
 670 void dwc2_enable_acg(struct dwc2_hsotg *hsotg)
 671 {
 672         if (hsotg->params.acg_enable) {
 673                 u32 pcgcctl1 = dwc2_readl(hsotg, PCGCCTL1);
 674
 675                 dev_dbg(hsotg->dev, "Enabling Active Clock Gating\n");
 676                 pcgcctl1 |= PCGCCTL1_GATEEN;
 677                 dwc2_writel(hsotg, pcgcctl1, PCGCCTL1);
 678         }
 679 }
 680
 681 /**
 682  * dwc2_dump_host_registers() - Prints the host registers
 683  *
 684  * @hsotg: Programming view of DWC_otg controller
 685  *
 686  * NOTE: This function will be removed once the peripheral controller code
 687  * is integrated and the driver is stable
 688  */
 689 void dwc2_dump_host_registers(struct dwc2_hsotg *hsotg)
 690 {
 691 #ifdef DEBUG
 692         u32 __iomem *addr;
 693         int i;
 694
 695         dev_dbg(hsotg->dev, "Host Global Registers\n");
 696         addr = hsotg->regs + HCFG;
 697         dev_dbg(hsotg->dev, "HCFG        @0x%08lX : 0x%08X\n",
 698                 (unsigned long)addr, dwc2_readl(hsotg, HCFG));
 699         addr = hsotg->regs + HFIR;
 700         dev_dbg(hsotg->dev, "HFIR        @0x%08lX : 0x%08X\n",
 701                 (unsigned long)addr, dwc2_readl(hsotg, HFIR));
 702         addr = hsotg->regs + HFNUM;
 703         dev_dbg(hsotg->dev, "HFNUM       @0x%08lX : 0x%08X\n",
 704                 (unsigned long)addr, dwc2_readl(hsotg, HFNUM));
 705         addr = hsotg->regs + HPTXSTS;
 706         dev_dbg(hsotg->dev, "HPTXSTS     @0x%08lX : 0x%08X\n",
 707                 (unsigned long)addr, dwc2_readl(hsotg, HPTXSTS));
 708         addr = hsotg->regs + HAINT;
 709         dev_dbg(hsotg->dev, "HAINT       @0x%08lX : 0x%08X\n",
 710                 (unsigned long)addr, dwc2_readl(hsotg, HAINT));
 711         addr = hsotg->regs + HAINTMSK;
 712         dev_dbg(hsotg->dev, "HAINTMSK    @0x%08lX : 0x%08X\n",
 713                 (unsigned long)addr, dwc2_readl(hsotg, HAINTMSK));
 714         if (hsotg->params.dma_desc_enable) {
 715                 addr = hsotg->regs + HFLBADDR;
 716                 dev_dbg(hsotg->dev, "HFLBADDR @0x%08lX : 0x%08X\n",
 717                         (unsigned long)addr, dwc2_readl(hsotg, HFLBADDR));
 718         }
 719
 720         addr = hsotg->regs + HPRT0;
 721         dev_dbg(hsotg->dev, "HPRT0       @0x%08lX : 0x%08X\n",
 722                 (unsigned long)addr, dwc2_readl(hsotg, HPRT0));
 723
 724         for (i = 0; i < hsotg->params.host_channels; i++) {
 725                 dev_dbg(hsotg->dev, "Host Channel %d Specific Registers\n", i);
 726                 addr = hsotg->regs + HCCHAR(i);
 727                 dev_dbg(hsotg->dev, "HCCHAR      @0x%08lX : 0x%08X\n",
 728                         (unsigned long)addr, dwc2_readl(hsotg, HCCHAR(i)));
 729                 addr = hsotg->regs + HCSPLT(i);
 730                 dev_dbg(hsotg->dev, "HCSPLT      @0x%08lX : 0x%08X\n",
 731                         (unsigned long)addr, dwc2_readl(hsotg, HCSPLT(i)));
 732                 addr = hsotg->regs + HCINT(i);
 733                 dev_dbg(hsotg->dev, "HCINT       @0x%08lX : 0x%08X\n",
 734                         (unsigned long)addr, dwc2_readl(hsotg, HCINT(i)));
 735                 addr = hsotg->regs + HCINTMSK(i);
 736                 dev_dbg(hsotg->dev, "HCINTMSK    @0x%08lX : 0x%08X\n",
 737                         (unsigned long)addr, dwc2_readl(hsotg, HCINTMSK(i)));
 738                 addr = hsotg->regs + HCTSIZ(i);
 739                 dev_dbg(hsotg->dev, "HCTSIZ      @0x%08lX : 0x%08X\n",
 740                         (unsigned long)addr, dwc2_readl(hsotg, HCTSIZ(i)));
 741                 addr = hsotg->regs + HCDMA(i);
 742                 dev_dbg(hsotg->dev, "HCDMA       @0x%08lX : 0x%08X\n",
 743                         (unsigned long)addr, dwc2_readl(hsotg, HCDMA(i)));
 744                 if (hsotg->params.dma_desc_enable) {
 745                         addr = hsotg->regs + HCDMAB(i);
 746                         dev_dbg(hsotg->dev, "HCDMAB      @0x%08lX : 0x%08X\n",
 747                                 (unsigned long)addr, dwc2_readl(hsotg,
 748                                                                 HCDMAB(i)));
 749                 }
 750         }
 751 #endif
 752 }
 753
 754 /**
 755  * dwc2_dump_global_registers() - Prints the core global registers
 756  *
 757  * @hsotg: Programming view of DWC_otg controller
 758  *
 759  * NOTE: This function will be removed once the peripheral controller code
 760  * is integrated and the driver is stable
 761  */
 762 void dwc2_dump_global_registers(struct dwc2_hsotg *hsotg)
 763 {
 764 #ifdef DEBUG
 765         u32 __iomem *addr;
 766
 767         dev_dbg(hsotg->dev, "Core Global Registers\n");
 768         addr = hsotg->regs + GOTGCTL;
 769         dev_dbg(hsotg->dev, "GOTGCTL     @0x%08lX : 0x%08X\n",
 770                 (unsigned long)addr, dwc2_readl(hsotg, GOTGCTL));
 771         addr = hsotg->regs + GOTGINT;
 772         dev_dbg(hsotg->dev, "GOTGINT     @0x%08lX : 0x%08X\n",
 773                 (unsigned long)addr, dwc2_readl(hsotg, GOTGINT));
 774         addr = hsotg->regs + GAHBCFG;
 775         dev_dbg(hsotg->dev, "GAHBCFG     @0x%08lX : 0x%08X\n",
 776                 (unsigned long)addr, dwc2_readl(hsotg, GAHBCFG));
 777         addr = hsotg->regs + GUSBCFG;
 778         dev_dbg(hsotg->dev, "GUSBCFG     @0x%08lX : 0x%08X\n",
 779                 (unsigned long)addr, dwc2_readl(hsotg, GUSBCFG));
 780         addr = hsotg->regs + GRSTCTL;
 781         dev_dbg(hsotg->dev, "GRSTCTL     @0x%08lX : 0x%08X\n",
 782                 (unsigned long)addr, dwc2_readl(hsotg, GRSTCTL));
 783         addr = hsotg->regs + GINTSTS;
 784         dev_dbg(hsotg->dev, "GINTSTS     @0x%08lX : 0x%08X\n",
 785                 (unsigned long)addr, dwc2_readl(hsotg, GINTSTS));
 786         addr = hsotg->regs + GINTMSK;
 787         dev_dbg(hsotg->dev, "GINTMSK     @0x%08lX : 0x%08X\n",
 788                 (unsigned long)addr, dwc2_readl(hsotg, GINTMSK));
 789         addr = hsotg->regs + GRXSTSR;
 790         dev_dbg(hsotg->dev, "GRXSTSR     @0x%08lX : 0x%08X\n",
 791                 (unsigned long)addr, dwc2_readl(hsotg, GRXSTSR));
 792         addr = hsotg->regs + GRXFSIZ;
 793         dev_dbg(hsotg->dev, "GRXFSIZ     @0x%08lX : 0x%08X\n",
 794                 (unsigned long)addr, dwc2_readl(hsotg, GRXFSIZ));
 795         addr = hsotg->regs + GNPTXFSIZ;
 796         dev_dbg(hsotg->dev, "GNPTXFSIZ   @0x%08lX : 0x%08X\n",
 797                 (unsigned long)addr, dwc2_readl(hsotg, GNPTXFSIZ));
 798         addr = hsotg->regs + GNPTXSTS;
 799         dev_dbg(hsotg->dev, "GNPTXSTS    @0x%08lX : 0x%08X\n",
 800                 (unsigned long)addr, dwc2_readl(hsotg, GNPTXSTS));
 801         addr = hsotg->regs + GI2CCTL;
 802         dev_dbg(hsotg->dev, "GI2CCTL     @0x%08lX : 0x%08X\n",
 803                 (unsigned long)addr, dwc2_readl(hsotg, GI2CCTL));
 804         addr = hsotg->regs + GPVNDCTL;
 805         dev_dbg(hsotg->dev, "GPVNDCTL    @0x%08lX : 0x%08X\n",
 806                 (unsigned long)addr, dwc2_readl(hsotg, GPVNDCTL));
 807         addr = hsotg->regs + GGPIO;
 808         dev_dbg(hsotg->dev, "GGPIO       @0x%08lX : 0x%08X\n",
 809                 (unsigned long)addr, dwc2_readl(hsotg, GGPIO));
 810         addr = hsotg->regs + GUID;
 811         dev_dbg(hsotg->dev, "GUID        @0x%08lX : 0x%08X\n",
 812                 (unsigned long)addr, dwc2_readl(hsotg, GUID));
 813         addr = hsotg->regs + GSNPSID;
 814         dev_dbg(hsotg->dev, "GSNPSID     @0x%08lX : 0x%08X\n",
 815                 (unsigned long)addr, dwc2_readl(hsotg, GSNPSID));
 816         addr = hsotg->regs + GHWCFG1;
 817         dev_dbg(hsotg->dev, "GHWCFG1     @0x%08lX : 0x%08X\n",
 818                 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG1));
 819         addr = hsotg->regs + GHWCFG2;
 820         dev_dbg(hsotg->dev, "GHWCFG2     @0x%08lX : 0x%08X\n",
 821                 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG2));
 822         addr = hsotg->regs + GHWCFG3;
 823         dev_dbg(hsotg->dev, "GHWCFG3     @0x%08lX : 0x%08X\n",
 824                 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG3));
 825         addr = hsotg->regs + GHWCFG4;
 826         dev_dbg(hsotg->dev, "GHWCFG4     @0x%08lX : 0x%08X\n",
 827                 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG4));
 828         addr = hsotg->regs + GLPMCFG;
 829         dev_dbg(hsotg->dev, "GLPMCFG     @0x%08lX : 0x%08X\n",
 830                 (unsigned long)addr, dwc2_readl(hsotg, GLPMCFG));
 831         addr = hsotg->regs + GPWRDN;
 832         dev_dbg(hsotg->dev, "GPWRDN      @0x%08lX : 0x%08X\n",
 833                 (unsigned long)addr, dwc2_readl(hsotg, GPWRDN));
 834         addr = hsotg->regs + GDFIFOCFG;
 835         dev_dbg(hsotg->dev, "GDFIFOCFG   @0x%08lX : 0x%08X\n",
 836                 (unsigned long)addr, dwc2_readl(hsotg, GDFIFOCFG));
 837         addr = hsotg->regs + HPTXFSIZ;
 838         dev_dbg(hsotg->dev, "HPTXFSIZ    @0x%08lX : 0x%08X\n",
 839                 (unsigned long)addr, dwc2_readl(hsotg, HPTXFSIZ));
 840
 841         addr = hsotg->regs + PCGCTL;
 842         dev_dbg(hsotg->dev, "PCGCTL      @0x%08lX : 0x%08X\n",
 843                 (unsigned long)addr, dwc2_readl(hsotg, PCGCTL));
 844 #endif
 845 }
 846
 847 /**
 848  * dwc2_flush_tx_fifo() - Flushes a Tx FIFO
 849  *
 850  * @hsotg: Programming view of DWC_otg controller
 851  * @num:   Tx FIFO to flush
 852  */
 853 void dwc2_flush_tx_fifo(struct dwc2_hsotg *hsotg, const int num)
 854 {
 855         u32 greset;
 856
 857         dev_vdbg(hsotg->dev, "Flush Tx FIFO %d\n", num);
 858
 859         /* Wait for AHB master IDLE state */
 860         if (dwc2_hsotg_wait_bit_set(hsotg, GRSTCTL, GRSTCTL_AHBIDLE, 10000))
 861                 dev_warn(hsotg->dev, "%s:  HANG! AHB Idle GRSCTL\n",
 862                          __func__);
 863
 864         greset = GRSTCTL_TXFFLSH;
 865         greset |= num << GRSTCTL_TXFNUM_SHIFT & GRSTCTL_TXFNUM_MASK;
 866         dwc2_writel(hsotg, greset, GRSTCTL);
 867
 868         if (dwc2_hsotg_wait_bit_clear(hsotg, GRSTCTL, GRSTCTL_TXFFLSH, 10000))
 869                 dev_warn(hsotg->dev, "%s:  HANG! timeout GRSTCTL GRSTCTL_TXFFLSH\n",
 870                          __func__);
 871
 872         /* Wait for at least 3 PHY Clocks */
 873         udelay(1);
 874 }
 875
 876 /**
 877  * dwc2_flush_rx_fifo() - Flushes the Rx FIFO
 878  *
 879  * @hsotg: Programming view of DWC_otg controller
 880  */
 881 void dwc2_flush_rx_fifo(struct dwc2_hsotg *hsotg)
 882 {
 883         u32 greset;
 884
 885         dev_vdbg(hsotg->dev, "%s()\n", __func__);
 886
 887         /* Wait for AHB master IDLE state */
 888         if (dwc2_hsotg_wait_bit_set(hsotg, GRSTCTL, GRSTCTL_AHBIDLE, 10000))
 889                 dev_warn(hsotg->dev, "%s:  HANG! AHB Idle GRSCTL\n",
 890                          __func__);
 891
 892         greset = GRSTCTL_RXFFLSH;
 893         dwc2_writel(hsotg, greset, GRSTCTL);
 894
 895         /* Wait for RxFIFO flush done */
 896         if (dwc2_hsotg_wait_bit_clear(hsotg, GRSTCTL, GRSTCTL_RXFFLSH, 10000))
 897                 dev_warn(hsotg->dev, "%s: HANG! timeout GRSTCTL GRSTCTL_RXFFLSH\n",
 898                          __func__);
 899
 900         /* Wait for at least 3 PHY Clocks */
 901         udelay(1);
 902 }
 903
 904 bool dwc2_is_controller_alive(struct dwc2_hsotg *hsotg)
 905 {
 906         if (dwc2_readl(hsotg, GSNPSID) == 0xffffffff)
 907                 return false;
 908         else
 909                 return true;
 910 }
 911
 912 /**
 913  * dwc2_enable_global_interrupts() - Enables the controller's Global
 914  * Interrupt in the AHB Config register
 915  *
 916  * @hsotg: Programming view of DWC_otg controller
 917  */
 918 void dwc2_enable_global_interrupts(struct dwc2_hsotg *hsotg)
 919 {
 920         u32 ahbcfg = dwc2_readl(hsotg, GAHBCFG);
 921
 922         ahbcfg |= GAHBCFG_GLBL_INTR_EN;
 923         dwc2_writel(hsotg, ahbcfg, GAHBCFG);
 924 }
 925
 926 /**
 927  * dwc2_disable_global_interrupts() - Disables the controller's Global
 928  * Interrupt in the AHB Config register
 929  *
 930  * @hsotg: Programming view of DWC_otg controller
 931  */
 932 void dwc2_disable_global_interrupts(struct dwc2_hsotg *hsotg)
 933 {
 934         u32 ahbcfg = dwc2_readl(hsotg, GAHBCFG);
 935
 936         ahbcfg &= ~GAHBCFG_GLBL_INTR_EN;
 937         dwc2_writel(hsotg, ahbcfg, GAHBCFG);
 938 }
 939
 940 /* Returns the controller's GHWCFG2.OTG_MODE. */
 941 unsigned int dwc2_op_mode(struct dwc2_hsotg *hsotg)
 942 {
 943         u32 ghwcfg2 = dwc2_readl(hsotg, GHWCFG2);
 944
 945         return (ghwcfg2 & GHWCFG2_OP_MODE_MASK) >>
 946                 GHWCFG2_OP_MODE_SHIFT;
 947 }
 948
 949 /* Returns true if the controller is capable of DRD. */
 950 bool dwc2_hw_is_otg(struct dwc2_hsotg *hsotg)
 951 {
 952         unsigned int op_mode = dwc2_op_mode(hsotg);
 953
 954         return (op_mode == GHWCFG2_OP_MODE_HNP_SRP_CAPABLE) ||
 955                 (op_mode == GHWCFG2_OP_MODE_SRP_ONLY_CAPABLE) ||
 956                 (op_mode == GHWCFG2_OP_MODE_NO_HNP_SRP_CAPABLE);
 957 }
 958
 959 /* Returns true if the controller is host-only. */
 960 bool dwc2_hw_is_host(struct dwc2_hsotg *hsotg)
 961 {
 962         unsigned int op_mode = dwc2_op_mode(hsotg);
 963
 964         return (op_mode == GHWCFG2_OP_MODE_SRP_CAPABLE_HOST) ||
 965                 (op_mode == GHWCFG2_OP_MODE_NO_SRP_CAPABLE_HOST);
 966 }
 967
 968 /* Returns true if the controller is device-only. */
 969 bool dwc2_hw_is_device(struct dwc2_hsotg *hsotg)
 970 {
 971         unsigned int op_mode = dwc2_op_mode(hsotg);
 972
 973         return (op_mode == GHWCFG2_OP_MODE_SRP_CAPABLE_DEVICE) ||
 974                 (op_mode == GHWCFG2_OP_MODE_NO_SRP_CAPABLE_DEVICE);
 975 }
 976
 977 /**
 978  * dwc2_hsotg_wait_bit_set - Waits for bit to be set.
 979  * @hsotg: Programming view of DWC_otg controller.
 980  * @offset: Register's offset where bit/bits must be set.
 981  * @mask: Mask of the bit/bits which must be set.
 982  * @timeout: Timeout to wait.
 983  *
 984  * Return: 0 if bit/bits are set or -ETIMEDOUT in case of timeout.
 985  */
 986 int dwc2_hsotg_wait_bit_set(struct dwc2_hsotg *hsotg, u32 offset, u32 mask,
 987                             u32 timeout)
 988 {
 989         u32 i;
 990
 991         for (i = 0; i < timeout; i++) {
 992                 if (dwc2_readl(hsotg, offset) & mask)
 993                         return 0;
 994                 udelay(1);
 995         }
 996
 997         return -ETIMEDOUT;
 998 }
 999
1000 /**
1001  * dwc2_hsotg_wait_bit_clear - Waits for bit to be clear.
1002  * @hsotg: Programming view of DWC_otg controller.
1003  * @offset: Register's offset where bit/bits must be set.
1004  * @mask: Mask of the bit/bits which must be set.
1005  * @timeout: Timeout to wait.
1006  *
1007  * Return: 0 if bit/bits are set or -ETIMEDOUT in case of timeout.
1008  */
1009 int dwc2_hsotg_wait_bit_clear(struct dwc2_hsotg *hsotg, u32 offset, u32 mask,
1010                               u32 timeout)
1011 {
1012         u32 i;
1013
1014         for (i = 0; i < timeout; i++) {
1015                 if (!(dwc2_readl(hsotg, offset) & mask))
1016                         return 0;
1017                 udelay(1);
1018         }
1019
1020         return -ETIMEDOUT;
1021 }
1022
1023 /*
1024  * Initializes the FSLSPClkSel field of the HCFG register depending on the
1025  * PHY type
1026  */
1027 void dwc2_init_fs_ls_pclk_sel(struct dwc2_hsotg *hsotg)
1028 {
1029         u32 hcfg, val;
1030
1031         if ((hsotg->hw_params.hs_phy_type == GHWCFG2_HS_PHY_TYPE_ULPI &&
1032              hsotg->hw_params.fs_phy_type == GHWCFG2_FS_PHY_TYPE_DEDICATED &&
1033              hsotg->params.ulpi_fs_ls) ||
1034             hsotg->params.phy_type == DWC2_PHY_TYPE_PARAM_FS) {
1035                 /* Full speed PHY */
1036                 val = HCFG_FSLSPCLKSEL_48_MHZ;
1037         } else {
1038                 /* High speed PHY running at full speed or high speed */
1039                 val = HCFG_FSLSPCLKSEL_30_60_MHZ;
1040         }
1041
1042         dev_dbg(hsotg->dev, "Initializing HCFG.FSLSPClkSel to %08x\n", val);
1043         hcfg = dwc2_readl(hsotg, HCFG);
1044         hcfg &= ~HCFG_FSLSPCLKSEL_MASK;
1045         hcfg |= val << HCFG_FSLSPCLKSEL_SHIFT;
1046         dwc2_writel(hsotg, hcfg, HCFG);
1047 }
1048
1049 static int dwc2_fs_phy_init(struct dwc2_hsotg *hsotg, bool select_phy)
1050 {
1051         u32 usbcfg, ggpio, i2cctl;
1052         int retval = 0;
1053
1054         /*
1055          * core_init() is now called on every switch so only call the
1056          * following for the first time through
1057          */
1058         if (select_phy) {
1059                 dev_dbg(hsotg->dev, "FS PHY selected\n");
1060
1061                 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1062                 if (!(usbcfg & GUSBCFG_PHYSEL)) {
1063                         usbcfg |= GUSBCFG_PHYSEL;
1064                         dwc2_writel(hsotg, usbcfg, GUSBCFG);
1065
1066                         /* Reset after a PHY select */
1067                         retval = dwc2_core_reset(hsotg, false);
1068
1069                         if (retval) {
1070                                 dev_err(hsotg->dev,
1071                                         "%s: Reset failed, aborting", __func__);
1072                                 return retval;
1073                         }
1074                 }
1075
1076                 if (hsotg->params.activate_stm_fs_transceiver) {
1077                         ggpio = dwc2_readl(hsotg, GGPIO);
1078                         if (!(ggpio & GGPIO_STM32_OTG_GCCFG_PWRDWN)) {
1079                                 dev_dbg(hsotg->dev, "Activating transceiver\n");
1080                                 /*
1081                                  * STM32F4x9 uses the GGPIO register as general
1082                                  * core configuration register.
1083                                  */
1084                                 ggpio |= GGPIO_STM32_OTG_GCCFG_PWRDWN;
1085                                 dwc2_writel(hsotg, ggpio, GGPIO);
1086                         }
1087                 }
1088         }
1089
1090         /*
1091          * Program DCFG.DevSpd or HCFG.FSLSPclkSel to 48Mhz in FS. Also
1092          * do this on HNP Dev/Host mode switches (done in dev_init and
1093          * host_init).
1094          */
1095         if (dwc2_is_host_mode(hsotg))
1096                 dwc2_init_fs_ls_pclk_sel(hsotg);
1097
1098         if (hsotg->params.i2c_enable) {
1099                 dev_dbg(hsotg->dev, "FS PHY enabling I2C\n");
1100
1101                 /* Program GUSBCFG.OtgUtmiFsSel to I2C */
1102                 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1103                 usbcfg |= GUSBCFG_OTG_UTMI_FS_SEL;
1104                 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1105
1106                 /* Program GI2CCTL.I2CEn */
1107                 i2cctl = dwc2_readl(hsotg, GI2CCTL);
1108                 i2cctl &= ~GI2CCTL_I2CDEVADDR_MASK;
1109                 i2cctl |= 1 << GI2CCTL_I2CDEVADDR_SHIFT;
1110                 i2cctl &= ~GI2CCTL_I2CEN;
1111                 dwc2_writel(hsotg, i2cctl, GI2CCTL);
1112                 i2cctl |= GI2CCTL_I2CEN;
1113                 dwc2_writel(hsotg, i2cctl, GI2CCTL);
1114         }
1115
1116         return retval;
1117 }
1118
1119 static int dwc2_hs_phy_init(struct dwc2_hsotg *hsotg, bool select_phy)
1120 {
1121         u32 usbcfg, usbcfg_old;
1122         int retval = 0;
1123
1124         if (!select_phy)
1125                 return 0;
1126
1127         usbcfg = dwc2_readl(hsotg, GUSBCFG);
1128         usbcfg_old = usbcfg;
1129
1130         /*
1131          * HS PHY parameters. These parameters are preserved during soft reset
1132          * so only program the first time. Do a soft reset immediately after
1133          * setting phyif.
1134          */
1135         switch (hsotg->params.phy_type) {
1136         case DWC2_PHY_TYPE_PARAM_ULPI:
1137                 /* ULPI interface */
1138                 dev_dbg(hsotg->dev, "HS ULPI PHY selected\n");
1139                 usbcfg |= GUSBCFG_ULPI_UTMI_SEL;
1140                 usbcfg &= ~(GUSBCFG_PHYIF16 | GUSBCFG_DDRSEL);
1141                 if (hsotg->params.phy_ulpi_ddr)
1142                         usbcfg |= GUSBCFG_DDRSEL;
1143
1144                 /* Set external VBUS indicator as needed. */
1145                 if (hsotg->params.oc_disable)
1146                         usbcfg |= (GUSBCFG_ULPI_INT_VBUS_IND |
1147                                    GUSBCFG_INDICATORPASSTHROUGH);
1148                 break;
1149         case DWC2_PHY_TYPE_PARAM_UTMI:
1150                 /* UTMI+ interface */
1151                 dev_dbg(hsotg->dev, "HS UTMI+ PHY selected\n");
1152                 usbcfg &= ~(GUSBCFG_ULPI_UTMI_SEL | GUSBCFG_PHYIF16);
1153                 if (hsotg->params.phy_utmi_width == 16)
1154                         usbcfg |= GUSBCFG_PHYIF16;
1155
1156                 /* Set turnaround time */
1157                 if (dwc2_is_device_mode(hsotg)) {
1158                         usbcfg &= ~GUSBCFG_USBTRDTIM_MASK;
1159                         if (hsotg->params.phy_utmi_width == 16)
1160                                 usbcfg |= 5 << GUSBCFG_USBTRDTIM_SHIFT;
1161                         else
1162                                 usbcfg |= 9 << GUSBCFG_USBTRDTIM_SHIFT;
1163                 }
1164                 break;
1165         default:
1166                 dev_err(hsotg->dev, "FS PHY selected at HS!\n");
1167                 break;
1168         }
1169
1170         if (usbcfg != usbcfg_old) {
1171                 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1172
1173                 /* Reset after setting the PHY parameters */
1174                 retval = dwc2_core_reset(hsotg, false);
1175                 if (retval) {
1176                         dev_err(hsotg->dev,
1177                                 "%s: Reset failed, aborting", __func__);
1178                         return retval;
1179                 }
1180         }
1181
1182         return retval;
1183 }
1184
1185 int dwc2_phy_init(struct dwc2_hsotg *hsotg, bool select_phy)
1186 {
1187         u32 usbcfg;
1188         int retval = 0;
1189
1190         if ((hsotg->params.speed == DWC2_SPEED_PARAM_FULL ||
1191              hsotg->params.speed == DWC2_SPEED_PARAM_LOW) &&
1192             hsotg->params.phy_type == DWC2_PHY_TYPE_PARAM_FS) {
1193                 /* If FS/LS mode with FS/LS PHY */
1194                 retval = dwc2_fs_phy_init(hsotg, select_phy);
1195                 if (retval)
1196                         return retval;
1197         } else {
1198                 /* High speed PHY */
1199                 retval = dwc2_hs_phy_init(hsotg, select_phy);
1200                 if (retval)
1201                         return retval;
1202         }
1203
1204         if (hsotg->hw_params.hs_phy_type == GHWCFG2_HS_PHY_TYPE_ULPI &&
1205             hsotg->hw_params.fs_phy_type == GHWCFG2_FS_PHY_TYPE_DEDICATED &&
1206             hsotg->params.ulpi_fs_ls) {
1207                 dev_dbg(hsotg->dev, "Setting ULPI FSLS\n");
1208                 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1209                 usbcfg |= GUSBCFG_ULPI_FS_LS;
1210                 usbcfg |= GUSBCFG_ULPI_CLK_SUSP_M;
1211                 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1212         } else {
1213                 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1214                 usbcfg &= ~GUSBCFG_ULPI_FS_LS;
1215                 usbcfg &= ~GUSBCFG_ULPI_CLK_SUSP_M;
1216                 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1217         }
1218
1219         return retval;
1220 }
1221
1222 MODULE_DESCRIPTION("DESIGNWARE HS OTG Core");
1223 MODULE_AUTHOR("Synopsys, Inc.");
1224 MODULE_LICENSE("Dual BSD/GPL");