1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2011 LAPIS Semiconductor Co., Ltd.
4*4882a593Smuzhiyun */
5*4882a593Smuzhiyun #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
6*4882a593Smuzhiyun #include <linux/kernel.h>
7*4882a593Smuzhiyun #include <linux/module.h>
8*4882a593Smuzhiyun #include <linux/pci.h>
9*4882a593Smuzhiyun #include <linux/delay.h>
10*4882a593Smuzhiyun #include <linux/dmi.h>
11*4882a593Smuzhiyun #include <linux/errno.h>
12*4882a593Smuzhiyun #include <linux/gpio/consumer.h>
13*4882a593Smuzhiyun #include <linux/gpio/machine.h>
14*4882a593Smuzhiyun #include <linux/list.h>
15*4882a593Smuzhiyun #include <linux/interrupt.h>
16*4882a593Smuzhiyun #include <linux/usb/ch9.h>
17*4882a593Smuzhiyun #include <linux/usb/gadget.h>
18*4882a593Smuzhiyun #include <linux/irq.h>
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun #define PCH_VBUS_PERIOD 3000 /* VBUS polling period (msec) */
21*4882a593Smuzhiyun #define PCH_VBUS_INTERVAL 10 /* VBUS polling interval (msec) */
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /* Address offset of Registers */
24*4882a593Smuzhiyun #define UDC_EP_REG_SHIFT 0x20 /* Offset to next EP */
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun #define UDC_EPCTL_ADDR 0x00 /* Endpoint control */
27*4882a593Smuzhiyun #define UDC_EPSTS_ADDR 0x04 /* Endpoint status */
28*4882a593Smuzhiyun #define UDC_BUFIN_FRAMENUM_ADDR 0x08 /* buffer size in / frame number out */
29*4882a593Smuzhiyun #define UDC_BUFOUT_MAXPKT_ADDR 0x0C /* buffer size out / maxpkt in */
30*4882a593Smuzhiyun #define UDC_SUBPTR_ADDR 0x10 /* setup buffer pointer */
31*4882a593Smuzhiyun #define UDC_DESPTR_ADDR 0x14 /* Data descriptor pointer */
32*4882a593Smuzhiyun #define UDC_CONFIRM_ADDR 0x18 /* Write/Read confirmation */
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun #define UDC_DEVCFG_ADDR 0x400 /* Device configuration */
35*4882a593Smuzhiyun #define UDC_DEVCTL_ADDR 0x404 /* Device control */
36*4882a593Smuzhiyun #define UDC_DEVSTS_ADDR 0x408 /* Device status */
37*4882a593Smuzhiyun #define UDC_DEVIRQSTS_ADDR 0x40C /* Device irq status */
38*4882a593Smuzhiyun #define UDC_DEVIRQMSK_ADDR 0x410 /* Device irq mask */
39*4882a593Smuzhiyun #define UDC_EPIRQSTS_ADDR 0x414 /* Endpoint irq status */
40*4882a593Smuzhiyun #define UDC_EPIRQMSK_ADDR 0x418 /* Endpoint irq mask */
41*4882a593Smuzhiyun #define UDC_DEVLPM_ADDR 0x41C /* LPM control / status */
42*4882a593Smuzhiyun #define UDC_CSR_BUSY_ADDR 0x4f0 /* UDC_CSR_BUSY Status register */
43*4882a593Smuzhiyun #define UDC_SRST_ADDR 0x4fc /* SOFT RESET register */
44*4882a593Smuzhiyun #define UDC_CSR_ADDR 0x500 /* USB_DEVICE endpoint register */
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun /* Endpoint control register */
47*4882a593Smuzhiyun /* Bit position */
48*4882a593Smuzhiyun #define UDC_EPCTL_MRXFLUSH (1 << 12)
49*4882a593Smuzhiyun #define UDC_EPCTL_RRDY (1 << 9)
50*4882a593Smuzhiyun #define UDC_EPCTL_CNAK (1 << 8)
51*4882a593Smuzhiyun #define UDC_EPCTL_SNAK (1 << 7)
52*4882a593Smuzhiyun #define UDC_EPCTL_NAK (1 << 6)
53*4882a593Smuzhiyun #define UDC_EPCTL_P (1 << 3)
54*4882a593Smuzhiyun #define UDC_EPCTL_F (1 << 1)
55*4882a593Smuzhiyun #define UDC_EPCTL_S (1 << 0)
56*4882a593Smuzhiyun #define UDC_EPCTL_ET_SHIFT 4
57*4882a593Smuzhiyun /* Mask patern */
58*4882a593Smuzhiyun #define UDC_EPCTL_ET_MASK 0x00000030
59*4882a593Smuzhiyun /* Value for ET field */
60*4882a593Smuzhiyun #define UDC_EPCTL_ET_CONTROL 0
61*4882a593Smuzhiyun #define UDC_EPCTL_ET_ISO 1
62*4882a593Smuzhiyun #define UDC_EPCTL_ET_BULK 2
63*4882a593Smuzhiyun #define UDC_EPCTL_ET_INTERRUPT 3
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun /* Endpoint status register */
66*4882a593Smuzhiyun /* Bit position */
67*4882a593Smuzhiyun #define UDC_EPSTS_XFERDONE (1 << 27)
68*4882a593Smuzhiyun #define UDC_EPSTS_RSS (1 << 26)
69*4882a593Smuzhiyun #define UDC_EPSTS_RCS (1 << 25)
70*4882a593Smuzhiyun #define UDC_EPSTS_TXEMPTY (1 << 24)
71*4882a593Smuzhiyun #define UDC_EPSTS_TDC (1 << 10)
72*4882a593Smuzhiyun #define UDC_EPSTS_HE (1 << 9)
73*4882a593Smuzhiyun #define UDC_EPSTS_MRXFIFO_EMP (1 << 8)
74*4882a593Smuzhiyun #define UDC_EPSTS_BNA (1 << 7)
75*4882a593Smuzhiyun #define UDC_EPSTS_IN (1 << 6)
76*4882a593Smuzhiyun #define UDC_EPSTS_OUT_SHIFT 4
77*4882a593Smuzhiyun /* Mask patern */
78*4882a593Smuzhiyun #define UDC_EPSTS_OUT_MASK 0x00000030
79*4882a593Smuzhiyun #define UDC_EPSTS_ALL_CLR_MASK 0x1F0006F0
80*4882a593Smuzhiyun /* Value for OUT field */
81*4882a593Smuzhiyun #define UDC_EPSTS_OUT_SETUP 2
82*4882a593Smuzhiyun #define UDC_EPSTS_OUT_DATA 1
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun /* Device configuration register */
85*4882a593Smuzhiyun /* Bit position */
86*4882a593Smuzhiyun #define UDC_DEVCFG_CSR_PRG (1 << 17)
87*4882a593Smuzhiyun #define UDC_DEVCFG_SP (1 << 3)
88*4882a593Smuzhiyun /* SPD Valee */
89*4882a593Smuzhiyun #define UDC_DEVCFG_SPD_HS 0x0
90*4882a593Smuzhiyun #define UDC_DEVCFG_SPD_FS 0x1
91*4882a593Smuzhiyun #define UDC_DEVCFG_SPD_LS 0x2
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun /* Device control register */
94*4882a593Smuzhiyun /* Bit position */
95*4882a593Smuzhiyun #define UDC_DEVCTL_THLEN_SHIFT 24
96*4882a593Smuzhiyun #define UDC_DEVCTL_BRLEN_SHIFT 16
97*4882a593Smuzhiyun #define UDC_DEVCTL_CSR_DONE (1 << 13)
98*4882a593Smuzhiyun #define UDC_DEVCTL_SD (1 << 10)
99*4882a593Smuzhiyun #define UDC_DEVCTL_MODE (1 << 9)
100*4882a593Smuzhiyun #define UDC_DEVCTL_BREN (1 << 8)
101*4882a593Smuzhiyun #define UDC_DEVCTL_THE (1 << 7)
102*4882a593Smuzhiyun #define UDC_DEVCTL_DU (1 << 4)
103*4882a593Smuzhiyun #define UDC_DEVCTL_TDE (1 << 3)
104*4882a593Smuzhiyun #define UDC_DEVCTL_RDE (1 << 2)
105*4882a593Smuzhiyun #define UDC_DEVCTL_RES (1 << 0)
106*4882a593Smuzhiyun
107*4882a593Smuzhiyun /* Device status register */
108*4882a593Smuzhiyun /* Bit position */
109*4882a593Smuzhiyun #define UDC_DEVSTS_TS_SHIFT 18
110*4882a593Smuzhiyun #define UDC_DEVSTS_ENUM_SPEED_SHIFT 13
111*4882a593Smuzhiyun #define UDC_DEVSTS_ALT_SHIFT 8
112*4882a593Smuzhiyun #define UDC_DEVSTS_INTF_SHIFT 4
113*4882a593Smuzhiyun #define UDC_DEVSTS_CFG_SHIFT 0
114*4882a593Smuzhiyun /* Mask patern */
115*4882a593Smuzhiyun #define UDC_DEVSTS_TS_MASK 0xfffc0000
116*4882a593Smuzhiyun #define UDC_DEVSTS_ENUM_SPEED_MASK 0x00006000
117*4882a593Smuzhiyun #define UDC_DEVSTS_ALT_MASK 0x00000f00
118*4882a593Smuzhiyun #define UDC_DEVSTS_INTF_MASK 0x000000f0
119*4882a593Smuzhiyun #define UDC_DEVSTS_CFG_MASK 0x0000000f
120*4882a593Smuzhiyun /* value for maximum speed for SPEED field */
121*4882a593Smuzhiyun #define UDC_DEVSTS_ENUM_SPEED_FULL 1
122*4882a593Smuzhiyun #define UDC_DEVSTS_ENUM_SPEED_HIGH 0
123*4882a593Smuzhiyun #define UDC_DEVSTS_ENUM_SPEED_LOW 2
124*4882a593Smuzhiyun #define UDC_DEVSTS_ENUM_SPEED_FULLX 3
125*4882a593Smuzhiyun
126*4882a593Smuzhiyun /* Device irq register */
127*4882a593Smuzhiyun /* Bit position */
128*4882a593Smuzhiyun #define UDC_DEVINT_RWKP (1 << 7)
129*4882a593Smuzhiyun #define UDC_DEVINT_ENUM (1 << 6)
130*4882a593Smuzhiyun #define UDC_DEVINT_SOF (1 << 5)
131*4882a593Smuzhiyun #define UDC_DEVINT_US (1 << 4)
132*4882a593Smuzhiyun #define UDC_DEVINT_UR (1 << 3)
133*4882a593Smuzhiyun #define UDC_DEVINT_ES (1 << 2)
134*4882a593Smuzhiyun #define UDC_DEVINT_SI (1 << 1)
135*4882a593Smuzhiyun #define UDC_DEVINT_SC (1 << 0)
136*4882a593Smuzhiyun /* Mask patern */
137*4882a593Smuzhiyun #define UDC_DEVINT_MSK 0x7f
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun /* Endpoint irq register */
140*4882a593Smuzhiyun /* Bit position */
141*4882a593Smuzhiyun #define UDC_EPINT_IN_SHIFT 0
142*4882a593Smuzhiyun #define UDC_EPINT_OUT_SHIFT 16
143*4882a593Smuzhiyun #define UDC_EPINT_IN_EP0 (1 << 0)
144*4882a593Smuzhiyun #define UDC_EPINT_OUT_EP0 (1 << 16)
145*4882a593Smuzhiyun /* Mask patern */
146*4882a593Smuzhiyun #define UDC_EPINT_MSK_DISABLE_ALL 0xffffffff
147*4882a593Smuzhiyun
148*4882a593Smuzhiyun /* UDC_CSR_BUSY Status register */
149*4882a593Smuzhiyun /* Bit position */
150*4882a593Smuzhiyun #define UDC_CSR_BUSY (1 << 0)
151*4882a593Smuzhiyun
152*4882a593Smuzhiyun /* SOFT RESET register */
153*4882a593Smuzhiyun /* Bit position */
154*4882a593Smuzhiyun #define UDC_PSRST (1 << 1)
155*4882a593Smuzhiyun #define UDC_SRST (1 << 0)
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun /* USB_DEVICE endpoint register */
158*4882a593Smuzhiyun /* Bit position */
159*4882a593Smuzhiyun #define UDC_CSR_NE_NUM_SHIFT 0
160*4882a593Smuzhiyun #define UDC_CSR_NE_DIR_SHIFT 4
161*4882a593Smuzhiyun #define UDC_CSR_NE_TYPE_SHIFT 5
162*4882a593Smuzhiyun #define UDC_CSR_NE_CFG_SHIFT 7
163*4882a593Smuzhiyun #define UDC_CSR_NE_INTF_SHIFT 11
164*4882a593Smuzhiyun #define UDC_CSR_NE_ALT_SHIFT 15
165*4882a593Smuzhiyun #define UDC_CSR_NE_MAX_PKT_SHIFT 19
166*4882a593Smuzhiyun /* Mask patern */
167*4882a593Smuzhiyun #define UDC_CSR_NE_NUM_MASK 0x0000000f
168*4882a593Smuzhiyun #define UDC_CSR_NE_DIR_MASK 0x00000010
169*4882a593Smuzhiyun #define UDC_CSR_NE_TYPE_MASK 0x00000060
170*4882a593Smuzhiyun #define UDC_CSR_NE_CFG_MASK 0x00000780
171*4882a593Smuzhiyun #define UDC_CSR_NE_INTF_MASK 0x00007800
172*4882a593Smuzhiyun #define UDC_CSR_NE_ALT_MASK 0x00078000
173*4882a593Smuzhiyun #define UDC_CSR_NE_MAX_PKT_MASK 0x3ff80000
174*4882a593Smuzhiyun
175*4882a593Smuzhiyun #define PCH_UDC_CSR(ep) (UDC_CSR_ADDR + ep*4)
176*4882a593Smuzhiyun #define PCH_UDC_EPINT(in, num)\
177*4882a593Smuzhiyun (1 << (num + (in ? UDC_EPINT_IN_SHIFT : UDC_EPINT_OUT_SHIFT)))
178*4882a593Smuzhiyun
179*4882a593Smuzhiyun /* Index of endpoint */
180*4882a593Smuzhiyun #define UDC_EP0IN_IDX 0
181*4882a593Smuzhiyun #define UDC_EP0OUT_IDX 1
182*4882a593Smuzhiyun #define UDC_EPIN_IDX(ep) (ep * 2)
183*4882a593Smuzhiyun #define UDC_EPOUT_IDX(ep) (ep * 2 + 1)
184*4882a593Smuzhiyun #define PCH_UDC_EP0 0
185*4882a593Smuzhiyun #define PCH_UDC_EP1 1
186*4882a593Smuzhiyun #define PCH_UDC_EP2 2
187*4882a593Smuzhiyun #define PCH_UDC_EP3 3
188*4882a593Smuzhiyun
189*4882a593Smuzhiyun /* Number of endpoint */
190*4882a593Smuzhiyun #define PCH_UDC_EP_NUM 32 /* Total number of EPs (16 IN,16 OUT) */
191*4882a593Smuzhiyun #define PCH_UDC_USED_EP_NUM 4 /* EP number of EP's really used */
192*4882a593Smuzhiyun /* Length Value */
193*4882a593Smuzhiyun #define PCH_UDC_BRLEN 0x0F /* Burst length */
194*4882a593Smuzhiyun #define PCH_UDC_THLEN 0x1F /* Threshold length */
195*4882a593Smuzhiyun /* Value of EP Buffer Size */
196*4882a593Smuzhiyun #define UDC_EP0IN_BUFF_SIZE 16
197*4882a593Smuzhiyun #define UDC_EPIN_BUFF_SIZE 256
198*4882a593Smuzhiyun #define UDC_EP0OUT_BUFF_SIZE 16
199*4882a593Smuzhiyun #define UDC_EPOUT_BUFF_SIZE 256
200*4882a593Smuzhiyun /* Value of EP maximum packet size */
201*4882a593Smuzhiyun #define UDC_EP0IN_MAX_PKT_SIZE 64
202*4882a593Smuzhiyun #define UDC_EP0OUT_MAX_PKT_SIZE 64
203*4882a593Smuzhiyun #define UDC_BULK_MAX_PKT_SIZE 512
204*4882a593Smuzhiyun
205*4882a593Smuzhiyun /* DMA */
206*4882a593Smuzhiyun #define DMA_DIR_RX 1 /* DMA for data receive */
207*4882a593Smuzhiyun #define DMA_DIR_TX 2 /* DMA for data transmit */
208*4882a593Smuzhiyun #define DMA_ADDR_INVALID (~(dma_addr_t)0)
209*4882a593Smuzhiyun #define UDC_DMA_MAXPACKET 65536 /* maximum packet size for DMA */
210*4882a593Smuzhiyun
211*4882a593Smuzhiyun /**
212*4882a593Smuzhiyun * struct pch_udc_data_dma_desc - Structure to hold DMA descriptor information
213*4882a593Smuzhiyun * for data
214*4882a593Smuzhiyun * @status: Status quadlet
215*4882a593Smuzhiyun * @reserved: Reserved
216*4882a593Smuzhiyun * @dataptr: Buffer descriptor
217*4882a593Smuzhiyun * @next: Next descriptor
218*4882a593Smuzhiyun */
219*4882a593Smuzhiyun struct pch_udc_data_dma_desc {
220*4882a593Smuzhiyun u32 status;
221*4882a593Smuzhiyun u32 reserved;
222*4882a593Smuzhiyun u32 dataptr;
223*4882a593Smuzhiyun u32 next;
224*4882a593Smuzhiyun };
225*4882a593Smuzhiyun
226*4882a593Smuzhiyun /**
227*4882a593Smuzhiyun * struct pch_udc_stp_dma_desc - Structure to hold DMA descriptor information
228*4882a593Smuzhiyun * for control data
229*4882a593Smuzhiyun * @status: Status
230*4882a593Smuzhiyun * @reserved: Reserved
231*4882a593Smuzhiyun * @request: Control Request
232*4882a593Smuzhiyun */
233*4882a593Smuzhiyun struct pch_udc_stp_dma_desc {
234*4882a593Smuzhiyun u32 status;
235*4882a593Smuzhiyun u32 reserved;
236*4882a593Smuzhiyun struct usb_ctrlrequest request;
237*4882a593Smuzhiyun } __attribute((packed));
238*4882a593Smuzhiyun
239*4882a593Smuzhiyun /* DMA status definitions */
240*4882a593Smuzhiyun /* Buffer status */
241*4882a593Smuzhiyun #define PCH_UDC_BUFF_STS 0xC0000000
242*4882a593Smuzhiyun #define PCH_UDC_BS_HST_RDY 0x00000000
243*4882a593Smuzhiyun #define PCH_UDC_BS_DMA_BSY 0x40000000
244*4882a593Smuzhiyun #define PCH_UDC_BS_DMA_DONE 0x80000000
245*4882a593Smuzhiyun #define PCH_UDC_BS_HST_BSY 0xC0000000
246*4882a593Smuzhiyun /* Rx/Tx Status */
247*4882a593Smuzhiyun #define PCH_UDC_RXTX_STS 0x30000000
248*4882a593Smuzhiyun #define PCH_UDC_RTS_SUCC 0x00000000
249*4882a593Smuzhiyun #define PCH_UDC_RTS_DESERR 0x10000000
250*4882a593Smuzhiyun #define PCH_UDC_RTS_BUFERR 0x30000000
251*4882a593Smuzhiyun /* Last Descriptor Indication */
252*4882a593Smuzhiyun #define PCH_UDC_DMA_LAST 0x08000000
253*4882a593Smuzhiyun /* Number of Rx/Tx Bytes Mask */
254*4882a593Smuzhiyun #define PCH_UDC_RXTX_BYTES 0x0000ffff
255*4882a593Smuzhiyun
256*4882a593Smuzhiyun /**
257*4882a593Smuzhiyun * struct pch_udc_cfg_data - Structure to hold current configuration
258*4882a593Smuzhiyun * and interface information
259*4882a593Smuzhiyun * @cur_cfg: current configuration in use
260*4882a593Smuzhiyun * @cur_intf: current interface in use
261*4882a593Smuzhiyun * @cur_alt: current alt interface in use
262*4882a593Smuzhiyun */
263*4882a593Smuzhiyun struct pch_udc_cfg_data {
264*4882a593Smuzhiyun u16 cur_cfg;
265*4882a593Smuzhiyun u16 cur_intf;
266*4882a593Smuzhiyun u16 cur_alt;
267*4882a593Smuzhiyun };
268*4882a593Smuzhiyun
269*4882a593Smuzhiyun /**
270*4882a593Smuzhiyun * struct pch_udc_ep - Structure holding a PCH USB device Endpoint information
271*4882a593Smuzhiyun * @ep: embedded ep request
272*4882a593Smuzhiyun * @td_stp_phys: for setup request
273*4882a593Smuzhiyun * @td_data_phys: for data request
274*4882a593Smuzhiyun * @td_stp: for setup request
275*4882a593Smuzhiyun * @td_data: for data request
276*4882a593Smuzhiyun * @dev: reference to device struct
277*4882a593Smuzhiyun * @offset_addr: offset address of ep register
278*4882a593Smuzhiyun * @desc: for this ep
279*4882a593Smuzhiyun * @queue: queue for requests
280*4882a593Smuzhiyun * @num: endpoint number
281*4882a593Smuzhiyun * @in: endpoint is IN
282*4882a593Smuzhiyun * @halted: endpoint halted?
283*4882a593Smuzhiyun * @epsts: Endpoint status
284*4882a593Smuzhiyun */
285*4882a593Smuzhiyun struct pch_udc_ep {
286*4882a593Smuzhiyun struct usb_ep ep;
287*4882a593Smuzhiyun dma_addr_t td_stp_phys;
288*4882a593Smuzhiyun dma_addr_t td_data_phys;
289*4882a593Smuzhiyun struct pch_udc_stp_dma_desc *td_stp;
290*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td_data;
291*4882a593Smuzhiyun struct pch_udc_dev *dev;
292*4882a593Smuzhiyun unsigned long offset_addr;
293*4882a593Smuzhiyun struct list_head queue;
294*4882a593Smuzhiyun unsigned num:5,
295*4882a593Smuzhiyun in:1,
296*4882a593Smuzhiyun halted:1;
297*4882a593Smuzhiyun unsigned long epsts;
298*4882a593Smuzhiyun };
299*4882a593Smuzhiyun
300*4882a593Smuzhiyun /**
301*4882a593Smuzhiyun * struct pch_vbus_gpio_data - Structure holding GPIO informaton
302*4882a593Smuzhiyun * for detecting VBUS
303*4882a593Smuzhiyun * @port: gpio descriptor for the VBUS GPIO
304*4882a593Smuzhiyun * @intr: gpio interrupt number
305*4882a593Smuzhiyun * @irq_work_fall: Structure for WorkQueue
306*4882a593Smuzhiyun * @irq_work_rise: Structure for WorkQueue
307*4882a593Smuzhiyun */
308*4882a593Smuzhiyun struct pch_vbus_gpio_data {
309*4882a593Smuzhiyun struct gpio_desc *port;
310*4882a593Smuzhiyun int intr;
311*4882a593Smuzhiyun struct work_struct irq_work_fall;
312*4882a593Smuzhiyun struct work_struct irq_work_rise;
313*4882a593Smuzhiyun };
314*4882a593Smuzhiyun
315*4882a593Smuzhiyun /**
316*4882a593Smuzhiyun * struct pch_udc_dev - Structure holding complete information
317*4882a593Smuzhiyun * of the PCH USB device
318*4882a593Smuzhiyun * @gadget: gadget driver data
319*4882a593Smuzhiyun * @driver: reference to gadget driver bound
320*4882a593Smuzhiyun * @pdev: reference to the PCI device
321*4882a593Smuzhiyun * @ep: array of endpoints
322*4882a593Smuzhiyun * @lock: protects all state
323*4882a593Smuzhiyun * @stall: stall requested
324*4882a593Smuzhiyun * @prot_stall: protcol stall requested
325*4882a593Smuzhiyun * @registered: driver registered with system
326*4882a593Smuzhiyun * @suspended: driver in suspended state
327*4882a593Smuzhiyun * @connected: gadget driver associated
328*4882a593Smuzhiyun * @vbus_session: required vbus_session state
329*4882a593Smuzhiyun * @set_cfg_not_acked: pending acknowledgement 4 setup
330*4882a593Smuzhiyun * @waiting_zlp_ack: pending acknowledgement 4 ZLP
331*4882a593Smuzhiyun * @data_requests: DMA pool for data requests
332*4882a593Smuzhiyun * @stp_requests: DMA pool for setup requests
333*4882a593Smuzhiyun * @dma_addr: DMA pool for received
334*4882a593Smuzhiyun * @setup_data: Received setup data
335*4882a593Smuzhiyun * @base_addr: for mapped device memory
336*4882a593Smuzhiyun * @cfg_data: current cfg, intf, and alt in use
337*4882a593Smuzhiyun * @vbus_gpio: GPIO informaton for detecting VBUS
338*4882a593Smuzhiyun */
339*4882a593Smuzhiyun struct pch_udc_dev {
340*4882a593Smuzhiyun struct usb_gadget gadget;
341*4882a593Smuzhiyun struct usb_gadget_driver *driver;
342*4882a593Smuzhiyun struct pci_dev *pdev;
343*4882a593Smuzhiyun struct pch_udc_ep ep[PCH_UDC_EP_NUM];
344*4882a593Smuzhiyun spinlock_t lock; /* protects all state */
345*4882a593Smuzhiyun unsigned
346*4882a593Smuzhiyun stall:1,
347*4882a593Smuzhiyun prot_stall:1,
348*4882a593Smuzhiyun suspended:1,
349*4882a593Smuzhiyun connected:1,
350*4882a593Smuzhiyun vbus_session:1,
351*4882a593Smuzhiyun set_cfg_not_acked:1,
352*4882a593Smuzhiyun waiting_zlp_ack:1;
353*4882a593Smuzhiyun struct dma_pool *data_requests;
354*4882a593Smuzhiyun struct dma_pool *stp_requests;
355*4882a593Smuzhiyun dma_addr_t dma_addr;
356*4882a593Smuzhiyun struct usb_ctrlrequest setup_data;
357*4882a593Smuzhiyun void __iomem *base_addr;
358*4882a593Smuzhiyun struct pch_udc_cfg_data cfg_data;
359*4882a593Smuzhiyun struct pch_vbus_gpio_data vbus_gpio;
360*4882a593Smuzhiyun };
361*4882a593Smuzhiyun #define to_pch_udc(g) (container_of((g), struct pch_udc_dev, gadget))
362*4882a593Smuzhiyun
363*4882a593Smuzhiyun #define PCH_UDC_PCI_BAR_QUARK_X1000 0
364*4882a593Smuzhiyun #define PCH_UDC_PCI_BAR 1
365*4882a593Smuzhiyun
366*4882a593Smuzhiyun #define PCI_DEVICE_ID_INTEL_QUARK_X1000_UDC 0x0939
367*4882a593Smuzhiyun #define PCI_DEVICE_ID_INTEL_EG20T_UDC 0x8808
368*4882a593Smuzhiyun
369*4882a593Smuzhiyun #define PCI_DEVICE_ID_ML7213_IOH_UDC 0x801D
370*4882a593Smuzhiyun #define PCI_DEVICE_ID_ML7831_IOH_UDC 0x8808
371*4882a593Smuzhiyun
372*4882a593Smuzhiyun static const char ep0_string[] = "ep0in";
373*4882a593Smuzhiyun static DEFINE_SPINLOCK(udc_stall_spinlock); /* stall spin lock */
374*4882a593Smuzhiyun static bool speed_fs;
375*4882a593Smuzhiyun module_param_named(speed_fs, speed_fs, bool, S_IRUGO);
376*4882a593Smuzhiyun MODULE_PARM_DESC(speed_fs, "true for Full speed operation");
377*4882a593Smuzhiyun
378*4882a593Smuzhiyun /**
379*4882a593Smuzhiyun * struct pch_udc_request - Structure holding a PCH USB device request packet
380*4882a593Smuzhiyun * @req: embedded ep request
381*4882a593Smuzhiyun * @td_data_phys: phys. address
382*4882a593Smuzhiyun * @td_data: first dma desc. of chain
383*4882a593Smuzhiyun * @td_data_last: last dma desc. of chain
384*4882a593Smuzhiyun * @queue: associated queue
385*4882a593Smuzhiyun * @dma_going: DMA in progress for request
386*4882a593Smuzhiyun * @dma_mapped: DMA memory mapped for request
387*4882a593Smuzhiyun * @dma_done: DMA completed for request
388*4882a593Smuzhiyun * @chain_len: chain length
389*4882a593Smuzhiyun * @buf: Buffer memory for align adjustment
390*4882a593Smuzhiyun * @dma: DMA memory for align adjustment
391*4882a593Smuzhiyun */
392*4882a593Smuzhiyun struct pch_udc_request {
393*4882a593Smuzhiyun struct usb_request req;
394*4882a593Smuzhiyun dma_addr_t td_data_phys;
395*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td_data;
396*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td_data_last;
397*4882a593Smuzhiyun struct list_head queue;
398*4882a593Smuzhiyun unsigned dma_going:1,
399*4882a593Smuzhiyun dma_mapped:1,
400*4882a593Smuzhiyun dma_done:1;
401*4882a593Smuzhiyun unsigned chain_len;
402*4882a593Smuzhiyun void *buf;
403*4882a593Smuzhiyun dma_addr_t dma;
404*4882a593Smuzhiyun };
405*4882a593Smuzhiyun
pch_udc_readl(struct pch_udc_dev * dev,unsigned long reg)406*4882a593Smuzhiyun static inline u32 pch_udc_readl(struct pch_udc_dev *dev, unsigned long reg)
407*4882a593Smuzhiyun {
408*4882a593Smuzhiyun return ioread32(dev->base_addr + reg);
409*4882a593Smuzhiyun }
410*4882a593Smuzhiyun
pch_udc_writel(struct pch_udc_dev * dev,unsigned long val,unsigned long reg)411*4882a593Smuzhiyun static inline void pch_udc_writel(struct pch_udc_dev *dev,
412*4882a593Smuzhiyun unsigned long val, unsigned long reg)
413*4882a593Smuzhiyun {
414*4882a593Smuzhiyun iowrite32(val, dev->base_addr + reg);
415*4882a593Smuzhiyun }
416*4882a593Smuzhiyun
pch_udc_bit_set(struct pch_udc_dev * dev,unsigned long reg,unsigned long bitmask)417*4882a593Smuzhiyun static inline void pch_udc_bit_set(struct pch_udc_dev *dev,
418*4882a593Smuzhiyun unsigned long reg,
419*4882a593Smuzhiyun unsigned long bitmask)
420*4882a593Smuzhiyun {
421*4882a593Smuzhiyun pch_udc_writel(dev, pch_udc_readl(dev, reg) | bitmask, reg);
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun
pch_udc_bit_clr(struct pch_udc_dev * dev,unsigned long reg,unsigned long bitmask)424*4882a593Smuzhiyun static inline void pch_udc_bit_clr(struct pch_udc_dev *dev,
425*4882a593Smuzhiyun unsigned long reg,
426*4882a593Smuzhiyun unsigned long bitmask)
427*4882a593Smuzhiyun {
428*4882a593Smuzhiyun pch_udc_writel(dev, pch_udc_readl(dev, reg) & ~(bitmask), reg);
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun
pch_udc_ep_readl(struct pch_udc_ep * ep,unsigned long reg)431*4882a593Smuzhiyun static inline u32 pch_udc_ep_readl(struct pch_udc_ep *ep, unsigned long reg)
432*4882a593Smuzhiyun {
433*4882a593Smuzhiyun return ioread32(ep->dev->base_addr + ep->offset_addr + reg);
434*4882a593Smuzhiyun }
435*4882a593Smuzhiyun
pch_udc_ep_writel(struct pch_udc_ep * ep,unsigned long val,unsigned long reg)436*4882a593Smuzhiyun static inline void pch_udc_ep_writel(struct pch_udc_ep *ep,
437*4882a593Smuzhiyun unsigned long val, unsigned long reg)
438*4882a593Smuzhiyun {
439*4882a593Smuzhiyun iowrite32(val, ep->dev->base_addr + ep->offset_addr + reg);
440*4882a593Smuzhiyun }
441*4882a593Smuzhiyun
pch_udc_ep_bit_set(struct pch_udc_ep * ep,unsigned long reg,unsigned long bitmask)442*4882a593Smuzhiyun static inline void pch_udc_ep_bit_set(struct pch_udc_ep *ep,
443*4882a593Smuzhiyun unsigned long reg,
444*4882a593Smuzhiyun unsigned long bitmask)
445*4882a593Smuzhiyun {
446*4882a593Smuzhiyun pch_udc_ep_writel(ep, pch_udc_ep_readl(ep, reg) | bitmask, reg);
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun
pch_udc_ep_bit_clr(struct pch_udc_ep * ep,unsigned long reg,unsigned long bitmask)449*4882a593Smuzhiyun static inline void pch_udc_ep_bit_clr(struct pch_udc_ep *ep,
450*4882a593Smuzhiyun unsigned long reg,
451*4882a593Smuzhiyun unsigned long bitmask)
452*4882a593Smuzhiyun {
453*4882a593Smuzhiyun pch_udc_ep_writel(ep, pch_udc_ep_readl(ep, reg) & ~(bitmask), reg);
454*4882a593Smuzhiyun }
455*4882a593Smuzhiyun
456*4882a593Smuzhiyun /**
457*4882a593Smuzhiyun * pch_udc_csr_busy() - Wait till idle.
458*4882a593Smuzhiyun * @dev: Reference to pch_udc_dev structure
459*4882a593Smuzhiyun */
pch_udc_csr_busy(struct pch_udc_dev * dev)460*4882a593Smuzhiyun static void pch_udc_csr_busy(struct pch_udc_dev *dev)
461*4882a593Smuzhiyun {
462*4882a593Smuzhiyun unsigned int count = 200;
463*4882a593Smuzhiyun
464*4882a593Smuzhiyun /* Wait till idle */
465*4882a593Smuzhiyun while ((pch_udc_readl(dev, UDC_CSR_BUSY_ADDR) & UDC_CSR_BUSY)
466*4882a593Smuzhiyun && --count)
467*4882a593Smuzhiyun cpu_relax();
468*4882a593Smuzhiyun if (!count)
469*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "%s: wait error\n", __func__);
470*4882a593Smuzhiyun }
471*4882a593Smuzhiyun
472*4882a593Smuzhiyun /**
473*4882a593Smuzhiyun * pch_udc_write_csr() - Write the command and status registers.
474*4882a593Smuzhiyun * @dev: Reference to pch_udc_dev structure
475*4882a593Smuzhiyun * @val: value to be written to CSR register
476*4882a593Smuzhiyun * @ep: end-point number
477*4882a593Smuzhiyun */
pch_udc_write_csr(struct pch_udc_dev * dev,unsigned long val,unsigned int ep)478*4882a593Smuzhiyun static void pch_udc_write_csr(struct pch_udc_dev *dev, unsigned long val,
479*4882a593Smuzhiyun unsigned int ep)
480*4882a593Smuzhiyun {
481*4882a593Smuzhiyun unsigned long reg = PCH_UDC_CSR(ep);
482*4882a593Smuzhiyun
483*4882a593Smuzhiyun pch_udc_csr_busy(dev); /* Wait till idle */
484*4882a593Smuzhiyun pch_udc_writel(dev, val, reg);
485*4882a593Smuzhiyun pch_udc_csr_busy(dev); /* Wait till idle */
486*4882a593Smuzhiyun }
487*4882a593Smuzhiyun
488*4882a593Smuzhiyun /**
489*4882a593Smuzhiyun * pch_udc_read_csr() - Read the command and status registers.
490*4882a593Smuzhiyun * @dev: Reference to pch_udc_dev structure
491*4882a593Smuzhiyun * @ep: end-point number
492*4882a593Smuzhiyun *
493*4882a593Smuzhiyun * Return codes: content of CSR register
494*4882a593Smuzhiyun */
pch_udc_read_csr(struct pch_udc_dev * dev,unsigned int ep)495*4882a593Smuzhiyun static u32 pch_udc_read_csr(struct pch_udc_dev *dev, unsigned int ep)
496*4882a593Smuzhiyun {
497*4882a593Smuzhiyun unsigned long reg = PCH_UDC_CSR(ep);
498*4882a593Smuzhiyun
499*4882a593Smuzhiyun pch_udc_csr_busy(dev); /* Wait till idle */
500*4882a593Smuzhiyun pch_udc_readl(dev, reg); /* Dummy read */
501*4882a593Smuzhiyun pch_udc_csr_busy(dev); /* Wait till idle */
502*4882a593Smuzhiyun return pch_udc_readl(dev, reg);
503*4882a593Smuzhiyun }
504*4882a593Smuzhiyun
505*4882a593Smuzhiyun /**
506*4882a593Smuzhiyun * pch_udc_rmt_wakeup() - Initiate for remote wakeup
507*4882a593Smuzhiyun * @dev: Reference to pch_udc_dev structure
508*4882a593Smuzhiyun */
pch_udc_rmt_wakeup(struct pch_udc_dev * dev)509*4882a593Smuzhiyun static inline void pch_udc_rmt_wakeup(struct pch_udc_dev *dev)
510*4882a593Smuzhiyun {
511*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
512*4882a593Smuzhiyun mdelay(1);
513*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
514*4882a593Smuzhiyun }
515*4882a593Smuzhiyun
516*4882a593Smuzhiyun /**
517*4882a593Smuzhiyun * pch_udc_get_frame() - Get the current frame from device status register
518*4882a593Smuzhiyun * @dev: Reference to pch_udc_dev structure
519*4882a593Smuzhiyun * Retern current frame
520*4882a593Smuzhiyun */
pch_udc_get_frame(struct pch_udc_dev * dev)521*4882a593Smuzhiyun static inline int pch_udc_get_frame(struct pch_udc_dev *dev)
522*4882a593Smuzhiyun {
523*4882a593Smuzhiyun u32 frame = pch_udc_readl(dev, UDC_DEVSTS_ADDR);
524*4882a593Smuzhiyun return (frame & UDC_DEVSTS_TS_MASK) >> UDC_DEVSTS_TS_SHIFT;
525*4882a593Smuzhiyun }
526*4882a593Smuzhiyun
527*4882a593Smuzhiyun /**
528*4882a593Smuzhiyun * pch_udc_clear_selfpowered() - Clear the self power control
529*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
530*4882a593Smuzhiyun */
pch_udc_clear_selfpowered(struct pch_udc_dev * dev)531*4882a593Smuzhiyun static inline void pch_udc_clear_selfpowered(struct pch_udc_dev *dev)
532*4882a593Smuzhiyun {
533*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_SP);
534*4882a593Smuzhiyun }
535*4882a593Smuzhiyun
536*4882a593Smuzhiyun /**
537*4882a593Smuzhiyun * pch_udc_set_selfpowered() - Set the self power control
538*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
539*4882a593Smuzhiyun */
pch_udc_set_selfpowered(struct pch_udc_dev * dev)540*4882a593Smuzhiyun static inline void pch_udc_set_selfpowered(struct pch_udc_dev *dev)
541*4882a593Smuzhiyun {
542*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_SP);
543*4882a593Smuzhiyun }
544*4882a593Smuzhiyun
545*4882a593Smuzhiyun /**
546*4882a593Smuzhiyun * pch_udc_set_disconnect() - Set the disconnect status.
547*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
548*4882a593Smuzhiyun */
pch_udc_set_disconnect(struct pch_udc_dev * dev)549*4882a593Smuzhiyun static inline void pch_udc_set_disconnect(struct pch_udc_dev *dev)
550*4882a593Smuzhiyun {
551*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_SD);
552*4882a593Smuzhiyun }
553*4882a593Smuzhiyun
554*4882a593Smuzhiyun /**
555*4882a593Smuzhiyun * pch_udc_clear_disconnect() - Clear the disconnect status.
556*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
557*4882a593Smuzhiyun */
pch_udc_clear_disconnect(struct pch_udc_dev * dev)558*4882a593Smuzhiyun static void pch_udc_clear_disconnect(struct pch_udc_dev *dev)
559*4882a593Smuzhiyun {
560*4882a593Smuzhiyun /* Clear the disconnect */
561*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
562*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_SD);
563*4882a593Smuzhiyun mdelay(1);
564*4882a593Smuzhiyun /* Resume USB signalling */
565*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun
568*4882a593Smuzhiyun /**
569*4882a593Smuzhiyun * pch_udc_reconnect() - This API initializes usb device controller,
570*4882a593Smuzhiyun * and clear the disconnect status.
571*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
572*4882a593Smuzhiyun */
573*4882a593Smuzhiyun static void pch_udc_init(struct pch_udc_dev *dev);
pch_udc_reconnect(struct pch_udc_dev * dev)574*4882a593Smuzhiyun static void pch_udc_reconnect(struct pch_udc_dev *dev)
575*4882a593Smuzhiyun {
576*4882a593Smuzhiyun pch_udc_init(dev);
577*4882a593Smuzhiyun
578*4882a593Smuzhiyun /* enable device interrupts */
579*4882a593Smuzhiyun /* pch_udc_enable_interrupts() */
580*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVIRQMSK_ADDR,
581*4882a593Smuzhiyun UDC_DEVINT_UR | UDC_DEVINT_ENUM);
582*4882a593Smuzhiyun
583*4882a593Smuzhiyun /* Clear the disconnect */
584*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
585*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_SD);
586*4882a593Smuzhiyun mdelay(1);
587*4882a593Smuzhiyun /* Resume USB signalling */
588*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RES);
589*4882a593Smuzhiyun }
590*4882a593Smuzhiyun
591*4882a593Smuzhiyun /**
592*4882a593Smuzhiyun * pch_udc_vbus_session() - set or clearr the disconnect status.
593*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
594*4882a593Smuzhiyun * @is_active: Parameter specifying the action
595*4882a593Smuzhiyun * 0: indicating VBUS power is ending
596*4882a593Smuzhiyun * !0: indicating VBUS power is starting
597*4882a593Smuzhiyun */
pch_udc_vbus_session(struct pch_udc_dev * dev,int is_active)598*4882a593Smuzhiyun static inline void pch_udc_vbus_session(struct pch_udc_dev *dev,
599*4882a593Smuzhiyun int is_active)
600*4882a593Smuzhiyun {
601*4882a593Smuzhiyun unsigned long iflags;
602*4882a593Smuzhiyun
603*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, iflags);
604*4882a593Smuzhiyun if (is_active) {
605*4882a593Smuzhiyun pch_udc_reconnect(dev);
606*4882a593Smuzhiyun dev->vbus_session = 1;
607*4882a593Smuzhiyun } else {
608*4882a593Smuzhiyun if (dev->driver && dev->driver->disconnect) {
609*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, iflags);
610*4882a593Smuzhiyun dev->driver->disconnect(&dev->gadget);
611*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, iflags);
612*4882a593Smuzhiyun }
613*4882a593Smuzhiyun pch_udc_set_disconnect(dev);
614*4882a593Smuzhiyun dev->vbus_session = 0;
615*4882a593Smuzhiyun }
616*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, iflags);
617*4882a593Smuzhiyun }
618*4882a593Smuzhiyun
619*4882a593Smuzhiyun /**
620*4882a593Smuzhiyun * pch_udc_ep_set_stall() - Set the stall of endpoint
621*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
622*4882a593Smuzhiyun */
pch_udc_ep_set_stall(struct pch_udc_ep * ep)623*4882a593Smuzhiyun static void pch_udc_ep_set_stall(struct pch_udc_ep *ep)
624*4882a593Smuzhiyun {
625*4882a593Smuzhiyun if (ep->in) {
626*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_F);
627*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_S);
628*4882a593Smuzhiyun } else {
629*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_S);
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun }
632*4882a593Smuzhiyun
633*4882a593Smuzhiyun /**
634*4882a593Smuzhiyun * pch_udc_ep_clear_stall() - Clear the stall of endpoint
635*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
636*4882a593Smuzhiyun */
pch_udc_ep_clear_stall(struct pch_udc_ep * ep)637*4882a593Smuzhiyun static inline void pch_udc_ep_clear_stall(struct pch_udc_ep *ep)
638*4882a593Smuzhiyun {
639*4882a593Smuzhiyun /* Clear the stall */
640*4882a593Smuzhiyun pch_udc_ep_bit_clr(ep, UDC_EPCTL_ADDR, UDC_EPCTL_S);
641*4882a593Smuzhiyun /* Clear NAK by writing CNAK */
642*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_CNAK);
643*4882a593Smuzhiyun }
644*4882a593Smuzhiyun
645*4882a593Smuzhiyun /**
646*4882a593Smuzhiyun * pch_udc_ep_set_trfr_type() - Set the transfer type of endpoint
647*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
648*4882a593Smuzhiyun * @type: Type of endpoint
649*4882a593Smuzhiyun */
pch_udc_ep_set_trfr_type(struct pch_udc_ep * ep,u8 type)650*4882a593Smuzhiyun static inline void pch_udc_ep_set_trfr_type(struct pch_udc_ep *ep,
651*4882a593Smuzhiyun u8 type)
652*4882a593Smuzhiyun {
653*4882a593Smuzhiyun pch_udc_ep_writel(ep, ((type << UDC_EPCTL_ET_SHIFT) &
654*4882a593Smuzhiyun UDC_EPCTL_ET_MASK), UDC_EPCTL_ADDR);
655*4882a593Smuzhiyun }
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun /**
658*4882a593Smuzhiyun * pch_udc_ep_set_bufsz() - Set the maximum packet size for the endpoint
659*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
660*4882a593Smuzhiyun * @buf_size: The buffer word size
661*4882a593Smuzhiyun * @ep_in: EP is IN
662*4882a593Smuzhiyun */
pch_udc_ep_set_bufsz(struct pch_udc_ep * ep,u32 buf_size,u32 ep_in)663*4882a593Smuzhiyun static void pch_udc_ep_set_bufsz(struct pch_udc_ep *ep,
664*4882a593Smuzhiyun u32 buf_size, u32 ep_in)
665*4882a593Smuzhiyun {
666*4882a593Smuzhiyun u32 data;
667*4882a593Smuzhiyun if (ep_in) {
668*4882a593Smuzhiyun data = pch_udc_ep_readl(ep, UDC_BUFIN_FRAMENUM_ADDR);
669*4882a593Smuzhiyun data = (data & 0xffff0000) | (buf_size & 0xffff);
670*4882a593Smuzhiyun pch_udc_ep_writel(ep, data, UDC_BUFIN_FRAMENUM_ADDR);
671*4882a593Smuzhiyun } else {
672*4882a593Smuzhiyun data = pch_udc_ep_readl(ep, UDC_BUFOUT_MAXPKT_ADDR);
673*4882a593Smuzhiyun data = (buf_size << 16) | (data & 0xffff);
674*4882a593Smuzhiyun pch_udc_ep_writel(ep, data, UDC_BUFOUT_MAXPKT_ADDR);
675*4882a593Smuzhiyun }
676*4882a593Smuzhiyun }
677*4882a593Smuzhiyun
678*4882a593Smuzhiyun /**
679*4882a593Smuzhiyun * pch_udc_ep_set_maxpkt() - Set the Max packet size for the endpoint
680*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
681*4882a593Smuzhiyun * @pkt_size: The packet byte size
682*4882a593Smuzhiyun */
pch_udc_ep_set_maxpkt(struct pch_udc_ep * ep,u32 pkt_size)683*4882a593Smuzhiyun static void pch_udc_ep_set_maxpkt(struct pch_udc_ep *ep, u32 pkt_size)
684*4882a593Smuzhiyun {
685*4882a593Smuzhiyun u32 data = pch_udc_ep_readl(ep, UDC_BUFOUT_MAXPKT_ADDR);
686*4882a593Smuzhiyun data = (data & 0xffff0000) | (pkt_size & 0xffff);
687*4882a593Smuzhiyun pch_udc_ep_writel(ep, data, UDC_BUFOUT_MAXPKT_ADDR);
688*4882a593Smuzhiyun }
689*4882a593Smuzhiyun
690*4882a593Smuzhiyun /**
691*4882a593Smuzhiyun * pch_udc_ep_set_subptr() - Set the Setup buffer pointer for the endpoint
692*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
693*4882a593Smuzhiyun * @addr: Address of the register
694*4882a593Smuzhiyun */
pch_udc_ep_set_subptr(struct pch_udc_ep * ep,u32 addr)695*4882a593Smuzhiyun static inline void pch_udc_ep_set_subptr(struct pch_udc_ep *ep, u32 addr)
696*4882a593Smuzhiyun {
697*4882a593Smuzhiyun pch_udc_ep_writel(ep, addr, UDC_SUBPTR_ADDR);
698*4882a593Smuzhiyun }
699*4882a593Smuzhiyun
700*4882a593Smuzhiyun /**
701*4882a593Smuzhiyun * pch_udc_ep_set_ddptr() - Set the Data descriptor pointer for the endpoint
702*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
703*4882a593Smuzhiyun * @addr: Address of the register
704*4882a593Smuzhiyun */
pch_udc_ep_set_ddptr(struct pch_udc_ep * ep,u32 addr)705*4882a593Smuzhiyun static inline void pch_udc_ep_set_ddptr(struct pch_udc_ep *ep, u32 addr)
706*4882a593Smuzhiyun {
707*4882a593Smuzhiyun pch_udc_ep_writel(ep, addr, UDC_DESPTR_ADDR);
708*4882a593Smuzhiyun }
709*4882a593Smuzhiyun
710*4882a593Smuzhiyun /**
711*4882a593Smuzhiyun * pch_udc_ep_set_pd() - Set the poll demand bit for the endpoint
712*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
713*4882a593Smuzhiyun */
pch_udc_ep_set_pd(struct pch_udc_ep * ep)714*4882a593Smuzhiyun static inline void pch_udc_ep_set_pd(struct pch_udc_ep *ep)
715*4882a593Smuzhiyun {
716*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_P);
717*4882a593Smuzhiyun }
718*4882a593Smuzhiyun
719*4882a593Smuzhiyun /**
720*4882a593Smuzhiyun * pch_udc_ep_set_rrdy() - Set the receive ready bit for the endpoint
721*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
722*4882a593Smuzhiyun */
pch_udc_ep_set_rrdy(struct pch_udc_ep * ep)723*4882a593Smuzhiyun static inline void pch_udc_ep_set_rrdy(struct pch_udc_ep *ep)
724*4882a593Smuzhiyun {
725*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_RRDY);
726*4882a593Smuzhiyun }
727*4882a593Smuzhiyun
728*4882a593Smuzhiyun /**
729*4882a593Smuzhiyun * pch_udc_ep_clear_rrdy() - Clear the receive ready bit for the endpoint
730*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
731*4882a593Smuzhiyun */
pch_udc_ep_clear_rrdy(struct pch_udc_ep * ep)732*4882a593Smuzhiyun static inline void pch_udc_ep_clear_rrdy(struct pch_udc_ep *ep)
733*4882a593Smuzhiyun {
734*4882a593Smuzhiyun pch_udc_ep_bit_clr(ep, UDC_EPCTL_ADDR, UDC_EPCTL_RRDY);
735*4882a593Smuzhiyun }
736*4882a593Smuzhiyun
737*4882a593Smuzhiyun /**
738*4882a593Smuzhiyun * pch_udc_set_dma() - Set the 'TDE' or RDE bit of device control
739*4882a593Smuzhiyun * register depending on the direction specified
740*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
741*4882a593Smuzhiyun * @dir: whether Tx or Rx
742*4882a593Smuzhiyun * DMA_DIR_RX: Receive
743*4882a593Smuzhiyun * DMA_DIR_TX: Transmit
744*4882a593Smuzhiyun */
pch_udc_set_dma(struct pch_udc_dev * dev,int dir)745*4882a593Smuzhiyun static inline void pch_udc_set_dma(struct pch_udc_dev *dev, int dir)
746*4882a593Smuzhiyun {
747*4882a593Smuzhiyun if (dir == DMA_DIR_RX)
748*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RDE);
749*4882a593Smuzhiyun else if (dir == DMA_DIR_TX)
750*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_TDE);
751*4882a593Smuzhiyun }
752*4882a593Smuzhiyun
753*4882a593Smuzhiyun /**
754*4882a593Smuzhiyun * pch_udc_clear_dma() - Clear the 'TDE' or RDE bit of device control
755*4882a593Smuzhiyun * register depending on the direction specified
756*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
757*4882a593Smuzhiyun * @dir: Whether Tx or Rx
758*4882a593Smuzhiyun * DMA_DIR_RX: Receive
759*4882a593Smuzhiyun * DMA_DIR_TX: Transmit
760*4882a593Smuzhiyun */
pch_udc_clear_dma(struct pch_udc_dev * dev,int dir)761*4882a593Smuzhiyun static inline void pch_udc_clear_dma(struct pch_udc_dev *dev, int dir)
762*4882a593Smuzhiyun {
763*4882a593Smuzhiyun if (dir == DMA_DIR_RX)
764*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_RDE);
765*4882a593Smuzhiyun else if (dir == DMA_DIR_TX)
766*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_TDE);
767*4882a593Smuzhiyun }
768*4882a593Smuzhiyun
769*4882a593Smuzhiyun /**
770*4882a593Smuzhiyun * pch_udc_set_csr_done() - Set the device control register
771*4882a593Smuzhiyun * CSR done field (bit 13)
772*4882a593Smuzhiyun * @dev: reference to structure of type pch_udc_regs
773*4882a593Smuzhiyun */
pch_udc_set_csr_done(struct pch_udc_dev * dev)774*4882a593Smuzhiyun static inline void pch_udc_set_csr_done(struct pch_udc_dev *dev)
775*4882a593Smuzhiyun {
776*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR, UDC_DEVCTL_CSR_DONE);
777*4882a593Smuzhiyun }
778*4882a593Smuzhiyun
779*4882a593Smuzhiyun /**
780*4882a593Smuzhiyun * pch_udc_disable_interrupts() - Disables the specified interrupts
781*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
782*4882a593Smuzhiyun * @mask: Mask to disable interrupts
783*4882a593Smuzhiyun */
pch_udc_disable_interrupts(struct pch_udc_dev * dev,u32 mask)784*4882a593Smuzhiyun static inline void pch_udc_disable_interrupts(struct pch_udc_dev *dev,
785*4882a593Smuzhiyun u32 mask)
786*4882a593Smuzhiyun {
787*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVIRQMSK_ADDR, mask);
788*4882a593Smuzhiyun }
789*4882a593Smuzhiyun
790*4882a593Smuzhiyun /**
791*4882a593Smuzhiyun * pch_udc_enable_interrupts() - Enable the specified interrupts
792*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
793*4882a593Smuzhiyun * @mask: Mask to enable interrupts
794*4882a593Smuzhiyun */
pch_udc_enable_interrupts(struct pch_udc_dev * dev,u32 mask)795*4882a593Smuzhiyun static inline void pch_udc_enable_interrupts(struct pch_udc_dev *dev,
796*4882a593Smuzhiyun u32 mask)
797*4882a593Smuzhiyun {
798*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_DEVIRQMSK_ADDR, mask);
799*4882a593Smuzhiyun }
800*4882a593Smuzhiyun
801*4882a593Smuzhiyun /**
802*4882a593Smuzhiyun * pch_udc_disable_ep_interrupts() - Disable endpoint interrupts
803*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
804*4882a593Smuzhiyun * @mask: Mask to disable interrupts
805*4882a593Smuzhiyun */
pch_udc_disable_ep_interrupts(struct pch_udc_dev * dev,u32 mask)806*4882a593Smuzhiyun static inline void pch_udc_disable_ep_interrupts(struct pch_udc_dev *dev,
807*4882a593Smuzhiyun u32 mask)
808*4882a593Smuzhiyun {
809*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_EPIRQMSK_ADDR, mask);
810*4882a593Smuzhiyun }
811*4882a593Smuzhiyun
812*4882a593Smuzhiyun /**
813*4882a593Smuzhiyun * pch_udc_enable_ep_interrupts() - Enable endpoint interrupts
814*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
815*4882a593Smuzhiyun * @mask: Mask to enable interrupts
816*4882a593Smuzhiyun */
pch_udc_enable_ep_interrupts(struct pch_udc_dev * dev,u32 mask)817*4882a593Smuzhiyun static inline void pch_udc_enable_ep_interrupts(struct pch_udc_dev *dev,
818*4882a593Smuzhiyun u32 mask)
819*4882a593Smuzhiyun {
820*4882a593Smuzhiyun pch_udc_bit_clr(dev, UDC_EPIRQMSK_ADDR, mask);
821*4882a593Smuzhiyun }
822*4882a593Smuzhiyun
823*4882a593Smuzhiyun /**
824*4882a593Smuzhiyun * pch_udc_read_device_interrupts() - Read the device interrupts
825*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
826*4882a593Smuzhiyun * Retern The device interrupts
827*4882a593Smuzhiyun */
pch_udc_read_device_interrupts(struct pch_udc_dev * dev)828*4882a593Smuzhiyun static inline u32 pch_udc_read_device_interrupts(struct pch_udc_dev *dev)
829*4882a593Smuzhiyun {
830*4882a593Smuzhiyun return pch_udc_readl(dev, UDC_DEVIRQSTS_ADDR);
831*4882a593Smuzhiyun }
832*4882a593Smuzhiyun
833*4882a593Smuzhiyun /**
834*4882a593Smuzhiyun * pch_udc_write_device_interrupts() - Write device interrupts
835*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
836*4882a593Smuzhiyun * @val: The value to be written to interrupt register
837*4882a593Smuzhiyun */
pch_udc_write_device_interrupts(struct pch_udc_dev * dev,u32 val)838*4882a593Smuzhiyun static inline void pch_udc_write_device_interrupts(struct pch_udc_dev *dev,
839*4882a593Smuzhiyun u32 val)
840*4882a593Smuzhiyun {
841*4882a593Smuzhiyun pch_udc_writel(dev, val, UDC_DEVIRQSTS_ADDR);
842*4882a593Smuzhiyun }
843*4882a593Smuzhiyun
844*4882a593Smuzhiyun /**
845*4882a593Smuzhiyun * pch_udc_read_ep_interrupts() - Read the endpoint interrupts
846*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
847*4882a593Smuzhiyun * Retern The endpoint interrupt
848*4882a593Smuzhiyun */
pch_udc_read_ep_interrupts(struct pch_udc_dev * dev)849*4882a593Smuzhiyun static inline u32 pch_udc_read_ep_interrupts(struct pch_udc_dev *dev)
850*4882a593Smuzhiyun {
851*4882a593Smuzhiyun return pch_udc_readl(dev, UDC_EPIRQSTS_ADDR);
852*4882a593Smuzhiyun }
853*4882a593Smuzhiyun
854*4882a593Smuzhiyun /**
855*4882a593Smuzhiyun * pch_udc_write_ep_interrupts() - Clear endpoint interupts
856*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
857*4882a593Smuzhiyun * @val: The value to be written to interrupt register
858*4882a593Smuzhiyun */
pch_udc_write_ep_interrupts(struct pch_udc_dev * dev,u32 val)859*4882a593Smuzhiyun static inline void pch_udc_write_ep_interrupts(struct pch_udc_dev *dev,
860*4882a593Smuzhiyun u32 val)
861*4882a593Smuzhiyun {
862*4882a593Smuzhiyun pch_udc_writel(dev, val, UDC_EPIRQSTS_ADDR);
863*4882a593Smuzhiyun }
864*4882a593Smuzhiyun
865*4882a593Smuzhiyun /**
866*4882a593Smuzhiyun * pch_udc_read_device_status() - Read the device status
867*4882a593Smuzhiyun * @dev: Reference to structure of type pch_udc_regs
868*4882a593Smuzhiyun * Retern The device status
869*4882a593Smuzhiyun */
pch_udc_read_device_status(struct pch_udc_dev * dev)870*4882a593Smuzhiyun static inline u32 pch_udc_read_device_status(struct pch_udc_dev *dev)
871*4882a593Smuzhiyun {
872*4882a593Smuzhiyun return pch_udc_readl(dev, UDC_DEVSTS_ADDR);
873*4882a593Smuzhiyun }
874*4882a593Smuzhiyun
875*4882a593Smuzhiyun /**
876*4882a593Smuzhiyun * pch_udc_read_ep_control() - Read the endpoint control
877*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
878*4882a593Smuzhiyun * Retern The endpoint control register value
879*4882a593Smuzhiyun */
pch_udc_read_ep_control(struct pch_udc_ep * ep)880*4882a593Smuzhiyun static inline u32 pch_udc_read_ep_control(struct pch_udc_ep *ep)
881*4882a593Smuzhiyun {
882*4882a593Smuzhiyun return pch_udc_ep_readl(ep, UDC_EPCTL_ADDR);
883*4882a593Smuzhiyun }
884*4882a593Smuzhiyun
885*4882a593Smuzhiyun /**
886*4882a593Smuzhiyun * pch_udc_clear_ep_control() - Clear the endpoint control register
887*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
888*4882a593Smuzhiyun * Retern The endpoint control register value
889*4882a593Smuzhiyun */
pch_udc_clear_ep_control(struct pch_udc_ep * ep)890*4882a593Smuzhiyun static inline void pch_udc_clear_ep_control(struct pch_udc_ep *ep)
891*4882a593Smuzhiyun {
892*4882a593Smuzhiyun return pch_udc_ep_writel(ep, 0, UDC_EPCTL_ADDR);
893*4882a593Smuzhiyun }
894*4882a593Smuzhiyun
895*4882a593Smuzhiyun /**
896*4882a593Smuzhiyun * pch_udc_read_ep_status() - Read the endpoint status
897*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
898*4882a593Smuzhiyun * Retern The endpoint status
899*4882a593Smuzhiyun */
pch_udc_read_ep_status(struct pch_udc_ep * ep)900*4882a593Smuzhiyun static inline u32 pch_udc_read_ep_status(struct pch_udc_ep *ep)
901*4882a593Smuzhiyun {
902*4882a593Smuzhiyun return pch_udc_ep_readl(ep, UDC_EPSTS_ADDR);
903*4882a593Smuzhiyun }
904*4882a593Smuzhiyun
905*4882a593Smuzhiyun /**
906*4882a593Smuzhiyun * pch_udc_clear_ep_status() - Clear the endpoint status
907*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
908*4882a593Smuzhiyun * @stat: Endpoint status
909*4882a593Smuzhiyun */
pch_udc_clear_ep_status(struct pch_udc_ep * ep,u32 stat)910*4882a593Smuzhiyun static inline void pch_udc_clear_ep_status(struct pch_udc_ep *ep,
911*4882a593Smuzhiyun u32 stat)
912*4882a593Smuzhiyun {
913*4882a593Smuzhiyun return pch_udc_ep_writel(ep, stat, UDC_EPSTS_ADDR);
914*4882a593Smuzhiyun }
915*4882a593Smuzhiyun
916*4882a593Smuzhiyun /**
917*4882a593Smuzhiyun * pch_udc_ep_set_nak() - Set the bit 7 (SNAK field)
918*4882a593Smuzhiyun * of the endpoint control register
919*4882a593Smuzhiyun * @ep: Reference to structure of type pch_udc_ep_regs
920*4882a593Smuzhiyun */
pch_udc_ep_set_nak(struct pch_udc_ep * ep)921*4882a593Smuzhiyun static inline void pch_udc_ep_set_nak(struct pch_udc_ep *ep)
922*4882a593Smuzhiyun {
923*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_SNAK);
924*4882a593Smuzhiyun }
925*4882a593Smuzhiyun
926*4882a593Smuzhiyun /**
927*4882a593Smuzhiyun * pch_udc_ep_clear_nak() - Set the bit 8 (CNAK field)
928*4882a593Smuzhiyun * of the endpoint control register
929*4882a593Smuzhiyun * @ep: reference to structure of type pch_udc_ep_regs
930*4882a593Smuzhiyun */
pch_udc_ep_clear_nak(struct pch_udc_ep * ep)931*4882a593Smuzhiyun static void pch_udc_ep_clear_nak(struct pch_udc_ep *ep)
932*4882a593Smuzhiyun {
933*4882a593Smuzhiyun unsigned int loopcnt = 0;
934*4882a593Smuzhiyun struct pch_udc_dev *dev = ep->dev;
935*4882a593Smuzhiyun
936*4882a593Smuzhiyun if (!(pch_udc_ep_readl(ep, UDC_EPCTL_ADDR) & UDC_EPCTL_NAK))
937*4882a593Smuzhiyun return;
938*4882a593Smuzhiyun if (!ep->in) {
939*4882a593Smuzhiyun loopcnt = 10000;
940*4882a593Smuzhiyun while (!(pch_udc_read_ep_status(ep) & UDC_EPSTS_MRXFIFO_EMP) &&
941*4882a593Smuzhiyun --loopcnt)
942*4882a593Smuzhiyun udelay(5);
943*4882a593Smuzhiyun if (!loopcnt)
944*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "%s: RxFIFO not Empty\n",
945*4882a593Smuzhiyun __func__);
946*4882a593Smuzhiyun }
947*4882a593Smuzhiyun loopcnt = 10000;
948*4882a593Smuzhiyun while ((pch_udc_read_ep_control(ep) & UDC_EPCTL_NAK) && --loopcnt) {
949*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_CNAK);
950*4882a593Smuzhiyun udelay(5);
951*4882a593Smuzhiyun }
952*4882a593Smuzhiyun if (!loopcnt)
953*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "%s: Clear NAK not set for ep%d%s\n",
954*4882a593Smuzhiyun __func__, ep->num, (ep->in ? "in" : "out"));
955*4882a593Smuzhiyun }
956*4882a593Smuzhiyun
957*4882a593Smuzhiyun /**
958*4882a593Smuzhiyun * pch_udc_ep_fifo_flush() - Flush the endpoint fifo
959*4882a593Smuzhiyun * @ep: reference to structure of type pch_udc_ep_regs
960*4882a593Smuzhiyun * @dir: direction of endpoint
961*4882a593Smuzhiyun * 0: endpoint is OUT
962*4882a593Smuzhiyun * !0: endpoint is IN
963*4882a593Smuzhiyun */
pch_udc_ep_fifo_flush(struct pch_udc_ep * ep,int dir)964*4882a593Smuzhiyun static void pch_udc_ep_fifo_flush(struct pch_udc_ep *ep, int dir)
965*4882a593Smuzhiyun {
966*4882a593Smuzhiyun if (dir) { /* IN ep */
967*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPCTL_ADDR, UDC_EPCTL_F);
968*4882a593Smuzhiyun return;
969*4882a593Smuzhiyun }
970*4882a593Smuzhiyun }
971*4882a593Smuzhiyun
972*4882a593Smuzhiyun /**
973*4882a593Smuzhiyun * pch_udc_ep_enable() - This api enables endpoint
974*4882a593Smuzhiyun * @ep: reference to structure of type pch_udc_ep_regs
975*4882a593Smuzhiyun * @cfg: current configuration information
976*4882a593Smuzhiyun * @desc: endpoint descriptor
977*4882a593Smuzhiyun */
pch_udc_ep_enable(struct pch_udc_ep * ep,struct pch_udc_cfg_data * cfg,const struct usb_endpoint_descriptor * desc)978*4882a593Smuzhiyun static void pch_udc_ep_enable(struct pch_udc_ep *ep,
979*4882a593Smuzhiyun struct pch_udc_cfg_data *cfg,
980*4882a593Smuzhiyun const struct usb_endpoint_descriptor *desc)
981*4882a593Smuzhiyun {
982*4882a593Smuzhiyun u32 val = 0;
983*4882a593Smuzhiyun u32 buff_size = 0;
984*4882a593Smuzhiyun
985*4882a593Smuzhiyun pch_udc_ep_set_trfr_type(ep, desc->bmAttributes);
986*4882a593Smuzhiyun if (ep->in)
987*4882a593Smuzhiyun buff_size = UDC_EPIN_BUFF_SIZE;
988*4882a593Smuzhiyun else
989*4882a593Smuzhiyun buff_size = UDC_EPOUT_BUFF_SIZE;
990*4882a593Smuzhiyun pch_udc_ep_set_bufsz(ep, buff_size, ep->in);
991*4882a593Smuzhiyun pch_udc_ep_set_maxpkt(ep, usb_endpoint_maxp(desc));
992*4882a593Smuzhiyun pch_udc_ep_set_nak(ep);
993*4882a593Smuzhiyun pch_udc_ep_fifo_flush(ep, ep->in);
994*4882a593Smuzhiyun /* Configure the endpoint */
995*4882a593Smuzhiyun val = ep->num << UDC_CSR_NE_NUM_SHIFT | ep->in << UDC_CSR_NE_DIR_SHIFT |
996*4882a593Smuzhiyun ((desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) <<
997*4882a593Smuzhiyun UDC_CSR_NE_TYPE_SHIFT) |
998*4882a593Smuzhiyun (cfg->cur_cfg << UDC_CSR_NE_CFG_SHIFT) |
999*4882a593Smuzhiyun (cfg->cur_intf << UDC_CSR_NE_INTF_SHIFT) |
1000*4882a593Smuzhiyun (cfg->cur_alt << UDC_CSR_NE_ALT_SHIFT) |
1001*4882a593Smuzhiyun usb_endpoint_maxp(desc) << UDC_CSR_NE_MAX_PKT_SHIFT;
1002*4882a593Smuzhiyun
1003*4882a593Smuzhiyun if (ep->in)
1004*4882a593Smuzhiyun pch_udc_write_csr(ep->dev, val, UDC_EPIN_IDX(ep->num));
1005*4882a593Smuzhiyun else
1006*4882a593Smuzhiyun pch_udc_write_csr(ep->dev, val, UDC_EPOUT_IDX(ep->num));
1007*4882a593Smuzhiyun }
1008*4882a593Smuzhiyun
1009*4882a593Smuzhiyun /**
1010*4882a593Smuzhiyun * pch_udc_ep_disable() - This api disables endpoint
1011*4882a593Smuzhiyun * @ep: reference to structure of type pch_udc_ep_regs
1012*4882a593Smuzhiyun */
pch_udc_ep_disable(struct pch_udc_ep * ep)1013*4882a593Smuzhiyun static void pch_udc_ep_disable(struct pch_udc_ep *ep)
1014*4882a593Smuzhiyun {
1015*4882a593Smuzhiyun if (ep->in) {
1016*4882a593Smuzhiyun /* flush the fifo */
1017*4882a593Smuzhiyun pch_udc_ep_writel(ep, UDC_EPCTL_F, UDC_EPCTL_ADDR);
1018*4882a593Smuzhiyun /* set NAK */
1019*4882a593Smuzhiyun pch_udc_ep_writel(ep, UDC_EPCTL_SNAK, UDC_EPCTL_ADDR);
1020*4882a593Smuzhiyun pch_udc_ep_bit_set(ep, UDC_EPSTS_ADDR, UDC_EPSTS_IN);
1021*4882a593Smuzhiyun } else {
1022*4882a593Smuzhiyun /* set NAK */
1023*4882a593Smuzhiyun pch_udc_ep_writel(ep, UDC_EPCTL_SNAK, UDC_EPCTL_ADDR);
1024*4882a593Smuzhiyun }
1025*4882a593Smuzhiyun /* reset desc pointer */
1026*4882a593Smuzhiyun pch_udc_ep_writel(ep, 0, UDC_DESPTR_ADDR);
1027*4882a593Smuzhiyun }
1028*4882a593Smuzhiyun
1029*4882a593Smuzhiyun /**
1030*4882a593Smuzhiyun * pch_udc_wait_ep_stall() - Wait EP stall.
1031*4882a593Smuzhiyun * @ep: reference to structure of type pch_udc_ep_regs
1032*4882a593Smuzhiyun */
pch_udc_wait_ep_stall(struct pch_udc_ep * ep)1033*4882a593Smuzhiyun static void pch_udc_wait_ep_stall(struct pch_udc_ep *ep)
1034*4882a593Smuzhiyun {
1035*4882a593Smuzhiyun unsigned int count = 10000;
1036*4882a593Smuzhiyun
1037*4882a593Smuzhiyun /* Wait till idle */
1038*4882a593Smuzhiyun while ((pch_udc_read_ep_control(ep) & UDC_EPCTL_S) && --count)
1039*4882a593Smuzhiyun udelay(5);
1040*4882a593Smuzhiyun if (!count)
1041*4882a593Smuzhiyun dev_err(&ep->dev->pdev->dev, "%s: wait error\n", __func__);
1042*4882a593Smuzhiyun }
1043*4882a593Smuzhiyun
1044*4882a593Smuzhiyun /**
1045*4882a593Smuzhiyun * pch_udc_init() - This API initializes usb device controller
1046*4882a593Smuzhiyun * @dev: Rreference to pch_udc_regs structure
1047*4882a593Smuzhiyun */
pch_udc_init(struct pch_udc_dev * dev)1048*4882a593Smuzhiyun static void pch_udc_init(struct pch_udc_dev *dev)
1049*4882a593Smuzhiyun {
1050*4882a593Smuzhiyun if (NULL == dev) {
1051*4882a593Smuzhiyun pr_err("%s: Invalid address\n", __func__);
1052*4882a593Smuzhiyun return;
1053*4882a593Smuzhiyun }
1054*4882a593Smuzhiyun /* Soft Reset and Reset PHY */
1055*4882a593Smuzhiyun pch_udc_writel(dev, UDC_SRST, UDC_SRST_ADDR);
1056*4882a593Smuzhiyun pch_udc_writel(dev, UDC_SRST | UDC_PSRST, UDC_SRST_ADDR);
1057*4882a593Smuzhiyun mdelay(1);
1058*4882a593Smuzhiyun pch_udc_writel(dev, UDC_SRST, UDC_SRST_ADDR);
1059*4882a593Smuzhiyun pch_udc_writel(dev, 0x00, UDC_SRST_ADDR);
1060*4882a593Smuzhiyun mdelay(1);
1061*4882a593Smuzhiyun /* mask and clear all device interrupts */
1062*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVIRQMSK_ADDR, UDC_DEVINT_MSK);
1063*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVIRQSTS_ADDR, UDC_DEVINT_MSK);
1064*4882a593Smuzhiyun
1065*4882a593Smuzhiyun /* mask and clear all ep interrupts */
1066*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_EPIRQMSK_ADDR, UDC_EPINT_MSK_DISABLE_ALL);
1067*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_EPIRQSTS_ADDR, UDC_EPINT_MSK_DISABLE_ALL);
1068*4882a593Smuzhiyun
1069*4882a593Smuzhiyun /* enable dynamic CSR programmingi, self powered and device speed */
1070*4882a593Smuzhiyun if (speed_fs)
1071*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_CSR_PRG |
1072*4882a593Smuzhiyun UDC_DEVCFG_SP | UDC_DEVCFG_SPD_FS);
1073*4882a593Smuzhiyun else /* defaul high speed */
1074*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCFG_ADDR, UDC_DEVCFG_CSR_PRG |
1075*4882a593Smuzhiyun UDC_DEVCFG_SP | UDC_DEVCFG_SPD_HS);
1076*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVCTL_ADDR,
1077*4882a593Smuzhiyun (PCH_UDC_THLEN << UDC_DEVCTL_THLEN_SHIFT) |
1078*4882a593Smuzhiyun (PCH_UDC_BRLEN << UDC_DEVCTL_BRLEN_SHIFT) |
1079*4882a593Smuzhiyun UDC_DEVCTL_MODE | UDC_DEVCTL_BREN |
1080*4882a593Smuzhiyun UDC_DEVCTL_THE);
1081*4882a593Smuzhiyun }
1082*4882a593Smuzhiyun
1083*4882a593Smuzhiyun /**
1084*4882a593Smuzhiyun * pch_udc_exit() - This API exit usb device controller
1085*4882a593Smuzhiyun * @dev: Reference to pch_udc_regs structure
1086*4882a593Smuzhiyun */
pch_udc_exit(struct pch_udc_dev * dev)1087*4882a593Smuzhiyun static void pch_udc_exit(struct pch_udc_dev *dev)
1088*4882a593Smuzhiyun {
1089*4882a593Smuzhiyun /* mask all device interrupts */
1090*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_DEVIRQMSK_ADDR, UDC_DEVINT_MSK);
1091*4882a593Smuzhiyun /* mask all ep interrupts */
1092*4882a593Smuzhiyun pch_udc_bit_set(dev, UDC_EPIRQMSK_ADDR, UDC_EPINT_MSK_DISABLE_ALL);
1093*4882a593Smuzhiyun /* put device in disconnected state */
1094*4882a593Smuzhiyun pch_udc_set_disconnect(dev);
1095*4882a593Smuzhiyun }
1096*4882a593Smuzhiyun
1097*4882a593Smuzhiyun /**
1098*4882a593Smuzhiyun * pch_udc_pcd_get_frame() - This API is invoked to get the current frame number
1099*4882a593Smuzhiyun * @gadget: Reference to the gadget driver
1100*4882a593Smuzhiyun *
1101*4882a593Smuzhiyun * Return codes:
1102*4882a593Smuzhiyun * 0: Success
1103*4882a593Smuzhiyun * -EINVAL: If the gadget passed is NULL
1104*4882a593Smuzhiyun */
pch_udc_pcd_get_frame(struct usb_gadget * gadget)1105*4882a593Smuzhiyun static int pch_udc_pcd_get_frame(struct usb_gadget *gadget)
1106*4882a593Smuzhiyun {
1107*4882a593Smuzhiyun struct pch_udc_dev *dev;
1108*4882a593Smuzhiyun
1109*4882a593Smuzhiyun if (!gadget)
1110*4882a593Smuzhiyun return -EINVAL;
1111*4882a593Smuzhiyun dev = container_of(gadget, struct pch_udc_dev, gadget);
1112*4882a593Smuzhiyun return pch_udc_get_frame(dev);
1113*4882a593Smuzhiyun }
1114*4882a593Smuzhiyun
1115*4882a593Smuzhiyun /**
1116*4882a593Smuzhiyun * pch_udc_pcd_wakeup() - This API is invoked to initiate a remote wakeup
1117*4882a593Smuzhiyun * @gadget: Reference to the gadget driver
1118*4882a593Smuzhiyun *
1119*4882a593Smuzhiyun * Return codes:
1120*4882a593Smuzhiyun * 0: Success
1121*4882a593Smuzhiyun * -EINVAL: If the gadget passed is NULL
1122*4882a593Smuzhiyun */
pch_udc_pcd_wakeup(struct usb_gadget * gadget)1123*4882a593Smuzhiyun static int pch_udc_pcd_wakeup(struct usb_gadget *gadget)
1124*4882a593Smuzhiyun {
1125*4882a593Smuzhiyun struct pch_udc_dev *dev;
1126*4882a593Smuzhiyun unsigned long flags;
1127*4882a593Smuzhiyun
1128*4882a593Smuzhiyun if (!gadget)
1129*4882a593Smuzhiyun return -EINVAL;
1130*4882a593Smuzhiyun dev = container_of(gadget, struct pch_udc_dev, gadget);
1131*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, flags);
1132*4882a593Smuzhiyun pch_udc_rmt_wakeup(dev);
1133*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, flags);
1134*4882a593Smuzhiyun return 0;
1135*4882a593Smuzhiyun }
1136*4882a593Smuzhiyun
1137*4882a593Smuzhiyun /**
1138*4882a593Smuzhiyun * pch_udc_pcd_selfpowered() - This API is invoked to specify whether the device
1139*4882a593Smuzhiyun * is self powered or not
1140*4882a593Smuzhiyun * @gadget: Reference to the gadget driver
1141*4882a593Smuzhiyun * @value: Specifies self powered or not
1142*4882a593Smuzhiyun *
1143*4882a593Smuzhiyun * Return codes:
1144*4882a593Smuzhiyun * 0: Success
1145*4882a593Smuzhiyun * -EINVAL: If the gadget passed is NULL
1146*4882a593Smuzhiyun */
pch_udc_pcd_selfpowered(struct usb_gadget * gadget,int value)1147*4882a593Smuzhiyun static int pch_udc_pcd_selfpowered(struct usb_gadget *gadget, int value)
1148*4882a593Smuzhiyun {
1149*4882a593Smuzhiyun struct pch_udc_dev *dev;
1150*4882a593Smuzhiyun
1151*4882a593Smuzhiyun if (!gadget)
1152*4882a593Smuzhiyun return -EINVAL;
1153*4882a593Smuzhiyun gadget->is_selfpowered = (value != 0);
1154*4882a593Smuzhiyun dev = container_of(gadget, struct pch_udc_dev, gadget);
1155*4882a593Smuzhiyun if (value)
1156*4882a593Smuzhiyun pch_udc_set_selfpowered(dev);
1157*4882a593Smuzhiyun else
1158*4882a593Smuzhiyun pch_udc_clear_selfpowered(dev);
1159*4882a593Smuzhiyun return 0;
1160*4882a593Smuzhiyun }
1161*4882a593Smuzhiyun
1162*4882a593Smuzhiyun /**
1163*4882a593Smuzhiyun * pch_udc_pcd_pullup() - This API is invoked to make the device
1164*4882a593Smuzhiyun * visible/invisible to the host
1165*4882a593Smuzhiyun * @gadget: Reference to the gadget driver
1166*4882a593Smuzhiyun * @is_on: Specifies whether the pull up is made active or inactive
1167*4882a593Smuzhiyun *
1168*4882a593Smuzhiyun * Return codes:
1169*4882a593Smuzhiyun * 0: Success
1170*4882a593Smuzhiyun * -EINVAL: If the gadget passed is NULL
1171*4882a593Smuzhiyun */
pch_udc_pcd_pullup(struct usb_gadget * gadget,int is_on)1172*4882a593Smuzhiyun static int pch_udc_pcd_pullup(struct usb_gadget *gadget, int is_on)
1173*4882a593Smuzhiyun {
1174*4882a593Smuzhiyun struct pch_udc_dev *dev;
1175*4882a593Smuzhiyun unsigned long iflags;
1176*4882a593Smuzhiyun
1177*4882a593Smuzhiyun if (!gadget)
1178*4882a593Smuzhiyun return -EINVAL;
1179*4882a593Smuzhiyun
1180*4882a593Smuzhiyun dev = container_of(gadget, struct pch_udc_dev, gadget);
1181*4882a593Smuzhiyun
1182*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, iflags);
1183*4882a593Smuzhiyun if (is_on) {
1184*4882a593Smuzhiyun pch_udc_reconnect(dev);
1185*4882a593Smuzhiyun } else {
1186*4882a593Smuzhiyun if (dev->driver && dev->driver->disconnect) {
1187*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, iflags);
1188*4882a593Smuzhiyun dev->driver->disconnect(&dev->gadget);
1189*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, iflags);
1190*4882a593Smuzhiyun }
1191*4882a593Smuzhiyun pch_udc_set_disconnect(dev);
1192*4882a593Smuzhiyun }
1193*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, iflags);
1194*4882a593Smuzhiyun
1195*4882a593Smuzhiyun return 0;
1196*4882a593Smuzhiyun }
1197*4882a593Smuzhiyun
1198*4882a593Smuzhiyun /**
1199*4882a593Smuzhiyun * pch_udc_pcd_vbus_session() - This API is used by a driver for an external
1200*4882a593Smuzhiyun * transceiver (or GPIO) that
1201*4882a593Smuzhiyun * detects a VBUS power session starting/ending
1202*4882a593Smuzhiyun * @gadget: Reference to the gadget driver
1203*4882a593Smuzhiyun * @is_active: specifies whether the session is starting or ending
1204*4882a593Smuzhiyun *
1205*4882a593Smuzhiyun * Return codes:
1206*4882a593Smuzhiyun * 0: Success
1207*4882a593Smuzhiyun * -EINVAL: If the gadget passed is NULL
1208*4882a593Smuzhiyun */
pch_udc_pcd_vbus_session(struct usb_gadget * gadget,int is_active)1209*4882a593Smuzhiyun static int pch_udc_pcd_vbus_session(struct usb_gadget *gadget, int is_active)
1210*4882a593Smuzhiyun {
1211*4882a593Smuzhiyun struct pch_udc_dev *dev;
1212*4882a593Smuzhiyun
1213*4882a593Smuzhiyun if (!gadget)
1214*4882a593Smuzhiyun return -EINVAL;
1215*4882a593Smuzhiyun dev = container_of(gadget, struct pch_udc_dev, gadget);
1216*4882a593Smuzhiyun pch_udc_vbus_session(dev, is_active);
1217*4882a593Smuzhiyun return 0;
1218*4882a593Smuzhiyun }
1219*4882a593Smuzhiyun
1220*4882a593Smuzhiyun /**
1221*4882a593Smuzhiyun * pch_udc_pcd_vbus_draw() - This API is used by gadget drivers during
1222*4882a593Smuzhiyun * SET_CONFIGURATION calls to
1223*4882a593Smuzhiyun * specify how much power the device can consume
1224*4882a593Smuzhiyun * @gadget: Reference to the gadget driver
1225*4882a593Smuzhiyun * @mA: specifies the current limit in 2mA unit
1226*4882a593Smuzhiyun *
1227*4882a593Smuzhiyun * Return codes:
1228*4882a593Smuzhiyun * -EINVAL: If the gadget passed is NULL
1229*4882a593Smuzhiyun * -EOPNOTSUPP:
1230*4882a593Smuzhiyun */
pch_udc_pcd_vbus_draw(struct usb_gadget * gadget,unsigned int mA)1231*4882a593Smuzhiyun static int pch_udc_pcd_vbus_draw(struct usb_gadget *gadget, unsigned int mA)
1232*4882a593Smuzhiyun {
1233*4882a593Smuzhiyun return -EOPNOTSUPP;
1234*4882a593Smuzhiyun }
1235*4882a593Smuzhiyun
1236*4882a593Smuzhiyun static int pch_udc_start(struct usb_gadget *g,
1237*4882a593Smuzhiyun struct usb_gadget_driver *driver);
1238*4882a593Smuzhiyun static int pch_udc_stop(struct usb_gadget *g);
1239*4882a593Smuzhiyun
1240*4882a593Smuzhiyun static const struct usb_gadget_ops pch_udc_ops = {
1241*4882a593Smuzhiyun .get_frame = pch_udc_pcd_get_frame,
1242*4882a593Smuzhiyun .wakeup = pch_udc_pcd_wakeup,
1243*4882a593Smuzhiyun .set_selfpowered = pch_udc_pcd_selfpowered,
1244*4882a593Smuzhiyun .pullup = pch_udc_pcd_pullup,
1245*4882a593Smuzhiyun .vbus_session = pch_udc_pcd_vbus_session,
1246*4882a593Smuzhiyun .vbus_draw = pch_udc_pcd_vbus_draw,
1247*4882a593Smuzhiyun .udc_start = pch_udc_start,
1248*4882a593Smuzhiyun .udc_stop = pch_udc_stop,
1249*4882a593Smuzhiyun };
1250*4882a593Smuzhiyun
1251*4882a593Smuzhiyun /**
1252*4882a593Smuzhiyun * pch_vbus_gpio_get_value() - This API gets value of GPIO port as VBUS status.
1253*4882a593Smuzhiyun * @dev: Reference to the driver structure
1254*4882a593Smuzhiyun *
1255*4882a593Smuzhiyun * Return value:
1256*4882a593Smuzhiyun * 1: VBUS is high
1257*4882a593Smuzhiyun * 0: VBUS is low
1258*4882a593Smuzhiyun * -1: It is not enable to detect VBUS using GPIO
1259*4882a593Smuzhiyun */
pch_vbus_gpio_get_value(struct pch_udc_dev * dev)1260*4882a593Smuzhiyun static int pch_vbus_gpio_get_value(struct pch_udc_dev *dev)
1261*4882a593Smuzhiyun {
1262*4882a593Smuzhiyun int vbus = 0;
1263*4882a593Smuzhiyun
1264*4882a593Smuzhiyun if (dev->vbus_gpio.port)
1265*4882a593Smuzhiyun vbus = gpiod_get_value(dev->vbus_gpio.port) ? 1 : 0;
1266*4882a593Smuzhiyun else
1267*4882a593Smuzhiyun vbus = -1;
1268*4882a593Smuzhiyun
1269*4882a593Smuzhiyun return vbus;
1270*4882a593Smuzhiyun }
1271*4882a593Smuzhiyun
1272*4882a593Smuzhiyun /**
1273*4882a593Smuzhiyun * pch_vbus_gpio_work_fall() - This API keeps watch on VBUS becoming Low.
1274*4882a593Smuzhiyun * If VBUS is Low, disconnect is processed
1275*4882a593Smuzhiyun * @irq_work: Structure for WorkQueue
1276*4882a593Smuzhiyun *
1277*4882a593Smuzhiyun */
pch_vbus_gpio_work_fall(struct work_struct * irq_work)1278*4882a593Smuzhiyun static void pch_vbus_gpio_work_fall(struct work_struct *irq_work)
1279*4882a593Smuzhiyun {
1280*4882a593Smuzhiyun struct pch_vbus_gpio_data *vbus_gpio = container_of(irq_work,
1281*4882a593Smuzhiyun struct pch_vbus_gpio_data, irq_work_fall);
1282*4882a593Smuzhiyun struct pch_udc_dev *dev =
1283*4882a593Smuzhiyun container_of(vbus_gpio, struct pch_udc_dev, vbus_gpio);
1284*4882a593Smuzhiyun int vbus_saved = -1;
1285*4882a593Smuzhiyun int vbus;
1286*4882a593Smuzhiyun int count;
1287*4882a593Smuzhiyun
1288*4882a593Smuzhiyun if (!dev->vbus_gpio.port)
1289*4882a593Smuzhiyun return;
1290*4882a593Smuzhiyun
1291*4882a593Smuzhiyun for (count = 0; count < (PCH_VBUS_PERIOD / PCH_VBUS_INTERVAL);
1292*4882a593Smuzhiyun count++) {
1293*4882a593Smuzhiyun vbus = pch_vbus_gpio_get_value(dev);
1294*4882a593Smuzhiyun
1295*4882a593Smuzhiyun if ((vbus_saved == vbus) && (vbus == 0)) {
1296*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "VBUS fell");
1297*4882a593Smuzhiyun if (dev->driver
1298*4882a593Smuzhiyun && dev->driver->disconnect) {
1299*4882a593Smuzhiyun dev->driver->disconnect(
1300*4882a593Smuzhiyun &dev->gadget);
1301*4882a593Smuzhiyun }
1302*4882a593Smuzhiyun if (dev->vbus_gpio.intr)
1303*4882a593Smuzhiyun pch_udc_init(dev);
1304*4882a593Smuzhiyun else
1305*4882a593Smuzhiyun pch_udc_reconnect(dev);
1306*4882a593Smuzhiyun return;
1307*4882a593Smuzhiyun }
1308*4882a593Smuzhiyun vbus_saved = vbus;
1309*4882a593Smuzhiyun mdelay(PCH_VBUS_INTERVAL);
1310*4882a593Smuzhiyun }
1311*4882a593Smuzhiyun }
1312*4882a593Smuzhiyun
1313*4882a593Smuzhiyun /**
1314*4882a593Smuzhiyun * pch_vbus_gpio_work_rise() - This API checks VBUS is High.
1315*4882a593Smuzhiyun * If VBUS is High, connect is processed
1316*4882a593Smuzhiyun * @irq_work: Structure for WorkQueue
1317*4882a593Smuzhiyun *
1318*4882a593Smuzhiyun */
pch_vbus_gpio_work_rise(struct work_struct * irq_work)1319*4882a593Smuzhiyun static void pch_vbus_gpio_work_rise(struct work_struct *irq_work)
1320*4882a593Smuzhiyun {
1321*4882a593Smuzhiyun struct pch_vbus_gpio_data *vbus_gpio = container_of(irq_work,
1322*4882a593Smuzhiyun struct pch_vbus_gpio_data, irq_work_rise);
1323*4882a593Smuzhiyun struct pch_udc_dev *dev =
1324*4882a593Smuzhiyun container_of(vbus_gpio, struct pch_udc_dev, vbus_gpio);
1325*4882a593Smuzhiyun int vbus;
1326*4882a593Smuzhiyun
1327*4882a593Smuzhiyun if (!dev->vbus_gpio.port)
1328*4882a593Smuzhiyun return;
1329*4882a593Smuzhiyun
1330*4882a593Smuzhiyun mdelay(PCH_VBUS_INTERVAL);
1331*4882a593Smuzhiyun vbus = pch_vbus_gpio_get_value(dev);
1332*4882a593Smuzhiyun
1333*4882a593Smuzhiyun if (vbus == 1) {
1334*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "VBUS rose");
1335*4882a593Smuzhiyun pch_udc_reconnect(dev);
1336*4882a593Smuzhiyun return;
1337*4882a593Smuzhiyun }
1338*4882a593Smuzhiyun }
1339*4882a593Smuzhiyun
1340*4882a593Smuzhiyun /**
1341*4882a593Smuzhiyun * pch_vbus_gpio_irq() - IRQ handler for GPIO interrupt for changing VBUS
1342*4882a593Smuzhiyun * @irq: Interrupt request number
1343*4882a593Smuzhiyun * @data: Reference to the device structure
1344*4882a593Smuzhiyun *
1345*4882a593Smuzhiyun * Return codes:
1346*4882a593Smuzhiyun * 0: Success
1347*4882a593Smuzhiyun * -EINVAL: GPIO port is invalid or can't be initialized.
1348*4882a593Smuzhiyun */
pch_vbus_gpio_irq(int irq,void * data)1349*4882a593Smuzhiyun static irqreturn_t pch_vbus_gpio_irq(int irq, void *data)
1350*4882a593Smuzhiyun {
1351*4882a593Smuzhiyun struct pch_udc_dev *dev = (struct pch_udc_dev *)data;
1352*4882a593Smuzhiyun
1353*4882a593Smuzhiyun if (!dev->vbus_gpio.port || !dev->vbus_gpio.intr)
1354*4882a593Smuzhiyun return IRQ_NONE;
1355*4882a593Smuzhiyun
1356*4882a593Smuzhiyun if (pch_vbus_gpio_get_value(dev))
1357*4882a593Smuzhiyun schedule_work(&dev->vbus_gpio.irq_work_rise);
1358*4882a593Smuzhiyun else
1359*4882a593Smuzhiyun schedule_work(&dev->vbus_gpio.irq_work_fall);
1360*4882a593Smuzhiyun
1361*4882a593Smuzhiyun return IRQ_HANDLED;
1362*4882a593Smuzhiyun }
1363*4882a593Smuzhiyun
1364*4882a593Smuzhiyun static struct gpiod_lookup_table minnowboard_udc_gpios = {
1365*4882a593Smuzhiyun .dev_id = "0000:02:02.4",
1366*4882a593Smuzhiyun .table = {
1367*4882a593Smuzhiyun GPIO_LOOKUP("sch_gpio.33158", 12, NULL, GPIO_ACTIVE_HIGH),
1368*4882a593Smuzhiyun {}
1369*4882a593Smuzhiyun },
1370*4882a593Smuzhiyun };
1371*4882a593Smuzhiyun
1372*4882a593Smuzhiyun static const struct dmi_system_id pch_udc_gpio_dmi_table[] = {
1373*4882a593Smuzhiyun {
1374*4882a593Smuzhiyun .ident = "MinnowBoard",
1375*4882a593Smuzhiyun .matches = {
1376*4882a593Smuzhiyun DMI_MATCH(DMI_BOARD_NAME, "MinnowBoard"),
1377*4882a593Smuzhiyun },
1378*4882a593Smuzhiyun .driver_data = &minnowboard_udc_gpios,
1379*4882a593Smuzhiyun },
1380*4882a593Smuzhiyun { }
1381*4882a593Smuzhiyun };
1382*4882a593Smuzhiyun
pch_vbus_gpio_remove_table(void * table)1383*4882a593Smuzhiyun static void pch_vbus_gpio_remove_table(void *table)
1384*4882a593Smuzhiyun {
1385*4882a593Smuzhiyun gpiod_remove_lookup_table(table);
1386*4882a593Smuzhiyun }
1387*4882a593Smuzhiyun
pch_vbus_gpio_add_table(struct pch_udc_dev * dev)1388*4882a593Smuzhiyun static int pch_vbus_gpio_add_table(struct pch_udc_dev *dev)
1389*4882a593Smuzhiyun {
1390*4882a593Smuzhiyun struct device *d = &dev->pdev->dev;
1391*4882a593Smuzhiyun const struct dmi_system_id *dmi;
1392*4882a593Smuzhiyun
1393*4882a593Smuzhiyun dmi = dmi_first_match(pch_udc_gpio_dmi_table);
1394*4882a593Smuzhiyun if (!dmi)
1395*4882a593Smuzhiyun return 0;
1396*4882a593Smuzhiyun
1397*4882a593Smuzhiyun gpiod_add_lookup_table(dmi->driver_data);
1398*4882a593Smuzhiyun return devm_add_action_or_reset(d, pch_vbus_gpio_remove_table, dmi->driver_data);
1399*4882a593Smuzhiyun }
1400*4882a593Smuzhiyun
1401*4882a593Smuzhiyun /**
1402*4882a593Smuzhiyun * pch_vbus_gpio_init() - This API initializes GPIO port detecting VBUS.
1403*4882a593Smuzhiyun * @dev: Reference to the driver structure
1404*4882a593Smuzhiyun *
1405*4882a593Smuzhiyun * Return codes:
1406*4882a593Smuzhiyun * 0: Success
1407*4882a593Smuzhiyun * -EINVAL: GPIO port is invalid or can't be initialized.
1408*4882a593Smuzhiyun */
pch_vbus_gpio_init(struct pch_udc_dev * dev)1409*4882a593Smuzhiyun static int pch_vbus_gpio_init(struct pch_udc_dev *dev)
1410*4882a593Smuzhiyun {
1411*4882a593Smuzhiyun struct device *d = &dev->pdev->dev;
1412*4882a593Smuzhiyun int err;
1413*4882a593Smuzhiyun int irq_num = 0;
1414*4882a593Smuzhiyun struct gpio_desc *gpiod;
1415*4882a593Smuzhiyun
1416*4882a593Smuzhiyun dev->vbus_gpio.port = NULL;
1417*4882a593Smuzhiyun dev->vbus_gpio.intr = 0;
1418*4882a593Smuzhiyun
1419*4882a593Smuzhiyun err = pch_vbus_gpio_add_table(dev);
1420*4882a593Smuzhiyun if (err)
1421*4882a593Smuzhiyun return err;
1422*4882a593Smuzhiyun
1423*4882a593Smuzhiyun /* Retrieve the GPIO line from the USB gadget device */
1424*4882a593Smuzhiyun gpiod = devm_gpiod_get_optional(d, NULL, GPIOD_IN);
1425*4882a593Smuzhiyun if (IS_ERR(gpiod))
1426*4882a593Smuzhiyun return PTR_ERR(gpiod);
1427*4882a593Smuzhiyun gpiod_set_consumer_name(gpiod, "pch_vbus");
1428*4882a593Smuzhiyun
1429*4882a593Smuzhiyun dev->vbus_gpio.port = gpiod;
1430*4882a593Smuzhiyun INIT_WORK(&dev->vbus_gpio.irq_work_fall, pch_vbus_gpio_work_fall);
1431*4882a593Smuzhiyun
1432*4882a593Smuzhiyun irq_num = gpiod_to_irq(gpiod);
1433*4882a593Smuzhiyun if (irq_num > 0) {
1434*4882a593Smuzhiyun irq_set_irq_type(irq_num, IRQ_TYPE_EDGE_BOTH);
1435*4882a593Smuzhiyun err = request_irq(irq_num, pch_vbus_gpio_irq, 0,
1436*4882a593Smuzhiyun "vbus_detect", dev);
1437*4882a593Smuzhiyun if (!err) {
1438*4882a593Smuzhiyun dev->vbus_gpio.intr = irq_num;
1439*4882a593Smuzhiyun INIT_WORK(&dev->vbus_gpio.irq_work_rise,
1440*4882a593Smuzhiyun pch_vbus_gpio_work_rise);
1441*4882a593Smuzhiyun } else {
1442*4882a593Smuzhiyun pr_err("%s: can't request irq %d, err: %d\n",
1443*4882a593Smuzhiyun __func__, irq_num, err);
1444*4882a593Smuzhiyun }
1445*4882a593Smuzhiyun }
1446*4882a593Smuzhiyun
1447*4882a593Smuzhiyun return 0;
1448*4882a593Smuzhiyun }
1449*4882a593Smuzhiyun
1450*4882a593Smuzhiyun /**
1451*4882a593Smuzhiyun * pch_vbus_gpio_free() - This API frees resources of GPIO port
1452*4882a593Smuzhiyun * @dev: Reference to the driver structure
1453*4882a593Smuzhiyun */
pch_vbus_gpio_free(struct pch_udc_dev * dev)1454*4882a593Smuzhiyun static void pch_vbus_gpio_free(struct pch_udc_dev *dev)
1455*4882a593Smuzhiyun {
1456*4882a593Smuzhiyun if (dev->vbus_gpio.intr)
1457*4882a593Smuzhiyun free_irq(dev->vbus_gpio.intr, dev);
1458*4882a593Smuzhiyun }
1459*4882a593Smuzhiyun
1460*4882a593Smuzhiyun /**
1461*4882a593Smuzhiyun * complete_req() - This API is invoked from the driver when processing
1462*4882a593Smuzhiyun * of a request is complete
1463*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
1464*4882a593Smuzhiyun * @req: Reference to the request structure
1465*4882a593Smuzhiyun * @status: Indicates the success/failure of completion
1466*4882a593Smuzhiyun */
complete_req(struct pch_udc_ep * ep,struct pch_udc_request * req,int status)1467*4882a593Smuzhiyun static void complete_req(struct pch_udc_ep *ep, struct pch_udc_request *req,
1468*4882a593Smuzhiyun int status)
1469*4882a593Smuzhiyun __releases(&dev->lock)
1470*4882a593Smuzhiyun __acquires(&dev->lock)
1471*4882a593Smuzhiyun {
1472*4882a593Smuzhiyun struct pch_udc_dev *dev;
1473*4882a593Smuzhiyun unsigned halted = ep->halted;
1474*4882a593Smuzhiyun
1475*4882a593Smuzhiyun list_del_init(&req->queue);
1476*4882a593Smuzhiyun
1477*4882a593Smuzhiyun /* set new status if pending */
1478*4882a593Smuzhiyun if (req->req.status == -EINPROGRESS)
1479*4882a593Smuzhiyun req->req.status = status;
1480*4882a593Smuzhiyun else
1481*4882a593Smuzhiyun status = req->req.status;
1482*4882a593Smuzhiyun
1483*4882a593Smuzhiyun dev = ep->dev;
1484*4882a593Smuzhiyun if (req->dma_mapped) {
1485*4882a593Smuzhiyun if (req->dma == DMA_ADDR_INVALID) {
1486*4882a593Smuzhiyun if (ep->in)
1487*4882a593Smuzhiyun dma_unmap_single(&dev->pdev->dev, req->req.dma,
1488*4882a593Smuzhiyun req->req.length,
1489*4882a593Smuzhiyun DMA_TO_DEVICE);
1490*4882a593Smuzhiyun else
1491*4882a593Smuzhiyun dma_unmap_single(&dev->pdev->dev, req->req.dma,
1492*4882a593Smuzhiyun req->req.length,
1493*4882a593Smuzhiyun DMA_FROM_DEVICE);
1494*4882a593Smuzhiyun req->req.dma = DMA_ADDR_INVALID;
1495*4882a593Smuzhiyun } else {
1496*4882a593Smuzhiyun if (ep->in)
1497*4882a593Smuzhiyun dma_unmap_single(&dev->pdev->dev, req->dma,
1498*4882a593Smuzhiyun req->req.length,
1499*4882a593Smuzhiyun DMA_TO_DEVICE);
1500*4882a593Smuzhiyun else {
1501*4882a593Smuzhiyun dma_unmap_single(&dev->pdev->dev, req->dma,
1502*4882a593Smuzhiyun req->req.length,
1503*4882a593Smuzhiyun DMA_FROM_DEVICE);
1504*4882a593Smuzhiyun memcpy(req->req.buf, req->buf, req->req.length);
1505*4882a593Smuzhiyun }
1506*4882a593Smuzhiyun kfree(req->buf);
1507*4882a593Smuzhiyun req->dma = DMA_ADDR_INVALID;
1508*4882a593Smuzhiyun }
1509*4882a593Smuzhiyun req->dma_mapped = 0;
1510*4882a593Smuzhiyun }
1511*4882a593Smuzhiyun ep->halted = 1;
1512*4882a593Smuzhiyun spin_unlock(&dev->lock);
1513*4882a593Smuzhiyun if (!ep->in)
1514*4882a593Smuzhiyun pch_udc_ep_clear_rrdy(ep);
1515*4882a593Smuzhiyun usb_gadget_giveback_request(&ep->ep, &req->req);
1516*4882a593Smuzhiyun spin_lock(&dev->lock);
1517*4882a593Smuzhiyun ep->halted = halted;
1518*4882a593Smuzhiyun }
1519*4882a593Smuzhiyun
1520*4882a593Smuzhiyun /**
1521*4882a593Smuzhiyun * empty_req_queue() - This API empties the request queue of an endpoint
1522*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
1523*4882a593Smuzhiyun */
empty_req_queue(struct pch_udc_ep * ep)1524*4882a593Smuzhiyun static void empty_req_queue(struct pch_udc_ep *ep)
1525*4882a593Smuzhiyun {
1526*4882a593Smuzhiyun struct pch_udc_request *req;
1527*4882a593Smuzhiyun
1528*4882a593Smuzhiyun ep->halted = 1;
1529*4882a593Smuzhiyun while (!list_empty(&ep->queue)) {
1530*4882a593Smuzhiyun req = list_entry(ep->queue.next, struct pch_udc_request, queue);
1531*4882a593Smuzhiyun complete_req(ep, req, -ESHUTDOWN); /* Remove from list */
1532*4882a593Smuzhiyun }
1533*4882a593Smuzhiyun }
1534*4882a593Smuzhiyun
1535*4882a593Smuzhiyun /**
1536*4882a593Smuzhiyun * pch_udc_free_dma_chain() - This function frees the DMA chain created
1537*4882a593Smuzhiyun * for the request
1538*4882a593Smuzhiyun * @dev: Reference to the driver structure
1539*4882a593Smuzhiyun * @req: Reference to the request to be freed
1540*4882a593Smuzhiyun *
1541*4882a593Smuzhiyun * Return codes:
1542*4882a593Smuzhiyun * 0: Success
1543*4882a593Smuzhiyun */
pch_udc_free_dma_chain(struct pch_udc_dev * dev,struct pch_udc_request * req)1544*4882a593Smuzhiyun static void pch_udc_free_dma_chain(struct pch_udc_dev *dev,
1545*4882a593Smuzhiyun struct pch_udc_request *req)
1546*4882a593Smuzhiyun {
1547*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td = req->td_data;
1548*4882a593Smuzhiyun unsigned i = req->chain_len;
1549*4882a593Smuzhiyun
1550*4882a593Smuzhiyun dma_addr_t addr2;
1551*4882a593Smuzhiyun dma_addr_t addr = (dma_addr_t)td->next;
1552*4882a593Smuzhiyun td->next = 0x00;
1553*4882a593Smuzhiyun for (; i > 1; --i) {
1554*4882a593Smuzhiyun /* do not free first desc., will be done by free for request */
1555*4882a593Smuzhiyun td = phys_to_virt(addr);
1556*4882a593Smuzhiyun addr2 = (dma_addr_t)td->next;
1557*4882a593Smuzhiyun dma_pool_free(dev->data_requests, td, addr);
1558*4882a593Smuzhiyun addr = addr2;
1559*4882a593Smuzhiyun }
1560*4882a593Smuzhiyun req->chain_len = 1;
1561*4882a593Smuzhiyun }
1562*4882a593Smuzhiyun
1563*4882a593Smuzhiyun /**
1564*4882a593Smuzhiyun * pch_udc_create_dma_chain() - This function creates or reinitializes
1565*4882a593Smuzhiyun * a DMA chain
1566*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
1567*4882a593Smuzhiyun * @req: Reference to the request
1568*4882a593Smuzhiyun * @buf_len: The buffer length
1569*4882a593Smuzhiyun * @gfp_flags: Flags to be used while mapping the data buffer
1570*4882a593Smuzhiyun *
1571*4882a593Smuzhiyun * Return codes:
1572*4882a593Smuzhiyun * 0: success,
1573*4882a593Smuzhiyun * -ENOMEM: dma_pool_alloc invocation fails
1574*4882a593Smuzhiyun */
pch_udc_create_dma_chain(struct pch_udc_ep * ep,struct pch_udc_request * req,unsigned long buf_len,gfp_t gfp_flags)1575*4882a593Smuzhiyun static int pch_udc_create_dma_chain(struct pch_udc_ep *ep,
1576*4882a593Smuzhiyun struct pch_udc_request *req,
1577*4882a593Smuzhiyun unsigned long buf_len,
1578*4882a593Smuzhiyun gfp_t gfp_flags)
1579*4882a593Smuzhiyun {
1580*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td = req->td_data, *last;
1581*4882a593Smuzhiyun unsigned long bytes = req->req.length, i = 0;
1582*4882a593Smuzhiyun dma_addr_t dma_addr;
1583*4882a593Smuzhiyun unsigned len = 1;
1584*4882a593Smuzhiyun
1585*4882a593Smuzhiyun if (req->chain_len > 1)
1586*4882a593Smuzhiyun pch_udc_free_dma_chain(ep->dev, req);
1587*4882a593Smuzhiyun
1588*4882a593Smuzhiyun if (req->dma == DMA_ADDR_INVALID)
1589*4882a593Smuzhiyun td->dataptr = req->req.dma;
1590*4882a593Smuzhiyun else
1591*4882a593Smuzhiyun td->dataptr = req->dma;
1592*4882a593Smuzhiyun
1593*4882a593Smuzhiyun td->status = PCH_UDC_BS_HST_BSY;
1594*4882a593Smuzhiyun for (; ; bytes -= buf_len, ++len) {
1595*4882a593Smuzhiyun td->status = PCH_UDC_BS_HST_BSY | min(buf_len, bytes);
1596*4882a593Smuzhiyun if (bytes <= buf_len)
1597*4882a593Smuzhiyun break;
1598*4882a593Smuzhiyun last = td;
1599*4882a593Smuzhiyun td = dma_pool_alloc(ep->dev->data_requests, gfp_flags,
1600*4882a593Smuzhiyun &dma_addr);
1601*4882a593Smuzhiyun if (!td)
1602*4882a593Smuzhiyun goto nomem;
1603*4882a593Smuzhiyun i += buf_len;
1604*4882a593Smuzhiyun td->dataptr = req->td_data->dataptr + i;
1605*4882a593Smuzhiyun last->next = dma_addr;
1606*4882a593Smuzhiyun }
1607*4882a593Smuzhiyun
1608*4882a593Smuzhiyun req->td_data_last = td;
1609*4882a593Smuzhiyun td->status |= PCH_UDC_DMA_LAST;
1610*4882a593Smuzhiyun td->next = req->td_data_phys;
1611*4882a593Smuzhiyun req->chain_len = len;
1612*4882a593Smuzhiyun return 0;
1613*4882a593Smuzhiyun
1614*4882a593Smuzhiyun nomem:
1615*4882a593Smuzhiyun if (len > 1) {
1616*4882a593Smuzhiyun req->chain_len = len;
1617*4882a593Smuzhiyun pch_udc_free_dma_chain(ep->dev, req);
1618*4882a593Smuzhiyun }
1619*4882a593Smuzhiyun req->chain_len = 1;
1620*4882a593Smuzhiyun return -ENOMEM;
1621*4882a593Smuzhiyun }
1622*4882a593Smuzhiyun
1623*4882a593Smuzhiyun /**
1624*4882a593Smuzhiyun * prepare_dma() - This function creates and initializes the DMA chain
1625*4882a593Smuzhiyun * for the request
1626*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
1627*4882a593Smuzhiyun * @req: Reference to the request
1628*4882a593Smuzhiyun * @gfp: Flag to be used while mapping the data buffer
1629*4882a593Smuzhiyun *
1630*4882a593Smuzhiyun * Return codes:
1631*4882a593Smuzhiyun * 0: Success
1632*4882a593Smuzhiyun * Other 0: linux error number on failure
1633*4882a593Smuzhiyun */
prepare_dma(struct pch_udc_ep * ep,struct pch_udc_request * req,gfp_t gfp)1634*4882a593Smuzhiyun static int prepare_dma(struct pch_udc_ep *ep, struct pch_udc_request *req,
1635*4882a593Smuzhiyun gfp_t gfp)
1636*4882a593Smuzhiyun {
1637*4882a593Smuzhiyun int retval;
1638*4882a593Smuzhiyun
1639*4882a593Smuzhiyun /* Allocate and create a DMA chain */
1640*4882a593Smuzhiyun retval = pch_udc_create_dma_chain(ep, req, ep->ep.maxpacket, gfp);
1641*4882a593Smuzhiyun if (retval) {
1642*4882a593Smuzhiyun pr_err("%s: could not create DMA chain:%d\n", __func__, retval);
1643*4882a593Smuzhiyun return retval;
1644*4882a593Smuzhiyun }
1645*4882a593Smuzhiyun if (ep->in)
1646*4882a593Smuzhiyun req->td_data->status = (req->td_data->status &
1647*4882a593Smuzhiyun ~PCH_UDC_BUFF_STS) | PCH_UDC_BS_HST_RDY;
1648*4882a593Smuzhiyun return 0;
1649*4882a593Smuzhiyun }
1650*4882a593Smuzhiyun
1651*4882a593Smuzhiyun /**
1652*4882a593Smuzhiyun * process_zlp() - This function process zero length packets
1653*4882a593Smuzhiyun * from the gadget driver
1654*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
1655*4882a593Smuzhiyun * @req: Reference to the request
1656*4882a593Smuzhiyun */
process_zlp(struct pch_udc_ep * ep,struct pch_udc_request * req)1657*4882a593Smuzhiyun static void process_zlp(struct pch_udc_ep *ep, struct pch_udc_request *req)
1658*4882a593Smuzhiyun {
1659*4882a593Smuzhiyun struct pch_udc_dev *dev = ep->dev;
1660*4882a593Smuzhiyun
1661*4882a593Smuzhiyun /* IN zlp's are handled by hardware */
1662*4882a593Smuzhiyun complete_req(ep, req, 0);
1663*4882a593Smuzhiyun
1664*4882a593Smuzhiyun /* if set_config or set_intf is waiting for ack by zlp
1665*4882a593Smuzhiyun * then set CSR_DONE
1666*4882a593Smuzhiyun */
1667*4882a593Smuzhiyun if (dev->set_cfg_not_acked) {
1668*4882a593Smuzhiyun pch_udc_set_csr_done(dev);
1669*4882a593Smuzhiyun dev->set_cfg_not_acked = 0;
1670*4882a593Smuzhiyun }
1671*4882a593Smuzhiyun /* setup command is ACK'ed now by zlp */
1672*4882a593Smuzhiyun if (!dev->stall && dev->waiting_zlp_ack) {
1673*4882a593Smuzhiyun pch_udc_ep_clear_nak(&(dev->ep[UDC_EP0IN_IDX]));
1674*4882a593Smuzhiyun dev->waiting_zlp_ack = 0;
1675*4882a593Smuzhiyun }
1676*4882a593Smuzhiyun }
1677*4882a593Smuzhiyun
1678*4882a593Smuzhiyun /**
1679*4882a593Smuzhiyun * pch_udc_start_rxrequest() - This function starts the receive requirement.
1680*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
1681*4882a593Smuzhiyun * @req: Reference to the request structure
1682*4882a593Smuzhiyun */
pch_udc_start_rxrequest(struct pch_udc_ep * ep,struct pch_udc_request * req)1683*4882a593Smuzhiyun static void pch_udc_start_rxrequest(struct pch_udc_ep *ep,
1684*4882a593Smuzhiyun struct pch_udc_request *req)
1685*4882a593Smuzhiyun {
1686*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td_data;
1687*4882a593Smuzhiyun
1688*4882a593Smuzhiyun pch_udc_clear_dma(ep->dev, DMA_DIR_RX);
1689*4882a593Smuzhiyun td_data = req->td_data;
1690*4882a593Smuzhiyun /* Set the status bits for all descriptors */
1691*4882a593Smuzhiyun while (1) {
1692*4882a593Smuzhiyun td_data->status = (td_data->status & ~PCH_UDC_BUFF_STS) |
1693*4882a593Smuzhiyun PCH_UDC_BS_HST_RDY;
1694*4882a593Smuzhiyun if ((td_data->status & PCH_UDC_DMA_LAST) == PCH_UDC_DMA_LAST)
1695*4882a593Smuzhiyun break;
1696*4882a593Smuzhiyun td_data = phys_to_virt(td_data->next);
1697*4882a593Smuzhiyun }
1698*4882a593Smuzhiyun /* Write the descriptor pointer */
1699*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, req->td_data_phys);
1700*4882a593Smuzhiyun req->dma_going = 1;
1701*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev, UDC_EPINT_OUT_EP0 << ep->num);
1702*4882a593Smuzhiyun pch_udc_set_dma(ep->dev, DMA_DIR_RX);
1703*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
1704*4882a593Smuzhiyun pch_udc_ep_set_rrdy(ep);
1705*4882a593Smuzhiyun }
1706*4882a593Smuzhiyun
1707*4882a593Smuzhiyun /**
1708*4882a593Smuzhiyun * pch_udc_pcd_ep_enable() - This API enables the endpoint. It is called
1709*4882a593Smuzhiyun * from gadget driver
1710*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1711*4882a593Smuzhiyun * @desc: Reference to the USB endpoint descriptor structure
1712*4882a593Smuzhiyun *
1713*4882a593Smuzhiyun * Return codes:
1714*4882a593Smuzhiyun * 0: Success
1715*4882a593Smuzhiyun * -EINVAL:
1716*4882a593Smuzhiyun * -ESHUTDOWN:
1717*4882a593Smuzhiyun */
pch_udc_pcd_ep_enable(struct usb_ep * usbep,const struct usb_endpoint_descriptor * desc)1718*4882a593Smuzhiyun static int pch_udc_pcd_ep_enable(struct usb_ep *usbep,
1719*4882a593Smuzhiyun const struct usb_endpoint_descriptor *desc)
1720*4882a593Smuzhiyun {
1721*4882a593Smuzhiyun struct pch_udc_ep *ep;
1722*4882a593Smuzhiyun struct pch_udc_dev *dev;
1723*4882a593Smuzhiyun unsigned long iflags;
1724*4882a593Smuzhiyun
1725*4882a593Smuzhiyun if (!usbep || (usbep->name == ep0_string) || !desc ||
1726*4882a593Smuzhiyun (desc->bDescriptorType != USB_DT_ENDPOINT) || !desc->wMaxPacketSize)
1727*4882a593Smuzhiyun return -EINVAL;
1728*4882a593Smuzhiyun
1729*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
1730*4882a593Smuzhiyun dev = ep->dev;
1731*4882a593Smuzhiyun if (!dev->driver || (dev->gadget.speed == USB_SPEED_UNKNOWN))
1732*4882a593Smuzhiyun return -ESHUTDOWN;
1733*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, iflags);
1734*4882a593Smuzhiyun ep->ep.desc = desc;
1735*4882a593Smuzhiyun ep->halted = 0;
1736*4882a593Smuzhiyun pch_udc_ep_enable(ep, &ep->dev->cfg_data, desc);
1737*4882a593Smuzhiyun ep->ep.maxpacket = usb_endpoint_maxp(desc);
1738*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
1739*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, iflags);
1740*4882a593Smuzhiyun return 0;
1741*4882a593Smuzhiyun }
1742*4882a593Smuzhiyun
1743*4882a593Smuzhiyun /**
1744*4882a593Smuzhiyun * pch_udc_pcd_ep_disable() - This API disables endpoint and is called
1745*4882a593Smuzhiyun * from gadget driver
1746*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1747*4882a593Smuzhiyun *
1748*4882a593Smuzhiyun * Return codes:
1749*4882a593Smuzhiyun * 0: Success
1750*4882a593Smuzhiyun * -EINVAL:
1751*4882a593Smuzhiyun */
pch_udc_pcd_ep_disable(struct usb_ep * usbep)1752*4882a593Smuzhiyun static int pch_udc_pcd_ep_disable(struct usb_ep *usbep)
1753*4882a593Smuzhiyun {
1754*4882a593Smuzhiyun struct pch_udc_ep *ep;
1755*4882a593Smuzhiyun unsigned long iflags;
1756*4882a593Smuzhiyun
1757*4882a593Smuzhiyun if (!usbep)
1758*4882a593Smuzhiyun return -EINVAL;
1759*4882a593Smuzhiyun
1760*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
1761*4882a593Smuzhiyun if ((usbep->name == ep0_string) || !ep->ep.desc)
1762*4882a593Smuzhiyun return -EINVAL;
1763*4882a593Smuzhiyun
1764*4882a593Smuzhiyun spin_lock_irqsave(&ep->dev->lock, iflags);
1765*4882a593Smuzhiyun empty_req_queue(ep);
1766*4882a593Smuzhiyun ep->halted = 1;
1767*4882a593Smuzhiyun pch_udc_ep_disable(ep);
1768*4882a593Smuzhiyun pch_udc_disable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
1769*4882a593Smuzhiyun ep->ep.desc = NULL;
1770*4882a593Smuzhiyun INIT_LIST_HEAD(&ep->queue);
1771*4882a593Smuzhiyun spin_unlock_irqrestore(&ep->dev->lock, iflags);
1772*4882a593Smuzhiyun return 0;
1773*4882a593Smuzhiyun }
1774*4882a593Smuzhiyun
1775*4882a593Smuzhiyun /**
1776*4882a593Smuzhiyun * pch_udc_alloc_request() - This function allocates request structure.
1777*4882a593Smuzhiyun * It is called by gadget driver
1778*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1779*4882a593Smuzhiyun * @gfp: Flag to be used while allocating memory
1780*4882a593Smuzhiyun *
1781*4882a593Smuzhiyun * Return codes:
1782*4882a593Smuzhiyun * NULL: Failure
1783*4882a593Smuzhiyun * Allocated address: Success
1784*4882a593Smuzhiyun */
pch_udc_alloc_request(struct usb_ep * usbep,gfp_t gfp)1785*4882a593Smuzhiyun static struct usb_request *pch_udc_alloc_request(struct usb_ep *usbep,
1786*4882a593Smuzhiyun gfp_t gfp)
1787*4882a593Smuzhiyun {
1788*4882a593Smuzhiyun struct pch_udc_request *req;
1789*4882a593Smuzhiyun struct pch_udc_ep *ep;
1790*4882a593Smuzhiyun struct pch_udc_data_dma_desc *dma_desc;
1791*4882a593Smuzhiyun
1792*4882a593Smuzhiyun if (!usbep)
1793*4882a593Smuzhiyun return NULL;
1794*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
1795*4882a593Smuzhiyun req = kzalloc(sizeof *req, gfp);
1796*4882a593Smuzhiyun if (!req)
1797*4882a593Smuzhiyun return NULL;
1798*4882a593Smuzhiyun req->req.dma = DMA_ADDR_INVALID;
1799*4882a593Smuzhiyun req->dma = DMA_ADDR_INVALID;
1800*4882a593Smuzhiyun INIT_LIST_HEAD(&req->queue);
1801*4882a593Smuzhiyun if (!ep->dev->dma_addr)
1802*4882a593Smuzhiyun return &req->req;
1803*4882a593Smuzhiyun /* ep0 in requests are allocated from data pool here */
1804*4882a593Smuzhiyun dma_desc = dma_pool_alloc(ep->dev->data_requests, gfp,
1805*4882a593Smuzhiyun &req->td_data_phys);
1806*4882a593Smuzhiyun if (NULL == dma_desc) {
1807*4882a593Smuzhiyun kfree(req);
1808*4882a593Smuzhiyun return NULL;
1809*4882a593Smuzhiyun }
1810*4882a593Smuzhiyun /* prevent from using desc. - set HOST BUSY */
1811*4882a593Smuzhiyun dma_desc->status |= PCH_UDC_BS_HST_BSY;
1812*4882a593Smuzhiyun dma_desc->dataptr = lower_32_bits(DMA_ADDR_INVALID);
1813*4882a593Smuzhiyun req->td_data = dma_desc;
1814*4882a593Smuzhiyun req->td_data_last = dma_desc;
1815*4882a593Smuzhiyun req->chain_len = 1;
1816*4882a593Smuzhiyun return &req->req;
1817*4882a593Smuzhiyun }
1818*4882a593Smuzhiyun
1819*4882a593Smuzhiyun /**
1820*4882a593Smuzhiyun * pch_udc_free_request() - This function frees request structure.
1821*4882a593Smuzhiyun * It is called by gadget driver
1822*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1823*4882a593Smuzhiyun * @usbreq: Reference to the USB request
1824*4882a593Smuzhiyun */
pch_udc_free_request(struct usb_ep * usbep,struct usb_request * usbreq)1825*4882a593Smuzhiyun static void pch_udc_free_request(struct usb_ep *usbep,
1826*4882a593Smuzhiyun struct usb_request *usbreq)
1827*4882a593Smuzhiyun {
1828*4882a593Smuzhiyun struct pch_udc_ep *ep;
1829*4882a593Smuzhiyun struct pch_udc_request *req;
1830*4882a593Smuzhiyun struct pch_udc_dev *dev;
1831*4882a593Smuzhiyun
1832*4882a593Smuzhiyun if (!usbep || !usbreq)
1833*4882a593Smuzhiyun return;
1834*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
1835*4882a593Smuzhiyun req = container_of(usbreq, struct pch_udc_request, req);
1836*4882a593Smuzhiyun dev = ep->dev;
1837*4882a593Smuzhiyun if (!list_empty(&req->queue))
1838*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "%s: %s req=0x%p queue not empty\n",
1839*4882a593Smuzhiyun __func__, usbep->name, req);
1840*4882a593Smuzhiyun if (req->td_data != NULL) {
1841*4882a593Smuzhiyun if (req->chain_len > 1)
1842*4882a593Smuzhiyun pch_udc_free_dma_chain(ep->dev, req);
1843*4882a593Smuzhiyun dma_pool_free(ep->dev->data_requests, req->td_data,
1844*4882a593Smuzhiyun req->td_data_phys);
1845*4882a593Smuzhiyun }
1846*4882a593Smuzhiyun kfree(req);
1847*4882a593Smuzhiyun }
1848*4882a593Smuzhiyun
1849*4882a593Smuzhiyun /**
1850*4882a593Smuzhiyun * pch_udc_pcd_queue() - This function queues a request packet. It is called
1851*4882a593Smuzhiyun * by gadget driver
1852*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1853*4882a593Smuzhiyun * @usbreq: Reference to the USB request
1854*4882a593Smuzhiyun * @gfp: Flag to be used while mapping the data buffer
1855*4882a593Smuzhiyun *
1856*4882a593Smuzhiyun * Return codes:
1857*4882a593Smuzhiyun * 0: Success
1858*4882a593Smuzhiyun * linux error number: Failure
1859*4882a593Smuzhiyun */
pch_udc_pcd_queue(struct usb_ep * usbep,struct usb_request * usbreq,gfp_t gfp)1860*4882a593Smuzhiyun static int pch_udc_pcd_queue(struct usb_ep *usbep, struct usb_request *usbreq,
1861*4882a593Smuzhiyun gfp_t gfp)
1862*4882a593Smuzhiyun {
1863*4882a593Smuzhiyun int retval = 0;
1864*4882a593Smuzhiyun struct pch_udc_ep *ep;
1865*4882a593Smuzhiyun struct pch_udc_dev *dev;
1866*4882a593Smuzhiyun struct pch_udc_request *req;
1867*4882a593Smuzhiyun unsigned long iflags;
1868*4882a593Smuzhiyun
1869*4882a593Smuzhiyun if (!usbep || !usbreq || !usbreq->complete || !usbreq->buf)
1870*4882a593Smuzhiyun return -EINVAL;
1871*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
1872*4882a593Smuzhiyun dev = ep->dev;
1873*4882a593Smuzhiyun if (!ep->ep.desc && ep->num)
1874*4882a593Smuzhiyun return -EINVAL;
1875*4882a593Smuzhiyun req = container_of(usbreq, struct pch_udc_request, req);
1876*4882a593Smuzhiyun if (!list_empty(&req->queue))
1877*4882a593Smuzhiyun return -EINVAL;
1878*4882a593Smuzhiyun if (!dev->driver || (dev->gadget.speed == USB_SPEED_UNKNOWN))
1879*4882a593Smuzhiyun return -ESHUTDOWN;
1880*4882a593Smuzhiyun spin_lock_irqsave(&dev->lock, iflags);
1881*4882a593Smuzhiyun /* map the buffer for dma */
1882*4882a593Smuzhiyun if (usbreq->length &&
1883*4882a593Smuzhiyun ((usbreq->dma == DMA_ADDR_INVALID) || !usbreq->dma)) {
1884*4882a593Smuzhiyun if (!((unsigned long)(usbreq->buf) & 0x03)) {
1885*4882a593Smuzhiyun if (ep->in)
1886*4882a593Smuzhiyun usbreq->dma = dma_map_single(&dev->pdev->dev,
1887*4882a593Smuzhiyun usbreq->buf,
1888*4882a593Smuzhiyun usbreq->length,
1889*4882a593Smuzhiyun DMA_TO_DEVICE);
1890*4882a593Smuzhiyun else
1891*4882a593Smuzhiyun usbreq->dma = dma_map_single(&dev->pdev->dev,
1892*4882a593Smuzhiyun usbreq->buf,
1893*4882a593Smuzhiyun usbreq->length,
1894*4882a593Smuzhiyun DMA_FROM_DEVICE);
1895*4882a593Smuzhiyun } else {
1896*4882a593Smuzhiyun req->buf = kzalloc(usbreq->length, GFP_ATOMIC);
1897*4882a593Smuzhiyun if (!req->buf) {
1898*4882a593Smuzhiyun retval = -ENOMEM;
1899*4882a593Smuzhiyun goto probe_end;
1900*4882a593Smuzhiyun }
1901*4882a593Smuzhiyun if (ep->in) {
1902*4882a593Smuzhiyun memcpy(req->buf, usbreq->buf, usbreq->length);
1903*4882a593Smuzhiyun req->dma = dma_map_single(&dev->pdev->dev,
1904*4882a593Smuzhiyun req->buf,
1905*4882a593Smuzhiyun usbreq->length,
1906*4882a593Smuzhiyun DMA_TO_DEVICE);
1907*4882a593Smuzhiyun } else
1908*4882a593Smuzhiyun req->dma = dma_map_single(&dev->pdev->dev,
1909*4882a593Smuzhiyun req->buf,
1910*4882a593Smuzhiyun usbreq->length,
1911*4882a593Smuzhiyun DMA_FROM_DEVICE);
1912*4882a593Smuzhiyun }
1913*4882a593Smuzhiyun req->dma_mapped = 1;
1914*4882a593Smuzhiyun }
1915*4882a593Smuzhiyun if (usbreq->length > 0) {
1916*4882a593Smuzhiyun retval = prepare_dma(ep, req, GFP_ATOMIC);
1917*4882a593Smuzhiyun if (retval)
1918*4882a593Smuzhiyun goto probe_end;
1919*4882a593Smuzhiyun }
1920*4882a593Smuzhiyun usbreq->actual = 0;
1921*4882a593Smuzhiyun usbreq->status = -EINPROGRESS;
1922*4882a593Smuzhiyun req->dma_done = 0;
1923*4882a593Smuzhiyun if (list_empty(&ep->queue) && !ep->halted) {
1924*4882a593Smuzhiyun /* no pending transfer, so start this req */
1925*4882a593Smuzhiyun if (!usbreq->length) {
1926*4882a593Smuzhiyun process_zlp(ep, req);
1927*4882a593Smuzhiyun retval = 0;
1928*4882a593Smuzhiyun goto probe_end;
1929*4882a593Smuzhiyun }
1930*4882a593Smuzhiyun if (!ep->in) {
1931*4882a593Smuzhiyun pch_udc_start_rxrequest(ep, req);
1932*4882a593Smuzhiyun } else {
1933*4882a593Smuzhiyun /*
1934*4882a593Smuzhiyun * For IN trfr the descriptors will be programmed and
1935*4882a593Smuzhiyun * P bit will be set when
1936*4882a593Smuzhiyun * we get an IN token
1937*4882a593Smuzhiyun */
1938*4882a593Smuzhiyun pch_udc_wait_ep_stall(ep);
1939*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
1940*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev, (1 << ep->num));
1941*4882a593Smuzhiyun }
1942*4882a593Smuzhiyun }
1943*4882a593Smuzhiyun /* Now add this request to the ep's pending requests */
1944*4882a593Smuzhiyun if (req != NULL)
1945*4882a593Smuzhiyun list_add_tail(&req->queue, &ep->queue);
1946*4882a593Smuzhiyun
1947*4882a593Smuzhiyun probe_end:
1948*4882a593Smuzhiyun spin_unlock_irqrestore(&dev->lock, iflags);
1949*4882a593Smuzhiyun return retval;
1950*4882a593Smuzhiyun }
1951*4882a593Smuzhiyun
1952*4882a593Smuzhiyun /**
1953*4882a593Smuzhiyun * pch_udc_pcd_dequeue() - This function de-queues a request packet.
1954*4882a593Smuzhiyun * It is called by gadget driver
1955*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1956*4882a593Smuzhiyun * @usbreq: Reference to the USB request
1957*4882a593Smuzhiyun *
1958*4882a593Smuzhiyun * Return codes:
1959*4882a593Smuzhiyun * 0: Success
1960*4882a593Smuzhiyun * linux error number: Failure
1961*4882a593Smuzhiyun */
pch_udc_pcd_dequeue(struct usb_ep * usbep,struct usb_request * usbreq)1962*4882a593Smuzhiyun static int pch_udc_pcd_dequeue(struct usb_ep *usbep,
1963*4882a593Smuzhiyun struct usb_request *usbreq)
1964*4882a593Smuzhiyun {
1965*4882a593Smuzhiyun struct pch_udc_ep *ep;
1966*4882a593Smuzhiyun struct pch_udc_request *req;
1967*4882a593Smuzhiyun unsigned long flags;
1968*4882a593Smuzhiyun int ret = -EINVAL;
1969*4882a593Smuzhiyun
1970*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
1971*4882a593Smuzhiyun if (!usbep || !usbreq || (!ep->ep.desc && ep->num))
1972*4882a593Smuzhiyun return ret;
1973*4882a593Smuzhiyun req = container_of(usbreq, struct pch_udc_request, req);
1974*4882a593Smuzhiyun spin_lock_irqsave(&ep->dev->lock, flags);
1975*4882a593Smuzhiyun /* make sure it's still queued on this endpoint */
1976*4882a593Smuzhiyun list_for_each_entry(req, &ep->queue, queue) {
1977*4882a593Smuzhiyun if (&req->req == usbreq) {
1978*4882a593Smuzhiyun pch_udc_ep_set_nak(ep);
1979*4882a593Smuzhiyun if (!list_empty(&req->queue))
1980*4882a593Smuzhiyun complete_req(ep, req, -ECONNRESET);
1981*4882a593Smuzhiyun ret = 0;
1982*4882a593Smuzhiyun break;
1983*4882a593Smuzhiyun }
1984*4882a593Smuzhiyun }
1985*4882a593Smuzhiyun spin_unlock_irqrestore(&ep->dev->lock, flags);
1986*4882a593Smuzhiyun return ret;
1987*4882a593Smuzhiyun }
1988*4882a593Smuzhiyun
1989*4882a593Smuzhiyun /**
1990*4882a593Smuzhiyun * pch_udc_pcd_set_halt() - This function Sets or clear the endpoint halt
1991*4882a593Smuzhiyun * feature
1992*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
1993*4882a593Smuzhiyun * @halt: Specifies whether to set or clear the feature
1994*4882a593Smuzhiyun *
1995*4882a593Smuzhiyun * Return codes:
1996*4882a593Smuzhiyun * 0: Success
1997*4882a593Smuzhiyun * linux error number: Failure
1998*4882a593Smuzhiyun */
pch_udc_pcd_set_halt(struct usb_ep * usbep,int halt)1999*4882a593Smuzhiyun static int pch_udc_pcd_set_halt(struct usb_ep *usbep, int halt)
2000*4882a593Smuzhiyun {
2001*4882a593Smuzhiyun struct pch_udc_ep *ep;
2002*4882a593Smuzhiyun unsigned long iflags;
2003*4882a593Smuzhiyun int ret;
2004*4882a593Smuzhiyun
2005*4882a593Smuzhiyun if (!usbep)
2006*4882a593Smuzhiyun return -EINVAL;
2007*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
2008*4882a593Smuzhiyun if (!ep->ep.desc && !ep->num)
2009*4882a593Smuzhiyun return -EINVAL;
2010*4882a593Smuzhiyun if (!ep->dev->driver || (ep->dev->gadget.speed == USB_SPEED_UNKNOWN))
2011*4882a593Smuzhiyun return -ESHUTDOWN;
2012*4882a593Smuzhiyun spin_lock_irqsave(&udc_stall_spinlock, iflags);
2013*4882a593Smuzhiyun if (list_empty(&ep->queue)) {
2014*4882a593Smuzhiyun if (halt) {
2015*4882a593Smuzhiyun if (ep->num == PCH_UDC_EP0)
2016*4882a593Smuzhiyun ep->dev->stall = 1;
2017*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2018*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(
2019*4882a593Smuzhiyun ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
2020*4882a593Smuzhiyun } else {
2021*4882a593Smuzhiyun pch_udc_ep_clear_stall(ep);
2022*4882a593Smuzhiyun }
2023*4882a593Smuzhiyun ret = 0;
2024*4882a593Smuzhiyun } else {
2025*4882a593Smuzhiyun ret = -EAGAIN;
2026*4882a593Smuzhiyun }
2027*4882a593Smuzhiyun spin_unlock_irqrestore(&udc_stall_spinlock, iflags);
2028*4882a593Smuzhiyun return ret;
2029*4882a593Smuzhiyun }
2030*4882a593Smuzhiyun
2031*4882a593Smuzhiyun /**
2032*4882a593Smuzhiyun * pch_udc_pcd_set_wedge() - This function Sets or clear the endpoint
2033*4882a593Smuzhiyun * halt feature
2034*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
2035*4882a593Smuzhiyun *
2036*4882a593Smuzhiyun * Return codes:
2037*4882a593Smuzhiyun * 0: Success
2038*4882a593Smuzhiyun * linux error number: Failure
2039*4882a593Smuzhiyun */
pch_udc_pcd_set_wedge(struct usb_ep * usbep)2040*4882a593Smuzhiyun static int pch_udc_pcd_set_wedge(struct usb_ep *usbep)
2041*4882a593Smuzhiyun {
2042*4882a593Smuzhiyun struct pch_udc_ep *ep;
2043*4882a593Smuzhiyun unsigned long iflags;
2044*4882a593Smuzhiyun int ret;
2045*4882a593Smuzhiyun
2046*4882a593Smuzhiyun if (!usbep)
2047*4882a593Smuzhiyun return -EINVAL;
2048*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
2049*4882a593Smuzhiyun if (!ep->ep.desc && !ep->num)
2050*4882a593Smuzhiyun return -EINVAL;
2051*4882a593Smuzhiyun if (!ep->dev->driver || (ep->dev->gadget.speed == USB_SPEED_UNKNOWN))
2052*4882a593Smuzhiyun return -ESHUTDOWN;
2053*4882a593Smuzhiyun spin_lock_irqsave(&udc_stall_spinlock, iflags);
2054*4882a593Smuzhiyun if (!list_empty(&ep->queue)) {
2055*4882a593Smuzhiyun ret = -EAGAIN;
2056*4882a593Smuzhiyun } else {
2057*4882a593Smuzhiyun if (ep->num == PCH_UDC_EP0)
2058*4882a593Smuzhiyun ep->dev->stall = 1;
2059*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2060*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2061*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2062*4882a593Smuzhiyun ep->dev->prot_stall = 1;
2063*4882a593Smuzhiyun ret = 0;
2064*4882a593Smuzhiyun }
2065*4882a593Smuzhiyun spin_unlock_irqrestore(&udc_stall_spinlock, iflags);
2066*4882a593Smuzhiyun return ret;
2067*4882a593Smuzhiyun }
2068*4882a593Smuzhiyun
2069*4882a593Smuzhiyun /**
2070*4882a593Smuzhiyun * pch_udc_pcd_fifo_flush() - This function Flush the FIFO of specified endpoint
2071*4882a593Smuzhiyun * @usbep: Reference to the USB endpoint structure
2072*4882a593Smuzhiyun */
pch_udc_pcd_fifo_flush(struct usb_ep * usbep)2073*4882a593Smuzhiyun static void pch_udc_pcd_fifo_flush(struct usb_ep *usbep)
2074*4882a593Smuzhiyun {
2075*4882a593Smuzhiyun struct pch_udc_ep *ep;
2076*4882a593Smuzhiyun
2077*4882a593Smuzhiyun if (!usbep)
2078*4882a593Smuzhiyun return;
2079*4882a593Smuzhiyun
2080*4882a593Smuzhiyun ep = container_of(usbep, struct pch_udc_ep, ep);
2081*4882a593Smuzhiyun if (ep->ep.desc || !ep->num)
2082*4882a593Smuzhiyun pch_udc_ep_fifo_flush(ep, ep->in);
2083*4882a593Smuzhiyun }
2084*4882a593Smuzhiyun
2085*4882a593Smuzhiyun static const struct usb_ep_ops pch_udc_ep_ops = {
2086*4882a593Smuzhiyun .enable = pch_udc_pcd_ep_enable,
2087*4882a593Smuzhiyun .disable = pch_udc_pcd_ep_disable,
2088*4882a593Smuzhiyun .alloc_request = pch_udc_alloc_request,
2089*4882a593Smuzhiyun .free_request = pch_udc_free_request,
2090*4882a593Smuzhiyun .queue = pch_udc_pcd_queue,
2091*4882a593Smuzhiyun .dequeue = pch_udc_pcd_dequeue,
2092*4882a593Smuzhiyun .set_halt = pch_udc_pcd_set_halt,
2093*4882a593Smuzhiyun .set_wedge = pch_udc_pcd_set_wedge,
2094*4882a593Smuzhiyun .fifo_status = NULL,
2095*4882a593Smuzhiyun .fifo_flush = pch_udc_pcd_fifo_flush,
2096*4882a593Smuzhiyun };
2097*4882a593Smuzhiyun
2098*4882a593Smuzhiyun /**
2099*4882a593Smuzhiyun * pch_udc_init_setup_buff() - This function initializes the SETUP buffer
2100*4882a593Smuzhiyun * @td_stp: Reference to the SETP buffer structure
2101*4882a593Smuzhiyun */
pch_udc_init_setup_buff(struct pch_udc_stp_dma_desc * td_stp)2102*4882a593Smuzhiyun static void pch_udc_init_setup_buff(struct pch_udc_stp_dma_desc *td_stp)
2103*4882a593Smuzhiyun {
2104*4882a593Smuzhiyun static u32 pky_marker;
2105*4882a593Smuzhiyun
2106*4882a593Smuzhiyun if (!td_stp)
2107*4882a593Smuzhiyun return;
2108*4882a593Smuzhiyun td_stp->reserved = ++pky_marker;
2109*4882a593Smuzhiyun memset(&td_stp->request, 0xFF, sizeof td_stp->request);
2110*4882a593Smuzhiyun td_stp->status = PCH_UDC_BS_HST_RDY;
2111*4882a593Smuzhiyun }
2112*4882a593Smuzhiyun
2113*4882a593Smuzhiyun /**
2114*4882a593Smuzhiyun * pch_udc_start_next_txrequest() - This function starts
2115*4882a593Smuzhiyun * the next transmission requirement
2116*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
2117*4882a593Smuzhiyun */
pch_udc_start_next_txrequest(struct pch_udc_ep * ep)2118*4882a593Smuzhiyun static void pch_udc_start_next_txrequest(struct pch_udc_ep *ep)
2119*4882a593Smuzhiyun {
2120*4882a593Smuzhiyun struct pch_udc_request *req;
2121*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td_data;
2122*4882a593Smuzhiyun
2123*4882a593Smuzhiyun if (pch_udc_read_ep_control(ep) & UDC_EPCTL_P)
2124*4882a593Smuzhiyun return;
2125*4882a593Smuzhiyun
2126*4882a593Smuzhiyun if (list_empty(&ep->queue))
2127*4882a593Smuzhiyun return;
2128*4882a593Smuzhiyun
2129*4882a593Smuzhiyun /* next request */
2130*4882a593Smuzhiyun req = list_entry(ep->queue.next, struct pch_udc_request, queue);
2131*4882a593Smuzhiyun if (req->dma_going)
2132*4882a593Smuzhiyun return;
2133*4882a593Smuzhiyun if (!req->td_data)
2134*4882a593Smuzhiyun return;
2135*4882a593Smuzhiyun pch_udc_wait_ep_stall(ep);
2136*4882a593Smuzhiyun req->dma_going = 1;
2137*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, 0);
2138*4882a593Smuzhiyun td_data = req->td_data;
2139*4882a593Smuzhiyun while (1) {
2140*4882a593Smuzhiyun td_data->status = (td_data->status & ~PCH_UDC_BUFF_STS) |
2141*4882a593Smuzhiyun PCH_UDC_BS_HST_RDY;
2142*4882a593Smuzhiyun if ((td_data->status & PCH_UDC_DMA_LAST) == PCH_UDC_DMA_LAST)
2143*4882a593Smuzhiyun break;
2144*4882a593Smuzhiyun td_data = phys_to_virt(td_data->next);
2145*4882a593Smuzhiyun }
2146*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, req->td_data_phys);
2147*4882a593Smuzhiyun pch_udc_set_dma(ep->dev, DMA_DIR_TX);
2148*4882a593Smuzhiyun pch_udc_ep_set_pd(ep);
2149*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
2150*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
2151*4882a593Smuzhiyun }
2152*4882a593Smuzhiyun
2153*4882a593Smuzhiyun /**
2154*4882a593Smuzhiyun * pch_udc_complete_transfer() - This function completes a transfer
2155*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
2156*4882a593Smuzhiyun */
pch_udc_complete_transfer(struct pch_udc_ep * ep)2157*4882a593Smuzhiyun static void pch_udc_complete_transfer(struct pch_udc_ep *ep)
2158*4882a593Smuzhiyun {
2159*4882a593Smuzhiyun struct pch_udc_request *req;
2160*4882a593Smuzhiyun struct pch_udc_dev *dev = ep->dev;
2161*4882a593Smuzhiyun
2162*4882a593Smuzhiyun if (list_empty(&ep->queue))
2163*4882a593Smuzhiyun return;
2164*4882a593Smuzhiyun req = list_entry(ep->queue.next, struct pch_udc_request, queue);
2165*4882a593Smuzhiyun if ((req->td_data_last->status & PCH_UDC_BUFF_STS) !=
2166*4882a593Smuzhiyun PCH_UDC_BS_DMA_DONE)
2167*4882a593Smuzhiyun return;
2168*4882a593Smuzhiyun if ((req->td_data_last->status & PCH_UDC_RXTX_STS) !=
2169*4882a593Smuzhiyun PCH_UDC_RTS_SUCC) {
2170*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "Invalid RXTX status (0x%08x) "
2171*4882a593Smuzhiyun "epstatus=0x%08x\n",
2172*4882a593Smuzhiyun (req->td_data_last->status & PCH_UDC_RXTX_STS),
2173*4882a593Smuzhiyun (int)(ep->epsts));
2174*4882a593Smuzhiyun return;
2175*4882a593Smuzhiyun }
2176*4882a593Smuzhiyun
2177*4882a593Smuzhiyun req->req.actual = req->req.length;
2178*4882a593Smuzhiyun req->td_data_last->status = PCH_UDC_BS_HST_BSY | PCH_UDC_DMA_LAST;
2179*4882a593Smuzhiyun req->td_data->status = PCH_UDC_BS_HST_BSY | PCH_UDC_DMA_LAST;
2180*4882a593Smuzhiyun complete_req(ep, req, 0);
2181*4882a593Smuzhiyun req->dma_going = 0;
2182*4882a593Smuzhiyun if (!list_empty(&ep->queue)) {
2183*4882a593Smuzhiyun pch_udc_wait_ep_stall(ep);
2184*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
2185*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2186*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2187*4882a593Smuzhiyun } else {
2188*4882a593Smuzhiyun pch_udc_disable_ep_interrupts(ep->dev,
2189*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2190*4882a593Smuzhiyun }
2191*4882a593Smuzhiyun }
2192*4882a593Smuzhiyun
2193*4882a593Smuzhiyun /**
2194*4882a593Smuzhiyun * pch_udc_complete_receiver() - This function completes a receiver
2195*4882a593Smuzhiyun * @ep: Reference to the endpoint structure
2196*4882a593Smuzhiyun */
pch_udc_complete_receiver(struct pch_udc_ep * ep)2197*4882a593Smuzhiyun static void pch_udc_complete_receiver(struct pch_udc_ep *ep)
2198*4882a593Smuzhiyun {
2199*4882a593Smuzhiyun struct pch_udc_request *req;
2200*4882a593Smuzhiyun struct pch_udc_dev *dev = ep->dev;
2201*4882a593Smuzhiyun unsigned int count;
2202*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td;
2203*4882a593Smuzhiyun dma_addr_t addr;
2204*4882a593Smuzhiyun
2205*4882a593Smuzhiyun if (list_empty(&ep->queue))
2206*4882a593Smuzhiyun return;
2207*4882a593Smuzhiyun /* next request */
2208*4882a593Smuzhiyun req = list_entry(ep->queue.next, struct pch_udc_request, queue);
2209*4882a593Smuzhiyun pch_udc_clear_dma(ep->dev, DMA_DIR_RX);
2210*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, 0);
2211*4882a593Smuzhiyun if ((req->td_data_last->status & PCH_UDC_BUFF_STS) ==
2212*4882a593Smuzhiyun PCH_UDC_BS_DMA_DONE)
2213*4882a593Smuzhiyun td = req->td_data_last;
2214*4882a593Smuzhiyun else
2215*4882a593Smuzhiyun td = req->td_data;
2216*4882a593Smuzhiyun
2217*4882a593Smuzhiyun while (1) {
2218*4882a593Smuzhiyun if ((td->status & PCH_UDC_RXTX_STS) != PCH_UDC_RTS_SUCC) {
2219*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "Invalid RXTX status=0x%08x "
2220*4882a593Smuzhiyun "epstatus=0x%08x\n",
2221*4882a593Smuzhiyun (req->td_data->status & PCH_UDC_RXTX_STS),
2222*4882a593Smuzhiyun (int)(ep->epsts));
2223*4882a593Smuzhiyun return;
2224*4882a593Smuzhiyun }
2225*4882a593Smuzhiyun if ((td->status & PCH_UDC_BUFF_STS) == PCH_UDC_BS_DMA_DONE)
2226*4882a593Smuzhiyun if (td->status & PCH_UDC_DMA_LAST) {
2227*4882a593Smuzhiyun count = td->status & PCH_UDC_RXTX_BYTES;
2228*4882a593Smuzhiyun break;
2229*4882a593Smuzhiyun }
2230*4882a593Smuzhiyun if (td == req->td_data_last) {
2231*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "Not complete RX descriptor");
2232*4882a593Smuzhiyun return;
2233*4882a593Smuzhiyun }
2234*4882a593Smuzhiyun addr = (dma_addr_t)td->next;
2235*4882a593Smuzhiyun td = phys_to_virt(addr);
2236*4882a593Smuzhiyun }
2237*4882a593Smuzhiyun /* on 64k packets the RXBYTES field is zero */
2238*4882a593Smuzhiyun if (!count && (req->req.length == UDC_DMA_MAXPACKET))
2239*4882a593Smuzhiyun count = UDC_DMA_MAXPACKET;
2240*4882a593Smuzhiyun req->td_data->status |= PCH_UDC_DMA_LAST;
2241*4882a593Smuzhiyun td->status |= PCH_UDC_BS_HST_BSY;
2242*4882a593Smuzhiyun
2243*4882a593Smuzhiyun req->dma_going = 0;
2244*4882a593Smuzhiyun req->req.actual = count;
2245*4882a593Smuzhiyun complete_req(ep, req, 0);
2246*4882a593Smuzhiyun /* If there is a new/failed requests try that now */
2247*4882a593Smuzhiyun if (!list_empty(&ep->queue)) {
2248*4882a593Smuzhiyun req = list_entry(ep->queue.next, struct pch_udc_request, queue);
2249*4882a593Smuzhiyun pch_udc_start_rxrequest(ep, req);
2250*4882a593Smuzhiyun }
2251*4882a593Smuzhiyun }
2252*4882a593Smuzhiyun
2253*4882a593Smuzhiyun /**
2254*4882a593Smuzhiyun * pch_udc_svc_data_in() - This function process endpoint interrupts
2255*4882a593Smuzhiyun * for IN endpoints
2256*4882a593Smuzhiyun * @dev: Reference to the device structure
2257*4882a593Smuzhiyun * @ep_num: Endpoint that generated the interrupt
2258*4882a593Smuzhiyun */
pch_udc_svc_data_in(struct pch_udc_dev * dev,int ep_num)2259*4882a593Smuzhiyun static void pch_udc_svc_data_in(struct pch_udc_dev *dev, int ep_num)
2260*4882a593Smuzhiyun {
2261*4882a593Smuzhiyun u32 epsts;
2262*4882a593Smuzhiyun struct pch_udc_ep *ep;
2263*4882a593Smuzhiyun
2264*4882a593Smuzhiyun ep = &dev->ep[UDC_EPIN_IDX(ep_num)];
2265*4882a593Smuzhiyun epsts = ep->epsts;
2266*4882a593Smuzhiyun ep->epsts = 0;
2267*4882a593Smuzhiyun
2268*4882a593Smuzhiyun if (!(epsts & (UDC_EPSTS_IN | UDC_EPSTS_BNA | UDC_EPSTS_HE |
2269*4882a593Smuzhiyun UDC_EPSTS_TDC | UDC_EPSTS_RCS | UDC_EPSTS_TXEMPTY |
2270*4882a593Smuzhiyun UDC_EPSTS_RSS | UDC_EPSTS_XFERDONE)))
2271*4882a593Smuzhiyun return;
2272*4882a593Smuzhiyun if ((epsts & UDC_EPSTS_BNA))
2273*4882a593Smuzhiyun return;
2274*4882a593Smuzhiyun if (epsts & UDC_EPSTS_HE)
2275*4882a593Smuzhiyun return;
2276*4882a593Smuzhiyun if (epsts & UDC_EPSTS_RSS) {
2277*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2278*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2279*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2280*4882a593Smuzhiyun }
2281*4882a593Smuzhiyun if (epsts & UDC_EPSTS_RCS) {
2282*4882a593Smuzhiyun if (!dev->prot_stall) {
2283*4882a593Smuzhiyun pch_udc_ep_clear_stall(ep);
2284*4882a593Smuzhiyun } else {
2285*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2286*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2287*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2288*4882a593Smuzhiyun }
2289*4882a593Smuzhiyun }
2290*4882a593Smuzhiyun if (epsts & UDC_EPSTS_TDC)
2291*4882a593Smuzhiyun pch_udc_complete_transfer(ep);
2292*4882a593Smuzhiyun /* On IN interrupt, provide data if we have any */
2293*4882a593Smuzhiyun if ((epsts & UDC_EPSTS_IN) && !(epsts & UDC_EPSTS_RSS) &&
2294*4882a593Smuzhiyun !(epsts & UDC_EPSTS_TDC) && !(epsts & UDC_EPSTS_TXEMPTY))
2295*4882a593Smuzhiyun pch_udc_start_next_txrequest(ep);
2296*4882a593Smuzhiyun }
2297*4882a593Smuzhiyun
2298*4882a593Smuzhiyun /**
2299*4882a593Smuzhiyun * pch_udc_svc_data_out() - Handles interrupts from OUT endpoint
2300*4882a593Smuzhiyun * @dev: Reference to the device structure
2301*4882a593Smuzhiyun * @ep_num: Endpoint that generated the interrupt
2302*4882a593Smuzhiyun */
pch_udc_svc_data_out(struct pch_udc_dev * dev,int ep_num)2303*4882a593Smuzhiyun static void pch_udc_svc_data_out(struct pch_udc_dev *dev, int ep_num)
2304*4882a593Smuzhiyun {
2305*4882a593Smuzhiyun u32 epsts;
2306*4882a593Smuzhiyun struct pch_udc_ep *ep;
2307*4882a593Smuzhiyun struct pch_udc_request *req = NULL;
2308*4882a593Smuzhiyun
2309*4882a593Smuzhiyun ep = &dev->ep[UDC_EPOUT_IDX(ep_num)];
2310*4882a593Smuzhiyun epsts = ep->epsts;
2311*4882a593Smuzhiyun ep->epsts = 0;
2312*4882a593Smuzhiyun
2313*4882a593Smuzhiyun if ((epsts & UDC_EPSTS_BNA) && (!list_empty(&ep->queue))) {
2314*4882a593Smuzhiyun /* next request */
2315*4882a593Smuzhiyun req = list_entry(ep->queue.next, struct pch_udc_request,
2316*4882a593Smuzhiyun queue);
2317*4882a593Smuzhiyun if ((req->td_data_last->status & PCH_UDC_BUFF_STS) !=
2318*4882a593Smuzhiyun PCH_UDC_BS_DMA_DONE) {
2319*4882a593Smuzhiyun if (!req->dma_going)
2320*4882a593Smuzhiyun pch_udc_start_rxrequest(ep, req);
2321*4882a593Smuzhiyun return;
2322*4882a593Smuzhiyun }
2323*4882a593Smuzhiyun }
2324*4882a593Smuzhiyun if (epsts & UDC_EPSTS_HE)
2325*4882a593Smuzhiyun return;
2326*4882a593Smuzhiyun if (epsts & UDC_EPSTS_RSS) {
2327*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2328*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2329*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2330*4882a593Smuzhiyun }
2331*4882a593Smuzhiyun if (epsts & UDC_EPSTS_RCS) {
2332*4882a593Smuzhiyun if (!dev->prot_stall) {
2333*4882a593Smuzhiyun pch_udc_ep_clear_stall(ep);
2334*4882a593Smuzhiyun } else {
2335*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2336*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2337*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2338*4882a593Smuzhiyun }
2339*4882a593Smuzhiyun }
2340*4882a593Smuzhiyun if (((epsts & UDC_EPSTS_OUT_MASK) >> UDC_EPSTS_OUT_SHIFT) ==
2341*4882a593Smuzhiyun UDC_EPSTS_OUT_DATA) {
2342*4882a593Smuzhiyun if (ep->dev->prot_stall == 1) {
2343*4882a593Smuzhiyun pch_udc_ep_set_stall(ep);
2344*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2345*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2346*4882a593Smuzhiyun } else {
2347*4882a593Smuzhiyun pch_udc_complete_receiver(ep);
2348*4882a593Smuzhiyun }
2349*4882a593Smuzhiyun }
2350*4882a593Smuzhiyun if (list_empty(&ep->queue))
2351*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_RX);
2352*4882a593Smuzhiyun }
2353*4882a593Smuzhiyun
pch_udc_gadget_setup(struct pch_udc_dev * dev)2354*4882a593Smuzhiyun static int pch_udc_gadget_setup(struct pch_udc_dev *dev)
2355*4882a593Smuzhiyun __must_hold(&dev->lock)
2356*4882a593Smuzhiyun {
2357*4882a593Smuzhiyun int rc;
2358*4882a593Smuzhiyun
2359*4882a593Smuzhiyun /* In some cases we can get an interrupt before driver gets setup */
2360*4882a593Smuzhiyun if (!dev->driver)
2361*4882a593Smuzhiyun return -ESHUTDOWN;
2362*4882a593Smuzhiyun
2363*4882a593Smuzhiyun spin_unlock(&dev->lock);
2364*4882a593Smuzhiyun rc = dev->driver->setup(&dev->gadget, &dev->setup_data);
2365*4882a593Smuzhiyun spin_lock(&dev->lock);
2366*4882a593Smuzhiyun return rc;
2367*4882a593Smuzhiyun }
2368*4882a593Smuzhiyun
2369*4882a593Smuzhiyun /**
2370*4882a593Smuzhiyun * pch_udc_svc_control_in() - Handle Control IN endpoint interrupts
2371*4882a593Smuzhiyun * @dev: Reference to the device structure
2372*4882a593Smuzhiyun */
pch_udc_svc_control_in(struct pch_udc_dev * dev)2373*4882a593Smuzhiyun static void pch_udc_svc_control_in(struct pch_udc_dev *dev)
2374*4882a593Smuzhiyun {
2375*4882a593Smuzhiyun u32 epsts;
2376*4882a593Smuzhiyun struct pch_udc_ep *ep;
2377*4882a593Smuzhiyun struct pch_udc_ep *ep_out;
2378*4882a593Smuzhiyun
2379*4882a593Smuzhiyun ep = &dev->ep[UDC_EP0IN_IDX];
2380*4882a593Smuzhiyun ep_out = &dev->ep[UDC_EP0OUT_IDX];
2381*4882a593Smuzhiyun epsts = ep->epsts;
2382*4882a593Smuzhiyun ep->epsts = 0;
2383*4882a593Smuzhiyun
2384*4882a593Smuzhiyun if (!(epsts & (UDC_EPSTS_IN | UDC_EPSTS_BNA | UDC_EPSTS_HE |
2385*4882a593Smuzhiyun UDC_EPSTS_TDC | UDC_EPSTS_RCS | UDC_EPSTS_TXEMPTY |
2386*4882a593Smuzhiyun UDC_EPSTS_XFERDONE)))
2387*4882a593Smuzhiyun return;
2388*4882a593Smuzhiyun if ((epsts & UDC_EPSTS_BNA))
2389*4882a593Smuzhiyun return;
2390*4882a593Smuzhiyun if (epsts & UDC_EPSTS_HE)
2391*4882a593Smuzhiyun return;
2392*4882a593Smuzhiyun if ((epsts & UDC_EPSTS_TDC) && (!dev->stall)) {
2393*4882a593Smuzhiyun pch_udc_complete_transfer(ep);
2394*4882a593Smuzhiyun pch_udc_clear_dma(dev, DMA_DIR_RX);
2395*4882a593Smuzhiyun ep_out->td_data->status = (ep_out->td_data->status &
2396*4882a593Smuzhiyun ~PCH_UDC_BUFF_STS) |
2397*4882a593Smuzhiyun PCH_UDC_BS_HST_RDY;
2398*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep_out);
2399*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_RX);
2400*4882a593Smuzhiyun pch_udc_ep_set_rrdy(ep_out);
2401*4882a593Smuzhiyun }
2402*4882a593Smuzhiyun /* On IN interrupt, provide data if we have any */
2403*4882a593Smuzhiyun if ((epsts & UDC_EPSTS_IN) && !(epsts & UDC_EPSTS_TDC) &&
2404*4882a593Smuzhiyun !(epsts & UDC_EPSTS_TXEMPTY))
2405*4882a593Smuzhiyun pch_udc_start_next_txrequest(ep);
2406*4882a593Smuzhiyun }
2407*4882a593Smuzhiyun
2408*4882a593Smuzhiyun /**
2409*4882a593Smuzhiyun * pch_udc_svc_control_out() - Routine that handle Control
2410*4882a593Smuzhiyun * OUT endpoint interrupts
2411*4882a593Smuzhiyun * @dev: Reference to the device structure
2412*4882a593Smuzhiyun */
pch_udc_svc_control_out(struct pch_udc_dev * dev)2413*4882a593Smuzhiyun static void pch_udc_svc_control_out(struct pch_udc_dev *dev)
2414*4882a593Smuzhiyun __releases(&dev->lock)
2415*4882a593Smuzhiyun __acquires(&dev->lock)
2416*4882a593Smuzhiyun {
2417*4882a593Smuzhiyun u32 stat;
2418*4882a593Smuzhiyun int setup_supported;
2419*4882a593Smuzhiyun struct pch_udc_ep *ep;
2420*4882a593Smuzhiyun
2421*4882a593Smuzhiyun ep = &dev->ep[UDC_EP0OUT_IDX];
2422*4882a593Smuzhiyun stat = ep->epsts;
2423*4882a593Smuzhiyun ep->epsts = 0;
2424*4882a593Smuzhiyun
2425*4882a593Smuzhiyun /* If setup data */
2426*4882a593Smuzhiyun if (((stat & UDC_EPSTS_OUT_MASK) >> UDC_EPSTS_OUT_SHIFT) ==
2427*4882a593Smuzhiyun UDC_EPSTS_OUT_SETUP) {
2428*4882a593Smuzhiyun dev->stall = 0;
2429*4882a593Smuzhiyun dev->ep[UDC_EP0IN_IDX].halted = 0;
2430*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].halted = 0;
2431*4882a593Smuzhiyun dev->setup_data = ep->td_stp->request;
2432*4882a593Smuzhiyun pch_udc_init_setup_buff(ep->td_stp);
2433*4882a593Smuzhiyun pch_udc_clear_dma(dev, DMA_DIR_RX);
2434*4882a593Smuzhiyun pch_udc_ep_fifo_flush(&(dev->ep[UDC_EP0IN_IDX]),
2435*4882a593Smuzhiyun dev->ep[UDC_EP0IN_IDX].in);
2436*4882a593Smuzhiyun if ((dev->setup_data.bRequestType & USB_DIR_IN))
2437*4882a593Smuzhiyun dev->gadget.ep0 = &dev->ep[UDC_EP0IN_IDX].ep;
2438*4882a593Smuzhiyun else /* OUT */
2439*4882a593Smuzhiyun dev->gadget.ep0 = &ep->ep;
2440*4882a593Smuzhiyun /* If Mass storage Reset */
2441*4882a593Smuzhiyun if ((dev->setup_data.bRequestType == 0x21) &&
2442*4882a593Smuzhiyun (dev->setup_data.bRequest == 0xFF))
2443*4882a593Smuzhiyun dev->prot_stall = 0;
2444*4882a593Smuzhiyun /* call gadget with setup data received */
2445*4882a593Smuzhiyun setup_supported = pch_udc_gadget_setup(dev);
2446*4882a593Smuzhiyun
2447*4882a593Smuzhiyun if (dev->setup_data.bRequestType & USB_DIR_IN) {
2448*4882a593Smuzhiyun ep->td_data->status = (ep->td_data->status &
2449*4882a593Smuzhiyun ~PCH_UDC_BUFF_STS) |
2450*4882a593Smuzhiyun PCH_UDC_BS_HST_RDY;
2451*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, ep->td_data_phys);
2452*4882a593Smuzhiyun }
2453*4882a593Smuzhiyun /* ep0 in returns data on IN phase */
2454*4882a593Smuzhiyun if (setup_supported >= 0 && setup_supported <
2455*4882a593Smuzhiyun UDC_EP0IN_MAX_PKT_SIZE) {
2456*4882a593Smuzhiyun pch_udc_ep_clear_nak(&(dev->ep[UDC_EP0IN_IDX]));
2457*4882a593Smuzhiyun /* Gadget would have queued a request when
2458*4882a593Smuzhiyun * we called the setup */
2459*4882a593Smuzhiyun if (!(dev->setup_data.bRequestType & USB_DIR_IN)) {
2460*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_RX);
2461*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
2462*4882a593Smuzhiyun }
2463*4882a593Smuzhiyun } else if (setup_supported < 0) {
2464*4882a593Smuzhiyun /* if unsupported request, then stall */
2465*4882a593Smuzhiyun pch_udc_ep_set_stall(&(dev->ep[UDC_EP0IN_IDX]));
2466*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev,
2467*4882a593Smuzhiyun PCH_UDC_EPINT(ep->in, ep->num));
2468*4882a593Smuzhiyun dev->stall = 0;
2469*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_RX);
2470*4882a593Smuzhiyun } else {
2471*4882a593Smuzhiyun dev->waiting_zlp_ack = 1;
2472*4882a593Smuzhiyun }
2473*4882a593Smuzhiyun } else if ((((stat & UDC_EPSTS_OUT_MASK) >> UDC_EPSTS_OUT_SHIFT) ==
2474*4882a593Smuzhiyun UDC_EPSTS_OUT_DATA) && !dev->stall) {
2475*4882a593Smuzhiyun pch_udc_clear_dma(dev, DMA_DIR_RX);
2476*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, 0);
2477*4882a593Smuzhiyun if (!list_empty(&ep->queue)) {
2478*4882a593Smuzhiyun ep->epsts = stat;
2479*4882a593Smuzhiyun pch_udc_svc_data_out(dev, PCH_UDC_EP0);
2480*4882a593Smuzhiyun }
2481*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_RX);
2482*4882a593Smuzhiyun }
2483*4882a593Smuzhiyun pch_udc_ep_set_rrdy(ep);
2484*4882a593Smuzhiyun }
2485*4882a593Smuzhiyun
2486*4882a593Smuzhiyun
2487*4882a593Smuzhiyun /**
2488*4882a593Smuzhiyun * pch_udc_postsvc_epinters() - This function enables end point interrupts
2489*4882a593Smuzhiyun * and clears NAK status
2490*4882a593Smuzhiyun * @dev: Reference to the device structure
2491*4882a593Smuzhiyun * @ep_num: End point number
2492*4882a593Smuzhiyun */
pch_udc_postsvc_epinters(struct pch_udc_dev * dev,int ep_num)2493*4882a593Smuzhiyun static void pch_udc_postsvc_epinters(struct pch_udc_dev *dev, int ep_num)
2494*4882a593Smuzhiyun {
2495*4882a593Smuzhiyun struct pch_udc_ep *ep = &dev->ep[UDC_EPIN_IDX(ep_num)];
2496*4882a593Smuzhiyun if (list_empty(&ep->queue))
2497*4882a593Smuzhiyun return;
2498*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(ep->dev, PCH_UDC_EPINT(ep->in, ep->num));
2499*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
2500*4882a593Smuzhiyun }
2501*4882a593Smuzhiyun
2502*4882a593Smuzhiyun /**
2503*4882a593Smuzhiyun * pch_udc_read_all_epstatus() - This function read all endpoint status
2504*4882a593Smuzhiyun * @dev: Reference to the device structure
2505*4882a593Smuzhiyun * @ep_intr: Status of endpoint interrupt
2506*4882a593Smuzhiyun */
pch_udc_read_all_epstatus(struct pch_udc_dev * dev,u32 ep_intr)2507*4882a593Smuzhiyun static void pch_udc_read_all_epstatus(struct pch_udc_dev *dev, u32 ep_intr)
2508*4882a593Smuzhiyun {
2509*4882a593Smuzhiyun int i;
2510*4882a593Smuzhiyun struct pch_udc_ep *ep;
2511*4882a593Smuzhiyun
2512*4882a593Smuzhiyun for (i = 0; i < PCH_UDC_USED_EP_NUM; i++) {
2513*4882a593Smuzhiyun /* IN */
2514*4882a593Smuzhiyun if (ep_intr & (0x1 << i)) {
2515*4882a593Smuzhiyun ep = &dev->ep[UDC_EPIN_IDX(i)];
2516*4882a593Smuzhiyun ep->epsts = pch_udc_read_ep_status(ep);
2517*4882a593Smuzhiyun pch_udc_clear_ep_status(ep, ep->epsts);
2518*4882a593Smuzhiyun }
2519*4882a593Smuzhiyun /* OUT */
2520*4882a593Smuzhiyun if (ep_intr & (0x10000 << i)) {
2521*4882a593Smuzhiyun ep = &dev->ep[UDC_EPOUT_IDX(i)];
2522*4882a593Smuzhiyun ep->epsts = pch_udc_read_ep_status(ep);
2523*4882a593Smuzhiyun pch_udc_clear_ep_status(ep, ep->epsts);
2524*4882a593Smuzhiyun }
2525*4882a593Smuzhiyun }
2526*4882a593Smuzhiyun }
2527*4882a593Smuzhiyun
2528*4882a593Smuzhiyun /**
2529*4882a593Smuzhiyun * pch_udc_activate_control_ep() - This function enables the control endpoints
2530*4882a593Smuzhiyun * for traffic after a reset
2531*4882a593Smuzhiyun * @dev: Reference to the device structure
2532*4882a593Smuzhiyun */
pch_udc_activate_control_ep(struct pch_udc_dev * dev)2533*4882a593Smuzhiyun static void pch_udc_activate_control_ep(struct pch_udc_dev *dev)
2534*4882a593Smuzhiyun {
2535*4882a593Smuzhiyun struct pch_udc_ep *ep;
2536*4882a593Smuzhiyun u32 val;
2537*4882a593Smuzhiyun
2538*4882a593Smuzhiyun /* Setup the IN endpoint */
2539*4882a593Smuzhiyun ep = &dev->ep[UDC_EP0IN_IDX];
2540*4882a593Smuzhiyun pch_udc_clear_ep_control(ep);
2541*4882a593Smuzhiyun pch_udc_ep_fifo_flush(ep, ep->in);
2542*4882a593Smuzhiyun pch_udc_ep_set_bufsz(ep, UDC_EP0IN_BUFF_SIZE, ep->in);
2543*4882a593Smuzhiyun pch_udc_ep_set_maxpkt(ep, UDC_EP0IN_MAX_PKT_SIZE);
2544*4882a593Smuzhiyun /* Initialize the IN EP Descriptor */
2545*4882a593Smuzhiyun ep->td_data = NULL;
2546*4882a593Smuzhiyun ep->td_stp = NULL;
2547*4882a593Smuzhiyun ep->td_data_phys = 0;
2548*4882a593Smuzhiyun ep->td_stp_phys = 0;
2549*4882a593Smuzhiyun
2550*4882a593Smuzhiyun /* Setup the OUT endpoint */
2551*4882a593Smuzhiyun ep = &dev->ep[UDC_EP0OUT_IDX];
2552*4882a593Smuzhiyun pch_udc_clear_ep_control(ep);
2553*4882a593Smuzhiyun pch_udc_ep_fifo_flush(ep, ep->in);
2554*4882a593Smuzhiyun pch_udc_ep_set_bufsz(ep, UDC_EP0OUT_BUFF_SIZE, ep->in);
2555*4882a593Smuzhiyun pch_udc_ep_set_maxpkt(ep, UDC_EP0OUT_MAX_PKT_SIZE);
2556*4882a593Smuzhiyun val = UDC_EP0OUT_MAX_PKT_SIZE << UDC_CSR_NE_MAX_PKT_SHIFT;
2557*4882a593Smuzhiyun pch_udc_write_csr(ep->dev, val, UDC_EP0OUT_IDX);
2558*4882a593Smuzhiyun
2559*4882a593Smuzhiyun /* Initialize the SETUP buffer */
2560*4882a593Smuzhiyun pch_udc_init_setup_buff(ep->td_stp);
2561*4882a593Smuzhiyun /* Write the pointer address of dma descriptor */
2562*4882a593Smuzhiyun pch_udc_ep_set_subptr(ep, ep->td_stp_phys);
2563*4882a593Smuzhiyun /* Write the pointer address of Setup descriptor */
2564*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, ep->td_data_phys);
2565*4882a593Smuzhiyun
2566*4882a593Smuzhiyun /* Initialize the dma descriptor */
2567*4882a593Smuzhiyun ep->td_data->status = PCH_UDC_DMA_LAST;
2568*4882a593Smuzhiyun ep->td_data->dataptr = dev->dma_addr;
2569*4882a593Smuzhiyun ep->td_data->next = ep->td_data_phys;
2570*4882a593Smuzhiyun
2571*4882a593Smuzhiyun pch_udc_ep_clear_nak(ep);
2572*4882a593Smuzhiyun }
2573*4882a593Smuzhiyun
2574*4882a593Smuzhiyun
2575*4882a593Smuzhiyun /**
2576*4882a593Smuzhiyun * pch_udc_svc_ur_interrupt() - This function handles a USB reset interrupt
2577*4882a593Smuzhiyun * @dev: Reference to driver structure
2578*4882a593Smuzhiyun */
pch_udc_svc_ur_interrupt(struct pch_udc_dev * dev)2579*4882a593Smuzhiyun static void pch_udc_svc_ur_interrupt(struct pch_udc_dev *dev)
2580*4882a593Smuzhiyun {
2581*4882a593Smuzhiyun struct pch_udc_ep *ep;
2582*4882a593Smuzhiyun int i;
2583*4882a593Smuzhiyun
2584*4882a593Smuzhiyun pch_udc_clear_dma(dev, DMA_DIR_TX);
2585*4882a593Smuzhiyun pch_udc_clear_dma(dev, DMA_DIR_RX);
2586*4882a593Smuzhiyun /* Mask all endpoint interrupts */
2587*4882a593Smuzhiyun pch_udc_disable_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
2588*4882a593Smuzhiyun /* clear all endpoint interrupts */
2589*4882a593Smuzhiyun pch_udc_write_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
2590*4882a593Smuzhiyun
2591*4882a593Smuzhiyun for (i = 0; i < PCH_UDC_EP_NUM; i++) {
2592*4882a593Smuzhiyun ep = &dev->ep[i];
2593*4882a593Smuzhiyun pch_udc_clear_ep_status(ep, UDC_EPSTS_ALL_CLR_MASK);
2594*4882a593Smuzhiyun pch_udc_clear_ep_control(ep);
2595*4882a593Smuzhiyun pch_udc_ep_set_ddptr(ep, 0);
2596*4882a593Smuzhiyun pch_udc_write_csr(ep->dev, 0x00, i);
2597*4882a593Smuzhiyun }
2598*4882a593Smuzhiyun dev->stall = 0;
2599*4882a593Smuzhiyun dev->prot_stall = 0;
2600*4882a593Smuzhiyun dev->waiting_zlp_ack = 0;
2601*4882a593Smuzhiyun dev->set_cfg_not_acked = 0;
2602*4882a593Smuzhiyun
2603*4882a593Smuzhiyun /* disable ep to empty req queue. Skip the control EP's */
2604*4882a593Smuzhiyun for (i = 0; i < (PCH_UDC_USED_EP_NUM*2); i++) {
2605*4882a593Smuzhiyun ep = &dev->ep[i];
2606*4882a593Smuzhiyun pch_udc_ep_set_nak(ep);
2607*4882a593Smuzhiyun pch_udc_ep_fifo_flush(ep, ep->in);
2608*4882a593Smuzhiyun /* Complete request queue */
2609*4882a593Smuzhiyun empty_req_queue(ep);
2610*4882a593Smuzhiyun }
2611*4882a593Smuzhiyun if (dev->driver) {
2612*4882a593Smuzhiyun spin_unlock(&dev->lock);
2613*4882a593Smuzhiyun usb_gadget_udc_reset(&dev->gadget, dev->driver);
2614*4882a593Smuzhiyun spin_lock(&dev->lock);
2615*4882a593Smuzhiyun }
2616*4882a593Smuzhiyun }
2617*4882a593Smuzhiyun
2618*4882a593Smuzhiyun /**
2619*4882a593Smuzhiyun * pch_udc_svc_enum_interrupt() - This function handles a USB speed enumeration
2620*4882a593Smuzhiyun * done interrupt
2621*4882a593Smuzhiyun * @dev: Reference to driver structure
2622*4882a593Smuzhiyun */
pch_udc_svc_enum_interrupt(struct pch_udc_dev * dev)2623*4882a593Smuzhiyun static void pch_udc_svc_enum_interrupt(struct pch_udc_dev *dev)
2624*4882a593Smuzhiyun {
2625*4882a593Smuzhiyun u32 dev_stat, dev_speed;
2626*4882a593Smuzhiyun u32 speed = USB_SPEED_FULL;
2627*4882a593Smuzhiyun
2628*4882a593Smuzhiyun dev_stat = pch_udc_read_device_status(dev);
2629*4882a593Smuzhiyun dev_speed = (dev_stat & UDC_DEVSTS_ENUM_SPEED_MASK) >>
2630*4882a593Smuzhiyun UDC_DEVSTS_ENUM_SPEED_SHIFT;
2631*4882a593Smuzhiyun switch (dev_speed) {
2632*4882a593Smuzhiyun case UDC_DEVSTS_ENUM_SPEED_HIGH:
2633*4882a593Smuzhiyun speed = USB_SPEED_HIGH;
2634*4882a593Smuzhiyun break;
2635*4882a593Smuzhiyun case UDC_DEVSTS_ENUM_SPEED_FULL:
2636*4882a593Smuzhiyun speed = USB_SPEED_FULL;
2637*4882a593Smuzhiyun break;
2638*4882a593Smuzhiyun case UDC_DEVSTS_ENUM_SPEED_LOW:
2639*4882a593Smuzhiyun speed = USB_SPEED_LOW;
2640*4882a593Smuzhiyun break;
2641*4882a593Smuzhiyun default:
2642*4882a593Smuzhiyun BUG();
2643*4882a593Smuzhiyun }
2644*4882a593Smuzhiyun dev->gadget.speed = speed;
2645*4882a593Smuzhiyun pch_udc_activate_control_ep(dev);
2646*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(dev, UDC_EPINT_IN_EP0 | UDC_EPINT_OUT_EP0);
2647*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_TX);
2648*4882a593Smuzhiyun pch_udc_set_dma(dev, DMA_DIR_RX);
2649*4882a593Smuzhiyun pch_udc_ep_set_rrdy(&(dev->ep[UDC_EP0OUT_IDX]));
2650*4882a593Smuzhiyun
2651*4882a593Smuzhiyun /* enable device interrupts */
2652*4882a593Smuzhiyun pch_udc_enable_interrupts(dev, UDC_DEVINT_UR | UDC_DEVINT_US |
2653*4882a593Smuzhiyun UDC_DEVINT_ES | UDC_DEVINT_ENUM |
2654*4882a593Smuzhiyun UDC_DEVINT_SI | UDC_DEVINT_SC);
2655*4882a593Smuzhiyun }
2656*4882a593Smuzhiyun
2657*4882a593Smuzhiyun /**
2658*4882a593Smuzhiyun * pch_udc_svc_intf_interrupt() - This function handles a set interface
2659*4882a593Smuzhiyun * interrupt
2660*4882a593Smuzhiyun * @dev: Reference to driver structure
2661*4882a593Smuzhiyun */
pch_udc_svc_intf_interrupt(struct pch_udc_dev * dev)2662*4882a593Smuzhiyun static void pch_udc_svc_intf_interrupt(struct pch_udc_dev *dev)
2663*4882a593Smuzhiyun {
2664*4882a593Smuzhiyun u32 reg, dev_stat = 0;
2665*4882a593Smuzhiyun int i;
2666*4882a593Smuzhiyun
2667*4882a593Smuzhiyun dev_stat = pch_udc_read_device_status(dev);
2668*4882a593Smuzhiyun dev->cfg_data.cur_intf = (dev_stat & UDC_DEVSTS_INTF_MASK) >>
2669*4882a593Smuzhiyun UDC_DEVSTS_INTF_SHIFT;
2670*4882a593Smuzhiyun dev->cfg_data.cur_alt = (dev_stat & UDC_DEVSTS_ALT_MASK) >>
2671*4882a593Smuzhiyun UDC_DEVSTS_ALT_SHIFT;
2672*4882a593Smuzhiyun dev->set_cfg_not_acked = 1;
2673*4882a593Smuzhiyun /* Construct the usb request for gadget driver and inform it */
2674*4882a593Smuzhiyun memset(&dev->setup_data, 0 , sizeof dev->setup_data);
2675*4882a593Smuzhiyun dev->setup_data.bRequest = USB_REQ_SET_INTERFACE;
2676*4882a593Smuzhiyun dev->setup_data.bRequestType = USB_RECIP_INTERFACE;
2677*4882a593Smuzhiyun dev->setup_data.wValue = cpu_to_le16(dev->cfg_data.cur_alt);
2678*4882a593Smuzhiyun dev->setup_data.wIndex = cpu_to_le16(dev->cfg_data.cur_intf);
2679*4882a593Smuzhiyun /* programm the Endpoint Cfg registers */
2680*4882a593Smuzhiyun /* Only one end point cfg register */
2681*4882a593Smuzhiyun reg = pch_udc_read_csr(dev, UDC_EP0OUT_IDX);
2682*4882a593Smuzhiyun reg = (reg & ~UDC_CSR_NE_INTF_MASK) |
2683*4882a593Smuzhiyun (dev->cfg_data.cur_intf << UDC_CSR_NE_INTF_SHIFT);
2684*4882a593Smuzhiyun reg = (reg & ~UDC_CSR_NE_ALT_MASK) |
2685*4882a593Smuzhiyun (dev->cfg_data.cur_alt << UDC_CSR_NE_ALT_SHIFT);
2686*4882a593Smuzhiyun pch_udc_write_csr(dev, reg, UDC_EP0OUT_IDX);
2687*4882a593Smuzhiyun for (i = 0; i < PCH_UDC_USED_EP_NUM * 2; i++) {
2688*4882a593Smuzhiyun /* clear stall bits */
2689*4882a593Smuzhiyun pch_udc_ep_clear_stall(&(dev->ep[i]));
2690*4882a593Smuzhiyun dev->ep[i].halted = 0;
2691*4882a593Smuzhiyun }
2692*4882a593Smuzhiyun dev->stall = 0;
2693*4882a593Smuzhiyun pch_udc_gadget_setup(dev);
2694*4882a593Smuzhiyun }
2695*4882a593Smuzhiyun
2696*4882a593Smuzhiyun /**
2697*4882a593Smuzhiyun * pch_udc_svc_cfg_interrupt() - This function handles a set configuration
2698*4882a593Smuzhiyun * interrupt
2699*4882a593Smuzhiyun * @dev: Reference to driver structure
2700*4882a593Smuzhiyun */
pch_udc_svc_cfg_interrupt(struct pch_udc_dev * dev)2701*4882a593Smuzhiyun static void pch_udc_svc_cfg_interrupt(struct pch_udc_dev *dev)
2702*4882a593Smuzhiyun {
2703*4882a593Smuzhiyun int i;
2704*4882a593Smuzhiyun u32 reg, dev_stat = 0;
2705*4882a593Smuzhiyun
2706*4882a593Smuzhiyun dev_stat = pch_udc_read_device_status(dev);
2707*4882a593Smuzhiyun dev->set_cfg_not_acked = 1;
2708*4882a593Smuzhiyun dev->cfg_data.cur_cfg = (dev_stat & UDC_DEVSTS_CFG_MASK) >>
2709*4882a593Smuzhiyun UDC_DEVSTS_CFG_SHIFT;
2710*4882a593Smuzhiyun /* make usb request for gadget driver */
2711*4882a593Smuzhiyun memset(&dev->setup_data, 0 , sizeof dev->setup_data);
2712*4882a593Smuzhiyun dev->setup_data.bRequest = USB_REQ_SET_CONFIGURATION;
2713*4882a593Smuzhiyun dev->setup_data.wValue = cpu_to_le16(dev->cfg_data.cur_cfg);
2714*4882a593Smuzhiyun /* program the NE registers */
2715*4882a593Smuzhiyun /* Only one end point cfg register */
2716*4882a593Smuzhiyun reg = pch_udc_read_csr(dev, UDC_EP0OUT_IDX);
2717*4882a593Smuzhiyun reg = (reg & ~UDC_CSR_NE_CFG_MASK) |
2718*4882a593Smuzhiyun (dev->cfg_data.cur_cfg << UDC_CSR_NE_CFG_SHIFT);
2719*4882a593Smuzhiyun pch_udc_write_csr(dev, reg, UDC_EP0OUT_IDX);
2720*4882a593Smuzhiyun for (i = 0; i < PCH_UDC_USED_EP_NUM * 2; i++) {
2721*4882a593Smuzhiyun /* clear stall bits */
2722*4882a593Smuzhiyun pch_udc_ep_clear_stall(&(dev->ep[i]));
2723*4882a593Smuzhiyun dev->ep[i].halted = 0;
2724*4882a593Smuzhiyun }
2725*4882a593Smuzhiyun dev->stall = 0;
2726*4882a593Smuzhiyun
2727*4882a593Smuzhiyun /* call gadget zero with setup data received */
2728*4882a593Smuzhiyun pch_udc_gadget_setup(dev);
2729*4882a593Smuzhiyun }
2730*4882a593Smuzhiyun
2731*4882a593Smuzhiyun /**
2732*4882a593Smuzhiyun * pch_udc_dev_isr() - This function services device interrupts
2733*4882a593Smuzhiyun * by invoking appropriate routines.
2734*4882a593Smuzhiyun * @dev: Reference to the device structure
2735*4882a593Smuzhiyun * @dev_intr: The Device interrupt status.
2736*4882a593Smuzhiyun */
pch_udc_dev_isr(struct pch_udc_dev * dev,u32 dev_intr)2737*4882a593Smuzhiyun static void pch_udc_dev_isr(struct pch_udc_dev *dev, u32 dev_intr)
2738*4882a593Smuzhiyun {
2739*4882a593Smuzhiyun int vbus;
2740*4882a593Smuzhiyun
2741*4882a593Smuzhiyun /* USB Reset Interrupt */
2742*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_UR) {
2743*4882a593Smuzhiyun pch_udc_svc_ur_interrupt(dev);
2744*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "USB_RESET\n");
2745*4882a593Smuzhiyun }
2746*4882a593Smuzhiyun /* Enumeration Done Interrupt */
2747*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_ENUM) {
2748*4882a593Smuzhiyun pch_udc_svc_enum_interrupt(dev);
2749*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "USB_ENUM\n");
2750*4882a593Smuzhiyun }
2751*4882a593Smuzhiyun /* Set Interface Interrupt */
2752*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_SI)
2753*4882a593Smuzhiyun pch_udc_svc_intf_interrupt(dev);
2754*4882a593Smuzhiyun /* Set Config Interrupt */
2755*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_SC)
2756*4882a593Smuzhiyun pch_udc_svc_cfg_interrupt(dev);
2757*4882a593Smuzhiyun /* USB Suspend interrupt */
2758*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_US) {
2759*4882a593Smuzhiyun if (dev->driver
2760*4882a593Smuzhiyun && dev->driver->suspend) {
2761*4882a593Smuzhiyun spin_unlock(&dev->lock);
2762*4882a593Smuzhiyun dev->driver->suspend(&dev->gadget);
2763*4882a593Smuzhiyun spin_lock(&dev->lock);
2764*4882a593Smuzhiyun }
2765*4882a593Smuzhiyun
2766*4882a593Smuzhiyun vbus = pch_vbus_gpio_get_value(dev);
2767*4882a593Smuzhiyun if ((dev->vbus_session == 0)
2768*4882a593Smuzhiyun && (vbus != 1)) {
2769*4882a593Smuzhiyun if (dev->driver && dev->driver->disconnect) {
2770*4882a593Smuzhiyun spin_unlock(&dev->lock);
2771*4882a593Smuzhiyun dev->driver->disconnect(&dev->gadget);
2772*4882a593Smuzhiyun spin_lock(&dev->lock);
2773*4882a593Smuzhiyun }
2774*4882a593Smuzhiyun pch_udc_reconnect(dev);
2775*4882a593Smuzhiyun } else if ((dev->vbus_session == 0)
2776*4882a593Smuzhiyun && (vbus == 1)
2777*4882a593Smuzhiyun && !dev->vbus_gpio.intr)
2778*4882a593Smuzhiyun schedule_work(&dev->vbus_gpio.irq_work_fall);
2779*4882a593Smuzhiyun
2780*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "USB_SUSPEND\n");
2781*4882a593Smuzhiyun }
2782*4882a593Smuzhiyun /* Clear the SOF interrupt, if enabled */
2783*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_SOF)
2784*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "SOF\n");
2785*4882a593Smuzhiyun /* ES interrupt, IDLE > 3ms on the USB */
2786*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_ES)
2787*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "ES\n");
2788*4882a593Smuzhiyun /* RWKP interrupt */
2789*4882a593Smuzhiyun if (dev_intr & UDC_DEVINT_RWKP)
2790*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "RWKP\n");
2791*4882a593Smuzhiyun }
2792*4882a593Smuzhiyun
2793*4882a593Smuzhiyun /**
2794*4882a593Smuzhiyun * pch_udc_isr() - This function handles interrupts from the PCH USB Device
2795*4882a593Smuzhiyun * @irq: Interrupt request number
2796*4882a593Smuzhiyun * @pdev: Reference to the device structure
2797*4882a593Smuzhiyun */
pch_udc_isr(int irq,void * pdev)2798*4882a593Smuzhiyun static irqreturn_t pch_udc_isr(int irq, void *pdev)
2799*4882a593Smuzhiyun {
2800*4882a593Smuzhiyun struct pch_udc_dev *dev = (struct pch_udc_dev *) pdev;
2801*4882a593Smuzhiyun u32 dev_intr, ep_intr;
2802*4882a593Smuzhiyun int i;
2803*4882a593Smuzhiyun
2804*4882a593Smuzhiyun dev_intr = pch_udc_read_device_interrupts(dev);
2805*4882a593Smuzhiyun ep_intr = pch_udc_read_ep_interrupts(dev);
2806*4882a593Smuzhiyun
2807*4882a593Smuzhiyun /* For a hot plug, this find that the controller is hung up. */
2808*4882a593Smuzhiyun if (dev_intr == ep_intr)
2809*4882a593Smuzhiyun if (dev_intr == pch_udc_readl(dev, UDC_DEVCFG_ADDR)) {
2810*4882a593Smuzhiyun dev_dbg(&dev->pdev->dev, "UDC: Hung up\n");
2811*4882a593Smuzhiyun /* The controller is reset */
2812*4882a593Smuzhiyun pch_udc_writel(dev, UDC_SRST, UDC_SRST_ADDR);
2813*4882a593Smuzhiyun return IRQ_HANDLED;
2814*4882a593Smuzhiyun }
2815*4882a593Smuzhiyun if (dev_intr)
2816*4882a593Smuzhiyun /* Clear device interrupts */
2817*4882a593Smuzhiyun pch_udc_write_device_interrupts(dev, dev_intr);
2818*4882a593Smuzhiyun if (ep_intr)
2819*4882a593Smuzhiyun /* Clear ep interrupts */
2820*4882a593Smuzhiyun pch_udc_write_ep_interrupts(dev, ep_intr);
2821*4882a593Smuzhiyun if (!dev_intr && !ep_intr)
2822*4882a593Smuzhiyun return IRQ_NONE;
2823*4882a593Smuzhiyun spin_lock(&dev->lock);
2824*4882a593Smuzhiyun if (dev_intr)
2825*4882a593Smuzhiyun pch_udc_dev_isr(dev, dev_intr);
2826*4882a593Smuzhiyun if (ep_intr) {
2827*4882a593Smuzhiyun pch_udc_read_all_epstatus(dev, ep_intr);
2828*4882a593Smuzhiyun /* Process Control In interrupts, if present */
2829*4882a593Smuzhiyun if (ep_intr & UDC_EPINT_IN_EP0) {
2830*4882a593Smuzhiyun pch_udc_svc_control_in(dev);
2831*4882a593Smuzhiyun pch_udc_postsvc_epinters(dev, 0);
2832*4882a593Smuzhiyun }
2833*4882a593Smuzhiyun /* Process Control Out interrupts, if present */
2834*4882a593Smuzhiyun if (ep_intr & UDC_EPINT_OUT_EP0)
2835*4882a593Smuzhiyun pch_udc_svc_control_out(dev);
2836*4882a593Smuzhiyun /* Process data in end point interrupts */
2837*4882a593Smuzhiyun for (i = 1; i < PCH_UDC_USED_EP_NUM; i++) {
2838*4882a593Smuzhiyun if (ep_intr & (1 << i)) {
2839*4882a593Smuzhiyun pch_udc_svc_data_in(dev, i);
2840*4882a593Smuzhiyun pch_udc_postsvc_epinters(dev, i);
2841*4882a593Smuzhiyun }
2842*4882a593Smuzhiyun }
2843*4882a593Smuzhiyun /* Process data out end point interrupts */
2844*4882a593Smuzhiyun for (i = UDC_EPINT_OUT_SHIFT + 1; i < (UDC_EPINT_OUT_SHIFT +
2845*4882a593Smuzhiyun PCH_UDC_USED_EP_NUM); i++)
2846*4882a593Smuzhiyun if (ep_intr & (1 << i))
2847*4882a593Smuzhiyun pch_udc_svc_data_out(dev, i -
2848*4882a593Smuzhiyun UDC_EPINT_OUT_SHIFT);
2849*4882a593Smuzhiyun }
2850*4882a593Smuzhiyun spin_unlock(&dev->lock);
2851*4882a593Smuzhiyun return IRQ_HANDLED;
2852*4882a593Smuzhiyun }
2853*4882a593Smuzhiyun
2854*4882a593Smuzhiyun /**
2855*4882a593Smuzhiyun * pch_udc_setup_ep0() - This function enables control endpoint for traffic
2856*4882a593Smuzhiyun * @dev: Reference to the device structure
2857*4882a593Smuzhiyun */
pch_udc_setup_ep0(struct pch_udc_dev * dev)2858*4882a593Smuzhiyun static void pch_udc_setup_ep0(struct pch_udc_dev *dev)
2859*4882a593Smuzhiyun {
2860*4882a593Smuzhiyun /* enable ep0 interrupts */
2861*4882a593Smuzhiyun pch_udc_enable_ep_interrupts(dev, UDC_EPINT_IN_EP0 |
2862*4882a593Smuzhiyun UDC_EPINT_OUT_EP0);
2863*4882a593Smuzhiyun /* enable device interrupts */
2864*4882a593Smuzhiyun pch_udc_enable_interrupts(dev, UDC_DEVINT_UR | UDC_DEVINT_US |
2865*4882a593Smuzhiyun UDC_DEVINT_ES | UDC_DEVINT_ENUM |
2866*4882a593Smuzhiyun UDC_DEVINT_SI | UDC_DEVINT_SC);
2867*4882a593Smuzhiyun }
2868*4882a593Smuzhiyun
2869*4882a593Smuzhiyun /**
2870*4882a593Smuzhiyun * pch_udc_pcd_reinit() - This API initializes the endpoint structures
2871*4882a593Smuzhiyun * @dev: Reference to the driver structure
2872*4882a593Smuzhiyun */
pch_udc_pcd_reinit(struct pch_udc_dev * dev)2873*4882a593Smuzhiyun static void pch_udc_pcd_reinit(struct pch_udc_dev *dev)
2874*4882a593Smuzhiyun {
2875*4882a593Smuzhiyun const char *const ep_string[] = {
2876*4882a593Smuzhiyun ep0_string, "ep0out", "ep1in", "ep1out", "ep2in", "ep2out",
2877*4882a593Smuzhiyun "ep3in", "ep3out", "ep4in", "ep4out", "ep5in", "ep5out",
2878*4882a593Smuzhiyun "ep6in", "ep6out", "ep7in", "ep7out", "ep8in", "ep8out",
2879*4882a593Smuzhiyun "ep9in", "ep9out", "ep10in", "ep10out", "ep11in", "ep11out",
2880*4882a593Smuzhiyun "ep12in", "ep12out", "ep13in", "ep13out", "ep14in", "ep14out",
2881*4882a593Smuzhiyun "ep15in", "ep15out",
2882*4882a593Smuzhiyun };
2883*4882a593Smuzhiyun int i;
2884*4882a593Smuzhiyun
2885*4882a593Smuzhiyun dev->gadget.speed = USB_SPEED_UNKNOWN;
2886*4882a593Smuzhiyun INIT_LIST_HEAD(&dev->gadget.ep_list);
2887*4882a593Smuzhiyun
2888*4882a593Smuzhiyun /* Initialize the endpoints structures */
2889*4882a593Smuzhiyun memset(dev->ep, 0, sizeof dev->ep);
2890*4882a593Smuzhiyun for (i = 0; i < PCH_UDC_EP_NUM; i++) {
2891*4882a593Smuzhiyun struct pch_udc_ep *ep = &dev->ep[i];
2892*4882a593Smuzhiyun ep->dev = dev;
2893*4882a593Smuzhiyun ep->halted = 1;
2894*4882a593Smuzhiyun ep->num = i / 2;
2895*4882a593Smuzhiyun ep->in = ~i & 1;
2896*4882a593Smuzhiyun ep->ep.name = ep_string[i];
2897*4882a593Smuzhiyun ep->ep.ops = &pch_udc_ep_ops;
2898*4882a593Smuzhiyun if (ep->in) {
2899*4882a593Smuzhiyun ep->offset_addr = ep->num * UDC_EP_REG_SHIFT;
2900*4882a593Smuzhiyun ep->ep.caps.dir_in = true;
2901*4882a593Smuzhiyun } else {
2902*4882a593Smuzhiyun ep->offset_addr = (UDC_EPINT_OUT_SHIFT + ep->num) *
2903*4882a593Smuzhiyun UDC_EP_REG_SHIFT;
2904*4882a593Smuzhiyun ep->ep.caps.dir_out = true;
2905*4882a593Smuzhiyun }
2906*4882a593Smuzhiyun if (i == UDC_EP0IN_IDX || i == UDC_EP0OUT_IDX) {
2907*4882a593Smuzhiyun ep->ep.caps.type_control = true;
2908*4882a593Smuzhiyun } else {
2909*4882a593Smuzhiyun ep->ep.caps.type_iso = true;
2910*4882a593Smuzhiyun ep->ep.caps.type_bulk = true;
2911*4882a593Smuzhiyun ep->ep.caps.type_int = true;
2912*4882a593Smuzhiyun }
2913*4882a593Smuzhiyun /* need to set ep->ep.maxpacket and set Default Configuration?*/
2914*4882a593Smuzhiyun usb_ep_set_maxpacket_limit(&ep->ep, UDC_BULK_MAX_PKT_SIZE);
2915*4882a593Smuzhiyun list_add_tail(&ep->ep.ep_list, &dev->gadget.ep_list);
2916*4882a593Smuzhiyun INIT_LIST_HEAD(&ep->queue);
2917*4882a593Smuzhiyun }
2918*4882a593Smuzhiyun usb_ep_set_maxpacket_limit(&dev->ep[UDC_EP0IN_IDX].ep, UDC_EP0IN_MAX_PKT_SIZE);
2919*4882a593Smuzhiyun usb_ep_set_maxpacket_limit(&dev->ep[UDC_EP0OUT_IDX].ep, UDC_EP0OUT_MAX_PKT_SIZE);
2920*4882a593Smuzhiyun
2921*4882a593Smuzhiyun /* remove ep0 in and out from the list. They have own pointer */
2922*4882a593Smuzhiyun list_del_init(&dev->ep[UDC_EP0IN_IDX].ep.ep_list);
2923*4882a593Smuzhiyun list_del_init(&dev->ep[UDC_EP0OUT_IDX].ep.ep_list);
2924*4882a593Smuzhiyun
2925*4882a593Smuzhiyun dev->gadget.ep0 = &dev->ep[UDC_EP0IN_IDX].ep;
2926*4882a593Smuzhiyun INIT_LIST_HEAD(&dev->gadget.ep0->ep_list);
2927*4882a593Smuzhiyun }
2928*4882a593Smuzhiyun
2929*4882a593Smuzhiyun /**
2930*4882a593Smuzhiyun * pch_udc_pcd_init() - This API initializes the driver structure
2931*4882a593Smuzhiyun * @dev: Reference to the driver structure
2932*4882a593Smuzhiyun *
2933*4882a593Smuzhiyun * Return codes:
2934*4882a593Smuzhiyun * 0: Success
2935*4882a593Smuzhiyun * -%ERRNO: All kind of errors when retrieving VBUS GPIO
2936*4882a593Smuzhiyun */
pch_udc_pcd_init(struct pch_udc_dev * dev)2937*4882a593Smuzhiyun static int pch_udc_pcd_init(struct pch_udc_dev *dev)
2938*4882a593Smuzhiyun {
2939*4882a593Smuzhiyun int ret;
2940*4882a593Smuzhiyun
2941*4882a593Smuzhiyun pch_udc_init(dev);
2942*4882a593Smuzhiyun pch_udc_pcd_reinit(dev);
2943*4882a593Smuzhiyun
2944*4882a593Smuzhiyun ret = pch_vbus_gpio_init(dev);
2945*4882a593Smuzhiyun if (ret)
2946*4882a593Smuzhiyun pch_udc_exit(dev);
2947*4882a593Smuzhiyun return ret;
2948*4882a593Smuzhiyun }
2949*4882a593Smuzhiyun
2950*4882a593Smuzhiyun /**
2951*4882a593Smuzhiyun * init_dma_pools() - create dma pools during initialization
2952*4882a593Smuzhiyun * @dev: reference to struct pci_dev
2953*4882a593Smuzhiyun */
init_dma_pools(struct pch_udc_dev * dev)2954*4882a593Smuzhiyun static int init_dma_pools(struct pch_udc_dev *dev)
2955*4882a593Smuzhiyun {
2956*4882a593Smuzhiyun struct pch_udc_stp_dma_desc *td_stp;
2957*4882a593Smuzhiyun struct pch_udc_data_dma_desc *td_data;
2958*4882a593Smuzhiyun void *ep0out_buf;
2959*4882a593Smuzhiyun
2960*4882a593Smuzhiyun /* DMA setup */
2961*4882a593Smuzhiyun dev->data_requests = dma_pool_create("data_requests", &dev->pdev->dev,
2962*4882a593Smuzhiyun sizeof(struct pch_udc_data_dma_desc), 0, 0);
2963*4882a593Smuzhiyun if (!dev->data_requests) {
2964*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "%s: can't get request data pool\n",
2965*4882a593Smuzhiyun __func__);
2966*4882a593Smuzhiyun return -ENOMEM;
2967*4882a593Smuzhiyun }
2968*4882a593Smuzhiyun
2969*4882a593Smuzhiyun /* dma desc for setup data */
2970*4882a593Smuzhiyun dev->stp_requests = dma_pool_create("setup requests", &dev->pdev->dev,
2971*4882a593Smuzhiyun sizeof(struct pch_udc_stp_dma_desc), 0, 0);
2972*4882a593Smuzhiyun if (!dev->stp_requests) {
2973*4882a593Smuzhiyun dev_err(&dev->pdev->dev, "%s: can't get setup request pool\n",
2974*4882a593Smuzhiyun __func__);
2975*4882a593Smuzhiyun return -ENOMEM;
2976*4882a593Smuzhiyun }
2977*4882a593Smuzhiyun /* setup */
2978*4882a593Smuzhiyun td_stp = dma_pool_alloc(dev->stp_requests, GFP_KERNEL,
2979*4882a593Smuzhiyun &dev->ep[UDC_EP0OUT_IDX].td_stp_phys);
2980*4882a593Smuzhiyun if (!td_stp) {
2981*4882a593Smuzhiyun dev_err(&dev->pdev->dev,
2982*4882a593Smuzhiyun "%s: can't allocate setup dma descriptor\n", __func__);
2983*4882a593Smuzhiyun return -ENOMEM;
2984*4882a593Smuzhiyun }
2985*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].td_stp = td_stp;
2986*4882a593Smuzhiyun
2987*4882a593Smuzhiyun /* data: 0 packets !? */
2988*4882a593Smuzhiyun td_data = dma_pool_alloc(dev->data_requests, GFP_KERNEL,
2989*4882a593Smuzhiyun &dev->ep[UDC_EP0OUT_IDX].td_data_phys);
2990*4882a593Smuzhiyun if (!td_data) {
2991*4882a593Smuzhiyun dev_err(&dev->pdev->dev,
2992*4882a593Smuzhiyun "%s: can't allocate data dma descriptor\n", __func__);
2993*4882a593Smuzhiyun return -ENOMEM;
2994*4882a593Smuzhiyun }
2995*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].td_data = td_data;
2996*4882a593Smuzhiyun dev->ep[UDC_EP0IN_IDX].td_stp = NULL;
2997*4882a593Smuzhiyun dev->ep[UDC_EP0IN_IDX].td_stp_phys = 0;
2998*4882a593Smuzhiyun dev->ep[UDC_EP0IN_IDX].td_data = NULL;
2999*4882a593Smuzhiyun dev->ep[UDC_EP0IN_IDX].td_data_phys = 0;
3000*4882a593Smuzhiyun
3001*4882a593Smuzhiyun ep0out_buf = devm_kzalloc(&dev->pdev->dev, UDC_EP0OUT_BUFF_SIZE * 4,
3002*4882a593Smuzhiyun GFP_KERNEL);
3003*4882a593Smuzhiyun if (!ep0out_buf)
3004*4882a593Smuzhiyun return -ENOMEM;
3005*4882a593Smuzhiyun dev->dma_addr = dma_map_single(&dev->pdev->dev, ep0out_buf,
3006*4882a593Smuzhiyun UDC_EP0OUT_BUFF_SIZE * 4,
3007*4882a593Smuzhiyun DMA_FROM_DEVICE);
3008*4882a593Smuzhiyun return dma_mapping_error(&dev->pdev->dev, dev->dma_addr);
3009*4882a593Smuzhiyun }
3010*4882a593Smuzhiyun
pch_udc_start(struct usb_gadget * g,struct usb_gadget_driver * driver)3011*4882a593Smuzhiyun static int pch_udc_start(struct usb_gadget *g,
3012*4882a593Smuzhiyun struct usb_gadget_driver *driver)
3013*4882a593Smuzhiyun {
3014*4882a593Smuzhiyun struct pch_udc_dev *dev = to_pch_udc(g);
3015*4882a593Smuzhiyun
3016*4882a593Smuzhiyun driver->driver.bus = NULL;
3017*4882a593Smuzhiyun dev->driver = driver;
3018*4882a593Smuzhiyun
3019*4882a593Smuzhiyun /* get ready for ep0 traffic */
3020*4882a593Smuzhiyun pch_udc_setup_ep0(dev);
3021*4882a593Smuzhiyun
3022*4882a593Smuzhiyun /* clear SD */
3023*4882a593Smuzhiyun if ((pch_vbus_gpio_get_value(dev) != 0) || !dev->vbus_gpio.intr)
3024*4882a593Smuzhiyun pch_udc_clear_disconnect(dev);
3025*4882a593Smuzhiyun
3026*4882a593Smuzhiyun dev->connected = 1;
3027*4882a593Smuzhiyun return 0;
3028*4882a593Smuzhiyun }
3029*4882a593Smuzhiyun
pch_udc_stop(struct usb_gadget * g)3030*4882a593Smuzhiyun static int pch_udc_stop(struct usb_gadget *g)
3031*4882a593Smuzhiyun {
3032*4882a593Smuzhiyun struct pch_udc_dev *dev = to_pch_udc(g);
3033*4882a593Smuzhiyun
3034*4882a593Smuzhiyun pch_udc_disable_interrupts(dev, UDC_DEVINT_MSK);
3035*4882a593Smuzhiyun
3036*4882a593Smuzhiyun /* Assures that there are no pending requests with this driver */
3037*4882a593Smuzhiyun dev->driver = NULL;
3038*4882a593Smuzhiyun dev->connected = 0;
3039*4882a593Smuzhiyun
3040*4882a593Smuzhiyun /* set SD */
3041*4882a593Smuzhiyun pch_udc_set_disconnect(dev);
3042*4882a593Smuzhiyun
3043*4882a593Smuzhiyun return 0;
3044*4882a593Smuzhiyun }
3045*4882a593Smuzhiyun
pch_udc_shutdown(struct pci_dev * pdev)3046*4882a593Smuzhiyun static void pch_udc_shutdown(struct pci_dev *pdev)
3047*4882a593Smuzhiyun {
3048*4882a593Smuzhiyun struct pch_udc_dev *dev = pci_get_drvdata(pdev);
3049*4882a593Smuzhiyun
3050*4882a593Smuzhiyun pch_udc_disable_interrupts(dev, UDC_DEVINT_MSK);
3051*4882a593Smuzhiyun pch_udc_disable_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
3052*4882a593Smuzhiyun
3053*4882a593Smuzhiyun /* disable the pullup so the host will think we're gone */
3054*4882a593Smuzhiyun pch_udc_set_disconnect(dev);
3055*4882a593Smuzhiyun }
3056*4882a593Smuzhiyun
pch_udc_remove(struct pci_dev * pdev)3057*4882a593Smuzhiyun static void pch_udc_remove(struct pci_dev *pdev)
3058*4882a593Smuzhiyun {
3059*4882a593Smuzhiyun struct pch_udc_dev *dev = pci_get_drvdata(pdev);
3060*4882a593Smuzhiyun
3061*4882a593Smuzhiyun usb_del_gadget_udc(&dev->gadget);
3062*4882a593Smuzhiyun
3063*4882a593Smuzhiyun /* gadget driver must not be registered */
3064*4882a593Smuzhiyun if (dev->driver)
3065*4882a593Smuzhiyun dev_err(&pdev->dev,
3066*4882a593Smuzhiyun "%s: gadget driver still bound!!!\n", __func__);
3067*4882a593Smuzhiyun /* dma pool cleanup */
3068*4882a593Smuzhiyun dma_pool_destroy(dev->data_requests);
3069*4882a593Smuzhiyun
3070*4882a593Smuzhiyun if (dev->stp_requests) {
3071*4882a593Smuzhiyun /* cleanup DMA desc's for ep0in */
3072*4882a593Smuzhiyun if (dev->ep[UDC_EP0OUT_IDX].td_stp) {
3073*4882a593Smuzhiyun dma_pool_free(dev->stp_requests,
3074*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].td_stp,
3075*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].td_stp_phys);
3076*4882a593Smuzhiyun }
3077*4882a593Smuzhiyun if (dev->ep[UDC_EP0OUT_IDX].td_data) {
3078*4882a593Smuzhiyun dma_pool_free(dev->stp_requests,
3079*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].td_data,
3080*4882a593Smuzhiyun dev->ep[UDC_EP0OUT_IDX].td_data_phys);
3081*4882a593Smuzhiyun }
3082*4882a593Smuzhiyun dma_pool_destroy(dev->stp_requests);
3083*4882a593Smuzhiyun }
3084*4882a593Smuzhiyun
3085*4882a593Smuzhiyun if (dev->dma_addr)
3086*4882a593Smuzhiyun dma_unmap_single(&dev->pdev->dev, dev->dma_addr,
3087*4882a593Smuzhiyun UDC_EP0OUT_BUFF_SIZE * 4, DMA_FROM_DEVICE);
3088*4882a593Smuzhiyun
3089*4882a593Smuzhiyun pch_vbus_gpio_free(dev);
3090*4882a593Smuzhiyun
3091*4882a593Smuzhiyun pch_udc_exit(dev);
3092*4882a593Smuzhiyun }
3093*4882a593Smuzhiyun
3094*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
pch_udc_suspend(struct device * d)3095*4882a593Smuzhiyun static int pch_udc_suspend(struct device *d)
3096*4882a593Smuzhiyun {
3097*4882a593Smuzhiyun struct pch_udc_dev *dev = dev_get_drvdata(d);
3098*4882a593Smuzhiyun
3099*4882a593Smuzhiyun pch_udc_disable_interrupts(dev, UDC_DEVINT_MSK);
3100*4882a593Smuzhiyun pch_udc_disable_ep_interrupts(dev, UDC_EPINT_MSK_DISABLE_ALL);
3101*4882a593Smuzhiyun
3102*4882a593Smuzhiyun return 0;
3103*4882a593Smuzhiyun }
3104*4882a593Smuzhiyun
pch_udc_resume(struct device * d)3105*4882a593Smuzhiyun static int pch_udc_resume(struct device *d)
3106*4882a593Smuzhiyun {
3107*4882a593Smuzhiyun return 0;
3108*4882a593Smuzhiyun }
3109*4882a593Smuzhiyun
3110*4882a593Smuzhiyun static SIMPLE_DEV_PM_OPS(pch_udc_pm, pch_udc_suspend, pch_udc_resume);
3111*4882a593Smuzhiyun #define PCH_UDC_PM_OPS (&pch_udc_pm)
3112*4882a593Smuzhiyun #else
3113*4882a593Smuzhiyun #define PCH_UDC_PM_OPS NULL
3114*4882a593Smuzhiyun #endif /* CONFIG_PM_SLEEP */
3115*4882a593Smuzhiyun
pch_udc_probe(struct pci_dev * pdev,const struct pci_device_id * id)3116*4882a593Smuzhiyun static int pch_udc_probe(struct pci_dev *pdev,
3117*4882a593Smuzhiyun const struct pci_device_id *id)
3118*4882a593Smuzhiyun {
3119*4882a593Smuzhiyun int bar;
3120*4882a593Smuzhiyun int retval;
3121*4882a593Smuzhiyun struct pch_udc_dev *dev;
3122*4882a593Smuzhiyun
3123*4882a593Smuzhiyun /* init */
3124*4882a593Smuzhiyun dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
3125*4882a593Smuzhiyun if (!dev)
3126*4882a593Smuzhiyun return -ENOMEM;
3127*4882a593Smuzhiyun
3128*4882a593Smuzhiyun /* pci setup */
3129*4882a593Smuzhiyun retval = pcim_enable_device(pdev);
3130*4882a593Smuzhiyun if (retval)
3131*4882a593Smuzhiyun return retval;
3132*4882a593Smuzhiyun
3133*4882a593Smuzhiyun dev->pdev = pdev;
3134*4882a593Smuzhiyun pci_set_drvdata(pdev, dev);
3135*4882a593Smuzhiyun
3136*4882a593Smuzhiyun /* Determine BAR based on PCI ID */
3137*4882a593Smuzhiyun if (id->device == PCI_DEVICE_ID_INTEL_QUARK_X1000_UDC)
3138*4882a593Smuzhiyun bar = PCH_UDC_PCI_BAR_QUARK_X1000;
3139*4882a593Smuzhiyun else
3140*4882a593Smuzhiyun bar = PCH_UDC_PCI_BAR;
3141*4882a593Smuzhiyun
3142*4882a593Smuzhiyun /* PCI resource allocation */
3143*4882a593Smuzhiyun retval = pcim_iomap_regions(pdev, 1 << bar, pci_name(pdev));
3144*4882a593Smuzhiyun if (retval)
3145*4882a593Smuzhiyun return retval;
3146*4882a593Smuzhiyun
3147*4882a593Smuzhiyun dev->base_addr = pcim_iomap_table(pdev)[bar];
3148*4882a593Smuzhiyun
3149*4882a593Smuzhiyun /* initialize the hardware */
3150*4882a593Smuzhiyun retval = pch_udc_pcd_init(dev);
3151*4882a593Smuzhiyun if (retval)
3152*4882a593Smuzhiyun return retval;
3153*4882a593Smuzhiyun
3154*4882a593Smuzhiyun pci_enable_msi(pdev);
3155*4882a593Smuzhiyun
3156*4882a593Smuzhiyun retval = devm_request_irq(&pdev->dev, pdev->irq, pch_udc_isr,
3157*4882a593Smuzhiyun IRQF_SHARED, KBUILD_MODNAME, dev);
3158*4882a593Smuzhiyun if (retval) {
3159*4882a593Smuzhiyun dev_err(&pdev->dev, "%s: request_irq(%d) fail\n", __func__,
3160*4882a593Smuzhiyun pdev->irq);
3161*4882a593Smuzhiyun goto finished;
3162*4882a593Smuzhiyun }
3163*4882a593Smuzhiyun
3164*4882a593Smuzhiyun pci_set_master(pdev);
3165*4882a593Smuzhiyun pci_try_set_mwi(pdev);
3166*4882a593Smuzhiyun
3167*4882a593Smuzhiyun /* device struct setup */
3168*4882a593Smuzhiyun spin_lock_init(&dev->lock);
3169*4882a593Smuzhiyun dev->gadget.ops = &pch_udc_ops;
3170*4882a593Smuzhiyun
3171*4882a593Smuzhiyun retval = init_dma_pools(dev);
3172*4882a593Smuzhiyun if (retval)
3173*4882a593Smuzhiyun goto finished;
3174*4882a593Smuzhiyun
3175*4882a593Smuzhiyun dev->gadget.name = KBUILD_MODNAME;
3176*4882a593Smuzhiyun dev->gadget.max_speed = USB_SPEED_HIGH;
3177*4882a593Smuzhiyun
3178*4882a593Smuzhiyun /* Put the device in disconnected state till a driver is bound */
3179*4882a593Smuzhiyun pch_udc_set_disconnect(dev);
3180*4882a593Smuzhiyun retval = usb_add_gadget_udc(&pdev->dev, &dev->gadget);
3181*4882a593Smuzhiyun if (retval)
3182*4882a593Smuzhiyun goto finished;
3183*4882a593Smuzhiyun return 0;
3184*4882a593Smuzhiyun
3185*4882a593Smuzhiyun finished:
3186*4882a593Smuzhiyun pch_udc_remove(pdev);
3187*4882a593Smuzhiyun return retval;
3188*4882a593Smuzhiyun }
3189*4882a593Smuzhiyun
3190*4882a593Smuzhiyun static const struct pci_device_id pch_udc_pcidev_id[] = {
3191*4882a593Smuzhiyun {
3192*4882a593Smuzhiyun PCI_DEVICE(PCI_VENDOR_ID_INTEL,
3193*4882a593Smuzhiyun PCI_DEVICE_ID_INTEL_QUARK_X1000_UDC),
3194*4882a593Smuzhiyun .class = PCI_CLASS_SERIAL_USB_DEVICE,
3195*4882a593Smuzhiyun .class_mask = 0xffffffff,
3196*4882a593Smuzhiyun },
3197*4882a593Smuzhiyun {
3198*4882a593Smuzhiyun PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_EG20T_UDC),
3199*4882a593Smuzhiyun .class = PCI_CLASS_SERIAL_USB_DEVICE,
3200*4882a593Smuzhiyun .class_mask = 0xffffffff,
3201*4882a593Smuzhiyun },
3202*4882a593Smuzhiyun {
3203*4882a593Smuzhiyun PCI_DEVICE(PCI_VENDOR_ID_ROHM, PCI_DEVICE_ID_ML7213_IOH_UDC),
3204*4882a593Smuzhiyun .class = PCI_CLASS_SERIAL_USB_DEVICE,
3205*4882a593Smuzhiyun .class_mask = 0xffffffff,
3206*4882a593Smuzhiyun },
3207*4882a593Smuzhiyun {
3208*4882a593Smuzhiyun PCI_DEVICE(PCI_VENDOR_ID_ROHM, PCI_DEVICE_ID_ML7831_IOH_UDC),
3209*4882a593Smuzhiyun .class = PCI_CLASS_SERIAL_USB_DEVICE,
3210*4882a593Smuzhiyun .class_mask = 0xffffffff,
3211*4882a593Smuzhiyun },
3212*4882a593Smuzhiyun { 0 },
3213*4882a593Smuzhiyun };
3214*4882a593Smuzhiyun
3215*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, pch_udc_pcidev_id);
3216*4882a593Smuzhiyun
3217*4882a593Smuzhiyun static struct pci_driver pch_udc_driver = {
3218*4882a593Smuzhiyun .name = KBUILD_MODNAME,
3219*4882a593Smuzhiyun .id_table = pch_udc_pcidev_id,
3220*4882a593Smuzhiyun .probe = pch_udc_probe,
3221*4882a593Smuzhiyun .remove = pch_udc_remove,
3222*4882a593Smuzhiyun .shutdown = pch_udc_shutdown,
3223*4882a593Smuzhiyun .driver = {
3224*4882a593Smuzhiyun .pm = PCH_UDC_PM_OPS,
3225*4882a593Smuzhiyun },
3226*4882a593Smuzhiyun };
3227*4882a593Smuzhiyun
3228*4882a593Smuzhiyun module_pci_driver(pch_udc_driver);
3229*4882a593Smuzhiyun
3230*4882a593Smuzhiyun MODULE_DESCRIPTION("Intel EG20T USB Device Controller");
3231*4882a593Smuzhiyun MODULE_AUTHOR("LAPIS Semiconductor, <tomoya-linux@dsn.lapis-semi.com>");
3232*4882a593Smuzhiyun MODULE_LICENSE("GPL");
3233