Hans de Goede | 82aa038 | 2013-10-21 08:53:31 +0100 | [diff] [blame] | 1 | #include <linux/usb.h> |
| 2 | #include <linux/usb/hcd.h> |
Hans de Goede | 97172a6 | 2013-11-16 12:19:36 +0100 | [diff] [blame] | 3 | #include "usb.h" |
Hans de Goede | 82aa038 | 2013-10-21 08:53:31 +0100 | [diff] [blame] | 4 | |
| 5 | static int uas_is_interface(struct usb_host_interface *intf) |
| 6 | { |
| 7 | return (intf->desc.bInterfaceClass == USB_CLASS_MASS_STORAGE && |
| 8 | intf->desc.bInterfaceSubClass == USB_SC_SCSI && |
| 9 | intf->desc.bInterfaceProtocol == USB_PR_UAS); |
| 10 | } |
| 11 | |
Hans de Goede | 82aa038 | 2013-10-21 08:53:31 +0100 | [diff] [blame] | 12 | static int uas_find_uas_alt_setting(struct usb_interface *intf) |
| 13 | { |
| 14 | int i; |
Hans de Goede | 82aa038 | 2013-10-21 08:53:31 +0100 | [diff] [blame] | 15 | |
| 16 | for (i = 0; i < intf->num_altsetting; i++) { |
| 17 | struct usb_host_interface *alt = &intf->altsetting[i]; |
| 18 | |
Hans de Goede | cc4deaf | 2014-07-25 22:01:26 +0200 | [diff] [blame] | 19 | if (uas_is_interface(alt)) |
Hans de Goede | 82aa038 | 2013-10-21 08:53:31 +0100 | [diff] [blame] | 20 | return alt->desc.bAlternateSetting; |
Hans de Goede | 82aa038 | 2013-10-21 08:53:31 +0100 | [diff] [blame] | 21 | } |
| 22 | |
| 23 | return -ENODEV; |
| 24 | } |
Hans de Goede | 79b4c06 | 2013-10-25 17:04:33 +0100 | [diff] [blame] | 25 | |
Hans de Goede | d77adc02 | 2013-10-29 10:03:34 +0100 | [diff] [blame] | 26 | static int uas_find_endpoints(struct usb_host_interface *alt, |
| 27 | struct usb_host_endpoint *eps[]) |
| 28 | { |
| 29 | struct usb_host_endpoint *endpoint = alt->endpoint; |
| 30 | unsigned i, n_endpoints = alt->desc.bNumEndpoints; |
| 31 | |
| 32 | for (i = 0; i < n_endpoints; i++) { |
| 33 | unsigned char *extra = endpoint[i].extra; |
| 34 | int len = endpoint[i].extralen; |
| 35 | while (len >= 3) { |
| 36 | if (extra[1] == USB_DT_PIPE_USAGE) { |
| 37 | unsigned pipe_id = extra[2]; |
| 38 | if (pipe_id > 0 && pipe_id < 5) |
| 39 | eps[pipe_id - 1] = &endpoint[i]; |
| 40 | break; |
| 41 | } |
| 42 | len -= extra[0]; |
| 43 | extra += extra[0]; |
| 44 | } |
| 45 | } |
| 46 | |
| 47 | if (!eps[0] || !eps[1] || !eps[2] || !eps[3]) |
| 48 | return -ENODEV; |
| 49 | |
| 50 | return 0; |
| 51 | } |
| 52 | |
Hans de Goede | 79b4c06 | 2013-10-25 17:04:33 +0100 | [diff] [blame] | 53 | static int uas_use_uas_driver(struct usb_interface *intf, |
| 54 | const struct usb_device_id *id) |
| 55 | { |
Hans de Goede | 6134041 | 2013-11-16 11:37:41 +0100 | [diff] [blame] | 56 | struct usb_host_endpoint *eps[4] = { }; |
Hans de Goede | 97172a6 | 2013-11-16 12:19:36 +0100 | [diff] [blame] | 57 | struct usb_device *udev = interface_to_usbdev(intf); |
Oliver Neukum | 14aec58 | 2014-02-11 20:36:04 +0100 | [diff] [blame] | 58 | struct usb_hcd *hcd = bus_to_hcd(udev->bus); |
Hans de Goede | 79b4c06 | 2013-10-25 17:04:33 +0100 | [diff] [blame] | 59 | unsigned long flags = id->driver_info; |
Hans de Goede | 6134041 | 2013-11-16 11:37:41 +0100 | [diff] [blame] | 60 | int r, alt; |
Hans de Goede | 79b4c06 | 2013-10-25 17:04:33 +0100 | [diff] [blame] | 61 | |
Hans de Goede | 79b4c06 | 2013-10-25 17:04:33 +0100 | [diff] [blame] | 62 | |
Hans de Goede | 6134041 | 2013-11-16 11:37:41 +0100 | [diff] [blame] | 63 | alt = uas_find_uas_alt_setting(intf); |
| 64 | if (alt < 0) |
| 65 | return 0; |
| 66 | |
| 67 | r = uas_find_endpoints(&intf->altsetting[alt], eps); |
| 68 | if (r < 0) |
| 69 | return 0; |
| 70 | |
Hans de Goede | a9c54ca | 2014-09-10 10:51:36 +0200 | [diff] [blame^] | 71 | /* |
| 72 | * ASM1051 and older ASM1053 devices have the same usb-id, and UAS is |
| 73 | * broken on the ASM1051, use the number of streams to differentiate. |
| 74 | * New ASM1053-s also support 32 streams, but have a different prod-id. |
| 75 | */ |
| 76 | if (udev->descriptor.idVendor == 0x174c && |
| 77 | udev->descriptor.idProduct == 0x55aa) { |
| 78 | if (udev->speed < USB_SPEED_SUPER) { |
| 79 | /* No streams info, assume ASM1051 */ |
| 80 | flags |= US_FL_IGNORE_UAS; |
| 81 | } else if (usb_ss_max_streams(&eps[1]->ss_ep_comp) == 32) { |
| 82 | flags |= US_FL_IGNORE_UAS; |
| 83 | } |
| 84 | } |
| 85 | |
| 86 | usb_stor_adjust_quirks(udev, &flags); |
| 87 | |
| 88 | if (flags & US_FL_IGNORE_UAS) { |
| 89 | dev_warn(&udev->dev, |
| 90 | "UAS is blacklisted for this device, using usb-storage instead\n"); |
| 91 | return 0; |
| 92 | } |
| 93 | |
Hans de Goede | cc4deaf | 2014-07-25 22:01:26 +0200 | [diff] [blame] | 94 | if (udev->bus->sg_tablesize == 0) { |
| 95 | dev_warn(&udev->dev, |
| 96 | "The driver for the USB controller %s does not support scatter-gather which is\n", |
| 97 | hcd->driver->description); |
| 98 | dev_warn(&udev->dev, |
| 99 | "required by the UAS driver. Please try an other USB controller if you wish to use UAS.\n"); |
| 100 | return 0; |
| 101 | } |
| 102 | |
Hans de Goede | 43508be | 2014-07-25 22:01:27 +0200 | [diff] [blame] | 103 | if (udev->speed >= USB_SPEED_SUPER && !hcd->can_do_streams) { |
| 104 | dev_warn(&udev->dev, |
| 105 | "USB controller %s does not support streams, which are required by the UAS driver.\n", |
| 106 | hcd_to_bus(hcd)->bus_name); |
| 107 | dev_warn(&udev->dev, |
| 108 | "Please try an other USB controller if you wish to use UAS.\n"); |
| 109 | return 0; |
| 110 | } |
| 111 | |
Hans de Goede | 6134041 | 2013-11-16 11:37:41 +0100 | [diff] [blame] | 112 | return 1; |
Hans de Goede | 79b4c06 | 2013-10-25 17:04:33 +0100 | [diff] [blame] | 113 | } |