20 static void dwc2_ovr_init(struct dwc2_hsotg *hsotg)  in dwc2_ovr_init()  argument
25 	spin_lock_irqsave(&hsotg->lock, flags);  in dwc2_ovr_init()
27 	gotgctl = dwc2_readl(hsotg, GOTGCTL);  in dwc2_ovr_init()
30 	if (hsotg->role_sw_default_mode == USB_DR_MODE_HOST)  in dwc2_ovr_init()
32 	else if (hsotg->role_sw_default_mode == USB_DR_MODE_PERIPHERAL)  in dwc2_ovr_init()
34 	dwc2_writel(hsotg, gotgctl, GOTGCTL);  in dwc2_ovr_init()
36 	spin_unlock_irqrestore(&hsotg->lock, flags);  in dwc2_ovr_init()
38 	dwc2_force_mode(hsotg, (hsotg->dr_mode == USB_DR_MODE_HOST) ||  in dwc2_ovr_init()
39 				(hsotg->role_sw_default_mode == USB_DR_MODE_HOST));  in dwc2_ovr_init()
42 static int dwc2_ovr_avalid(struct dwc2_hsotg *hsotg, bool valid)  in dwc2_ovr_avalid()  argument
44 	u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);  in dwc2_ovr_avalid()
59 	dwc2_writel(hsotg, gotgctl, GOTGCTL);  in dwc2_ovr_avalid()
64 static int dwc2_ovr_bvalid(struct dwc2_hsotg *hsotg, bool valid)  in dwc2_ovr_bvalid()  argument
66 	u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);  in dwc2_ovr_bvalid()
81 	dwc2_writel(hsotg, gotgctl, GOTGCTL);  in dwc2_ovr_bvalid()
88 	struct dwc2_hsotg *hsotg = usb_role_switch_get_drvdata(sw);  in dwc2_drd_role_sw_set()  local
93 	if ((role == USB_ROLE_DEVICE && hsotg->dr_mode == USB_DR_MODE_HOST) ||  in dwc2_drd_role_sw_set()
94 	    (role == USB_ROLE_HOST && hsotg->dr_mode == USB_DR_MODE_PERIPHERAL))  in dwc2_drd_role_sw_set()
100 	if (role == USB_ROLE_NONE && hsotg->test_mode) {  in dwc2_drd_role_sw_set()
101 		dev_dbg(hsotg->dev, "Core is in test mode\n");  in dwc2_drd_role_sw_set()
113 	if (!hsotg->ll_hw_enabled && hsotg->clk) {  in dwc2_drd_role_sw_set()
114 		int ret = clk_prepare_enable(hsotg->clk);  in dwc2_drd_role_sw_set()
120 	spin_lock_irqsave(&hsotg->lock, flags);  in dwc2_drd_role_sw_set()
124 		if (hsotg->role_sw_default_mode == USB_DR_MODE_HOST)  in dwc2_drd_role_sw_set()
126 		else if (hsotg->role_sw_default_mode == USB_DR_MODE_PERIPHERAL)  in dwc2_drd_role_sw_set()
131 		already = dwc2_ovr_avalid(hsotg, true);  in dwc2_drd_role_sw_set()
133 		already = dwc2_ovr_bvalid(hsotg, true);  in dwc2_drd_role_sw_set()
134 		if (dwc2_is_device_enabled(hsotg)) {  in dwc2_drd_role_sw_set()
136 			dwc2_hsotg_core_connect(hsotg);  in dwc2_drd_role_sw_set()
139 		if (dwc2_is_device_mode(hsotg)) {  in dwc2_drd_role_sw_set()
140 			if (!dwc2_ovr_bvalid(hsotg, false))  in dwc2_drd_role_sw_set()
142 				dwc2_hsotg_core_disconnect(hsotg);  in dwc2_drd_role_sw_set()
144 			dwc2_ovr_avalid(hsotg, false);  in dwc2_drd_role_sw_set()
148 	spin_unlock_irqrestore(&hsotg->lock, flags);  in dwc2_drd_role_sw_set()
150 	if (!already && hsotg->dr_mode == USB_DR_MODE_OTG)  in dwc2_drd_role_sw_set()
152 		dwc2_force_mode(hsotg, role == USB_ROLE_HOST);  in dwc2_drd_role_sw_set()
154 	if (!hsotg->ll_hw_enabled && hsotg->clk)  in dwc2_drd_role_sw_set()
155 		clk_disable_unprepare(hsotg->clk);  in dwc2_drd_role_sw_set()
157 	dev_dbg(hsotg->dev, "%s-session valid\n",  in dwc2_drd_role_sw_set()
164 int dwc2_drd_init(struct dwc2_hsotg *hsotg)  in dwc2_drd_init()  argument
170 	if (!device_property_read_bool(hsotg->dev, "usb-role-switch"))  in dwc2_drd_init()
173 	hsotg->role_sw_default_mode = usb_get_role_switch_default_mode(hsotg->dev);  in dwc2_drd_init()
174 	role_sw_desc.driver_data = hsotg;  in dwc2_drd_init()
175 	role_sw_desc.fwnode = dev_fwnode(hsotg->dev);  in dwc2_drd_init()
179 	role_sw = usb_role_switch_register(hsotg->dev, &role_sw_desc);  in dwc2_drd_init()
182 		dev_err(hsotg->dev,  in dwc2_drd_init()
187 	hsotg->role_sw = role_sw;  in dwc2_drd_init()
190 	dwc2_ovr_init(hsotg);  in dwc2_drd_init()
195 void dwc2_drd_suspend(struct dwc2_hsotg *hsotg)  in dwc2_drd_suspend()  argument
199 	if (hsotg->role_sw && !hsotg->params.external_id_pin_ctl) {  in dwc2_drd_suspend()
200 		gintmsk = dwc2_readl(hsotg, GINTMSK);  in dwc2_drd_suspend()
202 		dwc2_writel(hsotg, gintmsk, GINTMSK);  in dwc2_drd_suspend()
203 		gintsts = dwc2_readl(hsotg, GINTSTS);  in dwc2_drd_suspend()
204 		dwc2_writel(hsotg, gintsts | GINTSTS_CONIDSTSCHNG, GINTSTS);  in dwc2_drd_suspend()
208 void dwc2_drd_resume(struct dwc2_hsotg *hsotg)  in dwc2_drd_resume()  argument
213 	if (hsotg->role_sw) {  in dwc2_drd_resume()
215 		role = usb_role_switch_get_role(hsotg->role_sw);  in dwc2_drd_resume()
218 			if (hsotg->role_sw_default_mode == USB_DR_MODE_HOST)  in dwc2_drd_resume()
220 			else if (hsotg->role_sw_default_mode == USB_DR_MODE_PERIPHERAL)  in dwc2_drd_resume()
226 			dwc2_ovr_avalid(hsotg, true);  in dwc2_drd_resume()
228 			dwc2_ovr_bvalid(hsotg, true);  in dwc2_drd_resume()
230 		dwc2_force_mode(hsotg, role == USB_ROLE_HOST);  in dwc2_drd_resume()
232 		dev_dbg(hsotg->dev, "resuming %s-session valid\n",  in dwc2_drd_resume()
237 	if (hsotg->role_sw && !hsotg->params.external_id_pin_ctl) {  in dwc2_drd_resume()
238 		gintsts = dwc2_readl(hsotg, GINTSTS);  in dwc2_drd_resume()
239 		dwc2_writel(hsotg, gintsts | GINTSTS_CONIDSTSCHNG, GINTSTS);  in dwc2_drd_resume()
240 		gintmsk = dwc2_readl(hsotg, GINTMSK);  in dwc2_drd_resume()
242 		dwc2_writel(hsotg, gintmsk, GINTMSK);  in dwc2_drd_resume()
246 void dwc2_drd_exit(struct dwc2_hsotg *hsotg)  in dwc2_drd_exit()  argument
248 	if (hsotg->role_sw)  in dwc2_drd_exit()
249 		usb_role_switch_unregister(hsotg->role_sw);  in dwc2_drd_exit()