• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright 2012 Freescale Semiconductor, Inc.
4  * Copyright (C) 2012 Marek Vasut <marex@denx.de>
5  * on behalf of DENX Software Engineering GmbH
6  */
7 
8 #include <linux/module.h>
9 #include <linux/of_platform.h>
10 #include <linux/platform_device.h>
11 #include <linux/pm_runtime.h>
12 #include <linux/usb/chipidea.h>
13 #include <linux/usb/of.h>
14 #include <linux/clk.h>
15 #include <linux/pinctrl/consumer.h>
16 #include <linux/pm_qos.h>
17 
18 #include "ci.h"
19 #include "ci_hdrc_imx.h"
20 
21 struct ci_hdrc_imx_platform_flag {
22 	unsigned int flags;
23 };
24 
25 static const struct ci_hdrc_imx_platform_flag imx23_usb_data = {
26 	.flags = CI_HDRC_TURN_VBUS_EARLY_ON |
27 		CI_HDRC_DISABLE_STREAMING,
28 };
29 
30 static const struct ci_hdrc_imx_platform_flag imx27_usb_data = {
31 	.flags = CI_HDRC_DISABLE_STREAMING,
32 };
33 
34 static const struct ci_hdrc_imx_platform_flag imx28_usb_data = {
35 	.flags = CI_HDRC_IMX28_WRITE_FIX |
36 		CI_HDRC_TURN_VBUS_EARLY_ON |
37 		CI_HDRC_DISABLE_STREAMING,
38 };
39 
40 static const struct ci_hdrc_imx_platform_flag imx6q_usb_data = {
41 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
42 		CI_HDRC_TURN_VBUS_EARLY_ON |
43 		CI_HDRC_DISABLE_STREAMING,
44 };
45 
46 static const struct ci_hdrc_imx_platform_flag imx6sl_usb_data = {
47 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
48 		CI_HDRC_TURN_VBUS_EARLY_ON |
49 		CI_HDRC_DISABLE_HOST_STREAMING,
50 };
51 
52 static const struct ci_hdrc_imx_platform_flag imx6sx_usb_data = {
53 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
54 		CI_HDRC_TURN_VBUS_EARLY_ON |
55 		CI_HDRC_DISABLE_HOST_STREAMING,
56 };
57 
58 static const struct ci_hdrc_imx_platform_flag imx6ul_usb_data = {
59 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
60 		CI_HDRC_TURN_VBUS_EARLY_ON |
61 		CI_HDRC_DISABLE_DEVICE_STREAMING,
62 };
63 
64 static const struct ci_hdrc_imx_platform_flag imx7d_usb_data = {
65 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM,
66 };
67 
68 static const struct ci_hdrc_imx_platform_flag imx7ulp_usb_data = {
69 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM |
70 		CI_HDRC_PMQOS,
71 };
72 
73 static const struct ci_hdrc_imx_platform_flag imx8ulp_usb_data = {
74 	.flags = CI_HDRC_SUPPORTS_RUNTIME_PM,
75 };
76 
77 static const struct of_device_id ci_hdrc_imx_dt_ids[] = {
78 	{ .compatible = "fsl,imx23-usb", .data = &imx23_usb_data},
79 	{ .compatible = "fsl,imx28-usb", .data = &imx28_usb_data},
80 	{ .compatible = "fsl,imx27-usb", .data = &imx27_usb_data},
81 	{ .compatible = "fsl,imx6q-usb", .data = &imx6q_usb_data},
82 	{ .compatible = "fsl,imx6sl-usb", .data = &imx6sl_usb_data},
83 	{ .compatible = "fsl,imx6sx-usb", .data = &imx6sx_usb_data},
84 	{ .compatible = "fsl,imx6ul-usb", .data = &imx6ul_usb_data},
85 	{ .compatible = "fsl,imx7d-usb", .data = &imx7d_usb_data},
86 	{ .compatible = "fsl,imx7ulp-usb", .data = &imx7ulp_usb_data},
87 	{ .compatible = "fsl,imx8ulp-usb", .data = &imx8ulp_usb_data},
88 	{ /* sentinel */ }
89 };
90 MODULE_DEVICE_TABLE(of, ci_hdrc_imx_dt_ids);
91 
92 struct ci_hdrc_imx_data {
93 	struct usb_phy *phy;
94 	struct platform_device *ci_pdev;
95 	struct clk *clk;
96 	struct imx_usbmisc_data *usbmisc_data;
97 	bool supports_runtime_pm;
98 	bool override_phy_control;
99 	bool in_lpm;
100 	struct pinctrl *pinctrl;
101 	struct pinctrl_state *pinctrl_hsic_active;
102 	struct regulator *hsic_pad_regulator;
103 	/* SoC before i.mx6 (except imx23/imx28) needs three clks */
104 	bool need_three_clks;
105 	struct clk *clk_ipg;
106 	struct clk *clk_ahb;
107 	struct clk *clk_per;
108 	/* --------------------------------- */
109 	struct pm_qos_request pm_qos_req;
110 	const struct ci_hdrc_imx_platform_flag *plat_data;
111 };
112 
113 /* Common functions shared by usbmisc drivers */
114 
usbmisc_get_init_data(struct device * dev)115 static struct imx_usbmisc_data *usbmisc_get_init_data(struct device *dev)
116 {
117 	struct platform_device *misc_pdev;
118 	struct device_node *np = dev->of_node;
119 	struct of_phandle_args args;
120 	struct imx_usbmisc_data *data;
121 	int ret;
122 
123 	/*
124 	 * In case the fsl,usbmisc property is not present this device doesn't
125 	 * need usbmisc. Return NULL (which is no error here)
126 	 */
127 	if (!of_get_property(np, "fsl,usbmisc", NULL))
128 		return NULL;
129 
130 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
131 	if (!data)
132 		return ERR_PTR(-ENOMEM);
133 
134 	ret = of_parse_phandle_with_args(np, "fsl,usbmisc", "#index-cells",
135 					0, &args);
136 	if (ret) {
137 		dev_err(dev, "Failed to parse property fsl,usbmisc, errno %d\n",
138 			ret);
139 		return ERR_PTR(ret);
140 	}
141 
142 	data->index = args.args[0];
143 
144 	misc_pdev = of_find_device_by_node(args.np);
145 	of_node_put(args.np);
146 
147 	if (!misc_pdev)
148 		return ERR_PTR(-EPROBE_DEFER);
149 
150 	if (!platform_get_drvdata(misc_pdev)) {
151 		put_device(&misc_pdev->dev);
152 		return ERR_PTR(-EPROBE_DEFER);
153 	}
154 	data->dev = &misc_pdev->dev;
155 
156 	/*
157 	 * Check the various over current related properties. If over current
158 	 * detection is disabled we're not interested in the polarity.
159 	 */
160 	if (of_find_property(np, "disable-over-current", NULL)) {
161 		data->disable_oc = 1;
162 	} else if (of_find_property(np, "over-current-active-high", NULL)) {
163 		data->oc_pol_active_low = 0;
164 		data->oc_pol_configured = 1;
165 	} else if (of_find_property(np, "over-current-active-low", NULL)) {
166 		data->oc_pol_active_low = 1;
167 		data->oc_pol_configured = 1;
168 	} else {
169 		dev_warn(dev, "No over current polarity defined\n");
170 	}
171 
172 	data->pwr_pol = of_property_read_bool(np, "power-active-high");
173 	data->evdo = of_property_read_bool(np, "external-vbus-divider");
174 
175 	if (of_usb_get_phy_mode(np) == USBPHY_INTERFACE_MODE_ULPI)
176 		data->ulpi = 1;
177 
178 	if (of_property_read_u32(np, "samsung,picophy-pre-emp-curr-control",
179 			&data->emp_curr_control))
180 		data->emp_curr_control = -1;
181 	if (of_property_read_u32(np, "samsung,picophy-dc-vol-level-adjust",
182 			&data->dc_vol_level_adjust))
183 		data->dc_vol_level_adjust = -1;
184 
185 	return data;
186 }
187 
188 /* End of common functions shared by usbmisc drivers*/
imx_get_clks(struct device * dev)189 static int imx_get_clks(struct device *dev)
190 {
191 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
192 	int ret = 0;
193 
194 	data->clk_ipg = devm_clk_get(dev, "ipg");
195 	if (IS_ERR(data->clk_ipg)) {
196 		/* If the platform only needs one clocks */
197 		data->clk = devm_clk_get(dev, NULL);
198 		if (IS_ERR(data->clk)) {
199 			ret = PTR_ERR(data->clk);
200 			dev_err(dev,
201 				"Failed to get clks, err=%ld,%ld\n",
202 				PTR_ERR(data->clk), PTR_ERR(data->clk_ipg));
203 			return ret;
204 		}
205 		return ret;
206 	}
207 
208 	data->clk_ahb = devm_clk_get(dev, "ahb");
209 	if (IS_ERR(data->clk_ahb)) {
210 		ret = PTR_ERR(data->clk_ahb);
211 		dev_err(dev,
212 			"Failed to get ahb clock, err=%d\n", ret);
213 		return ret;
214 	}
215 
216 	data->clk_per = devm_clk_get(dev, "per");
217 	if (IS_ERR(data->clk_per)) {
218 		ret = PTR_ERR(data->clk_per);
219 		dev_err(dev,
220 			"Failed to get per clock, err=%d\n", ret);
221 		return ret;
222 	}
223 
224 	data->need_three_clks = true;
225 	return ret;
226 }
227 
imx_prepare_enable_clks(struct device * dev)228 static int imx_prepare_enable_clks(struct device *dev)
229 {
230 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
231 	int ret = 0;
232 
233 	if (data->need_three_clks) {
234 		ret = clk_prepare_enable(data->clk_ipg);
235 		if (ret) {
236 			dev_err(dev,
237 				"Failed to prepare/enable ipg clk, err=%d\n",
238 				ret);
239 			return ret;
240 		}
241 
242 		ret = clk_prepare_enable(data->clk_ahb);
243 		if (ret) {
244 			dev_err(dev,
245 				"Failed to prepare/enable ahb clk, err=%d\n",
246 				ret);
247 			clk_disable_unprepare(data->clk_ipg);
248 			return ret;
249 		}
250 
251 		ret = clk_prepare_enable(data->clk_per);
252 		if (ret) {
253 			dev_err(dev,
254 				"Failed to prepare/enable per clk, err=%d\n",
255 				ret);
256 			clk_disable_unprepare(data->clk_ahb);
257 			clk_disable_unprepare(data->clk_ipg);
258 			return ret;
259 		}
260 	} else {
261 		ret = clk_prepare_enable(data->clk);
262 		if (ret) {
263 			dev_err(dev,
264 				"Failed to prepare/enable clk, err=%d\n",
265 				ret);
266 			return ret;
267 		}
268 	}
269 
270 	return ret;
271 }
272 
imx_disable_unprepare_clks(struct device * dev)273 static void imx_disable_unprepare_clks(struct device *dev)
274 {
275 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
276 
277 	if (data->need_three_clks) {
278 		clk_disable_unprepare(data->clk_per);
279 		clk_disable_unprepare(data->clk_ahb);
280 		clk_disable_unprepare(data->clk_ipg);
281 	} else {
282 		clk_disable_unprepare(data->clk);
283 	}
284 }
285 
ci_hdrc_imx_notify_event(struct ci_hdrc * ci,unsigned int event)286 static int ci_hdrc_imx_notify_event(struct ci_hdrc *ci, unsigned int event)
287 {
288 	struct device *dev = ci->dev->parent;
289 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
290 	int ret = 0;
291 	struct imx_usbmisc_data *mdata = data->usbmisc_data;
292 
293 	switch (event) {
294 	case CI_HDRC_IMX_HSIC_ACTIVE_EVENT:
295 		if (data->pinctrl) {
296 			ret = pinctrl_select_state(data->pinctrl,
297 					data->pinctrl_hsic_active);
298 			if (ret)
299 				dev_err(dev,
300 					"hsic_active select failed, err=%d\n",
301 					ret);
302 		}
303 		break;
304 	case CI_HDRC_IMX_HSIC_SUSPEND_EVENT:
305 		ret = imx_usbmisc_hsic_set_connect(mdata);
306 		if (ret)
307 			dev_err(dev,
308 				"hsic_set_connect failed, err=%d\n", ret);
309 		break;
310 	case CI_HDRC_CONTROLLER_VBUS_EVENT:
311 		if (ci->vbus_active)
312 			ret = imx_usbmisc_charger_detection(mdata, true);
313 		else
314 			ret = imx_usbmisc_charger_detection(mdata, false);
315 		if (ci->usb_phy)
316 			schedule_work(&ci->usb_phy->chg_work);
317 		break;
318 	default:
319 		break;
320 	}
321 
322 	return ret;
323 }
324 
ci_hdrc_imx_probe(struct platform_device * pdev)325 static int ci_hdrc_imx_probe(struct platform_device *pdev)
326 {
327 	struct ci_hdrc_imx_data *data;
328 	struct ci_hdrc_platform_data pdata = {
329 		.name		= dev_name(&pdev->dev),
330 		.capoffset	= DEF_CAPOFFSET,
331 		.notify_event	= ci_hdrc_imx_notify_event,
332 	};
333 	int ret;
334 	const struct ci_hdrc_imx_platform_flag *imx_platform_flag;
335 	struct device_node *np = pdev->dev.of_node;
336 	struct device *dev = &pdev->dev;
337 
338 	imx_platform_flag = of_device_get_match_data(&pdev->dev);
339 
340 	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
341 	if (!data)
342 		return -ENOMEM;
343 
344 	data->plat_data = imx_platform_flag;
345 	pdata.flags |= imx_platform_flag->flags;
346 	platform_set_drvdata(pdev, data);
347 	data->usbmisc_data = usbmisc_get_init_data(dev);
348 	if (IS_ERR(data->usbmisc_data))
349 		return PTR_ERR(data->usbmisc_data);
350 
351 	if ((of_usb_get_phy_mode(dev->of_node) == USBPHY_INTERFACE_MODE_HSIC)
352 		&& data->usbmisc_data) {
353 		pdata.flags |= CI_HDRC_IMX_IS_HSIC;
354 		data->usbmisc_data->hsic = 1;
355 		data->pinctrl = devm_pinctrl_get(dev);
356 		if (PTR_ERR(data->pinctrl) == -ENODEV)
357 			data->pinctrl = NULL;
358 		else if (IS_ERR(data->pinctrl)) {
359 			if (PTR_ERR(data->pinctrl) != -EPROBE_DEFER)
360 				dev_err(dev, "pinctrl get failed, err=%ld\n",
361 					PTR_ERR(data->pinctrl));
362 			return PTR_ERR(data->pinctrl);
363 		}
364 
365 		data->hsic_pad_regulator =
366 				devm_regulator_get_optional(dev, "hsic");
367 		if (PTR_ERR(data->hsic_pad_regulator) == -ENODEV) {
368 			/* no pad regualator is needed */
369 			data->hsic_pad_regulator = NULL;
370 		} else if (IS_ERR(data->hsic_pad_regulator)) {
371 			if (PTR_ERR(data->hsic_pad_regulator) != -EPROBE_DEFER)
372 				dev_err(dev,
373 					"Get HSIC pad regulator error: %ld\n",
374 					PTR_ERR(data->hsic_pad_regulator));
375 			return PTR_ERR(data->hsic_pad_regulator);
376 		}
377 
378 		if (data->hsic_pad_regulator) {
379 			ret = regulator_enable(data->hsic_pad_regulator);
380 			if (ret) {
381 				dev_err(dev,
382 					"Failed to enable HSIC pad regulator\n");
383 				return ret;
384 			}
385 		}
386 	}
387 
388 	/* HSIC pinctrl handling */
389 	if (data->pinctrl) {
390 		struct pinctrl_state *pinctrl_hsic_idle;
391 
392 		pinctrl_hsic_idle = pinctrl_lookup_state(data->pinctrl, "idle");
393 		if (IS_ERR(pinctrl_hsic_idle)) {
394 			dev_err(dev,
395 				"pinctrl_hsic_idle lookup failed, err=%ld\n",
396 					PTR_ERR(pinctrl_hsic_idle));
397 			return PTR_ERR(pinctrl_hsic_idle);
398 		}
399 
400 		ret = pinctrl_select_state(data->pinctrl, pinctrl_hsic_idle);
401 		if (ret) {
402 			dev_err(dev, "hsic_idle select failed, err=%d\n", ret);
403 			return ret;
404 		}
405 
406 		data->pinctrl_hsic_active = pinctrl_lookup_state(data->pinctrl,
407 								"active");
408 		if (IS_ERR(data->pinctrl_hsic_active)) {
409 			dev_err(dev,
410 				"pinctrl_hsic_active lookup failed, err=%ld\n",
411 					PTR_ERR(data->pinctrl_hsic_active));
412 			return PTR_ERR(data->pinctrl_hsic_active);
413 		}
414 	}
415 
416 	if (pdata.flags & CI_HDRC_PMQOS)
417 		cpu_latency_qos_add_request(&data->pm_qos_req, 0);
418 
419 	ret = imx_get_clks(dev);
420 	if (ret)
421 		goto disable_hsic_regulator;
422 
423 	ret = imx_prepare_enable_clks(dev);
424 	if (ret)
425 		goto disable_hsic_regulator;
426 
427 	data->phy = devm_usb_get_phy_by_phandle(dev, "fsl,usbphy", 0);
428 	if (IS_ERR(data->phy)) {
429 		ret = PTR_ERR(data->phy);
430 		if (ret != -ENODEV)
431 			goto err_clk;
432 		data->phy = devm_usb_get_phy_by_phandle(dev, "phys", 0);
433 		if (IS_ERR(data->phy)) {
434 			ret = PTR_ERR(data->phy);
435 			if (ret == -ENODEV)
436 				data->phy = NULL;
437 			else
438 				goto err_clk;
439 		}
440 	}
441 
442 	pdata.usb_phy = data->phy;
443 	if (data->usbmisc_data)
444 		data->usbmisc_data->usb_phy = data->phy;
445 
446 	if ((of_device_is_compatible(np, "fsl,imx53-usb") ||
447 	     of_device_is_compatible(np, "fsl,imx51-usb")) && pdata.usb_phy &&
448 	    of_usb_get_phy_mode(np) == USBPHY_INTERFACE_MODE_ULPI) {
449 		pdata.flags |= CI_HDRC_OVERRIDE_PHY_CONTROL;
450 		data->override_phy_control = true;
451 		usb_phy_init(pdata.usb_phy);
452 	}
453 
454 	if (pdata.flags & CI_HDRC_SUPPORTS_RUNTIME_PM)
455 		data->supports_runtime_pm = true;
456 
457 	ret = imx_usbmisc_init(data->usbmisc_data);
458 	if (ret) {
459 		dev_err(dev, "usbmisc init failed, ret=%d\n", ret);
460 		goto err_clk;
461 	}
462 
463 	data->ci_pdev = ci_hdrc_add_device(dev,
464 				pdev->resource, pdev->num_resources,
465 				&pdata);
466 	if (IS_ERR(data->ci_pdev)) {
467 		ret = PTR_ERR(data->ci_pdev);
468 		if (ret != -EPROBE_DEFER)
469 			dev_err(dev, "ci_hdrc_add_device failed, err=%d\n",
470 					ret);
471 		goto err_clk;
472 	}
473 
474 	if (data->usbmisc_data) {
475 		if (!IS_ERR(pdata.id_extcon.edev) ||
476 		    of_property_read_bool(np, "usb-role-switch"))
477 			data->usbmisc_data->ext_id = 1;
478 
479 		if (!IS_ERR(pdata.vbus_extcon.edev) ||
480 		    of_property_read_bool(np, "usb-role-switch"))
481 			data->usbmisc_data->ext_vbus = 1;
482 
483 		/* usbmisc needs to know dr mode to choose wakeup setting */
484 		data->usbmisc_data->available_role =
485 			ci_hdrc_query_available_role(data->ci_pdev);
486 	}
487 
488 	ret = imx_usbmisc_init_post(data->usbmisc_data);
489 	if (ret) {
490 		dev_err(dev, "usbmisc post failed, ret=%d\n", ret);
491 		goto disable_device;
492 	}
493 
494 	if (data->supports_runtime_pm) {
495 		pm_runtime_set_active(dev);
496 		pm_runtime_enable(dev);
497 	}
498 
499 	device_set_wakeup_capable(dev, true);
500 
501 	return 0;
502 
503 disable_device:
504 	ci_hdrc_remove_device(data->ci_pdev);
505 err_clk:
506 	imx_disable_unprepare_clks(dev);
507 disable_hsic_regulator:
508 	if (data->hsic_pad_regulator)
509 		/* don't overwrite original ret (cf. EPROBE_DEFER) */
510 		regulator_disable(data->hsic_pad_regulator);
511 	if (pdata.flags & CI_HDRC_PMQOS)
512 		cpu_latency_qos_remove_request(&data->pm_qos_req);
513 	data->ci_pdev = NULL;
514 	return ret;
515 }
516 
ci_hdrc_imx_remove(struct platform_device * pdev)517 static int ci_hdrc_imx_remove(struct platform_device *pdev)
518 {
519 	struct ci_hdrc_imx_data *data = platform_get_drvdata(pdev);
520 
521 	if (data->supports_runtime_pm) {
522 		pm_runtime_get_sync(&pdev->dev);
523 		pm_runtime_disable(&pdev->dev);
524 		pm_runtime_put_noidle(&pdev->dev);
525 	}
526 	if (data->ci_pdev)
527 		ci_hdrc_remove_device(data->ci_pdev);
528 	if (data->override_phy_control)
529 		usb_phy_shutdown(data->phy);
530 	if (data->ci_pdev) {
531 		imx_disable_unprepare_clks(&pdev->dev);
532 		if (data->plat_data->flags & CI_HDRC_PMQOS)
533 			cpu_latency_qos_remove_request(&data->pm_qos_req);
534 		if (data->hsic_pad_regulator)
535 			regulator_disable(data->hsic_pad_regulator);
536 	}
537 
538 	return 0;
539 }
540 
ci_hdrc_imx_shutdown(struct platform_device * pdev)541 static void ci_hdrc_imx_shutdown(struct platform_device *pdev)
542 {
543 	ci_hdrc_imx_remove(pdev);
544 }
545 
imx_controller_suspend(struct device * dev)546 static int __maybe_unused imx_controller_suspend(struct device *dev)
547 {
548 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
549 	int ret = 0;
550 
551 	dev_dbg(dev, "at %s\n", __func__);
552 
553 	ret = imx_usbmisc_hsic_set_clk(data->usbmisc_data, false);
554 	if (ret) {
555 		dev_err(dev, "usbmisc hsic_set_clk failed, ret=%d\n", ret);
556 		return ret;
557 	}
558 
559 	imx_disable_unprepare_clks(dev);
560 	if (data->plat_data->flags & CI_HDRC_PMQOS)
561 		cpu_latency_qos_remove_request(&data->pm_qos_req);
562 
563 	data->in_lpm = true;
564 
565 	return 0;
566 }
567 
imx_controller_resume(struct device * dev)568 static int __maybe_unused imx_controller_resume(struct device *dev)
569 {
570 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
571 	int ret = 0;
572 
573 	dev_dbg(dev, "at %s\n", __func__);
574 
575 	if (!data->in_lpm) {
576 		WARN_ON(1);
577 		return 0;
578 	}
579 
580 	if (data->plat_data->flags & CI_HDRC_PMQOS)
581 		cpu_latency_qos_add_request(&data->pm_qos_req, 0);
582 
583 	ret = imx_prepare_enable_clks(dev);
584 	if (ret)
585 		return ret;
586 
587 	data->in_lpm = false;
588 
589 	ret = imx_usbmisc_set_wakeup(data->usbmisc_data, false);
590 	if (ret) {
591 		dev_err(dev, "usbmisc set_wakeup failed, ret=%d\n", ret);
592 		goto clk_disable;
593 	}
594 
595 	ret = imx_usbmisc_hsic_set_clk(data->usbmisc_data, true);
596 	if (ret) {
597 		dev_err(dev, "usbmisc hsic_set_clk failed, ret=%d\n", ret);
598 		goto hsic_set_clk_fail;
599 	}
600 
601 	return 0;
602 
603 hsic_set_clk_fail:
604 	imx_usbmisc_set_wakeup(data->usbmisc_data, true);
605 clk_disable:
606 	imx_disable_unprepare_clks(dev);
607 	return ret;
608 }
609 
ci_hdrc_imx_suspend(struct device * dev)610 static int __maybe_unused ci_hdrc_imx_suspend(struct device *dev)
611 {
612 	int ret;
613 
614 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
615 
616 	if (data->in_lpm)
617 		/* The core's suspend doesn't run */
618 		return 0;
619 
620 	if (device_may_wakeup(dev)) {
621 		ret = imx_usbmisc_set_wakeup(data->usbmisc_data, true);
622 		if (ret) {
623 			dev_err(dev, "usbmisc set_wakeup failed, ret=%d\n",
624 					ret);
625 			return ret;
626 		}
627 	}
628 
629 	ret = imx_controller_suspend(dev);
630 	if (ret)
631 		return ret;
632 
633 	pinctrl_pm_select_sleep_state(dev);
634 	return ret;
635 }
636 
ci_hdrc_imx_resume(struct device * dev)637 static int __maybe_unused ci_hdrc_imx_resume(struct device *dev)
638 {
639 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
640 	int ret;
641 
642 	pinctrl_pm_select_default_state(dev);
643 	ret = imx_controller_resume(dev);
644 	if (!ret && data->supports_runtime_pm) {
645 		pm_runtime_disable(dev);
646 		pm_runtime_set_active(dev);
647 		pm_runtime_enable(dev);
648 	}
649 
650 	return ret;
651 }
652 
ci_hdrc_imx_runtime_suspend(struct device * dev)653 static int __maybe_unused ci_hdrc_imx_runtime_suspend(struct device *dev)
654 {
655 	struct ci_hdrc_imx_data *data = dev_get_drvdata(dev);
656 	int ret;
657 
658 	if (data->in_lpm) {
659 		WARN_ON(1);
660 		return 0;
661 	}
662 
663 	ret = imx_usbmisc_set_wakeup(data->usbmisc_data, true);
664 	if (ret) {
665 		dev_err(dev, "usbmisc set_wakeup failed, ret=%d\n", ret);
666 		return ret;
667 	}
668 
669 	return imx_controller_suspend(dev);
670 }
671 
ci_hdrc_imx_runtime_resume(struct device * dev)672 static int __maybe_unused ci_hdrc_imx_runtime_resume(struct device *dev)
673 {
674 	return imx_controller_resume(dev);
675 }
676 
677 static const struct dev_pm_ops ci_hdrc_imx_pm_ops = {
678 	SET_SYSTEM_SLEEP_PM_OPS(ci_hdrc_imx_suspend, ci_hdrc_imx_resume)
679 	SET_RUNTIME_PM_OPS(ci_hdrc_imx_runtime_suspend,
680 			ci_hdrc_imx_runtime_resume, NULL)
681 };
682 static struct platform_driver ci_hdrc_imx_driver = {
683 	.probe = ci_hdrc_imx_probe,
684 	.remove = ci_hdrc_imx_remove,
685 	.shutdown = ci_hdrc_imx_shutdown,
686 	.driver = {
687 		.name = "imx_usb",
688 		.of_match_table = ci_hdrc_imx_dt_ids,
689 		.pm = &ci_hdrc_imx_pm_ops,
690 	 },
691 };
692 
693 module_platform_driver(ci_hdrc_imx_driver);
694 
695 MODULE_ALIAS("platform:imx-usb");
696 MODULE_LICENSE("GPL");
697 MODULE_DESCRIPTION("CI HDRC i.MX USB binding");
698 MODULE_AUTHOR("Marek Vasut <marex@denx.de>");
699 MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");
700