xref: /linux/drivers/usb/dwc2/platform.c (revision ca9e742b5c27c230b0bf003aecba2433a60ba837)
1 // SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
2 /*
3  * platform.c - DesignWare HS OTG Controller platform driver
4  *
5  * Copyright (C) Matthijs Kooijman <matthijs@stdin.nl>
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 #include <linux/kernel.h>
39 #include <linux/module.h>
40 #include <linux/slab.h>
41 #include <linux/clk.h>
42 #include <linux/device.h>
43 #include <linux/dma-mapping.h>
44 #include <linux/of_device.h>
45 #include <linux/mutex.h>
46 #include <linux/platform_device.h>
47 #include <linux/phy/phy.h>
48 #include <linux/platform_data/s3c-hsotg.h>
49 #include <linux/reset.h>
50 
51 #include <linux/usb/of.h>
52 
53 #include "core.h"
54 #include "hcd.h"
55 #include "debug.h"
56 
57 static const char dwc2_driver_name[] = "dwc2";
58 
59 /*
60  * Check the dr_mode against the module configuration and hardware
61  * capabilities.
62  *
63  * The hardware, module, and dr_mode, can each be set to host, device,
64  * or otg. Check that all these values are compatible and adjust the
65  * value of dr_mode if possible.
66  *
67  *                      actual
68  *    HW  MOD dr_mode   dr_mode
69  *  ------------------------------
70  *   HST  HST  any    :  HST
71  *   HST  DEV  any    :  ---
72  *   HST  OTG  any    :  HST
73  *
74  *   DEV  HST  any    :  ---
75  *   DEV  DEV  any    :  DEV
76  *   DEV  OTG  any    :  DEV
77  *
78  *   OTG  HST  any    :  HST
79  *   OTG  DEV  any    :  DEV
80  *   OTG  OTG  any    :  dr_mode
81  */
82 static int dwc2_get_dr_mode(struct dwc2_hsotg *hsotg)
83 {
84 	enum usb_dr_mode mode;
85 
86 	hsotg->dr_mode = usb_get_dr_mode(hsotg->dev);
87 	if (hsotg->dr_mode == USB_DR_MODE_UNKNOWN)
88 		hsotg->dr_mode = USB_DR_MODE_OTG;
89 
90 	mode = hsotg->dr_mode;
91 
92 	if (dwc2_hw_is_device(hsotg)) {
93 		if (IS_ENABLED(CONFIG_USB_DWC2_HOST)) {
94 			dev_err(hsotg->dev,
95 				"Controller does not support host mode.\n");
96 			return -EINVAL;
97 		}
98 		mode = USB_DR_MODE_PERIPHERAL;
99 	} else if (dwc2_hw_is_host(hsotg)) {
100 		if (IS_ENABLED(CONFIG_USB_DWC2_PERIPHERAL)) {
101 			dev_err(hsotg->dev,
102 				"Controller does not support device mode.\n");
103 			return -EINVAL;
104 		}
105 		mode = USB_DR_MODE_HOST;
106 	} else {
107 		if (IS_ENABLED(CONFIG_USB_DWC2_HOST))
108 			mode = USB_DR_MODE_HOST;
109 		else if (IS_ENABLED(CONFIG_USB_DWC2_PERIPHERAL))
110 			mode = USB_DR_MODE_PERIPHERAL;
111 	}
112 
113 	if (mode != hsotg->dr_mode) {
114 		dev_warn(hsotg->dev,
115 			 "Configuration mismatch. dr_mode forced to %s\n",
116 			mode == USB_DR_MODE_HOST ? "host" : "device");
117 
118 		hsotg->dr_mode = mode;
119 	}
120 
121 	return 0;
122 }
123 
124 static int __dwc2_lowlevel_hw_enable(struct dwc2_hsotg *hsotg)
125 {
126 	struct platform_device *pdev = to_platform_device(hsotg->dev);
127 	int ret;
128 
129 	ret = regulator_bulk_enable(ARRAY_SIZE(hsotg->supplies),
130 				    hsotg->supplies);
131 	if (ret)
132 		return ret;
133 
134 	if (hsotg->clk) {
135 		ret = clk_prepare_enable(hsotg->clk);
136 		if (ret)
137 			return ret;
138 	}
139 
140 	if (hsotg->uphy) {
141 		ret = usb_phy_init(hsotg->uphy);
142 	} else if (hsotg->plat && hsotg->plat->phy_init) {
143 		ret = hsotg->plat->phy_init(pdev, hsotg->plat->phy_type);
144 	} else {
145 		ret = phy_power_on(hsotg->phy);
146 		if (ret == 0)
147 			ret = phy_init(hsotg->phy);
148 	}
149 
150 	return ret;
151 }
152 
153 /**
154  * dwc2_lowlevel_hw_enable - enable platform lowlevel hw resources
155  * @hsotg: The driver state
156  *
157  * A wrapper for platform code responsible for controlling
158  * low-level USB platform resources (phy, clock, regulators)
159  */
160 int dwc2_lowlevel_hw_enable(struct dwc2_hsotg *hsotg)
161 {
162 	int ret = __dwc2_lowlevel_hw_enable(hsotg);
163 
164 	if (ret == 0)
165 		hsotg->ll_hw_enabled = true;
166 	return ret;
167 }
168 
169 static int __dwc2_lowlevel_hw_disable(struct dwc2_hsotg *hsotg)
170 {
171 	struct platform_device *pdev = to_platform_device(hsotg->dev);
172 	int ret = 0;
173 
174 	if (hsotg->uphy) {
175 		usb_phy_shutdown(hsotg->uphy);
176 	} else if (hsotg->plat && hsotg->plat->phy_exit) {
177 		ret = hsotg->plat->phy_exit(pdev, hsotg->plat->phy_type);
178 	} else {
179 		ret = phy_exit(hsotg->phy);
180 		if (ret == 0)
181 			ret = phy_power_off(hsotg->phy);
182 	}
183 	if (ret)
184 		return ret;
185 
186 	if (hsotg->clk)
187 		clk_disable_unprepare(hsotg->clk);
188 
189 	ret = regulator_bulk_disable(ARRAY_SIZE(hsotg->supplies),
190 				     hsotg->supplies);
191 
192 	return ret;
193 }
194 
195 /**
196  * dwc2_lowlevel_hw_disable - disable platform lowlevel hw resources
197  * @hsotg: The driver state
198  *
199  * A wrapper for platform code responsible for controlling
200  * low-level USB platform resources (phy, clock, regulators)
201  */
202 int dwc2_lowlevel_hw_disable(struct dwc2_hsotg *hsotg)
203 {
204 	int ret = __dwc2_lowlevel_hw_disable(hsotg);
205 
206 	if (ret == 0)
207 		hsotg->ll_hw_enabled = false;
208 	return ret;
209 }
210 
211 static int dwc2_lowlevel_hw_init(struct dwc2_hsotg *hsotg)
212 {
213 	int i, ret;
214 
215 	hsotg->reset = devm_reset_control_get_optional(hsotg->dev, "dwc2");
216 	if (IS_ERR(hsotg->reset)) {
217 		ret = PTR_ERR(hsotg->reset);
218 		dev_err(hsotg->dev, "error getting reset control %d\n", ret);
219 		return ret;
220 	}
221 
222 	reset_control_deassert(hsotg->reset);
223 
224 	hsotg->reset_ecc = devm_reset_control_get_optional(hsotg->dev, "dwc2-ecc");
225 	if (IS_ERR(hsotg->reset_ecc)) {
226 		ret = PTR_ERR(hsotg->reset_ecc);
227 		dev_err(hsotg->dev, "error getting reset control for ecc %d\n", ret);
228 		return ret;
229 	}
230 
231 	reset_control_deassert(hsotg->reset_ecc);
232 
233 	/*
234 	 * Attempt to find a generic PHY, then look for an old style
235 	 * USB PHY and then fall back to pdata
236 	 */
237 	hsotg->phy = devm_phy_get(hsotg->dev, "usb2-phy");
238 	if (IS_ERR(hsotg->phy)) {
239 		ret = PTR_ERR(hsotg->phy);
240 		switch (ret) {
241 		case -ENODEV:
242 		case -ENOSYS:
243 			hsotg->phy = NULL;
244 			break;
245 		case -EPROBE_DEFER:
246 			return ret;
247 		default:
248 			dev_err(hsotg->dev, "error getting phy %d\n", ret);
249 			return ret;
250 		}
251 	}
252 
253 	if (!hsotg->phy) {
254 		hsotg->uphy = devm_usb_get_phy(hsotg->dev, USB_PHY_TYPE_USB2);
255 		if (IS_ERR(hsotg->uphy)) {
256 			ret = PTR_ERR(hsotg->uphy);
257 			switch (ret) {
258 			case -ENODEV:
259 			case -ENXIO:
260 				hsotg->uphy = NULL;
261 				break;
262 			case -EPROBE_DEFER:
263 				return ret;
264 			default:
265 				dev_err(hsotg->dev, "error getting usb phy %d\n",
266 					ret);
267 				return ret;
268 			}
269 		}
270 	}
271 
272 	hsotg->plat = dev_get_platdata(hsotg->dev);
273 
274 	/* Clock */
275 	hsotg->clk = devm_clk_get_optional(hsotg->dev, "otg");
276 	if (IS_ERR(hsotg->clk)) {
277 		dev_err(hsotg->dev, "cannot get otg clock\n");
278 		return PTR_ERR(hsotg->clk);
279 	}
280 
281 	/* Regulators */
282 	for (i = 0; i < ARRAY_SIZE(hsotg->supplies); i++)
283 		hsotg->supplies[i].supply = dwc2_hsotg_supply_names[i];
284 
285 	ret = devm_regulator_bulk_get(hsotg->dev, ARRAY_SIZE(hsotg->supplies),
286 				      hsotg->supplies);
287 	if (ret) {
288 		if (ret != -EPROBE_DEFER)
289 			dev_err(hsotg->dev, "failed to request supplies: %d\n",
290 				ret);
291 		return ret;
292 	}
293 	return 0;
294 }
295 
296 /**
297  * dwc2_driver_remove() - Called when the DWC_otg core is unregistered with the
298  * DWC_otg driver
299  *
300  * @dev: Platform device
301  *
302  * This routine is called, for example, when the rmmod command is executed. The
303  * device may or may not be electrically present. If it is present, the driver
304  * stops device processing. Any resources used on behalf of this device are
305  * freed.
306  */
307 static int dwc2_driver_remove(struct platform_device *dev)
308 {
309 	struct dwc2_hsotg *hsotg = platform_get_drvdata(dev);
310 
311 	dwc2_debugfs_exit(hsotg);
312 	if (hsotg->hcd_enabled)
313 		dwc2_hcd_remove(hsotg);
314 	if (hsotg->gadget_enabled)
315 		dwc2_hsotg_remove(hsotg);
316 
317 	if (hsotg->params.activate_stm_id_vb_detection)
318 		regulator_disable(hsotg->usb33d);
319 
320 	if (hsotg->ll_hw_enabled)
321 		dwc2_lowlevel_hw_disable(hsotg);
322 
323 	reset_control_assert(hsotg->reset);
324 	reset_control_assert(hsotg->reset_ecc);
325 
326 	return 0;
327 }
328 
329 /**
330  * dwc2_driver_shutdown() - Called on device shutdown
331  *
332  * @dev: Platform device
333  *
334  * In specific conditions (involving usb hubs) dwc2 devices can create a
335  * lot of interrupts, even to the point of overwhelming devices running
336  * at low frequencies. Some devices need to do special clock handling
337  * at shutdown-time which may bring the system clock below the threshold
338  * of being able to handle the dwc2 interrupts. Disabling dwc2-irqs
339  * prevents reboots/poweroffs from getting stuck in such cases.
340  */
341 static void dwc2_driver_shutdown(struct platform_device *dev)
342 {
343 	struct dwc2_hsotg *hsotg = platform_get_drvdata(dev);
344 
345 	disable_irq(hsotg->irq);
346 }
347 
348 /**
349  * dwc2_check_core_endianness() - Returns true if core and AHB have
350  * opposite endianness.
351  * @hsotg:	Programming view of the DWC_otg controller.
352  */
353 static bool dwc2_check_core_endianness(struct dwc2_hsotg *hsotg)
354 {
355 	u32 snpsid;
356 
357 	snpsid = ioread32(hsotg->regs + GSNPSID);
358 	if ((snpsid & GSNPSID_ID_MASK) == DWC2_OTG_ID ||
359 	    (snpsid & GSNPSID_ID_MASK) == DWC2_FS_IOT_ID ||
360 	    (snpsid & GSNPSID_ID_MASK) == DWC2_HS_IOT_ID)
361 		return false;
362 	return true;
363 }
364 
365 /**
366  * dwc2_driver_probe() - Called when the DWC_otg core is bound to the DWC_otg
367  * driver
368  *
369  * @dev: Platform device
370  *
371  * This routine creates the driver components required to control the device
372  * (core, HCD, and PCD) and initializes the device. The driver components are
373  * stored in a dwc2_hsotg structure. A reference to the dwc2_hsotg is saved
374  * in the device private data. This allows the driver to access the dwc2_hsotg
375  * structure on subsequent calls to driver methods for this device.
376  */
377 static int dwc2_driver_probe(struct platform_device *dev)
378 {
379 	struct dwc2_hsotg *hsotg;
380 	struct resource *res;
381 	int retval;
382 
383 	hsotg = devm_kzalloc(&dev->dev, sizeof(*hsotg), GFP_KERNEL);
384 	if (!hsotg)
385 		return -ENOMEM;
386 
387 	hsotg->dev = &dev->dev;
388 
389 	/*
390 	 * Use reasonable defaults so platforms don't have to provide these.
391 	 */
392 	if (!dev->dev.dma_mask)
393 		dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
394 	retval = dma_set_coherent_mask(&dev->dev, DMA_BIT_MASK(32));
395 	if (retval) {
396 		dev_err(&dev->dev, "can't set coherent DMA mask: %d\n", retval);
397 		return retval;
398 	}
399 
400 	res = platform_get_resource(dev, IORESOURCE_MEM, 0);
401 	hsotg->regs = devm_ioremap_resource(&dev->dev, res);
402 	if (IS_ERR(hsotg->regs))
403 		return PTR_ERR(hsotg->regs);
404 
405 	dev_dbg(&dev->dev, "mapped PA %08lx to VA %p\n",
406 		(unsigned long)res->start, hsotg->regs);
407 
408 	retval = dwc2_lowlevel_hw_init(hsotg);
409 	if (retval)
410 		return retval;
411 
412 	spin_lock_init(&hsotg->lock);
413 
414 	hsotg->irq = platform_get_irq(dev, 0);
415 	if (hsotg->irq < 0)
416 		return hsotg->irq;
417 
418 	dev_dbg(hsotg->dev, "registering common handler for irq%d\n",
419 		hsotg->irq);
420 	retval = devm_request_irq(hsotg->dev, hsotg->irq,
421 				  dwc2_handle_common_intr, IRQF_SHARED,
422 				  dev_name(hsotg->dev), hsotg);
423 	if (retval)
424 		return retval;
425 
426 	hsotg->vbus_supply = devm_regulator_get_optional(hsotg->dev, "vbus");
427 	if (IS_ERR(hsotg->vbus_supply)) {
428 		retval = PTR_ERR(hsotg->vbus_supply);
429 		hsotg->vbus_supply = NULL;
430 		if (retval != -ENODEV)
431 			return retval;
432 	}
433 
434 	retval = dwc2_lowlevel_hw_enable(hsotg);
435 	if (retval)
436 		return retval;
437 
438 	hsotg->needs_byte_swap = dwc2_check_core_endianness(hsotg);
439 
440 	retval = dwc2_get_dr_mode(hsotg);
441 	if (retval)
442 		goto error;
443 
444 	hsotg->need_phy_for_wake =
445 		of_property_read_bool(dev->dev.of_node,
446 				      "snps,need-phy-for-wake");
447 
448 	/*
449 	 * Reset before dwc2_get_hwparams() then it could get power-on real
450 	 * reset value form registers.
451 	 */
452 	retval = dwc2_core_reset(hsotg, false);
453 	if (retval)
454 		goto error;
455 
456 	/* Detect config values from hardware */
457 	retval = dwc2_get_hwparams(hsotg);
458 	if (retval)
459 		goto error;
460 
461 	/*
462 	 * For OTG cores, set the force mode bits to reflect the value
463 	 * of dr_mode. Force mode bits should not be touched at any
464 	 * other time after this.
465 	 */
466 	dwc2_force_dr_mode(hsotg);
467 
468 	retval = dwc2_init_params(hsotg);
469 	if (retval)
470 		goto error;
471 
472 	if (hsotg->params.activate_stm_id_vb_detection) {
473 		u32 ggpio;
474 
475 		hsotg->usb33d = devm_regulator_get(hsotg->dev, "usb33d");
476 		if (IS_ERR(hsotg->usb33d)) {
477 			retval = PTR_ERR(hsotg->usb33d);
478 			if (retval != -EPROBE_DEFER)
479 				dev_err(hsotg->dev,
480 					"failed to request usb33d supply: %d\n",
481 					retval);
482 			goto error;
483 		}
484 		retval = regulator_enable(hsotg->usb33d);
485 		if (retval) {
486 			dev_err(hsotg->dev,
487 				"failed to enable usb33d supply: %d\n", retval);
488 			goto error;
489 		}
490 
491 		ggpio = dwc2_readl(hsotg, GGPIO);
492 		ggpio |= GGPIO_STM32_OTG_GCCFG_IDEN;
493 		ggpio |= GGPIO_STM32_OTG_GCCFG_VBDEN;
494 		dwc2_writel(hsotg, ggpio, GGPIO);
495 	}
496 
497 	if (hsotg->dr_mode != USB_DR_MODE_HOST) {
498 		retval = dwc2_gadget_init(hsotg);
499 		if (retval)
500 			goto error_init;
501 		hsotg->gadget_enabled = 1;
502 	}
503 
504 	/*
505 	 * If we need PHY for wakeup we must be wakeup capable.
506 	 * When we have a device that can wake without the PHY we
507 	 * can adjust this condition.
508 	 */
509 	if (hsotg->need_phy_for_wake)
510 		device_set_wakeup_capable(&dev->dev, true);
511 
512 	hsotg->reset_phy_on_wake =
513 		of_property_read_bool(dev->dev.of_node,
514 				      "snps,reset-phy-on-wake");
515 	if (hsotg->reset_phy_on_wake && !hsotg->phy) {
516 		dev_warn(hsotg->dev,
517 			 "Quirk reset-phy-on-wake only supports generic PHYs\n");
518 		hsotg->reset_phy_on_wake = false;
519 	}
520 
521 	if (hsotg->dr_mode != USB_DR_MODE_PERIPHERAL) {
522 		retval = dwc2_hcd_init(hsotg);
523 		if (retval) {
524 			if (hsotg->gadget_enabled)
525 				dwc2_hsotg_remove(hsotg);
526 			goto error_init;
527 		}
528 		hsotg->hcd_enabled = 1;
529 	}
530 
531 	platform_set_drvdata(dev, hsotg);
532 	hsotg->hibernated = 0;
533 
534 	dwc2_debugfs_init(hsotg);
535 
536 	/* Gadget code manages lowlevel hw on its own */
537 	if (hsotg->dr_mode == USB_DR_MODE_PERIPHERAL)
538 		dwc2_lowlevel_hw_disable(hsotg);
539 
540 	return 0;
541 
542 error_init:
543 	if (hsotg->params.activate_stm_id_vb_detection)
544 		regulator_disable(hsotg->usb33d);
545 error:
546 	dwc2_lowlevel_hw_disable(hsotg);
547 	return retval;
548 }
549 
550 static int __maybe_unused dwc2_suspend(struct device *dev)
551 {
552 	struct dwc2_hsotg *dwc2 = dev_get_drvdata(dev);
553 	bool is_device_mode = dwc2_is_device_mode(dwc2);
554 	int ret = 0;
555 
556 	if (is_device_mode)
557 		dwc2_hsotg_suspend(dwc2);
558 
559 	if (dwc2->params.activate_stm_id_vb_detection) {
560 		unsigned long flags;
561 		u32 ggpio, gotgctl;
562 
563 		/*
564 		 * Need to force the mode to the current mode to avoid Mode
565 		 * Mismatch Interrupt when ID detection will be disabled.
566 		 */
567 		dwc2_force_mode(dwc2, !is_device_mode);
568 
569 		spin_lock_irqsave(&dwc2->lock, flags);
570 		gotgctl = dwc2_readl(dwc2, GOTGCTL);
571 		/* bypass debounce filter, enable overrides */
572 		gotgctl |= GOTGCTL_DBNCE_FLTR_BYPASS;
573 		gotgctl |= GOTGCTL_BVALOEN | GOTGCTL_AVALOEN;
574 		/* Force A / B session if needed */
575 		if (gotgctl & GOTGCTL_ASESVLD)
576 			gotgctl |= GOTGCTL_AVALOVAL;
577 		if (gotgctl & GOTGCTL_BSESVLD)
578 			gotgctl |= GOTGCTL_BVALOVAL;
579 		dwc2_writel(dwc2, gotgctl, GOTGCTL);
580 		spin_unlock_irqrestore(&dwc2->lock, flags);
581 
582 		ggpio = dwc2_readl(dwc2, GGPIO);
583 		ggpio &= ~GGPIO_STM32_OTG_GCCFG_IDEN;
584 		ggpio &= ~GGPIO_STM32_OTG_GCCFG_VBDEN;
585 		dwc2_writel(dwc2, ggpio, GGPIO);
586 
587 		regulator_disable(dwc2->usb33d);
588 	}
589 
590 	if (dwc2->ll_hw_enabled &&
591 	    (is_device_mode || dwc2_host_can_poweroff_phy(dwc2))) {
592 		ret = __dwc2_lowlevel_hw_disable(dwc2);
593 		dwc2->phy_off_for_suspend = true;
594 	}
595 
596 	return ret;
597 }
598 
599 static int __maybe_unused dwc2_resume(struct device *dev)
600 {
601 	struct dwc2_hsotg *dwc2 = dev_get_drvdata(dev);
602 	int ret = 0;
603 
604 	if (dwc2->phy_off_for_suspend && dwc2->ll_hw_enabled) {
605 		ret = __dwc2_lowlevel_hw_enable(dwc2);
606 		if (ret)
607 			return ret;
608 	}
609 	dwc2->phy_off_for_suspend = false;
610 
611 	if (dwc2->params.activate_stm_id_vb_detection) {
612 		unsigned long flags;
613 		u32 ggpio, gotgctl;
614 
615 		ret = regulator_enable(dwc2->usb33d);
616 		if (ret)
617 			return ret;
618 
619 		ggpio = dwc2_readl(dwc2, GGPIO);
620 		ggpio |= GGPIO_STM32_OTG_GCCFG_IDEN;
621 		ggpio |= GGPIO_STM32_OTG_GCCFG_VBDEN;
622 		dwc2_writel(dwc2, ggpio, GGPIO);
623 
624 		/* ID/VBUS detection startup time */
625 		usleep_range(5000, 7000);
626 
627 		spin_lock_irqsave(&dwc2->lock, flags);
628 		gotgctl = dwc2_readl(dwc2, GOTGCTL);
629 		gotgctl &= ~GOTGCTL_DBNCE_FLTR_BYPASS;
630 		gotgctl &= ~(GOTGCTL_BVALOEN | GOTGCTL_AVALOEN |
631 			     GOTGCTL_BVALOVAL | GOTGCTL_AVALOVAL);
632 		dwc2_writel(dwc2, gotgctl, GOTGCTL);
633 		spin_unlock_irqrestore(&dwc2->lock, flags);
634 	}
635 
636 	/* Need to restore FORCEDEVMODE/FORCEHOSTMODE */
637 	dwc2_force_dr_mode(dwc2);
638 
639 	if (dwc2_is_device_mode(dwc2))
640 		ret = dwc2_hsotg_resume(dwc2);
641 
642 	return ret;
643 }
644 
645 static const struct dev_pm_ops dwc2_dev_pm_ops = {
646 	SET_SYSTEM_SLEEP_PM_OPS(dwc2_suspend, dwc2_resume)
647 };
648 
649 static struct platform_driver dwc2_platform_driver = {
650 	.driver = {
651 		.name = dwc2_driver_name,
652 		.of_match_table = dwc2_of_match_table,
653 		.pm = &dwc2_dev_pm_ops,
654 	},
655 	.probe = dwc2_driver_probe,
656 	.remove = dwc2_driver_remove,
657 	.shutdown = dwc2_driver_shutdown,
658 };
659 
660 module_platform_driver(dwc2_platform_driver);
661 
662 MODULE_DESCRIPTION("DESIGNWARE HS OTG Platform Glue");
663 MODULE_AUTHOR("Matthijs Kooijman <matthijs@stdin.nl>");
664 MODULE_LICENSE("Dual BSD/GPL");
665