1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (C) 2015 Karol Kosik <karo9@interia.eu> 4 * 2015 Samsung Electronics 5 * Author: Igor Kotrasinski <i.kotrasinsk@samsung.com> 6 * 7 * Based on tools/usb/usbip/libsrc/usbip_host_driver.c, which is: 8 * Copyright (C) 2011 matt mooney <mfm@muteddisk.com> 9 * 2005-2007 Takahiro Hirofuchi 10 */ 11 12 #include <fcntl.h> 13 #include <string.h> 14 #include <linux/usb/ch9.h> 15 16 #include <unistd.h> 17 18 #include "usbip_host_common.h" 19 #include "usbip_device_driver.h" 20 21 #undef PROGNAME 22 #define PROGNAME "libusbip" 23 24 #define copy_descr_attr16(dev, descr, attr) \ 25 ((dev)->attr = le16toh((descr)->attr)) \ 26 27 #define copy_descr_attr(dev, descr, attr) \ 28 ((dev)->attr = (descr)->attr) \ 29 30 #define ARRAY_SIZE(arr) (sizeof(arr) / sizeof((arr)[0])) 31 32 static struct { 33 enum usb_device_speed speed; 34 const char *name; 35 } speed_names[] = { 36 { 37 .speed = USB_SPEED_UNKNOWN, 38 .name = "UNKNOWN", 39 }, 40 { 41 .speed = USB_SPEED_LOW, 42 .name = "low-speed", 43 }, 44 { 45 .speed = USB_SPEED_FULL, 46 .name = "full-speed", 47 }, 48 { 49 .speed = USB_SPEED_HIGH, 50 .name = "high-speed", 51 }, 52 { 53 .speed = USB_SPEED_WIRELESS, 54 .name = "wireless", 55 }, 56 { 57 .speed = USB_SPEED_SUPER, 58 .name = "super-speed", 59 }, 60 }; 61 62 static 63 int read_usb_vudc_device(struct udev_device *sdev, struct usbip_usb_device *dev) 64 { 65 const char *path, *name; 66 char filepath[SYSFS_PATH_MAX]; 67 struct usb_device_descriptor descr; 68 unsigned int i; 69 FILE *fd = NULL; 70 struct udev_device *plat; 71 const char *speed; 72 int ret = 0; 73 74 plat = udev_device_get_parent(sdev); 75 path = udev_device_get_syspath(plat); 76 snprintf(filepath, SYSFS_PATH_MAX, "%s/%s", 77 path, VUDC_DEVICE_DESCR_FILE); 78 fd = fopen(filepath, "r"); 79 if (!fd) 80 return -1; 81 ret = fread((char *) &descr, sizeof(descr), 1, fd); 82 if (ret < 0) 83 goto err; 84 fclose(fd); 85 86 copy_descr_attr(dev, &descr, bDeviceClass); 87 copy_descr_attr(dev, &descr, bDeviceSubClass); 88 copy_descr_attr(dev, &descr, bDeviceProtocol); 89 copy_descr_attr(dev, &descr, bNumConfigurations); 90 copy_descr_attr16(dev, &descr, idVendor); 91 copy_descr_attr16(dev, &descr, idProduct); 92 copy_descr_attr16(dev, &descr, bcdDevice); 93 94 strncpy(dev->path, path, SYSFS_PATH_MAX - 1); 95 dev->path[SYSFS_PATH_MAX - 1] = '\0'; 96 97 dev->speed = USB_SPEED_UNKNOWN; 98 speed = udev_device_get_sysattr_value(sdev, "current_speed"); 99 if (speed) { 100 for (i = 0; i < ARRAY_SIZE(speed_names); i++) { 101 if (!strcmp(speed_names[i].name, speed)) { 102 dev->speed = speed_names[i].speed; 103 break; 104 } 105 } 106 } 107 108 /* Only used for user output, little sense to output them in general */ 109 dev->bNumInterfaces = 0; 110 dev->bConfigurationValue = 0; 111 dev->busnum = 0; 112 113 name = udev_device_get_sysname(plat); 114 strncpy(dev->busid, name, SYSFS_BUS_ID_SIZE - 1); 115 dev->busid[SYSFS_BUS_ID_SIZE - 1] = '\0'; 116 return 0; 117 err: 118 fclose(fd); 119 return -1; 120 } 121 122 static int is_my_device(struct udev_device *dev) 123 { 124 const char *driver; 125 126 driver = udev_device_get_property_value(dev, "USB_UDC_NAME"); 127 return driver != NULL && !strcmp(driver, USBIP_DEVICE_DRV_NAME); 128 } 129 130 static int usbip_device_driver_open(struct usbip_host_driver *hdriver) 131 { 132 int ret; 133 134 hdriver->ndevs = 0; 135 INIT_LIST_HEAD(&hdriver->edev_list); 136 137 ret = usbip_generic_driver_open(hdriver); 138 if (ret) 139 err("please load " USBIP_CORE_MOD_NAME ".ko and " 140 USBIP_DEVICE_DRV_NAME ".ko!"); 141 142 return ret; 143 } 144 145 struct usbip_host_driver device_driver = { 146 .edev_list = LIST_HEAD_INIT(device_driver.edev_list), 147 .udev_subsystem = "udc", 148 .ops = { 149 .open = usbip_device_driver_open, 150 .close = usbip_generic_driver_close, 151 .refresh_device_list = usbip_generic_refresh_device_list, 152 .get_device = usbip_generic_get_device, 153 .read_device = read_usb_vudc_device, 154 .is_my_device = is_my_device, 155 }, 156 }; 157