WebSVN - shark - Blame - Rev 1618 - /shark/branches/xen/drivers/usb/host/uhci-hub.c

Rev	Author	Line No.	Line
846	giacomo	1	/*
		2	* Universal Host Controller Interface driver for USB.
		3	*
		4	* Maintainer: Johannes Erdfelt <johannes@erdfelt.com>
		5	*
		6	* (C) Copyright 1999 Linus Torvalds
		7	* (C) Copyright 1999-2002 Johannes Erdfelt, johannes@erdfelt.com
		8	* (C) Copyright 1999 Randy Dunlap
		9	* (C) Copyright 1999 Georg Acher, acher@in.tum.de
		10	* (C) Copyright 1999 Deti Fliegl, deti@fliegl.de
		11	* (C) Copyright 1999 Thomas Sailer, sailer@ife.ee.ethz.ch
		12	*/
		13
		14	static __u8 root_hub_hub_des[] =
		15	{
		16	0x09, /* __u8 bLength; */
		17	0x29, /* __u8 bDescriptorType; Hub-descriptor */
		18	0x02, /* __u8 bNbrPorts; */
		19	0x00, /* __u16 wHubCharacteristics; */
		20	0x00,
		21	0x01, /* __u8 bPwrOn2pwrGood; 2ms */
		22	0x00, /* __u8 bHubContrCurrent; 0 mA */
		23	0x00, /* __u8 DeviceRemovable; * 7 Ports max * */
		24	0xff /* __u8 PortPwrCtrlMask; * 7 ports max * */
		25	};
		26
		27	static int uhci_hub_status_data(struct usb_hcd hcd, char buf)
		28	{
		29	struct uhci_hcd *uhci = hcd_to_uhci(hcd);
		30	unsigned int io_addr = uhci->io_addr;
		31	int i, len = 1;
		32
		33	*buf = 0;
		34	for (i = 0; i < uhci->rh_numports; i++) {
		35	buf \|= ((inw(io_addr + USBPORTSC1 + i 2) & 0xa) > 0 ? (1 << (i + 1)) : 0);
		36	len = (i + 1) / 8 + 1;
		37	}
		38
		39	return !!*buf;
		40	}
		41
		42	#define OK(x) len = (x); break
		43
		44	#define CLR_RH_PORTSTAT(x) \
		45	status = inw(io_addr + USBPORTSC1 + 2 * (wIndex-1)); \
		46	status = (status & 0xfff5) & ~(x); \
		47	outw(status, io_addr + USBPORTSC1 + 2 * (wIndex-1))
		48
		49	#define SET_RH_PORTSTAT(x) \
		50	status = inw(io_addr + USBPORTSC1 + 2 * (wIndex-1)); \
		51	status = (status & 0xfff5) \| (x); \
		52	outw(status, io_addr + USBPORTSC1 + 2 * (wIndex-1))
		53
		54
		55	/* size of returned buffer is part of USB spec */
		56	static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
		57	u16 wIndex, char *buf, u16 wLength)
		58	{
		59	struct uhci_hcd *uhci = hcd_to_uhci(hcd);
		60	int i, status, retval = 0, len = 0;
		61	unsigned int io_addr = uhci->io_addr;
		62	__u16 cstatus;
		63	char c_p_r[8];
		64
		65	for (i = 0; i < 8; i++)
		66	c_p_r[i] = 0;
		67
		68	switch (typeReq) {
		69	/* Request Destination:
		70	without flags: Device,
		71	RH_INTERFACE: interface,
		72	RH_ENDPOINT: endpoint,
		73	RH_CLASS means HUB here,
		74	RH_OTHER \| RH_CLASS almost ever means HUB_PORT here
		75	*/
		76
		77	case GetHubStatus:
		78	(__u32 )buf = cpu_to_le32(0);
		79	OK(4); /* hub power */
		80	case GetPortStatus:
		81	status = inw(io_addr + USBPORTSC1 + 2 * (wIndex - 1));
		82	cstatus = ((status & USBPORTSC_CSC) >> (1 - 0)) \|
		83	((status & USBPORTSC_PEC) >> (3 - 1)) \|
		84	(c_p_r[wIndex - 1] << (0 + 4));
		85	status = (status & USBPORTSC_CCS) \|
		86	((status & USBPORTSC_PE) >> (2 - 1)) \|
		87	((status & USBPORTSC_SUSP) >> (12 - 2)) \|
		88	((status & USBPORTSC_PR) >> (9 - 4)) \|
		89	(1 << 8) \| /* power on */
		90	((status & USBPORTSC_LSDA) << (-8 + 9));
		91
		92	(__u16 )buf = cpu_to_le16(status);
		93	(__u16 )(buf + 2) = cpu_to_le16(cstatus);
		94	OK(4);
		95	case SetHubFeature:
		96	switch (wValue) {
		97	case C_HUB_OVER_CURRENT:
		98	case C_HUB_LOCAL_POWER:
		99	break;
		100	default:
		101	goto err;
		102	}
		103	break;
		104	case ClearHubFeature:
		105	switch (wValue) {
		106	case C_HUB_OVER_CURRENT:
		107	OK(0); /* hub power over current */
		108	default:
		109	goto err;
		110	}
		111	break;
		112	case SetPortFeature:
		113	if (!wIndex \|\| wIndex > uhci->rh_numports)
		114	goto err;
		115
		116	switch (wValue) {
		117	case USB_PORT_FEAT_SUSPEND:
		118	SET_RH_PORTSTAT(USBPORTSC_SUSP);
		119	OK(0);
		120	case USB_PORT_FEAT_RESET:
		121	SET_RH_PORTSTAT(USBPORTSC_PR);
		122	mdelay(50); /* USB v1.1 7.1.7.3 */
		123	c_p_r[wIndex - 1] = 1;
		124	CLR_RH_PORTSTAT(USBPORTSC_PR);
		125	udelay(10);
		126	SET_RH_PORTSTAT(USBPORTSC_PE);
		127	mdelay(10);
		128	SET_RH_PORTSTAT(0xa);
		129	OK(0);
		130	case USB_PORT_FEAT_POWER:
		131	OK(0); /* port power ** */
		132	case USB_PORT_FEAT_ENABLE:
		133	SET_RH_PORTSTAT(USBPORTSC_PE);
		134	OK(0);
		135	default:
		136	goto err;
		137	}
		138	break;
		139	case ClearPortFeature:
		140	if (!wIndex \|\| wIndex > uhci->rh_numports)
		141	goto err;
		142
		143	switch (wValue) {
		144	case USB_PORT_FEAT_ENABLE:
		145	CLR_RH_PORTSTAT(USBPORTSC_PE);
		146	OK(0);
		147	case USB_PORT_FEAT_C_ENABLE:
		148	SET_RH_PORTSTAT(USBPORTSC_PEC);
		149	OK(0);
		150	case USB_PORT_FEAT_SUSPEND:
		151	CLR_RH_PORTSTAT(USBPORTSC_SUSP);
		152	OK(0);
		153	case USB_PORT_FEAT_C_SUSPEND:
		154	/*** WR_RH_PORTSTAT(RH_PS_PSSC); */
		155	OK(0);
		156	case USB_PORT_FEAT_POWER:
		157	OK(0); /* port power */
		158	case USB_PORT_FEAT_C_CONNECTION:
		159	SET_RH_PORTSTAT(USBPORTSC_CSC);
		160	OK(0);
		161	case USB_PORT_FEAT_C_OVER_CURRENT:
		162	OK(0); /* port power over current */
		163	case USB_PORT_FEAT_C_RESET:
		164	c_p_r[wIndex - 1] = 0;
		165	OK(0);
		166	default:
		167	goto err;
		168	}
		169	break;
		170	case GetHubDescriptor:
		171	len = min_t(unsigned int, wLength,
		172	min_t(unsigned int, sizeof(root_hub_hub_des), wLength));
		173	memcpy(buf, root_hub_hub_des, len);
		174	if (len > 2)
		175	buf[2] = uhci->rh_numports;
		176	OK(len);
		177	default:
		178	err:
		179	retval = -EPIPE;
		180	}
		181
		182	return retval;
		183	}
		184

Subversion Repositories shark

(root)/shark/branches/xen/drivers/usb/host/uhci-hub.c - Rev 1618