mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-11 18:46:47 +07:00
48e8236114
To add USB 3.0 link power management (LPM), we need to know what the U1 and U2 exit latencies are for the xHCI host controller. External USB 3.0 hubs report these values through the SuperSpeed Capabilities descriptor in the BOS descriptor. Make the USB 3.0 roothub for the xHCI host behave like an external hub and return the BOS descriptors. The U1 and U2 exit latencies will vary across each host controller, so we need to dynamically fill those values in by reading the exit latencies out of the xHC registers. Make the roothub code in the USB core handle hub_control() returning the length of the data copied. Signed-off-by: Sarah Sharp <sarah.a.sharp@linux.intel.com> Acked-by: Alan Stern <stern@rowland.harvard.edu> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
2651 lines
77 KiB
C
2651 lines
77 KiB
C
/*
|
|
* (C) Copyright Linus Torvalds 1999
|
|
* (C) Copyright Johannes Erdfelt 1999-2001
|
|
* (C) Copyright Andreas Gal 1999
|
|
* (C) Copyright Gregory P. Smith 1999
|
|
* (C) Copyright Deti Fliegl 1999
|
|
* (C) Copyright Randy Dunlap 2000
|
|
* (C) Copyright David Brownell 2000-2002
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
* 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 02139, USA.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/version.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/completion.h>
|
|
#include <linux/utsname.h>
|
|
#include <linux/mm.h>
|
|
#include <asm/io.h>
|
|
#include <linux/device.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/mutex.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/byteorder.h>
|
|
#include <asm/unaligned.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/workqueue.h>
|
|
|
|
#include <linux/usb.h>
|
|
#include <linux/usb/hcd.h>
|
|
|
|
#include "usb.h"
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/*
|
|
* USB Host Controller Driver framework
|
|
*
|
|
* Plugs into usbcore (usb_bus) and lets HCDs share code, minimizing
|
|
* HCD-specific behaviors/bugs.
|
|
*
|
|
* This does error checks, tracks devices and urbs, and delegates to a
|
|
* "hc_driver" only for code (and data) that really needs to know about
|
|
* hardware differences. That includes root hub registers, i/o queues,
|
|
* and so on ... but as little else as possible.
|
|
*
|
|
* Shared code includes most of the "root hub" code (these are emulated,
|
|
* though each HC's hardware works differently) and PCI glue, plus request
|
|
* tracking overhead. The HCD code should only block on spinlocks or on
|
|
* hardware handshaking; blocking on software events (such as other kernel
|
|
* threads releasing resources, or completing actions) is all generic.
|
|
*
|
|
* Happens the USB 2.0 spec says this would be invisible inside the "USBD",
|
|
* and includes mostly a "HCDI" (HCD Interface) along with some APIs used
|
|
* only by the hub driver ... and that neither should be seen or used by
|
|
* usb client device drivers.
|
|
*
|
|
* Contributors of ideas or unattributed patches include: David Brownell,
|
|
* Roman Weissgaerber, Rory Bolt, Greg Kroah-Hartman, ...
|
|
*
|
|
* HISTORY:
|
|
* 2002-02-21 Pull in most of the usb_bus support from usb.c; some
|
|
* associated cleanup. "usb_hcd" still != "usb_bus".
|
|
* 2001-12-12 Initial patch version for Linux 2.5.1 kernel.
|
|
*/
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* Keep track of which host controller drivers are loaded */
|
|
unsigned long usb_hcds_loaded;
|
|
EXPORT_SYMBOL_GPL(usb_hcds_loaded);
|
|
|
|
/* host controllers we manage */
|
|
LIST_HEAD (usb_bus_list);
|
|
EXPORT_SYMBOL_GPL (usb_bus_list);
|
|
|
|
/* used when allocating bus numbers */
|
|
#define USB_MAXBUS 64
|
|
struct usb_busmap {
|
|
unsigned long busmap [USB_MAXBUS / (8*sizeof (unsigned long))];
|
|
};
|
|
static struct usb_busmap busmap;
|
|
|
|
/* used when updating list of hcds */
|
|
DEFINE_MUTEX(usb_bus_list_lock); /* exported only for usbfs */
|
|
EXPORT_SYMBOL_GPL (usb_bus_list_lock);
|
|
|
|
/* used for controlling access to virtual root hubs */
|
|
static DEFINE_SPINLOCK(hcd_root_hub_lock);
|
|
|
|
/* used when updating an endpoint's URB list */
|
|
static DEFINE_SPINLOCK(hcd_urb_list_lock);
|
|
|
|
/* used to protect against unlinking URBs after the device is gone */
|
|
static DEFINE_SPINLOCK(hcd_urb_unlink_lock);
|
|
|
|
/* wait queue for synchronous unlinks */
|
|
DECLARE_WAIT_QUEUE_HEAD(usb_kill_urb_queue);
|
|
|
|
static inline int is_root_hub(struct usb_device *udev)
|
|
{
|
|
return (udev->parent == NULL);
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/*
|
|
* Sharable chunks of root hub code.
|
|
*/
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
#define KERNEL_REL ((LINUX_VERSION_CODE >> 16) & 0x0ff)
|
|
#define KERNEL_VER ((LINUX_VERSION_CODE >> 8) & 0x0ff)
|
|
|
|
/* usb 3.0 root hub device descriptor */
|
|
static const u8 usb3_rh_dev_descriptor[18] = {
|
|
0x12, /* __u8 bLength; */
|
|
0x01, /* __u8 bDescriptorType; Device */
|
|
0x00, 0x03, /* __le16 bcdUSB; v3.0 */
|
|
|
|
0x09, /* __u8 bDeviceClass; HUB_CLASSCODE */
|
|
0x00, /* __u8 bDeviceSubClass; */
|
|
0x03, /* __u8 bDeviceProtocol; USB 3.0 hub */
|
|
0x09, /* __u8 bMaxPacketSize0; 2^9 = 512 Bytes */
|
|
|
|
0x6b, 0x1d, /* __le16 idVendor; Linux Foundation */
|
|
0x03, 0x00, /* __le16 idProduct; device 0x0003 */
|
|
KERNEL_VER, KERNEL_REL, /* __le16 bcdDevice */
|
|
|
|
0x03, /* __u8 iManufacturer; */
|
|
0x02, /* __u8 iProduct; */
|
|
0x01, /* __u8 iSerialNumber; */
|
|
0x01 /* __u8 bNumConfigurations; */
|
|
};
|
|
|
|
/* usb 2.0 root hub device descriptor */
|
|
static const u8 usb2_rh_dev_descriptor [18] = {
|
|
0x12, /* __u8 bLength; */
|
|
0x01, /* __u8 bDescriptorType; Device */
|
|
0x00, 0x02, /* __le16 bcdUSB; v2.0 */
|
|
|
|
0x09, /* __u8 bDeviceClass; HUB_CLASSCODE */
|
|
0x00, /* __u8 bDeviceSubClass; */
|
|
0x00, /* __u8 bDeviceProtocol; [ usb 2.0 no TT ] */
|
|
0x40, /* __u8 bMaxPacketSize0; 64 Bytes */
|
|
|
|
0x6b, 0x1d, /* __le16 idVendor; Linux Foundation */
|
|
0x02, 0x00, /* __le16 idProduct; device 0x0002 */
|
|
KERNEL_VER, KERNEL_REL, /* __le16 bcdDevice */
|
|
|
|
0x03, /* __u8 iManufacturer; */
|
|
0x02, /* __u8 iProduct; */
|
|
0x01, /* __u8 iSerialNumber; */
|
|
0x01 /* __u8 bNumConfigurations; */
|
|
};
|
|
|
|
/* no usb 2.0 root hub "device qualifier" descriptor: one speed only */
|
|
|
|
/* usb 1.1 root hub device descriptor */
|
|
static const u8 usb11_rh_dev_descriptor [18] = {
|
|
0x12, /* __u8 bLength; */
|
|
0x01, /* __u8 bDescriptorType; Device */
|
|
0x10, 0x01, /* __le16 bcdUSB; v1.1 */
|
|
|
|
0x09, /* __u8 bDeviceClass; HUB_CLASSCODE */
|
|
0x00, /* __u8 bDeviceSubClass; */
|
|
0x00, /* __u8 bDeviceProtocol; [ low/full speeds only ] */
|
|
0x40, /* __u8 bMaxPacketSize0; 64 Bytes */
|
|
|
|
0x6b, 0x1d, /* __le16 idVendor; Linux Foundation */
|
|
0x01, 0x00, /* __le16 idProduct; device 0x0001 */
|
|
KERNEL_VER, KERNEL_REL, /* __le16 bcdDevice */
|
|
|
|
0x03, /* __u8 iManufacturer; */
|
|
0x02, /* __u8 iProduct; */
|
|
0x01, /* __u8 iSerialNumber; */
|
|
0x01 /* __u8 bNumConfigurations; */
|
|
};
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* Configuration descriptors for our root hubs */
|
|
|
|
static const u8 fs_rh_config_descriptor [] = {
|
|
|
|
/* one configuration */
|
|
0x09, /* __u8 bLength; */
|
|
0x02, /* __u8 bDescriptorType; Configuration */
|
|
0x19, 0x00, /* __le16 wTotalLength; */
|
|
0x01, /* __u8 bNumInterfaces; (1) */
|
|
0x01, /* __u8 bConfigurationValue; */
|
|
0x00, /* __u8 iConfiguration; */
|
|
0xc0, /* __u8 bmAttributes;
|
|
Bit 7: must be set,
|
|
6: Self-powered,
|
|
5: Remote wakeup,
|
|
4..0: resvd */
|
|
0x00, /* __u8 MaxPower; */
|
|
|
|
/* USB 1.1:
|
|
* USB 2.0, single TT organization (mandatory):
|
|
* one interface, protocol 0
|
|
*
|
|
* USB 2.0, multiple TT organization (optional):
|
|
* two interfaces, protocols 1 (like single TT)
|
|
* and 2 (multiple TT mode) ... config is
|
|
* sometimes settable
|
|
* NOT IMPLEMENTED
|
|
*/
|
|
|
|
/* one interface */
|
|
0x09, /* __u8 if_bLength; */
|
|
0x04, /* __u8 if_bDescriptorType; Interface */
|
|
0x00, /* __u8 if_bInterfaceNumber; */
|
|
0x00, /* __u8 if_bAlternateSetting; */
|
|
0x01, /* __u8 if_bNumEndpoints; */
|
|
0x09, /* __u8 if_bInterfaceClass; HUB_CLASSCODE */
|
|
0x00, /* __u8 if_bInterfaceSubClass; */
|
|
0x00, /* __u8 if_bInterfaceProtocol; [usb1.1 or single tt] */
|
|
0x00, /* __u8 if_iInterface; */
|
|
|
|
/* one endpoint (status change endpoint) */
|
|
0x07, /* __u8 ep_bLength; */
|
|
0x05, /* __u8 ep_bDescriptorType; Endpoint */
|
|
0x81, /* __u8 ep_bEndpointAddress; IN Endpoint 1 */
|
|
0x03, /* __u8 ep_bmAttributes; Interrupt */
|
|
0x02, 0x00, /* __le16 ep_wMaxPacketSize; 1 + (MAX_ROOT_PORTS / 8) */
|
|
0xff /* __u8 ep_bInterval; (255ms -- usb 2.0 spec) */
|
|
};
|
|
|
|
static const u8 hs_rh_config_descriptor [] = {
|
|
|
|
/* one configuration */
|
|
0x09, /* __u8 bLength; */
|
|
0x02, /* __u8 bDescriptorType; Configuration */
|
|
0x19, 0x00, /* __le16 wTotalLength; */
|
|
0x01, /* __u8 bNumInterfaces; (1) */
|
|
0x01, /* __u8 bConfigurationValue; */
|
|
0x00, /* __u8 iConfiguration; */
|
|
0xc0, /* __u8 bmAttributes;
|
|
Bit 7: must be set,
|
|
6: Self-powered,
|
|
5: Remote wakeup,
|
|
4..0: resvd */
|
|
0x00, /* __u8 MaxPower; */
|
|
|
|
/* USB 1.1:
|
|
* USB 2.0, single TT organization (mandatory):
|
|
* one interface, protocol 0
|
|
*
|
|
* USB 2.0, multiple TT organization (optional):
|
|
* two interfaces, protocols 1 (like single TT)
|
|
* and 2 (multiple TT mode) ... config is
|
|
* sometimes settable
|
|
* NOT IMPLEMENTED
|
|
*/
|
|
|
|
/* one interface */
|
|
0x09, /* __u8 if_bLength; */
|
|
0x04, /* __u8 if_bDescriptorType; Interface */
|
|
0x00, /* __u8 if_bInterfaceNumber; */
|
|
0x00, /* __u8 if_bAlternateSetting; */
|
|
0x01, /* __u8 if_bNumEndpoints; */
|
|
0x09, /* __u8 if_bInterfaceClass; HUB_CLASSCODE */
|
|
0x00, /* __u8 if_bInterfaceSubClass; */
|
|
0x00, /* __u8 if_bInterfaceProtocol; [usb1.1 or single tt] */
|
|
0x00, /* __u8 if_iInterface; */
|
|
|
|
/* one endpoint (status change endpoint) */
|
|
0x07, /* __u8 ep_bLength; */
|
|
0x05, /* __u8 ep_bDescriptorType; Endpoint */
|
|
0x81, /* __u8 ep_bEndpointAddress; IN Endpoint 1 */
|
|
0x03, /* __u8 ep_bmAttributes; Interrupt */
|
|
/* __le16 ep_wMaxPacketSize; 1 + (MAX_ROOT_PORTS / 8)
|
|
* see hub.c:hub_configure() for details. */
|
|
(USB_MAXCHILDREN + 1 + 7) / 8, 0x00,
|
|
0x0c /* __u8 ep_bInterval; (256ms -- usb 2.0 spec) */
|
|
};
|
|
|
|
static const u8 ss_rh_config_descriptor[] = {
|
|
/* one configuration */
|
|
0x09, /* __u8 bLength; */
|
|
0x02, /* __u8 bDescriptorType; Configuration */
|
|
0x1f, 0x00, /* __le16 wTotalLength; */
|
|
0x01, /* __u8 bNumInterfaces; (1) */
|
|
0x01, /* __u8 bConfigurationValue; */
|
|
0x00, /* __u8 iConfiguration; */
|
|
0xc0, /* __u8 bmAttributes;
|
|
Bit 7: must be set,
|
|
6: Self-powered,
|
|
5: Remote wakeup,
|
|
4..0: resvd */
|
|
0x00, /* __u8 MaxPower; */
|
|
|
|
/* one interface */
|
|
0x09, /* __u8 if_bLength; */
|
|
0x04, /* __u8 if_bDescriptorType; Interface */
|
|
0x00, /* __u8 if_bInterfaceNumber; */
|
|
0x00, /* __u8 if_bAlternateSetting; */
|
|
0x01, /* __u8 if_bNumEndpoints; */
|
|
0x09, /* __u8 if_bInterfaceClass; HUB_CLASSCODE */
|
|
0x00, /* __u8 if_bInterfaceSubClass; */
|
|
0x00, /* __u8 if_bInterfaceProtocol; */
|
|
0x00, /* __u8 if_iInterface; */
|
|
|
|
/* one endpoint (status change endpoint) */
|
|
0x07, /* __u8 ep_bLength; */
|
|
0x05, /* __u8 ep_bDescriptorType; Endpoint */
|
|
0x81, /* __u8 ep_bEndpointAddress; IN Endpoint 1 */
|
|
0x03, /* __u8 ep_bmAttributes; Interrupt */
|
|
/* __le16 ep_wMaxPacketSize; 1 + (MAX_ROOT_PORTS / 8)
|
|
* see hub.c:hub_configure() for details. */
|
|
(USB_MAXCHILDREN + 1 + 7) / 8, 0x00,
|
|
0x0c, /* __u8 ep_bInterval; (256ms -- usb 2.0 spec) */
|
|
|
|
/* one SuperSpeed endpoint companion descriptor */
|
|
0x06, /* __u8 ss_bLength */
|
|
0x30, /* __u8 ss_bDescriptorType; SuperSpeed EP Companion */
|
|
0x00, /* __u8 ss_bMaxBurst; allows 1 TX between ACKs */
|
|
0x00, /* __u8 ss_bmAttributes; 1 packet per service interval */
|
|
0x02, 0x00 /* __le16 ss_wBytesPerInterval; 15 bits for max 15 ports */
|
|
};
|
|
|
|
/* authorized_default behaviour:
|
|
* -1 is authorized for all devices except wireless (old behaviour)
|
|
* 0 is unauthorized for all devices
|
|
* 1 is authorized for all devices
|
|
*/
|
|
static int authorized_default = -1;
|
|
module_param(authorized_default, int, S_IRUGO|S_IWUSR);
|
|
MODULE_PARM_DESC(authorized_default,
|
|
"Default USB device authorization: 0 is not authorized, 1 is "
|
|
"authorized, -1 is authorized except for wireless USB (default, "
|
|
"old behaviour");
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* ascii2desc() - Helper routine for producing UTF-16LE string descriptors
|
|
* @s: Null-terminated ASCII (actually ISO-8859-1) string
|
|
* @buf: Buffer for USB string descriptor (header + UTF-16LE)
|
|
* @len: Length (in bytes; may be odd) of descriptor buffer.
|
|
*
|
|
* The return value is the number of bytes filled in: 2 + 2*strlen(s) or
|
|
* buflen, whichever is less.
|
|
*
|
|
* USB String descriptors can contain at most 126 characters; input
|
|
* strings longer than that are truncated.
|
|
*/
|
|
static unsigned
|
|
ascii2desc(char const *s, u8 *buf, unsigned len)
|
|
{
|
|
unsigned n, t = 2 + 2*strlen(s);
|
|
|
|
if (t > 254)
|
|
t = 254; /* Longest possible UTF string descriptor */
|
|
if (len > t)
|
|
len = t;
|
|
|
|
t += USB_DT_STRING << 8; /* Now t is first 16 bits to store */
|
|
|
|
n = len;
|
|
while (n--) {
|
|
*buf++ = t;
|
|
if (!n--)
|
|
break;
|
|
*buf++ = t >> 8;
|
|
t = (unsigned char)*s++;
|
|
}
|
|
return len;
|
|
}
|
|
|
|
/**
|
|
* rh_string() - provides string descriptors for root hub
|
|
* @id: the string ID number (0: langids, 1: serial #, 2: product, 3: vendor)
|
|
* @hcd: the host controller for this root hub
|
|
* @data: buffer for output packet
|
|
* @len: length of the provided buffer
|
|
*
|
|
* Produces either a manufacturer, product or serial number string for the
|
|
* virtual root hub device.
|
|
* Returns the number of bytes filled in: the length of the descriptor or
|
|
* of the provided buffer, whichever is less.
|
|
*/
|
|
static unsigned
|
|
rh_string(int id, struct usb_hcd const *hcd, u8 *data, unsigned len)
|
|
{
|
|
char buf[100];
|
|
char const *s;
|
|
static char const langids[4] = {4, USB_DT_STRING, 0x09, 0x04};
|
|
|
|
// language ids
|
|
switch (id) {
|
|
case 0:
|
|
/* Array of LANGID codes (0x0409 is MSFT-speak for "en-us") */
|
|
/* See http://www.usb.org/developers/docs/USB_LANGIDs.pdf */
|
|
if (len > 4)
|
|
len = 4;
|
|
memcpy(data, langids, len);
|
|
return len;
|
|
case 1:
|
|
/* Serial number */
|
|
s = hcd->self.bus_name;
|
|
break;
|
|
case 2:
|
|
/* Product name */
|
|
s = hcd->product_desc;
|
|
break;
|
|
case 3:
|
|
/* Manufacturer */
|
|
snprintf (buf, sizeof buf, "%s %s %s", init_utsname()->sysname,
|
|
init_utsname()->release, hcd->driver->description);
|
|
s = buf;
|
|
break;
|
|
default:
|
|
/* Can't happen; caller guarantees it */
|
|
return 0;
|
|
}
|
|
|
|
return ascii2desc(s, data, len);
|
|
}
|
|
|
|
|
|
/* Root hub control transfers execute synchronously */
|
|
static int rh_call_control (struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
struct usb_ctrlrequest *cmd;
|
|
u16 typeReq, wValue, wIndex, wLength;
|
|
u8 *ubuf = urb->transfer_buffer;
|
|
/*
|
|
* tbuf should be as big as the BOS descriptor and
|
|
* the USB hub descriptor.
|
|
*/
|
|
u8 tbuf[USB_DT_BOS_SIZE + USB_DT_USB_SS_CAP_SIZE]
|
|
__attribute__((aligned(4)));
|
|
const u8 *bufp = tbuf;
|
|
unsigned len = 0;
|
|
int status;
|
|
u8 patch_wakeup = 0;
|
|
u8 patch_protocol = 0;
|
|
|
|
might_sleep();
|
|
|
|
spin_lock_irq(&hcd_root_hub_lock);
|
|
status = usb_hcd_link_urb_to_ep(hcd, urb);
|
|
spin_unlock_irq(&hcd_root_hub_lock);
|
|
if (status)
|
|
return status;
|
|
urb->hcpriv = hcd; /* Indicate it's queued */
|
|
|
|
cmd = (struct usb_ctrlrequest *) urb->setup_packet;
|
|
typeReq = (cmd->bRequestType << 8) | cmd->bRequest;
|
|
wValue = le16_to_cpu (cmd->wValue);
|
|
wIndex = le16_to_cpu (cmd->wIndex);
|
|
wLength = le16_to_cpu (cmd->wLength);
|
|
|
|
if (wLength > urb->transfer_buffer_length)
|
|
goto error;
|
|
|
|
urb->actual_length = 0;
|
|
switch (typeReq) {
|
|
|
|
/* DEVICE REQUESTS */
|
|
|
|
/* The root hub's remote wakeup enable bit is implemented using
|
|
* driver model wakeup flags. If this system supports wakeup
|
|
* through USB, userspace may change the default "allow wakeup"
|
|
* policy through sysfs or these calls.
|
|
*
|
|
* Most root hubs support wakeup from downstream devices, for
|
|
* runtime power management (disabling USB clocks and reducing
|
|
* VBUS power usage). However, not all of them do so; silicon,
|
|
* board, and BIOS bugs here are not uncommon, so these can't
|
|
* be treated quite like external hubs.
|
|
*
|
|
* Likewise, not all root hubs will pass wakeup events upstream,
|
|
* to wake up the whole system. So don't assume root hub and
|
|
* controller capabilities are identical.
|
|
*/
|
|
|
|
case DeviceRequest | USB_REQ_GET_STATUS:
|
|
tbuf [0] = (device_may_wakeup(&hcd->self.root_hub->dev)
|
|
<< USB_DEVICE_REMOTE_WAKEUP)
|
|
| (1 << USB_DEVICE_SELF_POWERED);
|
|
tbuf [1] = 0;
|
|
len = 2;
|
|
break;
|
|
case DeviceOutRequest | USB_REQ_CLEAR_FEATURE:
|
|
if (wValue == USB_DEVICE_REMOTE_WAKEUP)
|
|
device_set_wakeup_enable(&hcd->self.root_hub->dev, 0);
|
|
else
|
|
goto error;
|
|
break;
|
|
case DeviceOutRequest | USB_REQ_SET_FEATURE:
|
|
if (device_can_wakeup(&hcd->self.root_hub->dev)
|
|
&& wValue == USB_DEVICE_REMOTE_WAKEUP)
|
|
device_set_wakeup_enable(&hcd->self.root_hub->dev, 1);
|
|
else
|
|
goto error;
|
|
break;
|
|
case DeviceRequest | USB_REQ_GET_CONFIGURATION:
|
|
tbuf [0] = 1;
|
|
len = 1;
|
|
/* FALLTHROUGH */
|
|
case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
|
|
break;
|
|
case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
|
|
switch (wValue & 0xff00) {
|
|
case USB_DT_DEVICE << 8:
|
|
switch (hcd->speed) {
|
|
case HCD_USB3:
|
|
bufp = usb3_rh_dev_descriptor;
|
|
break;
|
|
case HCD_USB2:
|
|
bufp = usb2_rh_dev_descriptor;
|
|
break;
|
|
case HCD_USB11:
|
|
bufp = usb11_rh_dev_descriptor;
|
|
break;
|
|
default:
|
|
goto error;
|
|
}
|
|
len = 18;
|
|
if (hcd->has_tt)
|
|
patch_protocol = 1;
|
|
break;
|
|
case USB_DT_CONFIG << 8:
|
|
switch (hcd->speed) {
|
|
case HCD_USB3:
|
|
bufp = ss_rh_config_descriptor;
|
|
len = sizeof ss_rh_config_descriptor;
|
|
break;
|
|
case HCD_USB2:
|
|
bufp = hs_rh_config_descriptor;
|
|
len = sizeof hs_rh_config_descriptor;
|
|
break;
|
|
case HCD_USB11:
|
|
bufp = fs_rh_config_descriptor;
|
|
len = sizeof fs_rh_config_descriptor;
|
|
break;
|
|
default:
|
|
goto error;
|
|
}
|
|
if (device_can_wakeup(&hcd->self.root_hub->dev))
|
|
patch_wakeup = 1;
|
|
break;
|
|
case USB_DT_STRING << 8:
|
|
if ((wValue & 0xff) < 4)
|
|
urb->actual_length = rh_string(wValue & 0xff,
|
|
hcd, ubuf, wLength);
|
|
else /* unsupported IDs --> "protocol stall" */
|
|
goto error;
|
|
break;
|
|
case USB_DT_BOS << 8:
|
|
goto nongeneric;
|
|
default:
|
|
goto error;
|
|
}
|
|
break;
|
|
case DeviceRequest | USB_REQ_GET_INTERFACE:
|
|
tbuf [0] = 0;
|
|
len = 1;
|
|
/* FALLTHROUGH */
|
|
case DeviceOutRequest | USB_REQ_SET_INTERFACE:
|
|
break;
|
|
case DeviceOutRequest | USB_REQ_SET_ADDRESS:
|
|
// wValue == urb->dev->devaddr
|
|
dev_dbg (hcd->self.controller, "root hub device address %d\n",
|
|
wValue);
|
|
break;
|
|
|
|
/* INTERFACE REQUESTS (no defined feature/status flags) */
|
|
|
|
/* ENDPOINT REQUESTS */
|
|
|
|
case EndpointRequest | USB_REQ_GET_STATUS:
|
|
// ENDPOINT_HALT flag
|
|
tbuf [0] = 0;
|
|
tbuf [1] = 0;
|
|
len = 2;
|
|
/* FALLTHROUGH */
|
|
case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
|
|
case EndpointOutRequest | USB_REQ_SET_FEATURE:
|
|
dev_dbg (hcd->self.controller, "no endpoint features yet\n");
|
|
break;
|
|
|
|
/* CLASS REQUESTS (and errors) */
|
|
|
|
default:
|
|
nongeneric:
|
|
/* non-generic request */
|
|
switch (typeReq) {
|
|
case GetHubStatus:
|
|
case GetPortStatus:
|
|
len = 4;
|
|
break;
|
|
case GetHubDescriptor:
|
|
len = sizeof (struct usb_hub_descriptor);
|
|
break;
|
|
case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
|
|
/* len is returned by hub_control */
|
|
break;
|
|
}
|
|
status = hcd->driver->hub_control (hcd,
|
|
typeReq, wValue, wIndex,
|
|
tbuf, wLength);
|
|
break;
|
|
error:
|
|
/* "protocol stall" on error */
|
|
status = -EPIPE;
|
|
}
|
|
|
|
if (status < 0) {
|
|
len = 0;
|
|
if (status != -EPIPE) {
|
|
dev_dbg (hcd->self.controller,
|
|
"CTRL: TypeReq=0x%x val=0x%x "
|
|
"idx=0x%x len=%d ==> %d\n",
|
|
typeReq, wValue, wIndex,
|
|
wLength, status);
|
|
}
|
|
} else if (status > 0) {
|
|
/* hub_control may return the length of data copied. */
|
|
len = status;
|
|
status = 0;
|
|
}
|
|
if (len) {
|
|
if (urb->transfer_buffer_length < len)
|
|
len = urb->transfer_buffer_length;
|
|
urb->actual_length = len;
|
|
// always USB_DIR_IN, toward host
|
|
memcpy (ubuf, bufp, len);
|
|
|
|
/* report whether RH hardware supports remote wakeup */
|
|
if (patch_wakeup &&
|
|
len > offsetof (struct usb_config_descriptor,
|
|
bmAttributes))
|
|
((struct usb_config_descriptor *)ubuf)->bmAttributes
|
|
|= USB_CONFIG_ATT_WAKEUP;
|
|
|
|
/* report whether RH hardware has an integrated TT */
|
|
if (patch_protocol &&
|
|
len > offsetof(struct usb_device_descriptor,
|
|
bDeviceProtocol))
|
|
((struct usb_device_descriptor *) ubuf)->
|
|
bDeviceProtocol = 1;
|
|
}
|
|
|
|
/* any errors get returned through the urb completion */
|
|
spin_lock_irq(&hcd_root_hub_lock);
|
|
usb_hcd_unlink_urb_from_ep(hcd, urb);
|
|
|
|
/* This peculiar use of spinlocks echoes what real HC drivers do.
|
|
* Avoiding calls to local_irq_disable/enable makes the code
|
|
* RT-friendly.
|
|
*/
|
|
spin_unlock(&hcd_root_hub_lock);
|
|
usb_hcd_giveback_urb(hcd, urb, status);
|
|
spin_lock(&hcd_root_hub_lock);
|
|
|
|
spin_unlock_irq(&hcd_root_hub_lock);
|
|
return 0;
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/*
|
|
* Root Hub interrupt transfers are polled using a timer if the
|
|
* driver requests it; otherwise the driver is responsible for
|
|
* calling usb_hcd_poll_rh_status() when an event occurs.
|
|
*
|
|
* Completions are called in_interrupt(), but they may or may not
|
|
* be in_irq().
|
|
*/
|
|
void usb_hcd_poll_rh_status(struct usb_hcd *hcd)
|
|
{
|
|
struct urb *urb;
|
|
int length;
|
|
unsigned long flags;
|
|
char buffer[6]; /* Any root hubs with > 31 ports? */
|
|
|
|
if (unlikely(!hcd->rh_pollable))
|
|
return;
|
|
if (!hcd->uses_new_polling && !hcd->status_urb)
|
|
return;
|
|
|
|
length = hcd->driver->hub_status_data(hcd, buffer);
|
|
if (length > 0) {
|
|
|
|
/* try to complete the status urb */
|
|
spin_lock_irqsave(&hcd_root_hub_lock, flags);
|
|
urb = hcd->status_urb;
|
|
if (urb) {
|
|
clear_bit(HCD_FLAG_POLL_PENDING, &hcd->flags);
|
|
hcd->status_urb = NULL;
|
|
urb->actual_length = length;
|
|
memcpy(urb->transfer_buffer, buffer, length);
|
|
|
|
usb_hcd_unlink_urb_from_ep(hcd, urb);
|
|
spin_unlock(&hcd_root_hub_lock);
|
|
usb_hcd_giveback_urb(hcd, urb, 0);
|
|
spin_lock(&hcd_root_hub_lock);
|
|
} else {
|
|
length = 0;
|
|
set_bit(HCD_FLAG_POLL_PENDING, &hcd->flags);
|
|
}
|
|
spin_unlock_irqrestore(&hcd_root_hub_lock, flags);
|
|
}
|
|
|
|
/* The USB 2.0 spec says 256 ms. This is close enough and won't
|
|
* exceed that limit if HZ is 100. The math is more clunky than
|
|
* maybe expected, this is to make sure that all timers for USB devices
|
|
* fire at the same time to give the CPU a break in between */
|
|
if (hcd->uses_new_polling ? HCD_POLL_RH(hcd) :
|
|
(length == 0 && hcd->status_urb != NULL))
|
|
mod_timer (&hcd->rh_timer, (jiffies/(HZ/4) + 1) * (HZ/4));
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_poll_rh_status);
|
|
|
|
/* timer callback */
|
|
static void rh_timer_func (unsigned long _hcd)
|
|
{
|
|
usb_hcd_poll_rh_status((struct usb_hcd *) _hcd);
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
static int rh_queue_status (struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
int retval;
|
|
unsigned long flags;
|
|
unsigned len = 1 + (urb->dev->maxchild / 8);
|
|
|
|
spin_lock_irqsave (&hcd_root_hub_lock, flags);
|
|
if (hcd->status_urb || urb->transfer_buffer_length < len) {
|
|
dev_dbg (hcd->self.controller, "not queuing rh status urb\n");
|
|
retval = -EINVAL;
|
|
goto done;
|
|
}
|
|
|
|
retval = usb_hcd_link_urb_to_ep(hcd, urb);
|
|
if (retval)
|
|
goto done;
|
|
|
|
hcd->status_urb = urb;
|
|
urb->hcpriv = hcd; /* indicate it's queued */
|
|
if (!hcd->uses_new_polling)
|
|
mod_timer(&hcd->rh_timer, (jiffies/(HZ/4) + 1) * (HZ/4));
|
|
|
|
/* If a status change has already occurred, report it ASAP */
|
|
else if (HCD_POLL_PENDING(hcd))
|
|
mod_timer(&hcd->rh_timer, jiffies);
|
|
retval = 0;
|
|
done:
|
|
spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
|
|
return retval;
|
|
}
|
|
|
|
static int rh_urb_enqueue (struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
if (usb_endpoint_xfer_int(&urb->ep->desc))
|
|
return rh_queue_status (hcd, urb);
|
|
if (usb_endpoint_xfer_control(&urb->ep->desc))
|
|
return rh_call_control (hcd, urb);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* Unlinks of root-hub control URBs are legal, but they don't do anything
|
|
* since these URBs always execute synchronously.
|
|
*/
|
|
static int usb_rh_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
|
|
{
|
|
unsigned long flags;
|
|
int rc;
|
|
|
|
spin_lock_irqsave(&hcd_root_hub_lock, flags);
|
|
rc = usb_hcd_check_unlink_urb(hcd, urb, status);
|
|
if (rc)
|
|
goto done;
|
|
|
|
if (usb_endpoint_num(&urb->ep->desc) == 0) { /* Control URB */
|
|
; /* Do nothing */
|
|
|
|
} else { /* Status URB */
|
|
if (!hcd->uses_new_polling)
|
|
del_timer (&hcd->rh_timer);
|
|
if (urb == hcd->status_urb) {
|
|
hcd->status_urb = NULL;
|
|
usb_hcd_unlink_urb_from_ep(hcd, urb);
|
|
|
|
spin_unlock(&hcd_root_hub_lock);
|
|
usb_hcd_giveback_urb(hcd, urb, status);
|
|
spin_lock(&hcd_root_hub_lock);
|
|
}
|
|
}
|
|
done:
|
|
spin_unlock_irqrestore(&hcd_root_hub_lock, flags);
|
|
return rc;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* Show & store the current value of authorized_default
|
|
*/
|
|
static ssize_t usb_host_authorized_default_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct usb_device *rh_usb_dev = to_usb_device(dev);
|
|
struct usb_bus *usb_bus = rh_usb_dev->bus;
|
|
struct usb_hcd *usb_hcd;
|
|
|
|
if (usb_bus == NULL) /* FIXME: not sure if this case is possible */
|
|
return -ENODEV;
|
|
usb_hcd = bus_to_hcd(usb_bus);
|
|
return snprintf(buf, PAGE_SIZE, "%u\n", usb_hcd->authorized_default);
|
|
}
|
|
|
|
static ssize_t usb_host_authorized_default_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t size)
|
|
{
|
|
ssize_t result;
|
|
unsigned val;
|
|
struct usb_device *rh_usb_dev = to_usb_device(dev);
|
|
struct usb_bus *usb_bus = rh_usb_dev->bus;
|
|
struct usb_hcd *usb_hcd;
|
|
|
|
if (usb_bus == NULL) /* FIXME: not sure if this case is possible */
|
|
return -ENODEV;
|
|
usb_hcd = bus_to_hcd(usb_bus);
|
|
result = sscanf(buf, "%u\n", &val);
|
|
if (result == 1) {
|
|
usb_hcd->authorized_default = val? 1 : 0;
|
|
result = size;
|
|
}
|
|
else
|
|
result = -EINVAL;
|
|
return result;
|
|
}
|
|
|
|
static DEVICE_ATTR(authorized_default, 0644,
|
|
usb_host_authorized_default_show,
|
|
usb_host_authorized_default_store);
|
|
|
|
|
|
/* Group all the USB bus attributes */
|
|
static struct attribute *usb_bus_attrs[] = {
|
|
&dev_attr_authorized_default.attr,
|
|
NULL,
|
|
};
|
|
|
|
static struct attribute_group usb_bus_attr_group = {
|
|
.name = NULL, /* we want them in the same directory */
|
|
.attrs = usb_bus_attrs,
|
|
};
|
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_bus_init - shared initialization code
|
|
* @bus: the bus structure being initialized
|
|
*
|
|
* This code is used to initialize a usb_bus structure, memory for which is
|
|
* separately managed.
|
|
*/
|
|
static void usb_bus_init (struct usb_bus *bus)
|
|
{
|
|
memset (&bus->devmap, 0, sizeof(struct usb_devmap));
|
|
|
|
bus->devnum_next = 1;
|
|
|
|
bus->root_hub = NULL;
|
|
bus->busnum = -1;
|
|
bus->bandwidth_allocated = 0;
|
|
bus->bandwidth_int_reqs = 0;
|
|
bus->bandwidth_isoc_reqs = 0;
|
|
|
|
INIT_LIST_HEAD (&bus->bus_list);
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_register_bus - registers the USB host controller with the usb core
|
|
* @bus: pointer to the bus to register
|
|
* Context: !in_interrupt()
|
|
*
|
|
* Assigns a bus number, and links the controller into usbcore data
|
|
* structures so that it can be seen by scanning the bus list.
|
|
*/
|
|
static int usb_register_bus(struct usb_bus *bus)
|
|
{
|
|
int result = -E2BIG;
|
|
int busnum;
|
|
|
|
mutex_lock(&usb_bus_list_lock);
|
|
busnum = find_next_zero_bit (busmap.busmap, USB_MAXBUS, 1);
|
|
if (busnum >= USB_MAXBUS) {
|
|
printk (KERN_ERR "%s: too many buses\n", usbcore_name);
|
|
goto error_find_busnum;
|
|
}
|
|
set_bit (busnum, busmap.busmap);
|
|
bus->busnum = busnum;
|
|
|
|
/* Add it to the local list of buses */
|
|
list_add (&bus->bus_list, &usb_bus_list);
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
|
|
usb_notify_add_bus(bus);
|
|
|
|
dev_info (bus->controller, "new USB bus registered, assigned bus "
|
|
"number %d\n", bus->busnum);
|
|
return 0;
|
|
|
|
error_find_busnum:
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
return result;
|
|
}
|
|
|
|
/**
|
|
* usb_deregister_bus - deregisters the USB host controller
|
|
* @bus: pointer to the bus to deregister
|
|
* Context: !in_interrupt()
|
|
*
|
|
* Recycles the bus number, and unlinks the controller from usbcore data
|
|
* structures so that it won't be seen by scanning the bus list.
|
|
*/
|
|
static void usb_deregister_bus (struct usb_bus *bus)
|
|
{
|
|
dev_info (bus->controller, "USB bus %d deregistered\n", bus->busnum);
|
|
|
|
/*
|
|
* NOTE: make sure that all the devices are removed by the
|
|
* controller code, as well as having it call this when cleaning
|
|
* itself up
|
|
*/
|
|
mutex_lock(&usb_bus_list_lock);
|
|
list_del (&bus->bus_list);
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
|
|
usb_notify_remove_bus(bus);
|
|
|
|
clear_bit (bus->busnum, busmap.busmap);
|
|
}
|
|
|
|
/**
|
|
* register_root_hub - called by usb_add_hcd() to register a root hub
|
|
* @hcd: host controller for this root hub
|
|
*
|
|
* This function registers the root hub with the USB subsystem. It sets up
|
|
* the device properly in the device tree and then calls usb_new_device()
|
|
* to register the usb device. It also assigns the root hub's USB address
|
|
* (always 1).
|
|
*/
|
|
static int register_root_hub(struct usb_hcd *hcd)
|
|
{
|
|
struct device *parent_dev = hcd->self.controller;
|
|
struct usb_device *usb_dev = hcd->self.root_hub;
|
|
const int devnum = 1;
|
|
int retval;
|
|
|
|
usb_dev->devnum = devnum;
|
|
usb_dev->bus->devnum_next = devnum + 1;
|
|
memset (&usb_dev->bus->devmap.devicemap, 0,
|
|
sizeof usb_dev->bus->devmap.devicemap);
|
|
set_bit (devnum, usb_dev->bus->devmap.devicemap);
|
|
usb_set_device_state(usb_dev, USB_STATE_ADDRESS);
|
|
|
|
mutex_lock(&usb_bus_list_lock);
|
|
|
|
usb_dev->ep0.desc.wMaxPacketSize = cpu_to_le16(64);
|
|
retval = usb_get_device_descriptor(usb_dev, USB_DT_DEVICE_SIZE);
|
|
if (retval != sizeof usb_dev->descriptor) {
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
dev_dbg (parent_dev, "can't read %s device descriptor %d\n",
|
|
dev_name(&usb_dev->dev), retval);
|
|
return (retval < 0) ? retval : -EMSGSIZE;
|
|
}
|
|
|
|
retval = usb_new_device (usb_dev);
|
|
if (retval) {
|
|
dev_err (parent_dev, "can't register root hub for %s, %d\n",
|
|
dev_name(&usb_dev->dev), retval);
|
|
}
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
|
|
if (retval == 0) {
|
|
spin_lock_irq (&hcd_root_hub_lock);
|
|
hcd->rh_registered = 1;
|
|
spin_unlock_irq (&hcd_root_hub_lock);
|
|
|
|
/* Did the HC die before the root hub was registered? */
|
|
if (HCD_DEAD(hcd))
|
|
usb_hc_died (hcd); /* This time clean up */
|
|
}
|
|
|
|
return retval;
|
|
}
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_calc_bus_time - approximate periodic transaction time in nanoseconds
|
|
* @speed: from dev->speed; USB_SPEED_{LOW,FULL,HIGH}
|
|
* @is_input: true iff the transaction sends data to the host
|
|
* @isoc: true for isochronous transactions, false for interrupt ones
|
|
* @bytecount: how many bytes in the transaction.
|
|
*
|
|
* Returns approximate bus time in nanoseconds for a periodic transaction.
|
|
* See USB 2.0 spec section 5.11.3; only periodic transfers need to be
|
|
* scheduled in software, this function is only used for such scheduling.
|
|
*/
|
|
long usb_calc_bus_time (int speed, int is_input, int isoc, int bytecount)
|
|
{
|
|
unsigned long tmp;
|
|
|
|
switch (speed) {
|
|
case USB_SPEED_LOW: /* INTR only */
|
|
if (is_input) {
|
|
tmp = (67667L * (31L + 10L * BitTime (bytecount))) / 1000L;
|
|
return (64060L + (2 * BW_HUB_LS_SETUP) + BW_HOST_DELAY + tmp);
|
|
} else {
|
|
tmp = (66700L * (31L + 10L * BitTime (bytecount))) / 1000L;
|
|
return (64107L + (2 * BW_HUB_LS_SETUP) + BW_HOST_DELAY + tmp);
|
|
}
|
|
case USB_SPEED_FULL: /* ISOC or INTR */
|
|
if (isoc) {
|
|
tmp = (8354L * (31L + 10L * BitTime (bytecount))) / 1000L;
|
|
return (((is_input) ? 7268L : 6265L) + BW_HOST_DELAY + tmp);
|
|
} else {
|
|
tmp = (8354L * (31L + 10L * BitTime (bytecount))) / 1000L;
|
|
return (9107L + BW_HOST_DELAY + tmp);
|
|
}
|
|
case USB_SPEED_HIGH: /* ISOC or INTR */
|
|
// FIXME adjust for input vs output
|
|
if (isoc)
|
|
tmp = HS_NSECS_ISO (bytecount);
|
|
else
|
|
tmp = HS_NSECS (bytecount);
|
|
return tmp;
|
|
default:
|
|
pr_debug ("%s: bogus device speed!\n", usbcore_name);
|
|
return -1;
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_calc_bus_time);
|
|
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/*
|
|
* Generic HC operations.
|
|
*/
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_hcd_link_urb_to_ep - add an URB to its endpoint queue
|
|
* @hcd: host controller to which @urb was submitted
|
|
* @urb: URB being submitted
|
|
*
|
|
* Host controller drivers should call this routine in their enqueue()
|
|
* method. The HCD's private spinlock must be held and interrupts must
|
|
* be disabled. The actions carried out here are required for URB
|
|
* submission, as well as for endpoint shutdown and for usb_kill_urb.
|
|
*
|
|
* Returns 0 for no error, otherwise a negative error code (in which case
|
|
* the enqueue() method must fail). If no error occurs but enqueue() fails
|
|
* anyway, it must call usb_hcd_unlink_urb_from_ep() before releasing
|
|
* the private spinlock and returning.
|
|
*/
|
|
int usb_hcd_link_urb_to_ep(struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
int rc = 0;
|
|
|
|
spin_lock(&hcd_urb_list_lock);
|
|
|
|
/* Check that the URB isn't being killed */
|
|
if (unlikely(atomic_read(&urb->reject))) {
|
|
rc = -EPERM;
|
|
goto done;
|
|
}
|
|
|
|
if (unlikely(!urb->ep->enabled)) {
|
|
rc = -ENOENT;
|
|
goto done;
|
|
}
|
|
|
|
if (unlikely(!urb->dev->can_submit)) {
|
|
rc = -EHOSTUNREACH;
|
|
goto done;
|
|
}
|
|
|
|
/*
|
|
* Check the host controller's state and add the URB to the
|
|
* endpoint's queue.
|
|
*/
|
|
if (HCD_RH_RUNNING(hcd)) {
|
|
urb->unlinked = 0;
|
|
list_add_tail(&urb->urb_list, &urb->ep->urb_list);
|
|
} else {
|
|
rc = -ESHUTDOWN;
|
|
goto done;
|
|
}
|
|
done:
|
|
spin_unlock(&hcd_urb_list_lock);
|
|
return rc;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_link_urb_to_ep);
|
|
|
|
/**
|
|
* usb_hcd_check_unlink_urb - check whether an URB may be unlinked
|
|
* @hcd: host controller to which @urb was submitted
|
|
* @urb: URB being checked for unlinkability
|
|
* @status: error code to store in @urb if the unlink succeeds
|
|
*
|
|
* Host controller drivers should call this routine in their dequeue()
|
|
* method. The HCD's private spinlock must be held and interrupts must
|
|
* be disabled. The actions carried out here are required for making
|
|
* sure than an unlink is valid.
|
|
*
|
|
* Returns 0 for no error, otherwise a negative error code (in which case
|
|
* the dequeue() method must fail). The possible error codes are:
|
|
*
|
|
* -EIDRM: @urb was not submitted or has already completed.
|
|
* The completion function may not have been called yet.
|
|
*
|
|
* -EBUSY: @urb has already been unlinked.
|
|
*/
|
|
int usb_hcd_check_unlink_urb(struct usb_hcd *hcd, struct urb *urb,
|
|
int status)
|
|
{
|
|
struct list_head *tmp;
|
|
|
|
/* insist the urb is still queued */
|
|
list_for_each(tmp, &urb->ep->urb_list) {
|
|
if (tmp == &urb->urb_list)
|
|
break;
|
|
}
|
|
if (tmp != &urb->urb_list)
|
|
return -EIDRM;
|
|
|
|
/* Any status except -EINPROGRESS means something already started to
|
|
* unlink this URB from the hardware. So there's no more work to do.
|
|
*/
|
|
if (urb->unlinked)
|
|
return -EBUSY;
|
|
urb->unlinked = status;
|
|
|
|
/* IRQ setup can easily be broken so that USB controllers
|
|
* never get completion IRQs ... maybe even the ones we need to
|
|
* finish unlinking the initial failed usb_set_address()
|
|
* or device descriptor fetch.
|
|
*/
|
|
if (!HCD_SAW_IRQ(hcd) && !is_root_hub(urb->dev)) {
|
|
dev_warn(hcd->self.controller, "Unlink after no-IRQ? "
|
|
"Controller is probably using the wrong IRQ.\n");
|
|
set_bit(HCD_FLAG_SAW_IRQ, &hcd->flags);
|
|
if (hcd->shared_hcd)
|
|
set_bit(HCD_FLAG_SAW_IRQ, &hcd->shared_hcd->flags);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_check_unlink_urb);
|
|
|
|
/**
|
|
* usb_hcd_unlink_urb_from_ep - remove an URB from its endpoint queue
|
|
* @hcd: host controller to which @urb was submitted
|
|
* @urb: URB being unlinked
|
|
*
|
|
* Host controller drivers should call this routine before calling
|
|
* usb_hcd_giveback_urb(). The HCD's private spinlock must be held and
|
|
* interrupts must be disabled. The actions carried out here are required
|
|
* for URB completion.
|
|
*/
|
|
void usb_hcd_unlink_urb_from_ep(struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
/* clear all state linking urb to this dev (and hcd) */
|
|
spin_lock(&hcd_urb_list_lock);
|
|
list_del_init(&urb->urb_list);
|
|
spin_unlock(&hcd_urb_list_lock);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_unlink_urb_from_ep);
|
|
|
|
/*
|
|
* Some usb host controllers can only perform dma using a small SRAM area.
|
|
* The usb core itself is however optimized for host controllers that can dma
|
|
* using regular system memory - like pci devices doing bus mastering.
|
|
*
|
|
* To support host controllers with limited dma capabilites we provide dma
|
|
* bounce buffers. This feature can be enabled using the HCD_LOCAL_MEM flag.
|
|
* For this to work properly the host controller code must first use the
|
|
* function dma_declare_coherent_memory() to point out which memory area
|
|
* that should be used for dma allocations.
|
|
*
|
|
* The HCD_LOCAL_MEM flag then tells the usb code to allocate all data for
|
|
* dma using dma_alloc_coherent() which in turn allocates from the memory
|
|
* area pointed out with dma_declare_coherent_memory().
|
|
*
|
|
* So, to summarize...
|
|
*
|
|
* - We need "local" memory, canonical example being
|
|
* a small SRAM on a discrete controller being the
|
|
* only memory that the controller can read ...
|
|
* (a) "normal" kernel memory is no good, and
|
|
* (b) there's not enough to share
|
|
*
|
|
* - The only *portable* hook for such stuff in the
|
|
* DMA framework is dma_declare_coherent_memory()
|
|
*
|
|
* - So we use that, even though the primary requirement
|
|
* is that the memory be "local" (hence addressible
|
|
* by that device), not "coherent".
|
|
*
|
|
*/
|
|
|
|
static int hcd_alloc_coherent(struct usb_bus *bus,
|
|
gfp_t mem_flags, dma_addr_t *dma_handle,
|
|
void **vaddr_handle, size_t size,
|
|
enum dma_data_direction dir)
|
|
{
|
|
unsigned char *vaddr;
|
|
|
|
if (*vaddr_handle == NULL) {
|
|
WARN_ON_ONCE(1);
|
|
return -EFAULT;
|
|
}
|
|
|
|
vaddr = hcd_buffer_alloc(bus, size + sizeof(vaddr),
|
|
mem_flags, dma_handle);
|
|
if (!vaddr)
|
|
return -ENOMEM;
|
|
|
|
/*
|
|
* Store the virtual address of the buffer at the end
|
|
* of the allocated dma buffer. The size of the buffer
|
|
* may be uneven so use unaligned functions instead
|
|
* of just rounding up. It makes sense to optimize for
|
|
* memory footprint over access speed since the amount
|
|
* of memory available for dma may be limited.
|
|
*/
|
|
put_unaligned((unsigned long)*vaddr_handle,
|
|
(unsigned long *)(vaddr + size));
|
|
|
|
if (dir == DMA_TO_DEVICE)
|
|
memcpy(vaddr, *vaddr_handle, size);
|
|
|
|
*vaddr_handle = vaddr;
|
|
return 0;
|
|
}
|
|
|
|
static void hcd_free_coherent(struct usb_bus *bus, dma_addr_t *dma_handle,
|
|
void **vaddr_handle, size_t size,
|
|
enum dma_data_direction dir)
|
|
{
|
|
unsigned char *vaddr = *vaddr_handle;
|
|
|
|
vaddr = (void *)get_unaligned((unsigned long *)(vaddr + size));
|
|
|
|
if (dir == DMA_FROM_DEVICE)
|
|
memcpy(vaddr, *vaddr_handle, size);
|
|
|
|
hcd_buffer_free(bus, size + sizeof(vaddr), *vaddr_handle, *dma_handle);
|
|
|
|
*vaddr_handle = vaddr;
|
|
*dma_handle = 0;
|
|
}
|
|
|
|
void usb_hcd_unmap_urb_setup_for_dma(struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
if (urb->transfer_flags & URB_SETUP_MAP_SINGLE)
|
|
dma_unmap_single(hcd->self.controller,
|
|
urb->setup_dma,
|
|
sizeof(struct usb_ctrlrequest),
|
|
DMA_TO_DEVICE);
|
|
else if (urb->transfer_flags & URB_SETUP_MAP_LOCAL)
|
|
hcd_free_coherent(urb->dev->bus,
|
|
&urb->setup_dma,
|
|
(void **) &urb->setup_packet,
|
|
sizeof(struct usb_ctrlrequest),
|
|
DMA_TO_DEVICE);
|
|
|
|
/* Make it safe to call this routine more than once */
|
|
urb->transfer_flags &= ~(URB_SETUP_MAP_SINGLE | URB_SETUP_MAP_LOCAL);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_unmap_urb_setup_for_dma);
|
|
|
|
static void unmap_urb_for_dma(struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
if (hcd->driver->unmap_urb_for_dma)
|
|
hcd->driver->unmap_urb_for_dma(hcd, urb);
|
|
else
|
|
usb_hcd_unmap_urb_for_dma(hcd, urb);
|
|
}
|
|
|
|
void usb_hcd_unmap_urb_for_dma(struct usb_hcd *hcd, struct urb *urb)
|
|
{
|
|
enum dma_data_direction dir;
|
|
|
|
usb_hcd_unmap_urb_setup_for_dma(hcd, urb);
|
|
|
|
dir = usb_urb_dir_in(urb) ? DMA_FROM_DEVICE : DMA_TO_DEVICE;
|
|
if (urb->transfer_flags & URB_DMA_MAP_SG)
|
|
dma_unmap_sg(hcd->self.controller,
|
|
urb->sg,
|
|
urb->num_sgs,
|
|
dir);
|
|
else if (urb->transfer_flags & URB_DMA_MAP_PAGE)
|
|
dma_unmap_page(hcd->self.controller,
|
|
urb->transfer_dma,
|
|
urb->transfer_buffer_length,
|
|
dir);
|
|
else if (urb->transfer_flags & URB_DMA_MAP_SINGLE)
|
|
dma_unmap_single(hcd->self.controller,
|
|
urb->transfer_dma,
|
|
urb->transfer_buffer_length,
|
|
dir);
|
|
else if (urb->transfer_flags & URB_MAP_LOCAL)
|
|
hcd_free_coherent(urb->dev->bus,
|
|
&urb->transfer_dma,
|
|
&urb->transfer_buffer,
|
|
urb->transfer_buffer_length,
|
|
dir);
|
|
|
|
/* Make it safe to call this routine more than once */
|
|
urb->transfer_flags &= ~(URB_DMA_MAP_SG | URB_DMA_MAP_PAGE |
|
|
URB_DMA_MAP_SINGLE | URB_MAP_LOCAL);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_unmap_urb_for_dma);
|
|
|
|
static int map_urb_for_dma(struct usb_hcd *hcd, struct urb *urb,
|
|
gfp_t mem_flags)
|
|
{
|
|
if (hcd->driver->map_urb_for_dma)
|
|
return hcd->driver->map_urb_for_dma(hcd, urb, mem_flags);
|
|
else
|
|
return usb_hcd_map_urb_for_dma(hcd, urb, mem_flags);
|
|
}
|
|
|
|
int usb_hcd_map_urb_for_dma(struct usb_hcd *hcd, struct urb *urb,
|
|
gfp_t mem_flags)
|
|
{
|
|
enum dma_data_direction dir;
|
|
int ret = 0;
|
|
|
|
/* Map the URB's buffers for DMA access.
|
|
* Lower level HCD code should use *_dma exclusively,
|
|
* unless it uses pio or talks to another transport,
|
|
* or uses the provided scatter gather list for bulk.
|
|
*/
|
|
|
|
if (usb_endpoint_xfer_control(&urb->ep->desc)) {
|
|
if (hcd->self.uses_pio_for_control)
|
|
return ret;
|
|
if (hcd->self.uses_dma) {
|
|
urb->setup_dma = dma_map_single(
|
|
hcd->self.controller,
|
|
urb->setup_packet,
|
|
sizeof(struct usb_ctrlrequest),
|
|
DMA_TO_DEVICE);
|
|
if (dma_mapping_error(hcd->self.controller,
|
|
urb->setup_dma))
|
|
return -EAGAIN;
|
|
urb->transfer_flags |= URB_SETUP_MAP_SINGLE;
|
|
} else if (hcd->driver->flags & HCD_LOCAL_MEM) {
|
|
ret = hcd_alloc_coherent(
|
|
urb->dev->bus, mem_flags,
|
|
&urb->setup_dma,
|
|
(void **)&urb->setup_packet,
|
|
sizeof(struct usb_ctrlrequest),
|
|
DMA_TO_DEVICE);
|
|
if (ret)
|
|
return ret;
|
|
urb->transfer_flags |= URB_SETUP_MAP_LOCAL;
|
|
}
|
|
}
|
|
|
|
dir = usb_urb_dir_in(urb) ? DMA_FROM_DEVICE : DMA_TO_DEVICE;
|
|
if (urb->transfer_buffer_length != 0
|
|
&& !(urb->transfer_flags & URB_NO_TRANSFER_DMA_MAP)) {
|
|
if (hcd->self.uses_dma) {
|
|
if (urb->num_sgs) {
|
|
int n = dma_map_sg(
|
|
hcd->self.controller,
|
|
urb->sg,
|
|
urb->num_sgs,
|
|
dir);
|
|
if (n <= 0)
|
|
ret = -EAGAIN;
|
|
else
|
|
urb->transfer_flags |= URB_DMA_MAP_SG;
|
|
if (n != urb->num_sgs) {
|
|
urb->num_sgs = n;
|
|
urb->transfer_flags |=
|
|
URB_DMA_SG_COMBINED;
|
|
}
|
|
} else if (urb->sg) {
|
|
struct scatterlist *sg = urb->sg;
|
|
urb->transfer_dma = dma_map_page(
|
|
hcd->self.controller,
|
|
sg_page(sg),
|
|
sg->offset,
|
|
urb->transfer_buffer_length,
|
|
dir);
|
|
if (dma_mapping_error(hcd->self.controller,
|
|
urb->transfer_dma))
|
|
ret = -EAGAIN;
|
|
else
|
|
urb->transfer_flags |= URB_DMA_MAP_PAGE;
|
|
} else {
|
|
urb->transfer_dma = dma_map_single(
|
|
hcd->self.controller,
|
|
urb->transfer_buffer,
|
|
urb->transfer_buffer_length,
|
|
dir);
|
|
if (dma_mapping_error(hcd->self.controller,
|
|
urb->transfer_dma))
|
|
ret = -EAGAIN;
|
|
else
|
|
urb->transfer_flags |= URB_DMA_MAP_SINGLE;
|
|
}
|
|
} else if (hcd->driver->flags & HCD_LOCAL_MEM) {
|
|
ret = hcd_alloc_coherent(
|
|
urb->dev->bus, mem_flags,
|
|
&urb->transfer_dma,
|
|
&urb->transfer_buffer,
|
|
urb->transfer_buffer_length,
|
|
dir);
|
|
if (ret == 0)
|
|
urb->transfer_flags |= URB_MAP_LOCAL;
|
|
}
|
|
if (ret && (urb->transfer_flags & (URB_SETUP_MAP_SINGLE |
|
|
URB_SETUP_MAP_LOCAL)))
|
|
usb_hcd_unmap_urb_for_dma(hcd, urb);
|
|
}
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_map_urb_for_dma);
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* may be called in any context with a valid urb->dev usecount
|
|
* caller surrenders "ownership" of urb
|
|
* expects usb_submit_urb() to have sanity checked and conditioned all
|
|
* inputs in the urb
|
|
*/
|
|
int usb_hcd_submit_urb (struct urb *urb, gfp_t mem_flags)
|
|
{
|
|
int status;
|
|
struct usb_hcd *hcd = bus_to_hcd(urb->dev->bus);
|
|
|
|
/* increment urb's reference count as part of giving it to the HCD
|
|
* (which will control it). HCD guarantees that it either returns
|
|
* an error or calls giveback(), but not both.
|
|
*/
|
|
usb_get_urb(urb);
|
|
atomic_inc(&urb->use_count);
|
|
atomic_inc(&urb->dev->urbnum);
|
|
usbmon_urb_submit(&hcd->self, urb);
|
|
|
|
/* NOTE requirements on root-hub callers (usbfs and the hub
|
|
* driver, for now): URBs' urb->transfer_buffer must be
|
|
* valid and usb_buffer_{sync,unmap}() not be needed, since
|
|
* they could clobber root hub response data. Also, control
|
|
* URBs must be submitted in process context with interrupts
|
|
* enabled.
|
|
*/
|
|
|
|
if (is_root_hub(urb->dev)) {
|
|
status = rh_urb_enqueue(hcd, urb);
|
|
} else {
|
|
status = map_urb_for_dma(hcd, urb, mem_flags);
|
|
if (likely(status == 0)) {
|
|
status = hcd->driver->urb_enqueue(hcd, urb, mem_flags);
|
|
if (unlikely(status))
|
|
unmap_urb_for_dma(hcd, urb);
|
|
}
|
|
}
|
|
|
|
if (unlikely(status)) {
|
|
usbmon_urb_submit_error(&hcd->self, urb, status);
|
|
urb->hcpriv = NULL;
|
|
INIT_LIST_HEAD(&urb->urb_list);
|
|
atomic_dec(&urb->use_count);
|
|
atomic_dec(&urb->dev->urbnum);
|
|
if (atomic_read(&urb->reject))
|
|
wake_up(&usb_kill_urb_queue);
|
|
usb_put_urb(urb);
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* this makes the hcd giveback() the urb more quickly, by kicking it
|
|
* off hardware queues (which may take a while) and returning it as
|
|
* soon as practical. we've already set up the urb's return status,
|
|
* but we can't know if the callback completed already.
|
|
*/
|
|
static int unlink1(struct usb_hcd *hcd, struct urb *urb, int status)
|
|
{
|
|
int value;
|
|
|
|
if (is_root_hub(urb->dev))
|
|
value = usb_rh_urb_dequeue(hcd, urb, status);
|
|
else {
|
|
|
|
/* The only reason an HCD might fail this call is if
|
|
* it has not yet fully queued the urb to begin with.
|
|
* Such failures should be harmless. */
|
|
value = hcd->driver->urb_dequeue(hcd, urb, status);
|
|
}
|
|
return value;
|
|
}
|
|
|
|
/*
|
|
* called in any context
|
|
*
|
|
* caller guarantees urb won't be recycled till both unlink()
|
|
* and the urb's completion function return
|
|
*/
|
|
int usb_hcd_unlink_urb (struct urb *urb, int status)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
int retval = -EIDRM;
|
|
unsigned long flags;
|
|
|
|
/* Prevent the device and bus from going away while
|
|
* the unlink is carried out. If they are already gone
|
|
* then urb->use_count must be 0, since disconnected
|
|
* devices can't have any active URBs.
|
|
*/
|
|
spin_lock_irqsave(&hcd_urb_unlink_lock, flags);
|
|
if (atomic_read(&urb->use_count) > 0) {
|
|
retval = 0;
|
|
usb_get_dev(urb->dev);
|
|
}
|
|
spin_unlock_irqrestore(&hcd_urb_unlink_lock, flags);
|
|
if (retval == 0) {
|
|
hcd = bus_to_hcd(urb->dev->bus);
|
|
retval = unlink1(hcd, urb, status);
|
|
usb_put_dev(urb->dev);
|
|
}
|
|
|
|
if (retval == 0)
|
|
retval = -EINPROGRESS;
|
|
else if (retval != -EIDRM && retval != -EBUSY)
|
|
dev_dbg(&urb->dev->dev, "hcd_unlink_urb %p fail %d\n",
|
|
urb, retval);
|
|
return retval;
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_hcd_giveback_urb - return URB from HCD to device driver
|
|
* @hcd: host controller returning the URB
|
|
* @urb: urb being returned to the USB device driver.
|
|
* @status: completion status code for the URB.
|
|
* Context: in_interrupt()
|
|
*
|
|
* This hands the URB from HCD to its USB device driver, using its
|
|
* completion function. The HCD has freed all per-urb resources
|
|
* (and is done using urb->hcpriv). It also released all HCD locks;
|
|
* the device driver won't cause problems if it frees, modifies,
|
|
* or resubmits this URB.
|
|
*
|
|
* If @urb was unlinked, the value of @status will be overridden by
|
|
* @urb->unlinked. Erroneous short transfers are detected in case
|
|
* the HCD hasn't checked for them.
|
|
*/
|
|
void usb_hcd_giveback_urb(struct usb_hcd *hcd, struct urb *urb, int status)
|
|
{
|
|
urb->hcpriv = NULL;
|
|
if (unlikely(urb->unlinked))
|
|
status = urb->unlinked;
|
|
else if (unlikely((urb->transfer_flags & URB_SHORT_NOT_OK) &&
|
|
urb->actual_length < urb->transfer_buffer_length &&
|
|
!status))
|
|
status = -EREMOTEIO;
|
|
|
|
unmap_urb_for_dma(hcd, urb);
|
|
usbmon_urb_complete(&hcd->self, urb, status);
|
|
usb_unanchor_urb(urb);
|
|
|
|
/* pass ownership to the completion handler */
|
|
urb->status = status;
|
|
urb->complete (urb);
|
|
atomic_dec (&urb->use_count);
|
|
if (unlikely(atomic_read(&urb->reject)))
|
|
wake_up (&usb_kill_urb_queue);
|
|
usb_put_urb (urb);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_giveback_urb);
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* Cancel all URBs pending on this endpoint and wait for the endpoint's
|
|
* queue to drain completely. The caller must first insure that no more
|
|
* URBs can be submitted for this endpoint.
|
|
*/
|
|
void usb_hcd_flush_endpoint(struct usb_device *udev,
|
|
struct usb_host_endpoint *ep)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
struct urb *urb;
|
|
|
|
if (!ep)
|
|
return;
|
|
might_sleep();
|
|
hcd = bus_to_hcd(udev->bus);
|
|
|
|
/* No more submits can occur */
|
|
spin_lock_irq(&hcd_urb_list_lock);
|
|
rescan:
|
|
list_for_each_entry (urb, &ep->urb_list, urb_list) {
|
|
int is_in;
|
|
|
|
if (urb->unlinked)
|
|
continue;
|
|
usb_get_urb (urb);
|
|
is_in = usb_urb_dir_in(urb);
|
|
spin_unlock(&hcd_urb_list_lock);
|
|
|
|
/* kick hcd */
|
|
unlink1(hcd, urb, -ESHUTDOWN);
|
|
dev_dbg (hcd->self.controller,
|
|
"shutdown urb %p ep%d%s%s\n",
|
|
urb, usb_endpoint_num(&ep->desc),
|
|
is_in ? "in" : "out",
|
|
({ char *s;
|
|
|
|
switch (usb_endpoint_type(&ep->desc)) {
|
|
case USB_ENDPOINT_XFER_CONTROL:
|
|
s = ""; break;
|
|
case USB_ENDPOINT_XFER_BULK:
|
|
s = "-bulk"; break;
|
|
case USB_ENDPOINT_XFER_INT:
|
|
s = "-intr"; break;
|
|
default:
|
|
s = "-iso"; break;
|
|
};
|
|
s;
|
|
}));
|
|
usb_put_urb (urb);
|
|
|
|
/* list contents may have changed */
|
|
spin_lock(&hcd_urb_list_lock);
|
|
goto rescan;
|
|
}
|
|
spin_unlock_irq(&hcd_urb_list_lock);
|
|
|
|
/* Wait until the endpoint queue is completely empty */
|
|
while (!list_empty (&ep->urb_list)) {
|
|
spin_lock_irq(&hcd_urb_list_lock);
|
|
|
|
/* The list may have changed while we acquired the spinlock */
|
|
urb = NULL;
|
|
if (!list_empty (&ep->urb_list)) {
|
|
urb = list_entry (ep->urb_list.prev, struct urb,
|
|
urb_list);
|
|
usb_get_urb (urb);
|
|
}
|
|
spin_unlock_irq(&hcd_urb_list_lock);
|
|
|
|
if (urb) {
|
|
usb_kill_urb (urb);
|
|
usb_put_urb (urb);
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* usb_hcd_alloc_bandwidth - check whether a new bandwidth setting exceeds
|
|
* the bus bandwidth
|
|
* @udev: target &usb_device
|
|
* @new_config: new configuration to install
|
|
* @cur_alt: the current alternate interface setting
|
|
* @new_alt: alternate interface setting that is being installed
|
|
*
|
|
* To change configurations, pass in the new configuration in new_config,
|
|
* and pass NULL for cur_alt and new_alt.
|
|
*
|
|
* To reset a device's configuration (put the device in the ADDRESSED state),
|
|
* pass in NULL for new_config, cur_alt, and new_alt.
|
|
*
|
|
* To change alternate interface settings, pass in NULL for new_config,
|
|
* pass in the current alternate interface setting in cur_alt,
|
|
* and pass in the new alternate interface setting in new_alt.
|
|
*
|
|
* Returns an error if the requested bandwidth change exceeds the
|
|
* bus bandwidth or host controller internal resources.
|
|
*/
|
|
int usb_hcd_alloc_bandwidth(struct usb_device *udev,
|
|
struct usb_host_config *new_config,
|
|
struct usb_host_interface *cur_alt,
|
|
struct usb_host_interface *new_alt)
|
|
{
|
|
int num_intfs, i, j;
|
|
struct usb_host_interface *alt = NULL;
|
|
int ret = 0;
|
|
struct usb_hcd *hcd;
|
|
struct usb_host_endpoint *ep;
|
|
|
|
hcd = bus_to_hcd(udev->bus);
|
|
if (!hcd->driver->check_bandwidth)
|
|
return 0;
|
|
|
|
/* Configuration is being removed - set configuration 0 */
|
|
if (!new_config && !cur_alt) {
|
|
for (i = 1; i < 16; ++i) {
|
|
ep = udev->ep_out[i];
|
|
if (ep)
|
|
hcd->driver->drop_endpoint(hcd, udev, ep);
|
|
ep = udev->ep_in[i];
|
|
if (ep)
|
|
hcd->driver->drop_endpoint(hcd, udev, ep);
|
|
}
|
|
hcd->driver->check_bandwidth(hcd, udev);
|
|
return 0;
|
|
}
|
|
/* Check if the HCD says there's enough bandwidth. Enable all endpoints
|
|
* each interface's alt setting 0 and ask the HCD to check the bandwidth
|
|
* of the bus. There will always be bandwidth for endpoint 0, so it's
|
|
* ok to exclude it.
|
|
*/
|
|
if (new_config) {
|
|
num_intfs = new_config->desc.bNumInterfaces;
|
|
/* Remove endpoints (except endpoint 0, which is always on the
|
|
* schedule) from the old config from the schedule
|
|
*/
|
|
for (i = 1; i < 16; ++i) {
|
|
ep = udev->ep_out[i];
|
|
if (ep) {
|
|
ret = hcd->driver->drop_endpoint(hcd, udev, ep);
|
|
if (ret < 0)
|
|
goto reset;
|
|
}
|
|
ep = udev->ep_in[i];
|
|
if (ep) {
|
|
ret = hcd->driver->drop_endpoint(hcd, udev, ep);
|
|
if (ret < 0)
|
|
goto reset;
|
|
}
|
|
}
|
|
for (i = 0; i < num_intfs; ++i) {
|
|
struct usb_host_interface *first_alt;
|
|
int iface_num;
|
|
|
|
first_alt = &new_config->intf_cache[i]->altsetting[0];
|
|
iface_num = first_alt->desc.bInterfaceNumber;
|
|
/* Set up endpoints for alternate interface setting 0 */
|
|
alt = usb_find_alt_setting(new_config, iface_num, 0);
|
|
if (!alt)
|
|
/* No alt setting 0? Pick the first setting. */
|
|
alt = first_alt;
|
|
|
|
for (j = 0; j < alt->desc.bNumEndpoints; j++) {
|
|
ret = hcd->driver->add_endpoint(hcd, udev, &alt->endpoint[j]);
|
|
if (ret < 0)
|
|
goto reset;
|
|
}
|
|
}
|
|
}
|
|
if (cur_alt && new_alt) {
|
|
struct usb_interface *iface = usb_ifnum_to_if(udev,
|
|
cur_alt->desc.bInterfaceNumber);
|
|
|
|
if (!iface)
|
|
return -EINVAL;
|
|
if (iface->resetting_device) {
|
|
/*
|
|
* The USB core just reset the device, so the xHCI host
|
|
* and the device will think alt setting 0 is installed.
|
|
* However, the USB core will pass in the alternate
|
|
* setting installed before the reset as cur_alt. Dig
|
|
* out the alternate setting 0 structure, or the first
|
|
* alternate setting if a broken device doesn't have alt
|
|
* setting 0.
|
|
*/
|
|
cur_alt = usb_altnum_to_altsetting(iface, 0);
|
|
if (!cur_alt)
|
|
cur_alt = &iface->altsetting[0];
|
|
}
|
|
|
|
/* Drop all the endpoints in the current alt setting */
|
|
for (i = 0; i < cur_alt->desc.bNumEndpoints; i++) {
|
|
ret = hcd->driver->drop_endpoint(hcd, udev,
|
|
&cur_alt->endpoint[i]);
|
|
if (ret < 0)
|
|
goto reset;
|
|
}
|
|
/* Add all the endpoints in the new alt setting */
|
|
for (i = 0; i < new_alt->desc.bNumEndpoints; i++) {
|
|
ret = hcd->driver->add_endpoint(hcd, udev,
|
|
&new_alt->endpoint[i]);
|
|
if (ret < 0)
|
|
goto reset;
|
|
}
|
|
}
|
|
ret = hcd->driver->check_bandwidth(hcd, udev);
|
|
reset:
|
|
if (ret < 0)
|
|
hcd->driver->reset_bandwidth(hcd, udev);
|
|
return ret;
|
|
}
|
|
|
|
/* Disables the endpoint: synchronizes with the hcd to make sure all
|
|
* endpoint state is gone from hardware. usb_hcd_flush_endpoint() must
|
|
* have been called previously. Use for set_configuration, set_interface,
|
|
* driver removal, physical disconnect.
|
|
*
|
|
* example: a qh stored in ep->hcpriv, holding state related to endpoint
|
|
* type, maxpacket size, toggle, halt status, and scheduling.
|
|
*/
|
|
void usb_hcd_disable_endpoint(struct usb_device *udev,
|
|
struct usb_host_endpoint *ep)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
|
|
might_sleep();
|
|
hcd = bus_to_hcd(udev->bus);
|
|
if (hcd->driver->endpoint_disable)
|
|
hcd->driver->endpoint_disable(hcd, ep);
|
|
}
|
|
|
|
/**
|
|
* usb_hcd_reset_endpoint - reset host endpoint state
|
|
* @udev: USB device.
|
|
* @ep: the endpoint to reset.
|
|
*
|
|
* Resets any host endpoint state such as the toggle bit, sequence
|
|
* number and current window.
|
|
*/
|
|
void usb_hcd_reset_endpoint(struct usb_device *udev,
|
|
struct usb_host_endpoint *ep)
|
|
{
|
|
struct usb_hcd *hcd = bus_to_hcd(udev->bus);
|
|
|
|
if (hcd->driver->endpoint_reset)
|
|
hcd->driver->endpoint_reset(hcd, ep);
|
|
else {
|
|
int epnum = usb_endpoint_num(&ep->desc);
|
|
int is_out = usb_endpoint_dir_out(&ep->desc);
|
|
int is_control = usb_endpoint_xfer_control(&ep->desc);
|
|
|
|
usb_settoggle(udev, epnum, is_out, 0);
|
|
if (is_control)
|
|
usb_settoggle(udev, epnum, !is_out, 0);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* usb_alloc_streams - allocate bulk endpoint stream IDs.
|
|
* @interface: alternate setting that includes all endpoints.
|
|
* @eps: array of endpoints that need streams.
|
|
* @num_eps: number of endpoints in the array.
|
|
* @num_streams: number of streams to allocate.
|
|
* @mem_flags: flags hcd should use to allocate memory.
|
|
*
|
|
* Sets up a group of bulk endpoints to have num_streams stream IDs available.
|
|
* Drivers may queue multiple transfers to different stream IDs, which may
|
|
* complete in a different order than they were queued.
|
|
*/
|
|
int usb_alloc_streams(struct usb_interface *interface,
|
|
struct usb_host_endpoint **eps, unsigned int num_eps,
|
|
unsigned int num_streams, gfp_t mem_flags)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
struct usb_device *dev;
|
|
int i;
|
|
|
|
dev = interface_to_usbdev(interface);
|
|
hcd = bus_to_hcd(dev->bus);
|
|
if (!hcd->driver->alloc_streams || !hcd->driver->free_streams)
|
|
return -EINVAL;
|
|
if (dev->speed != USB_SPEED_SUPER)
|
|
return -EINVAL;
|
|
|
|
/* Streams only apply to bulk endpoints. */
|
|
for (i = 0; i < num_eps; i++)
|
|
if (!usb_endpoint_xfer_bulk(&eps[i]->desc))
|
|
return -EINVAL;
|
|
|
|
return hcd->driver->alloc_streams(hcd, dev, eps, num_eps,
|
|
num_streams, mem_flags);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_alloc_streams);
|
|
|
|
/**
|
|
* usb_free_streams - free bulk endpoint stream IDs.
|
|
* @interface: alternate setting that includes all endpoints.
|
|
* @eps: array of endpoints to remove streams from.
|
|
* @num_eps: number of endpoints in the array.
|
|
* @mem_flags: flags hcd should use to allocate memory.
|
|
*
|
|
* Reverts a group of bulk endpoints back to not using stream IDs.
|
|
* Can fail if we are given bad arguments, or HCD is broken.
|
|
*/
|
|
void usb_free_streams(struct usb_interface *interface,
|
|
struct usb_host_endpoint **eps, unsigned int num_eps,
|
|
gfp_t mem_flags)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
struct usb_device *dev;
|
|
int i;
|
|
|
|
dev = interface_to_usbdev(interface);
|
|
hcd = bus_to_hcd(dev->bus);
|
|
if (dev->speed != USB_SPEED_SUPER)
|
|
return;
|
|
|
|
/* Streams only apply to bulk endpoints. */
|
|
for (i = 0; i < num_eps; i++)
|
|
if (!eps[i] || !usb_endpoint_xfer_bulk(&eps[i]->desc))
|
|
return;
|
|
|
|
hcd->driver->free_streams(hcd, dev, eps, num_eps, mem_flags);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_free_streams);
|
|
|
|
/* Protect against drivers that try to unlink URBs after the device
|
|
* is gone, by waiting until all unlinks for @udev are finished.
|
|
* Since we don't currently track URBs by device, simply wait until
|
|
* nothing is running in the locked region of usb_hcd_unlink_urb().
|
|
*/
|
|
void usb_hcd_synchronize_unlinks(struct usb_device *udev)
|
|
{
|
|
spin_lock_irq(&hcd_urb_unlink_lock);
|
|
spin_unlock_irq(&hcd_urb_unlink_lock);
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/* called in any context */
|
|
int usb_hcd_get_frame_number (struct usb_device *udev)
|
|
{
|
|
struct usb_hcd *hcd = bus_to_hcd(udev->bus);
|
|
|
|
if (!HCD_RH_RUNNING(hcd))
|
|
return -ESHUTDOWN;
|
|
return hcd->driver->get_frame_number (hcd);
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
#ifdef CONFIG_PM
|
|
|
|
int hcd_bus_suspend(struct usb_device *rhdev, pm_message_t msg)
|
|
{
|
|
struct usb_hcd *hcd = container_of(rhdev->bus, struct usb_hcd, self);
|
|
int status;
|
|
int old_state = hcd->state;
|
|
|
|
dev_dbg(&rhdev->dev, "bus %s%s\n",
|
|
(msg.event & PM_EVENT_AUTO ? "auto-" : ""), "suspend");
|
|
if (HCD_DEAD(hcd)) {
|
|
dev_dbg(&rhdev->dev, "skipped %s of dead bus\n", "suspend");
|
|
return 0;
|
|
}
|
|
|
|
if (!hcd->driver->bus_suspend) {
|
|
status = -ENOENT;
|
|
} else {
|
|
clear_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
hcd->state = HC_STATE_QUIESCING;
|
|
status = hcd->driver->bus_suspend(hcd);
|
|
}
|
|
if (status == 0) {
|
|
usb_set_device_state(rhdev, USB_STATE_SUSPENDED);
|
|
hcd->state = HC_STATE_SUSPENDED;
|
|
} else {
|
|
spin_lock_irq(&hcd_root_hub_lock);
|
|
if (!HCD_DEAD(hcd)) {
|
|
set_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
hcd->state = old_state;
|
|
}
|
|
spin_unlock_irq(&hcd_root_hub_lock);
|
|
dev_dbg(&rhdev->dev, "bus %s fail, err %d\n",
|
|
"suspend", status);
|
|
}
|
|
return status;
|
|
}
|
|
|
|
int hcd_bus_resume(struct usb_device *rhdev, pm_message_t msg)
|
|
{
|
|
struct usb_hcd *hcd = container_of(rhdev->bus, struct usb_hcd, self);
|
|
int status;
|
|
int old_state = hcd->state;
|
|
|
|
dev_dbg(&rhdev->dev, "usb %s%s\n",
|
|
(msg.event & PM_EVENT_AUTO ? "auto-" : ""), "resume");
|
|
if (HCD_DEAD(hcd)) {
|
|
dev_dbg(&rhdev->dev, "skipped %s of dead bus\n", "resume");
|
|
return 0;
|
|
}
|
|
if (!hcd->driver->bus_resume)
|
|
return -ENOENT;
|
|
if (HCD_RH_RUNNING(hcd))
|
|
return 0;
|
|
|
|
hcd->state = HC_STATE_RESUMING;
|
|
status = hcd->driver->bus_resume(hcd);
|
|
clear_bit(HCD_FLAG_WAKEUP_PENDING, &hcd->flags);
|
|
if (status == 0) {
|
|
/* TRSMRCY = 10 msec */
|
|
msleep(10);
|
|
spin_lock_irq(&hcd_root_hub_lock);
|
|
if (!HCD_DEAD(hcd)) {
|
|
usb_set_device_state(rhdev, rhdev->actconfig
|
|
? USB_STATE_CONFIGURED
|
|
: USB_STATE_ADDRESS);
|
|
set_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
hcd->state = HC_STATE_RUNNING;
|
|
}
|
|
spin_unlock_irq(&hcd_root_hub_lock);
|
|
} else {
|
|
hcd->state = old_state;
|
|
dev_dbg(&rhdev->dev, "bus %s fail, err %d\n",
|
|
"resume", status);
|
|
if (status != -ESHUTDOWN)
|
|
usb_hc_died(hcd);
|
|
}
|
|
return status;
|
|
}
|
|
|
|
#endif /* CONFIG_PM */
|
|
|
|
#ifdef CONFIG_USB_SUSPEND
|
|
|
|
/* Workqueue routine for root-hub remote wakeup */
|
|
static void hcd_resume_work(struct work_struct *work)
|
|
{
|
|
struct usb_hcd *hcd = container_of(work, struct usb_hcd, wakeup_work);
|
|
struct usb_device *udev = hcd->self.root_hub;
|
|
|
|
usb_lock_device(udev);
|
|
usb_remote_wakeup(udev);
|
|
usb_unlock_device(udev);
|
|
}
|
|
|
|
/**
|
|
* usb_hcd_resume_root_hub - called by HCD to resume its root hub
|
|
* @hcd: host controller for this root hub
|
|
*
|
|
* The USB host controller calls this function when its root hub is
|
|
* suspended (with the remote wakeup feature enabled) and a remote
|
|
* wakeup request is received. The routine submits a workqueue request
|
|
* to resume the root hub (that is, manage its downstream ports again).
|
|
*/
|
|
void usb_hcd_resume_root_hub (struct usb_hcd *hcd)
|
|
{
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave (&hcd_root_hub_lock, flags);
|
|
if (hcd->rh_registered) {
|
|
set_bit(HCD_FLAG_WAKEUP_PENDING, &hcd->flags);
|
|
queue_work(pm_wq, &hcd->wakeup_work);
|
|
}
|
|
spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_resume_root_hub);
|
|
|
|
#endif /* CONFIG_USB_SUSPEND */
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
#ifdef CONFIG_USB_OTG
|
|
|
|
/**
|
|
* usb_bus_start_enum - start immediate enumeration (for OTG)
|
|
* @bus: the bus (must use hcd framework)
|
|
* @port_num: 1-based number of port; usually bus->otg_port
|
|
* Context: in_interrupt()
|
|
*
|
|
* Starts enumeration, with an immediate reset followed later by
|
|
* khubd identifying and possibly configuring the device.
|
|
* This is needed by OTG controller drivers, where it helps meet
|
|
* HNP protocol timing requirements for starting a port reset.
|
|
*/
|
|
int usb_bus_start_enum(struct usb_bus *bus, unsigned port_num)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
int status = -EOPNOTSUPP;
|
|
|
|
/* NOTE: since HNP can't start by grabbing the bus's address0_sem,
|
|
* boards with root hubs hooked up to internal devices (instead of
|
|
* just the OTG port) may need more attention to resetting...
|
|
*/
|
|
hcd = container_of (bus, struct usb_hcd, self);
|
|
if (port_num && hcd->driver->start_port_reset)
|
|
status = hcd->driver->start_port_reset(hcd, port_num);
|
|
|
|
/* run khubd shortly after (first) root port reset finishes;
|
|
* it may issue others, until at least 50 msecs have passed.
|
|
*/
|
|
if (status == 0)
|
|
mod_timer(&hcd->rh_timer, jiffies + msecs_to_jiffies(10));
|
|
return status;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_bus_start_enum);
|
|
|
|
#endif
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_hcd_irq - hook IRQs to HCD framework (bus glue)
|
|
* @irq: the IRQ being raised
|
|
* @__hcd: pointer to the HCD whose IRQ is being signaled
|
|
*
|
|
* If the controller isn't HALTed, calls the driver's irq handler.
|
|
* Checks whether the controller is now dead.
|
|
*/
|
|
irqreturn_t usb_hcd_irq (int irq, void *__hcd)
|
|
{
|
|
struct usb_hcd *hcd = __hcd;
|
|
unsigned long flags;
|
|
irqreturn_t rc;
|
|
|
|
/* IRQF_DISABLED doesn't work correctly with shared IRQs
|
|
* when the first handler doesn't use it. So let's just
|
|
* assume it's never used.
|
|
*/
|
|
local_irq_save(flags);
|
|
|
|
if (unlikely(HCD_DEAD(hcd) || !HCD_HW_ACCESSIBLE(hcd))) {
|
|
rc = IRQ_NONE;
|
|
} else if (hcd->driver->irq(hcd) == IRQ_NONE) {
|
|
rc = IRQ_NONE;
|
|
} else {
|
|
set_bit(HCD_FLAG_SAW_IRQ, &hcd->flags);
|
|
if (hcd->shared_hcd)
|
|
set_bit(HCD_FLAG_SAW_IRQ, &hcd->shared_hcd->flags);
|
|
rc = IRQ_HANDLED;
|
|
}
|
|
|
|
local_irq_restore(flags);
|
|
return rc;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_irq);
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_hc_died - report abnormal shutdown of a host controller (bus glue)
|
|
* @hcd: pointer to the HCD representing the controller
|
|
*
|
|
* This is called by bus glue to report a USB host controller that died
|
|
* while operations may still have been pending. It's called automatically
|
|
* by the PCI glue, so only glue for non-PCI busses should need to call it.
|
|
*
|
|
* Only call this function with the primary HCD.
|
|
*/
|
|
void usb_hc_died (struct usb_hcd *hcd)
|
|
{
|
|
unsigned long flags;
|
|
|
|
dev_err (hcd->self.controller, "HC died; cleaning up\n");
|
|
|
|
spin_lock_irqsave (&hcd_root_hub_lock, flags);
|
|
clear_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
set_bit(HCD_FLAG_DEAD, &hcd->flags);
|
|
if (hcd->rh_registered) {
|
|
clear_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
|
|
|
/* make khubd clean up old urbs and devices */
|
|
usb_set_device_state (hcd->self.root_hub,
|
|
USB_STATE_NOTATTACHED);
|
|
usb_kick_khubd (hcd->self.root_hub);
|
|
}
|
|
if (usb_hcd_is_primary_hcd(hcd) && hcd->shared_hcd) {
|
|
hcd = hcd->shared_hcd;
|
|
if (hcd->rh_registered) {
|
|
clear_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
|
|
|
/* make khubd clean up old urbs and devices */
|
|
usb_set_device_state(hcd->self.root_hub,
|
|
USB_STATE_NOTATTACHED);
|
|
usb_kick_khubd(hcd->self.root_hub);
|
|
}
|
|
}
|
|
spin_unlock_irqrestore (&hcd_root_hub_lock, flags);
|
|
/* Make sure that the other roothub is also deallocated. */
|
|
}
|
|
EXPORT_SYMBOL_GPL (usb_hc_died);
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
/**
|
|
* usb_create_shared_hcd - create and initialize an HCD structure
|
|
* @driver: HC driver that will use this hcd
|
|
* @dev: device for this HC, stored in hcd->self.controller
|
|
* @bus_name: value to store in hcd->self.bus_name
|
|
* @primary_hcd: a pointer to the usb_hcd structure that is sharing the
|
|
* PCI device. Only allocate certain resources for the primary HCD
|
|
* Context: !in_interrupt()
|
|
*
|
|
* Allocate a struct usb_hcd, with extra space at the end for the
|
|
* HC driver's private data. Initialize the generic members of the
|
|
* hcd structure.
|
|
*
|
|
* If memory is unavailable, returns NULL.
|
|
*/
|
|
struct usb_hcd *usb_create_shared_hcd(const struct hc_driver *driver,
|
|
struct device *dev, const char *bus_name,
|
|
struct usb_hcd *primary_hcd)
|
|
{
|
|
struct usb_hcd *hcd;
|
|
|
|
hcd = kzalloc(sizeof(*hcd) + driver->hcd_priv_size, GFP_KERNEL);
|
|
if (!hcd) {
|
|
dev_dbg (dev, "hcd alloc failed\n");
|
|
return NULL;
|
|
}
|
|
if (primary_hcd == NULL) {
|
|
hcd->bandwidth_mutex = kmalloc(sizeof(*hcd->bandwidth_mutex),
|
|
GFP_KERNEL);
|
|
if (!hcd->bandwidth_mutex) {
|
|
kfree(hcd);
|
|
dev_dbg(dev, "hcd bandwidth mutex alloc failed\n");
|
|
return NULL;
|
|
}
|
|
mutex_init(hcd->bandwidth_mutex);
|
|
dev_set_drvdata(dev, hcd);
|
|
} else {
|
|
hcd->bandwidth_mutex = primary_hcd->bandwidth_mutex;
|
|
hcd->primary_hcd = primary_hcd;
|
|
primary_hcd->primary_hcd = primary_hcd;
|
|
hcd->shared_hcd = primary_hcd;
|
|
primary_hcd->shared_hcd = hcd;
|
|
}
|
|
|
|
kref_init(&hcd->kref);
|
|
|
|
usb_bus_init(&hcd->self);
|
|
hcd->self.controller = dev;
|
|
hcd->self.bus_name = bus_name;
|
|
hcd->self.uses_dma = (dev->dma_mask != NULL);
|
|
|
|
init_timer(&hcd->rh_timer);
|
|
hcd->rh_timer.function = rh_timer_func;
|
|
hcd->rh_timer.data = (unsigned long) hcd;
|
|
#ifdef CONFIG_USB_SUSPEND
|
|
INIT_WORK(&hcd->wakeup_work, hcd_resume_work);
|
|
#endif
|
|
|
|
hcd->driver = driver;
|
|
hcd->speed = driver->flags & HCD_MASK;
|
|
hcd->product_desc = (driver->product_desc) ? driver->product_desc :
|
|
"USB Host Controller";
|
|
return hcd;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_create_shared_hcd);
|
|
|
|
/**
|
|
* usb_create_hcd - create and initialize an HCD structure
|
|
* @driver: HC driver that will use this hcd
|
|
* @dev: device for this HC, stored in hcd->self.controller
|
|
* @bus_name: value to store in hcd->self.bus_name
|
|
* Context: !in_interrupt()
|
|
*
|
|
* Allocate a struct usb_hcd, with extra space at the end for the
|
|
* HC driver's private data. Initialize the generic members of the
|
|
* hcd structure.
|
|
*
|
|
* If memory is unavailable, returns NULL.
|
|
*/
|
|
struct usb_hcd *usb_create_hcd(const struct hc_driver *driver,
|
|
struct device *dev, const char *bus_name)
|
|
{
|
|
return usb_create_shared_hcd(driver, dev, bus_name, NULL);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_create_hcd);
|
|
|
|
/*
|
|
* Roothubs that share one PCI device must also share the bandwidth mutex.
|
|
* Don't deallocate the bandwidth_mutex until the last shared usb_hcd is
|
|
* deallocated.
|
|
*
|
|
* Make sure to only deallocate the bandwidth_mutex when the primary HCD is
|
|
* freed. When hcd_release() is called for the non-primary HCD, set the
|
|
* primary_hcd's shared_hcd pointer to null (since the non-primary HCD will be
|
|
* freed shortly).
|
|
*/
|
|
static void hcd_release (struct kref *kref)
|
|
{
|
|
struct usb_hcd *hcd = container_of (kref, struct usb_hcd, kref);
|
|
|
|
if (usb_hcd_is_primary_hcd(hcd))
|
|
kfree(hcd->bandwidth_mutex);
|
|
else
|
|
hcd->shared_hcd->shared_hcd = NULL;
|
|
kfree(hcd);
|
|
}
|
|
|
|
struct usb_hcd *usb_get_hcd (struct usb_hcd *hcd)
|
|
{
|
|
if (hcd)
|
|
kref_get (&hcd->kref);
|
|
return hcd;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_get_hcd);
|
|
|
|
void usb_put_hcd (struct usb_hcd *hcd)
|
|
{
|
|
if (hcd)
|
|
kref_put (&hcd->kref, hcd_release);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_put_hcd);
|
|
|
|
int usb_hcd_is_primary_hcd(struct usb_hcd *hcd)
|
|
{
|
|
if (!hcd->primary_hcd)
|
|
return 1;
|
|
return hcd == hcd->primary_hcd;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_is_primary_hcd);
|
|
|
|
static int usb_hcd_request_irqs(struct usb_hcd *hcd,
|
|
unsigned int irqnum, unsigned long irqflags)
|
|
{
|
|
int retval;
|
|
|
|
if (hcd->driver->irq) {
|
|
|
|
/* IRQF_DISABLED doesn't work as advertised when used together
|
|
* with IRQF_SHARED. As usb_hcd_irq() will always disable
|
|
* interrupts we can remove it here.
|
|
*/
|
|
if (irqflags & IRQF_SHARED)
|
|
irqflags &= ~IRQF_DISABLED;
|
|
|
|
snprintf(hcd->irq_descr, sizeof(hcd->irq_descr), "%s:usb%d",
|
|
hcd->driver->description, hcd->self.busnum);
|
|
retval = request_irq(irqnum, &usb_hcd_irq, irqflags,
|
|
hcd->irq_descr, hcd);
|
|
if (retval != 0) {
|
|
dev_err(hcd->self.controller,
|
|
"request interrupt %d failed\n",
|
|
irqnum);
|
|
return retval;
|
|
}
|
|
hcd->irq = irqnum;
|
|
dev_info(hcd->self.controller, "irq %d, %s 0x%08llx\n", irqnum,
|
|
(hcd->driver->flags & HCD_MEMORY) ?
|
|
"io mem" : "io base",
|
|
(unsigned long long)hcd->rsrc_start);
|
|
} else {
|
|
hcd->irq = -1;
|
|
if (hcd->rsrc_start)
|
|
dev_info(hcd->self.controller, "%s 0x%08llx\n",
|
|
(hcd->driver->flags & HCD_MEMORY) ?
|
|
"io mem" : "io base",
|
|
(unsigned long long)hcd->rsrc_start);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* usb_add_hcd - finish generic HCD structure initialization and register
|
|
* @hcd: the usb_hcd structure to initialize
|
|
* @irqnum: Interrupt line to allocate
|
|
* @irqflags: Interrupt type flags
|
|
*
|
|
* Finish the remaining parts of generic HCD initialization: allocate the
|
|
* buffers of consistent memory, register the bus, request the IRQ line,
|
|
* and call the driver's reset() and start() routines.
|
|
*/
|
|
int usb_add_hcd(struct usb_hcd *hcd,
|
|
unsigned int irqnum, unsigned long irqflags)
|
|
{
|
|
int retval;
|
|
struct usb_device *rhdev;
|
|
|
|
dev_info(hcd->self.controller, "%s\n", hcd->product_desc);
|
|
|
|
/* Keep old behaviour if authorized_default is not in [0, 1]. */
|
|
if (authorized_default < 0 || authorized_default > 1)
|
|
hcd->authorized_default = hcd->wireless? 0 : 1;
|
|
else
|
|
hcd->authorized_default = authorized_default;
|
|
set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
|
|
|
|
/* HC is in reset state, but accessible. Now do the one-time init,
|
|
* bottom up so that hcds can customize the root hubs before khubd
|
|
* starts talking to them. (Note, bus id is assigned early too.)
|
|
*/
|
|
if ((retval = hcd_buffer_create(hcd)) != 0) {
|
|
dev_dbg(hcd->self.controller, "pool alloc failed\n");
|
|
return retval;
|
|
}
|
|
|
|
if ((retval = usb_register_bus(&hcd->self)) < 0)
|
|
goto err_register_bus;
|
|
|
|
if ((rhdev = usb_alloc_dev(NULL, &hcd->self, 0)) == NULL) {
|
|
dev_err(hcd->self.controller, "unable to allocate root hub\n");
|
|
retval = -ENOMEM;
|
|
goto err_allocate_root_hub;
|
|
}
|
|
hcd->self.root_hub = rhdev;
|
|
|
|
switch (hcd->speed) {
|
|
case HCD_USB11:
|
|
rhdev->speed = USB_SPEED_FULL;
|
|
break;
|
|
case HCD_USB2:
|
|
rhdev->speed = USB_SPEED_HIGH;
|
|
break;
|
|
case HCD_USB3:
|
|
rhdev->speed = USB_SPEED_SUPER;
|
|
break;
|
|
default:
|
|
retval = -EINVAL;
|
|
goto err_set_rh_speed;
|
|
}
|
|
|
|
/* wakeup flag init defaults to "everything works" for root hubs,
|
|
* but drivers can override it in reset() if needed, along with
|
|
* recording the overall controller's system wakeup capability.
|
|
*/
|
|
device_set_wakeup_capable(&rhdev->dev, 1);
|
|
|
|
/* HCD_FLAG_RH_RUNNING doesn't matter until the root hub is
|
|
* registered. But since the controller can die at any time,
|
|
* let's initialize the flag before touching the hardware.
|
|
*/
|
|
set_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
|
|
/* "reset" is misnamed; its role is now one-time init. the controller
|
|
* should already have been reset (and boot firmware kicked off etc).
|
|
*/
|
|
if (hcd->driver->reset && (retval = hcd->driver->reset(hcd)) < 0) {
|
|
dev_err(hcd->self.controller, "can't setup\n");
|
|
goto err_hcd_driver_setup;
|
|
}
|
|
hcd->rh_pollable = 1;
|
|
|
|
/* NOTE: root hub and controller capabilities may not be the same */
|
|
if (device_can_wakeup(hcd->self.controller)
|
|
&& device_can_wakeup(&hcd->self.root_hub->dev))
|
|
dev_dbg(hcd->self.controller, "supports USB remote wakeup\n");
|
|
|
|
/* enable irqs just before we start the controller */
|
|
if (usb_hcd_is_primary_hcd(hcd)) {
|
|
retval = usb_hcd_request_irqs(hcd, irqnum, irqflags);
|
|
if (retval)
|
|
goto err_request_irq;
|
|
}
|
|
|
|
hcd->state = HC_STATE_RUNNING;
|
|
retval = hcd->driver->start(hcd);
|
|
if (retval < 0) {
|
|
dev_err(hcd->self.controller, "startup error %d\n", retval);
|
|
goto err_hcd_driver_start;
|
|
}
|
|
|
|
/* starting here, usbcore will pay attention to this root hub */
|
|
rhdev->bus_mA = min(500u, hcd->power_budget);
|
|
if ((retval = register_root_hub(hcd)) != 0)
|
|
goto err_register_root_hub;
|
|
|
|
retval = sysfs_create_group(&rhdev->dev.kobj, &usb_bus_attr_group);
|
|
if (retval < 0) {
|
|
printk(KERN_ERR "Cannot register USB bus sysfs attributes: %d\n",
|
|
retval);
|
|
goto error_create_attr_group;
|
|
}
|
|
if (hcd->uses_new_polling && HCD_POLL_RH(hcd))
|
|
usb_hcd_poll_rh_status(hcd);
|
|
|
|
/*
|
|
* Host controllers don't generate their own wakeup requests;
|
|
* they only forward requests from the root hub. Therefore
|
|
* controllers should always be enabled for remote wakeup.
|
|
*/
|
|
device_wakeup_enable(hcd->self.controller);
|
|
return retval;
|
|
|
|
error_create_attr_group:
|
|
clear_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
if (HC_IS_RUNNING(hcd->state))
|
|
hcd->state = HC_STATE_QUIESCING;
|
|
spin_lock_irq(&hcd_root_hub_lock);
|
|
hcd->rh_registered = 0;
|
|
spin_unlock_irq(&hcd_root_hub_lock);
|
|
|
|
#ifdef CONFIG_USB_SUSPEND
|
|
cancel_work_sync(&hcd->wakeup_work);
|
|
#endif
|
|
mutex_lock(&usb_bus_list_lock);
|
|
usb_disconnect(&rhdev); /* Sets rhdev to NULL */
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
err_register_root_hub:
|
|
hcd->rh_pollable = 0;
|
|
clear_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
|
del_timer_sync(&hcd->rh_timer);
|
|
hcd->driver->stop(hcd);
|
|
hcd->state = HC_STATE_HALT;
|
|
clear_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
|
del_timer_sync(&hcd->rh_timer);
|
|
err_hcd_driver_start:
|
|
if (usb_hcd_is_primary_hcd(hcd) && hcd->irq >= 0)
|
|
free_irq(irqnum, hcd);
|
|
err_request_irq:
|
|
err_hcd_driver_setup:
|
|
err_set_rh_speed:
|
|
usb_put_dev(hcd->self.root_hub);
|
|
err_allocate_root_hub:
|
|
usb_deregister_bus(&hcd->self);
|
|
err_register_bus:
|
|
hcd_buffer_destroy(hcd);
|
|
return retval;
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_add_hcd);
|
|
|
|
/**
|
|
* usb_remove_hcd - shutdown processing for generic HCDs
|
|
* @hcd: the usb_hcd structure to remove
|
|
* Context: !in_interrupt()
|
|
*
|
|
* Disconnects the root hub, then reverses the effects of usb_add_hcd(),
|
|
* invoking the HCD's stop() method.
|
|
*/
|
|
void usb_remove_hcd(struct usb_hcd *hcd)
|
|
{
|
|
struct usb_device *rhdev = hcd->self.root_hub;
|
|
|
|
dev_info(hcd->self.controller, "remove, state %x\n", hcd->state);
|
|
|
|
usb_get_dev(rhdev);
|
|
sysfs_remove_group(&rhdev->dev.kobj, &usb_bus_attr_group);
|
|
|
|
clear_bit(HCD_FLAG_RH_RUNNING, &hcd->flags);
|
|
if (HC_IS_RUNNING (hcd->state))
|
|
hcd->state = HC_STATE_QUIESCING;
|
|
|
|
dev_dbg(hcd->self.controller, "roothub graceful disconnect\n");
|
|
spin_lock_irq (&hcd_root_hub_lock);
|
|
hcd->rh_registered = 0;
|
|
spin_unlock_irq (&hcd_root_hub_lock);
|
|
|
|
#ifdef CONFIG_USB_SUSPEND
|
|
cancel_work_sync(&hcd->wakeup_work);
|
|
#endif
|
|
|
|
mutex_lock(&usb_bus_list_lock);
|
|
usb_disconnect(&rhdev); /* Sets rhdev to NULL */
|
|
mutex_unlock(&usb_bus_list_lock);
|
|
|
|
/* Prevent any more root-hub status calls from the timer.
|
|
* The HCD might still restart the timer (if a port status change
|
|
* interrupt occurs), but usb_hcd_poll_rh_status() won't invoke
|
|
* the hub_status_data() callback.
|
|
*/
|
|
hcd->rh_pollable = 0;
|
|
clear_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
|
del_timer_sync(&hcd->rh_timer);
|
|
|
|
hcd->driver->stop(hcd);
|
|
hcd->state = HC_STATE_HALT;
|
|
|
|
/* In case the HCD restarted the timer, stop it again. */
|
|
clear_bit(HCD_FLAG_POLL_RH, &hcd->flags);
|
|
del_timer_sync(&hcd->rh_timer);
|
|
|
|
if (usb_hcd_is_primary_hcd(hcd)) {
|
|
if (hcd->irq >= 0)
|
|
free_irq(hcd->irq, hcd);
|
|
}
|
|
|
|
usb_put_dev(hcd->self.root_hub);
|
|
usb_deregister_bus(&hcd->self);
|
|
hcd_buffer_destroy(hcd);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_remove_hcd);
|
|
|
|
void
|
|
usb_hcd_platform_shutdown(struct platform_device* dev)
|
|
{
|
|
struct usb_hcd *hcd = platform_get_drvdata(dev);
|
|
|
|
if (hcd->driver->shutdown)
|
|
hcd->driver->shutdown(hcd);
|
|
}
|
|
EXPORT_SYMBOL_GPL(usb_hcd_platform_shutdown);
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
|
|
#if defined(CONFIG_USB_MON) || defined(CONFIG_USB_MON_MODULE)
|
|
|
|
struct usb_mon_operations *mon_ops;
|
|
|
|
/*
|
|
* The registration is unlocked.
|
|
* We do it this way because we do not want to lock in hot paths.
|
|
*
|
|
* Notice that the code is minimally error-proof. Because usbmon needs
|
|
* symbols from usbcore, usbcore gets referenced and cannot be unloaded first.
|
|
*/
|
|
|
|
int usb_mon_register (struct usb_mon_operations *ops)
|
|
{
|
|
|
|
if (mon_ops)
|
|
return -EBUSY;
|
|
|
|
mon_ops = ops;
|
|
mb();
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL (usb_mon_register);
|
|
|
|
void usb_mon_deregister (void)
|
|
{
|
|
|
|
if (mon_ops == NULL) {
|
|
printk(KERN_ERR "USB: monitor was not registered\n");
|
|
return;
|
|
}
|
|
mon_ops = NULL;
|
|
mb();
|
|
}
|
|
EXPORT_SYMBOL_GPL (usb_mon_deregister);
|
|
|
|
#endif /* CONFIG_USB_MON || CONFIG_USB_MON_MODULE */
|