1
1
mirror of https://github.com/systemd/systemd-stable.git synced 2024-10-31 16:21:11 +03:00
systemd-stable/extras/usb_id/usb_id.c
2008-09-19 23:03:49 -07:00

457 lines
11 KiB
C

/*
* usb_id - identify an USB device
*
* Copyright (c) 2005 SUSE Linux Products GmbH, Germany
*
* Author:
* Hannes Reinecke <hare@suse.de>
*
* This program is free software; you can redistribute it and/or modify it
* under the terms of the GNU General Public License as published by the
* Free Software Foundation version 2 of the License.
*/
#include <stdio.h>
#include <stdlib.h>
#include <stdarg.h>
#include <unistd.h>
#include <string.h>
#include <ctype.h>
#include <errno.h>
#include <getopt.h>
#include "../../udev/udev.h"
#define MAX_PATH_LEN 512
#define MAX_SERIAL_LEN 256
#define BLKGETSIZE64 _IOR(0x12,114,size_t)
static void log_fn(struct udev *udev, int priority,
const char *file, int line, const char *fn,
const char *format, va_list args)
{
vsyslog(priority, format, args);
}
static char vendor_str[64];
static char model_str[64];
static char serial_str[MAX_SERIAL_LEN];
static char revision_str[64];
static char type_str[64];
static char instance_str[64];
static int use_usb_info;
static int use_num_info;
static void set_str(char *to, const char *from, size_t count)
{
size_t i, j, len;
/* strip trailing whitespace */
len = strnlen(from, count);
while (len && isspace(from[len-1]))
len--;
/* strip leading whitespace */
i = 0;
while (isspace(from[i]) && (i < len))
i++;
j = 0;
while (i < len) {
/* substitute multiple whitespace */
if (isspace(from[i])) {
while (isspace(from[i]))
i++;
to[j++] = '_';
}
/* Replace '/' with '.' */
if (from[i] == '/') {
to[j++] = '.';
i++;
continue;
}
/* skip non-printable chars */
if (!isalnum(from[i]) && !ispunct(from[i])) {
i++;
continue;
}
to[j++] = from[i++];
}
to[j] = '\0';
}
static void set_usb_iftype(char *to, int if_class_num, size_t len)
{
char *type = "generic";
switch (if_class_num) {
case 1:
type = "audio";
break;
case 3:
type = "hid";
break;
case 7:
type = "printer";
break;
case 8:
type = "storage";
break;
case 2: /* CDC-Control */
case 5: /* Physical */
case 6: /* Image */
case 9: /* HUB */
case 0x0a: /* CDC-Data */
case 0x0b: /* Chip/Smart Card */
case 0x0d: /* Content Security */
case 0x0e: /* Video */
case 0xdc: /* Diagnostic Device */
case 0xe0: /* Wireless Controller */
case 0xf2: /* Application-specific */
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;
char *type = "generic";
type_num = strtoul(from, &eptr, 0);
if (eptr != from) {
switch (type_num) {
case 2:
type = "cd";
break;
case 3:
type = "tape";
break;
case 4: /* UFI */
case 5: /* SFF-8070i */
type = "floppy";
break;
case 1: /* RBC devices */
case 6: /* Transparent SPC-2 devices */
type = "disk";
break;
default:
break;
}
}
util_strlcpy(to, type, len);
return type_num;
}
static void set_scsi_type(char *to, const char *from, size_t len)
{
int type_num;
char *eptr;
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;
}
}
util_strlcpy(to, type, len);
}
/*
* A unique USB identification is generated like this:
*
* 1.) Get the USB device type from DeviceClass, 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 usb_id(struct udev *udev, const char *devpath)
{
struct sysfs_device *dev;
struct sysfs_device *dev_interface;
struct sysfs_device *dev_usb;
const char *if_class, *if_subclass;
int if_class_num;
int protocol = 0;
dbg("devpath %s\n", devpath);
/* get all usb specific information: dev_interface, if_class, dev_usb */
dev = sysfs_device_get(udev, devpath);
if (dev == NULL) {
err(udev, "unable to access '%s'\n", devpath);
return 1;
}
/* usb interface directory */
dev_interface = sysfs_device_get_parent_with_subsystem(udev, dev, "usb");
if (dev_interface == NULL) {
info(udev, "unable to access usb_interface device of '%s'\n", devpath);
return 1;
}
if_class = sysfs_attr_get_value(udev, dev_interface->devpath, "bInterfaceClass");
if (!if_class) {
info(udev, "%s: cannot get bInterfaceClass attribute\n", dev_interface->kernel);
return 1;
}
if_class_num = strtoul(if_class, NULL, 16);
if (if_class_num == 8) {
if_subclass = sysfs_attr_get_value(udev, dev_interface->devpath, "bInterfaceSubClass");
if (if_subclass != NULL)
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);
info(udev, "%s: if_class %d protocol %d\n", dev_interface->devpath, if_class_num, protocol);
/* usb device directory */
dev_usb = sysfs_device_get_parent_with_subsystem(udev, dev_interface, "usb");
if (!dev_usb) {
info(udev, "unable to find parent 'usb' device of '%s'\n", devpath);
return 1;
}
/* mass storage */
if (protocol == 6 && !use_usb_info) {
struct sysfs_device *dev_scsi;
const char *scsi_model, *scsi_vendor, *scsi_type, *scsi_rev;
int host, bus, target, lun;
/* get scsi device */
dev_scsi = sysfs_device_get_parent_with_subsystem(udev, dev, "scsi");
if (dev_scsi == NULL) {
info(udev, "unable to find parent 'scsi' device of '%s'\n", devpath);
goto fallback;
}
if (sscanf(dev_scsi->kernel, "%d:%d:%d:%d", &host, &bus, &target, &lun) != 4) {
info(udev, "invalid scsi device '%s'\n", dev_scsi->kernel);
goto fallback;
}
/* Generic SPC-2 device */
scsi_vendor = sysfs_attr_get_value(udev, dev_scsi->devpath, "vendor");
if (!scsi_vendor) {
info(udev, "%s: cannot get SCSI vendor attribute\n", dev_scsi->kernel);
goto fallback;
}
set_str(vendor_str, scsi_vendor, sizeof(vendor_str)-1);
scsi_model = sysfs_attr_get_value(udev, dev_scsi->devpath, "model");
if (!scsi_model) {
info(udev, "%s: cannot get SCSI model attribute\n", dev_scsi->kernel);
goto fallback;
}
set_str(model_str, scsi_model, sizeof(model_str)-1);
scsi_type = sysfs_attr_get_value(udev, dev_scsi->devpath, "type");
if (!scsi_type) {
info(udev, "%s: cannot get SCSI type attribute\n", dev_scsi->kernel);
goto fallback;
}
set_scsi_type(type_str, scsi_type, sizeof(type_str)-1);
scsi_rev = sysfs_attr_get_value(udev, dev_scsi->devpath, "rev");
if (!scsi_rev) {
info(udev, "%s: cannot get SCSI revision attribute\n", dev_scsi->kernel);
goto fallback;
}
set_str(revision_str, scsi_rev, sizeof(revision_str)-1);
/*
* some broken devices have the same identifiers
* for all luns, export the target:lun number
*/
sprintf(instance_str, "%d:%d", target, lun);
}
fallback:
/* fallback to USB vendor & device */
if (vendor_str[0] == '\0') {
const char *usb_vendor = NULL;
if (!use_num_info)
usb_vendor = sysfs_attr_get_value(udev, dev_usb->devpath, "manufacturer");
if (!usb_vendor)
usb_vendor = sysfs_attr_get_value(udev, dev_usb->devpath, "idVendor");
if (!usb_vendor) {
info(udev, "No USB vendor information available\n");
return 1;
}
set_str(vendor_str, usb_vendor, sizeof(vendor_str)-1);
}
if (model_str[0] == '\0') {
const char *usb_model = NULL;
if (!use_num_info)
usb_model = sysfs_attr_get_value(udev, dev_usb->devpath, "product");
if (!usb_model)
usb_model = sysfs_attr_get_value(udev, dev_usb->devpath, "idProduct");
if (!usb_model) {
dbg("No USB model information available\n");
return 1;
}
set_str(model_str, usb_model, sizeof(model_str)-1);
}
if (revision_str[0] == '\0') {
const char *usb_rev;
usb_rev = sysfs_attr_get_value(udev, dev_usb->devpath, "bcdDevice");
if (usb_rev)
set_str(revision_str, usb_rev, sizeof(revision_str)-1);
}
if (serial_str[0] == '\0') {
const char *usb_serial;
usb_serial = sysfs_attr_get_value(udev, dev_usb->devpath, "serial");
if (usb_serial)
set_str(serial_str, usb_serial, sizeof(serial_str)-1);
}
return 0;
}
int main(int argc, char **argv)
{
struct udev *udev;
int retval = 0;
const char *env;
char devpath[MAX_PATH_LEN];
static int export;
static const struct option options[] = {
{ "usb-info", 0, NULL, 'u' },
{ "num-info", 0, NULL, 'n' },
{ "export", 0, NULL, 'x' },
{ "help", 0, NULL, 'h' },
{}
};
udev = udev_new();
if (udev == NULL)
goto exit;
logging_init("usb_id");
udev_set_log_fn(udev, log_fn);
sysfs_init();
while (1) {
int option;
option = getopt_long(argc, argv, "nuxh", options, NULL);
if (option == -1)
break;
switch (option) {
case 'n':
use_num_info = 1;
use_usb_info = 1;
break;
case 'u':
use_usb_info = 1;
break;
case 'x':
export = 1;
break;
case 'h':
printf("Usage: usb_id [--usb-info] [--num-info] [--export] [--help] <devpath>\n"
" --usb-info use usb strings instead\n"
" --num-info use numerical values\n"
" --export print values as environemt keys\n"
" --help print this help text\n\n");
default:
retval = 1;
goto exit;
}
}
env = getenv("DEVPATH");
if (env != NULL)
util_strlcpy(devpath, env, sizeof(devpath));
else {
if (argv[optind] == NULL) {
fprintf(stderr, "No device specified\n");
retval = 1;
goto exit;
}
util_strlcpy(devpath, argv[optind], sizeof(devpath));
}
retval = usb_id(udev, devpath);
if (retval == 0) {
char serial[256];
util_strlcpy(serial, vendor_str, sizeof(serial));
util_strlcat(serial, "_", sizeof(serial));
util_strlcat(serial, model_str, sizeof(serial));
if (serial_str[0] != '\0') {
util_strlcat(serial, "_", sizeof(serial));
util_strlcat(serial, serial_str, sizeof(serial));
}
if (instance_str[0] != '\0') {
util_strlcat(serial, "-", sizeof(serial));
util_strlcat(serial, instance_str, sizeof(serial));
}
if (export) {
printf("ID_VENDOR=%s\n", vendor_str);
printf("ID_MODEL=%s\n", model_str);
printf("ID_REVISION=%s\n", revision_str);
printf("ID_SERIAL=%s\n", serial);
if (serial_str[0] != '\0')
printf("ID_SERIAL_SHORT=%s\n", serial_str);
printf("ID_TYPE=%s\n", type_str);
if (instance_str[0] != '\0')
printf("ID_INSTANCE=%s\n", instance_str);
printf("ID_BUS=usb\n");
} else
printf("%s\n", serial);
}
exit:
udev_unref(udev);
sysfs_cleanup();
logging_close();
return retval;
}