musb_dsps.c revision 7557a57f5e649c99239975529e2b30dc4990c548
1/*
2 * Texas Instruments DSPS platforms "glue layer"
3 *
4 * Copyright (C) 2012, by Texas Instruments
5 *
6 * Based on the am35x "glue layer" code.
7 *
8 * This file is part of the Inventra Controller Driver for Linux.
9 *
10 * The Inventra Controller Driver for Linux is free software; you
11 * can redistribute it and/or modify it under the terms of the GNU
12 * General Public License version 2 as published by the Free Software
13 * Foundation.
14 *
15 * The Inventra Controller Driver for Linux is distributed in
16 * the hope that it will be useful, but WITHOUT ANY WARRANTY;
17 * without even the implied warranty of MERCHANTABILITY or
18 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public
19 * License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with The Inventra Controller Driver for Linux ; if not,
23 * write to the Free Software Foundation, Inc., 59 Temple Place,
24 * Suite 330, Boston, MA  02111-1307  USA
25 *
26 * musb_dsps.c will be a common file for all the TI DSPS platforms
27 * such as dm64x, dm36x, dm35x, da8x, am35x and ti81x.
28 * For now only ti81x is using this and in future davinci.c, am35x.c
29 * da8xx.c would be merged to this file after testing.
30 */
31
32#include <linux/init.h>
33#include <linux/io.h>
34#include <linux/err.h>
35#include <linux/platform_device.h>
36#include <linux/dma-mapping.h>
37#include <linux/pm_runtime.h>
38#include <linux/module.h>
39#include <linux/usb/nop-usb-xceiv.h>
40#include <linux/platform_data/usb-omap.h>
41#include <linux/sizes.h>
42
43#include <linux/of.h>
44#include <linux/of_device.h>
45#include <linux/of_address.h>
46
47#include "musb_core.h"
48
49#ifdef CONFIG_OF
50static const struct of_device_id musb_dsps_of_match[];
51#endif
52
53/**
54 * avoid using musb_readx()/musb_writex() as glue layer should not be
55 * dependent on musb core layer symbols.
56 */
57static inline u8 dsps_readb(const void __iomem *addr, unsigned offset)
58	{ return __raw_readb(addr + offset); }
59
60static inline u32 dsps_readl(const void __iomem *addr, unsigned offset)
61	{ return __raw_readl(addr + offset); }
62
63static inline void dsps_writeb(void __iomem *addr, unsigned offset, u8 data)
64	{ __raw_writeb(data, addr + offset); }
65
66static inline void dsps_writel(void __iomem *addr, unsigned offset, u32 data)
67	{ __raw_writel(data, addr + offset); }
68
69/**
70 * DSPS musb wrapper register offset.
71 * FIXME: This should be expanded to have all the wrapper registers from TI DSPS
72 * musb ips.
73 */
74struct dsps_musb_wrapper {
75	u16	revision;
76	u16	control;
77	u16	status;
78	u16	eoi;
79	u16	epintr_set;
80	u16	epintr_clear;
81	u16	epintr_status;
82	u16	coreintr_set;
83	u16	coreintr_clear;
84	u16	coreintr_status;
85	u16	phy_utmi;
86	u16	mode;
87
88	/* bit positions for control */
89	unsigned	reset:5;
90
91	/* bit positions for interrupt */
92	unsigned	usb_shift:5;
93	u32		usb_mask;
94	u32		usb_bitmap;
95	unsigned	drvvbus:5;
96
97	unsigned	txep_shift:5;
98	u32		txep_mask;
99	u32		txep_bitmap;
100
101	unsigned	rxep_shift:5;
102	u32		rxep_mask;
103	u32		rxep_bitmap;
104
105	/* bit positions for phy_utmi */
106	unsigned	otg_disable:5;
107
108	/* bit positions for mode */
109	unsigned	iddig:5;
110	/* miscellaneous stuff */
111	u32		musb_core_offset;
112	u8		poll_seconds;
113	/* number of musb instances */
114	u8		instances;
115};
116
117/**
118 * DSPS glue structure.
119 */
120struct dsps_glue {
121	struct device *dev;
122	struct platform_device *musb[2];	/* child musb pdev */
123	const struct dsps_musb_wrapper *wrp; /* wrapper register offsets */
124	struct timer_list timer[2];	/* otg_workaround timer */
125	unsigned long last_timer[2];    /* last timer data for each instance */
126	u32 __iomem *usb_ctrl[2];
127};
128
129#define	DSPS_AM33XX_CONTROL_MODULE_PHYS_0	0x44e10620
130#define	DSPS_AM33XX_CONTROL_MODULE_PHYS_1	0x44e10628
131
132static const resource_size_t dsps_control_module_phys[] = {
133	DSPS_AM33XX_CONTROL_MODULE_PHYS_0,
134	DSPS_AM33XX_CONTROL_MODULE_PHYS_1,
135};
136
137#define USBPHY_CM_PWRDN		(1 << 0)
138#define USBPHY_OTG_PWRDN	(1 << 1)
139#define USBPHY_OTGVDET_EN	(1 << 19)
140#define USBPHY_OTGSESSEND_EN	(1 << 20)
141
142/**
143 * musb_dsps_phy_control - phy on/off
144 * @glue: struct dsps_glue *
145 * @id: musb instance
146 * @on: flag for phy to be switched on or off
147 *
148 * This is to enable the PHY using usb_ctrl register in system control
149 * module space.
150 *
151 * XXX: This function will be removed once we have a seperate driver for
152 * control module
153 */
154static void musb_dsps_phy_control(struct dsps_glue *glue, u8 id, u8 on)
155{
156	u32 usbphycfg;
157
158	usbphycfg = readl(glue->usb_ctrl[id]);
159
160	if (on) {
161		usbphycfg &= ~(USBPHY_CM_PWRDN | USBPHY_OTG_PWRDN);
162		usbphycfg |= USBPHY_OTGVDET_EN | USBPHY_OTGSESSEND_EN;
163	} else {
164		usbphycfg |= USBPHY_CM_PWRDN | USBPHY_OTG_PWRDN;
165	}
166
167	writel(usbphycfg, glue->usb_ctrl[id]);
168}
169/**
170 * dsps_musb_enable - enable interrupts
171 */
172static void dsps_musb_enable(struct musb *musb)
173{
174	struct device *dev = musb->controller;
175	struct platform_device *pdev = to_platform_device(dev->parent);
176	struct dsps_glue *glue = platform_get_drvdata(pdev);
177	const struct dsps_musb_wrapper *wrp = glue->wrp;
178	void __iomem *reg_base = musb->ctrl_base;
179	u32 epmask, coremask;
180
181	/* Workaround: setup IRQs through both register sets. */
182	epmask = ((musb->epmask & wrp->txep_mask) << wrp->txep_shift) |
183	       ((musb->epmask & wrp->rxep_mask) << wrp->rxep_shift);
184	coremask = (wrp->usb_bitmap & ~MUSB_INTR_SOF);
185
186	dsps_writel(reg_base, wrp->epintr_set, epmask);
187	dsps_writel(reg_base, wrp->coreintr_set, coremask);
188	/* Force the DRVVBUS IRQ so we can start polling for ID change. */
189	dsps_writel(reg_base, wrp->coreintr_set,
190		    (1 << wrp->drvvbus) << wrp->usb_shift);
191}
192
193/**
194 * dsps_musb_disable - disable HDRC and flush interrupts
195 */
196static void dsps_musb_disable(struct musb *musb)
197{
198	struct device *dev = musb->controller;
199	struct platform_device *pdev = to_platform_device(dev->parent);
200	struct dsps_glue *glue = platform_get_drvdata(pdev);
201	const struct dsps_musb_wrapper *wrp = glue->wrp;
202	void __iomem *reg_base = musb->ctrl_base;
203
204	dsps_writel(reg_base, wrp->coreintr_clear, wrp->usb_bitmap);
205	dsps_writel(reg_base, wrp->epintr_clear,
206			 wrp->txep_bitmap | wrp->rxep_bitmap);
207	dsps_writeb(musb->mregs, MUSB_DEVCTL, 0);
208	dsps_writel(reg_base, wrp->eoi, 0);
209}
210
211static void otg_timer(unsigned long _musb)
212{
213	struct musb *musb = (void *)_musb;
214	void __iomem *mregs = musb->mregs;
215	struct device *dev = musb->controller;
216	struct platform_device *pdev = to_platform_device(dev);
217	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
218	const struct dsps_musb_wrapper *wrp = glue->wrp;
219	u8 devctl;
220	unsigned long flags;
221
222	/*
223	 * We poll because DSPS IP's won't expose several OTG-critical
224	 * status change events (from the transceiver) otherwise.
225	 */
226	devctl = dsps_readb(mregs, MUSB_DEVCTL);
227	dev_dbg(musb->controller, "Poll devctl %02x (%s)\n", devctl,
228				usb_otg_state_string(musb->xceiv->state));
229
230	spin_lock_irqsave(&musb->lock, flags);
231	switch (musb->xceiv->state) {
232	case OTG_STATE_A_WAIT_BCON:
233		devctl &= ~MUSB_DEVCTL_SESSION;
234		dsps_writeb(musb->mregs, MUSB_DEVCTL, devctl);
235
236		devctl = dsps_readb(musb->mregs, MUSB_DEVCTL);
237		if (devctl & MUSB_DEVCTL_BDEVICE) {
238			musb->xceiv->state = OTG_STATE_B_IDLE;
239			MUSB_DEV_MODE(musb);
240		} else {
241			musb->xceiv->state = OTG_STATE_A_IDLE;
242			MUSB_HST_MODE(musb);
243		}
244		break;
245	case OTG_STATE_A_WAIT_VFALL:
246		musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
247		dsps_writel(musb->ctrl_base, wrp->coreintr_set,
248			    MUSB_INTR_VBUSERROR << wrp->usb_shift);
249		break;
250	case OTG_STATE_B_IDLE:
251		devctl = dsps_readb(mregs, MUSB_DEVCTL);
252		if (devctl & MUSB_DEVCTL_BDEVICE)
253			mod_timer(&glue->timer[pdev->id],
254					jiffies + wrp->poll_seconds * HZ);
255		else
256			musb->xceiv->state = OTG_STATE_A_IDLE;
257		break;
258	default:
259		break;
260	}
261	spin_unlock_irqrestore(&musb->lock, flags);
262}
263
264static void dsps_musb_try_idle(struct musb *musb, unsigned long timeout)
265{
266	struct device *dev = musb->controller;
267	struct platform_device *pdev = to_platform_device(dev);
268	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
269
270	if (timeout == 0)
271		timeout = jiffies + msecs_to_jiffies(3);
272
273	/* Never idle if active, or when VBUS timeout is not set as host */
274	if (musb->is_active || (musb->a_wait_bcon == 0 &&
275				musb->xceiv->state == OTG_STATE_A_WAIT_BCON)) {
276		dev_dbg(musb->controller, "%s active, deleting timer\n",
277				usb_otg_state_string(musb->xceiv->state));
278		del_timer(&glue->timer[pdev->id]);
279		glue->last_timer[pdev->id] = jiffies;
280		return;
281	}
282
283	if (time_after(glue->last_timer[pdev->id], timeout) &&
284				timer_pending(&glue->timer[pdev->id])) {
285		dev_dbg(musb->controller,
286			"Longer idle timer already pending, ignoring...\n");
287		return;
288	}
289	glue->last_timer[pdev->id] = timeout;
290
291	dev_dbg(musb->controller, "%s inactive, starting idle timer for %u ms\n",
292		usb_otg_state_string(musb->xceiv->state),
293			jiffies_to_msecs(timeout - jiffies));
294	mod_timer(&glue->timer[pdev->id], timeout);
295}
296
297static irqreturn_t dsps_interrupt(int irq, void *hci)
298{
299	struct musb  *musb = hci;
300	void __iomem *reg_base = musb->ctrl_base;
301	struct device *dev = musb->controller;
302	struct platform_device *pdev = to_platform_device(dev);
303	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
304	const struct dsps_musb_wrapper *wrp = glue->wrp;
305	unsigned long flags;
306	irqreturn_t ret = IRQ_NONE;
307	u32 epintr, usbintr;
308
309	spin_lock_irqsave(&musb->lock, flags);
310
311	/* Get endpoint interrupts */
312	epintr = dsps_readl(reg_base, wrp->epintr_status);
313	musb->int_rx = (epintr & wrp->rxep_bitmap) >> wrp->rxep_shift;
314	musb->int_tx = (epintr & wrp->txep_bitmap) >> wrp->txep_shift;
315
316	if (epintr)
317		dsps_writel(reg_base, wrp->epintr_status, epintr);
318
319	/* Get usb core interrupts */
320	usbintr = dsps_readl(reg_base, wrp->coreintr_status);
321	if (!usbintr && !epintr)
322		goto eoi;
323
324	musb->int_usb =	(usbintr & wrp->usb_bitmap) >> wrp->usb_shift;
325	if (usbintr)
326		dsps_writel(reg_base, wrp->coreintr_status, usbintr);
327
328	dev_dbg(musb->controller, "usbintr (%x) epintr(%x)\n",
329			usbintr, epintr);
330	/*
331	 * DRVVBUS IRQs are the only proxy we have (a very poor one!) for
332	 * DSPS IP's missing ID change IRQ.  We need an ID change IRQ to
333	 * switch appropriately between halves of the OTG state machine.
334	 * Managing DEVCTL.SESSION per Mentor docs requires that we know its
335	 * value but DEVCTL.BDEVICE is invalid without DEVCTL.SESSION set.
336	 * Also, DRVVBUS pulses for SRP (but not at 5V) ...
337	 */
338	if (is_host_active(musb) && usbintr & MUSB_INTR_BABBLE)
339		pr_info("CAUTION: musb: Babble Interrupt Occurred\n");
340
341	if (usbintr & ((1 << wrp->drvvbus) << wrp->usb_shift)) {
342		int drvvbus = dsps_readl(reg_base, wrp->status);
343		void __iomem *mregs = musb->mregs;
344		u8 devctl = dsps_readb(mregs, MUSB_DEVCTL);
345		int err;
346
347		err = musb->int_usb & MUSB_INTR_VBUSERROR;
348		if (err) {
349			/*
350			 * The Mentor core doesn't debounce VBUS as needed
351			 * to cope with device connect current spikes. This
352			 * means it's not uncommon for bus-powered devices
353			 * to get VBUS errors during enumeration.
354			 *
355			 * This is a workaround, but newer RTL from Mentor
356			 * seems to allow a better one: "re"-starting sessions
357			 * without waiting for VBUS to stop registering in
358			 * devctl.
359			 */
360			musb->int_usb &= ~MUSB_INTR_VBUSERROR;
361			musb->xceiv->state = OTG_STATE_A_WAIT_VFALL;
362			mod_timer(&glue->timer[pdev->id],
363					jiffies + wrp->poll_seconds * HZ);
364			WARNING("VBUS error workaround (delay coming)\n");
365		} else if (drvvbus) {
366			musb->is_active = 1;
367			MUSB_HST_MODE(musb);
368			musb->xceiv->otg->default_a = 1;
369			musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
370			del_timer(&glue->timer[pdev->id]);
371		} else {
372			musb->is_active = 0;
373			MUSB_DEV_MODE(musb);
374			musb->xceiv->otg->default_a = 0;
375			musb->xceiv->state = OTG_STATE_B_IDLE;
376		}
377
378		/* NOTE: this must complete power-on within 100 ms. */
379		dev_dbg(musb->controller, "VBUS %s (%s)%s, devctl %02x\n",
380				drvvbus ? "on" : "off",
381				usb_otg_state_string(musb->xceiv->state),
382				err ? " ERROR" : "",
383				devctl);
384		ret = IRQ_HANDLED;
385	}
386
387	if (musb->int_tx || musb->int_rx || musb->int_usb)
388		ret |= musb_interrupt(musb);
389
390 eoi:
391	/* EOI needs to be written for the IRQ to be re-asserted. */
392	if (ret == IRQ_HANDLED || epintr || usbintr)
393		dsps_writel(reg_base, wrp->eoi, 1);
394
395	/* Poll for ID change */
396	if (musb->xceiv->state == OTG_STATE_B_IDLE)
397		mod_timer(&glue->timer[pdev->id],
398			 jiffies + wrp->poll_seconds * HZ);
399
400	spin_unlock_irqrestore(&musb->lock, flags);
401
402	return ret;
403}
404
405static int dsps_musb_init(struct musb *musb)
406{
407	struct device *dev = musb->controller;
408	struct platform_device *pdev = to_platform_device(dev);
409	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
410	const struct dsps_musb_wrapper *wrp = glue->wrp;
411	void __iomem *reg_base = musb->ctrl_base;
412	u32 rev, val;
413	int status;
414
415	/* mentor core register starts at offset of 0x400 from musb base */
416	musb->mregs += wrp->musb_core_offset;
417
418	/* NOP driver needs change if supporting dual instance */
419	usb_nop_xceiv_register();
420	musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
421	if (IS_ERR_OR_NULL(musb->xceiv))
422		return -EPROBE_DEFER;
423
424	/* Returns zero if e.g. not clocked */
425	rev = dsps_readl(reg_base, wrp->revision);
426	if (!rev) {
427		status = -ENODEV;
428		goto err0;
429	}
430
431	usb_phy_init(musb->xceiv);
432
433	setup_timer(&glue->timer[pdev->id], otg_timer, (unsigned long) musb);
434
435	/* Reset the musb */
436	dsps_writel(reg_base, wrp->control, (1 << wrp->reset));
437
438	/* Start the on-chip PHY and its PLL. */
439	musb_dsps_phy_control(glue, pdev->id, 1);
440
441	musb->isr = dsps_interrupt;
442
443	/* reset the otgdisable bit, needed for host mode to work */
444	val = dsps_readl(reg_base, wrp->phy_utmi);
445	val &= ~(1 << wrp->otg_disable);
446	dsps_writel(musb->ctrl_base, wrp->phy_utmi, val);
447
448	/* clear level interrupt */
449	dsps_writel(reg_base, wrp->eoi, 0);
450
451	return 0;
452err0:
453	usb_put_phy(musb->xceiv);
454	usb_nop_xceiv_unregister();
455	return status;
456}
457
458static int dsps_musb_exit(struct musb *musb)
459{
460	struct device *dev = musb->controller;
461	struct platform_device *pdev = to_platform_device(dev);
462	struct dsps_glue *glue = dev_get_drvdata(dev->parent);
463
464	del_timer_sync(&glue->timer[pdev->id]);
465
466	/* Shutdown the on-chip PHY and its PLL. */
467	musb_dsps_phy_control(glue, pdev->id, 0);
468	usb_phy_shutdown(musb->xceiv);
469
470	/* NOP driver needs change if supporting dual instance */
471	usb_put_phy(musb->xceiv);
472	usb_nop_xceiv_unregister();
473
474	return 0;
475}
476
477static struct musb_platform_ops dsps_ops = {
478	.init		= dsps_musb_init,
479	.exit		= dsps_musb_exit,
480
481	.enable		= dsps_musb_enable,
482	.disable	= dsps_musb_disable,
483
484	.try_idle	= dsps_musb_try_idle,
485};
486
487static u64 musb_dmamask = DMA_BIT_MASK(32);
488
489static int dsps_create_musb_pdev(struct dsps_glue *glue, u8 id)
490{
491	struct device *dev = glue->dev;
492	struct platform_device *pdev = to_platform_device(dev);
493	struct musb_hdrc_platform_data  *pdata = dev->platform_data;
494	struct device_node *np = pdev->dev.of_node;
495	struct musb_hdrc_config	*config;
496	struct platform_device	*musb;
497	struct resource *res;
498	struct resource	resources[2];
499	char res_name[11];
500	int ret;
501
502	resources[0].start = dsps_control_module_phys[id];
503	resources[0].end = resources[0].start + SZ_4 - 1;
504	resources[0].flags = IORESOURCE_MEM;
505
506	glue->usb_ctrl[id] = devm_ioremap_resource(&pdev->dev, resources);
507	if (IS_ERR(glue->usb_ctrl[id])) {
508		ret = PTR_ERR(glue->usb_ctrl[id]);
509		goto err0;
510	}
511
512	/* first resource is for usbss, so start index from 1 */
513	res = platform_get_resource(pdev, IORESOURCE_MEM, id + 1);
514	if (!res) {
515		dev_err(dev, "failed to get memory for instance %d\n", id);
516		ret = -ENODEV;
517		goto err0;
518	}
519	res->parent = NULL;
520	resources[0] = *res;
521
522	/* first resource is for usbss, so start index from 1 */
523	res = platform_get_resource(pdev, IORESOURCE_IRQ, id + 1);
524	if (!res) {
525		dev_err(dev, "failed to get irq for instance %d\n", id);
526		ret = -ENODEV;
527		goto err0;
528	}
529	res->parent = NULL;
530	resources[1] = *res;
531	resources[1].name = "mc";
532
533	/* allocate the child platform device */
534	musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
535	if (!musb) {
536		dev_err(dev, "failed to allocate musb device\n");
537		ret = -ENOMEM;
538		goto err0;
539	}
540
541	musb->dev.parent		= dev;
542	musb->dev.dma_mask		= &musb_dmamask;
543	musb->dev.coherent_dma_mask	= musb_dmamask;
544
545	glue->musb[id]			= musb;
546
547	ret = platform_device_add_resources(musb, resources, 2);
548	if (ret) {
549		dev_err(dev, "failed to add resources\n");
550		goto err2;
551	}
552
553	if (np) {
554		pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
555		if (!pdata) {
556			dev_err(&pdev->dev,
557				"failed to allocate musb platform data\n");
558			ret = -ENOMEM;
559			goto err2;
560		}
561
562		config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL);
563		if (!config) {
564			dev_err(&pdev->dev,
565				"failed to allocate musb hdrc config\n");
566			ret = -ENOMEM;
567			goto err2;
568		}
569
570		of_property_read_u32(np, "num-eps", (u32 *)&config->num_eps);
571		of_property_read_u32(np, "ram-bits", (u32 *)&config->ram_bits);
572		snprintf(res_name, sizeof(res_name), "port%d-mode", id);
573		of_property_read_u32(np, res_name, (u32 *)&pdata->mode);
574		of_property_read_u32(np, "power", (u32 *)&pdata->power);
575		config->multipoint = of_property_read_bool(np, "multipoint");
576
577		pdata->config		= config;
578	}
579
580	pdata->platform_ops		= &dsps_ops;
581
582	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
583	if (ret) {
584		dev_err(dev, "failed to add platform_data\n");
585		goto err2;
586	}
587
588	ret = platform_device_add(musb);
589	if (ret) {
590		dev_err(dev, "failed to register musb device\n");
591		goto err2;
592	}
593
594	return 0;
595
596err2:
597	platform_device_put(musb);
598err0:
599	return ret;
600}
601
602static int dsps_probe(struct platform_device *pdev)
603{
604	const struct of_device_id *match;
605	const struct dsps_musb_wrapper *wrp;
606	struct dsps_glue *glue;
607	struct resource *iomem;
608	int ret, i;
609
610	match = of_match_node(musb_dsps_of_match, pdev->dev.of_node);
611	if (!match) {
612		dev_err(&pdev->dev, "fail to get matching of_match struct\n");
613		ret = -EINVAL;
614		goto err0;
615	}
616	wrp = match->data;
617
618	/* allocate glue */
619	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
620	if (!glue) {
621		dev_err(&pdev->dev, "unable to allocate glue memory\n");
622		ret = -ENOMEM;
623		goto err0;
624	}
625
626	/* get memory resource */
627	iomem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
628	if (!iomem) {
629		dev_err(&pdev->dev, "failed to get usbss mem resourse\n");
630		ret = -ENODEV;
631		goto err1;
632	}
633
634	glue->dev = &pdev->dev;
635
636	glue->wrp = kmemdup(wrp, sizeof(*wrp), GFP_KERNEL);
637	if (!glue->wrp) {
638		dev_err(&pdev->dev, "failed to duplicate wrapper struct memory\n");
639		ret = -ENOMEM;
640		goto err1;
641	}
642	platform_set_drvdata(pdev, glue);
643
644	/* enable the usbss clocks */
645	pm_runtime_enable(&pdev->dev);
646
647	ret = pm_runtime_get_sync(&pdev->dev);
648	if (ret < 0) {
649		dev_err(&pdev->dev, "pm_runtime_get_sync FAILED");
650		goto err2;
651	}
652
653	/* create the child platform device for all instances of musb */
654	for (i = 0; i < wrp->instances ; i++) {
655		ret = dsps_create_musb_pdev(glue, i);
656		if (ret != 0) {
657			dev_err(&pdev->dev, "failed to create child pdev\n");
658			/* release resources of previously created instances */
659			for (i--; i >= 0 ; i--)
660				platform_device_unregister(glue->musb[i]);
661			goto err3;
662		}
663	}
664
665	return 0;
666
667err3:
668	pm_runtime_put(&pdev->dev);
669err2:
670	pm_runtime_disable(&pdev->dev);
671	kfree(glue->wrp);
672err1:
673	kfree(glue);
674err0:
675	return ret;
676}
677static int dsps_remove(struct platform_device *pdev)
678{
679	struct dsps_glue *glue = platform_get_drvdata(pdev);
680	const struct dsps_musb_wrapper *wrp = glue->wrp;
681	int i;
682
683	/* delete the child platform device */
684	for (i = 0; i < wrp->instances ; i++)
685		platform_device_unregister(glue->musb[i]);
686
687	/* disable usbss clocks */
688	pm_runtime_put(&pdev->dev);
689	pm_runtime_disable(&pdev->dev);
690	kfree(glue->wrp);
691	kfree(glue);
692	return 0;
693}
694
695#ifdef CONFIG_PM_SLEEP
696static int dsps_suspend(struct device *dev)
697{
698	struct platform_device *pdev = to_platform_device(dev->parent);
699	struct dsps_glue *glue = platform_get_drvdata(pdev);
700	const struct dsps_musb_wrapper *wrp = glue->wrp;
701	int i;
702
703	for (i = 0; i < wrp->instances; i++)
704		musb_dsps_phy_control(glue, i, 0);
705
706	return 0;
707}
708
709static int dsps_resume(struct device *dev)
710{
711	struct platform_device *pdev = to_platform_device(dev->parent);
712	struct dsps_glue *glue = platform_get_drvdata(pdev);
713	const struct dsps_musb_wrapper *wrp = glue->wrp;
714	int i;
715
716	for (i = 0; i < wrp->instances; i++)
717		musb_dsps_phy_control(glue, i, 1);
718
719	return 0;
720}
721#endif
722
723static SIMPLE_DEV_PM_OPS(dsps_pm_ops, dsps_suspend, dsps_resume);
724
725static const struct dsps_musb_wrapper ti81xx_driver_data = {
726	.revision		= 0x00,
727	.control		= 0x14,
728	.status			= 0x18,
729	.eoi			= 0x24,
730	.epintr_set		= 0x38,
731	.epintr_clear		= 0x40,
732	.epintr_status		= 0x30,
733	.coreintr_set		= 0x3c,
734	.coreintr_clear		= 0x44,
735	.coreintr_status	= 0x34,
736	.phy_utmi		= 0xe0,
737	.mode			= 0xe8,
738	.reset			= 0,
739	.otg_disable		= 21,
740	.iddig			= 8,
741	.usb_shift		= 0,
742	.usb_mask		= 0x1ff,
743	.usb_bitmap		= (0x1ff << 0),
744	.drvvbus		= 8,
745	.txep_shift		= 0,
746	.txep_mask		= 0xffff,
747	.txep_bitmap		= (0xffff << 0),
748	.rxep_shift		= 16,
749	.rxep_mask		= 0xfffe,
750	.rxep_bitmap		= (0xfffe << 16),
751	.musb_core_offset	= 0x400,
752	.poll_seconds		= 2,
753	.instances		= 1,
754};
755
756static const struct platform_device_id musb_dsps_id_table[] = {
757	{
758		.name	= "musb-ti81xx",
759		.driver_data	= (kernel_ulong_t) &ti81xx_driver_data,
760	},
761	{  },	/* Terminating Entry */
762};
763MODULE_DEVICE_TABLE(platform, musb_dsps_id_table);
764
765#ifdef CONFIG_OF
766static const struct of_device_id musb_dsps_of_match[] = {
767	{ .compatible = "ti,musb-am33xx",
768		.data = (void *) &ti81xx_driver_data, },
769	{  },
770};
771MODULE_DEVICE_TABLE(of, musb_dsps_of_match);
772#endif
773
774static struct platform_driver dsps_usbss_driver = {
775	.probe		= dsps_probe,
776	.remove         = dsps_remove,
777	.driver         = {
778		.name   = "musb-dsps",
779		.pm	= &dsps_pm_ops,
780		.of_match_table	= of_match_ptr(musb_dsps_of_match),
781	},
782	.id_table	= musb_dsps_id_table,
783};
784
785MODULE_DESCRIPTION("TI DSPS MUSB Glue Layer");
786MODULE_AUTHOR("Ravi B <ravibabu@ti.com>");
787MODULE_AUTHOR("Ajay Kumar Gupta <ajay.gupta@ti.com>");
788MODULE_LICENSE("GPL v2");
789
790static int __init dsps_init(void)
791{
792	return platform_driver_register(&dsps_usbss_driver);
793}
794subsys_initcall(dsps_init);
795
796static void __exit dsps_exit(void)
797{
798	platform_driver_unregister(&dsps_usbss_driver);
799}
800module_exit(dsps_exit);
801