Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Universal Host Controller Interface driver for USB. |
| 3 | * |
| 4 | * Maintainer: Alan Stern <stern@rowland.harvard.edu> |
| 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 | * (C) Copyright 1999 Roman Weissgaerber, weissg@vienna.at |
| 13 | * (C) Copyright 2000 Yggdrasil Computing, Inc. (port of new PCI interface |
| 14 | * support from usb-ohci.c by Adam Richter, adam@yggdrasil.com). |
| 15 | * (C) Copyright 1999 Gregory P. Smith (from usb-ohci.c) |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 16 | * (C) Copyright 2004-2007 Alan Stern, stern@rowland.harvard.edu |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | * |
| 18 | * Intel documents this fairly well, and as far as I know there |
| 19 | * are no royalties or anything like that, but even so there are |
| 20 | * people who decided that they want to do the same thing in a |
| 21 | * completely different way. |
| 22 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | */ |
| 24 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | #include <linux/module.h> |
| 26 | #include <linux/pci.h> |
| 27 | #include <linux/kernel.h> |
| 28 | #include <linux/init.h> |
| 29 | #include <linux/delay.h> |
| 30 | #include <linux/ioport.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 | #include <linux/errno.h> |
| 33 | #include <linux/unistd.h> |
| 34 | #include <linux/interrupt.h> |
| 35 | #include <linux/spinlock.h> |
| 36 | #include <linux/debugfs.h> |
| 37 | #include <linux/pm.h> |
| 38 | #include <linux/dmapool.h> |
| 39 | #include <linux/dma-mapping.h> |
| 40 | #include <linux/usb.h> |
| 41 | #include <linux/bitops.h> |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 42 | #include <linux/dmi.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | |
| 44 | #include <asm/uaccess.h> |
| 45 | #include <asm/io.h> |
| 46 | #include <asm/irq.h> |
| 47 | #include <asm/system.h> |
| 48 | |
| 49 | #include "../core/hcd.h" |
| 50 | #include "uhci-hcd.h" |
Adrian Bunk | 75e2df6 | 2006-03-25 18:01:53 +0100 | [diff] [blame] | 51 | #include "pci-quirks.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 | |
| 53 | /* |
| 54 | * Version Information |
| 55 | */ |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 56 | #define DRIVER_VERSION "v3.0" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | #define DRIVER_AUTHOR "Linus 'Frodo Rabbit' Torvalds, Johannes Erdfelt, \ |
| 58 | Randy Dunlap, Georg Acher, Deti Fliegl, Thomas Sailer, Roman Weissgaerber, \ |
| 59 | Alan Stern" |
| 60 | #define DRIVER_DESC "USB Universal Host Controller Interface driver" |
| 61 | |
Alan Stern | 5f8364b | 2006-12-05 16:29:55 -0500 | [diff] [blame] | 62 | /* for flakey hardware, ignore overcurrent indicators */ |
| 63 | static int ignore_oc; |
| 64 | module_param(ignore_oc, bool, S_IRUGO); |
| 65 | MODULE_PARM_DESC(ignore_oc, "ignore hardware overcurrent indications"); |
| 66 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 | /* |
| 68 | * debug = 0, no debugging messages |
Alan Stern | 687f5f3 | 2005-11-30 17:16:19 -0500 | [diff] [blame] | 69 | * debug = 1, dump failed URBs except for stalls |
| 70 | * debug = 2, dump all failed URBs (including stalls) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | * show all queues in /debug/uhci/[pci_addr] |
Alan Stern | 687f5f3 | 2005-11-30 17:16:19 -0500 | [diff] [blame] | 72 | * debug = 3, show all TDs in URBs when dumping |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | */ |
| 74 | #ifdef DEBUG |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 75 | #define DEBUG_CONFIGURED 1 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | static int debug = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 77 | module_param(debug, int, S_IRUGO | S_IWUSR); |
| 78 | MODULE_PARM_DESC(debug, "Debug level"); |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 79 | |
| 80 | #else |
| 81 | #define DEBUG_CONFIGURED 0 |
| 82 | #define debug 0 |
| 83 | #endif |
| 84 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | static char *errbuf; |
| 86 | #define ERRBUF_LEN (32 * 1024) |
| 87 | |
Christoph Lameter | e18b890 | 2006-12-06 20:33:20 -0800 | [diff] [blame] | 88 | static struct kmem_cache *uhci_up_cachep; /* urb_priv */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 90 | static void suspend_rh(struct uhci_hcd *uhci, enum uhci_rh_state new_state); |
| 91 | static void wakeup_rh(struct uhci_hcd *uhci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 92 | static void uhci_get_current_frame_number(struct uhci_hcd *uhci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | |
Alan Stern | f3fe239 | 2007-01-08 12:00:28 -0500 | [diff] [blame] | 94 | /* |
| 95 | * Calculate the link pointer DMA value for the first Skeleton QH in a frame. |
| 96 | */ |
| 97 | static __le32 uhci_frame_skel_link(struct uhci_hcd *uhci, int frame) |
| 98 | { |
| 99 | int skelnum; |
| 100 | |
| 101 | /* |
| 102 | * The interrupt queues will be interleaved as evenly as possible. |
| 103 | * There's not much to be done about period-1 interrupts; they have |
| 104 | * to occur in every frame. But we can schedule period-2 interrupts |
| 105 | * in odd-numbered frames, period-4 interrupts in frames congruent |
| 106 | * to 2 (mod 4), and so on. This way each frame only has two |
| 107 | * interrupt QHs, which will help spread out bandwidth utilization. |
| 108 | * |
| 109 | * ffs (Find First bit Set) does exactly what we need: |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 110 | * 1,3,5,... => ffs = 0 => use period-2 QH = skelqh[8], |
| 111 | * 2,6,10,... => ffs = 1 => use period-4 QH = skelqh[7], etc. |
Alan Stern | f3fe239 | 2007-01-08 12:00:28 -0500 | [diff] [blame] | 112 | * ffs >= 7 => not on any high-period queue, so use |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 113 | * period-1 QH = skelqh[9]. |
Alan Stern | f3fe239 | 2007-01-08 12:00:28 -0500 | [diff] [blame] | 114 | * Add in UHCI_NUMFRAMES to insure at least one bit is set. |
| 115 | */ |
| 116 | skelnum = 8 - (int) __ffs(frame | UHCI_NUMFRAMES); |
| 117 | if (skelnum <= 1) |
| 118 | skelnum = 9; |
Alan Stern | 28b9325 | 2007-02-19 15:51:51 -0500 | [diff] [blame] | 119 | return LINK_TO_QH(uhci->skelqh[skelnum]); |
Alan Stern | f3fe239 | 2007-01-08 12:00:28 -0500 | [diff] [blame] | 120 | } |
| 121 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | #include "uhci-debug.c" |
| 123 | #include "uhci-q.c" |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 124 | #include "uhci-hub.c" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 126 | /* |
Alan Stern | bb200f6 | 2005-10-03 16:36:29 -0400 | [diff] [blame] | 127 | * Finish up a host controller reset and update the recorded state. |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 128 | */ |
Alan Stern | bb200f6 | 2005-10-03 16:36:29 -0400 | [diff] [blame] | 129 | static void finish_reset(struct uhci_hcd *uhci) |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 130 | { |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 131 | int port; |
| 132 | |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 133 | /* HCRESET doesn't affect the Suspend, Reset, and Resume Detect |
| 134 | * bits in the port status and control registers. |
| 135 | * We have to clear them by hand. |
| 136 | */ |
| 137 | for (port = 0; port < uhci->rh_numports; ++port) |
| 138 | outw(0, uhci->io_addr + USBPORTSC1 + (port * 2)); |
| 139 | |
Alan Stern | 8e32640 | 2006-04-04 14:47:44 -0400 | [diff] [blame] | 140 | uhci->port_c_suspend = uhci->resuming_ports = 0; |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 141 | uhci->rh_state = UHCI_RH_RESET; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 142 | uhci->is_stopped = UHCI_IS_STOPPED; |
| 143 | uhci_to_hcd(uhci)->state = HC_STATE_HALT; |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 144 | uhci_to_hcd(uhci)->poll_rh = 0; |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 145 | |
| 146 | uhci->dead = 0; /* Full reset resurrects the controller */ |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 147 | } |
| 148 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 149 | /* |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 150 | * Last rites for a defunct/nonfunctional controller |
Alan Stern | 02597d2 | 2005-04-28 14:51:27 -0400 | [diff] [blame] | 151 | * or one we don't want to use any more. |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 152 | */ |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 153 | static void uhci_hc_died(struct uhci_hcd *uhci) |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 154 | { |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 155 | uhci_get_current_frame_number(uhci); |
Alan Stern | bb200f6 | 2005-10-03 16:36:29 -0400 | [diff] [blame] | 156 | uhci_reset_hc(to_pci_dev(uhci_dev(uhci)), uhci->io_addr); |
| 157 | finish_reset(uhci); |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 158 | uhci->dead = 1; |
| 159 | |
| 160 | /* The current frame may already be partway finished */ |
| 161 | ++uhci->frame_number; |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 162 | } |
| 163 | |
| 164 | /* |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 165 | * Initialize a controller that was newly discovered or has lost power |
| 166 | * or otherwise been reset while it was suspended. In none of these cases |
| 167 | * can we be sure of its previous state. |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 168 | */ |
| 169 | static void check_and_reset_hc(struct uhci_hcd *uhci) |
| 170 | { |
Alan Stern | bb200f6 | 2005-10-03 16:36:29 -0400 | [diff] [blame] | 171 | if (uhci_check_and_reset_hc(to_pci_dev(uhci_dev(uhci)), uhci->io_addr)) |
| 172 | finish_reset(uhci); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 173 | } |
| 174 | |
| 175 | /* |
| 176 | * Store the basic register settings needed by the controller. |
| 177 | */ |
| 178 | static void configure_hc(struct uhci_hcd *uhci) |
| 179 | { |
| 180 | /* Set the frame length to the default: 1 ms exactly */ |
| 181 | outb(USBSOF_DEFAULT, uhci->io_addr + USBSOF); |
| 182 | |
| 183 | /* Store the frame list base address */ |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 184 | outl(uhci->frame_dma_handle, uhci->io_addr + USBFLBASEADD); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 185 | |
| 186 | /* Set the current frame number */ |
Alan Stern | c433472 | 2006-05-19 16:34:57 -0400 | [diff] [blame] | 187 | outw(uhci->frame_number & UHCI_MAX_SOF_NUMBER, |
| 188 | uhci->io_addr + USBFRNUM); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 189 | |
Alan Stern | f37be9b | 2005-10-17 10:42:06 -0400 | [diff] [blame] | 190 | /* Mark controller as not halted before we enable interrupts */ |
| 191 | uhci_to_hcd(uhci)->state = HC_STATE_SUSPENDED; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 192 | mb(); |
| 193 | |
| 194 | /* Enable PIRQ */ |
| 195 | pci_write_config_word(to_pci_dev(uhci_dev(uhci)), USBLEGSUP, |
| 196 | USBLEGSUP_DEFAULT); |
| 197 | } |
| 198 | |
| 199 | |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 200 | static int resume_detect_interrupts_are_broken(struct uhci_hcd *uhci) |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 201 | { |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 202 | int port; |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 203 | |
Alan Stern | 5f8364b | 2006-12-05 16:29:55 -0500 | [diff] [blame] | 204 | /* If we have to ignore overcurrent events then almost by definition |
| 205 | * we can't depend on resume-detect interrupts. */ |
| 206 | if (ignore_oc) |
| 207 | return 1; |
| 208 | |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 209 | switch (to_pci_dev(uhci_dev(uhci))->vendor) { |
| 210 | default: |
| 211 | break; |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 212 | |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 213 | case PCI_VENDOR_ID_GENESYS: |
| 214 | /* Genesys Logic's GL880S controllers don't generate |
| 215 | * resume-detect interrupts. |
| 216 | */ |
| 217 | return 1; |
| 218 | |
| 219 | case PCI_VENDOR_ID_INTEL: |
| 220 | /* Some of Intel's USB controllers have a bug that causes |
| 221 | * resume-detect interrupts if any port has an over-current |
| 222 | * condition. To make matters worse, some motherboards |
| 223 | * hardwire unused USB ports' over-current inputs active! |
| 224 | * To prevent problems, we will not enable resume-detect |
| 225 | * interrupts if any ports are OC. |
| 226 | */ |
| 227 | for (port = 0; port < uhci->rh_numports; ++port) { |
| 228 | if (inw(uhci->io_addr + USBPORTSC1 + port * 2) & |
| 229 | USBPORTSC_OC) |
| 230 | return 1; |
| 231 | } |
| 232 | break; |
| 233 | } |
| 234 | return 0; |
| 235 | } |
| 236 | |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 237 | static int remote_wakeup_is_broken(struct uhci_hcd *uhci) |
| 238 | { |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 239 | int port; |
Jeff Garzik | 1855256 | 2007-10-03 15:15:40 -0400 | [diff] [blame] | 240 | const char *sys_info; |
Alan Stern | c80a70d | 2006-12-15 16:06:25 -0500 | [diff] [blame] | 241 | static char bad_Asus_board[] = "A7V8X"; |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 242 | |
| 243 | /* One of Asus's motherboards has a bug which causes it to |
| 244 | * wake up immediately from suspend-to-RAM if any of the ports |
| 245 | * are connected. In such cases we will not set EGSM. |
| 246 | */ |
Alan Stern | c80a70d | 2006-12-15 16:06:25 -0500 | [diff] [blame] | 247 | sys_info = dmi_get_system_info(DMI_BOARD_NAME); |
| 248 | if (sys_info && !strcmp(sys_info, bad_Asus_board)) { |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 249 | for (port = 0; port < uhci->rh_numports; ++port) { |
| 250 | if (inw(uhci->io_addr + USBPORTSC1 + port * 2) & |
| 251 | USBPORTSC_CCS) |
| 252 | return 1; |
| 253 | } |
| 254 | } |
| 255 | |
| 256 | return 0; |
| 257 | } |
| 258 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 259 | static void suspend_rh(struct uhci_hcd *uhci, enum uhci_rh_state new_state) |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 260 | __releases(uhci->lock) |
| 261 | __acquires(uhci->lock) |
| 262 | { |
| 263 | int auto_stop; |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 264 | int int_enable, egsm_enable; |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 265 | |
| 266 | auto_stop = (new_state == UHCI_RH_AUTO_STOPPED); |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 267 | dev_dbg(&uhci_to_hcd(uhci)->self.root_hub->dev, |
| 268 | "%s%s\n", __FUNCTION__, |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 269 | (auto_stop ? " (auto-stop)" : "")); |
| 270 | |
| 271 | /* If we get a suspend request when we're already auto-stopped |
| 272 | * then there's nothing to do. |
| 273 | */ |
| 274 | if (uhci->rh_state == UHCI_RH_AUTO_STOPPED) { |
| 275 | uhci->rh_state = new_state; |
| 276 | return; |
| 277 | } |
| 278 | |
| 279 | /* Enable resume-detect interrupts if they work. |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 280 | * Then enter Global Suspend mode if _it_ works, still configured. |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 281 | */ |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 282 | egsm_enable = USBCMD_EGSM; |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 283 | uhci->working_RD = 1; |
| 284 | int_enable = USBINTR_RESUME; |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 285 | if (remote_wakeup_is_broken(uhci)) |
| 286 | egsm_enable = 0; |
Alan Stern | 25c77b3 | 2006-12-15 16:08:13 -0500 | [diff] [blame] | 287 | if (resume_detect_interrupts_are_broken(uhci) || !egsm_enable || |
| 288 | !device_may_wakeup( |
| 289 | &uhci_to_hcd(uhci)->self.root_hub->dev)) |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 290 | uhci->working_RD = int_enable = 0; |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 291 | |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 292 | outw(int_enable, uhci->io_addr + USBINTR); |
Alan Stern | b62df45 | 2006-10-10 10:54:00 -0400 | [diff] [blame] | 293 | outw(egsm_enable | USBCMD_CF, uhci->io_addr + USBCMD); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 294 | mb(); |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 295 | udelay(5); |
| 296 | |
| 297 | /* If we're auto-stopping then no devices have been attached |
| 298 | * for a while, so there shouldn't be any active URBs and the |
| 299 | * controller should stop after a few microseconds. Otherwise |
| 300 | * we will give the controller one frame to stop. |
| 301 | */ |
| 302 | if (!auto_stop && !(inw(uhci->io_addr + USBSTS) & USBSTS_HCH)) { |
| 303 | uhci->rh_state = UHCI_RH_SUSPENDING; |
| 304 | spin_unlock_irq(&uhci->lock); |
| 305 | msleep(1); |
| 306 | spin_lock_irq(&uhci->lock); |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 307 | if (uhci->dead) |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 308 | return; |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 309 | } |
| 310 | if (!(inw(uhci->io_addr + USBSTS) & USBSTS_HCH)) |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 311 | dev_warn(&uhci_to_hcd(uhci)->self.root_hub->dev, |
| 312 | "Controller not stopped yet!\n"); |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 313 | |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 314 | uhci_get_current_frame_number(uhci); |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 315 | |
| 316 | uhci->rh_state = new_state; |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 317 | uhci->is_stopped = UHCI_IS_STOPPED; |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 318 | uhci_to_hcd(uhci)->poll_rh = !int_enable; |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 319 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 320 | uhci_scan_schedule(uhci); |
Alan Stern | 84afddd | 2006-05-12 11:35:45 -0400 | [diff] [blame] | 321 | uhci_fsbr_off(uhci); |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 322 | } |
| 323 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 324 | static void start_rh(struct uhci_hcd *uhci) |
| 325 | { |
Alan Stern | f37be9b | 2005-10-17 10:42:06 -0400 | [diff] [blame] | 326 | uhci_to_hcd(uhci)->state = HC_STATE_RUNNING; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 327 | uhci->is_stopped = 0; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 328 | |
| 329 | /* Mark it configured and running with a 64-byte max packet. |
| 330 | * All interrupts are enabled, even though RESUME won't do anything. |
| 331 | */ |
| 332 | outw(USBCMD_RS | USBCMD_CF | USBCMD_MAXP, uhci->io_addr + USBCMD); |
| 333 | outw(USBINTR_TIMEOUT | USBINTR_RESUME | USBINTR_IOC | USBINTR_SP, |
| 334 | uhci->io_addr + USBINTR); |
| 335 | mb(); |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 336 | uhci->rh_state = UHCI_RH_RUNNING; |
| 337 | uhci_to_hcd(uhci)->poll_rh = 1; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 338 | } |
| 339 | |
| 340 | static void wakeup_rh(struct uhci_hcd *uhci) |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 341 | __releases(uhci->lock) |
| 342 | __acquires(uhci->lock) |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 343 | { |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 344 | dev_dbg(&uhci_to_hcd(uhci)->self.root_hub->dev, |
| 345 | "%s%s\n", __FUNCTION__, |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 346 | uhci->rh_state == UHCI_RH_AUTO_STOPPED ? |
| 347 | " (auto-start)" : ""); |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 348 | |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 349 | /* If we are auto-stopped then no devices are attached so there's |
| 350 | * no need for wakeup signals. Otherwise we send Global Resume |
| 351 | * for 20 ms. |
| 352 | */ |
| 353 | if (uhci->rh_state == UHCI_RH_SUSPENDED) { |
| 354 | uhci->rh_state = UHCI_RH_RESUMING; |
| 355 | outw(USBCMD_FGR | USBCMD_EGSM | USBCMD_CF, |
| 356 | uhci->io_addr + USBCMD); |
| 357 | spin_unlock_irq(&uhci->lock); |
| 358 | msleep(20); |
| 359 | spin_lock_irq(&uhci->lock); |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 360 | if (uhci->dead) |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 361 | return; |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 362 | |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 363 | /* End Global Resume and wait for EOP to be sent */ |
| 364 | outw(USBCMD_CF, uhci->io_addr + USBCMD); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 365 | mb(); |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 366 | udelay(4); |
| 367 | if (inw(uhci->io_addr + USBCMD) & USBCMD_FGR) |
| 368 | dev_warn(uhci_dev(uhci), "FGR not stopped yet!\n"); |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 369 | } |
Alan Stern | c8f4fe4 | 2005-04-09 17:27:32 -0400 | [diff] [blame] | 370 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 371 | start_rh(uhci); |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 372 | |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 373 | /* Restart root hub polling */ |
| 374 | mod_timer(&uhci_to_hcd(uhci)->rh_timer, jiffies); |
Alan Stern | 014e73c | 2005-04-09 17:24:42 -0400 | [diff] [blame] | 375 | } |
| 376 | |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 377 | static irqreturn_t uhci_irq(struct usb_hcd *hcd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 378 | { |
| 379 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 380 | unsigned short status; |
| 381 | |
| 382 | /* |
| 383 | * Read the interrupt status, and write it back to clear the |
| 384 | * interrupt cause. Contrary to the UHCI specification, the |
| 385 | * "HC Halted" status bit is persistent: it is RO, not R/WC. |
| 386 | */ |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 387 | status = inw(uhci->io_addr + USBSTS); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 388 | if (!(status & ~USBSTS_HCH)) /* shared interrupt, not mine */ |
| 389 | return IRQ_NONE; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 390 | outw(status, uhci->io_addr + USBSTS); /* Clear it */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 391 | |
| 392 | if (status & ~(USBSTS_USBINT | USBSTS_ERROR | USBSTS_RD)) { |
| 393 | if (status & USBSTS_HSE) |
| 394 | dev_err(uhci_dev(uhci), "host system error, " |
| 395 | "PCI problems?\n"); |
| 396 | if (status & USBSTS_HCPE) |
| 397 | dev_err(uhci_dev(uhci), "host controller process " |
| 398 | "error, something bad happened!\n"); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 399 | if (status & USBSTS_HCH) { |
Alan Stern | 442258e | 2007-12-06 14:47:08 -0500 | [diff] [blame] | 400 | spin_lock(&uhci->lock); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 401 | if (uhci->rh_state >= UHCI_RH_RUNNING) { |
| 402 | dev_err(uhci_dev(uhci), |
| 403 | "host controller halted, " |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | "very bad!\n"); |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 405 | if (debug > 1 && errbuf) { |
| 406 | /* Print the schedule for debugging */ |
| 407 | uhci_sprint_schedule(uhci, |
| 408 | errbuf, ERRBUF_LEN); |
| 409 | lprintk(errbuf); |
| 410 | } |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 411 | uhci_hc_died(uhci); |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 412 | |
| 413 | /* Force a callback in case there are |
| 414 | * pending unlinks */ |
| 415 | mod_timer(&hcd->rh_timer, jiffies); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 416 | } |
Alan Stern | 442258e | 2007-12-06 14:47:08 -0500 | [diff] [blame] | 417 | spin_unlock(&uhci->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 418 | } |
| 419 | } |
| 420 | |
| 421 | if (status & USBSTS_RD) |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 422 | usb_hcd_poll_rh_status(hcd); |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 423 | else { |
Alan Stern | 442258e | 2007-12-06 14:47:08 -0500 | [diff] [blame] | 424 | spin_lock(&uhci->lock); |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 425 | uhci_scan_schedule(uhci); |
Alan Stern | 442258e | 2007-12-06 14:47:08 -0500 | [diff] [blame] | 426 | spin_unlock(&uhci->lock); |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 427 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 428 | |
| 429 | return IRQ_HANDLED; |
| 430 | } |
| 431 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 432 | /* |
| 433 | * Store the current frame number in uhci->frame_number if the controller |
Alan Stern | c433472 | 2006-05-19 16:34:57 -0400 | [diff] [blame] | 434 | * is runnning. Expand from 11 bits (of which we use only 10) to a |
| 435 | * full-sized integer. |
| 436 | * |
| 437 | * Like many other parts of the driver, this code relies on being polled |
| 438 | * more than once per second as long as the controller is running. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 439 | */ |
| 440 | static void uhci_get_current_frame_number(struct uhci_hcd *uhci) |
| 441 | { |
Alan Stern | c433472 | 2006-05-19 16:34:57 -0400 | [diff] [blame] | 442 | if (!uhci->is_stopped) { |
| 443 | unsigned delta; |
| 444 | |
| 445 | delta = (inw(uhci->io_addr + USBFRNUM) - uhci->frame_number) & |
| 446 | (UHCI_NUMFRAMES - 1); |
| 447 | uhci->frame_number += delta; |
| 448 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 449 | } |
| 450 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 451 | /* |
| 452 | * De-allocate all resources |
| 453 | */ |
| 454 | static void release_uhci(struct uhci_hcd *uhci) |
| 455 | { |
| 456 | int i; |
| 457 | |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 458 | if (DEBUG_CONFIGURED) { |
| 459 | spin_lock_irq(&uhci->lock); |
| 460 | uhci->is_initialized = 0; |
| 461 | spin_unlock_irq(&uhci->lock); |
| 462 | |
| 463 | debugfs_remove(uhci->dentry); |
| 464 | } |
| 465 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 466 | for (i = 0; i < UHCI_NUM_SKELQH; i++) |
Alan Stern | 8b4cd42 | 2005-09-16 14:17:45 -0400 | [diff] [blame] | 467 | uhci_free_qh(uhci, uhci->skelqh[i]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 468 | |
Alan Stern | 8b4cd42 | 2005-09-16 14:17:45 -0400 | [diff] [blame] | 469 | uhci_free_td(uhci, uhci->term_td); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 470 | |
Alan Stern | 8b4cd42 | 2005-09-16 14:17:45 -0400 | [diff] [blame] | 471 | dma_pool_destroy(uhci->qh_pool); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 472 | |
Alan Stern | 8b4cd42 | 2005-09-16 14:17:45 -0400 | [diff] [blame] | 473 | dma_pool_destroy(uhci->td_pool); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 474 | |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 475 | kfree(uhci->frame_cpu); |
| 476 | |
| 477 | dma_free_coherent(uhci_dev(uhci), |
| 478 | UHCI_NUMFRAMES * sizeof(*uhci->frame), |
| 479 | uhci->frame, uhci->frame_dma_handle); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 | } |
| 481 | |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 482 | static int uhci_init(struct usb_hcd *hcd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 483 | { |
| 484 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 485 | unsigned io_size = (unsigned) hcd->rsrc_len; |
| 486 | int port; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 487 | |
| 488 | uhci->io_addr = (unsigned long) hcd->rsrc_start; |
| 489 | |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 490 | /* The UHCI spec says devices must have 2 ports, and goes on to say |
| 491 | * they may have more but gives no way to determine how many there |
Alan Stern | e07fefa | 2005-05-31 16:33:21 -0400 | [diff] [blame] | 492 | * are. However according to the UHCI spec, Bit 7 of the port |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 493 | * status and control register is always set to 1. So we try to |
Alan Stern | e07fefa | 2005-05-31 16:33:21 -0400 | [diff] [blame] | 494 | * use this to our advantage. Another common failure mode when |
| 495 | * a nonexistent register is addressed is to return all ones, so |
| 496 | * we test for that also. |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 497 | */ |
| 498 | for (port = 0; port < (io_size - USBPORTSC1) / 2; port++) { |
| 499 | unsigned int portstatus; |
| 500 | |
| 501 | portstatus = inw(uhci->io_addr + USBPORTSC1 + (port * 2)); |
Alan Stern | e07fefa | 2005-05-31 16:33:21 -0400 | [diff] [blame] | 502 | if (!(portstatus & 0x0080) || portstatus == 0xffff) |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 503 | break; |
| 504 | } |
| 505 | if (debug) |
| 506 | dev_info(uhci_dev(uhci), "detected %d ports\n", port); |
| 507 | |
Alan Stern | e07fefa | 2005-05-31 16:33:21 -0400 | [diff] [blame] | 508 | /* Anything greater than 7 is weird so we'll ignore it. */ |
| 509 | if (port > UHCI_RH_MAXCHILD) { |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 510 | dev_info(uhci_dev(uhci), "port count misdetected? " |
| 511 | "forcing to 2 ports\n"); |
| 512 | port = 2; |
| 513 | } |
| 514 | uhci->rh_numports = port; |
| 515 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 516 | /* Kick BIOS off this hardware and reset if the controller |
| 517 | * isn't already safely quiescent. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 518 | */ |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 519 | check_and_reset_hc(uhci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 520 | return 0; |
| 521 | } |
| 522 | |
Alan Stern | 02597d2 | 2005-04-28 14:51:27 -0400 | [diff] [blame] | 523 | /* Make sure the controller is quiescent and that we're not using it |
| 524 | * any more. This is mainly for the benefit of programs which, like kexec, |
| 525 | * expect the hardware to be idle: not doing DMA or generating IRQs. |
| 526 | * |
| 527 | * This routine may be called in a damaged or failing kernel. Hence we |
| 528 | * do not acquire the spinlock before shutting down the controller. |
| 529 | */ |
| 530 | static void uhci_shutdown(struct pci_dev *pdev) |
| 531 | { |
| 532 | struct usb_hcd *hcd = (struct usb_hcd *) pci_get_drvdata(pdev); |
| 533 | |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 534 | uhci_hc_died(hcd_to_uhci(hcd)); |
Alan Stern | 02597d2 | 2005-04-28 14:51:27 -0400 | [diff] [blame] | 535 | } |
| 536 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 537 | /* |
| 538 | * Allocate a frame list, and then setup the skeleton |
| 539 | * |
| 540 | * The hardware doesn't really know any difference |
| 541 | * in the queues, but the order does matter for the |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 542 | * protocols higher up. The order in which the queues |
| 543 | * are encountered by the hardware is: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 544 | * |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 545 | * - All isochronous events are handled before any |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 546 | * of the queues. We don't do that here, because |
| 547 | * we'll create the actual TD entries on demand. |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 548 | * - The first queue is the high-period interrupt queue. |
| 549 | * - The second queue is the period-1 interrupt and async |
| 550 | * (low-speed control, full-speed control, then bulk) queue. |
| 551 | * - The third queue is the terminating bandwidth reclamation queue, |
| 552 | * which contains no members, loops back to itself, and is present |
| 553 | * only when FSBR is on and there are no full-speed control or bulk QHs. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 554 | */ |
| 555 | static int uhci_start(struct usb_hcd *hcd) |
| 556 | { |
| 557 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
| 558 | int retval = -EBUSY; |
Alan Stern | c074b41 | 2005-04-22 14:39:12 -0400 | [diff] [blame] | 559 | int i; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 560 | struct dentry *dentry; |
| 561 | |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 562 | hcd->uses_new_polling = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 563 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 564 | spin_lock_init(&uhci->lock); |
Alan Stern | c5e3b74 | 2006-06-05 12:28:57 -0400 | [diff] [blame] | 565 | setup_timer(&uhci->fsbr_timer, uhci_fsbr_timeout, |
| 566 | (unsigned long) uhci); |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 567 | INIT_LIST_HEAD(&uhci->idle_qh_list); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 568 | init_waitqueue_head(&uhci->waitqh); |
| 569 | |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 570 | if (DEBUG_CONFIGURED) { |
| 571 | dentry = debugfs_create_file(hcd->self.bus_name, |
| 572 | S_IFREG|S_IRUGO|S_IWUSR, uhci_debugfs_root, |
| 573 | uhci, &uhci_debug_operations); |
| 574 | if (!dentry) { |
| 575 | dev_err(uhci_dev(uhci), "couldn't create uhci " |
| 576 | "debugfs entry\n"); |
| 577 | retval = -ENOMEM; |
| 578 | goto err_create_debug_entry; |
| 579 | } |
| 580 | uhci->dentry = dentry; |
| 581 | } |
| 582 | |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 583 | uhci->frame = dma_alloc_coherent(uhci_dev(uhci), |
| 584 | UHCI_NUMFRAMES * sizeof(*uhci->frame), |
| 585 | &uhci->frame_dma_handle, 0); |
| 586 | if (!uhci->frame) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 587 | dev_err(uhci_dev(uhci), "unable to allocate " |
| 588 | "consistent memory for frame list\n"); |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 589 | goto err_alloc_frame; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 590 | } |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 591 | memset(uhci->frame, 0, UHCI_NUMFRAMES * sizeof(*uhci->frame)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 592 | |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 593 | uhci->frame_cpu = kcalloc(UHCI_NUMFRAMES, sizeof(*uhci->frame_cpu), |
| 594 | GFP_KERNEL); |
| 595 | if (!uhci->frame_cpu) { |
| 596 | dev_err(uhci_dev(uhci), "unable to allocate " |
| 597 | "memory for frame pointers\n"); |
| 598 | goto err_alloc_frame_cpu; |
| 599 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | |
| 601 | uhci->td_pool = dma_pool_create("uhci_td", uhci_dev(uhci), |
| 602 | sizeof(struct uhci_td), 16, 0); |
| 603 | if (!uhci->td_pool) { |
| 604 | dev_err(uhci_dev(uhci), "unable to create td dma_pool\n"); |
| 605 | goto err_create_td_pool; |
| 606 | } |
| 607 | |
| 608 | uhci->qh_pool = dma_pool_create("uhci_qh", uhci_dev(uhci), |
| 609 | sizeof(struct uhci_qh), 16, 0); |
| 610 | if (!uhci->qh_pool) { |
| 611 | dev_err(uhci_dev(uhci), "unable to create qh dma_pool\n"); |
| 612 | goto err_create_qh_pool; |
| 613 | } |
| 614 | |
Alan Stern | 2532178 | 2005-04-25 11:14:31 -0400 | [diff] [blame] | 615 | uhci->term_td = uhci_alloc_td(uhci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 616 | if (!uhci->term_td) { |
| 617 | dev_err(uhci_dev(uhci), "unable to allocate terminating TD\n"); |
| 618 | goto err_alloc_term_td; |
| 619 | } |
| 620 | |
| 621 | for (i = 0; i < UHCI_NUM_SKELQH; i++) { |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 622 | uhci->skelqh[i] = uhci_alloc_qh(uhci, NULL, NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 623 | if (!uhci->skelqh[i]) { |
| 624 | dev_err(uhci_dev(uhci), "unable to allocate QH\n"); |
| 625 | goto err_alloc_skelqh; |
| 626 | } |
| 627 | } |
| 628 | |
| 629 | /* |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 630 | * 8 Interrupt queues; link all higher int queues to int1 = async |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 631 | */ |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 632 | for (i = SKEL_ISO + 1; i < SKEL_ASYNC; ++i) |
| 633 | uhci->skelqh[i]->link = LINK_TO_QH(uhci->skel_async_qh); |
Alan Stern | e009f1b | 2007-03-19 15:31:42 -0400 | [diff] [blame] | 634 | uhci->skel_async_qh->link = UHCI_PTR_TERM; |
| 635 | uhci->skel_term_qh->link = LINK_TO_QH(uhci->skel_term_qh); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 636 | |
| 637 | /* This dummy TD is to work around a bug in Intel PIIX controllers */ |
Alan Stern | fa34656 | 2005-11-30 11:57:51 -0500 | [diff] [blame] | 638 | uhci_fill_td(uhci->term_td, 0, uhci_explen(0) | |
Alan Stern | 17230ac | 2007-02-19 15:52:45 -0500 | [diff] [blame] | 639 | (0x7f << TD_TOKEN_DEVADDR_SHIFT) | USB_PID_IN, 0); |
| 640 | uhci->term_td->link = UHCI_PTR_TERM; |
| 641 | uhci->skel_async_qh->element = uhci->skel_term_qh->element = |
| 642 | LINK_TO_TD(uhci->term_td); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 643 | |
| 644 | /* |
| 645 | * Fill the frame list: make all entries point to the proper |
| 646 | * interrupt queue. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 647 | */ |
| 648 | for (i = 0; i < UHCI_NUMFRAMES; i++) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 | |
| 650 | /* Only place we don't use the frame list routines */ |
Alan Stern | f3fe239 | 2007-01-08 12:00:28 -0500 | [diff] [blame] | 651 | uhci->frame[i] = uhci_frame_skel_link(uhci, i); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 652 | } |
| 653 | |
| 654 | /* |
| 655 | * Some architectures require a full mb() to enforce completion of |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 656 | * the memory writes above before the I/O transfers in configure_hc(). |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 657 | */ |
| 658 | mb(); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 659 | |
| 660 | configure_hc(uhci); |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 661 | uhci->is_initialized = 1; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 662 | start_rh(uhci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 663 | return 0; |
| 664 | |
| 665 | /* |
| 666 | * error exits: |
| 667 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 668 | err_alloc_skelqh: |
Alan Stern | 8b4cd42 | 2005-09-16 14:17:45 -0400 | [diff] [blame] | 669 | for (i = 0; i < UHCI_NUM_SKELQH; i++) { |
| 670 | if (uhci->skelqh[i]) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 671 | uhci_free_qh(uhci, uhci->skelqh[i]); |
Alan Stern | 8b4cd42 | 2005-09-16 14:17:45 -0400 | [diff] [blame] | 672 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 673 | |
| 674 | uhci_free_td(uhci, uhci->term_td); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 675 | |
| 676 | err_alloc_term_td: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 677 | dma_pool_destroy(uhci->qh_pool); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 678 | |
| 679 | err_create_qh_pool: |
| 680 | dma_pool_destroy(uhci->td_pool); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 681 | |
| 682 | err_create_td_pool: |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 683 | kfree(uhci->frame_cpu); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 | |
Alan Stern | a1d59ce | 2005-09-16 14:22:51 -0400 | [diff] [blame] | 685 | err_alloc_frame_cpu: |
| 686 | dma_free_coherent(uhci_dev(uhci), |
| 687 | UHCI_NUMFRAMES * sizeof(*uhci->frame), |
| 688 | uhci->frame, uhci->frame_dma_handle); |
| 689 | |
| 690 | err_alloc_frame: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 691 | debugfs_remove(uhci->dentry); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 692 | |
| 693 | err_create_debug_entry: |
| 694 | return retval; |
| 695 | } |
| 696 | |
| 697 | static void uhci_stop(struct usb_hcd *hcd) |
| 698 | { |
| 699 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
| 700 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 701 | spin_lock_irq(&uhci->lock); |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 702 | if (test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags) && !uhci->dead) |
| 703 | uhci_hc_died(uhci); |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 704 | uhci_scan_schedule(uhci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 705 | spin_unlock_irq(&uhci->lock); |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 706 | |
Alan Stern | c5e3b74 | 2006-06-05 12:28:57 -0400 | [diff] [blame] | 707 | del_timer_sync(&uhci->fsbr_timer); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 708 | release_uhci(uhci); |
| 709 | } |
| 710 | |
| 711 | #ifdef CONFIG_PM |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 712 | static int uhci_rh_suspend(struct usb_hcd *hcd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 713 | { |
| 714 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 715 | int rc = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 716 | |
| 717 | spin_lock_irq(&uhci->lock); |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 718 | if (!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags)) |
| 719 | rc = -ESHUTDOWN; |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 720 | else if (!uhci->dead) |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 721 | suspend_rh(uhci, UHCI_RH_SUSPENDED); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 722 | spin_unlock_irq(&uhci->lock); |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 723 | return rc; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 724 | } |
| 725 | |
| 726 | static int uhci_rh_resume(struct usb_hcd *hcd) |
| 727 | { |
| 728 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 729 | int rc = 0; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 730 | |
| 731 | spin_lock_irq(&uhci->lock); |
Alan Stern | cfa59da | 2007-06-21 16:25:35 -0400 | [diff] [blame] | 732 | if (!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags)) |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 733 | rc = -ESHUTDOWN; |
Alan Stern | cfa59da | 2007-06-21 16:25:35 -0400 | [diff] [blame] | 734 | else if (!uhci->dead) |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 735 | wakeup_rh(uhci); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 736 | spin_unlock_irq(&uhci->lock); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 737 | return rc; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 738 | } |
| 739 | |
| 740 | static int uhci_suspend(struct usb_hcd *hcd, pm_message_t message) |
| 741 | { |
| 742 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 743 | int rc = 0; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 744 | |
| 745 | dev_dbg(uhci_dev(uhci), "%s\n", __FUNCTION__); |
| 746 | |
| 747 | spin_lock_irq(&uhci->lock); |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 748 | if (!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags) || uhci->dead) |
| 749 | goto done_okay; /* Already suspended or dead */ |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 750 | |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 751 | if (uhci->rh_state > UHCI_RH_SUSPENDED) { |
| 752 | dev_warn(uhci_dev(uhci), "Root hub isn't suspended!\n"); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 753 | rc = -EBUSY; |
| 754 | goto done; |
| 755 | }; |
| 756 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 757 | /* All PCI host controllers are required to disable IRQ generation |
| 758 | * at the source, so we must turn off PIRQ. |
| 759 | */ |
| 760 | pci_write_config_word(to_pci_dev(uhci_dev(uhci)), USBLEGSUP, 0); |
Alan Stern | 42245e6 | 2005-12-16 11:09:01 -0800 | [diff] [blame] | 761 | mb(); |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 762 | hcd->poll_rh = 0; |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 763 | |
| 764 | /* FIXME: Enable non-PME# remote wakeup? */ |
| 765 | |
David Brownell | 1858499 | 2006-08-14 23:11:06 -0700 | [diff] [blame] | 766 | /* make sure snapshot being resumed re-enumerates everything */ |
| 767 | if (message.event == PM_EVENT_PRETHAW) |
| 768 | uhci_hc_died(uhci); |
| 769 | |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 770 | done_okay: |
| 771 | clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 772 | done: |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 773 | spin_unlock_irq(&uhci->lock); |
Alan Stern | 4daaa87 | 2005-04-09 17:30:08 -0400 | [diff] [blame] | 774 | return rc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 775 | } |
| 776 | |
| 777 | static int uhci_resume(struct usb_hcd *hcd) |
| 778 | { |
| 779 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 780 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 781 | dev_dbg(uhci_dev(uhci), "%s\n", __FUNCTION__); |
| 782 | |
Alan Stern | 687f5f3 | 2005-11-30 17:16:19 -0500 | [diff] [blame] | 783 | /* Since we aren't in D3 any more, it's safe to set this flag |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 784 | * even if the controller was dead. |
Benjamin Herrenschmidt | 8de9840 | 2005-11-25 09:59:46 +1100 | [diff] [blame] | 785 | */ |
| 786 | set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); |
Alan Stern | 42245e6 | 2005-12-16 11:09:01 -0800 | [diff] [blame] | 787 | mb(); |
Benjamin Herrenschmidt | 8de9840 | 2005-11-25 09:59:46 +1100 | [diff] [blame] | 788 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 789 | spin_lock_irq(&uhci->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 790 | |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 791 | /* FIXME: Disable non-PME# remote wakeup? */ |
| 792 | |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 793 | /* The firmware or a boot kernel may have changed the controller |
| 794 | * settings during a system wakeup. Check it and reconfigure |
| 795 | * to avoid problems. |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 796 | */ |
| 797 | check_and_reset_hc(uhci); |
Alan Stern | e323de4 | 2006-06-05 12:21:30 -0400 | [diff] [blame] | 798 | |
| 799 | /* If the controller was dead before, it's back alive now */ |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 800 | configure_hc(uhci); |
| 801 | |
Alan Stern | 1c50c31 | 2005-11-14 11:45:38 -0500 | [diff] [blame] | 802 | if (uhci->rh_state == UHCI_RH_RESET) { |
| 803 | |
| 804 | /* The controller had to be reset */ |
| 805 | usb_root_hub_lost_power(hcd->self.root_hub); |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 806 | suspend_rh(uhci, UHCI_RH_SUSPENDED); |
Alan Stern | 1c50c31 | 2005-11-14 11:45:38 -0500 | [diff] [blame] | 807 | } |
Alan Stern | a8bed8b | 2005-04-09 17:29:00 -0400 | [diff] [blame] | 808 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 809 | spin_unlock_irq(&uhci->lock); |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 810 | |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 811 | if (!uhci->working_RD) { |
| 812 | /* Suspended root hub needs to be polled */ |
| 813 | hcd->poll_rh = 1; |
Alan Stern | 6c1b445 | 2005-04-21 16:04:58 -0400 | [diff] [blame] | 814 | usb_hcd_poll_rh_status(hcd); |
Alan Stern | 1f09df8 | 2005-09-05 13:59:51 -0400 | [diff] [blame] | 815 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 816 | return 0; |
| 817 | } |
| 818 | #endif |
| 819 | |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 820 | /* Wait until a particular device/endpoint's QH is idle, and free it */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 821 | static void uhci_hcd_endpoint_disable(struct usb_hcd *hcd, |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 822 | struct usb_host_endpoint *hep) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 823 | { |
| 824 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 825 | struct uhci_qh *qh; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 826 | |
Alan Stern | dccf4a4 | 2005-12-17 17:58:46 -0500 | [diff] [blame] | 827 | spin_lock_irq(&uhci->lock); |
| 828 | qh = (struct uhci_qh *) hep->hcpriv; |
| 829 | if (qh == NULL) |
| 830 | goto done; |
| 831 | |
| 832 | while (qh->state != QH_STATE_IDLE) { |
| 833 | ++uhci->num_waiting; |
| 834 | spin_unlock_irq(&uhci->lock); |
| 835 | wait_event_interruptible(uhci->waitqh, |
| 836 | qh->state == QH_STATE_IDLE); |
| 837 | spin_lock_irq(&uhci->lock); |
| 838 | --uhci->num_waiting; |
| 839 | } |
| 840 | |
| 841 | uhci_free_qh(uhci, qh); |
| 842 | done: |
| 843 | spin_unlock_irq(&uhci->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | } |
| 845 | |
| 846 | static int uhci_hcd_get_frame_number(struct usb_hcd *hcd) |
| 847 | { |
| 848 | struct uhci_hcd *uhci = hcd_to_uhci(hcd); |
Alan Stern | c433472 | 2006-05-19 16:34:57 -0400 | [diff] [blame] | 849 | unsigned frame_number; |
| 850 | unsigned delta; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 851 | |
| 852 | /* Minimize latency by avoiding the spinlock */ |
Alan Stern | c433472 | 2006-05-19 16:34:57 -0400 | [diff] [blame] | 853 | frame_number = uhci->frame_number; |
| 854 | barrier(); |
| 855 | delta = (inw(uhci->io_addr + USBFRNUM) - frame_number) & |
| 856 | (UHCI_NUMFRAMES - 1); |
| 857 | return frame_number + delta; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 858 | } |
| 859 | |
| 860 | static const char hcd_name[] = "uhci_hcd"; |
| 861 | |
| 862 | static const struct hc_driver uhci_driver = { |
| 863 | .description = hcd_name, |
| 864 | .product_desc = "UHCI Host Controller", |
| 865 | .hcd_priv_size = sizeof(struct uhci_hcd), |
| 866 | |
| 867 | /* Generic hardware linkage */ |
| 868 | .irq = uhci_irq, |
| 869 | .flags = HCD_USB11, |
| 870 | |
| 871 | /* Basic lifecycle operations */ |
David Brownell | be3cbc5 | 2006-06-05 12:16:39 -0400 | [diff] [blame] | 872 | .reset = uhci_init, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 873 | .start = uhci_start, |
| 874 | #ifdef CONFIG_PM |
| 875 | .suspend = uhci_suspend, |
| 876 | .resume = uhci_resume, |
Alan Stern | 0c0382e | 2005-10-13 17:08:02 -0400 | [diff] [blame] | 877 | .bus_suspend = uhci_rh_suspend, |
| 878 | .bus_resume = uhci_rh_resume, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 879 | #endif |
| 880 | .stop = uhci_stop, |
| 881 | |
| 882 | .urb_enqueue = uhci_urb_enqueue, |
| 883 | .urb_dequeue = uhci_urb_dequeue, |
| 884 | |
| 885 | .endpoint_disable = uhci_hcd_endpoint_disable, |
| 886 | .get_frame_number = uhci_hcd_get_frame_number, |
| 887 | |
| 888 | .hub_status_data = uhci_hub_status_data, |
| 889 | .hub_control = uhci_hub_control, |
| 890 | }; |
| 891 | |
| 892 | static const struct pci_device_id uhci_pci_ids[] = { { |
| 893 | /* handle any USB UHCI controller */ |
Jean Delvare | c67808e | 2006-04-09 20:07:35 +0200 | [diff] [blame] | 894 | PCI_DEVICE_CLASS(PCI_CLASS_SERIAL_USB_UHCI, ~0), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 895 | .driver_data = (unsigned long) &uhci_driver, |
| 896 | }, { /* end: all zeroes */ } |
| 897 | }; |
| 898 | |
| 899 | MODULE_DEVICE_TABLE(pci, uhci_pci_ids); |
| 900 | |
| 901 | static struct pci_driver uhci_pci_driver = { |
| 902 | .name = (char *)hcd_name, |
| 903 | .id_table = uhci_pci_ids, |
| 904 | |
| 905 | .probe = usb_hcd_pci_probe, |
| 906 | .remove = usb_hcd_pci_remove, |
Alan Stern | 02597d2 | 2005-04-28 14:51:27 -0400 | [diff] [blame] | 907 | .shutdown = uhci_shutdown, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 908 | |
| 909 | #ifdef CONFIG_PM |
| 910 | .suspend = usb_hcd_pci_suspend, |
| 911 | .resume = usb_hcd_pci_resume, |
| 912 | #endif /* PM */ |
| 913 | }; |
| 914 | |
| 915 | static int __init uhci_hcd_init(void) |
| 916 | { |
| 917 | int retval = -ENOMEM; |
| 918 | |
Alan Stern | 5f8364b | 2006-12-05 16:29:55 -0500 | [diff] [blame] | 919 | printk(KERN_INFO DRIVER_DESC " " DRIVER_VERSION "%s\n", |
| 920 | ignore_oc ? ", overcurrent ignored" : ""); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 921 | |
| 922 | if (usb_disabled()) |
| 923 | return -ENODEV; |
| 924 | |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 925 | if (DEBUG_CONFIGURED) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 926 | errbuf = kmalloc(ERRBUF_LEN, GFP_KERNEL); |
| 927 | if (!errbuf) |
| 928 | goto errbuf_failed; |
Alan Stern | 8d402e1 | 2005-12-17 18:03:37 -0500 | [diff] [blame] | 929 | uhci_debugfs_root = debugfs_create_dir("uhci", NULL); |
| 930 | if (!uhci_debugfs_root) |
| 931 | goto debug_failed; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 932 | } |
| 933 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 934 | uhci_up_cachep = kmem_cache_create("uhci_urb_priv", |
Paul Mundt | 20c2df8 | 2007-07-20 10:11:58 +0900 | [diff] [blame] | 935 | sizeof(struct urb_priv), 0, 0, NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 936 | if (!uhci_up_cachep) |
| 937 | goto up_failed; |
| 938 | |
| 939 | retval = pci_register_driver(&uhci_pci_driver); |
| 940 | if (retval) |
| 941 | goto init_failed; |
| 942 | |
| 943 | return 0; |
| 944 | |
| 945 | init_failed: |
Alexey Dobriyan | 1a1d92c | 2006-09-27 01:49:40 -0700 | [diff] [blame] | 946 | kmem_cache_destroy(uhci_up_cachep); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 947 | |
| 948 | up_failed: |
| 949 | debugfs_remove(uhci_debugfs_root); |
| 950 | |
| 951 | debug_failed: |
Jesper Juhl | 1bc3c9e | 2005-04-18 17:39:34 -0700 | [diff] [blame] | 952 | kfree(errbuf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 953 | |
| 954 | errbuf_failed: |
| 955 | |
| 956 | return retval; |
| 957 | } |
| 958 | |
| 959 | static void __exit uhci_hcd_cleanup(void) |
| 960 | { |
| 961 | pci_unregister_driver(&uhci_pci_driver); |
Alexey Dobriyan | 1a1d92c | 2006-09-27 01:49:40 -0700 | [diff] [blame] | 962 | kmem_cache_destroy(uhci_up_cachep); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 963 | debugfs_remove(uhci_debugfs_root); |
Jesper Juhl | 1bc3c9e | 2005-04-18 17:39:34 -0700 | [diff] [blame] | 964 | kfree(errbuf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 965 | } |
| 966 | |
| 967 | module_init(uhci_hcd_init); |
| 968 | module_exit(uhci_hcd_cleanup); |
| 969 | |
| 970 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 971 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 972 | MODULE_LICENSE("GPL"); |