11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * OHCI HCD (Host Controller Driver) for USB. 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at> 51da177e4SLinus Torvalds * (C) Copyright 2000-2004 David Brownell <dbrownell@users.sourceforge.net> 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * This file is licenced under GPL 81da177e4SLinus Torvalds */ 91da177e4SLinus Torvalds 101da177e4SLinus Torvalds /*-------------------------------------------------------------------------*/ 111da177e4SLinus Torvalds 121da177e4SLinus Torvalds /* 131da177e4SLinus Torvalds * OHCI Root Hub ... the nonsharable stuff 141da177e4SLinus Torvalds */ 151da177e4SLinus Torvalds 161da177e4SLinus Torvalds #define dbg_port(hc,label,num,value) \ 171da177e4SLinus Torvalds ohci_dbg (hc, \ 181da177e4SLinus Torvalds "%s roothub.portstatus [%d] " \ 191da177e4SLinus Torvalds "= 0x%08x%s%s%s%s%s%s%s%s%s%s%s%s\n", \ 201da177e4SLinus Torvalds label, num, temp, \ 211da177e4SLinus Torvalds (temp & RH_PS_PRSC) ? " PRSC" : "", \ 221da177e4SLinus Torvalds (temp & RH_PS_OCIC) ? " OCIC" : "", \ 231da177e4SLinus Torvalds (temp & RH_PS_PSSC) ? " PSSC" : "", \ 241da177e4SLinus Torvalds (temp & RH_PS_PESC) ? " PESC" : "", \ 251da177e4SLinus Torvalds (temp & RH_PS_CSC) ? " CSC" : "", \ 261da177e4SLinus Torvalds \ 271da177e4SLinus Torvalds (temp & RH_PS_LSDA) ? " LSDA" : "", \ 281da177e4SLinus Torvalds (temp & RH_PS_PPS) ? " PPS" : "", \ 291da177e4SLinus Torvalds (temp & RH_PS_PRS) ? " PRS" : "", \ 301da177e4SLinus Torvalds (temp & RH_PS_POCI) ? " POCI" : "", \ 311da177e4SLinus Torvalds (temp & RH_PS_PSS) ? " PSS" : "", \ 321da177e4SLinus Torvalds \ 331da177e4SLinus Torvalds (temp & RH_PS_PES) ? " PES" : "", \ 341da177e4SLinus Torvalds (temp & RH_PS_CCS) ? " CCS" : "" \ 351da177e4SLinus Torvalds ); 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds /*-------------------------------------------------------------------------*/ 381da177e4SLinus Torvalds 398ad7fe16SDavid Brownell #ifdef CONFIG_PM 401da177e4SLinus Torvalds 411da177e4SLinus Torvalds #define OHCI_SCHED_ENABLES \ 421da177e4SLinus Torvalds (OHCI_CTRL_CLE|OHCI_CTRL_BLE|OHCI_CTRL_PLE|OHCI_CTRL_IE) 431da177e4SLinus Torvalds 441da177e4SLinus Torvalds static void dl_done_list (struct ohci_hcd *, struct pt_regs *); 451da177e4SLinus Torvalds static void finish_unlinks (struct ohci_hcd *, u16 , struct pt_regs *); 461da177e4SLinus Torvalds static int ohci_restart (struct ohci_hcd *ohci); 471da177e4SLinus Torvalds 480c0382e3SAlan Stern static int ohci_bus_suspend (struct usb_hcd *hcd) 491da177e4SLinus Torvalds { 501da177e4SLinus Torvalds struct ohci_hcd *ohci = hcd_to_ohci (hcd); 511da177e4SLinus Torvalds int status = 0; 521da177e4SLinus Torvalds unsigned long flags; 531da177e4SLinus Torvalds 541da177e4SLinus Torvalds spin_lock_irqsave (&ohci->lock, flags); 551da177e4SLinus Torvalds 568de98402SBenjamin Herrenschmidt if (unlikely(!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags))) { 578de98402SBenjamin Herrenschmidt spin_unlock_irqrestore (&ohci->lock, flags); 588de98402SBenjamin Herrenschmidt return -ESHUTDOWN; 598de98402SBenjamin Herrenschmidt } 608de98402SBenjamin Herrenschmidt 611da177e4SLinus Torvalds ohci->hc_control = ohci_readl (ohci, &ohci->regs->control); 621da177e4SLinus Torvalds switch (ohci->hc_control & OHCI_CTRL_HCFS) { 631da177e4SLinus Torvalds case OHCI_USB_RESUME: 641da177e4SLinus Torvalds ohci_dbg (ohci, "resume/suspend?\n"); 651da177e4SLinus Torvalds ohci->hc_control &= ~OHCI_CTRL_HCFS; 661da177e4SLinus Torvalds ohci->hc_control |= OHCI_USB_RESET; 671da177e4SLinus Torvalds ohci_writel (ohci, ohci->hc_control, &ohci->regs->control); 681da177e4SLinus Torvalds (void) ohci_readl (ohci, &ohci->regs->control); 691da177e4SLinus Torvalds /* FALL THROUGH */ 701da177e4SLinus Torvalds case OHCI_USB_RESET: 711da177e4SLinus Torvalds status = -EBUSY; 721da177e4SLinus Torvalds ohci_dbg (ohci, "needs reinit!\n"); 731da177e4SLinus Torvalds goto done; 741da177e4SLinus Torvalds case OHCI_USB_SUSPEND: 751da177e4SLinus Torvalds ohci_dbg (ohci, "already suspended\n"); 761da177e4SLinus Torvalds goto done; 771da177e4SLinus Torvalds } 781da177e4SLinus Torvalds ohci_dbg (ohci, "suspend root hub\n"); 791da177e4SLinus Torvalds 801da177e4SLinus Torvalds /* First stop any processing */ 811da177e4SLinus Torvalds if (ohci->hc_control & OHCI_SCHED_ENABLES) { 821da177e4SLinus Torvalds int limit; 831da177e4SLinus Torvalds 841da177e4SLinus Torvalds ohci->hc_control &= ~OHCI_SCHED_ENABLES; 851da177e4SLinus Torvalds ohci_writel (ohci, ohci->hc_control, &ohci->regs->control); 861da177e4SLinus Torvalds ohci->hc_control = ohci_readl (ohci, &ohci->regs->control); 871da177e4SLinus Torvalds ohci_writel (ohci, OHCI_INTR_SF, &ohci->regs->intrstatus); 881da177e4SLinus Torvalds 891da177e4SLinus Torvalds /* sched disables take effect on the next frame, 901da177e4SLinus Torvalds * then the last WDH could take 6+ msec 911da177e4SLinus Torvalds */ 921da177e4SLinus Torvalds ohci_dbg (ohci, "stopping schedules ...\n"); 931da177e4SLinus Torvalds limit = 2000; 941da177e4SLinus Torvalds while (limit > 0) { 951da177e4SLinus Torvalds udelay (250); 961da177e4SLinus Torvalds limit =- 250; 971da177e4SLinus Torvalds if (ohci_readl (ohci, &ohci->regs->intrstatus) 981da177e4SLinus Torvalds & OHCI_INTR_SF) 991da177e4SLinus Torvalds break; 1001da177e4SLinus Torvalds } 1011da177e4SLinus Torvalds dl_done_list (ohci, NULL); 1021da177e4SLinus Torvalds mdelay (7); 1031da177e4SLinus Torvalds } 1041da177e4SLinus Torvalds dl_done_list (ohci, NULL); 1051da177e4SLinus Torvalds finish_unlinks (ohci, ohci_frame_no(ohci), NULL); 1061da177e4SLinus Torvalds ohci_writel (ohci, ohci_readl (ohci, &ohci->regs->intrstatus), 1071da177e4SLinus Torvalds &ohci->regs->intrstatus); 1081da177e4SLinus Torvalds 1091da177e4SLinus Torvalds /* maybe resume can wake root hub */ 110*6a9062f3SDavid Brownell if (device_may_wakeup(&ohci_to_hcd(ohci)->self.root_hub->dev)) 1111da177e4SLinus Torvalds ohci->hc_control |= OHCI_CTRL_RWE; 1121da177e4SLinus Torvalds else 1131da177e4SLinus Torvalds ohci->hc_control &= ~OHCI_CTRL_RWE; 1141da177e4SLinus Torvalds 115f197b2c5SDavid Brownell /* Suspend hub ... this is the "global (to this bus) suspend" mode, 116f197b2c5SDavid Brownell * which doesn't imply ports will first be individually suspended. 117f197b2c5SDavid Brownell */ 1181da177e4SLinus Torvalds ohci->hc_control &= ~OHCI_CTRL_HCFS; 1191da177e4SLinus Torvalds ohci->hc_control |= OHCI_USB_SUSPEND; 1201da177e4SLinus Torvalds ohci_writel (ohci, ohci->hc_control, &ohci->regs->control); 1211da177e4SLinus Torvalds (void) ohci_readl (ohci, &ohci->regs->control); 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds /* no resumes until devices finish suspending */ 1241da177e4SLinus Torvalds ohci->next_statechange = jiffies + msecs_to_jiffies (5); 1251da177e4SLinus Torvalds 1261da177e4SLinus Torvalds done: 127f197b2c5SDavid Brownell /* external suspend vs self autosuspend ... same effect */ 1281da177e4SLinus Torvalds if (status == 0) 129f197b2c5SDavid Brownell usb_hcd_suspend_root_hub(hcd); 1301da177e4SLinus Torvalds spin_unlock_irqrestore (&ohci->lock, flags); 1311da177e4SLinus Torvalds return status; 1321da177e4SLinus Torvalds } 1331da177e4SLinus Torvalds 1341da177e4SLinus Torvalds static inline struct ed *find_head (struct ed *ed) 1351da177e4SLinus Torvalds { 1361da177e4SLinus Torvalds /* for bulk and control lists */ 1371da177e4SLinus Torvalds while (ed->ed_prev) 1381da177e4SLinus Torvalds ed = ed->ed_prev; 1391da177e4SLinus Torvalds return ed; 1401da177e4SLinus Torvalds } 1411da177e4SLinus Torvalds 1421da177e4SLinus Torvalds /* caller has locked the root hub */ 1430c0382e3SAlan Stern static int ohci_bus_resume (struct usb_hcd *hcd) 1441da177e4SLinus Torvalds { 1451da177e4SLinus Torvalds struct ohci_hcd *ohci = hcd_to_ohci (hcd); 1461da177e4SLinus Torvalds u32 temp, enables; 1471da177e4SLinus Torvalds int status = -EINPROGRESS; 1488de98402SBenjamin Herrenschmidt unsigned long flags; 1491da177e4SLinus Torvalds 1501da177e4SLinus Torvalds if (time_before (jiffies, ohci->next_statechange)) 1511da177e4SLinus Torvalds msleep(5); 1521da177e4SLinus Torvalds 1538de98402SBenjamin Herrenschmidt spin_lock_irqsave (&ohci->lock, flags); 1548de98402SBenjamin Herrenschmidt 1558de98402SBenjamin Herrenschmidt if (unlikely(!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags))) { 1568de98402SBenjamin Herrenschmidt spin_unlock_irqrestore (&ohci->lock, flags); 1578de98402SBenjamin Herrenschmidt return -ESHUTDOWN; 1588de98402SBenjamin Herrenschmidt } 1598de98402SBenjamin Herrenschmidt 1608de98402SBenjamin Herrenschmidt 1611da177e4SLinus Torvalds ohci->hc_control = ohci_readl (ohci, &ohci->regs->control); 1621da177e4SLinus Torvalds 1631da177e4SLinus Torvalds if (ohci->hc_control & (OHCI_CTRL_IR | OHCI_SCHED_ENABLES)) { 164f197b2c5SDavid Brownell /* this can happen after resuming a swsusp snapshot */ 1651da177e4SLinus Torvalds if (hcd->state == HC_STATE_RESUMING) { 1661da177e4SLinus Torvalds ohci_dbg (ohci, "BIOS/SMM active, control %03x\n", 1671da177e4SLinus Torvalds ohci->hc_control); 1681da177e4SLinus Torvalds status = -EBUSY; 1691da177e4SLinus Torvalds /* this happens when pmcore resumes HC then root */ 1701da177e4SLinus Torvalds } else { 1711da177e4SLinus Torvalds ohci_dbg (ohci, "duplicate resume\n"); 1721da177e4SLinus Torvalds status = 0; 1731da177e4SLinus Torvalds } 1741da177e4SLinus Torvalds } else switch (ohci->hc_control & OHCI_CTRL_HCFS) { 1751da177e4SLinus Torvalds case OHCI_USB_SUSPEND: 1761da177e4SLinus Torvalds ohci->hc_control &= ~(OHCI_CTRL_HCFS|OHCI_SCHED_ENABLES); 1771da177e4SLinus Torvalds ohci->hc_control |= OHCI_USB_RESUME; 1781da177e4SLinus Torvalds ohci_writel (ohci, ohci->hc_control, &ohci->regs->control); 1791da177e4SLinus Torvalds (void) ohci_readl (ohci, &ohci->regs->control); 1801da177e4SLinus Torvalds ohci_dbg (ohci, "resume root hub\n"); 1811da177e4SLinus Torvalds break; 1821da177e4SLinus Torvalds case OHCI_USB_RESUME: 1831da177e4SLinus Torvalds /* HCFS changes sometime after INTR_RD */ 1841da177e4SLinus Torvalds ohci_info (ohci, "wakeup\n"); 1851da177e4SLinus Torvalds break; 1861da177e4SLinus Torvalds case OHCI_USB_OPER: 187f197b2c5SDavid Brownell /* this can happen after resuming a swsusp snapshot */ 188f197b2c5SDavid Brownell ohci_dbg (ohci, "snapshot resume? reinit\n"); 189f197b2c5SDavid Brownell status = -EBUSY; 1901da177e4SLinus Torvalds break; 1911da177e4SLinus Torvalds default: /* RESET, we lost power */ 192f197b2c5SDavid Brownell ohci_dbg (ohci, "lost power\n"); 1931da177e4SLinus Torvalds status = -EBUSY; 1941da177e4SLinus Torvalds } 1958de98402SBenjamin Herrenschmidt spin_unlock_irqrestore (&ohci->lock, flags); 1961da177e4SLinus Torvalds if (status == -EBUSY) { 1971da177e4SLinus Torvalds (void) ohci_init (ohci); 1981da177e4SLinus Torvalds return ohci_restart (ohci); 1991da177e4SLinus Torvalds } 2001da177e4SLinus Torvalds if (status != -EINPROGRESS) 2011da177e4SLinus Torvalds return status; 2021da177e4SLinus Torvalds 203fdd13b36SDavid Brownell temp = ohci->num_ports; 2041da177e4SLinus Torvalds enables = 0; 2051da177e4SLinus Torvalds while (temp--) { 2061da177e4SLinus Torvalds u32 stat = ohci_readl (ohci, 2071da177e4SLinus Torvalds &ohci->regs->roothub.portstatus [temp]); 2081da177e4SLinus Torvalds 2091da177e4SLinus Torvalds /* force global, not selective, resume */ 2101da177e4SLinus Torvalds if (!(stat & RH_PS_PSS)) 2111da177e4SLinus Torvalds continue; 2121da177e4SLinus Torvalds ohci_writel (ohci, RH_PS_POCI, 2131da177e4SLinus Torvalds &ohci->regs->roothub.portstatus [temp]); 2141da177e4SLinus Torvalds } 2151da177e4SLinus Torvalds 2161da177e4SLinus Torvalds /* Some controllers (lucent erratum) need extra-long delays */ 217f197b2c5SDavid Brownell msleep (20 /* usb 11.5.1.10 */ + 12 /* 32 msec counter */ + 1); 2181da177e4SLinus Torvalds 2191da177e4SLinus Torvalds temp = ohci_readl (ohci, &ohci->regs->control); 2201da177e4SLinus Torvalds temp &= OHCI_CTRL_HCFS; 2211da177e4SLinus Torvalds if (temp != OHCI_USB_RESUME) { 2221da177e4SLinus Torvalds ohci_err (ohci, "controller won't resume\n"); 2231da177e4SLinus Torvalds return -EBUSY; 2241da177e4SLinus Torvalds } 2251da177e4SLinus Torvalds 2261da177e4SLinus Torvalds /* disable old schedule state, reinit from scratch */ 2271da177e4SLinus Torvalds ohci_writel (ohci, 0, &ohci->regs->ed_controlhead); 2281da177e4SLinus Torvalds ohci_writel (ohci, 0, &ohci->regs->ed_controlcurrent); 2291da177e4SLinus Torvalds ohci_writel (ohci, 0, &ohci->regs->ed_bulkhead); 2301da177e4SLinus Torvalds ohci_writel (ohci, 0, &ohci->regs->ed_bulkcurrent); 2311da177e4SLinus Torvalds ohci_writel (ohci, 0, &ohci->regs->ed_periodcurrent); 2321da177e4SLinus Torvalds ohci_writel (ohci, (u32) ohci->hcca_dma, &ohci->regs->hcca); 2331da177e4SLinus Torvalds 2341da177e4SLinus Torvalds /* Sometimes PCI D3 suspend trashes frame timings ... */ 2351da177e4SLinus Torvalds periodic_reinit (ohci); 2361da177e4SLinus Torvalds 2371da177e4SLinus Torvalds /* interrupts might have been disabled */ 2381da177e4SLinus Torvalds ohci_writel (ohci, OHCI_INTR_INIT, &ohci->regs->intrenable); 2391da177e4SLinus Torvalds if (ohci->ed_rm_list) 2401da177e4SLinus Torvalds ohci_writel (ohci, OHCI_INTR_SF, &ohci->regs->intrenable); 2411da177e4SLinus Torvalds ohci_writel (ohci, ohci_readl (ohci, &ohci->regs->intrstatus), 2421da177e4SLinus Torvalds &ohci->regs->intrstatus); 2431da177e4SLinus Torvalds 2441da177e4SLinus Torvalds /* Then re-enable operations */ 2451da177e4SLinus Torvalds ohci_writel (ohci, OHCI_USB_OPER, &ohci->regs->control); 2461da177e4SLinus Torvalds (void) ohci_readl (ohci, &ohci->regs->control); 2471da177e4SLinus Torvalds msleep (3); 2481da177e4SLinus Torvalds 249*6a9062f3SDavid Brownell temp = ohci->hc_control; 250*6a9062f3SDavid Brownell temp &= OHCI_CTRL_RWC; 251*6a9062f3SDavid Brownell temp |= OHCI_CONTROL_INIT | OHCI_USB_OPER; 2521da177e4SLinus Torvalds ohci->hc_control = temp; 2531da177e4SLinus Torvalds ohci_writel (ohci, temp, &ohci->regs->control); 2541da177e4SLinus Torvalds (void) ohci_readl (ohci, &ohci->regs->control); 2551da177e4SLinus Torvalds 2561da177e4SLinus Torvalds /* TRSMRCY */ 2571da177e4SLinus Torvalds msleep (10); 2581da177e4SLinus Torvalds 2591da177e4SLinus Torvalds /* keep it alive for ~5x suspend + resume costs */ 2601da177e4SLinus Torvalds ohci->next_statechange = jiffies + msecs_to_jiffies (250); 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds /* maybe turn schedules back on */ 2631da177e4SLinus Torvalds enables = 0; 2641da177e4SLinus Torvalds temp = 0; 2651da177e4SLinus Torvalds if (!ohci->ed_rm_list) { 2661da177e4SLinus Torvalds if (ohci->ed_controltail) { 2671da177e4SLinus Torvalds ohci_writel (ohci, 2681da177e4SLinus Torvalds find_head (ohci->ed_controltail)->dma, 2691da177e4SLinus Torvalds &ohci->regs->ed_controlhead); 2701da177e4SLinus Torvalds enables |= OHCI_CTRL_CLE; 2711da177e4SLinus Torvalds temp |= OHCI_CLF; 2721da177e4SLinus Torvalds } 2731da177e4SLinus Torvalds if (ohci->ed_bulktail) { 2741da177e4SLinus Torvalds ohci_writel (ohci, find_head (ohci->ed_bulktail)->dma, 2751da177e4SLinus Torvalds &ohci->regs->ed_bulkhead); 2761da177e4SLinus Torvalds enables |= OHCI_CTRL_BLE; 2771da177e4SLinus Torvalds temp |= OHCI_BLF; 2781da177e4SLinus Torvalds } 2791da177e4SLinus Torvalds } 2801da177e4SLinus Torvalds if (hcd->self.bandwidth_isoc_reqs || hcd->self.bandwidth_int_reqs) 2811da177e4SLinus Torvalds enables |= OHCI_CTRL_PLE|OHCI_CTRL_IE; 2821da177e4SLinus Torvalds if (enables) { 2831da177e4SLinus Torvalds ohci_dbg (ohci, "restarting schedules ... %08x\n", enables); 2841da177e4SLinus Torvalds ohci->hc_control |= enables; 2851da177e4SLinus Torvalds ohci_writel (ohci, ohci->hc_control, &ohci->regs->control); 2861da177e4SLinus Torvalds if (temp) 2871da177e4SLinus Torvalds ohci_writel (ohci, temp, &ohci->regs->cmdstatus); 2881da177e4SLinus Torvalds (void) ohci_readl (ohci, &ohci->regs->control); 2891da177e4SLinus Torvalds } 2901da177e4SLinus Torvalds 2911da177e4SLinus Torvalds return 0; 2921da177e4SLinus Torvalds } 2931da177e4SLinus Torvalds 2948ad7fe16SDavid Brownell #endif /* CONFIG_PM */ 2951da177e4SLinus Torvalds 2961da177e4SLinus Torvalds /*-------------------------------------------------------------------------*/ 2971da177e4SLinus Torvalds 2981da177e4SLinus Torvalds /* build "status change" packet (one or two bytes) from HC registers */ 2991da177e4SLinus Torvalds 3001da177e4SLinus Torvalds static int 3011da177e4SLinus Torvalds ohci_hub_status_data (struct usb_hcd *hcd, char *buf) 3021da177e4SLinus Torvalds { 3031da177e4SLinus Torvalds struct ohci_hcd *ohci = hcd_to_ohci (hcd); 304fdd13b36SDavid Brownell int i, changed = 0, length = 1; 305*6a9062f3SDavid Brownell int can_suspend = device_may_wakeup(&hcd->self.root_hub->dev); 3061da177e4SLinus Torvalds unsigned long flags; 3071da177e4SLinus Torvalds 3081da177e4SLinus Torvalds spin_lock_irqsave (&ohci->lock, flags); 3091da177e4SLinus Torvalds 3101da177e4SLinus Torvalds /* handle autosuspended root: finish resuming before 3111da177e4SLinus Torvalds * letting khubd or root hub timer see state changes. 3121da177e4SLinus Torvalds */ 3138de98402SBenjamin Herrenschmidt if (unlikely((ohci->hc_control & OHCI_CTRL_HCFS) != OHCI_USB_OPER 3148de98402SBenjamin Herrenschmidt || !HC_IS_RUNNING(hcd->state))) { 3151da177e4SLinus Torvalds can_suspend = 0; 3161da177e4SLinus Torvalds goto done; 3171da177e4SLinus Torvalds } 3181da177e4SLinus Torvalds 319fdd13b36SDavid Brownell /* undocumented erratum seen on at least rev D */ 320fdd13b36SDavid Brownell if ((ohci->flags & OHCI_QUIRK_AMD756) 321fdd13b36SDavid Brownell && (roothub_a (ohci) & RH_A_NDP) > MAX_ROOT_PORTS) { 322fdd13b36SDavid Brownell ohci_warn (ohci, "bogus NDP, rereads as NDP=%d\n", 3231da177e4SLinus Torvalds ohci_readl (ohci, &ohci->regs->roothub.a) & RH_A_NDP); 3241da177e4SLinus Torvalds /* retry later; "should not happen" */ 3251da177e4SLinus Torvalds goto done; 3261da177e4SLinus Torvalds } 3271da177e4SLinus Torvalds 3281da177e4SLinus Torvalds /* init status */ 3291da177e4SLinus Torvalds if (roothub_status (ohci) & (RH_HS_LPSC | RH_HS_OCIC)) 3301da177e4SLinus Torvalds buf [0] = changed = 1; 3311da177e4SLinus Torvalds else 3321da177e4SLinus Torvalds buf [0] = 0; 333fdd13b36SDavid Brownell if (ohci->num_ports > 7) { 3341da177e4SLinus Torvalds buf [1] = 0; 3351da177e4SLinus Torvalds length++; 3361da177e4SLinus Torvalds } 3371da177e4SLinus Torvalds 3381da177e4SLinus Torvalds /* look at each port */ 339fdd13b36SDavid Brownell for (i = 0; i < ohci->num_ports; i++) { 3401da177e4SLinus Torvalds u32 status = roothub_portstatus (ohci, i); 3411da177e4SLinus Torvalds 3421da177e4SLinus Torvalds if (status & (RH_PS_CSC | RH_PS_PESC | RH_PS_PSSC 3431da177e4SLinus Torvalds | RH_PS_OCIC | RH_PS_PRSC)) { 3441da177e4SLinus Torvalds changed = 1; 3451da177e4SLinus Torvalds if (i < 7) 3461da177e4SLinus Torvalds buf [0] |= 1 << (i + 1); 3471da177e4SLinus Torvalds else 3481da177e4SLinus Torvalds buf [1] |= 1 << (i - 7); 3491da177e4SLinus Torvalds continue; 3501da177e4SLinus Torvalds } 3511da177e4SLinus Torvalds 3521da177e4SLinus Torvalds /* can suspend if no ports are enabled; or if all all 3531da177e4SLinus Torvalds * enabled ports are suspended AND remote wakeup is on. 3541da177e4SLinus Torvalds */ 3551da177e4SLinus Torvalds if (!(status & RH_PS_CCS)) 3561da177e4SLinus Torvalds continue; 357*6a9062f3SDavid Brownell if ((status & RH_PS_PSS) && can_suspend) 3581da177e4SLinus Torvalds continue; 3591da177e4SLinus Torvalds can_suspend = 0; 3601da177e4SLinus Torvalds } 3611da177e4SLinus Torvalds done: 3621da177e4SLinus Torvalds spin_unlock_irqrestore (&ohci->lock, flags); 3631da177e4SLinus Torvalds 3641da177e4SLinus Torvalds #ifdef CONFIG_PM 3651da177e4SLinus Torvalds /* save power by suspending idle root hubs; 3661da177e4SLinus Torvalds * INTR_RD wakes us when there's work 3671da177e4SLinus Torvalds */ 3681da177e4SLinus Torvalds if (can_suspend 3691da177e4SLinus Torvalds && !changed 3701da177e4SLinus Torvalds && !ohci->ed_rm_list 3711da177e4SLinus Torvalds && ((OHCI_CTRL_HCFS | OHCI_SCHED_ENABLES) 3721da177e4SLinus Torvalds & ohci->hc_control) 3731da177e4SLinus Torvalds == OHCI_USB_OPER 3741da177e4SLinus Torvalds && time_after (jiffies, ohci->next_statechange) 3759ad3d6ccSAlan Stern && usb_trylock_device (hcd->self.root_hub) == 0 3761da177e4SLinus Torvalds ) { 3771da177e4SLinus Torvalds ohci_vdbg (ohci, "autosuspend\n"); 3780c0382e3SAlan Stern (void) ohci_bus_suspend (hcd); 3791da177e4SLinus Torvalds usb_unlock_device (hcd->self.root_hub); 3801da177e4SLinus Torvalds } 3811da177e4SLinus Torvalds #endif 3821da177e4SLinus Torvalds 3831da177e4SLinus Torvalds return changed ? length : 0; 3841da177e4SLinus Torvalds } 3851da177e4SLinus Torvalds 3861da177e4SLinus Torvalds /*-------------------------------------------------------------------------*/ 3871da177e4SLinus Torvalds 3881da177e4SLinus Torvalds static void 3891da177e4SLinus Torvalds ohci_hub_descriptor ( 3901da177e4SLinus Torvalds struct ohci_hcd *ohci, 3911da177e4SLinus Torvalds struct usb_hub_descriptor *desc 3921da177e4SLinus Torvalds ) { 3931da177e4SLinus Torvalds u32 rh = roothub_a (ohci); 3941da177e4SLinus Torvalds u16 temp; 3951da177e4SLinus Torvalds 3961da177e4SLinus Torvalds desc->bDescriptorType = 0x29; 3971da177e4SLinus Torvalds desc->bPwrOn2PwrGood = (rh & RH_A_POTPGT) >> 24; 3981da177e4SLinus Torvalds desc->bHubContrCurrent = 0; 3991da177e4SLinus Torvalds 400fdd13b36SDavid Brownell desc->bNbrPorts = ohci->num_ports; 401fdd13b36SDavid Brownell temp = 1 + (ohci->num_ports / 8); 4021da177e4SLinus Torvalds desc->bDescLength = 7 + 2 * temp; 4031da177e4SLinus Torvalds 4041da177e4SLinus Torvalds temp = 0; 4051da177e4SLinus Torvalds if (rh & RH_A_NPS) /* no power switching? */ 4061da177e4SLinus Torvalds temp |= 0x0002; 4071da177e4SLinus Torvalds if (rh & RH_A_PSM) /* per-port power switching? */ 4081da177e4SLinus Torvalds temp |= 0x0001; 4091da177e4SLinus Torvalds if (rh & RH_A_NOCP) /* no overcurrent reporting? */ 4101da177e4SLinus Torvalds temp |= 0x0010; 4111da177e4SLinus Torvalds else if (rh & RH_A_OCPM) /* per-port overcurrent reporting? */ 4121da177e4SLinus Torvalds temp |= 0x0008; 4131da177e4SLinus Torvalds desc->wHubCharacteristics = (__force __u16)cpu_to_hc16(ohci, temp); 4141da177e4SLinus Torvalds 4151da177e4SLinus Torvalds /* two bitmaps: ports removable, and usb 1.0 legacy PortPwrCtrlMask */ 4161da177e4SLinus Torvalds rh = roothub_b (ohci); 417b2134bcdSKAMBAROV, ZAUR memset(desc->bitmap, 0xff, sizeof(desc->bitmap)); 4181da177e4SLinus Torvalds desc->bitmap [0] = rh & RH_B_DR; 419fdd13b36SDavid Brownell if (ohci->num_ports > 7) { 4201da177e4SLinus Torvalds desc->bitmap [1] = (rh & RH_B_DR) >> 8; 421b2134bcdSKAMBAROV, ZAUR desc->bitmap [2] = 0xff; 4221da177e4SLinus Torvalds } else 4231da177e4SLinus Torvalds desc->bitmap [1] = 0xff; 4241da177e4SLinus Torvalds } 4251da177e4SLinus Torvalds 4261da177e4SLinus Torvalds /*-------------------------------------------------------------------------*/ 4271da177e4SLinus Torvalds 4281da177e4SLinus Torvalds #ifdef CONFIG_USB_OTG 4291da177e4SLinus Torvalds 4301da177e4SLinus Torvalds static int ohci_start_port_reset (struct usb_hcd *hcd, unsigned port) 4311da177e4SLinus Torvalds { 4321da177e4SLinus Torvalds struct ohci_hcd *ohci = hcd_to_ohci (hcd); 4331da177e4SLinus Torvalds u32 status; 4341da177e4SLinus Torvalds 4351da177e4SLinus Torvalds if (!port) 4361da177e4SLinus Torvalds return -EINVAL; 4371da177e4SLinus Torvalds port--; 4381da177e4SLinus Torvalds 4391da177e4SLinus Torvalds /* start port reset before HNP protocol times out */ 4401da177e4SLinus Torvalds status = ohci_readl(ohci, &ohci->regs->roothub.portstatus [port]); 4411da177e4SLinus Torvalds if (!(status & RH_PS_CCS)) 4421da177e4SLinus Torvalds return -ENODEV; 4431da177e4SLinus Torvalds 4441da177e4SLinus Torvalds /* khubd will finish the reset later */ 4451da177e4SLinus Torvalds ohci_writel(ohci, RH_PS_PRS, &ohci->regs->roothub.portstatus [port]); 4461da177e4SLinus Torvalds return 0; 4471da177e4SLinus Torvalds } 4481da177e4SLinus Torvalds 4491da177e4SLinus Torvalds static void start_hnp(struct ohci_hcd *ohci); 4501da177e4SLinus Torvalds 4511da177e4SLinus Torvalds #else 4521da177e4SLinus Torvalds 4531da177e4SLinus Torvalds #define ohci_start_port_reset NULL 4541da177e4SLinus Torvalds 4551da177e4SLinus Torvalds #endif 4561da177e4SLinus Torvalds 4571da177e4SLinus Torvalds /*-------------------------------------------------------------------------*/ 4581da177e4SLinus Torvalds 4591da177e4SLinus Torvalds 4601da177e4SLinus Torvalds /* See usb 7.1.7.5: root hubs must issue at least 50 msec reset signaling, 4611da177e4SLinus Torvalds * not necessarily continuous ... to guard against resume signaling. 4621da177e4SLinus Torvalds * The short timeout is safe for non-root hubs, and is backward-compatible 4631da177e4SLinus Torvalds * with earlier Linux hosts. 4641da177e4SLinus Torvalds */ 4651da177e4SLinus Torvalds #ifdef CONFIG_USB_SUSPEND 4661da177e4SLinus Torvalds #define PORT_RESET_MSEC 50 4671da177e4SLinus Torvalds #else 4681da177e4SLinus Torvalds #define PORT_RESET_MSEC 10 4691da177e4SLinus Torvalds #endif 4701da177e4SLinus Torvalds 4711da177e4SLinus Torvalds /* this timer value might be vendor-specific ... */ 4721da177e4SLinus Torvalds #define PORT_RESET_HW_MSEC 10 4731da177e4SLinus Torvalds 4741da177e4SLinus Torvalds /* wrap-aware logic morphed from <linux/jiffies.h> */ 4751da177e4SLinus Torvalds #define tick_before(t1,t2) ((s16)(((s16)(t1))-((s16)(t2))) < 0) 4761da177e4SLinus Torvalds 4771da177e4SLinus Torvalds /* called from some task, normally khubd */ 4781da177e4SLinus Torvalds static inline void root_port_reset (struct ohci_hcd *ohci, unsigned port) 4791da177e4SLinus Torvalds { 4801da177e4SLinus Torvalds __hc32 __iomem *portstat = &ohci->regs->roothub.portstatus [port]; 4811da177e4SLinus Torvalds u32 temp; 4821da177e4SLinus Torvalds u16 now = ohci_readl(ohci, &ohci->regs->fmnumber); 4831da177e4SLinus Torvalds u16 reset_done = now + PORT_RESET_MSEC; 4841da177e4SLinus Torvalds 4851da177e4SLinus Torvalds /* build a "continuous enough" reset signal, with up to 4861da177e4SLinus Torvalds * 3msec gap between pulses. scheduler HZ==100 must work; 4871da177e4SLinus Torvalds * this might need to be deadline-scheduled. 4881da177e4SLinus Torvalds */ 4891da177e4SLinus Torvalds do { 4901da177e4SLinus Torvalds /* spin until any current reset finishes */ 4911da177e4SLinus Torvalds for (;;) { 4921da177e4SLinus Torvalds temp = ohci_readl (ohci, portstat); 4931da177e4SLinus Torvalds if (!(temp & RH_PS_PRS)) 4941da177e4SLinus Torvalds break; 4951da177e4SLinus Torvalds udelay (500); 4961da177e4SLinus Torvalds } 4971da177e4SLinus Torvalds 4981da177e4SLinus Torvalds if (!(temp & RH_PS_CCS)) 4991da177e4SLinus Torvalds break; 5001da177e4SLinus Torvalds if (temp & RH_PS_PRSC) 5011da177e4SLinus Torvalds ohci_writel (ohci, RH_PS_PRSC, portstat); 5021da177e4SLinus Torvalds 5031da177e4SLinus Torvalds /* start the next reset, sleep till it's probably done */ 5041da177e4SLinus Torvalds ohci_writel (ohci, RH_PS_PRS, portstat); 5051da177e4SLinus Torvalds msleep(PORT_RESET_HW_MSEC); 5061da177e4SLinus Torvalds now = ohci_readl(ohci, &ohci->regs->fmnumber); 5071da177e4SLinus Torvalds } while (tick_before(now, reset_done)); 5081da177e4SLinus Torvalds /* caller synchronizes using PRSC */ 5091da177e4SLinus Torvalds } 5101da177e4SLinus Torvalds 5111da177e4SLinus Torvalds static int ohci_hub_control ( 5121da177e4SLinus Torvalds struct usb_hcd *hcd, 5131da177e4SLinus Torvalds u16 typeReq, 5141da177e4SLinus Torvalds u16 wValue, 5151da177e4SLinus Torvalds u16 wIndex, 5161da177e4SLinus Torvalds char *buf, 5171da177e4SLinus Torvalds u16 wLength 5181da177e4SLinus Torvalds ) { 5191da177e4SLinus Torvalds struct ohci_hcd *ohci = hcd_to_ohci (hcd); 5201da177e4SLinus Torvalds int ports = hcd_to_bus (hcd)->root_hub->maxchild; 5211da177e4SLinus Torvalds u32 temp; 5221da177e4SLinus Torvalds int retval = 0; 5231da177e4SLinus Torvalds 5248de98402SBenjamin Herrenschmidt if (unlikely(!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags))) 5258de98402SBenjamin Herrenschmidt return -ESHUTDOWN; 5268de98402SBenjamin Herrenschmidt 5271da177e4SLinus Torvalds switch (typeReq) { 5281da177e4SLinus Torvalds case ClearHubFeature: 5291da177e4SLinus Torvalds switch (wValue) { 5301da177e4SLinus Torvalds case C_HUB_OVER_CURRENT: 5311da177e4SLinus Torvalds ohci_writel (ohci, RH_HS_OCIC, 5321da177e4SLinus Torvalds &ohci->regs->roothub.status); 5331da177e4SLinus Torvalds case C_HUB_LOCAL_POWER: 5341da177e4SLinus Torvalds break; 5351da177e4SLinus Torvalds default: 5361da177e4SLinus Torvalds goto error; 5371da177e4SLinus Torvalds } 5381da177e4SLinus Torvalds break; 5391da177e4SLinus Torvalds case ClearPortFeature: 5401da177e4SLinus Torvalds if (!wIndex || wIndex > ports) 5411da177e4SLinus Torvalds goto error; 5421da177e4SLinus Torvalds wIndex--; 5431da177e4SLinus Torvalds 5441da177e4SLinus Torvalds switch (wValue) { 5451da177e4SLinus Torvalds case USB_PORT_FEAT_ENABLE: 5461da177e4SLinus Torvalds temp = RH_PS_CCS; 5471da177e4SLinus Torvalds break; 5481da177e4SLinus Torvalds case USB_PORT_FEAT_C_ENABLE: 5491da177e4SLinus Torvalds temp = RH_PS_PESC; 5501da177e4SLinus Torvalds break; 5511da177e4SLinus Torvalds case USB_PORT_FEAT_SUSPEND: 5521da177e4SLinus Torvalds temp = RH_PS_POCI; 5531da177e4SLinus Torvalds if ((ohci->hc_control & OHCI_CTRL_HCFS) 5541da177e4SLinus Torvalds != OHCI_USB_OPER) 555f197b2c5SDavid Brownell usb_hcd_resume_root_hub(hcd); 5561da177e4SLinus Torvalds break; 5571da177e4SLinus Torvalds case USB_PORT_FEAT_C_SUSPEND: 5581da177e4SLinus Torvalds temp = RH_PS_PSSC; 5591da177e4SLinus Torvalds break; 5601da177e4SLinus Torvalds case USB_PORT_FEAT_POWER: 5611da177e4SLinus Torvalds temp = RH_PS_LSDA; 5621da177e4SLinus Torvalds break; 5631da177e4SLinus Torvalds case USB_PORT_FEAT_C_CONNECTION: 5641da177e4SLinus Torvalds temp = RH_PS_CSC; 5651da177e4SLinus Torvalds break; 5661da177e4SLinus Torvalds case USB_PORT_FEAT_C_OVER_CURRENT: 5671da177e4SLinus Torvalds temp = RH_PS_OCIC; 5681da177e4SLinus Torvalds break; 5691da177e4SLinus Torvalds case USB_PORT_FEAT_C_RESET: 5701da177e4SLinus Torvalds temp = RH_PS_PRSC; 5711da177e4SLinus Torvalds break; 5721da177e4SLinus Torvalds default: 5731da177e4SLinus Torvalds goto error; 5741da177e4SLinus Torvalds } 5751da177e4SLinus Torvalds ohci_writel (ohci, temp, 5761da177e4SLinus Torvalds &ohci->regs->roothub.portstatus [wIndex]); 5771da177e4SLinus Torvalds // ohci_readl (ohci, &ohci->regs->roothub.portstatus [wIndex]); 5781da177e4SLinus Torvalds break; 5791da177e4SLinus Torvalds case GetHubDescriptor: 5801da177e4SLinus Torvalds ohci_hub_descriptor (ohci, (struct usb_hub_descriptor *) buf); 5811da177e4SLinus Torvalds break; 5821da177e4SLinus Torvalds case GetHubStatus: 5831da177e4SLinus Torvalds temp = roothub_status (ohci) & ~(RH_HS_CRWE | RH_HS_DRWE); 5841da177e4SLinus Torvalds *(__le32 *) buf = cpu_to_le32 (temp); 5851da177e4SLinus Torvalds break; 5861da177e4SLinus Torvalds case GetPortStatus: 5871da177e4SLinus Torvalds if (!wIndex || wIndex > ports) 5881da177e4SLinus Torvalds goto error; 5891da177e4SLinus Torvalds wIndex--; 5901da177e4SLinus Torvalds temp = roothub_portstatus (ohci, wIndex); 5911da177e4SLinus Torvalds *(__le32 *) buf = cpu_to_le32 (temp); 5921da177e4SLinus Torvalds 5931da177e4SLinus Torvalds #ifndef OHCI_VERBOSE_DEBUG 5941da177e4SLinus Torvalds if (*(u16*)(buf+2)) /* only if wPortChange is interesting */ 5951da177e4SLinus Torvalds #endif 5961da177e4SLinus Torvalds dbg_port (ohci, "GetStatus", wIndex, temp); 5971da177e4SLinus Torvalds break; 5981da177e4SLinus Torvalds case SetHubFeature: 5991da177e4SLinus Torvalds switch (wValue) { 6001da177e4SLinus Torvalds case C_HUB_OVER_CURRENT: 6011da177e4SLinus Torvalds // FIXME: this can be cleared, yes? 6021da177e4SLinus Torvalds case C_HUB_LOCAL_POWER: 6031da177e4SLinus Torvalds break; 6041da177e4SLinus Torvalds default: 6051da177e4SLinus Torvalds goto error; 6061da177e4SLinus Torvalds } 6071da177e4SLinus Torvalds break; 6081da177e4SLinus Torvalds case SetPortFeature: 6091da177e4SLinus Torvalds if (!wIndex || wIndex > ports) 6101da177e4SLinus Torvalds goto error; 6111da177e4SLinus Torvalds wIndex--; 6121da177e4SLinus Torvalds switch (wValue) { 6131da177e4SLinus Torvalds case USB_PORT_FEAT_SUSPEND: 6141da177e4SLinus Torvalds #ifdef CONFIG_USB_OTG 6151da177e4SLinus Torvalds if (hcd->self.otg_port == (wIndex + 1) 6161da177e4SLinus Torvalds && hcd->self.b_hnp_enable) 6171da177e4SLinus Torvalds start_hnp(ohci); 6181da177e4SLinus Torvalds else 6191da177e4SLinus Torvalds #endif 6201da177e4SLinus Torvalds ohci_writel (ohci, RH_PS_PSS, 6211da177e4SLinus Torvalds &ohci->regs->roothub.portstatus [wIndex]); 6221da177e4SLinus Torvalds break; 6231da177e4SLinus Torvalds case USB_PORT_FEAT_POWER: 6241da177e4SLinus Torvalds ohci_writel (ohci, RH_PS_PPS, 6251da177e4SLinus Torvalds &ohci->regs->roothub.portstatus [wIndex]); 6261da177e4SLinus Torvalds break; 6271da177e4SLinus Torvalds case USB_PORT_FEAT_RESET: 6281da177e4SLinus Torvalds root_port_reset (ohci, wIndex); 6291da177e4SLinus Torvalds break; 6301da177e4SLinus Torvalds default: 6311da177e4SLinus Torvalds goto error; 6321da177e4SLinus Torvalds } 6331da177e4SLinus Torvalds break; 6341da177e4SLinus Torvalds 6351da177e4SLinus Torvalds default: 6361da177e4SLinus Torvalds error: 6371da177e4SLinus Torvalds /* "protocol stall" on error */ 6381da177e4SLinus Torvalds retval = -EPIPE; 6391da177e4SLinus Torvalds } 6401da177e4SLinus Torvalds return retval; 6411da177e4SLinus Torvalds } 6421da177e4SLinus Torvalds 643