xref: /openbmc/linux/drivers/usb/chipidea/core.c (revision 5f36e231)
1e443b333SAlexander Shishkin /*
2e443b333SAlexander Shishkin  * core.c - ChipIdea USB IP core family device controller
3e443b333SAlexander Shishkin  *
4e443b333SAlexander Shishkin  * Copyright (C) 2008 Chipidea - MIPS Technologies, Inc. All rights reserved.
5e443b333SAlexander Shishkin  *
6e443b333SAlexander Shishkin  * Author: David Lopo
7e443b333SAlexander Shishkin  *
8e443b333SAlexander Shishkin  * This program is free software; you can redistribute it and/or modify
9e443b333SAlexander Shishkin  * it under the terms of the GNU General Public License version 2 as
10e443b333SAlexander Shishkin  * published by the Free Software Foundation.
11e443b333SAlexander Shishkin  */
12e443b333SAlexander Shishkin 
13e443b333SAlexander Shishkin /*
14e443b333SAlexander Shishkin  * Description: ChipIdea USB IP core family device controller
15e443b333SAlexander Shishkin  *
16e443b333SAlexander Shishkin  * This driver is composed of several blocks:
17e443b333SAlexander Shishkin  * - HW:     hardware interface
18e443b333SAlexander Shishkin  * - DBG:    debug facilities (optional)
19e443b333SAlexander Shishkin  * - UTIL:   utilities
20e443b333SAlexander Shishkin  * - ISR:    interrupts handling
21e443b333SAlexander Shishkin  * - ENDPT:  endpoint operations (Gadget API)
22e443b333SAlexander Shishkin  * - GADGET: gadget operations (Gadget API)
23e443b333SAlexander Shishkin  * - BUS:    bus glue code, bus abstraction layer
24e443b333SAlexander Shishkin  *
25e443b333SAlexander Shishkin  * Compile Options
26e443b333SAlexander Shishkin  * - CONFIG_USB_GADGET_DEBUG_FILES: enable debug facilities
27e443b333SAlexander Shishkin  * - STALL_IN:  non-empty bulk-in pipes cannot be halted
28e443b333SAlexander Shishkin  *              if defined mass storage compliance succeeds but with warnings
29e443b333SAlexander Shishkin  *              => case 4: Hi >  Dn
30e443b333SAlexander Shishkin  *              => case 5: Hi >  Di
31e443b333SAlexander Shishkin  *              => case 8: Hi <> Do
32e443b333SAlexander Shishkin  *              if undefined usbtest 13 fails
33e443b333SAlexander Shishkin  * - TRACE:     enable function tracing (depends on DEBUG)
34e443b333SAlexander Shishkin  *
35e443b333SAlexander Shishkin  * Main Features
36e443b333SAlexander Shishkin  * - Chapter 9 & Mass Storage Compliance with Gadget File Storage
37e443b333SAlexander Shishkin  * - Chapter 9 Compliance with Gadget Zero (STALL_IN undefined)
38e443b333SAlexander Shishkin  * - Normal & LPM support
39e443b333SAlexander Shishkin  *
40e443b333SAlexander Shishkin  * USBTEST Report
41e443b333SAlexander Shishkin  * - OK: 0-12, 13 (STALL_IN defined) & 14
42e443b333SAlexander Shishkin  * - Not Supported: 15 & 16 (ISO)
43e443b333SAlexander Shishkin  *
44e443b333SAlexander Shishkin  * TODO List
45e443b333SAlexander Shishkin  * - OTG
46e443b333SAlexander Shishkin  * - Isochronous & Interrupt Traffic
47e443b333SAlexander Shishkin  * - Handle requests which spawns into several TDs
48e443b333SAlexander Shishkin  * - GET_STATUS(device) - always reports 0
49e443b333SAlexander Shishkin  * - Gadget API (majority of optional features)
50e443b333SAlexander Shishkin  * - Suspend & Remote Wakeup
51e443b333SAlexander Shishkin  */
52e443b333SAlexander Shishkin #include <linux/delay.h>
53e443b333SAlexander Shishkin #include <linux/device.h>
54e443b333SAlexander Shishkin #include <linux/dmapool.h>
55e443b333SAlexander Shishkin #include <linux/dma-mapping.h>
56e443b333SAlexander Shishkin #include <linux/init.h>
57e443b333SAlexander Shishkin #include <linux/platform_device.h>
58e443b333SAlexander Shishkin #include <linux/module.h>
59e443b333SAlexander Shishkin #include <linux/interrupt.h>
60e443b333SAlexander Shishkin #include <linux/io.h>
61e443b333SAlexander Shishkin #include <linux/irq.h>
62e443b333SAlexander Shishkin #include <linux/kernel.h>
63e443b333SAlexander Shishkin #include <linux/slab.h>
64e443b333SAlexander Shishkin #include <linux/pm_runtime.h>
65e443b333SAlexander Shishkin #include <linux/usb/ch9.h>
66e443b333SAlexander Shishkin #include <linux/usb/gadget.h>
67e443b333SAlexander Shishkin #include <linux/usb/otg.h>
68e443b333SAlexander Shishkin #include <linux/usb/chipidea.h>
69e443b333SAlexander Shishkin 
70e443b333SAlexander Shishkin #include "ci.h"
71e443b333SAlexander Shishkin #include "udc.h"
72e443b333SAlexander Shishkin #include "bits.h"
73e443b333SAlexander Shishkin #include "debug.h"
74e443b333SAlexander Shishkin 
75e443b333SAlexander Shishkin /* MSM specific */
76e443b333SAlexander Shishkin #define ABS_AHBBURST        (0x0090UL)
77e443b333SAlexander Shishkin #define ABS_AHBMODE         (0x0098UL)
785f36e231SAlexander Shishkin /* Controller register map */
79e443b333SAlexander Shishkin static uintptr_t ci_regs_nolpm[] = {
80e443b333SAlexander Shishkin 	[CAP_CAPLENGTH]		= 0x000UL,
81e443b333SAlexander Shishkin 	[CAP_HCCPARAMS]		= 0x008UL,
82e443b333SAlexander Shishkin 	[CAP_DCCPARAMS]		= 0x024UL,
83e443b333SAlexander Shishkin 	[CAP_TESTMODE]		= 0x038UL,
84e443b333SAlexander Shishkin 	[OP_USBCMD]		= 0x000UL,
85e443b333SAlexander Shishkin 	[OP_USBSTS]		= 0x004UL,
86e443b333SAlexander Shishkin 	[OP_USBINTR]		= 0x008UL,
87e443b333SAlexander Shishkin 	[OP_DEVICEADDR]		= 0x014UL,
88e443b333SAlexander Shishkin 	[OP_ENDPTLISTADDR]	= 0x018UL,
89e443b333SAlexander Shishkin 	[OP_PORTSC]		= 0x044UL,
90e443b333SAlexander Shishkin 	[OP_DEVLC]		= 0x084UL,
915f36e231SAlexander Shishkin 	[OP_OTGSC]		= 0x064UL,
92e443b333SAlexander Shishkin 	[OP_USBMODE]		= 0x068UL,
93e443b333SAlexander Shishkin 	[OP_ENDPTSETUPSTAT]	= 0x06CUL,
94e443b333SAlexander Shishkin 	[OP_ENDPTPRIME]		= 0x070UL,
95e443b333SAlexander Shishkin 	[OP_ENDPTFLUSH]		= 0x074UL,
96e443b333SAlexander Shishkin 	[OP_ENDPTSTAT]		= 0x078UL,
97e443b333SAlexander Shishkin 	[OP_ENDPTCOMPLETE]	= 0x07CUL,
98e443b333SAlexander Shishkin 	[OP_ENDPTCTRL]		= 0x080UL,
99e443b333SAlexander Shishkin };
100e443b333SAlexander Shishkin 
101e443b333SAlexander Shishkin static uintptr_t ci_regs_lpm[] = {
102e443b333SAlexander Shishkin 	[CAP_CAPLENGTH]		= 0x000UL,
103e443b333SAlexander Shishkin 	[CAP_HCCPARAMS]		= 0x008UL,
104e443b333SAlexander Shishkin 	[CAP_DCCPARAMS]		= 0x024UL,
105e443b333SAlexander Shishkin 	[CAP_TESTMODE]		= 0x0FCUL,
106e443b333SAlexander Shishkin 	[OP_USBCMD]		= 0x000UL,
107e443b333SAlexander Shishkin 	[OP_USBSTS]		= 0x004UL,
108e443b333SAlexander Shishkin 	[OP_USBINTR]		= 0x008UL,
109e443b333SAlexander Shishkin 	[OP_DEVICEADDR]		= 0x014UL,
110e443b333SAlexander Shishkin 	[OP_ENDPTLISTADDR]	= 0x018UL,
111e443b333SAlexander Shishkin 	[OP_PORTSC]		= 0x044UL,
112e443b333SAlexander Shishkin 	[OP_DEVLC]		= 0x084UL,
1135f36e231SAlexander Shishkin 	[OP_OTGSC]		= 0x0C4UL,
114e443b333SAlexander Shishkin 	[OP_USBMODE]		= 0x0C8UL,
115e443b333SAlexander Shishkin 	[OP_ENDPTSETUPSTAT]	= 0x0D8UL,
116e443b333SAlexander Shishkin 	[OP_ENDPTPRIME]		= 0x0DCUL,
117e443b333SAlexander Shishkin 	[OP_ENDPTFLUSH]		= 0x0E0UL,
118e443b333SAlexander Shishkin 	[OP_ENDPTSTAT]		= 0x0E4UL,
119e443b333SAlexander Shishkin 	[OP_ENDPTCOMPLETE]	= 0x0E8UL,
120e443b333SAlexander Shishkin 	[OP_ENDPTCTRL]		= 0x0ECUL,
121e443b333SAlexander Shishkin };
122e443b333SAlexander Shishkin 
1235f36e231SAlexander Shishkin static int hw_alloc_regmap(struct ci13xxx *ci, bool is_lpm)
124e443b333SAlexander Shishkin {
125e443b333SAlexander Shishkin 	int i;
126e443b333SAlexander Shishkin 
1275f36e231SAlexander Shishkin 	kfree(ci->hw_bank.regmap);
128e443b333SAlexander Shishkin 
1295f36e231SAlexander Shishkin 	ci->hw_bank.regmap = kzalloc((OP_LAST + 1) * sizeof(void *),
130e443b333SAlexander Shishkin 				     GFP_KERNEL);
1315f36e231SAlexander Shishkin 	if (!ci->hw_bank.regmap)
132e443b333SAlexander Shishkin 		return -ENOMEM;
133e443b333SAlexander Shishkin 
134e443b333SAlexander Shishkin 	for (i = 0; i < OP_ENDPTCTRL; i++)
1355f36e231SAlexander Shishkin 		ci->hw_bank.regmap[i] =
1365f36e231SAlexander Shishkin 			(i <= CAP_LAST ? ci->hw_bank.cap : ci->hw_bank.op) +
137e443b333SAlexander Shishkin 			(is_lpm ? ci_regs_lpm[i] : ci_regs_nolpm[i]);
138e443b333SAlexander Shishkin 
139e443b333SAlexander Shishkin 	for (; i <= OP_LAST; i++)
1405f36e231SAlexander Shishkin 		ci->hw_bank.regmap[i] = ci->hw_bank.op +
141e443b333SAlexander Shishkin 			4 * (i - OP_ENDPTCTRL) +
142e443b333SAlexander Shishkin 			(is_lpm
143e443b333SAlexander Shishkin 			 ? ci_regs_lpm[OP_ENDPTCTRL]
144e443b333SAlexander Shishkin 			 : ci_regs_nolpm[OP_ENDPTCTRL]);
145e443b333SAlexander Shishkin 
146e443b333SAlexander Shishkin 	return 0;
147e443b333SAlexander Shishkin }
148e443b333SAlexander Shishkin 
149e443b333SAlexander Shishkin /**
150e443b333SAlexander Shishkin  * hw_port_test_set: writes port test mode (execute without interruption)
151e443b333SAlexander Shishkin  * @mode: new value
152e443b333SAlexander Shishkin  *
153e443b333SAlexander Shishkin  * This function returns an error code
154e443b333SAlexander Shishkin  */
155e443b333SAlexander Shishkin int hw_port_test_set(struct ci13xxx *ci, u8 mode)
156e443b333SAlexander Shishkin {
157e443b333SAlexander Shishkin 	const u8 TEST_MODE_MAX = 7;
158e443b333SAlexander Shishkin 
159e443b333SAlexander Shishkin 	if (mode > TEST_MODE_MAX)
160e443b333SAlexander Shishkin 		return -EINVAL;
161e443b333SAlexander Shishkin 
162e443b333SAlexander Shishkin 	hw_write(ci, OP_PORTSC, PORTSC_PTC, mode << ffs_nr(PORTSC_PTC));
163e443b333SAlexander Shishkin 	return 0;
164e443b333SAlexander Shishkin }
165e443b333SAlexander Shishkin 
166e443b333SAlexander Shishkin /**
167e443b333SAlexander Shishkin  * hw_port_test_get: reads port test mode value
168e443b333SAlexander Shishkin  *
169e443b333SAlexander Shishkin  * This function returns port test mode value
170e443b333SAlexander Shishkin  */
171e443b333SAlexander Shishkin u8 hw_port_test_get(struct ci13xxx *ci)
172e443b333SAlexander Shishkin {
173e443b333SAlexander Shishkin 	return hw_read(ci, OP_PORTSC, PORTSC_PTC) >> ffs_nr(PORTSC_PTC);
174e443b333SAlexander Shishkin }
175e443b333SAlexander Shishkin 
1765f36e231SAlexander Shishkin static int hw_device_init(struct ci13xxx *ci, void __iomem *base)
177e443b333SAlexander Shishkin {
178e443b333SAlexander Shishkin 	u32 reg;
179e443b333SAlexander Shishkin 
180e443b333SAlexander Shishkin 	/* bank is a module variable */
1815f36e231SAlexander Shishkin 	ci->hw_bank.abs = base;
182e443b333SAlexander Shishkin 
1835f36e231SAlexander Shishkin 	ci->hw_bank.cap = ci->hw_bank.abs;
1845f36e231SAlexander Shishkin 	ci->hw_bank.cap += ci->udc_driver->capoffset;
1855f36e231SAlexander Shishkin 	ci->hw_bank.op = ci->hw_bank.cap + ioread8(ci->hw_bank.cap);
186e443b333SAlexander Shishkin 
1875f36e231SAlexander Shishkin 	hw_alloc_regmap(ci, false);
1885f36e231SAlexander Shishkin 	reg = hw_read(ci, CAP_HCCPARAMS, HCCPARAMS_LEN) >>
189e443b333SAlexander Shishkin 		ffs_nr(HCCPARAMS_LEN);
1905f36e231SAlexander Shishkin 	ci->hw_bank.lpm  = reg;
1915f36e231SAlexander Shishkin 	hw_alloc_regmap(ci, !!reg);
1925f36e231SAlexander Shishkin 	ci->hw_bank.size = ci->hw_bank.op - ci->hw_bank.abs;
1935f36e231SAlexander Shishkin 	ci->hw_bank.size += OP_LAST;
1945f36e231SAlexander Shishkin 	ci->hw_bank.size /= sizeof(u32);
195e443b333SAlexander Shishkin 
1965f36e231SAlexander Shishkin 	reg = hw_read(ci, CAP_DCCPARAMS, DCCPARAMS_DEN) >>
197e443b333SAlexander Shishkin 		ffs_nr(DCCPARAMS_DEN);
1985f36e231SAlexander Shishkin 	ci->hw_ep_max = reg * 2;   /* cache hw ENDPT_MAX */
199e443b333SAlexander Shishkin 
2005f36e231SAlexander Shishkin 	if (ci->hw_ep_max == 0 || ci->hw_ep_max > ENDPT_MAX)
201e443b333SAlexander Shishkin 		return -ENODEV;
202e443b333SAlexander Shishkin 
2035f36e231SAlexander Shishkin 	dev_dbg(ci->dev, "ChipIdea HDRC found, lpm: %d; cap: %p op: %p\n",
2045f36e231SAlexander Shishkin 		ci->hw_bank.lpm, ci->hw_bank.cap, ci->hw_bank.op);
205e443b333SAlexander Shishkin 
206e443b333SAlexander Shishkin 	/* setup lock mode ? */
207e443b333SAlexander Shishkin 
208e443b333SAlexander Shishkin 	/* ENDPTSETUPSTAT is '0' by default */
209e443b333SAlexander Shishkin 
210e443b333SAlexander Shishkin 	/* HCSPARAMS.bf.ppc SHOULD BE zero for device */
211e443b333SAlexander Shishkin 
212e443b333SAlexander Shishkin 	return 0;
213e443b333SAlexander Shishkin }
214e443b333SAlexander Shishkin 
215e443b333SAlexander Shishkin /**
216e443b333SAlexander Shishkin  * hw_device_reset: resets chip (execute without interruption)
217e443b333SAlexander Shishkin  * @ci: the controller
218e443b333SAlexander Shishkin   *
219e443b333SAlexander Shishkin  * This function returns an error code
220e443b333SAlexander Shishkin  */
221e443b333SAlexander Shishkin int hw_device_reset(struct ci13xxx *ci)
222e443b333SAlexander Shishkin {
223e443b333SAlexander Shishkin 	/* should flush & stop before reset */
224e443b333SAlexander Shishkin 	hw_write(ci, OP_ENDPTFLUSH, ~0, ~0);
225e443b333SAlexander Shishkin 	hw_write(ci, OP_USBCMD, USBCMD_RS, 0);
226e443b333SAlexander Shishkin 
227e443b333SAlexander Shishkin 	hw_write(ci, OP_USBCMD, USBCMD_RST, USBCMD_RST);
228e443b333SAlexander Shishkin 	while (hw_read(ci, OP_USBCMD, USBCMD_RST))
229e443b333SAlexander Shishkin 		udelay(10);		/* not RTOS friendly */
230e443b333SAlexander Shishkin 
231e443b333SAlexander Shishkin 
232e443b333SAlexander Shishkin 	if (ci->udc_driver->notify_event)
233e443b333SAlexander Shishkin 		ci->udc_driver->notify_event(ci,
234e443b333SAlexander Shishkin 			CI13XXX_CONTROLLER_RESET_EVENT);
235e443b333SAlexander Shishkin 
236e443b333SAlexander Shishkin 	if (ci->udc_driver->flags & CI13XXX_DISABLE_STREAMING)
237e443b333SAlexander Shishkin 		hw_write(ci, OP_USBMODE, USBMODE_SDIS, USBMODE_SDIS);
238e443b333SAlexander Shishkin 
239e443b333SAlexander Shishkin 	/* USBMODE should be configured step by step */
240e443b333SAlexander Shishkin 	hw_write(ci, OP_USBMODE, USBMODE_CM, USBMODE_CM_IDLE);
241e443b333SAlexander Shishkin 	hw_write(ci, OP_USBMODE, USBMODE_CM, USBMODE_CM_DEVICE);
242e443b333SAlexander Shishkin 	/* HW >= 2.3 */
243e443b333SAlexander Shishkin 	hw_write(ci, OP_USBMODE, USBMODE_SLOM, USBMODE_SLOM);
244e443b333SAlexander Shishkin 
245e443b333SAlexander Shishkin 	if (hw_read(ci, OP_USBMODE, USBMODE_CM) != USBMODE_CM_DEVICE) {
246e443b333SAlexander Shishkin 		pr_err("cannot enter in device mode");
247e443b333SAlexander Shishkin 		pr_err("lpm = %i", ci->hw_bank.lpm);
248e443b333SAlexander Shishkin 		return -ENODEV;
249e443b333SAlexander Shishkin 	}
250e443b333SAlexander Shishkin 
251e443b333SAlexander Shishkin 	return 0;
252e443b333SAlexander Shishkin }
253e443b333SAlexander Shishkin 
2545f36e231SAlexander Shishkin /**
2555f36e231SAlexander Shishkin  * ci_otg_role - pick role based on ID pin state
2565f36e231SAlexander Shishkin  * @ci: the controller
2575f36e231SAlexander Shishkin  */
2585f36e231SAlexander Shishkin static enum ci_role ci_otg_role(struct ci13xxx *ci)
2595f36e231SAlexander Shishkin {
2605f36e231SAlexander Shishkin 	u32 sts = hw_read(ci, OP_OTGSC, ~0);
2615f36e231SAlexander Shishkin 	enum ci_role role = sts & OTGSC_ID
2625f36e231SAlexander Shishkin 		? CI_ROLE_GADGET
2635f36e231SAlexander Shishkin 		: CI_ROLE_HOST;
2645f36e231SAlexander Shishkin 
2655f36e231SAlexander Shishkin 	return role;
2665f36e231SAlexander Shishkin }
2675f36e231SAlexander Shishkin 
2685f36e231SAlexander Shishkin /**
2695f36e231SAlexander Shishkin  * ci_role_work - perform role changing based on ID pin
2705f36e231SAlexander Shishkin  * @work: work struct
2715f36e231SAlexander Shishkin  */
2725f36e231SAlexander Shishkin static void ci_role_work(struct work_struct *work)
2735f36e231SAlexander Shishkin {
2745f36e231SAlexander Shishkin 	struct ci13xxx *ci = container_of(work, struct ci13xxx, work);
2755f36e231SAlexander Shishkin 	enum ci_role role = ci_otg_role(ci);
2765f36e231SAlexander Shishkin 
2775f36e231SAlexander Shishkin 	hw_write(ci, OP_OTGSC, OTGSC_IDIS, OTGSC_IDIS);
2785f36e231SAlexander Shishkin 
2795f36e231SAlexander Shishkin 	if (role != ci->role) {
2805f36e231SAlexander Shishkin 		dev_dbg(ci->dev, "switching from %s to %s\n",
2815f36e231SAlexander Shishkin 			ci_role(ci)->name, ci->roles[role]->name);
2825f36e231SAlexander Shishkin 
2835f36e231SAlexander Shishkin 		ci_role_stop(ci);
2845f36e231SAlexander Shishkin 		ci_role_start(ci, role);
2855f36e231SAlexander Shishkin 	}
2865f36e231SAlexander Shishkin }
2875f36e231SAlexander Shishkin 
2885f36e231SAlexander Shishkin static ssize_t show_role(struct device *dev, struct device_attribute *attr,
2895f36e231SAlexander Shishkin 			 char *buf)
2905f36e231SAlexander Shishkin {
2915f36e231SAlexander Shishkin 	struct ci13xxx *ci = dev_get_drvdata(dev);
2925f36e231SAlexander Shishkin 
2935f36e231SAlexander Shishkin 	return sprintf(buf, "%s\n", ci_role(ci)->name);
2945f36e231SAlexander Shishkin }
2955f36e231SAlexander Shishkin 
2965f36e231SAlexander Shishkin static ssize_t store_role(struct device *dev, struct device_attribute *attr,
2975f36e231SAlexander Shishkin 			  const char *buf, size_t count)
2985f36e231SAlexander Shishkin {
2995f36e231SAlexander Shishkin 	struct ci13xxx *ci = dev_get_drvdata(dev);
3005f36e231SAlexander Shishkin 	enum ci_role role;
3015f36e231SAlexander Shishkin 	int ret;
3025f36e231SAlexander Shishkin 
3035f36e231SAlexander Shishkin 	for (role = CI_ROLE_HOST; role < CI_ROLE_END; role++)
3045f36e231SAlexander Shishkin 		if (ci->roles[role] && !strcmp(buf, ci->roles[role]->name))
3055f36e231SAlexander Shishkin 			break;
3065f36e231SAlexander Shishkin 
3075f36e231SAlexander Shishkin 	if (role == CI_ROLE_END || role == ci->role)
3085f36e231SAlexander Shishkin 		return -EINVAL;
3095f36e231SAlexander Shishkin 
3105f36e231SAlexander Shishkin 	ci_role_stop(ci);
3115f36e231SAlexander Shishkin 	ret = ci_role_start(ci, role);
3125f36e231SAlexander Shishkin 	if (ret)
3135f36e231SAlexander Shishkin 		return ret;
3145f36e231SAlexander Shishkin 
3155f36e231SAlexander Shishkin 	return count;
3165f36e231SAlexander Shishkin }
3175f36e231SAlexander Shishkin 
3185f36e231SAlexander Shishkin static DEVICE_ATTR(role, S_IRUSR | S_IWUSR, show_role, store_role);
3195f36e231SAlexander Shishkin 
3205f36e231SAlexander Shishkin static irqreturn_t ci_irq(int irq, void *data)
3215f36e231SAlexander Shishkin {
3225f36e231SAlexander Shishkin 	struct ci13xxx *ci = data;
3235f36e231SAlexander Shishkin 	irqreturn_t ret = IRQ_NONE;
3245f36e231SAlexander Shishkin 
3255f36e231SAlexander Shishkin 	if (ci->is_otg) {
3265f36e231SAlexander Shishkin 		u32 sts = hw_read(ci, OP_OTGSC, ~0);
3275f36e231SAlexander Shishkin 
3285f36e231SAlexander Shishkin 		if (sts & OTGSC_IDIS) {
3295f36e231SAlexander Shishkin 			queue_work(ci->wq, &ci->work);
3305f36e231SAlexander Shishkin 			ret = IRQ_HANDLED;
3315f36e231SAlexander Shishkin 		}
3325f36e231SAlexander Shishkin 	}
3335f36e231SAlexander Shishkin 
3345f36e231SAlexander Shishkin 	return ci->role == CI_ROLE_END ? ret : ci_role(ci)->irq(ci);
3355f36e231SAlexander Shishkin }
3365f36e231SAlexander Shishkin 
3375f36e231SAlexander Shishkin static int __devinit ci_hdrc_probe(struct platform_device *pdev)
338e443b333SAlexander Shishkin {
339e443b333SAlexander Shishkin 	struct device	*dev = &pdev->dev;
3405f36e231SAlexander Shishkin 	struct ci13xxx	*ci;
341e443b333SAlexander Shishkin 	struct resource	*res;
342e443b333SAlexander Shishkin 	void __iomem	*base;
343e443b333SAlexander Shishkin 	int		ret;
344e443b333SAlexander Shishkin 
3455f36e231SAlexander Shishkin 	if (!dev->platform_data) {
346e443b333SAlexander Shishkin 		dev_err(dev, "platform data missing\n");
347e443b333SAlexander Shishkin 		return -ENODEV;
348e443b333SAlexander Shishkin 	}
349e443b333SAlexander Shishkin 
350e443b333SAlexander Shishkin 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
351e443b333SAlexander Shishkin 	if (!res) {
352e443b333SAlexander Shishkin 		dev_err(dev, "missing resource\n");
353e443b333SAlexander Shishkin 		return -ENODEV;
354e443b333SAlexander Shishkin 	}
355e443b333SAlexander Shishkin 
356e443b333SAlexander Shishkin 	base = devm_request_and_ioremap(dev, res);
357e443b333SAlexander Shishkin 	if (!res) {
358e443b333SAlexander Shishkin 		dev_err(dev, "can't request and ioremap resource\n");
359e443b333SAlexander Shishkin 		return -ENOMEM;
360e443b333SAlexander Shishkin 	}
361e443b333SAlexander Shishkin 
3625f36e231SAlexander Shishkin 	ci = devm_kzalloc(dev, sizeof(*ci), GFP_KERNEL);
3635f36e231SAlexander Shishkin 	if (!ci) {
3645f36e231SAlexander Shishkin 		dev_err(dev, "can't allocate device\n");
3655f36e231SAlexander Shishkin 		return -ENOMEM;
3665f36e231SAlexander Shishkin 	}
367e443b333SAlexander Shishkin 
3685f36e231SAlexander Shishkin 	ci->dev = dev;
3695f36e231SAlexander Shishkin 	ci->udc_driver = dev->platform_data;
3705f36e231SAlexander Shishkin 
3715f36e231SAlexander Shishkin 	ret = hw_device_init(ci, base);
3725f36e231SAlexander Shishkin 	if (ret < 0) {
3735f36e231SAlexander Shishkin 		dev_err(dev, "can't initialize hardware\n");
3745f36e231SAlexander Shishkin 		return -ENODEV;
3755f36e231SAlexander Shishkin 	}
3765f36e231SAlexander Shishkin 
3775f36e231SAlexander Shishkin 	ci->irq = platform_get_irq(pdev, 0);
3785f36e231SAlexander Shishkin 	if (ci->irq < 0) {
379e443b333SAlexander Shishkin 		dev_err(dev, "missing IRQ\n");
3805f36e231SAlexander Shishkin 		return -ENODEV;
381e443b333SAlexander Shishkin 	}
382e443b333SAlexander Shishkin 
3835f36e231SAlexander Shishkin 	INIT_WORK(&ci->work, ci_role_work);
3845f36e231SAlexander Shishkin 	ci->wq = create_singlethread_workqueue("ci_otg");
3855f36e231SAlexander Shishkin 	if (!ci->wq) {
3865f36e231SAlexander Shishkin 		dev_err(dev, "can't create workqueue\n");
3875f36e231SAlexander Shishkin 		return -ENODEV;
3885f36e231SAlexander Shishkin 	}
389e443b333SAlexander Shishkin 
3905f36e231SAlexander Shishkin 	/* initialize role(s) before the interrupt is requested */
3915f36e231SAlexander Shishkin 	ret = ci_hdrc_gadget_init(ci);
392e443b333SAlexander Shishkin 	if (ret)
3935f36e231SAlexander Shishkin 		dev_info(dev, "doesn't support gadget\n");
3945f36e231SAlexander Shishkin 
3955f36e231SAlexander Shishkin 	if (!ci->roles[CI_ROLE_HOST] && !ci->roles[CI_ROLE_GADGET]) {
3965f36e231SAlexander Shishkin 		dev_err(dev, "no supported roles\n");
3975f36e231SAlexander Shishkin 		ret = -ENODEV;
3985f36e231SAlexander Shishkin 		goto rm_wq;
3995f36e231SAlexander Shishkin 	}
4005f36e231SAlexander Shishkin 
4015f36e231SAlexander Shishkin 	if (ci->roles[CI_ROLE_HOST] && ci->roles[CI_ROLE_GADGET]) {
4025f36e231SAlexander Shishkin 		ci->is_otg = true;
4035f36e231SAlexander Shishkin 		ci->role = ci_otg_role(ci);
4045f36e231SAlexander Shishkin 	} else {
4055f36e231SAlexander Shishkin 		ci->role = ci->roles[CI_ROLE_HOST]
4065f36e231SAlexander Shishkin 			? CI_ROLE_HOST
4075f36e231SAlexander Shishkin 			: CI_ROLE_GADGET;
4085f36e231SAlexander Shishkin 	}
4095f36e231SAlexander Shishkin 
4105f36e231SAlexander Shishkin 	ret = ci_role_start(ci, ci->role);
4115f36e231SAlexander Shishkin 	if (ret) {
4125f36e231SAlexander Shishkin 		dev_err(dev, "can't start %s role\n", ci_role(ci)->name);
4135f36e231SAlexander Shishkin 		ret = -ENODEV;
4145f36e231SAlexander Shishkin 		goto rm_wq;
4155f36e231SAlexander Shishkin 	}
4165f36e231SAlexander Shishkin 
4175f36e231SAlexander Shishkin 	platform_set_drvdata(pdev, ci);
4185f36e231SAlexander Shishkin 	ret = request_irq(ci->irq, ci_irq, IRQF_SHARED, ci->udc_driver->name,
4195f36e231SAlexander Shishkin 			  ci);
4205f36e231SAlexander Shishkin 	if (ret)
4215f36e231SAlexander Shishkin 		goto stop;
4225f36e231SAlexander Shishkin 
4235f36e231SAlexander Shishkin 	ret = device_create_file(dev, &dev_attr_role);
4245f36e231SAlexander Shishkin 	if (ret)
4255f36e231SAlexander Shishkin 		goto rm_attr;
4265f36e231SAlexander Shishkin 
4275f36e231SAlexander Shishkin 	if (ci->is_otg)
4285f36e231SAlexander Shishkin 		hw_write(ci, OP_OTGSC, OTGSC_IDIE, OTGSC_IDIE);
4295f36e231SAlexander Shishkin 
4305f36e231SAlexander Shishkin 	return ret;
4315f36e231SAlexander Shishkin 
4325f36e231SAlexander Shishkin rm_attr:
4335f36e231SAlexander Shishkin 	device_remove_file(dev, &dev_attr_role);
4345f36e231SAlexander Shishkin stop:
4355f36e231SAlexander Shishkin 	ci_role_stop(ci);
4365f36e231SAlexander Shishkin rm_wq:
4375f36e231SAlexander Shishkin 	flush_workqueue(ci->wq);
4385f36e231SAlexander Shishkin 	destroy_workqueue(ci->wq);
439e443b333SAlexander Shishkin 
440e443b333SAlexander Shishkin 	return ret;
441e443b333SAlexander Shishkin }
442e443b333SAlexander Shishkin 
4435f36e231SAlexander Shishkin static int __devexit ci_hdrc_remove(struct platform_device *pdev)
444e443b333SAlexander Shishkin {
4455f36e231SAlexander Shishkin 	struct ci13xxx *ci = platform_get_drvdata(pdev);
446e443b333SAlexander Shishkin 
4475f36e231SAlexander Shishkin 	flush_workqueue(ci->wq);
4485f36e231SAlexander Shishkin 	destroy_workqueue(ci->wq);
4495f36e231SAlexander Shishkin 	device_remove_file(ci->dev, &dev_attr_role);
4505f36e231SAlexander Shishkin 	free_irq(ci->irq, ci);
4515f36e231SAlexander Shishkin 	ci_role_stop(ci);
452e443b333SAlexander Shishkin 
453e443b333SAlexander Shishkin 	return 0;
454e443b333SAlexander Shishkin }
455e443b333SAlexander Shishkin 
4565f36e231SAlexander Shishkin static struct platform_driver ci_hdrc_driver = {
4575f36e231SAlexander Shishkin 	.probe	= ci_hdrc_probe,
4585f36e231SAlexander Shishkin 	.remove	= __devexit_p(ci_hdrc_remove),
459e443b333SAlexander Shishkin 	.driver	= {
4605f36e231SAlexander Shishkin 		.name	= "ci_hdrc",
461e443b333SAlexander Shishkin 	},
462e443b333SAlexander Shishkin };
463e443b333SAlexander Shishkin 
4645f36e231SAlexander Shishkin module_platform_driver(ci_hdrc_driver);
465e443b333SAlexander Shishkin 
4665f36e231SAlexander Shishkin MODULE_ALIAS("platform:ci_hdrc");
467e443b333SAlexander Shishkin MODULE_ALIAS("platform:ci13xxx");
468e443b333SAlexander Shishkin MODULE_LICENSE("GPL v2");
469e443b333SAlexander Shishkin MODULE_AUTHOR("David Lopo <dlopo@chipidea.mips.com>");
4705f36e231SAlexander Shishkin MODULE_DESCRIPTION("ChipIdea HDRC Driver");
471