Linux Audio

Check our new training course

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