[PATCH] UFS: inode->i_sem is not released in error path
[linux-2.6/verdex.git] / drivers / usb / host / pci-quirks.c
blob3ef2c0cdf1db2fe26c6235ea3410a36e543be617
1 /*
2 * This file contains code to reset and initialize USB host controllers.
3 * Some of it includes work-arounds for PCI hardware and BIOS quirks.
4 * It may need to run early during booting -- before USB would normally
5 * initialize -- to ensure that Linux doesn't use any legacy modes.
7 * Copyright (c) 1999 Martin Mares <mj@ucw.cz>
8 * (and others)
9 */
11 #include <linux/config.h>
12 #include <linux/types.h>
13 #include <linux/kernel.h>
14 #include <linux/pci.h>
15 #include <linux/init.h>
16 #include <linux/delay.h>
17 #include <linux/acpi.h>
20 #define UHCI_USBLEGSUP 0xc0 /* legacy support */
21 #define UHCI_USBCMD 0 /* command register */
22 #define UHCI_USBINTR 4 /* interrupt register */
23 #define UHCI_USBLEGSUP_RWC 0x8f00 /* the R/WC bits */
24 #define UHCI_USBLEGSUP_RO 0x5040 /* R/O and reserved bits */
25 #define UHCI_USBCMD_RUN 0x0001 /* RUN/STOP bit */
26 #define UHCI_USBCMD_HCRESET 0x0002 /* Host Controller reset */
27 #define UHCI_USBCMD_EGSM 0x0008 /* Global Suspend Mode */
28 #define UHCI_USBCMD_CONFIGURE 0x0040 /* Config Flag */
29 #define UHCI_USBINTR_RESUME 0x0002 /* Resume interrupt enable */
31 #define OHCI_CONTROL 0x04
32 #define OHCI_CMDSTATUS 0x08
33 #define OHCI_INTRSTATUS 0x0c
34 #define OHCI_INTRENABLE 0x10
35 #define OHCI_INTRDISABLE 0x14
36 #define OHCI_OCR (1 << 3) /* ownership change request */
37 #define OHCI_CTRL_RWC (1 << 9) /* remote wakeup connected */
38 #define OHCI_CTRL_IR (1 << 8) /* interrupt routing */
39 #define OHCI_INTR_OC (1 << 30) /* ownership change */
41 #define EHCI_HCC_PARAMS 0x08 /* extended capabilities */
42 #define EHCI_USBCMD 0 /* command register */
43 #define EHCI_USBCMD_RUN (1 << 0) /* RUN/STOP bit */
44 #define EHCI_USBSTS 4 /* status register */
45 #define EHCI_USBSTS_HALTED (1 << 12) /* HCHalted bit */
46 #define EHCI_USBINTR 8 /* interrupt register */
47 #define EHCI_USBLEGSUP 0 /* legacy support register */
48 #define EHCI_USBLEGSUP_BIOS (1 << 16) /* BIOS semaphore */
49 #define EHCI_USBLEGSUP_OS (1 << 24) /* OS semaphore */
50 #define EHCI_USBLEGCTLSTS 4 /* legacy control/status */
51 #define EHCI_USBLEGCTLSTS_SOOE (1 << 13) /* SMI on ownership change */
55 * Make sure the controller is completely inactive, unable to
56 * generate interrupts or do DMA.
58 void uhci_reset_hc(struct pci_dev *pdev, unsigned long base)
60 /* Turn off PIRQ enable and SMI enable. (This also turns off the
61 * BIOS's USB Legacy Support.) Turn off all the R/WC bits too.
63 pci_write_config_word(pdev, UHCI_USBLEGSUP, UHCI_USBLEGSUP_RWC);
65 /* Reset the HC - this will force us to get a
66 * new notification of any already connected
67 * ports due to the virtual disconnect that it
68 * implies.
70 outw(UHCI_USBCMD_HCRESET, base + UHCI_USBCMD);
71 mb();
72 udelay(5);
73 if (inw(base + UHCI_USBCMD) & UHCI_USBCMD_HCRESET)
74 dev_warn(&pdev->dev, "HCRESET not completed yet!\n");
76 /* Just to be safe, disable interrupt requests and
77 * make sure the controller is stopped.
79 outw(0, base + UHCI_USBINTR);
80 outw(0, base + UHCI_USBCMD);
82 EXPORT_SYMBOL_GPL(uhci_reset_hc);
85 * Initialize a controller that was newly discovered or has just been
86 * resumed. In either case we can't be sure of its previous state.
88 * Returns: 1 if the controller was reset, 0 otherwise.
90 int uhci_check_and_reset_hc(struct pci_dev *pdev, unsigned long base)
92 u16 legsup;
93 unsigned int cmd, intr;
96 * When restarting a suspended controller, we expect all the
97 * settings to be the same as we left them:
99 * PIRQ and SMI disabled, no R/W bits set in USBLEGSUP;
100 * Controller is stopped and configured with EGSM set;
101 * No interrupts enabled except possibly Resume Detect.
103 * If any of these conditions are violated we do a complete reset.
105 pci_read_config_word(pdev, UHCI_USBLEGSUP, &legsup);
106 if (legsup & ~(UHCI_USBLEGSUP_RO | UHCI_USBLEGSUP_RWC)) {
107 dev_dbg(&pdev->dev, "%s: legsup = 0x%04x\n",
108 __FUNCTION__, legsup);
109 goto reset_needed;
112 cmd = inw(base + UHCI_USBCMD);
113 if ((cmd & UHCI_USBCMD_RUN) || !(cmd & UHCI_USBCMD_CONFIGURE) ||
114 !(cmd & UHCI_USBCMD_EGSM)) {
115 dev_dbg(&pdev->dev, "%s: cmd = 0x%04x\n",
116 __FUNCTION__, cmd);
117 goto reset_needed;
120 intr = inw(base + UHCI_USBINTR);
121 if (intr & (~UHCI_USBINTR_RESUME)) {
122 dev_dbg(&pdev->dev, "%s: intr = 0x%04x\n",
123 __FUNCTION__, intr);
124 goto reset_needed;
126 return 0;
128 reset_needed:
129 dev_dbg(&pdev->dev, "Performing full reset\n");
130 uhci_reset_hc(pdev, base);
131 return 1;
133 EXPORT_SYMBOL_GPL(uhci_check_and_reset_hc);
135 static inline int io_type_enabled(struct pci_dev *pdev, unsigned int mask)
137 u16 cmd;
138 return !pci_read_config_word(pdev, PCI_COMMAND, &cmd) && (cmd & mask);
141 #define pio_enabled(dev) io_type_enabled(dev, PCI_COMMAND_IO)
142 #define mmio_enabled(dev) io_type_enabled(dev, PCI_COMMAND_MEMORY)
144 static void __devinit quirk_usb_handoff_uhci(struct pci_dev *pdev)
146 unsigned long base = 0;
147 int i;
149 if (!pio_enabled(pdev))
150 return;
152 for (i = 0; i < PCI_ROM_RESOURCE; i++)
153 if ((pci_resource_flags(pdev, i) & IORESOURCE_IO)) {
154 base = pci_resource_start(pdev, i);
155 break;
158 if (base)
159 uhci_check_and_reset_hc(pdev, base);
162 static int __devinit mmio_resource_enabled(struct pci_dev *pdev, int idx)
164 return pci_resource_start(pdev, idx) && mmio_enabled(pdev);
167 static void __devinit quirk_usb_handoff_ohci(struct pci_dev *pdev)
169 void __iomem *base;
170 int wait_time;
171 u32 control;
173 if (!mmio_resource_enabled(pdev, 0))
174 return;
176 base = ioremap_nocache(pci_resource_start(pdev, 0),
177 pci_resource_len(pdev, 0));
178 if (base == NULL) return;
180 /* On PA-RISC, PDC can leave IR set incorrectly; ignore it there. */
181 #ifndef __hppa__
182 control = readl(base + OHCI_CONTROL);
183 if (control & OHCI_CTRL_IR) {
184 wait_time = 500; /* arbitrary; 5 seconds */
185 writel(OHCI_INTR_OC, base + OHCI_INTRENABLE);
186 writel(OHCI_OCR, base + OHCI_CMDSTATUS);
187 while (wait_time > 0 &&
188 readl(base + OHCI_CONTROL) & OHCI_CTRL_IR) {
189 wait_time -= 10;
190 msleep(10);
192 if (wait_time <= 0)
193 printk(KERN_WARNING "%s %s: early BIOS handoff "
194 "failed (BIOS bug ?)\n",
195 pdev->dev.bus_id, "OHCI");
197 /* reset controller, preserving RWC */
198 writel(control & OHCI_CTRL_RWC, base + OHCI_CONTROL);
200 #endif
203 * disable interrupts
205 writel(~(u32)0, base + OHCI_INTRDISABLE);
206 writel(~(u32)0, base + OHCI_INTRSTATUS);
208 iounmap(base);
211 static void __devinit quirk_usb_disable_ehci(struct pci_dev *pdev)
213 int wait_time, delta;
214 void __iomem *base, *op_reg_base;
215 u32 hcc_params, val, temp;
216 u8 cap_length;
218 if (!mmio_resource_enabled(pdev, 0))
219 return;
221 base = ioremap_nocache(pci_resource_start(pdev, 0),
222 pci_resource_len(pdev, 0));
223 if (base == NULL) return;
225 cap_length = readb(base);
226 op_reg_base = base + cap_length;
227 hcc_params = readl(base + EHCI_HCC_PARAMS);
228 hcc_params = (hcc_params >> 8) & 0xff;
229 if (hcc_params) {
230 pci_read_config_dword(pdev,
231 hcc_params + EHCI_USBLEGSUP,
232 &val);
233 if (((val & 0xff) == 1) && (val & EHCI_USBLEGSUP_BIOS)) {
235 * Ok, BIOS is in smm mode, try to hand off...
237 pci_read_config_dword(pdev,
238 hcc_params + EHCI_USBLEGCTLSTS,
239 &temp);
240 pci_write_config_dword(pdev,
241 hcc_params + EHCI_USBLEGCTLSTS,
242 temp | EHCI_USBLEGCTLSTS_SOOE);
243 val |= EHCI_USBLEGSUP_OS;
244 pci_write_config_dword(pdev,
245 hcc_params + EHCI_USBLEGSUP,
246 val);
248 wait_time = 500;
249 do {
250 msleep(10);
251 wait_time -= 10;
252 pci_read_config_dword(pdev,
253 hcc_params + EHCI_USBLEGSUP,
254 &val);
255 } while (wait_time && (val & EHCI_USBLEGSUP_BIOS));
256 if (!wait_time) {
258 * well, possibly buggy BIOS...
260 printk(KERN_WARNING "%s %s: early BIOS handoff "
261 "failed (BIOS bug ?)\n",
262 pdev->dev.bus_id, "EHCI");
263 pci_write_config_dword(pdev,
264 hcc_params + EHCI_USBLEGSUP,
265 EHCI_USBLEGSUP_OS);
266 pci_write_config_dword(pdev,
267 hcc_params + EHCI_USBLEGCTLSTS,
274 * halt EHCI & disable its interrupts in any case
276 val = readl(op_reg_base + EHCI_USBSTS);
277 if ((val & EHCI_USBSTS_HALTED) == 0) {
278 val = readl(op_reg_base + EHCI_USBCMD);
279 val &= ~EHCI_USBCMD_RUN;
280 writel(val, op_reg_base + EHCI_USBCMD);
282 wait_time = 2000;
283 delta = 100;
284 do {
285 writel(0x3f, op_reg_base + EHCI_USBSTS);
286 udelay(delta);
287 wait_time -= delta;
288 val = readl(op_reg_base + EHCI_USBSTS);
289 if ((val == ~(u32)0) || (val & EHCI_USBSTS_HALTED)) {
290 break;
292 } while (wait_time > 0);
294 writel(0, op_reg_base + EHCI_USBINTR);
295 writel(0x3f, op_reg_base + EHCI_USBSTS);
297 iounmap(base);
299 return;
304 static void __devinit quirk_usb_early_handoff(struct pci_dev *pdev)
306 if (pdev->class == PCI_CLASS_SERIAL_USB_UHCI)
307 quirk_usb_handoff_uhci(pdev);
308 else if (pdev->class == PCI_CLASS_SERIAL_USB_OHCI)
309 quirk_usb_handoff_ohci(pdev);
310 else if (pdev->class == PCI_CLASS_SERIAL_USB_EHCI)
311 quirk_usb_disable_ehci(pdev);
313 DECLARE_PCI_FIXUP_FINAL(PCI_ANY_ID, PCI_ANY_ID, quirk_usb_early_handoff);