2 * Renesas USB3.0 Peripheral driver (USB gadget)
4 * Copyright (C) 2015 Renesas Electronics Corporation
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; version 2 of the License.
11 #include <linux/debugfs.h>
12 #include <linux/delay.h>
13 #include <linux/dma-mapping.h>
14 #include <linux/err.h>
15 #include <linux/extcon.h>
16 #include <linux/interrupt.h>
18 #include <linux/module.h>
19 #include <linux/of_device.h>
20 #include <linux/platform_device.h>
21 #include <linux/pm_runtime.h>
22 #include <linux/sizes.h>
23 #include <linux/slab.h>
24 #include <linux/string.h>
25 #include <linux/sys_soc.h>
26 #include <linux/uaccess.h>
27 #include <linux/usb/ch9.h>
28 #include <linux/usb/gadget.h>
30 /* register definitions */
31 #define USB3_AXI_INT_STA 0x008
32 #define USB3_AXI_INT_ENA 0x00c
33 #define USB3_DMA_INT_STA 0x010
34 #define USB3_DMA_INT_ENA 0x014
35 #define USB3_DMA_CH0_CON(n) (0x030 + ((n) - 1) * 0x10) /* n = 1 to 4 */
36 #define USB3_DMA_CH0_PRD_ADR(n) (0x034 + ((n) - 1) * 0x10) /* n = 1 to 4 */
37 #define USB3_USB_COM_CON 0x200
38 #define USB3_USB20_CON 0x204
39 #define USB3_USB30_CON 0x208
40 #define USB3_USB_STA 0x210
41 #define USB3_DRD_CON 0x218
42 #define USB3_USB_INT_STA_1 0x220
43 #define USB3_USB_INT_STA_2 0x224
44 #define USB3_USB_INT_ENA_1 0x228
45 #define USB3_USB_INT_ENA_2 0x22c
46 #define USB3_STUP_DAT_0 0x230
47 #define USB3_STUP_DAT_1 0x234
48 #define USB3_USB_OTG_STA 0x268
49 #define USB3_USB_OTG_INT_STA 0x26c
50 #define USB3_USB_OTG_INT_ENA 0x270
51 #define USB3_P0_MOD 0x280
52 #define USB3_P0_CON 0x288
53 #define USB3_P0_STA 0x28c
54 #define USB3_P0_INT_STA 0x290
55 #define USB3_P0_INT_ENA 0x294
56 #define USB3_P0_LNG 0x2a0
57 #define USB3_P0_READ 0x2a4
58 #define USB3_P0_WRITE 0x2a8
59 #define USB3_PIPE_COM 0x2b0
60 #define USB3_PN_MOD 0x2c0
61 #define USB3_PN_RAMMAP 0x2c4
62 #define USB3_PN_CON 0x2c8
63 #define USB3_PN_STA 0x2cc
64 #define USB3_PN_INT_STA 0x2d0
65 #define USB3_PN_INT_ENA 0x2d4
66 #define USB3_PN_LNG 0x2e0
67 #define USB3_PN_READ 0x2e4
68 #define USB3_PN_WRITE 0x2e8
69 #define USB3_SSIFCMD 0x340
71 /* AXI_INT_ENA and AXI_INT_STA */
72 #define AXI_INT_DMAINT BIT(31)
73 #define AXI_INT_EPCINT BIT(30)
74 /* PRD's n = from 1 to 4 */
75 #define AXI_INT_PRDEN_CLR_STA_SHIFT(n) (16 + (n) - 1)
76 #define AXI_INT_PRDERR_STA_SHIFT(n) (0 + (n) - 1)
77 #define AXI_INT_PRDEN_CLR_STA(n) (1 << AXI_INT_PRDEN_CLR_STA_SHIFT(n))
78 #define AXI_INT_PRDERR_STA(n) (1 << AXI_INT_PRDERR_STA_SHIFT(n))
80 /* DMA_INT_ENA and DMA_INT_STA */
81 #define DMA_INT(n) BIT(n)
84 #define DMA_CON_PIPE_DIR BIT(15) /* 1: In Transfer */
85 #define DMA_CON_PIPE_NO_SHIFT 8
86 #define DMA_CON_PIPE_NO_MASK GENMASK(12, DMA_CON_PIPE_NO_SHIFT)
87 #define DMA_COM_PIPE_NO(n) (((n) << DMA_CON_PIPE_NO_SHIFT) & \
89 #define DMA_CON_PRD_EN BIT(0)
92 #define LCLKSEL_LSEL BIT(18)
95 #define USB_COM_CON_CONF BIT(24)
96 #define USB_COM_CON_PN_WDATAIF_NL BIT(23)
97 #define USB_COM_CON_PN_RDATAIF_NL BIT(22)
98 #define USB_COM_CON_PN_LSTTR_PP BIT(21)
99 #define USB_COM_CON_SPD_MODE BIT(17)
100 #define USB_COM_CON_EP0_EN BIT(16)
101 #define USB_COM_CON_DEV_ADDR_SHIFT 8
102 #define USB_COM_CON_DEV_ADDR_MASK GENMASK(14, USB_COM_CON_DEV_ADDR_SHIFT)
103 #define USB_COM_CON_DEV_ADDR(n) (((n) << USB_COM_CON_DEV_ADDR_SHIFT) & \
104 USB_COM_CON_DEV_ADDR_MASK)
105 #define USB_COM_CON_RX_DETECTION BIT(1)
106 #define USB_COM_CON_PIPE_CLR BIT(0)
109 #define USB20_CON_B2_PUE BIT(31)
110 #define USB20_CON_B2_SUSPEND BIT(24)
111 #define USB20_CON_B2_CONNECT BIT(17)
112 #define USB20_CON_B2_TSTMOD_SHIFT 8
113 #define USB20_CON_B2_TSTMOD_MASK GENMASK(10, USB20_CON_B2_TSTMOD_SHIFT)
114 #define USB20_CON_B2_TSTMOD(n) (((n) << USB20_CON_B2_TSTMOD_SHIFT) & \
115 USB20_CON_B2_TSTMOD_MASK)
116 #define USB20_CON_B2_TSTMOD_EN BIT(0)
119 #define USB30_CON_POW_SEL_SHIFT 24
120 #define USB30_CON_POW_SEL_MASK GENMASK(26, USB30_CON_POW_SEL_SHIFT)
121 #define USB30_CON_POW_SEL_IN_U3 BIT(26)
122 #define USB30_CON_POW_SEL_IN_DISCON 0
123 #define USB30_CON_POW_SEL_P2_TO_P0 BIT(25)
124 #define USB30_CON_POW_SEL_P0_TO_P3 BIT(24)
125 #define USB30_CON_POW_SEL_P0_TO_P2 0
126 #define USB30_CON_B3_PLLWAKE BIT(23)
127 #define USB30_CON_B3_CONNECT BIT(17)
128 #define USB30_CON_B3_HOTRST_CMP BIT(1)
131 #define USB_STA_SPEED_MASK (BIT(2) | BIT(1))
132 #define USB_STA_SPEED_HS BIT(2)
133 #define USB_STA_SPEED_FS BIT(1)
134 #define USB_STA_SPEED_SS 0
135 #define USB_STA_VBUS_STA BIT(0)
138 #define DRD_CON_PERI_CON BIT(24)
139 #define DRD_CON_VBOUT BIT(0)
141 /* USB_INT_ENA_1 and USB_INT_STA_1 */
142 #define USB_INT_1_B3_PLLWKUP BIT(31)
143 #define USB_INT_1_B3_LUPSUCS BIT(30)
144 #define USB_INT_1_B3_DISABLE BIT(27)
145 #define USB_INT_1_B3_WRMRST BIT(21)
146 #define USB_INT_1_B3_HOTRST BIT(20)
147 #define USB_INT_1_B2_USBRST BIT(12)
148 #define USB_INT_1_B2_L1SPND BIT(11)
149 #define USB_INT_1_B2_SPND BIT(9)
150 #define USB_INT_1_B2_RSUM BIT(8)
151 #define USB_INT_1_SPEED BIT(1)
152 #define USB_INT_1_VBUS_CNG BIT(0)
154 /* USB_INT_ENA_2 and USB_INT_STA_2 */
155 #define USB_INT_2_PIPE(n) BIT(n)
157 /* USB_OTG_STA, USB_OTG_INT_STA and USB_OTG_INT_ENA */
158 #define USB_OTG_IDMON BIT(4)
161 #define P0_MOD_DIR BIT(6)
163 /* P0_CON and PN_CON */
164 #define PX_CON_BYTE_EN_MASK (BIT(10) | BIT(9))
165 #define PX_CON_BYTE_EN_SHIFT 9
166 #define PX_CON_BYTE_EN_BYTES(n) (((n) << PX_CON_BYTE_EN_SHIFT) & \
168 #define PX_CON_SEND BIT(8)
171 #define P0_CON_ST_RES_MASK (BIT(27) | BIT(26))
172 #define P0_CON_ST_RES_FORCE_STALL BIT(27)
173 #define P0_CON_ST_RES_NORMAL BIT(26)
174 #define P0_CON_ST_RES_FORCE_NRDY 0
175 #define P0_CON_OT_RES_MASK (BIT(25) | BIT(24))
176 #define P0_CON_OT_RES_FORCE_STALL BIT(25)
177 #define P0_CON_OT_RES_NORMAL BIT(24)
178 #define P0_CON_OT_RES_FORCE_NRDY 0
179 #define P0_CON_IN_RES_MASK (BIT(17) | BIT(16))
180 #define P0_CON_IN_RES_FORCE_STALL BIT(17)
181 #define P0_CON_IN_RES_NORMAL BIT(16)
182 #define P0_CON_IN_RES_FORCE_NRDY 0
183 #define P0_CON_RES_WEN BIT(7)
184 #define P0_CON_BCLR BIT(1)
186 /* P0_STA and PN_STA */
187 #define PX_STA_BUFSTS BIT(0)
189 /* P0_INT_ENA and P0_INT_STA */
190 #define P0_INT_STSED BIT(18)
191 #define P0_INT_STSST BIT(17)
192 #define P0_INT_SETUP BIT(16)
193 #define P0_INT_RCVNL BIT(8)
194 #define P0_INT_ERDY BIT(7)
195 #define P0_INT_FLOW BIT(6)
196 #define P0_INT_STALL BIT(2)
197 #define P0_INT_NRDY BIT(1)
198 #define P0_INT_BFRDY BIT(0)
199 #define P0_INT_ALL_BITS (P0_INT_STSED | P0_INT_SETUP | P0_INT_BFRDY)
202 #define PN_MOD_DIR BIT(6)
203 #define PN_MOD_TYPE_SHIFT 4
204 #define PN_MOD_TYPE_MASK GENMASK(5, PN_MOD_TYPE_SHIFT)
205 #define PN_MOD_TYPE(n) (((n) << PN_MOD_TYPE_SHIFT) & \
207 #define PN_MOD_EPNUM_MASK GENMASK(3, 0)
208 #define PN_MOD_EPNUM(n) ((n) & PN_MOD_EPNUM_MASK)
211 #define PN_RAMMAP_RAMAREA_SHIFT 29
212 #define PN_RAMMAP_RAMAREA_MASK GENMASK(31, PN_RAMMAP_RAMAREA_SHIFT)
213 #define PN_RAMMAP_RAMAREA_16KB BIT(31)
214 #define PN_RAMMAP_RAMAREA_8KB (BIT(30) | BIT(29))
215 #define PN_RAMMAP_RAMAREA_4KB BIT(30)
216 #define PN_RAMMAP_RAMAREA_2KB BIT(29)
217 #define PN_RAMMAP_RAMAREA_1KB 0
218 #define PN_RAMMAP_MPKT_SHIFT 16
219 #define PN_RAMMAP_MPKT_MASK GENMASK(26, PN_RAMMAP_MPKT_SHIFT)
220 #define PN_RAMMAP_MPKT(n) (((n) << PN_RAMMAP_MPKT_SHIFT) & \
222 #define PN_RAMMAP_RAMIF_SHIFT 14
223 #define PN_RAMMAP_RAMIF_MASK GENMASK(15, PN_RAMMAP_RAMIF_SHIFT)
224 #define PN_RAMMAP_RAMIF(n) (((n) << PN_RAMMAP_RAMIF_SHIFT) & \
225 PN_RAMMAP_RAMIF_MASK)
226 #define PN_RAMMAP_BASEAD_MASK GENMASK(13, 0)
227 #define PN_RAMMAP_BASEAD(offs) (((offs) >> 3) & PN_RAMMAP_BASEAD_MASK)
228 #define PN_RAMMAP_DATA(area, ramif, basead) ((PN_RAMMAP_##area) | \
229 (PN_RAMMAP_RAMIF(ramif)) | \
230 (PN_RAMMAP_BASEAD(basead)))
233 #define PN_CON_EN BIT(31)
234 #define PN_CON_DATAIF_EN BIT(30)
235 #define PN_CON_RES_MASK (BIT(17) | BIT(16))
236 #define PN_CON_RES_FORCE_STALL BIT(17)
237 #define PN_CON_RES_NORMAL BIT(16)
238 #define PN_CON_RES_FORCE_NRDY 0
239 #define PN_CON_LAST BIT(11)
240 #define PN_CON_RES_WEN BIT(7)
241 #define PN_CON_CLR BIT(0)
243 /* PN_INT_STA and PN_INT_ENA */
244 #define PN_INT_LSTTR BIT(4)
245 #define PN_INT_BFRDY BIT(0)
248 #define SSIFCMD_URES_U2 BIT(9)
249 #define SSIFCMD_URES_U1 BIT(8)
250 #define SSIFCMD_UDIR_U2 BIT(7)
251 #define SSIFCMD_UDIR_U1 BIT(6)
252 #define SSIFCMD_UREQ_U2 BIT(5)
253 #define SSIFCMD_UREQ_U1 BIT(4)
255 #define USB3_EP0_SS_MAX_PACKET_SIZE 512
256 #define USB3_EP0_HSFS_MAX_PACKET_SIZE 64
257 #define USB3_EP0_BUF_SIZE 8
258 #define USB3_MAX_NUM_PIPES 6 /* This includes PIPE 0 */
259 #define USB3_WAIT_US 3
260 #define USB3_DMA_NUM_SETTING_AREA 4
262 * To avoid double-meaning of "0" (xferred 65536 bytes or received zlp if
263 * buffer size is 65536), this driver uses the maximum size per a entry is
266 #define USB3_DMA_MAX_XFER_SIZE 32768
267 #define USB3_DMA_PRD_SIZE 4096
271 /* Physical Region Descriptor Table */
272 struct renesas_usb3_prd {
274 #define USB3_PRD1_E BIT(30) /* the end of chain */
275 #define USB3_PRD1_U BIT(29) /* completion of transfer */
276 #define USB3_PRD1_D BIT(28) /* Error occurred */
277 #define USB3_PRD1_INT BIT(27) /* Interrupt occurred */
278 #define USB3_PRD1_LST BIT(26) /* Last Packet */
279 #define USB3_PRD1_B_INC BIT(24)
280 #define USB3_PRD1_MPS_8 0
281 #define USB3_PRD1_MPS_16 BIT(21)
282 #define USB3_PRD1_MPS_32 BIT(22)
283 #define USB3_PRD1_MPS_64 (BIT(22) | BIT(21))
284 #define USB3_PRD1_MPS_512 BIT(23)
285 #define USB3_PRD1_MPS_1024 (BIT(23) | BIT(21))
286 #define USB3_PRD1_MPS_RESERVED (BIT(23) | BIT(22) | BIT(21))
287 #define USB3_PRD1_SIZE_MASK GENMASK(15, 0)
291 #define USB3_DMA_NUM_PRD_ENTRIES (USB3_DMA_PRD_SIZE / \
292 sizeof(struct renesas_usb3_prd))
293 #define USB3_DMA_MAX_XFER_SIZE_ALL_PRDS (USB3_DMA_PRD_SIZE / \
294 sizeof(struct renesas_usb3_prd) * \
295 USB3_DMA_MAX_XFER_SIZE)
297 struct renesas_usb3_dma {
298 struct renesas_usb3_prd *prd;
300 int num; /* Setting area number (from 1 to 4) */
304 struct renesas_usb3_request {
305 struct usb_request req;
306 struct list_head queue;
309 #define USB3_EP_NAME_SIZE 8
310 struct renesas_usb3_ep {
312 struct renesas_usb3 *usb3;
313 struct renesas_usb3_dma *dma;
315 char ep_name[USB3_EP_NAME_SIZE];
316 struct list_head queue;
324 struct renesas_usb3_priv {
325 int ramsize_per_ramif; /* unit = bytes */
327 int ramsize_per_pipe; /* unit = bytes */
328 bool workaround_for_vbus; /* if true, don't check vbus signal */
331 struct renesas_usb3 {
334 struct usb_gadget gadget;
335 struct usb_gadget_driver *driver;
336 struct extcon_dev *extcon;
337 struct work_struct extcon_work;
338 struct dentry *dentry;
340 struct renesas_usb3_ep *usb3_ep;
343 struct renesas_usb3_dma dma[USB3_DMA_NUM_SETTING_AREA];
348 struct usb_request *ep0_req;
350 u8 ep0_buf[USB3_EP0_BUF_SIZE];
352 bool workaround_for_vbus;
353 bool extcon_host; /* check id and set EXTCON_USB_HOST */
354 bool extcon_usb; /* check vbus and set EXTCON_USB */
355 bool forced_b_device;
356 bool start_to_connect;
359 #define gadget_to_renesas_usb3(_gadget) \
360 container_of(_gadget, struct renesas_usb3, gadget)
361 #define renesas_usb3_to_gadget(renesas_usb3) (&renesas_usb3->gadget)
362 #define usb3_to_dev(_usb3) (_usb3->gadget.dev.parent)
364 #define usb_ep_to_usb3_ep(_ep) container_of(_ep, struct renesas_usb3_ep, ep)
365 #define usb3_ep_to_usb3(_usb3_ep) (_usb3_ep->usb3)
366 #define usb_req_to_usb3_req(_req) container_of(_req, \
367 struct renesas_usb3_request, req)
369 #define usb3_get_ep(usb3, n) ((usb3)->usb3_ep + (n))
370 #define usb3_for_each_ep(usb3_ep, usb3, i) \
371 for ((i) = 0, usb3_ep = usb3_get_ep(usb3, (i)); \
372 (i) < (usb3)->num_usb3_eps; \
373 (i)++, usb3_ep = usb3_get_ep(usb3, (i)))
375 #define usb3_get_dma(usb3, i) (&(usb3)->dma[i])
376 #define usb3_for_each_dma(usb3, dma, i) \
377 for ((i) = 0, dma = usb3_get_dma((usb3), (i)); \
378 (i) < USB3_DMA_NUM_SETTING_AREA; \
379 (i)++, dma = usb3_get_dma((usb3), (i)))
381 static const char udc_name[] = "renesas_usb3";
383 static bool use_dma = 1;
384 module_param(use_dma, bool, 0644);
385 MODULE_PARM_DESC(use_dma, "use dedicated DMAC");
387 static void usb3_write(struct renesas_usb3 *usb3, u32 data, u32 offs)
389 iowrite32(data, usb3->reg + offs);
392 static u32 usb3_read(struct renesas_usb3 *usb3, u32 offs)
394 return ioread32(usb3->reg + offs);
397 static void usb3_set_bit(struct renesas_usb3 *usb3, u32 bits, u32 offs)
399 u32 val = usb3_read(usb3, offs);
402 usb3_write(usb3, val, offs);
405 static void usb3_clear_bit(struct renesas_usb3 *usb3, u32 bits, u32 offs)
407 u32 val = usb3_read(usb3, offs);
410 usb3_write(usb3, val, offs);
413 static int usb3_wait(struct renesas_usb3 *usb3, u32 reg, u32 mask,
418 for (i = 0; i < USB3_WAIT_US; i++) {
419 if ((usb3_read(usb3, reg) & mask) == expected)
424 dev_dbg(usb3_to_dev(usb3), "%s: timed out (%8x, %08x, %08x)\n",
425 __func__, reg, mask, expected);
430 static void renesas_usb3_extcon_work(struct work_struct *work)
432 struct renesas_usb3 *usb3 = container_of(work, struct renesas_usb3,
435 extcon_set_state_sync(usb3->extcon, EXTCON_USB_HOST, usb3->extcon_host);
436 extcon_set_state_sync(usb3->extcon, EXTCON_USB, usb3->extcon_usb);
439 static void usb3_enable_irq_1(struct renesas_usb3 *usb3, u32 bits)
441 usb3_set_bit(usb3, bits, USB3_USB_INT_ENA_1);
444 static void usb3_disable_irq_1(struct renesas_usb3 *usb3, u32 bits)
446 usb3_clear_bit(usb3, bits, USB3_USB_INT_ENA_1);
449 static void usb3_enable_pipe_irq(struct renesas_usb3 *usb3, int num)
451 usb3_set_bit(usb3, USB_INT_2_PIPE(num), USB3_USB_INT_ENA_2);
454 static void usb3_disable_pipe_irq(struct renesas_usb3 *usb3, int num)
456 usb3_clear_bit(usb3, USB_INT_2_PIPE(num), USB3_USB_INT_ENA_2);
459 static bool usb3_is_host(struct renesas_usb3 *usb3)
461 return !(usb3_read(usb3, USB3_DRD_CON) & DRD_CON_PERI_CON);
464 static void usb3_init_axi_bridge(struct renesas_usb3 *usb3)
467 usb3_write(usb3, ~0, USB3_DMA_INT_STA);
468 usb3_write(usb3, 0, USB3_DMA_INT_ENA);
469 usb3_set_bit(usb3, AXI_INT_DMAINT | AXI_INT_EPCINT, USB3_AXI_INT_ENA);
472 static void usb3_init_epc_registers(struct renesas_usb3 *usb3)
474 usb3_write(usb3, ~0, USB3_USB_INT_STA_1);
475 if (!usb3->workaround_for_vbus)
476 usb3_enable_irq_1(usb3, USB_INT_1_VBUS_CNG);
479 static bool usb3_wakeup_usb2_phy(struct renesas_usb3 *usb3)
481 if (!(usb3_read(usb3, USB3_USB20_CON) & USB20_CON_B2_SUSPEND))
482 return true; /* already waked it up */
484 usb3_clear_bit(usb3, USB20_CON_B2_SUSPEND, USB3_USB20_CON);
485 usb3_enable_irq_1(usb3, USB_INT_1_B2_RSUM);
490 static void usb3_usb2_pullup(struct renesas_usb3 *usb3, int pullup)
492 u32 bits = USB20_CON_B2_PUE | USB20_CON_B2_CONNECT;
494 if (usb3->softconnect && pullup)
495 usb3_set_bit(usb3, bits, USB3_USB20_CON);
497 usb3_clear_bit(usb3, bits, USB3_USB20_CON);
500 static void usb3_set_test_mode(struct renesas_usb3 *usb3)
502 u32 val = usb3_read(usb3, USB3_USB20_CON);
504 val &= ~USB20_CON_B2_TSTMOD_MASK;
505 val |= USB20_CON_B2_TSTMOD(usb3->test_mode);
506 usb3_write(usb3, val | USB20_CON_B2_TSTMOD_EN, USB3_USB20_CON);
507 if (!usb3->test_mode)
508 usb3_clear_bit(usb3, USB20_CON_B2_TSTMOD_EN, USB3_USB20_CON);
511 static void usb3_start_usb2_connection(struct renesas_usb3 *usb3)
513 usb3->disabled_count++;
514 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
515 usb3_set_bit(usb3, USB_COM_CON_SPD_MODE, USB3_USB_COM_CON);
516 usb3_usb2_pullup(usb3, 1);
519 static int usb3_is_usb3_phy_in_u3(struct renesas_usb3 *usb3)
521 return usb3_read(usb3, USB3_USB30_CON) & USB30_CON_POW_SEL_IN_U3;
524 static bool usb3_wakeup_usb3_phy(struct renesas_usb3 *usb3)
526 if (!usb3_is_usb3_phy_in_u3(usb3))
527 return true; /* already waked it up */
529 usb3_set_bit(usb3, USB30_CON_B3_PLLWAKE, USB3_USB30_CON);
530 usb3_enable_irq_1(usb3, USB_INT_1_B3_PLLWKUP);
535 static u16 usb3_feature_get_un_enabled(struct renesas_usb3 *usb3)
537 u32 mask_u2 = SSIFCMD_UDIR_U2 | SSIFCMD_UREQ_U2;
538 u32 mask_u1 = SSIFCMD_UDIR_U1 | SSIFCMD_UREQ_U1;
539 u32 val = usb3_read(usb3, USB3_SSIFCMD);
542 /* Enables {U2,U1} if the bits of UDIR and UREQ are set to 0 */
543 if (!(val & mask_u2))
544 ret |= 1 << USB_DEV_STAT_U2_ENABLED;
545 if (!(val & mask_u1))
546 ret |= 1 << USB_DEV_STAT_U1_ENABLED;
551 static void usb3_feature_u2_enable(struct renesas_usb3 *usb3, bool enable)
553 u32 bits = SSIFCMD_UDIR_U2 | SSIFCMD_UREQ_U2;
555 /* Enables U2 if the bits of UDIR and UREQ are set to 0 */
557 usb3_clear_bit(usb3, bits, USB3_SSIFCMD);
559 usb3_set_bit(usb3, bits, USB3_SSIFCMD);
562 static void usb3_feature_u1_enable(struct renesas_usb3 *usb3, bool enable)
564 u32 bits = SSIFCMD_UDIR_U1 | SSIFCMD_UREQ_U1;
566 /* Enables U1 if the bits of UDIR and UREQ are set to 0 */
568 usb3_clear_bit(usb3, bits, USB3_SSIFCMD);
570 usb3_set_bit(usb3, bits, USB3_SSIFCMD);
573 static void usb3_start_operation_for_usb3(struct renesas_usb3 *usb3)
575 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
576 usb3_clear_bit(usb3, USB_COM_CON_SPD_MODE, USB3_USB_COM_CON);
577 usb3_set_bit(usb3, USB30_CON_B3_CONNECT, USB3_USB30_CON);
580 static void usb3_start_usb3_connection(struct renesas_usb3 *usb3)
582 usb3_start_operation_for_usb3(usb3);
583 usb3_set_bit(usb3, USB_COM_CON_RX_DETECTION, USB3_USB_COM_CON);
585 usb3_enable_irq_1(usb3, USB_INT_1_B3_LUPSUCS | USB_INT_1_B3_DISABLE |
589 static void usb3_stop_usb3_connection(struct renesas_usb3 *usb3)
591 usb3_clear_bit(usb3, USB30_CON_B3_CONNECT, USB3_USB30_CON);
594 static void usb3_transition_to_default_state(struct renesas_usb3 *usb3,
597 usb3_set_bit(usb3, USB_INT_2_PIPE(0), USB3_USB_INT_ENA_2);
598 usb3_write(usb3, P0_INT_ALL_BITS, USB3_P0_INT_STA);
599 usb3_set_bit(usb3, P0_INT_ALL_BITS, USB3_P0_INT_ENA);
602 usb3_enable_irq_1(usb3, USB_INT_1_B3_WRMRST |
603 USB_INT_1_B3_HOTRST);
605 usb3_enable_irq_1(usb3, USB_INT_1_B2_SPND |
606 USB_INT_1_B2_L1SPND | USB_INT_1_B2_USBRST);
609 static void usb3_connect(struct renesas_usb3 *usb3)
611 if (usb3_wakeup_usb3_phy(usb3))
612 usb3_start_usb3_connection(usb3);
615 static void usb3_reset_epc(struct renesas_usb3 *usb3)
617 usb3_clear_bit(usb3, USB_COM_CON_CONF, USB3_USB_COM_CON);
618 usb3_clear_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
619 usb3_set_bit(usb3, USB_COM_CON_PIPE_CLR, USB3_USB_COM_CON);
621 usb3_set_test_mode(usb3);
624 static void usb3_disconnect(struct renesas_usb3 *usb3)
626 usb3->disabled_count = 0;
627 usb3_usb2_pullup(usb3, 0);
628 usb3_clear_bit(usb3, USB30_CON_B3_CONNECT, USB3_USB30_CON);
629 usb3_reset_epc(usb3);
630 usb3_disable_irq_1(usb3, USB_INT_1_B2_RSUM | USB_INT_1_B3_PLLWKUP |
631 USB_INT_1_B3_LUPSUCS | USB_INT_1_B3_DISABLE |
632 USB_INT_1_SPEED | USB_INT_1_B3_WRMRST |
633 USB_INT_1_B3_HOTRST | USB_INT_1_B2_SPND |
634 USB_INT_1_B2_L1SPND | USB_INT_1_B2_USBRST);
635 usb3_clear_bit(usb3, USB_COM_CON_SPD_MODE, USB3_USB_COM_CON);
636 usb3_init_epc_registers(usb3);
639 usb3->driver->disconnect(&usb3->gadget);
642 static void usb3_check_vbus(struct renesas_usb3 *usb3)
644 if (usb3->workaround_for_vbus) {
647 usb3->extcon_usb = !!(usb3_read(usb3, USB3_USB_STA) &
649 if (usb3->extcon_usb)
652 usb3_disconnect(usb3);
654 schedule_work(&usb3->extcon_work);
658 static void usb3_set_mode(struct renesas_usb3 *usb3, bool host)
661 usb3_clear_bit(usb3, DRD_CON_PERI_CON, USB3_DRD_CON);
663 usb3_set_bit(usb3, DRD_CON_PERI_CON, USB3_DRD_CON);
666 static void usb3_vbus_out(struct renesas_usb3 *usb3, bool enable)
669 usb3_set_bit(usb3, DRD_CON_VBOUT, USB3_DRD_CON);
671 usb3_clear_bit(usb3, DRD_CON_VBOUT, USB3_DRD_CON);
674 static void usb3_mode_config(struct renesas_usb3 *usb3, bool host, bool a_dev)
678 spin_lock_irqsave(&usb3->lock, flags);
679 usb3_set_mode(usb3, host);
680 usb3_vbus_out(usb3, a_dev);
681 /* for A-Peripheral or forced B-device mode */
682 if ((!host && a_dev) || usb3->start_to_connect)
684 spin_unlock_irqrestore(&usb3->lock, flags);
687 static bool usb3_is_a_device(struct renesas_usb3 *usb3)
689 return !(usb3_read(usb3, USB3_USB_OTG_STA) & USB_OTG_IDMON);
692 static void usb3_check_id(struct renesas_usb3 *usb3)
694 usb3->extcon_host = usb3_is_a_device(usb3);
696 if (usb3->extcon_host && !usb3->forced_b_device)
697 usb3_mode_config(usb3, true, true);
699 usb3_mode_config(usb3, false, false);
701 schedule_work(&usb3->extcon_work);
704 static void renesas_usb3_init_controller(struct renesas_usb3 *usb3)
706 usb3_init_axi_bridge(usb3);
707 usb3_init_epc_registers(usb3);
708 usb3_set_bit(usb3, USB_COM_CON_PN_WDATAIF_NL |
709 USB_COM_CON_PN_RDATAIF_NL | USB_COM_CON_PN_LSTTR_PP,
711 usb3_write(usb3, USB_OTG_IDMON, USB3_USB_OTG_INT_STA);
712 usb3_write(usb3, USB_OTG_IDMON, USB3_USB_OTG_INT_ENA);
715 usb3_check_vbus(usb3);
718 static void renesas_usb3_stop_controller(struct renesas_usb3 *usb3)
720 usb3_disconnect(usb3);
721 usb3_write(usb3, 0, USB3_P0_INT_ENA);
722 usb3_write(usb3, 0, USB3_USB_OTG_INT_ENA);
723 usb3_write(usb3, 0, USB3_USB_INT_ENA_1);
724 usb3_write(usb3, 0, USB3_USB_INT_ENA_2);
725 usb3_write(usb3, 0, USB3_AXI_INT_ENA);
728 static void usb3_irq_epc_int_1_pll_wakeup(struct renesas_usb3 *usb3)
730 usb3_disable_irq_1(usb3, USB_INT_1_B3_PLLWKUP);
731 usb3_clear_bit(usb3, USB30_CON_B3_PLLWAKE, USB3_USB30_CON);
732 usb3_start_usb3_connection(usb3);
735 static void usb3_irq_epc_int_1_linkup_success(struct renesas_usb3 *usb3)
737 usb3_transition_to_default_state(usb3, true);
740 static void usb3_irq_epc_int_1_resume(struct renesas_usb3 *usb3)
742 usb3_disable_irq_1(usb3, USB_INT_1_B2_RSUM);
743 usb3_start_usb2_connection(usb3);
744 usb3_transition_to_default_state(usb3, false);
747 static void usb3_irq_epc_int_1_disable(struct renesas_usb3 *usb3)
749 usb3_stop_usb3_connection(usb3);
750 if (usb3_wakeup_usb2_phy(usb3))
751 usb3_irq_epc_int_1_resume(usb3);
754 static void usb3_irq_epc_int_1_bus_reset(struct renesas_usb3 *usb3)
756 usb3_reset_epc(usb3);
757 if (usb3->disabled_count < 3)
758 usb3_start_usb3_connection(usb3);
760 usb3_start_usb2_connection(usb3);
763 static void usb3_irq_epc_int_1_vbus_change(struct renesas_usb3 *usb3)
765 usb3_check_vbus(usb3);
768 static void usb3_irq_epc_int_1_hot_reset(struct renesas_usb3 *usb3)
770 usb3_reset_epc(usb3);
771 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
773 /* This bit shall be set within 12ms from the start of HotReset */
774 usb3_set_bit(usb3, USB30_CON_B3_HOTRST_CMP, USB3_USB30_CON);
777 static void usb3_irq_epc_int_1_warm_reset(struct renesas_usb3 *usb3)
779 usb3_reset_epc(usb3);
780 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
782 usb3_start_operation_for_usb3(usb3);
783 usb3_enable_irq_1(usb3, USB_INT_1_SPEED);
786 static void usb3_irq_epc_int_1_speed(struct renesas_usb3 *usb3)
788 u32 speed = usb3_read(usb3, USB3_USB_STA) & USB_STA_SPEED_MASK;
791 case USB_STA_SPEED_SS:
792 usb3->gadget.speed = USB_SPEED_SUPER;
793 usb3->gadget.ep0->maxpacket = USB3_EP0_SS_MAX_PACKET_SIZE;
795 case USB_STA_SPEED_HS:
796 usb3->gadget.speed = USB_SPEED_HIGH;
797 usb3->gadget.ep0->maxpacket = USB3_EP0_HSFS_MAX_PACKET_SIZE;
799 case USB_STA_SPEED_FS:
800 usb3->gadget.speed = USB_SPEED_FULL;
801 usb3->gadget.ep0->maxpacket = USB3_EP0_HSFS_MAX_PACKET_SIZE;
804 usb3->gadget.speed = USB_SPEED_UNKNOWN;
809 static void usb3_irq_epc_int_1(struct renesas_usb3 *usb3, u32 int_sta_1)
811 if (int_sta_1 & USB_INT_1_B3_PLLWKUP)
812 usb3_irq_epc_int_1_pll_wakeup(usb3);
814 if (int_sta_1 & USB_INT_1_B3_LUPSUCS)
815 usb3_irq_epc_int_1_linkup_success(usb3);
817 if (int_sta_1 & USB_INT_1_B3_HOTRST)
818 usb3_irq_epc_int_1_hot_reset(usb3);
820 if (int_sta_1 & USB_INT_1_B3_WRMRST)
821 usb3_irq_epc_int_1_warm_reset(usb3);
823 if (int_sta_1 & USB_INT_1_B3_DISABLE)
824 usb3_irq_epc_int_1_disable(usb3);
826 if (int_sta_1 & USB_INT_1_B2_USBRST)
827 usb3_irq_epc_int_1_bus_reset(usb3);
829 if (int_sta_1 & USB_INT_1_B2_RSUM)
830 usb3_irq_epc_int_1_resume(usb3);
832 if (int_sta_1 & USB_INT_1_SPEED)
833 usb3_irq_epc_int_1_speed(usb3);
835 if (int_sta_1 & USB_INT_1_VBUS_CNG)
836 usb3_irq_epc_int_1_vbus_change(usb3);
839 static struct renesas_usb3_request *__usb3_get_request(struct renesas_usb3_ep
842 return list_first_entry_or_null(&usb3_ep->queue,
843 struct renesas_usb3_request, queue);
846 static struct renesas_usb3_request *usb3_get_request(struct renesas_usb3_ep
849 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
850 struct renesas_usb3_request *usb3_req;
853 spin_lock_irqsave(&usb3->lock, flags);
854 usb3_req = __usb3_get_request(usb3_ep);
855 spin_unlock_irqrestore(&usb3->lock, flags);
860 static void __usb3_request_done(struct renesas_usb3_ep *usb3_ep,
861 struct renesas_usb3_request *usb3_req,
864 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
866 dev_dbg(usb3_to_dev(usb3), "giveback: ep%2d, %u, %u, %d\n",
867 usb3_ep->num, usb3_req->req.length, usb3_req->req.actual,
869 usb3_req->req.status = status;
870 usb3_ep->started = false;
871 list_del_init(&usb3_req->queue);
872 spin_unlock(&usb3->lock);
873 usb_gadget_giveback_request(&usb3_ep->ep, &usb3_req->req);
874 spin_lock(&usb3->lock);
877 static void usb3_request_done(struct renesas_usb3_ep *usb3_ep,
878 struct renesas_usb3_request *usb3_req, int status)
880 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
883 spin_lock_irqsave(&usb3->lock, flags);
884 __usb3_request_done(usb3_ep, usb3_req, status);
885 spin_unlock_irqrestore(&usb3->lock, flags);
888 static void usb3_irq_epc_pipe0_status_end(struct renesas_usb3 *usb3)
890 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
891 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
894 usb3_request_done(usb3_ep, usb3_req, 0);
896 usb3_set_test_mode(usb3);
899 static void usb3_get_setup_data(struct renesas_usb3 *usb3,
900 struct usb_ctrlrequest *ctrl)
902 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
903 u32 *data = (u32 *)ctrl;
905 *data++ = usb3_read(usb3, USB3_STUP_DAT_0);
906 *data = usb3_read(usb3, USB3_STUP_DAT_1);
908 /* update this driver's flag */
909 usb3_ep->dir_in = !!(ctrl->bRequestType & USB_DIR_IN);
912 static void usb3_set_p0_con_update_res(struct renesas_usb3 *usb3, u32 res)
914 u32 val = usb3_read(usb3, USB3_P0_CON);
916 val &= ~(P0_CON_ST_RES_MASK | P0_CON_OT_RES_MASK | P0_CON_IN_RES_MASK);
917 val |= res | P0_CON_RES_WEN;
918 usb3_write(usb3, val, USB3_P0_CON);
921 static void usb3_set_p0_con_for_ctrl_read_data(struct renesas_usb3 *usb3)
923 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_NRDY |
924 P0_CON_OT_RES_FORCE_STALL |
925 P0_CON_IN_RES_NORMAL);
928 static void usb3_set_p0_con_for_ctrl_read_status(struct renesas_usb3 *usb3)
930 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_NORMAL |
931 P0_CON_OT_RES_FORCE_STALL |
932 P0_CON_IN_RES_NORMAL);
935 static void usb3_set_p0_con_for_ctrl_write_data(struct renesas_usb3 *usb3)
937 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_NRDY |
938 P0_CON_OT_RES_NORMAL |
939 P0_CON_IN_RES_FORCE_STALL);
942 static void usb3_set_p0_con_for_ctrl_write_status(struct renesas_usb3 *usb3)
944 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_NORMAL |
945 P0_CON_OT_RES_NORMAL |
946 P0_CON_IN_RES_FORCE_STALL);
949 static void usb3_set_p0_con_for_no_data(struct renesas_usb3 *usb3)
951 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_NORMAL |
952 P0_CON_OT_RES_FORCE_STALL |
953 P0_CON_IN_RES_FORCE_STALL);
956 static void usb3_set_p0_con_stall(struct renesas_usb3 *usb3)
958 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_STALL |
959 P0_CON_OT_RES_FORCE_STALL |
960 P0_CON_IN_RES_FORCE_STALL);
963 static void usb3_set_p0_con_stop(struct renesas_usb3 *usb3)
965 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_NRDY |
966 P0_CON_OT_RES_FORCE_NRDY |
967 P0_CON_IN_RES_FORCE_NRDY);
970 static int usb3_pn_change(struct renesas_usb3 *usb3, int num)
972 if (num == 0 || num > usb3->num_usb3_eps)
975 usb3_write(usb3, num, USB3_PIPE_COM);
980 static void usb3_set_pn_con_update_res(struct renesas_usb3 *usb3, u32 res)
982 u32 val = usb3_read(usb3, USB3_PN_CON);
984 val &= ~PN_CON_RES_MASK;
985 val |= res & PN_CON_RES_MASK;
986 val |= PN_CON_RES_WEN;
987 usb3_write(usb3, val, USB3_PN_CON);
990 static void usb3_pn_start(struct renesas_usb3 *usb3)
992 usb3_set_pn_con_update_res(usb3, PN_CON_RES_NORMAL);
995 static void usb3_pn_stop(struct renesas_usb3 *usb3)
997 usb3_set_pn_con_update_res(usb3, PN_CON_RES_FORCE_NRDY);
1000 static void usb3_pn_stall(struct renesas_usb3 *usb3)
1002 usb3_set_pn_con_update_res(usb3, PN_CON_RES_FORCE_STALL);
1005 static int usb3_pn_con_clear(struct renesas_usb3 *usb3)
1007 usb3_set_bit(usb3, PN_CON_CLR, USB3_PN_CON);
1009 return usb3_wait(usb3, USB3_PN_CON, PN_CON_CLR, 0);
1012 static bool usb3_is_transfer_complete(struct renesas_usb3_ep *usb3_ep,
1013 struct renesas_usb3_request *usb3_req)
1015 struct usb_request *req = &usb3_req->req;
1017 if ((!req->zero && req->actual == req->length) ||
1018 (req->actual % usb3_ep->ep.maxpacket) || (req->length == 0))
1024 static int usb3_wait_pipe_status(struct renesas_usb3_ep *usb3_ep, u32 mask)
1026 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1027 u32 sta_reg = usb3_ep->num ? USB3_PN_STA : USB3_P0_STA;
1029 return usb3_wait(usb3, sta_reg, mask, mask);
1032 static void usb3_set_px_con_send(struct renesas_usb3_ep *usb3_ep, int bytes,
1035 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1036 u32 con_reg = usb3_ep->num ? USB3_PN_CON : USB3_P0_CON;
1037 u32 val = usb3_read(usb3, con_reg);
1039 val |= PX_CON_SEND | PX_CON_BYTE_EN_BYTES(bytes);
1040 val |= (usb3_ep->num && last) ? PN_CON_LAST : 0;
1041 usb3_write(usb3, val, con_reg);
1044 static int usb3_write_pipe(struct renesas_usb3_ep *usb3_ep,
1045 struct renesas_usb3_request *usb3_req,
1048 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1050 int len = min_t(unsigned, usb3_req->req.length - usb3_req->req.actual,
1051 usb3_ep->ep.maxpacket);
1052 u8 *buf = usb3_req->req.buf + usb3_req->req.actual;
1054 bool is_last = !len ? true : false;
1056 if (usb3_wait_pipe_status(usb3_ep, PX_STA_BUFSTS) < 0)
1059 /* Update gadget driver parameter */
1060 usb3_req->req.actual += len;
1062 /* Write data to the register */
1064 iowrite32_rep(usb3->reg + fifo_reg, buf, len / 4);
1065 buf += (len / 4) * 4;
1066 len %= 4; /* update len to use usb3_set_pX_con_send() */
1070 for (i = 0; i < len; i++)
1071 tmp |= buf[i] << (8 * i);
1072 usb3_write(usb3, tmp, fifo_reg);
1076 is_last = usb3_is_transfer_complete(usb3_ep, usb3_req);
1078 usb3_set_px_con_send(usb3_ep, len, is_last);
1080 return is_last ? 0 : -EAGAIN;
1083 static u32 usb3_get_received_length(struct renesas_usb3_ep *usb3_ep)
1085 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1086 u32 lng_reg = usb3_ep->num ? USB3_PN_LNG : USB3_P0_LNG;
1088 return usb3_read(usb3, lng_reg);
1091 static int usb3_read_pipe(struct renesas_usb3_ep *usb3_ep,
1092 struct renesas_usb3_request *usb3_req, u32 fifo_reg)
1094 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1096 int len = min_t(unsigned, usb3_req->req.length - usb3_req->req.actual,
1097 usb3_get_received_length(usb3_ep));
1098 u8 *buf = usb3_req->req.buf + usb3_req->req.actual;
1104 /* Update gadget driver parameter */
1105 usb3_req->req.actual += len;
1107 /* Read data from the register */
1109 ioread32_rep(usb3->reg + fifo_reg, buf, len / 4);
1110 buf += (len / 4) * 4;
1115 tmp = usb3_read(usb3, fifo_reg);
1116 for (i = 0; i < len; i++)
1117 buf[i] = (tmp >> (8 * i)) & 0xff;
1120 return usb3_is_transfer_complete(usb3_ep, usb3_req) ? 0 : -EAGAIN;
1123 static void usb3_set_status_stage(struct renesas_usb3_ep *usb3_ep,
1124 struct renesas_usb3_request *usb3_req)
1126 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1128 if (usb3_ep->dir_in) {
1129 usb3_set_p0_con_for_ctrl_read_status(usb3);
1131 if (!usb3_req->req.length)
1132 usb3_set_p0_con_for_no_data(usb3);
1134 usb3_set_p0_con_for_ctrl_write_status(usb3);
1138 static void usb3_p0_xfer(struct renesas_usb3_ep *usb3_ep,
1139 struct renesas_usb3_request *usb3_req)
1143 if (usb3_ep->dir_in)
1144 ret = usb3_write_pipe(usb3_ep, usb3_req, USB3_P0_WRITE);
1146 ret = usb3_read_pipe(usb3_ep, usb3_req, USB3_P0_READ);
1149 usb3_set_status_stage(usb3_ep, usb3_req);
1152 static void usb3_start_pipe0(struct renesas_usb3_ep *usb3_ep,
1153 struct renesas_usb3_request *usb3_req)
1155 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1157 if (usb3_ep->started)
1160 usb3_ep->started = true;
1162 if (usb3_ep->dir_in) {
1163 usb3_set_bit(usb3, P0_MOD_DIR, USB3_P0_MOD);
1164 usb3_set_p0_con_for_ctrl_read_data(usb3);
1166 usb3_clear_bit(usb3, P0_MOD_DIR, USB3_P0_MOD);
1167 if (usb3_req->req.length)
1168 usb3_set_p0_con_for_ctrl_write_data(usb3);
1171 usb3_p0_xfer(usb3_ep, usb3_req);
1174 static void usb3_enable_dma_pipen(struct renesas_usb3 *usb3)
1176 usb3_set_bit(usb3, PN_CON_DATAIF_EN, USB3_PN_CON);
1179 static void usb3_disable_dma_pipen(struct renesas_usb3 *usb3)
1181 usb3_clear_bit(usb3, PN_CON_DATAIF_EN, USB3_PN_CON);
1184 static void usb3_enable_dma_irq(struct renesas_usb3 *usb3, int num)
1186 usb3_set_bit(usb3, DMA_INT(num), USB3_DMA_INT_ENA);
1189 static void usb3_disable_dma_irq(struct renesas_usb3 *usb3, int num)
1191 usb3_clear_bit(usb3, DMA_INT(num), USB3_DMA_INT_ENA);
1194 static u32 usb3_dma_mps_to_prd_word1(struct renesas_usb3_ep *usb3_ep)
1196 switch (usb3_ep->ep.maxpacket) {
1198 return USB3_PRD1_MPS_8;
1200 return USB3_PRD1_MPS_16;
1202 return USB3_PRD1_MPS_32;
1204 return USB3_PRD1_MPS_64;
1206 return USB3_PRD1_MPS_512;
1208 return USB3_PRD1_MPS_1024;
1210 return USB3_PRD1_MPS_RESERVED;
1214 static bool usb3_dma_get_setting_area(struct renesas_usb3_ep *usb3_ep,
1215 struct renesas_usb3_request *usb3_req)
1217 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1218 struct renesas_usb3_dma *dma;
1222 if (usb3_req->req.length > USB3_DMA_MAX_XFER_SIZE_ALL_PRDS) {
1223 dev_dbg(usb3_to_dev(usb3), "%s: the length is too big (%d)\n",
1224 __func__, usb3_req->req.length);
1228 /* The driver doesn't handle zero-length packet via dmac */
1229 if (!usb3_req->req.length)
1232 if (usb3_dma_mps_to_prd_word1(usb3_ep) == USB3_PRD1_MPS_RESERVED)
1235 usb3_for_each_dma(usb3, dma, i) {
1239 if (usb_gadget_map_request(&usb3->gadget, &usb3_req->req,
1240 usb3_ep->dir_in) < 0)
1252 static void usb3_dma_put_setting_area(struct renesas_usb3_ep *usb3_ep,
1253 struct renesas_usb3_request *usb3_req)
1255 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1257 struct renesas_usb3_dma *dma;
1259 usb3_for_each_dma(usb3, dma, i) {
1260 if (usb3_ep->dma == dma) {
1261 usb_gadget_unmap_request(&usb3->gadget, &usb3_req->req,
1264 usb3_ep->dma = NULL;
1270 static void usb3_dma_fill_prd(struct renesas_usb3_ep *usb3_ep,
1271 struct renesas_usb3_request *usb3_req)
1273 struct renesas_usb3_prd *cur_prd = usb3_ep->dma->prd;
1274 u32 remain = usb3_req->req.length;
1275 u32 dma = usb3_req->req.dma;
1280 len = min_t(u32, remain, USB3_DMA_MAX_XFER_SIZE) &
1281 USB3_PRD1_SIZE_MASK;
1282 cur_prd->word1 = usb3_dma_mps_to_prd_word1(usb3_ep) |
1283 USB3_PRD1_B_INC | len;
1287 if (!remain || (i + 1) < USB3_DMA_NUM_PRD_ENTRIES)
1294 cur_prd->word1 |= USB3_PRD1_E | USB3_PRD1_INT;
1295 if (usb3_ep->dir_in)
1296 cur_prd->word1 |= USB3_PRD1_LST;
1299 static void usb3_dma_kick_prd(struct renesas_usb3_ep *usb3_ep)
1301 struct renesas_usb3_dma *dma = usb3_ep->dma;
1302 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1303 u32 dma_con = DMA_COM_PIPE_NO(usb3_ep->num) | DMA_CON_PRD_EN;
1305 if (usb3_ep->dir_in)
1306 dma_con |= DMA_CON_PIPE_DIR;
1308 wmb(); /* prd entries should be in system memory here */
1310 usb3_write(usb3, 1 << usb3_ep->num, USB3_DMA_INT_STA);
1311 usb3_write(usb3, AXI_INT_PRDEN_CLR_STA(dma->num) |
1312 AXI_INT_PRDERR_STA(dma->num), USB3_AXI_INT_STA);
1314 usb3_write(usb3, dma->prd_dma, USB3_DMA_CH0_PRD_ADR(dma->num));
1315 usb3_write(usb3, dma_con, USB3_DMA_CH0_CON(dma->num));
1316 usb3_enable_dma_irq(usb3, usb3_ep->num);
1319 static void usb3_dma_stop_prd(struct renesas_usb3_ep *usb3_ep)
1321 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1322 struct renesas_usb3_dma *dma = usb3_ep->dma;
1324 usb3_disable_dma_irq(usb3, usb3_ep->num);
1325 usb3_write(usb3, 0, USB3_DMA_CH0_CON(dma->num));
1328 static int usb3_dma_update_status(struct renesas_usb3_ep *usb3_ep,
1329 struct renesas_usb3_request *usb3_req)
1331 struct renesas_usb3_prd *cur_prd = usb3_ep->dma->prd;
1332 struct usb_request *req = &usb3_req->req;
1337 rmb(); /* The controller updated prd entries */
1340 if (cur_prd->word1 & USB3_PRD1_D)
1342 if (cur_prd->word1 & USB3_PRD1_E)
1343 len = req->length % USB3_DMA_MAX_XFER_SIZE;
1345 len = USB3_DMA_MAX_XFER_SIZE;
1346 remain = cur_prd->word1 & USB3_PRD1_SIZE_MASK;
1347 req->actual += len - remain;
1349 if (cur_prd->word1 & USB3_PRD1_E ||
1350 (i + 1) < USB3_DMA_NUM_PRD_ENTRIES)
1360 static bool usb3_dma_try_start(struct renesas_usb3_ep *usb3_ep,
1361 struct renesas_usb3_request *usb3_req)
1363 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1368 if (usb3_dma_get_setting_area(usb3_ep, usb3_req)) {
1370 usb3_enable_dma_pipen(usb3);
1371 usb3_dma_fill_prd(usb3_ep, usb3_req);
1372 usb3_dma_kick_prd(usb3_ep);
1373 usb3_pn_start(usb3);
1380 static int usb3_dma_try_stop(struct renesas_usb3_ep *usb3_ep,
1381 struct renesas_usb3_request *usb3_req)
1383 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1384 unsigned long flags;
1387 spin_lock_irqsave(&usb3->lock, flags);
1391 if (!usb3_pn_change(usb3, usb3_ep->num))
1392 usb3_disable_dma_pipen(usb3);
1393 usb3_dma_stop_prd(usb3_ep);
1394 status = usb3_dma_update_status(usb3_ep, usb3_req);
1395 usb3_dma_put_setting_area(usb3_ep, usb3_req);
1398 spin_unlock_irqrestore(&usb3->lock, flags);
1402 static int renesas_usb3_dma_free_prd(struct renesas_usb3 *usb3,
1406 struct renesas_usb3_dma *dma;
1408 usb3_for_each_dma(usb3, dma, i) {
1410 dma_free_coherent(dev, USB3_DMA_PRD_SIZE,
1411 dma->prd, dma->prd_dma);
1419 static int renesas_usb3_dma_alloc_prd(struct renesas_usb3 *usb3,
1423 struct renesas_usb3_dma *dma;
1428 usb3_for_each_dma(usb3, dma, i) {
1429 dma->prd = dma_alloc_coherent(dev, USB3_DMA_PRD_SIZE,
1430 &dma->prd_dma, GFP_KERNEL);
1432 renesas_usb3_dma_free_prd(usb3, dev);
1441 static void usb3_start_pipen(struct renesas_usb3_ep *usb3_ep,
1442 struct renesas_usb3_request *usb3_req)
1444 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1445 struct renesas_usb3_request *usb3_req_first;
1446 unsigned long flags;
1448 u32 enable_bits = 0;
1450 spin_lock_irqsave(&usb3->lock, flags);
1451 if (usb3_ep->halt || usb3_ep->started)
1453 usb3_req_first = __usb3_get_request(usb3_ep);
1454 if (!usb3_req_first || usb3_req != usb3_req_first)
1457 if (usb3_pn_change(usb3, usb3_ep->num) < 0)
1460 usb3_ep->started = true;
1462 if (usb3_dma_try_start(usb3_ep, usb3_req))
1465 usb3_pn_start(usb3);
1467 if (usb3_ep->dir_in) {
1468 ret = usb3_write_pipe(usb3_ep, usb3_req, USB3_PN_WRITE);
1469 enable_bits |= PN_INT_LSTTR;
1473 enable_bits |= PN_INT_BFRDY;
1476 usb3_set_bit(usb3, enable_bits, USB3_PN_INT_ENA);
1477 usb3_enable_pipe_irq(usb3, usb3_ep->num);
1480 spin_unlock_irqrestore(&usb3->lock, flags);
1483 static int renesas_usb3_ep_queue(struct usb_ep *_ep, struct usb_request *_req,
1486 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1487 struct renesas_usb3_request *usb3_req = usb_req_to_usb3_req(_req);
1488 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1489 unsigned long flags;
1491 dev_dbg(usb3_to_dev(usb3), "ep_queue: ep%2d, %u\n", usb3_ep->num,
1494 _req->status = -EINPROGRESS;
1496 spin_lock_irqsave(&usb3->lock, flags);
1497 list_add_tail(&usb3_req->queue, &usb3_ep->queue);
1498 spin_unlock_irqrestore(&usb3->lock, flags);
1501 usb3_start_pipe0(usb3_ep, usb3_req);
1503 usb3_start_pipen(usb3_ep, usb3_req);
1508 static void usb3_set_device_address(struct renesas_usb3 *usb3, u16 addr)
1510 /* DEV_ADDR bit field is cleared by WarmReset, HotReset and BusReset */
1511 usb3_set_bit(usb3, USB_COM_CON_DEV_ADDR(addr), USB3_USB_COM_CON);
1514 static bool usb3_std_req_set_address(struct renesas_usb3 *usb3,
1515 struct usb_ctrlrequest *ctrl)
1517 if (ctrl->wValue >= 128)
1518 return true; /* stall */
1520 usb3_set_device_address(usb3, ctrl->wValue);
1521 usb3_set_p0_con_for_no_data(usb3);
1526 static void usb3_pipe0_internal_xfer(struct renesas_usb3 *usb3,
1527 void *tx_data, size_t len,
1528 void (*complete)(struct usb_ep *ep,
1529 struct usb_request *req))
1531 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
1534 memcpy(usb3->ep0_buf, tx_data,
1535 min_t(size_t, len, USB3_EP0_BUF_SIZE));
1537 usb3->ep0_req->buf = &usb3->ep0_buf;
1538 usb3->ep0_req->length = len;
1539 usb3->ep0_req->complete = complete;
1540 renesas_usb3_ep_queue(&usb3_ep->ep, usb3->ep0_req, GFP_ATOMIC);
1543 static void usb3_pipe0_get_status_completion(struct usb_ep *ep,
1544 struct usb_request *req)
1548 static bool usb3_std_req_get_status(struct renesas_usb3 *usb3,
1549 struct usb_ctrlrequest *ctrl)
1552 struct renesas_usb3_ep *usb3_ep;
1556 switch (ctrl->bRequestType & USB_RECIP_MASK) {
1557 case USB_RECIP_DEVICE:
1558 if (usb3->gadget.is_selfpowered)
1559 status |= 1 << USB_DEVICE_SELF_POWERED;
1560 if (usb3->gadget.speed == USB_SPEED_SUPER)
1561 status |= usb3_feature_get_un_enabled(usb3);
1563 case USB_RECIP_INTERFACE:
1565 case USB_RECIP_ENDPOINT:
1566 num = le16_to_cpu(ctrl->wIndex) & USB_ENDPOINT_NUMBER_MASK;
1567 usb3_ep = usb3_get_ep(usb3, num);
1569 status |= 1 << USB_ENDPOINT_HALT;
1577 status = cpu_to_le16(status);
1578 dev_dbg(usb3_to_dev(usb3), "get_status: req = %p\n",
1579 usb_req_to_usb3_req(usb3->ep0_req));
1580 usb3_pipe0_internal_xfer(usb3, &status, sizeof(status),
1581 usb3_pipe0_get_status_completion);
1587 static bool usb3_std_req_feature_device(struct renesas_usb3 *usb3,
1588 struct usb_ctrlrequest *ctrl, bool set)
1591 u16 w_value = le16_to_cpu(ctrl->wValue);
1594 case USB_DEVICE_TEST_MODE:
1597 usb3->test_mode = le16_to_cpu(ctrl->wIndex) >> 8;
1600 case USB_DEVICE_U1_ENABLE:
1601 case USB_DEVICE_U2_ENABLE:
1602 if (usb3->gadget.speed != USB_SPEED_SUPER)
1604 if (w_value == USB_DEVICE_U1_ENABLE)
1605 usb3_feature_u1_enable(usb3, set);
1606 if (w_value == USB_DEVICE_U2_ENABLE)
1607 usb3_feature_u2_enable(usb3, set);
1617 static int usb3_set_halt_p0(struct renesas_usb3_ep *usb3_ep, bool halt)
1619 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1621 if (unlikely(usb3_ep->num))
1624 usb3_ep->halt = halt;
1626 usb3_set_p0_con_stall(usb3);
1628 usb3_set_p0_con_stop(usb3);
1633 static int usb3_set_halt_pn(struct renesas_usb3_ep *usb3_ep, bool halt,
1634 bool is_clear_feature)
1636 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1637 unsigned long flags;
1639 spin_lock_irqsave(&usb3->lock, flags);
1640 if (!usb3_pn_change(usb3, usb3_ep->num)) {
1641 usb3_ep->halt = halt;
1643 usb3_pn_stall(usb3);
1644 } else if (!is_clear_feature || !usb3_ep->wedge) {
1645 usb3_pn_con_clear(usb3);
1646 usb3_set_bit(usb3, PN_CON_EN, USB3_PN_CON);
1650 spin_unlock_irqrestore(&usb3->lock, flags);
1655 static int usb3_set_halt(struct renesas_usb3_ep *usb3_ep, bool halt,
1656 bool is_clear_feature)
1660 if (halt && usb3_ep->started)
1664 ret = usb3_set_halt_pn(usb3_ep, halt, is_clear_feature);
1666 ret = usb3_set_halt_p0(usb3_ep, halt);
1671 static bool usb3_std_req_feature_endpoint(struct renesas_usb3 *usb3,
1672 struct usb_ctrlrequest *ctrl,
1675 int num = le16_to_cpu(ctrl->wIndex) & USB_ENDPOINT_NUMBER_MASK;
1676 struct renesas_usb3_ep *usb3_ep;
1677 struct renesas_usb3_request *usb3_req;
1679 if (le16_to_cpu(ctrl->wValue) != USB_ENDPOINT_HALT)
1680 return true; /* stall */
1682 usb3_ep = usb3_get_ep(usb3, num);
1683 usb3_set_halt(usb3_ep, set, true);
1685 /* Restarts a queue if clear feature */
1687 usb3_ep->started = false;
1688 usb3_req = usb3_get_request(usb3_ep);
1690 usb3_start_pipen(usb3_ep, usb3_req);
1696 static bool usb3_std_req_feature(struct renesas_usb3 *usb3,
1697 struct usb_ctrlrequest *ctrl, bool set)
1701 switch (ctrl->bRequestType & USB_RECIP_MASK) {
1702 case USB_RECIP_DEVICE:
1703 stall = usb3_std_req_feature_device(usb3, ctrl, set);
1705 case USB_RECIP_INTERFACE:
1707 case USB_RECIP_ENDPOINT:
1708 stall = usb3_std_req_feature_endpoint(usb3, ctrl, set);
1716 usb3_set_p0_con_for_no_data(usb3);
1721 static void usb3_pipe0_set_sel_completion(struct usb_ep *ep,
1722 struct usb_request *req)
1727 static bool usb3_std_req_set_sel(struct renesas_usb3 *usb3,
1728 struct usb_ctrlrequest *ctrl)
1730 u16 w_length = le16_to_cpu(ctrl->wLength);
1733 return true; /* stall */
1735 dev_dbg(usb3_to_dev(usb3), "set_sel: req = %p\n",
1736 usb_req_to_usb3_req(usb3->ep0_req));
1737 usb3_pipe0_internal_xfer(usb3, NULL, 6, usb3_pipe0_set_sel_completion);
1742 static bool usb3_std_req_set_configuration(struct renesas_usb3 *usb3,
1743 struct usb_ctrlrequest *ctrl)
1745 if (ctrl->wValue > 0)
1746 usb3_set_bit(usb3, USB_COM_CON_CONF, USB3_USB_COM_CON);
1748 usb3_clear_bit(usb3, USB_COM_CON_CONF, USB3_USB_COM_CON);
1754 * usb3_handle_standard_request - handle some standard requests
1755 * @usb3: the renesas_usb3 pointer
1756 * @ctrl: a pointer of setup data
1758 * Returns true if this function handled a standard request
1760 static bool usb3_handle_standard_request(struct renesas_usb3 *usb3,
1761 struct usb_ctrlrequest *ctrl)
1766 if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
1767 switch (ctrl->bRequest) {
1768 case USB_REQ_SET_ADDRESS:
1769 stall = usb3_std_req_set_address(usb3, ctrl);
1772 case USB_REQ_GET_STATUS:
1773 stall = usb3_std_req_get_status(usb3, ctrl);
1776 case USB_REQ_CLEAR_FEATURE:
1777 stall = usb3_std_req_feature(usb3, ctrl, false);
1780 case USB_REQ_SET_FEATURE:
1781 stall = usb3_std_req_feature(usb3, ctrl, true);
1784 case USB_REQ_SET_SEL:
1785 stall = usb3_std_req_set_sel(usb3, ctrl);
1788 case USB_REQ_SET_ISOCH_DELAY:
1789 /* This hardware doesn't support Isochronous xfer */
1793 case USB_REQ_SET_CONFIGURATION:
1794 usb3_std_req_set_configuration(usb3, ctrl);
1802 usb3_set_p0_con_stall(usb3);
1807 static int usb3_p0_con_clear_buffer(struct renesas_usb3 *usb3)
1809 usb3_set_bit(usb3, P0_CON_BCLR, USB3_P0_CON);
1811 return usb3_wait(usb3, USB3_P0_CON, P0_CON_BCLR, 0);
1814 static void usb3_irq_epc_pipe0_setup(struct renesas_usb3 *usb3)
1816 struct usb_ctrlrequest ctrl;
1817 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
1819 /* Call giveback function if previous transfer is not completed */
1820 if (usb3_ep->started)
1821 usb3_request_done(usb3_ep, usb3_get_request(usb3_ep),
1824 usb3_p0_con_clear_buffer(usb3);
1825 usb3_get_setup_data(usb3, &ctrl);
1826 if (!usb3_handle_standard_request(usb3, &ctrl))
1827 if (usb3->driver->setup(&usb3->gadget, &ctrl) < 0)
1828 usb3_set_p0_con_stall(usb3);
1831 static void usb3_irq_epc_pipe0_bfrdy(struct renesas_usb3 *usb3)
1833 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
1834 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
1839 usb3_p0_xfer(usb3_ep, usb3_req);
1842 static void usb3_irq_epc_pipe0(struct renesas_usb3 *usb3)
1844 u32 p0_int_sta = usb3_read(usb3, USB3_P0_INT_STA);
1846 p0_int_sta &= usb3_read(usb3, USB3_P0_INT_ENA);
1847 usb3_write(usb3, p0_int_sta, USB3_P0_INT_STA);
1848 if (p0_int_sta & P0_INT_STSED)
1849 usb3_irq_epc_pipe0_status_end(usb3);
1850 if (p0_int_sta & P0_INT_SETUP)
1851 usb3_irq_epc_pipe0_setup(usb3);
1852 if (p0_int_sta & P0_INT_BFRDY)
1853 usb3_irq_epc_pipe0_bfrdy(usb3);
1856 static void usb3_request_done_pipen(struct renesas_usb3 *usb3,
1857 struct renesas_usb3_ep *usb3_ep,
1858 struct renesas_usb3_request *usb3_req,
1861 unsigned long flags;
1863 spin_lock_irqsave(&usb3->lock, flags);
1864 if (usb3_pn_change(usb3, usb3_ep->num))
1866 spin_unlock_irqrestore(&usb3->lock, flags);
1868 usb3_disable_pipe_irq(usb3, usb3_ep->num);
1869 usb3_request_done(usb3_ep, usb3_req, status);
1871 /* get next usb3_req */
1872 usb3_req = usb3_get_request(usb3_ep);
1874 usb3_start_pipen(usb3_ep, usb3_req);
1877 static void usb3_irq_epc_pipen_lsttr(struct renesas_usb3 *usb3, int num)
1879 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, num);
1880 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
1885 if (usb3_ep->dir_in) {
1886 dev_dbg(usb3_to_dev(usb3), "%s: len = %u, actual = %u\n",
1887 __func__, usb3_req->req.length, usb3_req->req.actual);
1888 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, 0);
1892 static void usb3_irq_epc_pipen_bfrdy(struct renesas_usb3 *usb3, int num)
1894 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, num);
1895 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
1901 spin_lock(&usb3->lock);
1902 if (usb3_pn_change(usb3, num))
1905 if (usb3_ep->dir_in) {
1906 /* Do not stop the IN pipe here to detect LSTTR interrupt */
1907 if (!usb3_write_pipe(usb3_ep, usb3_req, USB3_PN_WRITE))
1908 usb3_clear_bit(usb3, PN_INT_BFRDY, USB3_PN_INT_ENA);
1910 if (!usb3_read_pipe(usb3_ep, usb3_req, USB3_PN_READ))
1915 /* need to unlock because usb3_request_done_pipen() locks it */
1916 spin_unlock(&usb3->lock);
1919 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, 0);
1922 static void usb3_irq_epc_pipen(struct renesas_usb3 *usb3, int num)
1926 spin_lock(&usb3->lock);
1927 if (usb3_pn_change(usb3, num) < 0) {
1928 spin_unlock(&usb3->lock);
1932 pn_int_sta = usb3_read(usb3, USB3_PN_INT_STA);
1933 pn_int_sta &= usb3_read(usb3, USB3_PN_INT_ENA);
1934 usb3_write(usb3, pn_int_sta, USB3_PN_INT_STA);
1935 spin_unlock(&usb3->lock);
1936 if (pn_int_sta & PN_INT_LSTTR)
1937 usb3_irq_epc_pipen_lsttr(usb3, num);
1938 if (pn_int_sta & PN_INT_BFRDY)
1939 usb3_irq_epc_pipen_bfrdy(usb3, num);
1942 static void usb3_irq_epc_int_2(struct renesas_usb3 *usb3, u32 int_sta_2)
1946 for (i = 0; i < usb3->num_usb3_eps; i++) {
1947 if (int_sta_2 & USB_INT_2_PIPE(i)) {
1949 usb3_irq_epc_pipe0(usb3);
1951 usb3_irq_epc_pipen(usb3, i);
1956 static void usb3_irq_idmon_change(struct renesas_usb3 *usb3)
1958 usb3_check_id(usb3);
1961 static void usb3_irq_otg_int(struct renesas_usb3 *usb3, u32 otg_int_sta)
1963 if (otg_int_sta & USB_OTG_IDMON)
1964 usb3_irq_idmon_change(usb3);
1967 static void usb3_irq_epc(struct renesas_usb3 *usb3)
1969 u32 int_sta_1 = usb3_read(usb3, USB3_USB_INT_STA_1);
1970 u32 int_sta_2 = usb3_read(usb3, USB3_USB_INT_STA_2);
1971 u32 otg_int_sta = usb3_read(usb3, USB3_USB_OTG_INT_STA);
1973 int_sta_1 &= usb3_read(usb3, USB3_USB_INT_ENA_1);
1975 usb3_write(usb3, int_sta_1, USB3_USB_INT_STA_1);
1976 usb3_irq_epc_int_1(usb3, int_sta_1);
1979 int_sta_2 &= usb3_read(usb3, USB3_USB_INT_ENA_2);
1981 usb3_irq_epc_int_2(usb3, int_sta_2);
1983 otg_int_sta &= usb3_read(usb3, USB3_USB_OTG_INT_ENA);
1985 usb3_write(usb3, otg_int_sta, USB3_USB_OTG_INT_STA);
1986 usb3_irq_otg_int(usb3, otg_int_sta);
1990 static void usb3_irq_dma_int(struct renesas_usb3 *usb3, u32 dma_sta)
1992 struct renesas_usb3_ep *usb3_ep;
1993 struct renesas_usb3_request *usb3_req;
1996 for (i = 0; i < usb3->num_usb3_eps; i++) {
1997 if (!(dma_sta & DMA_INT(i)))
2000 usb3_ep = usb3_get_ep(usb3, i);
2001 if (!(usb3_read(usb3, USB3_AXI_INT_STA) &
2002 AXI_INT_PRDEN_CLR_STA(usb3_ep->dma->num)))
2005 usb3_req = usb3_get_request(usb3_ep);
2006 status = usb3_dma_try_stop(usb3_ep, usb3_req);
2007 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, status);
2011 static void usb3_irq_dma(struct renesas_usb3 *usb3)
2013 u32 dma_sta = usb3_read(usb3, USB3_DMA_INT_STA);
2015 dma_sta &= usb3_read(usb3, USB3_DMA_INT_ENA);
2017 usb3_write(usb3, dma_sta, USB3_DMA_INT_STA);
2018 usb3_irq_dma_int(usb3, dma_sta);
2022 static irqreturn_t renesas_usb3_irq(int irq, void *_usb3)
2024 struct renesas_usb3 *usb3 = _usb3;
2025 irqreturn_t ret = IRQ_NONE;
2026 u32 axi_int_sta = usb3_read(usb3, USB3_AXI_INT_STA);
2028 if (axi_int_sta & AXI_INT_DMAINT) {
2033 if (axi_int_sta & AXI_INT_EPCINT) {
2041 static void usb3_write_pn_mod(struct renesas_usb3_ep *usb3_ep,
2042 const struct usb_endpoint_descriptor *desc)
2044 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
2047 val |= usb3_ep->dir_in ? PN_MOD_DIR : 0;
2048 val |= PN_MOD_TYPE(usb_endpoint_type(desc));
2049 val |= PN_MOD_EPNUM(usb_endpoint_num(desc));
2050 usb3_write(usb3, val, USB3_PN_MOD);
2053 static u32 usb3_calc_ramarea(int ram_size)
2055 WARN_ON(ram_size > SZ_16K);
2057 if (ram_size <= SZ_1K)
2058 return PN_RAMMAP_RAMAREA_1KB;
2059 else if (ram_size <= SZ_2K)
2060 return PN_RAMMAP_RAMAREA_2KB;
2061 else if (ram_size <= SZ_4K)
2062 return PN_RAMMAP_RAMAREA_4KB;
2063 else if (ram_size <= SZ_8K)
2064 return PN_RAMMAP_RAMAREA_8KB;
2066 return PN_RAMMAP_RAMAREA_16KB;
2069 static u32 usb3_calc_rammap_val(struct renesas_usb3_ep *usb3_ep,
2070 const struct usb_endpoint_descriptor *desc)
2073 const u32 max_packet_array[] = {8, 16, 32, 64, 512};
2074 u32 mpkt = PN_RAMMAP_MPKT(1024);
2076 for (i = 0; i < ARRAY_SIZE(max_packet_array); i++) {
2077 if (usb_endpoint_maxp(desc) <= max_packet_array[i])
2078 mpkt = PN_RAMMAP_MPKT(max_packet_array[i]);
2081 return usb3_ep->rammap_val | mpkt;
2084 static int usb3_enable_pipe_n(struct renesas_usb3_ep *usb3_ep,
2085 const struct usb_endpoint_descriptor *desc)
2087 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
2088 unsigned long flags;
2090 usb3_ep->dir_in = usb_endpoint_dir_in(desc);
2092 spin_lock_irqsave(&usb3->lock, flags);
2093 if (!usb3_pn_change(usb3, usb3_ep->num)) {
2094 usb3_write_pn_mod(usb3_ep, desc);
2095 usb3_write(usb3, usb3_calc_rammap_val(usb3_ep, desc),
2097 usb3_pn_con_clear(usb3);
2098 usb3_set_bit(usb3, PN_CON_EN, USB3_PN_CON);
2100 spin_unlock_irqrestore(&usb3->lock, flags);
2105 static int usb3_disable_pipe_n(struct renesas_usb3_ep *usb3_ep)
2107 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
2108 unsigned long flags;
2110 usb3_ep->halt = false;
2112 spin_lock_irqsave(&usb3->lock, flags);
2113 if (!usb3_pn_change(usb3, usb3_ep->num)) {
2114 usb3_write(usb3, 0, USB3_PN_INT_ENA);
2115 usb3_write(usb3, 0, USB3_PN_RAMMAP);
2116 usb3_clear_bit(usb3, PN_CON_EN, USB3_PN_CON);
2118 spin_unlock_irqrestore(&usb3->lock, flags);
2123 /*------- usb_ep_ops -----------------------------------------------------*/
2124 static int renesas_usb3_ep_enable(struct usb_ep *_ep,
2125 const struct usb_endpoint_descriptor *desc)
2127 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
2129 return usb3_enable_pipe_n(usb3_ep, desc);
2132 static int renesas_usb3_ep_disable(struct usb_ep *_ep)
2134 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
2135 struct renesas_usb3_request *usb3_req;
2138 usb3_req = usb3_get_request(usb3_ep);
2141 usb3_dma_try_stop(usb3_ep, usb3_req);
2142 usb3_request_done(usb3_ep, usb3_req, -ESHUTDOWN);
2145 return usb3_disable_pipe_n(usb3_ep);
2148 static struct usb_request *__renesas_usb3_ep_alloc_request(gfp_t gfp_flags)
2150 struct renesas_usb3_request *usb3_req;
2152 usb3_req = kzalloc(sizeof(struct renesas_usb3_request), gfp_flags);
2156 INIT_LIST_HEAD(&usb3_req->queue);
2158 return &usb3_req->req;
2161 static void __renesas_usb3_ep_free_request(struct usb_request *_req)
2163 struct renesas_usb3_request *usb3_req = usb_req_to_usb3_req(_req);
2168 static struct usb_request *renesas_usb3_ep_alloc_request(struct usb_ep *_ep,
2171 return __renesas_usb3_ep_alloc_request(gfp_flags);
2174 static void renesas_usb3_ep_free_request(struct usb_ep *_ep,
2175 struct usb_request *_req)
2177 __renesas_usb3_ep_free_request(_req);
2180 static int renesas_usb3_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req)
2182 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
2183 struct renesas_usb3_request *usb3_req = usb_req_to_usb3_req(_req);
2184 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
2186 dev_dbg(usb3_to_dev(usb3), "ep_dequeue: ep%2d, %u\n", usb3_ep->num,
2189 usb3_dma_try_stop(usb3_ep, usb3_req);
2190 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, -ECONNRESET);
2195 static int renesas_usb3_ep_set_halt(struct usb_ep *_ep, int value)
2197 return usb3_set_halt(usb_ep_to_usb3_ep(_ep), !!value, false);
2200 static int renesas_usb3_ep_set_wedge(struct usb_ep *_ep)
2202 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
2204 usb3_ep->wedge = true;
2205 return usb3_set_halt(usb3_ep, true, false);
2208 static void renesas_usb3_ep_fifo_flush(struct usb_ep *_ep)
2210 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
2211 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
2212 unsigned long flags;
2215 spin_lock_irqsave(&usb3->lock, flags);
2216 if (!usb3_pn_change(usb3, usb3_ep->num)) {
2217 usb3_pn_con_clear(usb3);
2218 usb3_set_bit(usb3, PN_CON_EN, USB3_PN_CON);
2220 spin_unlock_irqrestore(&usb3->lock, flags);
2222 usb3_p0_con_clear_buffer(usb3);
2226 static const struct usb_ep_ops renesas_usb3_ep_ops = {
2227 .enable = renesas_usb3_ep_enable,
2228 .disable = renesas_usb3_ep_disable,
2230 .alloc_request = renesas_usb3_ep_alloc_request,
2231 .free_request = renesas_usb3_ep_free_request,
2233 .queue = renesas_usb3_ep_queue,
2234 .dequeue = renesas_usb3_ep_dequeue,
2236 .set_halt = renesas_usb3_ep_set_halt,
2237 .set_wedge = renesas_usb3_ep_set_wedge,
2238 .fifo_flush = renesas_usb3_ep_fifo_flush,
2241 /*------- usb_gadget_ops -------------------------------------------------*/
2242 static int renesas_usb3_start(struct usb_gadget *gadget,
2243 struct usb_gadget_driver *driver)
2245 struct renesas_usb3 *usb3;
2247 if (!driver || driver->max_speed < USB_SPEED_FULL ||
2251 usb3 = gadget_to_renesas_usb3(gadget);
2253 /* hook up the driver */
2254 usb3->driver = driver;
2256 pm_runtime_enable(usb3_to_dev(usb3));
2257 pm_runtime_get_sync(usb3_to_dev(usb3));
2259 renesas_usb3_init_controller(usb3);
2264 static int renesas_usb3_stop(struct usb_gadget *gadget)
2266 struct renesas_usb3 *usb3 = gadget_to_renesas_usb3(gadget);
2268 usb3->softconnect = false;
2269 usb3->gadget.speed = USB_SPEED_UNKNOWN;
2270 usb3->driver = NULL;
2271 renesas_usb3_stop_controller(usb3);
2273 pm_runtime_put(usb3_to_dev(usb3));
2274 pm_runtime_disable(usb3_to_dev(usb3));
2279 static int renesas_usb3_get_frame(struct usb_gadget *_gadget)
2284 static int renesas_usb3_pullup(struct usb_gadget *gadget, int is_on)
2286 struct renesas_usb3 *usb3 = gadget_to_renesas_usb3(gadget);
2288 usb3->softconnect = !!is_on;
2293 static int renesas_usb3_set_selfpowered(struct usb_gadget *gadget, int is_self)
2295 gadget->is_selfpowered = !!is_self;
2300 static const struct usb_gadget_ops renesas_usb3_gadget_ops = {
2301 .get_frame = renesas_usb3_get_frame,
2302 .udc_start = renesas_usb3_start,
2303 .udc_stop = renesas_usb3_stop,
2304 .pullup = renesas_usb3_pullup,
2305 .set_selfpowered = renesas_usb3_set_selfpowered,
2308 static ssize_t role_store(struct device *dev, struct device_attribute *attr,
2309 const char *buf, size_t count)
2311 struct renesas_usb3 *usb3 = dev_get_drvdata(dev);
2312 bool new_mode_is_host;
2317 if (usb3->forced_b_device)
2320 if (sysfs_streq(buf, "host"))
2321 new_mode_is_host = true;
2322 else if (sysfs_streq(buf, "peripheral"))
2323 new_mode_is_host = false;
2327 if (new_mode_is_host == usb3_is_host(usb3))
2330 usb3_mode_config(usb3, new_mode_is_host, usb3_is_a_device(usb3));
2335 static ssize_t role_show(struct device *dev, struct device_attribute *attr,
2338 struct renesas_usb3 *usb3 = dev_get_drvdata(dev);
2343 return sprintf(buf, "%s\n", usb3_is_host(usb3) ? "host" : "peripheral");
2345 static DEVICE_ATTR_RW(role);
2347 static int renesas_usb3_b_device_show(struct seq_file *s, void *unused)
2349 struct renesas_usb3 *usb3 = s->private;
2351 seq_printf(s, "%d\n", usb3->forced_b_device);
2356 static int renesas_usb3_b_device_open(struct inode *inode, struct file *file)
2358 return single_open(file, renesas_usb3_b_device_show, inode->i_private);
2361 static ssize_t renesas_usb3_b_device_write(struct file *file,
2362 const char __user *ubuf,
2363 size_t count, loff_t *ppos)
2365 struct seq_file *s = file->private_data;
2366 struct renesas_usb3 *usb3 = s->private;
2372 if (copy_from_user(&buf, ubuf, min_t(size_t, sizeof(buf) - 1, count)))
2375 usb3->start_to_connect = false;
2376 if (usb3->workaround_for_vbus && usb3->forced_b_device &&
2377 !strncmp(buf, "2", 1))
2378 usb3->start_to_connect = true;
2379 else if (!strncmp(buf, "1", 1))
2380 usb3->forced_b_device = true;
2382 usb3->forced_b_device = false;
2384 if (usb3->workaround_for_vbus)
2385 usb3_disconnect(usb3);
2387 /* Let this driver call usb3_connect() if needed */
2388 usb3_check_id(usb3);
2393 static const struct file_operations renesas_usb3_b_device_fops = {
2394 .open = renesas_usb3_b_device_open,
2395 .write = renesas_usb3_b_device_write,
2397 .llseek = seq_lseek,
2398 .release = single_release,
2401 static void renesas_usb3_debugfs_init(struct renesas_usb3 *usb3,
2404 struct dentry *root, *file;
2406 root = debugfs_create_dir(dev_name(dev), NULL);
2407 if (IS_ERR_OR_NULL(root)) {
2408 dev_info(dev, "%s: Can't create the root\n", __func__);
2412 file = debugfs_create_file("b_device", 0644, root, usb3,
2413 &renesas_usb3_b_device_fops);
2415 dev_info(dev, "%s: Can't create debugfs mode\n", __func__);
2416 debugfs_remove_recursive(root);
2418 usb3->dentry = root;
2422 /*------- platform_driver ------------------------------------------------*/
2423 static int renesas_usb3_remove(struct platform_device *pdev)
2425 struct renesas_usb3 *usb3 = platform_get_drvdata(pdev);
2427 debugfs_remove_recursive(usb3->dentry);
2428 device_remove_file(&pdev->dev, &dev_attr_role);
2430 usb_del_gadget_udc(&usb3->gadget);
2431 renesas_usb3_dma_free_prd(usb3, &pdev->dev);
2433 __renesas_usb3_ep_free_request(usb3->ep0_req);
2438 static int renesas_usb3_init_ep(struct renesas_usb3 *usb3, struct device *dev,
2439 const struct renesas_usb3_priv *priv)
2441 struct renesas_usb3_ep *usb3_ep;
2444 /* calculate num_usb3_eps from renesas_usb3_priv */
2445 usb3->num_usb3_eps = priv->ramsize_per_ramif * priv->num_ramif * 2 /
2446 priv->ramsize_per_pipe + 1;
2448 if (usb3->num_usb3_eps > USB3_MAX_NUM_PIPES)
2449 usb3->num_usb3_eps = USB3_MAX_NUM_PIPES;
2451 usb3->usb3_ep = devm_kzalloc(dev, sizeof(*usb3_ep) * usb3->num_usb3_eps,
2456 dev_dbg(dev, "%s: num_usb3_eps = %d\n", __func__, usb3->num_usb3_eps);
2458 * This driver prepares pipes as follows:
2459 * - odd pipes = IN pipe
2460 * - even pipes = OUT pipe (except pipe 0)
2462 usb3_for_each_ep(usb3_ep, usb3, i) {
2463 snprintf(usb3_ep->ep_name, sizeof(usb3_ep->ep_name), "ep%d", i);
2464 usb3_ep->usb3 = usb3;
2466 usb3_ep->ep.name = usb3_ep->ep_name;
2467 usb3_ep->ep.ops = &renesas_usb3_ep_ops;
2468 INIT_LIST_HEAD(&usb3_ep->queue);
2469 INIT_LIST_HEAD(&usb3_ep->ep.ep_list);
2471 /* for control pipe */
2472 usb3->gadget.ep0 = &usb3_ep->ep;
2473 usb_ep_set_maxpacket_limit(&usb3_ep->ep,
2474 USB3_EP0_SS_MAX_PACKET_SIZE);
2475 usb3_ep->ep.caps.type_control = true;
2476 usb3_ep->ep.caps.dir_in = true;
2477 usb3_ep->ep.caps.dir_out = true;
2481 /* for bulk or interrupt pipe */
2482 usb_ep_set_maxpacket_limit(&usb3_ep->ep, ~0);
2483 list_add_tail(&usb3_ep->ep.ep_list, &usb3->gadget.ep_list);
2484 usb3_ep->ep.caps.type_bulk = true;
2485 usb3_ep->ep.caps.type_int = true;
2487 usb3_ep->ep.caps.dir_in = true;
2489 usb3_ep->ep.caps.dir_out = true;
2495 static void renesas_usb3_init_ram(struct renesas_usb3 *usb3, struct device *dev,
2496 const struct renesas_usb3_priv *priv)
2498 struct renesas_usb3_ep *usb3_ep;
2500 u32 ramif[2], basead[2]; /* index 0 = for IN pipes */
2501 u32 *cur_ramif, *cur_basead;
2504 memset(ramif, 0, sizeof(ramif));
2505 memset(basead, 0, sizeof(basead));
2508 * This driver prepares pipes as follows:
2509 * - all pipes = the same size as "ramsize_per_pipe"
2510 * Please refer to the "Method of Specifying RAM Mapping"
2512 usb3_for_each_ep(usb3_ep, usb3, i) {
2514 continue; /* out of scope if ep num = 0 */
2515 if (usb3_ep->ep.caps.dir_in) {
2516 cur_ramif = &ramif[0];
2517 cur_basead = &basead[0];
2519 cur_ramif = &ramif[1];
2520 cur_basead = &basead[1];
2523 if (*cur_basead > priv->ramsize_per_ramif)
2524 continue; /* out of memory for IN or OUT pipe */
2526 /* calculate rammap_val */
2527 val = PN_RAMMAP_RAMIF(*cur_ramif);
2528 val |= usb3_calc_ramarea(priv->ramsize_per_pipe);
2529 val |= PN_RAMMAP_BASEAD(*cur_basead);
2530 usb3_ep->rammap_val = val;
2532 dev_dbg(dev, "ep%2d: val = %08x, ramif = %d, base = %x\n",
2533 i, val, *cur_ramif, *cur_basead);
2535 /* update current ramif */
2536 if (*cur_ramif + 1 == priv->num_ramif) {
2538 *cur_basead += priv->ramsize_per_pipe;
2545 static const struct renesas_usb3_priv renesas_usb3_priv_r8a7795_es1 = {
2546 .ramsize_per_ramif = SZ_16K,
2548 .ramsize_per_pipe = SZ_4K,
2549 .workaround_for_vbus = true,
2552 static const struct renesas_usb3_priv renesas_usb3_priv_gen3 = {
2553 .ramsize_per_ramif = SZ_16K,
2555 .ramsize_per_pipe = SZ_4K,
2558 static const struct of_device_id usb3_of_match[] = {
2560 .compatible = "renesas,r8a7795-usb3-peri",
2561 .data = &renesas_usb3_priv_gen3,
2564 .compatible = "renesas,rcar-gen3-usb3-peri",
2565 .data = &renesas_usb3_priv_gen3,
2569 MODULE_DEVICE_TABLE(of, usb3_of_match);
2571 static const struct soc_device_attribute renesas_usb3_quirks_match[] = {
2573 .soc_id = "r8a7795", .revision = "ES1.*",
2574 .data = &renesas_usb3_priv_r8a7795_es1,
2579 static const unsigned int renesas_usb3_cable[] = {
2585 static int renesas_usb3_probe(struct platform_device *pdev)
2587 struct renesas_usb3 *usb3;
2588 struct resource *res;
2589 const struct of_device_id *match;
2591 const struct renesas_usb3_priv *priv;
2592 const struct soc_device_attribute *attr;
2594 match = of_match_node(usb3_of_match, pdev->dev.of_node);
2598 attr = soc_device_match(renesas_usb3_quirks_match);
2604 irq = platform_get_irq(pdev, 0);
2606 dev_err(&pdev->dev, "Failed to get IRQ: %d\n", irq);
2610 usb3 = devm_kzalloc(&pdev->dev, sizeof(*usb3), GFP_KERNEL);
2614 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2615 usb3->reg = devm_ioremap_resource(&pdev->dev, res);
2616 if (IS_ERR(usb3->reg))
2617 return PTR_ERR(usb3->reg);
2619 platform_set_drvdata(pdev, usb3);
2620 spin_lock_init(&usb3->lock);
2622 usb3->gadget.ops = &renesas_usb3_gadget_ops;
2623 usb3->gadget.name = udc_name;
2624 usb3->gadget.max_speed = USB_SPEED_SUPER;
2625 INIT_LIST_HEAD(&usb3->gadget.ep_list);
2626 ret = renesas_usb3_init_ep(usb3, &pdev->dev, priv);
2629 renesas_usb3_init_ram(usb3, &pdev->dev, priv);
2631 ret = devm_request_irq(&pdev->dev, irq, renesas_usb3_irq, 0,
2632 dev_name(&pdev->dev), usb3);
2636 INIT_WORK(&usb3->extcon_work, renesas_usb3_extcon_work);
2637 usb3->extcon = devm_extcon_dev_allocate(&pdev->dev, renesas_usb3_cable);
2638 if (IS_ERR(usb3->extcon))
2639 return PTR_ERR(usb3->extcon);
2641 ret = devm_extcon_dev_register(&pdev->dev, usb3->extcon);
2643 dev_err(&pdev->dev, "Failed to register extcon\n");
2647 /* for ep0 handling */
2648 usb3->ep0_req = __renesas_usb3_ep_alloc_request(GFP_KERNEL);
2652 ret = renesas_usb3_dma_alloc_prd(usb3, &pdev->dev);
2656 ret = usb_add_gadget_udc(&pdev->dev, &usb3->gadget);
2660 ret = device_create_file(&pdev->dev, &dev_attr_role);
2662 goto err_dev_create;
2664 usb3->workaround_for_vbus = priv->workaround_for_vbus;
2666 renesas_usb3_debugfs_init(usb3, &pdev->dev);
2668 dev_info(&pdev->dev, "probed\n");
2673 usb_del_gadget_udc(&usb3->gadget);
2676 renesas_usb3_dma_free_prd(usb3, &pdev->dev);
2679 __renesas_usb3_ep_free_request(usb3->ep0_req);
2684 static struct platform_driver renesas_usb3_driver = {
2685 .probe = renesas_usb3_probe,
2686 .remove = renesas_usb3_remove,
2688 .name = (char *)udc_name,
2689 .of_match_table = of_match_ptr(usb3_of_match),
2692 module_platform_driver(renesas_usb3_driver);
2694 MODULE_DESCRIPTION("Renesas USB3.0 Peripheral driver");
2695 MODULE_LICENSE("GPL v2");
2696 MODULE_AUTHOR("Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>");
2697 MODULE_ALIAS("platform:renesas_usb3");