xref: /OK3568_Linux_fs/kernel/drivers/usb/host/oxu210hp-hcd.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (c) 2008 Rodolfo Giometti <giometti@linux.it>
4*4882a593Smuzhiyun  * Copyright (c) 2008 Eurotech S.p.A. <info@eurtech.it>
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * This code is *strongly* based on EHCI-HCD code by David Brownell since
7*4882a593Smuzhiyun  * the chip is a quasi-EHCI compatible.
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/module.h>
11*4882a593Smuzhiyun #include <linux/pci.h>
12*4882a593Smuzhiyun #include <linux/dmapool.h>
13*4882a593Smuzhiyun #include <linux/kernel.h>
14*4882a593Smuzhiyun #include <linux/delay.h>
15*4882a593Smuzhiyun #include <linux/ioport.h>
16*4882a593Smuzhiyun #include <linux/sched.h>
17*4882a593Smuzhiyun #include <linux/slab.h>
18*4882a593Smuzhiyun #include <linux/errno.h>
19*4882a593Smuzhiyun #include <linux/timer.h>
20*4882a593Smuzhiyun #include <linux/list.h>
21*4882a593Smuzhiyun #include <linux/interrupt.h>
22*4882a593Smuzhiyun #include <linux/usb.h>
23*4882a593Smuzhiyun #include <linux/usb/hcd.h>
24*4882a593Smuzhiyun #include <linux/moduleparam.h>
25*4882a593Smuzhiyun #include <linux/dma-mapping.h>
26*4882a593Smuzhiyun #include <linux/io.h>
27*4882a593Smuzhiyun #include <linux/iopoll.h>
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #include <asm/irq.h>
30*4882a593Smuzhiyun #include <asm/unaligned.h>
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun #include <linux/irq.h>
33*4882a593Smuzhiyun #include <linux/platform_device.h>
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun #define DRIVER_VERSION "0.0.50"
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun #define OXU_DEVICEID			0x00
38*4882a593Smuzhiyun 	#define OXU_REV_MASK		0xffff0000
39*4882a593Smuzhiyun 	#define OXU_REV_SHIFT		16
40*4882a593Smuzhiyun 	#define OXU_REV_2100		0x2100
41*4882a593Smuzhiyun 	#define OXU_BO_SHIFT		8
42*4882a593Smuzhiyun 	#define OXU_BO_MASK		(0x3 << OXU_BO_SHIFT)
43*4882a593Smuzhiyun 	#define OXU_MAJ_REV_SHIFT	4
44*4882a593Smuzhiyun 	#define OXU_MAJ_REV_MASK	(0xf << OXU_MAJ_REV_SHIFT)
45*4882a593Smuzhiyun 	#define OXU_MIN_REV_SHIFT	0
46*4882a593Smuzhiyun 	#define OXU_MIN_REV_MASK	(0xf << OXU_MIN_REV_SHIFT)
47*4882a593Smuzhiyun #define OXU_HOSTIFCONFIG		0x04
48*4882a593Smuzhiyun #define OXU_SOFTRESET			0x08
49*4882a593Smuzhiyun 	#define OXU_SRESET		(1 << 0)
50*4882a593Smuzhiyun 
51*4882a593Smuzhiyun #define OXU_PIOBURSTREADCTRL		0x0C
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun #define OXU_CHIPIRQSTATUS		0x10
54*4882a593Smuzhiyun #define OXU_CHIPIRQEN_SET		0x14
55*4882a593Smuzhiyun #define OXU_CHIPIRQEN_CLR		0x18
56*4882a593Smuzhiyun 	#define OXU_USBSPHLPWUI		0x00000080
57*4882a593Smuzhiyun 	#define OXU_USBOTGLPWUI		0x00000040
58*4882a593Smuzhiyun 	#define OXU_USBSPHI		0x00000002
59*4882a593Smuzhiyun 	#define OXU_USBOTGI		0x00000001
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun #define OXU_CLKCTRL_SET			0x1C
62*4882a593Smuzhiyun 	#define OXU_SYSCLKEN		0x00000008
63*4882a593Smuzhiyun 	#define OXU_USBSPHCLKEN		0x00000002
64*4882a593Smuzhiyun 	#define OXU_USBOTGCLKEN		0x00000001
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun #define OXU_ASO				0x68
67*4882a593Smuzhiyun 	#define OXU_SPHPOEN		0x00000100
68*4882a593Smuzhiyun 	#define OXU_OVRCCURPUPDEN	0x00000800
69*4882a593Smuzhiyun 	#define OXU_ASO_OP		(1 << 10)
70*4882a593Smuzhiyun 	#define OXU_COMPARATOR		0x000004000
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun #define OXU_USBMODE			0x1A8
73*4882a593Smuzhiyun 	#define OXU_VBPS		0x00000020
74*4882a593Smuzhiyun 	#define OXU_ES_LITTLE		0x00000000
75*4882a593Smuzhiyun 	#define OXU_CM_HOST_ONLY	0x00000003
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun /*
78*4882a593Smuzhiyun  * Proper EHCI structs & defines
79*4882a593Smuzhiyun  */
80*4882a593Smuzhiyun 
81*4882a593Smuzhiyun /* Magic numbers that can affect system performance */
82*4882a593Smuzhiyun #define EHCI_TUNE_CERR		3	/* 0-3 qtd retries; 0 == don't stop */
83*4882a593Smuzhiyun #define EHCI_TUNE_RL_HS		4	/* nak throttle; see 4.9 */
84*4882a593Smuzhiyun #define EHCI_TUNE_RL_TT		0
85*4882a593Smuzhiyun #define EHCI_TUNE_MULT_HS	1	/* 1-3 transactions/uframe; 4.10.3 */
86*4882a593Smuzhiyun #define EHCI_TUNE_MULT_TT	1
87*4882a593Smuzhiyun #define EHCI_TUNE_FLS		2	/* (small) 256 frame schedule */
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun struct oxu_hcd;
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun /* EHCI register interface, corresponds to EHCI Revision 0.95 specification */
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun /* Section 2.2 Host Controller Capability Registers */
94*4882a593Smuzhiyun struct ehci_caps {
95*4882a593Smuzhiyun 	/* these fields are specified as 8 and 16 bit registers,
96*4882a593Smuzhiyun 	 * but some hosts can't perform 8 or 16 bit PCI accesses.
97*4882a593Smuzhiyun 	 */
98*4882a593Smuzhiyun 	u32		hc_capbase;
99*4882a593Smuzhiyun #define HC_LENGTH(p)		(((p)>>00)&0x00ff)	/* bits 7:0 */
100*4882a593Smuzhiyun #define HC_VERSION(p)		(((p)>>16)&0xffff)	/* bits 31:16 */
101*4882a593Smuzhiyun 	u32		hcs_params;     /* HCSPARAMS - offset 0x4 */
102*4882a593Smuzhiyun #define HCS_DEBUG_PORT(p)	(((p)>>20)&0xf)	/* bits 23:20, debug port? */
103*4882a593Smuzhiyun #define HCS_INDICATOR(p)	((p)&(1 << 16))	/* true: has port indicators */
104*4882a593Smuzhiyun #define HCS_N_CC(p)		(((p)>>12)&0xf)	/* bits 15:12, #companion HCs */
105*4882a593Smuzhiyun #define HCS_N_PCC(p)		(((p)>>8)&0xf)	/* bits 11:8, ports per CC */
106*4882a593Smuzhiyun #define HCS_PORTROUTED(p)	((p)&(1 << 7))	/* true: port routing */
107*4882a593Smuzhiyun #define HCS_PPC(p)		((p)&(1 << 4))	/* true: port power control */
108*4882a593Smuzhiyun #define HCS_N_PORTS(p)		(((p)>>0)&0xf)	/* bits 3:0, ports on HC */
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 	u32		hcc_params;      /* HCCPARAMS - offset 0x8 */
111*4882a593Smuzhiyun #define HCC_EXT_CAPS(p)		(((p)>>8)&0xff)	/* for pci extended caps */
112*4882a593Smuzhiyun #define HCC_ISOC_CACHE(p)       ((p)&(1 << 7))  /* true: can cache isoc frame */
113*4882a593Smuzhiyun #define HCC_ISOC_THRES(p)       (((p)>>4)&0x7)  /* bits 6:4, uframes cached */
114*4882a593Smuzhiyun #define HCC_CANPARK(p)		((p)&(1 << 2))  /* true: can park on async qh */
115*4882a593Smuzhiyun #define HCC_PGM_FRAMELISTLEN(p) ((p)&(1 << 1))  /* true: periodic_size changes*/
116*4882a593Smuzhiyun #define HCC_64BIT_ADDR(p)       ((p)&(1))       /* true: can use 64-bit addr */
117*4882a593Smuzhiyun 	u8		portroute[8];	 /* nibbles for routing - offset 0xC */
118*4882a593Smuzhiyun } __packed;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun /* Section 2.3 Host Controller Operational Registers */
122*4882a593Smuzhiyun struct ehci_regs {
123*4882a593Smuzhiyun 	/* USBCMD: offset 0x00 */
124*4882a593Smuzhiyun 	u32		command;
125*4882a593Smuzhiyun /* 23:16 is r/w intr rate, in microframes; default "8" == 1/msec */
126*4882a593Smuzhiyun #define CMD_PARK	(1<<11)		/* enable "park" on async qh */
127*4882a593Smuzhiyun #define CMD_PARK_CNT(c)	(((c)>>8)&3)	/* how many transfers to park for */
128*4882a593Smuzhiyun #define CMD_LRESET	(1<<7)		/* partial reset (no ports, etc) */
129*4882a593Smuzhiyun #define CMD_IAAD	(1<<6)		/* "doorbell" interrupt async advance */
130*4882a593Smuzhiyun #define CMD_ASE		(1<<5)		/* async schedule enable */
131*4882a593Smuzhiyun #define CMD_PSE		(1<<4)		/* periodic schedule enable */
132*4882a593Smuzhiyun /* 3:2 is periodic frame list size */
133*4882a593Smuzhiyun #define CMD_RESET	(1<<1)		/* reset HC not bus */
134*4882a593Smuzhiyun #define CMD_RUN		(1<<0)		/* start/stop HC */
135*4882a593Smuzhiyun 
136*4882a593Smuzhiyun 	/* USBSTS: offset 0x04 */
137*4882a593Smuzhiyun 	u32		status;
138*4882a593Smuzhiyun #define STS_ASS		(1<<15)		/* Async Schedule Status */
139*4882a593Smuzhiyun #define STS_PSS		(1<<14)		/* Periodic Schedule Status */
140*4882a593Smuzhiyun #define STS_RECL	(1<<13)		/* Reclamation */
141*4882a593Smuzhiyun #define STS_HALT	(1<<12)		/* Not running (any reason) */
142*4882a593Smuzhiyun /* some bits reserved */
143*4882a593Smuzhiyun 	/* these STS_* flags are also intr_enable bits (USBINTR) */
144*4882a593Smuzhiyun #define STS_IAA		(1<<5)		/* Interrupted on async advance */
145*4882a593Smuzhiyun #define STS_FATAL	(1<<4)		/* such as some PCI access errors */
146*4882a593Smuzhiyun #define STS_FLR		(1<<3)		/* frame list rolled over */
147*4882a593Smuzhiyun #define STS_PCD		(1<<2)		/* port change detect */
148*4882a593Smuzhiyun #define STS_ERR		(1<<1)		/* "error" completion (overflow, ...) */
149*4882a593Smuzhiyun #define STS_INT		(1<<0)		/* "normal" completion (short, ...) */
150*4882a593Smuzhiyun 
151*4882a593Smuzhiyun #define INTR_MASK (STS_IAA | STS_FATAL | STS_PCD | STS_ERR | STS_INT)
152*4882a593Smuzhiyun 
153*4882a593Smuzhiyun 	/* USBINTR: offset 0x08 */
154*4882a593Smuzhiyun 	u32		intr_enable;
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun 	/* FRINDEX: offset 0x0C */
157*4882a593Smuzhiyun 	u32		frame_index;	/* current microframe number */
158*4882a593Smuzhiyun 	/* CTRLDSSEGMENT: offset 0x10 */
159*4882a593Smuzhiyun 	u32		segment;	/* address bits 63:32 if needed */
160*4882a593Smuzhiyun 	/* PERIODICLISTBASE: offset 0x14 */
161*4882a593Smuzhiyun 	u32		frame_list;	/* points to periodic list */
162*4882a593Smuzhiyun 	/* ASYNCLISTADDR: offset 0x18 */
163*4882a593Smuzhiyun 	u32		async_next;	/* address of next async queue head */
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	u32		reserved[9];
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 	/* CONFIGFLAG: offset 0x40 */
168*4882a593Smuzhiyun 	u32		configured_flag;
169*4882a593Smuzhiyun #define FLAG_CF		(1<<0)		/* true: we'll support "high speed" */
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun 	/* PORTSC: offset 0x44 */
172*4882a593Smuzhiyun 	u32		port_status[0];	/* up to N_PORTS */
173*4882a593Smuzhiyun /* 31:23 reserved */
174*4882a593Smuzhiyun #define PORT_WKOC_E	(1<<22)		/* wake on overcurrent (enable) */
175*4882a593Smuzhiyun #define PORT_WKDISC_E	(1<<21)		/* wake on disconnect (enable) */
176*4882a593Smuzhiyun #define PORT_WKCONN_E	(1<<20)		/* wake on connect (enable) */
177*4882a593Smuzhiyun /* 19:16 for port testing */
178*4882a593Smuzhiyun #define PORT_LED_OFF	(0<<14)
179*4882a593Smuzhiyun #define PORT_LED_AMBER	(1<<14)
180*4882a593Smuzhiyun #define PORT_LED_GREEN	(2<<14)
181*4882a593Smuzhiyun #define PORT_LED_MASK	(3<<14)
182*4882a593Smuzhiyun #define PORT_OWNER	(1<<13)		/* true: companion hc owns this port */
183*4882a593Smuzhiyun #define PORT_POWER	(1<<12)		/* true: has power (see PPC) */
184*4882a593Smuzhiyun #define PORT_USB11(x) (((x)&(3<<10)) == (1<<10))	/* USB 1.1 device */
185*4882a593Smuzhiyun /* 11:10 for detecting lowspeed devices (reset vs release ownership) */
186*4882a593Smuzhiyun /* 9 reserved */
187*4882a593Smuzhiyun #define PORT_RESET	(1<<8)		/* reset port */
188*4882a593Smuzhiyun #define PORT_SUSPEND	(1<<7)		/* suspend port */
189*4882a593Smuzhiyun #define PORT_RESUME	(1<<6)		/* resume it */
190*4882a593Smuzhiyun #define PORT_OCC	(1<<5)		/* over current change */
191*4882a593Smuzhiyun #define PORT_OC		(1<<4)		/* over current active */
192*4882a593Smuzhiyun #define PORT_PEC	(1<<3)		/* port enable change */
193*4882a593Smuzhiyun #define PORT_PE		(1<<2)		/* port enable */
194*4882a593Smuzhiyun #define PORT_CSC	(1<<1)		/* connect status change */
195*4882a593Smuzhiyun #define PORT_CONNECT	(1<<0)		/* device connected */
196*4882a593Smuzhiyun #define PORT_RWC_BITS   (PORT_CSC | PORT_PEC | PORT_OCC)
197*4882a593Smuzhiyun } __packed;
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun /* Appendix C, Debug port ... intended for use with special "debug devices"
200*4882a593Smuzhiyun  * that can help if there's no serial console.  (nonstandard enumeration.)
201*4882a593Smuzhiyun  */
202*4882a593Smuzhiyun struct ehci_dbg_port {
203*4882a593Smuzhiyun 	u32	control;
204*4882a593Smuzhiyun #define DBGP_OWNER	(1<<30)
205*4882a593Smuzhiyun #define DBGP_ENABLED	(1<<28)
206*4882a593Smuzhiyun #define DBGP_DONE	(1<<16)
207*4882a593Smuzhiyun #define DBGP_INUSE	(1<<10)
208*4882a593Smuzhiyun #define DBGP_ERRCODE(x)	(((x)>>7)&0x07)
209*4882a593Smuzhiyun #	define DBGP_ERR_BAD	1
210*4882a593Smuzhiyun #	define DBGP_ERR_SIGNAL	2
211*4882a593Smuzhiyun #define DBGP_ERROR	(1<<6)
212*4882a593Smuzhiyun #define DBGP_GO		(1<<5)
213*4882a593Smuzhiyun #define DBGP_OUT	(1<<4)
214*4882a593Smuzhiyun #define DBGP_LEN(x)	(((x)>>0)&0x0f)
215*4882a593Smuzhiyun 	u32	pids;
216*4882a593Smuzhiyun #define DBGP_PID_GET(x)		(((x)>>16)&0xff)
217*4882a593Smuzhiyun #define DBGP_PID_SET(data, tok)	(((data)<<8)|(tok))
218*4882a593Smuzhiyun 	u32	data03;
219*4882a593Smuzhiyun 	u32	data47;
220*4882a593Smuzhiyun 	u32	address;
221*4882a593Smuzhiyun #define DBGP_EPADDR(dev, ep)	(((dev)<<8)|(ep))
222*4882a593Smuzhiyun } __packed;
223*4882a593Smuzhiyun 
224*4882a593Smuzhiyun #define	QTD_NEXT(dma)	cpu_to_le32((u32)dma)
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun /*
227*4882a593Smuzhiyun  * EHCI Specification 0.95 Section 3.5
228*4882a593Smuzhiyun  * QTD: describe data transfer components (buffer, direction, ...)
229*4882a593Smuzhiyun  * See Fig 3-6 "Queue Element Transfer Descriptor Block Diagram".
230*4882a593Smuzhiyun  *
231*4882a593Smuzhiyun  * These are associated only with "QH" (Queue Head) structures,
232*4882a593Smuzhiyun  * used with control, bulk, and interrupt transfers.
233*4882a593Smuzhiyun  */
234*4882a593Smuzhiyun struct ehci_qtd {
235*4882a593Smuzhiyun 	/* first part defined by EHCI spec */
236*4882a593Smuzhiyun 	__le32			hw_next;		/* see EHCI 3.5.1 */
237*4882a593Smuzhiyun 	__le32			hw_alt_next;		/* see EHCI 3.5.2 */
238*4882a593Smuzhiyun 	__le32			hw_token;		/* see EHCI 3.5.3 */
239*4882a593Smuzhiyun #define	QTD_TOGGLE	(1 << 31)	/* data toggle */
240*4882a593Smuzhiyun #define	QTD_LENGTH(tok)	(((tok)>>16) & 0x7fff)
241*4882a593Smuzhiyun #define	QTD_IOC		(1 << 15)	/* interrupt on complete */
242*4882a593Smuzhiyun #define	QTD_CERR(tok)	(((tok)>>10) & 0x3)
243*4882a593Smuzhiyun #define	QTD_PID(tok)	(((tok)>>8) & 0x3)
244*4882a593Smuzhiyun #define	QTD_STS_ACTIVE	(1 << 7)	/* HC may execute this */
245*4882a593Smuzhiyun #define	QTD_STS_HALT	(1 << 6)	/* halted on error */
246*4882a593Smuzhiyun #define	QTD_STS_DBE	(1 << 5)	/* data buffer error (in HC) */
247*4882a593Smuzhiyun #define	QTD_STS_BABBLE	(1 << 4)	/* device was babbling (qtd halted) */
248*4882a593Smuzhiyun #define	QTD_STS_XACT	(1 << 3)	/* device gave illegal response */
249*4882a593Smuzhiyun #define	QTD_STS_MMF	(1 << 2)	/* incomplete split transaction */
250*4882a593Smuzhiyun #define	QTD_STS_STS	(1 << 1)	/* split transaction state */
251*4882a593Smuzhiyun #define	QTD_STS_PING	(1 << 0)	/* issue PING? */
252*4882a593Smuzhiyun 	__le32			hw_buf[5];		/* see EHCI 3.5.4 */
253*4882a593Smuzhiyun 	__le32			hw_buf_hi[5];		/* Appendix B */
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	/* the rest is HCD-private */
256*4882a593Smuzhiyun 	dma_addr_t		qtd_dma;		/* qtd address */
257*4882a593Smuzhiyun 	struct list_head	qtd_list;		/* sw qtd list */
258*4882a593Smuzhiyun 	struct urb		*urb;			/* qtd's urb */
259*4882a593Smuzhiyun 	size_t			length;			/* length of buffer */
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun 	u32			qtd_buffer_len;
262*4882a593Smuzhiyun 	void			*buffer;
263*4882a593Smuzhiyun 	dma_addr_t		buffer_dma;
264*4882a593Smuzhiyun 	void			*transfer_buffer;
265*4882a593Smuzhiyun 	void			*transfer_dma;
266*4882a593Smuzhiyun } __aligned(32);
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun /* mask NakCnt+T in qh->hw_alt_next */
269*4882a593Smuzhiyun #define QTD_MASK cpu_to_le32 (~0x1f)
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun #define IS_SHORT_READ(token) (QTD_LENGTH(token) != 0 && QTD_PID(token) == 1)
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun /* Type tag from {qh, itd, sitd, fstn}->hw_next */
274*4882a593Smuzhiyun #define Q_NEXT_TYPE(dma) ((dma) & cpu_to_le32 (3 << 1))
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun /* values for that type tag */
277*4882a593Smuzhiyun #define Q_TYPE_QH	cpu_to_le32 (1 << 1)
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun /* next async queue entry, or pointer to interrupt/periodic QH */
280*4882a593Smuzhiyun #define	QH_NEXT(dma)	(cpu_to_le32(((u32)dma)&~0x01f)|Q_TYPE_QH)
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun /* for periodic/async schedules and qtd lists, mark end of list */
283*4882a593Smuzhiyun #define	EHCI_LIST_END	cpu_to_le32(1) /* "null pointer" to hw */
284*4882a593Smuzhiyun 
285*4882a593Smuzhiyun /*
286*4882a593Smuzhiyun  * Entries in periodic shadow table are pointers to one of four kinds
287*4882a593Smuzhiyun  * of data structure.  That's dictated by the hardware; a type tag is
288*4882a593Smuzhiyun  * encoded in the low bits of the hardware's periodic schedule.  Use
289*4882a593Smuzhiyun  * Q_NEXT_TYPE to get the tag.
290*4882a593Smuzhiyun  *
291*4882a593Smuzhiyun  * For entries in the async schedule, the type tag always says "qh".
292*4882a593Smuzhiyun  */
293*4882a593Smuzhiyun union ehci_shadow {
294*4882a593Smuzhiyun 	struct ehci_qh		*qh;		/* Q_TYPE_QH */
295*4882a593Smuzhiyun 	__le32			*hw_next;	/* (all types) */
296*4882a593Smuzhiyun 	void			*ptr;
297*4882a593Smuzhiyun };
298*4882a593Smuzhiyun 
299*4882a593Smuzhiyun /*
300*4882a593Smuzhiyun  * EHCI Specification 0.95 Section 3.6
301*4882a593Smuzhiyun  * QH: describes control/bulk/interrupt endpoints
302*4882a593Smuzhiyun  * See Fig 3-7 "Queue Head Structure Layout".
303*4882a593Smuzhiyun  *
304*4882a593Smuzhiyun  * These appear in both the async and (for interrupt) periodic schedules.
305*4882a593Smuzhiyun  */
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun struct ehci_qh {
308*4882a593Smuzhiyun 	/* first part defined by EHCI spec */
309*4882a593Smuzhiyun 	__le32			hw_next;	 /* see EHCI 3.6.1 */
310*4882a593Smuzhiyun 	__le32			hw_info1;	/* see EHCI 3.6.2 */
311*4882a593Smuzhiyun #define	QH_HEAD		0x00008000
312*4882a593Smuzhiyun 	__le32			hw_info2;	/* see EHCI 3.6.2 */
313*4882a593Smuzhiyun #define	QH_SMASK	0x000000ff
314*4882a593Smuzhiyun #define	QH_CMASK	0x0000ff00
315*4882a593Smuzhiyun #define	QH_HUBADDR	0x007f0000
316*4882a593Smuzhiyun #define	QH_HUBPORT	0x3f800000
317*4882a593Smuzhiyun #define	QH_MULT		0xc0000000
318*4882a593Smuzhiyun 	__le32			hw_current;	 /* qtd list - see EHCI 3.6.4 */
319*4882a593Smuzhiyun 
320*4882a593Smuzhiyun 	/* qtd overlay (hardware parts of a struct ehci_qtd) */
321*4882a593Smuzhiyun 	__le32			hw_qtd_next;
322*4882a593Smuzhiyun 	__le32			hw_alt_next;
323*4882a593Smuzhiyun 	__le32			hw_token;
324*4882a593Smuzhiyun 	__le32			hw_buf[5];
325*4882a593Smuzhiyun 	__le32			hw_buf_hi[5];
326*4882a593Smuzhiyun 
327*4882a593Smuzhiyun 	/* the rest is HCD-private */
328*4882a593Smuzhiyun 	dma_addr_t		qh_dma;		/* address of qh */
329*4882a593Smuzhiyun 	union ehci_shadow	qh_next;	/* ptr to qh; or periodic */
330*4882a593Smuzhiyun 	struct list_head	qtd_list;	/* sw qtd list */
331*4882a593Smuzhiyun 	struct ehci_qtd		*dummy;
332*4882a593Smuzhiyun 	struct ehci_qh		*reclaim;	/* next to reclaim */
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	struct oxu_hcd		*oxu;
335*4882a593Smuzhiyun 	struct kref		kref;
336*4882a593Smuzhiyun 	unsigned int		stamp;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	u8			qh_state;
339*4882a593Smuzhiyun #define	QH_STATE_LINKED		1		/* HC sees this */
340*4882a593Smuzhiyun #define	QH_STATE_UNLINK		2		/* HC may still see this */
341*4882a593Smuzhiyun #define	QH_STATE_IDLE		3		/* HC doesn't see this */
342*4882a593Smuzhiyun #define	QH_STATE_UNLINK_WAIT	4		/* LINKED and on reclaim q */
343*4882a593Smuzhiyun #define	QH_STATE_COMPLETING	5		/* don't touch token.HALT */
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	/* periodic schedule info */
346*4882a593Smuzhiyun 	u8			usecs;		/* intr bandwidth */
347*4882a593Smuzhiyun 	u8			gap_uf;		/* uframes split/csplit gap */
348*4882a593Smuzhiyun 	u8			c_usecs;	/* ... split completion bw */
349*4882a593Smuzhiyun 	u16			tt_usecs;	/* tt downstream bandwidth */
350*4882a593Smuzhiyun 	unsigned short		period;		/* polling interval */
351*4882a593Smuzhiyun 	unsigned short		start;		/* where polling starts */
352*4882a593Smuzhiyun #define NO_FRAME ((unsigned short)~0)			/* pick new start */
353*4882a593Smuzhiyun 	struct usb_device	*dev;		/* access to TT */
354*4882a593Smuzhiyun } __aligned(32);
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun /*
357*4882a593Smuzhiyun  * Proper OXU210HP structs
358*4882a593Smuzhiyun  */
359*4882a593Smuzhiyun 
360*4882a593Smuzhiyun #define OXU_OTG_CORE_OFFSET	0x00400
361*4882a593Smuzhiyun #define OXU_OTG_CAP_OFFSET	(OXU_OTG_CORE_OFFSET + 0x100)
362*4882a593Smuzhiyun #define OXU_SPH_CORE_OFFSET	0x00800
363*4882a593Smuzhiyun #define OXU_SPH_CAP_OFFSET	(OXU_SPH_CORE_OFFSET + 0x100)
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun #define OXU_OTG_MEM		0xE000
366*4882a593Smuzhiyun #define OXU_SPH_MEM		0x16000
367*4882a593Smuzhiyun 
368*4882a593Smuzhiyun /* Only how many elements & element structure are specifies here. */
369*4882a593Smuzhiyun /* 2 host controllers are enabled - total size <= 28 kbytes */
370*4882a593Smuzhiyun #define	DEFAULT_I_TDPS		1024
371*4882a593Smuzhiyun #define QHEAD_NUM		16
372*4882a593Smuzhiyun #define QTD_NUM			32
373*4882a593Smuzhiyun #define SITD_NUM		8
374*4882a593Smuzhiyun #define MURB_NUM		8
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun #define BUFFER_NUM		8
377*4882a593Smuzhiyun #define BUFFER_SIZE		512
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun struct oxu_info {
380*4882a593Smuzhiyun 	struct usb_hcd *hcd[2];
381*4882a593Smuzhiyun };
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun struct oxu_buf {
384*4882a593Smuzhiyun 	u8			buffer[BUFFER_SIZE];
385*4882a593Smuzhiyun } __aligned(BUFFER_SIZE);
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun struct oxu_onchip_mem {
388*4882a593Smuzhiyun 	struct oxu_buf		db_pool[BUFFER_NUM];
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 	u32			frame_list[DEFAULT_I_TDPS];
391*4882a593Smuzhiyun 	struct ehci_qh		qh_pool[QHEAD_NUM];
392*4882a593Smuzhiyun 	struct ehci_qtd		qtd_pool[QTD_NUM];
393*4882a593Smuzhiyun } __aligned(4 << 10);
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun #define	EHCI_MAX_ROOT_PORTS	15		/* see HCS_N_PORTS */
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun struct oxu_murb {
398*4882a593Smuzhiyun 	struct urb		urb;
399*4882a593Smuzhiyun 	struct urb		*main;
400*4882a593Smuzhiyun 	u8			last;
401*4882a593Smuzhiyun };
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun struct oxu_hcd {				/* one per controller */
404*4882a593Smuzhiyun 	unsigned int		is_otg:1;
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun 	u8			qh_used[QHEAD_NUM];
407*4882a593Smuzhiyun 	u8			qtd_used[QTD_NUM];
408*4882a593Smuzhiyun 	u8			db_used[BUFFER_NUM];
409*4882a593Smuzhiyun 	u8			murb_used[MURB_NUM];
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	struct oxu_onchip_mem	__iomem *mem;
412*4882a593Smuzhiyun 	spinlock_t		mem_lock;
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 	struct timer_list	urb_timer;
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	struct ehci_caps __iomem *caps;
417*4882a593Smuzhiyun 	struct ehci_regs __iomem *regs;
418*4882a593Smuzhiyun 
419*4882a593Smuzhiyun 	u32			hcs_params;	/* cached register copy */
420*4882a593Smuzhiyun 	spinlock_t		lock;
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun 	/* async schedule support */
423*4882a593Smuzhiyun 	struct ehci_qh		*async;
424*4882a593Smuzhiyun 	struct ehci_qh		*reclaim;
425*4882a593Smuzhiyun 	unsigned int		reclaim_ready:1;
426*4882a593Smuzhiyun 	unsigned int		scanning:1;
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	/* periodic schedule support */
429*4882a593Smuzhiyun 	unsigned int		periodic_size;
430*4882a593Smuzhiyun 	__le32			*periodic;	/* hw periodic table */
431*4882a593Smuzhiyun 	dma_addr_t		periodic_dma;
432*4882a593Smuzhiyun 	unsigned int		i_thresh;	/* uframes HC might cache */
433*4882a593Smuzhiyun 
434*4882a593Smuzhiyun 	union ehci_shadow	*pshadow;	/* mirror hw periodic table */
435*4882a593Smuzhiyun 	int			next_uframe;	/* scan periodic, start here */
436*4882a593Smuzhiyun 	unsigned int		periodic_sched;	/* periodic activity count */
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 	/* per root hub port */
439*4882a593Smuzhiyun 	unsigned long		reset_done[EHCI_MAX_ROOT_PORTS];
440*4882a593Smuzhiyun 	/* bit vectors (one bit per port) */
441*4882a593Smuzhiyun 	unsigned long		bus_suspended;	/* which ports were
442*4882a593Smuzhiyun 						 * already suspended at the
443*4882a593Smuzhiyun 						 * start of a bus suspend
444*4882a593Smuzhiyun 						 */
445*4882a593Smuzhiyun 	unsigned long		companion_ports;/* which ports are dedicated
446*4882a593Smuzhiyun 						 * to the companion controller
447*4882a593Smuzhiyun 						 */
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 	struct timer_list	watchdog;
450*4882a593Smuzhiyun 	unsigned long		actions;
451*4882a593Smuzhiyun 	unsigned int		stamp;
452*4882a593Smuzhiyun 	unsigned long		next_statechange;
453*4882a593Smuzhiyun 	u32			command;
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	/* SILICON QUIRKS */
456*4882a593Smuzhiyun 	struct list_head	urb_list;	/* this is the head to urb
457*4882a593Smuzhiyun 						 * queue that didn't get enough
458*4882a593Smuzhiyun 						 * resources
459*4882a593Smuzhiyun 						 */
460*4882a593Smuzhiyun 	struct oxu_murb		*murb_pool;	/* murb per split big urb */
461*4882a593Smuzhiyun 	unsigned int		urb_len;
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	u8			sbrn;		/* packed release number */
464*4882a593Smuzhiyun };
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun #define EHCI_IAA_JIFFIES	(HZ/100)	/* arbitrary; ~10 msec */
467*4882a593Smuzhiyun #define EHCI_IO_JIFFIES		(HZ/10)		/* io watchdog > irq_thresh */
468*4882a593Smuzhiyun #define EHCI_ASYNC_JIFFIES      (HZ/20)		/* async idle timeout */
469*4882a593Smuzhiyun #define EHCI_SHRINK_JIFFIES     (HZ/200)	/* async qh unlink delay */
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun enum ehci_timer_action {
472*4882a593Smuzhiyun 	TIMER_IO_WATCHDOG,
473*4882a593Smuzhiyun 	TIMER_IAA_WATCHDOG,
474*4882a593Smuzhiyun 	TIMER_ASYNC_SHRINK,
475*4882a593Smuzhiyun 	TIMER_ASYNC_OFF,
476*4882a593Smuzhiyun };
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun /*
479*4882a593Smuzhiyun  * Main defines
480*4882a593Smuzhiyun  */
481*4882a593Smuzhiyun 
482*4882a593Smuzhiyun #define oxu_dbg(oxu, fmt, args...) \
483*4882a593Smuzhiyun 		dev_dbg(oxu_to_hcd(oxu)->self.controller , fmt , ## args)
484*4882a593Smuzhiyun #define oxu_err(oxu, fmt, args...) \
485*4882a593Smuzhiyun 		dev_err(oxu_to_hcd(oxu)->self.controller , fmt , ## args)
486*4882a593Smuzhiyun #define oxu_info(oxu, fmt, args...) \
487*4882a593Smuzhiyun 		dev_info(oxu_to_hcd(oxu)->self.controller , fmt , ## args)
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun #ifdef CONFIG_DYNAMIC_DEBUG
490*4882a593Smuzhiyun #define DEBUG
491*4882a593Smuzhiyun #endif
492*4882a593Smuzhiyun 
oxu_to_hcd(struct oxu_hcd * oxu)493*4882a593Smuzhiyun static inline struct usb_hcd *oxu_to_hcd(struct oxu_hcd *oxu)
494*4882a593Smuzhiyun {
495*4882a593Smuzhiyun 	return container_of((void *) oxu, struct usb_hcd, hcd_priv);
496*4882a593Smuzhiyun }
497*4882a593Smuzhiyun 
hcd_to_oxu(struct usb_hcd * hcd)498*4882a593Smuzhiyun static inline struct oxu_hcd *hcd_to_oxu(struct usb_hcd *hcd)
499*4882a593Smuzhiyun {
500*4882a593Smuzhiyun 	return (struct oxu_hcd *) (hcd->hcd_priv);
501*4882a593Smuzhiyun }
502*4882a593Smuzhiyun 
503*4882a593Smuzhiyun /*
504*4882a593Smuzhiyun  * Debug stuff
505*4882a593Smuzhiyun  */
506*4882a593Smuzhiyun 
507*4882a593Smuzhiyun #undef OXU_URB_TRACE
508*4882a593Smuzhiyun #undef OXU_VERBOSE_DEBUG
509*4882a593Smuzhiyun 
510*4882a593Smuzhiyun #ifdef OXU_VERBOSE_DEBUG
511*4882a593Smuzhiyun #define oxu_vdbg			oxu_dbg
512*4882a593Smuzhiyun #else
513*4882a593Smuzhiyun #define oxu_vdbg(oxu, fmt, args...)	/* Nop */
514*4882a593Smuzhiyun #endif
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun #ifdef DEBUG
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun static int __attribute__((__unused__))
dbg_status_buf(char * buf,unsigned len,const char * label,u32 status)519*4882a593Smuzhiyun dbg_status_buf(char *buf, unsigned len, const char *label, u32 status)
520*4882a593Smuzhiyun {
521*4882a593Smuzhiyun 	return scnprintf(buf, len, "%s%sstatus %04x%s%s%s%s%s%s%s%s%s%s",
522*4882a593Smuzhiyun 		label, label[0] ? " " : "", status,
523*4882a593Smuzhiyun 		(status & STS_ASS) ? " Async" : "",
524*4882a593Smuzhiyun 		(status & STS_PSS) ? " Periodic" : "",
525*4882a593Smuzhiyun 		(status & STS_RECL) ? " Recl" : "",
526*4882a593Smuzhiyun 		(status & STS_HALT) ? " Halt" : "",
527*4882a593Smuzhiyun 		(status & STS_IAA) ? " IAA" : "",
528*4882a593Smuzhiyun 		(status & STS_FATAL) ? " FATAL" : "",
529*4882a593Smuzhiyun 		(status & STS_FLR) ? " FLR" : "",
530*4882a593Smuzhiyun 		(status & STS_PCD) ? " PCD" : "",
531*4882a593Smuzhiyun 		(status & STS_ERR) ? " ERR" : "",
532*4882a593Smuzhiyun 		(status & STS_INT) ? " INT" : ""
533*4882a593Smuzhiyun 		);
534*4882a593Smuzhiyun }
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun static int __attribute__((__unused__))
dbg_intr_buf(char * buf,unsigned len,const char * label,u32 enable)537*4882a593Smuzhiyun dbg_intr_buf(char *buf, unsigned len, const char *label, u32 enable)
538*4882a593Smuzhiyun {
539*4882a593Smuzhiyun 	return scnprintf(buf, len, "%s%sintrenable %02x%s%s%s%s%s%s",
540*4882a593Smuzhiyun 		label, label[0] ? " " : "", enable,
541*4882a593Smuzhiyun 		(enable & STS_IAA) ? " IAA" : "",
542*4882a593Smuzhiyun 		(enable & STS_FATAL) ? " FATAL" : "",
543*4882a593Smuzhiyun 		(enable & STS_FLR) ? " FLR" : "",
544*4882a593Smuzhiyun 		(enable & STS_PCD) ? " PCD" : "",
545*4882a593Smuzhiyun 		(enable & STS_ERR) ? " ERR" : "",
546*4882a593Smuzhiyun 		(enable & STS_INT) ? " INT" : ""
547*4882a593Smuzhiyun 		);
548*4882a593Smuzhiyun }
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun static const char *const fls_strings[] =
551*4882a593Smuzhiyun     { "1024", "512", "256", "??" };
552*4882a593Smuzhiyun 
dbg_command_buf(char * buf,unsigned len,const char * label,u32 command)553*4882a593Smuzhiyun static int dbg_command_buf(char *buf, unsigned len,
554*4882a593Smuzhiyun 				const char *label, u32 command)
555*4882a593Smuzhiyun {
556*4882a593Smuzhiyun 	return scnprintf(buf, len,
557*4882a593Smuzhiyun 		"%s%scommand %06x %s=%d ithresh=%d%s%s%s%s period=%s%s %s",
558*4882a593Smuzhiyun 		label, label[0] ? " " : "", command,
559*4882a593Smuzhiyun 		(command & CMD_PARK) ? "park" : "(park)",
560*4882a593Smuzhiyun 		CMD_PARK_CNT(command),
561*4882a593Smuzhiyun 		(command >> 16) & 0x3f,
562*4882a593Smuzhiyun 		(command & CMD_LRESET) ? " LReset" : "",
563*4882a593Smuzhiyun 		(command & CMD_IAAD) ? " IAAD" : "",
564*4882a593Smuzhiyun 		(command & CMD_ASE) ? " Async" : "",
565*4882a593Smuzhiyun 		(command & CMD_PSE) ? " Periodic" : "",
566*4882a593Smuzhiyun 		fls_strings[(command >> 2) & 0x3],
567*4882a593Smuzhiyun 		(command & CMD_RESET) ? " Reset" : "",
568*4882a593Smuzhiyun 		(command & CMD_RUN) ? "RUN" : "HALT"
569*4882a593Smuzhiyun 		);
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun 
dbg_port_buf(char * buf,unsigned len,const char * label,int port,u32 status)572*4882a593Smuzhiyun static int dbg_port_buf(char *buf, unsigned len, const char *label,
573*4882a593Smuzhiyun 				int port, u32 status)
574*4882a593Smuzhiyun {
575*4882a593Smuzhiyun 	char	*sig;
576*4882a593Smuzhiyun 
577*4882a593Smuzhiyun 	/* signaling state */
578*4882a593Smuzhiyun 	switch (status & (3 << 10)) {
579*4882a593Smuzhiyun 	case 0 << 10:
580*4882a593Smuzhiyun 		sig = "se0";
581*4882a593Smuzhiyun 		break;
582*4882a593Smuzhiyun 	case 1 << 10:
583*4882a593Smuzhiyun 		sig = "k";	/* low speed */
584*4882a593Smuzhiyun 		break;
585*4882a593Smuzhiyun 	case 2 << 10:
586*4882a593Smuzhiyun 		sig = "j";
587*4882a593Smuzhiyun 		break;
588*4882a593Smuzhiyun 	default:
589*4882a593Smuzhiyun 		sig = "?";
590*4882a593Smuzhiyun 		break;
591*4882a593Smuzhiyun 	}
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	return scnprintf(buf, len,
594*4882a593Smuzhiyun 		"%s%sport %d status %06x%s%s sig=%s%s%s%s%s%s%s%s%s%s",
595*4882a593Smuzhiyun 		label, label[0] ? " " : "", port, status,
596*4882a593Smuzhiyun 		(status & PORT_POWER) ? " POWER" : "",
597*4882a593Smuzhiyun 		(status & PORT_OWNER) ? " OWNER" : "",
598*4882a593Smuzhiyun 		sig,
599*4882a593Smuzhiyun 		(status & PORT_RESET) ? " RESET" : "",
600*4882a593Smuzhiyun 		(status & PORT_SUSPEND) ? " SUSPEND" : "",
601*4882a593Smuzhiyun 		(status & PORT_RESUME) ? " RESUME" : "",
602*4882a593Smuzhiyun 		(status & PORT_OCC) ? " OCC" : "",
603*4882a593Smuzhiyun 		(status & PORT_OC) ? " OC" : "",
604*4882a593Smuzhiyun 		(status & PORT_PEC) ? " PEC" : "",
605*4882a593Smuzhiyun 		(status & PORT_PE) ? " PE" : "",
606*4882a593Smuzhiyun 		(status & PORT_CSC) ? " CSC" : "",
607*4882a593Smuzhiyun 		(status & PORT_CONNECT) ? " CONNECT" : ""
608*4882a593Smuzhiyun 	    );
609*4882a593Smuzhiyun }
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun #else
612*4882a593Smuzhiyun 
613*4882a593Smuzhiyun static inline int __attribute__((__unused__))
dbg_status_buf(char * buf,unsigned len,const char * label,u32 status)614*4882a593Smuzhiyun dbg_status_buf(char *buf, unsigned len, const char *label, u32 status)
615*4882a593Smuzhiyun { return 0; }
616*4882a593Smuzhiyun 
617*4882a593Smuzhiyun static inline int __attribute__((__unused__))
dbg_command_buf(char * buf,unsigned len,const char * label,u32 command)618*4882a593Smuzhiyun dbg_command_buf(char *buf, unsigned len, const char *label, u32 command)
619*4882a593Smuzhiyun { return 0; }
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun static inline int __attribute__((__unused__))
dbg_intr_buf(char * buf,unsigned len,const char * label,u32 enable)622*4882a593Smuzhiyun dbg_intr_buf(char *buf, unsigned len, const char *label, u32 enable)
623*4882a593Smuzhiyun { return 0; }
624*4882a593Smuzhiyun 
625*4882a593Smuzhiyun static inline int __attribute__((__unused__))
dbg_port_buf(char * buf,unsigned len,const char * label,int port,u32 status)626*4882a593Smuzhiyun dbg_port_buf(char *buf, unsigned len, const char *label, int port, u32 status)
627*4882a593Smuzhiyun { return 0; }
628*4882a593Smuzhiyun 
629*4882a593Smuzhiyun #endif /* DEBUG */
630*4882a593Smuzhiyun 
631*4882a593Smuzhiyun /* functions have the "wrong" filename when they're output... */
632*4882a593Smuzhiyun #define dbg_status(oxu, label, status) { \
633*4882a593Smuzhiyun 	char _buf[80]; \
634*4882a593Smuzhiyun 	dbg_status_buf(_buf, sizeof _buf, label, status); \
635*4882a593Smuzhiyun 	oxu_dbg(oxu, "%s\n", _buf); \
636*4882a593Smuzhiyun }
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun #define dbg_cmd(oxu, label, command) { \
639*4882a593Smuzhiyun 	char _buf[80]; \
640*4882a593Smuzhiyun 	dbg_command_buf(_buf, sizeof _buf, label, command); \
641*4882a593Smuzhiyun 	oxu_dbg(oxu, "%s\n", _buf); \
642*4882a593Smuzhiyun }
643*4882a593Smuzhiyun 
644*4882a593Smuzhiyun #define dbg_port(oxu, label, port, status) { \
645*4882a593Smuzhiyun 	char _buf[80]; \
646*4882a593Smuzhiyun 	dbg_port_buf(_buf, sizeof _buf, label, port, status); \
647*4882a593Smuzhiyun 	oxu_dbg(oxu, "%s\n", _buf); \
648*4882a593Smuzhiyun }
649*4882a593Smuzhiyun 
650*4882a593Smuzhiyun /*
651*4882a593Smuzhiyun  * Module parameters
652*4882a593Smuzhiyun  */
653*4882a593Smuzhiyun 
654*4882a593Smuzhiyun /* Initial IRQ latency: faster than hw default */
655*4882a593Smuzhiyun static int log2_irq_thresh;			/* 0 to 6 */
656*4882a593Smuzhiyun module_param(log2_irq_thresh, int, S_IRUGO);
657*4882a593Smuzhiyun MODULE_PARM_DESC(log2_irq_thresh, "log2 IRQ latency, 1-64 microframes");
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun /* Initial park setting: slower than hw default */
660*4882a593Smuzhiyun static unsigned park;
661*4882a593Smuzhiyun module_param(park, uint, S_IRUGO);
662*4882a593Smuzhiyun MODULE_PARM_DESC(park, "park setting; 1-3 back-to-back async packets");
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun /* For flakey hardware, ignore overcurrent indicators */
665*4882a593Smuzhiyun static bool ignore_oc;
666*4882a593Smuzhiyun module_param(ignore_oc, bool, S_IRUGO);
667*4882a593Smuzhiyun MODULE_PARM_DESC(ignore_oc, "ignore bogus hardware overcurrent indications");
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun 
670*4882a593Smuzhiyun static void ehci_work(struct oxu_hcd *oxu);
671*4882a593Smuzhiyun static int oxu_hub_control(struct usb_hcd *hcd,
672*4882a593Smuzhiyun 				u16 typeReq, u16 wValue, u16 wIndex,
673*4882a593Smuzhiyun 				char *buf, u16 wLength);
674*4882a593Smuzhiyun 
675*4882a593Smuzhiyun /*
676*4882a593Smuzhiyun  * Local functions
677*4882a593Smuzhiyun  */
678*4882a593Smuzhiyun 
679*4882a593Smuzhiyun /* Low level read/write registers functions */
oxu_readl(void __iomem * base,u32 reg)680*4882a593Smuzhiyun static inline u32 oxu_readl(void __iomem *base, u32 reg)
681*4882a593Smuzhiyun {
682*4882a593Smuzhiyun 	return readl(base + reg);
683*4882a593Smuzhiyun }
684*4882a593Smuzhiyun 
oxu_writel(void __iomem * base,u32 reg,u32 val)685*4882a593Smuzhiyun static inline void oxu_writel(void __iomem *base, u32 reg, u32 val)
686*4882a593Smuzhiyun {
687*4882a593Smuzhiyun 	writel(val, base + reg);
688*4882a593Smuzhiyun }
689*4882a593Smuzhiyun 
timer_action_done(struct oxu_hcd * oxu,enum ehci_timer_action action)690*4882a593Smuzhiyun static inline void timer_action_done(struct oxu_hcd *oxu,
691*4882a593Smuzhiyun 					enum ehci_timer_action action)
692*4882a593Smuzhiyun {
693*4882a593Smuzhiyun 	clear_bit(action, &oxu->actions);
694*4882a593Smuzhiyun }
695*4882a593Smuzhiyun 
timer_action(struct oxu_hcd * oxu,enum ehci_timer_action action)696*4882a593Smuzhiyun static inline void timer_action(struct oxu_hcd *oxu,
697*4882a593Smuzhiyun 					enum ehci_timer_action action)
698*4882a593Smuzhiyun {
699*4882a593Smuzhiyun 	if (!test_and_set_bit(action, &oxu->actions)) {
700*4882a593Smuzhiyun 		unsigned long t;
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun 		switch (action) {
703*4882a593Smuzhiyun 		case TIMER_IAA_WATCHDOG:
704*4882a593Smuzhiyun 			t = EHCI_IAA_JIFFIES;
705*4882a593Smuzhiyun 			break;
706*4882a593Smuzhiyun 		case TIMER_IO_WATCHDOG:
707*4882a593Smuzhiyun 			t = EHCI_IO_JIFFIES;
708*4882a593Smuzhiyun 			break;
709*4882a593Smuzhiyun 		case TIMER_ASYNC_OFF:
710*4882a593Smuzhiyun 			t = EHCI_ASYNC_JIFFIES;
711*4882a593Smuzhiyun 			break;
712*4882a593Smuzhiyun 		case TIMER_ASYNC_SHRINK:
713*4882a593Smuzhiyun 		default:
714*4882a593Smuzhiyun 			t = EHCI_SHRINK_JIFFIES;
715*4882a593Smuzhiyun 			break;
716*4882a593Smuzhiyun 		}
717*4882a593Smuzhiyun 		t += jiffies;
718*4882a593Smuzhiyun 		/* all timings except IAA watchdog can be overridden.
719*4882a593Smuzhiyun 		 * async queue SHRINK often precedes IAA.  while it's ready
720*4882a593Smuzhiyun 		 * to go OFF neither can matter, and afterwards the IO
721*4882a593Smuzhiyun 		 * watchdog stops unless there's still periodic traffic.
722*4882a593Smuzhiyun 		 */
723*4882a593Smuzhiyun 		if (action != TIMER_IAA_WATCHDOG
724*4882a593Smuzhiyun 				&& t > oxu->watchdog.expires
725*4882a593Smuzhiyun 				&& timer_pending(&oxu->watchdog))
726*4882a593Smuzhiyun 			return;
727*4882a593Smuzhiyun 		mod_timer(&oxu->watchdog, t);
728*4882a593Smuzhiyun 	}
729*4882a593Smuzhiyun }
730*4882a593Smuzhiyun 
731*4882a593Smuzhiyun /*
732*4882a593Smuzhiyun  * handshake - spin reading hc until handshake completes or fails
733*4882a593Smuzhiyun  * @ptr: address of hc register to be read
734*4882a593Smuzhiyun  * @mask: bits to look at in result of read
735*4882a593Smuzhiyun  * @done: value of those bits when handshake succeeds
736*4882a593Smuzhiyun  * @usec: timeout in microseconds
737*4882a593Smuzhiyun  *
738*4882a593Smuzhiyun  * Returns negative errno, or zero on success
739*4882a593Smuzhiyun  *
740*4882a593Smuzhiyun  * Success happens when the "mask" bits have the specified value (hardware
741*4882a593Smuzhiyun  * handshake done).  There are two failure modes:  "usec" have passed (major
742*4882a593Smuzhiyun  * hardware flakeout), or the register reads as all-ones (hardware removed).
743*4882a593Smuzhiyun  *
744*4882a593Smuzhiyun  * That last failure should_only happen in cases like physical cardbus eject
745*4882a593Smuzhiyun  * before driver shutdown. But it also seems to be caused by bugs in cardbus
746*4882a593Smuzhiyun  * bridge shutdown:  shutting down the bridge before the devices using it.
747*4882a593Smuzhiyun  */
handshake(struct oxu_hcd * oxu,void __iomem * ptr,u32 mask,u32 done,int usec)748*4882a593Smuzhiyun static int handshake(struct oxu_hcd *oxu, void __iomem *ptr,
749*4882a593Smuzhiyun 					u32 mask, u32 done, int usec)
750*4882a593Smuzhiyun {
751*4882a593Smuzhiyun 	u32 result;
752*4882a593Smuzhiyun 	int ret;
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 	ret = readl_poll_timeout_atomic(ptr, result,
755*4882a593Smuzhiyun 					((result & mask) == done ||
756*4882a593Smuzhiyun 					 result == U32_MAX),
757*4882a593Smuzhiyun 					1, usec);
758*4882a593Smuzhiyun 	if (result == U32_MAX)		/* card removed */
759*4882a593Smuzhiyun 		return -ENODEV;
760*4882a593Smuzhiyun 
761*4882a593Smuzhiyun 	return ret;
762*4882a593Smuzhiyun }
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun /* Force HC to halt state from unknown (EHCI spec section 2.3) */
ehci_halt(struct oxu_hcd * oxu)765*4882a593Smuzhiyun static int ehci_halt(struct oxu_hcd *oxu)
766*4882a593Smuzhiyun {
767*4882a593Smuzhiyun 	u32	temp = readl(&oxu->regs->status);
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun 	/* disable any irqs left enabled by previous code */
770*4882a593Smuzhiyun 	writel(0, &oxu->regs->intr_enable);
771*4882a593Smuzhiyun 
772*4882a593Smuzhiyun 	if ((temp & STS_HALT) != 0)
773*4882a593Smuzhiyun 		return 0;
774*4882a593Smuzhiyun 
775*4882a593Smuzhiyun 	temp = readl(&oxu->regs->command);
776*4882a593Smuzhiyun 	temp &= ~CMD_RUN;
777*4882a593Smuzhiyun 	writel(temp, &oxu->regs->command);
778*4882a593Smuzhiyun 	return handshake(oxu, &oxu->regs->status,
779*4882a593Smuzhiyun 			  STS_HALT, STS_HALT, 16 * 125);
780*4882a593Smuzhiyun }
781*4882a593Smuzhiyun 
782*4882a593Smuzhiyun /* Put TDI/ARC silicon into EHCI mode */
tdi_reset(struct oxu_hcd * oxu)783*4882a593Smuzhiyun static void tdi_reset(struct oxu_hcd *oxu)
784*4882a593Smuzhiyun {
785*4882a593Smuzhiyun 	u32 __iomem *reg_ptr;
786*4882a593Smuzhiyun 	u32 tmp;
787*4882a593Smuzhiyun 
788*4882a593Smuzhiyun 	reg_ptr = (u32 __iomem *)(((u8 __iomem *)oxu->regs) + 0x68);
789*4882a593Smuzhiyun 	tmp = readl(reg_ptr);
790*4882a593Smuzhiyun 	tmp |= 0x3;
791*4882a593Smuzhiyun 	writel(tmp, reg_ptr);
792*4882a593Smuzhiyun }
793*4882a593Smuzhiyun 
794*4882a593Smuzhiyun /* Reset a non-running (STS_HALT == 1) controller */
ehci_reset(struct oxu_hcd * oxu)795*4882a593Smuzhiyun static int ehci_reset(struct oxu_hcd *oxu)
796*4882a593Smuzhiyun {
797*4882a593Smuzhiyun 	int	retval;
798*4882a593Smuzhiyun 	u32	command = readl(&oxu->regs->command);
799*4882a593Smuzhiyun 
800*4882a593Smuzhiyun 	command |= CMD_RESET;
801*4882a593Smuzhiyun 	dbg_cmd(oxu, "reset", command);
802*4882a593Smuzhiyun 	writel(command, &oxu->regs->command);
803*4882a593Smuzhiyun 	oxu_to_hcd(oxu)->state = HC_STATE_HALT;
804*4882a593Smuzhiyun 	oxu->next_statechange = jiffies;
805*4882a593Smuzhiyun 	retval = handshake(oxu, &oxu->regs->command,
806*4882a593Smuzhiyun 			    CMD_RESET, 0, 250 * 1000);
807*4882a593Smuzhiyun 
808*4882a593Smuzhiyun 	if (retval)
809*4882a593Smuzhiyun 		return retval;
810*4882a593Smuzhiyun 
811*4882a593Smuzhiyun 	tdi_reset(oxu);
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	return retval;
814*4882a593Smuzhiyun }
815*4882a593Smuzhiyun 
816*4882a593Smuzhiyun /* Idle the controller (from running) */
ehci_quiesce(struct oxu_hcd * oxu)817*4882a593Smuzhiyun static void ehci_quiesce(struct oxu_hcd *oxu)
818*4882a593Smuzhiyun {
819*4882a593Smuzhiyun 	u32	temp;
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun #ifdef DEBUG
822*4882a593Smuzhiyun 	BUG_ON(!HC_IS_RUNNING(oxu_to_hcd(oxu)->state));
823*4882a593Smuzhiyun #endif
824*4882a593Smuzhiyun 
825*4882a593Smuzhiyun 	/* wait for any schedule enables/disables to take effect */
826*4882a593Smuzhiyun 	temp = readl(&oxu->regs->command) << 10;
827*4882a593Smuzhiyun 	temp &= STS_ASS | STS_PSS;
828*4882a593Smuzhiyun 	if (handshake(oxu, &oxu->regs->status, STS_ASS | STS_PSS,
829*4882a593Smuzhiyun 				temp, 16 * 125) != 0) {
830*4882a593Smuzhiyun 		oxu_to_hcd(oxu)->state = HC_STATE_HALT;
831*4882a593Smuzhiyun 		return;
832*4882a593Smuzhiyun 	}
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun 	/* then disable anything that's still active */
835*4882a593Smuzhiyun 	temp = readl(&oxu->regs->command);
836*4882a593Smuzhiyun 	temp &= ~(CMD_ASE | CMD_IAAD | CMD_PSE);
837*4882a593Smuzhiyun 	writel(temp, &oxu->regs->command);
838*4882a593Smuzhiyun 
839*4882a593Smuzhiyun 	/* hardware can take 16 microframes to turn off ... */
840*4882a593Smuzhiyun 	if (handshake(oxu, &oxu->regs->status, STS_ASS | STS_PSS,
841*4882a593Smuzhiyun 				0, 16 * 125) != 0) {
842*4882a593Smuzhiyun 		oxu_to_hcd(oxu)->state = HC_STATE_HALT;
843*4882a593Smuzhiyun 		return;
844*4882a593Smuzhiyun 	}
845*4882a593Smuzhiyun }
846*4882a593Smuzhiyun 
check_reset_complete(struct oxu_hcd * oxu,int index,u32 __iomem * status_reg,int port_status)847*4882a593Smuzhiyun static int check_reset_complete(struct oxu_hcd *oxu, int index,
848*4882a593Smuzhiyun 				u32 __iomem *status_reg, int port_status)
849*4882a593Smuzhiyun {
850*4882a593Smuzhiyun 	if (!(port_status & PORT_CONNECT)) {
851*4882a593Smuzhiyun 		oxu->reset_done[index] = 0;
852*4882a593Smuzhiyun 		return port_status;
853*4882a593Smuzhiyun 	}
854*4882a593Smuzhiyun 
855*4882a593Smuzhiyun 	/* if reset finished and it's still not enabled -- handoff */
856*4882a593Smuzhiyun 	if (!(port_status & PORT_PE)) {
857*4882a593Smuzhiyun 		oxu_dbg(oxu, "Failed to enable port %d on root hub TT\n",
858*4882a593Smuzhiyun 				index+1);
859*4882a593Smuzhiyun 		return port_status;
860*4882a593Smuzhiyun 	} else
861*4882a593Smuzhiyun 		oxu_dbg(oxu, "port %d high speed\n", index + 1);
862*4882a593Smuzhiyun 
863*4882a593Smuzhiyun 	return port_status;
864*4882a593Smuzhiyun }
865*4882a593Smuzhiyun 
ehci_hub_descriptor(struct oxu_hcd * oxu,struct usb_hub_descriptor * desc)866*4882a593Smuzhiyun static void ehci_hub_descriptor(struct oxu_hcd *oxu,
867*4882a593Smuzhiyun 				struct usb_hub_descriptor *desc)
868*4882a593Smuzhiyun {
869*4882a593Smuzhiyun 	int ports = HCS_N_PORTS(oxu->hcs_params);
870*4882a593Smuzhiyun 	u16 temp;
871*4882a593Smuzhiyun 
872*4882a593Smuzhiyun 	desc->bDescriptorType = USB_DT_HUB;
873*4882a593Smuzhiyun 	desc->bPwrOn2PwrGood = 10;	/* oxu 1.0, 2.3.9 says 20ms max */
874*4882a593Smuzhiyun 	desc->bHubContrCurrent = 0;
875*4882a593Smuzhiyun 
876*4882a593Smuzhiyun 	desc->bNbrPorts = ports;
877*4882a593Smuzhiyun 	temp = 1 + (ports / 8);
878*4882a593Smuzhiyun 	desc->bDescLength = 7 + 2 * temp;
879*4882a593Smuzhiyun 
880*4882a593Smuzhiyun 	/* ports removable, and usb 1.0 legacy PortPwrCtrlMask */
881*4882a593Smuzhiyun 	memset(&desc->u.hs.DeviceRemovable[0], 0, temp);
882*4882a593Smuzhiyun 	memset(&desc->u.hs.DeviceRemovable[temp], 0xff, temp);
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun 	temp = HUB_CHAR_INDV_PORT_OCPM;	/* per-port overcurrent reporting */
885*4882a593Smuzhiyun 	if (HCS_PPC(oxu->hcs_params))
886*4882a593Smuzhiyun 		temp |= HUB_CHAR_INDV_PORT_LPSM; /* per-port power control */
887*4882a593Smuzhiyun 	else
888*4882a593Smuzhiyun 		temp |= HUB_CHAR_NO_LPSM; /* no power switching */
889*4882a593Smuzhiyun 	desc->wHubCharacteristics = (__force __u16)cpu_to_le16(temp);
890*4882a593Smuzhiyun }
891*4882a593Smuzhiyun 
892*4882a593Smuzhiyun 
893*4882a593Smuzhiyun /* Allocate an OXU210HP on-chip memory data buffer
894*4882a593Smuzhiyun  *
895*4882a593Smuzhiyun  * An on-chip memory data buffer is required for each OXU210HP USB transfer.
896*4882a593Smuzhiyun  * Each transfer descriptor has one or more on-chip memory data buffers.
897*4882a593Smuzhiyun  *
898*4882a593Smuzhiyun  * Data buffers are allocated from a fix sized pool of data blocks.
899*4882a593Smuzhiyun  * To minimise fragmentation and give reasonable memory utlisation,
900*4882a593Smuzhiyun  * data buffers are allocated with sizes the power of 2 multiples of
901*4882a593Smuzhiyun  * the block size, starting on an address a multiple of the allocated size.
902*4882a593Smuzhiyun  *
903*4882a593Smuzhiyun  * FIXME: callers of this function require a buffer to be allocated for
904*4882a593Smuzhiyun  * len=0. This is a waste of on-chip memory and should be fix. Then this
905*4882a593Smuzhiyun  * function should be changed to not allocate a buffer for len=0.
906*4882a593Smuzhiyun  */
oxu_buf_alloc(struct oxu_hcd * oxu,struct ehci_qtd * qtd,int len)907*4882a593Smuzhiyun static int oxu_buf_alloc(struct oxu_hcd *oxu, struct ehci_qtd *qtd, int len)
908*4882a593Smuzhiyun {
909*4882a593Smuzhiyun 	int n_blocks;	/* minium blocks needed to hold len */
910*4882a593Smuzhiyun 	int a_blocks;	/* blocks allocated */
911*4882a593Smuzhiyun 	int i, j;
912*4882a593Smuzhiyun 
913*4882a593Smuzhiyun 	/* Don't allocte bigger than supported */
914*4882a593Smuzhiyun 	if (len > BUFFER_SIZE * BUFFER_NUM) {
915*4882a593Smuzhiyun 		oxu_err(oxu, "buffer too big (%d)\n", len);
916*4882a593Smuzhiyun 		return -ENOMEM;
917*4882a593Smuzhiyun 	}
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
920*4882a593Smuzhiyun 
921*4882a593Smuzhiyun 	/* Number of blocks needed to hold len */
922*4882a593Smuzhiyun 	n_blocks = (len + BUFFER_SIZE - 1) / BUFFER_SIZE;
923*4882a593Smuzhiyun 
924*4882a593Smuzhiyun 	/* Round the number of blocks up to the power of 2 */
925*4882a593Smuzhiyun 	for (a_blocks = 1; a_blocks < n_blocks; a_blocks <<= 1)
926*4882a593Smuzhiyun 		;
927*4882a593Smuzhiyun 
928*4882a593Smuzhiyun 	/* Find a suitable available data buffer */
929*4882a593Smuzhiyun 	for (i = 0; i < BUFFER_NUM;
930*4882a593Smuzhiyun 			i += max(a_blocks, (int)oxu->db_used[i])) {
931*4882a593Smuzhiyun 
932*4882a593Smuzhiyun 		/* Check all the required blocks are available */
933*4882a593Smuzhiyun 		for (j = 0; j < a_blocks; j++)
934*4882a593Smuzhiyun 			if (oxu->db_used[i + j])
935*4882a593Smuzhiyun 				break;
936*4882a593Smuzhiyun 
937*4882a593Smuzhiyun 		if (j != a_blocks)
938*4882a593Smuzhiyun 			continue;
939*4882a593Smuzhiyun 
940*4882a593Smuzhiyun 		/* Allocate blocks found! */
941*4882a593Smuzhiyun 		qtd->buffer = (void *) &oxu->mem->db_pool[i];
942*4882a593Smuzhiyun 		qtd->buffer_dma = virt_to_phys(qtd->buffer);
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun 		qtd->qtd_buffer_len = BUFFER_SIZE * a_blocks;
945*4882a593Smuzhiyun 		oxu->db_used[i] = a_blocks;
946*4882a593Smuzhiyun 
947*4882a593Smuzhiyun 		spin_unlock(&oxu->mem_lock);
948*4882a593Smuzhiyun 
949*4882a593Smuzhiyun 		return 0;
950*4882a593Smuzhiyun 	}
951*4882a593Smuzhiyun 
952*4882a593Smuzhiyun 	/* Failed */
953*4882a593Smuzhiyun 
954*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
955*4882a593Smuzhiyun 
956*4882a593Smuzhiyun 	return -ENOMEM;
957*4882a593Smuzhiyun }
958*4882a593Smuzhiyun 
oxu_buf_free(struct oxu_hcd * oxu,struct ehci_qtd * qtd)959*4882a593Smuzhiyun static void oxu_buf_free(struct oxu_hcd *oxu, struct ehci_qtd *qtd)
960*4882a593Smuzhiyun {
961*4882a593Smuzhiyun 	int index;
962*4882a593Smuzhiyun 
963*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
964*4882a593Smuzhiyun 
965*4882a593Smuzhiyun 	index = (qtd->buffer - (void *) &oxu->mem->db_pool[0])
966*4882a593Smuzhiyun 							 / BUFFER_SIZE;
967*4882a593Smuzhiyun 	oxu->db_used[index] = 0;
968*4882a593Smuzhiyun 	qtd->qtd_buffer_len = 0;
969*4882a593Smuzhiyun 	qtd->buffer_dma = 0;
970*4882a593Smuzhiyun 	qtd->buffer = NULL;
971*4882a593Smuzhiyun 
972*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
973*4882a593Smuzhiyun }
974*4882a593Smuzhiyun 
ehci_qtd_init(struct ehci_qtd * qtd,dma_addr_t dma)975*4882a593Smuzhiyun static inline void ehci_qtd_init(struct ehci_qtd *qtd, dma_addr_t dma)
976*4882a593Smuzhiyun {
977*4882a593Smuzhiyun 	memset(qtd, 0, sizeof *qtd);
978*4882a593Smuzhiyun 	qtd->qtd_dma = dma;
979*4882a593Smuzhiyun 	qtd->hw_token = cpu_to_le32(QTD_STS_HALT);
980*4882a593Smuzhiyun 	qtd->hw_next = EHCI_LIST_END;
981*4882a593Smuzhiyun 	qtd->hw_alt_next = EHCI_LIST_END;
982*4882a593Smuzhiyun 	INIT_LIST_HEAD(&qtd->qtd_list);
983*4882a593Smuzhiyun }
984*4882a593Smuzhiyun 
oxu_qtd_free(struct oxu_hcd * oxu,struct ehci_qtd * qtd)985*4882a593Smuzhiyun static inline void oxu_qtd_free(struct oxu_hcd *oxu, struct ehci_qtd *qtd)
986*4882a593Smuzhiyun {
987*4882a593Smuzhiyun 	int index;
988*4882a593Smuzhiyun 
989*4882a593Smuzhiyun 	if (qtd->buffer)
990*4882a593Smuzhiyun 		oxu_buf_free(oxu, qtd);
991*4882a593Smuzhiyun 
992*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
993*4882a593Smuzhiyun 
994*4882a593Smuzhiyun 	index = qtd - &oxu->mem->qtd_pool[0];
995*4882a593Smuzhiyun 	oxu->qtd_used[index] = 0;
996*4882a593Smuzhiyun 
997*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
998*4882a593Smuzhiyun }
999*4882a593Smuzhiyun 
ehci_qtd_alloc(struct oxu_hcd * oxu)1000*4882a593Smuzhiyun static struct ehci_qtd *ehci_qtd_alloc(struct oxu_hcd *oxu)
1001*4882a593Smuzhiyun {
1002*4882a593Smuzhiyun 	int i;
1003*4882a593Smuzhiyun 	struct ehci_qtd *qtd = NULL;
1004*4882a593Smuzhiyun 
1005*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
1006*4882a593Smuzhiyun 
1007*4882a593Smuzhiyun 	for (i = 0; i < QTD_NUM; i++)
1008*4882a593Smuzhiyun 		if (!oxu->qtd_used[i])
1009*4882a593Smuzhiyun 			break;
1010*4882a593Smuzhiyun 
1011*4882a593Smuzhiyun 	if (i < QTD_NUM) {
1012*4882a593Smuzhiyun 		qtd = (struct ehci_qtd *) &oxu->mem->qtd_pool[i];
1013*4882a593Smuzhiyun 		memset(qtd, 0, sizeof *qtd);
1014*4882a593Smuzhiyun 
1015*4882a593Smuzhiyun 		qtd->hw_token = cpu_to_le32(QTD_STS_HALT);
1016*4882a593Smuzhiyun 		qtd->hw_next = EHCI_LIST_END;
1017*4882a593Smuzhiyun 		qtd->hw_alt_next = EHCI_LIST_END;
1018*4882a593Smuzhiyun 		INIT_LIST_HEAD(&qtd->qtd_list);
1019*4882a593Smuzhiyun 
1020*4882a593Smuzhiyun 		qtd->qtd_dma = virt_to_phys(qtd);
1021*4882a593Smuzhiyun 
1022*4882a593Smuzhiyun 		oxu->qtd_used[i] = 1;
1023*4882a593Smuzhiyun 	}
1024*4882a593Smuzhiyun 
1025*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
1026*4882a593Smuzhiyun 
1027*4882a593Smuzhiyun 	return qtd;
1028*4882a593Smuzhiyun }
1029*4882a593Smuzhiyun 
oxu_qh_free(struct oxu_hcd * oxu,struct ehci_qh * qh)1030*4882a593Smuzhiyun static void oxu_qh_free(struct oxu_hcd *oxu, struct ehci_qh *qh)
1031*4882a593Smuzhiyun {
1032*4882a593Smuzhiyun 	int index;
1033*4882a593Smuzhiyun 
1034*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
1035*4882a593Smuzhiyun 
1036*4882a593Smuzhiyun 	index = qh - &oxu->mem->qh_pool[0];
1037*4882a593Smuzhiyun 	oxu->qh_used[index] = 0;
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
1040*4882a593Smuzhiyun }
1041*4882a593Smuzhiyun 
qh_destroy(struct kref * kref)1042*4882a593Smuzhiyun static void qh_destroy(struct kref *kref)
1043*4882a593Smuzhiyun {
1044*4882a593Smuzhiyun 	struct ehci_qh *qh = container_of(kref, struct ehci_qh, kref);
1045*4882a593Smuzhiyun 	struct oxu_hcd *oxu = qh->oxu;
1046*4882a593Smuzhiyun 
1047*4882a593Smuzhiyun 	/* clean qtds first, and know this is not linked */
1048*4882a593Smuzhiyun 	if (!list_empty(&qh->qtd_list) || qh->qh_next.ptr) {
1049*4882a593Smuzhiyun 		oxu_dbg(oxu, "unused qh not empty!\n");
1050*4882a593Smuzhiyun 		BUG();
1051*4882a593Smuzhiyun 	}
1052*4882a593Smuzhiyun 	if (qh->dummy)
1053*4882a593Smuzhiyun 		oxu_qtd_free(oxu, qh->dummy);
1054*4882a593Smuzhiyun 	oxu_qh_free(oxu, qh);
1055*4882a593Smuzhiyun }
1056*4882a593Smuzhiyun 
oxu_qh_alloc(struct oxu_hcd * oxu)1057*4882a593Smuzhiyun static struct ehci_qh *oxu_qh_alloc(struct oxu_hcd *oxu)
1058*4882a593Smuzhiyun {
1059*4882a593Smuzhiyun 	int i;
1060*4882a593Smuzhiyun 	struct ehci_qh *qh = NULL;
1061*4882a593Smuzhiyun 
1062*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
1063*4882a593Smuzhiyun 
1064*4882a593Smuzhiyun 	for (i = 0; i < QHEAD_NUM; i++)
1065*4882a593Smuzhiyun 		if (!oxu->qh_used[i])
1066*4882a593Smuzhiyun 			break;
1067*4882a593Smuzhiyun 
1068*4882a593Smuzhiyun 	if (i < QHEAD_NUM) {
1069*4882a593Smuzhiyun 		qh = (struct ehci_qh *) &oxu->mem->qh_pool[i];
1070*4882a593Smuzhiyun 		memset(qh, 0, sizeof *qh);
1071*4882a593Smuzhiyun 
1072*4882a593Smuzhiyun 		kref_init(&qh->kref);
1073*4882a593Smuzhiyun 		qh->oxu = oxu;
1074*4882a593Smuzhiyun 		qh->qh_dma = virt_to_phys(qh);
1075*4882a593Smuzhiyun 		INIT_LIST_HEAD(&qh->qtd_list);
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 		/* dummy td enables safe urb queuing */
1078*4882a593Smuzhiyun 		qh->dummy = ehci_qtd_alloc(oxu);
1079*4882a593Smuzhiyun 		if (qh->dummy == NULL) {
1080*4882a593Smuzhiyun 			oxu_dbg(oxu, "no dummy td\n");
1081*4882a593Smuzhiyun 			oxu->qh_used[i] = 0;
1082*4882a593Smuzhiyun 			qh = NULL;
1083*4882a593Smuzhiyun 			goto unlock;
1084*4882a593Smuzhiyun 		}
1085*4882a593Smuzhiyun 
1086*4882a593Smuzhiyun 		oxu->qh_used[i] = 1;
1087*4882a593Smuzhiyun 	}
1088*4882a593Smuzhiyun unlock:
1089*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
1090*4882a593Smuzhiyun 
1091*4882a593Smuzhiyun 	return qh;
1092*4882a593Smuzhiyun }
1093*4882a593Smuzhiyun 
1094*4882a593Smuzhiyun /* to share a qh (cpu threads, or hc) */
qh_get(struct ehci_qh * qh)1095*4882a593Smuzhiyun static inline struct ehci_qh *qh_get(struct ehci_qh *qh)
1096*4882a593Smuzhiyun {
1097*4882a593Smuzhiyun 	kref_get(&qh->kref);
1098*4882a593Smuzhiyun 	return qh;
1099*4882a593Smuzhiyun }
1100*4882a593Smuzhiyun 
qh_put(struct ehci_qh * qh)1101*4882a593Smuzhiyun static inline void qh_put(struct ehci_qh *qh)
1102*4882a593Smuzhiyun {
1103*4882a593Smuzhiyun 	kref_put(&qh->kref, qh_destroy);
1104*4882a593Smuzhiyun }
1105*4882a593Smuzhiyun 
oxu_murb_free(struct oxu_hcd * oxu,struct oxu_murb * murb)1106*4882a593Smuzhiyun static void oxu_murb_free(struct oxu_hcd *oxu, struct oxu_murb *murb)
1107*4882a593Smuzhiyun {
1108*4882a593Smuzhiyun 	int index;
1109*4882a593Smuzhiyun 
1110*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
1111*4882a593Smuzhiyun 
1112*4882a593Smuzhiyun 	index = murb - &oxu->murb_pool[0];
1113*4882a593Smuzhiyun 	oxu->murb_used[index] = 0;
1114*4882a593Smuzhiyun 
1115*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
1116*4882a593Smuzhiyun }
1117*4882a593Smuzhiyun 
oxu_murb_alloc(struct oxu_hcd * oxu)1118*4882a593Smuzhiyun static struct oxu_murb *oxu_murb_alloc(struct oxu_hcd *oxu)
1119*4882a593Smuzhiyun 
1120*4882a593Smuzhiyun {
1121*4882a593Smuzhiyun 	int i;
1122*4882a593Smuzhiyun 	struct oxu_murb *murb = NULL;
1123*4882a593Smuzhiyun 
1124*4882a593Smuzhiyun 	spin_lock(&oxu->mem_lock);
1125*4882a593Smuzhiyun 
1126*4882a593Smuzhiyun 	for (i = 0; i < MURB_NUM; i++)
1127*4882a593Smuzhiyun 		if (!oxu->murb_used[i])
1128*4882a593Smuzhiyun 			break;
1129*4882a593Smuzhiyun 
1130*4882a593Smuzhiyun 	if (i < MURB_NUM) {
1131*4882a593Smuzhiyun 		murb = &(oxu->murb_pool)[i];
1132*4882a593Smuzhiyun 
1133*4882a593Smuzhiyun 		oxu->murb_used[i] = 1;
1134*4882a593Smuzhiyun 	}
1135*4882a593Smuzhiyun 
1136*4882a593Smuzhiyun 	spin_unlock(&oxu->mem_lock);
1137*4882a593Smuzhiyun 
1138*4882a593Smuzhiyun 	return murb;
1139*4882a593Smuzhiyun }
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun /* The queue heads and transfer descriptors are managed from pools tied
1142*4882a593Smuzhiyun  * to each of the "per device" structures.
1143*4882a593Smuzhiyun  * This is the initialisation and cleanup code.
1144*4882a593Smuzhiyun  */
ehci_mem_cleanup(struct oxu_hcd * oxu)1145*4882a593Smuzhiyun static void ehci_mem_cleanup(struct oxu_hcd *oxu)
1146*4882a593Smuzhiyun {
1147*4882a593Smuzhiyun 	kfree(oxu->murb_pool);
1148*4882a593Smuzhiyun 	oxu->murb_pool = NULL;
1149*4882a593Smuzhiyun 
1150*4882a593Smuzhiyun 	if (oxu->async)
1151*4882a593Smuzhiyun 		qh_put(oxu->async);
1152*4882a593Smuzhiyun 	oxu->async = NULL;
1153*4882a593Smuzhiyun 
1154*4882a593Smuzhiyun 	del_timer(&oxu->urb_timer);
1155*4882a593Smuzhiyun 
1156*4882a593Smuzhiyun 	oxu->periodic = NULL;
1157*4882a593Smuzhiyun 
1158*4882a593Smuzhiyun 	/* shadow periodic table */
1159*4882a593Smuzhiyun 	kfree(oxu->pshadow);
1160*4882a593Smuzhiyun 	oxu->pshadow = NULL;
1161*4882a593Smuzhiyun }
1162*4882a593Smuzhiyun 
1163*4882a593Smuzhiyun /* Remember to add cleanup code (above) if you add anything here.
1164*4882a593Smuzhiyun  */
ehci_mem_init(struct oxu_hcd * oxu,gfp_t flags)1165*4882a593Smuzhiyun static int ehci_mem_init(struct oxu_hcd *oxu, gfp_t flags)
1166*4882a593Smuzhiyun {
1167*4882a593Smuzhiyun 	int i;
1168*4882a593Smuzhiyun 
1169*4882a593Smuzhiyun 	for (i = 0; i < oxu->periodic_size; i++)
1170*4882a593Smuzhiyun 		oxu->mem->frame_list[i] = EHCI_LIST_END;
1171*4882a593Smuzhiyun 	for (i = 0; i < QHEAD_NUM; i++)
1172*4882a593Smuzhiyun 		oxu->qh_used[i] = 0;
1173*4882a593Smuzhiyun 	for (i = 0; i < QTD_NUM; i++)
1174*4882a593Smuzhiyun 		oxu->qtd_used[i] = 0;
1175*4882a593Smuzhiyun 
1176*4882a593Smuzhiyun 	oxu->murb_pool = kcalloc(MURB_NUM, sizeof(struct oxu_murb), flags);
1177*4882a593Smuzhiyun 	if (!oxu->murb_pool)
1178*4882a593Smuzhiyun 		goto fail;
1179*4882a593Smuzhiyun 
1180*4882a593Smuzhiyun 	for (i = 0; i < MURB_NUM; i++)
1181*4882a593Smuzhiyun 		oxu->murb_used[i] = 0;
1182*4882a593Smuzhiyun 
1183*4882a593Smuzhiyun 	oxu->async = oxu_qh_alloc(oxu);
1184*4882a593Smuzhiyun 	if (!oxu->async)
1185*4882a593Smuzhiyun 		goto fail;
1186*4882a593Smuzhiyun 
1187*4882a593Smuzhiyun 	oxu->periodic = (__le32 *) &oxu->mem->frame_list;
1188*4882a593Smuzhiyun 	oxu->periodic_dma = virt_to_phys(oxu->periodic);
1189*4882a593Smuzhiyun 
1190*4882a593Smuzhiyun 	for (i = 0; i < oxu->periodic_size; i++)
1191*4882a593Smuzhiyun 		oxu->periodic[i] = EHCI_LIST_END;
1192*4882a593Smuzhiyun 
1193*4882a593Smuzhiyun 	/* software shadow of hardware table */
1194*4882a593Smuzhiyun 	oxu->pshadow = kcalloc(oxu->periodic_size, sizeof(void *), flags);
1195*4882a593Smuzhiyun 	if (oxu->pshadow != NULL)
1196*4882a593Smuzhiyun 		return 0;
1197*4882a593Smuzhiyun 
1198*4882a593Smuzhiyun fail:
1199*4882a593Smuzhiyun 	oxu_dbg(oxu, "couldn't init memory\n");
1200*4882a593Smuzhiyun 	ehci_mem_cleanup(oxu);
1201*4882a593Smuzhiyun 	return -ENOMEM;
1202*4882a593Smuzhiyun }
1203*4882a593Smuzhiyun 
1204*4882a593Smuzhiyun /* Fill a qtd, returning how much of the buffer we were able to queue up.
1205*4882a593Smuzhiyun  */
qtd_fill(struct ehci_qtd * qtd,dma_addr_t buf,size_t len,int token,int maxpacket)1206*4882a593Smuzhiyun static int qtd_fill(struct ehci_qtd *qtd, dma_addr_t buf, size_t len,
1207*4882a593Smuzhiyun 				int token, int maxpacket)
1208*4882a593Smuzhiyun {
1209*4882a593Smuzhiyun 	int i, count;
1210*4882a593Smuzhiyun 	u64 addr = buf;
1211*4882a593Smuzhiyun 
1212*4882a593Smuzhiyun 	/* one buffer entry per 4K ... first might be short or unaligned */
1213*4882a593Smuzhiyun 	qtd->hw_buf[0] = cpu_to_le32((u32)addr);
1214*4882a593Smuzhiyun 	qtd->hw_buf_hi[0] = cpu_to_le32((u32)(addr >> 32));
1215*4882a593Smuzhiyun 	count = 0x1000 - (buf & 0x0fff);	/* rest of that page */
1216*4882a593Smuzhiyun 	if (likely(len < count))		/* ... iff needed */
1217*4882a593Smuzhiyun 		count = len;
1218*4882a593Smuzhiyun 	else {
1219*4882a593Smuzhiyun 		buf +=  0x1000;
1220*4882a593Smuzhiyun 		buf &= ~0x0fff;
1221*4882a593Smuzhiyun 
1222*4882a593Smuzhiyun 		/* per-qtd limit: from 16K to 20K (best alignment) */
1223*4882a593Smuzhiyun 		for (i = 1; count < len && i < 5; i++) {
1224*4882a593Smuzhiyun 			addr = buf;
1225*4882a593Smuzhiyun 			qtd->hw_buf[i] = cpu_to_le32((u32)addr);
1226*4882a593Smuzhiyun 			qtd->hw_buf_hi[i] = cpu_to_le32((u32)(addr >> 32));
1227*4882a593Smuzhiyun 			buf += 0x1000;
1228*4882a593Smuzhiyun 			if ((count + 0x1000) < len)
1229*4882a593Smuzhiyun 				count += 0x1000;
1230*4882a593Smuzhiyun 			else
1231*4882a593Smuzhiyun 				count = len;
1232*4882a593Smuzhiyun 		}
1233*4882a593Smuzhiyun 
1234*4882a593Smuzhiyun 		/* short packets may only terminate transfers */
1235*4882a593Smuzhiyun 		if (count != len)
1236*4882a593Smuzhiyun 			count -= (count % maxpacket);
1237*4882a593Smuzhiyun 	}
1238*4882a593Smuzhiyun 	qtd->hw_token = cpu_to_le32((count << 16) | token);
1239*4882a593Smuzhiyun 	qtd->length = count;
1240*4882a593Smuzhiyun 
1241*4882a593Smuzhiyun 	return count;
1242*4882a593Smuzhiyun }
1243*4882a593Smuzhiyun 
qh_update(struct oxu_hcd * oxu,struct ehci_qh * qh,struct ehci_qtd * qtd)1244*4882a593Smuzhiyun static inline void qh_update(struct oxu_hcd *oxu,
1245*4882a593Smuzhiyun 				struct ehci_qh *qh, struct ehci_qtd *qtd)
1246*4882a593Smuzhiyun {
1247*4882a593Smuzhiyun 	/* writes to an active overlay are unsafe */
1248*4882a593Smuzhiyun 	BUG_ON(qh->qh_state != QH_STATE_IDLE);
1249*4882a593Smuzhiyun 
1250*4882a593Smuzhiyun 	qh->hw_qtd_next = QTD_NEXT(qtd->qtd_dma);
1251*4882a593Smuzhiyun 	qh->hw_alt_next = EHCI_LIST_END;
1252*4882a593Smuzhiyun 
1253*4882a593Smuzhiyun 	/* Except for control endpoints, we make hardware maintain data
1254*4882a593Smuzhiyun 	 * toggle (like OHCI) ... here (re)initialize the toggle in the QH,
1255*4882a593Smuzhiyun 	 * and set the pseudo-toggle in udev. Only usb_clear_halt() will
1256*4882a593Smuzhiyun 	 * ever clear it.
1257*4882a593Smuzhiyun 	 */
1258*4882a593Smuzhiyun 	if (!(qh->hw_info1 & cpu_to_le32(1 << 14))) {
1259*4882a593Smuzhiyun 		unsigned	is_out, epnum;
1260*4882a593Smuzhiyun 
1261*4882a593Smuzhiyun 		is_out = !(qtd->hw_token & cpu_to_le32(1 << 8));
1262*4882a593Smuzhiyun 		epnum = (le32_to_cpup(&qh->hw_info1) >> 8) & 0x0f;
1263*4882a593Smuzhiyun 		if (unlikely(!usb_gettoggle(qh->dev, epnum, is_out))) {
1264*4882a593Smuzhiyun 			qh->hw_token &= ~cpu_to_le32(QTD_TOGGLE);
1265*4882a593Smuzhiyun 			usb_settoggle(qh->dev, epnum, is_out, 1);
1266*4882a593Smuzhiyun 		}
1267*4882a593Smuzhiyun 	}
1268*4882a593Smuzhiyun 
1269*4882a593Smuzhiyun 	/* HC must see latest qtd and qh data before we clear ACTIVE+HALT */
1270*4882a593Smuzhiyun 	wmb();
1271*4882a593Smuzhiyun 	qh->hw_token &= cpu_to_le32(QTD_TOGGLE | QTD_STS_PING);
1272*4882a593Smuzhiyun }
1273*4882a593Smuzhiyun 
1274*4882a593Smuzhiyun /* If it weren't for a common silicon quirk (writing the dummy into the qh
1275*4882a593Smuzhiyun  * overlay, so qh->hw_token wrongly becomes inactive/halted), only fault
1276*4882a593Smuzhiyun  * recovery (including urb dequeue) would need software changes to a QH...
1277*4882a593Smuzhiyun  */
qh_refresh(struct oxu_hcd * oxu,struct ehci_qh * qh)1278*4882a593Smuzhiyun static void qh_refresh(struct oxu_hcd *oxu, struct ehci_qh *qh)
1279*4882a593Smuzhiyun {
1280*4882a593Smuzhiyun 	struct ehci_qtd *qtd;
1281*4882a593Smuzhiyun 
1282*4882a593Smuzhiyun 	if (list_empty(&qh->qtd_list))
1283*4882a593Smuzhiyun 		qtd = qh->dummy;
1284*4882a593Smuzhiyun 	else {
1285*4882a593Smuzhiyun 		qtd = list_entry(qh->qtd_list.next,
1286*4882a593Smuzhiyun 				struct ehci_qtd, qtd_list);
1287*4882a593Smuzhiyun 		/* first qtd may already be partially processed */
1288*4882a593Smuzhiyun 		if (cpu_to_le32(qtd->qtd_dma) == qh->hw_current)
1289*4882a593Smuzhiyun 			qtd = NULL;
1290*4882a593Smuzhiyun 	}
1291*4882a593Smuzhiyun 
1292*4882a593Smuzhiyun 	if (qtd)
1293*4882a593Smuzhiyun 		qh_update(oxu, qh, qtd);
1294*4882a593Smuzhiyun }
1295*4882a593Smuzhiyun 
qtd_copy_status(struct oxu_hcd * oxu,struct urb * urb,size_t length,u32 token)1296*4882a593Smuzhiyun static void qtd_copy_status(struct oxu_hcd *oxu, struct urb *urb,
1297*4882a593Smuzhiyun 				size_t length, u32 token)
1298*4882a593Smuzhiyun {
1299*4882a593Smuzhiyun 	/* count IN/OUT bytes, not SETUP (even short packets) */
1300*4882a593Smuzhiyun 	if (likely(QTD_PID(token) != 2))
1301*4882a593Smuzhiyun 		urb->actual_length += length - QTD_LENGTH(token);
1302*4882a593Smuzhiyun 
1303*4882a593Smuzhiyun 	/* don't modify error codes */
1304*4882a593Smuzhiyun 	if (unlikely(urb->status != -EINPROGRESS))
1305*4882a593Smuzhiyun 		return;
1306*4882a593Smuzhiyun 
1307*4882a593Smuzhiyun 	/* force cleanup after short read; not always an error */
1308*4882a593Smuzhiyun 	if (unlikely(IS_SHORT_READ(token)))
1309*4882a593Smuzhiyun 		urb->status = -EREMOTEIO;
1310*4882a593Smuzhiyun 
1311*4882a593Smuzhiyun 	/* serious "can't proceed" faults reported by the hardware */
1312*4882a593Smuzhiyun 	if (token & QTD_STS_HALT) {
1313*4882a593Smuzhiyun 		if (token & QTD_STS_BABBLE) {
1314*4882a593Smuzhiyun 			/* FIXME "must" disable babbling device's port too */
1315*4882a593Smuzhiyun 			urb->status = -EOVERFLOW;
1316*4882a593Smuzhiyun 		} else if (token & QTD_STS_MMF) {
1317*4882a593Smuzhiyun 			/* fs/ls interrupt xfer missed the complete-split */
1318*4882a593Smuzhiyun 			urb->status = -EPROTO;
1319*4882a593Smuzhiyun 		} else if (token & QTD_STS_DBE) {
1320*4882a593Smuzhiyun 			urb->status = (QTD_PID(token) == 1) /* IN ? */
1321*4882a593Smuzhiyun 				? -ENOSR  /* hc couldn't read data */
1322*4882a593Smuzhiyun 				: -ECOMM; /* hc couldn't write data */
1323*4882a593Smuzhiyun 		} else if (token & QTD_STS_XACT) {
1324*4882a593Smuzhiyun 			/* timeout, bad crc, wrong PID, etc; retried */
1325*4882a593Smuzhiyun 			if (QTD_CERR(token))
1326*4882a593Smuzhiyun 				urb->status = -EPIPE;
1327*4882a593Smuzhiyun 			else {
1328*4882a593Smuzhiyun 				oxu_dbg(oxu, "devpath %s ep%d%s 3strikes\n",
1329*4882a593Smuzhiyun 					urb->dev->devpath,
1330*4882a593Smuzhiyun 					usb_pipeendpoint(urb->pipe),
1331*4882a593Smuzhiyun 					usb_pipein(urb->pipe) ? "in" : "out");
1332*4882a593Smuzhiyun 				urb->status = -EPROTO;
1333*4882a593Smuzhiyun 			}
1334*4882a593Smuzhiyun 		/* CERR nonzero + no errors + halt --> stall */
1335*4882a593Smuzhiyun 		} else if (QTD_CERR(token))
1336*4882a593Smuzhiyun 			urb->status = -EPIPE;
1337*4882a593Smuzhiyun 		else	/* unknown */
1338*4882a593Smuzhiyun 			urb->status = -EPROTO;
1339*4882a593Smuzhiyun 
1340*4882a593Smuzhiyun 		oxu_vdbg(oxu, "dev%d ep%d%s qtd token %08x --> status %d\n",
1341*4882a593Smuzhiyun 			usb_pipedevice(urb->pipe),
1342*4882a593Smuzhiyun 			usb_pipeendpoint(urb->pipe),
1343*4882a593Smuzhiyun 			usb_pipein(urb->pipe) ? "in" : "out",
1344*4882a593Smuzhiyun 			token, urb->status);
1345*4882a593Smuzhiyun 	}
1346*4882a593Smuzhiyun }
1347*4882a593Smuzhiyun 
ehci_urb_done(struct oxu_hcd * oxu,struct urb * urb)1348*4882a593Smuzhiyun static void ehci_urb_done(struct oxu_hcd *oxu, struct urb *urb)
1349*4882a593Smuzhiyun __releases(oxu->lock)
1350*4882a593Smuzhiyun __acquires(oxu->lock)
1351*4882a593Smuzhiyun {
1352*4882a593Smuzhiyun 	if (likely(urb->hcpriv != NULL)) {
1353*4882a593Smuzhiyun 		struct ehci_qh	*qh = (struct ehci_qh *) urb->hcpriv;
1354*4882a593Smuzhiyun 
1355*4882a593Smuzhiyun 		/* S-mask in a QH means it's an interrupt urb */
1356*4882a593Smuzhiyun 		if ((qh->hw_info2 & cpu_to_le32(QH_SMASK)) != 0) {
1357*4882a593Smuzhiyun 
1358*4882a593Smuzhiyun 			/* ... update hc-wide periodic stats (for usbfs) */
1359*4882a593Smuzhiyun 			oxu_to_hcd(oxu)->self.bandwidth_int_reqs--;
1360*4882a593Smuzhiyun 		}
1361*4882a593Smuzhiyun 		qh_put(qh);
1362*4882a593Smuzhiyun 	}
1363*4882a593Smuzhiyun 
1364*4882a593Smuzhiyun 	urb->hcpriv = NULL;
1365*4882a593Smuzhiyun 	switch (urb->status) {
1366*4882a593Smuzhiyun 	case -EINPROGRESS:		/* success */
1367*4882a593Smuzhiyun 		urb->status = 0;
1368*4882a593Smuzhiyun 	default:			/* fault */
1369*4882a593Smuzhiyun 		break;
1370*4882a593Smuzhiyun 	case -EREMOTEIO:		/* fault or normal */
1371*4882a593Smuzhiyun 		if (!(urb->transfer_flags & URB_SHORT_NOT_OK))
1372*4882a593Smuzhiyun 			urb->status = 0;
1373*4882a593Smuzhiyun 		break;
1374*4882a593Smuzhiyun 	case -ECONNRESET:		/* canceled */
1375*4882a593Smuzhiyun 	case -ENOENT:
1376*4882a593Smuzhiyun 		break;
1377*4882a593Smuzhiyun 	}
1378*4882a593Smuzhiyun 
1379*4882a593Smuzhiyun #ifdef OXU_URB_TRACE
1380*4882a593Smuzhiyun 	oxu_dbg(oxu, "%s %s urb %p ep%d%s status %d len %d/%d\n",
1381*4882a593Smuzhiyun 		__func__, urb->dev->devpath, urb,
1382*4882a593Smuzhiyun 		usb_pipeendpoint(urb->pipe),
1383*4882a593Smuzhiyun 		usb_pipein(urb->pipe) ? "in" : "out",
1384*4882a593Smuzhiyun 		urb->status,
1385*4882a593Smuzhiyun 		urb->actual_length, urb->transfer_buffer_length);
1386*4882a593Smuzhiyun #endif
1387*4882a593Smuzhiyun 
1388*4882a593Smuzhiyun 	/* complete() can reenter this HCD */
1389*4882a593Smuzhiyun 	spin_unlock(&oxu->lock);
1390*4882a593Smuzhiyun 	usb_hcd_giveback_urb(oxu_to_hcd(oxu), urb, urb->status);
1391*4882a593Smuzhiyun 	spin_lock(&oxu->lock);
1392*4882a593Smuzhiyun }
1393*4882a593Smuzhiyun 
1394*4882a593Smuzhiyun static void start_unlink_async(struct oxu_hcd *oxu, struct ehci_qh *qh);
1395*4882a593Smuzhiyun static void unlink_async(struct oxu_hcd *oxu, struct ehci_qh *qh);
1396*4882a593Smuzhiyun 
1397*4882a593Smuzhiyun static void intr_deschedule(struct oxu_hcd *oxu, struct ehci_qh *qh);
1398*4882a593Smuzhiyun static int qh_schedule(struct oxu_hcd *oxu, struct ehci_qh *qh);
1399*4882a593Smuzhiyun 
1400*4882a593Smuzhiyun #define HALT_BIT cpu_to_le32(QTD_STS_HALT)
1401*4882a593Smuzhiyun 
1402*4882a593Smuzhiyun /* Process and free completed qtds for a qh, returning URBs to drivers.
1403*4882a593Smuzhiyun  * Chases up to qh->hw_current.  Returns number of completions called,
1404*4882a593Smuzhiyun  * indicating how much "real" work we did.
1405*4882a593Smuzhiyun  */
qh_completions(struct oxu_hcd * oxu,struct ehci_qh * qh)1406*4882a593Smuzhiyun static unsigned qh_completions(struct oxu_hcd *oxu, struct ehci_qh *qh)
1407*4882a593Smuzhiyun {
1408*4882a593Smuzhiyun 	struct ehci_qtd *last = NULL, *end = qh->dummy;
1409*4882a593Smuzhiyun 	struct ehci_qtd	*qtd, *tmp;
1410*4882a593Smuzhiyun 	int stopped;
1411*4882a593Smuzhiyun 	unsigned count = 0;
1412*4882a593Smuzhiyun 	int do_status = 0;
1413*4882a593Smuzhiyun 	u8 state;
1414*4882a593Smuzhiyun 	struct oxu_murb *murb = NULL;
1415*4882a593Smuzhiyun 
1416*4882a593Smuzhiyun 	if (unlikely(list_empty(&qh->qtd_list)))
1417*4882a593Smuzhiyun 		return count;
1418*4882a593Smuzhiyun 
1419*4882a593Smuzhiyun 	/* completions (or tasks on other cpus) must never clobber HALT
1420*4882a593Smuzhiyun 	 * till we've gone through and cleaned everything up, even when
1421*4882a593Smuzhiyun 	 * they add urbs to this qh's queue or mark them for unlinking.
1422*4882a593Smuzhiyun 	 *
1423*4882a593Smuzhiyun 	 * NOTE:  unlinking expects to be done in queue order.
1424*4882a593Smuzhiyun 	 */
1425*4882a593Smuzhiyun 	state = qh->qh_state;
1426*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_COMPLETING;
1427*4882a593Smuzhiyun 	stopped = (state == QH_STATE_IDLE);
1428*4882a593Smuzhiyun 
1429*4882a593Smuzhiyun 	/* remove de-activated QTDs from front of queue.
1430*4882a593Smuzhiyun 	 * after faults (including short reads), cleanup this urb
1431*4882a593Smuzhiyun 	 * then let the queue advance.
1432*4882a593Smuzhiyun 	 * if queue is stopped, handles unlinks.
1433*4882a593Smuzhiyun 	 */
1434*4882a593Smuzhiyun 	list_for_each_entry_safe(qtd, tmp, &qh->qtd_list, qtd_list) {
1435*4882a593Smuzhiyun 		struct urb *urb;
1436*4882a593Smuzhiyun 		u32 token = 0;
1437*4882a593Smuzhiyun 
1438*4882a593Smuzhiyun 		urb = qtd->urb;
1439*4882a593Smuzhiyun 
1440*4882a593Smuzhiyun 		/* Clean up any state from previous QTD ...*/
1441*4882a593Smuzhiyun 		if (last) {
1442*4882a593Smuzhiyun 			if (likely(last->urb != urb)) {
1443*4882a593Smuzhiyun 				if (last->urb->complete == NULL) {
1444*4882a593Smuzhiyun 					murb = (struct oxu_murb *) last->urb;
1445*4882a593Smuzhiyun 					last->urb = murb->main;
1446*4882a593Smuzhiyun 					if (murb->last) {
1447*4882a593Smuzhiyun 						ehci_urb_done(oxu, last->urb);
1448*4882a593Smuzhiyun 						count++;
1449*4882a593Smuzhiyun 					}
1450*4882a593Smuzhiyun 					oxu_murb_free(oxu, murb);
1451*4882a593Smuzhiyun 				} else {
1452*4882a593Smuzhiyun 					ehci_urb_done(oxu, last->urb);
1453*4882a593Smuzhiyun 					count++;
1454*4882a593Smuzhiyun 				}
1455*4882a593Smuzhiyun 			}
1456*4882a593Smuzhiyun 			oxu_qtd_free(oxu, last);
1457*4882a593Smuzhiyun 			last = NULL;
1458*4882a593Smuzhiyun 		}
1459*4882a593Smuzhiyun 
1460*4882a593Smuzhiyun 		/* ignore urbs submitted during completions we reported */
1461*4882a593Smuzhiyun 		if (qtd == end)
1462*4882a593Smuzhiyun 			break;
1463*4882a593Smuzhiyun 
1464*4882a593Smuzhiyun 		/* hardware copies qtd out of qh overlay */
1465*4882a593Smuzhiyun 		rmb();
1466*4882a593Smuzhiyun 		token = le32_to_cpu(qtd->hw_token);
1467*4882a593Smuzhiyun 
1468*4882a593Smuzhiyun 		/* always clean up qtds the hc de-activated */
1469*4882a593Smuzhiyun 		if ((token & QTD_STS_ACTIVE) == 0) {
1470*4882a593Smuzhiyun 
1471*4882a593Smuzhiyun 			if ((token & QTD_STS_HALT) != 0) {
1472*4882a593Smuzhiyun 				stopped = 1;
1473*4882a593Smuzhiyun 
1474*4882a593Smuzhiyun 			/* magic dummy for some short reads; qh won't advance.
1475*4882a593Smuzhiyun 			 * that silicon quirk can kick in with this dummy too.
1476*4882a593Smuzhiyun 			 */
1477*4882a593Smuzhiyun 			} else if (IS_SHORT_READ(token) &&
1478*4882a593Smuzhiyun 					!(qtd->hw_alt_next & EHCI_LIST_END)) {
1479*4882a593Smuzhiyun 				stopped = 1;
1480*4882a593Smuzhiyun 				goto halt;
1481*4882a593Smuzhiyun 			}
1482*4882a593Smuzhiyun 
1483*4882a593Smuzhiyun 		/* stop scanning when we reach qtds the hc is using */
1484*4882a593Smuzhiyun 		} else if (likely(!stopped &&
1485*4882a593Smuzhiyun 				HC_IS_RUNNING(oxu_to_hcd(oxu)->state))) {
1486*4882a593Smuzhiyun 			break;
1487*4882a593Smuzhiyun 
1488*4882a593Smuzhiyun 		} else {
1489*4882a593Smuzhiyun 			stopped = 1;
1490*4882a593Smuzhiyun 
1491*4882a593Smuzhiyun 			if (unlikely(!HC_IS_RUNNING(oxu_to_hcd(oxu)->state)))
1492*4882a593Smuzhiyun 				urb->status = -ESHUTDOWN;
1493*4882a593Smuzhiyun 
1494*4882a593Smuzhiyun 			/* ignore active urbs unless some previous qtd
1495*4882a593Smuzhiyun 			 * for the urb faulted (including short read) or
1496*4882a593Smuzhiyun 			 * its urb was canceled.  we may patch qh or qtds.
1497*4882a593Smuzhiyun 			 */
1498*4882a593Smuzhiyun 			if (likely(urb->status == -EINPROGRESS))
1499*4882a593Smuzhiyun 				continue;
1500*4882a593Smuzhiyun 
1501*4882a593Smuzhiyun 			/* issue status after short control reads */
1502*4882a593Smuzhiyun 			if (unlikely(do_status != 0)
1503*4882a593Smuzhiyun 					&& QTD_PID(token) == 0 /* OUT */) {
1504*4882a593Smuzhiyun 				do_status = 0;
1505*4882a593Smuzhiyun 				continue;
1506*4882a593Smuzhiyun 			}
1507*4882a593Smuzhiyun 
1508*4882a593Smuzhiyun 			/* token in overlay may be most current */
1509*4882a593Smuzhiyun 			if (state == QH_STATE_IDLE
1510*4882a593Smuzhiyun 					&& cpu_to_le32(qtd->qtd_dma)
1511*4882a593Smuzhiyun 						== qh->hw_current)
1512*4882a593Smuzhiyun 				token = le32_to_cpu(qh->hw_token);
1513*4882a593Smuzhiyun 
1514*4882a593Smuzhiyun 			/* force halt for unlinked or blocked qh, so we'll
1515*4882a593Smuzhiyun 			 * patch the qh later and so that completions can't
1516*4882a593Smuzhiyun 			 * activate it while we "know" it's stopped.
1517*4882a593Smuzhiyun 			 */
1518*4882a593Smuzhiyun 			if ((HALT_BIT & qh->hw_token) == 0) {
1519*4882a593Smuzhiyun halt:
1520*4882a593Smuzhiyun 				qh->hw_token |= HALT_BIT;
1521*4882a593Smuzhiyun 				wmb();
1522*4882a593Smuzhiyun 			}
1523*4882a593Smuzhiyun 		}
1524*4882a593Smuzhiyun 
1525*4882a593Smuzhiyun 		/* Remove it from the queue */
1526*4882a593Smuzhiyun 		qtd_copy_status(oxu, urb->complete ?
1527*4882a593Smuzhiyun 					urb : ((struct oxu_murb *) urb)->main,
1528*4882a593Smuzhiyun 				qtd->length, token);
1529*4882a593Smuzhiyun 		if ((usb_pipein(qtd->urb->pipe)) &&
1530*4882a593Smuzhiyun 				(NULL != qtd->transfer_buffer))
1531*4882a593Smuzhiyun 			memcpy(qtd->transfer_buffer, qtd->buffer, qtd->length);
1532*4882a593Smuzhiyun 		do_status = (urb->status == -EREMOTEIO)
1533*4882a593Smuzhiyun 				&& usb_pipecontrol(urb->pipe);
1534*4882a593Smuzhiyun 
1535*4882a593Smuzhiyun 		if (stopped && qtd->qtd_list.prev != &qh->qtd_list) {
1536*4882a593Smuzhiyun 			last = list_entry(qtd->qtd_list.prev,
1537*4882a593Smuzhiyun 					struct ehci_qtd, qtd_list);
1538*4882a593Smuzhiyun 			last->hw_next = qtd->hw_next;
1539*4882a593Smuzhiyun 		}
1540*4882a593Smuzhiyun 		list_del(&qtd->qtd_list);
1541*4882a593Smuzhiyun 		last = qtd;
1542*4882a593Smuzhiyun 	}
1543*4882a593Smuzhiyun 
1544*4882a593Smuzhiyun 	/* last urb's completion might still need calling */
1545*4882a593Smuzhiyun 	if (likely(last != NULL)) {
1546*4882a593Smuzhiyun 		if (last->urb->complete == NULL) {
1547*4882a593Smuzhiyun 			murb = (struct oxu_murb *) last->urb;
1548*4882a593Smuzhiyun 			last->urb = murb->main;
1549*4882a593Smuzhiyun 			if (murb->last) {
1550*4882a593Smuzhiyun 				ehci_urb_done(oxu, last->urb);
1551*4882a593Smuzhiyun 				count++;
1552*4882a593Smuzhiyun 			}
1553*4882a593Smuzhiyun 			oxu_murb_free(oxu, murb);
1554*4882a593Smuzhiyun 		} else {
1555*4882a593Smuzhiyun 			ehci_urb_done(oxu, last->urb);
1556*4882a593Smuzhiyun 			count++;
1557*4882a593Smuzhiyun 		}
1558*4882a593Smuzhiyun 		oxu_qtd_free(oxu, last);
1559*4882a593Smuzhiyun 	}
1560*4882a593Smuzhiyun 
1561*4882a593Smuzhiyun 	/* restore original state; caller must unlink or relink */
1562*4882a593Smuzhiyun 	qh->qh_state = state;
1563*4882a593Smuzhiyun 
1564*4882a593Smuzhiyun 	/* be sure the hardware's done with the qh before refreshing
1565*4882a593Smuzhiyun 	 * it after fault cleanup, or recovering from silicon wrongly
1566*4882a593Smuzhiyun 	 * overlaying the dummy qtd (which reduces DMA chatter).
1567*4882a593Smuzhiyun 	 */
1568*4882a593Smuzhiyun 	if (stopped != 0 || qh->hw_qtd_next == EHCI_LIST_END) {
1569*4882a593Smuzhiyun 		switch (state) {
1570*4882a593Smuzhiyun 		case QH_STATE_IDLE:
1571*4882a593Smuzhiyun 			qh_refresh(oxu, qh);
1572*4882a593Smuzhiyun 			break;
1573*4882a593Smuzhiyun 		case QH_STATE_LINKED:
1574*4882a593Smuzhiyun 			/* should be rare for periodic transfers,
1575*4882a593Smuzhiyun 			 * except maybe high bandwidth ...
1576*4882a593Smuzhiyun 			 */
1577*4882a593Smuzhiyun 			if ((cpu_to_le32(QH_SMASK)
1578*4882a593Smuzhiyun 					& qh->hw_info2) != 0) {
1579*4882a593Smuzhiyun 				intr_deschedule(oxu, qh);
1580*4882a593Smuzhiyun 				(void) qh_schedule(oxu, qh);
1581*4882a593Smuzhiyun 			} else
1582*4882a593Smuzhiyun 				unlink_async(oxu, qh);
1583*4882a593Smuzhiyun 			break;
1584*4882a593Smuzhiyun 		/* otherwise, unlink already started */
1585*4882a593Smuzhiyun 		}
1586*4882a593Smuzhiyun 	}
1587*4882a593Smuzhiyun 
1588*4882a593Smuzhiyun 	return count;
1589*4882a593Smuzhiyun }
1590*4882a593Smuzhiyun 
1591*4882a593Smuzhiyun /* High bandwidth multiplier, as encoded in highspeed endpoint descriptors */
1592*4882a593Smuzhiyun #define hb_mult(wMaxPacketSize)		(1 + (((wMaxPacketSize) >> 11) & 0x03))
1593*4882a593Smuzhiyun /* ... and packet size, for any kind of endpoint descriptor */
1594*4882a593Smuzhiyun #define max_packet(wMaxPacketSize)	((wMaxPacketSize) & 0x07ff)
1595*4882a593Smuzhiyun 
1596*4882a593Smuzhiyun /* Reverse of qh_urb_transaction: free a list of TDs.
1597*4882a593Smuzhiyun  * used for cleanup after errors, before HC sees an URB's TDs.
1598*4882a593Smuzhiyun  */
qtd_list_free(struct oxu_hcd * oxu,struct urb * urb,struct list_head * head)1599*4882a593Smuzhiyun static void qtd_list_free(struct oxu_hcd *oxu,
1600*4882a593Smuzhiyun 				struct urb *urb, struct list_head *head)
1601*4882a593Smuzhiyun {
1602*4882a593Smuzhiyun 	struct ehci_qtd	*qtd, *temp;
1603*4882a593Smuzhiyun 
1604*4882a593Smuzhiyun 	list_for_each_entry_safe(qtd, temp, head, qtd_list) {
1605*4882a593Smuzhiyun 		list_del(&qtd->qtd_list);
1606*4882a593Smuzhiyun 		oxu_qtd_free(oxu, qtd);
1607*4882a593Smuzhiyun 	}
1608*4882a593Smuzhiyun }
1609*4882a593Smuzhiyun 
1610*4882a593Smuzhiyun /* Create a list of filled qtds for this URB; won't link into qh.
1611*4882a593Smuzhiyun  */
qh_urb_transaction(struct oxu_hcd * oxu,struct urb * urb,struct list_head * head,gfp_t flags)1612*4882a593Smuzhiyun static struct list_head *qh_urb_transaction(struct oxu_hcd *oxu,
1613*4882a593Smuzhiyun 						struct urb *urb,
1614*4882a593Smuzhiyun 						struct list_head *head,
1615*4882a593Smuzhiyun 						gfp_t flags)
1616*4882a593Smuzhiyun {
1617*4882a593Smuzhiyun 	struct ehci_qtd	*qtd, *qtd_prev;
1618*4882a593Smuzhiyun 	dma_addr_t buf;
1619*4882a593Smuzhiyun 	int len, maxpacket;
1620*4882a593Smuzhiyun 	int is_input;
1621*4882a593Smuzhiyun 	u32 token;
1622*4882a593Smuzhiyun 	void *transfer_buf = NULL;
1623*4882a593Smuzhiyun 	int ret;
1624*4882a593Smuzhiyun 
1625*4882a593Smuzhiyun 	/*
1626*4882a593Smuzhiyun 	 * URBs map to sequences of QTDs: one logical transaction
1627*4882a593Smuzhiyun 	 */
1628*4882a593Smuzhiyun 	qtd = ehci_qtd_alloc(oxu);
1629*4882a593Smuzhiyun 	if (unlikely(!qtd))
1630*4882a593Smuzhiyun 		return NULL;
1631*4882a593Smuzhiyun 	list_add_tail(&qtd->qtd_list, head);
1632*4882a593Smuzhiyun 	qtd->urb = urb;
1633*4882a593Smuzhiyun 
1634*4882a593Smuzhiyun 	token = QTD_STS_ACTIVE;
1635*4882a593Smuzhiyun 	token |= (EHCI_TUNE_CERR << 10);
1636*4882a593Smuzhiyun 	/* for split transactions, SplitXState initialized to zero */
1637*4882a593Smuzhiyun 
1638*4882a593Smuzhiyun 	len = urb->transfer_buffer_length;
1639*4882a593Smuzhiyun 	is_input = usb_pipein(urb->pipe);
1640*4882a593Smuzhiyun 	if (!urb->transfer_buffer && urb->transfer_buffer_length && is_input)
1641*4882a593Smuzhiyun 		urb->transfer_buffer = phys_to_virt(urb->transfer_dma);
1642*4882a593Smuzhiyun 
1643*4882a593Smuzhiyun 	if (usb_pipecontrol(urb->pipe)) {
1644*4882a593Smuzhiyun 		/* SETUP pid */
1645*4882a593Smuzhiyun 		ret = oxu_buf_alloc(oxu, qtd, sizeof(struct usb_ctrlrequest));
1646*4882a593Smuzhiyun 		if (ret)
1647*4882a593Smuzhiyun 			goto cleanup;
1648*4882a593Smuzhiyun 
1649*4882a593Smuzhiyun 		qtd_fill(qtd, qtd->buffer_dma, sizeof(struct usb_ctrlrequest),
1650*4882a593Smuzhiyun 				token | (2 /* "setup" */ << 8), 8);
1651*4882a593Smuzhiyun 		memcpy(qtd->buffer, qtd->urb->setup_packet,
1652*4882a593Smuzhiyun 				sizeof(struct usb_ctrlrequest));
1653*4882a593Smuzhiyun 
1654*4882a593Smuzhiyun 		/* ... and always at least one more pid */
1655*4882a593Smuzhiyun 		token ^= QTD_TOGGLE;
1656*4882a593Smuzhiyun 		qtd_prev = qtd;
1657*4882a593Smuzhiyun 		qtd = ehci_qtd_alloc(oxu);
1658*4882a593Smuzhiyun 		if (unlikely(!qtd))
1659*4882a593Smuzhiyun 			goto cleanup;
1660*4882a593Smuzhiyun 		qtd->urb = urb;
1661*4882a593Smuzhiyun 		qtd_prev->hw_next = QTD_NEXT(qtd->qtd_dma);
1662*4882a593Smuzhiyun 		list_add_tail(&qtd->qtd_list, head);
1663*4882a593Smuzhiyun 
1664*4882a593Smuzhiyun 		/* for zero length DATA stages, STATUS is always IN */
1665*4882a593Smuzhiyun 		if (len == 0)
1666*4882a593Smuzhiyun 			token |= (1 /* "in" */ << 8);
1667*4882a593Smuzhiyun 	}
1668*4882a593Smuzhiyun 
1669*4882a593Smuzhiyun 	/*
1670*4882a593Smuzhiyun 	 * Data transfer stage: buffer setup
1671*4882a593Smuzhiyun 	 */
1672*4882a593Smuzhiyun 
1673*4882a593Smuzhiyun 	ret = oxu_buf_alloc(oxu, qtd, len);
1674*4882a593Smuzhiyun 	if (ret)
1675*4882a593Smuzhiyun 		goto cleanup;
1676*4882a593Smuzhiyun 
1677*4882a593Smuzhiyun 	buf = qtd->buffer_dma;
1678*4882a593Smuzhiyun 	transfer_buf = urb->transfer_buffer;
1679*4882a593Smuzhiyun 
1680*4882a593Smuzhiyun 	if (!is_input)
1681*4882a593Smuzhiyun 		memcpy(qtd->buffer, qtd->urb->transfer_buffer, len);
1682*4882a593Smuzhiyun 
1683*4882a593Smuzhiyun 	if (is_input)
1684*4882a593Smuzhiyun 		token |= (1 /* "in" */ << 8);
1685*4882a593Smuzhiyun 	/* else it's already initted to "out" pid (0 << 8) */
1686*4882a593Smuzhiyun 
1687*4882a593Smuzhiyun 	maxpacket = max_packet(usb_maxpacket(urb->dev, urb->pipe, !is_input));
1688*4882a593Smuzhiyun 
1689*4882a593Smuzhiyun 	/*
1690*4882a593Smuzhiyun 	 * buffer gets wrapped in one or more qtds;
1691*4882a593Smuzhiyun 	 * last one may be "short" (including zero len)
1692*4882a593Smuzhiyun 	 * and may serve as a control status ack
1693*4882a593Smuzhiyun 	 */
1694*4882a593Smuzhiyun 	for (;;) {
1695*4882a593Smuzhiyun 		int this_qtd_len;
1696*4882a593Smuzhiyun 
1697*4882a593Smuzhiyun 		this_qtd_len = qtd_fill(qtd, buf, len, token, maxpacket);
1698*4882a593Smuzhiyun 		qtd->transfer_buffer = transfer_buf;
1699*4882a593Smuzhiyun 		len -= this_qtd_len;
1700*4882a593Smuzhiyun 		buf += this_qtd_len;
1701*4882a593Smuzhiyun 		transfer_buf += this_qtd_len;
1702*4882a593Smuzhiyun 		if (is_input)
1703*4882a593Smuzhiyun 			qtd->hw_alt_next = oxu->async->hw_alt_next;
1704*4882a593Smuzhiyun 
1705*4882a593Smuzhiyun 		/* qh makes control packets use qtd toggle; maybe switch it */
1706*4882a593Smuzhiyun 		if ((maxpacket & (this_qtd_len + (maxpacket - 1))) == 0)
1707*4882a593Smuzhiyun 			token ^= QTD_TOGGLE;
1708*4882a593Smuzhiyun 
1709*4882a593Smuzhiyun 		if (likely(len <= 0))
1710*4882a593Smuzhiyun 			break;
1711*4882a593Smuzhiyun 
1712*4882a593Smuzhiyun 		qtd_prev = qtd;
1713*4882a593Smuzhiyun 		qtd = ehci_qtd_alloc(oxu);
1714*4882a593Smuzhiyun 		if (unlikely(!qtd))
1715*4882a593Smuzhiyun 			goto cleanup;
1716*4882a593Smuzhiyun 		if (likely(len > 0)) {
1717*4882a593Smuzhiyun 			ret = oxu_buf_alloc(oxu, qtd, len);
1718*4882a593Smuzhiyun 			if (ret)
1719*4882a593Smuzhiyun 				goto cleanup;
1720*4882a593Smuzhiyun 		}
1721*4882a593Smuzhiyun 		qtd->urb = urb;
1722*4882a593Smuzhiyun 		qtd_prev->hw_next = QTD_NEXT(qtd->qtd_dma);
1723*4882a593Smuzhiyun 		list_add_tail(&qtd->qtd_list, head);
1724*4882a593Smuzhiyun 	}
1725*4882a593Smuzhiyun 
1726*4882a593Smuzhiyun 	/* unless the bulk/interrupt caller wants a chance to clean
1727*4882a593Smuzhiyun 	 * up after short reads, hc should advance qh past this urb
1728*4882a593Smuzhiyun 	 */
1729*4882a593Smuzhiyun 	if (likely((urb->transfer_flags & URB_SHORT_NOT_OK) == 0
1730*4882a593Smuzhiyun 				|| usb_pipecontrol(urb->pipe)))
1731*4882a593Smuzhiyun 		qtd->hw_alt_next = EHCI_LIST_END;
1732*4882a593Smuzhiyun 
1733*4882a593Smuzhiyun 	/*
1734*4882a593Smuzhiyun 	 * control requests may need a terminating data "status" ack;
1735*4882a593Smuzhiyun 	 * bulk ones may need a terminating short packet (zero length).
1736*4882a593Smuzhiyun 	 */
1737*4882a593Smuzhiyun 	if (likely(urb->transfer_buffer_length != 0)) {
1738*4882a593Smuzhiyun 		int	one_more = 0;
1739*4882a593Smuzhiyun 
1740*4882a593Smuzhiyun 		if (usb_pipecontrol(urb->pipe)) {
1741*4882a593Smuzhiyun 			one_more = 1;
1742*4882a593Smuzhiyun 			token ^= 0x0100;	/* "in" <--> "out"  */
1743*4882a593Smuzhiyun 			token |= QTD_TOGGLE;	/* force DATA1 */
1744*4882a593Smuzhiyun 		} else if (usb_pipebulk(urb->pipe)
1745*4882a593Smuzhiyun 				&& (urb->transfer_flags & URB_ZERO_PACKET)
1746*4882a593Smuzhiyun 				&& !(urb->transfer_buffer_length % maxpacket)) {
1747*4882a593Smuzhiyun 			one_more = 1;
1748*4882a593Smuzhiyun 		}
1749*4882a593Smuzhiyun 		if (one_more) {
1750*4882a593Smuzhiyun 			qtd_prev = qtd;
1751*4882a593Smuzhiyun 			qtd = ehci_qtd_alloc(oxu);
1752*4882a593Smuzhiyun 			if (unlikely(!qtd))
1753*4882a593Smuzhiyun 				goto cleanup;
1754*4882a593Smuzhiyun 			qtd->urb = urb;
1755*4882a593Smuzhiyun 			qtd_prev->hw_next = QTD_NEXT(qtd->qtd_dma);
1756*4882a593Smuzhiyun 			list_add_tail(&qtd->qtd_list, head);
1757*4882a593Smuzhiyun 
1758*4882a593Smuzhiyun 			/* never any data in such packets */
1759*4882a593Smuzhiyun 			qtd_fill(qtd, 0, 0, token, 0);
1760*4882a593Smuzhiyun 		}
1761*4882a593Smuzhiyun 	}
1762*4882a593Smuzhiyun 
1763*4882a593Smuzhiyun 	/* by default, enable interrupt on urb completion */
1764*4882a593Smuzhiyun 	qtd->hw_token |= cpu_to_le32(QTD_IOC);
1765*4882a593Smuzhiyun 	return head;
1766*4882a593Smuzhiyun 
1767*4882a593Smuzhiyun cleanup:
1768*4882a593Smuzhiyun 	qtd_list_free(oxu, urb, head);
1769*4882a593Smuzhiyun 	return NULL;
1770*4882a593Smuzhiyun }
1771*4882a593Smuzhiyun 
1772*4882a593Smuzhiyun /* Each QH holds a qtd list; a QH is used for everything except iso.
1773*4882a593Smuzhiyun  *
1774*4882a593Smuzhiyun  * For interrupt urbs, the scheduler must set the microframe scheduling
1775*4882a593Smuzhiyun  * mask(s) each time the QH gets scheduled.  For highspeed, that's
1776*4882a593Smuzhiyun  * just one microframe in the s-mask.  For split interrupt transactions
1777*4882a593Smuzhiyun  * there are additional complications: c-mask, maybe FSTNs.
1778*4882a593Smuzhiyun  */
qh_make(struct oxu_hcd * oxu,struct urb * urb,gfp_t flags)1779*4882a593Smuzhiyun static struct ehci_qh *qh_make(struct oxu_hcd *oxu,
1780*4882a593Smuzhiyun 				struct urb *urb, gfp_t flags)
1781*4882a593Smuzhiyun {
1782*4882a593Smuzhiyun 	struct ehci_qh *qh = oxu_qh_alloc(oxu);
1783*4882a593Smuzhiyun 	u32 info1 = 0, info2 = 0;
1784*4882a593Smuzhiyun 	int is_input, type;
1785*4882a593Smuzhiyun 	int maxp = 0;
1786*4882a593Smuzhiyun 
1787*4882a593Smuzhiyun 	if (!qh)
1788*4882a593Smuzhiyun 		return qh;
1789*4882a593Smuzhiyun 
1790*4882a593Smuzhiyun 	/*
1791*4882a593Smuzhiyun 	 * init endpoint/device data for this QH
1792*4882a593Smuzhiyun 	 */
1793*4882a593Smuzhiyun 	info1 |= usb_pipeendpoint(urb->pipe) << 8;
1794*4882a593Smuzhiyun 	info1 |= usb_pipedevice(urb->pipe) << 0;
1795*4882a593Smuzhiyun 
1796*4882a593Smuzhiyun 	is_input = usb_pipein(urb->pipe);
1797*4882a593Smuzhiyun 	type = usb_pipetype(urb->pipe);
1798*4882a593Smuzhiyun 	maxp = usb_maxpacket(urb->dev, urb->pipe, !is_input);
1799*4882a593Smuzhiyun 
1800*4882a593Smuzhiyun 	/* Compute interrupt scheduling parameters just once, and save.
1801*4882a593Smuzhiyun 	 * - allowing for high bandwidth, how many nsec/uframe are used?
1802*4882a593Smuzhiyun 	 * - split transactions need a second CSPLIT uframe; same question
1803*4882a593Smuzhiyun 	 * - splits also need a schedule gap (for full/low speed I/O)
1804*4882a593Smuzhiyun 	 * - qh has a polling interval
1805*4882a593Smuzhiyun 	 *
1806*4882a593Smuzhiyun 	 * For control/bulk requests, the HC or TT handles these.
1807*4882a593Smuzhiyun 	 */
1808*4882a593Smuzhiyun 	if (type == PIPE_INTERRUPT) {
1809*4882a593Smuzhiyun 		qh->usecs = NS_TO_US(usb_calc_bus_time(USB_SPEED_HIGH,
1810*4882a593Smuzhiyun 								is_input, 0,
1811*4882a593Smuzhiyun 				hb_mult(maxp) * max_packet(maxp)));
1812*4882a593Smuzhiyun 		qh->start = NO_FRAME;
1813*4882a593Smuzhiyun 
1814*4882a593Smuzhiyun 		if (urb->dev->speed == USB_SPEED_HIGH) {
1815*4882a593Smuzhiyun 			qh->c_usecs = 0;
1816*4882a593Smuzhiyun 			qh->gap_uf = 0;
1817*4882a593Smuzhiyun 
1818*4882a593Smuzhiyun 			qh->period = urb->interval >> 3;
1819*4882a593Smuzhiyun 			if (qh->period == 0 && urb->interval != 1) {
1820*4882a593Smuzhiyun 				/* NOTE interval 2 or 4 uframes could work.
1821*4882a593Smuzhiyun 				 * But interval 1 scheduling is simpler, and
1822*4882a593Smuzhiyun 				 * includes high bandwidth.
1823*4882a593Smuzhiyun 				 */
1824*4882a593Smuzhiyun 				oxu_dbg(oxu, "intr period %d uframes, NYET!\n",
1825*4882a593Smuzhiyun 					urb->interval);
1826*4882a593Smuzhiyun 				goto done;
1827*4882a593Smuzhiyun 			}
1828*4882a593Smuzhiyun 		} else {
1829*4882a593Smuzhiyun 			struct usb_tt	*tt = urb->dev->tt;
1830*4882a593Smuzhiyun 			int		think_time;
1831*4882a593Smuzhiyun 
1832*4882a593Smuzhiyun 			/* gap is f(FS/LS transfer times) */
1833*4882a593Smuzhiyun 			qh->gap_uf = 1 + usb_calc_bus_time(urb->dev->speed,
1834*4882a593Smuzhiyun 					is_input, 0, maxp) / (125 * 1000);
1835*4882a593Smuzhiyun 
1836*4882a593Smuzhiyun 			/* FIXME this just approximates SPLIT/CSPLIT times */
1837*4882a593Smuzhiyun 			if (is_input) {		/* SPLIT, gap, CSPLIT+DATA */
1838*4882a593Smuzhiyun 				qh->c_usecs = qh->usecs + HS_USECS(0);
1839*4882a593Smuzhiyun 				qh->usecs = HS_USECS(1);
1840*4882a593Smuzhiyun 			} else {		/* SPLIT+DATA, gap, CSPLIT */
1841*4882a593Smuzhiyun 				qh->usecs += HS_USECS(1);
1842*4882a593Smuzhiyun 				qh->c_usecs = HS_USECS(0);
1843*4882a593Smuzhiyun 			}
1844*4882a593Smuzhiyun 
1845*4882a593Smuzhiyun 			think_time = tt ? tt->think_time : 0;
1846*4882a593Smuzhiyun 			qh->tt_usecs = NS_TO_US(think_time +
1847*4882a593Smuzhiyun 					usb_calc_bus_time(urb->dev->speed,
1848*4882a593Smuzhiyun 					is_input, 0, max_packet(maxp)));
1849*4882a593Smuzhiyun 			qh->period = urb->interval;
1850*4882a593Smuzhiyun 		}
1851*4882a593Smuzhiyun 	}
1852*4882a593Smuzhiyun 
1853*4882a593Smuzhiyun 	/* support for tt scheduling, and access to toggles */
1854*4882a593Smuzhiyun 	qh->dev = urb->dev;
1855*4882a593Smuzhiyun 
1856*4882a593Smuzhiyun 	/* using TT? */
1857*4882a593Smuzhiyun 	switch (urb->dev->speed) {
1858*4882a593Smuzhiyun 	case USB_SPEED_LOW:
1859*4882a593Smuzhiyun 		info1 |= (1 << 12);	/* EPS "low" */
1860*4882a593Smuzhiyun 		fallthrough;
1861*4882a593Smuzhiyun 
1862*4882a593Smuzhiyun 	case USB_SPEED_FULL:
1863*4882a593Smuzhiyun 		/* EPS 0 means "full" */
1864*4882a593Smuzhiyun 		if (type != PIPE_INTERRUPT)
1865*4882a593Smuzhiyun 			info1 |= (EHCI_TUNE_RL_TT << 28);
1866*4882a593Smuzhiyun 		if (type == PIPE_CONTROL) {
1867*4882a593Smuzhiyun 			info1 |= (1 << 27);	/* for TT */
1868*4882a593Smuzhiyun 			info1 |= 1 << 14;	/* toggle from qtd */
1869*4882a593Smuzhiyun 		}
1870*4882a593Smuzhiyun 		info1 |= maxp << 16;
1871*4882a593Smuzhiyun 
1872*4882a593Smuzhiyun 		info2 |= (EHCI_TUNE_MULT_TT << 30);
1873*4882a593Smuzhiyun 		info2 |= urb->dev->ttport << 23;
1874*4882a593Smuzhiyun 
1875*4882a593Smuzhiyun 		/* NOTE:  if (PIPE_INTERRUPT) { scheduler sets c-mask } */
1876*4882a593Smuzhiyun 
1877*4882a593Smuzhiyun 		break;
1878*4882a593Smuzhiyun 
1879*4882a593Smuzhiyun 	case USB_SPEED_HIGH:		/* no TT involved */
1880*4882a593Smuzhiyun 		info1 |= (2 << 12);	/* EPS "high" */
1881*4882a593Smuzhiyun 		if (type == PIPE_CONTROL) {
1882*4882a593Smuzhiyun 			info1 |= (EHCI_TUNE_RL_HS << 28);
1883*4882a593Smuzhiyun 			info1 |= 64 << 16;	/* usb2 fixed maxpacket */
1884*4882a593Smuzhiyun 			info1 |= 1 << 14;	/* toggle from qtd */
1885*4882a593Smuzhiyun 			info2 |= (EHCI_TUNE_MULT_HS << 30);
1886*4882a593Smuzhiyun 		} else if (type == PIPE_BULK) {
1887*4882a593Smuzhiyun 			info1 |= (EHCI_TUNE_RL_HS << 28);
1888*4882a593Smuzhiyun 			info1 |= 512 << 16;	/* usb2 fixed maxpacket */
1889*4882a593Smuzhiyun 			info2 |= (EHCI_TUNE_MULT_HS << 30);
1890*4882a593Smuzhiyun 		} else {		/* PIPE_INTERRUPT */
1891*4882a593Smuzhiyun 			info1 |= max_packet(maxp) << 16;
1892*4882a593Smuzhiyun 			info2 |= hb_mult(maxp) << 30;
1893*4882a593Smuzhiyun 		}
1894*4882a593Smuzhiyun 		break;
1895*4882a593Smuzhiyun 	default:
1896*4882a593Smuzhiyun 		oxu_dbg(oxu, "bogus dev %p speed %d\n", urb->dev, urb->dev->speed);
1897*4882a593Smuzhiyun done:
1898*4882a593Smuzhiyun 		qh_put(qh);
1899*4882a593Smuzhiyun 		return NULL;
1900*4882a593Smuzhiyun 	}
1901*4882a593Smuzhiyun 
1902*4882a593Smuzhiyun 	/* NOTE:  if (PIPE_INTERRUPT) { scheduler sets s-mask } */
1903*4882a593Smuzhiyun 
1904*4882a593Smuzhiyun 	/* init as live, toggle clear, advance to dummy */
1905*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_IDLE;
1906*4882a593Smuzhiyun 	qh->hw_info1 = cpu_to_le32(info1);
1907*4882a593Smuzhiyun 	qh->hw_info2 = cpu_to_le32(info2);
1908*4882a593Smuzhiyun 	usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe), !is_input, 1);
1909*4882a593Smuzhiyun 	qh_refresh(oxu, qh);
1910*4882a593Smuzhiyun 	return qh;
1911*4882a593Smuzhiyun }
1912*4882a593Smuzhiyun 
1913*4882a593Smuzhiyun /* Move qh (and its qtds) onto async queue; maybe enable queue.
1914*4882a593Smuzhiyun  */
qh_link_async(struct oxu_hcd * oxu,struct ehci_qh * qh)1915*4882a593Smuzhiyun static void qh_link_async(struct oxu_hcd *oxu, struct ehci_qh *qh)
1916*4882a593Smuzhiyun {
1917*4882a593Smuzhiyun 	__le32 dma = QH_NEXT(qh->qh_dma);
1918*4882a593Smuzhiyun 	struct ehci_qh *head;
1919*4882a593Smuzhiyun 
1920*4882a593Smuzhiyun 	/* (re)start the async schedule? */
1921*4882a593Smuzhiyun 	head = oxu->async;
1922*4882a593Smuzhiyun 	timer_action_done(oxu, TIMER_ASYNC_OFF);
1923*4882a593Smuzhiyun 	if (!head->qh_next.qh) {
1924*4882a593Smuzhiyun 		u32	cmd = readl(&oxu->regs->command);
1925*4882a593Smuzhiyun 
1926*4882a593Smuzhiyun 		if (!(cmd & CMD_ASE)) {
1927*4882a593Smuzhiyun 			/* in case a clear of CMD_ASE didn't take yet */
1928*4882a593Smuzhiyun 			(void)handshake(oxu, &oxu->regs->status,
1929*4882a593Smuzhiyun 					STS_ASS, 0, 150);
1930*4882a593Smuzhiyun 			cmd |= CMD_ASE | CMD_RUN;
1931*4882a593Smuzhiyun 			writel(cmd, &oxu->regs->command);
1932*4882a593Smuzhiyun 			oxu_to_hcd(oxu)->state = HC_STATE_RUNNING;
1933*4882a593Smuzhiyun 			/* posted write need not be known to HC yet ... */
1934*4882a593Smuzhiyun 		}
1935*4882a593Smuzhiyun 	}
1936*4882a593Smuzhiyun 
1937*4882a593Smuzhiyun 	/* clear halt and/or toggle; and maybe recover from silicon quirk */
1938*4882a593Smuzhiyun 	if (qh->qh_state == QH_STATE_IDLE)
1939*4882a593Smuzhiyun 		qh_refresh(oxu, qh);
1940*4882a593Smuzhiyun 
1941*4882a593Smuzhiyun 	/* splice right after start */
1942*4882a593Smuzhiyun 	qh->qh_next = head->qh_next;
1943*4882a593Smuzhiyun 	qh->hw_next = head->hw_next;
1944*4882a593Smuzhiyun 	wmb();
1945*4882a593Smuzhiyun 
1946*4882a593Smuzhiyun 	head->qh_next.qh = qh;
1947*4882a593Smuzhiyun 	head->hw_next = dma;
1948*4882a593Smuzhiyun 
1949*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_LINKED;
1950*4882a593Smuzhiyun 	/* qtd completions reported later by interrupt */
1951*4882a593Smuzhiyun }
1952*4882a593Smuzhiyun 
1953*4882a593Smuzhiyun #define	QH_ADDR_MASK	cpu_to_le32(0x7f)
1954*4882a593Smuzhiyun 
1955*4882a593Smuzhiyun /*
1956*4882a593Smuzhiyun  * For control/bulk/interrupt, return QH with these TDs appended.
1957*4882a593Smuzhiyun  * Allocates and initializes the QH if necessary.
1958*4882a593Smuzhiyun  * Returns null if it can't allocate a QH it needs to.
1959*4882a593Smuzhiyun  * If the QH has TDs (urbs) already, that's great.
1960*4882a593Smuzhiyun  */
qh_append_tds(struct oxu_hcd * oxu,struct urb * urb,struct list_head * qtd_list,int epnum,void ** ptr)1961*4882a593Smuzhiyun static struct ehci_qh *qh_append_tds(struct oxu_hcd *oxu,
1962*4882a593Smuzhiyun 				struct urb *urb, struct list_head *qtd_list,
1963*4882a593Smuzhiyun 				int epnum, void	**ptr)
1964*4882a593Smuzhiyun {
1965*4882a593Smuzhiyun 	struct ehci_qh *qh = NULL;
1966*4882a593Smuzhiyun 
1967*4882a593Smuzhiyun 	qh = (struct ehci_qh *) *ptr;
1968*4882a593Smuzhiyun 	if (unlikely(qh == NULL)) {
1969*4882a593Smuzhiyun 		/* can't sleep here, we have oxu->lock... */
1970*4882a593Smuzhiyun 		qh = qh_make(oxu, urb, GFP_ATOMIC);
1971*4882a593Smuzhiyun 		*ptr = qh;
1972*4882a593Smuzhiyun 	}
1973*4882a593Smuzhiyun 	if (likely(qh != NULL)) {
1974*4882a593Smuzhiyun 		struct ehci_qtd	*qtd;
1975*4882a593Smuzhiyun 
1976*4882a593Smuzhiyun 		if (unlikely(list_empty(qtd_list)))
1977*4882a593Smuzhiyun 			qtd = NULL;
1978*4882a593Smuzhiyun 		else
1979*4882a593Smuzhiyun 			qtd = list_entry(qtd_list->next, struct ehci_qtd,
1980*4882a593Smuzhiyun 					qtd_list);
1981*4882a593Smuzhiyun 
1982*4882a593Smuzhiyun 		/* control qh may need patching ... */
1983*4882a593Smuzhiyun 		if (unlikely(epnum == 0)) {
1984*4882a593Smuzhiyun 
1985*4882a593Smuzhiyun 			/* usb_reset_device() briefly reverts to address 0 */
1986*4882a593Smuzhiyun 			if (usb_pipedevice(urb->pipe) == 0)
1987*4882a593Smuzhiyun 				qh->hw_info1 &= ~QH_ADDR_MASK;
1988*4882a593Smuzhiyun 		}
1989*4882a593Smuzhiyun 
1990*4882a593Smuzhiyun 		/* just one way to queue requests: swap with the dummy qtd.
1991*4882a593Smuzhiyun 		 * only hc or qh_refresh() ever modify the overlay.
1992*4882a593Smuzhiyun 		 */
1993*4882a593Smuzhiyun 		if (likely(qtd != NULL)) {
1994*4882a593Smuzhiyun 			struct ehci_qtd	*dummy;
1995*4882a593Smuzhiyun 			dma_addr_t dma;
1996*4882a593Smuzhiyun 			__le32 token;
1997*4882a593Smuzhiyun 
1998*4882a593Smuzhiyun 			/* to avoid racing the HC, use the dummy td instead of
1999*4882a593Smuzhiyun 			 * the first td of our list (becomes new dummy).  both
2000*4882a593Smuzhiyun 			 * tds stay deactivated until we're done, when the
2001*4882a593Smuzhiyun 			 * HC is allowed to fetch the old dummy (4.10.2).
2002*4882a593Smuzhiyun 			 */
2003*4882a593Smuzhiyun 			token = qtd->hw_token;
2004*4882a593Smuzhiyun 			qtd->hw_token = HALT_BIT;
2005*4882a593Smuzhiyun 			wmb();
2006*4882a593Smuzhiyun 			dummy = qh->dummy;
2007*4882a593Smuzhiyun 
2008*4882a593Smuzhiyun 			dma = dummy->qtd_dma;
2009*4882a593Smuzhiyun 			*dummy = *qtd;
2010*4882a593Smuzhiyun 			dummy->qtd_dma = dma;
2011*4882a593Smuzhiyun 
2012*4882a593Smuzhiyun 			list_del(&qtd->qtd_list);
2013*4882a593Smuzhiyun 			list_add(&dummy->qtd_list, qtd_list);
2014*4882a593Smuzhiyun 			list_splice(qtd_list, qh->qtd_list.prev);
2015*4882a593Smuzhiyun 
2016*4882a593Smuzhiyun 			ehci_qtd_init(qtd, qtd->qtd_dma);
2017*4882a593Smuzhiyun 			qh->dummy = qtd;
2018*4882a593Smuzhiyun 
2019*4882a593Smuzhiyun 			/* hc must see the new dummy at list end */
2020*4882a593Smuzhiyun 			dma = qtd->qtd_dma;
2021*4882a593Smuzhiyun 			qtd = list_entry(qh->qtd_list.prev,
2022*4882a593Smuzhiyun 					struct ehci_qtd, qtd_list);
2023*4882a593Smuzhiyun 			qtd->hw_next = QTD_NEXT(dma);
2024*4882a593Smuzhiyun 
2025*4882a593Smuzhiyun 			/* let the hc process these next qtds */
2026*4882a593Smuzhiyun 			dummy->hw_token = (token & ~(0x80));
2027*4882a593Smuzhiyun 			wmb();
2028*4882a593Smuzhiyun 			dummy->hw_token = token;
2029*4882a593Smuzhiyun 
2030*4882a593Smuzhiyun 			urb->hcpriv = qh_get(qh);
2031*4882a593Smuzhiyun 		}
2032*4882a593Smuzhiyun 	}
2033*4882a593Smuzhiyun 	return qh;
2034*4882a593Smuzhiyun }
2035*4882a593Smuzhiyun 
submit_async(struct oxu_hcd * oxu,struct urb * urb,struct list_head * qtd_list,gfp_t mem_flags)2036*4882a593Smuzhiyun static int submit_async(struct oxu_hcd	*oxu, struct urb *urb,
2037*4882a593Smuzhiyun 			struct list_head *qtd_list, gfp_t mem_flags)
2038*4882a593Smuzhiyun {
2039*4882a593Smuzhiyun 	int epnum = urb->ep->desc.bEndpointAddress;
2040*4882a593Smuzhiyun 	unsigned long flags;
2041*4882a593Smuzhiyun 	struct ehci_qh *qh = NULL;
2042*4882a593Smuzhiyun 	int rc = 0;
2043*4882a593Smuzhiyun #ifdef OXU_URB_TRACE
2044*4882a593Smuzhiyun 	struct ehci_qtd	*qtd;
2045*4882a593Smuzhiyun 
2046*4882a593Smuzhiyun 	qtd = list_entry(qtd_list->next, struct ehci_qtd, qtd_list);
2047*4882a593Smuzhiyun 
2048*4882a593Smuzhiyun 	oxu_dbg(oxu, "%s %s urb %p ep%d%s len %d, qtd %p [qh %p]\n",
2049*4882a593Smuzhiyun 		__func__, urb->dev->devpath, urb,
2050*4882a593Smuzhiyun 		epnum & 0x0f, (epnum & USB_DIR_IN) ? "in" : "out",
2051*4882a593Smuzhiyun 		urb->transfer_buffer_length,
2052*4882a593Smuzhiyun 		qtd, urb->ep->hcpriv);
2053*4882a593Smuzhiyun #endif
2054*4882a593Smuzhiyun 
2055*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
2056*4882a593Smuzhiyun 	if (unlikely(!HCD_HW_ACCESSIBLE(oxu_to_hcd(oxu)))) {
2057*4882a593Smuzhiyun 		rc = -ESHUTDOWN;
2058*4882a593Smuzhiyun 		goto done;
2059*4882a593Smuzhiyun 	}
2060*4882a593Smuzhiyun 
2061*4882a593Smuzhiyun 	qh = qh_append_tds(oxu, urb, qtd_list, epnum, &urb->ep->hcpriv);
2062*4882a593Smuzhiyun 	if (unlikely(qh == NULL)) {
2063*4882a593Smuzhiyun 		rc = -ENOMEM;
2064*4882a593Smuzhiyun 		goto done;
2065*4882a593Smuzhiyun 	}
2066*4882a593Smuzhiyun 
2067*4882a593Smuzhiyun 	/* Control/bulk operations through TTs don't need scheduling,
2068*4882a593Smuzhiyun 	 * the HC and TT handle it when the TT has a buffer ready.
2069*4882a593Smuzhiyun 	 */
2070*4882a593Smuzhiyun 	if (likely(qh->qh_state == QH_STATE_IDLE))
2071*4882a593Smuzhiyun 		qh_link_async(oxu, qh_get(qh));
2072*4882a593Smuzhiyun done:
2073*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
2074*4882a593Smuzhiyun 	if (unlikely(qh == NULL))
2075*4882a593Smuzhiyun 		qtd_list_free(oxu, urb, qtd_list);
2076*4882a593Smuzhiyun 	return rc;
2077*4882a593Smuzhiyun }
2078*4882a593Smuzhiyun 
2079*4882a593Smuzhiyun /* The async qh for the qtds being reclaimed are now unlinked from the HC */
2080*4882a593Smuzhiyun 
end_unlink_async(struct oxu_hcd * oxu)2081*4882a593Smuzhiyun static void end_unlink_async(struct oxu_hcd *oxu)
2082*4882a593Smuzhiyun {
2083*4882a593Smuzhiyun 	struct ehci_qh *qh = oxu->reclaim;
2084*4882a593Smuzhiyun 	struct ehci_qh *next;
2085*4882a593Smuzhiyun 
2086*4882a593Smuzhiyun 	timer_action_done(oxu, TIMER_IAA_WATCHDOG);
2087*4882a593Smuzhiyun 
2088*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_IDLE;
2089*4882a593Smuzhiyun 	qh->qh_next.qh = NULL;
2090*4882a593Smuzhiyun 	qh_put(qh);			/* refcount from reclaim */
2091*4882a593Smuzhiyun 
2092*4882a593Smuzhiyun 	/* other unlink(s) may be pending (in QH_STATE_UNLINK_WAIT) */
2093*4882a593Smuzhiyun 	next = qh->reclaim;
2094*4882a593Smuzhiyun 	oxu->reclaim = next;
2095*4882a593Smuzhiyun 	oxu->reclaim_ready = 0;
2096*4882a593Smuzhiyun 	qh->reclaim = NULL;
2097*4882a593Smuzhiyun 
2098*4882a593Smuzhiyun 	qh_completions(oxu, qh);
2099*4882a593Smuzhiyun 
2100*4882a593Smuzhiyun 	if (!list_empty(&qh->qtd_list)
2101*4882a593Smuzhiyun 			&& HC_IS_RUNNING(oxu_to_hcd(oxu)->state))
2102*4882a593Smuzhiyun 		qh_link_async(oxu, qh);
2103*4882a593Smuzhiyun 	else {
2104*4882a593Smuzhiyun 		qh_put(qh);		/* refcount from async list */
2105*4882a593Smuzhiyun 
2106*4882a593Smuzhiyun 		/* it's not free to turn the async schedule on/off; leave it
2107*4882a593Smuzhiyun 		 * active but idle for a while once it empties.
2108*4882a593Smuzhiyun 		 */
2109*4882a593Smuzhiyun 		if (HC_IS_RUNNING(oxu_to_hcd(oxu)->state)
2110*4882a593Smuzhiyun 				&& oxu->async->qh_next.qh == NULL)
2111*4882a593Smuzhiyun 			timer_action(oxu, TIMER_ASYNC_OFF);
2112*4882a593Smuzhiyun 	}
2113*4882a593Smuzhiyun 
2114*4882a593Smuzhiyun 	if (next) {
2115*4882a593Smuzhiyun 		oxu->reclaim = NULL;
2116*4882a593Smuzhiyun 		start_unlink_async(oxu, next);
2117*4882a593Smuzhiyun 	}
2118*4882a593Smuzhiyun }
2119*4882a593Smuzhiyun 
2120*4882a593Smuzhiyun /* makes sure the async qh will become idle */
2121*4882a593Smuzhiyun /* caller must own oxu->lock */
2122*4882a593Smuzhiyun 
start_unlink_async(struct oxu_hcd * oxu,struct ehci_qh * qh)2123*4882a593Smuzhiyun static void start_unlink_async(struct oxu_hcd *oxu, struct ehci_qh *qh)
2124*4882a593Smuzhiyun {
2125*4882a593Smuzhiyun 	int cmd = readl(&oxu->regs->command);
2126*4882a593Smuzhiyun 	struct ehci_qh *prev;
2127*4882a593Smuzhiyun 
2128*4882a593Smuzhiyun #ifdef DEBUG
2129*4882a593Smuzhiyun 	assert_spin_locked(&oxu->lock);
2130*4882a593Smuzhiyun 	BUG_ON(oxu->reclaim || (qh->qh_state != QH_STATE_LINKED
2131*4882a593Smuzhiyun 				&& qh->qh_state != QH_STATE_UNLINK_WAIT));
2132*4882a593Smuzhiyun #endif
2133*4882a593Smuzhiyun 
2134*4882a593Smuzhiyun 	/* stop async schedule right now? */
2135*4882a593Smuzhiyun 	if (unlikely(qh == oxu->async)) {
2136*4882a593Smuzhiyun 		/* can't get here without STS_ASS set */
2137*4882a593Smuzhiyun 		if (oxu_to_hcd(oxu)->state != HC_STATE_HALT
2138*4882a593Smuzhiyun 				&& !oxu->reclaim) {
2139*4882a593Smuzhiyun 			/* ... and CMD_IAAD clear */
2140*4882a593Smuzhiyun 			writel(cmd & ~CMD_ASE, &oxu->regs->command);
2141*4882a593Smuzhiyun 			wmb();
2142*4882a593Smuzhiyun 			/* handshake later, if we need to */
2143*4882a593Smuzhiyun 			timer_action_done(oxu, TIMER_ASYNC_OFF);
2144*4882a593Smuzhiyun 		}
2145*4882a593Smuzhiyun 		return;
2146*4882a593Smuzhiyun 	}
2147*4882a593Smuzhiyun 
2148*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_UNLINK;
2149*4882a593Smuzhiyun 	oxu->reclaim = qh = qh_get(qh);
2150*4882a593Smuzhiyun 
2151*4882a593Smuzhiyun 	prev = oxu->async;
2152*4882a593Smuzhiyun 	while (prev->qh_next.qh != qh)
2153*4882a593Smuzhiyun 		prev = prev->qh_next.qh;
2154*4882a593Smuzhiyun 
2155*4882a593Smuzhiyun 	prev->hw_next = qh->hw_next;
2156*4882a593Smuzhiyun 	prev->qh_next = qh->qh_next;
2157*4882a593Smuzhiyun 	wmb();
2158*4882a593Smuzhiyun 
2159*4882a593Smuzhiyun 	if (unlikely(oxu_to_hcd(oxu)->state == HC_STATE_HALT)) {
2160*4882a593Smuzhiyun 		/* if (unlikely(qh->reclaim != 0))
2161*4882a593Smuzhiyun 		 *	this will recurse, probably not much
2162*4882a593Smuzhiyun 		 */
2163*4882a593Smuzhiyun 		end_unlink_async(oxu);
2164*4882a593Smuzhiyun 		return;
2165*4882a593Smuzhiyun 	}
2166*4882a593Smuzhiyun 
2167*4882a593Smuzhiyun 	oxu->reclaim_ready = 0;
2168*4882a593Smuzhiyun 	cmd |= CMD_IAAD;
2169*4882a593Smuzhiyun 	writel(cmd, &oxu->regs->command);
2170*4882a593Smuzhiyun 	(void) readl(&oxu->regs->command);
2171*4882a593Smuzhiyun 	timer_action(oxu, TIMER_IAA_WATCHDOG);
2172*4882a593Smuzhiyun }
2173*4882a593Smuzhiyun 
scan_async(struct oxu_hcd * oxu)2174*4882a593Smuzhiyun static void scan_async(struct oxu_hcd *oxu)
2175*4882a593Smuzhiyun {
2176*4882a593Smuzhiyun 	struct ehci_qh *qh;
2177*4882a593Smuzhiyun 	enum ehci_timer_action action = TIMER_IO_WATCHDOG;
2178*4882a593Smuzhiyun 
2179*4882a593Smuzhiyun 	if (!++(oxu->stamp))
2180*4882a593Smuzhiyun 		oxu->stamp++;
2181*4882a593Smuzhiyun 	timer_action_done(oxu, TIMER_ASYNC_SHRINK);
2182*4882a593Smuzhiyun rescan:
2183*4882a593Smuzhiyun 	qh = oxu->async->qh_next.qh;
2184*4882a593Smuzhiyun 	if (likely(qh != NULL)) {
2185*4882a593Smuzhiyun 		do {
2186*4882a593Smuzhiyun 			/* clean any finished work for this qh */
2187*4882a593Smuzhiyun 			if (!list_empty(&qh->qtd_list)
2188*4882a593Smuzhiyun 					&& qh->stamp != oxu->stamp) {
2189*4882a593Smuzhiyun 				int temp;
2190*4882a593Smuzhiyun 
2191*4882a593Smuzhiyun 				/* unlinks could happen here; completion
2192*4882a593Smuzhiyun 				 * reporting drops the lock.  rescan using
2193*4882a593Smuzhiyun 				 * the latest schedule, but don't rescan
2194*4882a593Smuzhiyun 				 * qhs we already finished (no looping).
2195*4882a593Smuzhiyun 				 */
2196*4882a593Smuzhiyun 				qh = qh_get(qh);
2197*4882a593Smuzhiyun 				qh->stamp = oxu->stamp;
2198*4882a593Smuzhiyun 				temp = qh_completions(oxu, qh);
2199*4882a593Smuzhiyun 				qh_put(qh);
2200*4882a593Smuzhiyun 				if (temp != 0)
2201*4882a593Smuzhiyun 					goto rescan;
2202*4882a593Smuzhiyun 			}
2203*4882a593Smuzhiyun 
2204*4882a593Smuzhiyun 			/* unlink idle entries, reducing HC PCI usage as well
2205*4882a593Smuzhiyun 			 * as HCD schedule-scanning costs.  delay for any qh
2206*4882a593Smuzhiyun 			 * we just scanned, there's a not-unusual case that it
2207*4882a593Smuzhiyun 			 * doesn't stay idle for long.
2208*4882a593Smuzhiyun 			 * (plus, avoids some kind of re-activation race.)
2209*4882a593Smuzhiyun 			 */
2210*4882a593Smuzhiyun 			if (list_empty(&qh->qtd_list)) {
2211*4882a593Smuzhiyun 				if (qh->stamp == oxu->stamp)
2212*4882a593Smuzhiyun 					action = TIMER_ASYNC_SHRINK;
2213*4882a593Smuzhiyun 				else if (!oxu->reclaim
2214*4882a593Smuzhiyun 					    && qh->qh_state == QH_STATE_LINKED)
2215*4882a593Smuzhiyun 					start_unlink_async(oxu, qh);
2216*4882a593Smuzhiyun 			}
2217*4882a593Smuzhiyun 
2218*4882a593Smuzhiyun 			qh = qh->qh_next.qh;
2219*4882a593Smuzhiyun 		} while (qh);
2220*4882a593Smuzhiyun 	}
2221*4882a593Smuzhiyun 	if (action == TIMER_ASYNC_SHRINK)
2222*4882a593Smuzhiyun 		timer_action(oxu, TIMER_ASYNC_SHRINK);
2223*4882a593Smuzhiyun }
2224*4882a593Smuzhiyun 
2225*4882a593Smuzhiyun /*
2226*4882a593Smuzhiyun  * periodic_next_shadow - return "next" pointer on shadow list
2227*4882a593Smuzhiyun  * @periodic: host pointer to qh/itd/sitd
2228*4882a593Smuzhiyun  * @tag: hardware tag for type of this record
2229*4882a593Smuzhiyun  */
periodic_next_shadow(union ehci_shadow * periodic,__le32 tag)2230*4882a593Smuzhiyun static union ehci_shadow *periodic_next_shadow(union ehci_shadow *periodic,
2231*4882a593Smuzhiyun 						__le32 tag)
2232*4882a593Smuzhiyun {
2233*4882a593Smuzhiyun 	switch (tag) {
2234*4882a593Smuzhiyun 	default:
2235*4882a593Smuzhiyun 	case Q_TYPE_QH:
2236*4882a593Smuzhiyun 		return &periodic->qh->qh_next;
2237*4882a593Smuzhiyun 	}
2238*4882a593Smuzhiyun }
2239*4882a593Smuzhiyun 
2240*4882a593Smuzhiyun /* caller must hold oxu->lock */
periodic_unlink(struct oxu_hcd * oxu,unsigned frame,void * ptr)2241*4882a593Smuzhiyun static void periodic_unlink(struct oxu_hcd *oxu, unsigned frame, void *ptr)
2242*4882a593Smuzhiyun {
2243*4882a593Smuzhiyun 	union ehci_shadow *prev_p = &oxu->pshadow[frame];
2244*4882a593Smuzhiyun 	__le32 *hw_p = &oxu->periodic[frame];
2245*4882a593Smuzhiyun 	union ehci_shadow here = *prev_p;
2246*4882a593Smuzhiyun 
2247*4882a593Smuzhiyun 	/* find predecessor of "ptr"; hw and shadow lists are in sync */
2248*4882a593Smuzhiyun 	while (here.ptr && here.ptr != ptr) {
2249*4882a593Smuzhiyun 		prev_p = periodic_next_shadow(prev_p, Q_NEXT_TYPE(*hw_p));
2250*4882a593Smuzhiyun 		hw_p = here.hw_next;
2251*4882a593Smuzhiyun 		here = *prev_p;
2252*4882a593Smuzhiyun 	}
2253*4882a593Smuzhiyun 	/* an interrupt entry (at list end) could have been shared */
2254*4882a593Smuzhiyun 	if (!here.ptr)
2255*4882a593Smuzhiyun 		return;
2256*4882a593Smuzhiyun 
2257*4882a593Smuzhiyun 	/* update shadow and hardware lists ... the old "next" pointers
2258*4882a593Smuzhiyun 	 * from ptr may still be in use, the caller updates them.
2259*4882a593Smuzhiyun 	 */
2260*4882a593Smuzhiyun 	*prev_p = *periodic_next_shadow(&here, Q_NEXT_TYPE(*hw_p));
2261*4882a593Smuzhiyun 	*hw_p = *here.hw_next;
2262*4882a593Smuzhiyun }
2263*4882a593Smuzhiyun 
2264*4882a593Smuzhiyun /* how many of the uframe's 125 usecs are allocated? */
periodic_usecs(struct oxu_hcd * oxu,unsigned frame,unsigned uframe)2265*4882a593Smuzhiyun static unsigned short periodic_usecs(struct oxu_hcd *oxu,
2266*4882a593Smuzhiyun 					unsigned frame, unsigned uframe)
2267*4882a593Smuzhiyun {
2268*4882a593Smuzhiyun 	__le32 *hw_p = &oxu->periodic[frame];
2269*4882a593Smuzhiyun 	union ehci_shadow *q = &oxu->pshadow[frame];
2270*4882a593Smuzhiyun 	unsigned usecs = 0;
2271*4882a593Smuzhiyun 
2272*4882a593Smuzhiyun 	while (q->ptr) {
2273*4882a593Smuzhiyun 		switch (Q_NEXT_TYPE(*hw_p)) {
2274*4882a593Smuzhiyun 		case Q_TYPE_QH:
2275*4882a593Smuzhiyun 		default:
2276*4882a593Smuzhiyun 			/* is it in the S-mask? */
2277*4882a593Smuzhiyun 			if (q->qh->hw_info2 & cpu_to_le32(1 << uframe))
2278*4882a593Smuzhiyun 				usecs += q->qh->usecs;
2279*4882a593Smuzhiyun 			/* ... or C-mask? */
2280*4882a593Smuzhiyun 			if (q->qh->hw_info2 & cpu_to_le32(1 << (8 + uframe)))
2281*4882a593Smuzhiyun 				usecs += q->qh->c_usecs;
2282*4882a593Smuzhiyun 			hw_p = &q->qh->hw_next;
2283*4882a593Smuzhiyun 			q = &q->qh->qh_next;
2284*4882a593Smuzhiyun 			break;
2285*4882a593Smuzhiyun 		}
2286*4882a593Smuzhiyun 	}
2287*4882a593Smuzhiyun #ifdef DEBUG
2288*4882a593Smuzhiyun 	if (usecs > 100)
2289*4882a593Smuzhiyun 		oxu_err(oxu, "uframe %d sched overrun: %d usecs\n",
2290*4882a593Smuzhiyun 						frame * 8 + uframe, usecs);
2291*4882a593Smuzhiyun #endif
2292*4882a593Smuzhiyun 	return usecs;
2293*4882a593Smuzhiyun }
2294*4882a593Smuzhiyun 
enable_periodic(struct oxu_hcd * oxu)2295*4882a593Smuzhiyun static int enable_periodic(struct oxu_hcd *oxu)
2296*4882a593Smuzhiyun {
2297*4882a593Smuzhiyun 	u32 cmd;
2298*4882a593Smuzhiyun 	int status;
2299*4882a593Smuzhiyun 
2300*4882a593Smuzhiyun 	/* did clearing PSE did take effect yet?
2301*4882a593Smuzhiyun 	 * takes effect only at frame boundaries...
2302*4882a593Smuzhiyun 	 */
2303*4882a593Smuzhiyun 	status = handshake(oxu, &oxu->regs->status, STS_PSS, 0, 9 * 125);
2304*4882a593Smuzhiyun 	if (status != 0) {
2305*4882a593Smuzhiyun 		oxu_to_hcd(oxu)->state = HC_STATE_HALT;
2306*4882a593Smuzhiyun 		usb_hc_died(oxu_to_hcd(oxu));
2307*4882a593Smuzhiyun 		return status;
2308*4882a593Smuzhiyun 	}
2309*4882a593Smuzhiyun 
2310*4882a593Smuzhiyun 	cmd = readl(&oxu->regs->command) | CMD_PSE;
2311*4882a593Smuzhiyun 	writel(cmd, &oxu->regs->command);
2312*4882a593Smuzhiyun 	/* posted write ... PSS happens later */
2313*4882a593Smuzhiyun 	oxu_to_hcd(oxu)->state = HC_STATE_RUNNING;
2314*4882a593Smuzhiyun 
2315*4882a593Smuzhiyun 	/* make sure ehci_work scans these */
2316*4882a593Smuzhiyun 	oxu->next_uframe = readl(&oxu->regs->frame_index)
2317*4882a593Smuzhiyun 		% (oxu->periodic_size << 3);
2318*4882a593Smuzhiyun 	return 0;
2319*4882a593Smuzhiyun }
2320*4882a593Smuzhiyun 
disable_periodic(struct oxu_hcd * oxu)2321*4882a593Smuzhiyun static int disable_periodic(struct oxu_hcd *oxu)
2322*4882a593Smuzhiyun {
2323*4882a593Smuzhiyun 	u32 cmd;
2324*4882a593Smuzhiyun 	int status;
2325*4882a593Smuzhiyun 
2326*4882a593Smuzhiyun 	/* did setting PSE not take effect yet?
2327*4882a593Smuzhiyun 	 * takes effect only at frame boundaries...
2328*4882a593Smuzhiyun 	 */
2329*4882a593Smuzhiyun 	status = handshake(oxu, &oxu->regs->status, STS_PSS, STS_PSS, 9 * 125);
2330*4882a593Smuzhiyun 	if (status != 0) {
2331*4882a593Smuzhiyun 		oxu_to_hcd(oxu)->state = HC_STATE_HALT;
2332*4882a593Smuzhiyun 		usb_hc_died(oxu_to_hcd(oxu));
2333*4882a593Smuzhiyun 		return status;
2334*4882a593Smuzhiyun 	}
2335*4882a593Smuzhiyun 
2336*4882a593Smuzhiyun 	cmd = readl(&oxu->regs->command) & ~CMD_PSE;
2337*4882a593Smuzhiyun 	writel(cmd, &oxu->regs->command);
2338*4882a593Smuzhiyun 	/* posted write ... */
2339*4882a593Smuzhiyun 
2340*4882a593Smuzhiyun 	oxu->next_uframe = -1;
2341*4882a593Smuzhiyun 	return 0;
2342*4882a593Smuzhiyun }
2343*4882a593Smuzhiyun 
2344*4882a593Smuzhiyun /* periodic schedule slots have iso tds (normal or split) first, then a
2345*4882a593Smuzhiyun  * sparse tree for active interrupt transfers.
2346*4882a593Smuzhiyun  *
2347*4882a593Smuzhiyun  * this just links in a qh; caller guarantees uframe masks are set right.
2348*4882a593Smuzhiyun  * no FSTN support (yet; oxu 0.96+)
2349*4882a593Smuzhiyun  */
qh_link_periodic(struct oxu_hcd * oxu,struct ehci_qh * qh)2350*4882a593Smuzhiyun static int qh_link_periodic(struct oxu_hcd *oxu, struct ehci_qh *qh)
2351*4882a593Smuzhiyun {
2352*4882a593Smuzhiyun 	unsigned i;
2353*4882a593Smuzhiyun 	unsigned period = qh->period;
2354*4882a593Smuzhiyun 
2355*4882a593Smuzhiyun 	dev_dbg(&qh->dev->dev,
2356*4882a593Smuzhiyun 		"link qh%d-%04x/%p start %d [%d/%d us]\n",
2357*4882a593Smuzhiyun 		period, le32_to_cpup(&qh->hw_info2) & (QH_CMASK | QH_SMASK),
2358*4882a593Smuzhiyun 		qh, qh->start, qh->usecs, qh->c_usecs);
2359*4882a593Smuzhiyun 
2360*4882a593Smuzhiyun 	/* high bandwidth, or otherwise every microframe */
2361*4882a593Smuzhiyun 	if (period == 0)
2362*4882a593Smuzhiyun 		period = 1;
2363*4882a593Smuzhiyun 
2364*4882a593Smuzhiyun 	for (i = qh->start; i < oxu->periodic_size; i += period) {
2365*4882a593Smuzhiyun 		union ehci_shadow	*prev = &oxu->pshadow[i];
2366*4882a593Smuzhiyun 		__le32			*hw_p = &oxu->periodic[i];
2367*4882a593Smuzhiyun 		union ehci_shadow	here = *prev;
2368*4882a593Smuzhiyun 		__le32			type = 0;
2369*4882a593Smuzhiyun 
2370*4882a593Smuzhiyun 		/* skip the iso nodes at list head */
2371*4882a593Smuzhiyun 		while (here.ptr) {
2372*4882a593Smuzhiyun 			type = Q_NEXT_TYPE(*hw_p);
2373*4882a593Smuzhiyun 			if (type == Q_TYPE_QH)
2374*4882a593Smuzhiyun 				break;
2375*4882a593Smuzhiyun 			prev = periodic_next_shadow(prev, type);
2376*4882a593Smuzhiyun 			hw_p = &here.qh->hw_next;
2377*4882a593Smuzhiyun 			here = *prev;
2378*4882a593Smuzhiyun 		}
2379*4882a593Smuzhiyun 
2380*4882a593Smuzhiyun 		/* sorting each branch by period (slow-->fast)
2381*4882a593Smuzhiyun 		 * enables sharing interior tree nodes
2382*4882a593Smuzhiyun 		 */
2383*4882a593Smuzhiyun 		while (here.ptr && qh != here.qh) {
2384*4882a593Smuzhiyun 			if (qh->period > here.qh->period)
2385*4882a593Smuzhiyun 				break;
2386*4882a593Smuzhiyun 			prev = &here.qh->qh_next;
2387*4882a593Smuzhiyun 			hw_p = &here.qh->hw_next;
2388*4882a593Smuzhiyun 			here = *prev;
2389*4882a593Smuzhiyun 		}
2390*4882a593Smuzhiyun 		/* link in this qh, unless some earlier pass did that */
2391*4882a593Smuzhiyun 		if (qh != here.qh) {
2392*4882a593Smuzhiyun 			qh->qh_next = here;
2393*4882a593Smuzhiyun 			if (here.qh)
2394*4882a593Smuzhiyun 				qh->hw_next = *hw_p;
2395*4882a593Smuzhiyun 			wmb();
2396*4882a593Smuzhiyun 			prev->qh = qh;
2397*4882a593Smuzhiyun 			*hw_p = QH_NEXT(qh->qh_dma);
2398*4882a593Smuzhiyun 		}
2399*4882a593Smuzhiyun 	}
2400*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_LINKED;
2401*4882a593Smuzhiyun 	qh_get(qh);
2402*4882a593Smuzhiyun 
2403*4882a593Smuzhiyun 	/* update per-qh bandwidth for usbfs */
2404*4882a593Smuzhiyun 	oxu_to_hcd(oxu)->self.bandwidth_allocated += qh->period
2405*4882a593Smuzhiyun 		? ((qh->usecs + qh->c_usecs) / qh->period)
2406*4882a593Smuzhiyun 		: (qh->usecs * 8);
2407*4882a593Smuzhiyun 
2408*4882a593Smuzhiyun 	/* maybe enable periodic schedule processing */
2409*4882a593Smuzhiyun 	if (!oxu->periodic_sched++)
2410*4882a593Smuzhiyun 		return enable_periodic(oxu);
2411*4882a593Smuzhiyun 
2412*4882a593Smuzhiyun 	return 0;
2413*4882a593Smuzhiyun }
2414*4882a593Smuzhiyun 
qh_unlink_periodic(struct oxu_hcd * oxu,struct ehci_qh * qh)2415*4882a593Smuzhiyun static void qh_unlink_periodic(struct oxu_hcd *oxu, struct ehci_qh *qh)
2416*4882a593Smuzhiyun {
2417*4882a593Smuzhiyun 	unsigned i;
2418*4882a593Smuzhiyun 	unsigned period;
2419*4882a593Smuzhiyun 
2420*4882a593Smuzhiyun 	/* FIXME:
2421*4882a593Smuzhiyun 	 *   IF this isn't high speed
2422*4882a593Smuzhiyun 	 *   and this qh is active in the current uframe
2423*4882a593Smuzhiyun 	 *   (and overlay token SplitXstate is false?)
2424*4882a593Smuzhiyun 	 * THEN
2425*4882a593Smuzhiyun 	 *   qh->hw_info1 |= cpu_to_le32(1 << 7 "ignore");
2426*4882a593Smuzhiyun 	 */
2427*4882a593Smuzhiyun 
2428*4882a593Smuzhiyun 	/* high bandwidth, or otherwise part of every microframe */
2429*4882a593Smuzhiyun 	period = qh->period;
2430*4882a593Smuzhiyun 	if (period == 0)
2431*4882a593Smuzhiyun 		period = 1;
2432*4882a593Smuzhiyun 
2433*4882a593Smuzhiyun 	for (i = qh->start; i < oxu->periodic_size; i += period)
2434*4882a593Smuzhiyun 		periodic_unlink(oxu, i, qh);
2435*4882a593Smuzhiyun 
2436*4882a593Smuzhiyun 	/* update per-qh bandwidth for usbfs */
2437*4882a593Smuzhiyun 	oxu_to_hcd(oxu)->self.bandwidth_allocated -= qh->period
2438*4882a593Smuzhiyun 		? ((qh->usecs + qh->c_usecs) / qh->period)
2439*4882a593Smuzhiyun 		: (qh->usecs * 8);
2440*4882a593Smuzhiyun 
2441*4882a593Smuzhiyun 	dev_dbg(&qh->dev->dev,
2442*4882a593Smuzhiyun 		"unlink qh%d-%04x/%p start %d [%d/%d us]\n",
2443*4882a593Smuzhiyun 		qh->period,
2444*4882a593Smuzhiyun 		le32_to_cpup(&qh->hw_info2) & (QH_CMASK | QH_SMASK),
2445*4882a593Smuzhiyun 		qh, qh->start, qh->usecs, qh->c_usecs);
2446*4882a593Smuzhiyun 
2447*4882a593Smuzhiyun 	/* qh->qh_next still "live" to HC */
2448*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_UNLINK;
2449*4882a593Smuzhiyun 	qh->qh_next.ptr = NULL;
2450*4882a593Smuzhiyun 	qh_put(qh);
2451*4882a593Smuzhiyun 
2452*4882a593Smuzhiyun 	/* maybe turn off periodic schedule */
2453*4882a593Smuzhiyun 	oxu->periodic_sched--;
2454*4882a593Smuzhiyun 	if (!oxu->periodic_sched)
2455*4882a593Smuzhiyun 		(void) disable_periodic(oxu);
2456*4882a593Smuzhiyun }
2457*4882a593Smuzhiyun 
intr_deschedule(struct oxu_hcd * oxu,struct ehci_qh * qh)2458*4882a593Smuzhiyun static void intr_deschedule(struct oxu_hcd *oxu, struct ehci_qh *qh)
2459*4882a593Smuzhiyun {
2460*4882a593Smuzhiyun 	unsigned wait;
2461*4882a593Smuzhiyun 
2462*4882a593Smuzhiyun 	qh_unlink_periodic(oxu, qh);
2463*4882a593Smuzhiyun 
2464*4882a593Smuzhiyun 	/* simple/paranoid:  always delay, expecting the HC needs to read
2465*4882a593Smuzhiyun 	 * qh->hw_next or finish a writeback after SPLIT/CSPLIT ... and
2466*4882a593Smuzhiyun 	 * expect hub_wq to clean up after any CSPLITs we won't issue.
2467*4882a593Smuzhiyun 	 * active high speed queues may need bigger delays...
2468*4882a593Smuzhiyun 	 */
2469*4882a593Smuzhiyun 	if (list_empty(&qh->qtd_list)
2470*4882a593Smuzhiyun 		|| (cpu_to_le32(QH_CMASK) & qh->hw_info2) != 0)
2471*4882a593Smuzhiyun 		wait = 2;
2472*4882a593Smuzhiyun 	else
2473*4882a593Smuzhiyun 		wait = 55;	/* worst case: 3 * 1024 */
2474*4882a593Smuzhiyun 
2475*4882a593Smuzhiyun 	udelay(wait);
2476*4882a593Smuzhiyun 	qh->qh_state = QH_STATE_IDLE;
2477*4882a593Smuzhiyun 	qh->hw_next = EHCI_LIST_END;
2478*4882a593Smuzhiyun 	wmb();
2479*4882a593Smuzhiyun }
2480*4882a593Smuzhiyun 
check_period(struct oxu_hcd * oxu,unsigned frame,unsigned uframe,unsigned period,unsigned usecs)2481*4882a593Smuzhiyun static int check_period(struct oxu_hcd *oxu,
2482*4882a593Smuzhiyun 			unsigned frame, unsigned uframe,
2483*4882a593Smuzhiyun 			unsigned period, unsigned usecs)
2484*4882a593Smuzhiyun {
2485*4882a593Smuzhiyun 	int claimed;
2486*4882a593Smuzhiyun 
2487*4882a593Smuzhiyun 	/* complete split running into next frame?
2488*4882a593Smuzhiyun 	 * given FSTN support, we could sometimes check...
2489*4882a593Smuzhiyun 	 */
2490*4882a593Smuzhiyun 	if (uframe >= 8)
2491*4882a593Smuzhiyun 		return 0;
2492*4882a593Smuzhiyun 
2493*4882a593Smuzhiyun 	/*
2494*4882a593Smuzhiyun 	 * 80% periodic == 100 usec/uframe available
2495*4882a593Smuzhiyun 	 * convert "usecs we need" to "max already claimed"
2496*4882a593Smuzhiyun 	 */
2497*4882a593Smuzhiyun 	usecs = 100 - usecs;
2498*4882a593Smuzhiyun 
2499*4882a593Smuzhiyun 	/* we "know" 2 and 4 uframe intervals were rejected; so
2500*4882a593Smuzhiyun 	 * for period 0, check _every_ microframe in the schedule.
2501*4882a593Smuzhiyun 	 */
2502*4882a593Smuzhiyun 	if (unlikely(period == 0)) {
2503*4882a593Smuzhiyun 		do {
2504*4882a593Smuzhiyun 			for (uframe = 0; uframe < 7; uframe++) {
2505*4882a593Smuzhiyun 				claimed = periodic_usecs(oxu, frame, uframe);
2506*4882a593Smuzhiyun 				if (claimed > usecs)
2507*4882a593Smuzhiyun 					return 0;
2508*4882a593Smuzhiyun 			}
2509*4882a593Smuzhiyun 		} while ((frame += 1) < oxu->periodic_size);
2510*4882a593Smuzhiyun 
2511*4882a593Smuzhiyun 	/* just check the specified uframe, at that period */
2512*4882a593Smuzhiyun 	} else {
2513*4882a593Smuzhiyun 		do {
2514*4882a593Smuzhiyun 			claimed = periodic_usecs(oxu, frame, uframe);
2515*4882a593Smuzhiyun 			if (claimed > usecs)
2516*4882a593Smuzhiyun 				return 0;
2517*4882a593Smuzhiyun 		} while ((frame += period) < oxu->periodic_size);
2518*4882a593Smuzhiyun 	}
2519*4882a593Smuzhiyun 
2520*4882a593Smuzhiyun 	return 1;
2521*4882a593Smuzhiyun }
2522*4882a593Smuzhiyun 
check_intr_schedule(struct oxu_hcd * oxu,unsigned frame,unsigned uframe,const struct ehci_qh * qh,__le32 * c_maskp)2523*4882a593Smuzhiyun static int check_intr_schedule(struct oxu_hcd	*oxu,
2524*4882a593Smuzhiyun 				unsigned frame, unsigned uframe,
2525*4882a593Smuzhiyun 				const struct ehci_qh *qh, __le32 *c_maskp)
2526*4882a593Smuzhiyun {
2527*4882a593Smuzhiyun 	int retval = -ENOSPC;
2528*4882a593Smuzhiyun 
2529*4882a593Smuzhiyun 	if (qh->c_usecs && uframe >= 6)		/* FSTN territory? */
2530*4882a593Smuzhiyun 		goto done;
2531*4882a593Smuzhiyun 
2532*4882a593Smuzhiyun 	if (!check_period(oxu, frame, uframe, qh->period, qh->usecs))
2533*4882a593Smuzhiyun 		goto done;
2534*4882a593Smuzhiyun 	if (!qh->c_usecs) {
2535*4882a593Smuzhiyun 		retval = 0;
2536*4882a593Smuzhiyun 		*c_maskp = 0;
2537*4882a593Smuzhiyun 		goto done;
2538*4882a593Smuzhiyun 	}
2539*4882a593Smuzhiyun 
2540*4882a593Smuzhiyun done:
2541*4882a593Smuzhiyun 	return retval;
2542*4882a593Smuzhiyun }
2543*4882a593Smuzhiyun 
2544*4882a593Smuzhiyun /* "first fit" scheduling policy used the first time through,
2545*4882a593Smuzhiyun  * or when the previous schedule slot can't be re-used.
2546*4882a593Smuzhiyun  */
qh_schedule(struct oxu_hcd * oxu,struct ehci_qh * qh)2547*4882a593Smuzhiyun static int qh_schedule(struct oxu_hcd *oxu, struct ehci_qh *qh)
2548*4882a593Smuzhiyun {
2549*4882a593Smuzhiyun 	int		status;
2550*4882a593Smuzhiyun 	unsigned	uframe;
2551*4882a593Smuzhiyun 	__le32		c_mask;
2552*4882a593Smuzhiyun 	unsigned	frame;		/* 0..(qh->period - 1), or NO_FRAME */
2553*4882a593Smuzhiyun 
2554*4882a593Smuzhiyun 	qh_refresh(oxu, qh);
2555*4882a593Smuzhiyun 	qh->hw_next = EHCI_LIST_END;
2556*4882a593Smuzhiyun 	frame = qh->start;
2557*4882a593Smuzhiyun 
2558*4882a593Smuzhiyun 	/* reuse the previous schedule slots, if we can */
2559*4882a593Smuzhiyun 	if (frame < qh->period) {
2560*4882a593Smuzhiyun 		uframe = ffs(le32_to_cpup(&qh->hw_info2) & QH_SMASK);
2561*4882a593Smuzhiyun 		status = check_intr_schedule(oxu, frame, --uframe,
2562*4882a593Smuzhiyun 				qh, &c_mask);
2563*4882a593Smuzhiyun 	} else {
2564*4882a593Smuzhiyun 		uframe = 0;
2565*4882a593Smuzhiyun 		c_mask = 0;
2566*4882a593Smuzhiyun 		status = -ENOSPC;
2567*4882a593Smuzhiyun 	}
2568*4882a593Smuzhiyun 
2569*4882a593Smuzhiyun 	/* else scan the schedule to find a group of slots such that all
2570*4882a593Smuzhiyun 	 * uframes have enough periodic bandwidth available.
2571*4882a593Smuzhiyun 	 */
2572*4882a593Smuzhiyun 	if (status) {
2573*4882a593Smuzhiyun 		/* "normal" case, uframing flexible except with splits */
2574*4882a593Smuzhiyun 		if (qh->period) {
2575*4882a593Smuzhiyun 			frame = qh->period - 1;
2576*4882a593Smuzhiyun 			do {
2577*4882a593Smuzhiyun 				for (uframe = 0; uframe < 8; uframe++) {
2578*4882a593Smuzhiyun 					status = check_intr_schedule(oxu,
2579*4882a593Smuzhiyun 							frame, uframe, qh,
2580*4882a593Smuzhiyun 							&c_mask);
2581*4882a593Smuzhiyun 					if (status == 0)
2582*4882a593Smuzhiyun 						break;
2583*4882a593Smuzhiyun 				}
2584*4882a593Smuzhiyun 			} while (status && frame--);
2585*4882a593Smuzhiyun 
2586*4882a593Smuzhiyun 		/* qh->period == 0 means every uframe */
2587*4882a593Smuzhiyun 		} else {
2588*4882a593Smuzhiyun 			frame = 0;
2589*4882a593Smuzhiyun 			status = check_intr_schedule(oxu, 0, 0, qh, &c_mask);
2590*4882a593Smuzhiyun 		}
2591*4882a593Smuzhiyun 		if (status)
2592*4882a593Smuzhiyun 			goto done;
2593*4882a593Smuzhiyun 		qh->start = frame;
2594*4882a593Smuzhiyun 
2595*4882a593Smuzhiyun 		/* reset S-frame and (maybe) C-frame masks */
2596*4882a593Smuzhiyun 		qh->hw_info2 &= cpu_to_le32(~(QH_CMASK | QH_SMASK));
2597*4882a593Smuzhiyun 		qh->hw_info2 |= qh->period
2598*4882a593Smuzhiyun 			? cpu_to_le32(1 << uframe)
2599*4882a593Smuzhiyun 			: cpu_to_le32(QH_SMASK);
2600*4882a593Smuzhiyun 		qh->hw_info2 |= c_mask;
2601*4882a593Smuzhiyun 	} else
2602*4882a593Smuzhiyun 		oxu_dbg(oxu, "reused qh %p schedule\n", qh);
2603*4882a593Smuzhiyun 
2604*4882a593Smuzhiyun 	/* stuff into the periodic schedule */
2605*4882a593Smuzhiyun 	status = qh_link_periodic(oxu, qh);
2606*4882a593Smuzhiyun done:
2607*4882a593Smuzhiyun 	return status;
2608*4882a593Smuzhiyun }
2609*4882a593Smuzhiyun 
intr_submit(struct oxu_hcd * oxu,struct urb * urb,struct list_head * qtd_list,gfp_t mem_flags)2610*4882a593Smuzhiyun static int intr_submit(struct oxu_hcd *oxu, struct urb *urb,
2611*4882a593Smuzhiyun 			struct list_head *qtd_list, gfp_t mem_flags)
2612*4882a593Smuzhiyun {
2613*4882a593Smuzhiyun 	unsigned epnum;
2614*4882a593Smuzhiyun 	unsigned long flags;
2615*4882a593Smuzhiyun 	struct ehci_qh *qh;
2616*4882a593Smuzhiyun 	int status = 0;
2617*4882a593Smuzhiyun 	struct list_head	empty;
2618*4882a593Smuzhiyun 
2619*4882a593Smuzhiyun 	/* get endpoint and transfer/schedule data */
2620*4882a593Smuzhiyun 	epnum = urb->ep->desc.bEndpointAddress;
2621*4882a593Smuzhiyun 
2622*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
2623*4882a593Smuzhiyun 
2624*4882a593Smuzhiyun 	if (unlikely(!HCD_HW_ACCESSIBLE(oxu_to_hcd(oxu)))) {
2625*4882a593Smuzhiyun 		status = -ESHUTDOWN;
2626*4882a593Smuzhiyun 		goto done;
2627*4882a593Smuzhiyun 	}
2628*4882a593Smuzhiyun 
2629*4882a593Smuzhiyun 	/* get qh and force any scheduling errors */
2630*4882a593Smuzhiyun 	INIT_LIST_HEAD(&empty);
2631*4882a593Smuzhiyun 	qh = qh_append_tds(oxu, urb, &empty, epnum, &urb->ep->hcpriv);
2632*4882a593Smuzhiyun 	if (qh == NULL) {
2633*4882a593Smuzhiyun 		status = -ENOMEM;
2634*4882a593Smuzhiyun 		goto done;
2635*4882a593Smuzhiyun 	}
2636*4882a593Smuzhiyun 	if (qh->qh_state == QH_STATE_IDLE) {
2637*4882a593Smuzhiyun 		status = qh_schedule(oxu, qh);
2638*4882a593Smuzhiyun 		if (status != 0)
2639*4882a593Smuzhiyun 			goto done;
2640*4882a593Smuzhiyun 	}
2641*4882a593Smuzhiyun 
2642*4882a593Smuzhiyun 	/* then queue the urb's tds to the qh */
2643*4882a593Smuzhiyun 	qh = qh_append_tds(oxu, urb, qtd_list, epnum, &urb->ep->hcpriv);
2644*4882a593Smuzhiyun 	BUG_ON(qh == NULL);
2645*4882a593Smuzhiyun 
2646*4882a593Smuzhiyun 	/* ... update usbfs periodic stats */
2647*4882a593Smuzhiyun 	oxu_to_hcd(oxu)->self.bandwidth_int_reqs++;
2648*4882a593Smuzhiyun 
2649*4882a593Smuzhiyun done:
2650*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
2651*4882a593Smuzhiyun 	if (status)
2652*4882a593Smuzhiyun 		qtd_list_free(oxu, urb, qtd_list);
2653*4882a593Smuzhiyun 
2654*4882a593Smuzhiyun 	return status;
2655*4882a593Smuzhiyun }
2656*4882a593Smuzhiyun 
itd_submit(struct oxu_hcd * oxu,struct urb * urb,gfp_t mem_flags)2657*4882a593Smuzhiyun static inline int itd_submit(struct oxu_hcd *oxu, struct urb *urb,
2658*4882a593Smuzhiyun 						gfp_t mem_flags)
2659*4882a593Smuzhiyun {
2660*4882a593Smuzhiyun 	oxu_dbg(oxu, "iso support is missing!\n");
2661*4882a593Smuzhiyun 	return -ENOSYS;
2662*4882a593Smuzhiyun }
2663*4882a593Smuzhiyun 
sitd_submit(struct oxu_hcd * oxu,struct urb * urb,gfp_t mem_flags)2664*4882a593Smuzhiyun static inline int sitd_submit(struct oxu_hcd *oxu, struct urb *urb,
2665*4882a593Smuzhiyun 						gfp_t mem_flags)
2666*4882a593Smuzhiyun {
2667*4882a593Smuzhiyun 	oxu_dbg(oxu, "split iso support is missing!\n");
2668*4882a593Smuzhiyun 	return -ENOSYS;
2669*4882a593Smuzhiyun }
2670*4882a593Smuzhiyun 
scan_periodic(struct oxu_hcd * oxu)2671*4882a593Smuzhiyun static void scan_periodic(struct oxu_hcd *oxu)
2672*4882a593Smuzhiyun {
2673*4882a593Smuzhiyun 	unsigned frame, clock, now_uframe, mod;
2674*4882a593Smuzhiyun 	unsigned modified;
2675*4882a593Smuzhiyun 
2676*4882a593Smuzhiyun 	mod = oxu->periodic_size << 3;
2677*4882a593Smuzhiyun 
2678*4882a593Smuzhiyun 	/*
2679*4882a593Smuzhiyun 	 * When running, scan from last scan point up to "now"
2680*4882a593Smuzhiyun 	 * else clean up by scanning everything that's left.
2681*4882a593Smuzhiyun 	 * Touches as few pages as possible:  cache-friendly.
2682*4882a593Smuzhiyun 	 */
2683*4882a593Smuzhiyun 	now_uframe = oxu->next_uframe;
2684*4882a593Smuzhiyun 	if (HC_IS_RUNNING(oxu_to_hcd(oxu)->state))
2685*4882a593Smuzhiyun 		clock = readl(&oxu->regs->frame_index);
2686*4882a593Smuzhiyun 	else
2687*4882a593Smuzhiyun 		clock = now_uframe + mod - 1;
2688*4882a593Smuzhiyun 	clock %= mod;
2689*4882a593Smuzhiyun 
2690*4882a593Smuzhiyun 	for (;;) {
2691*4882a593Smuzhiyun 		union ehci_shadow	q, *q_p;
2692*4882a593Smuzhiyun 		__le32			type, *hw_p;
2693*4882a593Smuzhiyun 
2694*4882a593Smuzhiyun 		/* don't scan past the live uframe */
2695*4882a593Smuzhiyun 		frame = now_uframe >> 3;
2696*4882a593Smuzhiyun 		if (frame != (clock >> 3)) {
2697*4882a593Smuzhiyun 			/* safe to scan the whole frame at once */
2698*4882a593Smuzhiyun 			now_uframe |= 0x07;
2699*4882a593Smuzhiyun 		}
2700*4882a593Smuzhiyun 
2701*4882a593Smuzhiyun restart:
2702*4882a593Smuzhiyun 		/* scan each element in frame's queue for completions */
2703*4882a593Smuzhiyun 		q_p = &oxu->pshadow[frame];
2704*4882a593Smuzhiyun 		hw_p = &oxu->periodic[frame];
2705*4882a593Smuzhiyun 		q.ptr = q_p->ptr;
2706*4882a593Smuzhiyun 		type = Q_NEXT_TYPE(*hw_p);
2707*4882a593Smuzhiyun 		modified = 0;
2708*4882a593Smuzhiyun 
2709*4882a593Smuzhiyun 		while (q.ptr != NULL) {
2710*4882a593Smuzhiyun 			union ehci_shadow temp;
2711*4882a593Smuzhiyun 
2712*4882a593Smuzhiyun 			switch (type) {
2713*4882a593Smuzhiyun 			case Q_TYPE_QH:
2714*4882a593Smuzhiyun 				/* handle any completions */
2715*4882a593Smuzhiyun 				temp.qh = qh_get(q.qh);
2716*4882a593Smuzhiyun 				type = Q_NEXT_TYPE(q.qh->hw_next);
2717*4882a593Smuzhiyun 				q = q.qh->qh_next;
2718*4882a593Smuzhiyun 				modified = qh_completions(oxu, temp.qh);
2719*4882a593Smuzhiyun 				if (unlikely(list_empty(&temp.qh->qtd_list)))
2720*4882a593Smuzhiyun 					intr_deschedule(oxu, temp.qh);
2721*4882a593Smuzhiyun 				qh_put(temp.qh);
2722*4882a593Smuzhiyun 				break;
2723*4882a593Smuzhiyun 			default:
2724*4882a593Smuzhiyun 				oxu_dbg(oxu, "corrupt type %d frame %d shadow %p\n",
2725*4882a593Smuzhiyun 					type, frame, q.ptr);
2726*4882a593Smuzhiyun 				q.ptr = NULL;
2727*4882a593Smuzhiyun 			}
2728*4882a593Smuzhiyun 
2729*4882a593Smuzhiyun 			/* assume completion callbacks modify the queue */
2730*4882a593Smuzhiyun 			if (unlikely(modified))
2731*4882a593Smuzhiyun 				goto restart;
2732*4882a593Smuzhiyun 		}
2733*4882a593Smuzhiyun 
2734*4882a593Smuzhiyun 		/* Stop when we catch up to the HC */
2735*4882a593Smuzhiyun 
2736*4882a593Smuzhiyun 		/* FIXME:  this assumes we won't get lapped when
2737*4882a593Smuzhiyun 		 * latencies climb; that should be rare, but...
2738*4882a593Smuzhiyun 		 * detect it, and just go all the way around.
2739*4882a593Smuzhiyun 		 * FLR might help detect this case, so long as latencies
2740*4882a593Smuzhiyun 		 * don't exceed periodic_size msec (default 1.024 sec).
2741*4882a593Smuzhiyun 		 */
2742*4882a593Smuzhiyun 
2743*4882a593Smuzhiyun 		/* FIXME: likewise assumes HC doesn't halt mid-scan */
2744*4882a593Smuzhiyun 
2745*4882a593Smuzhiyun 		if (now_uframe == clock) {
2746*4882a593Smuzhiyun 			unsigned	now;
2747*4882a593Smuzhiyun 
2748*4882a593Smuzhiyun 			if (!HC_IS_RUNNING(oxu_to_hcd(oxu)->state))
2749*4882a593Smuzhiyun 				break;
2750*4882a593Smuzhiyun 			oxu->next_uframe = now_uframe;
2751*4882a593Smuzhiyun 			now = readl(&oxu->regs->frame_index) % mod;
2752*4882a593Smuzhiyun 			if (now_uframe == now)
2753*4882a593Smuzhiyun 				break;
2754*4882a593Smuzhiyun 
2755*4882a593Smuzhiyun 			/* rescan the rest of this frame, then ... */
2756*4882a593Smuzhiyun 			clock = now;
2757*4882a593Smuzhiyun 		} else {
2758*4882a593Smuzhiyun 			now_uframe++;
2759*4882a593Smuzhiyun 			now_uframe %= mod;
2760*4882a593Smuzhiyun 		}
2761*4882a593Smuzhiyun 	}
2762*4882a593Smuzhiyun }
2763*4882a593Smuzhiyun 
2764*4882a593Smuzhiyun /* On some systems, leaving remote wakeup enabled prevents system shutdown.
2765*4882a593Smuzhiyun  * The firmware seems to think that powering off is a wakeup event!
2766*4882a593Smuzhiyun  * This routine turns off remote wakeup and everything else, on all ports.
2767*4882a593Smuzhiyun  */
ehci_turn_off_all_ports(struct oxu_hcd * oxu)2768*4882a593Smuzhiyun static void ehci_turn_off_all_ports(struct oxu_hcd *oxu)
2769*4882a593Smuzhiyun {
2770*4882a593Smuzhiyun 	int port = HCS_N_PORTS(oxu->hcs_params);
2771*4882a593Smuzhiyun 
2772*4882a593Smuzhiyun 	while (port--)
2773*4882a593Smuzhiyun 		writel(PORT_RWC_BITS, &oxu->regs->port_status[port]);
2774*4882a593Smuzhiyun }
2775*4882a593Smuzhiyun 
ehci_port_power(struct oxu_hcd * oxu,int is_on)2776*4882a593Smuzhiyun static void ehci_port_power(struct oxu_hcd *oxu, int is_on)
2777*4882a593Smuzhiyun {
2778*4882a593Smuzhiyun 	unsigned port;
2779*4882a593Smuzhiyun 
2780*4882a593Smuzhiyun 	if (!HCS_PPC(oxu->hcs_params))
2781*4882a593Smuzhiyun 		return;
2782*4882a593Smuzhiyun 
2783*4882a593Smuzhiyun 	oxu_dbg(oxu, "...power%s ports...\n", is_on ? "up" : "down");
2784*4882a593Smuzhiyun 	for (port = HCS_N_PORTS(oxu->hcs_params); port > 0; ) {
2785*4882a593Smuzhiyun 		if (is_on)
2786*4882a593Smuzhiyun 			oxu_hub_control(oxu_to_hcd(oxu), SetPortFeature,
2787*4882a593Smuzhiyun 				USB_PORT_FEAT_POWER, port--, NULL, 0);
2788*4882a593Smuzhiyun 		else
2789*4882a593Smuzhiyun 			oxu_hub_control(oxu_to_hcd(oxu), ClearPortFeature,
2790*4882a593Smuzhiyun 				USB_PORT_FEAT_POWER, port--, NULL, 0);
2791*4882a593Smuzhiyun 	}
2792*4882a593Smuzhiyun 
2793*4882a593Smuzhiyun 	msleep(20);
2794*4882a593Smuzhiyun }
2795*4882a593Smuzhiyun 
2796*4882a593Smuzhiyun /* Called from some interrupts, timers, and so on.
2797*4882a593Smuzhiyun  * It calls driver completion functions, after dropping oxu->lock.
2798*4882a593Smuzhiyun  */
ehci_work(struct oxu_hcd * oxu)2799*4882a593Smuzhiyun static void ehci_work(struct oxu_hcd *oxu)
2800*4882a593Smuzhiyun {
2801*4882a593Smuzhiyun 	timer_action_done(oxu, TIMER_IO_WATCHDOG);
2802*4882a593Smuzhiyun 	if (oxu->reclaim_ready)
2803*4882a593Smuzhiyun 		end_unlink_async(oxu);
2804*4882a593Smuzhiyun 
2805*4882a593Smuzhiyun 	/* another CPU may drop oxu->lock during a schedule scan while
2806*4882a593Smuzhiyun 	 * it reports urb completions.  this flag guards against bogus
2807*4882a593Smuzhiyun 	 * attempts at re-entrant schedule scanning.
2808*4882a593Smuzhiyun 	 */
2809*4882a593Smuzhiyun 	if (oxu->scanning)
2810*4882a593Smuzhiyun 		return;
2811*4882a593Smuzhiyun 	oxu->scanning = 1;
2812*4882a593Smuzhiyun 	scan_async(oxu);
2813*4882a593Smuzhiyun 	if (oxu->next_uframe != -1)
2814*4882a593Smuzhiyun 		scan_periodic(oxu);
2815*4882a593Smuzhiyun 	oxu->scanning = 0;
2816*4882a593Smuzhiyun 
2817*4882a593Smuzhiyun 	/* the IO watchdog guards against hardware or driver bugs that
2818*4882a593Smuzhiyun 	 * misplace IRQs, and should let us run completely without IRQs.
2819*4882a593Smuzhiyun 	 * such lossage has been observed on both VT6202 and VT8235.
2820*4882a593Smuzhiyun 	 */
2821*4882a593Smuzhiyun 	if (HC_IS_RUNNING(oxu_to_hcd(oxu)->state) &&
2822*4882a593Smuzhiyun 			(oxu->async->qh_next.ptr != NULL ||
2823*4882a593Smuzhiyun 			 oxu->periodic_sched != 0))
2824*4882a593Smuzhiyun 		timer_action(oxu, TIMER_IO_WATCHDOG);
2825*4882a593Smuzhiyun }
2826*4882a593Smuzhiyun 
unlink_async(struct oxu_hcd * oxu,struct ehci_qh * qh)2827*4882a593Smuzhiyun static void unlink_async(struct oxu_hcd *oxu, struct ehci_qh *qh)
2828*4882a593Smuzhiyun {
2829*4882a593Smuzhiyun 	/* if we need to use IAA and it's busy, defer */
2830*4882a593Smuzhiyun 	if (qh->qh_state == QH_STATE_LINKED
2831*4882a593Smuzhiyun 			&& oxu->reclaim
2832*4882a593Smuzhiyun 			&& HC_IS_RUNNING(oxu_to_hcd(oxu)->state)) {
2833*4882a593Smuzhiyun 		struct ehci_qh		*last;
2834*4882a593Smuzhiyun 
2835*4882a593Smuzhiyun 		for (last = oxu->reclaim;
2836*4882a593Smuzhiyun 				last->reclaim;
2837*4882a593Smuzhiyun 				last = last->reclaim)
2838*4882a593Smuzhiyun 			continue;
2839*4882a593Smuzhiyun 		qh->qh_state = QH_STATE_UNLINK_WAIT;
2840*4882a593Smuzhiyun 		last->reclaim = qh;
2841*4882a593Smuzhiyun 
2842*4882a593Smuzhiyun 	/* bypass IAA if the hc can't care */
2843*4882a593Smuzhiyun 	} else if (!HC_IS_RUNNING(oxu_to_hcd(oxu)->state) && oxu->reclaim)
2844*4882a593Smuzhiyun 		end_unlink_async(oxu);
2845*4882a593Smuzhiyun 
2846*4882a593Smuzhiyun 	/* something else might have unlinked the qh by now */
2847*4882a593Smuzhiyun 	if (qh->qh_state == QH_STATE_LINKED)
2848*4882a593Smuzhiyun 		start_unlink_async(oxu, qh);
2849*4882a593Smuzhiyun }
2850*4882a593Smuzhiyun 
2851*4882a593Smuzhiyun /*
2852*4882a593Smuzhiyun  * USB host controller methods
2853*4882a593Smuzhiyun  */
2854*4882a593Smuzhiyun 
oxu210_hcd_irq(struct usb_hcd * hcd)2855*4882a593Smuzhiyun static irqreturn_t oxu210_hcd_irq(struct usb_hcd *hcd)
2856*4882a593Smuzhiyun {
2857*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
2858*4882a593Smuzhiyun 	u32 status, pcd_status = 0;
2859*4882a593Smuzhiyun 	int bh;
2860*4882a593Smuzhiyun 
2861*4882a593Smuzhiyun 	spin_lock(&oxu->lock);
2862*4882a593Smuzhiyun 
2863*4882a593Smuzhiyun 	status = readl(&oxu->regs->status);
2864*4882a593Smuzhiyun 
2865*4882a593Smuzhiyun 	/* e.g. cardbus physical eject */
2866*4882a593Smuzhiyun 	if (status == ~(u32) 0) {
2867*4882a593Smuzhiyun 		oxu_dbg(oxu, "device removed\n");
2868*4882a593Smuzhiyun 		goto dead;
2869*4882a593Smuzhiyun 	}
2870*4882a593Smuzhiyun 
2871*4882a593Smuzhiyun 	/* Shared IRQ? */
2872*4882a593Smuzhiyun 	status &= INTR_MASK;
2873*4882a593Smuzhiyun 	if (!status || unlikely(hcd->state == HC_STATE_HALT)) {
2874*4882a593Smuzhiyun 		spin_unlock(&oxu->lock);
2875*4882a593Smuzhiyun 		return IRQ_NONE;
2876*4882a593Smuzhiyun 	}
2877*4882a593Smuzhiyun 
2878*4882a593Smuzhiyun 	/* clear (just) interrupts */
2879*4882a593Smuzhiyun 	writel(status, &oxu->regs->status);
2880*4882a593Smuzhiyun 	readl(&oxu->regs->command);	/* unblock posted write */
2881*4882a593Smuzhiyun 	bh = 0;
2882*4882a593Smuzhiyun 
2883*4882a593Smuzhiyun #ifdef OXU_VERBOSE_DEBUG
2884*4882a593Smuzhiyun 	/* unrequested/ignored: Frame List Rollover */
2885*4882a593Smuzhiyun 	dbg_status(oxu, "irq", status);
2886*4882a593Smuzhiyun #endif
2887*4882a593Smuzhiyun 
2888*4882a593Smuzhiyun 	/* INT, ERR, and IAA interrupt rates can be throttled */
2889*4882a593Smuzhiyun 
2890*4882a593Smuzhiyun 	/* normal [4.15.1.2] or error [4.15.1.1] completion */
2891*4882a593Smuzhiyun 	if (likely((status & (STS_INT|STS_ERR)) != 0))
2892*4882a593Smuzhiyun 		bh = 1;
2893*4882a593Smuzhiyun 
2894*4882a593Smuzhiyun 	/* complete the unlinking of some qh [4.15.2.3] */
2895*4882a593Smuzhiyun 	if (status & STS_IAA) {
2896*4882a593Smuzhiyun 		oxu->reclaim_ready = 1;
2897*4882a593Smuzhiyun 		bh = 1;
2898*4882a593Smuzhiyun 	}
2899*4882a593Smuzhiyun 
2900*4882a593Smuzhiyun 	/* remote wakeup [4.3.1] */
2901*4882a593Smuzhiyun 	if (status & STS_PCD) {
2902*4882a593Smuzhiyun 		unsigned i = HCS_N_PORTS(oxu->hcs_params);
2903*4882a593Smuzhiyun 		pcd_status = status;
2904*4882a593Smuzhiyun 
2905*4882a593Smuzhiyun 		/* resume root hub? */
2906*4882a593Smuzhiyun 		if (!(readl(&oxu->regs->command) & CMD_RUN))
2907*4882a593Smuzhiyun 			usb_hcd_resume_root_hub(hcd);
2908*4882a593Smuzhiyun 
2909*4882a593Smuzhiyun 		while (i--) {
2910*4882a593Smuzhiyun 			int pstatus = readl(&oxu->regs->port_status[i]);
2911*4882a593Smuzhiyun 
2912*4882a593Smuzhiyun 			if (pstatus & PORT_OWNER)
2913*4882a593Smuzhiyun 				continue;
2914*4882a593Smuzhiyun 			if (!(pstatus & PORT_RESUME)
2915*4882a593Smuzhiyun 					|| oxu->reset_done[i] != 0)
2916*4882a593Smuzhiyun 				continue;
2917*4882a593Smuzhiyun 
2918*4882a593Smuzhiyun 			/* start USB_RESUME_TIMEOUT resume signaling from this
2919*4882a593Smuzhiyun 			 * port, and make hub_wq collect PORT_STAT_C_SUSPEND to
2920*4882a593Smuzhiyun 			 * stop that signaling.
2921*4882a593Smuzhiyun 			 */
2922*4882a593Smuzhiyun 			oxu->reset_done[i] = jiffies +
2923*4882a593Smuzhiyun 				msecs_to_jiffies(USB_RESUME_TIMEOUT);
2924*4882a593Smuzhiyun 			oxu_dbg(oxu, "port %d remote wakeup\n", i + 1);
2925*4882a593Smuzhiyun 			mod_timer(&hcd->rh_timer, oxu->reset_done[i]);
2926*4882a593Smuzhiyun 		}
2927*4882a593Smuzhiyun 	}
2928*4882a593Smuzhiyun 
2929*4882a593Smuzhiyun 	/* PCI errors [4.15.2.4] */
2930*4882a593Smuzhiyun 	if (unlikely((status & STS_FATAL) != 0)) {
2931*4882a593Smuzhiyun 		/* bogus "fatal" IRQs appear on some chips... why?  */
2932*4882a593Smuzhiyun 		status = readl(&oxu->regs->status);
2933*4882a593Smuzhiyun 		dbg_cmd(oxu, "fatal", readl(&oxu->regs->command));
2934*4882a593Smuzhiyun 		dbg_status(oxu, "fatal", status);
2935*4882a593Smuzhiyun 		if (status & STS_HALT) {
2936*4882a593Smuzhiyun 			oxu_err(oxu, "fatal error\n");
2937*4882a593Smuzhiyun dead:
2938*4882a593Smuzhiyun 			ehci_reset(oxu);
2939*4882a593Smuzhiyun 			writel(0, &oxu->regs->configured_flag);
2940*4882a593Smuzhiyun 			usb_hc_died(hcd);
2941*4882a593Smuzhiyun 			/* generic layer kills/unlinks all urbs, then
2942*4882a593Smuzhiyun 			 * uses oxu_stop to clean up the rest
2943*4882a593Smuzhiyun 			 */
2944*4882a593Smuzhiyun 			bh = 1;
2945*4882a593Smuzhiyun 		}
2946*4882a593Smuzhiyun 	}
2947*4882a593Smuzhiyun 
2948*4882a593Smuzhiyun 	if (bh)
2949*4882a593Smuzhiyun 		ehci_work(oxu);
2950*4882a593Smuzhiyun 	spin_unlock(&oxu->lock);
2951*4882a593Smuzhiyun 	if (pcd_status & STS_PCD)
2952*4882a593Smuzhiyun 		usb_hcd_poll_rh_status(hcd);
2953*4882a593Smuzhiyun 	return IRQ_HANDLED;
2954*4882a593Smuzhiyun }
2955*4882a593Smuzhiyun 
oxu_irq(struct usb_hcd * hcd)2956*4882a593Smuzhiyun static irqreturn_t oxu_irq(struct usb_hcd *hcd)
2957*4882a593Smuzhiyun {
2958*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
2959*4882a593Smuzhiyun 	int ret = IRQ_HANDLED;
2960*4882a593Smuzhiyun 
2961*4882a593Smuzhiyun 	u32 status = oxu_readl(hcd->regs, OXU_CHIPIRQSTATUS);
2962*4882a593Smuzhiyun 	u32 enable = oxu_readl(hcd->regs, OXU_CHIPIRQEN_SET);
2963*4882a593Smuzhiyun 
2964*4882a593Smuzhiyun 	/* Disable all interrupt */
2965*4882a593Smuzhiyun 	oxu_writel(hcd->regs, OXU_CHIPIRQEN_CLR, enable);
2966*4882a593Smuzhiyun 
2967*4882a593Smuzhiyun 	if ((oxu->is_otg && (status & OXU_USBOTGI)) ||
2968*4882a593Smuzhiyun 		(!oxu->is_otg && (status & OXU_USBSPHI)))
2969*4882a593Smuzhiyun 		oxu210_hcd_irq(hcd);
2970*4882a593Smuzhiyun 	else
2971*4882a593Smuzhiyun 		ret = IRQ_NONE;
2972*4882a593Smuzhiyun 
2973*4882a593Smuzhiyun 	/* Enable all interrupt back */
2974*4882a593Smuzhiyun 	oxu_writel(hcd->regs, OXU_CHIPIRQEN_SET, enable);
2975*4882a593Smuzhiyun 
2976*4882a593Smuzhiyun 	return ret;
2977*4882a593Smuzhiyun }
2978*4882a593Smuzhiyun 
oxu_watchdog(struct timer_list * t)2979*4882a593Smuzhiyun static void oxu_watchdog(struct timer_list *t)
2980*4882a593Smuzhiyun {
2981*4882a593Smuzhiyun 	struct oxu_hcd	*oxu = from_timer(oxu, t, watchdog);
2982*4882a593Smuzhiyun 	unsigned long flags;
2983*4882a593Smuzhiyun 
2984*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
2985*4882a593Smuzhiyun 
2986*4882a593Smuzhiyun 	/* lost IAA irqs wedge things badly; seen with a vt8235 */
2987*4882a593Smuzhiyun 	if (oxu->reclaim) {
2988*4882a593Smuzhiyun 		u32 status = readl(&oxu->regs->status);
2989*4882a593Smuzhiyun 		if (status & STS_IAA) {
2990*4882a593Smuzhiyun 			oxu_vdbg(oxu, "lost IAA\n");
2991*4882a593Smuzhiyun 			writel(STS_IAA, &oxu->regs->status);
2992*4882a593Smuzhiyun 			oxu->reclaim_ready = 1;
2993*4882a593Smuzhiyun 		}
2994*4882a593Smuzhiyun 	}
2995*4882a593Smuzhiyun 
2996*4882a593Smuzhiyun 	/* stop async processing after it's idled a bit */
2997*4882a593Smuzhiyun 	if (test_bit(TIMER_ASYNC_OFF, &oxu->actions))
2998*4882a593Smuzhiyun 		start_unlink_async(oxu, oxu->async);
2999*4882a593Smuzhiyun 
3000*4882a593Smuzhiyun 	/* oxu could run by timer, without IRQs ... */
3001*4882a593Smuzhiyun 	ehci_work(oxu);
3002*4882a593Smuzhiyun 
3003*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
3004*4882a593Smuzhiyun }
3005*4882a593Smuzhiyun 
3006*4882a593Smuzhiyun /* One-time init, only for memory state.
3007*4882a593Smuzhiyun  */
oxu_hcd_init(struct usb_hcd * hcd)3008*4882a593Smuzhiyun static int oxu_hcd_init(struct usb_hcd *hcd)
3009*4882a593Smuzhiyun {
3010*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3011*4882a593Smuzhiyun 	u32 temp;
3012*4882a593Smuzhiyun 	int retval;
3013*4882a593Smuzhiyun 	u32 hcc_params;
3014*4882a593Smuzhiyun 
3015*4882a593Smuzhiyun 	spin_lock_init(&oxu->lock);
3016*4882a593Smuzhiyun 
3017*4882a593Smuzhiyun 	timer_setup(&oxu->watchdog, oxu_watchdog, 0);
3018*4882a593Smuzhiyun 
3019*4882a593Smuzhiyun 	/*
3020*4882a593Smuzhiyun 	 * hw default: 1K periodic list heads, one per frame.
3021*4882a593Smuzhiyun 	 * periodic_size can shrink by USBCMD update if hcc_params allows.
3022*4882a593Smuzhiyun 	 */
3023*4882a593Smuzhiyun 	oxu->periodic_size = DEFAULT_I_TDPS;
3024*4882a593Smuzhiyun 	retval = ehci_mem_init(oxu, GFP_KERNEL);
3025*4882a593Smuzhiyun 	if (retval < 0)
3026*4882a593Smuzhiyun 		return retval;
3027*4882a593Smuzhiyun 
3028*4882a593Smuzhiyun 	/* controllers may cache some of the periodic schedule ... */
3029*4882a593Smuzhiyun 	hcc_params = readl(&oxu->caps->hcc_params);
3030*4882a593Smuzhiyun 	if (HCC_ISOC_CACHE(hcc_params))		/* full frame cache */
3031*4882a593Smuzhiyun 		oxu->i_thresh = 8;
3032*4882a593Smuzhiyun 	else					/* N microframes cached */
3033*4882a593Smuzhiyun 		oxu->i_thresh = 2 + HCC_ISOC_THRES(hcc_params);
3034*4882a593Smuzhiyun 
3035*4882a593Smuzhiyun 	oxu->reclaim = NULL;
3036*4882a593Smuzhiyun 	oxu->reclaim_ready = 0;
3037*4882a593Smuzhiyun 	oxu->next_uframe = -1;
3038*4882a593Smuzhiyun 
3039*4882a593Smuzhiyun 	/*
3040*4882a593Smuzhiyun 	 * dedicate a qh for the async ring head, since we couldn't unlink
3041*4882a593Smuzhiyun 	 * a 'real' qh without stopping the async schedule [4.8].  use it
3042*4882a593Smuzhiyun 	 * as the 'reclamation list head' too.
3043*4882a593Smuzhiyun 	 * its dummy is used in hw_alt_next of many tds, to prevent the qh
3044*4882a593Smuzhiyun 	 * from automatically advancing to the next td after short reads.
3045*4882a593Smuzhiyun 	 */
3046*4882a593Smuzhiyun 	oxu->async->qh_next.qh = NULL;
3047*4882a593Smuzhiyun 	oxu->async->hw_next = QH_NEXT(oxu->async->qh_dma);
3048*4882a593Smuzhiyun 	oxu->async->hw_info1 = cpu_to_le32(QH_HEAD);
3049*4882a593Smuzhiyun 	oxu->async->hw_token = cpu_to_le32(QTD_STS_HALT);
3050*4882a593Smuzhiyun 	oxu->async->hw_qtd_next = EHCI_LIST_END;
3051*4882a593Smuzhiyun 	oxu->async->qh_state = QH_STATE_LINKED;
3052*4882a593Smuzhiyun 	oxu->async->hw_alt_next = QTD_NEXT(oxu->async->dummy->qtd_dma);
3053*4882a593Smuzhiyun 
3054*4882a593Smuzhiyun 	/* clear interrupt enables, set irq latency */
3055*4882a593Smuzhiyun 	if (log2_irq_thresh < 0 || log2_irq_thresh > 6)
3056*4882a593Smuzhiyun 		log2_irq_thresh = 0;
3057*4882a593Smuzhiyun 	temp = 1 << (16 + log2_irq_thresh);
3058*4882a593Smuzhiyun 	if (HCC_CANPARK(hcc_params)) {
3059*4882a593Smuzhiyun 		/* HW default park == 3, on hardware that supports it (like
3060*4882a593Smuzhiyun 		 * NVidia and ALI silicon), maximizes throughput on the async
3061*4882a593Smuzhiyun 		 * schedule by avoiding QH fetches between transfers.
3062*4882a593Smuzhiyun 		 *
3063*4882a593Smuzhiyun 		 * With fast usb storage devices and NForce2, "park" seems to
3064*4882a593Smuzhiyun 		 * make problems:  throughput reduction (!), data errors...
3065*4882a593Smuzhiyun 		 */
3066*4882a593Smuzhiyun 		if (park) {
3067*4882a593Smuzhiyun 			park = min(park, (unsigned) 3);
3068*4882a593Smuzhiyun 			temp |= CMD_PARK;
3069*4882a593Smuzhiyun 			temp |= park << 8;
3070*4882a593Smuzhiyun 		}
3071*4882a593Smuzhiyun 		oxu_dbg(oxu, "park %d\n", park);
3072*4882a593Smuzhiyun 	}
3073*4882a593Smuzhiyun 	if (HCC_PGM_FRAMELISTLEN(hcc_params)) {
3074*4882a593Smuzhiyun 		/* periodic schedule size can be smaller than default */
3075*4882a593Smuzhiyun 		temp &= ~(3 << 2);
3076*4882a593Smuzhiyun 		temp |= (EHCI_TUNE_FLS << 2);
3077*4882a593Smuzhiyun 	}
3078*4882a593Smuzhiyun 	oxu->command = temp;
3079*4882a593Smuzhiyun 
3080*4882a593Smuzhiyun 	return 0;
3081*4882a593Smuzhiyun }
3082*4882a593Smuzhiyun 
3083*4882a593Smuzhiyun /* Called during probe() after chip reset completes.
3084*4882a593Smuzhiyun  */
oxu_reset(struct usb_hcd * hcd)3085*4882a593Smuzhiyun static int oxu_reset(struct usb_hcd *hcd)
3086*4882a593Smuzhiyun {
3087*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3088*4882a593Smuzhiyun 
3089*4882a593Smuzhiyun 	spin_lock_init(&oxu->mem_lock);
3090*4882a593Smuzhiyun 	INIT_LIST_HEAD(&oxu->urb_list);
3091*4882a593Smuzhiyun 	oxu->urb_len = 0;
3092*4882a593Smuzhiyun 
3093*4882a593Smuzhiyun 	if (oxu->is_otg) {
3094*4882a593Smuzhiyun 		oxu->caps = hcd->regs + OXU_OTG_CAP_OFFSET;
3095*4882a593Smuzhiyun 		oxu->regs = hcd->regs + OXU_OTG_CAP_OFFSET + \
3096*4882a593Smuzhiyun 			HC_LENGTH(readl(&oxu->caps->hc_capbase));
3097*4882a593Smuzhiyun 
3098*4882a593Smuzhiyun 		oxu->mem = hcd->regs + OXU_SPH_MEM;
3099*4882a593Smuzhiyun 	} else {
3100*4882a593Smuzhiyun 		oxu->caps = hcd->regs + OXU_SPH_CAP_OFFSET;
3101*4882a593Smuzhiyun 		oxu->regs = hcd->regs + OXU_SPH_CAP_OFFSET + \
3102*4882a593Smuzhiyun 			HC_LENGTH(readl(&oxu->caps->hc_capbase));
3103*4882a593Smuzhiyun 
3104*4882a593Smuzhiyun 		oxu->mem = hcd->regs + OXU_OTG_MEM;
3105*4882a593Smuzhiyun 	}
3106*4882a593Smuzhiyun 
3107*4882a593Smuzhiyun 	oxu->hcs_params = readl(&oxu->caps->hcs_params);
3108*4882a593Smuzhiyun 	oxu->sbrn = 0x20;
3109*4882a593Smuzhiyun 
3110*4882a593Smuzhiyun 	return oxu_hcd_init(hcd);
3111*4882a593Smuzhiyun }
3112*4882a593Smuzhiyun 
oxu_run(struct usb_hcd * hcd)3113*4882a593Smuzhiyun static int oxu_run(struct usb_hcd *hcd)
3114*4882a593Smuzhiyun {
3115*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3116*4882a593Smuzhiyun 	int retval;
3117*4882a593Smuzhiyun 	u32 temp, hcc_params;
3118*4882a593Smuzhiyun 
3119*4882a593Smuzhiyun 	hcd->uses_new_polling = 1;
3120*4882a593Smuzhiyun 
3121*4882a593Smuzhiyun 	/* EHCI spec section 4.1 */
3122*4882a593Smuzhiyun 	retval = ehci_reset(oxu);
3123*4882a593Smuzhiyun 	if (retval != 0) {
3124*4882a593Smuzhiyun 		ehci_mem_cleanup(oxu);
3125*4882a593Smuzhiyun 		return retval;
3126*4882a593Smuzhiyun 	}
3127*4882a593Smuzhiyun 	writel(oxu->periodic_dma, &oxu->regs->frame_list);
3128*4882a593Smuzhiyun 	writel((u32) oxu->async->qh_dma, &oxu->regs->async_next);
3129*4882a593Smuzhiyun 
3130*4882a593Smuzhiyun 	/* hcc_params controls whether oxu->regs->segment must (!!!)
3131*4882a593Smuzhiyun 	 * be used; it constrains QH/ITD/SITD and QTD locations.
3132*4882a593Smuzhiyun 	 * dma_pool consistent memory always uses segment zero.
3133*4882a593Smuzhiyun 	 * streaming mappings for I/O buffers, like pci_map_single(),
3134*4882a593Smuzhiyun 	 * can return segments above 4GB, if the device allows.
3135*4882a593Smuzhiyun 	 *
3136*4882a593Smuzhiyun 	 * NOTE:  the dma mask is visible through dev->dma_mask, so
3137*4882a593Smuzhiyun 	 * drivers can pass this info along ... like NETIF_F_HIGHDMA,
3138*4882a593Smuzhiyun 	 * Scsi_Host.highmem_io, and so forth.  It's readonly to all
3139*4882a593Smuzhiyun 	 * host side drivers though.
3140*4882a593Smuzhiyun 	 */
3141*4882a593Smuzhiyun 	hcc_params = readl(&oxu->caps->hcc_params);
3142*4882a593Smuzhiyun 	if (HCC_64BIT_ADDR(hcc_params))
3143*4882a593Smuzhiyun 		writel(0, &oxu->regs->segment);
3144*4882a593Smuzhiyun 
3145*4882a593Smuzhiyun 	oxu->command &= ~(CMD_LRESET | CMD_IAAD | CMD_PSE |
3146*4882a593Smuzhiyun 				CMD_ASE | CMD_RESET);
3147*4882a593Smuzhiyun 	oxu->command |= CMD_RUN;
3148*4882a593Smuzhiyun 	writel(oxu->command, &oxu->regs->command);
3149*4882a593Smuzhiyun 	dbg_cmd(oxu, "init", oxu->command);
3150*4882a593Smuzhiyun 
3151*4882a593Smuzhiyun 	/*
3152*4882a593Smuzhiyun 	 * Start, enabling full USB 2.0 functionality ... usb 1.1 devices
3153*4882a593Smuzhiyun 	 * are explicitly handed to companion controller(s), so no TT is
3154*4882a593Smuzhiyun 	 * involved with the root hub.  (Except where one is integrated,
3155*4882a593Smuzhiyun 	 * and there's no companion controller unless maybe for USB OTG.)
3156*4882a593Smuzhiyun 	 */
3157*4882a593Smuzhiyun 	hcd->state = HC_STATE_RUNNING;
3158*4882a593Smuzhiyun 	writel(FLAG_CF, &oxu->regs->configured_flag);
3159*4882a593Smuzhiyun 	readl(&oxu->regs->command);	/* unblock posted writes */
3160*4882a593Smuzhiyun 
3161*4882a593Smuzhiyun 	temp = HC_VERSION(readl(&oxu->caps->hc_capbase));
3162*4882a593Smuzhiyun 	oxu_info(oxu, "USB %x.%x started, quasi-EHCI %x.%02x, driver %s%s\n",
3163*4882a593Smuzhiyun 		((oxu->sbrn & 0xf0)>>4), (oxu->sbrn & 0x0f),
3164*4882a593Smuzhiyun 		temp >> 8, temp & 0xff, DRIVER_VERSION,
3165*4882a593Smuzhiyun 		ignore_oc ? ", overcurrent ignored" : "");
3166*4882a593Smuzhiyun 
3167*4882a593Smuzhiyun 	writel(INTR_MASK, &oxu->regs->intr_enable); /* Turn On Interrupts */
3168*4882a593Smuzhiyun 
3169*4882a593Smuzhiyun 	return 0;
3170*4882a593Smuzhiyun }
3171*4882a593Smuzhiyun 
oxu_stop(struct usb_hcd * hcd)3172*4882a593Smuzhiyun static void oxu_stop(struct usb_hcd *hcd)
3173*4882a593Smuzhiyun {
3174*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3175*4882a593Smuzhiyun 
3176*4882a593Smuzhiyun 	/* Turn off port power on all root hub ports. */
3177*4882a593Smuzhiyun 	ehci_port_power(oxu, 0);
3178*4882a593Smuzhiyun 
3179*4882a593Smuzhiyun 	/* no more interrupts ... */
3180*4882a593Smuzhiyun 	del_timer_sync(&oxu->watchdog);
3181*4882a593Smuzhiyun 
3182*4882a593Smuzhiyun 	spin_lock_irq(&oxu->lock);
3183*4882a593Smuzhiyun 	if (HC_IS_RUNNING(hcd->state))
3184*4882a593Smuzhiyun 		ehci_quiesce(oxu);
3185*4882a593Smuzhiyun 
3186*4882a593Smuzhiyun 	ehci_reset(oxu);
3187*4882a593Smuzhiyun 	writel(0, &oxu->regs->intr_enable);
3188*4882a593Smuzhiyun 	spin_unlock_irq(&oxu->lock);
3189*4882a593Smuzhiyun 
3190*4882a593Smuzhiyun 	/* let companion controllers work when we aren't */
3191*4882a593Smuzhiyun 	writel(0, &oxu->regs->configured_flag);
3192*4882a593Smuzhiyun 
3193*4882a593Smuzhiyun 	/* root hub is shut down separately (first, when possible) */
3194*4882a593Smuzhiyun 	spin_lock_irq(&oxu->lock);
3195*4882a593Smuzhiyun 	if (oxu->async)
3196*4882a593Smuzhiyun 		ehci_work(oxu);
3197*4882a593Smuzhiyun 	spin_unlock_irq(&oxu->lock);
3198*4882a593Smuzhiyun 	ehci_mem_cleanup(oxu);
3199*4882a593Smuzhiyun 
3200*4882a593Smuzhiyun 	dbg_status(oxu, "oxu_stop completed", readl(&oxu->regs->status));
3201*4882a593Smuzhiyun }
3202*4882a593Smuzhiyun 
3203*4882a593Smuzhiyun /* Kick in for silicon on any bus (not just pci, etc).
3204*4882a593Smuzhiyun  * This forcibly disables dma and IRQs, helping kexec and other cases
3205*4882a593Smuzhiyun  * where the next system software may expect clean state.
3206*4882a593Smuzhiyun  */
oxu_shutdown(struct usb_hcd * hcd)3207*4882a593Smuzhiyun static void oxu_shutdown(struct usb_hcd *hcd)
3208*4882a593Smuzhiyun {
3209*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3210*4882a593Smuzhiyun 
3211*4882a593Smuzhiyun 	(void) ehci_halt(oxu);
3212*4882a593Smuzhiyun 	ehci_turn_off_all_ports(oxu);
3213*4882a593Smuzhiyun 
3214*4882a593Smuzhiyun 	/* make BIOS/etc use companion controller during reboot */
3215*4882a593Smuzhiyun 	writel(0, &oxu->regs->configured_flag);
3216*4882a593Smuzhiyun 
3217*4882a593Smuzhiyun 	/* unblock posted writes */
3218*4882a593Smuzhiyun 	readl(&oxu->regs->configured_flag);
3219*4882a593Smuzhiyun }
3220*4882a593Smuzhiyun 
3221*4882a593Smuzhiyun /* Non-error returns are a promise to giveback() the urb later
3222*4882a593Smuzhiyun  * we drop ownership so next owner (or urb unlink) can get it
3223*4882a593Smuzhiyun  *
3224*4882a593Smuzhiyun  * urb + dev is in hcd.self.controller.urb_list
3225*4882a593Smuzhiyun  * we're queueing TDs onto software and hardware lists
3226*4882a593Smuzhiyun  *
3227*4882a593Smuzhiyun  * hcd-specific init for hcpriv hasn't been done yet
3228*4882a593Smuzhiyun  *
3229*4882a593Smuzhiyun  * NOTE:  control, bulk, and interrupt share the same code to append TDs
3230*4882a593Smuzhiyun  * to a (possibly active) QH, and the same QH scanning code.
3231*4882a593Smuzhiyun  */
__oxu_urb_enqueue(struct usb_hcd * hcd,struct urb * urb,gfp_t mem_flags)3232*4882a593Smuzhiyun static int __oxu_urb_enqueue(struct usb_hcd *hcd, struct urb *urb,
3233*4882a593Smuzhiyun 				gfp_t mem_flags)
3234*4882a593Smuzhiyun {
3235*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3236*4882a593Smuzhiyun 	struct list_head qtd_list;
3237*4882a593Smuzhiyun 
3238*4882a593Smuzhiyun 	INIT_LIST_HEAD(&qtd_list);
3239*4882a593Smuzhiyun 
3240*4882a593Smuzhiyun 	switch (usb_pipetype(urb->pipe)) {
3241*4882a593Smuzhiyun 	case PIPE_CONTROL:
3242*4882a593Smuzhiyun 	case PIPE_BULK:
3243*4882a593Smuzhiyun 	default:
3244*4882a593Smuzhiyun 		if (!qh_urb_transaction(oxu, urb, &qtd_list, mem_flags))
3245*4882a593Smuzhiyun 			return -ENOMEM;
3246*4882a593Smuzhiyun 		return submit_async(oxu, urb, &qtd_list, mem_flags);
3247*4882a593Smuzhiyun 
3248*4882a593Smuzhiyun 	case PIPE_INTERRUPT:
3249*4882a593Smuzhiyun 		if (!qh_urb_transaction(oxu, urb, &qtd_list, mem_flags))
3250*4882a593Smuzhiyun 			return -ENOMEM;
3251*4882a593Smuzhiyun 		return intr_submit(oxu, urb, &qtd_list, mem_flags);
3252*4882a593Smuzhiyun 
3253*4882a593Smuzhiyun 	case PIPE_ISOCHRONOUS:
3254*4882a593Smuzhiyun 		if (urb->dev->speed == USB_SPEED_HIGH)
3255*4882a593Smuzhiyun 			return itd_submit(oxu, urb, mem_flags);
3256*4882a593Smuzhiyun 		else
3257*4882a593Smuzhiyun 			return sitd_submit(oxu, urb, mem_flags);
3258*4882a593Smuzhiyun 	}
3259*4882a593Smuzhiyun }
3260*4882a593Smuzhiyun 
3261*4882a593Smuzhiyun /* This function is responsible for breaking URBs with big data size
3262*4882a593Smuzhiyun  * into smaller size and processing small urbs in sequence.
3263*4882a593Smuzhiyun  */
oxu_urb_enqueue(struct usb_hcd * hcd,struct urb * urb,gfp_t mem_flags)3264*4882a593Smuzhiyun static int oxu_urb_enqueue(struct usb_hcd *hcd, struct urb *urb,
3265*4882a593Smuzhiyun 				gfp_t mem_flags)
3266*4882a593Smuzhiyun {
3267*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3268*4882a593Smuzhiyun 	int num, rem;
3269*4882a593Smuzhiyun 	void *transfer_buffer;
3270*4882a593Smuzhiyun 	struct urb *murb;
3271*4882a593Smuzhiyun 	int i, ret;
3272*4882a593Smuzhiyun 
3273*4882a593Smuzhiyun 	/* If not bulk pipe just enqueue the URB */
3274*4882a593Smuzhiyun 	if (!usb_pipebulk(urb->pipe))
3275*4882a593Smuzhiyun 		return __oxu_urb_enqueue(hcd, urb, mem_flags);
3276*4882a593Smuzhiyun 
3277*4882a593Smuzhiyun 	/* Otherwise we should verify the USB transfer buffer size! */
3278*4882a593Smuzhiyun 	transfer_buffer = urb->transfer_buffer;
3279*4882a593Smuzhiyun 
3280*4882a593Smuzhiyun 	num = urb->transfer_buffer_length / 4096;
3281*4882a593Smuzhiyun 	rem = urb->transfer_buffer_length % 4096;
3282*4882a593Smuzhiyun 	if (rem != 0)
3283*4882a593Smuzhiyun 		num++;
3284*4882a593Smuzhiyun 
3285*4882a593Smuzhiyun 	/* If URB is smaller than 4096 bytes just enqueue it! */
3286*4882a593Smuzhiyun 	if (num == 1)
3287*4882a593Smuzhiyun 		return __oxu_urb_enqueue(hcd, urb, mem_flags);
3288*4882a593Smuzhiyun 
3289*4882a593Smuzhiyun 	/* Ok, we have more job to do! :) */
3290*4882a593Smuzhiyun 
3291*4882a593Smuzhiyun 	for (i = 0; i < num - 1; i++) {
3292*4882a593Smuzhiyun 		/* Get free micro URB poll till a free urb is received */
3293*4882a593Smuzhiyun 
3294*4882a593Smuzhiyun 		do {
3295*4882a593Smuzhiyun 			murb = (struct urb *) oxu_murb_alloc(oxu);
3296*4882a593Smuzhiyun 			if (!murb)
3297*4882a593Smuzhiyun 				schedule();
3298*4882a593Smuzhiyun 		} while (!murb);
3299*4882a593Smuzhiyun 
3300*4882a593Smuzhiyun 		/* Coping the urb */
3301*4882a593Smuzhiyun 		memcpy(murb, urb, sizeof(struct urb));
3302*4882a593Smuzhiyun 
3303*4882a593Smuzhiyun 		murb->transfer_buffer_length = 4096;
3304*4882a593Smuzhiyun 		murb->transfer_buffer = transfer_buffer + i * 4096;
3305*4882a593Smuzhiyun 
3306*4882a593Smuzhiyun 		/* Null pointer for the encodes that this is a micro urb */
3307*4882a593Smuzhiyun 		murb->complete = NULL;
3308*4882a593Smuzhiyun 
3309*4882a593Smuzhiyun 		((struct oxu_murb *) murb)->main = urb;
3310*4882a593Smuzhiyun 		((struct oxu_murb *) murb)->last = 0;
3311*4882a593Smuzhiyun 
3312*4882a593Smuzhiyun 		/* This loop is to guarantee urb to be processed when there's
3313*4882a593Smuzhiyun 		 * not enough resources at a particular time by retrying.
3314*4882a593Smuzhiyun 		 */
3315*4882a593Smuzhiyun 		do {
3316*4882a593Smuzhiyun 			ret  = __oxu_urb_enqueue(hcd, murb, mem_flags);
3317*4882a593Smuzhiyun 			if (ret)
3318*4882a593Smuzhiyun 				schedule();
3319*4882a593Smuzhiyun 		} while (ret);
3320*4882a593Smuzhiyun 	}
3321*4882a593Smuzhiyun 
3322*4882a593Smuzhiyun 	/* Last urb requires special handling  */
3323*4882a593Smuzhiyun 
3324*4882a593Smuzhiyun 	/* Get free micro URB poll till a free urb is received */
3325*4882a593Smuzhiyun 	do {
3326*4882a593Smuzhiyun 		murb = (struct urb *) oxu_murb_alloc(oxu);
3327*4882a593Smuzhiyun 		if (!murb)
3328*4882a593Smuzhiyun 			schedule();
3329*4882a593Smuzhiyun 	} while (!murb);
3330*4882a593Smuzhiyun 
3331*4882a593Smuzhiyun 	/* Coping the urb */
3332*4882a593Smuzhiyun 	memcpy(murb, urb, sizeof(struct urb));
3333*4882a593Smuzhiyun 
3334*4882a593Smuzhiyun 	murb->transfer_buffer_length = rem > 0 ? rem : 4096;
3335*4882a593Smuzhiyun 	murb->transfer_buffer = transfer_buffer + (num - 1) * 4096;
3336*4882a593Smuzhiyun 
3337*4882a593Smuzhiyun 	/* Null pointer for the encodes that this is a micro urb */
3338*4882a593Smuzhiyun 	murb->complete = NULL;
3339*4882a593Smuzhiyun 
3340*4882a593Smuzhiyun 	((struct oxu_murb *) murb)->main = urb;
3341*4882a593Smuzhiyun 	((struct oxu_murb *) murb)->last = 1;
3342*4882a593Smuzhiyun 
3343*4882a593Smuzhiyun 	do {
3344*4882a593Smuzhiyun 		ret = __oxu_urb_enqueue(hcd, murb, mem_flags);
3345*4882a593Smuzhiyun 		if (ret)
3346*4882a593Smuzhiyun 			schedule();
3347*4882a593Smuzhiyun 	} while (ret);
3348*4882a593Smuzhiyun 
3349*4882a593Smuzhiyun 	return ret;
3350*4882a593Smuzhiyun }
3351*4882a593Smuzhiyun 
3352*4882a593Smuzhiyun /* Remove from hardware lists.
3353*4882a593Smuzhiyun  * Completions normally happen asynchronously
3354*4882a593Smuzhiyun  */
oxu_urb_dequeue(struct usb_hcd * hcd,struct urb * urb,int status)3355*4882a593Smuzhiyun static int oxu_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
3356*4882a593Smuzhiyun {
3357*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3358*4882a593Smuzhiyun 	struct ehci_qh *qh;
3359*4882a593Smuzhiyun 	unsigned long flags;
3360*4882a593Smuzhiyun 
3361*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
3362*4882a593Smuzhiyun 	switch (usb_pipetype(urb->pipe)) {
3363*4882a593Smuzhiyun 	case PIPE_CONTROL:
3364*4882a593Smuzhiyun 	case PIPE_BULK:
3365*4882a593Smuzhiyun 	default:
3366*4882a593Smuzhiyun 		qh = (struct ehci_qh *) urb->hcpriv;
3367*4882a593Smuzhiyun 		if (!qh)
3368*4882a593Smuzhiyun 			break;
3369*4882a593Smuzhiyun 		unlink_async(oxu, qh);
3370*4882a593Smuzhiyun 		break;
3371*4882a593Smuzhiyun 
3372*4882a593Smuzhiyun 	case PIPE_INTERRUPT:
3373*4882a593Smuzhiyun 		qh = (struct ehci_qh *) urb->hcpriv;
3374*4882a593Smuzhiyun 		if (!qh)
3375*4882a593Smuzhiyun 			break;
3376*4882a593Smuzhiyun 		switch (qh->qh_state) {
3377*4882a593Smuzhiyun 		case QH_STATE_LINKED:
3378*4882a593Smuzhiyun 			intr_deschedule(oxu, qh);
3379*4882a593Smuzhiyun 			fallthrough;
3380*4882a593Smuzhiyun 		case QH_STATE_IDLE:
3381*4882a593Smuzhiyun 			qh_completions(oxu, qh);
3382*4882a593Smuzhiyun 			break;
3383*4882a593Smuzhiyun 		default:
3384*4882a593Smuzhiyun 			oxu_dbg(oxu, "bogus qh %p state %d\n",
3385*4882a593Smuzhiyun 					qh, qh->qh_state);
3386*4882a593Smuzhiyun 			goto done;
3387*4882a593Smuzhiyun 		}
3388*4882a593Smuzhiyun 
3389*4882a593Smuzhiyun 		/* reschedule QH iff another request is queued */
3390*4882a593Smuzhiyun 		if (!list_empty(&qh->qtd_list)
3391*4882a593Smuzhiyun 				&& HC_IS_RUNNING(hcd->state)) {
3392*4882a593Smuzhiyun 			int status;
3393*4882a593Smuzhiyun 
3394*4882a593Smuzhiyun 			status = qh_schedule(oxu, qh);
3395*4882a593Smuzhiyun 			spin_unlock_irqrestore(&oxu->lock, flags);
3396*4882a593Smuzhiyun 
3397*4882a593Smuzhiyun 			if (status != 0) {
3398*4882a593Smuzhiyun 				/* shouldn't happen often, but ...
3399*4882a593Smuzhiyun 				 * FIXME kill those tds' urbs
3400*4882a593Smuzhiyun 				 */
3401*4882a593Smuzhiyun 				dev_err(hcd->self.controller,
3402*4882a593Smuzhiyun 					"can't reschedule qh %p, err %d\n", qh,
3403*4882a593Smuzhiyun 					status);
3404*4882a593Smuzhiyun 			}
3405*4882a593Smuzhiyun 			return status;
3406*4882a593Smuzhiyun 		}
3407*4882a593Smuzhiyun 		break;
3408*4882a593Smuzhiyun 	}
3409*4882a593Smuzhiyun done:
3410*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
3411*4882a593Smuzhiyun 	return 0;
3412*4882a593Smuzhiyun }
3413*4882a593Smuzhiyun 
3414*4882a593Smuzhiyun /* Bulk qh holds the data toggle */
oxu_endpoint_disable(struct usb_hcd * hcd,struct usb_host_endpoint * ep)3415*4882a593Smuzhiyun static void oxu_endpoint_disable(struct usb_hcd *hcd,
3416*4882a593Smuzhiyun 					struct usb_host_endpoint *ep)
3417*4882a593Smuzhiyun {
3418*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3419*4882a593Smuzhiyun 	unsigned long		flags;
3420*4882a593Smuzhiyun 	struct ehci_qh		*qh, *tmp;
3421*4882a593Smuzhiyun 
3422*4882a593Smuzhiyun 	/* ASSERT:  any requests/urbs are being unlinked */
3423*4882a593Smuzhiyun 	/* ASSERT:  nobody can be submitting urbs for this any more */
3424*4882a593Smuzhiyun 
3425*4882a593Smuzhiyun rescan:
3426*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
3427*4882a593Smuzhiyun 	qh = ep->hcpriv;
3428*4882a593Smuzhiyun 	if (!qh)
3429*4882a593Smuzhiyun 		goto done;
3430*4882a593Smuzhiyun 
3431*4882a593Smuzhiyun 	/* endpoints can be iso streams.  for now, we don't
3432*4882a593Smuzhiyun 	 * accelerate iso completions ... so spin a while.
3433*4882a593Smuzhiyun 	 */
3434*4882a593Smuzhiyun 	if (qh->hw_info1 == 0) {
3435*4882a593Smuzhiyun 		oxu_vdbg(oxu, "iso delay\n");
3436*4882a593Smuzhiyun 		goto idle_timeout;
3437*4882a593Smuzhiyun 	}
3438*4882a593Smuzhiyun 
3439*4882a593Smuzhiyun 	if (!HC_IS_RUNNING(hcd->state))
3440*4882a593Smuzhiyun 		qh->qh_state = QH_STATE_IDLE;
3441*4882a593Smuzhiyun 	switch (qh->qh_state) {
3442*4882a593Smuzhiyun 	case QH_STATE_LINKED:
3443*4882a593Smuzhiyun 		for (tmp = oxu->async->qh_next.qh;
3444*4882a593Smuzhiyun 				tmp && tmp != qh;
3445*4882a593Smuzhiyun 				tmp = tmp->qh_next.qh)
3446*4882a593Smuzhiyun 			continue;
3447*4882a593Smuzhiyun 		/* periodic qh self-unlinks on empty */
3448*4882a593Smuzhiyun 		if (!tmp)
3449*4882a593Smuzhiyun 			goto nogood;
3450*4882a593Smuzhiyun 		unlink_async(oxu, qh);
3451*4882a593Smuzhiyun 		fallthrough;
3452*4882a593Smuzhiyun 	case QH_STATE_UNLINK:		/* wait for hw to finish? */
3453*4882a593Smuzhiyun idle_timeout:
3454*4882a593Smuzhiyun 		spin_unlock_irqrestore(&oxu->lock, flags);
3455*4882a593Smuzhiyun 		schedule_timeout_uninterruptible(1);
3456*4882a593Smuzhiyun 		goto rescan;
3457*4882a593Smuzhiyun 	case QH_STATE_IDLE:		/* fully unlinked */
3458*4882a593Smuzhiyun 		if (list_empty(&qh->qtd_list)) {
3459*4882a593Smuzhiyun 			qh_put(qh);
3460*4882a593Smuzhiyun 			break;
3461*4882a593Smuzhiyun 		}
3462*4882a593Smuzhiyun 		fallthrough;
3463*4882a593Smuzhiyun 	default:
3464*4882a593Smuzhiyun nogood:
3465*4882a593Smuzhiyun 		/* caller was supposed to have unlinked any requests;
3466*4882a593Smuzhiyun 		 * that's not our job.  just leak this memory.
3467*4882a593Smuzhiyun 		 */
3468*4882a593Smuzhiyun 		oxu_err(oxu, "qh %p (#%02x) state %d%s\n",
3469*4882a593Smuzhiyun 			qh, ep->desc.bEndpointAddress, qh->qh_state,
3470*4882a593Smuzhiyun 			list_empty(&qh->qtd_list) ? "" : "(has tds)");
3471*4882a593Smuzhiyun 		break;
3472*4882a593Smuzhiyun 	}
3473*4882a593Smuzhiyun 	ep->hcpriv = NULL;
3474*4882a593Smuzhiyun done:
3475*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
3476*4882a593Smuzhiyun }
3477*4882a593Smuzhiyun 
oxu_get_frame(struct usb_hcd * hcd)3478*4882a593Smuzhiyun static int oxu_get_frame(struct usb_hcd *hcd)
3479*4882a593Smuzhiyun {
3480*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3481*4882a593Smuzhiyun 
3482*4882a593Smuzhiyun 	return (readl(&oxu->regs->frame_index) >> 3) %
3483*4882a593Smuzhiyun 		oxu->periodic_size;
3484*4882a593Smuzhiyun }
3485*4882a593Smuzhiyun 
3486*4882a593Smuzhiyun /* Build "status change" packet (one or two bytes) from HC registers */
oxu_hub_status_data(struct usb_hcd * hcd,char * buf)3487*4882a593Smuzhiyun static int oxu_hub_status_data(struct usb_hcd *hcd, char *buf)
3488*4882a593Smuzhiyun {
3489*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3490*4882a593Smuzhiyun 	u32 temp, mask, status = 0;
3491*4882a593Smuzhiyun 	int ports, i, retval = 1;
3492*4882a593Smuzhiyun 	unsigned long flags;
3493*4882a593Smuzhiyun 
3494*4882a593Smuzhiyun 	/* if !PM, root hub timers won't get shut down ... */
3495*4882a593Smuzhiyun 	if (!HC_IS_RUNNING(hcd->state))
3496*4882a593Smuzhiyun 		return 0;
3497*4882a593Smuzhiyun 
3498*4882a593Smuzhiyun 	/* init status to no-changes */
3499*4882a593Smuzhiyun 	buf[0] = 0;
3500*4882a593Smuzhiyun 	ports = HCS_N_PORTS(oxu->hcs_params);
3501*4882a593Smuzhiyun 	if (ports > 7) {
3502*4882a593Smuzhiyun 		buf[1] = 0;
3503*4882a593Smuzhiyun 		retval++;
3504*4882a593Smuzhiyun 	}
3505*4882a593Smuzhiyun 
3506*4882a593Smuzhiyun 	/* Some boards (mostly VIA?) report bogus overcurrent indications,
3507*4882a593Smuzhiyun 	 * causing massive log spam unless we completely ignore them.  It
3508*4882a593Smuzhiyun 	 * may be relevant that VIA VT8235 controllers, where PORT_POWER is
3509*4882a593Smuzhiyun 	 * always set, seem to clear PORT_OCC and PORT_CSC when writing to
3510*4882a593Smuzhiyun 	 * PORT_POWER; that's surprising, but maybe within-spec.
3511*4882a593Smuzhiyun 	 */
3512*4882a593Smuzhiyun 	if (!ignore_oc)
3513*4882a593Smuzhiyun 		mask = PORT_CSC | PORT_PEC | PORT_OCC;
3514*4882a593Smuzhiyun 	else
3515*4882a593Smuzhiyun 		mask = PORT_CSC | PORT_PEC;
3516*4882a593Smuzhiyun 
3517*4882a593Smuzhiyun 	/* no hub change reports (bit 0) for now (power, ...) */
3518*4882a593Smuzhiyun 
3519*4882a593Smuzhiyun 	/* port N changes (bit N)? */
3520*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
3521*4882a593Smuzhiyun 	for (i = 0; i < ports; i++) {
3522*4882a593Smuzhiyun 		temp = readl(&oxu->regs->port_status[i]);
3523*4882a593Smuzhiyun 
3524*4882a593Smuzhiyun 		/*
3525*4882a593Smuzhiyun 		 * Return status information even for ports with OWNER set.
3526*4882a593Smuzhiyun 		 * Otherwise hub_wq wouldn't see the disconnect event when a
3527*4882a593Smuzhiyun 		 * high-speed device is switched over to the companion
3528*4882a593Smuzhiyun 		 * controller by the user.
3529*4882a593Smuzhiyun 		 */
3530*4882a593Smuzhiyun 
3531*4882a593Smuzhiyun 		if (!(temp & PORT_CONNECT))
3532*4882a593Smuzhiyun 			oxu->reset_done[i] = 0;
3533*4882a593Smuzhiyun 		if ((temp & mask) != 0 || ((temp & PORT_RESUME) != 0 &&
3534*4882a593Smuzhiyun 				time_after_eq(jiffies, oxu->reset_done[i]))) {
3535*4882a593Smuzhiyun 			if (i < 7)
3536*4882a593Smuzhiyun 				buf[0] |= 1 << (i + 1);
3537*4882a593Smuzhiyun 			else
3538*4882a593Smuzhiyun 				buf[1] |= 1 << (i - 7);
3539*4882a593Smuzhiyun 			status = STS_PCD;
3540*4882a593Smuzhiyun 		}
3541*4882a593Smuzhiyun 	}
3542*4882a593Smuzhiyun 	/* FIXME autosuspend idle root hubs */
3543*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
3544*4882a593Smuzhiyun 	return status ? retval : 0;
3545*4882a593Smuzhiyun }
3546*4882a593Smuzhiyun 
3547*4882a593Smuzhiyun /* Returns the speed of a device attached to a port on the root hub. */
oxu_port_speed(struct oxu_hcd * oxu,unsigned int portsc)3548*4882a593Smuzhiyun static inline unsigned int oxu_port_speed(struct oxu_hcd *oxu,
3549*4882a593Smuzhiyun 						unsigned int portsc)
3550*4882a593Smuzhiyun {
3551*4882a593Smuzhiyun 	switch ((portsc >> 26) & 3) {
3552*4882a593Smuzhiyun 	case 0:
3553*4882a593Smuzhiyun 		return 0;
3554*4882a593Smuzhiyun 	case 1:
3555*4882a593Smuzhiyun 		return USB_PORT_STAT_LOW_SPEED;
3556*4882a593Smuzhiyun 	case 2:
3557*4882a593Smuzhiyun 	default:
3558*4882a593Smuzhiyun 		return USB_PORT_STAT_HIGH_SPEED;
3559*4882a593Smuzhiyun 	}
3560*4882a593Smuzhiyun }
3561*4882a593Smuzhiyun 
3562*4882a593Smuzhiyun #define	PORT_WAKE_BITS	(PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
oxu_hub_control(struct usb_hcd * hcd,u16 typeReq,u16 wValue,u16 wIndex,char * buf,u16 wLength)3563*4882a593Smuzhiyun static int oxu_hub_control(struct usb_hcd *hcd, u16 typeReq,
3564*4882a593Smuzhiyun 				u16 wValue, u16 wIndex, char *buf, u16 wLength)
3565*4882a593Smuzhiyun {
3566*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3567*4882a593Smuzhiyun 	int ports = HCS_N_PORTS(oxu->hcs_params);
3568*4882a593Smuzhiyun 	u32 __iomem *status_reg = &oxu->regs->port_status[wIndex - 1];
3569*4882a593Smuzhiyun 	u32 temp, status;
3570*4882a593Smuzhiyun 	unsigned long	flags;
3571*4882a593Smuzhiyun 	int retval = 0;
3572*4882a593Smuzhiyun 	unsigned selector;
3573*4882a593Smuzhiyun 
3574*4882a593Smuzhiyun 	/*
3575*4882a593Smuzhiyun 	 * FIXME:  support SetPortFeatures USB_PORT_FEAT_INDICATOR.
3576*4882a593Smuzhiyun 	 * HCS_INDICATOR may say we can change LEDs to off/amber/green.
3577*4882a593Smuzhiyun 	 * (track current state ourselves) ... blink for diagnostics,
3578*4882a593Smuzhiyun 	 * power, "this is the one", etc.  EHCI spec supports this.
3579*4882a593Smuzhiyun 	 */
3580*4882a593Smuzhiyun 
3581*4882a593Smuzhiyun 	spin_lock_irqsave(&oxu->lock, flags);
3582*4882a593Smuzhiyun 	switch (typeReq) {
3583*4882a593Smuzhiyun 	case ClearHubFeature:
3584*4882a593Smuzhiyun 		switch (wValue) {
3585*4882a593Smuzhiyun 		case C_HUB_LOCAL_POWER:
3586*4882a593Smuzhiyun 		case C_HUB_OVER_CURRENT:
3587*4882a593Smuzhiyun 			/* no hub-wide feature/status flags */
3588*4882a593Smuzhiyun 			break;
3589*4882a593Smuzhiyun 		default:
3590*4882a593Smuzhiyun 			goto error;
3591*4882a593Smuzhiyun 		}
3592*4882a593Smuzhiyun 		break;
3593*4882a593Smuzhiyun 	case ClearPortFeature:
3594*4882a593Smuzhiyun 		if (!wIndex || wIndex > ports)
3595*4882a593Smuzhiyun 			goto error;
3596*4882a593Smuzhiyun 		wIndex--;
3597*4882a593Smuzhiyun 		temp = readl(status_reg);
3598*4882a593Smuzhiyun 
3599*4882a593Smuzhiyun 		/*
3600*4882a593Smuzhiyun 		 * Even if OWNER is set, so the port is owned by the
3601*4882a593Smuzhiyun 		 * companion controller, hub_wq needs to be able to clear
3602*4882a593Smuzhiyun 		 * the port-change status bits (especially
3603*4882a593Smuzhiyun 		 * USB_PORT_STAT_C_CONNECTION).
3604*4882a593Smuzhiyun 		 */
3605*4882a593Smuzhiyun 
3606*4882a593Smuzhiyun 		switch (wValue) {
3607*4882a593Smuzhiyun 		case USB_PORT_FEAT_ENABLE:
3608*4882a593Smuzhiyun 			writel(temp & ~PORT_PE, status_reg);
3609*4882a593Smuzhiyun 			break;
3610*4882a593Smuzhiyun 		case USB_PORT_FEAT_C_ENABLE:
3611*4882a593Smuzhiyun 			writel((temp & ~PORT_RWC_BITS) | PORT_PEC, status_reg);
3612*4882a593Smuzhiyun 			break;
3613*4882a593Smuzhiyun 		case USB_PORT_FEAT_SUSPEND:
3614*4882a593Smuzhiyun 			if (temp & PORT_RESET)
3615*4882a593Smuzhiyun 				goto error;
3616*4882a593Smuzhiyun 			if (temp & PORT_SUSPEND) {
3617*4882a593Smuzhiyun 				if ((temp & PORT_PE) == 0)
3618*4882a593Smuzhiyun 					goto error;
3619*4882a593Smuzhiyun 				/* resume signaling for 20 msec */
3620*4882a593Smuzhiyun 				temp &= ~(PORT_RWC_BITS | PORT_WAKE_BITS);
3621*4882a593Smuzhiyun 				writel(temp | PORT_RESUME, status_reg);
3622*4882a593Smuzhiyun 				oxu->reset_done[wIndex] = jiffies
3623*4882a593Smuzhiyun 						+ msecs_to_jiffies(20);
3624*4882a593Smuzhiyun 			}
3625*4882a593Smuzhiyun 			break;
3626*4882a593Smuzhiyun 		case USB_PORT_FEAT_C_SUSPEND:
3627*4882a593Smuzhiyun 			/* we auto-clear this feature */
3628*4882a593Smuzhiyun 			break;
3629*4882a593Smuzhiyun 		case USB_PORT_FEAT_POWER:
3630*4882a593Smuzhiyun 			if (HCS_PPC(oxu->hcs_params))
3631*4882a593Smuzhiyun 				writel(temp & ~(PORT_RWC_BITS | PORT_POWER),
3632*4882a593Smuzhiyun 					  status_reg);
3633*4882a593Smuzhiyun 			break;
3634*4882a593Smuzhiyun 		case USB_PORT_FEAT_C_CONNECTION:
3635*4882a593Smuzhiyun 			writel((temp & ~PORT_RWC_BITS) | PORT_CSC, status_reg);
3636*4882a593Smuzhiyun 			break;
3637*4882a593Smuzhiyun 		case USB_PORT_FEAT_C_OVER_CURRENT:
3638*4882a593Smuzhiyun 			writel((temp & ~PORT_RWC_BITS) | PORT_OCC, status_reg);
3639*4882a593Smuzhiyun 			break;
3640*4882a593Smuzhiyun 		case USB_PORT_FEAT_C_RESET:
3641*4882a593Smuzhiyun 			/* GetPortStatus clears reset */
3642*4882a593Smuzhiyun 			break;
3643*4882a593Smuzhiyun 		default:
3644*4882a593Smuzhiyun 			goto error;
3645*4882a593Smuzhiyun 		}
3646*4882a593Smuzhiyun 		readl(&oxu->regs->command);	/* unblock posted write */
3647*4882a593Smuzhiyun 		break;
3648*4882a593Smuzhiyun 	case GetHubDescriptor:
3649*4882a593Smuzhiyun 		ehci_hub_descriptor(oxu, (struct usb_hub_descriptor *)
3650*4882a593Smuzhiyun 			buf);
3651*4882a593Smuzhiyun 		break;
3652*4882a593Smuzhiyun 	case GetHubStatus:
3653*4882a593Smuzhiyun 		/* no hub-wide feature/status flags */
3654*4882a593Smuzhiyun 		memset(buf, 0, 4);
3655*4882a593Smuzhiyun 		break;
3656*4882a593Smuzhiyun 	case GetPortStatus:
3657*4882a593Smuzhiyun 		if (!wIndex || wIndex > ports)
3658*4882a593Smuzhiyun 			goto error;
3659*4882a593Smuzhiyun 		wIndex--;
3660*4882a593Smuzhiyun 		status = 0;
3661*4882a593Smuzhiyun 		temp = readl(status_reg);
3662*4882a593Smuzhiyun 
3663*4882a593Smuzhiyun 		/* wPortChange bits */
3664*4882a593Smuzhiyun 		if (temp & PORT_CSC)
3665*4882a593Smuzhiyun 			status |= USB_PORT_STAT_C_CONNECTION << 16;
3666*4882a593Smuzhiyun 		if (temp & PORT_PEC)
3667*4882a593Smuzhiyun 			status |= USB_PORT_STAT_C_ENABLE << 16;
3668*4882a593Smuzhiyun 		if ((temp & PORT_OCC) && !ignore_oc)
3669*4882a593Smuzhiyun 			status |= USB_PORT_STAT_C_OVERCURRENT << 16;
3670*4882a593Smuzhiyun 
3671*4882a593Smuzhiyun 		/* whoever resumes must GetPortStatus to complete it!! */
3672*4882a593Smuzhiyun 		if (temp & PORT_RESUME) {
3673*4882a593Smuzhiyun 
3674*4882a593Smuzhiyun 			/* Remote Wakeup received? */
3675*4882a593Smuzhiyun 			if (!oxu->reset_done[wIndex]) {
3676*4882a593Smuzhiyun 				/* resume signaling for 20 msec */
3677*4882a593Smuzhiyun 				oxu->reset_done[wIndex] = jiffies
3678*4882a593Smuzhiyun 						+ msecs_to_jiffies(20);
3679*4882a593Smuzhiyun 				/* check the port again */
3680*4882a593Smuzhiyun 				mod_timer(&oxu_to_hcd(oxu)->rh_timer,
3681*4882a593Smuzhiyun 						oxu->reset_done[wIndex]);
3682*4882a593Smuzhiyun 			}
3683*4882a593Smuzhiyun 
3684*4882a593Smuzhiyun 			/* resume completed? */
3685*4882a593Smuzhiyun 			else if (time_after_eq(jiffies,
3686*4882a593Smuzhiyun 					oxu->reset_done[wIndex])) {
3687*4882a593Smuzhiyun 				status |= USB_PORT_STAT_C_SUSPEND << 16;
3688*4882a593Smuzhiyun 				oxu->reset_done[wIndex] = 0;
3689*4882a593Smuzhiyun 
3690*4882a593Smuzhiyun 				/* stop resume signaling */
3691*4882a593Smuzhiyun 				temp = readl(status_reg);
3692*4882a593Smuzhiyun 				writel(temp & ~(PORT_RWC_BITS | PORT_RESUME),
3693*4882a593Smuzhiyun 					status_reg);
3694*4882a593Smuzhiyun 				retval = handshake(oxu, status_reg,
3695*4882a593Smuzhiyun 					   PORT_RESUME, 0, 2000 /* 2msec */);
3696*4882a593Smuzhiyun 				if (retval != 0) {
3697*4882a593Smuzhiyun 					oxu_err(oxu,
3698*4882a593Smuzhiyun 						"port %d resume error %d\n",
3699*4882a593Smuzhiyun 						wIndex + 1, retval);
3700*4882a593Smuzhiyun 					goto error;
3701*4882a593Smuzhiyun 				}
3702*4882a593Smuzhiyun 				temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));
3703*4882a593Smuzhiyun 			}
3704*4882a593Smuzhiyun 		}
3705*4882a593Smuzhiyun 
3706*4882a593Smuzhiyun 		/* whoever resets must GetPortStatus to complete it!! */
3707*4882a593Smuzhiyun 		if ((temp & PORT_RESET)
3708*4882a593Smuzhiyun 				&& time_after_eq(jiffies,
3709*4882a593Smuzhiyun 					oxu->reset_done[wIndex])) {
3710*4882a593Smuzhiyun 			status |= USB_PORT_STAT_C_RESET << 16;
3711*4882a593Smuzhiyun 			oxu->reset_done[wIndex] = 0;
3712*4882a593Smuzhiyun 
3713*4882a593Smuzhiyun 			/* force reset to complete */
3714*4882a593Smuzhiyun 			writel(temp & ~(PORT_RWC_BITS | PORT_RESET),
3715*4882a593Smuzhiyun 					status_reg);
3716*4882a593Smuzhiyun 			/* REVISIT:  some hardware needs 550+ usec to clear
3717*4882a593Smuzhiyun 			 * this bit; seems too long to spin routinely...
3718*4882a593Smuzhiyun 			 */
3719*4882a593Smuzhiyun 			retval = handshake(oxu, status_reg,
3720*4882a593Smuzhiyun 					PORT_RESET, 0, 750);
3721*4882a593Smuzhiyun 			if (retval != 0) {
3722*4882a593Smuzhiyun 				oxu_err(oxu, "port %d reset error %d\n",
3723*4882a593Smuzhiyun 					wIndex + 1, retval);
3724*4882a593Smuzhiyun 				goto error;
3725*4882a593Smuzhiyun 			}
3726*4882a593Smuzhiyun 
3727*4882a593Smuzhiyun 			/* see what we found out */
3728*4882a593Smuzhiyun 			temp = check_reset_complete(oxu, wIndex, status_reg,
3729*4882a593Smuzhiyun 					readl(status_reg));
3730*4882a593Smuzhiyun 		}
3731*4882a593Smuzhiyun 
3732*4882a593Smuzhiyun 		/* transfer dedicated ports to the companion hc */
3733*4882a593Smuzhiyun 		if ((temp & PORT_CONNECT) &&
3734*4882a593Smuzhiyun 				test_bit(wIndex, &oxu->companion_ports)) {
3735*4882a593Smuzhiyun 			temp &= ~PORT_RWC_BITS;
3736*4882a593Smuzhiyun 			temp |= PORT_OWNER;
3737*4882a593Smuzhiyun 			writel(temp, status_reg);
3738*4882a593Smuzhiyun 			oxu_dbg(oxu, "port %d --> companion\n", wIndex + 1);
3739*4882a593Smuzhiyun 			temp = readl(status_reg);
3740*4882a593Smuzhiyun 		}
3741*4882a593Smuzhiyun 
3742*4882a593Smuzhiyun 		/*
3743*4882a593Smuzhiyun 		 * Even if OWNER is set, there's no harm letting hub_wq
3744*4882a593Smuzhiyun 		 * see the wPortStatus values (they should all be 0 except
3745*4882a593Smuzhiyun 		 * for PORT_POWER anyway).
3746*4882a593Smuzhiyun 		 */
3747*4882a593Smuzhiyun 
3748*4882a593Smuzhiyun 		if (temp & PORT_CONNECT) {
3749*4882a593Smuzhiyun 			status |= USB_PORT_STAT_CONNECTION;
3750*4882a593Smuzhiyun 			/* status may be from integrated TT */
3751*4882a593Smuzhiyun 			status |= oxu_port_speed(oxu, temp);
3752*4882a593Smuzhiyun 		}
3753*4882a593Smuzhiyun 		if (temp & PORT_PE)
3754*4882a593Smuzhiyun 			status |= USB_PORT_STAT_ENABLE;
3755*4882a593Smuzhiyun 		if (temp & (PORT_SUSPEND|PORT_RESUME))
3756*4882a593Smuzhiyun 			status |= USB_PORT_STAT_SUSPEND;
3757*4882a593Smuzhiyun 		if (temp & PORT_OC)
3758*4882a593Smuzhiyun 			status |= USB_PORT_STAT_OVERCURRENT;
3759*4882a593Smuzhiyun 		if (temp & PORT_RESET)
3760*4882a593Smuzhiyun 			status |= USB_PORT_STAT_RESET;
3761*4882a593Smuzhiyun 		if (temp & PORT_POWER)
3762*4882a593Smuzhiyun 			status |= USB_PORT_STAT_POWER;
3763*4882a593Smuzhiyun 
3764*4882a593Smuzhiyun #ifndef	OXU_VERBOSE_DEBUG
3765*4882a593Smuzhiyun 	if (status & ~0xffff)	/* only if wPortChange is interesting */
3766*4882a593Smuzhiyun #endif
3767*4882a593Smuzhiyun 		dbg_port(oxu, "GetStatus", wIndex + 1, temp);
3768*4882a593Smuzhiyun 		put_unaligned(cpu_to_le32(status), (__le32 *) buf);
3769*4882a593Smuzhiyun 		break;
3770*4882a593Smuzhiyun 	case SetHubFeature:
3771*4882a593Smuzhiyun 		switch (wValue) {
3772*4882a593Smuzhiyun 		case C_HUB_LOCAL_POWER:
3773*4882a593Smuzhiyun 		case C_HUB_OVER_CURRENT:
3774*4882a593Smuzhiyun 			/* no hub-wide feature/status flags */
3775*4882a593Smuzhiyun 			break;
3776*4882a593Smuzhiyun 		default:
3777*4882a593Smuzhiyun 			goto error;
3778*4882a593Smuzhiyun 		}
3779*4882a593Smuzhiyun 		break;
3780*4882a593Smuzhiyun 	case SetPortFeature:
3781*4882a593Smuzhiyun 		selector = wIndex >> 8;
3782*4882a593Smuzhiyun 		wIndex &= 0xff;
3783*4882a593Smuzhiyun 		if (!wIndex || wIndex > ports)
3784*4882a593Smuzhiyun 			goto error;
3785*4882a593Smuzhiyun 		wIndex--;
3786*4882a593Smuzhiyun 		temp = readl(status_reg);
3787*4882a593Smuzhiyun 		if (temp & PORT_OWNER)
3788*4882a593Smuzhiyun 			break;
3789*4882a593Smuzhiyun 
3790*4882a593Smuzhiyun 		temp &= ~PORT_RWC_BITS;
3791*4882a593Smuzhiyun 		switch (wValue) {
3792*4882a593Smuzhiyun 		case USB_PORT_FEAT_SUSPEND:
3793*4882a593Smuzhiyun 			if ((temp & PORT_PE) == 0
3794*4882a593Smuzhiyun 					|| (temp & PORT_RESET) != 0)
3795*4882a593Smuzhiyun 				goto error;
3796*4882a593Smuzhiyun 			if (device_may_wakeup(&hcd->self.root_hub->dev))
3797*4882a593Smuzhiyun 				temp |= PORT_WAKE_BITS;
3798*4882a593Smuzhiyun 			writel(temp | PORT_SUSPEND, status_reg);
3799*4882a593Smuzhiyun 			break;
3800*4882a593Smuzhiyun 		case USB_PORT_FEAT_POWER:
3801*4882a593Smuzhiyun 			if (HCS_PPC(oxu->hcs_params))
3802*4882a593Smuzhiyun 				writel(temp | PORT_POWER, status_reg);
3803*4882a593Smuzhiyun 			break;
3804*4882a593Smuzhiyun 		case USB_PORT_FEAT_RESET:
3805*4882a593Smuzhiyun 			if (temp & PORT_RESUME)
3806*4882a593Smuzhiyun 				goto error;
3807*4882a593Smuzhiyun 			/* line status bits may report this as low speed,
3808*4882a593Smuzhiyun 			 * which can be fine if this root hub has a
3809*4882a593Smuzhiyun 			 * transaction translator built in.
3810*4882a593Smuzhiyun 			 */
3811*4882a593Smuzhiyun 			oxu_vdbg(oxu, "port %d reset\n", wIndex + 1);
3812*4882a593Smuzhiyun 			temp |= PORT_RESET;
3813*4882a593Smuzhiyun 			temp &= ~PORT_PE;
3814*4882a593Smuzhiyun 
3815*4882a593Smuzhiyun 			/*
3816*4882a593Smuzhiyun 			 * caller must wait, then call GetPortStatus
3817*4882a593Smuzhiyun 			 * usb 2.0 spec says 50 ms resets on root
3818*4882a593Smuzhiyun 			 */
3819*4882a593Smuzhiyun 			oxu->reset_done[wIndex] = jiffies
3820*4882a593Smuzhiyun 					+ msecs_to_jiffies(50);
3821*4882a593Smuzhiyun 			writel(temp, status_reg);
3822*4882a593Smuzhiyun 			break;
3823*4882a593Smuzhiyun 
3824*4882a593Smuzhiyun 		/* For downstream facing ports (these):  one hub port is put
3825*4882a593Smuzhiyun 		 * into test mode according to USB2 11.24.2.13, then the hub
3826*4882a593Smuzhiyun 		 * must be reset (which for root hub now means rmmod+modprobe,
3827*4882a593Smuzhiyun 		 * or else system reboot).  See EHCI 2.3.9 and 4.14 for info
3828*4882a593Smuzhiyun 		 * about the EHCI-specific stuff.
3829*4882a593Smuzhiyun 		 */
3830*4882a593Smuzhiyun 		case USB_PORT_FEAT_TEST:
3831*4882a593Smuzhiyun 			if (!selector || selector > 5)
3832*4882a593Smuzhiyun 				goto error;
3833*4882a593Smuzhiyun 			ehci_quiesce(oxu);
3834*4882a593Smuzhiyun 			ehci_halt(oxu);
3835*4882a593Smuzhiyun 			temp |= selector << 16;
3836*4882a593Smuzhiyun 			writel(temp, status_reg);
3837*4882a593Smuzhiyun 			break;
3838*4882a593Smuzhiyun 
3839*4882a593Smuzhiyun 		default:
3840*4882a593Smuzhiyun 			goto error;
3841*4882a593Smuzhiyun 		}
3842*4882a593Smuzhiyun 		readl(&oxu->regs->command);	/* unblock posted writes */
3843*4882a593Smuzhiyun 		break;
3844*4882a593Smuzhiyun 
3845*4882a593Smuzhiyun 	default:
3846*4882a593Smuzhiyun error:
3847*4882a593Smuzhiyun 		/* "stall" on error */
3848*4882a593Smuzhiyun 		retval = -EPIPE;
3849*4882a593Smuzhiyun 	}
3850*4882a593Smuzhiyun 	spin_unlock_irqrestore(&oxu->lock, flags);
3851*4882a593Smuzhiyun 	return retval;
3852*4882a593Smuzhiyun }
3853*4882a593Smuzhiyun 
3854*4882a593Smuzhiyun #ifdef CONFIG_PM
3855*4882a593Smuzhiyun 
oxu_bus_suspend(struct usb_hcd * hcd)3856*4882a593Smuzhiyun static int oxu_bus_suspend(struct usb_hcd *hcd)
3857*4882a593Smuzhiyun {
3858*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3859*4882a593Smuzhiyun 	int port;
3860*4882a593Smuzhiyun 	int mask;
3861*4882a593Smuzhiyun 
3862*4882a593Smuzhiyun 	oxu_dbg(oxu, "suspend root hub\n");
3863*4882a593Smuzhiyun 
3864*4882a593Smuzhiyun 	if (time_before(jiffies, oxu->next_statechange))
3865*4882a593Smuzhiyun 		msleep(5);
3866*4882a593Smuzhiyun 
3867*4882a593Smuzhiyun 	port = HCS_N_PORTS(oxu->hcs_params);
3868*4882a593Smuzhiyun 	spin_lock_irq(&oxu->lock);
3869*4882a593Smuzhiyun 
3870*4882a593Smuzhiyun 	/* stop schedules, clean any completed work */
3871*4882a593Smuzhiyun 	if (HC_IS_RUNNING(hcd->state)) {
3872*4882a593Smuzhiyun 		ehci_quiesce(oxu);
3873*4882a593Smuzhiyun 		hcd->state = HC_STATE_QUIESCING;
3874*4882a593Smuzhiyun 	}
3875*4882a593Smuzhiyun 	oxu->command = readl(&oxu->regs->command);
3876*4882a593Smuzhiyun 	if (oxu->reclaim)
3877*4882a593Smuzhiyun 		oxu->reclaim_ready = 1;
3878*4882a593Smuzhiyun 	ehci_work(oxu);
3879*4882a593Smuzhiyun 
3880*4882a593Smuzhiyun 	/* Unlike other USB host controller types, EHCI doesn't have
3881*4882a593Smuzhiyun 	 * any notion of "global" or bus-wide suspend.  The driver has
3882*4882a593Smuzhiyun 	 * to manually suspend all the active unsuspended ports, and
3883*4882a593Smuzhiyun 	 * then manually resume them in the bus_resume() routine.
3884*4882a593Smuzhiyun 	 */
3885*4882a593Smuzhiyun 	oxu->bus_suspended = 0;
3886*4882a593Smuzhiyun 	while (port--) {
3887*4882a593Smuzhiyun 		u32 __iomem *reg = &oxu->regs->port_status[port];
3888*4882a593Smuzhiyun 		u32 t1 = readl(reg) & ~PORT_RWC_BITS;
3889*4882a593Smuzhiyun 		u32 t2 = t1;
3890*4882a593Smuzhiyun 
3891*4882a593Smuzhiyun 		/* keep track of which ports we suspend */
3892*4882a593Smuzhiyun 		if ((t1 & PORT_PE) && !(t1 & PORT_OWNER) &&
3893*4882a593Smuzhiyun 				!(t1 & PORT_SUSPEND)) {
3894*4882a593Smuzhiyun 			t2 |= PORT_SUSPEND;
3895*4882a593Smuzhiyun 			set_bit(port, &oxu->bus_suspended);
3896*4882a593Smuzhiyun 		}
3897*4882a593Smuzhiyun 
3898*4882a593Smuzhiyun 		/* enable remote wakeup on all ports */
3899*4882a593Smuzhiyun 		if (device_may_wakeup(&hcd->self.root_hub->dev))
3900*4882a593Smuzhiyun 			t2 |= PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E;
3901*4882a593Smuzhiyun 		else
3902*4882a593Smuzhiyun 			t2 &= ~(PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E);
3903*4882a593Smuzhiyun 
3904*4882a593Smuzhiyun 		if (t1 != t2) {
3905*4882a593Smuzhiyun 			oxu_vdbg(oxu, "port %d, %08x -> %08x\n",
3906*4882a593Smuzhiyun 				port + 1, t1, t2);
3907*4882a593Smuzhiyun 			writel(t2, reg);
3908*4882a593Smuzhiyun 		}
3909*4882a593Smuzhiyun 	}
3910*4882a593Smuzhiyun 
3911*4882a593Smuzhiyun 	spin_unlock_irq(&oxu->lock);
3912*4882a593Smuzhiyun 	/* turn off now-idle HC */
3913*4882a593Smuzhiyun 	del_timer_sync(&oxu->watchdog);
3914*4882a593Smuzhiyun 	spin_lock_irq(&oxu->lock);
3915*4882a593Smuzhiyun 	ehci_halt(oxu);
3916*4882a593Smuzhiyun 	hcd->state = HC_STATE_SUSPENDED;
3917*4882a593Smuzhiyun 
3918*4882a593Smuzhiyun 	/* allow remote wakeup */
3919*4882a593Smuzhiyun 	mask = INTR_MASK;
3920*4882a593Smuzhiyun 	if (!device_may_wakeup(&hcd->self.root_hub->dev))
3921*4882a593Smuzhiyun 		mask &= ~STS_PCD;
3922*4882a593Smuzhiyun 	writel(mask, &oxu->regs->intr_enable);
3923*4882a593Smuzhiyun 	readl(&oxu->regs->intr_enable);
3924*4882a593Smuzhiyun 
3925*4882a593Smuzhiyun 	oxu->next_statechange = jiffies + msecs_to_jiffies(10);
3926*4882a593Smuzhiyun 	spin_unlock_irq(&oxu->lock);
3927*4882a593Smuzhiyun 	return 0;
3928*4882a593Smuzhiyun }
3929*4882a593Smuzhiyun 
3930*4882a593Smuzhiyun /* Caller has locked the root hub, and should reset/reinit on error */
oxu_bus_resume(struct usb_hcd * hcd)3931*4882a593Smuzhiyun static int oxu_bus_resume(struct usb_hcd *hcd)
3932*4882a593Smuzhiyun {
3933*4882a593Smuzhiyun 	struct oxu_hcd *oxu = hcd_to_oxu(hcd);
3934*4882a593Smuzhiyun 	u32 temp;
3935*4882a593Smuzhiyun 	int i;
3936*4882a593Smuzhiyun 
3937*4882a593Smuzhiyun 	if (time_before(jiffies, oxu->next_statechange))
3938*4882a593Smuzhiyun 		msleep(5);
3939*4882a593Smuzhiyun 	spin_lock_irq(&oxu->lock);
3940*4882a593Smuzhiyun 
3941*4882a593Smuzhiyun 	/* Ideally and we've got a real resume here, and no port's power
3942*4882a593Smuzhiyun 	 * was lost.  (For PCI, that means Vaux was maintained.)  But we
3943*4882a593Smuzhiyun 	 * could instead be restoring a swsusp snapshot -- so that BIOS was
3944*4882a593Smuzhiyun 	 * the last user of the controller, not reset/pm hardware keeping
3945*4882a593Smuzhiyun 	 * state we gave to it.
3946*4882a593Smuzhiyun 	 */
3947*4882a593Smuzhiyun 	temp = readl(&oxu->regs->intr_enable);
3948*4882a593Smuzhiyun 	oxu_dbg(oxu, "resume root hub%s\n", temp ? "" : " after power loss");
3949*4882a593Smuzhiyun 
3950*4882a593Smuzhiyun 	/* at least some APM implementations will try to deliver
3951*4882a593Smuzhiyun 	 * IRQs right away, so delay them until we're ready.
3952*4882a593Smuzhiyun 	 */
3953*4882a593Smuzhiyun 	writel(0, &oxu->regs->intr_enable);
3954*4882a593Smuzhiyun 
3955*4882a593Smuzhiyun 	/* re-init operational registers */
3956*4882a593Smuzhiyun 	writel(0, &oxu->regs->segment);
3957*4882a593Smuzhiyun 	writel(oxu->periodic_dma, &oxu->regs->frame_list);
3958*4882a593Smuzhiyun 	writel((u32) oxu->async->qh_dma, &oxu->regs->async_next);
3959*4882a593Smuzhiyun 
3960*4882a593Smuzhiyun 	/* restore CMD_RUN, framelist size, and irq threshold */
3961*4882a593Smuzhiyun 	writel(oxu->command, &oxu->regs->command);
3962*4882a593Smuzhiyun 
3963*4882a593Smuzhiyun 	/* Some controller/firmware combinations need a delay during which
3964*4882a593Smuzhiyun 	 * they set up the port statuses.  See Bugzilla #8190. */
3965*4882a593Smuzhiyun 	mdelay(8);
3966*4882a593Smuzhiyun 
3967*4882a593Smuzhiyun 	/* manually resume the ports we suspended during bus_suspend() */
3968*4882a593Smuzhiyun 	i = HCS_N_PORTS(oxu->hcs_params);
3969*4882a593Smuzhiyun 	while (i--) {
3970*4882a593Smuzhiyun 		temp = readl(&oxu->regs->port_status[i]);
3971*4882a593Smuzhiyun 		temp &= ~(PORT_RWC_BITS
3972*4882a593Smuzhiyun 			| PORT_WKOC_E | PORT_WKDISC_E | PORT_WKCONN_E);
3973*4882a593Smuzhiyun 		if (test_bit(i, &oxu->bus_suspended) && (temp & PORT_SUSPEND)) {
3974*4882a593Smuzhiyun 			oxu->reset_done[i] = jiffies + msecs_to_jiffies(20);
3975*4882a593Smuzhiyun 			temp |= PORT_RESUME;
3976*4882a593Smuzhiyun 		}
3977*4882a593Smuzhiyun 		writel(temp, &oxu->regs->port_status[i]);
3978*4882a593Smuzhiyun 	}
3979*4882a593Smuzhiyun 	i = HCS_N_PORTS(oxu->hcs_params);
3980*4882a593Smuzhiyun 	mdelay(20);
3981*4882a593Smuzhiyun 	while (i--) {
3982*4882a593Smuzhiyun 		temp = readl(&oxu->regs->port_status[i]);
3983*4882a593Smuzhiyun 		if (test_bit(i, &oxu->bus_suspended) && (temp & PORT_SUSPEND)) {
3984*4882a593Smuzhiyun 			temp &= ~(PORT_RWC_BITS | PORT_RESUME);
3985*4882a593Smuzhiyun 			writel(temp, &oxu->regs->port_status[i]);
3986*4882a593Smuzhiyun 			oxu_vdbg(oxu, "resumed port %d\n", i + 1);
3987*4882a593Smuzhiyun 		}
3988*4882a593Smuzhiyun 	}
3989*4882a593Smuzhiyun 	(void) readl(&oxu->regs->command);
3990*4882a593Smuzhiyun 
3991*4882a593Smuzhiyun 	/* maybe re-activate the schedule(s) */
3992*4882a593Smuzhiyun 	temp = 0;
3993*4882a593Smuzhiyun 	if (oxu->async->qh_next.qh)
3994*4882a593Smuzhiyun 		temp |= CMD_ASE;
3995*4882a593Smuzhiyun 	if (oxu->periodic_sched)
3996*4882a593Smuzhiyun 		temp |= CMD_PSE;
3997*4882a593Smuzhiyun 	if (temp) {
3998*4882a593Smuzhiyun 		oxu->command |= temp;
3999*4882a593Smuzhiyun 		writel(oxu->command, &oxu->regs->command);
4000*4882a593Smuzhiyun 	}
4001*4882a593Smuzhiyun 
4002*4882a593Smuzhiyun 	oxu->next_statechange = jiffies + msecs_to_jiffies(5);
4003*4882a593Smuzhiyun 	hcd->state = HC_STATE_RUNNING;
4004*4882a593Smuzhiyun 
4005*4882a593Smuzhiyun 	/* Now we can safely re-enable irqs */
4006*4882a593Smuzhiyun 	writel(INTR_MASK, &oxu->regs->intr_enable);
4007*4882a593Smuzhiyun 
4008*4882a593Smuzhiyun 	spin_unlock_irq(&oxu->lock);
4009*4882a593Smuzhiyun 	return 0;
4010*4882a593Smuzhiyun }
4011*4882a593Smuzhiyun 
4012*4882a593Smuzhiyun #else
4013*4882a593Smuzhiyun 
oxu_bus_suspend(struct usb_hcd * hcd)4014*4882a593Smuzhiyun static int oxu_bus_suspend(struct usb_hcd *hcd)
4015*4882a593Smuzhiyun {
4016*4882a593Smuzhiyun 	return 0;
4017*4882a593Smuzhiyun }
4018*4882a593Smuzhiyun 
oxu_bus_resume(struct usb_hcd * hcd)4019*4882a593Smuzhiyun static int oxu_bus_resume(struct usb_hcd *hcd)
4020*4882a593Smuzhiyun {
4021*4882a593Smuzhiyun 	return 0;
4022*4882a593Smuzhiyun }
4023*4882a593Smuzhiyun 
4024*4882a593Smuzhiyun #endif	/* CONFIG_PM */
4025*4882a593Smuzhiyun 
4026*4882a593Smuzhiyun static const struct hc_driver oxu_hc_driver = {
4027*4882a593Smuzhiyun 	.description =		"oxu210hp_hcd",
4028*4882a593Smuzhiyun 	.product_desc =		"oxu210hp HCD",
4029*4882a593Smuzhiyun 	.hcd_priv_size =	sizeof(struct oxu_hcd),
4030*4882a593Smuzhiyun 
4031*4882a593Smuzhiyun 	/*
4032*4882a593Smuzhiyun 	 * Generic hardware linkage
4033*4882a593Smuzhiyun 	 */
4034*4882a593Smuzhiyun 	.irq =			oxu_irq,
4035*4882a593Smuzhiyun 	.flags =		HCD_MEMORY | HCD_USB2,
4036*4882a593Smuzhiyun 
4037*4882a593Smuzhiyun 	/*
4038*4882a593Smuzhiyun 	 * Basic lifecycle operations
4039*4882a593Smuzhiyun 	 */
4040*4882a593Smuzhiyun 	.reset =		oxu_reset,
4041*4882a593Smuzhiyun 	.start =		oxu_run,
4042*4882a593Smuzhiyun 	.stop =			oxu_stop,
4043*4882a593Smuzhiyun 	.shutdown =		oxu_shutdown,
4044*4882a593Smuzhiyun 
4045*4882a593Smuzhiyun 	/*
4046*4882a593Smuzhiyun 	 * Managing i/o requests and associated device resources
4047*4882a593Smuzhiyun 	 */
4048*4882a593Smuzhiyun 	.urb_enqueue =		oxu_urb_enqueue,
4049*4882a593Smuzhiyun 	.urb_dequeue =		oxu_urb_dequeue,
4050*4882a593Smuzhiyun 	.endpoint_disable =	oxu_endpoint_disable,
4051*4882a593Smuzhiyun 
4052*4882a593Smuzhiyun 	/*
4053*4882a593Smuzhiyun 	 * Scheduling support
4054*4882a593Smuzhiyun 	 */
4055*4882a593Smuzhiyun 	.get_frame_number =	oxu_get_frame,
4056*4882a593Smuzhiyun 
4057*4882a593Smuzhiyun 	/*
4058*4882a593Smuzhiyun 	 * Root hub support
4059*4882a593Smuzhiyun 	 */
4060*4882a593Smuzhiyun 	.hub_status_data =	oxu_hub_status_data,
4061*4882a593Smuzhiyun 	.hub_control =		oxu_hub_control,
4062*4882a593Smuzhiyun 	.bus_suspend =		oxu_bus_suspend,
4063*4882a593Smuzhiyun 	.bus_resume =		oxu_bus_resume,
4064*4882a593Smuzhiyun };
4065*4882a593Smuzhiyun 
4066*4882a593Smuzhiyun /*
4067*4882a593Smuzhiyun  * Module stuff
4068*4882a593Smuzhiyun  */
4069*4882a593Smuzhiyun 
oxu_configuration(struct platform_device * pdev,void __iomem * base)4070*4882a593Smuzhiyun static void oxu_configuration(struct platform_device *pdev, void __iomem *base)
4071*4882a593Smuzhiyun {
4072*4882a593Smuzhiyun 	u32 tmp;
4073*4882a593Smuzhiyun 
4074*4882a593Smuzhiyun 	/* Initialize top level registers.
4075*4882a593Smuzhiyun 	 * First write ever
4076*4882a593Smuzhiyun 	 */
4077*4882a593Smuzhiyun 	oxu_writel(base, OXU_HOSTIFCONFIG, 0x0000037D);
4078*4882a593Smuzhiyun 	oxu_writel(base, OXU_SOFTRESET, OXU_SRESET);
4079*4882a593Smuzhiyun 	oxu_writel(base, OXU_HOSTIFCONFIG, 0x0000037D);
4080*4882a593Smuzhiyun 
4081*4882a593Smuzhiyun 	tmp = oxu_readl(base, OXU_PIOBURSTREADCTRL);
4082*4882a593Smuzhiyun 	oxu_writel(base, OXU_PIOBURSTREADCTRL, tmp | 0x0040);
4083*4882a593Smuzhiyun 
4084*4882a593Smuzhiyun 	oxu_writel(base, OXU_ASO, OXU_SPHPOEN | OXU_OVRCCURPUPDEN |
4085*4882a593Smuzhiyun 					OXU_COMPARATOR | OXU_ASO_OP);
4086*4882a593Smuzhiyun 
4087*4882a593Smuzhiyun 	tmp = oxu_readl(base, OXU_CLKCTRL_SET);
4088*4882a593Smuzhiyun 	oxu_writel(base, OXU_CLKCTRL_SET, tmp | OXU_SYSCLKEN | OXU_USBOTGCLKEN);
4089*4882a593Smuzhiyun 
4090*4882a593Smuzhiyun 	/* Clear all top interrupt enable */
4091*4882a593Smuzhiyun 	oxu_writel(base, OXU_CHIPIRQEN_CLR, 0xff);
4092*4882a593Smuzhiyun 
4093*4882a593Smuzhiyun 	/* Clear all top interrupt status */
4094*4882a593Smuzhiyun 	oxu_writel(base, OXU_CHIPIRQSTATUS, 0xff);
4095*4882a593Smuzhiyun 
4096*4882a593Smuzhiyun 	/* Enable all needed top interrupt except OTG SPH core */
4097*4882a593Smuzhiyun 	oxu_writel(base, OXU_CHIPIRQEN_SET, OXU_USBSPHLPWUI | OXU_USBOTGLPWUI);
4098*4882a593Smuzhiyun }
4099*4882a593Smuzhiyun 
oxu_verify_id(struct platform_device * pdev,void __iomem * base)4100*4882a593Smuzhiyun static int oxu_verify_id(struct platform_device *pdev, void __iomem *base)
4101*4882a593Smuzhiyun {
4102*4882a593Smuzhiyun 	u32 id;
4103*4882a593Smuzhiyun 	static const char * const bo[] = {
4104*4882a593Smuzhiyun 		"reserved",
4105*4882a593Smuzhiyun 		"128-pin LQFP",
4106*4882a593Smuzhiyun 		"84-pin TFBGA",
4107*4882a593Smuzhiyun 		"reserved",
4108*4882a593Smuzhiyun 	};
4109*4882a593Smuzhiyun 
4110*4882a593Smuzhiyun 	/* Read controller signature register to find a match */
4111*4882a593Smuzhiyun 	id = oxu_readl(base, OXU_DEVICEID);
4112*4882a593Smuzhiyun 	dev_info(&pdev->dev, "device ID %x\n", id);
4113*4882a593Smuzhiyun 	if ((id & OXU_REV_MASK) != (OXU_REV_2100 << OXU_REV_SHIFT))
4114*4882a593Smuzhiyun 		return -1;
4115*4882a593Smuzhiyun 
4116*4882a593Smuzhiyun 	dev_info(&pdev->dev, "found device %x %s (%04x:%04x)\n",
4117*4882a593Smuzhiyun 		id >> OXU_REV_SHIFT,
4118*4882a593Smuzhiyun 		bo[(id & OXU_BO_MASK) >> OXU_BO_SHIFT],
4119*4882a593Smuzhiyun 		(id & OXU_MAJ_REV_MASK) >> OXU_MAJ_REV_SHIFT,
4120*4882a593Smuzhiyun 		(id & OXU_MIN_REV_MASK) >> OXU_MIN_REV_SHIFT);
4121*4882a593Smuzhiyun 
4122*4882a593Smuzhiyun 	return 0;
4123*4882a593Smuzhiyun }
4124*4882a593Smuzhiyun 
4125*4882a593Smuzhiyun static const struct hc_driver oxu_hc_driver;
oxu_create(struct platform_device * pdev,unsigned long memstart,unsigned long memlen,void __iomem * base,int irq,int otg)4126*4882a593Smuzhiyun static struct usb_hcd *oxu_create(struct platform_device *pdev,
4127*4882a593Smuzhiyun 				unsigned long memstart, unsigned long memlen,
4128*4882a593Smuzhiyun 				void __iomem *base, int irq, int otg)
4129*4882a593Smuzhiyun {
4130*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
4131*4882a593Smuzhiyun 
4132*4882a593Smuzhiyun 	struct usb_hcd *hcd;
4133*4882a593Smuzhiyun 	struct oxu_hcd *oxu;
4134*4882a593Smuzhiyun 	int ret;
4135*4882a593Smuzhiyun 
4136*4882a593Smuzhiyun 	/* Set endian mode and host mode */
4137*4882a593Smuzhiyun 	oxu_writel(base + (otg ? OXU_OTG_CORE_OFFSET : OXU_SPH_CORE_OFFSET),
4138*4882a593Smuzhiyun 				OXU_USBMODE,
4139*4882a593Smuzhiyun 				OXU_CM_HOST_ONLY | OXU_ES_LITTLE | OXU_VBPS);
4140*4882a593Smuzhiyun 
4141*4882a593Smuzhiyun 	hcd = usb_create_hcd(&oxu_hc_driver, dev,
4142*4882a593Smuzhiyun 				otg ? "oxu210hp_otg" : "oxu210hp_sph");
4143*4882a593Smuzhiyun 	if (!hcd)
4144*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
4145*4882a593Smuzhiyun 
4146*4882a593Smuzhiyun 	hcd->rsrc_start = memstart;
4147*4882a593Smuzhiyun 	hcd->rsrc_len = memlen;
4148*4882a593Smuzhiyun 	hcd->regs = base;
4149*4882a593Smuzhiyun 	hcd->irq = irq;
4150*4882a593Smuzhiyun 	hcd->state = HC_STATE_HALT;
4151*4882a593Smuzhiyun 
4152*4882a593Smuzhiyun 	oxu = hcd_to_oxu(hcd);
4153*4882a593Smuzhiyun 	oxu->is_otg = otg;
4154*4882a593Smuzhiyun 
4155*4882a593Smuzhiyun 	ret = usb_add_hcd(hcd, irq, IRQF_SHARED);
4156*4882a593Smuzhiyun 	if (ret < 0) {
4157*4882a593Smuzhiyun 		usb_put_hcd(hcd);
4158*4882a593Smuzhiyun 		return ERR_PTR(ret);
4159*4882a593Smuzhiyun 	}
4160*4882a593Smuzhiyun 
4161*4882a593Smuzhiyun 	device_wakeup_enable(hcd->self.controller);
4162*4882a593Smuzhiyun 	return hcd;
4163*4882a593Smuzhiyun }
4164*4882a593Smuzhiyun 
oxu_init(struct platform_device * pdev,unsigned long memstart,unsigned long memlen,void __iomem * base,int irq)4165*4882a593Smuzhiyun static int oxu_init(struct platform_device *pdev,
4166*4882a593Smuzhiyun 				unsigned long memstart, unsigned long memlen,
4167*4882a593Smuzhiyun 				void __iomem *base, int irq)
4168*4882a593Smuzhiyun {
4169*4882a593Smuzhiyun 	struct oxu_info *info = platform_get_drvdata(pdev);
4170*4882a593Smuzhiyun 	struct usb_hcd *hcd;
4171*4882a593Smuzhiyun 	int ret;
4172*4882a593Smuzhiyun 
4173*4882a593Smuzhiyun 	/* First time configuration at start up */
4174*4882a593Smuzhiyun 	oxu_configuration(pdev, base);
4175*4882a593Smuzhiyun 
4176*4882a593Smuzhiyun 	ret = oxu_verify_id(pdev, base);
4177*4882a593Smuzhiyun 	if (ret) {
4178*4882a593Smuzhiyun 		dev_err(&pdev->dev, "no devices found!\n");
4179*4882a593Smuzhiyun 		return -ENODEV;
4180*4882a593Smuzhiyun 	}
4181*4882a593Smuzhiyun 
4182*4882a593Smuzhiyun 	/* Create the OTG controller */
4183*4882a593Smuzhiyun 	hcd = oxu_create(pdev, memstart, memlen, base, irq, 1);
4184*4882a593Smuzhiyun 	if (IS_ERR(hcd)) {
4185*4882a593Smuzhiyun 		dev_err(&pdev->dev, "cannot create OTG controller!\n");
4186*4882a593Smuzhiyun 		ret = PTR_ERR(hcd);
4187*4882a593Smuzhiyun 		goto error_create_otg;
4188*4882a593Smuzhiyun 	}
4189*4882a593Smuzhiyun 	info->hcd[0] = hcd;
4190*4882a593Smuzhiyun 
4191*4882a593Smuzhiyun 	/* Create the SPH host controller */
4192*4882a593Smuzhiyun 	hcd = oxu_create(pdev, memstart, memlen, base, irq, 0);
4193*4882a593Smuzhiyun 	if (IS_ERR(hcd)) {
4194*4882a593Smuzhiyun 		dev_err(&pdev->dev, "cannot create SPH controller!\n");
4195*4882a593Smuzhiyun 		ret = PTR_ERR(hcd);
4196*4882a593Smuzhiyun 		goto error_create_sph;
4197*4882a593Smuzhiyun 	}
4198*4882a593Smuzhiyun 	info->hcd[1] = hcd;
4199*4882a593Smuzhiyun 
4200*4882a593Smuzhiyun 	oxu_writel(base, OXU_CHIPIRQEN_SET,
4201*4882a593Smuzhiyun 		oxu_readl(base, OXU_CHIPIRQEN_SET) | 3);
4202*4882a593Smuzhiyun 
4203*4882a593Smuzhiyun 	return 0;
4204*4882a593Smuzhiyun 
4205*4882a593Smuzhiyun error_create_sph:
4206*4882a593Smuzhiyun 	usb_remove_hcd(info->hcd[0]);
4207*4882a593Smuzhiyun 	usb_put_hcd(info->hcd[0]);
4208*4882a593Smuzhiyun 
4209*4882a593Smuzhiyun error_create_otg:
4210*4882a593Smuzhiyun 	return ret;
4211*4882a593Smuzhiyun }
4212*4882a593Smuzhiyun 
oxu_drv_probe(struct platform_device * pdev)4213*4882a593Smuzhiyun static int oxu_drv_probe(struct platform_device *pdev)
4214*4882a593Smuzhiyun {
4215*4882a593Smuzhiyun 	struct resource *res;
4216*4882a593Smuzhiyun 	void __iomem *base;
4217*4882a593Smuzhiyun 	unsigned long memstart, memlen;
4218*4882a593Smuzhiyun 	int irq, ret;
4219*4882a593Smuzhiyun 	struct oxu_info *info;
4220*4882a593Smuzhiyun 
4221*4882a593Smuzhiyun 	if (usb_disabled())
4222*4882a593Smuzhiyun 		return -ENODEV;
4223*4882a593Smuzhiyun 
4224*4882a593Smuzhiyun 	/*
4225*4882a593Smuzhiyun 	 * Get the platform resources
4226*4882a593Smuzhiyun 	 */
4227*4882a593Smuzhiyun 	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
4228*4882a593Smuzhiyun 	if (!res) {
4229*4882a593Smuzhiyun 		dev_err(&pdev->dev,
4230*4882a593Smuzhiyun 			"no IRQ! Check %s setup!\n", dev_name(&pdev->dev));
4231*4882a593Smuzhiyun 		return -ENODEV;
4232*4882a593Smuzhiyun 	}
4233*4882a593Smuzhiyun 	irq = res->start;
4234*4882a593Smuzhiyun 	dev_dbg(&pdev->dev, "IRQ resource %d\n", irq);
4235*4882a593Smuzhiyun 
4236*4882a593Smuzhiyun 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
4237*4882a593Smuzhiyun 	base = devm_ioremap_resource(&pdev->dev, res);
4238*4882a593Smuzhiyun 	if (IS_ERR(base)) {
4239*4882a593Smuzhiyun 		ret = PTR_ERR(base);
4240*4882a593Smuzhiyun 		goto error;
4241*4882a593Smuzhiyun 	}
4242*4882a593Smuzhiyun 	memstart = res->start;
4243*4882a593Smuzhiyun 	memlen = resource_size(res);
4244*4882a593Smuzhiyun 
4245*4882a593Smuzhiyun 	ret = irq_set_irq_type(irq, IRQF_TRIGGER_FALLING);
4246*4882a593Smuzhiyun 	if (ret) {
4247*4882a593Smuzhiyun 		dev_err(&pdev->dev, "error setting irq type\n");
4248*4882a593Smuzhiyun 		ret = -EFAULT;
4249*4882a593Smuzhiyun 		goto error;
4250*4882a593Smuzhiyun 	}
4251*4882a593Smuzhiyun 
4252*4882a593Smuzhiyun 	/* Allocate a driver data struct to hold useful info for both
4253*4882a593Smuzhiyun 	 * SPH & OTG devices
4254*4882a593Smuzhiyun 	 */
4255*4882a593Smuzhiyun 	info = devm_kzalloc(&pdev->dev, sizeof(struct oxu_info), GFP_KERNEL);
4256*4882a593Smuzhiyun 	if (!info) {
4257*4882a593Smuzhiyun 		ret = -EFAULT;
4258*4882a593Smuzhiyun 		goto error;
4259*4882a593Smuzhiyun 	}
4260*4882a593Smuzhiyun 	platform_set_drvdata(pdev, info);
4261*4882a593Smuzhiyun 
4262*4882a593Smuzhiyun 	ret = oxu_init(pdev, memstart, memlen, base, irq);
4263*4882a593Smuzhiyun 	if (ret < 0) {
4264*4882a593Smuzhiyun 		dev_dbg(&pdev->dev, "cannot init USB devices\n");
4265*4882a593Smuzhiyun 		goto error;
4266*4882a593Smuzhiyun 	}
4267*4882a593Smuzhiyun 
4268*4882a593Smuzhiyun 	dev_info(&pdev->dev, "devices enabled and running\n");
4269*4882a593Smuzhiyun 	platform_set_drvdata(pdev, info);
4270*4882a593Smuzhiyun 
4271*4882a593Smuzhiyun 	return 0;
4272*4882a593Smuzhiyun 
4273*4882a593Smuzhiyun error:
4274*4882a593Smuzhiyun 	dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), ret);
4275*4882a593Smuzhiyun 	return ret;
4276*4882a593Smuzhiyun }
4277*4882a593Smuzhiyun 
oxu_remove(struct platform_device * pdev,struct usb_hcd * hcd)4278*4882a593Smuzhiyun static void oxu_remove(struct platform_device *pdev, struct usb_hcd *hcd)
4279*4882a593Smuzhiyun {
4280*4882a593Smuzhiyun 	usb_remove_hcd(hcd);
4281*4882a593Smuzhiyun 	usb_put_hcd(hcd);
4282*4882a593Smuzhiyun }
4283*4882a593Smuzhiyun 
oxu_drv_remove(struct platform_device * pdev)4284*4882a593Smuzhiyun static int oxu_drv_remove(struct platform_device *pdev)
4285*4882a593Smuzhiyun {
4286*4882a593Smuzhiyun 	struct oxu_info *info = platform_get_drvdata(pdev);
4287*4882a593Smuzhiyun 
4288*4882a593Smuzhiyun 	oxu_remove(pdev, info->hcd[0]);
4289*4882a593Smuzhiyun 	oxu_remove(pdev, info->hcd[1]);
4290*4882a593Smuzhiyun 
4291*4882a593Smuzhiyun 	return 0;
4292*4882a593Smuzhiyun }
4293*4882a593Smuzhiyun 
oxu_drv_shutdown(struct platform_device * pdev)4294*4882a593Smuzhiyun static void oxu_drv_shutdown(struct platform_device *pdev)
4295*4882a593Smuzhiyun {
4296*4882a593Smuzhiyun 	oxu_drv_remove(pdev);
4297*4882a593Smuzhiyun }
4298*4882a593Smuzhiyun 
4299*4882a593Smuzhiyun #if 0
4300*4882a593Smuzhiyun /* FIXME: TODO */
4301*4882a593Smuzhiyun static int oxu_drv_suspend(struct device *dev)
4302*4882a593Smuzhiyun {
4303*4882a593Smuzhiyun 	struct platform_device *pdev = to_platform_device(dev);
4304*4882a593Smuzhiyun 	struct usb_hcd *hcd = dev_get_drvdata(dev);
4305*4882a593Smuzhiyun 
4306*4882a593Smuzhiyun 	return 0;
4307*4882a593Smuzhiyun }
4308*4882a593Smuzhiyun 
4309*4882a593Smuzhiyun static int oxu_drv_resume(struct device *dev)
4310*4882a593Smuzhiyun {
4311*4882a593Smuzhiyun 	struct platform_device *pdev = to_platform_device(dev);
4312*4882a593Smuzhiyun 	struct usb_hcd *hcd = dev_get_drvdata(dev);
4313*4882a593Smuzhiyun 
4314*4882a593Smuzhiyun 	return 0;
4315*4882a593Smuzhiyun }
4316*4882a593Smuzhiyun #else
4317*4882a593Smuzhiyun #define oxu_drv_suspend	NULL
4318*4882a593Smuzhiyun #define oxu_drv_resume	NULL
4319*4882a593Smuzhiyun #endif
4320*4882a593Smuzhiyun 
4321*4882a593Smuzhiyun static struct platform_driver oxu_driver = {
4322*4882a593Smuzhiyun 	.probe		= oxu_drv_probe,
4323*4882a593Smuzhiyun 	.remove		= oxu_drv_remove,
4324*4882a593Smuzhiyun 	.shutdown	= oxu_drv_shutdown,
4325*4882a593Smuzhiyun 	.suspend	= oxu_drv_suspend,
4326*4882a593Smuzhiyun 	.resume		= oxu_drv_resume,
4327*4882a593Smuzhiyun 	.driver = {
4328*4882a593Smuzhiyun 		.name = "oxu210hp-hcd",
4329*4882a593Smuzhiyun 		.bus = &platform_bus_type
4330*4882a593Smuzhiyun 	}
4331*4882a593Smuzhiyun };
4332*4882a593Smuzhiyun 
4333*4882a593Smuzhiyun module_platform_driver(oxu_driver);
4334*4882a593Smuzhiyun 
4335*4882a593Smuzhiyun MODULE_DESCRIPTION("Oxford OXU210HP HCD driver - ver. " DRIVER_VERSION);
4336*4882a593Smuzhiyun MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>");
4337*4882a593Smuzhiyun MODULE_LICENSE("GPL");
4338