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