-
Notifications
You must be signed in to change notification settings - Fork 204
/
sysfs.c
76 lines (60 loc) · 1.66 KB
/
sysfs.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
// SPDX-License-Identifier: GPL-2.0-or-later
/*
* Helpers for querying USB properties from sysfs
*
* Copied from name.c which is:
* Copyright (C) 1999, 2000 Thomas Sailer ([email protected])
* Copyright (C) 2013 Tom Gundersen ([email protected])
*/
#include <stdint.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <stdio.h>
#include <linux/limits.h>
#include <libusb.h>
#include "sysfs.h"
/*
* The documentation of libusb_get_port_numbers() says "As per the USB 3.0
* specs, the current maximum limit for the depth is 7."
*/
#define USB_MAX_DEPTH 7
#define SYSFS_DEV_ATTR_PATH "/sys/bus/usb/devices/%s/%s"
int get_sysfs_name(char *buf, size_t size, libusb_device *dev)
{
int len = 0;
uint8_t bnum = libusb_get_bus_number(dev);
uint8_t pnums[USB_MAX_DEPTH];
int num_pnums;
buf[0] = '\0';
num_pnums = libusb_get_port_numbers(dev, pnums, sizeof(pnums));
if (num_pnums == LIBUSB_ERROR_OVERFLOW) {
return -1;
} else if (num_pnums == 0) {
/* Special-case root devices */
return snprintf(buf, size, "usb%d", bnum);
}
len += snprintf(buf, size, "%d-", bnum);
for (int i = 0; i < num_pnums; i++) {
int n = snprintf(buf + len, size - len, i ? ".%d" : "%d", pnums[i]);
if ((n < 0) || (n >= (int)(size - len)))
break;
len += n;
}
return len;
}
int read_sysfs_prop(char *buf, size_t size, const char *sysfs_name, const char *propname)
{
int n, fd;
char path[PATH_MAX];
buf[0] = '\0';
snprintf(path, sizeof(path), SYSFS_DEV_ATTR_PATH, sysfs_name, propname);
fd = open(path, O_RDONLY);
if (fd == -1)
return 0;
n = read(fd, buf, size);
if (n > 0)
buf[n-1] = '\0'; // Turn newline into null terminator
close(fd);
return n;
}