Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * OHCI HCD (Host Controller Driver) for USB. |
| 3 | * |
| 4 | * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at> |
| 5 | * (C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net> |
David Brownell | dd9048a | 2006-12-05 03:18:31 -0800 | [diff] [blame] | 6 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | * [ Initialisation is based on Linus' ] |
| 8 | * [ uhci code and gregs ohci fragments ] |
| 9 | * [ (C) Copyright 1999 Linus Torvalds ] |
| 10 | * [ (C) Copyright 1999 Gregory P. Smith] |
David Brownell | dd9048a | 2006-12-05 03:18:31 -0800 | [diff] [blame] | 11 | * |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | * PCI Bus Glue |
| 13 | * |
| 14 | * This file is licenced under the GPL. |
| 15 | */ |
David Brownell | dd9048a | 2006-12-05 03:18:31 -0800 | [diff] [blame] | 16 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | #ifndef CONFIG_PCI |
| 18 | #error "This file is PCI bus glue. CONFIG_PCI must be defined." |
| 19 | #endif |
| 20 | |
Libin Yang | ab1666c | 2008-08-08 15:03:31 +0800 | [diff] [blame^] | 21 | #include <linux/pci.h> |
| 22 | #include <linux/io.h> |
| 23 | |
| 24 | |
| 25 | /* constants used to work around PM-related transfer |
| 26 | * glitches in some AMD 700 series southbridges |
| 27 | */ |
| 28 | #define AB_REG_BAR 0xf0 |
| 29 | #define AB_INDX(addr) ((addr) + 0x00) |
| 30 | #define AB_DATA(addr) ((addr) + 0x04) |
| 31 | #define AX_INDXC 0X30 |
| 32 | #define AX_DATAC 0x34 |
| 33 | |
| 34 | #define NB_PCIE_INDX_ADDR 0xe0 |
| 35 | #define NB_PCIE_INDX_DATA 0xe4 |
| 36 | #define PCIE_P_CNTL 0x10040 |
| 37 | #define BIF_NB 0x10002 |
| 38 | |
| 39 | static struct pci_dev *amd_smbus_dev; |
| 40 | static struct pci_dev *amd_hb_dev; |
| 41 | static int amd_ohci_iso_count; |
| 42 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | /*-------------------------------------------------------------------------*/ |
| 44 | |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 45 | static int broken_suspend(struct usb_hcd *hcd) |
| 46 | { |
| 47 | device_init_wakeup(&hcd->self.root_hub->dev, 0); |
| 48 | return 0; |
| 49 | } |
| 50 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 51 | /* AMD 756, for most chips (early revs), corrupts register |
| 52 | * values on read ... so enable the vendor workaround. |
| 53 | */ |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 54 | static int ohci_quirk_amd756(struct usb_hcd *hcd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | { |
| 56 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 57 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 58 | ohci->flags = OHCI_QUIRK_AMD756; |
| 59 | ohci_dbg (ohci, "AMD756 erratum 4 workaround\n"); |
| 60 | |
| 61 | /* also erratum 10 (suspend/resume issues) */ |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 62 | return broken_suspend(hcd); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | } |
| 64 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 65 | /* Apple's OHCI driver has a lot of bizarre workarounds |
| 66 | * for this chip. Evidently control and bulk lists |
| 67 | * can get confused. (B&W G3 models, and ...) |
| 68 | */ |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 69 | static int ohci_quirk_opti(struct usb_hcd *hcd) |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 70 | { |
| 71 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 72 | |
| 73 | ohci_dbg (ohci, "WARNING: OPTi workarounds unavailable\n"); |
| 74 | |
| 75 | return 0; |
| 76 | } |
| 77 | |
| 78 | /* Check for NSC87560. We have to look at the bridge (fn1) to |
| 79 | * identify the USB (fn2). This quirk might apply to more or |
| 80 | * even all NSC stuff. |
| 81 | */ |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 82 | static int ohci_quirk_ns(struct usb_hcd *hcd) |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 83 | { |
| 84 | struct pci_dev *pdev = to_pci_dev(hcd->self.controller); |
| 85 | struct pci_dev *b; |
| 86 | |
| 87 | b = pci_get_slot (pdev->bus, PCI_DEVFN (PCI_SLOT (pdev->devfn), 1)); |
| 88 | if (b && b->device == PCI_DEVICE_ID_NS_87560_LIO |
| 89 | && b->vendor == PCI_VENDOR_ID_NS) { |
| 90 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 91 | |
| 92 | ohci->flags |= OHCI_QUIRK_SUPERIO; |
| 93 | ohci_dbg (ohci, "Using NSC SuperIO setup\n"); |
| 94 | } |
| 95 | pci_dev_put(b); |
| 96 | |
| 97 | return 0; |
| 98 | } |
| 99 | |
| 100 | /* Check for Compaq's ZFMicro chipset, which needs short |
| 101 | * delays before control or bulk queues get re-activated |
| 102 | * in finish_unlinks() |
| 103 | */ |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 104 | static int ohci_quirk_zfmicro(struct usb_hcd *hcd) |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 105 | { |
| 106 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 107 | |
| 108 | ohci->flags |= OHCI_QUIRK_ZFMICRO; |
Mike Nuss | 89a0fd1 | 2007-08-01 13:24:30 -0700 | [diff] [blame] | 109 | ohci_dbg(ohci, "enabled Compaq ZFMicro chipset quirks\n"); |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 110 | |
| 111 | return 0; |
| 112 | } |
| 113 | |
Benjamin Herrenschmidt | 11d1a4a | 2006-12-15 06:54:03 +1100 | [diff] [blame] | 114 | /* Check for Toshiba SCC OHCI which has big endian registers |
| 115 | * and little endian in memory data structures |
| 116 | */ |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 117 | static int ohci_quirk_toshiba_scc(struct usb_hcd *hcd) |
Benjamin Herrenschmidt | 11d1a4a | 2006-12-15 06:54:03 +1100 | [diff] [blame] | 118 | { |
| 119 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 120 | |
| 121 | /* That chip is only present in the southbridge of some |
| 122 | * cell based platforms which are supposed to select |
| 123 | * CONFIG_USB_OHCI_BIG_ENDIAN_MMIO. We verify here if |
| 124 | * that was the case though. |
| 125 | */ |
| 126 | #ifdef CONFIG_USB_OHCI_BIG_ENDIAN_MMIO |
| 127 | ohci->flags |= OHCI_QUIRK_BE_MMIO; |
| 128 | ohci_dbg (ohci, "enabled big endian Toshiba quirk\n"); |
| 129 | return 0; |
| 130 | #else |
| 131 | ohci_err (ohci, "unsupported big endian Toshiba quirk\n"); |
| 132 | return -ENXIO; |
| 133 | #endif |
| 134 | } |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 135 | |
Michael Hanselmann | d576bb9 | 2007-05-31 23:34:27 +0200 | [diff] [blame] | 136 | /* Check for NEC chip and apply quirk for allegedly lost interrupts. |
| 137 | */ |
Mike Nuss | 89a0fd1 | 2007-08-01 13:24:30 -0700 | [diff] [blame] | 138 | |
| 139 | static void ohci_quirk_nec_worker(struct work_struct *work) |
| 140 | { |
| 141 | struct ohci_hcd *ohci = container_of(work, struct ohci_hcd, nec_work); |
| 142 | int status; |
| 143 | |
| 144 | status = ohci_init(ohci); |
| 145 | if (status != 0) { |
| 146 | ohci_err(ohci, "Restarting NEC controller failed in %s, %d\n", |
| 147 | "ohci_init", status); |
| 148 | return; |
| 149 | } |
| 150 | |
| 151 | status = ohci_restart(ohci); |
| 152 | if (status != 0) |
| 153 | ohci_err(ohci, "Restarting NEC controller failed in %s, %d\n", |
| 154 | "ohci_restart", status); |
| 155 | } |
| 156 | |
Michael Hanselmann | d576bb9 | 2007-05-31 23:34:27 +0200 | [diff] [blame] | 157 | static int ohci_quirk_nec(struct usb_hcd *hcd) |
| 158 | { |
| 159 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 160 | |
| 161 | ohci->flags |= OHCI_QUIRK_NEC; |
Mike Nuss | 89a0fd1 | 2007-08-01 13:24:30 -0700 | [diff] [blame] | 162 | INIT_WORK(&ohci->nec_work, ohci_quirk_nec_worker); |
Michael Hanselmann | d576bb9 | 2007-05-31 23:34:27 +0200 | [diff] [blame] | 163 | ohci_dbg (ohci, "enabled NEC chipset lost interrupt quirk\n"); |
| 164 | |
| 165 | return 0; |
| 166 | } |
| 167 | |
Libin Yang | ab1666c | 2008-08-08 15:03:31 +0800 | [diff] [blame^] | 168 | static int ohci_quirk_amd700(struct usb_hcd *hcd) |
| 169 | { |
| 170 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); |
| 171 | u8 rev = 0; |
| 172 | |
| 173 | if (!amd_smbus_dev) |
| 174 | amd_smbus_dev = pci_get_device(PCI_VENDOR_ID_ATI, |
| 175 | PCI_DEVICE_ID_ATI_SBX00_SMBUS, NULL); |
| 176 | if (!amd_smbus_dev) |
| 177 | return 0; |
| 178 | |
| 179 | pci_read_config_byte(amd_smbus_dev, PCI_REVISION_ID, &rev); |
| 180 | if ((rev > 0x3b) || (rev < 0x30)) { |
| 181 | pci_dev_put(amd_smbus_dev); |
| 182 | amd_smbus_dev = NULL; |
| 183 | return 0; |
| 184 | } |
| 185 | |
| 186 | amd_ohci_iso_count++; |
| 187 | |
| 188 | if (!amd_hb_dev) |
| 189 | amd_hb_dev = pci_get_device(PCI_VENDOR_ID_AMD, 0x9600, NULL); |
| 190 | |
| 191 | ohci->flags |= OHCI_QUIRK_AMD_ISO; |
| 192 | ohci_dbg(ohci, "enabled AMD ISO transfers quirk\n"); |
| 193 | |
| 194 | return 0; |
| 195 | } |
| 196 | |
| 197 | /* |
| 198 | * The hardware normally enables the A-link power management feature, which |
| 199 | * lets the system lower the power consumption in idle states. |
| 200 | * |
| 201 | * Assume the system is configured to have USB 1.1 ISO transfers going |
| 202 | * to or from a USB device. Without this quirk, that stream may stutter |
| 203 | * or have breaks occasionally. For transfers going to speakers, this |
| 204 | * makes a very audible mess... |
| 205 | * |
| 206 | * That audio playback corruption is due to the audio stream getting |
| 207 | * interrupted occasionally when the link goes in lower power state |
| 208 | * This USB quirk prevents the link going into that lower power state |
| 209 | * during audio playback or other ISO operations. |
| 210 | */ |
| 211 | static void quirk_amd_pll(int on) |
| 212 | { |
| 213 | u32 addr; |
| 214 | u32 val; |
| 215 | u32 bit = (on > 0) ? 1 : 0; |
| 216 | |
| 217 | pci_read_config_dword(amd_smbus_dev, AB_REG_BAR, &addr); |
| 218 | |
| 219 | /* BIT names/meanings are NDA-protected, sorry ... */ |
| 220 | |
| 221 | outl(AX_INDXC, AB_INDX(addr)); |
| 222 | outl(0x40, AB_DATA(addr)); |
| 223 | outl(AX_DATAC, AB_INDX(addr)); |
| 224 | val = inl(AB_DATA(addr)); |
| 225 | val &= ~((1 << 3) | (1 << 4) | (1 << 9)); |
| 226 | val |= (bit << 3) | ((!bit) << 4) | ((!bit) << 9); |
| 227 | outl(val, AB_DATA(addr)); |
| 228 | |
| 229 | if (amd_hb_dev) { |
| 230 | addr = PCIE_P_CNTL; |
| 231 | pci_write_config_dword(amd_hb_dev, NB_PCIE_INDX_ADDR, addr); |
| 232 | |
| 233 | pci_read_config_dword(amd_hb_dev, NB_PCIE_INDX_DATA, &val); |
| 234 | val &= ~(1 | (1 << 3) | (1 << 4) | (1 << 9) | (1 << 12)); |
| 235 | val |= bit | (bit << 3) | (bit << 12); |
| 236 | val |= ((!bit) << 4) | ((!bit) << 9); |
| 237 | pci_write_config_dword(amd_hb_dev, NB_PCIE_INDX_DATA, val); |
| 238 | |
| 239 | addr = BIF_NB; |
| 240 | pci_write_config_dword(amd_hb_dev, NB_PCIE_INDX_ADDR, addr); |
| 241 | |
| 242 | pci_read_config_dword(amd_hb_dev, NB_PCIE_INDX_DATA, &val); |
| 243 | val &= ~(1 << 8); |
| 244 | val |= bit << 8; |
| 245 | pci_write_config_dword(amd_hb_dev, NB_PCIE_INDX_DATA, val); |
| 246 | } |
| 247 | } |
| 248 | |
| 249 | static void amd_iso_dev_put(void) |
| 250 | { |
| 251 | amd_ohci_iso_count--; |
| 252 | if (amd_ohci_iso_count == 0) { |
| 253 | if (amd_smbus_dev) { |
| 254 | pci_dev_put(amd_smbus_dev); |
| 255 | amd_smbus_dev = NULL; |
| 256 | } |
| 257 | if (amd_hb_dev) { |
| 258 | pci_dev_put(amd_hb_dev); |
| 259 | amd_hb_dev = NULL; |
| 260 | } |
| 261 | } |
| 262 | |
| 263 | } |
| 264 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 265 | /* List of quirks for OHCI */ |
| 266 | static const struct pci_device_id ohci_pci_quirks[] = { |
| 267 | { |
| 268 | PCI_DEVICE(PCI_VENDOR_ID_AMD, 0x740c), |
| 269 | .driver_data = (unsigned long)ohci_quirk_amd756, |
| 270 | }, |
| 271 | { |
| 272 | PCI_DEVICE(PCI_VENDOR_ID_OPTI, 0xc861), |
| 273 | .driver_data = (unsigned long)ohci_quirk_opti, |
| 274 | }, |
| 275 | { |
| 276 | PCI_DEVICE(PCI_VENDOR_ID_NS, PCI_ANY_ID), |
| 277 | .driver_data = (unsigned long)ohci_quirk_ns, |
| 278 | }, |
| 279 | { |
| 280 | PCI_DEVICE(PCI_VENDOR_ID_COMPAQ, 0xa0f8), |
| 281 | .driver_data = (unsigned long)ohci_quirk_zfmicro, |
| 282 | }, |
Benjamin Herrenschmidt | 11d1a4a | 2006-12-15 06:54:03 +1100 | [diff] [blame] | 283 | { |
| 284 | PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, 0x01b6), |
| 285 | .driver_data = (unsigned long)ohci_quirk_toshiba_scc, |
| 286 | }, |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 287 | { |
Michael Hanselmann | d576bb9 | 2007-05-31 23:34:27 +0200 | [diff] [blame] | 288 | PCI_DEVICE(PCI_VENDOR_ID_NEC, PCI_DEVICE_ID_NEC_USB), |
| 289 | .driver_data = (unsigned long)ohci_quirk_nec, |
| 290 | }, |
| 291 | { |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 292 | /* Toshiba portege 4000 */ |
| 293 | .vendor = PCI_VENDOR_ID_AL, |
| 294 | .device = 0x5237, |
Andrey Borzenkov | 8ab5e8c | 2007-05-19 14:23:28 -0700 | [diff] [blame] | 295 | .subvendor = PCI_VENDOR_ID_TOSHIBA, |
David Brownell | 931384f | 2007-04-17 13:06:29 -0700 | [diff] [blame] | 296 | .subdevice = 0x0004, |
| 297 | .driver_data = (unsigned long) broken_suspend, |
| 298 | }, |
Raphael Assenat | 33f73e5 | 2007-04-17 13:09:18 -0700 | [diff] [blame] | 299 | { |
| 300 | PCI_DEVICE(PCI_VENDOR_ID_ITE, 0x8152), |
| 301 | .driver_data = (unsigned long) broken_suspend, |
| 302 | }, |
Libin Yang | ab1666c | 2008-08-08 15:03:31 +0800 | [diff] [blame^] | 303 | { |
| 304 | PCI_DEVICE(PCI_VENDOR_ID_ATI, 0x4397), |
| 305 | .driver_data = (unsigned long)ohci_quirk_amd700, |
| 306 | }, |
| 307 | { |
| 308 | PCI_DEVICE(PCI_VENDOR_ID_ATI, 0x4398), |
| 309 | .driver_data = (unsigned long)ohci_quirk_amd700, |
| 310 | }, |
| 311 | { |
| 312 | PCI_DEVICE(PCI_VENDOR_ID_ATI, 0x4399), |
| 313 | .driver_data = (unsigned long)ohci_quirk_amd700, |
| 314 | }, |
| 315 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 316 | /* FIXME for some of the early AMD 760 southbridges, OHCI |
| 317 | * won't work at all. blacklist them. |
| 318 | */ |
Benjamin Herrenschmidt | 11d1a4a | 2006-12-15 06:54:03 +1100 | [diff] [blame] | 319 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 320 | {}, |
| 321 | }; |
| 322 | |
| 323 | static int ohci_pci_reset (struct usb_hcd *hcd) |
| 324 | { |
| 325 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 326 | int ret = 0; |
| 327 | |
| 328 | if (hcd->self.controller) { |
| 329 | struct pci_dev *pdev = to_pci_dev(hcd->self.controller); |
| 330 | const struct pci_device_id *quirk_id; |
| 331 | |
| 332 | quirk_id = pci_match_id(ohci_pci_quirks, pdev); |
| 333 | if (quirk_id != NULL) { |
| 334 | int (*quirk)(struct usb_hcd *ohci); |
| 335 | quirk = (void *)quirk_id->driver_data; |
| 336 | ret = quirk(hcd); |
| 337 | } |
| 338 | } |
| 339 | if (ret == 0) { |
| 340 | ohci_hcd_init (ohci); |
| 341 | return ohci_init (ohci); |
| 342 | } |
| 343 | return ret; |
| 344 | } |
| 345 | |
| 346 | |
| 347 | static int __devinit ohci_pci_start (struct usb_hcd *hcd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 348 | { |
| 349 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 350 | int ret; |
| 351 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 352 | #ifdef CONFIG_PM /* avoid warnings about unused pdev */ |
David Brownell | 6a9062f | 2006-01-23 15:28:07 -0800 | [diff] [blame] | 353 | if (hcd->self.controller) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | struct pci_dev *pdev = to_pci_dev(hcd->self.controller); |
| 355 | |
David Brownell | 6a9062f | 2006-01-23 15:28:07 -0800 | [diff] [blame] | 356 | /* RWC may not be set for add-in PCI cards, since boot |
| 357 | * firmware probably ignored them. This transfers PCI |
| 358 | * PM wakeup capabilities (once the PCI layer is fixed). |
| 359 | */ |
| 360 | if (device_may_wakeup(&pdev->dev)) |
| 361 | ohci->hc_control |= OHCI_CTRL_RWC; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | } |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 363 | #endif /* CONFIG_PM */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 | |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 365 | ret = ohci_run (ohci); |
| 366 | if (ret < 0) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 367 | ohci_err (ohci, "can't start\n"); |
| 368 | ohci_stop (hcd); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 369 | } |
Benjamin Herrenschmidt | 4302a59 | 2006-12-15 06:53:55 +1100 | [diff] [blame] | 370 | return ret; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 371 | } |
| 372 | |
| 373 | #ifdef CONFIG_PM |
| 374 | |
David Brownell | 9a5d3e9 | 2005-04-18 17:39:23 -0700 | [diff] [blame] | 375 | static int ohci_pci_suspend (struct usb_hcd *hcd, pm_message_t message) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 376 | { |
Benjamin Herrenschmidt | 8de9840 | 2005-11-25 09:59:46 +1100 | [diff] [blame] | 377 | struct ohci_hcd *ohci = hcd_to_ohci (hcd); |
| 378 | unsigned long flags; |
| 379 | int rc = 0; |
| 380 | |
| 381 | /* Root hub was already suspended. Disable irq emission and |
| 382 | * mark HW unaccessible, bail out if RH has been resumed. Use |
| 383 | * the spinlock to properly synchronize with possible pending |
| 384 | * RH suspend or resume activity. |
| 385 | * |
| 386 | * This is still racy as hcd->state is manipulated outside of |
| 387 | * any locks =P But that will be a different fix. |
| 388 | */ |
| 389 | spin_lock_irqsave (&ohci->lock, flags); |
| 390 | if (hcd->state != HC_STATE_SUSPENDED) { |
| 391 | rc = -EINVAL; |
| 392 | goto bail; |
| 393 | } |
| 394 | ohci_writel(ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable); |
| 395 | (void)ohci_readl(ohci, &ohci->regs->intrdisable); |
David Brownell | 1858499 | 2006-08-14 23:11:06 -0700 | [diff] [blame] | 396 | |
| 397 | /* make sure snapshot being resumed re-enumerates everything */ |
| 398 | if (message.event == PM_EVENT_PRETHAW) |
| 399 | ohci_usb_reset(ohci); |
| 400 | |
Benjamin Herrenschmidt | 8de9840 | 2005-11-25 09:59:46 +1100 | [diff] [blame] | 401 | clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); |
| 402 | bail: |
| 403 | spin_unlock_irqrestore (&ohci->lock, flags); |
| 404 | |
| 405 | return rc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 406 | } |
| 407 | |
| 408 | |
| 409 | static int ohci_pci_resume (struct usb_hcd *hcd) |
| 410 | { |
Benjamin Herrenschmidt | 8de9840 | 2005-11-25 09:59:46 +1100 | [diff] [blame] | 411 | set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); |
Alan Stern | 43bbb7e | 2008-04-03 18:03:17 -0400 | [diff] [blame] | 412 | ohci_finish_controller_resume(hcd); |
David Brownell | f197b2c | 2005-09-22 22:42:53 -0700 | [diff] [blame] | 413 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 414 | } |
| 415 | |
| 416 | #endif /* CONFIG_PM */ |
| 417 | |
| 418 | |
| 419 | /*-------------------------------------------------------------------------*/ |
| 420 | |
| 421 | static const struct hc_driver ohci_pci_hc_driver = { |
| 422 | .description = hcd_name, |
| 423 | .product_desc = "OHCI Host Controller", |
| 424 | .hcd_priv_size = sizeof(struct ohci_hcd), |
| 425 | |
| 426 | /* |
| 427 | * generic hardware linkage |
| 428 | */ |
| 429 | .irq = ohci_irq, |
| 430 | .flags = HCD_MEMORY | HCD_USB11, |
| 431 | |
| 432 | /* |
| 433 | * basic lifecycle operations |
| 434 | */ |
| 435 | .reset = ohci_pci_reset, |
| 436 | .start = ohci_pci_start, |
David Brownell | d413984 | 2006-08-04 11:31:55 -0700 | [diff] [blame] | 437 | .stop = ohci_stop, |
Aleksey Gorelov | 64a21d0 | 2006-08-08 17:24:08 -0700 | [diff] [blame] | 438 | .shutdown = ohci_shutdown, |
David Brownell | d413984 | 2006-08-04 11:31:55 -0700 | [diff] [blame] | 439 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 440 | #ifdef CONFIG_PM |
Alan Stern | 7be7d74 | 2008-04-03 18:03:06 -0400 | [diff] [blame] | 441 | .pci_suspend = ohci_pci_suspend, |
| 442 | .pci_resume = ohci_pci_resume, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 443 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 444 | |
| 445 | /* |
| 446 | * managing i/o requests and associated device resources |
| 447 | */ |
| 448 | .urb_enqueue = ohci_urb_enqueue, |
| 449 | .urb_dequeue = ohci_urb_dequeue, |
| 450 | .endpoint_disable = ohci_endpoint_disable, |
| 451 | |
| 452 | /* |
| 453 | * scheduling support |
| 454 | */ |
| 455 | .get_frame_number = ohci_get_frame, |
| 456 | |
| 457 | /* |
| 458 | * root hub support |
| 459 | */ |
| 460 | .hub_status_data = ohci_hub_status_data, |
| 461 | .hub_control = ohci_hub_control, |
Linus Torvalds | 09ca8ad | 2008-07-06 10:27:25 -0700 | [diff] [blame] | 462 | .hub_irq_enable = ohci_rhsc_enable, |
David Brownell | 8ad7fe1 | 2005-09-13 19:59:11 -0700 | [diff] [blame] | 463 | #ifdef CONFIG_PM |
Alan Stern | 0c0382e | 2005-10-13 17:08:02 -0400 | [diff] [blame] | 464 | .bus_suspend = ohci_bus_suspend, |
| 465 | .bus_resume = ohci_bus_resume, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 466 | #endif |
| 467 | .start_port_reset = ohci_start_port_reset, |
| 468 | }; |
| 469 | |
| 470 | /*-------------------------------------------------------------------------*/ |
| 471 | |
| 472 | |
| 473 | static const struct pci_device_id pci_ids [] = { { |
| 474 | /* handle any USB OHCI controller */ |
Jean Delvare | c67808e | 2006-04-09 20:07:35 +0200 | [diff] [blame] | 475 | PCI_DEVICE_CLASS(PCI_CLASS_SERIAL_USB_OHCI, ~0), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 476 | .driver_data = (unsigned long) &ohci_pci_hc_driver, |
| 477 | }, { /* end: all zeroes */ } |
| 478 | }; |
| 479 | MODULE_DEVICE_TABLE (pci, pci_ids); |
| 480 | |
| 481 | /* pci driver glue; this is a "new style" PCI driver module */ |
| 482 | static struct pci_driver ohci_pci_driver = { |
| 483 | .name = (char *) hcd_name, |
| 484 | .id_table = pci_ids, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 485 | |
| 486 | .probe = usb_hcd_pci_probe, |
| 487 | .remove = usb_hcd_pci_remove, |
| 488 | |
| 489 | #ifdef CONFIG_PM |
| 490 | .suspend = usb_hcd_pci_suspend, |
| 491 | .resume = usb_hcd_pci_resume, |
| 492 | #endif |
Aleksey Gorelov | 64a21d0 | 2006-08-08 17:24:08 -0700 | [diff] [blame] | 493 | |
| 494 | .shutdown = usb_hcd_pci_shutdown, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 495 | }; |
| 496 | |