• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Copyright (C) 2005-2007 Takahiro Hirofuchi
3  */
4 
5 #include <libudev.h>
6 #include "usbip_common.h"
7 #include "names.h"
8 
9 #undef  PROGNAME
10 #define PROGNAME "libusbip"
11 
12 int usbip_use_syslog;
13 int usbip_use_stderr;
14 int usbip_use_debug;
15 
16 extern struct udev *udev_context;
17 
18 struct speed_string {
19 	int num;
20 	char *speed;
21 	char *desc;
22 };
23 
24 static const struct speed_string speed_strings[] = {
25 	{ USB_SPEED_UNKNOWN, "unknown", "Unknown Speed"},
26 	{ USB_SPEED_LOW,  "1.5", "Low Speed(1.5Mbps)"  },
27 	{ USB_SPEED_FULL, "12",  "Full Speed(12Mbps)" },
28 	{ USB_SPEED_HIGH, "480", "High Speed(480Mbps)" },
29 	{ USB_SPEED_WIRELESS, "53.3-480", "Wireless"},
30 	{ USB_SPEED_SUPER, "5000", "Super Speed(5000Mbps)" },
31 	{ 0, NULL, NULL }
32 };
33 
34 struct portst_string {
35 	int num;
36 	char *desc;
37 };
38 
39 static struct portst_string portst_strings[] = {
40 	{ SDEV_ST_AVAILABLE,	"Device Available" },
41 	{ SDEV_ST_USED,		"Device in Use" },
42 	{ SDEV_ST_ERROR,	"Device Error"},
43 	{ VDEV_ST_NULL,		"Port Available"},
44 	{ VDEV_ST_NOTASSIGNED,	"Port Initializing"},
45 	{ VDEV_ST_USED,		"Port in Use"},
46 	{ VDEV_ST_ERROR,	"Port Error"},
47 	{ 0, NULL}
48 };
49 
usbip_status_string(int32_t status)50 const char *usbip_status_string(int32_t status)
51 {
52 	for (int i = 0; portst_strings[i].desc != NULL; i++)
53 		if (portst_strings[i].num == status)
54 			return portst_strings[i].desc;
55 
56 	return "Unknown Status";
57 }
58 
usbip_speed_string(int num)59 const char *usbip_speed_string(int num)
60 {
61 	for (int i = 0; speed_strings[i].speed != NULL; i++)
62 		if (speed_strings[i].num == num)
63 			return speed_strings[i].desc;
64 
65 	return "Unknown Speed";
66 }
67 
68 
69 #define DBG_UDEV_INTEGER(name)\
70 	dbg("%-20s = %x", to_string(name), (int) udev->name)
71 
72 #define DBG_UINF_INTEGER(name)\
73 	dbg("%-20s = %x", to_string(name), (int) uinf->name)
74 
dump_usb_interface(struct usbip_usb_interface * uinf)75 void dump_usb_interface(struct usbip_usb_interface *uinf)
76 {
77 	char buff[100];
78 
79 	usbip_names_get_class(buff, sizeof(buff),
80 			uinf->bInterfaceClass,
81 			uinf->bInterfaceSubClass,
82 			uinf->bInterfaceProtocol);
83 	dbg("%-20s = %s", "Interface(C/SC/P)", buff);
84 }
85 
dump_usb_device(struct usbip_usb_device * udev)86 void dump_usb_device(struct usbip_usb_device *udev)
87 {
88 	char buff[100];
89 
90 	dbg("%-20s = %s", "path",  udev->path);
91 	dbg("%-20s = %s", "busid", udev->busid);
92 
93 	usbip_names_get_class(buff, sizeof(buff),
94 			udev->bDeviceClass,
95 			udev->bDeviceSubClass,
96 			udev->bDeviceProtocol);
97 	dbg("%-20s = %s", "Device(C/SC/P)", buff);
98 
99 	DBG_UDEV_INTEGER(bcdDevice);
100 
101 	usbip_names_get_product(buff, sizeof(buff),
102 			udev->idVendor,
103 			udev->idProduct);
104 	dbg("%-20s = %s", "Vendor/Product", buff);
105 
106 	DBG_UDEV_INTEGER(bNumConfigurations);
107 	DBG_UDEV_INTEGER(bNumInterfaces);
108 
109 	dbg("%-20s = %s", "speed",
110 			usbip_speed_string(udev->speed));
111 
112 	DBG_UDEV_INTEGER(busnum);
113 	DBG_UDEV_INTEGER(devnum);
114 }
115 
116 
read_attr_value(struct udev_device * dev,const char * name,const char * format)117 int read_attr_value(struct udev_device *dev, const char *name,
118 		    const char *format)
119 {
120 	const char *attr;
121 	int num = 0;
122 	int ret;
123 
124 	attr = udev_device_get_sysattr_value(dev, name);
125 	if (!attr) {
126 		err("udev_device_get_sysattr_value failed");
127 		goto err;
128 	}
129 
130 	/* The client chooses the device configuration
131 	 * when attaching it so right after being bound
132 	 * to usbip-host on the server the device will
133 	 * have no configuration.
134 	 * Therefore, attributes such as bConfigurationValue
135 	 * and bNumInterfaces will not exist and sscanf will
136 	 * fail. Check for these cases and don't treat them
137 	 * as errors.
138 	 */
139 
140 	ret = sscanf(attr, format, &num);
141 	if (ret < 1) {
142 		if (strcmp(name, "bConfigurationValue") &&
143 				strcmp(name, "bNumInterfaces")) {
144 			err("sscanf failed for attribute %s", name);
145 			goto err;
146 		}
147 	}
148 
149 err:
150 
151 	return num;
152 }
153 
154 
read_attr_speed(struct udev_device * dev)155 int read_attr_speed(struct udev_device *dev)
156 {
157 	const char *speed;
158 
159 	speed = udev_device_get_sysattr_value(dev, "speed");
160 	if (!speed) {
161 		err("udev_device_get_sysattr_value failed");
162 		goto err;
163 	}
164 
165 	for (int i = 0; speed_strings[i].speed != NULL; i++) {
166 		if (!strcmp(speed, speed_strings[i].speed))
167 			return speed_strings[i].num;
168 	}
169 
170 err:
171 
172 	return USB_SPEED_UNKNOWN;
173 }
174 
175 #define READ_ATTR(object, type, dev, name, format)			      \
176 	do {								      \
177 		(object)->name = (type) read_attr_value(dev, to_string(name), \
178 							format);	      \
179 	} while (0)
180 
181 
read_usb_device(struct udev_device * sdev,struct usbip_usb_device * udev)182 int read_usb_device(struct udev_device *sdev, struct usbip_usb_device *udev)
183 {
184 	uint32_t busnum, devnum;
185 	const char *path, *name;
186 
187 	READ_ATTR(udev, uint8_t,  sdev, bDeviceClass,		"%02x\n");
188 	READ_ATTR(udev, uint8_t,  sdev, bDeviceSubClass,	"%02x\n");
189 	READ_ATTR(udev, uint8_t,  sdev, bDeviceProtocol,	"%02x\n");
190 
191 	READ_ATTR(udev, uint16_t, sdev, idVendor,		"%04x\n");
192 	READ_ATTR(udev, uint16_t, sdev, idProduct,		"%04x\n");
193 	READ_ATTR(udev, uint16_t, sdev, bcdDevice,		"%04x\n");
194 
195 	READ_ATTR(udev, uint8_t,  sdev, bConfigurationValue,	"%02x\n");
196 	READ_ATTR(udev, uint8_t,  sdev, bNumConfigurations,	"%02x\n");
197 	READ_ATTR(udev, uint8_t,  sdev, bNumInterfaces,		"%02x\n");
198 
199 	READ_ATTR(udev, uint8_t,  sdev, devnum,			"%d\n");
200 	udev->speed = read_attr_speed(sdev);
201 
202 	path = udev_device_get_syspath(sdev);
203 	name = udev_device_get_sysname(sdev);
204 
205 	strncpy(udev->path,  path,  SYSFS_PATH_MAX);
206 	strncpy(udev->busid, name, SYSFS_BUS_ID_SIZE);
207 
208 	sscanf(name, "%u-%u", &busnum, &devnum);
209 	udev->busnum = busnum;
210 
211 	return 0;
212 }
213 
read_usb_interface(struct usbip_usb_device * udev,int i,struct usbip_usb_interface * uinf)214 int read_usb_interface(struct usbip_usb_device *udev, int i,
215 		       struct usbip_usb_interface *uinf)
216 {
217 	char busid[SYSFS_BUS_ID_SIZE];
218 	int size;
219 	struct udev_device *sif;
220 
221 	size = snprintf(busid, sizeof(busid), "%s:%d.%d",
222 			udev->busid, udev->bConfigurationValue, i);
223 	if (size < 0 || (unsigned int)size >= sizeof(busid)) {
224 		err("busid length %i >= %lu or < 0", size,
225 		    (long unsigned)sizeof(busid));
226 		return -1;
227 	}
228 
229 	sif = udev_device_new_from_subsystem_sysname(udev_context, "usb", busid);
230 	if (!sif) {
231 		err("udev_device_new_from_subsystem_sysname %s failed", busid);
232 		return -1;
233 	}
234 
235 	READ_ATTR(uinf, uint8_t,  sif, bInterfaceClass,		"%02x\n");
236 	READ_ATTR(uinf, uint8_t,  sif, bInterfaceSubClass,	"%02x\n");
237 	READ_ATTR(uinf, uint8_t,  sif, bInterfaceProtocol,	"%02x\n");
238 
239 	return 0;
240 }
241 
usbip_names_init(char * f)242 int usbip_names_init(char *f)
243 {
244 	return names_init(f);
245 }
246 
usbip_names_free(void)247 void usbip_names_free(void)
248 {
249 	names_free();
250 }
251 
usbip_names_get_product(char * buff,size_t size,uint16_t vendor,uint16_t product)252 void usbip_names_get_product(char *buff, size_t size, uint16_t vendor,
253 			     uint16_t product)
254 {
255 	const char *prod, *vend;
256 
257 	prod = names_product(vendor, product);
258 	if (!prod)
259 		prod = "unknown product";
260 
261 
262 	vend = names_vendor(vendor);
263 	if (!vend)
264 		vend = "unknown vendor";
265 
266 	snprintf(buff, size, "%s : %s (%04x:%04x)", vend, prod, vendor, product);
267 }
268 
usbip_names_get_class(char * buff,size_t size,uint8_t class,uint8_t subclass,uint8_t protocol)269 void usbip_names_get_class(char *buff, size_t size, uint8_t class,
270 			   uint8_t subclass, uint8_t protocol)
271 {
272 	const char *c, *s, *p;
273 
274 	if (class == 0 && subclass == 0 && protocol == 0) {
275 		snprintf(buff, size, "(Defined at Interface level) (%02x/%02x/%02x)", class, subclass, protocol);
276 		return;
277 	}
278 
279 	p = names_protocol(class, subclass, protocol);
280 	if (!p)
281 		p = "unknown protocol";
282 
283 	s = names_subclass(class, subclass);
284 	if (!s)
285 		s = "unknown subclass";
286 
287 	c = names_class(class);
288 	if (!c)
289 		c = "unknown class";
290 
291 	snprintf(buff, size, "%s / %s / %s (%02x/%02x/%02x)", c, s, p, class, subclass, protocol);
292 }
293