xref: /rk3399_rockchip-uboot/drivers/usb/host/r8a66597-hcd.c (revision 1e9a8859b7bb7a542065068181ebeb31e247ef61)
1 /*
2  * R8A66597 HCD (Host Controller Driver) for u-boot
3  *
4  * Copyright (C) 2008  Yoshihiro Shimoda <shimoda.yoshihiro@renesas.com>
5  *
6  * SPDX-License-Identifier:	GPL-2.0
7  */
8 
9 #include <common.h>
10 #include <console.h>
11 #include <dm.h>
12 #include <usb.h>
13 #include <asm/io.h>
14 #include <linux/iopoll.h>
15 
16 #include "r8a66597.h"
17 
18 #ifdef R8A66597_DEBUG
19 #define R8A66597_DPRINT		printf
20 #else
21 #define R8A66597_DPRINT(...)
22 #endif
23 
24 static inline struct usb_device *usb_dev_get_parent(struct usb_device *udev)
25 {
26 	struct udevice *parent = udev->dev->parent;
27 
28 	/*
29 	 * When called from usb-uclass.c: usb_scan_device() udev->dev points
30 	 * to the parent udevice, not the actual udevice belonging to the
31 	 * udev as the device is not instantiated yet.
32 	 *
33 	 * If dev is an usb-bus, then we are called from usb_scan_device() for
34 	 * an usb-device plugged directly into the root port, return NULL.
35 	 */
36 	if (device_get_uclass_id(udev->dev) == UCLASS_USB)
37 		return NULL;
38 
39 	/*
40 	 * If these 2 are not the same we are being called from
41 	 * usb_scan_device() and udev itself is the parent.
42 	 */
43 	if (dev_get_parent_priv(udev->dev) != udev)
44 		return udev;
45 
46 	/* We are being called normally, use the parent pointer */
47 	if (device_get_uclass_id(parent) == UCLASS_USB_HUB)
48 		return dev_get_parent_priv(parent);
49 
50 	return NULL;
51 }
52 
53 static void get_hub_data(struct usb_device *dev, u16 *hub_devnum, u16 *hubport)
54 {
55 	struct usb_device *parent = usb_dev_get_parent(dev);
56 
57 	*hub_devnum = 0;
58 	*hubport = 0;
59 
60 	/* check a device connected to root_hub */
61 	if ((parent && parent->devnum == 1) ||
62 	    (dev->devnum == 1))
63 		return;
64 
65 	*hub_devnum = (u8)parent->devnum;
66 	*hubport = parent->portnr - 1;
67 }
68 
69 static void set_devadd(struct r8a66597 *r8a66597, u8 r8a66597_address,
70 			struct usb_device *dev, int port)
71 {
72 	u16 val, usbspd, upphub, hubport;
73 	unsigned long devadd_reg = get_devadd_addr(r8a66597_address);
74 
75 	get_hub_data(dev, &upphub, &hubport);
76 	usbspd = r8a66597->speed;
77 	val = (upphub << 11) | (hubport << 8) | (usbspd << 6) | (port & 0x0001);
78 	r8a66597_write(r8a66597, val, devadd_reg);
79 }
80 
81 static int r8a66597_clock_enable(struct r8a66597 *r8a66597)
82 {
83 	u16 tmp;
84 	int i = 0;
85 
86 	do {
87 		r8a66597_write(r8a66597, USBE, SYSCFG0);
88 		tmp = r8a66597_read(r8a66597, SYSCFG0);
89 		if (i++ > 1000) {
90 			printf("register access fail.\n");
91 			return -1;
92 		}
93 	} while ((tmp & USBE) != USBE);
94 	r8a66597_bclr(r8a66597, USBE, SYSCFG0);
95 	/*
96 	 * RZ/A Only:
97 	 * Bits XTAL(UCKSEL) and UPLLE in SYSCFG0 for USB0 controls both USB0
98 	 * and USB1, so we must always set the USB0 register
99 	 */
100 #if (CONFIG_R8A66597_XTAL == 1)
101 	setbits(le16, R8A66597_BASE0, XTAL);
102 #endif
103 	mdelay(1);
104 	setbits(le16, R8A66597_BASE0, UPLLE);
105 	mdelay(1);
106 	r8a66597_bset(r8a66597, SUSPM, SUSPMODE0);
107 
108 	return 0;
109 }
110 
111 static void r8a66597_clock_disable(struct r8a66597 *r8a66597)
112 {
113 	r8a66597_bclr(r8a66597, SUSPM, SUSPMODE0);
114 
115 	clrbits(le16, R8A66597_BASE0, UPLLE);
116 	mdelay(1);
117 	r8a66597_bclr(r8a66597, USBE, SYSCFG0);
118 	mdelay(1);
119 }
120 
121 static void r8a66597_enable_port(struct r8a66597 *r8a66597, int port)
122 {
123 	u16 val;
124 
125 	val = port ? DRPD : DCFM | DRPD;
126 	r8a66597_bset(r8a66597, val, get_syscfg_reg(port));
127 	r8a66597_bset(r8a66597, HSE, get_syscfg_reg(port));
128 }
129 
130 static void r8a66597_disable_port(struct r8a66597 *r8a66597, int port)
131 {
132 	u16 val, tmp;
133 
134 	r8a66597_write(r8a66597, 0, get_intenb_reg(port));
135 	r8a66597_write(r8a66597, 0, get_intsts_reg(port));
136 
137 	r8a66597_port_power(r8a66597, port, 0);
138 
139 	do {
140 		tmp = r8a66597_read(r8a66597, SOFCFG) & EDGESTS;
141 		udelay(640);
142 	} while (tmp == EDGESTS);
143 
144 	val = port ? DRPD : DCFM | DRPD;
145 	r8a66597_bclr(r8a66597, val, get_syscfg_reg(port));
146 	r8a66597_bclr(r8a66597, HSE, get_syscfg_reg(port));
147 }
148 
149 static int enable_controller(struct r8a66597 *r8a66597)
150 {
151 	int ret, port;
152 
153 	ret = r8a66597_clock_enable(r8a66597);
154 	if (ret < 0)
155 		return ret;
156 
157 	r8a66597_bset(r8a66597, USBE, SYSCFG0);
158 
159 	r8a66597_bset(r8a66597, INTL, SOFCFG);
160 	r8a66597_write(r8a66597, 0, INTENB0);
161 	for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++)
162 		r8a66597_write(r8a66597, 0, get_intenb_reg(port));
163 
164 	r8a66597_bclr(r8a66597, BIGEND, CFIFOSEL);
165 	r8a66597_bclr(r8a66597, BIGEND, D0FIFOSEL);
166 	r8a66597_bclr(r8a66597, BIGEND, D1FIFOSEL);
167 	r8a66597_bset(r8a66597, TRNENSEL, SOFCFG);
168 
169 	for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++)
170 		r8a66597_enable_port(r8a66597, port);
171 
172 	return 0;
173 }
174 
175 static void disable_controller(struct r8a66597 *r8a66597)
176 {
177 	int i;
178 
179 	if (!(r8a66597_read(r8a66597, SYSCFG0) & USBE))
180 		return;
181 
182 	r8a66597_write(r8a66597, 0, INTENB0);
183 	r8a66597_write(r8a66597, 0, INTSTS0);
184 
185 	r8a66597_write(r8a66597, 0, D0FIFOSEL);
186 	r8a66597_write(r8a66597, 0, D1FIFOSEL);
187 	r8a66597_write(r8a66597, 0, DCPCFG);
188 	r8a66597_write(r8a66597, 0x40, DCPMAXP);
189 	r8a66597_write(r8a66597, 0, DCPCTR);
190 
191 	for (i = 0; i <= 10; i++)
192 		r8a66597_write(r8a66597, 0, get_devadd_addr(i));
193 	for (i = 1; i <= 5; i++) {
194 		r8a66597_write(r8a66597, 0, get_pipetre_addr(i));
195 		r8a66597_write(r8a66597, 0, get_pipetrn_addr(i));
196 	}
197 	for (i = 1; i < R8A66597_MAX_NUM_PIPE; i++) {
198 		r8a66597_write(r8a66597, 0, get_pipectr_addr(i));
199 		r8a66597_write(r8a66597, i, PIPESEL);
200 		r8a66597_write(r8a66597, 0, PIPECFG);
201 		r8a66597_write(r8a66597, 0, PIPEBUF);
202 		r8a66597_write(r8a66597, 0, PIPEMAXP);
203 		r8a66597_write(r8a66597, 0, PIPEPERI);
204 	}
205 
206 	for (i = 0; i < R8A66597_MAX_ROOT_HUB; i++)
207 		r8a66597_disable_port(r8a66597, i);
208 
209 	r8a66597_clock_disable(r8a66597);
210 }
211 
212 static void r8a66597_reg_wait(struct r8a66597 *r8a66597, unsigned long reg,
213 			      u16 mask, u16 loop)
214 {
215 	u16 tmp;
216 	int i = 0;
217 
218 	do {
219 		tmp = r8a66597_read(r8a66597, reg);
220 		if (i++ > 1000000) {
221 			printf("register%lx, loop %x is timeout\n", reg, loop);
222 			break;
223 		}
224 	} while ((tmp & mask) != loop);
225 }
226 
227 static void pipe_buffer_setting(struct r8a66597 *r8a66597,
228 				struct usb_device *dev, unsigned long pipe)
229 {
230 	u16 val = 0;
231 	u16 pipenum, bufnum, maxpacket;
232 
233 	if (usb_pipein(pipe)) {
234 		pipenum = BULK_IN_PIPENUM;
235 		bufnum = BULK_IN_BUFNUM;
236 		maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)];
237 	} else {
238 		pipenum = BULK_OUT_PIPENUM;
239 		bufnum = BULK_OUT_BUFNUM;
240 		maxpacket = dev->epmaxpacketout[usb_pipeendpoint(pipe)];
241 	}
242 
243 	if (r8a66597->pipe_config & (1 << pipenum))
244 		return;
245 	r8a66597->pipe_config |= (1 << pipenum);
246 
247 	r8a66597_bset(r8a66597, ACLRM, get_pipectr_addr(pipenum));
248 	r8a66597_bclr(r8a66597, ACLRM, get_pipectr_addr(pipenum));
249 	r8a66597_write(r8a66597, pipenum, PIPESEL);
250 
251 	/* FIXME: This driver support bulk transfer only. */
252 	if (!usb_pipein(pipe))
253 		val |= R8A66597_DIR;
254 	else
255 		val |= R8A66597_SHTNAK;
256 	val |= R8A66597_BULK | R8A66597_DBLB | usb_pipeendpoint(pipe);
257 	r8a66597_write(r8a66597, val, PIPECFG);
258 
259 	r8a66597_write(r8a66597, (8 << 10) | bufnum, PIPEBUF);
260 	r8a66597_write(r8a66597, make_devsel(usb_pipedevice(pipe)) |
261 				 maxpacket, PIPEMAXP);
262 	r8a66597_write(r8a66597, 0, PIPEPERI);
263 	r8a66597_write(r8a66597, SQCLR, get_pipectr_addr(pipenum));
264 }
265 
266 static int send_setup_packet(struct r8a66597 *r8a66597, struct usb_device *dev,
267 			     struct devrequest *setup)
268 {
269 	int i;
270 	unsigned short *p = (unsigned short *)setup;
271 	unsigned long setup_addr = USBREQ;
272 	u16 intsts1;
273 	int timeout = 3000;
274 	u16 dcpctr;
275 	u16 devsel = setup->request == USB_REQ_SET_ADDRESS ? 0 : dev->devnum;
276 
277 	r8a66597_write(r8a66597, make_devsel(devsel) |
278 				 (8 << dev->maxpacketsize), DCPMAXP);
279 	r8a66597_write(r8a66597, ~(SIGN | SACK), INTSTS1);
280 
281 	dcpctr = r8a66597_read(r8a66597, DCPCTR);
282 	if ((dcpctr & PID) == PID_BUF) {
283 		if (readw_poll_timeout(r8a66597->reg + DCPCTR, dcpctr,
284 				       dcpctr & BSTS, 1000) < 0) {
285 			printf("DCPCTR BSTS timeout!\n");
286 			return -ETIMEDOUT;
287 		}
288 	}
289 
290 	for (i = 0; i < 4; i++) {
291 		r8a66597_write(r8a66597, le16_to_cpu(p[i]), setup_addr);
292 		setup_addr += 2;
293 	}
294 	r8a66597_write(r8a66597, ~0x0001, BRDYSTS);
295 	r8a66597_write(r8a66597, SUREQ, DCPCTR);
296 
297 	while (1) {
298 		intsts1 = r8a66597_read(r8a66597, INTSTS1);
299 		if (intsts1 & SACK)
300 			break;
301 		if (intsts1 & SIGN) {
302 			printf("setup packet send error\n");
303 			return -1;
304 		}
305 		if (timeout-- < 0) {
306 			printf("setup packet timeout\n");
307 			return -1;
308 		}
309 		udelay(500);
310 	}
311 
312 	return 0;
313 }
314 
315 static int send_bulk_packet(struct r8a66597 *r8a66597, struct usb_device *dev,
316 			    unsigned long pipe, void *buffer, int transfer_len)
317 {
318 	u16 tmp, bufsize;
319 	u16 *buf;
320 	size_t size;
321 
322 	R8A66597_DPRINT("%s\n", __func__);
323 
324 	r8a66597_mdfy(r8a66597, MBW | BULK_OUT_PIPENUM,
325 			MBW | CURPIPE, CFIFOSEL);
326 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, BULK_OUT_PIPENUM);
327 	tmp = r8a66597_read(r8a66597, CFIFOCTR);
328 	if ((tmp & FRDY) == 0) {
329 		printf("%s FRDY is not set (%x)\n", __func__, tmp);
330 		return -1;
331 	}
332 
333 	/* prepare parameters */
334 	bufsize = dev->epmaxpacketout[usb_pipeendpoint(pipe)];
335 	buf = (u16 *)(buffer + dev->act_len);
336 	size = min((int)bufsize, transfer_len - dev->act_len);
337 
338 	/* write fifo */
339 	r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS);
340 	if (buffer) {
341 		r8a66597_write_fifo(r8a66597, CFIFO, buf, size);
342 		r8a66597_write(r8a66597, BVAL, CFIFOCTR);
343 	}
344 
345 	/* update parameters */
346 	dev->act_len += size;
347 
348 	r8a66597_mdfy(r8a66597, PID_BUF, PID,
349 			get_pipectr_addr(BULK_OUT_PIPENUM));
350 
351 	while (!(r8a66597_read(r8a66597, BEMPSTS) & (1 << BULK_OUT_PIPENUM)))
352 		if (ctrlc())
353 			return -1;
354 	r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS);
355 
356 	if (dev->act_len >= transfer_len)
357 		r8a66597_mdfy(r8a66597, PID_NAK, PID,
358 				get_pipectr_addr(BULK_OUT_PIPENUM));
359 
360 	return 0;
361 }
362 
363 static int receive_bulk_packet(struct r8a66597 *r8a66597,
364 			       struct usb_device *dev,
365 			       unsigned long pipe,
366 			       void *buffer, int transfer_len)
367 {
368 	u16 tmp;
369 	u16 *buf;
370 	const u16 pipenum = BULK_IN_PIPENUM;
371 	int rcv_len;
372 	int maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)];
373 
374 	R8A66597_DPRINT("%s\n", __func__);
375 
376 	/* prepare */
377 	if (dev->act_len == 0) {
378 		r8a66597_mdfy(r8a66597, PID_NAK, PID,
379 				get_pipectr_addr(pipenum));
380 		r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS);
381 
382 		r8a66597_write(r8a66597, TRCLR, get_pipetre_addr(pipenum));
383 		r8a66597_write(r8a66597,
384 				(transfer_len + maxpacket - 1) / maxpacket,
385 				get_pipetrn_addr(pipenum));
386 		r8a66597_bset(r8a66597, TRENB, get_pipetre_addr(pipenum));
387 
388 		r8a66597_mdfy(r8a66597, PID_BUF, PID,
389 				get_pipectr_addr(pipenum));
390 	}
391 
392 	r8a66597_mdfy(r8a66597, MBW | pipenum, MBW | CURPIPE, CFIFOSEL);
393 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum);
394 
395 	while (!(r8a66597_read(r8a66597, BRDYSTS) & (1 << pipenum)))
396 		if (ctrlc())
397 			return -1;
398 	r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS);
399 
400 	tmp = r8a66597_read(r8a66597, CFIFOCTR);
401 	if ((tmp & FRDY) == 0) {
402 		printf("%s FRDY is not set. (%x)\n", __func__, tmp);
403 		return -1;
404 	}
405 
406 	buf = (u16 *)(buffer + dev->act_len);
407 	rcv_len = tmp & DTLN;
408 	dev->act_len += rcv_len;
409 
410 	if (buffer) {
411 		if (rcv_len == 0)
412 			r8a66597_write(r8a66597, BCLR, CFIFOCTR);
413 		else
414 			r8a66597_read_fifo(r8a66597, CFIFO, buf, rcv_len);
415 	}
416 
417 	return 0;
418 }
419 
420 static int receive_control_packet(struct r8a66597 *r8a66597,
421 				  struct usb_device *dev,
422 				  void *buffer, int transfer_len)
423 {
424 	u16 tmp;
425 	int rcv_len;
426 
427 	/* FIXME: limit transfer size : 64byte or less */
428 
429 	r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG);
430 	r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL);
431 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
432 	r8a66597_bset(r8a66597, SQSET, DCPCTR);
433 	r8a66597_write(r8a66597, BCLR, CFIFOCTR);
434 	r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR);
435 
436 	while (!(r8a66597_read(r8a66597, BRDYSTS) & 0x0001))
437 		if (ctrlc())
438 			return -1;
439 	r8a66597_write(r8a66597, ~0x0001, BRDYSTS);
440 
441 	r8a66597_mdfy(r8a66597, MBW, MBW | CURPIPE, CFIFOSEL);
442 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
443 
444 	tmp = r8a66597_read(r8a66597, CFIFOCTR);
445 	if ((tmp & FRDY) == 0) {
446 		printf("%s FRDY is not set. (%x)\n", __func__, tmp);
447 		return -1;
448 	}
449 
450 	rcv_len = tmp & DTLN;
451 	dev->act_len += rcv_len;
452 
453 	r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR);
454 
455 	if (buffer) {
456 		if (rcv_len == 0)
457 			r8a66597_write(r8a66597, BCLR, DCPCTR);
458 		else
459 			r8a66597_read_fifo(r8a66597, CFIFO, buffer, rcv_len);
460 	}
461 
462 	return 0;
463 }
464 
465 static int send_status_packet(struct r8a66597 *r8a66597,
466 			       unsigned long pipe)
467 {
468 	r8a66597_bset(r8a66597, SQSET, DCPCTR);
469 	r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR);
470 
471 	if (usb_pipein(pipe)) {
472 		r8a66597_bset(r8a66597, R8A66597_DIR, DCPCFG);
473 		r8a66597_mdfy(r8a66597, ISEL, ISEL | CURPIPE, CFIFOSEL);
474 		r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
475 		r8a66597_write(r8a66597, ~BEMP0, BEMPSTS);
476 		r8a66597_write(r8a66597, BCLR | BVAL, CFIFOCTR);
477 	} else {
478 		r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG);
479 		r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL);
480 		r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
481 		r8a66597_write(r8a66597, BCLR, CFIFOCTR);
482 	}
483 	r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR);
484 
485 	while (!(r8a66597_read(r8a66597, BEMPSTS) & 0x0001))
486 		if (ctrlc())
487 			return -1;
488 
489 	return 0;
490 }
491 
492 static void r8a66597_check_syssts(struct r8a66597 *r8a66597, int port)
493 {
494 	int count = R8A66597_MAX_SAMPLING;
495 	unsigned short syssts, old_syssts;
496 
497 	R8A66597_DPRINT("%s\n", __func__);
498 
499 	old_syssts = r8a66597_read(r8a66597, get_syssts_reg(port) & LNST);
500 	while (count > 0) {
501 		mdelay(R8A66597_RH_POLL_TIME);
502 
503 		syssts = r8a66597_read(r8a66597, get_syssts_reg(port) & LNST);
504 		if (syssts == old_syssts) {
505 			count--;
506 		} else {
507 			count = R8A66597_MAX_SAMPLING;
508 			old_syssts = syssts;
509 		}
510 	}
511 }
512 
513 static void r8a66597_bus_reset(struct r8a66597 *r8a66597, int port)
514 {
515 	mdelay(10);
516 	r8a66597_mdfy(r8a66597, USBRST, USBRST | UACT, get_dvstctr_reg(port));
517 	mdelay(50);
518 	r8a66597_mdfy(r8a66597, UACT, USBRST | UACT, get_dvstctr_reg(port));
519 	mdelay(50);
520 }
521 
522 static int check_usb_device_connecting(struct r8a66597 *r8a66597)
523 {
524 	int timeout = 10000;	/* 100usec * 10000 = 1sec */
525 	int i;
526 
527 	for (i = 0; i < 5; i++) {
528 		/* check a usb cable connect */
529 		while (!(r8a66597_read(r8a66597, INTSTS1) & ATTCH)) {
530 			if (timeout-- < 0) {
531 				printf("%s timeout.\n", __func__);
532 				return -1;
533 			}
534 			udelay(100);
535 		}
536 
537 		/* check a data line */
538 		r8a66597_check_syssts(r8a66597, 0);
539 
540 		r8a66597_bus_reset(r8a66597, 0);
541 		r8a66597->speed = get_rh_usb_speed(r8a66597, 0);
542 
543 		if (!(r8a66597_read(r8a66597, INTSTS1) & DTCH)) {
544 			r8a66597->port_change = USB_PORT_STAT_C_CONNECTION;
545 			r8a66597->port_status = USB_PORT_STAT_CONNECTION |
546 						USB_PORT_STAT_ENABLE;
547 			return 0;	/* success */
548 		}
549 
550 		R8A66597_DPRINT("USB device has detached. retry = %d\n", i);
551 		r8a66597_write(r8a66597, ~DTCH, INTSTS1);
552 	}
553 
554 	return -1;	/* fail */
555 }
556 
557 /*-------------------------------------------------------------------------*
558  * Virtual Root Hub
559  *-------------------------------------------------------------------------*/
560 
561 #include <usbroothubdes.h>
562 
563 static int r8a66597_submit_rh_msg(struct udevice *udev, struct usb_device *dev,
564 				  unsigned long pipe, void *buffer,
565 				  int transfer_len, struct devrequest *cmd)
566 {
567 	struct r8a66597 *r8a66597 = dev_get_priv(udev);
568 	int leni = transfer_len;
569 	int len = 0;
570 	int stat = 0;
571 	__u16 bmRType_bReq;
572 	__u16 wValue;
573 	__u16 wLength;
574 	unsigned char data[32];
575 
576 	R8A66597_DPRINT("%s\n", __func__);
577 
578 	if (usb_pipeint(pipe)) {
579 		printf("Root-Hub submit IRQ: NOT implemented");
580 		return 0;
581 	}
582 
583 	bmRType_bReq  = cmd->requesttype | (cmd->request << 8);
584 	wValue	      = cpu_to_le16 (cmd->value);
585 	wLength	      = cpu_to_le16 (cmd->length);
586 
587 	switch (bmRType_bReq) {
588 	case RH_GET_STATUS:
589 		*(__u16 *)buffer = cpu_to_le16(1);
590 		len = 2;
591 		break;
592 	case RH_GET_STATUS | RH_INTERFACE:
593 		*(__u16 *)buffer = cpu_to_le16(0);
594 		len = 2;
595 		break;
596 	case RH_GET_STATUS | RH_ENDPOINT:
597 		*(__u16 *)buffer = cpu_to_le16(0);
598 		len = 2;
599 		break;
600 	case RH_GET_STATUS | RH_CLASS:
601 		*(__u32 *)buffer = cpu_to_le32(0);
602 		len = 4;
603 		break;
604 	case RH_GET_STATUS | RH_OTHER | RH_CLASS:
605 		*(__u32 *)buffer = cpu_to_le32(r8a66597->port_status |
606 						(r8a66597->port_change << 16));
607 		len = 4;
608 		break;
609 	case RH_CLEAR_FEATURE | RH_ENDPOINT:
610 	case RH_CLEAR_FEATURE | RH_CLASS:
611 		break;
612 
613 	case RH_CLEAR_FEATURE | RH_OTHER | RH_CLASS:
614 		switch (wValue) {
615 		case RH_C_PORT_CONNECTION:
616 			r8a66597->port_change &= ~USB_PORT_STAT_C_CONNECTION;
617 			break;
618 		}
619 		break;
620 
621 	case RH_SET_FEATURE | RH_OTHER | RH_CLASS:
622 		switch (wValue) {
623 		case (RH_PORT_SUSPEND):
624 			break;
625 		case (RH_PORT_RESET):
626 			r8a66597_bus_reset(r8a66597, 0);
627 			break;
628 		case (RH_PORT_POWER):
629 			break;
630 		case (RH_PORT_ENABLE):
631 			break;
632 		}
633 		break;
634 	case RH_SET_ADDRESS:
635 		r8a66597->rh_devnum = wValue;
636 		break;
637 	case RH_GET_DESCRIPTOR:
638 		switch ((wValue & 0xff00) >> 8) {
639 		case (0x01): /* device descriptor */
640 			len = min_t(unsigned int,
641 				  leni,
642 				  min_t(unsigned int,
643 				      sizeof(root_hub_dev_des),
644 				      wLength));
645 			memcpy(buffer, root_hub_dev_des, len);
646 			break;
647 		case (0x02): /* configuration descriptor */
648 			len = min_t(unsigned int,
649 				  leni,
650 				  min_t(unsigned int,
651 				      sizeof(root_hub_config_des),
652 				      wLength));
653 			memcpy(buffer, root_hub_config_des, len);
654 			break;
655 		case (0x03): /* string descriptors */
656 			if (wValue == 0x0300) {
657 				len = min_t(unsigned int,
658 					  leni,
659 					  min_t(unsigned int,
660 					      sizeof(root_hub_str_index0),
661 					      wLength));
662 				memcpy(buffer, root_hub_str_index0, len);
663 			}
664 			if (wValue == 0x0301) {
665 				len = min_t(unsigned int,
666 					  leni,
667 					  min_t(unsigned int,
668 					      sizeof(root_hub_str_index1),
669 					      wLength));
670 				memcpy(buffer, root_hub_str_index1, len);
671 			}
672 			break;
673 		default:
674 			stat = USB_ST_STALLED;
675 		}
676 		break;
677 
678 	case RH_GET_DESCRIPTOR | RH_CLASS:
679 	{
680 		__u32 temp = 0x00000001;
681 
682 		data[0] = 9;		/* min length; */
683 		data[1] = 0x29;
684 		data[2] = temp & RH_A_NDP;
685 		data[3] = 0;
686 		if (temp & RH_A_PSM)
687 			data[3] |= 0x1;
688 		if (temp & RH_A_NOCP)
689 			data[3] |= 0x10;
690 		else if (temp & RH_A_OCPM)
691 			data[3] |= 0x8;
692 
693 		/* corresponds to data[4-7] */
694 		data[5] = (temp & RH_A_POTPGT) >> 24;
695 		data[7] = temp & RH_B_DR;
696 		if (data[2] < 7) {
697 			data[8] = 0xff;
698 		} else {
699 			data[0] += 2;
700 			data[8] = (temp & RH_B_DR) >> 8;
701 			data[10] = data[9] = 0xff;
702 		}
703 
704 		len = min_t(unsigned int, leni,
705 			    min_t(unsigned int, data[0], wLength));
706 		memcpy(buffer, data, len);
707 		break;
708 	}
709 
710 	case RH_GET_CONFIGURATION:
711 		*(__u8 *) buffer = 0x01;
712 		len = 1;
713 		break;
714 	case RH_SET_CONFIGURATION:
715 		break;
716 	default:
717 		R8A66597_DPRINT("unsupported root hub command");
718 		stat = USB_ST_STALLED;
719 	}
720 
721 	mdelay(1);
722 
723 	len = min_t(int, len, leni);
724 
725 	dev->act_len = len;
726 	dev->status = stat;
727 
728 	return stat;
729 }
730 
731 static int r8a66597_submit_control_msg(struct udevice *udev, struct usb_device *dev,
732 				   unsigned long pipe, void *buffer, int length,
733 				   struct devrequest *setup)
734 {
735 	struct r8a66597 *r8a66597 = dev_get_priv(udev);
736 	u16 r8a66597_address = setup->request == USB_REQ_SET_ADDRESS ?
737 					0 : dev->devnum;
738 
739 	debug("%s: dev='%s', udev=%p, udev->dev='%s', portnr=%d\n", __func__,
740 	      udev->name, dev, dev->dev->name, dev->portnr);
741 
742 	R8A66597_DPRINT("%s\n", __func__);
743 	if (usb_pipedevice(pipe) == r8a66597->rh_devnum)
744 		return r8a66597_submit_rh_msg(udev, dev, pipe, buffer,
745 					      length, setup);
746 
747 	R8A66597_DPRINT("%s: setup\n", __func__);
748 	set_devadd(r8a66597, r8a66597_address, dev, 0);
749 
750 	if (send_setup_packet(r8a66597, dev, setup) < 0) {
751 		printf("setup packet send error\n");
752 		return -1;
753 	}
754 
755 	dev->act_len = 0;
756 	if (usb_pipein(pipe))
757 		if (receive_control_packet(r8a66597, dev, buffer,
758 						length) < 0)
759 			return -1;
760 
761 	if (send_status_packet(r8a66597, pipe) < 0)
762 		return -1;
763 
764 	dev->status = 0;
765 
766 	return 0;
767 }
768 
769 static int r8a66597_submit_bulk_msg(struct udevice *udev, struct usb_device *dev,
770 				unsigned long pipe, void *buffer, int length)
771 {
772 	struct r8a66597 *r8a66597 = dev_get_priv(udev);
773 	int ret = 0;
774 
775 	debug("%s: dev='%s', udev=%p\n", __func__, udev->name, dev);
776 
777 	R8A66597_DPRINT("%s\n", __func__);
778 	R8A66597_DPRINT("pipe = %08x, buffer = %p, len = %d, devnum = %d\n",
779 			pipe, buffer, length, dev->devnum);
780 
781 	set_devadd(r8a66597, dev->devnum, dev, 0);
782 
783 	pipe_buffer_setting(r8a66597, dev, pipe);
784 
785 	dev->act_len = 0;
786 	while (dev->act_len < length && ret == 0) {
787 		if (ctrlc())
788 			return -1;
789 
790 		if (usb_pipein(pipe))
791 			ret = receive_bulk_packet(r8a66597, dev, pipe, buffer,
792 							length);
793 		else
794 			ret = send_bulk_packet(r8a66597, dev, pipe, buffer,
795 							length);
796 	}
797 
798 	if (ret == 0)
799 		dev->status = 0;
800 
801 	return ret;
802 }
803 
804 static int r8a66597_usb_ofdata_to_platdata(struct udevice *dev)
805 {
806 	struct r8a66597 *priv = dev_get_priv(dev);
807 	fdt_addr_t addr;
808 
809 	addr = dev_read_addr(dev);
810 	if (addr == FDT_ADDR_T_NONE)
811 		return -EINVAL;
812 	priv->reg = addr;
813 
814 	return 0;
815 }
816 
817 static int r8a66597_usb_probe(struct udevice *dev)
818 {
819 	struct r8a66597 *priv = dev_get_priv(dev);
820 	struct usb_bus_priv *bus_priv = dev_get_uclass_priv(dev);
821 
822 	bus_priv->desc_before_addr = true;
823 
824 	disable_controller(priv);
825 	mdelay(100);
826 
827 	enable_controller(priv);
828 	r8a66597_port_power(priv, 0 , 1);
829 
830 	/* check usb device */
831 	check_usb_device_connecting(priv);
832 
833 	mdelay(50);
834 
835 	return 0;
836 }
837 
838 static int r8a66597_usb_remove(struct udevice *dev)
839 {
840 	struct r8a66597 *priv = dev_get_priv(dev);
841 
842 	disable_controller(priv);
843 
844 	return 0;
845 }
846 
847 struct dm_usb_ops r8a66597_usb_ops = {
848 	.control = r8a66597_submit_control_msg,
849 	.bulk = r8a66597_submit_bulk_msg,
850 };
851 
852 static const struct udevice_id r8a66597_usb_ids[] = {
853 	{ .compatible = "renesas,rza1-usbhs" },
854 	{ }
855 };
856 
857 U_BOOT_DRIVER(usb_r8a66597) = {
858 	.name	= "r8a66597_usb",
859 	.id	= UCLASS_USB,
860 	.of_match = r8a66597_usb_ids,
861 	.ofdata_to_platdata = r8a66597_usb_ofdata_to_platdata,
862 	.probe	= r8a66597_usb_probe,
863 	.remove = r8a66597_usb_remove,
864 	.ops	= &r8a66597_usb_ops,
865 	.priv_auto_alloc_size = sizeof(struct r8a66597),
866 	.flags	= DM_FLAG_ALLOC_PRIV_DMA,
867 };
868