]>
Commit | Line | Data |
---|---|---|
2232cac8 GKH |
1 | /* |
2 | * namedev.c | |
3 | * | |
4 | * Userspace devfs | |
5 | * | |
6 | * Copyright (C) 2003 Greg Kroah-Hartman <greg@kroah.com> | |
7 | * | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify it | |
10 | * under the terms of the GNU General Public License as published by the | |
11 | * Free Software Foundation version 2 of the License. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License along | |
19 | * with this program; if not, write to the Free Software Foundation, Inc., | |
20 | * 675 Mass Ave, Cambridge, MA 02139, USA. | |
21 | * | |
22 | */ | |
23 | ||
24 | #include <stddef.h> | |
25 | #include <stdlib.h> | |
26 | #include <string.h> | |
27 | #include <stdio.h> | |
28 | #include <fcntl.h> | |
29 | #include <ctype.h> | |
30 | #include <unistd.h> | |
31 | #include <errno.h> | |
616a7078 | 32 | #include <time.h> |
c27e6911 | 33 | #include <sys/wait.h> |
dac056aa | 34 | #include <sys/stat.h> |
2232cac8 | 35 | |
c80da508 | 36 | #include "libsysfs/sysfs/libsysfs.h" |
2232cac8 GKH |
37 | #include "list.h" |
38 | #include "udev.h" | |
39 | #include "udev_version.h" | |
54988802 | 40 | #include "logging.h" |
2232cac8 | 41 | #include "namedev.h" |
2023350e | 42 | #include "klibc_fixups.h" |
2232cac8 | 43 | |
a27cd06c KS |
44 | static struct sysfs_attribute *find_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, char *attr); |
45 | ||
19feb351 | 46 | LIST_HEAD(config_device_list); |
61219c75 | 47 | LIST_HEAD(perm_device_list); |
2232cac8 | 48 | |
9f1da361 KS |
49 | /* compare string with pattern (supports * ? [0-9] [!A-Z]) */ |
50 | static int strcmp_pattern(const char *p, const char *s) | |
c124eafa | 51 | { |
8a08e4b1 KS |
52 | if (s[0] == '\0') { |
53 | while (p[0] == '*') | |
9f1da361 | 54 | p++; |
8a08e4b1 | 55 | return (p[0] != '\0'); |
9f1da361 | 56 | } |
8a08e4b1 | 57 | switch (p[0]) { |
9f1da361 KS |
58 | case '[': |
59 | { | |
60 | int not = 0; | |
61 | p++; | |
8a08e4b1 | 62 | if (p[0] == '!') { |
9f1da361 KS |
63 | not = 1; |
64 | p++; | |
65 | } | |
8a08e4b1 | 66 | while ((p[0] != '\0') && (p[0] != ']')) { |
9f1da361 KS |
67 | int match = 0; |
68 | if (p[1] == '-') { | |
8a08e4b1 | 69 | if ((s[0] >= p[0]) && (s[0] <= p[2])) |
9f1da361 KS |
70 | match = 1; |
71 | p += 3; | |
72 | } else { | |
8a08e4b1 | 73 | match = (p[0] == s[0]); |
9f1da361 KS |
74 | p++; |
75 | } | |
76 | if (match ^ not) { | |
8a08e4b1 | 77 | while ((p[0] != '\0') && (p[0] != ']')) |
9f1da361 | 78 | p++; |
8a08e4b1 KS |
79 | if (p[0] == ']') |
80 | return strcmp_pattern(p+1, s+1); | |
9f1da361 KS |
81 | } |
82 | } | |
83 | } | |
84 | break; | |
85 | case '*': | |
86 | if (strcmp_pattern(p, s+1)) | |
87 | return strcmp_pattern(p+1, s); | |
88 | return 0; | |
89 | case '\0': | |
8a08e4b1 | 90 | if (s[0] == '\0') { |
9f1da361 KS |
91 | return 0; |
92 | } | |
93 | break; | |
94 | default: | |
8a08e4b1 | 95 | if ((p[0] == s[0]) || (p[0] == '?')) |
9f1da361 KS |
96 | return strcmp_pattern(p+1, s+1); |
97 | break; | |
98 | } | |
99 | return 1; | |
c124eafa KS |
100 | } |
101 | ||
2232cac8 GKH |
102 | #define copy_var(a, b, var) \ |
103 | if (b->var) \ | |
469c7cff | 104 | a->var = b->var; |
2232cac8 GKH |
105 | |
106 | #define copy_string(a, b, var) \ | |
107 | if (strlen(b->var)) \ | |
469c7cff | 108 | strcpy(a->var, b->var); |
2232cac8 | 109 | |
61219c75 GKH |
110 | int add_perm_dev(struct perm_device *new_dev) |
111 | { | |
843d1a84 | 112 | struct perm_device *dev; |
61219c75 GKH |
113 | struct perm_device *tmp_dev; |
114 | ||
115 | /* update the values if we already have the device */ | |
843d1a84 | 116 | list_for_each_entry(dev, &perm_device_list, node) { |
ba053b91 | 117 | if (strcmp(new_dev->name, dev->name)) |
61219c75 GKH |
118 | continue; |
119 | copy_var(dev, new_dev, mode); | |
120 | copy_string(dev, new_dev, owner); | |
121 | copy_string(dev, new_dev, group); | |
122 | return 0; | |
123 | } | |
124 | ||
125 | /* not found, add new structure to the perm list */ | |
126 | tmp_dev = malloc(sizeof(*tmp_dev)); | |
127 | if (!tmp_dev) | |
128 | return -ENOMEM; | |
129 | memcpy(tmp_dev, new_dev, sizeof(*tmp_dev)); | |
130 | list_add_tail(&tmp_dev->node, &perm_device_list); | |
131 | //dump_perm_dev(tmp_dev); | |
132 | return 0; | |
133 | } | |
134 | ||
135 | static struct perm_device *find_perm(char *name) | |
136 | { | |
843d1a84 | 137 | struct perm_device *perm; |
61219c75 | 138 | |
843d1a84 | 139 | list_for_each_entry(perm, &perm_device_list, node) { |
61219c75 GKH |
140 | if (strcmp_pattern(perm->name, name)) |
141 | continue; | |
142 | return perm; | |
143 | } | |
144 | return NULL; | |
145 | } | |
146 | ||
765cbd97 | 147 | static mode_t get_default_mode(void) |
185a35a4 | 148 | { |
89571022 GKH |
149 | mode_t mode = 0600; /* default to owner rw only */ |
150 | ||
267f534d | 151 | if (strlen(default_mode_str) != 0) |
89571022 | 152 | mode = strtol(default_mode_str, NULL, 8); |
267f534d | 153 | |
89571022 | 154 | return mode; |
185a35a4 GKH |
155 | } |
156 | ||
267f534d | 157 | static char *get_default_owner(void) |
74c73ef9 | 158 | { |
267f534d | 159 | if (strlen(default_owner_str) == 0) |
c472e3c8 | 160 | strfieldcpy(default_owner_str, "root"); |
267f534d | 161 | |
74c73ef9 | 162 | return default_owner_str; |
163 | } | |
164 | ||
267f534d | 165 | static char *get_default_group(void) |
74c73ef9 | 166 | { |
267f534d | 167 | if (strlen(default_group_str) == 0) |
c472e3c8 | 168 | strfieldcpy(default_group_str, "root"); |
267f534d | 169 | |
74c73ef9 | 170 | return default_group_str; |
171 | } | |
172 | ||
a27cd06c KS |
173 | /* extract possible {attr} and move str behind it */ |
174 | static char *get_format_attribute(char **str) | |
175 | { | |
176 | char *pos; | |
177 | char *attr = NULL; | |
178 | ||
179 | if (*str[0] == '{') { | |
180 | pos = strchr(*str, '}'); | |
181 | if (pos == NULL) { | |
182 | dbg("missing closing brace for format"); | |
183 | return NULL; | |
184 | } | |
185 | pos[0] = '\0'; | |
186 | attr = *str+1; | |
187 | *str = pos+1; | |
188 | dbg("attribute='%s', str='%s'", attr, *str); | |
189 | } | |
190 | return attr; | |
191 | } | |
192 | ||
193 | /* extract possible format length and move str behind it*/ | |
194 | static int get_format_len(char **str) | |
195 | { | |
196 | int num; | |
197 | char *tail; | |
198 | ||
199 | if (isdigit(*str[0])) { | |
200 | num = (int) strtoul(*str, &tail, 10); | |
aebef544 | 201 | if (num > 0) { |
a27cd06c KS |
202 | *str = tail; |
203 | dbg("format length=%i", num); | |
204 | return num; | |
205 | } else { | |
206 | dbg("format parsing error '%s'", *str); | |
207 | } | |
208 | } | |
209 | return -1; | |
210 | } | |
211 | ||
831f800d KS |
212 | static void apply_format(struct udevice *udev, char *string, size_t maxsize, |
213 | struct sysfs_class_device *class_dev, | |
214 | struct sysfs_device *sysfs_device) | |
f3b04a2e | 215 | { |
b1c5e333 | 216 | char temp[NAME_SIZE]; |
27c3403d | 217 | char temp2[NAME_SIZE]; |
b1c5e333 | 218 | char *tail; |
f3b04a2e | 219 | char *pos; |
a27cd06c | 220 | char *attr; |
63ead27c | 221 | int len; |
88f09368 | 222 | int i; |
a27cd06c | 223 | char c; |
ef672b3d KS |
224 | char *spos; |
225 | int slen; | |
a27cd06c | 226 | struct sysfs_attribute *tmpattr; |
f3b04a2e | 227 | |
8ffb636f | 228 | pos = string; |
a27cd06c | 229 | |
f3b04a2e | 230 | while (1) { |
3fe07342 | 231 | pos = strchr(string, '%'); |
a27cd06c | 232 | if (pos != NULL) { |
8ffb636f | 233 | pos[0] = '\0'; |
b1c5e333 | 234 | tail = pos+1; |
63ead27c | 235 | len = get_format_len(&tail); |
a27cd06c | 236 | c = tail[0]; |
8ffb636f | 237 | strfieldcpy(temp, tail+1); |
a27cd06c KS |
238 | tail = temp; |
239 | } else { | |
240 | break; | |
241 | } | |
242 | dbg("format=%c, string='%s', tail='%s'",c , string, tail); | |
b1c5e333 | 243 | |
a27cd06c KS |
244 | attr = get_format_attribute(&tail); |
245 | ||
246 | switch (c) { | |
247 | case 'b': | |
248 | if (strlen(udev->bus_id) == 0) | |
f3b04a2e | 249 | break; |
3fe07342 | 250 | strnfieldcat(string, udev->bus_id, maxsize); |
a27cd06c KS |
251 | dbg("substitute bus_id '%s'", udev->bus_id); |
252 | break; | |
253 | case 'k': | |
254 | if (strlen(udev->kernel_name) == 0) | |
3e540368 | 255 | break; |
3fe07342 | 256 | strnfieldcat(string, udev->kernel_name, maxsize); |
a27cd06c KS |
257 | dbg("substitute kernel name '%s'", udev->kernel_name); |
258 | break; | |
259 | case 'n': | |
260 | if (strlen(udev->kernel_number) == 0) | |
f3b04a2e | 261 | break; |
3fe07342 | 262 | strnfieldcat(string, udev->kernel_number, maxsize); |
a27cd06c | 263 | dbg("substitute kernel number '%s'", udev->kernel_number); |
f3b04a2e | 264 | break; |
a27cd06c | 265 | case 'm': |
c58e36c0 | 266 | strnintcat(string, udev->minor, maxsize); |
a27cd06c KS |
267 | dbg("substitute minor number '%u'", udev->minor); |
268 | break; | |
c58e36c0 KS |
269 | case 'M': |
270 | strnintcat(string, udev->major, maxsize); | |
a27cd06c KS |
271 | dbg("substitute major number '%u'", udev->major); |
272 | break; | |
273 | case 'c': | |
274 | if (strlen(udev->program_result) == 0) | |
f3b04a2e | 275 | break; |
88f09368 | 276 | /* get part part of the result string */ |
63ead27c | 277 | i = 0; |
88f09368 KS |
278 | if (attr != NULL) |
279 | i = atoi(attr); | |
280 | if (i > 0) { | |
9fe3f9a9 | 281 | foreach_strpart(udev->program_result, " \n\r", spos, slen) { |
88f09368 | 282 | i--; |
9fe3f9a9 | 283 | if (i == 0) |
a27cd06c | 284 | break; |
b1c5e333 | 285 | } |
9fe3f9a9 KS |
286 | if (i > 0) { |
287 | dbg("requested part of result string not found"); | |
288 | break; | |
a27cd06c | 289 | } |
ef672b3d | 290 | strnfieldcpy(temp2, spos, slen+1); |
27c3403d KS |
291 | strnfieldcat(string, temp2, maxsize); |
292 | dbg("substitute part of result string '%s'", temp2); | |
a27cd06c | 293 | } else { |
3fe07342 | 294 | strnfieldcat(string, udev->program_result, maxsize); |
a27cd06c | 295 | dbg("substitute result string '%s'", udev->program_result); |
f3b04a2e | 296 | } |
f3b04a2e | 297 | break; |
a27cd06c KS |
298 | case 's': |
299 | if (attr != NULL) { | |
300 | tmpattr = find_sysfs_attribute(class_dev, sysfs_device, attr); | |
301 | if (tmpattr == NULL) { | |
302 | dbg("sysfa attribute '%s' not found", attr); | |
303 | break; | |
304 | } | |
3fe07342 | 305 | strnfieldcat(string, tmpattr->value, maxsize); |
a27cd06c KS |
306 | dbg("substitute sysfs value '%s'", tmpattr->value); |
307 | } else { | |
308 | dbg("missing attribute"); | |
309 | } | |
310 | break; | |
311 | case '%': | |
3fe07342 | 312 | strnfieldcat(string, "%", maxsize); |
a27cd06c KS |
313 | break; |
314 | default: | |
315 | dbg("unknown substitution type '%%%c'", c); | |
316 | break; | |
317 | } | |
63ead27c KS |
318 | /* truncate to specified length */ |
319 | if (len > 0) | |
320 | pos[len] = '\0'; | |
321 | ||
3fe07342 | 322 | strnfieldcat(string, tail, maxsize); |
f3b04a2e GKH |
323 | } |
324 | } | |
325 | ||
bb051f66 GKH |
326 | /* |
327 | * Note, we can have multiple files for different busses in here due | |
328 | * to the mess that USB has for its device tree... | |
329 | */ | |
dac056aa GKH |
330 | static struct bus_file { |
331 | char *bus; | |
332 | char *file; | |
333 | } bus_files[] = { | |
334 | { .bus = "scsi", .file = "vendor" }, | |
335 | { .bus = "usb", .file = "idVendor" }, | |
bb051f66 | 336 | { .bus = "usb", .file = "iInterface" }, |
b7824727 | 337 | { .bus = "usb-serial", .file = "detach_state" }, |
2441c207 | 338 | { .bus = "ide", .file = "detach_state" }, |
48076332 | 339 | { .bus = "pci", .file = "vendor" }, |
dac056aa GKH |
340 | {} |
341 | }; | |
342 | ||
343 | #define SECONDS_TO_WAIT_FOR_FILE 10 | |
344 | static void wait_for_device_to_initialize(struct sysfs_device *sysfs_device) | |
345 | { | |
346 | /* sleep until we see the file for this specific bus type show up this | |
347 | * is needed because we can easily out-run the kernel in looking for | |
348 | * these files before the paticular subsystem has created them in the | |
349 | * sysfs tree properly. | |
350 | * | |
351 | * And people thought that the /sbin/hotplug event system was going to | |
352 | * be slow, poo on you for arguing that before even testing it... | |
353 | */ | |
354 | struct bus_file *b = &bus_files[0]; | |
355 | struct sysfs_attribute *tmpattr; | |
bb051f66 GKH |
356 | int found = 0; |
357 | int loop = SECONDS_TO_WAIT_FOR_FILE; | |
dac056aa GKH |
358 | |
359 | while (1) { | |
bb051f66 GKH |
360 | if (b->bus == NULL) { |
361 | if (!found) | |
362 | break; | |
363 | /* sleep to give the kernel a chance to create the file */ | |
364 | sleep(1); | |
365 | --loop; | |
366 | if (loop == 0) | |
367 | break; | |
368 | b = &bus_files[0]; | |
369 | } | |
dac056aa | 370 | if (strcmp(sysfs_device->bus, b->bus) == 0) { |
bb051f66 GKH |
371 | found = 1; |
372 | dbg("looking for file '%s' on bus '%s'", b->file, b->bus); | |
373 | tmpattr = sysfs_get_device_attr(sysfs_device, b->file); | |
374 | if (tmpattr) { | |
375 | /* found it! */ | |
376 | goto exit; | |
dac056aa | 377 | } |
bb051f66 | 378 | dbg("can't find '%s' file", b->file); |
dac056aa | 379 | } |
bb051f66 | 380 | ++b; |
dac056aa | 381 | } |
bb051f66 GKH |
382 | if (!found) |
383 | dbg("did not find bus type '%s' on list of bus_id_files, " | |
384 | "contact greg@kroah.com", sysfs_device->bus); | |
dac056aa GKH |
385 | exit: |
386 | return; /* here to prevent compiler warning... */ | |
387 | } | |
19dc5d4c | 388 | |
1b941027 GKH |
389 | static void fix_kernel_name(struct udevice *udev) |
390 | { | |
391 | char *temp = udev->kernel_name; | |
392 | ||
393 | while (*temp != 0x00) { | |
394 | /* Some block devices have a ! in their name, | |
395 | * we need to change that to / */ | |
396 | if (*temp == '!') | |
397 | *temp = '/'; | |
398 | ++temp; | |
399 | } | |
400 | } | |
401 | ||
ac28b86d | 402 | static int execute_program(char *path, char *value, int len) |
c27e6911 PM |
403 | { |
404 | int retval; | |
405 | int res; | |
406 | int status; | |
407 | int fds[2]; | |
408 | pid_t pid; | |
409 | int value_set = 0; | |
e964c2c0 | 410 | char buffer[255]; |
20524642 | 411 | char *pos; |
7e5f7397 | 412 | char *args[PROGRAM_MAXARG]; |
bc434511 | 413 | int i; |
c27e6911 | 414 | |
ac28b86d | 415 | dbg("executing '%s'", path); |
c27e6911 PM |
416 | retval = pipe(fds); |
417 | if (retval != 0) { | |
418 | dbg("pipe failed"); | |
419 | return -1; | |
420 | } | |
421 | pid = fork(); | |
2a25816f KS |
422 | switch(pid) { |
423 | case 0: | |
8f43a65e | 424 | /* child */ |
c27e6911 | 425 | close(STDOUT_FILENO); |
dde05ccb GKH |
426 | |
427 | /* dup write side of pipe to STDOUT */ | |
428 | dup(fds[1]); | |
429 | ||
430 | /* copy off our path to use incase we have too many args */ | |
431 | strnfieldcpy(buffer, path, sizeof(buffer)); | |
432 | ||
41397661 | 433 | if (strchr(path, ' ')) { |
ac28b86d | 434 | /* exec with arguments */ |
41397661 | 435 | pos = path; |
7e5f7397 | 436 | for (i=0; i < PROGRAM_MAXARG-1; i++) { |
20524642 | 437 | args[i] = strsep(&pos, " "); |
bc434511 KS |
438 | if (args[i] == NULL) |
439 | break; | |
440 | } | |
441 | if (args[i]) { | |
dde05ccb GKH |
442 | dbg("too many args - %d, using subshell instead '%s'", i, buffer); |
443 | retval = execl("/bin/sh", "sh", "-c", buffer, NULL); | |
444 | } else { | |
445 | dbg("execute program '%s'", path); | |
446 | retval = execv(args[0], args); | |
bc434511 | 447 | } |
bc434511 | 448 | } else { |
2a25816f | 449 | retval = execv(path, main_argv); |
bc434511 | 450 | } |
dde05ccb | 451 | info(FIELD_PROGRAM " execution of '%s' failed", path); |
2a25816f KS |
452 | exit(1); |
453 | case -1: | |
454 | dbg("fork failed"); | |
455 | return -1; | |
456 | default: | |
8f43a65e | 457 | /* parent reads from fds[0] */ |
c27e6911 PM |
458 | close(fds[1]); |
459 | retval = 0; | |
460 | while (1) { | |
461 | res = read(fds[0], buffer, sizeof(buffer) - 1); | |
462 | if (res <= 0) | |
463 | break; | |
464 | buffer[res] = '\0'; | |
465 | if (res > len) { | |
ac28b86d | 466 | dbg("result len %d too short", len); |
c27e6911 PM |
467 | retval = -1; |
468 | } | |
469 | if (value_set) { | |
ac28b86d | 470 | dbg("result value already set"); |
c27e6911 PM |
471 | retval = -1; |
472 | } else { | |
473 | value_set = 1; | |
474 | strncpy(value, buffer, len); | |
20524642 KS |
475 | pos = value + strlen(value)-1; |
476 | if (pos[0] == '\n') | |
831f800d | 477 | pos[0] = '\0'; |
ac28b86d | 478 | dbg("result is '%s'", value); |
c27e6911 PM |
479 | } |
480 | } | |
481 | close(fds[0]); | |
482 | res = wait(&status); | |
483 | if (res < 0) { | |
484 | dbg("wait failed result %d", res); | |
485 | retval = -1; | |
486 | } | |
487 | ||
488 | if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) { | |
ac28b86d | 489 | dbg("exec program status 0x%x", status); |
c27e6911 PM |
490 | retval = -1; |
491 | } | |
492 | } | |
493 | return retval; | |
494 | } | |
495 | ||
a27cd06c | 496 | static struct sysfs_attribute *find_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, char *attr) |
ca1cc0fe GKH |
497 | { |
498 | struct sysfs_attribute *tmpattr = NULL; | |
a8b01705 GKH |
499 | char *c; |
500 | ||
a27cd06c | 501 | dbg("look for device attribute '%s'", attr); |
a8b01705 | 502 | /* try to find the attribute in the class device directory */ |
a27cd06c | 503 | tmpattr = sysfs_get_classdev_attr(class_dev, attr); |
a8b01705 | 504 | if (tmpattr) |
a27cd06c | 505 | goto attr_found; |
a8b01705 GKH |
506 | |
507 | /* look in the class device directory if present */ | |
508 | if (sysfs_device) { | |
a27cd06c | 509 | tmpattr = sysfs_get_device_attr(sysfs_device, attr); |
a8b01705 | 510 | if (tmpattr) |
a27cd06c | 511 | goto attr_found; |
a8b01705 | 512 | } |
a8b01705 | 513 | |
a27cd06c KS |
514 | return NULL; |
515 | ||
516 | attr_found: | |
517 | c = strchr(tmpattr->value, '\n'); | |
518 | if (c != NULL) | |
519 | c[0] = '\0'; | |
520 | ||
521 | dbg("found attribute '%s'", tmpattr->path); | |
522 | return tmpattr; | |
523 | } | |
524 | ||
525 | static int compare_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, struct sysfs_pair *pair) | |
526 | { | |
527 | struct sysfs_attribute *tmpattr; | |
d5f91372 KS |
528 | int i; |
529 | int len; | |
a27cd06c KS |
530 | |
531 | if ((pair == NULL) || (pair->file[0] == '\0') || (pair->value == '\0')) | |
532 | return -ENODEV; | |
533 | ||
534 | tmpattr = find_sysfs_attribute(class_dev, sysfs_device, pair->file); | |
535 | if (tmpattr == NULL) | |
536 | return -ENODEV; | |
537 | ||
d5f91372 KS |
538 | /* strip trailing whitespace of value, if not asked to match for it */ |
539 | if (! isspace(pair->value[strlen(pair->value)-1])) { | |
540 | i = len = strlen(tmpattr->value); | |
541 | while (i > 0 && isspace(tmpattr->value[i-1])) | |
542 | i--; | |
543 | if (i < len) { | |
544 | tmpattr->value[i] = '\0'; | |
545 | dbg("remove %i trailing whitespace chars from '%s'", | |
546 | len - i, tmpattr->value); | |
547 | } | |
548 | } | |
549 | ||
a8b01705 GKH |
550 | dbg("compare attribute '%s' value '%s' with '%s'", |
551 | pair->file, tmpattr->value, pair->value); | |
552 | if (strcmp_pattern(pair->value, tmpattr->value) != 0) | |
553 | return -ENODEV; | |
554 | ||
555 | dbg("found matching attribute '%s' with value '%s'", | |
556 | pair->file, pair->value); | |
557 | return 0; | |
558 | } | |
559 | ||
ac28b86d | 560 | static int match_sysfs_pairs(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device) |
a8b01705 GKH |
561 | { |
562 | struct sysfs_pair *pair; | |
a8b01705 | 563 | int i; |
137af0cc | 564 | |
ac28b86d KS |
565 | for (i = 0; i < MAX_SYSFS_PAIRS; ++i) { |
566 | pair = &dev->sysfs_pair[i]; | |
567 | if ((pair->file[0] == '\0') || (pair->value[0] == '\0')) | |
568 | break; | |
569 | if (compare_sysfs_attribute(class_dev, sysfs_device, pair) != 0) { | |
570 | dbg("sysfs attribute doesn't match"); | |
571 | return -ENODEV; | |
ca1cc0fe | 572 | } |
ca1cc0fe | 573 | } |
ac28b86d KS |
574 | |
575 | return 0; | |
ca1cc0fe GKH |
576 | } |
577 | ||
ac28b86d | 578 | static int match_id(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device) |
ca1cc0fe | 579 | { |
ca1cc0fe | 580 | char path[SYSFS_PATH_MAX]; |
ca1cc0fe GKH |
581 | char *temp = NULL; |
582 | ||
1f7148c7 | 583 | /* we have to have a sysfs device for ID to work */ |
ca1cc0fe GKH |
584 | if (!sysfs_device) |
585 | return -ENODEV; | |
586 | ||
ac28b86d KS |
587 | strfieldcpy(path, sysfs_device->path); |
588 | temp = strrchr(path, '/'); | |
3a8c51a7 | 589 | temp++; |
ac28b86d | 590 | dbg("search '%s' in '%s', path='%s'", dev->id, temp, path); |
3a8c51a7 | 591 | if (strcmp_pattern(dev->id, temp) != 0) |
ac28b86d | 592 | return -ENODEV; |
5a42932b PM |
593 | else |
594 | return 0; | |
ca1cc0fe GKH |
595 | } |
596 | ||
ac28b86d | 597 | static int match_place(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device) |
8c51bbfe | 598 | { |
8c51bbfe GKH |
599 | char path[SYSFS_PATH_MAX]; |
600 | int found; | |
601 | char *temp = NULL; | |
602 | ||
1f7148c7 | 603 | /* we have to have a sysfs device for PLACE to work */ |
8c51bbfe GKH |
604 | if (!sysfs_device) |
605 | return -ENODEV; | |
606 | ||
ac28b86d KS |
607 | found = 0; |
608 | strfieldcpy(path, sysfs_device->path); | |
609 | temp = strrchr(path, '/'); | |
610 | dbg("search '%s' in '%s', path='%s'", dev->place, temp, path); | |
611 | if (strstr(temp, dev->place) != NULL) { | |
612 | found = 1; | |
613 | } else { | |
614 | *temp = 0x00; | |
8c51bbfe | 615 | temp = strrchr(path, '/'); |
19feb351 | 616 | dbg("search '%s' in '%s', path='%s'", dev->place, temp, path); |
ac28b86d | 617 | if (strstr(temp, dev->place) != NULL) |
8c51bbfe | 618 | found = 1; |
8c51bbfe | 619 | } |
ac28b86d KS |
620 | if (!found) { |
621 | dbg("place doesn't match"); | |
622 | return -ENODEV; | |
120d45d0 | 623 | } |
120d45d0 | 624 | |
ac28b86d | 625 | return 0; |
09e52d51 KS |
626 | } |
627 | ||
dac056aa | 628 | static struct sysfs_device *get_sysfs_device(struct sysfs_class_device *class_dev) |
185a35a4 | 629 | { |
dac056aa GKH |
630 | struct sysfs_device *sysfs_device; |
631 | struct sysfs_class_device *class_dev_parent; | |
616a7078 | 632 | struct timespec tspec; |
dac056aa | 633 | int loop; |
07562d6e GKH |
634 | |
635 | /* Figure out where the device symlink is at. For char devices this will | |
636 | * always be in the class_dev->path. But for block devices, it's different. | |
637 | * The main block device will have the device symlink in it's path, but | |
638 | * all partitions have the symlink in its parent directory. | |
639 | * But we need to watch out for block devices that do not have parents, yet | |
640 | * look like a partition (fd0, loop0, etc.) They all do not have a device | |
641 | * symlink yet. We do sit and spin on waiting for them right now, we should | |
642 | * possibly have a whitelist for these devices here... | |
dac056aa | 643 | */ |
616a7078 AM |
644 | class_dev_parent = sysfs_get_classdev_parent(class_dev); |
645 | if (class_dev_parent) | |
646 | dbg("Really a partition"); | |
1edbb8d3 | 647 | |
616a7078 AM |
648 | tspec.tv_sec = 0; |
649 | tspec.tv_nsec = 10000000; /* sleep 10 millisec */ | |
650 | loop = 10; | |
dac056aa | 651 | while (loop--) { |
961e4784 GKH |
652 | if (udev_sleep) |
653 | nanosleep(&tspec, NULL); | |
616a7078 AM |
654 | if (class_dev_parent) |
655 | sysfs_device = sysfs_get_classdev_device(class_dev_parent); | |
656 | else | |
657 | sysfs_device = sysfs_get_classdev_device(class_dev); | |
07562d6e | 658 | |
dac056aa | 659 | if (sysfs_device != NULL) |
616a7078 | 660 | goto device_found; |
7bd22a78 | 661 | } |
54988802 | 662 | dbg("timed out waiting for device symlink, continuing on anyway..."); |
616a7078 AM |
663 | |
664 | device_found: | |
665 | /* We have another issue with just the wait above - the sysfs part of | |
666 | * the kernel may not be quick enough to have created the link to the | |
667 | * device under the "bus" subsystem. Due to this, the sysfs_device->bus | |
668 | * will not contain the actual bus name :( | |
669 | * | |
670 | * Libsysfs now provides a new API sysfs_get_device_bus(), so use it | |
671 | * if needed | |
672 | */ | |
673 | if (sysfs_device) { | |
616a7078 AM |
674 | if (sysfs_device->bus[0] != '\0') |
675 | goto bus_found; | |
267f534d | 676 | |
616a7078 AM |
677 | loop = 10; |
678 | tspec.tv_nsec = 10000000; | |
679 | while (loop--) { | |
961e4784 GKH |
680 | if (udev_sleep) |
681 | nanosleep(&tspec, NULL); | |
616a7078 AM |
682 | sysfs_get_device_bus(sysfs_device); |
683 | ||
684 | if (sysfs_device->bus[0] != '\0') | |
685 | goto bus_found; | |
686 | } | |
54988802 | 687 | dbg("timed out waiting to find the device bus, continuing on anyway"); |
616a7078 AM |
688 | goto exit; |
689 | bus_found: | |
54988802 | 690 | dbg("device %s is registered with bus '%s'", |
616a7078 AM |
691 | sysfs_device->name, sysfs_device->bus); |
692 | } | |
dac056aa GKH |
693 | exit: |
694 | return sysfs_device; | |
695 | } | |
696 | ||
724257d9 | 697 | static int match_rule(struct config_device *dev, struct sysfs_class_device *class_dev, struct udevice *udev, struct sysfs_device *sysfs_device) |
dac056aa | 698 | { |
724257d9 | 699 | while (1) { |
ac28b86d KS |
700 | /* check for matching bus value */ |
701 | if (dev->bus[0] != '\0') { | |
702 | if (sysfs_device == NULL) { | |
703 | dbg("device has no bus"); | |
c5118442 | 704 | goto try_parent; |
ac28b86d KS |
705 | } |
706 | dbg("check for " FIELD_BUS " dev->bus='%s' sysfs_device->bus='%s'", dev->bus, sysfs_device->bus); | |
707 | if (strcmp_pattern(dev->bus, sysfs_device->bus) != 0) { | |
708 | dbg(FIELD_BUS " is not matching"); | |
c5118442 | 709 | goto try_parent; |
ac28b86d KS |
710 | } else { |
711 | dbg(FIELD_BUS " matches"); | |
712 | } | |
713 | } | |
120d45d0 | 714 | |
ac28b86d KS |
715 | /* check for matching kernel name*/ |
716 | if (dev->kernel[0] != '\0') { | |
717 | dbg("check for " FIELD_KERNEL " dev->kernel='%s' class_dev->name='%s'", dev->kernel, class_dev->name); | |
718 | if (strcmp_pattern(dev->kernel, class_dev->name) != 0) { | |
719 | dbg(FIELD_KERNEL " is not matching"); | |
c5118442 | 720 | goto try_parent; |
ac28b86d KS |
721 | } else { |
722 | dbg(FIELD_KERNEL " matches"); | |
723 | } | |
724 | } | |
ca1cc0fe | 725 | |
ac28b86d KS |
726 | /* check for matching bus id */ |
727 | if (dev->id[0] != '\0') { | |
728 | dbg("check " FIELD_ID); | |
729 | if (match_id(dev, class_dev, sysfs_device) != 0) { | |
730 | dbg(FIELD_ID " is not matching"); | |
c5118442 | 731 | goto try_parent; |
ac28b86d KS |
732 | } else { |
733 | dbg(FIELD_ID " matches"); | |
734 | } | |
735 | } | |
ca1cc0fe | 736 | |
ac28b86d KS |
737 | /* check for matching place of device */ |
738 | if (dev->place[0] != '\0') { | |
739 | dbg("check " FIELD_PLACE); | |
740 | if (match_place(dev, class_dev, sysfs_device) != 0) { | |
741 | dbg(FIELD_PLACE " is not matching"); | |
c5118442 | 742 | goto try_parent; |
ac28b86d KS |
743 | } else { |
744 | dbg(FIELD_PLACE " matches"); | |
745 | } | |
746 | } | |
8c51bbfe | 747 | |
ac28b86d KS |
748 | /* check for matching sysfs pairs */ |
749 | if (dev->sysfs_pair[0].file[0] != '\0') { | |
750 | dbg("check " FIELD_SYSFS " pairs"); | |
751 | if (match_sysfs_pairs(dev, class_dev, sysfs_device) != 0) { | |
752 | dbg(FIELD_SYSFS " is not matching"); | |
c5118442 | 753 | goto try_parent; |
ac28b86d KS |
754 | } else { |
755 | dbg(FIELD_SYSFS " matches"); | |
756 | } | |
757 | } | |
758 | ||
759 | /* execute external program */ | |
760 | if (dev->program[0] != '\0') { | |
761 | dbg("check " FIELD_PROGRAM); | |
831f800d KS |
762 | apply_format(udev, dev->program, sizeof(dev->program), |
763 | class_dev, sysfs_device); | |
ac28b86d KS |
764 | if (execute_program(dev->program, udev->program_result, NAME_SIZE) != 0) { |
765 | dbg(FIELD_PROGRAM " returned nozero"); | |
c5118442 | 766 | goto try_parent; |
ac28b86d KS |
767 | } else { |
768 | dbg(FIELD_PROGRAM " returned successful"); | |
769 | } | |
770 | } | |
771 | ||
772 | /* check for matching result of external program */ | |
773 | if (dev->result[0] != '\0') { | |
774 | dbg("check for " FIELD_RESULT | |
775 | " dev->result='%s', udev->program_result='%s'", | |
776 | dev->result, udev->program_result); | |
777 | if (strcmp_pattern(dev->result, udev->program_result) != 0) { | |
778 | dbg(FIELD_RESULT " is not matching"); | |
c5118442 | 779 | goto try_parent; |
ac28b86d KS |
780 | } else { |
781 | dbg(FIELD_RESULT " matches"); | |
782 | } | |
783 | } | |
784 | ||
724257d9 GKH |
785 | /* Yeah, we matched! */ |
786 | return 0; | |
787 | ||
c5118442 KS |
788 | try_parent: |
789 | dbg("try parent sysfs device"); | |
724257d9 GKH |
790 | sysfs_device = sysfs_get_device_parent(sysfs_device); |
791 | if (sysfs_device == NULL) | |
792 | return -ENODEV; | |
793 | dbg("sysfs_device->path='%s'", sysfs_device->path); | |
794 | dbg("sysfs_device->bus_id='%s'", sysfs_device->bus_id); | |
795 | dbg("sysfs_device->bus='%s'", sysfs_device->bus); | |
796 | } | |
797 | ||
798 | } | |
799 | ||
800 | int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *udev) | |
801 | { | |
802 | struct sysfs_device *sysfs_device = NULL; | |
803 | struct config_device *dev; | |
804 | struct perm_device *perm; | |
805 | char *pos; | |
806 | ||
807 | udev->mode = 0; | |
808 | ||
809 | /* find the sysfs_device associated with this class device */ | |
810 | sysfs_device = get_sysfs_device(class_dev); | |
811 | if (sysfs_device) { | |
812 | dbg("sysfs_device->path='%s'", sysfs_device->path); | |
813 | dbg("sysfs_device->bus_id='%s'", sysfs_device->bus_id); | |
814 | dbg("sysfs_device->bus='%s'", sysfs_device->bus); | |
815 | strfieldcpy(udev->bus_id, sysfs_device->bus_id); | |
816 | wait_for_device_to_initialize(sysfs_device); | |
724257d9 | 817 | } |
1b941027 | 818 | dbg("class_dev->name = '%s'", class_dev->name); |
724257d9 GKH |
819 | |
820 | strfieldcpy(udev->kernel_name, class_dev->name); | |
1b941027 GKH |
821 | fix_kernel_name(udev); |
822 | dbg("udev->kernel_name = '%s'", udev->kernel_name); | |
724257d9 GKH |
823 | |
824 | /* get kernel number */ | |
825 | pos = class_dev->name + strlen(class_dev->name); | |
826 | while (isdigit(*(pos-1))) | |
827 | pos--; | |
828 | strfieldcpy(udev->kernel_number, pos); | |
829 | dbg("kernel_number='%s'", udev->kernel_number); | |
830 | ||
831 | /* look for a matching rule to apply */ | |
832 | list_for_each_entry(dev, &config_device_list, node) { | |
833 | dbg("process rule"); | |
724257d9 | 834 | if (match_rule(dev, class_dev, udev, sysfs_device) == 0) { |
97ed02ee | 835 | if (dev->name[0] == '\0' && dev->symlink[0] == '\0') { |
c5118442 | 836 | info("configured rule in '%s' at line %i applied, '%s' is ignored", |
bd5f8e7c | 837 | dev->config_file, dev->config_line, udev->kernel_name); |
c5118442 KS |
838 | return -1; |
839 | } | |
840 | ||
97ed02ee | 841 | if (dev->symlink[0] != '\0') { |
842 | char temp[NAME_MAX]; | |
843 | ||
844 | info("configured rule in '%s' at line %i applied, added symlink '%s'", | |
bd5f8e7c | 845 | dev->config_file, dev->config_line, dev->symlink); |
97ed02ee | 846 | /* do not clobber dev */ |
847 | strfieldcpy(temp, dev->symlink); | |
848 | apply_format(udev, temp, sizeof(temp), | |
849 | class_dev, sysfs_device); | |
850 | strfieldcat(udev->symlink, temp); | |
851 | strfieldcat(udev->symlink, " "); | |
852 | } | |
853 | ||
854 | if (dev->name[0] != '\0') { | |
855 | info("configured rule in '%s' at line %i applied, '%s' becomes '%s'", | |
bd5f8e7c | 856 | dev->config_file, dev->config_line, udev->kernel_name, dev->name); |
97ed02ee | 857 | strfieldcpy(udev->name, dev->name); |
858 | goto found; | |
859 | } | |
724257d9 | 860 | } |
ac28b86d | 861 | } |
120d45d0 | 862 | |
ac28b86d | 863 | /* no rule was found so we use the kernel name */ |
7a4877bf | 864 | strfieldcpy(udev->name, udev->kernel_name); |
09e52d51 | 865 | goto done; |
c2405f50 | 866 | |
09e52d51 | 867 | found: |
3d150dfb | 868 | /* substitute placeholder */ |
831f800d KS |
869 | apply_format(udev, udev->name, sizeof(udev->name), |
870 | class_dev, sysfs_device); | |
50e5de03 | 871 | udev->partitions = dev->partitions; |
09e52d51 | 872 | done: |
61219c75 GKH |
873 | perm = find_perm(udev->name); |
874 | if (perm) { | |
875 | udev->mode = perm->mode; | |
876 | strfieldcpy(udev->owner, perm->owner); | |
877 | strfieldcpy(udev->group, perm->group); | |
878 | } else { | |
879 | /* no matching perms found :( */ | |
765cbd97 | 880 | udev->mode = get_default_mode(); |
c472e3c8 KS |
881 | strfieldcpy(udev->owner, get_default_owner()); |
882 | strfieldcpy(udev->group, get_default_group()); | |
615e05f8 | 883 | } |
61219c75 GKH |
884 | dbg("name, '%s' is going to have owner='%s', group='%s', mode = %#o", |
885 | udev->name, udev->owner, udev->group, udev->mode); | |
7bd22a78 | 886 | |
120d45d0 | 887 | return 0; |
185a35a4 GKH |
888 | } |
889 | ||
2232cac8 GKH |
890 | int namedev_init(void) |
891 | { | |
892 | int retval; | |
28d6536a | 893 | |
e8baccca | 894 | retval = namedev_init_rules(); |
2232cac8 GKH |
895 | if (retval) |
896 | return retval; | |
897 | ||
898 | retval = namedev_init_permissions(); | |
899 | if (retval) | |
900 | return retval; | |
901 | ||
19feb351 | 902 | dump_config_dev_list(); |
61219c75 | 903 | dump_perm_dev_list(); |
2232cac8 GKH |
904 | return retval; |
905 | } |