Linux Audio

Check our new training course

Loading...
v4.6
 
  1/*
  2 * Copyright 2012 Freescale Semiconductor, Inc.
  3 *
  4 * The code contained herein is licensed under the GNU General Public
  5 * License. You may obtain a copy of the GNU General Public License
  6 * Version 2 or later at the following locations:
  7 *
  8 * http://www.opensource.org/licenses/gpl-license.html
  9 * http://www.gnu.org/copyleft/gpl.html
 10 */
 11
 12#include <linux/module.h>
 13#include <linux/of_platform.h>
 14#include <linux/err.h>
 15#include <linux/io.h>
 16#include <linux/delay.h>
 17
 18#include "ci_hdrc_imx.h"
 19
 20#define MX25_USB_PHY_CTRL_OFFSET	0x08
 21#define MX25_BM_EXTERNAL_VBUS_DIVIDER	BIT(23)
 22
 23#define MX25_EHCI_INTERFACE_SINGLE_UNI	(2 << 0)
 24#define MX25_EHCI_INTERFACE_DIFF_UNI	(0 << 0)
 25#define MX25_EHCI_INTERFACE_MASK	(0xf)
 26
 27#define MX25_OTG_SIC_SHIFT		29
 28#define MX25_OTG_SIC_MASK		(0x3 << MX25_OTG_SIC_SHIFT)
 29#define MX25_OTG_PM_BIT			BIT(24)
 30#define MX25_OTG_PP_BIT			BIT(11)
 31#define MX25_OTG_OCPOL_BIT		BIT(3)
 32
 33#define MX25_H1_SIC_SHIFT		21
 34#define MX25_H1_SIC_MASK		(0x3 << MX25_H1_SIC_SHIFT)
 35#define MX25_H1_PP_BIT			BIT(18)
 36#define MX25_H1_PM_BIT			BIT(16)
 37#define MX25_H1_IPPUE_UP_BIT		BIT(7)
 38#define MX25_H1_IPPUE_DOWN_BIT		BIT(6)
 39#define MX25_H1_TLL_BIT			BIT(5)
 40#define MX25_H1_USBTE_BIT		BIT(4)
 41#define MX25_H1_OCPOL_BIT		BIT(2)
 42
 43#define MX27_H1_PM_BIT			BIT(8)
 44#define MX27_H2_PM_BIT			BIT(16)
 45#define MX27_OTG_PM_BIT			BIT(24)
 46
 47#define MX53_USB_OTG_PHY_CTRL_0_OFFSET	0x08
 48#define MX53_USB_OTG_PHY_CTRL_1_OFFSET	0x0c
 
 
 
 
 
 49#define MX53_USB_UH2_CTRL_OFFSET	0x14
 50#define MX53_USB_UH3_CTRL_OFFSET	0x18
 
 
 
 51#define MX53_BM_OVER_CUR_DIS_H1		BIT(5)
 52#define MX53_BM_OVER_CUR_DIS_OTG	BIT(8)
 53#define MX53_BM_OVER_CUR_DIS_UHx	BIT(30)
 
 
 
 
 54#define MX53_USB_PHYCTRL1_PLLDIV_MASK	0x3
 55#define MX53_USB_PLL_DIV_24_MHZ		0x01
 56
 57#define MX6_BM_NON_BURST_SETTING	BIT(1)
 58#define MX6_BM_OVER_CUR_DIS		BIT(7)
 
 
 59#define MX6_BM_WAKEUP_ENABLE		BIT(10)
 
 60#define MX6_BM_ID_WAKEUP		BIT(16)
 61#define MX6_BM_VBUS_WAKEUP		BIT(17)
 62#define MX6SX_BM_DPDM_WAKEUP_EN		BIT(29)
 63#define MX6_BM_WAKEUP_INTR		BIT(31)
 
 
 
 
 
 
 
 
 
 
 
 64#define MX6_USB_OTG1_PHY_CTRL		0x18
 65/* For imx6dql, it is host-only controller, for later imx6, it is otg's */
 66#define MX6_USB_OTG2_PHY_CTRL		0x1c
 67#define MX6SX_USB_VBUS_WAKEUP_SOURCE(v)	(v << 8)
 68#define MX6SX_USB_VBUS_WAKEUP_SOURCE_VBUS	MX6SX_USB_VBUS_WAKEUP_SOURCE(0)
 69#define MX6SX_USB_VBUS_WAKEUP_SOURCE_AVALID	MX6SX_USB_VBUS_WAKEUP_SOURCE(1)
 70#define MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID	MX6SX_USB_VBUS_WAKEUP_SOURCE(2)
 71#define MX6SX_USB_VBUS_WAKEUP_SOURCE_SESS_END	MX6SX_USB_VBUS_WAKEUP_SOURCE(3)
 72
 73#define VF610_OVER_CUR_DIS		BIT(7)
 74
 75#define MX7D_USBNC_USB_CTRL2		0x4
 76#define MX7D_USB_VBUS_WAKEUP_SOURCE_MASK	0x3
 77#define MX7D_USB_VBUS_WAKEUP_SOURCE(v)		(v << 0)
 78#define MX7D_USB_VBUS_WAKEUP_SOURCE_VBUS	MX7D_USB_VBUS_WAKEUP_SOURCE(0)
 79#define MX7D_USB_VBUS_WAKEUP_SOURCE_AVALID	MX7D_USB_VBUS_WAKEUP_SOURCE(1)
 80#define MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID	MX7D_USB_VBUS_WAKEUP_SOURCE(2)
 81#define MX7D_USB_VBUS_WAKEUP_SOURCE_SESS_END	MX7D_USB_VBUS_WAKEUP_SOURCE(3)
 82
 83struct usbmisc_ops {
 84	/* It's called once when probe a usb device */
 85	int (*init)(struct imx_usbmisc_data *data);
 86	/* It's called once after adding a usb device */
 87	int (*post)(struct imx_usbmisc_data *data);
 88	/* It's called when we need to enable/disable usb wakeup */
 89	int (*set_wakeup)(struct imx_usbmisc_data *data, bool enabled);
 
 
 
 
 90};
 91
 92struct imx_usbmisc {
 93	void __iomem *base;
 94	spinlock_t lock;
 95	const struct usbmisc_ops *ops;
 96};
 97
 
 
 98static int usbmisc_imx25_init(struct imx_usbmisc_data *data)
 99{
100	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
101	unsigned long flags;
102	u32 val = 0;
103
104	if (data->index > 1)
105		return -EINVAL;
106
107	spin_lock_irqsave(&usbmisc->lock, flags);
108	switch (data->index) {
109	case 0:
110		val = readl(usbmisc->base);
111		val &= ~(MX25_OTG_SIC_MASK | MX25_OTG_PP_BIT);
112		val |= (MX25_EHCI_INTERFACE_DIFF_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_OTG_SIC_SHIFT;
113		val |= (MX25_OTG_PM_BIT | MX25_OTG_OCPOL_BIT);
 
 
 
 
 
 
 
 
114		writel(val, usbmisc->base);
115		break;
116	case 1:
117		val = readl(usbmisc->base);
118		val &= ~(MX25_H1_SIC_MASK | MX25_H1_PP_BIT |  MX25_H1_IPPUE_UP_BIT);
119		val |= (MX25_EHCI_INTERFACE_SINGLE_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_H1_SIC_SHIFT;
120		val |= (MX25_H1_PM_BIT | MX25_H1_OCPOL_BIT | MX25_H1_TLL_BIT |
121			MX25_H1_USBTE_BIT | MX25_H1_IPPUE_DOWN_BIT);
122
 
 
 
 
 
 
 
123		writel(val, usbmisc->base);
124
125		break;
126	}
127	spin_unlock_irqrestore(&usbmisc->lock, flags);
128
129	return 0;
130}
131
132static int usbmisc_imx25_post(struct imx_usbmisc_data *data)
133{
134	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
135	void __iomem *reg;
136	unsigned long flags;
137	u32 val;
138
139	if (data->index > 2)
140		return -EINVAL;
141
142	if (data->evdo) {
143		spin_lock_irqsave(&usbmisc->lock, flags);
144		reg = usbmisc->base + MX25_USB_PHY_CTRL_OFFSET;
145		val = readl(reg);
146		writel(val | MX25_BM_EXTERNAL_VBUS_DIVIDER, reg);
147		spin_unlock_irqrestore(&usbmisc->lock, flags);
148		usleep_range(5000, 10000); /* needed to stabilize voltage */
149	}
 
 
 
 
 
 
 
150
151	return 0;
152}
153
154static int usbmisc_imx27_init(struct imx_usbmisc_data *data)
155{
156	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
157	unsigned long flags;
158	u32 val;
159
160	switch (data->index) {
161	case 0:
162		val = MX27_OTG_PM_BIT;
163		break;
164	case 1:
165		val = MX27_H1_PM_BIT;
166		break;
167	case 2:
168		val = MX27_H2_PM_BIT;
169		break;
170	default:
171		return -EINVAL;
172	}
173
174	spin_lock_irqsave(&usbmisc->lock, flags);
175	if (data->disable_oc)
176		val = readl(usbmisc->base) | val;
177	else
178		val = readl(usbmisc->base) & ~val;
179	writel(val, usbmisc->base);
180	spin_unlock_irqrestore(&usbmisc->lock, flags);
181
182	return 0;
183}
184
185static int usbmisc_imx53_init(struct imx_usbmisc_data *data)
186{
187	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
188	void __iomem *reg = NULL;
189	unsigned long flags;
190	u32 val = 0;
191
192	if (data->index > 3)
193		return -EINVAL;
194
195	/* Select a 24 MHz reference clock for the PHY  */
196	val = readl(usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
197	val &= ~MX53_USB_PHYCTRL1_PLLDIV_MASK;
198	val |= MX53_USB_PLL_DIV_24_MHZ;
199	writel(val, usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
200
201	if (data->disable_oc) {
202		spin_lock_irqsave(&usbmisc->lock, flags);
203		switch (data->index) {
204		case 0:
 
205			reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
206			val = readl(reg) | MX53_BM_OVER_CUR_DIS_OTG;
207			break;
208		case 1:
 
 
 
209			reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
210			val = readl(reg) | MX53_BM_OVER_CUR_DIS_H1;
211			break;
212		case 2:
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
213			reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
214			val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
215			break;
216		case 3:
 
 
 
 
 
 
 
 
 
 
 
217			reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
218			val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
219			break;
 
 
 
 
 
 
 
 
 
 
220		}
221		if (reg && val)
 
 
222			writel(val, reg);
223		spin_unlock_irqrestore(&usbmisc->lock, flags);
 
224	}
225
 
 
226	return 0;
227}
228
229static int usbmisc_imx6q_set_wakeup
230	(struct imx_usbmisc_data *data, bool enabled)
231{
232	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
233	unsigned long flags;
234	u32 val;
235	u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
236		MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
237	int ret = 0;
238
239	if (data->index > 3)
240		return -EINVAL;
241
242	spin_lock_irqsave(&usbmisc->lock, flags);
243	val = readl(usbmisc->base + data->index * 4);
244	if (enabled) {
245		val |= wakeup_setting;
246		writel(val, usbmisc->base + data->index * 4);
247	} else {
248		if (val & MX6_BM_WAKEUP_INTR)
249			pr_debug("wakeup int at ci_hdrc.%d\n", data->index);
250		val &= ~wakeup_setting;
251		writel(val, usbmisc->base + data->index * 4);
252	}
 
253	spin_unlock_irqrestore(&usbmisc->lock, flags);
254
255	return ret;
256}
257
258static int usbmisc_imx6q_init(struct imx_usbmisc_data *data)
259{
260	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
261	unsigned long flags;
262	u32 reg;
263
264	if (data->index > 3)
265		return -EINVAL;
266
267	spin_lock_irqsave(&usbmisc->lock, flags);
268
 
269	if (data->disable_oc) {
270		reg = readl(usbmisc->base + data->index * 4);
271		writel(reg | MX6_BM_OVER_CUR_DIS,
272			usbmisc->base + data->index * 4);
 
 
 
 
 
 
 
 
 
273	}
 
 
 
 
274
275	/* SoC non-burst setting */
276	reg = readl(usbmisc->base + data->index * 4);
277	writel(reg | MX6_BM_NON_BURST_SETTING,
278			usbmisc->base + data->index * 4);
279
 
 
 
 
 
 
 
 
 
 
 
 
280	spin_unlock_irqrestore(&usbmisc->lock, flags);
281
282	usbmisc_imx6q_set_wakeup(data, false);
283
284	return 0;
285}
286
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
287static int usbmisc_imx6sx_init(struct imx_usbmisc_data *data)
288{
289	void __iomem *reg = NULL;
290	unsigned long flags;
291	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
292	u32 val;
293
294	usbmisc_imx6q_init(data);
295
296	if (data->index == 0 || data->index == 1) {
297		reg = usbmisc->base + MX6_USB_OTG1_PHY_CTRL + data->index * 4;
298		spin_lock_irqsave(&usbmisc->lock, flags);
299		/* Set vbus wakeup source as bvalid */
300		val = readl(reg);
301		writel(val | MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID, reg);
302		/*
303		 * Disable dp/dm wakeup in device mode when vbus is
304		 * not there.
305		 */
306		val = readl(usbmisc->base + data->index * 4);
307		writel(val & ~MX6SX_BM_DPDM_WAKEUP_EN,
308			usbmisc->base + data->index * 4);
309		spin_unlock_irqrestore(&usbmisc->lock, flags);
310	}
311
 
 
 
 
 
 
 
312	return 0;
313}
314
315static int usbmisc_vf610_init(struct imx_usbmisc_data *data)
316{
317	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
318	u32 reg;
319
320	/*
321	 * Vybrid only has one misc register set, but in two different
322	 * areas. These is reflected in two instances of this driver.
323	 */
324	if (data->index >= 1)
325		return -EINVAL;
326
327	if (data->disable_oc) {
328		reg = readl(usbmisc->base);
329		writel(reg | VF610_OVER_CUR_DIS, usbmisc->base);
330	}
331
332	return 0;
333}
334
335static int usbmisc_imx7d_set_wakeup
336	(struct imx_usbmisc_data *data, bool enabled)
337{
338	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
339	unsigned long flags;
340	u32 val;
341	u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
342		MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
343
344	spin_lock_irqsave(&usbmisc->lock, flags);
345	val = readl(usbmisc->base);
346	if (enabled) {
347		writel(val | wakeup_setting, usbmisc->base);
348	} else {
349		if (val & MX6_BM_WAKEUP_INTR)
350			dev_dbg(data->dev, "wakeup int\n");
351		writel(val & ~wakeup_setting, usbmisc->base);
352	}
353	spin_unlock_irqrestore(&usbmisc->lock, flags);
354
355	return 0;
356}
357
358static int usbmisc_imx7d_init(struct imx_usbmisc_data *data)
359{
360	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
361	unsigned long flags;
362	u32 reg;
363
364	if (data->index >= 1)
365		return -EINVAL;
366
367	spin_lock_irqsave(&usbmisc->lock, flags);
 
368	if (data->disable_oc) {
369		reg = readl(usbmisc->base);
370		writel(reg | MX6_BM_OVER_CUR_DIS, usbmisc->base);
 
 
 
 
 
 
 
 
 
 
371	}
 
 
 
 
372
373	reg = readl(usbmisc->base + MX7D_USBNC_USB_CTRL2);
374	reg &= ~MX7D_USB_VBUS_WAKEUP_SOURCE_MASK;
375	writel(reg | MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID,
376		 usbmisc->base + MX7D_USBNC_USB_CTRL2);
 
377	spin_unlock_irqrestore(&usbmisc->lock, flags);
378
379	usbmisc_imx7d_set_wakeup(data, false);
380
381	return 0;
382}
383
384static const struct usbmisc_ops imx25_usbmisc_ops = {
385	.init = usbmisc_imx25_init,
386	.post = usbmisc_imx25_post,
387};
388
389static const struct usbmisc_ops imx27_usbmisc_ops = {
390	.init = usbmisc_imx27_init,
391};
392
 
 
 
 
393static const struct usbmisc_ops imx53_usbmisc_ops = {
394	.init = usbmisc_imx53_init,
395};
396
397static const struct usbmisc_ops imx6q_usbmisc_ops = {
398	.set_wakeup = usbmisc_imx6q_set_wakeup,
399	.init = usbmisc_imx6q_init,
 
 
400};
401
402static const struct usbmisc_ops vf610_usbmisc_ops = {
403	.init = usbmisc_vf610_init,
404};
405
406static const struct usbmisc_ops imx6sx_usbmisc_ops = {
407	.set_wakeup = usbmisc_imx6q_set_wakeup,
408	.init = usbmisc_imx6sx_init,
 
 
409};
410
411static const struct usbmisc_ops imx7d_usbmisc_ops = {
412	.init = usbmisc_imx7d_init,
413	.set_wakeup = usbmisc_imx7d_set_wakeup,
414};
415
 
 
 
 
 
 
 
416int imx_usbmisc_init(struct imx_usbmisc_data *data)
417{
418	struct imx_usbmisc *usbmisc;
419
420	if (!data)
421		return 0;
422
423	usbmisc = dev_get_drvdata(data->dev);
424	if (!usbmisc->ops->init)
425		return 0;
426	return usbmisc->ops->init(data);
427}
428EXPORT_SYMBOL_GPL(imx_usbmisc_init);
429
430int imx_usbmisc_init_post(struct imx_usbmisc_data *data)
431{
432	struct imx_usbmisc *usbmisc;
433
434	if (!data)
435		return 0;
436
437	usbmisc = dev_get_drvdata(data->dev);
438	if (!usbmisc->ops->post)
439		return 0;
440	return usbmisc->ops->post(data);
441}
442EXPORT_SYMBOL_GPL(imx_usbmisc_init_post);
443
444int imx_usbmisc_set_wakeup(struct imx_usbmisc_data *data, bool enabled)
445{
446	struct imx_usbmisc *usbmisc;
447
448	if (!data)
449		return 0;
450
451	usbmisc = dev_get_drvdata(data->dev);
452	if (!usbmisc->ops->set_wakeup)
453		return 0;
454	return usbmisc->ops->set_wakeup(data, enabled);
455}
456EXPORT_SYMBOL_GPL(imx_usbmisc_set_wakeup);
457
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
458static const struct of_device_id usbmisc_imx_dt_ids[] = {
459	{
460		.compatible = "fsl,imx25-usbmisc",
461		.data = &imx25_usbmisc_ops,
462	},
463	{
464		.compatible = "fsl,imx35-usbmisc",
465		.data = &imx25_usbmisc_ops,
466	},
467	{
468		.compatible = "fsl,imx27-usbmisc",
469		.data = &imx27_usbmisc_ops,
470	},
471	{
472		.compatible = "fsl,imx51-usbmisc",
473		.data = &imx53_usbmisc_ops,
474	},
475	{
476		.compatible = "fsl,imx53-usbmisc",
477		.data = &imx53_usbmisc_ops,
478	},
479	{
480		.compatible = "fsl,imx6q-usbmisc",
481		.data = &imx6q_usbmisc_ops,
482	},
483	{
484		.compatible = "fsl,vf610-usbmisc",
485		.data = &vf610_usbmisc_ops,
486	},
487	{
488		.compatible = "fsl,imx6sx-usbmisc",
489		.data = &imx6sx_usbmisc_ops,
490	},
491	{
492		.compatible = "fsl,imx6ul-usbmisc",
493		.data = &imx6sx_usbmisc_ops,
494	},
 
 
 
 
 
 
 
 
495	{ /* sentinel */ }
496};
497MODULE_DEVICE_TABLE(of, usbmisc_imx_dt_ids);
498
499static int usbmisc_imx_probe(struct platform_device *pdev)
500{
501	struct resource	*res;
502	struct imx_usbmisc *data;
503	const struct of_device_id *of_id;
504
505	of_id = of_match_device(usbmisc_imx_dt_ids, &pdev->dev);
506	if (!of_id)
507		return -ENODEV;
508
509	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
510	if (!data)
511		return -ENOMEM;
512
513	spin_lock_init(&data->lock);
514
515	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
516	data->base = devm_ioremap_resource(&pdev->dev, res);
517	if (IS_ERR(data->base))
518		return PTR_ERR(data->base);
519
520	data->ops = (const struct usbmisc_ops *)of_id->data;
521	platform_set_drvdata(pdev, data);
522
523	return 0;
524}
525
526static int usbmisc_imx_remove(struct platform_device *pdev)
527{
528	return 0;
529}
530
531static struct platform_driver usbmisc_imx_driver = {
532	.probe = usbmisc_imx_probe,
533	.remove = usbmisc_imx_remove,
534	.driver = {
535		.name = "usbmisc_imx",
536		.of_match_table = usbmisc_imx_dt_ids,
537	 },
538};
539
540module_platform_driver(usbmisc_imx_driver);
541
542MODULE_ALIAS("platform:usbmisc-imx");
543MODULE_LICENSE("GPL v2");
544MODULE_DESCRIPTION("driver for imx usb non-core registers");
545MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");
v5.4
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * Copyright 2012 Freescale Semiconductor, Inc.
 
 
 
 
 
 
 
  4 */
  5
  6#include <linux/module.h>
  7#include <linux/of_platform.h>
  8#include <linux/err.h>
  9#include <linux/io.h>
 10#include <linux/delay.h>
 11
 12#include "ci_hdrc_imx.h"
 13
 14#define MX25_USB_PHY_CTRL_OFFSET	0x08
 15#define MX25_BM_EXTERNAL_VBUS_DIVIDER	BIT(23)
 16
 17#define MX25_EHCI_INTERFACE_SINGLE_UNI	(2 << 0)
 18#define MX25_EHCI_INTERFACE_DIFF_UNI	(0 << 0)
 19#define MX25_EHCI_INTERFACE_MASK	(0xf)
 20
 21#define MX25_OTG_SIC_SHIFT		29
 22#define MX25_OTG_SIC_MASK		(0x3 << MX25_OTG_SIC_SHIFT)
 23#define MX25_OTG_PM_BIT			BIT(24)
 24#define MX25_OTG_PP_BIT			BIT(11)
 25#define MX25_OTG_OCPOL_BIT		BIT(3)
 26
 27#define MX25_H1_SIC_SHIFT		21
 28#define MX25_H1_SIC_MASK		(0x3 << MX25_H1_SIC_SHIFT)
 29#define MX25_H1_PP_BIT			BIT(18)
 30#define MX25_H1_PM_BIT			BIT(16)
 31#define MX25_H1_IPPUE_UP_BIT		BIT(7)
 32#define MX25_H1_IPPUE_DOWN_BIT		BIT(6)
 33#define MX25_H1_TLL_BIT			BIT(5)
 34#define MX25_H1_USBTE_BIT		BIT(4)
 35#define MX25_H1_OCPOL_BIT		BIT(2)
 36
 37#define MX27_H1_PM_BIT			BIT(8)
 38#define MX27_H2_PM_BIT			BIT(16)
 39#define MX27_OTG_PM_BIT			BIT(24)
 40
 41#define MX53_USB_OTG_PHY_CTRL_0_OFFSET	0x08
 42#define MX53_USB_OTG_PHY_CTRL_1_OFFSET	0x0c
 43#define MX53_USB_CTRL_1_OFFSET	        0x10
 44#define MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_MASK (0x11 << 2)
 45#define MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_ULPI BIT(2)
 46#define MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_MASK (0x11 << 6)
 47#define MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_ULPI BIT(6)
 48#define MX53_USB_UH2_CTRL_OFFSET	0x14
 49#define MX53_USB_UH3_CTRL_OFFSET	0x18
 50#define MX53_USB_CLKONOFF_CTRL_OFFSET	0x24
 51#define MX53_USB_CLKONOFF_CTRL_H2_INT60CKOFF BIT(21)
 52#define MX53_USB_CLKONOFF_CTRL_H3_INT60CKOFF BIT(22)
 53#define MX53_BM_OVER_CUR_DIS_H1		BIT(5)
 54#define MX53_BM_OVER_CUR_DIS_OTG	BIT(8)
 55#define MX53_BM_OVER_CUR_DIS_UHx	BIT(30)
 56#define MX53_USB_CTRL_1_UH2_ULPI_EN	BIT(26)
 57#define MX53_USB_CTRL_1_UH3_ULPI_EN	BIT(27)
 58#define MX53_USB_UHx_CTRL_WAKE_UP_EN	BIT(7)
 59#define MX53_USB_UHx_CTRL_ULPI_INT_EN	BIT(8)
 60#define MX53_USB_PHYCTRL1_PLLDIV_MASK	0x3
 61#define MX53_USB_PLL_DIV_24_MHZ		0x01
 62
 63#define MX6_BM_NON_BURST_SETTING	BIT(1)
 64#define MX6_BM_OVER_CUR_DIS		BIT(7)
 65#define MX6_BM_OVER_CUR_POLARITY	BIT(8)
 66#define MX6_BM_PWR_POLARITY		BIT(9)
 67#define MX6_BM_WAKEUP_ENABLE		BIT(10)
 68#define MX6_BM_UTMI_ON_CLOCK		BIT(13)
 69#define MX6_BM_ID_WAKEUP		BIT(16)
 70#define MX6_BM_VBUS_WAKEUP		BIT(17)
 71#define MX6SX_BM_DPDM_WAKEUP_EN		BIT(29)
 72#define MX6_BM_WAKEUP_INTR		BIT(31)
 73
 74#define MX6_USB_HSIC_CTRL_OFFSET	0x10
 75/* Send resume signal without 480Mhz PHY clock */
 76#define MX6SX_BM_HSIC_AUTO_RESUME	BIT(23)
 77/* set before portsc.suspendM = 1 */
 78#define MX6_BM_HSIC_DEV_CONN		BIT(21)
 79/* HSIC enable */
 80#define MX6_BM_HSIC_EN			BIT(12)
 81/* Force HSIC module 480M clock on, even when in Host is in suspend mode */
 82#define MX6_BM_HSIC_CLK_ON		BIT(11)
 83
 84#define MX6_USB_OTG1_PHY_CTRL		0x18
 85/* For imx6dql, it is host-only controller, for later imx6, it is otg's */
 86#define MX6_USB_OTG2_PHY_CTRL		0x1c
 87#define MX6SX_USB_VBUS_WAKEUP_SOURCE(v)	(v << 8)
 88#define MX6SX_USB_VBUS_WAKEUP_SOURCE_VBUS	MX6SX_USB_VBUS_WAKEUP_SOURCE(0)
 89#define MX6SX_USB_VBUS_WAKEUP_SOURCE_AVALID	MX6SX_USB_VBUS_WAKEUP_SOURCE(1)
 90#define MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID	MX6SX_USB_VBUS_WAKEUP_SOURCE(2)
 91#define MX6SX_USB_VBUS_WAKEUP_SOURCE_SESS_END	MX6SX_USB_VBUS_WAKEUP_SOURCE(3)
 92
 93#define VF610_OVER_CUR_DIS		BIT(7)
 94
 95#define MX7D_USBNC_USB_CTRL2		0x4
 96#define MX7D_USB_VBUS_WAKEUP_SOURCE_MASK	0x3
 97#define MX7D_USB_VBUS_WAKEUP_SOURCE(v)		(v << 0)
 98#define MX7D_USB_VBUS_WAKEUP_SOURCE_VBUS	MX7D_USB_VBUS_WAKEUP_SOURCE(0)
 99#define MX7D_USB_VBUS_WAKEUP_SOURCE_AVALID	MX7D_USB_VBUS_WAKEUP_SOURCE(1)
100#define MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID	MX7D_USB_VBUS_WAKEUP_SOURCE(2)
101#define MX7D_USB_VBUS_WAKEUP_SOURCE_SESS_END	MX7D_USB_VBUS_WAKEUP_SOURCE(3)
102
103struct usbmisc_ops {
104	/* It's called once when probe a usb device */
105	int (*init)(struct imx_usbmisc_data *data);
106	/* It's called once after adding a usb device */
107	int (*post)(struct imx_usbmisc_data *data);
108	/* It's called when we need to enable/disable usb wakeup */
109	int (*set_wakeup)(struct imx_usbmisc_data *data, bool enabled);
110	/* It's called before setting portsc.suspendM */
111	int (*hsic_set_connect)(struct imx_usbmisc_data *data);
112	/* It's called during suspend/resume */
113	int (*hsic_set_clk)(struct imx_usbmisc_data *data, bool enabled);
114};
115
116struct imx_usbmisc {
117	void __iomem *base;
118	spinlock_t lock;
119	const struct usbmisc_ops *ops;
120};
121
122static inline bool is_imx53_usbmisc(struct imx_usbmisc_data *data);
123
124static int usbmisc_imx25_init(struct imx_usbmisc_data *data)
125{
126	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
127	unsigned long flags;
128	u32 val = 0;
129
130	if (data->index > 1)
131		return -EINVAL;
132
133	spin_lock_irqsave(&usbmisc->lock, flags);
134	switch (data->index) {
135	case 0:
136		val = readl(usbmisc->base);
137		val &= ~(MX25_OTG_SIC_MASK | MX25_OTG_PP_BIT);
138		val |= (MX25_EHCI_INTERFACE_DIFF_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_OTG_SIC_SHIFT;
139		val |= (MX25_OTG_PM_BIT | MX25_OTG_OCPOL_BIT);
140
141		/*
142		 * If the polarity is not configured assume active high for
143		 * historical reasons.
144		 */
145		if (data->oc_pol_configured && data->oc_pol_active_low)
146			val &= ~MX25_OTG_OCPOL_BIT;
147
148		writel(val, usbmisc->base);
149		break;
150	case 1:
151		val = readl(usbmisc->base);
152		val &= ~(MX25_H1_SIC_MASK | MX25_H1_PP_BIT |  MX25_H1_IPPUE_UP_BIT);
153		val |= (MX25_EHCI_INTERFACE_SINGLE_UNI & MX25_EHCI_INTERFACE_MASK) << MX25_H1_SIC_SHIFT;
154		val |= (MX25_H1_PM_BIT | MX25_H1_OCPOL_BIT | MX25_H1_TLL_BIT |
155			MX25_H1_USBTE_BIT | MX25_H1_IPPUE_DOWN_BIT);
156
157		/*
158		 * If the polarity is not configured assume active high for
159		 * historical reasons.
160		 */
161		if (data->oc_pol_configured && data->oc_pol_active_low)
162			val &= ~MX25_H1_OCPOL_BIT;
163
164		writel(val, usbmisc->base);
165
166		break;
167	}
168	spin_unlock_irqrestore(&usbmisc->lock, flags);
169
170	return 0;
171}
172
173static int usbmisc_imx25_post(struct imx_usbmisc_data *data)
174{
175	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
176	void __iomem *reg;
177	unsigned long flags;
178	u32 val;
179
180	if (data->index > 2)
181		return -EINVAL;
182
183	if (data->index)
184		return 0;
185
186	spin_lock_irqsave(&usbmisc->lock, flags);
187	reg = usbmisc->base + MX25_USB_PHY_CTRL_OFFSET;
188	val = readl(reg);
189
190	if (data->evdo)
191		val |= MX25_BM_EXTERNAL_VBUS_DIVIDER;
192	else
193		val &= ~MX25_BM_EXTERNAL_VBUS_DIVIDER;
194
195	writel(val, reg);
196	spin_unlock_irqrestore(&usbmisc->lock, flags);
197	usleep_range(5000, 10000); /* needed to stabilize voltage */
198
199	return 0;
200}
201
202static int usbmisc_imx27_init(struct imx_usbmisc_data *data)
203{
204	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
205	unsigned long flags;
206	u32 val;
207
208	switch (data->index) {
209	case 0:
210		val = MX27_OTG_PM_BIT;
211		break;
212	case 1:
213		val = MX27_H1_PM_BIT;
214		break;
215	case 2:
216		val = MX27_H2_PM_BIT;
217		break;
218	default:
219		return -EINVAL;
220	}
221
222	spin_lock_irqsave(&usbmisc->lock, flags);
223	if (data->disable_oc)
224		val = readl(usbmisc->base) | val;
225	else
226		val = readl(usbmisc->base) & ~val;
227	writel(val, usbmisc->base);
228	spin_unlock_irqrestore(&usbmisc->lock, flags);
229
230	return 0;
231}
232
233static int usbmisc_imx53_init(struct imx_usbmisc_data *data)
234{
235	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
236	void __iomem *reg = NULL;
237	unsigned long flags;
238	u32 val = 0;
239
240	if (data->index > 3)
241		return -EINVAL;
242
243	/* Select a 24 MHz reference clock for the PHY  */
244	val = readl(usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
245	val &= ~MX53_USB_PHYCTRL1_PLLDIV_MASK;
246	val |= MX53_USB_PLL_DIV_24_MHZ;
247	writel(val, usbmisc->base + MX53_USB_OTG_PHY_CTRL_1_OFFSET);
248
249	spin_lock_irqsave(&usbmisc->lock, flags);
250
251	switch (data->index) {
252	case 0:
253		if (data->disable_oc) {
254			reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
255			val = readl(reg) | MX53_BM_OVER_CUR_DIS_OTG;
256			writel(val, reg);
257		}
258		break;
259	case 1:
260		if (data->disable_oc) {
261			reg = usbmisc->base + MX53_USB_OTG_PHY_CTRL_0_OFFSET;
262			val = readl(reg) | MX53_BM_OVER_CUR_DIS_H1;
263			writel(val, reg);
264		}
265		break;
266	case 2:
267		if (data->ulpi) {
268			/* set USBH2 into ULPI-mode. */
269			reg = usbmisc->base + MX53_USB_CTRL_1_OFFSET;
270			val = readl(reg) | MX53_USB_CTRL_1_UH2_ULPI_EN;
271			/* select ULPI clock */
272			val &= ~MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_MASK;
273			val |= MX53_USB_CTRL_1_H2_XCVR_CLK_SEL_ULPI;
274			writel(val, reg);
275			/* Set interrupt wake up enable */
276			reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
277			val = readl(reg) | MX53_USB_UHx_CTRL_WAKE_UP_EN
278				| MX53_USB_UHx_CTRL_ULPI_INT_EN;
279			writel(val, reg);
280			if (is_imx53_usbmisc(data)) {
281				/* Disable internal 60Mhz clock */
282				reg = usbmisc->base +
283					MX53_USB_CLKONOFF_CTRL_OFFSET;
284				val = readl(reg) |
285					MX53_USB_CLKONOFF_CTRL_H2_INT60CKOFF;
286				writel(val, reg);
287			}
288
289		}
290		if (data->disable_oc) {
291			reg = usbmisc->base + MX53_USB_UH2_CTRL_OFFSET;
292			val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
293			writel(val, reg);
294		}
295		break;
296	case 3:
297		if (data->ulpi) {
298			/* set USBH3 into ULPI-mode. */
299			reg = usbmisc->base + MX53_USB_CTRL_1_OFFSET;
300			val = readl(reg) | MX53_USB_CTRL_1_UH3_ULPI_EN;
301			/* select ULPI clock */
302			val &= ~MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_MASK;
303			val |= MX53_USB_CTRL_1_H3_XCVR_CLK_SEL_ULPI;
304			writel(val, reg);
305			/* Set interrupt wake up enable */
306			reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
307			val = readl(reg) | MX53_USB_UHx_CTRL_WAKE_UP_EN
308				| MX53_USB_UHx_CTRL_ULPI_INT_EN;
309			writel(val, reg);
310
311			if (is_imx53_usbmisc(data)) {
312				/* Disable internal 60Mhz clock */
313				reg = usbmisc->base +
314					MX53_USB_CLKONOFF_CTRL_OFFSET;
315				val = readl(reg) |
316					MX53_USB_CLKONOFF_CTRL_H3_INT60CKOFF;
317				writel(val, reg);
318			}
319		}
320		if (data->disable_oc) {
321			reg = usbmisc->base + MX53_USB_UH3_CTRL_OFFSET;
322			val = readl(reg) | MX53_BM_OVER_CUR_DIS_UHx;
323			writel(val, reg);
324		}
325		break;
326	}
327
328	spin_unlock_irqrestore(&usbmisc->lock, flags);
329
330	return 0;
331}
332
333static int usbmisc_imx6q_set_wakeup
334	(struct imx_usbmisc_data *data, bool enabled)
335{
336	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
337	unsigned long flags;
338	u32 val;
339	u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
340		MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
341	int ret = 0;
342
343	if (data->index > 3)
344		return -EINVAL;
345
346	spin_lock_irqsave(&usbmisc->lock, flags);
347	val = readl(usbmisc->base + data->index * 4);
348	if (enabled) {
349		val |= wakeup_setting;
 
350	} else {
351		if (val & MX6_BM_WAKEUP_INTR)
352			pr_debug("wakeup int at ci_hdrc.%d\n", data->index);
353		val &= ~wakeup_setting;
 
354	}
355	writel(val, usbmisc->base + data->index * 4);
356	spin_unlock_irqrestore(&usbmisc->lock, flags);
357
358	return ret;
359}
360
361static int usbmisc_imx6q_init(struct imx_usbmisc_data *data)
362{
363	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
364	unsigned long flags;
365	u32 reg;
366
367	if (data->index > 3)
368		return -EINVAL;
369
370	spin_lock_irqsave(&usbmisc->lock, flags);
371
372	reg = readl(usbmisc->base + data->index * 4);
373	if (data->disable_oc) {
374		reg |= MX6_BM_OVER_CUR_DIS;
375	} else {
376		reg &= ~MX6_BM_OVER_CUR_DIS;
377
378		/*
379		 * If the polarity is not configured keep it as setup by the
380		 * bootloader.
381		 */
382		if (data->oc_pol_configured && data->oc_pol_active_low)
383			reg |= MX6_BM_OVER_CUR_POLARITY;
384		else if (data->oc_pol_configured)
385			reg &= ~MX6_BM_OVER_CUR_POLARITY;
386	}
387	/* If the polarity is not set keep it as setup by the bootlader */
388	if (data->pwr_pol == 1)
389		reg |= MX6_BM_PWR_POLARITY;
390	writel(reg, usbmisc->base + data->index * 4);
391
392	/* SoC non-burst setting */
393	reg = readl(usbmisc->base + data->index * 4);
394	writel(reg | MX6_BM_NON_BURST_SETTING,
395			usbmisc->base + data->index * 4);
396
397	/* For HSIC controller */
398	if (data->hsic) {
399		reg = readl(usbmisc->base + data->index * 4);
400		writel(reg | MX6_BM_UTMI_ON_CLOCK,
401			usbmisc->base + data->index * 4);
402		reg = readl(usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET
403			+ (data->index - 2) * 4);
404		reg |= MX6_BM_HSIC_EN | MX6_BM_HSIC_CLK_ON;
405		writel(reg, usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET
406			+ (data->index - 2) * 4);
407	}
408
409	spin_unlock_irqrestore(&usbmisc->lock, flags);
410
411	usbmisc_imx6q_set_wakeup(data, false);
412
413	return 0;
414}
415
416static int usbmisc_imx6_hsic_get_reg_offset(struct imx_usbmisc_data *data)
417{
418	int offset, ret = 0;
419
420	if (data->index == 2 || data->index == 3) {
421		offset = (data->index - 2) * 4;
422	} else if (data->index == 0) {
423		/*
424		 * For SoCs like i.MX7D and later, each USB controller has
425		 * its own non-core register region. For SoCs before i.MX7D,
426		 * the first two USB controllers are non-HSIC controllers.
427		 */
428		offset = 0;
429	} else {
430		dev_err(data->dev, "index is error for usbmisc\n");
431		ret = -EINVAL;
432	}
433
434	return ret ? ret : offset;
435}
436
437static int usbmisc_imx6_hsic_set_connect(struct imx_usbmisc_data *data)
438{
439	unsigned long flags;
440	u32 val;
441	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
442	int offset;
443
444	spin_lock_irqsave(&usbmisc->lock, flags);
445	offset = usbmisc_imx6_hsic_get_reg_offset(data);
446	if (offset < 0) {
447		spin_unlock_irqrestore(&usbmisc->lock, flags);
448		return offset;
449	}
450
451	val = readl(usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET + offset);
452	if (!(val & MX6_BM_HSIC_DEV_CONN))
453		writel(val | MX6_BM_HSIC_DEV_CONN,
454			usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET + offset);
455
456	spin_unlock_irqrestore(&usbmisc->lock, flags);
457
458	return 0;
459}
460
461static int usbmisc_imx6_hsic_set_clk(struct imx_usbmisc_data *data, bool on)
462{
463	unsigned long flags;
464	u32 val;
465	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
466	int offset;
467
468	spin_lock_irqsave(&usbmisc->lock, flags);
469	offset = usbmisc_imx6_hsic_get_reg_offset(data);
470	if (offset < 0) {
471		spin_unlock_irqrestore(&usbmisc->lock, flags);
472		return offset;
473	}
474
475	val = readl(usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET + offset);
476	val |= MX6_BM_HSIC_EN | MX6_BM_HSIC_CLK_ON;
477	if (on)
478		val |= MX6_BM_HSIC_CLK_ON;
479	else
480		val &= ~MX6_BM_HSIC_CLK_ON;
481
482	writel(val, usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET + offset);
483	spin_unlock_irqrestore(&usbmisc->lock, flags);
484
485	return 0;
486}
487
488
489static int usbmisc_imx6sx_init(struct imx_usbmisc_data *data)
490{
491	void __iomem *reg = NULL;
492	unsigned long flags;
493	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
494	u32 val;
495
496	usbmisc_imx6q_init(data);
497
498	if (data->index == 0 || data->index == 1) {
499		reg = usbmisc->base + MX6_USB_OTG1_PHY_CTRL + data->index * 4;
500		spin_lock_irqsave(&usbmisc->lock, flags);
501		/* Set vbus wakeup source as bvalid */
502		val = readl(reg);
503		writel(val | MX6SX_USB_VBUS_WAKEUP_SOURCE_BVALID, reg);
504		/*
505		 * Disable dp/dm wakeup in device mode when vbus is
506		 * not there.
507		 */
508		val = readl(usbmisc->base + data->index * 4);
509		writel(val & ~MX6SX_BM_DPDM_WAKEUP_EN,
510			usbmisc->base + data->index * 4);
511		spin_unlock_irqrestore(&usbmisc->lock, flags);
512	}
513
514	/* For HSIC controller */
515	if (data->hsic) {
516		val = readl(usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET);
517		val |= MX6SX_BM_HSIC_AUTO_RESUME;
518		writel(val, usbmisc->base + MX6_USB_HSIC_CTRL_OFFSET);
519	}
520
521	return 0;
522}
523
524static int usbmisc_vf610_init(struct imx_usbmisc_data *data)
525{
526	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
527	u32 reg;
528
529	/*
530	 * Vybrid only has one misc register set, but in two different
531	 * areas. These is reflected in two instances of this driver.
532	 */
533	if (data->index >= 1)
534		return -EINVAL;
535
536	if (data->disable_oc) {
537		reg = readl(usbmisc->base);
538		writel(reg | VF610_OVER_CUR_DIS, usbmisc->base);
539	}
540
541	return 0;
542}
543
544static int usbmisc_imx7d_set_wakeup
545	(struct imx_usbmisc_data *data, bool enabled)
546{
547	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
548	unsigned long flags;
549	u32 val;
550	u32 wakeup_setting = (MX6_BM_WAKEUP_ENABLE |
551		MX6_BM_VBUS_WAKEUP | MX6_BM_ID_WAKEUP);
552
553	spin_lock_irqsave(&usbmisc->lock, flags);
554	val = readl(usbmisc->base);
555	if (enabled) {
556		writel(val | wakeup_setting, usbmisc->base);
557	} else {
558		if (val & MX6_BM_WAKEUP_INTR)
559			dev_dbg(data->dev, "wakeup int\n");
560		writel(val & ~wakeup_setting, usbmisc->base);
561	}
562	spin_unlock_irqrestore(&usbmisc->lock, flags);
563
564	return 0;
565}
566
567static int usbmisc_imx7d_init(struct imx_usbmisc_data *data)
568{
569	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
570	unsigned long flags;
571	u32 reg;
572
573	if (data->index >= 1)
574		return -EINVAL;
575
576	spin_lock_irqsave(&usbmisc->lock, flags);
577	reg = readl(usbmisc->base);
578	if (data->disable_oc) {
579		reg |= MX6_BM_OVER_CUR_DIS;
580	} else {
581		reg &= ~MX6_BM_OVER_CUR_DIS;
582
583		/*
584		 * If the polarity is not configured keep it as setup by the
585		 * bootloader.
586		 */
587		if (data->oc_pol_configured && data->oc_pol_active_low)
588			reg |= MX6_BM_OVER_CUR_POLARITY;
589		else if (data->oc_pol_configured)
590			reg &= ~MX6_BM_OVER_CUR_POLARITY;
591	}
592	/* If the polarity is not set keep it as setup by the bootlader */
593	if (data->pwr_pol == 1)
594		reg |= MX6_BM_PWR_POLARITY;
595	writel(reg, usbmisc->base);
596
597	reg = readl(usbmisc->base + MX7D_USBNC_USB_CTRL2);
598	reg &= ~MX7D_USB_VBUS_WAKEUP_SOURCE_MASK;
599	writel(reg | MX7D_USB_VBUS_WAKEUP_SOURCE_BVALID,
600		 usbmisc->base + MX7D_USBNC_USB_CTRL2);
601
602	spin_unlock_irqrestore(&usbmisc->lock, flags);
603
604	usbmisc_imx7d_set_wakeup(data, false);
605
606	return 0;
607}
608
609static const struct usbmisc_ops imx25_usbmisc_ops = {
610	.init = usbmisc_imx25_init,
611	.post = usbmisc_imx25_post,
612};
613
614static const struct usbmisc_ops imx27_usbmisc_ops = {
615	.init = usbmisc_imx27_init,
616};
617
618static const struct usbmisc_ops imx51_usbmisc_ops = {
619	.init = usbmisc_imx53_init,
620};
621
622static const struct usbmisc_ops imx53_usbmisc_ops = {
623	.init = usbmisc_imx53_init,
624};
625
626static const struct usbmisc_ops imx6q_usbmisc_ops = {
627	.set_wakeup = usbmisc_imx6q_set_wakeup,
628	.init = usbmisc_imx6q_init,
629	.hsic_set_connect = usbmisc_imx6_hsic_set_connect,
630	.hsic_set_clk   = usbmisc_imx6_hsic_set_clk,
631};
632
633static const struct usbmisc_ops vf610_usbmisc_ops = {
634	.init = usbmisc_vf610_init,
635};
636
637static const struct usbmisc_ops imx6sx_usbmisc_ops = {
638	.set_wakeup = usbmisc_imx6q_set_wakeup,
639	.init = usbmisc_imx6sx_init,
640	.hsic_set_connect = usbmisc_imx6_hsic_set_connect,
641	.hsic_set_clk = usbmisc_imx6_hsic_set_clk,
642};
643
644static const struct usbmisc_ops imx7d_usbmisc_ops = {
645	.init = usbmisc_imx7d_init,
646	.set_wakeup = usbmisc_imx7d_set_wakeup,
647};
648
649static inline bool is_imx53_usbmisc(struct imx_usbmisc_data *data)
650{
651	struct imx_usbmisc *usbmisc = dev_get_drvdata(data->dev);
652
653	return usbmisc->ops == &imx53_usbmisc_ops;
654}
655
656int imx_usbmisc_init(struct imx_usbmisc_data *data)
657{
658	struct imx_usbmisc *usbmisc;
659
660	if (!data)
661		return 0;
662
663	usbmisc = dev_get_drvdata(data->dev);
664	if (!usbmisc->ops->init)
665		return 0;
666	return usbmisc->ops->init(data);
667}
668EXPORT_SYMBOL_GPL(imx_usbmisc_init);
669
670int imx_usbmisc_init_post(struct imx_usbmisc_data *data)
671{
672	struct imx_usbmisc *usbmisc;
673
674	if (!data)
675		return 0;
676
677	usbmisc = dev_get_drvdata(data->dev);
678	if (!usbmisc->ops->post)
679		return 0;
680	return usbmisc->ops->post(data);
681}
682EXPORT_SYMBOL_GPL(imx_usbmisc_init_post);
683
684int imx_usbmisc_set_wakeup(struct imx_usbmisc_data *data, bool enabled)
685{
686	struct imx_usbmisc *usbmisc;
687
688	if (!data)
689		return 0;
690
691	usbmisc = dev_get_drvdata(data->dev);
692	if (!usbmisc->ops->set_wakeup)
693		return 0;
694	return usbmisc->ops->set_wakeup(data, enabled);
695}
696EXPORT_SYMBOL_GPL(imx_usbmisc_set_wakeup);
697
698int imx_usbmisc_hsic_set_connect(struct imx_usbmisc_data *data)
699{
700	struct imx_usbmisc *usbmisc;
701
702	if (!data)
703		return 0;
704
705	usbmisc = dev_get_drvdata(data->dev);
706	if (!usbmisc->ops->hsic_set_connect || !data->hsic)
707		return 0;
708	return usbmisc->ops->hsic_set_connect(data);
709}
710EXPORT_SYMBOL_GPL(imx_usbmisc_hsic_set_connect);
711
712int imx_usbmisc_hsic_set_clk(struct imx_usbmisc_data *data, bool on)
713{
714	struct imx_usbmisc *usbmisc;
715
716	if (!data)
717		return 0;
718
719	usbmisc = dev_get_drvdata(data->dev);
720	if (!usbmisc->ops->hsic_set_clk || !data->hsic)
721		return 0;
722	return usbmisc->ops->hsic_set_clk(data, on);
723}
724EXPORT_SYMBOL_GPL(imx_usbmisc_hsic_set_clk);
725static const struct of_device_id usbmisc_imx_dt_ids[] = {
726	{
727		.compatible = "fsl,imx25-usbmisc",
728		.data = &imx25_usbmisc_ops,
729	},
730	{
731		.compatible = "fsl,imx35-usbmisc",
732		.data = &imx25_usbmisc_ops,
733	},
734	{
735		.compatible = "fsl,imx27-usbmisc",
736		.data = &imx27_usbmisc_ops,
737	},
738	{
739		.compatible = "fsl,imx51-usbmisc",
740		.data = &imx51_usbmisc_ops,
741	},
742	{
743		.compatible = "fsl,imx53-usbmisc",
744		.data = &imx53_usbmisc_ops,
745	},
746	{
747		.compatible = "fsl,imx6q-usbmisc",
748		.data = &imx6q_usbmisc_ops,
749	},
750	{
751		.compatible = "fsl,vf610-usbmisc",
752		.data = &vf610_usbmisc_ops,
753	},
754	{
755		.compatible = "fsl,imx6sx-usbmisc",
756		.data = &imx6sx_usbmisc_ops,
757	},
758	{
759		.compatible = "fsl,imx6ul-usbmisc",
760		.data = &imx6sx_usbmisc_ops,
761	},
762	{
763		.compatible = "fsl,imx7d-usbmisc",
764		.data = &imx7d_usbmisc_ops,
765	},
766	{
767		.compatible = "fsl,imx7ulp-usbmisc",
768		.data = &imx7d_usbmisc_ops,
769	},
770	{ /* sentinel */ }
771};
772MODULE_DEVICE_TABLE(of, usbmisc_imx_dt_ids);
773
774static int usbmisc_imx_probe(struct platform_device *pdev)
775{
 
776	struct imx_usbmisc *data;
777	const struct of_device_id *of_id;
778
779	of_id = of_match_device(usbmisc_imx_dt_ids, &pdev->dev);
780	if (!of_id)
781		return -ENODEV;
782
783	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
784	if (!data)
785		return -ENOMEM;
786
787	spin_lock_init(&data->lock);
788
789	data->base = devm_platform_ioremap_resource(pdev, 0);
 
790	if (IS_ERR(data->base))
791		return PTR_ERR(data->base);
792
793	data->ops = (const struct usbmisc_ops *)of_id->data;
794	platform_set_drvdata(pdev, data);
795
796	return 0;
797}
798
799static int usbmisc_imx_remove(struct platform_device *pdev)
800{
801	return 0;
802}
803
804static struct platform_driver usbmisc_imx_driver = {
805	.probe = usbmisc_imx_probe,
806	.remove = usbmisc_imx_remove,
807	.driver = {
808		.name = "usbmisc_imx",
809		.of_match_table = usbmisc_imx_dt_ids,
810	 },
811};
812
813module_platform_driver(usbmisc_imx_driver);
814
815MODULE_ALIAS("platform:usbmisc-imx");
816MODULE_LICENSE("GPL");
817MODULE_DESCRIPTION("driver for imx usb non-core registers");
818MODULE_AUTHOR("Richard Zhao <richard.zhao@freescale.com>");