blob: 59ee61d2a1980e03081fcbb8045441316c6dab6b [file] [log] [blame]
Sarah Sharp66d4ead2009-04-27 19:52:28 -07001/*
2 * xHCI host controller driver
3 *
4 * Copyright (C) 2008 Intel Corp.
5 *
6 * Author: Sarah Sharp
7 * Some code borrowed from the Linux EHCI driver.
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
12 *
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
15 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
16 * for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software Foundation,
20 * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 */
22
23#include <linux/irq.h>
24#include <linux/module.h>
25
26#include "xhci.h"
27
28#define DRIVER_AUTHOR "Sarah Sharp"
29#define DRIVER_DESC "'eXtensible' Host Controller (xHC) Driver"
30
31/* TODO: copied from ehci-hcd.c - can this be refactored? */
32/*
33 * handshake - spin reading hc until handshake completes or fails
34 * @ptr: address of hc register to be read
35 * @mask: bits to look at in result of read
36 * @done: value of those bits when handshake succeeds
37 * @usec: timeout in microseconds
38 *
39 * Returns negative errno, or zero on success
40 *
41 * Success happens when the "mask" bits have the specified value (hardware
42 * handshake done). There are two failure modes: "usec" have passed (major
43 * hardware flakeout), or the register reads as all-ones (hardware removed).
44 */
45static int handshake(struct xhci_hcd *xhci, void __iomem *ptr,
46 u32 mask, u32 done, int usec)
47{
48 u32 result;
49
50 do {
51 result = xhci_readl(xhci, ptr);
52 if (result == ~(u32)0) /* card removed */
53 return -ENODEV;
54 result &= mask;
55 if (result == done)
56 return 0;
57 udelay(1);
58 usec--;
59 } while (usec > 0);
60 return -ETIMEDOUT;
61}
62
63/*
64 * Force HC into halt state.
65 *
66 * Disable any IRQs and clear the run/stop bit.
67 * HC will complete any current and actively pipelined transactions, and
68 * should halt within 16 microframes of the run/stop bit being cleared.
69 * Read HC Halted bit in the status register to see when the HC is finished.
70 * XXX: shouldn't we set HC_STATE_HALT here somewhere?
71 */
72int xhci_halt(struct xhci_hcd *xhci)
73{
74 u32 halted;
75 u32 cmd;
76 u32 mask;
77
78 xhci_dbg(xhci, "// Halt the HC\n");
79 /* Disable all interrupts from the host controller */
80 mask = ~(XHCI_IRQS);
81 halted = xhci_readl(xhci, &xhci->op_regs->status) & STS_HALT;
82 if (!halted)
83 mask &= ~CMD_RUN;
84
85 cmd = xhci_readl(xhci, &xhci->op_regs->command);
86 cmd &= mask;
87 xhci_writel(xhci, cmd, &xhci->op_regs->command);
88
89 return handshake(xhci, &xhci->op_regs->status,
90 STS_HALT, STS_HALT, XHCI_MAX_HALT_USEC);
91}
92
93/*
94 * Reset a halted HC, and set the internal HC state to HC_STATE_HALT.
95 *
96 * This resets pipelines, timers, counters, state machines, etc.
97 * Transactions will be terminated immediately, and operational registers
98 * will be set to their defaults.
99 */
100int xhci_reset(struct xhci_hcd *xhci)
101{
102 u32 command;
103 u32 state;
104
105 state = xhci_readl(xhci, &xhci->op_regs->status);
106 BUG_ON((state & STS_HALT) == 0);
107
108 xhci_dbg(xhci, "// Reset the HC\n");
109 command = xhci_readl(xhci, &xhci->op_regs->command);
110 command |= CMD_RESET;
111 xhci_writel(xhci, command, &xhci->op_regs->command);
112 /* XXX: Why does EHCI set this here? Shouldn't other code do this? */
113 xhci_to_hcd(xhci)->state = HC_STATE_HALT;
114
115 return handshake(xhci, &xhci->op_regs->command, CMD_RESET, 0, 250 * 1000);
116}
117
118/*
119 * Stop the HC from processing the endpoint queues.
120 */
121static void xhci_quiesce(struct xhci_hcd *xhci)
122{
123 /*
124 * Queues are per endpoint, so we need to disable an endpoint or slot.
125 *
126 * To disable a slot, we need to insert a disable slot command on the
127 * command ring and ring the doorbell. This will also free any internal
128 * resources associated with the slot (which might not be what we want).
129 *
130 * A Release Endpoint command sounds better - doesn't free internal HC
131 * memory, but removes the endpoints from the schedule and releases the
132 * bandwidth, disables the doorbells, and clears the endpoint enable
133 * flag. Usually used prior to a set interface command.
134 *
135 * TODO: Implement after command ring code is done.
136 */
137 BUG_ON(!HC_IS_RUNNING(xhci_to_hcd(xhci)->state));
138 xhci_dbg(xhci, "Finished quiescing -- code not written yet\n");
139}
140
141#if 0
142/* Set up MSI-X table for entry 0 (may claim other entries later) */
143static int xhci_setup_msix(struct xhci_hcd *xhci)
144{
145 int ret;
146 struct pci_dev *pdev = to_pci_dev(xhci_to_hcd(xhci)->self.controller);
147
148 xhci->msix_count = 0;
149 /* XXX: did I do this right? ixgbe does kcalloc for more than one */
150 xhci->msix_entries = kmalloc(sizeof(struct msix_entry), GFP_KERNEL);
151 if (!xhci->msix_entries) {
152 xhci_err(xhci, "Failed to allocate MSI-X entries\n");
153 return -ENOMEM;
154 }
155 xhci->msix_entries[0].entry = 0;
156
157 ret = pci_enable_msix(pdev, xhci->msix_entries, xhci->msix_count);
158 if (ret) {
159 xhci_err(xhci, "Failed to enable MSI-X\n");
160 goto free_entries;
161 }
162
163 /*
164 * Pass the xhci pointer value as the request_irq "cookie".
165 * If more irqs are added, this will need to be unique for each one.
166 */
167 ret = request_irq(xhci->msix_entries[0].vector, &xhci_irq, 0,
168 "xHCI", xhci_to_hcd(xhci));
169 if (ret) {
170 xhci_err(xhci, "Failed to allocate MSI-X interrupt\n");
171 goto disable_msix;
172 }
173 xhci_dbg(xhci, "Finished setting up MSI-X\n");
174 return 0;
175
176disable_msix:
177 pci_disable_msix(pdev);
178free_entries:
179 kfree(xhci->msix_entries);
180 xhci->msix_entries = NULL;
181 return ret;
182}
183
184/* XXX: code duplication; can xhci_setup_msix call this? */
185/* Free any IRQs and disable MSI-X */
186static void xhci_cleanup_msix(struct xhci_hcd *xhci)
187{
188 struct pci_dev *pdev = to_pci_dev(xhci_to_hcd(xhci)->self.controller);
189 if (!xhci->msix_entries)
190 return;
191
192 free_irq(xhci->msix_entries[0].vector, xhci);
193 pci_disable_msix(pdev);
194 kfree(xhci->msix_entries);
195 xhci->msix_entries = NULL;
196 xhci_dbg(xhci, "Finished cleaning up MSI-X\n");
197}
198#endif
199
200/*
201 * Initialize memory for HCD and xHC (one-time init).
202 *
203 * Program the PAGESIZE register, initialize the device context array, create
204 * device contexts (?), set up a command ring segment (or two?), create event
205 * ring (one for now).
206 */
207int xhci_init(struct usb_hcd *hcd)
208{
209 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
210 int retval = 0;
211
212 xhci_dbg(xhci, "xhci_init\n");
213 spin_lock_init(&xhci->lock);
214 retval = xhci_mem_init(xhci, GFP_KERNEL);
215 xhci_dbg(xhci, "Finished xhci_init\n");
216
217 return retval;
218}
219
220/*
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700221 * Called in interrupt context when there might be work
222 * queued on the event ring
223 *
224 * xhci->lock must be held by caller.
225 */
226static void xhci_work(struct xhci_hcd *xhci)
227{
228 u32 temp;
229
230 /*
231 * Clear the op reg interrupt status first,
232 * so we can receive interrupts from other MSI-X interrupters.
233 * Write 1 to clear the interrupt status.
234 */
235 temp = xhci_readl(xhci, &xhci->op_regs->status);
236 temp |= STS_EINT;
237 xhci_writel(xhci, temp, &xhci->op_regs->status);
238 /* FIXME when MSI-X is supported and there are multiple vectors */
239 /* Clear the MSI-X event interrupt status */
240
241 /* Acknowledge the interrupt */
242 temp = xhci_readl(xhci, &xhci->ir_set->irq_pending);
243 temp |= 0x3;
244 xhci_writel(xhci, temp, &xhci->ir_set->irq_pending);
245 /* Flush posted writes */
246 xhci_readl(xhci, &xhci->ir_set->irq_pending);
247
248 /* FIXME this should be a delayed service routine that clears the EHB */
Stephen Rothwellb7258a42009-04-29 19:02:47 -0700249 xhci_handle_event(xhci);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700250
251 /* Clear the event handler busy flag; the event ring should be empty. */
252 temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
253 xhci_writel(xhci, temp & ~ERST_EHB, &xhci->ir_set->erst_dequeue[0]);
254 /* Flush posted writes -- FIXME is this necessary? */
255 xhci_readl(xhci, &xhci->ir_set->irq_pending);
256}
257
258/*-------------------------------------------------------------------------*/
259
260/*
261 * xHCI spec says we can get an interrupt, and if the HC has an error condition,
262 * we might get bad data out of the event ring. Section 4.10.2.7 has a list of
263 * indicators of an event TRB error, but we check the status *first* to be safe.
264 */
265irqreturn_t xhci_irq(struct usb_hcd *hcd)
266{
267 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
268 u32 temp, temp2;
269
270 spin_lock(&xhci->lock);
271 /* Check if the xHC generated the interrupt, or the irq is shared */
272 temp = xhci_readl(xhci, &xhci->op_regs->status);
273 temp2 = xhci_readl(xhci, &xhci->ir_set->irq_pending);
274 if (!(temp & STS_EINT) && !ER_IRQ_PENDING(temp2)) {
275 spin_unlock(&xhci->lock);
276 return IRQ_NONE;
277 }
278
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700279 if (temp & STS_FATAL) {
280 xhci_warn(xhci, "WARNING: Host System Error\n");
281 xhci_halt(xhci);
282 xhci_to_hcd(xhci)->state = HC_STATE_HALT;
Sarah Sharpc96a2b82009-04-29 19:05:40 -0700283 spin_unlock(&xhci->lock);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700284 return -ESHUTDOWN;
285 }
286
287 xhci_work(xhci);
288 spin_unlock(&xhci->lock);
289
290 return IRQ_HANDLED;
291}
292
293#ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
Sarah Sharp23e3be12009-04-29 19:05:20 -0700294void xhci_event_ring_work(unsigned long arg)
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700295{
296 unsigned long flags;
297 int temp;
298 struct xhci_hcd *xhci = (struct xhci_hcd *) arg;
299 int i, j;
300
301 xhci_dbg(xhci, "Poll event ring: %lu\n", jiffies);
302
303 spin_lock_irqsave(&xhci->lock, flags);
304 temp = xhci_readl(xhci, &xhci->op_regs->status);
305 xhci_dbg(xhci, "op reg status = 0x%x\n", temp);
306 temp = xhci_readl(xhci, &xhci->ir_set->irq_pending);
307 xhci_dbg(xhci, "ir_set 0 pending = 0x%x\n", temp);
308 xhci_dbg(xhci, "No-op commands handled = %d\n", xhci->noops_handled);
309 xhci_dbg(xhci, "HC error bitmask = 0x%x\n", xhci->error_bitmask);
310 xhci->error_bitmask = 0;
311 xhci_dbg(xhci, "Event ring:\n");
312 xhci_debug_segment(xhci, xhci->event_ring->deq_seg);
313 xhci_dbg_ring_ptrs(xhci, xhci->event_ring);
314 temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
315 temp &= ERST_PTR_MASK;
316 xhci_dbg(xhci, "ERST deq = 0x%x\n", temp);
317 xhci_dbg(xhci, "Command ring:\n");
318 xhci_debug_segment(xhci, xhci->cmd_ring->deq_seg);
319 xhci_dbg_ring_ptrs(xhci, xhci->cmd_ring);
320 xhci_dbg_cmd_ptrs(xhci);
Sarah Sharp3ffbba92009-04-27 19:57:38 -0700321 for (i = 0; i < MAX_HC_SLOTS; ++i) {
322 if (xhci->devs[i]) {
323 for (j = 0; j < 31; ++j) {
324 if (xhci->devs[i]->ep_rings[j]) {
325 xhci_dbg(xhci, "Dev %d endpoint ring %d:\n", i, j);
326 xhci_debug_segment(xhci, xhci->devs[i]->ep_rings[j]->deq_seg);
327 }
328 }
329 }
330 }
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700331
332 if (xhci->noops_submitted != NUM_TEST_NOOPS)
Sarah Sharp23e3be12009-04-29 19:05:20 -0700333 if (xhci_setup_one_noop(xhci))
334 xhci_ring_cmd_db(xhci);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700335 spin_unlock_irqrestore(&xhci->lock, flags);
336
337 if (!xhci->zombie)
338 mod_timer(&xhci->event_ring_timer, jiffies + POLL_TIMEOUT * HZ);
339 else
340 xhci_dbg(xhci, "Quit polling the event ring.\n");
341}
342#endif
343
344/*
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700345 * Start the HC after it was halted.
346 *
347 * This function is called by the USB core when the HC driver is added.
348 * Its opposite is xhci_stop().
349 *
350 * xhci_init() must be called once before this function can be called.
351 * Reset the HC, enable device slot contexts, program DCBAAP, and
352 * set command ring pointer and event ring pointer.
353 *
354 * Setup MSI-X vectors and enable interrupts.
355 */
356int xhci_run(struct usb_hcd *hcd)
357{
358 u32 temp;
359 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700360 void (*doorbell)(struct xhci_hcd *) = NULL;
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700361
Sarah Sharp0f2a7932009-04-27 19:57:12 -0700362 hcd->uses_new_polling = 1;
363 hcd->poll_rh = 0;
364
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700365 xhci_dbg(xhci, "xhci_run\n");
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700366#if 0 /* FIXME: MSI not setup yet */
367 /* Do this at the very last minute */
368 ret = xhci_setup_msix(xhci);
369 if (!ret)
370 return ret;
371
372 return -ENOSYS;
373#endif
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700374#ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
375 init_timer(&xhci->event_ring_timer);
376 xhci->event_ring_timer.data = (unsigned long) xhci;
Sarah Sharp23e3be12009-04-29 19:05:20 -0700377 xhci->event_ring_timer.function = xhci_event_ring_work;
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700378 /* Poll the event ring */
379 xhci->event_ring_timer.expires = jiffies + POLL_TIMEOUT * HZ;
380 xhci->zombie = 0;
381 xhci_dbg(xhci, "Setting event ring polling timer\n");
382 add_timer(&xhci->event_ring_timer);
383#endif
384
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700385 xhci_dbg(xhci, "// Set the interrupt modulation register\n");
386 temp = xhci_readl(xhci, &xhci->ir_set->irq_control);
387 temp &= 0xffff;
388 temp |= (u32) 160;
389 xhci_writel(xhci, temp, &xhci->ir_set->irq_control);
390
391 /* Set the HCD state before we enable the irqs */
392 hcd->state = HC_STATE_RUNNING;
393 temp = xhci_readl(xhci, &xhci->op_regs->command);
394 temp |= (CMD_EIE);
395 xhci_dbg(xhci, "// Enable interrupts, cmd = 0x%x.\n",
396 temp);
397 xhci_writel(xhci, temp, &xhci->op_regs->command);
398
399 temp = xhci_readl(xhci, &xhci->ir_set->irq_pending);
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700400 xhci_dbg(xhci, "// Enabling event ring interrupter %p by writing 0x%x to irq_pending\n",
401 xhci->ir_set, (unsigned int) ER_IRQ_ENABLE(temp));
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700402 xhci_writel(xhci, ER_IRQ_ENABLE(temp),
403 &xhci->ir_set->irq_pending);
404 xhci_print_ir_set(xhci, xhci->ir_set, 0);
405
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700406 if (NUM_TEST_NOOPS > 0)
Sarah Sharp23e3be12009-04-29 19:05:20 -0700407 doorbell = xhci_setup_one_noop(xhci);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700408
Sarah Sharp0ebbab32009-04-27 19:52:34 -0700409 xhci_dbg(xhci, "Command ring memory map follows:\n");
410 xhci_debug_ring(xhci, xhci->cmd_ring);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700411 xhci_dbg_ring_ptrs(xhci, xhci->cmd_ring);
412 xhci_dbg_cmd_ptrs(xhci);
413
Sarah Sharp0ebbab32009-04-27 19:52:34 -0700414 xhci_dbg(xhci, "ERST memory map follows:\n");
415 xhci_dbg_erst(xhci, &xhci->erst);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700416 xhci_dbg(xhci, "Event ring:\n");
417 xhci_debug_ring(xhci, xhci->event_ring);
418 xhci_dbg_ring_ptrs(xhci, xhci->event_ring);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700419 temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[0]);
420 temp &= ERST_PTR_MASK;
421 xhci_dbg(xhci, "ERST deq = 0x%x\n", temp);
Sarah Sharp3841d562009-04-29 19:04:32 -0700422 temp = xhci_readl(xhci, &xhci->ir_set->erst_dequeue[1]);
423 xhci_dbg(xhci, "ERST deq upper = 0x%x\n", temp);
Sarah Sharp0ebbab32009-04-27 19:52:34 -0700424
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700425 temp = xhci_readl(xhci, &xhci->op_regs->command);
426 temp |= (CMD_RUN);
427 xhci_dbg(xhci, "// Turn on HC, cmd = 0x%x.\n",
428 temp);
429 xhci_writel(xhci, temp, &xhci->op_regs->command);
430 /* Flush PCI posted writes */
431 temp = xhci_readl(xhci, &xhci->op_regs->command);
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700432 xhci_dbg(xhci, "// @%p = 0x%x\n", &xhci->op_regs->command, temp);
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700433 if (doorbell)
434 (*doorbell)(xhci);
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700435
436 xhci_dbg(xhci, "Finished xhci_run\n");
437 return 0;
438}
439
440/*
441 * Stop xHCI driver.
442 *
443 * This function is called by the USB core when the HC driver is removed.
444 * Its opposite is xhci_run().
445 *
446 * Disable device contexts, disable IRQs, and quiesce the HC.
447 * Reset the HC, finish any completed transactions, and cleanup memory.
448 */
449void xhci_stop(struct usb_hcd *hcd)
450{
451 u32 temp;
452 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
453
454 spin_lock_irq(&xhci->lock);
455 if (HC_IS_RUNNING(hcd->state))
456 xhci_quiesce(xhci);
457 xhci_halt(xhci);
458 xhci_reset(xhci);
459 spin_unlock_irq(&xhci->lock);
460
461#if 0 /* No MSI yet */
462 xhci_cleanup_msix(xhci);
463#endif
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700464#ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
465 /* Tell the event ring poll function not to reschedule */
466 xhci->zombie = 1;
467 del_timer_sync(&xhci->event_ring_timer);
468#endif
469
Sarah Sharp66d4ead2009-04-27 19:52:28 -0700470 xhci_dbg(xhci, "// Disabling event ring interrupts\n");
471 temp = xhci_readl(xhci, &xhci->op_regs->status);
472 xhci_writel(xhci, temp & ~STS_EINT, &xhci->op_regs->status);
473 temp = xhci_readl(xhci, &xhci->ir_set->irq_pending);
474 xhci_writel(xhci, ER_IRQ_DISABLE(temp),
475 &xhci->ir_set->irq_pending);
476 xhci_print_ir_set(xhci, xhci->ir_set, 0);
477
478 xhci_dbg(xhci, "cleaning up memory\n");
479 xhci_mem_cleanup(xhci);
480 xhci_dbg(xhci, "xhci_stop completed - status = %x\n",
481 xhci_readl(xhci, &xhci->op_regs->status));
482}
483
484/*
485 * Shutdown HC (not bus-specific)
486 *
487 * This is called when the machine is rebooting or halting. We assume that the
488 * machine will be powered off, and the HC's internal state will be reset.
489 * Don't bother to free memory.
490 */
491void xhci_shutdown(struct usb_hcd *hcd)
492{
493 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
494
495 spin_lock_irq(&xhci->lock);
496 xhci_halt(xhci);
497 spin_unlock_irq(&xhci->lock);
498
499#if 0
500 xhci_cleanup_msix(xhci);
501#endif
502
503 xhci_dbg(xhci, "xhci_shutdown completed - status = %x\n",
504 xhci_readl(xhci, &xhci->op_regs->status));
505}
506
Sarah Sharp7f84eef2009-04-27 19:53:56 -0700507/*-------------------------------------------------------------------------*/
508
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700509/**
510 * xhci_get_endpoint_index - Used for passing endpoint bitmasks between the core and
511 * HCDs. Find the index for an endpoint given its descriptor. Use the return
512 * value to right shift 1 for the bitmask.
513 *
514 * Index = (epnum * 2) + direction - 1,
515 * where direction = 0 for OUT, 1 for IN.
516 * For control endpoints, the IN index is used (OUT index is unused), so
517 * index = (epnum * 2) + direction - 1 = (epnum * 2) + 1 - 1 = (epnum * 2)
518 */
519unsigned int xhci_get_endpoint_index(struct usb_endpoint_descriptor *desc)
520{
521 unsigned int index;
522 if (usb_endpoint_xfer_control(desc))
523 index = (unsigned int) (usb_endpoint_num(desc)*2);
524 else
525 index = (unsigned int) (usb_endpoint_num(desc)*2) +
526 (usb_endpoint_dir_in(desc) ? 1 : 0) - 1;
527 return index;
528}
529
Sarah Sharpf94e01862009-04-27 19:58:38 -0700530/* Find the flag for this endpoint (for use in the control context). Use the
531 * endpoint index to create a bitmask. The slot context is bit 0, endpoint 0 is
532 * bit 1, etc.
533 */
534unsigned int xhci_get_endpoint_flag(struct usb_endpoint_descriptor *desc)
535{
536 return 1 << (xhci_get_endpoint_index(desc) + 1);
537}
538
539/* Compute the last valid endpoint context index. Basically, this is the
540 * endpoint index plus one. For slot contexts with more than valid endpoint,
541 * we find the most significant bit set in the added contexts flags.
542 * e.g. ep 1 IN (with epnum 0x81) => added_ctxs = 0b1000
543 * fls(0b1000) = 4, but the endpoint context index is 3, so subtract one.
544 */
545static inline unsigned int xhci_last_valid_endpoint(u32 added_ctxs)
546{
547 return fls(added_ctxs) - 1;
548}
549
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700550/* Returns 1 if the arguments are OK;
551 * returns 0 this is a root hub; returns -EINVAL for NULL pointers.
552 */
553int xhci_check_args(struct usb_hcd *hcd, struct usb_device *udev,
554 struct usb_host_endpoint *ep, int check_ep, const char *func) {
555 if (!hcd || (check_ep && !ep) || !udev) {
556 printk(KERN_DEBUG "xHCI %s called with invalid args\n",
557 func);
558 return -EINVAL;
559 }
560 if (!udev->parent) {
561 printk(KERN_DEBUG "xHCI %s called for root hub\n",
562 func);
563 return 0;
564 }
565 if (!udev->slot_id) {
566 printk(KERN_DEBUG "xHCI %s called with unaddressed device\n",
567 func);
568 return -EINVAL;
569 }
570 return 1;
571}
572
573/*
574 * non-error returns are a promise to giveback() the urb later
575 * we drop ownership so next owner (or urb unlink) can get it
576 */
577int xhci_urb_enqueue(struct usb_hcd *hcd, struct urb *urb, gfp_t mem_flags)
578{
579 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
580 unsigned long flags;
581 int ret = 0;
582 unsigned int slot_id, ep_index;
583
584 if (!urb || xhci_check_args(hcd, urb->dev, urb->ep, true, __func__) <= 0)
585 return -EINVAL;
586
587 slot_id = urb->dev->slot_id;
588 ep_index = xhci_get_endpoint_index(&urb->ep->desc);
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700589
590 spin_lock_irqsave(&xhci->lock, flags);
591 if (!xhci->devs || !xhci->devs[slot_id]) {
592 if (!in_interrupt())
593 dev_warn(&urb->dev->dev, "WARN: urb submitted for dev with no Slot ID\n");
Sarah Sharpc7959fb2009-04-29 19:06:36 -0700594 ret = -EINVAL;
595 goto exit;
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700596 }
597 if (!test_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags)) {
598 if (!in_interrupt())
599 xhci_dbg(xhci, "urb submitted during PCI suspend\n");
600 ret = -ESHUTDOWN;
601 goto exit;
602 }
Sarah Sharpb10de142009-04-27 19:58:50 -0700603 if (usb_endpoint_xfer_control(&urb->ep->desc))
Sarah Sharp23e3be12009-04-29 19:05:20 -0700604 ret = xhci_queue_ctrl_tx(xhci, mem_flags, urb,
605 slot_id, ep_index);
Sarah Sharpb10de142009-04-27 19:58:50 -0700606 else if (usb_endpoint_xfer_bulk(&urb->ep->desc))
Sarah Sharp23e3be12009-04-29 19:05:20 -0700607 ret = xhci_queue_bulk_tx(xhci, mem_flags, urb,
608 slot_id, ep_index);
Sarah Sharpb10de142009-04-27 19:58:50 -0700609 else
610 ret = -EINVAL;
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700611exit:
612 spin_unlock_irqrestore(&xhci->lock, flags);
613 return ret;
614}
615
Sarah Sharpae636742009-04-29 19:02:31 -0700616/*
617 * Remove the URB's TD from the endpoint ring. This may cause the HC to stop
618 * USB transfers, potentially stopping in the middle of a TRB buffer. The HC
619 * should pick up where it left off in the TD, unless a Set Transfer Ring
620 * Dequeue Pointer is issued.
621 *
622 * The TRBs that make up the buffers for the canceled URB will be "removed" from
623 * the ring. Since the ring is a contiguous structure, they can't be physically
624 * removed. Instead, there are two options:
625 *
626 * 1) If the HC is in the middle of processing the URB to be canceled, we
627 * simply move the ring's dequeue pointer past those TRBs using the Set
628 * Transfer Ring Dequeue Pointer command. This will be the common case,
629 * when drivers timeout on the last submitted URB and attempt to cancel.
630 *
631 * 2) If the HC is in the middle of a different TD, we turn the TRBs into a
632 * series of 1-TRB transfer no-op TDs. (No-ops shouldn't be chained.) The
633 * HC will need to invalidate the any TRBs it has cached after the stop
634 * endpoint command, as noted in the xHCI 0.95 errata.
635 *
636 * 3) The TD may have completed by the time the Stop Endpoint Command
637 * completes, so software needs to handle that case too.
638 *
639 * This function should protect against the TD enqueueing code ringing the
640 * doorbell while this code is waiting for a Stop Endpoint command to complete.
641 * It also needs to account for multiple cancellations on happening at the same
642 * time for the same endpoint.
643 *
644 * Note that this function can be called in any context, or so says
645 * usb_hcd_unlink_urb()
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700646 */
647int xhci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
648{
Sarah Sharpae636742009-04-29 19:02:31 -0700649 unsigned long flags;
650 int ret;
651 struct xhci_hcd *xhci;
652 struct xhci_td *td;
653 unsigned int ep_index;
654 struct xhci_ring *ep_ring;
655
656 xhci = hcd_to_xhci(hcd);
657 spin_lock_irqsave(&xhci->lock, flags);
658 /* Make sure the URB hasn't completed or been unlinked already */
659 ret = usb_hcd_check_unlink_urb(hcd, urb, status);
660 if (ret || !urb->hcpriv)
661 goto done;
662
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700663 xhci_dbg(xhci, "Cancel URB %p\n", urb);
Sarah Sharpae636742009-04-29 19:02:31 -0700664 ep_index = xhci_get_endpoint_index(&urb->ep->desc);
665 ep_ring = xhci->devs[urb->dev->slot_id]->ep_rings[ep_index];
666 td = (struct xhci_td *) urb->hcpriv;
667
668 ep_ring->cancels_pending++;
669 list_add_tail(&td->cancelled_td_list, &ep_ring->cancelled_td_list);
670 /* Queue a stop endpoint command, but only if this is
671 * the first cancellation to be handled.
672 */
673 if (ep_ring->cancels_pending == 1) {
Sarah Sharp23e3be12009-04-29 19:05:20 -0700674 xhci_queue_stop_endpoint(xhci, urb->dev->slot_id, ep_index);
675 xhci_ring_cmd_db(xhci);
Sarah Sharpae636742009-04-29 19:02:31 -0700676 }
677done:
678 spin_unlock_irqrestore(&xhci->lock, flags);
679 return ret;
Sarah Sharpd0e96f52009-04-27 19:58:01 -0700680}
681
Sarah Sharpf94e01862009-04-27 19:58:38 -0700682/* Drop an endpoint from a new bandwidth configuration for this device.
683 * Only one call to this function is allowed per endpoint before
684 * check_bandwidth() or reset_bandwidth() must be called.
685 * A call to xhci_drop_endpoint() followed by a call to xhci_add_endpoint() will
686 * add the endpoint to the schedule with possibly new parameters denoted by a
687 * different endpoint descriptor in usb_host_endpoint.
688 * A call to xhci_add_endpoint() followed by a call to xhci_drop_endpoint() is
689 * not allowed.
690 */
691int xhci_drop_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
692 struct usb_host_endpoint *ep)
693{
694 unsigned long flags;
695 struct xhci_hcd *xhci;
696 struct xhci_device_control *in_ctx;
697 unsigned int last_ctx;
698 unsigned int ep_index;
699 struct xhci_ep_ctx *ep_ctx;
700 u32 drop_flag;
701 u32 new_add_flags, new_drop_flags, new_slot_info;
702 int ret;
703
704 ret = xhci_check_args(hcd, udev, ep, 1, __func__);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700705 if (ret <= 0)
706 return ret;
707 xhci = hcd_to_xhci(hcd);
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700708 xhci_dbg(xhci, "%s called for udev %p\n", __func__, udev);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700709
710 drop_flag = xhci_get_endpoint_flag(&ep->desc);
711 if (drop_flag == SLOT_FLAG || drop_flag == EP0_FLAG) {
712 xhci_dbg(xhci, "xHCI %s - can't drop slot or ep 0 %#x\n",
713 __func__, drop_flag);
714 return 0;
715 }
716
717 spin_lock_irqsave(&xhci->lock, flags);
718 if (!xhci->devs || !xhci->devs[udev->slot_id]) {
719 xhci_warn(xhci, "xHCI %s called with unaddressed device\n",
720 __func__);
721 spin_unlock_irqrestore(&xhci->lock, flags);
722 return -EINVAL;
723 }
724
725 in_ctx = xhci->devs[udev->slot_id]->in_ctx;
726 ep_index = xhci_get_endpoint_index(&ep->desc);
727 ep_ctx = &xhci->devs[udev->slot_id]->out_ctx->ep[ep_index];
728 /* If the HC already knows the endpoint is disabled,
729 * or the HCD has noted it is disabled, ignore this request
730 */
731 if ((ep_ctx->ep_info & EP_STATE_MASK) == EP_STATE_DISABLED ||
732 in_ctx->drop_flags & xhci_get_endpoint_flag(&ep->desc)) {
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700733 xhci_warn(xhci, "xHCI %s called with disabled ep %p\n",
734 __func__, ep);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700735 spin_unlock_irqrestore(&xhci->lock, flags);
736 return 0;
737 }
738
739 in_ctx->drop_flags |= drop_flag;
740 new_drop_flags = in_ctx->drop_flags;
741
742 in_ctx->add_flags = ~drop_flag;
743 new_add_flags = in_ctx->add_flags;
744
745 last_ctx = xhci_last_valid_endpoint(in_ctx->add_flags);
746 /* Update the last valid endpoint context, if we deleted the last one */
747 if ((in_ctx->slot.dev_info & LAST_CTX_MASK) > LAST_CTX(last_ctx)) {
748 in_ctx->slot.dev_info &= ~LAST_CTX_MASK;
749 in_ctx->slot.dev_info |= LAST_CTX(last_ctx);
750 }
751 new_slot_info = in_ctx->slot.dev_info;
752
753 xhci_endpoint_zero(xhci, xhci->devs[udev->slot_id], ep);
754
755 spin_unlock_irqrestore(&xhci->lock, flags);
756
757 xhci_dbg(xhci, "drop ep 0x%x, slot id %d, new drop flags = %#x, new add flags = %#x, new slot info = %#x\n",
758 (unsigned int) ep->desc.bEndpointAddress,
759 udev->slot_id,
760 (unsigned int) new_drop_flags,
761 (unsigned int) new_add_flags,
762 (unsigned int) new_slot_info);
763 return 0;
764}
765
766/* Add an endpoint to a new possible bandwidth configuration for this device.
767 * Only one call to this function is allowed per endpoint before
768 * check_bandwidth() or reset_bandwidth() must be called.
769 * A call to xhci_drop_endpoint() followed by a call to xhci_add_endpoint() will
770 * add the endpoint to the schedule with possibly new parameters denoted by a
771 * different endpoint descriptor in usb_host_endpoint.
772 * A call to xhci_add_endpoint() followed by a call to xhci_drop_endpoint() is
773 * not allowed.
774 */
775int xhci_add_endpoint(struct usb_hcd *hcd, struct usb_device *udev,
776 struct usb_host_endpoint *ep)
777{
778 unsigned long flags;
779 struct xhci_hcd *xhci;
780 struct xhci_device_control *in_ctx;
781 unsigned int ep_index;
782 struct xhci_ep_ctx *ep_ctx;
783 u32 added_ctxs;
784 unsigned int last_ctx;
785 u32 new_add_flags, new_drop_flags, new_slot_info;
786 int ret = 0;
787
788 ret = xhci_check_args(hcd, udev, ep, 1, __func__);
789 if (ret <= 0)
790 return ret;
791 xhci = hcd_to_xhci(hcd);
792
793 added_ctxs = xhci_get_endpoint_flag(&ep->desc);
794 last_ctx = xhci_last_valid_endpoint(added_ctxs);
795 if (added_ctxs == SLOT_FLAG || added_ctxs == EP0_FLAG) {
796 /* FIXME when we have to issue an evaluate endpoint command to
797 * deal with ep0 max packet size changing once we get the
798 * descriptors
799 */
800 xhci_dbg(xhci, "xHCI %s - can't add slot or ep 0 %#x\n",
801 __func__, added_ctxs);
802 return 0;
803 }
804
805 spin_lock_irqsave(&xhci->lock, flags);
806 if (!xhci->devs || !xhci->devs[udev->slot_id]) {
807 xhci_warn(xhci, "xHCI %s called with unaddressed device\n",
808 __func__);
809 spin_unlock_irqrestore(&xhci->lock, flags);
810 return -EINVAL;
811 }
812
813 in_ctx = xhci->devs[udev->slot_id]->in_ctx;
814 ep_index = xhci_get_endpoint_index(&ep->desc);
815 ep_ctx = &xhci->devs[udev->slot_id]->out_ctx->ep[ep_index];
816 /* If the HCD has already noted the endpoint is enabled,
817 * ignore this request.
818 */
819 if (in_ctx->add_flags & xhci_get_endpoint_flag(&ep->desc)) {
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700820 xhci_warn(xhci, "xHCI %s called with enabled ep %p\n",
821 __func__, ep);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700822 spin_unlock_irqrestore(&xhci->lock, flags);
823 return 0;
824 }
825
826 if (xhci_endpoint_init(xhci, xhci->devs[udev->slot_id], udev, ep) < 0) {
827 dev_dbg(&udev->dev, "%s - could not initialize ep %#x\n",
828 __func__, ep->desc.bEndpointAddress);
829 spin_unlock_irqrestore(&xhci->lock, flags);
830 return -ENOMEM;
831 }
832
833 in_ctx->add_flags |= added_ctxs;
834 new_add_flags = in_ctx->add_flags;
835
836 /* If xhci_endpoint_disable() was called for this endpoint, but the
837 * xHC hasn't been notified yet through the check_bandwidth() call,
838 * this re-adds a new state for the endpoint from the new endpoint
839 * descriptors. We must drop and re-add this endpoint, so we leave the
840 * drop flags alone.
841 */
842 new_drop_flags = in_ctx->drop_flags;
843
844 /* Update the last valid endpoint context, if we just added one past */
845 if ((in_ctx->slot.dev_info & LAST_CTX_MASK) < LAST_CTX(last_ctx)) {
846 in_ctx->slot.dev_info &= ~LAST_CTX_MASK;
847 in_ctx->slot.dev_info |= LAST_CTX(last_ctx);
848 }
849 new_slot_info = in_ctx->slot.dev_info;
850 spin_unlock_irqrestore(&xhci->lock, flags);
851
852 xhci_dbg(xhci, "add ep 0x%x, slot id %d, new drop flags = %#x, new add flags = %#x, new slot info = %#x\n",
853 (unsigned int) ep->desc.bEndpointAddress,
854 udev->slot_id,
855 (unsigned int) new_drop_flags,
856 (unsigned int) new_add_flags,
857 (unsigned int) new_slot_info);
858 return 0;
859}
860
861static void xhci_zero_in_ctx(struct xhci_virt_device *virt_dev)
862{
863 struct xhci_ep_ctx *ep_ctx;
864 int i;
865
866 /* When a device's add flag and drop flag are zero, any subsequent
867 * configure endpoint command will leave that endpoint's state
868 * untouched. Make sure we don't leave any old state in the input
869 * endpoint contexts.
870 */
871 virt_dev->in_ctx->drop_flags = 0;
872 virt_dev->in_ctx->add_flags = 0;
873 virt_dev->in_ctx->slot.dev_info &= ~LAST_CTX_MASK;
874 /* Endpoint 0 is always valid */
875 virt_dev->in_ctx->slot.dev_info |= LAST_CTX(1);
876 for (i = 1; i < 31; ++i) {
877 ep_ctx = &virt_dev->in_ctx->ep[i];
878 ep_ctx->ep_info = 0;
879 ep_ctx->ep_info2 = 0;
880 ep_ctx->deq[0] = 0;
881 ep_ctx->deq[1] = 0;
882 ep_ctx->tx_info = 0;
883 }
884}
885
886int xhci_check_bandwidth(struct usb_hcd *hcd, struct usb_device *udev)
887{
888 int i;
889 int ret = 0;
890 int timeleft;
891 unsigned long flags;
892 struct xhci_hcd *xhci;
893 struct xhci_virt_device *virt_dev;
894
895 ret = xhci_check_args(hcd, udev, NULL, 0, __func__);
896 if (ret <= 0)
897 return ret;
898 xhci = hcd_to_xhci(hcd);
899
900 spin_lock_irqsave(&xhci->lock, flags);
901 if (!udev->slot_id || !xhci->devs || !xhci->devs[udev->slot_id]) {
902 xhci_warn(xhci, "xHCI %s called with unaddressed device\n",
903 __func__);
904 spin_unlock_irqrestore(&xhci->lock, flags);
905 return -EINVAL;
906 }
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -0700907 xhci_dbg(xhci, "%s called for udev %p\n", __func__, udev);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700908 virt_dev = xhci->devs[udev->slot_id];
909
910 /* See section 4.6.6 - A0 = 1; A1 = D0 = D1 = 0 */
911 virt_dev->in_ctx->add_flags |= SLOT_FLAG;
912 virt_dev->in_ctx->add_flags &= ~EP0_FLAG;
913 virt_dev->in_ctx->drop_flags &= ~SLOT_FLAG;
914 virt_dev->in_ctx->drop_flags &= ~EP0_FLAG;
915 xhci_dbg(xhci, "New Input Control Context:\n");
916 xhci_dbg_ctx(xhci, virt_dev->in_ctx, virt_dev->in_ctx_dma,
917 LAST_CTX_TO_EP_NUM(virt_dev->in_ctx->slot.dev_info));
918
Sarah Sharp23e3be12009-04-29 19:05:20 -0700919 ret = xhci_queue_configure_endpoint(xhci, virt_dev->in_ctx_dma,
920 udev->slot_id);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700921 if (ret < 0) {
922 xhci_dbg(xhci, "FIXME allocate a new ring segment\n");
923 spin_unlock_irqrestore(&xhci->lock, flags);
924 return -ENOMEM;
925 }
Sarah Sharp23e3be12009-04-29 19:05:20 -0700926 xhci_ring_cmd_db(xhci);
Sarah Sharpf94e01862009-04-27 19:58:38 -0700927 spin_unlock_irqrestore(&xhci->lock, flags);
928
929 /* Wait for the configure endpoint command to complete */
930 timeleft = wait_for_completion_interruptible_timeout(
931 &virt_dev->cmd_completion,
932 USB_CTRL_SET_TIMEOUT);
933 if (timeleft <= 0) {
934 xhci_warn(xhci, "%s while waiting for configure endpoint command\n",
935 timeleft == 0 ? "Timeout" : "Signal");
936 /* FIXME cancel the configure endpoint command */
937 return -ETIME;
938 }
939
940 spin_lock_irqsave(&xhci->lock, flags);
941 switch (virt_dev->cmd_status) {
942 case COMP_ENOMEM:
943 dev_warn(&udev->dev, "Not enough host controller resources "
944 "for new device state.\n");
945 ret = -ENOMEM;
946 /* FIXME: can we allocate more resources for the HC? */
947 break;
948 case COMP_BW_ERR:
949 dev_warn(&udev->dev, "Not enough bandwidth "
950 "for new device state.\n");
951 ret = -ENOSPC;
952 /* FIXME: can we go back to the old state? */
953 break;
954 case COMP_TRB_ERR:
955 /* the HCD set up something wrong */
956 dev_warn(&udev->dev, "ERROR: Endpoint drop flag = 0, add flag = 1, "
957 "and endpoint is not disabled.\n");
958 ret = -EINVAL;
959 break;
960 case COMP_SUCCESS:
961 dev_dbg(&udev->dev, "Successful Endpoint Configure command\n");
962 break;
963 default:
964 xhci_err(xhci, "ERROR: unexpected command completion "
965 "code 0x%x.\n", virt_dev->cmd_status);
966 ret = -EINVAL;
967 break;
968 }
969 if (ret) {
970 /* Callee should call reset_bandwidth() */
971 spin_unlock_irqrestore(&xhci->lock, flags);
972 return ret;
973 }
974
975 xhci_dbg(xhci, "Output context after successful config ep cmd:\n");
976 xhci_dbg_ctx(xhci, virt_dev->out_ctx, virt_dev->out_ctx_dma,
977 LAST_CTX_TO_EP_NUM(virt_dev->in_ctx->slot.dev_info));
978
979 xhci_zero_in_ctx(virt_dev);
980 /* Free any old rings */
981 for (i = 1; i < 31; ++i) {
982 if (virt_dev->new_ep_rings[i]) {
983 xhci_ring_free(xhci, virt_dev->ep_rings[i]);
984 virt_dev->ep_rings[i] = virt_dev->new_ep_rings[i];
985 virt_dev->new_ep_rings[i] = NULL;
986 }
987 }
988
989 spin_unlock_irqrestore(&xhci->lock, flags);
990
991 return ret;
992}
993
994void xhci_reset_bandwidth(struct usb_hcd *hcd, struct usb_device *udev)
995{
996 unsigned long flags;
997 struct xhci_hcd *xhci;
998 struct xhci_virt_device *virt_dev;
999 int i, ret;
1000
1001 ret = xhci_check_args(hcd, udev, NULL, 0, __func__);
1002 if (ret <= 0)
1003 return;
1004 xhci = hcd_to_xhci(hcd);
1005
1006 spin_lock_irqsave(&xhci->lock, flags);
1007 if (!xhci->devs || !xhci->devs[udev->slot_id]) {
1008 xhci_warn(xhci, "xHCI %s called with unaddressed device\n",
1009 __func__);
1010 spin_unlock_irqrestore(&xhci->lock, flags);
1011 return;
1012 }
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -07001013 xhci_dbg(xhci, "%s called for udev %p\n", __func__, udev);
Sarah Sharpf94e01862009-04-27 19:58:38 -07001014 virt_dev = xhci->devs[udev->slot_id];
1015 /* Free any rings allocated for added endpoints */
1016 for (i = 0; i < 31; ++i) {
1017 if (virt_dev->new_ep_rings[i]) {
1018 xhci_ring_free(xhci, virt_dev->new_ep_rings[i]);
1019 virt_dev->new_ep_rings[i] = NULL;
1020 }
1021 }
1022 xhci_zero_in_ctx(virt_dev);
1023 spin_unlock_irqrestore(&xhci->lock, flags);
1024}
1025
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001026/*
1027 * At this point, the struct usb_device is about to go away, the device has
1028 * disconnected, and all traffic has been stopped and the endpoints have been
1029 * disabled. Free any HC data structures associated with that device.
1030 */
1031void xhci_free_dev(struct usb_hcd *hcd, struct usb_device *udev)
1032{
1033 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
1034 unsigned long flags;
1035
1036 if (udev->slot_id == 0)
1037 return;
1038
1039 spin_lock_irqsave(&xhci->lock, flags);
Sarah Sharp23e3be12009-04-29 19:05:20 -07001040 if (xhci_queue_slot_control(xhci, TRB_DISABLE_SLOT, udev->slot_id)) {
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001041 spin_unlock_irqrestore(&xhci->lock, flags);
1042 xhci_dbg(xhci, "FIXME: allocate a command ring segment\n");
1043 return;
1044 }
Sarah Sharp23e3be12009-04-29 19:05:20 -07001045 xhci_ring_cmd_db(xhci);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001046 spin_unlock_irqrestore(&xhci->lock, flags);
1047 /*
1048 * Event command completion handler will free any data structures
1049 * associated with the slot
1050 */
1051}
1052
1053/*
1054 * Returns 0 if the xHC ran out of device slots, the Enable Slot command
1055 * timed out, or allocating memory failed. Returns 1 on success.
1056 */
1057int xhci_alloc_dev(struct usb_hcd *hcd, struct usb_device *udev)
1058{
1059 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
1060 unsigned long flags;
1061 int timeleft;
1062 int ret;
1063
1064 spin_lock_irqsave(&xhci->lock, flags);
Sarah Sharp23e3be12009-04-29 19:05:20 -07001065 ret = xhci_queue_slot_control(xhci, TRB_ENABLE_SLOT, 0);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001066 if (ret) {
1067 spin_unlock_irqrestore(&xhci->lock, flags);
1068 xhci_dbg(xhci, "FIXME: allocate a command ring segment\n");
1069 return 0;
1070 }
Sarah Sharp23e3be12009-04-29 19:05:20 -07001071 xhci_ring_cmd_db(xhci);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001072 spin_unlock_irqrestore(&xhci->lock, flags);
1073
1074 /* XXX: how much time for xHC slot assignment? */
1075 timeleft = wait_for_completion_interruptible_timeout(&xhci->addr_dev,
1076 USB_CTRL_SET_TIMEOUT);
1077 if (timeleft <= 0) {
1078 xhci_warn(xhci, "%s while waiting for a slot\n",
1079 timeleft == 0 ? "Timeout" : "Signal");
1080 /* FIXME cancel the enable slot request */
1081 return 0;
1082 }
1083
1084 spin_lock_irqsave(&xhci->lock, flags);
1085 if (!xhci->slot_id) {
1086 xhci_err(xhci, "Error while assigning device slot ID\n");
1087 spin_unlock_irqrestore(&xhci->lock, flags);
1088 return 0;
1089 }
1090 if (!xhci_alloc_virt_device(xhci, xhci->slot_id, udev, GFP_KERNEL)) {
1091 /* Disable slot, if we can do it without mem alloc */
1092 xhci_warn(xhci, "Could not allocate xHCI USB device data structures\n");
Sarah Sharp23e3be12009-04-29 19:05:20 -07001093 if (!xhci_queue_slot_control(xhci, TRB_DISABLE_SLOT, udev->slot_id))
1094 xhci_ring_cmd_db(xhci);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001095 spin_unlock_irqrestore(&xhci->lock, flags);
1096 return 0;
1097 }
1098 udev->slot_id = xhci->slot_id;
1099 /* Is this a LS or FS device under a HS hub? */
1100 /* Hub or peripherial? */
1101 spin_unlock_irqrestore(&xhci->lock, flags);
1102 return 1;
1103}
1104
1105/*
1106 * Issue an Address Device command (which will issue a SetAddress request to
1107 * the device).
1108 * We should be protected by the usb_address0_mutex in khubd's hub_port_init, so
1109 * we should only issue and wait on one address command at the same time.
1110 *
1111 * We add one to the device address issued by the hardware because the USB core
1112 * uses address 1 for the root hubs (even though they're not really devices).
1113 */
1114int xhci_address_device(struct usb_hcd *hcd, struct usb_device *udev)
1115{
1116 unsigned long flags;
1117 int timeleft;
1118 struct xhci_virt_device *virt_dev;
1119 int ret = 0;
1120 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
1121 u32 temp;
1122
1123 if (!udev->slot_id) {
1124 xhci_dbg(xhci, "Bad Slot ID %d\n", udev->slot_id);
1125 return -EINVAL;
1126 }
1127
1128 spin_lock_irqsave(&xhci->lock, flags);
1129 virt_dev = xhci->devs[udev->slot_id];
1130
1131 /* If this is a Set Address to an unconfigured device, setup ep 0 */
1132 if (!udev->config)
1133 xhci_setup_addressable_virt_dev(xhci, udev);
1134 /* Otherwise, assume the core has the device configured how it wants */
1135
Sarah Sharp23e3be12009-04-29 19:05:20 -07001136 ret = xhci_queue_address_device(xhci, virt_dev->in_ctx_dma,
1137 udev->slot_id);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001138 if (ret) {
1139 spin_unlock_irqrestore(&xhci->lock, flags);
1140 xhci_dbg(xhci, "FIXME: allocate a command ring segment\n");
1141 return ret;
1142 }
Sarah Sharp23e3be12009-04-29 19:05:20 -07001143 xhci_ring_cmd_db(xhci);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001144 spin_unlock_irqrestore(&xhci->lock, flags);
1145
1146 /* ctrl tx can take up to 5 sec; XXX: need more time for xHC? */
1147 timeleft = wait_for_completion_interruptible_timeout(&xhci->addr_dev,
1148 USB_CTRL_SET_TIMEOUT);
1149 /* FIXME: From section 4.3.4: "Software shall be responsible for timing
1150 * the SetAddress() "recovery interval" required by USB and aborting the
1151 * command on a timeout.
1152 */
1153 if (timeleft <= 0) {
1154 xhci_warn(xhci, "%s while waiting for a slot\n",
1155 timeleft == 0 ? "Timeout" : "Signal");
1156 /* FIXME cancel the address device command */
1157 return -ETIME;
1158 }
1159
1160 spin_lock_irqsave(&xhci->lock, flags);
1161 switch (virt_dev->cmd_status) {
1162 case COMP_CTX_STATE:
1163 case COMP_EBADSLT:
1164 xhci_err(xhci, "Setup ERROR: address device command for slot %d.\n",
1165 udev->slot_id);
1166 ret = -EINVAL;
1167 break;
1168 case COMP_TX_ERR:
1169 dev_warn(&udev->dev, "Device not responding to set address.\n");
1170 ret = -EPROTO;
1171 break;
1172 case COMP_SUCCESS:
1173 xhci_dbg(xhci, "Successful Address Device command\n");
1174 break;
1175 default:
1176 xhci_err(xhci, "ERROR: unexpected command completion "
1177 "code 0x%x.\n", virt_dev->cmd_status);
1178 ret = -EINVAL;
1179 break;
1180 }
1181 if (ret) {
1182 spin_unlock_irqrestore(&xhci->lock, flags);
1183 return ret;
1184 }
1185 temp = xhci_readl(xhci, &xhci->op_regs->dcbaa_ptr[0]);
1186 xhci_dbg(xhci, "Op regs DCBAA ptr[0] = %#08x\n", temp);
1187 temp = xhci_readl(xhci, &xhci->op_regs->dcbaa_ptr[1]);
1188 xhci_dbg(xhci, "Op regs DCBAA ptr[1] = %#08x\n", temp);
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -07001189 xhci_dbg(xhci, "Slot ID %d dcbaa entry[0] @%p = %#08x\n",
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001190 udev->slot_id,
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -07001191 &xhci->dcbaa->dev_context_ptrs[2*udev->slot_id],
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001192 xhci->dcbaa->dev_context_ptrs[2*udev->slot_id]);
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -07001193 xhci_dbg(xhci, "Slot ID %d dcbaa entry[1] @%p = %#08x\n",
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001194 udev->slot_id,
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -07001195 &xhci->dcbaa->dev_context_ptrs[2*udev->slot_id+1],
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001196 xhci->dcbaa->dev_context_ptrs[2*udev->slot_id+1]);
Greg Kroah-Hartman700e2052009-04-29 19:14:08 -07001197 xhci_dbg(xhci, "Output Context DMA address = %#08llx\n",
1198 (unsigned long long)virt_dev->out_ctx_dma);
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001199 xhci_dbg(xhci, "Slot ID %d Input Context:\n", udev->slot_id);
1200 xhci_dbg_ctx(xhci, virt_dev->in_ctx, virt_dev->in_ctx_dma, 2);
1201 xhci_dbg(xhci, "Slot ID %d Output Context:\n", udev->slot_id);
1202 xhci_dbg_ctx(xhci, virt_dev->out_ctx, virt_dev->out_ctx_dma, 2);
1203 /*
1204 * USB core uses address 1 for the roothubs, so we add one to the
1205 * address given back to us by the HC.
1206 */
1207 udev->devnum = (virt_dev->out_ctx->slot.dev_state & DEV_ADDR_MASK) + 1;
Sarah Sharpf94e01862009-04-27 19:58:38 -07001208 /* Zero the input context control for later use */
1209 virt_dev->in_ctx->add_flags = 0;
1210 virt_dev->in_ctx->drop_flags = 0;
1211 /* Mirror flags in the output context for future ep enable/disable */
1212 virt_dev->out_ctx->add_flags = SLOT_FLAG | EP0_FLAG;
1213 virt_dev->out_ctx->drop_flags = 0;
Sarah Sharp3ffbba92009-04-27 19:57:38 -07001214 spin_unlock_irqrestore(&xhci->lock, flags);
1215
1216 xhci_dbg(xhci, "Device address = %d\n", udev->devnum);
1217 /* XXX Meh, not sure if anyone else but choose_address uses this. */
1218 set_bit(udev->devnum, udev->bus->devmap.devicemap);
1219
1220 return 0;
1221}
1222
Sarah Sharp66d4ead2009-04-27 19:52:28 -07001223int xhci_get_frame(struct usb_hcd *hcd)
1224{
1225 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
1226 /* EHCI mods by the periodic size. Why? */
1227 return xhci_readl(xhci, &xhci->run_regs->microframe_index) >> 3;
1228}
1229
1230MODULE_DESCRIPTION(DRIVER_DESC);
1231MODULE_AUTHOR(DRIVER_AUTHOR);
1232MODULE_LICENSE("GPL");
1233
1234static int __init xhci_hcd_init(void)
1235{
1236#ifdef CONFIG_PCI
1237 int retval = 0;
1238
1239 retval = xhci_register_pci();
1240
1241 if (retval < 0) {
1242 printk(KERN_DEBUG "Problem registering PCI driver.");
1243 return retval;
1244 }
1245#endif
Sarah Sharp98441972009-05-14 11:44:18 -07001246 /*
1247 * Check the compiler generated sizes of structures that must be laid
1248 * out in specific ways for hardware access.
1249 */
1250 BUILD_BUG_ON(sizeof(struct xhci_doorbell_array) != 256*32/8);
1251 BUILD_BUG_ON(sizeof(struct xhci_slot_ctx) != 8*32/8);
1252 BUILD_BUG_ON(sizeof(struct xhci_ep_ctx) != 8*32/8);
1253 /* xhci_device_control has eight fields, and also
1254 * embeds one xhci_slot_ctx and 31 xhci_ep_ctx
1255 */
1256 BUILD_BUG_ON(sizeof(struct xhci_device_control) != (8+8+8*31)*32/8);
1257 BUILD_BUG_ON(sizeof(struct xhci_stream_ctx) != 4*32/8);
1258 BUILD_BUG_ON(sizeof(union xhci_trb) != 4*32/8);
1259 BUILD_BUG_ON(sizeof(struct xhci_erst_entry) != 4*32/8);
1260 BUILD_BUG_ON(sizeof(struct xhci_cap_regs) != 7*32/8);
1261 BUILD_BUG_ON(sizeof(struct xhci_intr_reg) != 8*32/8);
1262 /* xhci_run_regs has eight fields and embeds 128 xhci_intr_regs */
1263 BUILD_BUG_ON(sizeof(struct xhci_run_regs) != (8+8*128)*32/8);
1264 BUILD_BUG_ON(sizeof(struct xhci_doorbell_array) != 256*32/8);
Sarah Sharp66d4ead2009-04-27 19:52:28 -07001265 return 0;
1266}
1267module_init(xhci_hcd_init);
1268
1269static void __exit xhci_hcd_cleanup(void)
1270{
1271#ifdef CONFIG_PCI
1272 xhci_unregister_pci();
1273#endif
1274}
1275module_exit(xhci_hcd_cleanup);