usb/dwc2/drd.c

20 static void dwc2_ovr_init(struct dwc2_hsotg *hsotg)
25 	spin_lock_irqsave(&hsotg->lock, flags);
27 	gotgctl = dwc2_readl(hsotg, GOTGCTL);
30 	if (hsotg->role_sw_default_mode == USB_DR_MODE_HOST)
32 	else if (hsotg->role_sw_default_mode == USB_DR_MODE_PERIPHERAL)
34 	dwc2_writel(hsotg, gotgctl, GOTGCTL);
36 	spin_unlock_irqrestore(&hsotg->lock, flags);
38 	dwc2_force_mode(hsotg, (hsotg->dr_mode == USB_DR_MODE_HOST) ||
39 				(hsotg->role_sw_default_mode == USB_DR_MODE_HOST));
42 static int dwc2_ovr_avalid(struct dwc2_hsotg *hsotg, bool valid)
44 	u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);
59 	dwc2_writel(hsotg, gotgctl, GOTGCTL);
64 static int dwc2_ovr_bvalid(struct dwc2_hsotg *hsotg, bool valid)
66 	u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);
81 	dwc2_writel(hsotg, gotgctl, GOTGCTL);
88 	struct dwc2_hsotg *hsotg = usb_role_switch_get_drvdata(sw);
93 	if ((role == USB_ROLE_DEVICE && hsotg->dr_mode == USB_DR_MODE_HOST) ||
94 	    (role == USB_ROLE_HOST && hsotg->dr_mode == USB_DR_MODE_PERIPHERAL))
100 	if (role == USB_ROLE_NONE && hsotg->test_mode) {
101 		dev_dbg(hsotg->dev, "Core is in test mode\n");
113 	if (!hsotg->ll_hw_enabled && hsotg->clk) {
114 		int ret = clk_prepare_enable(hsotg->clk);
120 	spin_lock_irqsave(&hsotg->lock, flags);
124 		if (hsotg->role_sw_default_mode == USB_DR_MODE_HOST)
126 		else if (hsotg->role_sw_default_mode == USB_DR_MODE_PERIPHERAL)
132 	     dwc2_is_device_mode(hsotg) &&
133 	     hsotg->lx_state == DWC2_L2 &&
134 	     hsotg->params.power_down == DWC2_POWER_DOWN_PARAM_NONE &&
135 	     hsotg->bus_suspended &&
136 	     !hsotg->params.no_clock_gating)
137 		dwc2_gadget_exit_clock_gating(hsotg, 0);
140 		already = dwc2_ovr_avalid(hsotg, true);
142 		already = dwc2_ovr_bvalid(hsotg, true);
143 		if (dwc2_is_device_enabled(hsotg)) {
145 			dwc2_hsotg_core_connect(hsotg);
148 		if (dwc2_is_device_mode(hsotg)) {
149 			if (!dwc2_ovr_bvalid(hsotg, false))
151 				dwc2_hsotg_core_disconnect(hsotg);
153 			dwc2_ovr_avalid(hsotg, false);
157 	spin_unlock_irqrestore(&hsotg->lock, flags);
159 	if (!already && hsotg->dr_mode == USB_DR_MODE_OTG)
161 		dwc2_force_mode(hsotg, role == USB_ROLE_HOST);
163 	if (!hsotg->ll_hw_enabled && hsotg->clk)
164 		clk_disable_unprepare(hsotg->clk);
166 	dev_dbg(hsotg->dev, "%s-session valid\n",
173 int dwc2_drd_init(struct dwc2_hsotg *hsotg)
179 	if (!device_property_read_bool(hsotg->dev, "usb-role-switch"))
182 	hsotg->role_sw_default_mode = usb_get_role_switch_default_mode(hsotg->dev);
183 	role_sw_desc.driver_data = hsotg;
184 	role_sw_desc.fwnode = dev_fwnode(hsotg->dev);
188 	role_sw = usb_role_switch_register(hsotg->dev, &role_sw_desc);
191 		dev_err(hsotg->dev,
196 	hsotg->role_sw = role_sw;
199 	dwc2_ovr_init(hsotg);
204 void dwc2_drd_suspend(struct dwc2_hsotg *hsotg)
208 	if (hsotg->role_sw && !hsotg->params.external_id_pin_ctl) {
209 		gintmsk = dwc2_readl(hsotg, GINTMSK);
211 		dwc2_writel(hsotg, gintmsk, GINTMSK);
212 		gintsts = dwc2_readl(hsotg, GINTSTS);
213 		dwc2_writel(hsotg, gintsts | GINTSTS_CONIDSTSCHNG, GINTSTS);
217 void dwc2_drd_resume(struct dwc2_hsotg *hsotg)
222 	if (hsotg->role_sw) {
224 		role = usb_role_switch_get_role(hsotg->role_sw);
227 			if (hsotg->role_sw_default_mode == USB_DR_MODE_HOST)
229 			else if (hsotg->role_sw_default_mode == USB_DR_MODE_PERIPHERAL)
235 			dwc2_ovr_avalid(hsotg, true);
237 			dwc2_ovr_bvalid(hsotg, true);
239 		dwc2_force_mode(hsotg, role == USB_ROLE_HOST);
241 		dev_dbg(hsotg->dev, "resuming %s-session valid\n",
246 	if (hsotg->role_sw && !hsotg->params.external_id_pin_ctl) {
247 		gintsts = dwc2_readl(hsotg, GINTSTS);
248 		dwc2_writel(hsotg, gintsts | GINTSTS_CONIDSTSCHNG, GINTSTS);
249 		gintmsk = dwc2_readl(hsotg, GINTMSK);
251 		dwc2_writel(hsotg, gintmsk, GINTMSK);
255 void dwc2_drd_exit(struct dwc2_hsotg *hsotg)
257 	if (hsotg->role_sw)
258 		usb_role_switch_unregister(hsotg->role_sw);