Line | Count | Source |
1 | | /* |
2 | | * Copyright (c) 2021 Yubico AB. All rights reserved. |
3 | | * Use of this source code is governed by a BSD-style |
4 | | * license that can be found in the LICENSE file. |
5 | | * SPDX-License-Identifier: BSD-2-Clause |
6 | | */ |
7 | | |
8 | | #undef NDEBUG |
9 | | |
10 | | #include <sys/types.h> |
11 | | |
12 | | #include <linux/hidraw.h> |
13 | | #include <linux/input.h> |
14 | | |
15 | | #include <assert.h> |
16 | | #include <errno.h> |
17 | | #include <libudev.h> |
18 | | #include <stdlib.h> |
19 | | |
20 | | #include "mutator_aux.h" |
21 | | |
22 | | struct udev { |
23 | | int magic; |
24 | | }; |
25 | | |
26 | | struct udev_enumerate { |
27 | | int magic; |
28 | | struct udev_list_entry *list_entry; |
29 | | }; |
30 | | |
31 | | struct udev_list_entry { |
32 | | int magic; |
33 | | }; |
34 | | |
35 | | struct udev_device { |
36 | | int magic; |
37 | | struct udev_device *parent; |
38 | | }; |
39 | | |
40 | 2.29M | #define UDEV_MAGIC 0x584492cc |
41 | 7.21M | #define UDEV_DEVICE_MAGIC 0x569180dd |
42 | 9.92k | #define UDEV_LIST_ENTRY_MAGIC 0x497422ee |
43 | 9.98k | #define UDEV_ENUM_MAGIC 0x583570ff |
44 | | |
45 | 30.8M | #define ASSERT_TYPE(x, m) assert((x) != NULL && (x)->magic == (m)) |
46 | 9.13M | #define ASSERT_UDEV(x) ASSERT_TYPE((x), UDEV_MAGIC) |
47 | 39.8k | #define ASSERT_UDEV_ENUM(x) ASSERT_TYPE((x), UDEV_ENUM_MAGIC) |
48 | 9.11M | #define ASSERT_UDEV_LIST_ENTRY(x) ASSERT_TYPE((x), UDEV_LIST_ENTRY_MAGIC) |
49 | 12.5M | #define ASSERT_UDEV_DEVICE(x) ASSERT_TYPE((x), UDEV_DEVICE_MAGIC) |
50 | | |
51 | | static const char *uevent; |
52 | | static const struct blob *report_descriptor; |
53 | | |
54 | | struct udev *__wrap_udev_new(void); |
55 | | struct udev_device *__wrap_udev_device_get_parent_with_subsystem_devtype( |
56 | | struct udev_device *, const char *, const char *); |
57 | | struct udev_device *__wrap_udev_device_new_from_syspath(struct udev *, |
58 | | const char *); |
59 | | struct udev_enumerate *__wrap_udev_enumerate_new(struct udev *); |
60 | | struct udev_list_entry *__wrap_udev_enumerate_get_list_entry( |
61 | | struct udev_enumerate *); |
62 | | struct udev_list_entry *__wrap_udev_list_entry_get_next( |
63 | | struct udev_list_entry *); |
64 | | const char *__wrap_udev_device_get_sysattr_value(struct udev_device *, |
65 | | const char *); |
66 | | const char *__wrap_udev_list_entry_get_name(struct udev_list_entry *); |
67 | | const char *__wrap_udev_device_get_devnode(struct udev_device *); |
68 | | const char *__wrap_udev_device_get_sysnum(struct udev_device *); |
69 | | int __wrap_udev_enumerate_add_match_subsystem(struct udev_enumerate *, |
70 | | const char *); |
71 | | int __wrap_udev_enumerate_scan_devices(struct udev_enumerate *); |
72 | | int __wrap_ioctl(int, unsigned long , ...); |
73 | | void __wrap_udev_device_unref(struct udev_device *); |
74 | | void __wrap_udev_enumerate_unref(struct udev_enumerate *); |
75 | | void __wrap_udev_unref(struct udev *); |
76 | | void set_udev_parameters(const char *, const struct blob *); |
77 | | |
78 | | struct udev_device * |
79 | | __wrap_udev_device_get_parent_with_subsystem_devtype(struct udev_device *child, |
80 | | const char *subsystem, const char *devtype) |
81 | 426k | { |
82 | 426k | ASSERT_UDEV_DEVICE(child); |
83 | 426k | fido_log_debug("%s", subsystem); /* XXX consume */ |
84 | 426k | fido_log_debug("%s", devtype); /* XXX consume */ |
85 | 426k | if (child->parent != NULL) |
86 | 19.0k | return child->parent; |
87 | 407k | if ((child->parent = calloc(1, sizeof(*child->parent))) == NULL) |
88 | 1.11k | return NULL; |
89 | 406k | child->parent->magic = UDEV_DEVICE_MAGIC; |
90 | | |
91 | 406k | return child->parent; |
92 | 407k | } |
93 | | |
94 | | const char * |
95 | | __wrap_udev_device_get_sysattr_value(struct udev_device *udev_device, |
96 | | const char *sysattr) |
97 | 425k | { |
98 | 425k | ASSERT_UDEV_DEVICE(udev_device); |
99 | 425k | if (uniform_random(400) < 1) |
100 | 1.19k | return NULL; |
101 | 424k | if (!strcmp(sysattr, "manufacturer") || !strcmp(sysattr, "product")) |
102 | 18.8k | return "product info"; /* XXX randomise? */ |
103 | 405k | else if (!strcmp(sysattr, "uevent")) |
104 | 405k | return uevent; |
105 | | |
106 | 0 | return NULL; |
107 | 424k | } |
108 | | |
109 | | const char * |
110 | | __wrap_udev_list_entry_get_name(struct udev_list_entry *entry) |
111 | 4.55M | { |
112 | 4.55M | ASSERT_UDEV_LIST_ENTRY(entry); |
113 | 4.55M | return uniform_random(400) < 1 ? NULL : "name"; /* XXX randomise? */ |
114 | 4.55M | } |
115 | | |
116 | | struct udev_device * |
117 | | __wrap_udev_device_new_from_syspath(struct udev *udev, const char *syspath) |
118 | 6.82M | { |
119 | 6.82M | struct udev_device *udev_device; |
120 | | |
121 | 6.82M | ASSERT_UDEV(udev); |
122 | 6.82M | fido_log_debug("%s", syspath); |
123 | 6.82M | if ((udev_device = calloc(1, sizeof(*udev_device))) == NULL) |
124 | 17.0k | return NULL; |
125 | 6.81M | udev_device->magic = UDEV_DEVICE_MAGIC; |
126 | | |
127 | 6.81M | return udev_device; |
128 | 6.82M | } |
129 | | |
130 | | const char * |
131 | | __wrap_udev_device_get_devnode(struct udev_device *udev_device) |
132 | 2.21M | { |
133 | 2.21M | ASSERT_UDEV_DEVICE(udev_device); |
134 | 2.21M | return uniform_random(400) < 1 ? NULL : "/dev/zero"; |
135 | 2.21M | } |
136 | | |
137 | | const char * |
138 | | __wrap_udev_device_get_sysnum(struct udev_device *udev_device) |
139 | 2.28M | { |
140 | 2.28M | ASSERT_UDEV_DEVICE(udev_device); |
141 | 2.28M | return uniform_random(400) < 1 ? NULL : "101010"; /* XXX randomise? */ |
142 | 2.28M | } |
143 | | |
144 | | void |
145 | | __wrap_udev_device_unref(struct udev_device *udev_device) |
146 | 6.81M | { |
147 | 6.81M | ASSERT_UDEV_DEVICE(udev_device); |
148 | 6.81M | if (udev_device->parent) { |
149 | 406k | ASSERT_UDEV_DEVICE(udev_device->parent); |
150 | 406k | free(udev_device->parent); |
151 | 406k | } |
152 | 6.81M | free(udev_device); |
153 | 6.81M | } |
154 | | |
155 | | struct udev * |
156 | | __wrap_udev_new(void) |
157 | 2.30M | { |
158 | 2.30M | struct udev *udev; |
159 | | |
160 | 2.30M | if ((udev = calloc(1, sizeof(*udev))) == NULL) |
161 | 5.86k | return NULL; |
162 | 2.29M | udev->magic = UDEV_MAGIC; |
163 | | |
164 | 2.29M | return udev; |
165 | 2.30M | } |
166 | | |
167 | | struct udev_enumerate * |
168 | | __wrap_udev_enumerate_new(struct udev *udev) |
169 | 10.0k | { |
170 | 10.0k | struct udev_enumerate *udev_enum; |
171 | | |
172 | 10.0k | ASSERT_UDEV(udev); |
173 | 10.0k | if ((udev_enum = calloc(1, sizeof(*udev_enum))) == NULL) |
174 | 22 | return NULL; |
175 | 9.98k | udev_enum->magic = UDEV_ENUM_MAGIC; |
176 | | |
177 | 9.98k | return udev_enum; |
178 | 10.0k | } |
179 | | |
180 | | int |
181 | | __wrap_udev_enumerate_add_match_subsystem(struct udev_enumerate *udev_enum, |
182 | | const char *subsystem) |
183 | 9.98k | { |
184 | 9.98k | ASSERT_UDEV_ENUM(udev_enum); |
185 | 9.98k | fido_log_debug("%s:", subsystem); |
186 | 9.98k | return uniform_random(400) < 1 ? -EINVAL : 0; |
187 | 9.98k | } |
188 | | |
189 | | int |
190 | | __wrap_udev_enumerate_scan_devices(struct udev_enumerate *udev_enum) |
191 | 9.97k | { |
192 | 9.97k | ASSERT_UDEV_ENUM(udev_enum); |
193 | 9.97k | return uniform_random(400) < 1 ? -EINVAL : 0; |
194 | 9.97k | } |
195 | | |
196 | | struct udev_list_entry * |
197 | | __wrap_udev_enumerate_get_list_entry(struct udev_enumerate *udev_enum) |
198 | 9.94k | { |
199 | 9.94k | ASSERT_UDEV_ENUM(udev_enum); |
200 | 9.94k | if ((udev_enum->list_entry = calloc(1, |
201 | 9.94k | sizeof(*udev_enum->list_entry))) == NULL) |
202 | 22 | return NULL; |
203 | 9.92k | udev_enum->list_entry->magic = UDEV_LIST_ENTRY_MAGIC; |
204 | | |
205 | 9.92k | return udev_enum->list_entry; |
206 | 9.94k | } |
207 | | |
208 | | struct udev_list_entry * |
209 | | __wrap_udev_list_entry_get_next(struct udev_list_entry *udev_list_entry) |
210 | 4.55M | { |
211 | 4.55M | ASSERT_UDEV_LIST_ENTRY(udev_list_entry); |
212 | 4.55M | return uniform_random(400) < 1 ? NULL : udev_list_entry; |
213 | 4.55M | } |
214 | | |
215 | | void |
216 | | __wrap_udev_enumerate_unref(struct udev_enumerate *udev_enum) |
217 | 9.98k | { |
218 | 9.98k | ASSERT_UDEV_ENUM(udev_enum); |
219 | 9.98k | if (udev_enum->list_entry) |
220 | 9.98k | ASSERT_UDEV_LIST_ENTRY(udev_enum->list_entry); |
221 | 9.98k | free(udev_enum->list_entry); |
222 | 9.98k | free(udev_enum); |
223 | 9.98k | } |
224 | | |
225 | | void |
226 | | __wrap_udev_unref(struct udev *udev) |
227 | 2.29M | { |
228 | 2.29M | ASSERT_UDEV(udev); |
229 | 2.29M | free(udev); |
230 | 2.29M | } |
231 | | |
232 | | int |
233 | | __wrap_ioctl(int fd, unsigned long request, ...) |
234 | 4.40M | { |
235 | 4.40M | va_list ap; |
236 | 4.40M | struct hidraw_report_descriptor *hrd; |
237 | | |
238 | 4.40M | (void)fd; |
239 | | |
240 | 4.40M | if (uniform_random(400) < 1) { |
241 | 11.0k | errno = EINVAL; |
242 | 11.0k | return -1; |
243 | 11.0k | } |
244 | | |
245 | 4.40M | va_start(ap, request); |
246 | | |
247 | 4.39M | switch (IOCTL_REQ(request)) { |
248 | 2.20M | case IOCTL_REQ(HIDIOCGRDESCSIZE): |
249 | 2.20M | *va_arg(ap, int *) = (int)report_descriptor->len; |
250 | 2.20M | break; |
251 | 2.19M | case IOCTL_REQ(HIDIOCGRDESC): |
252 | 2.19M | hrd = va_arg(ap, struct hidraw_report_descriptor *); |
253 | 2.19M | assert(hrd->size == report_descriptor->len); |
254 | 2.19M | memcpy(hrd->value, report_descriptor->body, hrd->size); |
255 | 2.19M | break; |
256 | 0 | default: |
257 | 0 | warnx("%s: unknown request 0x%lx", __func__, request); |
258 | 0 | abort(); |
259 | 4.39M | } |
260 | | |
261 | 4.39M | va_end(ap); |
262 | | |
263 | 4.39M | return 0; |
264 | 4.39M | } |
265 | | |
266 | | void |
267 | | set_udev_parameters(const char *uevent_ptr, |
268 | | const struct blob *report_descriptor_ptr) |
269 | 5.16k | { |
270 | 5.16k | uevent = uevent_ptr; |
271 | 5.16k | report_descriptor = report_descriptor_ptr; |
272 | 5.16k | } |