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/delay.h>
12 #include <linux/err.h>
13 #include <linux/extcon.h>
14 #include <linux/interrupt.h>
16 #include <linux/module.h>
17 #include <linux/of_device.h>
18 #include <linux/platform_device.h>
19 #include <linux/pm_runtime.h>
20 #include <linux/sizes.h>
21 #include <linux/slab.h>
22 #include <linux/usb/ch9.h>
23 #include <linux/usb/gadget.h>
25 /* register definitions */
26 #define USB3_AXI_INT_STA 0x008
27 #define USB3_AXI_INT_ENA 0x00c
28 #define USB3_DMA_INT_STA 0x010
29 #define USB3_DMA_INT_ENA 0x014
30 #define USB3_USB_COM_CON 0x200
31 #define USB3_USB20_CON 0x204
32 #define USB3_USB30_CON 0x208
33 #define USB3_USB_STA 0x210
34 #define USB3_DRD_CON 0x218
35 #define USB3_USB_INT_STA_1 0x220
36 #define USB3_USB_INT_STA_2 0x224
37 #define USB3_USB_INT_ENA_1 0x228
38 #define USB3_USB_INT_ENA_2 0x22c
39 #define USB3_STUP_DAT_0 0x230
40 #define USB3_STUP_DAT_1 0x234
41 #define USB3_USB_OTG_STA 0x268
42 #define USB3_USB_OTG_INT_STA 0x26c
43 #define USB3_USB_OTG_INT_ENA 0x270
44 #define USB3_P0_MOD 0x280
45 #define USB3_P0_CON 0x288
46 #define USB3_P0_STA 0x28c
47 #define USB3_P0_INT_STA 0x290
48 #define USB3_P0_INT_ENA 0x294
49 #define USB3_P0_LNG 0x2a0
50 #define USB3_P0_READ 0x2a4
51 #define USB3_P0_WRITE 0x2a8
52 #define USB3_PIPE_COM 0x2b0
53 #define USB3_PN_MOD 0x2c0
54 #define USB3_PN_RAMMAP 0x2c4
55 #define USB3_PN_CON 0x2c8
56 #define USB3_PN_STA 0x2cc
57 #define USB3_PN_INT_STA 0x2d0
58 #define USB3_PN_INT_ENA 0x2d4
59 #define USB3_PN_LNG 0x2e0
60 #define USB3_PN_READ 0x2e4
61 #define USB3_PN_WRITE 0x2e8
62 #define USB3_SSIFCMD 0x340
64 /* AXI_INT_ENA and AXI_INT_STA */
65 #define AXI_INT_DMAINT BIT(31)
66 #define AXI_INT_EPCINT BIT(30)
69 #define LCLKSEL_LSEL BIT(18)
72 #define USB_COM_CON_CONF BIT(24)
73 #define USB_COM_CON_SPD_MODE BIT(17)
74 #define USB_COM_CON_EP0_EN BIT(16)
75 #define USB_COM_CON_DEV_ADDR_SHIFT 8
76 #define USB_COM_CON_DEV_ADDR_MASK GENMASK(14, USB_COM_CON_DEV_ADDR_SHIFT)
77 #define USB_COM_CON_DEV_ADDR(n) (((n) << USB_COM_CON_DEV_ADDR_SHIFT) & \
78 USB_COM_CON_DEV_ADDR_MASK)
79 #define USB_COM_CON_RX_DETECTION BIT(1)
80 #define USB_COM_CON_PIPE_CLR BIT(0)
83 #define USB20_CON_B2_PUE BIT(31)
84 #define USB20_CON_B2_SUSPEND BIT(24)
85 #define USB20_CON_B2_CONNECT BIT(17)
86 #define USB20_CON_B2_TSTMOD_SHIFT 8
87 #define USB20_CON_B2_TSTMOD_MASK GENMASK(10, USB20_CON_B2_TSTMOD_SHIFT)
88 #define USB20_CON_B2_TSTMOD(n) (((n) << USB20_CON_B2_TSTMOD_SHIFT) & \
89 USB20_CON_B2_TSTMOD_MASK)
90 #define USB20_CON_B2_TSTMOD_EN BIT(0)
93 #define USB30_CON_POW_SEL_SHIFT 24
94 #define USB30_CON_POW_SEL_MASK GENMASK(26, USB30_CON_POW_SEL_SHIFT)
95 #define USB30_CON_POW_SEL_IN_U3 BIT(26)
96 #define USB30_CON_POW_SEL_IN_DISCON 0
97 #define USB30_CON_POW_SEL_P2_TO_P0 BIT(25)
98 #define USB30_CON_POW_SEL_P0_TO_P3 BIT(24)
99 #define USB30_CON_POW_SEL_P0_TO_P2 0
100 #define USB30_CON_B3_PLLWAKE BIT(23)
101 #define USB30_CON_B3_CONNECT BIT(17)
102 #define USB30_CON_B3_HOTRST_CMP BIT(1)
105 #define USB_STA_SPEED_MASK (BIT(2) | BIT(1))
106 #define USB_STA_SPEED_HS BIT(2)
107 #define USB_STA_SPEED_FS BIT(1)
108 #define USB_STA_SPEED_SS 0
109 #define USB_STA_VBUS_STA BIT(0)
112 #define DRD_CON_PERI_CON BIT(24)
113 #define DRD_CON_VBOUT BIT(0)
115 /* USB_INT_ENA_1 and USB_INT_STA_1 */
116 #define USB_INT_1_B3_PLLWKUP BIT(31)
117 #define USB_INT_1_B3_LUPSUCS BIT(30)
118 #define USB_INT_1_B3_DISABLE BIT(27)
119 #define USB_INT_1_B3_WRMRST BIT(21)
120 #define USB_INT_1_B3_HOTRST BIT(20)
121 #define USB_INT_1_B2_USBRST BIT(12)
122 #define USB_INT_1_B2_L1SPND BIT(11)
123 #define USB_INT_1_B2_SPND BIT(9)
124 #define USB_INT_1_B2_RSUM BIT(8)
125 #define USB_INT_1_SPEED BIT(1)
126 #define USB_INT_1_VBUS_CNG BIT(0)
128 /* USB_INT_ENA_2 and USB_INT_STA_2 */
129 #define USB_INT_2_PIPE(n) BIT(n)
131 /* USB_OTG_STA, USB_OTG_INT_STA and USB_OTG_INT_ENA */
132 #define USB_OTG_IDMON BIT(4)
135 #define P0_MOD_DIR BIT(6)
137 /* P0_CON and PN_CON */
138 #define PX_CON_BYTE_EN_MASK (BIT(10) | BIT(9))
139 #define PX_CON_BYTE_EN_SHIFT 9
140 #define PX_CON_BYTE_EN_BYTES(n) (((n) << PX_CON_BYTE_EN_SHIFT) & \
142 #define PX_CON_SEND BIT(8)
145 #define P0_CON_ST_RES_MASK (BIT(27) | BIT(26))
146 #define P0_CON_ST_RES_FORCE_STALL BIT(27)
147 #define P0_CON_ST_RES_NORMAL BIT(26)
148 #define P0_CON_ST_RES_FORCE_NRDY 0
149 #define P0_CON_OT_RES_MASK (BIT(25) | BIT(24))
150 #define P0_CON_OT_RES_FORCE_STALL BIT(25)
151 #define P0_CON_OT_RES_NORMAL BIT(24)
152 #define P0_CON_OT_RES_FORCE_NRDY 0
153 #define P0_CON_IN_RES_MASK (BIT(17) | BIT(16))
154 #define P0_CON_IN_RES_FORCE_STALL BIT(17)
155 #define P0_CON_IN_RES_NORMAL BIT(16)
156 #define P0_CON_IN_RES_FORCE_NRDY 0
157 #define P0_CON_RES_WEN BIT(7)
158 #define P0_CON_BCLR BIT(1)
160 /* P0_STA and PN_STA */
161 #define PX_STA_BUFSTS BIT(0)
163 /* P0_INT_ENA and P0_INT_STA */
164 #define P0_INT_STSED BIT(18)
165 #define P0_INT_STSST BIT(17)
166 #define P0_INT_SETUP BIT(16)
167 #define P0_INT_RCVNL BIT(8)
168 #define P0_INT_ERDY BIT(7)
169 #define P0_INT_FLOW BIT(6)
170 #define P0_INT_STALL BIT(2)
171 #define P0_INT_NRDY BIT(1)
172 #define P0_INT_BFRDY BIT(0)
173 #define P0_INT_ALL_BITS (P0_INT_STSED | P0_INT_SETUP | P0_INT_BFRDY)
176 #define PN_MOD_DIR BIT(6)
177 #define PN_MOD_TYPE_SHIFT 4
178 #define PN_MOD_TYPE_MASK GENMASK(5, PN_MOD_TYPE_SHIFT)
179 #define PN_MOD_TYPE(n) (((n) << PN_MOD_TYPE_SHIFT) & \
181 #define PN_MOD_EPNUM_MASK GENMASK(3, 0)
182 #define PN_MOD_EPNUM(n) ((n) & PN_MOD_EPNUM_MASK)
185 #define PN_RAMMAP_RAMAREA_SHIFT 29
186 #define PN_RAMMAP_RAMAREA_MASK GENMASK(31, PN_RAMMAP_RAMAREA_SHIFT)
187 #define PN_RAMMAP_RAMAREA_16KB BIT(31)
188 #define PN_RAMMAP_RAMAREA_8KB (BIT(30) | BIT(29))
189 #define PN_RAMMAP_RAMAREA_4KB BIT(30)
190 #define PN_RAMMAP_RAMAREA_2KB BIT(29)
191 #define PN_RAMMAP_RAMAREA_1KB 0
192 #define PN_RAMMAP_MPKT_SHIFT 16
193 #define PN_RAMMAP_MPKT_MASK GENMASK(26, PN_RAMMAP_MPKT_SHIFT)
194 #define PN_RAMMAP_MPKT(n) (((n) << PN_RAMMAP_MPKT_SHIFT) & \
196 #define PN_RAMMAP_RAMIF_SHIFT 14
197 #define PN_RAMMAP_RAMIF_MASK GENMASK(15, PN_RAMMAP_RAMIF_SHIFT)
198 #define PN_RAMMAP_RAMIF(n) (((n) << PN_RAMMAP_RAMIF_SHIFT) & \
199 PN_RAMMAP_RAMIF_MASK)
200 #define PN_RAMMAP_BASEAD_MASK GENMASK(13, 0)
201 #define PN_RAMMAP_BASEAD(offs) (((offs) >> 3) & PN_RAMMAP_BASEAD_MASK)
202 #define PN_RAMMAP_DATA(area, ramif, basead) ((PN_RAMMAP_##area) | \
203 (PN_RAMMAP_RAMIF(ramif)) | \
204 (PN_RAMMAP_BASEAD(basead)))
207 #define PN_CON_EN BIT(31)
208 #define PN_CON_DATAIF_EN BIT(30)
209 #define PN_CON_RES_MASK (BIT(17) | BIT(16))
210 #define PN_CON_RES_FORCE_STALL BIT(17)
211 #define PN_CON_RES_NORMAL BIT(16)
212 #define PN_CON_RES_FORCE_NRDY 0
213 #define PN_CON_LAST BIT(11)
214 #define PN_CON_RES_WEN BIT(7)
215 #define PN_CON_CLR BIT(0)
217 /* PN_INT_STA and PN_INT_ENA */
218 #define PN_INT_LSTTR BIT(4)
219 #define PN_INT_BFRDY BIT(0)
222 #define SSIFCMD_URES_U2 BIT(9)
223 #define SSIFCMD_URES_U1 BIT(8)
224 #define SSIFCMD_UDIR_U2 BIT(7)
225 #define SSIFCMD_UDIR_U1 BIT(6)
226 #define SSIFCMD_UREQ_U2 BIT(5)
227 #define SSIFCMD_UREQ_U1 BIT(4)
229 #define USB3_EP0_SS_MAX_PACKET_SIZE 512
230 #define USB3_EP0_HSFS_MAX_PACKET_SIZE 64
231 #define USB3_EP0_BUF_SIZE 8
232 #define USB3_MAX_NUM_PIPES 30
233 #define USB3_WAIT_US 3
236 struct renesas_usb3_request {
237 struct usb_request req;
238 struct list_head queue;
241 #define USB3_EP_NAME_SIZE 8
242 struct renesas_usb3_ep {
244 struct renesas_usb3 *usb3;
246 char ep_name[USB3_EP_NAME_SIZE];
247 struct list_head queue;
255 struct renesas_usb3_priv {
256 int ramsize_per_ramif; /* unit = bytes */
258 int ramsize_per_pipe; /* unit = bytes */
259 bool workaround_for_vbus; /* if true, don't check vbus signal */
262 struct renesas_usb3 {
265 struct usb_gadget gadget;
266 struct usb_gadget_driver *driver;
267 struct extcon_dev *extcon;
268 struct work_struct extcon_work;
270 struct renesas_usb3_ep *usb3_ep;
276 struct usb_request *ep0_req;
278 u8 ep0_buf[USB3_EP0_BUF_SIZE];
280 bool workaround_for_vbus;
281 bool extcon_host; /* check id and set EXTCON_USB_HOST */
282 bool extcon_usb; /* check vbus and set EXTCON_USB */
285 #define gadget_to_renesas_usb3(_gadget) \
286 container_of(_gadget, struct renesas_usb3, gadget)
287 #define renesas_usb3_to_gadget(renesas_usb3) (&renesas_usb3->gadget)
288 #define usb3_to_dev(_usb3) (_usb3->gadget.dev.parent)
290 #define usb_ep_to_usb3_ep(_ep) container_of(_ep, struct renesas_usb3_ep, ep)
291 #define usb3_ep_to_usb3(_usb3_ep) (_usb3_ep->usb3)
292 #define usb_req_to_usb3_req(_req) container_of(_req, \
293 struct renesas_usb3_request, req)
295 #define usb3_get_ep(usb3, n) ((usb3)->usb3_ep + (n))
296 #define usb3_for_each_ep(usb3_ep, usb3, i) \
297 for ((i) = 0, usb3_ep = usb3_get_ep(usb3, (i)); \
298 (i) < (usb3)->num_usb3_eps; \
299 (i)++, usb3_ep = usb3_get_ep(usb3, (i)))
301 static const char udc_name[] = "renesas_usb3";
303 static void usb3_write(struct renesas_usb3 *usb3, u32 data, u32 offs)
305 iowrite32(data, usb3->reg + offs);
308 static u32 usb3_read(struct renesas_usb3 *usb3, u32 offs)
310 return ioread32(usb3->reg + offs);
313 static void usb3_set_bit(struct renesas_usb3 *usb3, u32 bits, u32 offs)
315 u32 val = usb3_read(usb3, offs);
318 usb3_write(usb3, val, offs);
321 static void usb3_clear_bit(struct renesas_usb3 *usb3, u32 bits, u32 offs)
323 u32 val = usb3_read(usb3, offs);
326 usb3_write(usb3, val, offs);
329 static int usb3_wait(struct renesas_usb3 *usb3, u32 reg, u32 mask,
334 for (i = 0; i < USB3_WAIT_US; i++) {
335 if ((usb3_read(usb3, reg) & mask) == expected)
340 dev_dbg(usb3_to_dev(usb3), "%s: timed out (%8x, %08x, %08x)\n",
341 __func__, reg, mask, expected);
346 static void renesas_usb3_extcon_work(struct work_struct *work)
348 struct renesas_usb3 *usb3 = container_of(work, struct renesas_usb3,
351 extcon_set_state_sync(usb3->extcon, EXTCON_USB_HOST, usb3->extcon_host);
352 extcon_set_state_sync(usb3->extcon, EXTCON_USB, usb3->extcon_usb);
355 static void usb3_enable_irq_1(struct renesas_usb3 *usb3, u32 bits)
357 usb3_set_bit(usb3, bits, USB3_USB_INT_ENA_1);
360 static void usb3_disable_irq_1(struct renesas_usb3 *usb3, u32 bits)
362 usb3_clear_bit(usb3, bits, USB3_USB_INT_ENA_1);
365 static void usb3_enable_pipe_irq(struct renesas_usb3 *usb3, int num)
367 usb3_set_bit(usb3, USB_INT_2_PIPE(num), USB3_USB_INT_ENA_2);
370 static void usb3_disable_pipe_irq(struct renesas_usb3 *usb3, int num)
372 usb3_clear_bit(usb3, USB_INT_2_PIPE(num), USB3_USB_INT_ENA_2);
375 static bool usb3_is_host(struct renesas_usb3 *usb3)
377 return !(usb3_read(usb3, USB3_DRD_CON) & DRD_CON_PERI_CON);
380 static void usb3_init_axi_bridge(struct renesas_usb3 *usb3)
383 usb3_write(usb3, ~0, USB3_DMA_INT_STA);
384 usb3_write(usb3, 0, USB3_DMA_INT_ENA);
385 usb3_set_bit(usb3, AXI_INT_DMAINT | AXI_INT_EPCINT, USB3_AXI_INT_ENA);
388 static void usb3_init_epc_registers(struct renesas_usb3 *usb3)
390 usb3_write(usb3, ~0, USB3_USB_INT_STA_1);
391 usb3_enable_irq_1(usb3, USB_INT_1_VBUS_CNG);
394 static bool usb3_wakeup_usb2_phy(struct renesas_usb3 *usb3)
396 if (!(usb3_read(usb3, USB3_USB20_CON) & USB20_CON_B2_SUSPEND))
397 return true; /* already waked it up */
399 usb3_clear_bit(usb3, USB20_CON_B2_SUSPEND, USB3_USB20_CON);
400 usb3_enable_irq_1(usb3, USB_INT_1_B2_RSUM);
405 static void usb3_usb2_pullup(struct renesas_usb3 *usb3, int pullup)
407 u32 bits = USB20_CON_B2_PUE | USB20_CON_B2_CONNECT;
409 if (usb3->softconnect && pullup)
410 usb3_set_bit(usb3, bits, USB3_USB20_CON);
412 usb3_clear_bit(usb3, bits, USB3_USB20_CON);
415 static void usb3_set_test_mode(struct renesas_usb3 *usb3)
417 u32 val = usb3_read(usb3, USB3_USB20_CON);
419 val &= ~USB20_CON_B2_TSTMOD_MASK;
420 val |= USB20_CON_B2_TSTMOD(usb3->test_mode);
421 usb3_write(usb3, val | USB20_CON_B2_TSTMOD_EN, USB3_USB20_CON);
422 if (!usb3->test_mode)
423 usb3_clear_bit(usb3, USB20_CON_B2_TSTMOD_EN, USB3_USB20_CON);
426 static void usb3_start_usb2_connection(struct renesas_usb3 *usb3)
428 usb3->disabled_count++;
429 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
430 usb3_set_bit(usb3, USB_COM_CON_SPD_MODE, USB3_USB_COM_CON);
431 usb3_usb2_pullup(usb3, 1);
434 static int usb3_is_usb3_phy_in_u3(struct renesas_usb3 *usb3)
436 return usb3_read(usb3, USB3_USB30_CON) & USB30_CON_POW_SEL_IN_U3;
439 static bool usb3_wakeup_usb3_phy(struct renesas_usb3 *usb3)
441 if (!usb3_is_usb3_phy_in_u3(usb3))
442 return true; /* already waked it up */
444 usb3_set_bit(usb3, USB30_CON_B3_PLLWAKE, USB3_USB30_CON);
445 usb3_enable_irq_1(usb3, USB_INT_1_B3_PLLWKUP);
450 static u16 usb3_feature_get_un_enabled(struct renesas_usb3 *usb3)
452 u32 mask_u2 = SSIFCMD_UDIR_U2 | SSIFCMD_UREQ_U2;
453 u32 mask_u1 = SSIFCMD_UDIR_U1 | SSIFCMD_UREQ_U1;
454 u32 val = usb3_read(usb3, USB3_SSIFCMD);
457 /* Enables {U2,U1} if the bits of UDIR and UREQ are set to 0 */
458 if (!(val & mask_u2))
459 ret |= 1 << USB_DEV_STAT_U2_ENABLED;
460 if (!(val & mask_u1))
461 ret |= 1 << USB_DEV_STAT_U1_ENABLED;
466 static void usb3_feature_u2_enable(struct renesas_usb3 *usb3, bool enable)
468 u32 bits = SSIFCMD_UDIR_U2 | SSIFCMD_UREQ_U2;
470 /* Enables U2 if the bits of UDIR and UREQ are set to 0 */
472 usb3_clear_bit(usb3, bits, USB3_SSIFCMD);
474 usb3_set_bit(usb3, bits, USB3_SSIFCMD);
477 static void usb3_feature_u1_enable(struct renesas_usb3 *usb3, bool enable)
479 u32 bits = SSIFCMD_UDIR_U1 | SSIFCMD_UREQ_U1;
481 /* Enables U1 if the bits of UDIR and UREQ are set to 0 */
483 usb3_clear_bit(usb3, bits, USB3_SSIFCMD);
485 usb3_set_bit(usb3, bits, USB3_SSIFCMD);
488 static void usb3_start_operation_for_usb3(struct renesas_usb3 *usb3)
490 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
491 usb3_clear_bit(usb3, USB_COM_CON_SPD_MODE, USB3_USB_COM_CON);
492 usb3_set_bit(usb3, USB30_CON_B3_CONNECT, USB3_USB30_CON);
495 static void usb3_start_usb3_connection(struct renesas_usb3 *usb3)
497 usb3_start_operation_for_usb3(usb3);
498 usb3_set_bit(usb3, USB_COM_CON_RX_DETECTION, USB3_USB_COM_CON);
500 usb3_enable_irq_1(usb3, USB_INT_1_B3_LUPSUCS | USB_INT_1_B3_DISABLE |
504 static void usb3_stop_usb3_connection(struct renesas_usb3 *usb3)
506 usb3_clear_bit(usb3, USB30_CON_B3_CONNECT, USB3_USB30_CON);
509 static void usb3_transition_to_default_state(struct renesas_usb3 *usb3,
512 usb3_set_bit(usb3, USB_INT_2_PIPE(0), USB3_USB_INT_ENA_2);
513 usb3_write(usb3, P0_INT_ALL_BITS, USB3_P0_INT_STA);
514 usb3_set_bit(usb3, P0_INT_ALL_BITS, USB3_P0_INT_ENA);
517 usb3_enable_irq_1(usb3, USB_INT_1_B3_WRMRST |
518 USB_INT_1_B3_HOTRST);
520 usb3_enable_irq_1(usb3, USB_INT_1_B2_SPND |
521 USB_INT_1_B2_L1SPND | USB_INT_1_B2_USBRST);
524 static void usb3_connect(struct renesas_usb3 *usb3)
526 if (usb3_wakeup_usb3_phy(usb3))
527 usb3_start_usb3_connection(usb3);
530 static void usb3_reset_epc(struct renesas_usb3 *usb3)
532 usb3_clear_bit(usb3, USB_COM_CON_CONF, USB3_USB_COM_CON);
533 usb3_clear_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
534 usb3_set_bit(usb3, USB_COM_CON_PIPE_CLR, USB3_USB_COM_CON);
536 usb3_set_test_mode(usb3);
539 static void usb3_disconnect(struct renesas_usb3 *usb3)
541 usb3->disabled_count = 0;
542 usb3_usb2_pullup(usb3, 0);
543 usb3_clear_bit(usb3, USB30_CON_B3_CONNECT, USB3_USB30_CON);
544 usb3_reset_epc(usb3);
547 usb3->driver->disconnect(&usb3->gadget);
550 static void usb3_check_vbus(struct renesas_usb3 *usb3)
552 if (usb3->workaround_for_vbus) {
555 usb3->extcon_usb = !!(usb3_read(usb3, USB3_USB_STA) &
557 if (usb3->extcon_usb)
560 usb3_disconnect(usb3);
562 schedule_work(&usb3->extcon_work);
566 static void usb3_set_mode(struct renesas_usb3 *usb3, bool host)
569 usb3_clear_bit(usb3, DRD_CON_PERI_CON, USB3_DRD_CON);
571 usb3_set_bit(usb3, DRD_CON_PERI_CON, USB3_DRD_CON);
574 static void usb3_vbus_out(struct renesas_usb3 *usb3, bool enable)
577 usb3_set_bit(usb3, DRD_CON_VBOUT, USB3_DRD_CON);
579 usb3_clear_bit(usb3, DRD_CON_VBOUT, USB3_DRD_CON);
582 static void usb3_mode_config(struct renesas_usb3 *usb3, bool host, bool a_dev)
586 spin_lock_irqsave(&usb3->lock, flags);
587 usb3_set_mode(usb3, host);
588 usb3_vbus_out(usb3, a_dev);
589 if (!host && a_dev) /* for A-Peripheral */
591 spin_unlock_irqrestore(&usb3->lock, flags);
594 static bool usb3_is_a_device(struct renesas_usb3 *usb3)
596 return !(usb3_read(usb3, USB3_USB_OTG_STA) & USB_OTG_IDMON);
599 static void usb3_check_id(struct renesas_usb3 *usb3)
601 usb3->extcon_host = usb3_is_a_device(usb3);
603 if (usb3->extcon_host)
604 usb3_mode_config(usb3, true, true);
606 usb3_mode_config(usb3, false, false);
608 schedule_work(&usb3->extcon_work);
611 static void renesas_usb3_init_controller(struct renesas_usb3 *usb3)
613 usb3_init_axi_bridge(usb3);
614 usb3_init_epc_registers(usb3);
615 usb3_write(usb3, USB_OTG_IDMON, USB3_USB_OTG_INT_STA);
616 usb3_write(usb3, USB_OTG_IDMON, USB3_USB_OTG_INT_ENA);
619 usb3_check_vbus(usb3);
622 static void renesas_usb3_stop_controller(struct renesas_usb3 *usb3)
624 usb3_disconnect(usb3);
625 usb3_write(usb3, 0, USB3_P0_INT_ENA);
626 usb3_write(usb3, 0, USB3_USB_OTG_INT_ENA);
627 usb3_write(usb3, 0, USB3_USB_INT_ENA_1);
628 usb3_write(usb3, 0, USB3_USB_INT_ENA_2);
629 usb3_write(usb3, 0, USB3_AXI_INT_ENA);
632 static void usb3_irq_epc_int_1_pll_wakeup(struct renesas_usb3 *usb3)
634 usb3_disable_irq_1(usb3, USB_INT_1_B3_PLLWKUP);
635 usb3_clear_bit(usb3, USB30_CON_B3_PLLWAKE, USB3_USB30_CON);
636 usb3_start_usb3_connection(usb3);
639 static void usb3_irq_epc_int_1_linkup_success(struct renesas_usb3 *usb3)
641 usb3_transition_to_default_state(usb3, true);
644 static void usb3_irq_epc_int_1_resume(struct renesas_usb3 *usb3)
646 usb3_disable_irq_1(usb3, USB_INT_1_B2_RSUM);
647 usb3_start_usb2_connection(usb3);
648 usb3_transition_to_default_state(usb3, false);
651 static void usb3_irq_epc_int_1_disable(struct renesas_usb3 *usb3)
653 usb3_stop_usb3_connection(usb3);
654 if (usb3_wakeup_usb2_phy(usb3))
655 usb3_irq_epc_int_1_resume(usb3);
658 static void usb3_irq_epc_int_1_bus_reset(struct renesas_usb3 *usb3)
660 usb3_reset_epc(usb3);
661 if (usb3->disabled_count < 3)
662 usb3_start_usb3_connection(usb3);
664 usb3_start_usb2_connection(usb3);
667 static void usb3_irq_epc_int_1_vbus_change(struct renesas_usb3 *usb3)
669 usb3_check_vbus(usb3);
672 static void usb3_irq_epc_int_1_hot_reset(struct renesas_usb3 *usb3)
674 usb3_reset_epc(usb3);
675 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
677 /* This bit shall be set within 12ms from the start of HotReset */
678 usb3_set_bit(usb3, USB30_CON_B3_HOTRST_CMP, USB3_USB30_CON);
681 static void usb3_irq_epc_int_1_warm_reset(struct renesas_usb3 *usb3)
683 usb3_reset_epc(usb3);
684 usb3_set_bit(usb3, USB_COM_CON_EP0_EN, USB3_USB_COM_CON);
686 usb3_start_operation_for_usb3(usb3);
687 usb3_enable_irq_1(usb3, USB_INT_1_SPEED);
690 static void usb3_irq_epc_int_1_speed(struct renesas_usb3 *usb3)
692 u32 speed = usb3_read(usb3, USB3_USB_STA) & USB_STA_SPEED_MASK;
695 case USB_STA_SPEED_SS:
696 usb3->gadget.speed = USB_SPEED_SUPER;
698 case USB_STA_SPEED_HS:
699 usb3->gadget.speed = USB_SPEED_HIGH;
701 case USB_STA_SPEED_FS:
702 usb3->gadget.speed = USB_SPEED_FULL;
705 usb3->gadget.speed = USB_SPEED_UNKNOWN;
710 static void usb3_irq_epc_int_1(struct renesas_usb3 *usb3, u32 int_sta_1)
712 if (int_sta_1 & USB_INT_1_B3_PLLWKUP)
713 usb3_irq_epc_int_1_pll_wakeup(usb3);
715 if (int_sta_1 & USB_INT_1_B3_LUPSUCS)
716 usb3_irq_epc_int_1_linkup_success(usb3);
718 if (int_sta_1 & USB_INT_1_B3_HOTRST)
719 usb3_irq_epc_int_1_hot_reset(usb3);
721 if (int_sta_1 & USB_INT_1_B3_WRMRST)
722 usb3_irq_epc_int_1_warm_reset(usb3);
724 if (int_sta_1 & USB_INT_1_B3_DISABLE)
725 usb3_irq_epc_int_1_disable(usb3);
727 if (int_sta_1 & USB_INT_1_B2_USBRST)
728 usb3_irq_epc_int_1_bus_reset(usb3);
730 if (int_sta_1 & USB_INT_1_B2_RSUM)
731 usb3_irq_epc_int_1_resume(usb3);
733 if (int_sta_1 & USB_INT_1_SPEED)
734 usb3_irq_epc_int_1_speed(usb3);
736 if (int_sta_1 & USB_INT_1_VBUS_CNG)
737 usb3_irq_epc_int_1_vbus_change(usb3);
740 static struct renesas_usb3_request *__usb3_get_request(struct renesas_usb3_ep
743 return list_first_entry_or_null(&usb3_ep->queue,
744 struct renesas_usb3_request, queue);
747 static struct renesas_usb3_request *usb3_get_request(struct renesas_usb3_ep
750 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
751 struct renesas_usb3_request *usb3_req;
754 spin_lock_irqsave(&usb3->lock, flags);
755 usb3_req = __usb3_get_request(usb3_ep);
756 spin_unlock_irqrestore(&usb3->lock, flags);
761 static void usb3_request_done(struct renesas_usb3_ep *usb3_ep,
762 struct renesas_usb3_request *usb3_req, int status)
764 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
767 dev_dbg(usb3_to_dev(usb3), "giveback: ep%2d, %u, %u, %d\n",
768 usb3_ep->num, usb3_req->req.length, usb3_req->req.actual,
770 usb3_req->req.status = status;
771 spin_lock_irqsave(&usb3->lock, flags);
772 usb3_ep->started = false;
773 list_del_init(&usb3_req->queue);
774 spin_unlock_irqrestore(&usb3->lock, flags);
775 usb_gadget_giveback_request(&usb3_ep->ep, &usb3_req->req);
778 static void usb3_irq_epc_pipe0_status_end(struct renesas_usb3 *usb3)
780 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
781 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
784 usb3_request_done(usb3_ep, usb3_req, 0);
786 usb3_set_test_mode(usb3);
789 static void usb3_get_setup_data(struct renesas_usb3 *usb3,
790 struct usb_ctrlrequest *ctrl)
792 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
793 u32 *data = (u32 *)ctrl;
795 *data++ = usb3_read(usb3, USB3_STUP_DAT_0);
796 *data = usb3_read(usb3, USB3_STUP_DAT_1);
798 /* update this driver's flag */
799 usb3_ep->dir_in = !!(ctrl->bRequestType & USB_DIR_IN);
802 static void usb3_set_p0_con_update_res(struct renesas_usb3 *usb3, u32 res)
804 u32 val = usb3_read(usb3, USB3_P0_CON);
806 val &= ~(P0_CON_ST_RES_MASK | P0_CON_OT_RES_MASK | P0_CON_IN_RES_MASK);
807 val |= res | P0_CON_RES_WEN;
808 usb3_write(usb3, val, USB3_P0_CON);
811 static void usb3_set_p0_con_for_ctrl_read_data(struct renesas_usb3 *usb3)
813 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_NRDY |
814 P0_CON_OT_RES_FORCE_STALL |
815 P0_CON_IN_RES_NORMAL);
818 static void usb3_set_p0_con_for_ctrl_read_status(struct renesas_usb3 *usb3)
820 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_NORMAL |
821 P0_CON_OT_RES_FORCE_STALL |
822 P0_CON_IN_RES_NORMAL);
825 static void usb3_set_p0_con_for_ctrl_write_data(struct renesas_usb3 *usb3)
827 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_NRDY |
828 P0_CON_OT_RES_NORMAL |
829 P0_CON_IN_RES_FORCE_STALL);
832 static void usb3_set_p0_con_for_ctrl_write_status(struct renesas_usb3 *usb3)
834 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_NORMAL |
835 P0_CON_OT_RES_NORMAL |
836 P0_CON_IN_RES_FORCE_STALL);
839 static void usb3_set_p0_con_for_no_data(struct renesas_usb3 *usb3)
841 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_NORMAL |
842 P0_CON_OT_RES_FORCE_STALL |
843 P0_CON_IN_RES_FORCE_STALL);
846 static void usb3_set_p0_con_stall(struct renesas_usb3 *usb3)
848 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_STALL |
849 P0_CON_OT_RES_FORCE_STALL |
850 P0_CON_IN_RES_FORCE_STALL);
853 static void usb3_set_p0_con_stop(struct renesas_usb3 *usb3)
855 usb3_set_p0_con_update_res(usb3, P0_CON_ST_RES_FORCE_NRDY |
856 P0_CON_OT_RES_FORCE_NRDY |
857 P0_CON_IN_RES_FORCE_NRDY);
860 static int usb3_pn_change(struct renesas_usb3 *usb3, int num)
862 if (num == 0 || num > usb3->num_usb3_eps)
865 usb3_write(usb3, num, USB3_PIPE_COM);
870 static void usb3_set_pn_con_update_res(struct renesas_usb3 *usb3, u32 res)
872 u32 val = usb3_read(usb3, USB3_PN_CON);
874 val &= ~PN_CON_RES_MASK;
875 val |= res & PN_CON_RES_MASK;
876 val |= PN_CON_RES_WEN;
877 usb3_write(usb3, val, USB3_PN_CON);
880 static void usb3_pn_start(struct renesas_usb3 *usb3)
882 usb3_set_pn_con_update_res(usb3, PN_CON_RES_NORMAL);
885 static void usb3_pn_stop(struct renesas_usb3 *usb3)
887 usb3_set_pn_con_update_res(usb3, PN_CON_RES_FORCE_NRDY);
890 static void usb3_pn_stall(struct renesas_usb3 *usb3)
892 usb3_set_pn_con_update_res(usb3, PN_CON_RES_FORCE_STALL);
895 static int usb3_pn_con_clear(struct renesas_usb3 *usb3)
897 usb3_set_bit(usb3, PN_CON_CLR, USB3_PN_CON);
899 return usb3_wait(usb3, USB3_PN_CON, PN_CON_CLR, 0);
902 static bool usb3_is_transfer_complete(struct renesas_usb3_ep *usb3_ep,
903 struct renesas_usb3_request *usb3_req)
905 struct usb_request *req = &usb3_req->req;
907 if ((!req->zero && req->actual == req->length) ||
908 (req->actual % usb3_ep->ep.maxpacket) || (req->length == 0))
914 static int usb3_wait_pipe_status(struct renesas_usb3_ep *usb3_ep, u32 mask)
916 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
917 u32 sta_reg = usb3_ep->num ? USB3_PN_STA : USB3_P0_STA;
919 return usb3_wait(usb3, sta_reg, mask, mask);
922 static void usb3_set_px_con_send(struct renesas_usb3_ep *usb3_ep, int bytes,
925 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
926 u32 con_reg = usb3_ep->num ? USB3_PN_CON : USB3_P0_CON;
927 u32 val = usb3_read(usb3, con_reg);
929 val |= PX_CON_SEND | PX_CON_BYTE_EN_BYTES(bytes);
930 val |= (usb3_ep->num && last) ? PN_CON_LAST : 0;
931 usb3_write(usb3, val, con_reg);
934 static int usb3_write_pipe(struct renesas_usb3_ep *usb3_ep,
935 struct renesas_usb3_request *usb3_req,
938 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
940 int len = min_t(unsigned, usb3_req->req.length - usb3_req->req.actual,
941 usb3_ep->ep.maxpacket);
942 u8 *buf = usb3_req->req.buf + usb3_req->req.actual;
946 if (usb3_wait_pipe_status(usb3_ep, PX_STA_BUFSTS) < 0)
949 /* Update gadget driver parameter */
950 usb3_req->req.actual += len;
952 /* Write data to the register */
954 iowrite32_rep(usb3->reg + fifo_reg, buf, len / 4);
955 buf += (len / 4) * 4;
956 len %= 4; /* update len to use usb3_set_pX_con_send() */
960 for (i = 0; i < len; i++)
961 tmp |= buf[i] << (8 * i);
962 usb3_write(usb3, tmp, fifo_reg);
965 is_last = usb3_is_transfer_complete(usb3_ep, usb3_req);
967 usb3_set_px_con_send(usb3_ep, len, is_last);
969 return is_last ? 0 : -EAGAIN;
972 static u32 usb3_get_received_length(struct renesas_usb3_ep *usb3_ep)
974 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
975 u32 lng_reg = usb3_ep->num ? USB3_PN_LNG : USB3_P0_LNG;
977 return usb3_read(usb3, lng_reg);
980 static int usb3_read_pipe(struct renesas_usb3_ep *usb3_ep,
981 struct renesas_usb3_request *usb3_req, u32 fifo_reg)
983 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
985 int len = min_t(unsigned, usb3_req->req.length - usb3_req->req.actual,
986 usb3_get_received_length(usb3_ep));
987 u8 *buf = usb3_req->req.buf + usb3_req->req.actual;
993 /* Update gadget driver parameter */
994 usb3_req->req.actual += len;
996 /* Read data from the register */
998 ioread32_rep(usb3->reg + fifo_reg, buf, len / 4);
999 buf += (len / 4) * 4;
1004 tmp = usb3_read(usb3, fifo_reg);
1005 for (i = 0; i < len; i++)
1006 buf[i] = (tmp >> (8 * i)) & 0xff;
1009 return usb3_is_transfer_complete(usb3_ep, usb3_req) ? 0 : -EAGAIN;
1012 static void usb3_set_status_stage(struct renesas_usb3_ep *usb3_ep,
1013 struct renesas_usb3_request *usb3_req)
1015 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1017 if (usb3_ep->dir_in) {
1018 usb3_set_p0_con_for_ctrl_read_status(usb3);
1020 if (!usb3_req->req.length)
1021 usb3_set_p0_con_for_no_data(usb3);
1023 usb3_set_p0_con_for_ctrl_write_status(usb3);
1027 static void usb3_p0_xfer(struct renesas_usb3_ep *usb3_ep,
1028 struct renesas_usb3_request *usb3_req)
1032 if (usb3_ep->dir_in)
1033 ret = usb3_write_pipe(usb3_ep, usb3_req, USB3_P0_WRITE);
1035 ret = usb3_read_pipe(usb3_ep, usb3_req, USB3_P0_READ);
1038 usb3_set_status_stage(usb3_ep, usb3_req);
1041 static void usb3_start_pipe0(struct renesas_usb3_ep *usb3_ep,
1042 struct renesas_usb3_request *usb3_req)
1044 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1046 if (usb3_ep->started)
1049 usb3_ep->started = true;
1051 if (usb3_ep->dir_in) {
1052 usb3_set_bit(usb3, P0_MOD_DIR, USB3_P0_MOD);
1053 usb3_set_p0_con_for_ctrl_read_data(usb3);
1055 usb3_clear_bit(usb3, P0_MOD_DIR, USB3_P0_MOD);
1056 usb3_set_p0_con_for_ctrl_write_data(usb3);
1059 usb3_p0_xfer(usb3_ep, usb3_req);
1062 static void usb3_start_pipen(struct renesas_usb3_ep *usb3_ep,
1063 struct renesas_usb3_request *usb3_req)
1065 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1066 struct renesas_usb3_request *usb3_req_first = usb3_get_request(usb3_ep);
1067 unsigned long flags;
1069 u32 enable_bits = 0;
1071 if (usb3_ep->halt || usb3_ep->started)
1073 if (usb3_req != usb3_req_first)
1076 spin_lock_irqsave(&usb3->lock, flags);
1077 if (usb3_pn_change(usb3, usb3_ep->num) < 0)
1080 usb3_ep->started = true;
1081 usb3_pn_start(usb3);
1083 if (usb3_ep->dir_in) {
1084 ret = usb3_write_pipe(usb3_ep, usb3_req, USB3_PN_WRITE);
1085 enable_bits |= PN_INT_LSTTR;
1089 enable_bits |= PN_INT_BFRDY;
1092 usb3_set_bit(usb3, enable_bits, USB3_PN_INT_ENA);
1093 usb3_enable_pipe_irq(usb3, usb3_ep->num);
1096 spin_unlock_irqrestore(&usb3->lock, flags);
1099 static int renesas_usb3_ep_queue(struct usb_ep *_ep, struct usb_request *_req,
1102 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1103 struct renesas_usb3_request *usb3_req = usb_req_to_usb3_req(_req);
1104 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1105 unsigned long flags;
1107 dev_dbg(usb3_to_dev(usb3), "ep_queue: ep%2d, %u\n", usb3_ep->num,
1110 _req->status = -EINPROGRESS;
1112 spin_lock_irqsave(&usb3->lock, flags);
1113 list_add_tail(&usb3_req->queue, &usb3_ep->queue);
1114 spin_unlock_irqrestore(&usb3->lock, flags);
1117 usb3_start_pipe0(usb3_ep, usb3_req);
1119 usb3_start_pipen(usb3_ep, usb3_req);
1124 static void usb3_set_device_address(struct renesas_usb3 *usb3, u16 addr)
1126 /* DEV_ADDR bit field is cleared by WarmReset, HotReset and BusReset */
1127 usb3_set_bit(usb3, USB_COM_CON_DEV_ADDR(addr), USB3_USB_COM_CON);
1130 static bool usb3_std_req_set_address(struct renesas_usb3 *usb3,
1131 struct usb_ctrlrequest *ctrl)
1133 if (ctrl->wValue >= 128)
1134 return true; /* stall */
1136 usb3_set_device_address(usb3, ctrl->wValue);
1137 usb3_set_p0_con_for_no_data(usb3);
1142 static void usb3_pipe0_internal_xfer(struct renesas_usb3 *usb3,
1143 void *tx_data, size_t len,
1144 void (*complete)(struct usb_ep *ep,
1145 struct usb_request *req))
1147 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
1150 memcpy(usb3->ep0_buf, tx_data,
1151 min_t(size_t, len, USB3_EP0_BUF_SIZE));
1153 usb3->ep0_req->buf = &usb3->ep0_buf;
1154 usb3->ep0_req->length = len;
1155 usb3->ep0_req->complete = complete;
1156 renesas_usb3_ep_queue(&usb3_ep->ep, usb3->ep0_req, GFP_ATOMIC);
1159 static void usb3_pipe0_get_status_completion(struct usb_ep *ep,
1160 struct usb_request *req)
1164 static bool usb3_std_req_get_status(struct renesas_usb3 *usb3,
1165 struct usb_ctrlrequest *ctrl)
1168 struct renesas_usb3_ep *usb3_ep;
1172 switch (ctrl->bRequestType & USB_RECIP_MASK) {
1173 case USB_RECIP_DEVICE:
1174 if (usb3->gadget.is_selfpowered)
1175 status |= 1 << USB_DEVICE_SELF_POWERED;
1176 if (usb3->gadget.speed == USB_SPEED_SUPER)
1177 status |= usb3_feature_get_un_enabled(usb3);
1179 case USB_RECIP_INTERFACE:
1181 case USB_RECIP_ENDPOINT:
1182 num = le16_to_cpu(ctrl->wIndex) & USB_ENDPOINT_NUMBER_MASK;
1183 usb3_ep = usb3_get_ep(usb3, num);
1185 status |= 1 << USB_ENDPOINT_HALT;
1193 status = cpu_to_le16(status);
1194 dev_dbg(usb3_to_dev(usb3), "get_status: req = %p\n",
1195 usb_req_to_usb3_req(usb3->ep0_req));
1196 usb3_pipe0_internal_xfer(usb3, &status, sizeof(status),
1197 usb3_pipe0_get_status_completion);
1203 static bool usb3_std_req_feature_device(struct renesas_usb3 *usb3,
1204 struct usb_ctrlrequest *ctrl, bool set)
1207 u16 w_value = le16_to_cpu(ctrl->wValue);
1210 case USB_DEVICE_TEST_MODE:
1213 usb3->test_mode = le16_to_cpu(ctrl->wIndex) >> 8;
1216 case USB_DEVICE_U1_ENABLE:
1217 case USB_DEVICE_U2_ENABLE:
1218 if (usb3->gadget.speed != USB_SPEED_SUPER)
1220 if (w_value == USB_DEVICE_U1_ENABLE)
1221 usb3_feature_u1_enable(usb3, set);
1222 if (w_value == USB_DEVICE_U2_ENABLE)
1223 usb3_feature_u2_enable(usb3, set);
1233 static int usb3_set_halt_p0(struct renesas_usb3_ep *usb3_ep, bool halt)
1235 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1237 if (unlikely(usb3_ep->num))
1240 usb3_ep->halt = halt;
1242 usb3_set_p0_con_stall(usb3);
1244 usb3_set_p0_con_stop(usb3);
1249 static int usb3_set_halt_pn(struct renesas_usb3_ep *usb3_ep, bool halt,
1250 bool is_clear_feature)
1252 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1253 unsigned long flags;
1255 spin_lock_irqsave(&usb3->lock, flags);
1256 if (!usb3_pn_change(usb3, usb3_ep->num)) {
1257 usb3_ep->halt = halt;
1259 usb3_pn_stall(usb3);
1260 } else if (!is_clear_feature || !usb3_ep->wedge) {
1261 usb3_pn_con_clear(usb3);
1262 usb3_set_bit(usb3, PN_CON_EN, USB3_PN_CON);
1266 spin_unlock_irqrestore(&usb3->lock, flags);
1271 static int usb3_set_halt(struct renesas_usb3_ep *usb3_ep, bool halt,
1272 bool is_clear_feature)
1276 if (halt && usb3_ep->started)
1280 ret = usb3_set_halt_pn(usb3_ep, halt, is_clear_feature);
1282 ret = usb3_set_halt_p0(usb3_ep, halt);
1287 static bool usb3_std_req_feature_endpoint(struct renesas_usb3 *usb3,
1288 struct usb_ctrlrequest *ctrl,
1291 int num = le16_to_cpu(ctrl->wIndex) & USB_ENDPOINT_NUMBER_MASK;
1292 struct renesas_usb3_ep *usb3_ep;
1293 struct renesas_usb3_request *usb3_req;
1295 if (le16_to_cpu(ctrl->wValue) != USB_ENDPOINT_HALT)
1296 return true; /* stall */
1298 usb3_ep = usb3_get_ep(usb3, num);
1299 usb3_set_halt(usb3_ep, set, true);
1301 /* Restarts a queue if clear feature */
1303 usb3_ep->started = false;
1304 usb3_req = usb3_get_request(usb3_ep);
1306 usb3_start_pipen(usb3_ep, usb3_req);
1312 static bool usb3_std_req_feature(struct renesas_usb3 *usb3,
1313 struct usb_ctrlrequest *ctrl, bool set)
1317 switch (ctrl->bRequestType & USB_RECIP_MASK) {
1318 case USB_RECIP_DEVICE:
1319 stall = usb3_std_req_feature_device(usb3, ctrl, set);
1321 case USB_RECIP_INTERFACE:
1323 case USB_RECIP_ENDPOINT:
1324 stall = usb3_std_req_feature_endpoint(usb3, ctrl, set);
1332 usb3_set_p0_con_for_no_data(usb3);
1337 static void usb3_pipe0_set_sel_completion(struct usb_ep *ep,
1338 struct usb_request *req)
1343 static bool usb3_std_req_set_sel(struct renesas_usb3 *usb3,
1344 struct usb_ctrlrequest *ctrl)
1346 u16 w_length = le16_to_cpu(ctrl->wLength);
1349 return true; /* stall */
1351 dev_dbg(usb3_to_dev(usb3), "set_sel: req = %p\n",
1352 usb_req_to_usb3_req(usb3->ep0_req));
1353 usb3_pipe0_internal_xfer(usb3, NULL, 6, usb3_pipe0_set_sel_completion);
1358 static bool usb3_std_req_set_configuration(struct renesas_usb3 *usb3,
1359 struct usb_ctrlrequest *ctrl)
1361 if (ctrl->wValue > 0)
1362 usb3_set_bit(usb3, USB_COM_CON_CONF, USB3_USB_COM_CON);
1364 usb3_clear_bit(usb3, USB_COM_CON_CONF, USB3_USB_COM_CON);
1370 * usb3_handle_standard_request - handle some standard requests
1371 * @usb3: the renesas_usb3 pointer
1372 * @ctrl: a pointer of setup data
1374 * Returns true if this function handled a standard request
1376 static bool usb3_handle_standard_request(struct renesas_usb3 *usb3,
1377 struct usb_ctrlrequest *ctrl)
1382 if ((ctrl->bRequestType & USB_TYPE_MASK) == USB_TYPE_STANDARD) {
1383 switch (ctrl->bRequest) {
1384 case USB_REQ_SET_ADDRESS:
1385 stall = usb3_std_req_set_address(usb3, ctrl);
1388 case USB_REQ_GET_STATUS:
1389 stall = usb3_std_req_get_status(usb3, ctrl);
1392 case USB_REQ_CLEAR_FEATURE:
1393 stall = usb3_std_req_feature(usb3, ctrl, false);
1396 case USB_REQ_SET_FEATURE:
1397 stall = usb3_std_req_feature(usb3, ctrl, true);
1400 case USB_REQ_SET_SEL:
1401 stall = usb3_std_req_set_sel(usb3, ctrl);
1404 case USB_REQ_SET_ISOCH_DELAY:
1405 /* This hardware doesn't support Isochronous xfer */
1409 case USB_REQ_SET_CONFIGURATION:
1410 usb3_std_req_set_configuration(usb3, ctrl);
1418 usb3_set_p0_con_stall(usb3);
1423 static int usb3_p0_con_clear_buffer(struct renesas_usb3 *usb3)
1425 usb3_set_bit(usb3, P0_CON_BCLR, USB3_P0_CON);
1427 return usb3_wait(usb3, USB3_P0_CON, P0_CON_BCLR, 0);
1430 static void usb3_irq_epc_pipe0_setup(struct renesas_usb3 *usb3)
1432 struct usb_ctrlrequest ctrl;
1433 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
1435 /* Call giveback function if previous transfer is not completed */
1436 if (usb3_ep->started)
1437 usb3_request_done(usb3_ep, usb3_get_request(usb3_ep),
1440 usb3_p0_con_clear_buffer(usb3);
1441 usb3_get_setup_data(usb3, &ctrl);
1442 if (!usb3_handle_standard_request(usb3, &ctrl))
1443 if (usb3->driver->setup(&usb3->gadget, &ctrl) < 0)
1444 usb3_set_p0_con_stall(usb3);
1447 static void usb3_irq_epc_pipe0_bfrdy(struct renesas_usb3 *usb3)
1449 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, 0);
1450 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
1455 usb3_p0_xfer(usb3_ep, usb3_req);
1458 static void usb3_irq_epc_pipe0(struct renesas_usb3 *usb3)
1460 u32 p0_int_sta = usb3_read(usb3, USB3_P0_INT_STA);
1462 p0_int_sta &= usb3_read(usb3, USB3_P0_INT_ENA);
1463 usb3_write(usb3, p0_int_sta, USB3_P0_INT_STA);
1464 if (p0_int_sta & P0_INT_STSED)
1465 usb3_irq_epc_pipe0_status_end(usb3);
1466 if (p0_int_sta & P0_INT_SETUP)
1467 usb3_irq_epc_pipe0_setup(usb3);
1468 if (p0_int_sta & P0_INT_BFRDY)
1469 usb3_irq_epc_pipe0_bfrdy(usb3);
1472 static void usb3_request_done_pipen(struct renesas_usb3 *usb3,
1473 struct renesas_usb3_ep *usb3_ep,
1474 struct renesas_usb3_request *usb3_req,
1477 unsigned long flags;
1479 spin_lock_irqsave(&usb3->lock, flags);
1480 if (usb3_pn_change(usb3, usb3_ep->num))
1482 spin_unlock_irqrestore(&usb3->lock, flags);
1484 usb3_disable_pipe_irq(usb3, usb3_ep->num);
1485 usb3_request_done(usb3_ep, usb3_req, status);
1487 /* get next usb3_req */
1488 usb3_req = usb3_get_request(usb3_ep);
1490 usb3_start_pipen(usb3_ep, usb3_req);
1493 static void usb3_irq_epc_pipen_lsttr(struct renesas_usb3 *usb3, int num)
1495 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, num);
1496 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
1501 if (usb3_ep->dir_in) {
1502 dev_dbg(usb3_to_dev(usb3), "%s: len = %u, actual = %u\n",
1503 __func__, usb3_req->req.length, usb3_req->req.actual);
1504 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, 0);
1508 static void usb3_irq_epc_pipen_bfrdy(struct renesas_usb3 *usb3, int num)
1510 struct renesas_usb3_ep *usb3_ep = usb3_get_ep(usb3, num);
1511 struct renesas_usb3_request *usb3_req = usb3_get_request(usb3_ep);
1517 spin_lock(&usb3->lock);
1518 if (usb3_pn_change(usb3, num))
1521 if (usb3_ep->dir_in) {
1522 /* Do not stop the IN pipe here to detect LSTTR interrupt */
1523 if (!usb3_write_pipe(usb3_ep, usb3_req, USB3_PN_WRITE))
1524 usb3_clear_bit(usb3, PN_INT_BFRDY, USB3_PN_INT_ENA);
1526 if (!usb3_read_pipe(usb3_ep, usb3_req, USB3_PN_READ))
1531 /* need to unlock because usb3_request_done_pipen() locks it */
1532 spin_unlock(&usb3->lock);
1535 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, 0);
1538 static void usb3_irq_epc_pipen(struct renesas_usb3 *usb3, int num)
1542 spin_lock(&usb3->lock);
1543 if (usb3_pn_change(usb3, num) < 0) {
1544 spin_unlock(&usb3->lock);
1548 pn_int_sta = usb3_read(usb3, USB3_PN_INT_STA);
1549 pn_int_sta &= usb3_read(usb3, USB3_PN_INT_ENA);
1550 usb3_write(usb3, pn_int_sta, USB3_PN_INT_STA);
1551 spin_unlock(&usb3->lock);
1552 if (pn_int_sta & PN_INT_LSTTR)
1553 usb3_irq_epc_pipen_lsttr(usb3, num);
1554 if (pn_int_sta & PN_INT_BFRDY)
1555 usb3_irq_epc_pipen_bfrdy(usb3, num);
1558 static void usb3_irq_epc_int_2(struct renesas_usb3 *usb3, u32 int_sta_2)
1562 for (i = 0; i < usb3->num_usb3_eps; i++) {
1563 if (int_sta_2 & USB_INT_2_PIPE(i)) {
1565 usb3_irq_epc_pipe0(usb3);
1567 usb3_irq_epc_pipen(usb3, i);
1572 static void usb3_irq_idmon_change(struct renesas_usb3 *usb3)
1574 usb3_check_id(usb3);
1577 static void usb3_irq_otg_int(struct renesas_usb3 *usb3, u32 otg_int_sta)
1579 if (otg_int_sta & USB_OTG_IDMON)
1580 usb3_irq_idmon_change(usb3);
1583 static void usb3_irq_epc(struct renesas_usb3 *usb3)
1585 u32 int_sta_1 = usb3_read(usb3, USB3_USB_INT_STA_1);
1586 u32 int_sta_2 = usb3_read(usb3, USB3_USB_INT_STA_2);
1587 u32 otg_int_sta = usb3_read(usb3, USB3_USB_OTG_INT_STA);
1589 int_sta_1 &= usb3_read(usb3, USB3_USB_INT_ENA_1);
1591 usb3_write(usb3, int_sta_1, USB3_USB_INT_STA_1);
1592 usb3_irq_epc_int_1(usb3, int_sta_1);
1595 int_sta_2 &= usb3_read(usb3, USB3_USB_INT_ENA_2);
1597 usb3_irq_epc_int_2(usb3, int_sta_2);
1599 otg_int_sta &= usb3_read(usb3, USB3_USB_OTG_INT_ENA);
1601 usb3_write(usb3, otg_int_sta, USB3_USB_OTG_INT_STA);
1602 usb3_irq_otg_int(usb3, otg_int_sta);
1606 static irqreturn_t renesas_usb3_irq(int irq, void *_usb3)
1608 struct renesas_usb3 *usb3 = _usb3;
1609 irqreturn_t ret = IRQ_NONE;
1610 u32 axi_int_sta = usb3_read(usb3, USB3_AXI_INT_STA);
1612 if (axi_int_sta & AXI_INT_EPCINT) {
1620 static void usb3_write_pn_mod(struct renesas_usb3_ep *usb3_ep,
1621 const struct usb_endpoint_descriptor *desc)
1623 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1626 val |= usb3_ep->dir_in ? PN_MOD_DIR : 0;
1627 val |= PN_MOD_TYPE(usb_endpoint_type(desc));
1628 val |= PN_MOD_EPNUM(usb_endpoint_num(desc));
1629 usb3_write(usb3, val, USB3_PN_MOD);
1632 static u32 usb3_calc_ramarea(int ram_size)
1634 WARN_ON(ram_size > SZ_16K);
1636 if (ram_size <= SZ_1K)
1637 return PN_RAMMAP_RAMAREA_1KB;
1638 else if (ram_size <= SZ_2K)
1639 return PN_RAMMAP_RAMAREA_2KB;
1640 else if (ram_size <= SZ_4K)
1641 return PN_RAMMAP_RAMAREA_4KB;
1642 else if (ram_size <= SZ_8K)
1643 return PN_RAMMAP_RAMAREA_8KB;
1645 return PN_RAMMAP_RAMAREA_16KB;
1648 static u32 usb3_calc_rammap_val(struct renesas_usb3_ep *usb3_ep,
1649 const struct usb_endpoint_descriptor *desc)
1651 return usb3_ep->rammap_val | PN_RAMMAP_MPKT(usb_endpoint_maxp(desc));
1654 static int usb3_enable_pipe_n(struct renesas_usb3_ep *usb3_ep,
1655 const struct usb_endpoint_descriptor *desc)
1657 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1658 unsigned long flags;
1660 usb3_ep->dir_in = usb_endpoint_dir_in(desc);
1662 spin_lock_irqsave(&usb3->lock, flags);
1663 if (!usb3_pn_change(usb3, usb3_ep->num)) {
1664 usb3_write_pn_mod(usb3_ep, desc);
1665 usb3_write(usb3, usb3_calc_rammap_val(usb3_ep, desc),
1667 usb3_pn_con_clear(usb3);
1668 usb3_set_bit(usb3, PN_CON_EN, USB3_PN_CON);
1670 spin_unlock_irqrestore(&usb3->lock, flags);
1675 static int usb3_disable_pipe_n(struct renesas_usb3_ep *usb3_ep)
1677 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1678 unsigned long flags;
1680 usb3_ep->halt = false;
1682 spin_lock_irqsave(&usb3->lock, flags);
1683 if (!usb3_pn_change(usb3, usb3_ep->num)) {
1684 usb3_write(usb3, 0, USB3_PN_INT_ENA);
1685 usb3_write(usb3, 0, USB3_PN_RAMMAP);
1686 usb3_clear_bit(usb3, PN_CON_EN, USB3_PN_CON);
1688 spin_unlock_irqrestore(&usb3->lock, flags);
1693 /*------- usb_ep_ops -----------------------------------------------------*/
1694 static int renesas_usb3_ep_enable(struct usb_ep *_ep,
1695 const struct usb_endpoint_descriptor *desc)
1697 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1699 return usb3_enable_pipe_n(usb3_ep, desc);
1702 static int renesas_usb3_ep_disable(struct usb_ep *_ep)
1704 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1705 struct renesas_usb3_request *usb3_req;
1708 usb3_req = usb3_get_request(usb3_ep);
1711 usb3_request_done(usb3_ep, usb3_req, -ESHUTDOWN);
1714 return usb3_disable_pipe_n(usb3_ep);
1717 static struct usb_request *__renesas_usb3_ep_alloc_request(gfp_t gfp_flags)
1719 struct renesas_usb3_request *usb3_req;
1721 usb3_req = kzalloc(sizeof(struct renesas_usb3_request), gfp_flags);
1725 INIT_LIST_HEAD(&usb3_req->queue);
1727 return &usb3_req->req;
1730 static void __renesas_usb3_ep_free_request(struct usb_request *_req)
1732 struct renesas_usb3_request *usb3_req = usb_req_to_usb3_req(_req);
1737 static struct usb_request *renesas_usb3_ep_alloc_request(struct usb_ep *_ep,
1740 return __renesas_usb3_ep_alloc_request(gfp_flags);
1743 static void renesas_usb3_ep_free_request(struct usb_ep *_ep,
1744 struct usb_request *_req)
1746 __renesas_usb3_ep_free_request(_req);
1749 static int renesas_usb3_ep_dequeue(struct usb_ep *_ep, struct usb_request *_req)
1751 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1752 struct renesas_usb3_request *usb3_req = usb_req_to_usb3_req(_req);
1753 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1755 dev_dbg(usb3_to_dev(usb3), "ep_dequeue: ep%2d, %u\n", usb3_ep->num,
1758 usb3_request_done_pipen(usb3, usb3_ep, usb3_req, -ECONNRESET);
1763 static int renesas_usb3_ep_set_halt(struct usb_ep *_ep, int value)
1765 return usb3_set_halt(usb_ep_to_usb3_ep(_ep), !!value, false);
1768 static int renesas_usb3_ep_set_wedge(struct usb_ep *_ep)
1770 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1772 usb3_ep->wedge = true;
1773 return usb3_set_halt(usb3_ep, true, false);
1776 static void renesas_usb3_ep_fifo_flush(struct usb_ep *_ep)
1778 struct renesas_usb3_ep *usb3_ep = usb_ep_to_usb3_ep(_ep);
1779 struct renesas_usb3 *usb3 = usb3_ep_to_usb3(usb3_ep);
1780 unsigned long flags;
1783 spin_lock_irqsave(&usb3->lock, flags);
1784 if (!usb3_pn_change(usb3, usb3_ep->num)) {
1785 usb3_pn_con_clear(usb3);
1786 usb3_set_bit(usb3, PN_CON_EN, USB3_PN_CON);
1788 spin_unlock_irqrestore(&usb3->lock, flags);
1790 usb3_p0_con_clear_buffer(usb3);
1794 static struct usb_ep_ops renesas_usb3_ep_ops = {
1795 .enable = renesas_usb3_ep_enable,
1796 .disable = renesas_usb3_ep_disable,
1798 .alloc_request = renesas_usb3_ep_alloc_request,
1799 .free_request = renesas_usb3_ep_free_request,
1801 .queue = renesas_usb3_ep_queue,
1802 .dequeue = renesas_usb3_ep_dequeue,
1804 .set_halt = renesas_usb3_ep_set_halt,
1805 .set_wedge = renesas_usb3_ep_set_wedge,
1806 .fifo_flush = renesas_usb3_ep_fifo_flush,
1809 /*------- usb_gadget_ops -------------------------------------------------*/
1810 static int renesas_usb3_start(struct usb_gadget *gadget,
1811 struct usb_gadget_driver *driver)
1813 struct renesas_usb3 *usb3;
1815 if (!driver || driver->max_speed < USB_SPEED_FULL ||
1819 usb3 = gadget_to_renesas_usb3(gadget);
1821 /* hook up the driver */
1822 usb3->driver = driver;
1824 pm_runtime_enable(usb3_to_dev(usb3));
1825 pm_runtime_get_sync(usb3_to_dev(usb3));
1827 renesas_usb3_init_controller(usb3);
1832 static int renesas_usb3_stop(struct usb_gadget *gadget)
1834 struct renesas_usb3 *usb3 = gadget_to_renesas_usb3(gadget);
1836 usb3->softconnect = false;
1837 usb3->gadget.speed = USB_SPEED_UNKNOWN;
1838 usb3->driver = NULL;
1839 renesas_usb3_stop_controller(usb3);
1841 pm_runtime_put(usb3_to_dev(usb3));
1842 pm_runtime_disable(usb3_to_dev(usb3));
1847 static int renesas_usb3_get_frame(struct usb_gadget *_gadget)
1852 static int renesas_usb3_pullup(struct usb_gadget *gadget, int is_on)
1854 struct renesas_usb3 *usb3 = gadget_to_renesas_usb3(gadget);
1856 usb3->softconnect = !!is_on;
1861 static int renesas_usb3_set_selfpowered(struct usb_gadget *gadget, int is_self)
1863 gadget->is_selfpowered = !!is_self;
1868 static const struct usb_gadget_ops renesas_usb3_gadget_ops = {
1869 .get_frame = renesas_usb3_get_frame,
1870 .udc_start = renesas_usb3_start,
1871 .udc_stop = renesas_usb3_stop,
1872 .pullup = renesas_usb3_pullup,
1873 .set_selfpowered = renesas_usb3_set_selfpowered,
1876 static ssize_t role_store(struct device *dev, struct device_attribute *attr,
1877 const char *buf, size_t count)
1879 struct renesas_usb3 *usb3 = dev_get_drvdata(dev);
1880 bool new_mode_is_host;
1885 if (!strncmp(buf, "host", strlen("host")))
1886 new_mode_is_host = true;
1887 else if (!strncmp(buf, "peripheral", strlen("peripheral")))
1888 new_mode_is_host = false;
1892 if (new_mode_is_host == usb3_is_host(usb3))
1895 usb3_mode_config(usb3, new_mode_is_host, usb3_is_a_device(usb3));
1900 static ssize_t role_show(struct device *dev, struct device_attribute *attr,
1903 struct renesas_usb3 *usb3 = dev_get_drvdata(dev);
1908 return sprintf(buf, "%s\n", usb3_is_host(usb3) ? "host" : "peripheral");
1910 static DEVICE_ATTR_RW(role);
1912 /*------- platform_driver ------------------------------------------------*/
1913 static int renesas_usb3_remove(struct platform_device *pdev)
1915 struct renesas_usb3 *usb3 = platform_get_drvdata(pdev);
1917 device_remove_file(&pdev->dev, &dev_attr_role);
1919 usb_del_gadget_udc(&usb3->gadget);
1921 __renesas_usb3_ep_free_request(usb3->ep0_req);
1926 static int renesas_usb3_init_ep(struct renesas_usb3 *usb3, struct device *dev,
1927 const struct renesas_usb3_priv *priv)
1929 struct renesas_usb3_ep *usb3_ep;
1932 /* calculate num_usb3_eps from renesas_usb3_priv */
1933 usb3->num_usb3_eps = priv->ramsize_per_ramif * priv->num_ramif * 2 /
1934 priv->ramsize_per_pipe + 1;
1936 if (usb3->num_usb3_eps > USB3_MAX_NUM_PIPES)
1937 usb3->num_usb3_eps = USB3_MAX_NUM_PIPES;
1939 usb3->usb3_ep = devm_kzalloc(dev, sizeof(*usb3_ep) * usb3->num_usb3_eps,
1944 dev_dbg(dev, "%s: num_usb3_eps = %d\n", __func__, usb3->num_usb3_eps);
1946 * This driver prepares pipes as follows:
1947 * - odd pipes = IN pipe
1948 * - even pipes = OUT pipe (except pipe 0)
1950 usb3_for_each_ep(usb3_ep, usb3, i) {
1951 snprintf(usb3_ep->ep_name, sizeof(usb3_ep->ep_name), "ep%d", i);
1952 usb3_ep->usb3 = usb3;
1954 usb3_ep->ep.name = usb3_ep->ep_name;
1955 usb3_ep->ep.ops = &renesas_usb3_ep_ops;
1956 INIT_LIST_HEAD(&usb3_ep->queue);
1957 INIT_LIST_HEAD(&usb3_ep->ep.ep_list);
1959 /* for control pipe */
1960 usb3->gadget.ep0 = &usb3_ep->ep;
1961 usb_ep_set_maxpacket_limit(&usb3_ep->ep,
1962 USB3_EP0_HSFS_MAX_PACKET_SIZE);
1963 usb3_ep->ep.caps.type_control = true;
1964 usb3_ep->ep.caps.dir_in = true;
1965 usb3_ep->ep.caps.dir_out = true;
1969 /* for bulk or interrupt pipe */
1970 usb_ep_set_maxpacket_limit(&usb3_ep->ep, ~0);
1971 list_add_tail(&usb3_ep->ep.ep_list, &usb3->gadget.ep_list);
1972 usb3_ep->ep.caps.type_bulk = true;
1973 usb3_ep->ep.caps.type_int = true;
1975 usb3_ep->ep.caps.dir_in = true;
1977 usb3_ep->ep.caps.dir_out = true;
1983 static void renesas_usb3_init_ram(struct renesas_usb3 *usb3, struct device *dev,
1984 const struct renesas_usb3_priv *priv)
1986 struct renesas_usb3_ep *usb3_ep;
1988 u32 ramif[2], basead[2]; /* index 0 = for IN pipes */
1989 u32 *cur_ramif, *cur_basead;
1992 memset(ramif, 0, sizeof(ramif));
1993 memset(basead, 0, sizeof(basead));
1996 * This driver prepares pipes as follows:
1997 * - all pipes = the same size as "ramsize_per_pipe"
1998 * Please refer to the "Method of Specifying RAM Mapping"
2000 usb3_for_each_ep(usb3_ep, usb3, i) {
2002 continue; /* out of scope if ep num = 0 */
2003 if (usb3_ep->ep.caps.dir_in) {
2004 cur_ramif = &ramif[0];
2005 cur_basead = &basead[0];
2007 cur_ramif = &ramif[1];
2008 cur_basead = &basead[1];
2011 if (*cur_basead > priv->ramsize_per_ramif)
2012 continue; /* out of memory for IN or OUT pipe */
2014 /* calculate rammap_val */
2015 val = PN_RAMMAP_RAMIF(*cur_ramif);
2016 val |= usb3_calc_ramarea(priv->ramsize_per_pipe);
2017 val |= PN_RAMMAP_BASEAD(*cur_basead);
2018 usb3_ep->rammap_val = val;
2020 dev_dbg(dev, "ep%2d: val = %08x, ramif = %d, base = %x\n",
2021 i, val, *cur_ramif, *cur_basead);
2023 /* update current ramif */
2024 if (*cur_ramif + 1 == priv->num_ramif) {
2026 *cur_basead += priv->ramsize_per_pipe;
2033 static const struct renesas_usb3_priv renesas_usb3_priv_r8a7795 = {
2034 .ramsize_per_ramif = SZ_16K,
2036 .ramsize_per_pipe = SZ_4K,
2037 .workaround_for_vbus = true,
2040 static const struct of_device_id usb3_of_match[] = {
2042 .compatible = "renesas,r8a7795-usb3-peri",
2043 .data = &renesas_usb3_priv_r8a7795,
2047 MODULE_DEVICE_TABLE(of, usb3_of_match);
2049 static const unsigned int renesas_usb3_cable[] = {
2055 static int renesas_usb3_probe(struct platform_device *pdev)
2057 struct renesas_usb3 *usb3;
2058 struct resource *res;
2059 const struct of_device_id *match;
2061 const struct renesas_usb3_priv *priv;
2063 match = of_match_node(usb3_of_match, pdev->dev.of_node);
2068 irq = platform_get_irq(pdev, 0);
2072 usb3 = devm_kzalloc(&pdev->dev, sizeof(*usb3), GFP_KERNEL);
2076 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2077 usb3->reg = devm_ioremap_resource(&pdev->dev, res);
2078 if (IS_ERR(usb3->reg))
2079 return PTR_ERR(usb3->reg);
2081 platform_set_drvdata(pdev, usb3);
2082 spin_lock_init(&usb3->lock);
2084 usb3->gadget.ops = &renesas_usb3_gadget_ops;
2085 usb3->gadget.name = udc_name;
2086 usb3->gadget.max_speed = USB_SPEED_SUPER;
2087 INIT_LIST_HEAD(&usb3->gadget.ep_list);
2088 ret = renesas_usb3_init_ep(usb3, &pdev->dev, priv);
2091 renesas_usb3_init_ram(usb3, &pdev->dev, priv);
2093 ret = devm_request_irq(&pdev->dev, irq, renesas_usb3_irq, 0,
2094 dev_name(&pdev->dev), usb3);
2098 INIT_WORK(&usb3->extcon_work, renesas_usb3_extcon_work);
2099 usb3->extcon = devm_extcon_dev_allocate(&pdev->dev, renesas_usb3_cable);
2100 if (IS_ERR(usb3->extcon))
2101 return PTR_ERR(usb3->extcon);
2103 ret = devm_extcon_dev_register(&pdev->dev, usb3->extcon);
2105 dev_err(&pdev->dev, "Failed to register extcon\n");
2109 /* for ep0 handling */
2110 usb3->ep0_req = __renesas_usb3_ep_alloc_request(GFP_KERNEL);
2114 ret = usb_add_gadget_udc(&pdev->dev, &usb3->gadget);
2118 ret = device_create_file(&pdev->dev, &dev_attr_role);
2120 goto err_dev_create;
2122 usb3->workaround_for_vbus = priv->workaround_for_vbus;
2124 dev_info(&pdev->dev, "probed\n");
2129 usb_del_gadget_udc(&usb3->gadget);
2132 __renesas_usb3_ep_free_request(usb3->ep0_req);
2137 static struct platform_driver renesas_usb3_driver = {
2138 .probe = renesas_usb3_probe,
2139 .remove = renesas_usb3_remove,
2141 .name = (char *)udc_name,
2142 .of_match_table = of_match_ptr(usb3_of_match),
2145 module_platform_driver(renesas_usb3_driver);
2147 MODULE_DESCRIPTION("Renesas USB3.0 Peripheral driver");
2148 MODULE_LICENSE("GPL v2");
2149 MODULE_AUTHOR("Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>");
2150 MODULE_ALIAS("platform:renesas_usb3");