]>
git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/usb/host/xhci-hcd.c
2 * xHCI host controller driver
4 * Copyright (C) 2008 Intel Corp.
7 * Some code borrowed from the Linux EHCI driver.
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.
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
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.
23 #include <linux/irq.h>
24 #include <linux/module.h>
28 #define DRIVER_AUTHOR "Sarah Sharp"
29 #define DRIVER_DESC "'eXtensible' Host Controller (xHC) Driver"
31 /* TODO: copied from ehci-hcd.c - can this be refactored? */
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
39 * Returns negative errno, or zero on success
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).
45 static int handshake(struct xhci_hcd
*xhci
, void __iomem
*ptr
,
46 u32 mask
, u32 done
, int usec
)
51 result
= xhci_readl(xhci
, ptr
);
52 if (result
== ~(u32
)0) /* card removed */
64 * Force HC into halt state.
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?
72 int xhci_halt(struct xhci_hcd
*xhci
)
78 xhci_dbg(xhci
, "// Halt the HC\n");
79 /* Disable all interrupts from the host controller */
81 halted
= xhci_readl(xhci
, &xhci
->op_regs
->status
) & STS_HALT
;
85 cmd
= xhci_readl(xhci
, &xhci
->op_regs
->command
);
87 xhci_writel(xhci
, cmd
, &xhci
->op_regs
->command
);
89 return handshake(xhci
, &xhci
->op_regs
->status
,
90 STS_HALT
, STS_HALT
, XHCI_MAX_HALT_USEC
);
94 * Reset a halted HC, and set the internal HC state to HC_STATE_HALT.
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.
100 int xhci_reset(struct xhci_hcd
*xhci
)
105 state
= xhci_readl(xhci
, &xhci
->op_regs
->status
);
106 BUG_ON((state
& STS_HALT
) == 0);
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
;
115 return handshake(xhci
, &xhci
->op_regs
->command
, CMD_RESET
, 0, 250 * 1000);
119 * Stop the HC from processing the endpoint queues.
121 static void xhci_quiesce(struct xhci_hcd
*xhci
)
124 * Queues are per endpoint, so we need to disable an endpoint or slot.
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).
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.
135 * TODO: Implement after command ring code is done.
137 BUG_ON(!HC_IS_RUNNING(xhci_to_hcd(xhci
)->state
));
138 xhci_dbg(xhci
, "Finished quiescing -- code not written yet\n");
142 /* Set up MSI-X table for entry 0 (may claim other entries later) */
143 static int xhci_setup_msix(struct xhci_hcd
*xhci
)
146 struct pci_dev
*pdev
= to_pci_dev(xhci_to_hcd(xhci
)->self
.controller
);
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");
155 xhci
->msix_entries
[0].entry
= 0;
157 ret
= pci_enable_msix(pdev
, xhci
->msix_entries
, xhci
->msix_count
);
159 xhci_err(xhci
, "Failed to enable MSI-X\n");
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.
167 ret
= request_irq(xhci
->msix_entries
[0].vector
, &xhci_irq
, 0,
168 "xHCI", xhci_to_hcd(xhci
));
170 xhci_err(xhci
, "Failed to allocate MSI-X interrupt\n");
173 xhci_dbg(xhci
, "Finished setting up MSI-X\n");
177 pci_disable_msix(pdev
);
179 kfree(xhci
->msix_entries
);
180 xhci
->msix_entries
= NULL
;
184 /* XXX: code duplication; can xhci_setup_msix call this? */
185 /* Free any IRQs and disable MSI-X */
186 static void xhci_cleanup_msix(struct xhci_hcd
*xhci
)
188 struct pci_dev
*pdev
= to_pci_dev(xhci_to_hcd(xhci
)->self
.controller
);
189 if (!xhci
->msix_entries
)
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");
201 * Initialize memory for HCD and xHC (one-time init).
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).
207 int xhci_init(struct usb_hcd
*hcd
)
209 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
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");
221 * Called in interrupt context when there might be work
222 * queued on the event ring
224 * xhci->lock must be held by caller.
226 static void xhci_work(struct xhci_hcd
*xhci
)
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.
235 temp
= xhci_readl(xhci
, &xhci
->op_regs
->status
);
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 */
241 /* Acknowledge the interrupt */
242 temp
= xhci_readl(xhci
, &xhci
->ir_set
->irq_pending
);
244 xhci_writel(xhci
, temp
, &xhci
->ir_set
->irq_pending
);
245 /* Flush posted writes */
246 xhci_readl(xhci
, &xhci
->ir_set
->irq_pending
);
248 /* FIXME this should be a delayed service routine that clears the EHB */
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
);
258 /*-------------------------------------------------------------------------*/
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.
265 irqreturn_t
xhci_irq(struct usb_hcd
*hcd
)
267 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
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
);
279 temp
= xhci_readl(xhci
, &xhci
->op_regs
->status
);
280 if (temp
& STS_FATAL
) {
281 xhci_warn(xhci
, "WARNING: Host System Error\n");
283 xhci_to_hcd(xhci
)->state
= HC_STATE_HALT
;
288 spin_unlock(&xhci
->lock
);
293 #ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
294 void event_ring_work(unsigned long arg
)
298 struct xhci_hcd
*xhci
= (struct xhci_hcd
*) arg
;
301 xhci_dbg(xhci
, "Poll event ring: %lu\n", jiffies
);
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
);
321 for (i
= 0; i
< MAX_HC_SLOTS
; ++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
);
332 if (xhci
->noops_submitted
!= NUM_TEST_NOOPS
)
333 if (setup_one_noop(xhci
))
335 spin_unlock_irqrestore(&xhci
->lock
, flags
);
338 mod_timer(&xhci
->event_ring_timer
, jiffies
+ POLL_TIMEOUT
* HZ
);
340 xhci_dbg(xhci
, "Quit polling the event ring.\n");
345 * Start the HC after it was halted.
347 * This function is called by the USB core when the HC driver is added.
348 * Its opposite is xhci_stop().
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.
354 * Setup MSI-X vectors and enable interrupts.
356 int xhci_run(struct usb_hcd
*hcd
)
359 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
360 void (*doorbell
)(struct xhci_hcd
*) = NULL
;
362 hcd
->uses_new_polling
= 1;
365 xhci_dbg(xhci
, "xhci_run\n");
366 #if 0 /* FIXME: MSI not setup yet */
367 /* Do this at the very last minute */
368 ret
= xhci_setup_msix(xhci
);
374 #ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
375 init_timer(&xhci
->event_ring_timer
);
376 xhci
->event_ring_timer
.data
= (unsigned long) xhci
;
377 xhci
->event_ring_timer
.function
= event_ring_work
;
378 /* Poll the event ring */
379 xhci
->event_ring_timer
.expires
= jiffies
+ POLL_TIMEOUT
* HZ
;
381 xhci_dbg(xhci
, "Setting event ring polling timer\n");
382 add_timer(&xhci
->event_ring_timer
);
385 xhci_dbg(xhci
, "// Set the interrupt modulation register\n");
386 temp
= xhci_readl(xhci
, &xhci
->ir_set
->irq_control
);
389 xhci_writel(xhci
, temp
, &xhci
->ir_set
->irq_control
);
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
);
395 xhci_dbg(xhci
, "// Enable interrupts, cmd = 0x%x.\n",
397 xhci_writel(xhci
, temp
, &xhci
->op_regs
->command
);
399 temp
= xhci_readl(xhci
, &xhci
->ir_set
->irq_pending
);
400 xhci_dbg(xhci
, "// Enabling event ring interrupter 0x%x"
401 " by writing 0x%x to irq_pending\n",
402 (unsigned int) xhci
->ir_set
,
403 (unsigned int) ER_IRQ_ENABLE(temp
));
404 xhci_writel(xhci
, ER_IRQ_ENABLE(temp
),
405 &xhci
->ir_set
->irq_pending
);
406 xhci_print_ir_set(xhci
, xhci
->ir_set
, 0);
408 if (NUM_TEST_NOOPS
> 0)
409 doorbell
= setup_one_noop(xhci
);
411 xhci_dbg(xhci
, "Command ring memory map follows:\n");
412 xhci_debug_ring(xhci
, xhci
->cmd_ring
);
413 xhci_dbg_ring_ptrs(xhci
, xhci
->cmd_ring
);
414 xhci_dbg_cmd_ptrs(xhci
);
416 xhci_dbg(xhci
, "ERST memory map follows:\n");
417 xhci_dbg_erst(xhci
, &xhci
->erst
);
418 xhci_dbg(xhci
, "Event ring:\n");
419 xhci_debug_ring(xhci
, xhci
->event_ring
);
420 xhci_dbg_ring_ptrs(xhci
, xhci
->event_ring
);
421 temp
= xhci_readl(xhci
, &xhci
->ir_set
->erst_dequeue
[1]);
422 xhci_dbg(xhci
, "ERST deq upper = 0x%x\n", temp
);
423 temp
= xhci_readl(xhci
, &xhci
->ir_set
->erst_dequeue
[0]);
424 temp
&= ERST_PTR_MASK
;
425 xhci_dbg(xhci
, "ERST deq = 0x%x\n", temp
);
427 temp
= xhci_readl(xhci
, &xhci
->op_regs
->command
);
429 xhci_dbg(xhci
, "// Turn on HC, cmd = 0x%x.\n",
431 xhci_writel(xhci
, temp
, &xhci
->op_regs
->command
);
432 /* Flush PCI posted writes */
433 temp
= xhci_readl(xhci
, &xhci
->op_regs
->command
);
434 xhci_dbg(xhci
, "// @%x = 0x%x\n",
435 (unsigned int) &xhci
->op_regs
->command
, temp
);
439 xhci_dbg(xhci
, "Finished xhci_run\n");
446 * This function is called by the USB core when the HC driver is removed.
447 * Its opposite is xhci_run().
449 * Disable device contexts, disable IRQs, and quiesce the HC.
450 * Reset the HC, finish any completed transactions, and cleanup memory.
452 void xhci_stop(struct usb_hcd
*hcd
)
455 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
457 spin_lock_irq(&xhci
->lock
);
458 if (HC_IS_RUNNING(hcd
->state
))
462 spin_unlock_irq(&xhci
->lock
);
464 #if 0 /* No MSI yet */
465 xhci_cleanup_msix(xhci
);
467 #ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
468 /* Tell the event ring poll function not to reschedule */
470 del_timer_sync(&xhci
->event_ring_timer
);
473 xhci_dbg(xhci
, "// Disabling event ring interrupts\n");
474 temp
= xhci_readl(xhci
, &xhci
->op_regs
->status
);
475 xhci_writel(xhci
, temp
& ~STS_EINT
, &xhci
->op_regs
->status
);
476 temp
= xhci_readl(xhci
, &xhci
->ir_set
->irq_pending
);
477 xhci_writel(xhci
, ER_IRQ_DISABLE(temp
),
478 &xhci
->ir_set
->irq_pending
);
479 xhci_print_ir_set(xhci
, xhci
->ir_set
, 0);
481 xhci_dbg(xhci
, "cleaning up memory\n");
482 xhci_mem_cleanup(xhci
);
483 xhci_dbg(xhci
, "xhci_stop completed - status = %x\n",
484 xhci_readl(xhci
, &xhci
->op_regs
->status
));
488 * Shutdown HC (not bus-specific)
490 * This is called when the machine is rebooting or halting. We assume that the
491 * machine will be powered off, and the HC's internal state will be reset.
492 * Don't bother to free memory.
494 void xhci_shutdown(struct usb_hcd
*hcd
)
496 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
498 spin_lock_irq(&xhci
->lock
);
500 spin_unlock_irq(&xhci
->lock
);
503 xhci_cleanup_msix(xhci
);
506 xhci_dbg(xhci
, "xhci_shutdown completed - status = %x\n",
507 xhci_readl(xhci
, &xhci
->op_regs
->status
));
510 /*-------------------------------------------------------------------------*/
513 * xhci_get_endpoint_index - Used for passing endpoint bitmasks between the core and
514 * HCDs. Find the index for an endpoint given its descriptor. Use the return
515 * value to right shift 1 for the bitmask.
517 * Index = (epnum * 2) + direction - 1,
518 * where direction = 0 for OUT, 1 for IN.
519 * For control endpoints, the IN index is used (OUT index is unused), so
520 * index = (epnum * 2) + direction - 1 = (epnum * 2) + 1 - 1 = (epnum * 2)
522 unsigned int xhci_get_endpoint_index(struct usb_endpoint_descriptor
*desc
)
525 if (usb_endpoint_xfer_control(desc
))
526 index
= (unsigned int) (usb_endpoint_num(desc
)*2);
528 index
= (unsigned int) (usb_endpoint_num(desc
)*2) +
529 (usb_endpoint_dir_in(desc
) ? 1 : 0) - 1;
533 /* Returns 1 if the arguments are OK;
534 * returns 0 this is a root hub; returns -EINVAL for NULL pointers.
536 int xhci_check_args(struct usb_hcd
*hcd
, struct usb_device
*udev
,
537 struct usb_host_endpoint
*ep
, int check_ep
, const char *func
) {
538 if (!hcd
|| (check_ep
&& !ep
) || !udev
) {
539 printk(KERN_DEBUG
"xHCI %s called with invalid args\n",
544 printk(KERN_DEBUG
"xHCI %s called for root hub\n",
548 if (!udev
->slot_id
) {
549 printk(KERN_DEBUG
"xHCI %s called with unaddressed device\n",
557 * non-error returns are a promise to giveback() the urb later
558 * we drop ownership so next owner (or urb unlink) can get it
560 int xhci_urb_enqueue(struct usb_hcd
*hcd
, struct urb
*urb
, gfp_t mem_flags
)
562 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
565 unsigned int slot_id
, ep_index
;
567 if (!urb
|| xhci_check_args(hcd
, urb
->dev
, urb
->ep
, true, __func__
) <= 0)
570 slot_id
= urb
->dev
->slot_id
;
571 ep_index
= xhci_get_endpoint_index(&urb
->ep
->desc
);
572 /* Only support ep 0 control transfers for now */
574 xhci_dbg(xhci
, "WARN: urb submitted to unsupported ep %x\n",
575 urb
->ep
->desc
.bEndpointAddress
);
579 spin_lock_irqsave(&xhci
->lock
, flags
);
580 if (!xhci
->devs
|| !xhci
->devs
[slot_id
]) {
582 dev_warn(&urb
->dev
->dev
, "WARN: urb submitted for dev with no Slot ID\n");
585 if (!test_bit(HCD_FLAG_HW_ACCESSIBLE
, &hcd
->flags
)) {
587 xhci_dbg(xhci
, "urb submitted during PCI suspend\n");
591 ret
= queue_ctrl_tx(xhci
, mem_flags
, urb
, slot_id
, ep_index
);
593 spin_unlock_irqrestore(&xhci
->lock
, flags
);
597 /* Remove from hardware lists
598 * completions normally happen asynchronously
600 int xhci_urb_dequeue(struct usb_hcd
*hcd
, struct urb
*urb
, int status
)
606 * At this point, the struct usb_device is about to go away, the device has
607 * disconnected, and all traffic has been stopped and the endpoints have been
608 * disabled. Free any HC data structures associated with that device.
610 void xhci_free_dev(struct usb_hcd
*hcd
, struct usb_device
*udev
)
612 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
615 if (udev
->slot_id
== 0)
618 spin_lock_irqsave(&xhci
->lock
, flags
);
619 if (queue_slot_control(xhci
, TRB_DISABLE_SLOT
, udev
->slot_id
)) {
620 spin_unlock_irqrestore(&xhci
->lock
, flags
);
621 xhci_dbg(xhci
, "FIXME: allocate a command ring segment\n");
625 spin_unlock_irqrestore(&xhci
->lock
, flags
);
627 * Event command completion handler will free any data structures
628 * associated with the slot
633 * Returns 0 if the xHC ran out of device slots, the Enable Slot command
634 * timed out, or allocating memory failed. Returns 1 on success.
636 int xhci_alloc_dev(struct usb_hcd
*hcd
, struct usb_device
*udev
)
638 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
643 spin_lock_irqsave(&xhci
->lock
, flags
);
644 ret
= queue_slot_control(xhci
, TRB_ENABLE_SLOT
, 0);
646 spin_unlock_irqrestore(&xhci
->lock
, flags
);
647 xhci_dbg(xhci
, "FIXME: allocate a command ring segment\n");
651 spin_unlock_irqrestore(&xhci
->lock
, flags
);
653 /* XXX: how much time for xHC slot assignment? */
654 timeleft
= wait_for_completion_interruptible_timeout(&xhci
->addr_dev
,
655 USB_CTRL_SET_TIMEOUT
);
657 xhci_warn(xhci
, "%s while waiting for a slot\n",
658 timeleft
== 0 ? "Timeout" : "Signal");
659 /* FIXME cancel the enable slot request */
663 spin_lock_irqsave(&xhci
->lock
, flags
);
664 if (!xhci
->slot_id
) {
665 xhci_err(xhci
, "Error while assigning device slot ID\n");
666 spin_unlock_irqrestore(&xhci
->lock
, flags
);
669 if (!xhci_alloc_virt_device(xhci
, xhci
->slot_id
, udev
, GFP_KERNEL
)) {
670 /* Disable slot, if we can do it without mem alloc */
671 xhci_warn(xhci
, "Could not allocate xHCI USB device data structures\n");
672 if (!queue_slot_control(xhci
, TRB_DISABLE_SLOT
, udev
->slot_id
))
674 spin_unlock_irqrestore(&xhci
->lock
, flags
);
677 udev
->slot_id
= xhci
->slot_id
;
678 /* Is this a LS or FS device under a HS hub? */
679 /* Hub or peripherial? */
680 spin_unlock_irqrestore(&xhci
->lock
, flags
);
685 * Issue an Address Device command (which will issue a SetAddress request to
687 * We should be protected by the usb_address0_mutex in khubd's hub_port_init, so
688 * we should only issue and wait on one address command at the same time.
690 * We add one to the device address issued by the hardware because the USB core
691 * uses address 1 for the root hubs (even though they're not really devices).
693 int xhci_address_device(struct usb_hcd
*hcd
, struct usb_device
*udev
)
697 struct xhci_virt_device
*virt_dev
;
699 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
702 if (!udev
->slot_id
) {
703 xhci_dbg(xhci
, "Bad Slot ID %d\n", udev
->slot_id
);
707 spin_lock_irqsave(&xhci
->lock
, flags
);
708 virt_dev
= xhci
->devs
[udev
->slot_id
];
710 /* If this is a Set Address to an unconfigured device, setup ep 0 */
712 xhci_setup_addressable_virt_dev(xhci
, udev
);
713 /* Otherwise, assume the core has the device configured how it wants */
715 ret
= queue_address_device(xhci
, virt_dev
->in_ctx_dma
, udev
->slot_id
);
717 spin_unlock_irqrestore(&xhci
->lock
, flags
);
718 xhci_dbg(xhci
, "FIXME: allocate a command ring segment\n");
722 spin_unlock_irqrestore(&xhci
->lock
, flags
);
724 /* ctrl tx can take up to 5 sec; XXX: need more time for xHC? */
725 timeleft
= wait_for_completion_interruptible_timeout(&xhci
->addr_dev
,
726 USB_CTRL_SET_TIMEOUT
);
727 /* FIXME: From section 4.3.4: "Software shall be responsible for timing
728 * the SetAddress() "recovery interval" required by USB and aborting the
729 * command on a timeout.
732 xhci_warn(xhci
, "%s while waiting for a slot\n",
733 timeleft
== 0 ? "Timeout" : "Signal");
734 /* FIXME cancel the address device command */
738 spin_lock_irqsave(&xhci
->lock
, flags
);
739 switch (virt_dev
->cmd_status
) {
742 xhci_err(xhci
, "Setup ERROR: address device command for slot %d.\n",
747 dev_warn(&udev
->dev
, "Device not responding to set address.\n");
751 xhci_dbg(xhci
, "Successful Address Device command\n");
754 xhci_err(xhci
, "ERROR: unexpected command completion "
755 "code 0x%x.\n", virt_dev
->cmd_status
);
760 spin_unlock_irqrestore(&xhci
->lock
, flags
);
763 temp
= xhci_readl(xhci
, &xhci
->op_regs
->dcbaa_ptr
[0]);
764 xhci_dbg(xhci
, "Op regs DCBAA ptr[0] = %#08x\n", temp
);
765 temp
= xhci_readl(xhci
, &xhci
->op_regs
->dcbaa_ptr
[1]);
766 xhci_dbg(xhci
, "Op regs DCBAA ptr[1] = %#08x\n", temp
);
767 xhci_dbg(xhci
, "Slot ID %d dcbaa entry[0] @%08x = %#08x\n",
769 (unsigned int) &xhci
->dcbaa
->dev_context_ptrs
[2*udev
->slot_id
],
770 xhci
->dcbaa
->dev_context_ptrs
[2*udev
->slot_id
]);
771 xhci_dbg(xhci
, "Slot ID %d dcbaa entry[1] @%08x = %#08x\n",
773 (unsigned int) &xhci
->dcbaa
->dev_context_ptrs
[2*udev
->slot_id
+1],
774 xhci
->dcbaa
->dev_context_ptrs
[2*udev
->slot_id
+1]);
775 xhci_dbg(xhci
, "Output Context DMA address = %#08x\n",
776 virt_dev
->out_ctx_dma
);
777 xhci_dbg(xhci
, "Slot ID %d Input Context:\n", udev
->slot_id
);
778 xhci_dbg_ctx(xhci
, virt_dev
->in_ctx
, virt_dev
->in_ctx_dma
, 2);
779 xhci_dbg(xhci
, "Slot ID %d Output Context:\n", udev
->slot_id
);
780 xhci_dbg_ctx(xhci
, virt_dev
->out_ctx
, virt_dev
->out_ctx_dma
, 2);
782 * USB core uses address 1 for the roothubs, so we add one to the
783 * address given back to us by the HC.
785 udev
->devnum
= (virt_dev
->out_ctx
->slot
.dev_state
& DEV_ADDR_MASK
) + 1;
786 /* FIXME: Zero the input context control for later use? */
787 spin_unlock_irqrestore(&xhci
->lock
, flags
);
789 xhci_dbg(xhci
, "Device address = %d\n", udev
->devnum
);
790 /* XXX Meh, not sure if anyone else but choose_address uses this. */
791 set_bit(udev
->devnum
, udev
->bus
->devmap
.devicemap
);
796 int xhci_get_frame(struct usb_hcd
*hcd
)
798 struct xhci_hcd
*xhci
= hcd_to_xhci(hcd
);
799 /* EHCI mods by the periodic size. Why? */
800 return xhci_readl(xhci
, &xhci
->run_regs
->microframe_index
) >> 3;
803 MODULE_DESCRIPTION(DRIVER_DESC
);
804 MODULE_AUTHOR(DRIVER_AUTHOR
);
805 MODULE_LICENSE("GPL");
807 static int __init
xhci_hcd_init(void)
812 retval
= xhci_register_pci();
815 printk(KERN_DEBUG
"Problem registering PCI driver.");
821 module_init(xhci_hcd_init
);
823 static void __exit
xhci_hcd_cleanup(void)
826 xhci_unregister_pci();
829 module_exit(xhci_hcd_cleanup
);