chiark / gitweb /
[PATCH] udev - safer string handling - part two
[elogind.git] / namedev.c
index fdc6252bf66fa46583ca97b4b9fab0389b12bb12..f688507dc39c985b389e3b1c68cf2efafce110f3 100644 (file)
--- a/namedev.c
+++ b/namedev.c
 #include <ctype.h>
 #include <unistd.h>
 #include <errno.h>
+#include <time.h>
 #include <sys/wait.h>
 #include <sys/stat.h>
 
+#include "libsysfs/sysfs/libsysfs.h"
 #include "list.h"
 #include "udev.h"
 #include "udev_version.h"
+#include "logging.h"
 #include "namedev.h"
-#include "libsysfs/libsysfs.h"
 #include "klibc_fixups.h"
 
+static struct sysfs_attribute *find_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, char *attr);
+
 LIST_HEAD(config_device_list);
 LIST_HEAD(perm_device_list);
 
 /* compare string with pattern (supports * ? [0-9] [!A-Z]) */
 static int strcmp_pattern(const char *p, const char *s)
 {
-       if (*s == '\0') {
-               while (*p == '*')
+       if (s[0] == '\0') {
+               while (p[0] == '*')
                        p++;
-               return (*p != '\0');
+               return (p[0] != '\0');
        }
-       switch (*p) {
+       switch (p[0]) {
        case '[':
                {
                        int not = 0;
                        p++;
-                       if (*p == '!') {
+                       if (p[0] == '!') {
                                not = 1;
                                p++;
                        }
-                       while (*p && (*p != ']')) {
+                       while ((p[0] != '\0') && (p[0] != ']')) {
                                int match = 0;
                                if (p[1] == '-') {
-                                       if ((*s >= *p) && (*s <= p[2]))
+                                       if ((s[0] >= p[0]) && (s[0] <= p[2]))
                                                match = 1;
                                        p += 3;
                                } else {
-                                       match = (*p == *s);
+                                       match = (p[0] == s[0]);
                                        p++;
                                }
                                if (match ^ not) {
-                                       while (*p && (*p != ']'))
+                                       while ((p[0] != '\0') && (p[0] != ']'))
                                                p++;
-                                       return strcmp_pattern(p+1, s+1);
+                                       if (p[0] == ']')
+                                               return strcmp_pattern(p+1, s+1);
                                }
                        }
                }
@@ -82,12 +87,12 @@ static int strcmp_pattern(const char *p, const char *s)
                        return strcmp_pattern(p+1, s);
                return 0;
        case '\0':
-               if (*s == '\0') {
+               if (s[0] == '\0') {
                        return 0;
                }
                break;
        default:
-               if ((*p == *s) || (*p == '?'))
+               if ((p[0] == s[0]) || (p[0] == '?'))
                        return strcmp_pattern(p+1, s+1);
                break;
        }
@@ -109,7 +114,7 @@ int add_perm_dev(struct perm_device *new_dev)
 
        /* update the values if we already have the device */
        list_for_each_entry(dev, &perm_device_list, node) {
-               if (strcmp_pattern(new_dev->name, dev->name))
+               if (strcmp(new_dev->name, dev->name))
                        continue;
                copy_var(dev, new_dev, mode);
                copy_string(dev, new_dev, owner);
@@ -139,119 +144,194 @@ static struct perm_device *find_perm(char *name)
        return NULL;
 }
 
-static mode_t get_default_mode(struct sysfs_class_device *class_dev)
+static mode_t get_default_mode(void)
 {
        mode_t mode = 0600;     /* default to owner rw only */
 
-       if (strlen(default_mode_str) != 0) {
+       if (strlen(default_mode_str) != 0)
                mode = strtol(default_mode_str, NULL, 8);
-       }
+
        return mode;
 }
 
-static void apply_format(struct udevice *udev, unsigned char *string)
+static char *get_default_owner(void)
+{
+       if (strlen(default_owner_str) == 0)
+               strfieldcpy(default_owner_str, "root");
+
+       return default_owner_str;
+}
+
+static char *get_default_group(void)
+{
+       if (strlen(default_group_str) == 0)
+               strfieldcpy(default_group_str, "root");
+
+       return default_group_str;
+}
+
+/* extract possible {attr} and move str behind it */
+static char *get_format_attribute(char **str)
+{
+       char *pos;
+       char *attr = NULL;
+
+       if (*str[0] == '{') {
+               pos = strchr(*str, '}');
+               if (pos == NULL) {
+                       dbg("missing closing brace for format");
+                       return NULL;
+               }
+               pos[0] = '\0';
+               attr = *str+1;
+               *str = pos+1;
+               dbg("attribute='%s', str='%s'", attr, *str);
+       }
+       return attr;
+}
+
+/* extract possible format length and move str behind it*/
+static int get_format_len(char **str)
+{
+       int num;
+       char *tail;
+
+       if (isdigit(*str[0])) {
+               num = (int) strtoul(*str, &tail, 10);
+               if (tail != NULL) {
+                       *str = tail;
+                       dbg("format length=%i", num);
+                       return num;
+               } else {
+                       dbg("format parsing error '%s'", *str);
+               }
+       }
+       return -1;
+}
+
+static void apply_format(struct udevice *udev, char *string, size_t maxsize,
+                        struct sysfs_class_device *class_dev,
+                        struct sysfs_device *sysfs_device)
 {
-       char name[NAME_SIZE];
        char temp[NAME_SIZE];
+       char temp1[NAME_SIZE];
        char *tail;
        char *pos;
        char *pos2;
        char *pos3;
+       char *attr;
        int num;
+       int i;
+       char c;
+       struct sysfs_attribute *tmpattr;
 
-       while (1) {
-               num = 0;
-               pos = strchr(string, '%');
+       pos = string;
 
-               if (pos) {
-                       *pos = '\0';
+       while (1) {
+               pos = strchr(pos, '%');
+               if (pos != NULL) {
+                       pos[0] = '\0';
                        tail = pos+1;
-                       if (isdigit(tail[0])) {
-                               num = (int) strtoul(&pos[1], &tail, 10);
-                               if (tail == NULL) {
-                                       dbg("format parsing error '%s'", pos+1);
-                                       break;
-                               }
-                       }
-                       strfieldcpy(name, tail+1);
+                       num = get_format_len(&tail);
+                       c = tail[0];
+                       strfieldcpy(temp, tail+1);
+                       tail = temp;
+               } else {
+                       break;
+               }
+               dbg("format=%c, string='%s', tail='%s'",c , string, tail);
 
-                       switch (tail[0]) {
-                       case 'b':
-                               if (strlen(udev->bus_id) == 0)
-                                       break;
-                               strcat(pos, udev->bus_id);
-                               dbg("substitute bus_id '%s'", udev->bus_id);
-                               break;
-                       case 'k':
-                               if (strlen(udev->kernel_name) == 0)
-                                       break;
-                               strcat(pos, udev->kernel_name);
-                               dbg("substitute kernel name '%s'", udev->kernel_name);
+               attr = get_format_attribute(&tail);
+
+               switch (c) {
+               case 'b':
+                       if (strlen(udev->bus_id) == 0)
                                break;
-                       case 'n':
-                               if (strlen(udev->kernel_number) == 0)
-                                       break;
-                               strcat(pos, udev->kernel_number);
-                               dbg("substitute kernel number '%s'", udev->kernel_number);
+                       strnfieldcat(pos, udev->bus_id, maxsize);
+                       dbg("substitute bus_id '%s'", udev->bus_id);
+                       break;
+               case 'k':
+                       if (strlen(udev->kernel_name) == 0)
                                break;
-                       case 'D':
-                               if (strlen(udev->kernel_number) == 0) {
-                                       strcat(pos, "disc");
-                                       dbg("substitute devfs disc");
-                                       break;
-                               }
-                               strcat(pos, "part");
-                               strcat(pos, udev->kernel_number);
-                               dbg("substitute devfs part '%s'", udev->kernel_number);
+                       strnfieldcat(pos, udev->kernel_name, maxsize);
+                       dbg("substitute kernel name '%s'", udev->kernel_name);
+                       break;
+               case 'n':
+                       if (strlen(udev->kernel_number) == 0)
                                break;
-                       case 'm':
-                               sprintf(pos, "%u", udev->minor);
-                               dbg("substitute minor number '%u'", udev->minor);
+                       strnfieldcat(pos, udev->kernel_number, maxsize);
+                       dbg("substitute kernel number '%s'", udev->kernel_number);
                                break;
+               case 'm':
+                       sprintf(pos, "%u", udev->minor);
+                       dbg("substitute minor number '%u'", udev->minor);
+                       break;
                        case 'M':
-                               sprintf(pos, "%u", udev->major);
-                               dbg("substitute major number '%u'", udev->major);
+                       sprintf(pos, "%u", udev->major);
+                       dbg("substitute major number '%u'", udev->major);
+                       break;
+               case 'c':
+                       if (strlen(udev->program_result) == 0)
                                break;
-                       case 'c':
-                               if (strlen(udev->program_result) == 0)
-                                       break;
-                               if (num) {
-                                       /* get part of return string */
-                                       strncpy(temp, udev->program_result, sizeof(temp));
-                                       pos2 = temp;
-                                       while (num) {
-                                               num--;
-                                               pos3 = strsep(&pos2, " ");
-                                               if (pos3 == NULL) {
-                                                       dbg("requested part of result string not found");
-                                                       break;
-                                               }
+                       /* get part part of the result string */
+                       i = num; /* num syntax is deprecated and will be removed  */
+                       if (attr != NULL)
+                               i = atoi(attr);
+                       if (i > 0) {
+                               strfieldcpy(temp1, udev->program_result);
+                               pos2 = temp1;
+                               while (i) {
+                                       i--;
+                                       pos3 = strsep(&pos2, " ");
+                                       if (pos3 == NULL) {
+                                               dbg("requested part of result string not found");
+                                               break;
                                        }
-                                       if (pos3) {
-                                               strcat(pos, pos3);
-                                               dbg("substitute part of result string '%s'", pos3);
-                                       }
-                               } else {
-                                       strcat(pos, udev->program_result);
-                                       dbg("substitute result string '%s'", udev->program_result);
                                }
-                               break;
-                       default:
-                               dbg("unknown substitution type '%%%c'", pos[1]);
-                               break;
+                               if (pos3) {
+                                       strnfieldcat(pos, pos3, maxsize);
+                                       dbg("substitute part of result string '%s'", pos3);
+                               }
+                       } else {
+                               strnfieldcat(pos, udev->program_result, maxsize);
+                               dbg("substitute result string '%s'", udev->program_result);
                        }
-                       strcat(string, name);
-               } else
                        break;
+               case 's':
+                       if (attr != NULL) {
+                               tmpattr = find_sysfs_attribute(class_dev, sysfs_device, attr);
+                               if (tmpattr == NULL) {
+                                       dbg("sysfa attribute '%s' not found", attr);
+                                       break;
+                               }
+                               strnfieldcpy(pos, tmpattr->value, maxsize);
+                               dbg("substitute sysfs value '%s'", tmpattr->value);
+                       } else {
+                               dbg("missing attribute");
+                       }
+                       break;
+               case '%':
+                       strnfieldcat(pos, "%", maxsize);
+                       break;
+               default:
+                       dbg("unknown substitution type '%%%c'", c);
+                       break;
+               }
+               strnfieldcat(pos, tail, maxsize);
        }
 }
 
+/* 
+ * Note, we can have multiple files for different busses in here due
+ * to the mess that USB has for its device tree...
+ */
 static struct bus_file {
        char *bus;
        char *file;
 } bus_files[] = {
        { .bus = "scsi",        .file = "vendor" },
        { .bus = "usb",         .file = "idVendor" },
+       { .bus = "usb",         .file = "iInterface" },
        { .bus = "usb-serial",  .file = "detach_state" },
        { .bus = "ide",         .file = "detach_state" },
        { .bus = "pci",         .file = "vendor" },
@@ -271,34 +351,52 @@ static void wait_for_device_to_initialize(struct sysfs_device *sysfs_device)
         */
        struct bus_file *b = &bus_files[0];
        struct sysfs_attribute *tmpattr;
-       int loop;
+       int found = 0;
+       int loop = SECONDS_TO_WAIT_FOR_FILE;
 
        while (1) {
-               if (b->bus == NULL)
-                       break;
+               if (b->bus == NULL) {
+                       if (!found)
+                               break;
+                       /* sleep to give the kernel a chance to create the file */
+                       sleep(1);
+                       --loop;
+                       if (loop == 0)
+                               break;
+                       b = &bus_files[0];
+               }
                if (strcmp(sysfs_device->bus, b->bus) == 0) {
-                       tmpattr = NULL;
-                       loop = SECONDS_TO_WAIT_FOR_FILE;
-                       while (loop--) {
-                               dbg("looking for file '%s' on bus '%s'", b->file, b->bus);
-                               tmpattr = sysfs_get_device_attr(sysfs_device, b->file);
-                               if (tmpattr) {
-                                       /* found it! */
-                                       goto exit;
-                               }
-                               /* sleep to give the kernel a chance to create the file */
-                               sleep(1);
+                       found = 1;
+                       dbg("looking for file '%s' on bus '%s'", b->file, b->bus);
+                       tmpattr = sysfs_get_device_attr(sysfs_device, b->file);
+                       if (tmpattr) {
+                               /* found it! */
+                               goto exit;
                        }
-                       dbg("Timed out waiting for '%s' file, continuing on anyway...", b->file);
-                       goto exit;
+                       dbg("can't find '%s' file", b->file);
                }
-               b++;
+               ++b;
        }
-       dbg("Did not find bus type '%s' on list of bus_id_files, contact greg@kroah.com", sysfs_device->bus);
+       if (!found)
+               dbg("did not find bus type '%s' on list of bus_id_files, "
+                   "contact greg@kroah.com", sysfs_device->bus);
 exit:
        return; /* here to prevent compiler warning... */
 }
 
+static void fix_kernel_name(struct udevice *udev)
+{
+       char *temp = udev->kernel_name;
+
+       while (*temp != 0x00) {
+               /* Some block devices have a ! in their name, 
+                * we need to change that to / */
+               if (*temp == '!')
+                       *temp = '/';
+               ++temp;
+       }
+}
+
 static int execute_program(char *path, char *value, int len)
 {
        int retval;
@@ -309,7 +407,7 @@ static int execute_program(char *path, char *value, int len)
        int value_set = 0;
        char buffer[256];
        char *pos;
-       char *args[CALLOUT_MAXARG];
+       char *args[PROGRAM_MAXARG];
        int i;
 
        dbg("executing '%s'", path);
@@ -319,19 +417,15 @@ static int execute_program(char *path, char *value, int len)
                return -1;
        }
        pid = fork();
-       if (pid == -1) {
-               dbg("fork failed");
-               return -1;
-       }
-
-       if (pid == 0) {
+       switch(pid) {
+       case 0:
                /* child */
                close(STDOUT_FILENO);
                dup(fds[1]);    /* dup write side of pipe to STDOUT */
                if (strchr(path, ' ')) {
                        /* exec with arguments */
                        pos = path;
-                       for (i=0; i < CALLOUT_MAXARG-1; i++) {
+                       for (i=0; i < PROGRAM_MAXARG-1; i++) {
                                args[i] = strsep(&pos, " ");
                                if (args[i] == NULL)
                                        break;
@@ -340,16 +434,16 @@ static int execute_program(char *path, char *value, int len)
                                dbg("too many args - %d", i);
                                args[i] = NULL;
                        }
-                       retval = execve(args[0], args, main_envp);
+                       retval = execv(args[0], args);
                } else {
-                       retval = execve(path, main_argv, main_envp);
+                       retval = execv(path, main_argv);
                }
-               if (retval != 0) {
-                       dbg("child execve failed");
-                       exit(1);
-               }
-               return -1; /* avoid compiler warning */
-       } else {
+               dbg("child execve failed");
+               exit(1);
+       case -1:
+               dbg("fork failed");
+               return -1;
+       default:
                /* parent reads from fds[0] */
                close(fds[1]);
                retval = 0;
@@ -370,7 +464,7 @@ static int execute_program(char *path, char *value, int len)
                                strncpy(value, buffer, len);
                                pos = value + strlen(value)-1;
                                if (pos[0] == '\n')
-                               pos[0] = '\0';
+                                       pos[0] = '\0';
                                dbg("result is '%s'", value);
                        }
                }
@@ -389,32 +483,46 @@ static int execute_program(char *path, char *value, int len)
        return retval;
 }
 
-static int compare_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, struct sysfs_pair *pair)
+static struct sysfs_attribute *find_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, char *attr)
 {
        struct sysfs_attribute *tmpattr = NULL;
        char *c;
 
-       if ((pair == NULL) || (pair->file[0] == '\0') || (pair->value == '\0'))
-               return -ENODEV;
-
-       dbg("look for device attribute '%s'", pair->file);
+       dbg("look for device attribute '%s'", attr);
        /* try to find the attribute in the class device directory */
-       tmpattr = sysfs_get_classdev_attr(class_dev, pair->file);
+       tmpattr = sysfs_get_classdev_attr(class_dev, attr);
        if (tmpattr)
-               goto label_found;
+               goto attr_found;
 
        /* look in the class device directory if present */
        if (sysfs_device) {
-               tmpattr = sysfs_get_device_attr(sysfs_device, pair->file);
+               tmpattr = sysfs_get_device_attr(sysfs_device, attr);
                if (tmpattr)
-                       goto label_found;
+                       goto attr_found;
        }
-       return -ENODEV;
 
-label_found:
-       c = tmpattr->value + strlen(tmpattr->value)-1;
-       if (*c == '\n')
-               *c = 0x00;
+       return NULL;
+
+attr_found:
+       c = strchr(tmpattr->value, '\n');
+       if (c != NULL)
+               c[0] = '\0';
+
+       dbg("found attribute '%s'", tmpattr->path);
+       return tmpattr;
+}
+
+static int compare_sysfs_attribute(struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device, struct sysfs_pair *pair)
+{
+       struct sysfs_attribute *tmpattr;
+
+       if ((pair == NULL) || (pair->file[0] == '\0') || (pair->value == '\0'))
+               return -ENODEV;
+
+       tmpattr = find_sysfs_attribute(class_dev, sysfs_device, pair->file);
+       if (tmpattr == NULL)
+               return -ENODEV;
+
        dbg("compare attribute '%s' value '%s' with '%s'",
                  pair->file, tmpattr->value, pair->value);
        if (strcmp_pattern(pair->value, tmpattr->value) != 0)
@@ -446,32 +554,20 @@ static int match_sysfs_pairs(struct config_device *dev, struct sysfs_class_devic
 static int match_id(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device)
 {
        char path[SYSFS_PATH_MAX];
-       int found;
        char *temp = NULL;
 
        /* we have to have a sysfs device for ID to work */
        if (!sysfs_device)
                return -ENODEV;
 
-       found = 0;
        strfieldcpy(path, sysfs_device->path);
        temp = strrchr(path, '/');
+       temp++;
        dbg("search '%s' in '%s', path='%s'", dev->id, temp, path);
-       if (strstr(temp, dev->id) != NULL) {
-               found = 1;
-       } else {
-               *temp = 0x00;
-               temp = strrchr(path, '/');
-               dbg("search '%s' in '%s', path='%s'", dev->id, temp, path);
-               if (strstr(temp, dev->id) != NULL)
-                       found = 1;
-       }
-       if (!found) {
-               dbg("id doesn't match");
+       if (strcmp_pattern(dev->id, temp) != 0)
                return -ENODEV;
-       }
-
-       return 0;
+       else
+               return 0;
 }
 
 static int match_place(struct config_device *dev, struct sysfs_class_device *class_dev, struct sysfs_device *sysfs_device)
@@ -509,11 +605,8 @@ static struct sysfs_device *get_sysfs_device(struct sysfs_class_device *class_de
 {
        struct sysfs_device *sysfs_device;
        struct sysfs_class_device *class_dev_parent;
+       struct timespec tspec;
        int loop;
-       char filename[SYSFS_PATH_MAX + 6];
-       int retval;
-       char *temp;
-       int partition = 0;
 
        /* Figure out where the device symlink is at.  For char devices this will
         * always be in the class_dev->path.  But for block devices, it's different.
@@ -524,117 +617,72 @@ static struct sysfs_device *get_sysfs_device(struct sysfs_class_device *class_de
         * symlink yet.  We do sit and spin on waiting for them right now, we should
         * possibly have a whitelist for these devices here...
         */
-       strcpy(filename, class_dev->path);
-       dbg("filename = %s", filename);
-       if (strcmp(class_dev->classname, SYSFS_BLOCK_NAME) == 0) {
-               if (isdigit(class_dev->path[strlen(class_dev->path)-1])) {
-                       temp = strrchr(filename, '/');
-                       if (temp) {
-                               char *temp2 = strrchr(filename, '/');
-                               partition = 1;
-                               *temp = 0x00;
-                               dbg("temp2 = %s", temp2);
-                               if (temp2 && (strcmp(temp2, "/block") == 0)) {
-                                       /* oops, we have no parent block device, so go back to original directory */
-                                       strcpy(filename, class_dev->path);
-                                       partition = 0;
-                               }
-                       }
-               }
-       }
-       strcat(filename, "/device");
+       class_dev_parent = sysfs_get_classdev_parent(class_dev);
+       if (class_dev_parent) 
+               dbg("Really a partition");
 
-       loop = 2;
+       tspec.tv_sec = 0;
+       tspec.tv_nsec = 10000000;  /* sleep 10 millisec */
+       loop = 10;
        while (loop--) {
-               struct stat buf;
-               dbg("looking for '%s'", filename);
-               retval = stat(filename, &buf);
-               if (!retval)
-                       break;
-               /* sleep to give the kernel a chance to create the device file */
-               sleep(1);
-       }
+               if (udev_sleep)
+                       nanosleep(&tspec, NULL);
+               if (class_dev_parent)
+                       sysfs_device = sysfs_get_classdev_device(class_dev_parent);
+               else
+                       sysfs_device = sysfs_get_classdev_device(class_dev);
 
-       loop = 1;       /* FIXME put a real value in here for when everything is fixed... */
-       while (loop--) {
-               /* find the sysfs_device for this class device */
-               /* Wouldn't it really be nice if libsysfs could do this for us? */
-               sysfs_device = sysfs_get_classdev_device(class_dev);
                if (sysfs_device != NULL)
-                       goto exit;
-
-               /* if it's a partition, we need to get the parent device */
-               if (partition) {
-                       /* FIXME  HACK HACK HACK HACK
-                        * for some reason partitions need this extra sleep here, in order
-                        * to wait for the device properly.  Once the libsysfs code is
-                        * fixed properly, this sleep should go away, and we can just loop above.
-                        */
-                       sleep(1);
-                       dbg("really is a partition");
-                       class_dev_parent = sysfs_get_classdev_parent(class_dev);
-                       if (class_dev_parent == NULL) {
-                               dbg("sysfs_get_classdev_parent for class device '%s' failed", class_dev->name);
-                       } else {
-                               dbg("class_dev_parent->name='%s'", class_dev_parent->name);
-                               sysfs_device = sysfs_get_classdev_device(class_dev_parent);
-                               if (sysfs_device != NULL)
-                                       goto exit;
-                       }
+                       goto device_found;
+       }
+       dbg("timed out waiting for device symlink, continuing on anyway...");
+       
+device_found:
+        /* We have another issue with just the wait above - the sysfs part of
+        * the kernel may not be quick enough to have created the link to the
+        * device under the "bus" subsystem. Due to this, the sysfs_device->bus
+        * will not contain the actual bus name :(
+        *
+        * Libsysfs now provides a new API sysfs_get_device_bus(), so use it
+        * if needed
+        */
+        if (sysfs_device) {
+               if (sysfs_device->bus[0] != '\0')
+                       goto bus_found;
+
+               loop = 10;
+               tspec.tv_nsec = 10000000;
+               while (loop--) {
+                       if (udev_sleep)
+                               nanosleep(&tspec, NULL);
+                       sysfs_get_device_bus(sysfs_device);
+                       
+                       if (sysfs_device->bus[0] != '\0')
+                               goto bus_found;
                }
-               /* sleep to give the kernel a chance to create the link */
-               /* FIXME remove comment...
-               sleep(1); */
+               dbg("timed out waiting to find the device bus, continuing on anyway");
+               goto exit;
+bus_found:
+               dbg("device %s is registered with bus '%s'",
+                               sysfs_device->name, sysfs_device->bus);
        }
-       dbg("Timed out waiting for device symlink, continuing on anyway...");
 exit:
        return sysfs_device;
 }
 
-int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *udev)
+static int match_rule(struct config_device *dev, struct sysfs_class_device *class_dev, struct udevice *udev, struct sysfs_device *sysfs_device)
 {
-       struct sysfs_device *sysfs_device = NULL;
-       struct config_device *dev;
-       struct perm_device *perm;
-       char *pos;
-
-       udev->mode = 0;
-
-       /* find the sysfs_device associated with this class device */
-       sysfs_device = get_sysfs_device(class_dev);
-       if (sysfs_device) {
-               dbg("sysfs_device->path='%s'", sysfs_device->path);
-               dbg("sysfs_device->bus_id='%s'", sysfs_device->bus_id);
-               dbg("sysfs_device->bus='%s'", sysfs_device->bus);
-               strfieldcpy(udev->bus_id, sysfs_device->bus_id);
-               wait_for_device_to_initialize(sysfs_device);
-       } else {
-               dbg("class_dev->name = '%s'", class_dev->name);
-       }
-
-       strfieldcpy(udev->kernel_name, class_dev->name);
-
-       /* get kernel number */
-       pos = class_dev->name + strlen(class_dev->name);
-       while (isdigit(*(pos-1)))
-               pos--;
-       strfieldcpy(udev->kernel_number, pos);
-       dbg("kernel_number='%s'", udev->kernel_number);
-
-       /* look for a matching rule to apply */
-       list_for_each_entry(dev, &config_device_list, node) {
-               dbg("process rule");
-
+       while (1) {
                /* check for matching bus value */
                if (dev->bus[0] != '\0') {
                        if (sysfs_device == NULL) {
                                dbg("device has no bus");
-                               continue;
+                               goto try_parent;
                        }
                        dbg("check for " FIELD_BUS " dev->bus='%s' sysfs_device->bus='%s'", dev->bus, sysfs_device->bus);
                        if (strcmp_pattern(dev->bus, sysfs_device->bus) != 0) {
                                dbg(FIELD_BUS " is not matching");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_BUS " matches");
                        }
@@ -645,7 +693,7 @@ int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *ud
                        dbg("check for " FIELD_KERNEL " dev->kernel='%s' class_dev->name='%s'", dev->kernel, class_dev->name);
                        if (strcmp_pattern(dev->kernel, class_dev->name) != 0) {
                                dbg(FIELD_KERNEL " is not matching");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_KERNEL " matches");
                        }
@@ -656,7 +704,7 @@ int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *ud
                        dbg("check " FIELD_ID);
                        if (match_id(dev, class_dev, sysfs_device) != 0) {
                                dbg(FIELD_ID " is not matching");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_ID " matches");
                        }
@@ -667,7 +715,7 @@ int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *ud
                        dbg("check " FIELD_PLACE);
                        if (match_place(dev, class_dev, sysfs_device) != 0) {
                                dbg(FIELD_PLACE " is not matching");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_PLACE " matches");
                        }
@@ -678,7 +726,7 @@ int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *ud
                        dbg("check " FIELD_SYSFS " pairs");
                        if (match_sysfs_pairs(dev, class_dev, sysfs_device) != 0) {
                                dbg(FIELD_SYSFS " is not matching");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_SYSFS " matches");
                        }
@@ -687,10 +735,11 @@ int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *ud
                /* execute external program */
                if (dev->program[0] != '\0') {
                        dbg("check " FIELD_PROGRAM);
-                       apply_format(udev, dev->program);
+                       apply_format(udev, dev->program, sizeof(dev->program),
+                                    class_dev, sysfs_device);
                        if (execute_program(dev->program, udev->program_result, NAME_SIZE) != 0) {
                                dbg(FIELD_PROGRAM " returned nozero");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_PROGRAM " returned successful");
                        }
@@ -703,34 +752,87 @@ int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *ud
                            dev->result, udev->program_result);
                        if (strcmp_pattern(dev->result, udev->program_result) != 0) {
                                dbg(FIELD_RESULT " is not matching");
-                               continue;
+                               goto try_parent;
                        } else {
                                dbg(FIELD_RESULT " matches");
                        }
                }
 
-               /* check if we are instructed to ignore this device */
-               if (dev->name[0] == '\0') {
-                       dbg("instructed to ignore this device");
-                       return -1;
-               }
+               /* Yeah, we matched! */
+               return 0;
+
+try_parent:
+               dbg("try parent sysfs device");
+               sysfs_device = sysfs_get_device_parent(sysfs_device);
+               if (sysfs_device == NULL)
+                       return -ENODEV;
+               dbg("sysfs_device->path='%s'", sysfs_device->path);
+               dbg("sysfs_device->bus_id='%s'", sysfs_device->bus_id);
+               dbg("sysfs_device->bus='%s'", sysfs_device->bus);
+       }
+
+}
+
+int namedev_name_device(struct sysfs_class_device *class_dev, struct udevice *udev)
+{
+       struct sysfs_device *sysfs_device = NULL;
+       struct config_device *dev;
+       struct perm_device *perm;
+       char *pos;
+
+       udev->mode = 0;
 
-               /* Yup, this rule belongs to us! */
-               dbg("found matching rule, '%s' becomes '%s'", dev->kernel, dev->name);
-               strfieldcpy(udev->name, dev->name);
-               strfieldcpy(udev->symlink, dev->symlink);
-               goto found;
+       /* find the sysfs_device associated with this class device */
+       sysfs_device = get_sysfs_device(class_dev);
+       if (sysfs_device) {
+               dbg("sysfs_device->path='%s'", sysfs_device->path);
+               dbg("sysfs_device->bus_id='%s'", sysfs_device->bus_id);
+               dbg("sysfs_device->bus='%s'", sysfs_device->bus);
+               strfieldcpy(udev->bus_id, sysfs_device->bus_id);
+               wait_for_device_to_initialize(sysfs_device);
+       }
+       dbg("class_dev->name = '%s'", class_dev->name);
+
+       strfieldcpy(udev->kernel_name, class_dev->name);
+       fix_kernel_name(udev);
+       dbg("udev->kernel_name = '%s'", udev->kernel_name);
+
+       /* get kernel number */
+       pos = class_dev->name + strlen(class_dev->name);
+       while (isdigit(*(pos-1)))
+               pos--;
+       strfieldcpy(udev->kernel_number, pos);
+       dbg("kernel_number='%s'", udev->kernel_number);
+
+       /* look for a matching rule to apply */
+       list_for_each_entry(dev, &config_device_list, node) {
+               dbg("process rule");
+               if (match_rule(dev, class_dev, udev, sysfs_device) == 0) {
+                       if (dev->name[0] == '\0') {
+                               info("configured rule in '%s' at line %i applied, '%s' is ignored",
+                                    udev_rules_filename, dev->config_line, udev->kernel_name);
+                               return -1;
+                       }
+
+                       info("configured rule in '%s' at line %i applied, '%s' becomes '%s'",
+                            udev_rules_filename, dev->config_line, udev->kernel_name, dev->name);
+                       strfieldcpy(udev->name, dev->name);
+                       strfieldcpy(udev->symlink, dev->symlink);
+                       goto found;
+               }
        }
 
        /* no rule was found so we use the kernel name */
-       strfieldcpy(udev->name, class_dev->name);
+       strfieldcpy(udev->name, udev->kernel_name);
        goto done;
 
 found:
        /* substitute placeholder */
-       apply_format(udev, udev->name);
-       apply_format(udev, udev->symlink);
-
+       apply_format(udev, udev->name, sizeof(udev->name),
+                    class_dev, sysfs_device);
+       apply_format(udev, udev->symlink, sizeof(udev->symlink),
+                    class_dev, sysfs_device);
+       udev->partitions = dev->partitions;
 done:
        perm = find_perm(udev->name);
        if (perm) {
@@ -739,9 +841,9 @@ done:
                strfieldcpy(udev->group, perm->group);
        } else {
                /* no matching perms found :( */
-               udev->mode = get_default_mode(class_dev);
-               udev->owner[0] = 0x00;
-               udev->group[0] = 0x00;
+               udev->mode = get_default_mode();
+               strfieldcpy(udev->owner, get_default_owner());
+               strfieldcpy(udev->group, get_default_group());
        }
        dbg("name, '%s' is going to have owner='%s', group='%s', mode = %#o",
            udev->name, udev->owner, udev->group, udev->mode);