]> git.ipfire.org Git - thirdparty/systemd.git/blob - namedev.c
[PATCH] udev - simple debug tweak
[thirdparty/systemd.git] / namedev.c
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>
32 #include <sys/wait.h>
33 #include <sys/stat.h>
34
35 #include "list.h"
36 #include "udev.h"
37 #include "udev_version.h"
38 #include "namedev.h"
39 #include "libsysfs/libsysfs.h"
40 #include "klibc_fixups.h"
41
42 LIST_HEAD(config_device_list);
43 LIST_HEAD(perm_device_list);
44
45 /* compare string with pattern (supports * ? [0-9] [!A-Z]) */
46 static int strcmp_pattern(const char *p, const char *s)
47 {
48 if (*s == '\0') {
49 while (*p == '*')
50 p++;
51 return (*p != '\0');
52 }
53 switch (*p) {
54 case '[':
55 {
56 int not = 0;
57 p++;
58 if (*p == '!') {
59 not = 1;
60 p++;
61 }
62 while (*p && (*p != ']')) {
63 int match = 0;
64 if (p[1] == '-') {
65 if ((*s >= *p) && (*s <= p[2]))
66 match = 1;
67 p += 3;
68 } else {
69 match = (*p == *s);
70 p++;
71 }
72 if (match ^ not) {
73 while (*p && (*p != ']'))
74 p++;
75 return strcmp_pattern(p+1, s+1);
76 }
77 }
78 }
79 break;
80 case '*':
81 if (strcmp_pattern(p, s+1))
82 return strcmp_pattern(p+1, s);
83 return 0;
84 case '\0':
85 if (*s == '\0') {
86 return 0;
87 }
88 break;
89 default:
90 if ((*p == *s) || (*p == '?'))
91 return strcmp_pattern(p+1, s+1);
92 break;
93 }
94 return 1;
95 }
96
97 #define copy_var(a, b, var) \
98 if (b->var) \
99 a->var = b->var;
100
101 #define copy_string(a, b, var) \
102 if (strlen(b->var)) \
103 strcpy(a->var, b->var);
104
105 int add_perm_dev(struct perm_device *new_dev)
106 {
107 struct perm_device *dev;
108 struct perm_device *tmp_dev;
109
110 /* update the values if we already have the device */
111 list_for_each_entry(dev, &perm_device_list, node) {
112 if (strcmp_pattern(new_dev->name, dev->name))
113 continue;
114 copy_var(dev, new_dev, mode);
115 copy_string(dev, new_dev, owner);
116 copy_string(dev, new_dev, group);
117 return 0;
118 }
119
120 /* not found, add new structure to the perm list */
121 tmp_dev = malloc(sizeof(*tmp_dev));
122 if (!tmp_dev)
123 return -ENOMEM;
124 memcpy(tmp_dev, new_dev, sizeof(*tmp_dev));
125 list_add_tail(&tmp_dev->node, &perm_device_list);
126 //dump_perm_dev(tmp_dev);
127 return 0;
128 }
129
130 static struct perm_device *find_perm(char *name)
131 {
132 struct perm_device *perm;
133
134 list_for_each_entry(perm, &perm_device_list, node) {
135 if (strcmp_pattern(perm->name, name))
136 continue;
137 return perm;
138 }
139 return NULL;
140 }
141
142 static mode_t get_default_mode(struct sysfs_class_device *class_dev)
143 {
144 mode_t mode = 0600; /* default to owner rw only */
145
146 if (strlen(default_mode_str) != 0) {
147 mode = strtol(default_mode_str, NULL, 8);
148 }
149 return mode;
150 }
151
152 static void apply_format(struct udevice *udev, unsigned char *string)
153 {
154 char name[NAME_SIZE];
155 char temp[NAME_SIZE];
156 char *tail;
157 char *pos;
158 char *pos2;
159 char *pos3;
160 int num;
161
162 while (1) {
163 num = 0;
164 pos = strchr(string, '%');
165
166 if (pos) {
167 *pos = '\0';
168 tail = pos+1;
169 if (isdigit(tail[0])) {
170 num = (int) strtoul(&pos[1], &tail, 10);
171 if (tail == NULL) {
172 dbg("format parsing error '%s'", pos+1);
173 break;
174 }
175 }
176 strfieldcpy(name, tail+1);
177
178 switch (tail[0]) {
179 case 'b':
180 if (strlen(udev->bus_id) == 0)
181 break;
182 strcat(pos, udev->bus_id);
183 dbg("substitute bus_id '%s'", udev->bus_id);
184 break;
185 case 'k':
186 if (strlen(udev->kernel_name) == 0)
187 break;
188 strcat(pos, udev->kernel_name);
189 dbg("substitute kernel name '%s'", udev->kernel_name);
190 break;
191 case 'n':
192 if (strlen(udev->kernel_number) == 0)
193 break;
194 strcat(pos, udev->kernel_number);
195 dbg("substitute kernel number '%s'", udev->kernel_number);
196 break;
197 case 'D':
198 if (strlen(udev->kernel_number) == 0) {
199 strcat(pos, "disc");
200 dbg("substitute devfs disc");
201 break;
202 }
203 strcat(pos, "part");
204 strcat(pos, udev->kernel_number);
205 dbg("substitute devfs part '%s'", udev->kernel_number);
206 break;
207 case 'm':
208 sprintf(pos, "%u", udev->minor);
209 dbg("substitute minor number '%u'", udev->minor);
210 break;
211 case 'M':
212 sprintf(pos, "%u", udev->major);
213 dbg("substitute major number '%u'", udev->major);
214 break;
215 case 'c':
216 if (strlen(udev->program_result) == 0)
217 break;
218 if (num) {
219 /* get part of return string */
220 strncpy(temp, udev->program_result, sizeof(temp));
221 pos2 = temp;
222 while (num) {
223 num--;
224 pos3 = strsep(&pos2, " ");
225 if (pos3 == NULL) {
226 dbg("requested part of result string not found");
227 break;
228 }
229 }
230 if (pos3) {
231 strcat(pos, pos3);
232 dbg("substitute part of result string '%s'", pos3);
233 }
234 } else {
235 strcat(pos, udev->program_result);
236 dbg("substitute result string '%s'", udev->program_result);
237 }
238 break;
239 default:
240 dbg("unknown substitution type '%%%c'", pos[1]);
241 break;
242 }
243 strcat(string, name);
244 } else
245 break;
246 }
247 }
248
249 static struct bus_file {
250 char *bus;
251 char *file;
252 } bus_files[] = {
253 { .bus = "scsi", .file = "vendor" },
254 { .bus = "usb", .file = "idVendor" },
255 { .bus = "usb-serial", .file = "detach_state" },
256 { .bus = "ide", .file = "detach_state" },
257 { .bus = "pci", .file = "vendor" },
258 {}
259 };
260
261 #define SECONDS_TO_WAIT_FOR_FILE 10
262 static void wait_for_device_to_initialize(struct sysfs_device *sysfs_device)
263 {
264 /* sleep until we see the file for this specific bus type show up this
265 * is needed because we can easily out-run the kernel in looking for
266 * these files before the paticular subsystem has created them in the
267 * sysfs tree properly.
268 *
269 * And people thought that the /sbin/hotplug event system was going to
270 * be slow, poo on you for arguing that before even testing it...
271 */
272 struct bus_file *b = &bus_files[0];
273 struct sysfs_attribute *tmpattr;
274 int loop;
275
276 while (1) {
277 if (b->bus == NULL)
278 break;
279 if (strcmp(sysfs_device->bus, b->bus) == 0) {
280 tmpattr = NULL;
281 loop = SECONDS_TO_WAIT_FOR_FILE;
282 while (loop--) {
283 dbg("looking for file '%s' on bus '%s'", b->file, b->bus);
284 tmpattr = sysfs_get_device_attr(sysfs_device, b->file);
285 if (tmpattr) {
286 /* found it! */
287 goto exit;
288 }
289 /* sleep to give the kernel a chance to create the file */
290 sleep(1);
291 }
292 dbg("Timed out waiting for '%s' file, continuing on anyway...", b->file);
293 goto exit;
294 }
295 b++;
296 }
297 dbg("Did not find bus type '%s' on list of bus_id_files, contact greg@kroah.com", sysfs_device->bus);
298 exit:
299 return; /* here to prevent compiler warning... */
300 }
301
302 static int execute_program(char *path, char *value, int len)
303 {
304 int retval;
305 int res;
306 int status;
307 int fds[2];
308 pid_t pid;
309 int value_set = 0;
310 char buffer[256];
311 char *pos;
312 char *args[CALLOUT_MAXARG];
313 int i;
314
315 dbg("executing '%s'", path);
316 retval = pipe(fds);
317 if (retval != 0) {
318 dbg("pipe failed");
319 return -1;
320 }
321 pid = fork();
322 if (pid == -1) {
323 dbg("fork failed");
324 return -1;
325 }
326
327 if (pid == 0) {
328 /* child */
329 close(STDOUT_FILENO);
330 dup(fds[1]); /* dup write side of pipe to STDOUT */
331 if (strchr(path, ' ')) {
332 /* exec with arguments */
333 pos = path;
334 for (i=0; i < CALLOUT_MAXARG-1; i++) {
335 args[i] = strsep(&pos, " ");
336 if (args[i] == NULL)
337 break;
338 }
339 if (args[i]) {
340 dbg("too many args - %d", i);
341 args[i] = NULL;
342 }
343 retval = execve(args[0], args, main_envp);
344 } else {
345 retval = execve(path, main_argv, main_envp);
346 }
347 if (retval != 0) {
348 dbg("child execve failed");
349 exit(1);
350 }
351 return -1; /* avoid compiler warning */
352 } else {
353 /* parent reads from fds[0] */
354 close(fds[1]);
355 retval = 0;
356 while (1) {
357 res = read(fds[0], buffer, sizeof(buffer) - 1);
358 if (res <= 0)
359 break;
360 buffer[res] = '\0';
361 if (res > len) {
362 dbg("result len %d too short", len);
363 retval = -1;
364 }
365 if (value_set) {
366 dbg("result value already set");
367 retval = -1;
368 } else {
369 value_set = 1;
370 strncpy(value, buffer, len);
371 pos = value + strlen(value)-1;
372 if (pos[0] == '\n')
373 pos[0] = '\0';
374 dbg("result is '%s'", value);
375 }
376 }
377 close(fds[0]);
378 res = wait(&status);
379 if (res < 0) {
380 dbg("wait failed result %d", res);
381 retval = -1;
382 }
383
384 if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) {
385 dbg("exec program status 0x%x", status);
386 retval = -1;
387 }
388 }
389 return retval;
390 }
391
392 static int compare_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, struct sysfs_pair *pair)
393 {
394 struct sysfs_attribute *tmpattr = NULL;
395 char *c;
396
397 if ((pair == NULL) || (pair->file[0] == '\0') || (pair->value == '\0'))
398 return -ENODEV;
399
400 dbg("look for device attribute '%s'", pair->file);
401 /* try to find the attribute in the class device directory */
402 tmpattr = sysfs_get_classdev_attr(class_dev, pair->file);
403 if (tmpattr)
404 goto label_found;
405
406 /* look in the class device directory if present */
407 if (sysfs_device) {
408 tmpattr = sysfs_get_device_attr(sysfs_device, pair->file);
409 if (tmpattr)
410 goto label_found;
411 }
412 return -ENODEV;
413
414 label_found:
415 c = tmpattr->value + strlen(tmpattr->value)-1;
416 if (*c == '\n')
417 *c = 0x00;
418 dbg("compare attribute '%s' value '%s' with '%s'",
419 pair->file, tmpattr->value, pair->value);
420 if (strcmp_pattern(pair->value, tmpattr->value) != 0)
421 return -ENODEV;
422
423 dbg("found matching attribute '%s' with value '%s'",
424 pair->file, pair->value);
425 return 0;
426 }
427
428 static int match_sysfs_pairs(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device)
429 {
430 struct sysfs_pair *pair;
431 int i;
432
433 for (i = 0; i < MAX_SYSFS_PAIRS; ++i) {
434 pair = &dev->sysfs_pair[i];
435 if ((pair->file[0] == '\0') || (pair->value[0] == '\0'))
436 break;
437 if (compare_sysfs_attribute(class_dev, sysfs_device, pair) != 0) {
438 dbg("sysfs attribute doesn't match");
439 return -ENODEV;
440 }
441 }
442
443 return 0;
444 }
445
446 static int match_id(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device)
447 {
448 char path[SYSFS_PATH_MAX];
449 int found;
450 char *temp = NULL;
451
452 /* we have to have a sysfs device for ID to work */
453 if (!sysfs_device)
454 return -ENODEV;
455
456 found = 0;
457 strfieldcpy(path, sysfs_device->path);
458 temp = strrchr(path, '/');
459 dbg("search '%s' in '%s', path='%s'", dev->id, temp, path);
460 if (strstr(temp, dev->id) != NULL) {
461 found = 1;
462 } else {
463 *temp = 0x00;
464 temp = strrchr(path, '/');
465 dbg("search '%s' in '%s', path='%s'", dev->id, temp, path);
466 if (strstr(temp, dev->id) != NULL)
467 found = 1;
468 }
469 if (!found) {
470 dbg("id doesn't match");
471 return -ENODEV;
472 }
473
474 return 0;
475 }
476
477 static int match_place(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device)
478 {
479 char path[SYSFS_PATH_MAX];
480 int found;
481 char *temp = NULL;
482
483 /* we have to have a sysfs device for PLACE to work */
484 if (!sysfs_device)
485 return -ENODEV;
486
487 found = 0;
488 strfieldcpy(path, sysfs_device->path);
489 temp = strrchr(path, '/');
490 dbg("search '%s' in '%s', path='%s'", dev->place, temp, path);
491 if (strstr(temp, dev->place) != NULL) {
492 found = 1;
493 } else {
494 *temp = 0x00;
495 temp = strrchr(path, '/');
496 dbg("search '%s' in '%s', path='%s'", dev->place, temp, path);
497 if (strstr(temp, dev->place) != NULL)
498 found = 1;
499 }
500 if (!found) {
501 dbg("place doesn't match");
502 return -ENODEV;
503 }
504
505 return 0;
506 }
507
508 static struct sysfs_device *get_sysfs_device(struct sysfs_class_device *class_dev)
509 {
510 struct sysfs_device *sysfs_device;
511 struct sysfs_class_device *class_dev_parent;
512 int loop;
513 char filename[SYSFS_PATH_MAX + 6];
514 int retval;
515 char *temp;
516 int partition = 0;
517
518 /* Figure out where the device symlink is at. For char devices this will
519 * always be in the class_dev->path. But for block devices, it's different.
520 * The main block device will have the device symlink in it's path, but
521 * all partitions have the symlink in its parent directory.
522 * But we need to watch out for block devices that do not have parents, yet
523 * look like a partition (fd0, loop0, etc.) They all do not have a device
524 * symlink yet. We do sit and spin on waiting for them right now, we should
525 * possibly have a whitelist for these devices here...
526 */
527 strcpy(filename, class_dev->path);
528 dbg("filename = %s", filename);
529 if (strcmp(class_dev->classname, SYSFS_BLOCK_NAME) == 0) {
530 if (isdigit(class_dev->path[strlen(class_dev->path)-1])) {
531 temp = strrchr(filename, '/');
532 if (temp) {
533 char *temp2 = strrchr(filename, '/');
534 partition = 1;
535 *temp = 0x00;
536 dbg("temp2 = %s", temp2);
537 if (temp2 && (strcmp(temp2, "/block") == 0)) {
538 /* oops, we have no parent block device, so go back to original directory */
539 strcpy(filename, class_dev->path);
540 partition = 0;
541 }
542 }
543 }
544 }
545 strcat(filename, "/device");
546
547 loop = 2;
548 while (loop--) {
549 struct stat buf;
550 dbg("looking for '%s'", filename);
551 retval = stat(filename, &buf);
552 if (!retval)
553 break;
554 /* sleep to give the kernel a chance to create the device file */
555 sleep(1);
556 }
557
558 loop = 1; /* FIXME put a real value in here for when everything is fixed... */
559 while (loop--) {
560 /* find the sysfs_device for this class device */
561 /* Wouldn't it really be nice if libsysfs could do this for us? */
562 sysfs_device = sysfs_get_classdev_device(class_dev);
563 if (sysfs_device != NULL)
564 goto exit;
565
566 /* if it's a partition, we need to get the parent device */
567 if (partition) {
568 /* FIXME HACK HACK HACK HACK
569 * for some reason partitions need this extra sleep here, in order
570 * to wait for the device properly. Once the libsysfs code is
571 * fixed properly, this sleep should go away, and we can just loop above.
572 */
573 sleep(1);
574 dbg("really is a partition");
575 class_dev_parent = sysfs_get_classdev_parent(class_dev);
576 if (class_dev_parent == NULL) {
577 dbg("sysfs_get_classdev_parent for class device '%s' failed", class_dev->name);
578 } else {
579 dbg("class_dev_parent->name='%s'", class_dev_parent->name);
580 sysfs_device = sysfs_get_classdev_device(class_dev_parent);
581 if (sysfs_device != NULL)
582 goto exit;
583 }
584 }
585 /* sleep to give the kernel a chance to create the link */
586 /* FIXME remove comment...
587 sleep(1); */
588 }
589 dbg("Timed out waiting for device symlink, continuing on anyway...");
590 exit:
591 return sysfs_device;
592 }
593
594 int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *udev)
595 {
596 struct sysfs_device *sysfs_device = NULL;
597 struct config_device *dev;
598 struct perm_device *perm;
599 char *pos;
600
601 udev->mode = 0;
602
603 /* find the sysfs_device associated with this class device */
604 sysfs_device = get_sysfs_device(class_dev);
605 if (sysfs_device) {
606 dbg("sysfs_device->path='%s'", sysfs_device->path);
607 dbg("sysfs_device->bus_id='%s'", sysfs_device->bus_id);
608 dbg("sysfs_device->bus='%s'", sysfs_device->bus);
609 strfieldcpy(udev->bus_id, sysfs_device->bus_id);
610 wait_for_device_to_initialize(sysfs_device);
611 } else {
612 dbg("class_dev->name = '%s'", class_dev->name);
613 }
614
615 strfieldcpy(udev->kernel_name, class_dev->name);
616
617 /* get kernel number */
618 pos = class_dev->name + strlen(class_dev->name);
619 while (isdigit(*(pos-1)))
620 pos--;
621 strfieldcpy(udev->kernel_number, pos);
622 dbg("kernel_number='%s'", udev->kernel_number);
623
624 /* look for a matching rule to apply */
625 list_for_each_entry(dev, &config_device_list, node) {
626 dbg("process rule");
627
628 /* check for matching bus value */
629 if (dev->bus[0] != '\0') {
630 if (sysfs_device == NULL) {
631 dbg("device has no bus");
632 continue;
633 }
634 dbg("check for " FIELD_BUS " dev->bus='%s' sysfs_device->bus='%s'", dev->bus, sysfs_device->bus);
635 if (strcmp_pattern(dev->bus, sysfs_device->bus) != 0) {
636 dbg(FIELD_BUS " is not matching");
637 continue;
638 } else {
639 dbg(FIELD_BUS " matches");
640 }
641 }
642
643 /* check for matching kernel name*/
644 if (dev->kernel[0] != '\0') {
645 dbg("check for " FIELD_KERNEL " dev->kernel='%s' class_dev->name='%s'", dev->kernel, class_dev->name);
646 if (strcmp_pattern(dev->kernel, class_dev->name) != 0) {
647 dbg(FIELD_KERNEL " is not matching");
648 continue;
649 } else {
650 dbg(FIELD_KERNEL " matches");
651 }
652 }
653
654 /* check for matching bus id */
655 if (dev->id[0] != '\0') {
656 dbg("check " FIELD_ID);
657 if (match_id(dev, class_dev, sysfs_device) != 0) {
658 dbg(FIELD_ID " is not matching");
659 continue;
660 } else {
661 dbg(FIELD_ID " matches");
662 }
663 }
664
665 /* check for matching place of device */
666 if (dev->place[0] != '\0') {
667 dbg("check " FIELD_PLACE);
668 if (match_place(dev, class_dev, sysfs_device) != 0) {
669 dbg(FIELD_PLACE " is not matching");
670 continue;
671 } else {
672 dbg(FIELD_PLACE " matches");
673 }
674 }
675
676 /* check for matching sysfs pairs */
677 if (dev->sysfs_pair[0].file[0] != '\0') {
678 dbg("check " FIELD_SYSFS " pairs");
679 if (match_sysfs_pairs(dev, class_dev, sysfs_device) != 0) {
680 dbg(FIELD_SYSFS " is not matching");
681 continue;
682 } else {
683 dbg(FIELD_SYSFS " matches");
684 }
685 }
686
687 /* execute external program */
688 if (dev->program[0] != '\0') {
689 dbg("check " FIELD_PROGRAM);
690 apply_format(udev, dev->program);
691 if (execute_program(dev->program, udev->program_result, NAME_SIZE) != 0) {
692 dbg(FIELD_PROGRAM " returned nozero");
693 continue;
694 } else {
695 dbg(FIELD_PROGRAM " returned successful");
696 }
697 }
698
699 /* check for matching result of external program */
700 if (dev->result[0] != '\0') {
701 dbg("check for " FIELD_RESULT
702 " dev->result='%s', udev->program_result='%s'",
703 dev->result, udev->program_result);
704 if (strcmp_pattern(dev->result, udev->program_result) != 0) {
705 dbg(FIELD_RESULT " is not matching");
706 continue;
707 } else {
708 dbg(FIELD_RESULT " matches");
709 }
710 }
711
712 /* check if we are instructed to ignore this device */
713 if (dev->name[0] == '\0') {
714 dbg("instructed to ignore this device");
715 return -1;
716 }
717
718 /* Yup, this rule belongs to us! */
719 dbg("found matching rule, '%s' becomes '%s'", dev->kernel, dev->name);
720 strfieldcpy(udev->name, dev->name);
721 strfieldcpy(udev->symlink, dev->symlink);
722 goto found;
723 }
724
725 /* no rule was found so we use the kernel name */
726 strfieldcpy(udev->name, class_dev->name);
727 goto done;
728
729 found:
730 /* substitute placeholder */
731 apply_format(udev, udev->name);
732 apply_format(udev, udev->symlink);
733
734 done:
735 perm = find_perm(udev->name);
736 if (perm) {
737 udev->mode = perm->mode;
738 strfieldcpy(udev->owner, perm->owner);
739 strfieldcpy(udev->group, perm->group);
740 } else {
741 /* no matching perms found :( */
742 udev->mode = get_default_mode(class_dev);
743 udev->owner[0] = 0x00;
744 udev->group[0] = 0x00;
745 }
746 dbg("name, '%s' is going to have owner='%s', group='%s', mode = %#o",
747 udev->name, udev->owner, udev->group, udev->mode);
748
749 return 0;
750 }
751
752 int namedev_init(void)
753 {
754 int retval;
755
756 retval = namedev_init_rules();
757 if (retval)
758 return retval;
759
760 retval = namedev_init_permissions();
761 if (retval)
762 return retval;
763
764 dump_config_dev_list();
765 dump_perm_dev_list();
766 return retval;
767 }