123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596 |
- #include <linux/usb.h>
- #include <linux/usb/hcd.h>
- #include "usb.h"
- static int uas_is_interface(struct usb_host_interface *intf)
- {
- return (intf->desc.bInterfaceClass == USB_CLASS_MASS_STORAGE &&
- intf->desc.bInterfaceSubClass == USB_SC_SCSI &&
- intf->desc.bInterfaceProtocol == USB_PR_UAS);
- }
- static int uas_isnt_supported(struct usb_device *udev)
- {
- struct usb_hcd *hcd = bus_to_hcd(udev->bus);
- dev_warn(&udev->dev, "The driver for the USB controller %s does not "
- "support scatter-gather which is\n",
- hcd->driver->description);
- dev_warn(&udev->dev, "required by the UAS driver. Please try an"
- "alternative USB controller if you wish to use UAS.\n");
- return -ENODEV;
- }
- static int uas_find_uas_alt_setting(struct usb_interface *intf)
- {
- int i;
- struct usb_device *udev = interface_to_usbdev(intf);
- int sg_supported = udev->bus->sg_tablesize != 0;
- for (i = 0; i < intf->num_altsetting; i++) {
- struct usb_host_interface *alt = &intf->altsetting[i];
- if (uas_is_interface(alt)) {
- if (!sg_supported)
- return uas_isnt_supported(udev);
- return alt->desc.bAlternateSetting;
- }
- }
- return -ENODEV;
- }
- static int uas_find_endpoints(struct usb_host_interface *alt,
- struct usb_host_endpoint *eps[])
- {
- struct usb_host_endpoint *endpoint = alt->endpoint;
- unsigned i, n_endpoints = alt->desc.bNumEndpoints;
- for (i = 0; i < n_endpoints; i++) {
- unsigned char *extra = endpoint[i].extra;
- int len = endpoint[i].extralen;
- while (len >= 3) {
- if (extra[1] == USB_DT_PIPE_USAGE) {
- unsigned pipe_id = extra[2];
- if (pipe_id > 0 && pipe_id < 5)
- eps[pipe_id - 1] = &endpoint[i];
- break;
- }
- len -= extra[0];
- extra += extra[0];
- }
- }
- if (!eps[0] || !eps[1] || !eps[2] || !eps[3])
- return -ENODEV;
- return 0;
- }
- static int uas_use_uas_driver(struct usb_interface *intf,
- const struct usb_device_id *id)
- {
- struct usb_host_endpoint *eps[4] = { };
- struct usb_device *udev = interface_to_usbdev(intf);
- struct usb_hcd *hcd = bus_to_hcd(udev->bus);
- unsigned long flags = id->driver_info;
- int r, alt;
- usb_stor_adjust_quirks(udev, &flags);
- if (flags & US_FL_IGNORE_UAS)
- return 0;
- if (udev->speed >= USB_SPEED_SUPER && !hcd->can_do_streams)
- return 0;
- alt = uas_find_uas_alt_setting(intf);
- if (alt < 0)
- return 0;
- r = uas_find_endpoints(&intf->altsetting[alt], eps);
- if (r < 0)
- return 0;
- return 1;
- }
|