uas-detect.h 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596
  1. #include <linux/usb.h>
  2. #include <linux/usb/hcd.h>
  3. #include "usb.h"
  4. static int uas_is_interface(struct usb_host_interface *intf)
  5. {
  6. return (intf->desc.bInterfaceClass == USB_CLASS_MASS_STORAGE &&
  7. intf->desc.bInterfaceSubClass == USB_SC_SCSI &&
  8. intf->desc.bInterfaceProtocol == USB_PR_UAS);
  9. }
  10. static int uas_isnt_supported(struct usb_device *udev)
  11. {
  12. struct usb_hcd *hcd = bus_to_hcd(udev->bus);
  13. dev_warn(&udev->dev, "The driver for the USB controller %s does not "
  14. "support scatter-gather which is\n",
  15. hcd->driver->description);
  16. dev_warn(&udev->dev, "required by the UAS driver. Please try an"
  17. "alternative USB controller if you wish to use UAS.\n");
  18. return -ENODEV;
  19. }
  20. static int uas_find_uas_alt_setting(struct usb_interface *intf)
  21. {
  22. int i;
  23. struct usb_device *udev = interface_to_usbdev(intf);
  24. int sg_supported = udev->bus->sg_tablesize != 0;
  25. for (i = 0; i < intf->num_altsetting; i++) {
  26. struct usb_host_interface *alt = &intf->altsetting[i];
  27. if (uas_is_interface(alt)) {
  28. if (!sg_supported)
  29. return uas_isnt_supported(udev);
  30. return alt->desc.bAlternateSetting;
  31. }
  32. }
  33. return -ENODEV;
  34. }
  35. static int uas_find_endpoints(struct usb_host_interface *alt,
  36. struct usb_host_endpoint *eps[])
  37. {
  38. struct usb_host_endpoint *endpoint = alt->endpoint;
  39. unsigned i, n_endpoints = alt->desc.bNumEndpoints;
  40. for (i = 0; i < n_endpoints; i++) {
  41. unsigned char *extra = endpoint[i].extra;
  42. int len = endpoint[i].extralen;
  43. while (len >= 3) {
  44. if (extra[1] == USB_DT_PIPE_USAGE) {
  45. unsigned pipe_id = extra[2];
  46. if (pipe_id > 0 && pipe_id < 5)
  47. eps[pipe_id - 1] = &endpoint[i];
  48. break;
  49. }
  50. len -= extra[0];
  51. extra += extra[0];
  52. }
  53. }
  54. if (!eps[0] || !eps[1] || !eps[2] || !eps[3])
  55. return -ENODEV;
  56. return 0;
  57. }
  58. static int uas_use_uas_driver(struct usb_interface *intf,
  59. const struct usb_device_id *id)
  60. {
  61. struct usb_host_endpoint *eps[4] = { };
  62. struct usb_device *udev = interface_to_usbdev(intf);
  63. struct usb_hcd *hcd = bus_to_hcd(udev->bus);
  64. unsigned long flags = id->driver_info;
  65. int r, alt;
  66. usb_stor_adjust_quirks(udev, &flags);
  67. if (flags & US_FL_IGNORE_UAS)
  68. return 0;
  69. if (udev->speed >= USB_SPEED_SUPER && !hcd->can_do_streams)
  70. return 0;
  71. alt = uas_find_uas_alt_setting(intf);
  72. if (alt < 0)
  73. return 0;
  74. r = uas_find_endpoints(&intf->altsetting[alt], eps);
  75. if (r < 0)
  76. return 0;
  77. return 1;
  78. }