usb: dwc3: core: make dwc3_set_mode() work properly