xref: /openbmc/u-boot/drivers/usb/host/r8a66597-hcd.c (revision e8f80a5a)
1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0
22731b9a8SJean-Christophe PLAGNIOL-VILLARD /*
32731b9a8SJean-Christophe PLAGNIOL-VILLARD  * R8A66597 HCD (Host Controller Driver) for u-boot
42731b9a8SJean-Christophe PLAGNIOL-VILLARD  *
52731b9a8SJean-Christophe PLAGNIOL-VILLARD  * Copyright (C) 2008  Yoshihiro Shimoda <shimoda.yoshihiro@renesas.com>
62731b9a8SJean-Christophe PLAGNIOL-VILLARD  */
72731b9a8SJean-Christophe PLAGNIOL-VILLARD 
82731b9a8SJean-Christophe PLAGNIOL-VILLARD #include <common.h>
924b852a7SSimon Glass #include <console.h>
102731b9a8SJean-Christophe PLAGNIOL-VILLARD #include <usb.h>
112731b9a8SJean-Christophe PLAGNIOL-VILLARD #include <asm/io.h>
12243fd642SChris Brandt #include <linux/iopoll.h>
132731b9a8SJean-Christophe PLAGNIOL-VILLARD 
142731b9a8SJean-Christophe PLAGNIOL-VILLARD #include "r8a66597.h"
152731b9a8SJean-Christophe PLAGNIOL-VILLARD 
162731b9a8SJean-Christophe PLAGNIOL-VILLARD #ifdef R8A66597_DEBUG
172731b9a8SJean-Christophe PLAGNIOL-VILLARD #define R8A66597_DPRINT		printf
182731b9a8SJean-Christophe PLAGNIOL-VILLARD #else
192731b9a8SJean-Christophe PLAGNIOL-VILLARD #define R8A66597_DPRINT(...)
202731b9a8SJean-Christophe PLAGNIOL-VILLARD #endif
212731b9a8SJean-Christophe PLAGNIOL-VILLARD 
222731b9a8SJean-Christophe PLAGNIOL-VILLARD static struct r8a66597 gr8a66597;
232731b9a8SJean-Christophe PLAGNIOL-VILLARD 
get_hub_data(struct usb_device * dev,u16 * hub_devnum,u16 * hubport)242731b9a8SJean-Christophe PLAGNIOL-VILLARD static void get_hub_data(struct usb_device *dev, u16 *hub_devnum, u16 *hubport)
252731b9a8SJean-Christophe PLAGNIOL-VILLARD {
262731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int i;
272731b9a8SJean-Christophe PLAGNIOL-VILLARD 
282731b9a8SJean-Christophe PLAGNIOL-VILLARD 	*hub_devnum = 0;
292731b9a8SJean-Christophe PLAGNIOL-VILLARD 	*hubport = 0;
302731b9a8SJean-Christophe PLAGNIOL-VILLARD 
312731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* check a device connected to root_hub */
322731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if ((dev->parent && dev->parent->devnum == 1) ||
332731b9a8SJean-Christophe PLAGNIOL-VILLARD 	    (dev->devnum == 1))
342731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return;
352731b9a8SJean-Christophe PLAGNIOL-VILLARD 
362731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 0; i < USB_MAXCHILDREN; i++) {
372731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (dev->parent->children[i] == dev) {
382731b9a8SJean-Christophe PLAGNIOL-VILLARD 			*hub_devnum = (u8)dev->parent->devnum;
392731b9a8SJean-Christophe PLAGNIOL-VILLARD 			*hubport = i;
402731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return;
412731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
422731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
432731b9a8SJean-Christophe PLAGNIOL-VILLARD 
442731b9a8SJean-Christophe PLAGNIOL-VILLARD 	printf("get_hub_data error.\n");
452731b9a8SJean-Christophe PLAGNIOL-VILLARD }
462731b9a8SJean-Christophe PLAGNIOL-VILLARD 
set_devadd(struct r8a66597 * r8a66597,u8 r8a66597_address,struct usb_device * dev,int port)472731b9a8SJean-Christophe PLAGNIOL-VILLARD static void set_devadd(struct r8a66597 *r8a66597, u8 r8a66597_address,
482731b9a8SJean-Christophe PLAGNIOL-VILLARD 			struct usb_device *dev, int port)
492731b9a8SJean-Christophe PLAGNIOL-VILLARD {
502731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 val, usbspd, upphub, hubport;
512731b9a8SJean-Christophe PLAGNIOL-VILLARD 	unsigned long devadd_reg = get_devadd_addr(r8a66597_address);
522731b9a8SJean-Christophe PLAGNIOL-VILLARD 
532731b9a8SJean-Christophe PLAGNIOL-VILLARD 	get_hub_data(dev, &upphub, &hubport);
542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	usbspd = r8a66597->speed;
552731b9a8SJean-Christophe PLAGNIOL-VILLARD 	val = (upphub << 11) | (hubport << 8) | (usbspd << 6) | (port & 0x0001);
562731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, val, devadd_reg);
572731b9a8SJean-Christophe PLAGNIOL-VILLARD }
582731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_clock_enable(struct r8a66597 * r8a66597)592731b9a8SJean-Christophe PLAGNIOL-VILLARD static int r8a66597_clock_enable(struct r8a66597 *r8a66597)
602731b9a8SJean-Christophe PLAGNIOL-VILLARD {
612731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 tmp;
622731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int i = 0;
632731b9a8SJean-Christophe PLAGNIOL-VILLARD 
642731b9a8SJean-Christophe PLAGNIOL-VILLARD #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597)
652731b9a8SJean-Christophe PLAGNIOL-VILLARD 	do {
662731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, SCKE, SYSCFG0);
672731b9a8SJean-Christophe PLAGNIOL-VILLARD 		tmp = r8a66597_read(r8a66597, SYSCFG0);
682731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (i++ > 1000) {
692731b9a8SJean-Christophe PLAGNIOL-VILLARD 			printf("register access fail.\n");
702731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
712731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
722731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} while ((tmp & SCKE) != SCKE);
732731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0x04, 0x02);
742731b9a8SJean-Christophe PLAGNIOL-VILLARD #else
752731b9a8SJean-Christophe PLAGNIOL-VILLARD 	do {
762731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, USBE, SYSCFG0);
772731b9a8SJean-Christophe PLAGNIOL-VILLARD 		tmp = r8a66597_read(r8a66597, SYSCFG0);
782731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (i++ > 1000) {
792731b9a8SJean-Christophe PLAGNIOL-VILLARD 			printf("register access fail.\n");
802731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
812731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
822731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} while ((tmp & USBE) != USBE);
832731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, USBE, SYSCFG0);
8411f46789SChris Brandt #if !defined(CONFIG_RZA_USB)
859d034208SNobuhiro Iwamatsu 	r8a66597_mdfy(r8a66597, CONFIG_R8A66597_XTAL, XTAL, SYSCFG0);
862731b9a8SJean-Christophe PLAGNIOL-VILLARD 
872731b9a8SJean-Christophe PLAGNIOL-VILLARD 	i = 0;
882731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, XCKE, SYSCFG0);
892731b9a8SJean-Christophe PLAGNIOL-VILLARD 	do {
902731b9a8SJean-Christophe PLAGNIOL-VILLARD 		udelay(1000);
912731b9a8SJean-Christophe PLAGNIOL-VILLARD 		tmp = r8a66597_read(r8a66597, SYSCFG0);
922731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (i++ > 500) {
932731b9a8SJean-Christophe PLAGNIOL-VILLARD 			printf("register access fail.\n");
942731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
952731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
962731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} while ((tmp & SCKE) != SCKE);
9711f46789SChris Brandt #else
9811f46789SChris Brandt 	/*
9911f46789SChris Brandt 	 * RZ/A Only:
10011f46789SChris Brandt 	 * Bits XTAL(UCKSEL) and UPLLE in SYSCFG0 for USB0 controls both USB0
10111f46789SChris Brandt 	 * and USB1, so we must always set the USB0 register
10211f46789SChris Brandt 	 */
10311f46789SChris Brandt #if (CONFIG_R8A66597_XTAL == 1)
10411f46789SChris Brandt 	setbits(le16, R8A66597_BASE0, XTAL);
10511f46789SChris Brandt #endif
10611f46789SChris Brandt 	mdelay(1);
10711f46789SChris Brandt 	setbits(le16, R8A66597_BASE0, UPLLE);
10811f46789SChris Brandt 	mdelay(1);
10911f46789SChris Brandt 	r8a66597_bset(r8a66597, SUSPM, SUSPMODE0);
11011f46789SChris Brandt #endif /* CONFIG_RZA_USB */
1112731b9a8SJean-Christophe PLAGNIOL-VILLARD #endif	/* #if defined(CONFIG_SUPERH_ON_CHIP_R8A66597) */
1122731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1132731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
1142731b9a8SJean-Christophe PLAGNIOL-VILLARD }
1152731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_clock_disable(struct r8a66597 * r8a66597)1162731b9a8SJean-Christophe PLAGNIOL-VILLARD static void r8a66597_clock_disable(struct r8a66597 *r8a66597)
1172731b9a8SJean-Christophe PLAGNIOL-VILLARD {
11811f46789SChris Brandt #if !defined(CONFIG_RZA_USB)
1192731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, SCKE, SYSCFG0);
1202731b9a8SJean-Christophe PLAGNIOL-VILLARD 	udelay(1);
1212731b9a8SJean-Christophe PLAGNIOL-VILLARD #if !defined(CONFIG_SUPERH_ON_CHIP_R8A66597)
1222731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, PLLC, SYSCFG0);
1232731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, XCKE, SYSCFG0);
1242731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, USBE, SYSCFG0);
1252731b9a8SJean-Christophe PLAGNIOL-VILLARD #endif
12611f46789SChris Brandt #else
12711f46789SChris Brandt 	r8a66597_bclr(r8a66597, SUSPM, SUSPMODE0);
12811f46789SChris Brandt 
12911f46789SChris Brandt 	clrbits(le16, R8A66597_BASE0, UPLLE);
13011f46789SChris Brandt 	mdelay(1);
13111f46789SChris Brandt 	r8a66597_bclr(r8a66597, USBE, SYSCFG0);
13211f46789SChris Brandt 	mdelay(1);
13311f46789SChris Brandt 
13411f46789SChris Brandt #endif
1352731b9a8SJean-Christophe PLAGNIOL-VILLARD }
1362731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_enable_port(struct r8a66597 * r8a66597,int port)1372731b9a8SJean-Christophe PLAGNIOL-VILLARD static void r8a66597_enable_port(struct r8a66597 *r8a66597, int port)
1382731b9a8SJean-Christophe PLAGNIOL-VILLARD {
1392731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 val;
1402731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1412731b9a8SJean-Christophe PLAGNIOL-VILLARD 	val = port ? DRPD : DCFM | DRPD;
1422731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, val, get_syscfg_reg(port));
1432731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, HSE, get_syscfg_reg(port));
1442731b9a8SJean-Christophe PLAGNIOL-VILLARD 
14511f46789SChris Brandt #if !defined(CONFIG_RZA_USB)
1462731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, BURST | CPU_ADR_RD_WR, get_dmacfg_reg(port));
14711f46789SChris Brandt #endif
1482731b9a8SJean-Christophe PLAGNIOL-VILLARD }
1492731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_disable_port(struct r8a66597 * r8a66597,int port)1502731b9a8SJean-Christophe PLAGNIOL-VILLARD static void r8a66597_disable_port(struct r8a66597 *r8a66597, int port)
1512731b9a8SJean-Christophe PLAGNIOL-VILLARD {
1522731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 val, tmp;
1532731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, get_intenb_reg(port));
1552731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, get_intsts_reg(port));
1562731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1572731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_port_power(r8a66597, port, 0);
1582731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1592731b9a8SJean-Christophe PLAGNIOL-VILLARD 	do {
1602731b9a8SJean-Christophe PLAGNIOL-VILLARD 		tmp = r8a66597_read(r8a66597, SOFCFG) & EDGESTS;
1612731b9a8SJean-Christophe PLAGNIOL-VILLARD 		udelay(640);
1622731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} while (tmp == EDGESTS);
1632731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1642731b9a8SJean-Christophe PLAGNIOL-VILLARD 	val = port ? DRPD : DCFM | DRPD;
1652731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, val, get_syscfg_reg(port));
1662731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, HSE, get_syscfg_reg(port));
1672731b9a8SJean-Christophe PLAGNIOL-VILLARD }
1682731b9a8SJean-Christophe PLAGNIOL-VILLARD 
enable_controller(struct r8a66597 * r8a66597)1692731b9a8SJean-Christophe PLAGNIOL-VILLARD static int enable_controller(struct r8a66597 *r8a66597)
1702731b9a8SJean-Christophe PLAGNIOL-VILLARD {
1712731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int ret, port;
1722731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1732731b9a8SJean-Christophe PLAGNIOL-VILLARD 	ret = r8a66597_clock_enable(r8a66597);
1742731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (ret < 0)
1752731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return ret;
1762731b9a8SJean-Christophe PLAGNIOL-VILLARD 
17711f46789SChris Brandt #if !defined(CONFIG_RZA_USB)
1789d034208SNobuhiro Iwamatsu 	r8a66597_bset(r8a66597, CONFIG_R8A66597_LDRV & LDRV, PINCFG);
17911f46789SChris Brandt #endif
1802731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, USBE, SYSCFG0);
1812731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1822731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, INTL, SOFCFG);
1832731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, INTENB0);
1848ecdce72Syasuhisa umano 	for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++)
1858ecdce72Syasuhisa umano 		r8a66597_write(r8a66597, 0, get_intenb_reg(port));
1862731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1879d034208SNobuhiro Iwamatsu 	r8a66597_bset(r8a66597, CONFIG_R8A66597_ENDIAN & BIGEND, CFIFOSEL);
1889d034208SNobuhiro Iwamatsu 	r8a66597_bset(r8a66597, CONFIG_R8A66597_ENDIAN & BIGEND, D0FIFOSEL);
1899d034208SNobuhiro Iwamatsu 	r8a66597_bset(r8a66597, CONFIG_R8A66597_ENDIAN & BIGEND, D1FIFOSEL);
1902731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, TRNENSEL, SOFCFG);
1912731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1922731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (port = 0; port < R8A66597_MAX_ROOT_HUB; port++)
1932731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_enable_port(r8a66597, port);
1942731b9a8SJean-Christophe PLAGNIOL-VILLARD 
1952731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
1962731b9a8SJean-Christophe PLAGNIOL-VILLARD }
1972731b9a8SJean-Christophe PLAGNIOL-VILLARD 
disable_controller(struct r8a66597 * r8a66597)1982731b9a8SJean-Christophe PLAGNIOL-VILLARD static void disable_controller(struct r8a66597 *r8a66597)
1992731b9a8SJean-Christophe PLAGNIOL-VILLARD {
2002731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int i;
2012731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2022731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (!(r8a66597_read(r8a66597, SYSCFG0) & USBE))
2032731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return;
2042731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2052731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, INTENB0);
2062731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, INTSTS0);
2072731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2082731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, D0FIFOSEL);
2092731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, D1FIFOSEL);
2102731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, DCPCFG);
2112731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0x40, DCPMAXP);
2122731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, DCPCTR);
2132731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2142731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 0; i <= 10; i++)
2152731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, get_devadd_addr(i));
2162731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 1; i <= 5; i++) {
2172731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, get_pipetre_addr(i));
2182731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, get_pipetrn_addr(i));
2192731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
2202731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 1; i < R8A66597_MAX_NUM_PIPE; i++) {
2212731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, get_pipectr_addr(i));
2222731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, i, PIPESEL);
2232731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, PIPECFG);
2242731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, PIPEBUF);
2252731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, PIPEMAXP);
2262731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, 0, PIPEPERI);
2272731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
2282731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2292731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 0; i < R8A66597_MAX_ROOT_HUB; i++)
2302731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_disable_port(r8a66597, i);
2312731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2322731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_clock_disable(r8a66597);
2332731b9a8SJean-Christophe PLAGNIOL-VILLARD }
2342731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_reg_wait(struct r8a66597 * r8a66597,unsigned long reg,u16 mask,u16 loop)2352731b9a8SJean-Christophe PLAGNIOL-VILLARD static void r8a66597_reg_wait(struct r8a66597 *r8a66597, unsigned long reg,
2362731b9a8SJean-Christophe PLAGNIOL-VILLARD 			      u16 mask, u16 loop)
2372731b9a8SJean-Christophe PLAGNIOL-VILLARD {
2382731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 tmp;
2392731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int i = 0;
2402731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2412731b9a8SJean-Christophe PLAGNIOL-VILLARD 	do {
2422731b9a8SJean-Christophe PLAGNIOL-VILLARD 		tmp = r8a66597_read(r8a66597, reg);
2432731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (i++ > 1000000) {
2442731b9a8SJean-Christophe PLAGNIOL-VILLARD 			printf("register%lx, loop %x is timeout\n", reg, loop);
2452731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
2462731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
2472731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} while ((tmp & mask) != loop);
2482731b9a8SJean-Christophe PLAGNIOL-VILLARD }
2492731b9a8SJean-Christophe PLAGNIOL-VILLARD 
pipe_buffer_setting(struct r8a66597 * r8a66597,struct usb_device * dev,unsigned long pipe)2502731b9a8SJean-Christophe PLAGNIOL-VILLARD static void pipe_buffer_setting(struct r8a66597 *r8a66597,
2512731b9a8SJean-Christophe PLAGNIOL-VILLARD 				struct usb_device *dev, unsigned long pipe)
2522731b9a8SJean-Christophe PLAGNIOL-VILLARD {
2532731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 val = 0;
2542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 pipenum, bufnum, maxpacket;
2552731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2562731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (usb_pipein(pipe)) {
2572731b9a8SJean-Christophe PLAGNIOL-VILLARD 		pipenum = BULK_IN_PIPENUM;
2582731b9a8SJean-Christophe PLAGNIOL-VILLARD 		bufnum = BULK_IN_BUFNUM;
2592731b9a8SJean-Christophe PLAGNIOL-VILLARD 		maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)];
2602731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} else {
2612731b9a8SJean-Christophe PLAGNIOL-VILLARD 		pipenum = BULK_OUT_PIPENUM;
2622731b9a8SJean-Christophe PLAGNIOL-VILLARD 		bufnum = BULK_OUT_BUFNUM;
2632731b9a8SJean-Christophe PLAGNIOL-VILLARD 		maxpacket = dev->epmaxpacketout[usb_pipeendpoint(pipe)];
2642731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
2652731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2662731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (r8a66597->pipe_config & (1 << pipenum))
2672731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return;
2682731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597->pipe_config |= (1 << pipenum);
2692731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2702731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, ACLRM, get_pipectr_addr(pipenum));
2712731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, ACLRM, get_pipectr_addr(pipenum));
2722731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, pipenum, PIPESEL);
2732731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2742731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* FIXME: This driver support bulk transfer only. */
2752731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (!usb_pipein(pipe))
2762731b9a8SJean-Christophe PLAGNIOL-VILLARD 		val |= R8A66597_DIR;
2772731b9a8SJean-Christophe PLAGNIOL-VILLARD 	else
2782731b9a8SJean-Christophe PLAGNIOL-VILLARD 		val |= R8A66597_SHTNAK;
2792731b9a8SJean-Christophe PLAGNIOL-VILLARD 	val |= R8A66597_BULK | R8A66597_DBLB | usb_pipeendpoint(pipe);
2802731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, val, PIPECFG);
2812731b9a8SJean-Christophe PLAGNIOL-VILLARD 
2822731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, (8 << 10) | bufnum, PIPEBUF);
2832731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, make_devsel(usb_pipedevice(pipe)) |
2842731b9a8SJean-Christophe PLAGNIOL-VILLARD 				 maxpacket, PIPEMAXP);
2852731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, 0, PIPEPERI);
2862731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, SQCLR, get_pipectr_addr(pipenum));
2872731b9a8SJean-Christophe PLAGNIOL-VILLARD }
2882731b9a8SJean-Christophe PLAGNIOL-VILLARD 
send_setup_packet(struct r8a66597 * r8a66597,struct usb_device * dev,struct devrequest * setup)2892731b9a8SJean-Christophe PLAGNIOL-VILLARD static int send_setup_packet(struct r8a66597 *r8a66597, struct usb_device *dev,
2902731b9a8SJean-Christophe PLAGNIOL-VILLARD 			     struct devrequest *setup)
2912731b9a8SJean-Christophe PLAGNIOL-VILLARD {
2922731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int i;
2932731b9a8SJean-Christophe PLAGNIOL-VILLARD 	unsigned short *p = (unsigned short *)setup;
2942731b9a8SJean-Christophe PLAGNIOL-VILLARD 	unsigned long setup_addr = USBREQ;
2952731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 intsts1;
2962731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int timeout = 3000;
29711f46789SChris Brandt #if defined(CONFIG_RZA_USB)
29811f46789SChris Brandt 	u16 dcpctr;
29911f46789SChris Brandt #endif
3002731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 devsel = setup->request == USB_REQ_SET_ADDRESS ? 0 : dev->devnum;
3012731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3022731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, make_devsel(devsel) |
3032731b9a8SJean-Christophe PLAGNIOL-VILLARD 				 (8 << dev->maxpacketsize), DCPMAXP);
3042731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, ~(SIGN | SACK), INTSTS1);
3052731b9a8SJean-Christophe PLAGNIOL-VILLARD 
30611f46789SChris Brandt #if defined(CONFIG_RZA_USB)
30711f46789SChris Brandt 	dcpctr = r8a66597_read(r8a66597, DCPCTR);
30811f46789SChris Brandt 	if ((dcpctr & PID) == PID_BUF) {
309243fd642SChris Brandt 		if (readw_poll_timeout(r8a66597->reg + DCPCTR, dcpctr,
310243fd642SChris Brandt 				       dcpctr & BSTS, 1000) < 0) {
311243fd642SChris Brandt 			printf("DCPCTR BSTS timeout!\n");
312243fd642SChris Brandt 			return -ETIMEDOUT;
31311f46789SChris Brandt 		}
31411f46789SChris Brandt 	}
31511f46789SChris Brandt #endif
31611f46789SChris Brandt 
3172731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 0; i < 4; i++) {
3182731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, le16_to_cpu(p[i]), setup_addr);
3192731b9a8SJean-Christophe PLAGNIOL-VILLARD 		setup_addr += 2;
3202731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
3212731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, ~0x0001, BRDYSTS);
3222731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, SUREQ, DCPCTR);
3232731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3242731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (1) {
3252731b9a8SJean-Christophe PLAGNIOL-VILLARD 		intsts1 = r8a66597_read(r8a66597, INTSTS1);
3262731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (intsts1 & SACK)
3272731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
3282731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (intsts1 & SIGN) {
3292731b9a8SJean-Christophe PLAGNIOL-VILLARD 			printf("setup packet send error\n");
3302731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
3312731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
3322731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (timeout-- < 0) {
3332731b9a8SJean-Christophe PLAGNIOL-VILLARD 			printf("setup packet timeout\n");
3342731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
3352731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
3362731b9a8SJean-Christophe PLAGNIOL-VILLARD 		udelay(500);
3372731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
3382731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3392731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
3402731b9a8SJean-Christophe PLAGNIOL-VILLARD }
3412731b9a8SJean-Christophe PLAGNIOL-VILLARD 
send_bulk_packet(struct r8a66597 * r8a66597,struct usb_device * dev,unsigned long pipe,void * buffer,int transfer_len)3422731b9a8SJean-Christophe PLAGNIOL-VILLARD static int send_bulk_packet(struct r8a66597 *r8a66597, struct usb_device *dev,
3432731b9a8SJean-Christophe PLAGNIOL-VILLARD 			    unsigned long pipe, void *buffer, int transfer_len)
3442731b9a8SJean-Christophe PLAGNIOL-VILLARD {
3452731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 tmp, bufsize;
3462731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 *buf;
3472731b9a8SJean-Christophe PLAGNIOL-VILLARD 	size_t size;
3482731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3492731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
3502731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3512731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, MBW | BULK_OUT_PIPENUM,
3522731b9a8SJean-Christophe PLAGNIOL-VILLARD 			MBW | CURPIPE, CFIFOSEL);
3532731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, BULK_OUT_PIPENUM);
3542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	tmp = r8a66597_read(r8a66597, CFIFOCTR);
3552731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if ((tmp & FRDY) == 0) {
3562731b9a8SJean-Christophe PLAGNIOL-VILLARD 		printf("%s FRDY is not set (%x)\n", __func__, tmp);
3572731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return -1;
3582731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
3592731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3602731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* prepare parameters */
3612731b9a8SJean-Christophe PLAGNIOL-VILLARD 	bufsize = dev->epmaxpacketout[usb_pipeendpoint(pipe)];
3622731b9a8SJean-Christophe PLAGNIOL-VILLARD 	buf = (u16 *)(buffer + dev->act_len);
3632731b9a8SJean-Christophe PLAGNIOL-VILLARD 	size = min((int)bufsize, transfer_len - dev->act_len);
3642731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3652731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* write fifo */
3662731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS);
3672731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (buffer) {
3682731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write_fifo(r8a66597, CFIFO, buf, size);
3692731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, BVAL, CFIFOCTR);
3702731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
3712731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3722731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* update parameters */
3732731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->act_len += size;
3742731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3752731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, PID_BUF, PID,
3762731b9a8SJean-Christophe PLAGNIOL-VILLARD 			get_pipectr_addr(BULK_OUT_PIPENUM));
3772731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3782731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (!(r8a66597_read(r8a66597, BEMPSTS) & (1 << BULK_OUT_PIPENUM)))
3792731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (ctrlc())
3802731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
3812731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, ~(1 << BULK_OUT_PIPENUM), BEMPSTS);
3822731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3832731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (dev->act_len >= transfer_len)
3842731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_mdfy(r8a66597, PID_NAK, PID,
3852731b9a8SJean-Christophe PLAGNIOL-VILLARD 				get_pipectr_addr(BULK_OUT_PIPENUM));
3862731b9a8SJean-Christophe PLAGNIOL-VILLARD 
3872731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
3882731b9a8SJean-Christophe PLAGNIOL-VILLARD }
3892731b9a8SJean-Christophe PLAGNIOL-VILLARD 
receive_bulk_packet(struct r8a66597 * r8a66597,struct usb_device * dev,unsigned long pipe,void * buffer,int transfer_len)3902731b9a8SJean-Christophe PLAGNIOL-VILLARD static int receive_bulk_packet(struct r8a66597 *r8a66597,
3912731b9a8SJean-Christophe PLAGNIOL-VILLARD 			       struct usb_device *dev,
3922731b9a8SJean-Christophe PLAGNIOL-VILLARD 			       unsigned long pipe,
3932731b9a8SJean-Christophe PLAGNIOL-VILLARD 			       void *buffer, int transfer_len)
3942731b9a8SJean-Christophe PLAGNIOL-VILLARD {
3952731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 tmp;
3962731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 *buf;
3972731b9a8SJean-Christophe PLAGNIOL-VILLARD 	const u16 pipenum = BULK_IN_PIPENUM;
3982731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int rcv_len;
3992731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int maxpacket = dev->epmaxpacketin[usb_pipeendpoint(pipe)];
4002731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4012731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
4022731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4032731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* prepare */
4042731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (dev->act_len == 0) {
4052731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_mdfy(r8a66597, PID_NAK, PID,
4062731b9a8SJean-Christophe PLAGNIOL-VILLARD 				get_pipectr_addr(pipenum));
4072731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS);
4082731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4092731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, TRCLR, get_pipetre_addr(pipenum));
4102731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597,
4112731b9a8SJean-Christophe PLAGNIOL-VILLARD 				(transfer_len + maxpacket - 1) / maxpacket,
4122731b9a8SJean-Christophe PLAGNIOL-VILLARD 				get_pipetrn_addr(pipenum));
4132731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_bset(r8a66597, TRENB, get_pipetre_addr(pipenum));
4142731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4152731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_mdfy(r8a66597, PID_BUF, PID,
4162731b9a8SJean-Christophe PLAGNIOL-VILLARD 				get_pipectr_addr(pipenum));
4172731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
4182731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4192731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, MBW | pipenum, MBW | CURPIPE, CFIFOSEL);
4202731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, pipenum);
4212731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4222731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (!(r8a66597_read(r8a66597, BRDYSTS) & (1 << pipenum)))
4232731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (ctrlc())
4242731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
4252731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, ~(1 << pipenum), BRDYSTS);
4262731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4272731b9a8SJean-Christophe PLAGNIOL-VILLARD 	tmp = r8a66597_read(r8a66597, CFIFOCTR);
4282731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if ((tmp & FRDY) == 0) {
4292731b9a8SJean-Christophe PLAGNIOL-VILLARD 		printf("%s FRDY is not set. (%x)\n", __func__, tmp);
4302731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return -1;
4312731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
4322731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4332731b9a8SJean-Christophe PLAGNIOL-VILLARD 	buf = (u16 *)(buffer + dev->act_len);
4342731b9a8SJean-Christophe PLAGNIOL-VILLARD 	rcv_len = tmp & DTLN;
4352731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->act_len += rcv_len;
4362731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4372731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (buffer) {
4382731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (rcv_len == 0)
4392731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597_write(r8a66597, BCLR, CFIFOCTR);
4402731b9a8SJean-Christophe PLAGNIOL-VILLARD 		else
4412731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597_read_fifo(r8a66597, CFIFO, buf, rcv_len);
4422731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
4432731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4442731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
4452731b9a8SJean-Christophe PLAGNIOL-VILLARD }
4462731b9a8SJean-Christophe PLAGNIOL-VILLARD 
receive_control_packet(struct r8a66597 * r8a66597,struct usb_device * dev,void * buffer,int transfer_len)4472731b9a8SJean-Christophe PLAGNIOL-VILLARD static int receive_control_packet(struct r8a66597 *r8a66597,
4482731b9a8SJean-Christophe PLAGNIOL-VILLARD 				  struct usb_device *dev,
4492731b9a8SJean-Christophe PLAGNIOL-VILLARD 				  void *buffer, int transfer_len)
4502731b9a8SJean-Christophe PLAGNIOL-VILLARD {
4512731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 tmp;
4522731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int rcv_len;
4532731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* FIXME: limit transfer size : 64byte or less */
4552731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4562731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG);
4572731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL);
4582731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
4592731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, SQSET, DCPCTR);
4602731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, BCLR, CFIFOCTR);
4612731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR);
4622731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4632731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (!(r8a66597_read(r8a66597, BRDYSTS) & 0x0001))
4642731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (ctrlc())
4652731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
4662731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_write(r8a66597, ~0x0001, BRDYSTS);
4672731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4682731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, MBW, MBW | CURPIPE, CFIFOSEL);
4692731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
4702731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4712731b9a8SJean-Christophe PLAGNIOL-VILLARD 	tmp = r8a66597_read(r8a66597, CFIFOCTR);
4722731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if ((tmp & FRDY) == 0) {
4732731b9a8SJean-Christophe PLAGNIOL-VILLARD 		printf("%s FRDY is not set. (%x)\n", __func__, tmp);
4742731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return -1;
4752731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
4762731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4772731b9a8SJean-Christophe PLAGNIOL-VILLARD 	rcv_len = tmp & DTLN;
4782731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->act_len += rcv_len;
4792731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4802731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR);
4812731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4822731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (buffer) {
4832731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (rcv_len == 0)
4842731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597_write(r8a66597, BCLR, DCPCTR);
4852731b9a8SJean-Christophe PLAGNIOL-VILLARD 		else
4862731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597_read_fifo(r8a66597, CFIFO, buffer, rcv_len);
4872731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
4882731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4892731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
4902731b9a8SJean-Christophe PLAGNIOL-VILLARD }
4912731b9a8SJean-Christophe PLAGNIOL-VILLARD 
send_status_packet(struct r8a66597 * r8a66597,unsigned long pipe)4922731b9a8SJean-Christophe PLAGNIOL-VILLARD static int send_status_packet(struct r8a66597 *r8a66597,
4932731b9a8SJean-Christophe PLAGNIOL-VILLARD 			       unsigned long pipe)
4942731b9a8SJean-Christophe PLAGNIOL-VILLARD {
4952731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_bset(r8a66597, SQSET, DCPCTR);
4962731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, PID_NAK, PID, DCPCTR);
4972731b9a8SJean-Christophe PLAGNIOL-VILLARD 
4982731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (usb_pipein(pipe)) {
4992731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_bset(r8a66597, R8A66597_DIR, DCPCFG);
5002731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_mdfy(r8a66597, ISEL, ISEL | CURPIPE, CFIFOSEL);
5012731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
5022731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, ~BEMP0, BEMPSTS);
5032731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, BCLR | BVAL, CFIFOCTR);
5042731b9a8SJean-Christophe PLAGNIOL-VILLARD 	} else {
5052731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_bclr(r8a66597, R8A66597_DIR, DCPCFG);
5062731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_mdfy(r8a66597, 0, ISEL | CURPIPE, CFIFOSEL);
5072731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_reg_wait(r8a66597, CFIFOSEL, CURPIPE, 0);
5082731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, BCLR, CFIFOCTR);
5092731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
5102731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, PID_BUF, PID, DCPCTR);
5112731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5122731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (!(r8a66597_read(r8a66597, BEMPSTS) & 0x0001))
5132731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (ctrlc())
5142731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
5152731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5162731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
5172731b9a8SJean-Christophe PLAGNIOL-VILLARD }
5182731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_check_syssts(struct r8a66597 * r8a66597,int port)5192731b9a8SJean-Christophe PLAGNIOL-VILLARD static void r8a66597_check_syssts(struct r8a66597 *r8a66597, int port)
5202731b9a8SJean-Christophe PLAGNIOL-VILLARD {
5212731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int count = R8A66597_MAX_SAMPLING;
5222731b9a8SJean-Christophe PLAGNIOL-VILLARD 	unsigned short syssts, old_syssts;
5232731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5242731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
5252731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5262731b9a8SJean-Christophe PLAGNIOL-VILLARD 	old_syssts = r8a66597_read(r8a66597, get_syssts_reg(port) & LNST);
5272731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (count > 0) {
5285b84dd67SMike Frysinger 		mdelay(R8A66597_RH_POLL_TIME);
5292731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5302731b9a8SJean-Christophe PLAGNIOL-VILLARD 		syssts = r8a66597_read(r8a66597, get_syssts_reg(port) & LNST);
5312731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (syssts == old_syssts) {
5322731b9a8SJean-Christophe PLAGNIOL-VILLARD 			count--;
5332731b9a8SJean-Christophe PLAGNIOL-VILLARD 		} else {
5342731b9a8SJean-Christophe PLAGNIOL-VILLARD 			count = R8A66597_MAX_SAMPLING;
5352731b9a8SJean-Christophe PLAGNIOL-VILLARD 			old_syssts = syssts;
5362731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
5372731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
5382731b9a8SJean-Christophe PLAGNIOL-VILLARD }
5392731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_bus_reset(struct r8a66597 * r8a66597,int port)5402731b9a8SJean-Christophe PLAGNIOL-VILLARD static void r8a66597_bus_reset(struct r8a66597 *r8a66597, int port)
5412731b9a8SJean-Christophe PLAGNIOL-VILLARD {
5425b84dd67SMike Frysinger 	mdelay(10);
5432731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, USBRST, USBRST | UACT, get_dvstctr_reg(port));
5445b84dd67SMike Frysinger 	mdelay(50);
5452731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_mdfy(r8a66597, UACT, USBRST | UACT, get_dvstctr_reg(port));
5465b84dd67SMike Frysinger 	mdelay(50);
5472731b9a8SJean-Christophe PLAGNIOL-VILLARD }
5482731b9a8SJean-Christophe PLAGNIOL-VILLARD 
check_usb_device_connecting(struct r8a66597 * r8a66597)5492731b9a8SJean-Christophe PLAGNIOL-VILLARD static int check_usb_device_connecting(struct r8a66597 *r8a66597)
5502731b9a8SJean-Christophe PLAGNIOL-VILLARD {
5512731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int timeout = 10000;	/* 100usec * 10000 = 1sec */
5522731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int i;
5532731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	for (i = 0; i < 5; i++) {
5552731b9a8SJean-Christophe PLAGNIOL-VILLARD 		/* check a usb cable connect */
5562731b9a8SJean-Christophe PLAGNIOL-VILLARD 		while (!(r8a66597_read(r8a66597, INTSTS1) & ATTCH)) {
5572731b9a8SJean-Christophe PLAGNIOL-VILLARD 			if (timeout-- < 0) {
5582731b9a8SJean-Christophe PLAGNIOL-VILLARD 				printf("%s timeout.\n", __func__);
5592731b9a8SJean-Christophe PLAGNIOL-VILLARD 				return -1;
5602731b9a8SJean-Christophe PLAGNIOL-VILLARD 			}
5612731b9a8SJean-Christophe PLAGNIOL-VILLARD 			udelay(100);
5622731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
5632731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5642731b9a8SJean-Christophe PLAGNIOL-VILLARD 		/* check a data line */
5652731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_check_syssts(r8a66597, 0);
5662731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5672731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_bus_reset(r8a66597, 0);
5682731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597->speed = get_rh_usb_speed(r8a66597, 0);
5692731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5702731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (!(r8a66597_read(r8a66597, INTSTS1) & DTCH)) {
5712731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597->port_change = USB_PORT_STAT_C_CONNECTION;
5722731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597->port_status = USB_PORT_STAT_CONNECTION |
5732731b9a8SJean-Christophe PLAGNIOL-VILLARD 						USB_PORT_STAT_ENABLE;
5742731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return 0;	/* success */
5752731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
5762731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5772731b9a8SJean-Christophe PLAGNIOL-VILLARD 		R8A66597_DPRINT("USB device has detached. retry = %d\n", i);
5782731b9a8SJean-Christophe PLAGNIOL-VILLARD 		r8a66597_write(r8a66597, ~DTCH, INTSTS1);
5792731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
5802731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5812731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return -1;	/* fail */
5822731b9a8SJean-Christophe PLAGNIOL-VILLARD }
5832731b9a8SJean-Christophe PLAGNIOL-VILLARD 
5842731b9a8SJean-Christophe PLAGNIOL-VILLARD /*-------------------------------------------------------------------------*
5852731b9a8SJean-Christophe PLAGNIOL-VILLARD  * Virtual Root Hub
5862731b9a8SJean-Christophe PLAGNIOL-VILLARD  *-------------------------------------------------------------------------*/
5872731b9a8SJean-Christophe PLAGNIOL-VILLARD 
588eb838e7dSStephen Warren #include <usbroothubdes.h>
5892731b9a8SJean-Christophe PLAGNIOL-VILLARD 
r8a66597_submit_rh_msg(struct usb_device * dev,unsigned long pipe,void * buffer,int transfer_len,struct devrequest * cmd)5902731b9a8SJean-Christophe PLAGNIOL-VILLARD static int r8a66597_submit_rh_msg(struct usb_device *dev, unsigned long pipe,
5912731b9a8SJean-Christophe PLAGNIOL-VILLARD 			void *buffer, int transfer_len, struct devrequest *cmd)
5922731b9a8SJean-Christophe PLAGNIOL-VILLARD {
5932731b9a8SJean-Christophe PLAGNIOL-VILLARD 	struct r8a66597 *r8a66597 = &gr8a66597;
5942731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int leni = transfer_len;
5952731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int len = 0;
5962731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int stat = 0;
5972731b9a8SJean-Christophe PLAGNIOL-VILLARD 	__u16 bmRType_bReq;
5982731b9a8SJean-Christophe PLAGNIOL-VILLARD 	__u16 wValue;
5992731b9a8SJean-Christophe PLAGNIOL-VILLARD 	__u16 wLength;
6002731b9a8SJean-Christophe PLAGNIOL-VILLARD 	unsigned char data[32];
6012731b9a8SJean-Christophe PLAGNIOL-VILLARD 
6022731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
6032731b9a8SJean-Christophe PLAGNIOL-VILLARD 
6042731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (usb_pipeint(pipe)) {
6052731b9a8SJean-Christophe PLAGNIOL-VILLARD 		printf("Root-Hub submit IRQ: NOT implemented");
6062731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return 0;
6072731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
6082731b9a8SJean-Christophe PLAGNIOL-VILLARD 
6092731b9a8SJean-Christophe PLAGNIOL-VILLARD 	bmRType_bReq  = cmd->requesttype | (cmd->request << 8);
6102731b9a8SJean-Christophe PLAGNIOL-VILLARD 	wValue	      = cpu_to_le16 (cmd->value);
6112731b9a8SJean-Christophe PLAGNIOL-VILLARD 	wLength	      = cpu_to_le16 (cmd->length);
6122731b9a8SJean-Christophe PLAGNIOL-VILLARD 
6132731b9a8SJean-Christophe PLAGNIOL-VILLARD 	switch (bmRType_bReq) {
6142731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_STATUS:
6152731b9a8SJean-Christophe PLAGNIOL-VILLARD 		*(__u16 *)buffer = cpu_to_le16(1);
6162731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = 2;
6172731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6182731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_STATUS | RH_INTERFACE:
6192731b9a8SJean-Christophe PLAGNIOL-VILLARD 		*(__u16 *)buffer = cpu_to_le16(0);
6202731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = 2;
6212731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6222731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_STATUS | RH_ENDPOINT:
6232731b9a8SJean-Christophe PLAGNIOL-VILLARD 		*(__u16 *)buffer = cpu_to_le16(0);
6242731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = 2;
6252731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6262731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_STATUS | RH_CLASS:
6272731b9a8SJean-Christophe PLAGNIOL-VILLARD 		*(__u32 *)buffer = cpu_to_le32(0);
6282731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = 4;
6292731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6302731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_STATUS | RH_OTHER | RH_CLASS:
6312731b9a8SJean-Christophe PLAGNIOL-VILLARD 		*(__u32 *)buffer = cpu_to_le32(r8a66597->port_status |
6322731b9a8SJean-Christophe PLAGNIOL-VILLARD 						(r8a66597->port_change << 16));
6332731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = 4;
6342731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6352731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_CLEAR_FEATURE | RH_ENDPOINT:
6362731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_CLEAR_FEATURE | RH_CLASS:
6372731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6382731b9a8SJean-Christophe PLAGNIOL-VILLARD 
6392731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_CLEAR_FEATURE | RH_OTHER | RH_CLASS:
6402731b9a8SJean-Christophe PLAGNIOL-VILLARD 		switch (wValue) {
6412731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case RH_C_PORT_CONNECTION:
6422731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597->port_change &= ~USB_PORT_STAT_C_CONNECTION;
6432731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6442731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
6452731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6462731b9a8SJean-Christophe PLAGNIOL-VILLARD 
6472731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_SET_FEATURE | RH_OTHER | RH_CLASS:
6482731b9a8SJean-Christophe PLAGNIOL-VILLARD 		switch (wValue) {
6492731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (RH_PORT_SUSPEND):
6502731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6512731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (RH_PORT_RESET):
6522731b9a8SJean-Christophe PLAGNIOL-VILLARD 			r8a66597_bus_reset(r8a66597, 0);
6532731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6542731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (RH_PORT_POWER):
6552731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6562731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (RH_PORT_ENABLE):
6572731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6582731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
6592731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6602731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_SET_ADDRESS:
6612731b9a8SJean-Christophe PLAGNIOL-VILLARD 		gr8a66597.rh_devnum = wValue;
6622731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
6632731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_DESCRIPTOR:
6642731b9a8SJean-Christophe PLAGNIOL-VILLARD 		switch ((wValue & 0xff00) >> 8) {
6652731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (0x01): /* device descriptor */
6662731b9a8SJean-Christophe PLAGNIOL-VILLARD 			len = min_t(unsigned int,
6672731b9a8SJean-Christophe PLAGNIOL-VILLARD 				  leni,
6682731b9a8SJean-Christophe PLAGNIOL-VILLARD 				  min_t(unsigned int,
6692731b9a8SJean-Christophe PLAGNIOL-VILLARD 				      sizeof(root_hub_dev_des),
6702731b9a8SJean-Christophe PLAGNIOL-VILLARD 				      wLength));
6712731b9a8SJean-Christophe PLAGNIOL-VILLARD 			memcpy(buffer, root_hub_dev_des, len);
6722731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6732731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (0x02): /* configuration descriptor */
6742731b9a8SJean-Christophe PLAGNIOL-VILLARD 			len = min_t(unsigned int,
6752731b9a8SJean-Christophe PLAGNIOL-VILLARD 				  leni,
6762731b9a8SJean-Christophe PLAGNIOL-VILLARD 				  min_t(unsigned int,
6772731b9a8SJean-Christophe PLAGNIOL-VILLARD 				      sizeof(root_hub_config_des),
6782731b9a8SJean-Christophe PLAGNIOL-VILLARD 				      wLength));
6792731b9a8SJean-Christophe PLAGNIOL-VILLARD 			memcpy(buffer, root_hub_config_des, len);
6802731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6812731b9a8SJean-Christophe PLAGNIOL-VILLARD 		case (0x03): /* string descriptors */
6822731b9a8SJean-Christophe PLAGNIOL-VILLARD 			if (wValue == 0x0300) {
6832731b9a8SJean-Christophe PLAGNIOL-VILLARD 				len = min_t(unsigned int,
6842731b9a8SJean-Christophe PLAGNIOL-VILLARD 					  leni,
6852731b9a8SJean-Christophe PLAGNIOL-VILLARD 					  min_t(unsigned int,
6862731b9a8SJean-Christophe PLAGNIOL-VILLARD 					      sizeof(root_hub_str_index0),
6872731b9a8SJean-Christophe PLAGNIOL-VILLARD 					      wLength));
6882731b9a8SJean-Christophe PLAGNIOL-VILLARD 				memcpy(buffer, root_hub_str_index0, len);
6892731b9a8SJean-Christophe PLAGNIOL-VILLARD 			}
6902731b9a8SJean-Christophe PLAGNIOL-VILLARD 			if (wValue == 0x0301) {
6912731b9a8SJean-Christophe PLAGNIOL-VILLARD 				len = min_t(unsigned int,
6922731b9a8SJean-Christophe PLAGNIOL-VILLARD 					  leni,
6932731b9a8SJean-Christophe PLAGNIOL-VILLARD 					  min_t(unsigned int,
6942731b9a8SJean-Christophe PLAGNIOL-VILLARD 					      sizeof(root_hub_str_index1),
6952731b9a8SJean-Christophe PLAGNIOL-VILLARD 					      wLength));
6962731b9a8SJean-Christophe PLAGNIOL-VILLARD 				memcpy(buffer, root_hub_str_index1, len);
6972731b9a8SJean-Christophe PLAGNIOL-VILLARD 			}
6982731b9a8SJean-Christophe PLAGNIOL-VILLARD 			break;
6992731b9a8SJean-Christophe PLAGNIOL-VILLARD 		default:
7002731b9a8SJean-Christophe PLAGNIOL-VILLARD 			stat = USB_ST_STALLED;
7012731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
7022731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
7032731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7042731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_DESCRIPTOR | RH_CLASS:
7052731b9a8SJean-Christophe PLAGNIOL-VILLARD 	{
7062731b9a8SJean-Christophe PLAGNIOL-VILLARD 		__u32 temp = 0x00000001;
7072731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7082731b9a8SJean-Christophe PLAGNIOL-VILLARD 		data[0] = 9;		/* min length; */
7092731b9a8SJean-Christophe PLAGNIOL-VILLARD 		data[1] = 0x29;
7102731b9a8SJean-Christophe PLAGNIOL-VILLARD 		data[2] = temp & RH_A_NDP;
7112731b9a8SJean-Christophe PLAGNIOL-VILLARD 		data[3] = 0;
7122731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (temp & RH_A_PSM)
7132731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[3] |= 0x1;
7142731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (temp & RH_A_NOCP)
7152731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[3] |= 0x10;
7162731b9a8SJean-Christophe PLAGNIOL-VILLARD 		else if (temp & RH_A_OCPM)
7172731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[3] |= 0x8;
7182731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7192731b9a8SJean-Christophe PLAGNIOL-VILLARD 		/* corresponds to data[4-7] */
7202731b9a8SJean-Christophe PLAGNIOL-VILLARD 		data[5] = (temp & RH_A_POTPGT) >> 24;
7212731b9a8SJean-Christophe PLAGNIOL-VILLARD 		data[7] = temp & RH_B_DR;
7222731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (data[2] < 7) {
7232731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[8] = 0xff;
7242731b9a8SJean-Christophe PLAGNIOL-VILLARD 		} else {
7252731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[0] += 2;
7262731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[8] = (temp & RH_B_DR) >> 8;
7272731b9a8SJean-Christophe PLAGNIOL-VILLARD 			data[10] = data[9] = 0xff;
7282731b9a8SJean-Christophe PLAGNIOL-VILLARD 		}
7292731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7302731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = min_t(unsigned int, leni,
7312731b9a8SJean-Christophe PLAGNIOL-VILLARD 			    min_t(unsigned int, data[0], wLength));
7322731b9a8SJean-Christophe PLAGNIOL-VILLARD 		memcpy(buffer, data, len);
7332731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
7342731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
7352731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7362731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_GET_CONFIGURATION:
7372731b9a8SJean-Christophe PLAGNIOL-VILLARD 		*(__u8 *) buffer = 0x01;
7382731b9a8SJean-Christophe PLAGNIOL-VILLARD 		len = 1;
7392731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
7402731b9a8SJean-Christophe PLAGNIOL-VILLARD 	case RH_SET_CONFIGURATION:
7412731b9a8SJean-Christophe PLAGNIOL-VILLARD 		break;
7422731b9a8SJean-Christophe PLAGNIOL-VILLARD 	default:
7432731b9a8SJean-Christophe PLAGNIOL-VILLARD 		R8A66597_DPRINT("unsupported root hub command");
7442731b9a8SJean-Christophe PLAGNIOL-VILLARD 		stat = USB_ST_STALLED;
7452731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
7462731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7475b84dd67SMike Frysinger 	mdelay(1);
7482731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7492731b9a8SJean-Christophe PLAGNIOL-VILLARD 	len = min_t(int, len, leni);
7502731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7512731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->act_len = len;
7522731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->status = stat;
7532731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7542731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return stat;
7552731b9a8SJean-Christophe PLAGNIOL-VILLARD }
7562731b9a8SJean-Christophe PLAGNIOL-VILLARD 
submit_bulk_msg(struct usb_device * dev,unsigned long pipe,void * buffer,int transfer_len)7572731b9a8SJean-Christophe PLAGNIOL-VILLARD int submit_bulk_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
7582731b9a8SJean-Christophe PLAGNIOL-VILLARD 		    int transfer_len)
7592731b9a8SJean-Christophe PLAGNIOL-VILLARD {
7602731b9a8SJean-Christophe PLAGNIOL-VILLARD 	struct r8a66597 *r8a66597 = &gr8a66597;
7612731b9a8SJean-Christophe PLAGNIOL-VILLARD 	int ret = 0;
7622731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7632731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
7642731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("pipe = %08x, buffer = %p, len = %d, devnum = %d\n",
7652731b9a8SJean-Christophe PLAGNIOL-VILLARD 			pipe, buffer, transfer_len, dev->devnum);
7662731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7672731b9a8SJean-Christophe PLAGNIOL-VILLARD 	set_devadd(r8a66597, dev->devnum, dev, 0);
7682731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7692731b9a8SJean-Christophe PLAGNIOL-VILLARD 	pipe_buffer_setting(r8a66597, dev, pipe);
7702731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7712731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->act_len = 0;
7722731b9a8SJean-Christophe PLAGNIOL-VILLARD 	while (dev->act_len < transfer_len && ret == 0) {
7732731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (ctrlc())
7742731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
7752731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7762731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (usb_pipein(pipe))
7772731b9a8SJean-Christophe PLAGNIOL-VILLARD 			ret = receive_bulk_packet(r8a66597, dev, pipe, buffer,
7782731b9a8SJean-Christophe PLAGNIOL-VILLARD 							transfer_len);
7792731b9a8SJean-Christophe PLAGNIOL-VILLARD 		else
7802731b9a8SJean-Christophe PLAGNIOL-VILLARD 			ret = send_bulk_packet(r8a66597, dev, pipe, buffer,
7812731b9a8SJean-Christophe PLAGNIOL-VILLARD 							transfer_len);
7822731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
7832731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7842731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (ret == 0)
7852731b9a8SJean-Christophe PLAGNIOL-VILLARD 		dev->status = 0;
7862731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7872731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return ret;
7882731b9a8SJean-Christophe PLAGNIOL-VILLARD }
7892731b9a8SJean-Christophe PLAGNIOL-VILLARD 
submit_control_msg(struct usb_device * dev,unsigned long pipe,void * buffer,int transfer_len,struct devrequest * setup)7902731b9a8SJean-Christophe PLAGNIOL-VILLARD int submit_control_msg(struct usb_device *dev, unsigned long pipe,
7912731b9a8SJean-Christophe PLAGNIOL-VILLARD 		       void *buffer, int transfer_len, struct devrequest *setup)
7922731b9a8SJean-Christophe PLAGNIOL-VILLARD {
7932731b9a8SJean-Christophe PLAGNIOL-VILLARD 	struct r8a66597 *r8a66597 = &gr8a66597;
7942731b9a8SJean-Christophe PLAGNIOL-VILLARD 	u16 r8a66597_address = setup->request == USB_REQ_SET_ADDRESS ?
7952731b9a8SJean-Christophe PLAGNIOL-VILLARD 					0 : dev->devnum;
7962731b9a8SJean-Christophe PLAGNIOL-VILLARD 
7972731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
7982731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (usb_pipedevice(pipe) == r8a66597->rh_devnum)
7992731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return r8a66597_submit_rh_msg(dev, pipe, buffer, transfer_len,
8002731b9a8SJean-Christophe PLAGNIOL-VILLARD 						setup);
8012731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8022731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s: setup\n", __func__);
8032731b9a8SJean-Christophe PLAGNIOL-VILLARD 	set_devadd(r8a66597, r8a66597_address, dev, 0);
8042731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8052731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (send_setup_packet(r8a66597, dev, setup) < 0) {
8062731b9a8SJean-Christophe PLAGNIOL-VILLARD 		printf("setup packet send error\n");
8072731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return -1;
8082731b9a8SJean-Christophe PLAGNIOL-VILLARD 	}
8092731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8102731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->act_len = 0;
8112731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (usb_pipein(pipe))
8122731b9a8SJean-Christophe PLAGNIOL-VILLARD 		if (receive_control_packet(r8a66597, dev, buffer,
8132731b9a8SJean-Christophe PLAGNIOL-VILLARD 						transfer_len) < 0)
8142731b9a8SJean-Christophe PLAGNIOL-VILLARD 			return -1;
8152731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8162731b9a8SJean-Christophe PLAGNIOL-VILLARD 	if (send_status_packet(r8a66597, pipe) < 0)
8172731b9a8SJean-Christophe PLAGNIOL-VILLARD 		return -1;
8182731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8192731b9a8SJean-Christophe PLAGNIOL-VILLARD 	dev->status = 0;
8202731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8212731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
8222731b9a8SJean-Christophe PLAGNIOL-VILLARD }
8232731b9a8SJean-Christophe PLAGNIOL-VILLARD 
submit_int_msg(struct usb_device * dev,unsigned long pipe,void * buffer,int transfer_len,int interval)8242731b9a8SJean-Christophe PLAGNIOL-VILLARD int submit_int_msg(struct usb_device *dev, unsigned long pipe, void *buffer,
8252731b9a8SJean-Christophe PLAGNIOL-VILLARD 			int transfer_len, int interval)
8262731b9a8SJean-Christophe PLAGNIOL-VILLARD {
8272731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* no implement */
8282731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
8292731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
8302731b9a8SJean-Christophe PLAGNIOL-VILLARD }
8312731b9a8SJean-Christophe PLAGNIOL-VILLARD 
usb_lowlevel_init(int index,enum usb_init_type init,void ** controller)83206d513ecSTroy Kisky int usb_lowlevel_init(int index, enum usb_init_type init, void **controller)
8332731b9a8SJean-Christophe PLAGNIOL-VILLARD {
8342731b9a8SJean-Christophe PLAGNIOL-VILLARD 	struct r8a66597 *r8a66597 = &gr8a66597;
8352731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8362731b9a8SJean-Christophe PLAGNIOL-VILLARD 	R8A66597_DPRINT("%s\n", __func__);
8372731b9a8SJean-Christophe PLAGNIOL-VILLARD 
838198c5f99SYasuhisa Umano 	memset(r8a66597, 0, sizeof(*r8a66597));
8392731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597->reg = CONFIG_R8A66597_BASE_ADDR;
8402731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8412731b9a8SJean-Christophe PLAGNIOL-VILLARD 	disable_controller(r8a66597);
8425b84dd67SMike Frysinger 	mdelay(100);
8432731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8442731b9a8SJean-Christophe PLAGNIOL-VILLARD 	enable_controller(r8a66597);
8452731b9a8SJean-Christophe PLAGNIOL-VILLARD 	r8a66597_port_power(r8a66597, 0 , 1);
8462731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8472731b9a8SJean-Christophe PLAGNIOL-VILLARD 	/* check usb device */
8482731b9a8SJean-Christophe PLAGNIOL-VILLARD 	check_usb_device_connecting(r8a66597);
8492731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8505b84dd67SMike Frysinger 	mdelay(50);
8512731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8522731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
8532731b9a8SJean-Christophe PLAGNIOL-VILLARD }
8542731b9a8SJean-Christophe PLAGNIOL-VILLARD 
usb_lowlevel_stop(int index)855c7e3b2b5SLucas Stach int usb_lowlevel_stop(int index)
8562731b9a8SJean-Christophe PLAGNIOL-VILLARD {
8572731b9a8SJean-Christophe PLAGNIOL-VILLARD 	disable_controller(&gr8a66597);
8582731b9a8SJean-Christophe PLAGNIOL-VILLARD 
8592731b9a8SJean-Christophe PLAGNIOL-VILLARD 	return 0;
8602731b9a8SJean-Christophe PLAGNIOL-VILLARD }
861