2009-04-28 06:52:28 +04:00
/*
* xHCI host controller driver
*
* Copyright ( C ) 2008 Intel Corp .
*
* Author : Sarah Sharp
* Some code borrowed from the Linux EHCI driver .
*
* This program is free software ; you can redistribute it and / or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation .
*
* This program is distributed in the hope that it will be useful , but
* WITHOUT ANY WARRANTY ; without even the implied warranty of MERCHANTABILITY
* or FITNESS FOR A PARTICULAR PURPOSE . See the GNU General Public License
* for more details .
*
* You should have received a copy of the GNU General Public License
* along with this program ; if not , write to the Free Software Foundation ,
* Inc . , 675 Mass Ave , Cambridge , MA 0213 9 , USA .
*/
# include <linux/irq.h>
# include <linux/module.h>
# include "xhci.h"
# define DRIVER_AUTHOR "Sarah Sharp"
# define DRIVER_DESC "'eXtensible' Host Controller (xHC) Driver"
/* TODO: copied from ehci-hcd.c - can this be refactored? */
/*
* handshake - spin reading hc until handshake completes or fails
* @ ptr : address of hc register to be read
* @ mask : bits to look at in result of read
* @ done : value of those bits when handshake succeeds
* @ usec : timeout in microseconds
*
* Returns negative errno , or zero on success
*
* Success happens when the " mask " bits have the specified value ( hardware
* handshake done ) . There are two failure modes : " usec " have passed ( major
* hardware flakeout ) , or the register reads as all - ones ( hardware removed ) .
*/
static int handshake ( struct xhci_hcd * xhci , void __iomem * ptr ,
u32 mask , u32 done , int usec )
{
u32 result ;
do {
result = xhci_readl ( xhci , ptr ) ;
if ( result = = ~ ( u32 ) 0 ) /* card removed */
return - ENODEV ;
result & = mask ;
if ( result = = done )
return 0 ;
udelay ( 1 ) ;
usec - - ;
} while ( usec > 0 ) ;
return - ETIMEDOUT ;
}
/*
* Force HC into halt state .
*
* Disable any IRQs and clear the run / stop bit .
* HC will complete any current and actively pipelined transactions , and
* should halt within 16 microframes of the run / stop bit being cleared .
* Read HC Halted bit in the status register to see when the HC is finished .
* XXX : shouldn ' t we set HC_STATE_HALT here somewhere ?
*/
int xhci_halt ( struct xhci_hcd * xhci )
{
u32 halted ;
u32 cmd ;
u32 mask ;
xhci_dbg ( xhci , " // Halt the HC \n " ) ;
/* Disable all interrupts from the host controller */
mask = ~ ( XHCI_IRQS ) ;
halted = xhci_readl ( xhci , & xhci - > op_regs - > status ) & STS_HALT ;
if ( ! halted )
mask & = ~ CMD_RUN ;
cmd = xhci_readl ( xhci , & xhci - > op_regs - > command ) ;
cmd & = mask ;
xhci_writel ( xhci , cmd , & xhci - > op_regs - > command ) ;
return handshake ( xhci , & xhci - > op_regs - > status ,
STS_HALT , STS_HALT , XHCI_MAX_HALT_USEC ) ;
}
/*
* Reset a halted HC , and set the internal HC state to HC_STATE_HALT .
*
* This resets pipelines , timers , counters , state machines , etc .
* Transactions will be terminated immediately , and operational registers
* will be set to their defaults .
*/
int xhci_reset ( struct xhci_hcd * xhci )
{
u32 command ;
u32 state ;
state = xhci_readl ( xhci , & xhci - > op_regs - > status ) ;
BUG_ON ( ( state & STS_HALT ) = = 0 ) ;
xhci_dbg ( xhci , " // Reset the HC \n " ) ;
command = xhci_readl ( xhci , & xhci - > op_regs - > command ) ;
command | = CMD_RESET ;
xhci_writel ( xhci , command , & xhci - > op_regs - > command ) ;
/* XXX: Why does EHCI set this here? Shouldn't other code do this? */
xhci_to_hcd ( xhci ) - > state = HC_STATE_HALT ;
return handshake ( xhci , & xhci - > op_regs - > command , CMD_RESET , 0 , 250 * 1000 ) ;
}
/*
* Stop the HC from processing the endpoint queues .
*/
static void xhci_quiesce ( struct xhci_hcd * xhci )
{
/*
* Queues are per endpoint , so we need to disable an endpoint or slot .
*
* To disable a slot , we need to insert a disable slot command on the
* command ring and ring the doorbell . This will also free any internal
* resources associated with the slot ( which might not be what we want ) .
*
* A Release Endpoint command sounds better - doesn ' t free internal HC
* memory , but removes the endpoints from the schedule and releases the
* bandwidth , disables the doorbells , and clears the endpoint enable
* flag . Usually used prior to a set interface command .
*
* TODO : Implement after command ring code is done .
*/
BUG_ON ( ! HC_IS_RUNNING ( xhci_to_hcd ( xhci ) - > state ) ) ;
xhci_dbg ( xhci , " Finished quiescing -- code not written yet \n " ) ;
}
#if 0
/* Set up MSI-X table for entry 0 (may claim other entries later) */
static int xhci_setup_msix ( struct xhci_hcd * xhci )
{
int ret ;
struct pci_dev * pdev = to_pci_dev ( xhci_to_hcd ( xhci ) - > self . controller ) ;
xhci - > msix_count = 0 ;
/* XXX: did I do this right? ixgbe does kcalloc for more than one */
xhci - > msix_entries = kmalloc ( sizeof ( struct msix_entry ) , GFP_KERNEL ) ;
if ( ! xhci - > msix_entries ) {
xhci_err ( xhci , " Failed to allocate MSI-X entries \n " ) ;
return - ENOMEM ;
}
xhci - > msix_entries [ 0 ] . entry = 0 ;
ret = pci_enable_msix ( pdev , xhci - > msix_entries , xhci - > msix_count ) ;
if ( ret ) {
xhci_err ( xhci , " Failed to enable MSI-X \n " ) ;
goto free_entries ;
}
/*
* Pass the xhci pointer value as the request_irq " cookie " .
* If more irqs are added , this will need to be unique for each one .
*/
ret = request_irq ( xhci - > msix_entries [ 0 ] . vector , & xhci_irq , 0 ,
" xHCI " , xhci_to_hcd ( xhci ) ) ;
if ( ret ) {
xhci_err ( xhci , " Failed to allocate MSI-X interrupt \n " ) ;
goto disable_msix ;
}
xhci_dbg ( xhci , " Finished setting up MSI-X \n " ) ;
return 0 ;
disable_msix :
pci_disable_msix ( pdev ) ;
free_entries :
kfree ( xhci - > msix_entries ) ;
xhci - > msix_entries = NULL ;
return ret ;
}
/* XXX: code duplication; can xhci_setup_msix call this? */
/* Free any IRQs and disable MSI-X */
static void xhci_cleanup_msix ( struct xhci_hcd * xhci )
{
struct pci_dev * pdev = to_pci_dev ( xhci_to_hcd ( xhci ) - > self . controller ) ;
if ( ! xhci - > msix_entries )
return ;
free_irq ( xhci - > msix_entries [ 0 ] . vector , xhci ) ;
pci_disable_msix ( pdev ) ;
kfree ( xhci - > msix_entries ) ;
xhci - > msix_entries = NULL ;
xhci_dbg ( xhci , " Finished cleaning up MSI-X \n " ) ;
}
# endif
/*
* Initialize memory for HCD and xHC ( one - time init ) .
*
* Program the PAGESIZE register , initialize the device context array , create
* device contexts ( ? ) , set up a command ring segment ( or two ? ) , create event
* ring ( one for now ) .
*/
int xhci_init ( struct usb_hcd * hcd )
{
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
int retval = 0 ;
xhci_dbg ( xhci , " xhci_init \n " ) ;
spin_lock_init ( & xhci - > lock ) ;
retval = xhci_mem_init ( xhci , GFP_KERNEL ) ;
xhci_dbg ( xhci , " Finished xhci_init \n " ) ;
return retval ;
}
2009-04-28 06:53:56 +04:00
/*
* Called in interrupt context when there might be work
* queued on the event ring
*
* xhci - > lock must be held by caller .
*/
static void xhci_work ( struct xhci_hcd * xhci )
{
u32 temp ;
/*
* Clear the op reg interrupt status first ,
* so we can receive interrupts from other MSI - X interrupters .
* Write 1 to clear the interrupt status .
*/
temp = xhci_readl ( xhci , & xhci - > op_regs - > status ) ;
temp | = STS_EINT ;
xhci_writel ( xhci , temp , & xhci - > op_regs - > status ) ;
/* FIXME when MSI-X is supported and there are multiple vectors */
/* Clear the MSI-X event interrupt status */
/* Acknowledge the interrupt */
temp = xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
temp | = 0x3 ;
xhci_writel ( xhci , temp , & xhci - > ir_set - > irq_pending ) ;
/* Flush posted writes */
xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
/* FIXME this should be a delayed service routine that clears the EHB */
handle_event ( xhci ) ;
/* Clear the event handler busy flag; the event ring should be empty. */
temp = xhci_readl ( xhci , & xhci - > ir_set - > erst_dequeue [ 0 ] ) ;
xhci_writel ( xhci , temp & ~ ERST_EHB , & xhci - > ir_set - > erst_dequeue [ 0 ] ) ;
/* Flush posted writes -- FIXME is this necessary? */
xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
}
/*-------------------------------------------------------------------------*/
/*
* xHCI spec says we can get an interrupt , and if the HC has an error condition ,
* we might get bad data out of the event ring . Section 4.10 .2 .7 has a list of
* indicators of an event TRB error , but we check the status * first * to be safe .
*/
irqreturn_t xhci_irq ( struct usb_hcd * hcd )
{
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
u32 temp , temp2 ;
spin_lock ( & xhci - > lock ) ;
/* Check if the xHC generated the interrupt, or the irq is shared */
temp = xhci_readl ( xhci , & xhci - > op_regs - > status ) ;
temp2 = xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
if ( ! ( temp & STS_EINT ) & & ! ER_IRQ_PENDING ( temp2 ) ) {
spin_unlock ( & xhci - > lock ) ;
return IRQ_NONE ;
}
temp = xhci_readl ( xhci , & xhci - > op_regs - > status ) ;
if ( temp & STS_FATAL ) {
xhci_warn ( xhci , " WARNING: Host System Error \n " ) ;
xhci_halt ( xhci ) ;
xhci_to_hcd ( xhci ) - > state = HC_STATE_HALT ;
return - ESHUTDOWN ;
}
xhci_work ( xhci ) ;
spin_unlock ( & xhci - > lock ) ;
return IRQ_HANDLED ;
}
# ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
void event_ring_work ( unsigned long arg )
{
unsigned long flags ;
int temp ;
struct xhci_hcd * xhci = ( struct xhci_hcd * ) arg ;
int i , j ;
xhci_dbg ( xhci , " Poll event ring: %lu \n " , jiffies ) ;
spin_lock_irqsave ( & xhci - > lock , flags ) ;
temp = xhci_readl ( xhci , & xhci - > op_regs - > status ) ;
xhci_dbg ( xhci , " op reg status = 0x%x \n " , temp ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
xhci_dbg ( xhci , " ir_set 0 pending = 0x%x \n " , temp ) ;
xhci_dbg ( xhci , " No-op commands handled = %d \n " , xhci - > noops_handled ) ;
xhci_dbg ( xhci , " HC error bitmask = 0x%x \n " , xhci - > error_bitmask ) ;
xhci - > error_bitmask = 0 ;
xhci_dbg ( xhci , " Event ring: \n " ) ;
xhci_debug_segment ( xhci , xhci - > event_ring - > deq_seg ) ;
xhci_dbg_ring_ptrs ( xhci , xhci - > event_ring ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > erst_dequeue [ 0 ] ) ;
temp & = ERST_PTR_MASK ;
xhci_dbg ( xhci , " ERST deq = 0x%x \n " , temp ) ;
xhci_dbg ( xhci , " Command ring: \n " ) ;
xhci_debug_segment ( xhci , xhci - > cmd_ring - > deq_seg ) ;
xhci_dbg_ring_ptrs ( xhci , xhci - > cmd_ring ) ;
xhci_dbg_cmd_ptrs ( xhci ) ;
2009-04-28 06:57:38 +04:00
for ( i = 0 ; i < MAX_HC_SLOTS ; + + i ) {
if ( xhci - > devs [ i ] ) {
for ( j = 0 ; j < 31 ; + + j ) {
if ( xhci - > devs [ i ] - > ep_rings [ j ] ) {
xhci_dbg ( xhci , " Dev %d endpoint ring %d: \n " , i , j ) ;
xhci_debug_segment ( xhci , xhci - > devs [ i ] - > ep_rings [ j ] - > deq_seg ) ;
}
}
}
}
2009-04-28 06:53:56 +04:00
if ( xhci - > noops_submitted ! = NUM_TEST_NOOPS )
if ( setup_one_noop ( xhci ) )
ring_cmd_db ( xhci ) ;
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
if ( ! xhci - > zombie )
mod_timer ( & xhci - > event_ring_timer , jiffies + POLL_TIMEOUT * HZ ) ;
else
xhci_dbg ( xhci , " Quit polling the event ring. \n " ) ;
}
# endif
2009-04-28 06:52:28 +04:00
/*
* Start the HC after it was halted .
*
* This function is called by the USB core when the HC driver is added .
* Its opposite is xhci_stop ( ) .
*
* xhci_init ( ) must be called once before this function can be called .
* Reset the HC , enable device slot contexts , program DCBAAP , and
* set command ring pointer and event ring pointer .
*
* Setup MSI - X vectors and enable interrupts .
*/
int xhci_run ( struct usb_hcd * hcd )
{
u32 temp ;
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
2009-04-28 06:53:56 +04:00
void ( * doorbell ) ( struct xhci_hcd * ) = NULL ;
2009-04-28 06:52:28 +04:00
2009-04-28 06:57:12 +04:00
hcd - > uses_new_polling = 1 ;
hcd - > poll_rh = 0 ;
2009-04-28 06:53:56 +04:00
xhci_dbg ( xhci , " xhci_run \n " ) ;
2009-04-28 06:52:28 +04:00
#if 0 /* FIXME: MSI not setup yet */
/* Do this at the very last minute */
ret = xhci_setup_msix ( xhci ) ;
if ( ! ret )
return ret ;
return - ENOSYS ;
# endif
2009-04-28 06:53:56 +04:00
# ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
init_timer ( & xhci - > event_ring_timer ) ;
xhci - > event_ring_timer . data = ( unsigned long ) xhci ;
xhci - > event_ring_timer . function = event_ring_work ;
/* Poll the event ring */
xhci - > event_ring_timer . expires = jiffies + POLL_TIMEOUT * HZ ;
xhci - > zombie = 0 ;
xhci_dbg ( xhci , " Setting event ring polling timer \n " ) ;
add_timer ( & xhci - > event_ring_timer ) ;
# endif
2009-04-28 06:52:28 +04:00
xhci_dbg ( xhci , " // Set the interrupt modulation register \n " ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > irq_control ) ;
temp & = 0xffff ;
temp | = ( u32 ) 160 ;
xhci_writel ( xhci , temp , & xhci - > ir_set - > irq_control ) ;
/* Set the HCD state before we enable the irqs */
hcd - > state = HC_STATE_RUNNING ;
temp = xhci_readl ( xhci , & xhci - > op_regs - > command ) ;
temp | = ( CMD_EIE ) ;
xhci_dbg ( xhci , " // Enable interrupts, cmd = 0x%x. \n " ,
temp ) ;
xhci_writel ( xhci , temp , & xhci - > op_regs - > command ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
xhci_dbg ( xhci , " // Enabling event ring interrupter 0x%x "
" by writing 0x%x to irq_pending \n " ,
( unsigned int ) xhci - > ir_set ,
( unsigned int ) ER_IRQ_ENABLE ( temp ) ) ;
xhci_writel ( xhci , ER_IRQ_ENABLE ( temp ) ,
& xhci - > ir_set - > irq_pending ) ;
xhci_print_ir_set ( xhci , xhci - > ir_set , 0 ) ;
2009-04-28 06:53:56 +04:00
if ( NUM_TEST_NOOPS > 0 )
doorbell = setup_one_noop ( xhci ) ;
2009-04-28 06:52:34 +04:00
xhci_dbg ( xhci , " Command ring memory map follows: \n " ) ;
xhci_debug_ring ( xhci , xhci - > cmd_ring ) ;
2009-04-28 06:53:56 +04:00
xhci_dbg_ring_ptrs ( xhci , xhci - > cmd_ring ) ;
xhci_dbg_cmd_ptrs ( xhci ) ;
2009-04-28 06:52:34 +04:00
xhci_dbg ( xhci , " ERST memory map follows: \n " ) ;
xhci_dbg_erst ( xhci , & xhci - > erst ) ;
2009-04-28 06:53:56 +04:00
xhci_dbg ( xhci , " Event ring: \n " ) ;
xhci_debug_ring ( xhci , xhci - > event_ring ) ;
xhci_dbg_ring_ptrs ( xhci , xhci - > event_ring ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > erst_dequeue [ 1 ] ) ;
xhci_dbg ( xhci , " ERST deq upper = 0x%x \n " , temp ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > erst_dequeue [ 0 ] ) ;
temp & = ERST_PTR_MASK ;
xhci_dbg ( xhci , " ERST deq = 0x%x \n " , temp ) ;
2009-04-28 06:52:34 +04:00
2009-04-28 06:52:28 +04:00
temp = xhci_readl ( xhci , & xhci - > op_regs - > command ) ;
temp | = ( CMD_RUN ) ;
xhci_dbg ( xhci , " // Turn on HC, cmd = 0x%x. \n " ,
temp ) ;
xhci_writel ( xhci , temp , & xhci - > op_regs - > command ) ;
/* Flush PCI posted writes */
temp = xhci_readl ( xhci , & xhci - > op_regs - > command ) ;
xhci_dbg ( xhci , " // @%x = 0x%x \n " ,
( unsigned int ) & xhci - > op_regs - > command , temp ) ;
2009-04-28 06:53:56 +04:00
if ( doorbell )
( * doorbell ) ( xhci ) ;
2009-04-28 06:52:28 +04:00
xhci_dbg ( xhci , " Finished xhci_run \n " ) ;
return 0 ;
}
/*
* Stop xHCI driver .
*
* This function is called by the USB core when the HC driver is removed .
* Its opposite is xhci_run ( ) .
*
* Disable device contexts , disable IRQs , and quiesce the HC .
* Reset the HC , finish any completed transactions , and cleanup memory .
*/
void xhci_stop ( struct usb_hcd * hcd )
{
u32 temp ;
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
spin_lock_irq ( & xhci - > lock ) ;
if ( HC_IS_RUNNING ( hcd - > state ) )
xhci_quiesce ( xhci ) ;
xhci_halt ( xhci ) ;
xhci_reset ( xhci ) ;
spin_unlock_irq ( & xhci - > lock ) ;
#if 0 /* No MSI yet */
xhci_cleanup_msix ( xhci ) ;
# endif
2009-04-28 06:53:56 +04:00
# ifdef CONFIG_USB_XHCI_HCD_DEBUGGING
/* Tell the event ring poll function not to reschedule */
xhci - > zombie = 1 ;
del_timer_sync ( & xhci - > event_ring_timer ) ;
# endif
2009-04-28 06:52:28 +04:00
xhci_dbg ( xhci , " // Disabling event ring interrupts \n " ) ;
temp = xhci_readl ( xhci , & xhci - > op_regs - > status ) ;
xhci_writel ( xhci , temp & ~ STS_EINT , & xhci - > op_regs - > status ) ;
temp = xhci_readl ( xhci , & xhci - > ir_set - > irq_pending ) ;
xhci_writel ( xhci , ER_IRQ_DISABLE ( temp ) ,
& xhci - > ir_set - > irq_pending ) ;
xhci_print_ir_set ( xhci , xhci - > ir_set , 0 ) ;
xhci_dbg ( xhci , " cleaning up memory \n " ) ;
xhci_mem_cleanup ( xhci ) ;
xhci_dbg ( xhci , " xhci_stop completed - status = %x \n " ,
xhci_readl ( xhci , & xhci - > op_regs - > status ) ) ;
}
/*
* Shutdown HC ( not bus - specific )
*
* This is called when the machine is rebooting or halting . We assume that the
* machine will be powered off , and the HC ' s internal state will be reset .
* Don ' t bother to free memory .
*/
void xhci_shutdown ( struct usb_hcd * hcd )
{
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
spin_lock_irq ( & xhci - > lock ) ;
xhci_halt ( xhci ) ;
spin_unlock_irq ( & xhci - > lock ) ;
#if 0
xhci_cleanup_msix ( xhci ) ;
# endif
xhci_dbg ( xhci , " xhci_shutdown completed - status = %x \n " ,
xhci_readl ( xhci , & xhci - > op_regs - > status ) ) ;
}
2009-04-28 06:53:56 +04:00
/*-------------------------------------------------------------------------*/
2009-04-28 06:57:38 +04:00
/*
* At this point , the struct usb_device is about to go away , the device has
* disconnected , and all traffic has been stopped and the endpoints have been
* disabled . Free any HC data structures associated with that device .
*/
void xhci_free_dev ( struct usb_hcd * hcd , struct usb_device * udev )
{
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
unsigned long flags ;
if ( udev - > slot_id = = 0 )
return ;
spin_lock_irqsave ( & xhci - > lock , flags ) ;
if ( queue_slot_control ( xhci , TRB_DISABLE_SLOT , udev - > slot_id ) ) {
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
xhci_dbg ( xhci , " FIXME: allocate a command ring segment \n " ) ;
return ;
}
ring_cmd_db ( xhci ) ;
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
/*
* Event command completion handler will free any data structures
* associated with the slot
*/
}
/*
* Returns 0 if the xHC ran out of device slots , the Enable Slot command
* timed out , or allocating memory failed . Returns 1 on success .
*/
int xhci_alloc_dev ( struct usb_hcd * hcd , struct usb_device * udev )
{
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
unsigned long flags ;
int timeleft ;
int ret ;
spin_lock_irqsave ( & xhci - > lock , flags ) ;
ret = queue_slot_control ( xhci , TRB_ENABLE_SLOT , 0 ) ;
if ( ret ) {
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
xhci_dbg ( xhci , " FIXME: allocate a command ring segment \n " ) ;
return 0 ;
}
ring_cmd_db ( xhci ) ;
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
/* XXX: how much time for xHC slot assignment? */
timeleft = wait_for_completion_interruptible_timeout ( & xhci - > addr_dev ,
USB_CTRL_SET_TIMEOUT ) ;
if ( timeleft < = 0 ) {
xhci_warn ( xhci , " %s while waiting for a slot \n " ,
timeleft = = 0 ? " Timeout " : " Signal " ) ;
/* FIXME cancel the enable slot request */
return 0 ;
}
spin_lock_irqsave ( & xhci - > lock , flags ) ;
if ( ! xhci - > slot_id ) {
xhci_err ( xhci , " Error while assigning device slot ID \n " ) ;
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
return 0 ;
}
if ( ! xhci_alloc_virt_device ( xhci , xhci - > slot_id , udev , GFP_KERNEL ) ) {
/* Disable slot, if we can do it without mem alloc */
xhci_warn ( xhci , " Could not allocate xHCI USB device data structures \n " ) ;
if ( ! queue_slot_control ( xhci , TRB_DISABLE_SLOT , udev - > slot_id ) )
ring_cmd_db ( xhci ) ;
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
return 0 ;
}
udev - > slot_id = xhci - > slot_id ;
/* Is this a LS or FS device under a HS hub? */
/* Hub or peripherial? */
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
return 1 ;
}
/*
* Issue an Address Device command ( which will issue a SetAddress request to
* the device ) .
* We should be protected by the usb_address0_mutex in khubd ' s hub_port_init , so
* we should only issue and wait on one address command at the same time .
*
* We add one to the device address issued by the hardware because the USB core
* uses address 1 for the root hubs ( even though they ' re not really devices ) .
*/
int xhci_address_device ( struct usb_hcd * hcd , struct usb_device * udev )
{
unsigned long flags ;
int timeleft ;
struct xhci_virt_device * virt_dev ;
int ret = 0 ;
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
u32 temp ;
if ( ! udev - > slot_id ) {
xhci_dbg ( xhci , " Bad Slot ID %d \n " , udev - > slot_id ) ;
return - EINVAL ;
}
spin_lock_irqsave ( & xhci - > lock , flags ) ;
virt_dev = xhci - > devs [ udev - > slot_id ] ;
/* If this is a Set Address to an unconfigured device, setup ep 0 */
if ( ! udev - > config )
xhci_setup_addressable_virt_dev ( xhci , udev ) ;
/* Otherwise, assume the core has the device configured how it wants */
ret = queue_address_device ( xhci , virt_dev - > in_ctx_dma , udev - > slot_id ) ;
if ( ret ) {
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
xhci_dbg ( xhci , " FIXME: allocate a command ring segment \n " ) ;
return ret ;
}
ring_cmd_db ( xhci ) ;
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
/* ctrl tx can take up to 5 sec; XXX: need more time for xHC? */
timeleft = wait_for_completion_interruptible_timeout ( & xhci - > addr_dev ,
USB_CTRL_SET_TIMEOUT ) ;
/* FIXME: From section 4.3.4: "Software shall be responsible for timing
* the SetAddress ( ) " recovery interval " required by USB and aborting the
* command on a timeout .
*/
if ( timeleft < = 0 ) {
xhci_warn ( xhci , " %s while waiting for a slot \n " ,
timeleft = = 0 ? " Timeout " : " Signal " ) ;
/* FIXME cancel the address device command */
return - ETIME ;
}
spin_lock_irqsave ( & xhci - > lock , flags ) ;
switch ( virt_dev - > cmd_status ) {
case COMP_CTX_STATE :
case COMP_EBADSLT :
xhci_err ( xhci , " Setup ERROR: address device command for slot %d. \n " ,
udev - > slot_id ) ;
ret = - EINVAL ;
break ;
case COMP_TX_ERR :
dev_warn ( & udev - > dev , " Device not responding to set address. \n " ) ;
ret = - EPROTO ;
break ;
case COMP_SUCCESS :
xhci_dbg ( xhci , " Successful Address Device command \n " ) ;
break ;
default :
xhci_err ( xhci , " ERROR: unexpected command completion "
" code 0x%x. \n " , virt_dev - > cmd_status ) ;
ret = - EINVAL ;
break ;
}
if ( ret ) {
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
return ret ;
}
temp = xhci_readl ( xhci , & xhci - > op_regs - > dcbaa_ptr [ 0 ] ) ;
xhci_dbg ( xhci , " Op regs DCBAA ptr[0] = %#08x \n " , temp ) ;
temp = xhci_readl ( xhci , & xhci - > op_regs - > dcbaa_ptr [ 1 ] ) ;
xhci_dbg ( xhci , " Op regs DCBAA ptr[1] = %#08x \n " , temp ) ;
xhci_dbg ( xhci , " Slot ID %d dcbaa entry[0] @%08x = %#08x \n " ,
udev - > slot_id ,
( unsigned int ) & xhci - > dcbaa - > dev_context_ptrs [ 2 * udev - > slot_id ] ,
xhci - > dcbaa - > dev_context_ptrs [ 2 * udev - > slot_id ] ) ;
xhci_dbg ( xhci , " Slot ID %d dcbaa entry[1] @%08x = %#08x \n " ,
udev - > slot_id ,
( unsigned int ) & xhci - > dcbaa - > dev_context_ptrs [ 2 * udev - > slot_id + 1 ] ,
xhci - > dcbaa - > dev_context_ptrs [ 2 * udev - > slot_id + 1 ] ) ;
xhci_dbg ( xhci , " Output Context DMA address = %#08x \n " ,
virt_dev - > out_ctx_dma ) ;
xhci_dbg ( xhci , " Slot ID %d Input Context: \n " , udev - > slot_id ) ;
xhci_dbg_ctx ( xhci , virt_dev - > in_ctx , virt_dev - > in_ctx_dma , 2 ) ;
xhci_dbg ( xhci , " Slot ID %d Output Context: \n " , udev - > slot_id ) ;
xhci_dbg_ctx ( xhci , virt_dev - > out_ctx , virt_dev - > out_ctx_dma , 2 ) ;
/*
* USB core uses address 1 for the roothubs , so we add one to the
* address given back to us by the HC .
*/
udev - > devnum = ( virt_dev - > out_ctx - > slot . dev_state & DEV_ADDR_MASK ) + 1 ;
/* FIXME: Zero the input context control for later use? */
spin_unlock_irqrestore ( & xhci - > lock , flags ) ;
xhci_dbg ( xhci , " Device address = %d \n " , udev - > devnum ) ;
/* XXX Meh, not sure if anyone else but choose_address uses this. */
set_bit ( udev - > devnum , udev - > bus - > devmap . devicemap ) ;
return 0 ;
}
2009-04-28 06:52:28 +04:00
int xhci_get_frame ( struct usb_hcd * hcd )
{
struct xhci_hcd * xhci = hcd_to_xhci ( hcd ) ;
/* EHCI mods by the periodic size. Why? */
return xhci_readl ( xhci , & xhci - > run_regs - > microframe_index ) > > 3 ;
}
MODULE_DESCRIPTION ( DRIVER_DESC ) ;
MODULE_AUTHOR ( DRIVER_AUTHOR ) ;
MODULE_LICENSE ( " GPL " ) ;
static int __init xhci_hcd_init ( void )
{
# ifdef CONFIG_PCI
int retval = 0 ;
retval = xhci_register_pci ( ) ;
if ( retval < 0 ) {
printk ( KERN_DEBUG " Problem registering PCI driver. " ) ;
return retval ;
}
# endif
return 0 ;
}
module_init ( xhci_hcd_init ) ;
static void __exit xhci_hcd_cleanup ( void )
{
# ifdef CONFIG_PCI
xhci_unregister_pci ( ) ;
# endif
}
module_exit ( xhci_hcd_cleanup ) ;