6 * Copyright (C) 2003 Greg Kroah-Hartman <greg@kroah.com>
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.
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.
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.
24 /* define this to enable parsing debugging */
25 /* #define DEBUG_PARSER */
39 #include "udev_version.h"
41 #include "libsysfs/libsysfs.h"
43 #define TYPE_LABEL "LABEL"
44 #define TYPE_NUMBER "NUMBER"
45 #define TYPE_TOPOLOGY "TOPOLOGY"
46 #define TYPE_REPLACE "REPLACE"
47 #define TYPE_CALLOUT "CALLOUT"
48 #define CALLOUT_MAXARG 8
50 static LIST_HEAD(config_device_list);
52 static void dump_dev(struct config_device *dev)
56 dbg_parse("KERNEL name='%s' ,"
57 "owner='%s', group='%s', mode=%#o",
58 dev->name, dev->owner, dev->group, dev->mode);
61 dbg_parse("LABEL name='%s', bus='%s', sysfs_file='%s', sysfs_value='%s', "
62 "owner='%s', group='%s', mode=%#o",
63 dev->name, dev->bus, dev->sysfs_file, dev->sysfs_value,
64 dev->owner, dev->group, dev->mode);
67 dbg_parse("NUMBER name='%s', bus='%s', id='%s', "
68 "owner='%s', group='%s', mode=%#o",
69 dev->name, dev->bus, dev->id,
70 dev->owner, dev->group, dev->mode);
73 dbg_parse("TOPOLOGY name='%s', bus='%s', place='%s', "
74 "owner='%s', group='%s', mode=%#o",
75 dev->name, dev->bus, dev->place,
76 dev->owner, dev->group, dev->mode);
79 dbg_parse("REPLACE name=%s, kernel_name=%s, "
80 "owner='%s', group='%s', mode=%#o",
81 dev->name, dev->kernel_name,
82 dev->owner, dev->group, dev->mode);
85 dbg_parse("CALLOUT name='%s', program='%s', bus='%s', id='%s', "
86 "owner='%s', group='%s', mode=%#o",
87 dev->name, dev->exec_program, dev->bus, dev->id,
88 dev->owner, dev->group, dev->mode);
91 dbg_parse("unknown type of method");
95 #define copy_var(a, b, var) \
99 #define copy_string(a, b, var) \
100 if (strlen(b->var)) \
101 strcpy(a->var, b->var);
103 static int add_dev(struct config_device *new_dev)
105 struct list_head *tmp;
106 struct config_device *tmp_dev;
108 /* update the values if we already have the device */
109 list_for_each(tmp, &config_device_list) {
110 struct config_device *dev = list_entry(tmp, struct config_device, node);
111 int len = strlen(new_dev->name);
112 if (new_dev->name[len-1] == '*') {
114 if (strncmp(dev->name, new_dev->name, len))
117 if (strcmp(dev->name, new_dev->name))
120 /* the same, copy the new info into this structure */
121 copy_var(dev, new_dev, type);
122 copy_var(dev, new_dev, mode);
123 copy_string(dev, new_dev, bus);
124 copy_string(dev, new_dev, sysfs_file);
125 copy_string(dev, new_dev, sysfs_value);
126 copy_string(dev, new_dev, id);
127 copy_string(dev, new_dev, place);
128 copy_string(dev, new_dev, kernel_name);
129 copy_string(dev, new_dev, owner);
130 copy_string(dev, new_dev, group);
134 /* not found, add new structure to the device list */
135 tmp_dev = malloc(sizeof(*tmp_dev));
138 memcpy(tmp_dev, new_dev, sizeof(*tmp_dev));
139 list_add(&tmp_dev->node, &config_device_list);
144 static void dump_dev_list(void)
146 struct list_head *tmp;
148 list_for_each(tmp, &config_device_list) {
149 struct config_device *dev = list_entry(tmp, struct config_device, node);
154 static int get_pair(char **orig_string, char **left, char **right)
157 char *string = *orig_string;
162 /* eat any whitespace */
163 while (isspace(*string))
166 /* split based on '=' */
167 temp = strsep(&string, "=");
172 /* take the right side and strip off the '"' */
173 while (isspace(*string))
180 temp = strsep(&string, "\"");
181 if (!string || *temp == '\0')
184 *orig_string = string;
189 static int get_value(const char *left, char **orig_string, char **ret_string)
194 retval = get_pair(orig_string, &left_string, ret_string);
197 if (strcasecmp(left_string, left) != 0)
202 static int namedev_init_config(void)
211 struct config_device dev;
213 dbg("opening %s to read as config", udev_config_filename);
214 fd = fopen(udev_config_filename, "r");
216 dbg("can't open %s", udev_config_filename);
220 /* loop through the whole file */
224 temp = fgets(line, sizeof(line), fd);
229 dbg_parse("read %s", temp);
231 /* eat the whitespace at the beginning of the line */
232 while (isspace(*temp))
239 /* see if this is a comment */
240 if (*temp == COMMENT_CHARACTER)
243 memset(&dev, 0x00, sizeof(struct config_device));
246 temp2 = strsep(&temp, ",");
247 if (strcasecmp(temp2, TYPE_LABEL) == 0) {
252 retval = get_value("BUS", &temp, &temp3);
255 strfieldcpy(dev.bus, temp3);
258 temp2 = strsep(&temp, ",");
259 retval = get_pair(&temp, &temp2, &temp3);
262 strfieldcpy(dev.sysfs_file, temp2);
263 strfieldcpy(dev.sysfs_value, temp3);
265 /* NAME="new_name" */
266 temp2 = strsep(&temp, ",");
267 retval = get_value("NAME", &temp, &temp3);
270 strfieldcpy(dev.name, temp3);
272 dbg_parse("LABEL name='%s', bus='%s', "
273 "sysfs_file='%s', sysfs_value='%s'",
274 dev.name, dev.bus, dev.sysfs_file,
278 if (strcasecmp(temp2, TYPE_NUMBER) == 0) {
283 retval = get_value("BUS", &temp, &temp3);
286 strfieldcpy(dev.bus, temp3);
289 temp2 = strsep(&temp, ",");
290 retval = get_value("ID", &temp, &temp3);
293 strfieldcpy(dev.id, temp3);
295 /* NAME="new_name" */
296 temp2 = strsep(&temp, ",");
297 retval = get_value("NAME", &temp, &temp3);
300 strfieldcpy(dev.name, temp3);
302 dbg_parse("NUMBER name='%s', bus='%s', id='%s'",
303 dev.name, dev.bus, dev.id);
306 if (strcasecmp(temp2, TYPE_TOPOLOGY) == 0) {
311 retval = get_value("BUS", &temp, &temp3);
314 strfieldcpy(dev.bus, temp3);
317 temp2 = strsep(&temp, ",");
318 retval = get_value("PLACE", &temp, &temp3);
321 strfieldcpy(dev.place, temp3);
323 /* NAME="new_name" */
324 temp2 = strsep(&temp, ",");
325 retval = get_value("NAME", &temp, &temp3);
328 strfieldcpy(dev.name, temp3);
330 dbg_parse("TOPOLOGY name='%s', bus='%s', place='%s'",
331 dev.name, dev.bus, dev.place);
334 if (strcasecmp(temp2, TYPE_REPLACE) == 0) {
338 /* KERNEL="kernel_name" */
339 retval = get_value("KERNEL", &temp, &temp3);
342 strfieldcpy(dev.kernel_name, temp3);
344 /* NAME="new_name" */
345 temp2 = strsep(&temp, ",");
346 retval = get_value("NAME", &temp, &temp3);
349 strfieldcpy(dev.name, temp3);
350 dbg_parse("REPLACE name='%s', kernel_name='%s'",
351 dev.name, dev.kernel_name);
353 if (strcasecmp(temp2, TYPE_CALLOUT) == 0) {
358 retval = get_value("BUS", &temp, &temp3);
361 strfieldcpy(dev.bus, temp3);
363 /* PROGRAM="executable" */
364 temp2 = strsep(&temp, ",");
365 retval = get_value("PROGRAM", &temp, &temp3);
368 strfieldcpy(dev.exec_program, temp3);
371 temp2 = strsep(&temp, ",");
372 retval = get_value("ID", &temp, &temp3);
375 strfieldcpy(dev.id, temp3);
377 /* NAME="new_name" */
378 temp2 = strsep(&temp, ",");
379 retval = get_value("NAME", &temp, &temp3);
382 strfieldcpy(dev.name, temp3);
383 dbg_parse("CALLOUT name='%s', program='%s'",
384 dev.name, dev.exec_program);
387 retval = add_dev(&dev);
389 dbg("add_dev returned with error %d", retval);
393 dbg_parse("%s:%d:%Zd: error parsing '%s'", udev_config_filename,
394 lineno, temp - line, temp);
401 static int namedev_init_permissions(void)
408 struct config_device dev;
410 dbg("opening %s to read as permissions config", udev_config_permission_filename);
411 fd = fopen(udev_config_permission_filename, "r");
413 dbg("can't open %s", udev_config_permission_filename);
417 /* loop through the whole file */
420 temp = fgets(line, sizeof(line), fd);
424 dbg_parse("read %s", temp);
426 /* eat the whitespace at the beginning of the line */
427 while (isspace(*temp))
434 /* see if this is a comment */
435 if (*temp == COMMENT_CHARACTER)
438 memset(&dev, 0x00, sizeof(dev));
441 temp2 = strsep(&temp, ":");
442 strncpy(dev.name, temp2, sizeof(dev.name));
444 temp2 = strsep(&temp, ":");
445 strncpy(dev.owner, temp2, sizeof(dev.owner));
447 temp2 = strsep(&temp, ":");
448 strncpy(dev.group, temp2, sizeof(dev.owner));
450 dev.mode = strtol(temp, NULL, 8);
452 dbg_parse("name='%s', owner='%s', group='%s', mode=%#o",
453 dev.name, dev.owner, dev.group,
455 retval = add_dev(&dev);
457 dbg("add_dev returned with error %d", retval);
467 static mode_t get_default_mode(struct sysfs_class_device *class_dev)
469 /* just default everyone to rw for the world! */
474 static int exec_callout(struct config_device *dev, char *value, int len)
484 char *args[CALLOUT_MAXARG];
487 dbg("callout to '%s'", dev->exec_program);
501 close(STDOUT_FILENO);
502 dup(fds[1]); /* dup write side of pipe to STDOUT */
503 if (strchr(dev->exec_program, ' ')) {
504 /* callout with arguments */
505 arg = dev->exec_program;
506 for (i=0; i < CALLOUT_MAXARG-1; i++) {
507 args[i] = strsep(&arg, " ");
512 dbg("to many args - %d", i);
515 retval = execve(args[0], args, main_envp);
517 retval = execve(dev->exec_program, main_argv, main_envp);
520 dbg("child execve failed");
523 return -1; /* avoid compiler warning */
525 /* parent reads from fds[0] */
529 res = read(fds[0], buffer, sizeof(buffer) - 1);
534 dbg("callout len %d too short\n", len);
538 dbg("callout value already set");
542 strncpy(value, buffer, len);
545 dbg("callout returned '%s'", value);
549 dbg("wait failed result %d", res);
554 if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) {
555 dbg("callout program status 0x%x", status);
563 static int do_callout(struct sysfs_class_device *class_dev, struct udevice *udev)
565 struct config_device *dev;
566 struct list_head *tmp;
569 list_for_each(tmp, &config_device_list) {
570 dev = list_entry(tmp, struct config_device, node);
571 if (dev->type != CALLOUT)
574 if (exec_callout(dev, value, sizeof(value)))
576 if (strncmp(value, dev->id, sizeof(value)) != 0)
578 strfieldcpy(udev->name, dev->name);
579 if (dev->mode != 0) {
580 udev->mode = dev->mode;
581 strfieldcpy(udev->owner, dev->owner);
582 strfieldcpy(udev->group, dev->group);
584 dbg_parse("callout returned matching value '%s', '%s' becomes '%s'"
585 " - owner='%s', group='%s', mode =%#o",
586 dev->id, class_dev->name, udev->name,
587 dev->owner, dev->group, dev->mode);
593 static int do_label(struct sysfs_class_device *class_dev, struct udevice *udev, struct sysfs_device *sysfs_device)
595 struct sysfs_attribute *tmpattr = NULL;
596 struct config_device *dev;
597 struct list_head *tmp;
599 list_for_each(tmp, &config_device_list) {
600 dev = list_entry(tmp, struct config_device, node);
601 if (dev->type != LABEL)
604 dbg_parse("look for device attribute '%s'", dev->sysfs_file);
605 /* try to find the attribute in the class device directory */
606 tmpattr = sysfs_get_classdev_attr(class_dev, dev->sysfs_file);
610 /* look in the class device directory if present */
612 tmpattr = sysfs_get_device_attr(sysfs_device, dev->sysfs_file);
620 tmpattr->value[strlen(tmpattr->value)-1] = 0x00;
621 dbg_parse("compare attribute '%s' value '%s' with '%s'",
622 dev->sysfs_file, tmpattr->value, dev->sysfs_value);
623 if (strcmp(dev->sysfs_value, tmpattr->value) != 0)
626 strfieldcpy(udev->name, dev->name);
627 if (dev->mode != 0) {
628 udev->mode = dev->mode;
629 strfieldcpy(udev->owner, dev->owner);
630 strfieldcpy(udev->group, dev->group);
632 dbg_parse("found matching attribute '%s', '%s' becomes '%s' "
633 "- owner='%s', group='%s', mode=%#o",
634 dev->sysfs_file, class_dev->name, udev->name,
635 dev->owner, dev->group, dev->mode);
642 static int do_number(struct sysfs_class_device *class_dev, struct udevice *udev, struct sysfs_device *sysfs_device)
644 struct config_device *dev;
645 struct list_head *tmp;
646 char path[SYSFS_PATH_MAX];
650 /* we have to have a sysfs device for NUMBER to work */
654 list_for_each(tmp, &config_device_list) {
655 dev = list_entry(tmp, struct config_device, node);
656 if (dev->type != NUMBER)
660 strfieldcpy(path, sysfs_device->path);
661 temp = strrchr(path, '/');
662 dbg_parse("search '%s' in '%s', path='%s'", dev->id, temp, path);
663 if (strstr(temp, dev->id) != NULL) {
667 temp = strrchr(path, '/');
668 dbg_parse("search '%s' in '%s', path='%s'", dev->id, temp, path);
669 if (strstr(temp, dev->id) != NULL)
674 strfieldcpy(udev->name, dev->name);
675 if (dev->mode != 0) {
676 udev->mode = dev->mode;
677 strfieldcpy(udev->owner, dev->owner);
678 strfieldcpy(udev->group, dev->group);
680 dbg_parse("found matching id '%s', '%s' becomes '%s'"
681 " - owner='%s', group ='%s', mode=%#o",
682 dev->id, class_dev->name, udev->name,
683 dev->owner, dev->group, dev->mode);
690 static int do_topology(struct sysfs_class_device *class_dev, struct udevice *udev, struct sysfs_device *sysfs_device)
692 struct config_device *dev;
693 struct list_head *tmp;
694 char path[SYSFS_PATH_MAX];
698 /* we have to have a sysfs device for TOPOLOGY to work */
702 list_for_each(tmp, &config_device_list) {
703 dev = list_entry(tmp, struct config_device, node);
704 if (dev->type != TOPOLOGY)
708 strfieldcpy(path, sysfs_device->path);
709 temp = strrchr(path, '/');
710 dbg_parse("search '%s' in '%s', path='%s'", dev->place, temp, path);
711 if (strstr(temp, dev->place) != NULL) {
715 temp = strrchr(path, '/');
716 dbg_parse("search '%s' in '%s', path='%s'", dev->place, temp, path);
717 if (strstr(temp, dev->place) != NULL)
723 strfieldcpy(udev->name, dev->name);
724 if (dev->mode != 0) {
725 udev->mode = dev->mode;
726 strfieldcpy(udev->owner, dev->owner);
727 strfieldcpy(udev->group, dev->group);
729 dbg_parse("found matching place '%s', '%s' becomes '%s'"
730 " - owner='%s', group ='%s', mode=%#o",
731 dev->place, class_dev->name, udev->name,
732 dev->owner, dev->group, dev->mode);
738 static int do_replace(struct sysfs_class_device *class_dev, struct udevice *udev)
740 struct config_device *dev;
741 struct list_head *tmp;
743 list_for_each(tmp, &config_device_list) {
744 dev = list_entry(tmp, struct config_device, node);
745 if (dev->type != REPLACE)
748 dbg_parse("compare name '%s' with '%s'",
749 dev->kernel_name, dev->name);
750 if (strcmp(dev->kernel_name, class_dev->name) != 0)
753 strfieldcpy(udev->name, dev->name);
754 if (dev->mode != 0) {
755 udev->mode = dev->mode;
756 strfieldcpy(udev->owner, dev->owner);
757 strfieldcpy(udev->group, dev->group);
759 dbg_parse("found name, '%s' becomes '%s' - owner='%s', group='%s', mode = %#o",
760 dev->kernel_name, udev->name,
761 dev->owner, dev->group, dev->mode);
768 static void do_kernelname(struct sysfs_class_device *class_dev, struct udevice *udev)
770 struct config_device *dev;
771 struct list_head *tmp;
774 strfieldcpy(udev->name, class_dev->name);
775 list_for_each(tmp, &config_device_list) {
776 dev = list_entry(tmp, struct config_device, node);
777 len = strlen(dev->name);
778 if (dev->name[len-1] == '*') {
780 if (strncmp(dev->name, class_dev->name, len))
783 if (strcmp(dev->name, class_dev->name))
786 if (dev->mode != 0) {
787 dbg_parse("found permissions for '%s'", class_dev->name);
788 udev->mode = dev->mode;
789 strfieldcpy(udev->owner, dev->owner);
790 strfieldcpy(udev->group, dev->group);
795 static int get_attr(struct sysfs_class_device *class_dev, struct udevice *udev)
797 struct sysfs_device *sysfs_device = NULL;
798 struct sysfs_class_device *class_dev_parent = NULL;
804 /* find the sysfs_device for this class device */
805 /* Wouldn't it really be nice if libsysfs could do this for us? */
806 if (class_dev->sysdevice) {
807 sysfs_device = class_dev->sysdevice;
809 /* bah, let's go backwards up a level to see if the device is there,
810 * as block partitions don't point to the physical device. Need to fix that
811 * up in the kernel...
813 if (strstr(class_dev->path, "block")) {
814 dbg_parse("looking at block device...");
815 if (isdigit(class_dev->path[strlen(class_dev->path)-1])) {
816 char path[SYSFS_PATH_MAX];
818 dbg_parse("really is a partition...");
819 strfieldcpy(path, class_dev->path);
820 temp = strrchr(path, '/');
822 dbg_parse("looking for a class device at '%s'", path);
823 class_dev_parent = sysfs_open_class_device(path);
824 if (class_dev_parent == NULL) {
825 dbg("sysfs_open_class_device at '%s' failed", path);
827 dbg_parse("class_dev_parent->name=%s", class_dev_parent->name);
828 if (class_dev_parent->sysdevice)
829 sysfs_device = class_dev_parent->sysdevice;
836 dbg_parse("sysfs_device->path='%s'", sysfs_device->path);
837 dbg_parse("sysfs_device->bus_id='%s'", sysfs_device->bus_id);
839 dbg_parse("class_dev->name = '%s'", class_dev->name);
842 /* rules are looked at in priority order */
843 retval = do_callout(class_dev, udev);
847 retval = do_label(class_dev, udev, sysfs_device);
851 retval = do_number(class_dev, udev, sysfs_device);
855 retval = do_topology(class_dev, udev, sysfs_device);
859 retval = do_replace(class_dev, udev);
863 do_kernelname(class_dev, udev);
867 /* substitute placeholder in NAME */
869 char *pos = strchr(udev->name, '%');
871 char name[NAME_SIZE];
873 strfieldcpy(name, pos+2);
879 strcat(udev->name, sysfs_device->bus_id);
880 dbg("bus_id inserted: %s",
881 sysfs_device->bus_id);
884 dig = class_dev->name + strlen(class_dev->name);
885 while (isdigit(*(dig-1)))
887 strcat(udev->name, dig);
888 dbg("substitute kernel number '%s'", dig);
891 sprintf(pos, "%u", udev->minor);
892 dbg("substitute minor number '%u'", udev->minor);
895 sprintf(pos, "%u", udev->major);
896 dbg("substitute major number '%u'", udev->major);
899 dbg("unknown substitution type '%%%c'", pos[1]);
902 strcat(udev->name, name);
908 /* mode was never set above */
910 udev->mode = get_default_mode(class_dev);
911 udev->owner[0] = 0x00;
912 udev->group[0] = 0x00;
915 if (class_dev_parent)
916 sysfs_close_class_device(class_dev_parent);
921 int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *dev)
925 retval = get_attr(class_dev, dev);
927 dbg("get_attr failed");
932 int namedev_init(void)
936 retval = namedev_init_config();
940 retval = namedev_init_permissions();