]>
Commit | Line | Data |
---|---|---|
53e1b683 | 1 | /* SPDX-License-Identifier: LGPL-2.1+ */ |
ccba91c7 | 2 | |
981b8159 | 3 | #include <errno.h> |
67410e9f | 4 | #include <fnmatch.h> |
796b06c2 | 5 | #include <getopt.h> |
07630cea LP |
6 | #include <stdio.h> |
7 | #include <stdlib.h> | |
ccba91c7 | 8 | |
c532d8a0 | 9 | #include "sd-hwdb.h" |
ccba91c7 | 10 | |
b5efdb8a | 11 | #include "alloc-util.h" |
b0db44fe | 12 | #include "device-util.h" |
c532d8a0 | 13 | #include "hwdb-util.h" |
5547c125 | 14 | #include "parse-util.h" |
07630cea | 15 | #include "string-util.h" |
07a26e42 | 16 | #include "udev-builtin.h" |
c532d8a0 TG |
17 | |
18 | static sd_hwdb *hwdb; | |
ccba91c7 | 19 | |
bfc38d8f | 20 | int udev_builtin_hwdb_lookup(sd_device *dev, |
a4bbef09 KS |
21 | const char *prefix, const char *modalias, |
22 | const char *filter, bool test) { | |
45d9a304 | 23 | _cleanup_free_ char *lookup = NULL; |
c532d8a0 | 24 | const char *key, *value; |
269c3b67 | 25 | int n = 0, r; |
59803c38 | 26 | |
33c770b1 KS |
27 | if (!hwdb) |
28 | return -ENOENT; | |
29 | ||
a4bbef09 | 30 | if (prefix) { |
605405c6 | 31 | lookup = strjoin(prefix, modalias); |
a4bbef09 KS |
32 | if (!lookup) |
33 | return -ENOMEM; | |
c532d8a0 TG |
34 | modalias = lookup; |
35 | } | |
a4bbef09 | 36 | |
c532d8a0 TG |
37 | SD_HWDB_FOREACH_PROPERTY(hwdb, modalias, key, value) { |
38 | if (filter && fnmatch(filter, key, FNM_NOESCAPE) != 0) | |
67410e9f KS |
39 | continue; |
40 | ||
269c3b67 YW |
41 | r = udev_builtin_add_property(dev, test, key, value); |
42 | if (r < 0) | |
43 | return r; | |
59803c38 KS |
44 | n++; |
45 | } | |
46 | return n; | |
47 | } | |
48 | ||
bfc38d8f | 49 | static const char *modalias_usb(sd_device *dev, char *s, size_t size) { |
df766732 | 50 | const char *v, *p, *n = NULL; |
5547c125 | 51 | uint16_t vn, pn; |
59803c38 | 52 | |
bfc38d8f | 53 | if (sd_device_get_sysattr_value(dev, "idVendor", &v) < 0) |
59803c38 | 54 | return NULL; |
bfc38d8f | 55 | if (sd_device_get_sysattr_value(dev, "idProduct", &p) < 0) |
59803c38 | 56 | return NULL; |
5547c125 | 57 | if (safe_atoux16(v, &vn) < 0) |
2f5fa62b | 58 | return NULL; |
5547c125 | 59 | if (safe_atoux16(p, &pn) < 0) |
2f5fa62b | 60 | return NULL; |
df766732 ZJS |
61 | (void) sd_device_get_sysattr_value(dev, "product", &n); |
62 | ||
63 | snprintf(s, size, "usb:v%04Xp%04X:%s", vn, pn, strempty(n)); | |
59803c38 KS |
64 | return s; |
65 | } | |
66 | ||
bfc38d8f | 67 | static int udev_builtin_hwdb_search(sd_device *dev, sd_device *srcdev, |
a4bbef09 KS |
68 | const char *subsystem, const char *prefix, |
69 | const char *filter, bool test) { | |
df766732 | 70 | char s[LINE_MAX]; |
77cf759e KS |
71 | bool last = false; |
72 | int r = 0; | |
59803c38 | 73 | |
3b64e4d4 TG |
74 | assert(dev); |
75 | ||
e448a1c3 TG |
76 | if (!srcdev) |
77 | srcdev = dev; | |
78 | ||
df766732 | 79 | for (sd_device *d = srcdev; d; ) { |
bfc38d8f | 80 | const char *dsubsys, *devtype, *modalias = NULL; |
59803c38 | 81 | |
bfc38d8f YW |
82 | if (sd_device_get_subsystem(d, &dsubsys) < 0) |
83 | goto next; | |
59803c38 KS |
84 | |
85 | /* look only at devices of a specific subsystem */ | |
86 | if (subsystem && !streq(dsubsys, subsystem)) | |
bfc38d8f | 87 | goto next; |
59803c38 | 88 | |
bfc38d8f | 89 | (void) sd_device_get_property_value(d, "MODALIAS", &modalias); |
0238cf7c | 90 | |
bfc38d8f YW |
91 | if (streq(dsubsys, "usb") && |
92 | sd_device_get_devtype(d, &devtype) >= 0 && | |
93 | streq(devtype, "usb_device")) { | |
77cf759e KS |
94 | /* if the usb_device does not have a modalias, compose one */ |
95 | if (!modalias) | |
96 | modalias = modalias_usb(d, s, sizeof(s)); | |
97 | ||
98 | /* avoid looking at any parent device, they are usually just a USB hub */ | |
99 | last = true; | |
100 | } | |
59803c38 | 101 | |
59803c38 | 102 | if (!modalias) |
bfc38d8f | 103 | goto next; |
67410e9f | 104 | |
df766732 ZJS |
105 | log_device_debug(dev, "hwdb modalias key: \"%s\"", modalias); |
106 | ||
77cf759e KS |
107 | r = udev_builtin_hwdb_lookup(dev, prefix, modalias, filter, test); |
108 | if (r > 0) | |
59803c38 | 109 | break; |
bfc38d8f YW |
110 | |
111 | if (last) | |
112 | break; | |
113 | next: | |
114 | if (sd_device_get_parent(d, &d) < 0) | |
115 | break; | |
59803c38 KS |
116 | } |
117 | ||
77cf759e | 118 | return r; |
59803c38 KS |
119 | } |
120 | ||
3fc2e9a2 | 121 | static int builtin_hwdb(sd_device *dev, int argc, char *argv[], bool test) { |
2001208c | 122 | static const struct option options[] = { |
67410e9f KS |
123 | { "filter", required_argument, NULL, 'f' }, |
124 | { "device", required_argument, NULL, 'd' }, | |
2001208c | 125 | { "subsystem", required_argument, NULL, 's' }, |
a4bbef09 | 126 | { "lookup-prefix", required_argument, NULL, 'p' }, |
2001208c | 127 | {} |
796b06c2 | 128 | }; |
67410e9f KS |
129 | const char *filter = NULL; |
130 | const char *device = NULL; | |
59803c38 | 131 | const char *subsystem = NULL; |
a4bbef09 | 132 | const char *prefix = NULL; |
bfc38d8f | 133 | _cleanup_(sd_device_unrefp) sd_device *srcdev = NULL; |
d354690e | 134 | int r; |
ccba91c7 | 135 | |
2001208c | 136 | if (!hwdb) |
d354690e | 137 | return -EINVAL; |
ccba91c7 | 138 | |
2001208c KS |
139 | for (;;) { |
140 | int option; | |
ccba91c7 | 141 | |
a4bbef09 | 142 | option = getopt_long(argc, argv, "f:d:s:p:", options, NULL); |
2001208c KS |
143 | if (option == -1) |
144 | break; | |
ccba91c7 | 145 | |
2001208c | 146 | switch (option) { |
67410e9f KS |
147 | case 'f': |
148 | filter = optarg; | |
149 | break; | |
150 | ||
151 | case 'd': | |
152 | device = optarg; | |
153 | break; | |
154 | ||
2001208c | 155 | case 's': |
59803c38 | 156 | subsystem = optarg; |
2001208c | 157 | break; |
a4bbef09 KS |
158 | |
159 | case 'p': | |
160 | prefix = optarg; | |
161 | break; | |
912541b0 KS |
162 | } |
163 | } | |
ccba91c7 | 164 | |
6824690f | 165 | /* query a specific key given as argument */ |
b0db44fe YW |
166 | if (argv[optind]) { |
167 | r = udev_builtin_hwdb_lookup(dev, prefix, argv[optind], filter, test); | |
168 | if (r < 0) | |
105a1a36 | 169 | return log_device_debug_errno(dev, r, "Failed to look up hwdb: %m"); |
b0db44fe | 170 | if (r == 0) |
8d6c4b31 | 171 | return log_device_debug_errno(dev, SYNTHETIC_ERRNO(ENODATA), "No entry found from hwdb."); |
b0db44fe YW |
172 | return r; |
173 | } | |
6824690f | 174 | |
67410e9f | 175 | /* read data from another device than the device we will store the data */ |
d354690e YW |
176 | if (device) { |
177 | r = sd_device_new_from_device_id(&srcdev, device); | |
178 | if (r < 0) | |
b0db44fe | 179 | return log_device_debug_errno(dev, r, "Failed to create sd_device object '%s': %m", device); |
d354690e | 180 | } |
bfc38d8f | 181 | |
b0db44fe YW |
182 | r = udev_builtin_hwdb_search(dev, srcdev, subsystem, prefix, filter, test); |
183 | if (r < 0) | |
105a1a36 | 184 | return log_device_debug_errno(dev, r, "Failed to look up hwdb: %m"); |
b0db44fe | 185 | if (r == 0) |
8d6c4b31 | 186 | return log_device_debug_errno(dev, SYNTHETIC_ERRNO(ENODATA), "No entry found from hwdb."); |
b0db44fe | 187 | return r; |
796b06c2 | 188 | } |
ccba91c7 | 189 | |
796b06c2 | 190 | /* called at udev startup and reload */ |
2024ed61 | 191 | static int builtin_hwdb_init(void) { |
c532d8a0 TG |
192 | int r; |
193 | ||
2001208c | 194 | if (hwdb) |
5b4d50ef | 195 | return 0; |
c532d8a0 TG |
196 | |
197 | r = sd_hwdb_new(&hwdb); | |
198 | if (r < 0) | |
199 | return r; | |
200 | ||
912541b0 | 201 | return 0; |
3cf5266b | 202 | } |
ccba91c7 | 203 | |
796b06c2 | 204 | /* called on udev shutdown and reload request */ |
2024ed61 | 205 | static void builtin_hwdb_exit(void) { |
c532d8a0 | 206 | hwdb = sd_hwdb_unref(hwdb); |
ccba91c7 | 207 | } |
3cf5266b | 208 | |
796b06c2 | 209 | /* called every couple of seconds during event activity; 'true' if config has changed */ |
2024ed61 | 210 | static bool builtin_hwdb_validate(void) { |
c532d8a0 | 211 | return hwdb_validate(hwdb); |
796b06c2 | 212 | } |
3cf5266b | 213 | |
25de7aa7 | 214 | const UdevBuiltin udev_builtin_hwdb = { |
796b06c2 KS |
215 | .name = "hwdb", |
216 | .cmd = builtin_hwdb, | |
217 | .init = builtin_hwdb_init, | |
218 | .exit = builtin_hwdb_exit, | |
219 | .validate = builtin_hwdb_validate, | |
5ac0162c | 220 | .help = "Hardware database", |
3cf5266b | 221 | }; |