Linux Audio

Check our new training course

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