usb: dwc2: Fix probe problem on bcm2835

Fixes an issue found on Raspberry PI platform that prevents probe. Don't
skip setting the force mode if it's already set.

Fixes: 09c9698 ("usb: dwc2: Add functions to set and clear force mode")
Tested-by: Heiko Stuebner <[email protected]>
Tested-by: Douglas Anderson <[email protected]>
Signed-off-by: John Youn <[email protected]>
Reported-by: Stefan Wahren <[email protected]>
Reported-by: Remi Pommarel <[email protected]>
Tested-by: Stefan Wahren <[email protected]>
Tested-by: Remi Pommarel <[email protected]>
Signed-off-by: Felipe Balbi <[email protected]>

Author: jysnps

drivers/usb/dwc2/core.c

@@ -572,12 +572,6 @@ static bool dwc2_force_mode(struct dwc2_hsotg *hsotg, bool host)
 	set = host ? GUSBCFG_FORCEHOSTMODE : GUSBCFG_FORCEDEVMODE;
 	clear = host ? GUSBCFG_FORCEDEVMODE : GUSBCFG_FORCEHOSTMODE;
 
-	/*
-	 * If the force mode bit is already set, don't set it.
-	 */
-	if ((gusbcfg & set) && !(gusbcfg & clear))
-		return false;
-
 	gusbcfg &= ~clear;
 	gusbcfg |= set;
 	dwc2_writel(gusbcfg, hsotg->regs + GUSBCFG);