*/		if (!(temp & PORT_CONNECT))			ehci->reset_done [i] = 0;		if ((temp & mask) != 0				|| ((temp & PORT_RESUME) != 0					&& time_after_eq(jiffies,						ehci->reset_done[i]))) {			if (i < 7)			    buf [0] |= 1 << (i + 1);			else			    buf [1] |= 1 << (i - 7);			status = STS_PCD;		}	}	/* FIXME autosuspend idle root hubs */	spin_unlock_irqrestore (&ehci->lock, flags);	return status ? retval : 0;}/*-------------------------------------------------------------------------*/static voidehci_hub_descriptor (	struct ehci_hcd			*ehci,	struct usb_hub_descriptor	*desc) {	int		ports = HCS_N_PORTS (ehci->hcs_params);	u16		temp;	desc->bDescriptorType = 0x29;	desc->bPwrOn2PwrGood = 10;	/* ehci 1.0, 2.3.9 says 20ms max */	desc->bHubContrCurrent = 0;	desc->bNbrPorts = ports;	temp = 1 + (ports / 8);	desc->bDescLength = 7 + 2 * temp;	/* two bitmaps:  ports removable, and usb 1.0 legacy PortPwrCtrlMask */	memset (&desc->bitmap [0], 0, temp);	memset (&desc->bitmap [temp], 0xff, temp);	temp = 0x0008;			/* per-port overcurrent reporting */	if (HCS_PPC (ehci->hcs_params))		temp |= 0x0001;		/* per-port power control */	else		temp |= 0x0002;		/* no power switching */#if 0// re-enable when we support USB_PORT_FEAT_INDICATOR below.	if (HCS_INDICATOR (ehci->hcs_params))		temp |= 0x0080;		/* per-port indicators (LEDs) */#endif	desc->wHubCharacteristics = (__force __u16)cpu_to_le16 (temp);}/*-------------------------------------------------------------------------*/#define	PORT_WAKE_BITS	(PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)static int ehci_hub_control (	struct usb_hcd	*hcd,	u16		typeReq,	u16		wValue,	u16		wIndex,	char		*buf,	u16		wLength) {	struct ehci_hcd	*ehci = hcd_to_ehci (hcd);	int		ports = HCS_N_PORTS (ehci->hcs_params);	u32 __iomem	*status_reg = &ehci->regs->port_status[wIndex - 1];	u32		temp, status;	unsigned long	flags;	int		retval = 0;	unsigned	selector;	/*	 * FIXME:  support SetPortFeatures USB_PORT_FEAT_INDICATOR.	 * HCS_INDICATOR may say we can change LEDs to off/amber/green.	 * (track current state ourselves) ... blink for diagnostics,	 * power, "this is the one", etc.  EHCI spec supports this.	 */	spin_lock_irqsave (&ehci->lock, flags);	switch (typeReq) {	case ClearHubFeature:		switch (wValue) {		case C_HUB_LOCAL_POWER:		case C_HUB_OVER_CURRENT:			/* no hub-wide feature/status flags */			break;		default:			goto error;		}		break;	case ClearPortFeature:		if (!wIndex || wIndex > ports)			goto error;		wIndex--;		temp = ehci_readl(ehci, status_reg);		/*		 * Even if OWNER is set, so the port is owned by the		 * companion controller, khubd needs to be able to clear		 * the port-change status bits (especially		 * USB_PORT_FEAT_C_CONNECTION).		 */		switch (wValue) {		case USB_PORT_FEAT_ENABLE:			ehci_writel(ehci, temp & ~PORT_PE, status_reg);			break;		case USB_PORT_FEAT_C_ENABLE:			ehci_writel(ehci, (temp & ~PORT_RWC_BITS) | PORT_PEC,					status_reg);			break;		case USB_PORT_FEAT_SUSPEND:			if (temp & PORT_RESET)				goto error;			if (ehci->no_selective_suspend)				break;			if (temp & PORT_SUSPEND) {				if ((temp & PORT_PE) == 0)					goto error;				/* resume signaling for 20 msec */				temp &= ~(PORT_RWC_BITS | PORT_WAKE_BITS);				ehci_writel(ehci, temp | PORT_RESUME,						status_reg);				ehci->reset_done [wIndex] = jiffies						+ msecs_to_jiffies (20);			}			break;		case USB_PORT_FEAT_C_SUSPEND:			/* we auto-clear this feature */			break;		case USB_PORT_FEAT_POWER:			if (HCS_PPC (ehci->hcs_params))				ehci_writel(ehci,					  temp & ~(PORT_RWC_BITS | PORT_POWER),					  status_reg);			break;		case USB_PORT_FEAT_C_CONNECTION:			ehci_writel(ehci, (temp & ~PORT_RWC_BITS) | PORT_CSC,					status_reg);			break;		case USB_PORT_FEAT_C_OVER_CURRENT:			ehci_writel(ehci, (temp & ~PORT_RWC_BITS) | PORT_OCC,					status_reg);			break;		case USB_PORT_FEAT_C_RESET:			/* GetPortStatus clears reset */			break;		default:			goto error;		}		ehci_readl(ehci, &ehci->regs->command);	/* unblock posted write */		break;	case GetHubDescriptor:		ehci_hub_descriptor (ehci, (struct usb_hub_descriptor *)			buf);		break;	case GetHubStatus:		/* no hub-wide feature/status flags */		memset (buf, 0, 4);		//cpu_to_le32s ((u32 *) buf);		break;	case GetPortStatus:		if (!wIndex || wIndex > ports)			goto error;		wIndex--;		status = 0;		temp = ehci_readl(ehci, status_reg);		// wPortChange bits		if (temp & PORT_CSC)			status |= 1 << USB_PORT_FEAT_C_CONNECTION;		if (temp & PORT_PEC)			status |= 1 << USB_PORT_FEAT_C_ENABLE;		if ((temp & PORT_OCC) && !ignore_oc)			status |= 1 << USB_PORT_FEAT_C_OVER_CURRENT;		/* whoever resumes must GetPortStatus to complete it!! */		if (temp & PORT_RESUME) {			/* Remote Wakeup received? */			if (!ehci->reset_done[wIndex]) {				/* resume signaling for 20 msec */				ehci->reset_done[wIndex] = jiffies						+ msecs_to_jiffies(20);				/* check the port again */				mod_timer(&ehci_to_hcd(ehci)->rh_timer,						ehci->reset_done[wIndex]);			}			/* resume completed? */			else if (time_after_eq(jiffies,					ehci->reset_done[wIndex])) {				status |= 1 << USB_PORT_FEAT_C_SUSPEND;				ehci->reset_done[wIndex] = 0;				/* stop resume signaling */				temp = ehci_readl(ehci, status_reg);				ehci_writel(ehci,					temp & ~(PORT_RWC_BITS | PORT_RESUME),					status_reg);				retval = handshake(ehci, status_reg,					   PORT_RESUME, 0, 2000 /* 2msec */);				if (retval != 0) {					ehci_err(ehci,						"port %d resume error %d\n",						wIndex + 1, retval);					goto error;				}				temp &= ~(PORT_SUSPEND|PORT_RESUME|(3<<10));			}		}		/* whoever resets must GetPortStatus to complete it!! */		if ((temp & PORT_RESET)				&& time_after_eq(jiffies,					ehci->reset_done[wIndex])) {			status |= 1 << USB_PORT_FEAT_C_RESET;			ehci->reset_done [wIndex] = 0;			/* force reset to complete */			ehci_writel(ehci, temp & ~(PORT_RWC_BITS | PORT_RESET),					status_reg);			/* REVISIT:  some hardware needs 550+ usec to clear			 * this bit; seems too long to spin routinely...			 */			retval = handshake(ehci, status_reg,					PORT_RESET, 0, 750);			if (retval != 0) {				ehci_err (ehci, "port %d reset error %d\n",					wIndex + 1, retval);				goto error;			}			/* see what we found out */			temp = check_reset_complete (ehci, wIndex, status_reg,					ehci_readl(ehci, status_reg));		}		/* transfer dedicated ports to the companion hc */		if ((temp & PORT_CONNECT) &&				test_bit(wIndex, &ehci->companion_ports)) {			temp &= ~PORT_RWC_BITS;			temp |= PORT_OWNER;			ehci_writel(ehci, temp, status_reg);			ehci_dbg(ehci, "port %d --> companion\n", wIndex + 1);			temp = ehci_readl(ehci, status_reg);		}		/*		 * Even if OWNER is set, there's no harm letting khubd		 * see the wPortStatus values (they should all be 0 except		 * for PORT_POWER anyway).		 */		if (temp & PORT_CONNECT) {			status |= 1 << USB_PORT_FEAT_CONNECTION;			// status may be from integrated TT			status |= ehci_port_speed(ehci, temp);		}		if (temp & PORT_PE)			status |= 1 << USB_PORT_FEAT_ENABLE;		if (temp & (PORT_SUSPEND|PORT_RESUME))			status |= 1 << USB_PORT_FEAT_SUSPEND;		if (temp & PORT_OC)			status |= 1 << USB_PORT_FEAT_OVER_CURRENT;		if (temp & PORT_RESET)			status |= 1 << USB_PORT_FEAT_RESET;		if (temp & PORT_POWER)			status |= 1 << USB_PORT_FEAT_POWER;#ifndef	EHCI_VERBOSE_DEBUG	if (status & ~0xffff)	/* only if wPortChange is interesting */#endif		dbg_port (ehci, "GetStatus", wIndex + 1, temp);		put_unaligned(cpu_to_le32 (status), (__le32 *) buf);		break;	case SetHubFeature:		switch (wValue) {		case C_HUB_LOCAL_POWER:		case C_HUB_OVER_CURRENT:			/* no hub-wide feature/status flags */			break;		default:			goto error;		}		break;	case SetPortFeature:		selector = wIndex >> 8;		wIndex &= 0xff;		if (!wIndex || wIndex > ports)			goto error;		wIndex--;		temp = ehci_readl(ehci, status_reg);		if (temp & PORT_OWNER)			break;		temp &= ~PORT_RWC_BITS;		switch (wValue) {		case USB_PORT_FEAT_SUSPEND:			if (ehci->no_selective_suspend)				break;			if ((temp & PORT_PE) == 0					|| (temp & PORT_RESET) != 0)				goto error;			if (device_may_wakeup(&hcd->self.root_hub->dev))				temp |= PORT_WAKE_BITS;			ehci_writel(ehci, temp | PORT_SUSPEND, status_reg);			break;		case USB_PORT_FEAT_POWER:			if (HCS_PPC (ehci->hcs_params))				ehci_writel(ehci, temp | PORT_POWER,						status_reg);			break;		case USB_PORT_FEAT_RESET:			if (temp & PORT_RESUME)				goto error;			/* line status bits may report this as low speed,			 * which can be fine if this root hub has a			 * transaction translator built in.			 */			if ((temp & (PORT_PE|PORT_CONNECT)) == PORT_CONNECT					&& !ehci_is_TDI(ehci)					&& PORT_USB11 (temp)) {				ehci_dbg (ehci,					"port %d low speed --> companion\n",					wIndex + 1);				temp |= PORT_OWNER;			} else {				ehci_vdbg (ehci, "port %d reset\n", wIndex + 1);				temp |= PORT_RESET;				temp &= ~PORT_PE;				/*				 * caller must wait, then call GetPortStatus				 * usb 2.0 spec says 50 ms resets on root				 */				ehci->reset_done [wIndex] = jiffies						+ msecs_to_jiffies (50);			}			ehci_writel(ehci, temp, status_reg);			break;		/* For downstream facing ports (these):  one hub port is put		 * into test mode according to USB2 11.24.2.13, then the hub		 * must be reset (which for root hub now means rmmod+modprobe,		 * or else system reboot).  See EHCI 2.3.9 and 4.14 for info		 * about the EHCI-specific stuff.		 */		case USB_PORT_FEAT_TEST:			if (!selector || selector > 5)				goto error;			ehci_quiesce(ehci);			ehci_halt(ehci);			temp |= selector << 16;			ehci_writel(ehci, temp, status_reg);			break;		default:			goto error;		}		ehci_readl(ehci, &ehci->regs->command);	/* unblock posted writes */		break;	default:error:		/* "stall" on error */		retval = -EPIPE;	}	spin_unlock_irqrestore (&ehci->lock, flags);	return retval;}