| /* SPDX-License-Identifier: GPL-2.0+ */ |
| /* |
| * USB device properties and persistent device path |
| * |
| * Copyright (c) 2005 SUSE Linux Products GmbH, Germany |
| * Author: Hannes Reinecke <hare@suse.de> |
| */ |
| |
| #include <ctype.h> |
| #include <errno.h> |
| #include <fcntl.h> |
| #include <stdarg.h> |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <unistd.h> |
| |
| #include "alloc-util.h" |
| #include "device-util.h" |
| #include "fd-util.h" |
| #include "libudev-util.h" |
| #include "string-util.h" |
| #include "strxcpyx.h" |
| #include "udev-builtin.h" |
| |
| static void set_usb_iftype(char *to, int if_class_num, size_t len) { |
| const char *type = "generic"; |
| |
| switch (if_class_num) { |
| case 1: |
| type = "audio"; |
| break; |
| case 2: /* CDC-Control */ |
| break; |
| case 3: |
| type = "hid"; |
| break; |
| case 5: /* Physical */ |
| break; |
| case 6: |
| type = "media"; |
| break; |
| case 7: |
| type = "printer"; |
| break; |
| case 8: |
| type = "storage"; |
| break; |
| case 9: |
| type = "hub"; |
| break; |
| case 0x0a: /* CDC-Data */ |
| break; |
| case 0x0b: /* Chip/Smart Card */ |
| break; |
| case 0x0d: /* Content Security */ |
| break; |
| case 0x0e: |
| type = "video"; |
| break; |
| case 0xdc: /* Diagnostic Device */ |
| break; |
| case 0xe0: /* Wireless Controller */ |
| break; |
| case 0xfe: /* Application-specific */ |
| break; |
| case 0xff: /* Vendor-specific */ |
| break; |
| default: |
| break; |
| } |
| strncpy(to, type, len); |
| to[len-1] = '\0'; |
| } |
| |
| static int set_usb_mass_storage_ifsubtype(char *to, const char *from, size_t len) { |
| int type_num = 0; |
| char *eptr; |
| const char *type = "generic"; |
| |
| type_num = strtoul(from, &eptr, 0); |
| if (eptr != from) { |
| switch (type_num) { |
| case 1: /* RBC devices */ |
| type = "rbc"; |
| break; |
| case 2: |
| type = "atapi"; |
| break; |
| case 3: |
| type = "tape"; |
| break; |
| case 4: /* UFI */ |
| type = "floppy"; |
| break; |
| case 6: /* Transparent SPC-2 devices */ |
| type = "scsi"; |
| break; |
| default: |
| break; |
| } |
| } |
| strscpy(to, len, type); |
| return type_num; |
| } |
| |
| static void set_scsi_type(char *to, const char *from, size_t len) { |
| int type_num; |
| char *eptr; |
| const char *type = "generic"; |
| |
| type_num = strtoul(from, &eptr, 0); |
| if (eptr != from) { |
| switch (type_num) { |
| case 0: |
| case 0xe: |
| type = "disk"; |
| break; |
| case 1: |
| type = "tape"; |
| break; |
| case 4: |
| case 7: |
| case 0xf: |
| type = "optical"; |
| break; |
| case 5: |
| type = "cd"; |
| break; |
| default: |
| break; |
| } |
| } |
| strscpy(to, len, type); |
| } |
| |
| #define USB_DT_DEVICE 0x01 |
| #define USB_DT_INTERFACE 0x04 |
| |
| static int dev_if_packed_info(sd_device *dev, char *ifs_str, size_t len) { |
| _cleanup_free_ char *filename = NULL; |
| _cleanup_close_ int fd = -1; |
| ssize_t size; |
| unsigned char buf[18 + 65535]; |
| size_t pos = 0; |
| unsigned strpos = 0; |
| const char *syspath; |
| int r; |
| struct usb_interface_descriptor { |
| uint8_t bLength; |
| uint8_t bDescriptorType; |
| uint8_t bInterfaceNumber; |
| uint8_t bAlternateSetting; |
| uint8_t bNumEndpoints; |
| uint8_t bInterfaceClass; |
| uint8_t bInterfaceSubClass; |
| uint8_t bInterfaceProtocol; |
| uint8_t iInterface; |
| } _packed_; |
| |
| r = sd_device_get_syspath(dev, &syspath); |
| if (r < 0) |
| return r; |
| if (asprintf(&filename, "%s/descriptors", syspath) < 0) |
| return log_oom(); |
| |
| fd = open(filename, O_RDONLY|O_CLOEXEC); |
| if (fd < 0) |
| return log_device_debug_errno(dev, errno, "Failed to open USB device 'descriptors' file: %m"); |
| |
| size = read(fd, buf, sizeof(buf)); |
| if (size < 18 || (size_t) size >= sizeof(buf)) |
| return -EIO; |
| |
| ifs_str[0] = '\0'; |
| while (pos + sizeof(struct usb_interface_descriptor) < (size_t) size && |
| strpos + 7 < len - 2) { |
| |
| struct usb_interface_descriptor *desc; |
| char if_str[8]; |
| |
| desc = (struct usb_interface_descriptor *) &buf[pos]; |
| if (desc->bLength < 3) |
| break; |
| pos += desc->bLength; |
| |
| if (desc->bDescriptorType != USB_DT_INTERFACE) |
| continue; |
| |
| if (snprintf(if_str, 8, ":%02x%02x%02x", |
| desc->bInterfaceClass, |
| desc->bInterfaceSubClass, |
| desc->bInterfaceProtocol) != 7) |
| continue; |
| |
| if (strstr(ifs_str, if_str) != NULL) |
| continue; |
| |
| memcpy(&ifs_str[strpos], if_str, 8), |
| strpos += 7; |
| } |
| |
| if (strpos > 0) { |
| ifs_str[strpos++] = ':'; |
| ifs_str[strpos++] = '\0'; |
| } |
| |
| return 0; |
| } |
| |
| /* |
| * A unique USB identification is generated like this: |
| * |
| * 1.) Get the USB device type from InterfaceClass and InterfaceSubClass |
| * 2.) If the device type is 'Mass-Storage/SPC-2' or 'Mass-Storage/RBC', |
| * use the SCSI vendor and model as USB-Vendor and USB-model. |
| * 3.) Otherwise, use the USB manufacturer and product as |
| * USB-Vendor and USB-model. Any non-printable characters |
| * in those strings will be skipped; a slash '/' will be converted |
| * into a full stop '.'. |
| * 4.) If that fails, too, we will use idVendor and idProduct |
| * as USB-Vendor and USB-model. |
| * 5.) The USB identification is the USB-vendor and USB-model |
| * string concatenated with an underscore '_'. |
| * 6.) If the device supplies a serial number, this number |
| * is concatenated with the identification with an underscore '_'. |
| */ |
| static int builtin_usb_id(sd_device *dev, int argc, char *argv[], bool test) { |
| char vendor_str[64] = ""; |
| char vendor_str_enc[256]; |
| const char *vendor_id; |
| char model_str[64] = ""; |
| char model_str_enc[256]; |
| const char *product_id; |
| char serial_str[UTIL_NAME_SIZE] = ""; |
| char packed_if_str[UTIL_NAME_SIZE] = ""; |
| char revision_str[64] = ""; |
| char type_str[64] = ""; |
| char instance_str[64] = ""; |
| const char *ifnum = NULL; |
| const char *driver = NULL; |
| char serial[256]; |
| |
| sd_device *dev_interface, *dev_usb; |
| const char *if_class, *if_subclass; |
| int if_class_num; |
| int protocol = 0; |
| size_t l; |
| char *s; |
| |
| const char *syspath, *sysname, *devtype, *interface_syspath; |
| int r; |
| |
| assert(dev); |
| |
| r = sd_device_get_syspath(dev, &syspath); |
| if (r < 0) |
| return r; |
| |
| r = sd_device_get_sysname(dev, &sysname); |
| if (r < 0) |
| return r; |
| |
| /* shortcut, if we are called directly for a "usb_device" type */ |
| if (sd_device_get_devtype(dev, &devtype) >= 0 && streq(devtype, "usb_device")) { |
| dev_if_packed_info(dev, packed_if_str, sizeof(packed_if_str)); |
| dev_usb = dev; |
| goto fallback; |
| } |
| |
| /* usb interface directory */ |
| r = sd_device_get_parent_with_subsystem_devtype(dev, "usb", "usb_interface", &dev_interface); |
| if (r < 0) |
| return log_device_debug_errno(dev, r, "Failed to access usb_interface: %m"); |
| |
| r = sd_device_get_syspath(dev_interface, &interface_syspath); |
| if (r < 0) |
| return log_device_debug_errno(dev_interface, r, "Failed to get syspath: %m"); |
| (void) sd_device_get_sysattr_value(dev_interface, "bInterfaceNumber", &ifnum); |
| (void) sd_device_get_sysattr_value(dev_interface, "driver", &driver); |
| |
| r = sd_device_get_sysattr_value(dev_interface, "bInterfaceClass", &if_class); |
| if (r < 0) |
| return log_device_debug_errno(dev_interface, r, "Failed to get bInterfaceClass attribute: %m"); |
| |
| if_class_num = strtoul(if_class, NULL, 16); |
| if (if_class_num == 8) { |
| /* mass storage */ |
| if (sd_device_get_sysattr_value(dev_interface, "bInterfaceSubClass", &if_subclass) >= 0) |
| protocol = set_usb_mass_storage_ifsubtype(type_str, if_subclass, sizeof(type_str)-1); |
| } else |
| set_usb_iftype(type_str, if_class_num, sizeof(type_str)-1); |
| |
| log_device_debug(dev_interface, "if_class:%d protocol:%d", if_class_num, protocol); |
| |
| /* usb device directory */ |
| r = sd_device_get_parent_with_subsystem_devtype(dev_interface, "usb", "usb_device", &dev_usb); |
| if (r < 0) |
| return log_device_debug_errno(dev_interface, r, "Failed to find parent 'usb' device"); |
| |
| /* all interfaces of the device in a single string */ |
| dev_if_packed_info(dev_usb, packed_if_str, sizeof(packed_if_str)); |
| |
| /* mass storage : SCSI or ATAPI */ |
| if (IN_SET(protocol, 6, 2)) { |
| sd_device *dev_scsi; |
| const char *scsi_sysname, *scsi_model, *scsi_vendor, *scsi_type, *scsi_rev; |
| int host, bus, target, lun; |
| |
| /* get scsi device */ |
| r = sd_device_get_parent_with_subsystem_devtype(dev, "scsi", "scsi_device", &dev_scsi); |
| if (r < 0) { |
| log_device_debug_errno(dev, r, "Unable to find parent SCSI device"); |
| goto fallback; |
| } |
| if (sd_device_get_sysname(dev_scsi, &scsi_sysname) < 0) |
| goto fallback; |
| if (sscanf(scsi_sysname, "%d:%d:%d:%d", &host, &bus, &target, &lun) != 4) { |
| log_device_debug(dev_scsi, "Invalid SCSI device"); |
| goto fallback; |
| } |
| |
| /* Generic SPC-2 device */ |
| r = sd_device_get_sysattr_value(dev_scsi, "vendor", &scsi_vendor); |
| if (r < 0) { |
| log_device_debug_errno(dev_scsi, r, "Failed to get SCSI vendor attribute: %m"); |
| goto fallback; |
| } |
| udev_util_encode_string(scsi_vendor, vendor_str_enc, sizeof(vendor_str_enc)); |
| util_replace_whitespace(scsi_vendor, vendor_str, sizeof(vendor_str)-1); |
| util_replace_chars(vendor_str, NULL); |
| |
| r = sd_device_get_sysattr_value(dev_scsi, "model", &scsi_model); |
| if (r < 0) { |
| log_device_debug_errno(dev_scsi, r, "Failed to get SCSI model attribute: %m"); |
| goto fallback; |
| } |
| udev_util_encode_string(scsi_model, model_str_enc, sizeof(model_str_enc)); |
| util_replace_whitespace(scsi_model, model_str, sizeof(model_str)-1); |
| util_replace_chars(model_str, NULL); |
| |
| r = sd_device_get_sysattr_value(dev_scsi, "type", &scsi_type); |
| if (r < 0) { |
| log_device_debug_errno(dev_scsi, r, "Failed to get SCSI type attribute: %m"); |
| goto fallback; |
| } |
| set_scsi_type(type_str, scsi_type, sizeof(type_str)-1); |
| |
| r = sd_device_get_sysattr_value(dev_scsi, "rev", &scsi_rev); |
| if (r < 0) { |
| log_device_debug_errno(dev_scsi, r, "Failed to get SCSI revision attribute: %m"); |
| goto fallback; |
| } |
| util_replace_whitespace(scsi_rev, revision_str, sizeof(revision_str)-1); |
| util_replace_chars(revision_str, NULL); |
| |
| /* |
| * some broken devices have the same identifiers |
| * for all luns, export the target:lun number |
| */ |
| sprintf(instance_str, "%d:%d", target, lun); |
| } |
| |
| fallback: |
| r = sd_device_get_sysattr_value(dev_usb, "idVendor", &vendor_id); |
| if (r < 0) |
| return log_device_debug_errno(dev_usb, r, "Failed to get idVendor attribute: %m"); |
| |
| r = sd_device_get_sysattr_value(dev_usb, "idProduct", &product_id); |
| if (r < 0) |
| return log_device_debug_errno(dev_usb, r, "Failed to get idProduct attribute: %m"); |
| |
| /* fallback to USB vendor & device */ |
| if (vendor_str[0] == '\0') { |
| const char *usb_vendor; |
| |
| if (sd_device_get_sysattr_value(dev_usb, "manufacturer", &usb_vendor) < 0) |
| usb_vendor = vendor_id; |
| udev_util_encode_string(usb_vendor, vendor_str_enc, sizeof(vendor_str_enc)); |
| util_replace_whitespace(usb_vendor, vendor_str, sizeof(vendor_str)-1); |
| util_replace_chars(vendor_str, NULL); |
| } |
| |
| if (model_str[0] == '\0') { |
| const char *usb_model; |
| |
| if (sd_device_get_sysattr_value(dev_usb, "product", &usb_model) < 0) |
| usb_model = product_id; |
| udev_util_encode_string(usb_model, model_str_enc, sizeof(model_str_enc)); |
| util_replace_whitespace(usb_model, model_str, sizeof(model_str)-1); |
| util_replace_chars(model_str, NULL); |
| } |
| |
| if (revision_str[0] == '\0') { |
| const char *usb_rev; |
| |
| if (sd_device_get_sysattr_value(dev_usb, "bcdDevice", &usb_rev) >= 0) { |
| util_replace_whitespace(usb_rev, revision_str, sizeof(revision_str)-1); |
| util_replace_chars(revision_str, NULL); |
| } |
| } |
| |
| if (serial_str[0] == '\0') { |
| const char *usb_serial; |
| |
| if (sd_device_get_sysattr_value(dev_usb, "serial", &usb_serial) >= 0) { |
| const unsigned char *p; |
| |
| /* http://msdn.microsoft.com/en-us/library/windows/hardware/gg487321.aspx */ |
| for (p = (unsigned char *) usb_serial; *p != '\0'; p++) |
| if (*p < 0x20 || *p > 0x7f || *p == ',') { |
| usb_serial = NULL; |
| break; |
| } |
| |
| if (usb_serial) { |
| util_replace_whitespace(usb_serial, serial_str, sizeof(serial_str)-1); |
| util_replace_chars(serial_str, NULL); |
| } |
| } |
| } |
| |
| s = serial; |
| l = strpcpyl(&s, sizeof(serial), vendor_str, "_", model_str, NULL); |
| if (!isempty(serial_str)) |
| l = strpcpyl(&s, l, "_", serial_str, NULL); |
| |
| if (!isempty(instance_str)) |
| strpcpyl(&s, l, "-", instance_str, NULL); |
| |
| udev_builtin_add_property(dev, test, "ID_VENDOR", vendor_str); |
| udev_builtin_add_property(dev, test, "ID_VENDOR_ENC", vendor_str_enc); |
| udev_builtin_add_property(dev, test, "ID_VENDOR_ID", vendor_id); |
| udev_builtin_add_property(dev, test, "ID_MODEL", model_str); |
| udev_builtin_add_property(dev, test, "ID_MODEL_ENC", model_str_enc); |
| udev_builtin_add_property(dev, test, "ID_MODEL_ID", product_id); |
| udev_builtin_add_property(dev, test, "ID_REVISION", revision_str); |
| udev_builtin_add_property(dev, test, "ID_SERIAL", serial); |
| if (!isempty(serial_str)) |
| udev_builtin_add_property(dev, test, "ID_SERIAL_SHORT", serial_str); |
| if (!isempty(type_str)) |
| udev_builtin_add_property(dev, test, "ID_TYPE", type_str); |
| if (!isempty(instance_str)) |
| udev_builtin_add_property(dev, test, "ID_INSTANCE", instance_str); |
| udev_builtin_add_property(dev, test, "ID_BUS", "usb"); |
| if (!isempty(packed_if_str)) |
| udev_builtin_add_property(dev, test, "ID_USB_INTERFACES", packed_if_str); |
| if (ifnum) |
| udev_builtin_add_property(dev, test, "ID_USB_INTERFACE_NUM", ifnum); |
| if (driver) |
| udev_builtin_add_property(dev, test, "ID_USB_DRIVER", driver); |
| return 0; |
| } |
| |
| const struct udev_builtin udev_builtin_usb_id = { |
| .name = "usb_id", |
| .cmd = builtin_usb_id, |
| .help = "USB device properties", |
| .run_once = true, |
| }; |