]>
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) { |
59803c38 | 50 | const char *v, *p; |
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; |
59803c38 KS |
61 | snprintf(s, size, "usb:v%04Xp%04X*", vn, pn); |
62 | return s; | |
63 | } | |
64 | ||
bfc38d8f | 65 | static int udev_builtin_hwdb_search(sd_device *dev, sd_device *srcdev, |
a4bbef09 KS |
66 | const char *subsystem, const char *prefix, |
67 | const char *filter, bool test) { | |
bfc38d8f | 68 | sd_device *d; |
59803c38 | 69 | char s[16]; |
77cf759e KS |
70 | bool last = false; |
71 | int r = 0; | |
59803c38 | 72 | |
3b64e4d4 TG |
73 | assert(dev); |
74 | ||
e448a1c3 TG |
75 | if (!srcdev) |
76 | srcdev = dev; | |
77 | ||
bfc38d8f YW |
78 | for (d = srcdev; d; ) { |
79 | const char *dsubsys, *devtype, *modalias = NULL; | |
59803c38 | 80 | |
bfc38d8f YW |
81 | if (sd_device_get_subsystem(d, &dsubsys) < 0) |
82 | goto next; | |
59803c38 KS |
83 | |
84 | /* look only at devices of a specific subsystem */ | |
85 | if (subsystem && !streq(dsubsys, subsystem)) | |
bfc38d8f | 86 | goto next; |
59803c38 | 87 | |
bfc38d8f | 88 | (void) sd_device_get_property_value(d, "MODALIAS", &modalias); |
0238cf7c | 89 | |
bfc38d8f YW |
90 | if (streq(dsubsys, "usb") && |
91 | sd_device_get_devtype(d, &devtype) >= 0 && | |
92 | streq(devtype, "usb_device")) { | |
77cf759e KS |
93 | /* if the usb_device does not have a modalias, compose one */ |
94 | if (!modalias) | |
95 | modalias = modalias_usb(d, s, sizeof(s)); | |
96 | ||
97 | /* avoid looking at any parent device, they are usually just a USB hub */ | |
98 | last = true; | |
99 | } | |
59803c38 | 100 | |
59803c38 | 101 | if (!modalias) |
bfc38d8f | 102 | goto next; |
67410e9f | 103 | |
77cf759e KS |
104 | r = udev_builtin_hwdb_lookup(dev, prefix, modalias, filter, test); |
105 | if (r > 0) | |
59803c38 | 106 | break; |
bfc38d8f YW |
107 | |
108 | if (last) | |
109 | break; | |
110 | next: | |
111 | if (sd_device_get_parent(d, &d) < 0) | |
112 | break; | |
59803c38 KS |
113 | } |
114 | ||
77cf759e | 115 | return r; |
59803c38 KS |
116 | } |
117 | ||
3fc2e9a2 | 118 | static int builtin_hwdb(sd_device *dev, int argc, char *argv[], bool test) { |
2001208c | 119 | static const struct option options[] = { |
67410e9f KS |
120 | { "filter", required_argument, NULL, 'f' }, |
121 | { "device", required_argument, NULL, 'd' }, | |
2001208c | 122 | { "subsystem", required_argument, NULL, 's' }, |
a4bbef09 | 123 | { "lookup-prefix", required_argument, NULL, 'p' }, |
2001208c | 124 | {} |
796b06c2 | 125 | }; |
67410e9f KS |
126 | const char *filter = NULL; |
127 | const char *device = NULL; | |
59803c38 | 128 | const char *subsystem = NULL; |
a4bbef09 | 129 | const char *prefix = NULL; |
bfc38d8f | 130 | _cleanup_(sd_device_unrefp) sd_device *srcdev = NULL; |
d354690e | 131 | int r; |
ccba91c7 | 132 | |
2001208c | 133 | if (!hwdb) |
d354690e | 134 | return -EINVAL; |
ccba91c7 | 135 | |
2001208c KS |
136 | for (;;) { |
137 | int option; | |
ccba91c7 | 138 | |
a4bbef09 | 139 | option = getopt_long(argc, argv, "f:d:s:p:", options, NULL); |
2001208c KS |
140 | if (option == -1) |
141 | break; | |
ccba91c7 | 142 | |
2001208c | 143 | switch (option) { |
67410e9f KS |
144 | case 'f': |
145 | filter = optarg; | |
146 | break; | |
147 | ||
148 | case 'd': | |
149 | device = optarg; | |
150 | break; | |
151 | ||
2001208c | 152 | case 's': |
59803c38 | 153 | subsystem = optarg; |
2001208c | 154 | break; |
a4bbef09 KS |
155 | |
156 | case 'p': | |
157 | prefix = optarg; | |
158 | break; | |
912541b0 KS |
159 | } |
160 | } | |
ccba91c7 | 161 | |
6824690f | 162 | /* query a specific key given as argument */ |
b0db44fe YW |
163 | if (argv[optind]) { |
164 | r = udev_builtin_hwdb_lookup(dev, prefix, argv[optind], filter, test); | |
165 | if (r < 0) | |
166 | return log_device_debug_errno(dev, r, "Failed to lookup hwdb: %m"); | |
167 | if (r == 0) | |
8d6c4b31 | 168 | return log_device_debug_errno(dev, SYNTHETIC_ERRNO(ENODATA), "No entry found from hwdb."); |
b0db44fe YW |
169 | return r; |
170 | } | |
6824690f | 171 | |
67410e9f | 172 | /* read data from another device than the device we will store the data */ |
d354690e YW |
173 | if (device) { |
174 | r = sd_device_new_from_device_id(&srcdev, device); | |
175 | if (r < 0) | |
b0db44fe | 176 | return log_device_debug_errno(dev, r, "Failed to create sd_device object '%s': %m", device); |
d354690e | 177 | } |
bfc38d8f | 178 | |
b0db44fe YW |
179 | r = udev_builtin_hwdb_search(dev, srcdev, subsystem, prefix, filter, test); |
180 | if (r < 0) | |
181 | return log_device_debug_errno(dev, r, "Failed to lookup hwdb: %m"); | |
182 | if (r == 0) | |
8d6c4b31 | 183 | return log_device_debug_errno(dev, SYNTHETIC_ERRNO(ENODATA), "No entry found from hwdb."); |
b0db44fe | 184 | return r; |
796b06c2 | 185 | } |
ccba91c7 | 186 | |
796b06c2 | 187 | /* called at udev startup and reload */ |
2024ed61 | 188 | static int builtin_hwdb_init(void) { |
c532d8a0 TG |
189 | int r; |
190 | ||
2001208c | 191 | if (hwdb) |
5b4d50ef | 192 | return 0; |
c532d8a0 TG |
193 | |
194 | r = sd_hwdb_new(&hwdb); | |
195 | if (r < 0) | |
196 | return r; | |
197 | ||
912541b0 | 198 | return 0; |
3cf5266b | 199 | } |
ccba91c7 | 200 | |
796b06c2 | 201 | /* called on udev shutdown and reload request */ |
2024ed61 | 202 | static void builtin_hwdb_exit(void) { |
c532d8a0 | 203 | hwdb = sd_hwdb_unref(hwdb); |
ccba91c7 | 204 | } |
3cf5266b | 205 | |
796b06c2 | 206 | /* called every couple of seconds during event activity; 'true' if config has changed */ |
2024ed61 | 207 | static bool builtin_hwdb_validate(void) { |
c532d8a0 | 208 | return hwdb_validate(hwdb); |
796b06c2 | 209 | } |
3cf5266b | 210 | |
796b06c2 KS |
211 | const struct udev_builtin udev_builtin_hwdb = { |
212 | .name = "hwdb", | |
213 | .cmd = builtin_hwdb, | |
214 | .init = builtin_hwdb_init, | |
215 | .exit = builtin_hwdb_exit, | |
216 | .validate = builtin_hwdb_validate, | |
5ac0162c | 217 | .help = "Hardware database", |
3cf5266b | 218 | }; |