Fedora kernel-2.6.17-1.2142_FC4 patched with stable patch-2.6.17.4-vs2.0.2-rc26.diff
[linux-2.6.git] / drivers / usb / host / uhci-hub.c
index 5ab18db..c8451d9 100644 (file)
@@ -33,16 +33,31 @@ static __u8 root_hub_hub_des[] =
 /* status change bits:  nonzero writes will clear */
 #define RWC_BITS       (USBPORTSC_OCC | USBPORTSC_PEC | USBPORTSC_CSC)
 
-static int uhci_hub_status_data(struct usb_hcd *hcd, char *buf)
+/* A port that either is connected or has a changed-bit set will prevent
+ * us from AUTO_STOPPING.
+ */
+static int any_ports_active(struct uhci_hcd *uhci)
 {
-       struct uhci_hcd *uhci = hcd_to_uhci(hcd);
-       unsigned int io_addr = uhci->io_addr;
-       int i;
+       int port;
+
+       for (port = 0; port < uhci->rh_numports; ++port) {
+               if ((inw(uhci->io_addr + USBPORTSC1 + port * 2) &
+                               (USBPORTSC_CCS | RWC_BITS)) ||
+                               test_bit(port, &uhci->port_c_suspend))
+                       return 1;
+       }
+       return 0;
+}
+
+static inline int get_hub_status_data(struct uhci_hcd *uhci, char *buf)
+{
+       int port;
 
        *buf = 0;
-       for (i = 0; i < uhci->rh_numports; i++) {
-               if (inw(io_addr + USBPORTSC1 + i * 2) & RWC_BITS)
-                       *buf |= (1 << (i + 1));
+       for (port = 0; port < uhci->rh_numports; ++port) {
+               if ((inw(uhci->io_addr + USBPORTSC1 + port * 2) & RWC_BITS) ||
+                               test_bit(port, &uhci->port_c_suspend))
+                       *buf |= (1 << (port + 1));
        }
        return !!*buf;
 }
@@ -62,31 +77,171 @@ static int uhci_hub_status_data(struct usb_hcd *hcd, char *buf)
        status &= ~(RWC_BITS|WZ_BITS); \
        outw(status, port_addr)
 
+/* UHCI controllers don't automatically stop resume signalling after 20 msec,
+ * so we have to poll and check timeouts in order to take care of it.
+ */
+static void uhci_finish_suspend(struct uhci_hcd *uhci, int port,
+               unsigned long port_addr)
+{
+       int status;
+
+       if (inw(port_addr) & (USBPORTSC_SUSP | USBPORTSC_RD)) {
+               CLR_RH_PORTSTAT(USBPORTSC_SUSP | USBPORTSC_RD);
+               if (test_bit(port, &uhci->resuming_ports))
+                       set_bit(port, &uhci->port_c_suspend);
+
+               /* The controller won't actually turn off the RD bit until
+                * it has had a chance to send a low-speed EOP sequence,
+                * which takes 3 bit times (= 2 microseconds).  We'll delay
+                * slightly longer for good luck. */
+               udelay(4);
+       }
+       clear_bit(port, &uhci->resuming_ports);
+}
+
+/* Wait for the UHCI controller in HP's iLO2 server management chip.
+ * It can take up to 250 us to finish a reset and set the CSC bit.
+ */
+static void wait_for_HP(unsigned long port_addr)
+{
+       int i;
+
+       for (i = 10; i < 250; i += 10) {
+               if (inw(port_addr) & USBPORTSC_CSC)
+                       return;
+               udelay(10);
+       }
+       /* Log a warning? */
+}
+
+static void uhci_check_ports(struct uhci_hcd *uhci)
+{
+       unsigned int port;
+       unsigned long port_addr;
+       int status;
+
+       for (port = 0; port < uhci->rh_numports; ++port) {
+               port_addr = uhci->io_addr + USBPORTSC1 + 2 * port;
+               status = inw(port_addr);
+               if (unlikely(status & USBPORTSC_PR)) {
+                       if (time_after_eq(jiffies, uhci->ports_timeout)) {
+                               CLR_RH_PORTSTAT(USBPORTSC_PR);
+                               udelay(10);
+
+                               /* HP's server management chip requires
+                                * a longer delay. */
+                               if (to_pci_dev(uhci_dev(uhci))->vendor ==
+                                               PCI_VENDOR_ID_HP)
+                                       wait_for_HP(port_addr);
+
+                               /* If the port was enabled before, turning
+                                * reset on caused a port enable change.
+                                * Turning reset off causes a port connect
+                                * status change.  Clear these changes. */
+                               CLR_RH_PORTSTAT(USBPORTSC_CSC | USBPORTSC_PEC);
+                               SET_RH_PORTSTAT(USBPORTSC_PE);
+                       }
+               }
+               if (unlikely(status & USBPORTSC_RD)) {
+                       if (!test_bit(port, &uhci->resuming_ports)) {
+
+                               /* Port received a wakeup request */
+                               set_bit(port, &uhci->resuming_ports);
+                               uhci->ports_timeout = jiffies +
+                                               msecs_to_jiffies(20);
+
+                               /* Make sure we see the port again
+                                * after the resuming period is over. */
+                               mod_timer(&uhci_to_hcd(uhci)->rh_timer,
+                                               uhci->ports_timeout);
+                       } else if (time_after_eq(jiffies,
+                                               uhci->ports_timeout)) {
+                               uhci_finish_suspend(uhci, port, port_addr);
+                       }
+               }
+       }
+}
+
+static int uhci_hub_status_data(struct usb_hcd *hcd, char *buf)
+{
+       struct uhci_hcd *uhci = hcd_to_uhci(hcd);
+       unsigned long flags;
+       int status = 0;
+
+       spin_lock_irqsave(&uhci->lock, flags);
+
+       uhci_scan_schedule(uhci, NULL);
+       if (uhci->hc_inaccessible)
+               goto done;
+       check_fsbr(uhci);
+       uhci_check_ports(uhci);
+
+       status = get_hub_status_data(uhci, buf);
+
+       switch (uhci->rh_state) {
+           case UHCI_RH_SUSPENDING:
+           case UHCI_RH_SUSPENDED:
+               /* if port change, ask to be resumed */
+               if (status)
+                       usb_hcd_resume_root_hub(hcd);
+               break;
+
+           case UHCI_RH_AUTO_STOPPED:
+               /* if port change, auto start */
+               if (status)
+                       wakeup_rh(uhci);
+               break;
+
+           case UHCI_RH_RUNNING:
+               /* are any devices attached? */
+               if (!any_ports_active(uhci)) {
+                       uhci->rh_state = UHCI_RH_RUNNING_NODEVS;
+                       uhci->auto_stop_time = jiffies + HZ;
+               }
+               break;
+
+           case UHCI_RH_RUNNING_NODEVS:
+               /* auto-stop if nothing connected for 1 second */
+               if (any_ports_active(uhci))
+                       uhci->rh_state = UHCI_RH_RUNNING;
+               else if (time_after_eq(jiffies, uhci->auto_stop_time))
+                       suspend_rh(uhci, UHCI_RH_AUTO_STOPPED);
+               break;
+
+           default:
+               break;
+       }
+
+done:
+       spin_unlock_irqrestore(&uhci->lock, flags);
+       return status;
+}
 
 /* size of returned buffer is part of USB spec */
 static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
                        u16 wIndex, char *buf, u16 wLength)
 {
        struct uhci_hcd *uhci = hcd_to_uhci(hcd);
-       int status, retval = 0, len = 0;
-       unsigned int port_addr = uhci->io_addr + USBPORTSC1 + 2 * (wIndex-1);
-       __u16 wPortChange, wPortStatus;
+       int status, lstatus, retval = 0, len = 0;
+       unsigned int port = wIndex - 1;
+       unsigned long port_addr = uhci->io_addr + USBPORTSC1 + 2 * port;
+       u16 wPortChange, wPortStatus;
+       unsigned long flags;
 
+       if (uhci->hc_inaccessible)
+               return -ETIMEDOUT;
+
+       spin_lock_irqsave(&uhci->lock, flags);
        switch (typeReq) {
-               /* Request Destination:
-                  without flags: Device,
-                  RH_INTERFACE: interface,
-                  RH_ENDPOINT: endpoint,
-                  RH_CLASS means HUB here,
-                  RH_OTHER | RH_CLASS  almost ever means HUB_PORT here
-               */
 
        case GetHubStatus:
-               *(__u32 *)buf = cpu_to_le32(0);
+               *(__le32 *)buf = cpu_to_le32(0);
                OK(4);          /* hub power */
        case GetPortStatus:
-               if (!wIndex || wIndex > uhci->rh_numports)
+               if (port >= uhci->rh_numports)
                        goto err;
+
+               uhci_check_ports(uhci);
                status = inw(port_addr);
 
                /* Intel controllers report the OverCurrent bit active on.
@@ -97,37 +252,44 @@ static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
                                PCI_VENDOR_ID_VIA)
                        status ^= USBPORTSC_OC;
 
-               /* UHCI doesn't support C_SUSPEND and C_RESET (always false) */
-               wPortChange = 0;
+               /* UHCI doesn't support C_RESET (always false) */
+               wPortChange = lstatus = 0;
                if (status & USBPORTSC_CSC)
-                       wPortChange |= 1 << (USB_PORT_FEAT_C_CONNECTION - 16);
+                       wPortChange |= USB_PORT_STAT_C_CONNECTION;
                if (status & USBPORTSC_PEC)
-                       wPortChange |= 1 << (USB_PORT_FEAT_C_ENABLE - 16);
+                       wPortChange |= USB_PORT_STAT_C_ENABLE;
                if (status & USBPORTSC_OCC)
-                       wPortChange |= 1 << (USB_PORT_FEAT_C_OVER_CURRENT - 16);
+                       wPortChange |= USB_PORT_STAT_C_OVERCURRENT;
+
+               if (test_bit(port, &uhci->port_c_suspend)) {
+                       wPortChange |= USB_PORT_STAT_C_SUSPEND;
+                       lstatus |= 1;
+               }
+               if (test_bit(port, &uhci->resuming_ports))
+                       lstatus |= 4;
 
                /* UHCI has no power switching (always on) */
-               wPortStatus = 1 << USB_PORT_FEAT_POWER;
+               wPortStatus = USB_PORT_STAT_POWER;
                if (status & USBPORTSC_CCS)
-                       wPortStatus |= 1 << USB_PORT_FEAT_CONNECTION;
+                       wPortStatus |= USB_PORT_STAT_CONNECTION;
                if (status & USBPORTSC_PE) {
-                       wPortStatus |= 1 << USB_PORT_FEAT_ENABLE;
+                       wPortStatus |= USB_PORT_STAT_ENABLE;
                        if (status & (USBPORTSC_SUSP | USBPORTSC_RD))
-                               wPortStatus |= 1 << USB_PORT_FEAT_SUSPEND;
+                               wPortStatus |= USB_PORT_STAT_SUSPEND;
                }
                if (status & USBPORTSC_OC)
-                       wPortStatus |= 1 << USB_PORT_FEAT_OVER_CURRENT;
+                       wPortStatus |= USB_PORT_STAT_OVERCURRENT;
                if (status & USBPORTSC_PR)
-                       wPortStatus |= 1 << USB_PORT_FEAT_RESET;
+                       wPortStatus |= USB_PORT_STAT_RESET;
                if (status & USBPORTSC_LSDA)
-                       wPortStatus |= 1 << USB_PORT_FEAT_LOWSPEED;
+                       wPortStatus |= USB_PORT_STAT_LOW_SPEED;
 
                if (wPortChange)
-                       dev_dbg(uhci_dev(uhci), "port %d portsc %04x\n",
-                                       wIndex, status);
+                       dev_dbg(uhci_dev(uhci), "port %d portsc %04x,%02x\n",
+                                       wIndex, status, lstatus);
 
-               *(__u16 *)buf = cpu_to_le16(wPortStatus);
-               *(__u16 *)(buf + 2) = cpu_to_le16(wPortChange);
+               *(__le16 *)buf = cpu_to_le16(wPortStatus);
+               *(__le16 *)(buf + 2) = cpu_to_le16(wPortChange);
                OK(4);
        case SetHubFeature:             /* We don't implement these */
        case ClearHubFeature:
@@ -140,7 +302,7 @@ static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
                }
                break;
        case SetPortFeature:
-               if (!wIndex || wIndex > uhci->rh_numports)
+               if (port >= uhci->rh_numports)
                        goto err;
 
                switch (wValue) {
@@ -149,12 +311,12 @@ static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
                        OK(0);
                case USB_PORT_FEAT_RESET:
                        SET_RH_PORTSTAT(USBPORTSC_PR);
-                       mdelay(50);     /* USB v1.1 7.1.7.3 */
-                       CLR_RH_PORTSTAT(USBPORTSC_PR);
-                       udelay(10);
-                       SET_RH_PORTSTAT(USBPORTSC_PE);
-                       mdelay(10);
-                       CLR_RH_PORTSTAT(USBPORTSC_PEC|USBPORTSC_CSC);
+
+                       /* Reset terminates Resume signalling */
+                       uhci_finish_suspend(uhci, port, port_addr);
+
+                       /* USB v2.0 7.1.7.5 */
+                       uhci->ports_timeout = jiffies + msecs_to_jiffies(50);
                        OK(0);
                case USB_PORT_FEAT_POWER:
                        /* UHCI has no power switching */
@@ -164,21 +326,43 @@ static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
                }
                break;
        case ClearPortFeature:
-               if (!wIndex || wIndex > uhci->rh_numports)
+               if (port >= uhci->rh_numports)
                        goto err;
 
                switch (wValue) {
                case USB_PORT_FEAT_ENABLE:
                        CLR_RH_PORTSTAT(USBPORTSC_PE);
+
+                       /* Disable terminates Resume signalling */
+                       uhci_finish_suspend(uhci, port, port_addr);
                        OK(0);
                case USB_PORT_FEAT_C_ENABLE:
                        CLR_RH_PORTSTAT(USBPORTSC_PEC);
                        OK(0);
                case USB_PORT_FEAT_SUSPEND:
-                       CLR_RH_PORTSTAT(USBPORTSC_SUSP);
+                       if (!(inw(port_addr) & USBPORTSC_SUSP)) {
+
+                               /* Make certain the port isn't suspended */
+                               uhci_finish_suspend(uhci, port, port_addr);
+                       } else if (!test_and_set_bit(port,
+                                               &uhci->resuming_ports)) {
+                               SET_RH_PORTSTAT(USBPORTSC_RD);
+
+                               /* The controller won't allow RD to be set
+                                * if the port is disabled.  When this happens
+                                * just skip the Resume signalling.
+                                */
+                               if (!(inw(port_addr) & USBPORTSC_RD))
+                                       uhci_finish_suspend(uhci, port,
+                                                       port_addr);
+                               else
+                                       /* USB v2.0 7.1.7.7 */
+                                       uhci->ports_timeout = jiffies +
+                                               msecs_to_jiffies(20);
+                       }
                        OK(0);
                case USB_PORT_FEAT_C_SUSPEND:
-                       /* this driver won't report these */
+                       clear_bit(port, &uhci->port_c_suspend);
                        OK(0);
                case USB_PORT_FEAT_POWER:
                        /* UHCI has no power switching */
@@ -206,6 +390,7 @@ static int uhci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
 err:
                retval = -EPIPE;
        }
+       spin_unlock_irqrestore(&uhci->lock, flags);
 
        return retval;
 }