@@ -116,6 +116,9 @@ void dwc3_set_prtcap(struct dwc3 *dwc, u32 mode)
116116 dwc -> current_dr_role = mode ;
117117}
118118
119+ static void dwc3_core_exit (struct dwc3 * dwc );
120+ static int dwc3_core_init_for_resume (struct dwc3 * dwc );
121+
119122static void __dwc3_set_mode (struct work_struct * work )
120123{
121124 struct dwc3 * dwc = work_to_dwc (work );
@@ -134,7 +137,7 @@ static void __dwc3_set_mode(struct work_struct *work)
134137 if (dwc -> current_dr_role == DWC3_GCTL_PRTCAP_OTG )
135138 dwc3_otg_update (dwc , 0 );
136139
137- if (!desired_dr_role )
140+ if (!desired_dr_role && ! dwc -> role_switch_reset_quirk )
138141 goto out ;
139142
140143 if (desired_dr_role == dwc -> current_dr_role )
@@ -162,13 +165,32 @@ static void __dwc3_set_mode(struct work_struct *work)
162165 break ;
163166 }
164167
168+ if (dwc -> role_switch_reset_quirk ) {
169+ if (dwc -> current_dr_role ) {
170+ dwc -> current_dr_role = 0 ;
171+ dwc3_core_exit (dwc );
172+ }
173+
174+ if (desired_dr_role ) {
175+ ret = dwc3_core_init_for_resume (dwc );
176+ if (ret ) {
177+ dev_err (dwc -> dev ,
178+ "failed to reinitialize core\n" );
179+ goto out ;
180+ }
181+ } else {
182+ goto out ;
183+ }
184+ }
185+
165186 /*
166187 * When current_dr_role is not set, there's no role switching.
167188 * Only perform GCTL.CoreSoftReset when there's DRD role switching.
168189 */
169- if (dwc -> current_dr_role && ((DWC3_IP_IS (DWC3 ) ||
190+ if (dwc -> role_switch_reset_quirk ||
191+ (dwc -> current_dr_role && ((DWC3_IP_IS (DWC3 ) ||
170192 DWC3_VER_IS_PRIOR (DWC31 , 190 A )) &&
171- desired_dr_role != DWC3_GCTL_PRTCAP_OTG )) {
193+ desired_dr_role != DWC3_GCTL_PRTCAP_OTG ))) {
172194 reg = dwc3_readl (dwc -> regs , DWC3_GCTL );
173195 reg |= DWC3_GCTL_CORESOFTRESET ;
174196 dwc3_writel (dwc -> regs , DWC3_GCTL , reg );
@@ -1381,6 +1403,18 @@ static int dwc3_core_init_mode(struct dwc3 *dwc)
13811403 ret = dwc3_drd_init (dwc );
13821404 if (ret )
13831405 return dev_err_probe (dev , ret , "failed to initialize dual-role\n" );
1406+
1407+ /*
1408+ * If the role switch reset quirk is required the first role
1409+ * switch notification will initialize the core such that we
1410+ * have to shut it down here. Make sure that the __dwc3_set_mode
1411+ * queued by dwc3_drd_init has completed before since it
1412+ * may still try to access MMIO.
1413+ */
1414+ if (dwc -> role_switch_reset_quirk ) {
1415+ flush_work (& dwc -> drd_work );
1416+ dwc3_core_exit (dwc );
1417+ }
13841418 break ;
13851419 default :
13861420 dev_err (dev , "Unsupported mode of operation %d\n" , dwc -> dr_mode );
@@ -1851,6 +1885,22 @@ static int dwc3_probe(struct platform_device *pdev)
18511885 if (ret )
18521886 goto err_put_psy ;
18531887
1888+ if (dev -> of_node ) {
1889+ if (of_device_is_compatible (dev -> of_node , "apple,dwc3" )) {
1890+ if (!IS_ENABLED (CONFIG_USB_ROLE_SWITCH ) ||
1891+ !IS_ENABLED (CONFIG_USB_DWC3_DUAL_ROLE )) {
1892+ dev_err (dev ,
1893+ "Apple DWC3 requires role switch support.\n"
1894+ );
1895+ ret = - EINVAL ;
1896+ goto err_put_psy ;
1897+ }
1898+
1899+ dwc -> dr_mode = USB_DR_MODE_OTG ;
1900+ dwc -> role_switch_reset_quirk = true;
1901+ }
1902+ }
1903+
18541904 ret = reset_control_deassert (dwc -> reset );
18551905 if (ret )
18561906 goto err_put_psy ;
@@ -1974,7 +2024,6 @@ static void dwc3_remove(struct platform_device *pdev)
19742024 power_supply_put (dwc -> usb_psy );
19752025}
19762026
1977- #ifdef CONFIG_PM
19782027static int dwc3_core_init_for_resume (struct dwc3 * dwc )
19792028{
19802029 int ret ;
@@ -2001,6 +2050,7 @@ static int dwc3_core_init_for_resume(struct dwc3 *dwc)
20012050 return ret ;
20022051}
20032052
2053+ #ifdef CONFIG_PM
20042054static int dwc3_suspend_common (struct dwc3 * dwc , pm_message_t msg )
20052055{
20062056 unsigned long flags ;
0 commit comments