chiark / gitweb /
[PATCH] add dbg_parse() to cut down on parse file debugging statements
[elogind.git] / namedev.c
index b6d9a7f8e20085f374df36a6ba554df034d4639e..6f69959346713a0ef9e2a1f0e90d5ddad80fa383 100644 (file)
--- a/namedev.c
+++ b/namedev.c
@@ -21,6 +21,9 @@
  *
  */
 
+/* define this to enable parsing debugging */
+/* #define DEBUG_PARSER */
+
 #include <stddef.h>
 #include <stdlib.h>
 #include <string.h>
@@ -29,6 +32,7 @@
 #include <ctype.h>
 #include <unistd.h>
 #include <errno.h>
+#include <sys/wait.h>
 
 #include "list.h"
 #include "udev.h"
 #define TYPE_NUMBER    "NUMBER"
 #define TYPE_TOPOLOGY  "TOPOLOGY"
 #define TYPE_REPLACE   "REPLACE"
-
-enum config_type {
-       KERNEL_NAME     = 0,    /* must be 0 to let memset() default to this value */
-       LABEL           = 1,
-       NUMBER          = 2,
-       TOPOLOGY        = 3,
-       REPLACE         = 4,
-};
-
-#define BUS_SIZE       30
-#define FILE_SIZE      50
-#define VALUE_SIZE     100
-#define ID_SIZE                50
-#define PLACE_SIZE     50
-
-
-struct config_device {
-       struct list_head node;
-
-       enum config_type type;
-
-       char bus[BUS_SIZE];
-       char sysfs_file[FILE_SIZE];
-       char sysfs_value[VALUE_SIZE];
-       char id[ID_SIZE];
-       char place[PLACE_SIZE];
-       char kernel_name[NAME_SIZE];
-       
-       /* what to set the device to */
-       int mode;
-       char name[NAME_SIZE];
-       char owner[OWNER_SIZE];
-       char group[GROUP_SIZE];
-};
-
+#define TYPE_CALLOUT   "CALLOUT"
 
 static LIST_HEAD(config_device_list);
 
@@ -82,37 +52,43 @@ static void dump_dev(struct config_device *dev)
 {
        switch (dev->type) {
        case KERNEL_NAME:
-               dbg("KERNEL name ='%s'"
+               dbg_parse("KERNEL name ='%s'"
                        " owner = '%s', group = '%s', mode = '%#o'",
-                       dev->name, 
-                       dev->owner, dev->group, dev->mode);
+                       dev->attr.name, 
+                       dev->attr.owner, dev->attr.group, dev->attr.mode);
                break;
        case LABEL:
-               dbg("LABEL name = '%s', bus = '%s', sysfs_file = '%s', sysfs_value = '%s'"
+               dbg_parse("LABEL name = '%s', bus = '%s', sysfs_file = '%s', sysfs_value = '%s'"
                        " owner = '%s', group = '%s', mode = '%#o'",
-                       dev->name, dev->bus, dev->sysfs_file, dev->sysfs_value,
-                       dev->owner, dev->group, dev->mode);
+                       dev->attr.name, dev->bus, dev->sysfs_file, dev->sysfs_value,
+                       dev->attr.owner, dev->attr.group, dev->attr.mode);
                break;
        case NUMBER:
-               dbg("NUMBER name = '%s', bus = '%s', id = '%s'"
+               dbg_parse("NUMBER name = '%s', bus = '%s', id = '%s'"
                        " owner = '%s', group = '%s', mode = '%#o'",
-                       dev->name, dev->bus, dev->id,
-                       dev->owner, dev->group, dev->mode);
+                       dev->attr.name, dev->bus, dev->id,
+                       dev->attr.owner, dev->attr.group, dev->attr.mode);
                break;
        case TOPOLOGY:
-               dbg("TOPOLOGY name = '%s', bus = '%s', place = '%s'"
+               dbg_parse("TOPOLOGY name = '%s', bus = '%s', place = '%s'"
                        " owner = '%s', group = '%s', mode = '%#o'",
-                       dev->name, dev->bus, dev->place,
-                       dev->owner, dev->group, dev->mode);
+                       dev->attr.name, dev->bus, dev->place,
+                       dev->attr.owner, dev->attr.group, dev->attr.mode);
                break;
        case REPLACE:
-               dbg("REPLACE name = %s, kernel_name = %s"
+               dbg_parse("REPLACE name = %s, kernel_name = %s"
+                       " owner = '%s', group = '%s', mode = '%#o'",
+                       dev->attr.name, dev->kernel_name,
+                       dev->attr.owner, dev->attr.group, dev->attr.mode);
+               break;
+       case CALLOUT:
+               dbg_parse("CALLOUT name = '%s', program ='%s', bus = '%s', id = '%s'"
                        " owner = '%s', group = '%s', mode = '%#o'",
-                       dev->name, dev->kernel_name,
-                       dev->owner, dev->group, dev->mode);
+                       dev->attr.name, dev->exec_program, dev->bus, dev->id,
+                       dev->attr.owner, dev->attr.group, dev->attr.mode);
                break;
        default:
-               dbg("Unknown type of device!");
+               dbg_parse("Unknown type of device!");
        }
 }
 
@@ -133,18 +109,18 @@ static int add_dev(struct config_device *new_dev)
         * this one... */
        list_for_each(tmp, &config_device_list) {
                struct config_device *dev = list_entry(tmp, struct config_device, node);
-               if (strcmp(dev->name, new_dev->name) == 0) {
+               if (strcmp(dev->attr.name, new_dev->attr.name) == 0) {
                        /* the same, copy the new info into this structure */
                        copy_var(dev, new_dev, type);
-                       copy_var(dev, new_dev, mode);
+                       copy_var(dev, new_dev, attr.mode);
                        copy_string(dev, new_dev, bus);
                        copy_string(dev, new_dev, sysfs_file);
                        copy_string(dev, new_dev, sysfs_value);
                        copy_string(dev, new_dev, id);
                        copy_string(dev, new_dev, place);
                        copy_string(dev, new_dev, kernel_name);
-                       copy_string(dev, new_dev, owner);
-                       copy_string(dev, new_dev, group);
+                       copy_string(dev, new_dev, attr.owner);
+                       copy_string(dev, new_dev, attr.group);
                        return 0;
                }
        }
@@ -230,7 +206,7 @@ static int namedev_init_config(void)
        int retval = 0;
        struct config_device dev;
 
-       strcpy(filename, NAMEDEV_CONFIG_ROOT NAMEDEV_CONFIG_FILE);
+       strcpy(filename, UDEV_CONFIG_DIR NAMEDEV_CONFIG_FILE);
        dbg("opening %s to read as permissions config", filename);
        fd = fopen(filename, "r");
        if (fd == NULL) {
@@ -245,7 +221,7 @@ static int namedev_init_config(void)
                if (temp == NULL)
                        break;
 
-               dbg("read %s", temp);
+               dbg_parse("read %s", temp);
 
                /* eat the whitespace at the beginning of the line */
                while (isspace(*temp))
@@ -286,9 +262,12 @@ static int namedev_init_config(void)
                        retval = get_value("NAME", &temp, &temp3);
                        if (retval)
                                continue;
-                       strcpy(dev.name, temp3);
+                       strcpy(dev.attr.name, temp3);
 
-                       dbg("LABEL name = '%s', bus = '%s', sysfs_file = '%s', sysfs_value = '%s'", dev.name, dev.bus, dev.sysfs_file, dev.sysfs_value);
+                       dbg_parse("LABEL name = '%s', bus = '%s', "
+                               "sysfs_file = '%s', sysfs_value = '%s'", 
+                               dev.attr.name, dev.bus, dev.sysfs_file, 
+                               dev.sysfs_value);
                }
 
                if (strcasecmp(temp2, TYPE_NUMBER) == 0) {
@@ -313,9 +292,10 @@ static int namedev_init_config(void)
                        retval = get_value("NAME", &temp, &temp3);
                        if (retval)
                                continue;
-                       strcpy(dev.name, temp3);
+                       strcpy(dev.attr.name, temp3);
 
-                       dbg("NUMBER name = '%s', bus = '%s', id = '%s'", dev.name, dev.bus, dev.id);
+                       dbg_parse("NUMBER name = '%s', bus = '%s', id = '%s'",
+                                       dev.attr.name, dev.bus, dev.id);
                }
 
                if (strcasecmp(temp2, TYPE_TOPOLOGY) == 0) {
@@ -340,9 +320,10 @@ static int namedev_init_config(void)
                        retval = get_value("NAME", &temp, &temp3);
                        if (retval)
                                continue;
-                       strcpy(dev.name, temp3);
+                       strcpy(dev.attr.name, temp3);
 
-                       dbg("TOPOLOGY name = '%s', bus = '%s', place = '%s'", dev.name, dev.bus, dev.place);
+                       dbg_parse("TOPOLOGY name = '%s', bus = '%s', place = '%s'",
+                                       dev.attr.name, dev.bus, dev.place);
                }
 
                if (strcasecmp(temp2, TYPE_REPLACE) == 0) {
@@ -360,8 +341,42 @@ static int namedev_init_config(void)
                        retval = get_value("NAME", &temp, &temp3);
                        if (retval)
                                continue;
-                       strcpy(dev.name, temp3);
-                       dbg("REPLACE name = %s, kernel_name = %s", dev.name, dev.kernel_name);
+                       strcpy(dev.attr.name, temp3);
+                       dbg_parse("REPLACE name = %s, kernel_name = %s",
+                                       dev.attr.name, dev.kernel_name);
+               }
+               if (strcasecmp(temp2, TYPE_CALLOUT) == 0) {
+                       /* number type */
+                       dev.type = CALLOUT;
+
+                       /* PROGRAM="executable" */
+                       retval = get_value("PROGRAM", &temp, &temp3);
+                       if (retval)
+                               continue;
+                       strcpy(dev.exec_program, temp3);
+
+                       /* BUS="bus" */
+                       temp2 = strsep(&temp, ",");
+                       retval = get_value("BUS", &temp, &temp3);
+                       if (retval)
+                               continue;
+                       strcpy(dev.bus, temp3);
+
+                       /* ID="id" */
+                       temp2 = strsep(&temp, ",");
+                       retval = get_value("ID", &temp, &temp3);
+                       if (retval)
+                               continue;
+                       strcpy(dev.id, temp3);
+
+                       /* NAME="new_name" */
+                       temp2 = strsep(&temp, ",");
+                       retval = get_value("NAME", &temp, &temp3);
+                       if (retval)
+                               continue;
+                       strcpy(dev.attr.name, temp3);
+                       dbg_parse("CALLOUT name = %s, program = %s",
+                                       dev.attr.name, dev.exec_program);
                }
 
                retval = add_dev(&dev);
@@ -387,7 +402,7 @@ static int namedev_init_permissions(void)
        int retval = 0;
        struct config_device dev;
 
-       strcpy(filename, NAMEDEV_CONFIG_ROOT NAMEDEV_CONFIG_PERMISSION_FILE);
+       strcpy(filename, UDEV_CONFIG_DIR NAMEDEV_CONFIG_PERMISSION_FILE);
        dbg("opening %s to read as permissions config", filename);
        fd = fopen(filename, "r");
        if (fd == NULL) {
@@ -402,7 +417,7 @@ static int namedev_init_permissions(void)
                if (temp == NULL)
                        break;
 
-               dbg("read %s", temp);
+               dbg_parse("read %s", temp);
 
                /* eat the whitespace at the beginning of the line */
                while (isspace(*temp))
@@ -420,17 +435,18 @@ static int namedev_init_permissions(void)
 
                /* parse the line */
                temp2 = strsep(&temp, ":");
-               strncpy(dev.name, temp2, sizeof(dev.name));
+               strncpy(dev.attr.name, temp2, sizeof(dev.attr.name));
 
                temp2 = strsep(&temp, ":");
-               strncpy(dev.owner, temp2, sizeof(dev.owner));
+               strncpy(dev.attr.owner, temp2, sizeof(dev.attr.owner));
 
                temp2 = strsep(&temp, ":");
-               strncpy(dev.group, temp2, sizeof(dev.owner));
+               strncpy(dev.attr.group, temp2, sizeof(dev.attr.owner));
 
-               dev.mode = strtol(temp, NULL, 8);
+               dev.attr.mode = strtol(temp, NULL, 8);
 
-               dbg("name = %s, owner = %s, group = %s, mode = %#o", dev.name, dev.owner, dev.group, dev.mode);
+               dbg_parse("name = %s, owner = %s, group = %s, mode = %#o",
+                               dev.attr.name, dev.attr.owner, dev.attr.group, dev.attr.mode);
                retval = add_dev(&dev);
                if (retval) {
                        dbg("add_dev returned with error %d", retval);
@@ -450,28 +466,298 @@ static int get_default_mode(struct sysfs_class_device *class_dev)
 }
 
 
+static int exec_callout(struct config_device *dev, char *value, int len)
+{
+       int retval;
+       int res;
+       int status;
+       int fds[2];
+       pid_t pid;
+       int value_set = 0;
+       char buffer[256];
+
+       dbg("callout to %s\n", dev->exec_program);
+       retval = pipe(fds);
+       if (retval != 0) {
+               dbg("pipe failed");
+               return -1;
+       }
+       pid = fork();
+       if (pid == -1) {
+               dbg("fork failed");
+               return -1;
+       }
+
+       if (pid == 0) {
+               /*
+                * child 
+                */
+               close(STDOUT_FILENO);
+               dup(fds[1]);    /* dup write side of pipe to STDOUT */
+               retval = execve(dev->exec_program, main_argv, main_envp);
+               if (retval != 0) {
+                       dbg("child execve failed");
+                       exit(1);
+               }
+               return -1; /* avoid compiler warning */
+       } else {
+               /*
+                * Parent reads from fds[0].
+                */
+               close(fds[1]);
+               retval = 0;
+               while (1) {
+                       res = read(fds[0], buffer, sizeof(buffer) - 1);
+                       if (res <= 0)
+                               break;
+                       buffer[res] = '\0';
+                       if (res > len) {
+                               dbg("callout len %d too short\n", len);
+                               retval = -1;
+                       }
+                       if (value_set) {
+                               dbg("callout value already set");
+                               retval = -1;
+                       } else {
+                               value_set = 1;
+                               strncpy(value, buffer, len);
+                       }
+               }
+               close(fds[0]);
+               res = wait(&status);
+               if (res < 0) {
+                       dbg("wait failed result %d", res);
+                       retval = -1;
+               }
+
+               if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) {
+                       dbg("callout program status 0x%x", status);
+                       retval = -1;
+               }
+       }
+       return retval;
+}
+
 static int get_attr(struct sysfs_class_device *class_dev, struct device_attr *attr)
 {
        struct list_head *tmp;
        int retval = 0;
-
+       int found;
+
+       attr->mode = -1;
+       if (class_dev->sysdevice) {
+               dbg_parse("class_dev->sysdevice->directory->path = '%s'", class_dev->sysdevice->directory->path);
+               dbg_parse("class_dev->sysdevice->bus_id = '%s'", class_dev->sysdevice->bus_id);
+       } else {
+               dbg_parse("class_dev->name = '%s'", class_dev->name);
+       }
        list_for_each(tmp, &config_device_list) {
                struct config_device *dev = list_entry(tmp, struct config_device, node);
-               if (strcmp(dev->name, class_dev->name) == 0) {
-                       attr->mode = dev->mode;
-                       strcpy(attr->owner, dev->owner);
-                       strcpy(attr->group, dev->group);
-                       /* FIXME  put the proper name here!!! */
-                       strcpy(attr->name, dev->name);
-                       dbg("%s - owner = %s, group = %s, mode = %#o", dev->name, dev->owner, dev->group, dev->mode);
-                       goto exit;
-               }
+               switch (dev->type) {
+               case LABEL:
+                       {
+                       char *temp;
+
+                       dbg_parse("LABEL: match file '%s' with value '%s'",
+                                       dev->sysfs_file, dev->sysfs_value);
+                       /* try to find the attribute in the class device directory */
+                       temp = sysfs_get_value_from_attributes(class_dev->directory->attributes, dev->sysfs_file);
+                       if (temp)
+                               goto label_found;
+
+                       /* look in the class device device directory if present */
+                       if (class_dev->sysdevice) {
+                               temp = sysfs_get_value_from_attributes(class_dev->sysdevice->directory->attributes, dev->sysfs_file);
+                               if (temp)
+                                       goto label_found;
+                       }
+
+                       /* bah, let's go backwards up a level to see if the device is there,
+                        * as block partitions don't point to the physical device.  Need to fix that
+                        * up in the kernel...
+                        */
+                       if (strstr(class_dev->directory->path, "block")) {
+                               dbg_parse("looking at block device...");
+                               if (isdigit(class_dev->directory->path[strlen(class_dev->directory->path)-1])) {
+                                       char path[SYSFS_PATH_MAX];
+                                       struct sysfs_class_device *class_dev_parent;
+
+                                       dbg_parse("really is a partition...");
+                                       strcpy(path, class_dev->directory->path);
+                                       temp = strrchr(path, '/');
+                                       *temp = 0x00;
+                                       dbg_parse("looking for a class device at '%s'", path);
+                                       class_dev_parent = sysfs_open_class_device(path);
+                                       if (class_dev_parent == NULL) {
+                                               dbg("sysfs_open_class_device at '%s' failed", path);
+                                               continue;
+                                       }
+                                       dbg_parse("class_dev_parent->name = %s", class_dev_parent->name);
+
+                                       /* try to find the attribute in the class device directory */
+                                       temp = sysfs_get_value_from_attributes(class_dev_parent->directory->attributes, dev->sysfs_file);
+                                       if (temp) {
+                                               //sysfs_close_class_device(class_dev_parent);
+                                               goto label_found;
+                                       }
+
+                                       /* look in the class device device directory if present */
+                                       if (class_dev_parent->sysdevice) {
+                                               temp = sysfs_get_value_from_attributes(class_dev_parent->sysdevice->directory->attributes, dev->sysfs_file);
+                                               if (temp) {
+                                                       // sysfs_close_class_device(class_dev_parent);
+                                                       goto label_found;
+                                               }
+                                       }
+                                       
+                               }
+                       }
+                       continue;
+
+label_found:
+                       temp[strlen(temp)-1] = 0x00;
+                       dbg_parse("file '%s' found with value '%s' compare with '%s'", dev->sysfs_file, temp, dev->sysfs_value);
+                       if (strcmp(dev->sysfs_value, temp) != 0)
+                               continue;
+
+                       strcpy(attr->name, dev->attr.name);
+                       if (isdigit(class_dev->directory->path[strlen(class_dev->directory->path)-1])) {
+                               temp[0] = class_dev->directory->path[strlen(class_dev->directory->path)-1];
+                               temp[1] = 0x00;
+                               strcat(attr->name, temp);
+                       }
+                       if (dev->attr.mode != 0) {
+                               attr->mode = dev->attr.mode;
+                               strcpy(attr->owner, dev->attr.owner);
+                               strcpy(attr->group, dev->attr.group);
+                       }
+                       dbg_parse("file '%s' with value '%s' becomes '%s' - owner = %s, group = %s, mode = %#o",
+                               dev->sysfs_file, dev->sysfs_value, attr->name, 
+                               dev->attr.owner, dev->attr.group, dev->attr.mode);
+                       goto done;
+                       break;
+                       }
+               case NUMBER:
+                       {
+                       char path[SYSFS_PATH_MAX];
+                       char *temp;
+
+                       found = 0;
+                       if (!class_dev->sysdevice)
+                               continue;
+                       strcpy(path, class_dev->sysdevice->directory->path);
+                       temp = strrchr(path, '/');
+                       dbg_parse("NUMBER path = '%s'", path);
+                       dbg_parse("NUMBER temp = '%s' id = '%s'", temp, dev->id);
+                       if (strstr(temp, dev->id) != NULL) {
+                               found = 1;
+                       } else {
+                               *temp = 0x00;
+                               temp = strrchr(path, '/');
+                               dbg_parse("NUMBERY temp = '%s' id = '%s'", temp, dev->id);
+                               if (strstr(temp, dev->id) != NULL)
+                                       found = 1;
+                       }
+                       if (!found)
+                               continue;
+
+                       strcpy(attr->name, dev->attr.name);
+                       if (dev->attr.mode != 0) {
+                               attr->mode = dev->attr.mode;
+                               strcpy(attr->owner, dev->attr.owner);
+                               strcpy(attr->group, dev->attr.group);
+                       }
+                       dbg_parse("device id '%s' becomes '%s' - owner = %s, group = %s, mode = %#o",
+                               dev->id, attr->name, 
+                               dev->attr.owner, dev->attr.group, dev->attr.mode);
+                       goto done;
+                       break;
+                       }
+               case TOPOLOGY:
+                       {
+                       char path[SYSFS_PATH_MAX];
+                       char *temp;
+
+                       if (!class_dev->sysdevice)
+                               continue;
+                       found = 0;      
+                       strcpy(path, class_dev->sysdevice->directory->path);
+                       temp = strrchr(path, '/');
+                       dbg_parse("TOPOLOGY path = '%s'", path);
+                       dbg_parse("TOPOLOGY temp = '%s' place = '%s'", temp, dev->place);
+                       if (strstr(temp, dev->place) != NULL) {
+                               found = 1;
+                       } else {
+                               *temp = 0x00;
+                               temp = strrchr(path, '/');
+                               dbg_parse("TOPOLOGY temp = '%s' place = '%s'", temp, dev->place);
+                               if (strstr(temp, dev->place) != NULL)
+                                       found = 1;
+                       }
+                       if (!found)
+                               continue;
+
+                       strcpy(attr->name, dev->attr.name);
+                       if (dev->attr.mode != 0) {
+                               attr->mode = dev->attr.mode;
+                               strcpy(attr->owner, dev->attr.owner);
+                               strcpy(attr->group, dev->attr.group);
+                       }
+                       dbg_parse("device at '%s' becomes '%s' - owner = %s, group = %s, mode = %#o",
+                               dev->place, attr->name, 
+                               dev->attr.owner, dev->attr.group, dev->attr.mode);
+                       goto done;
+                       break;
+                       }
+               case CALLOUT:
+                       {
+                       char value[ID_SIZE];
+
+                       if (exec_callout(dev, value, sizeof(value)))
+                               continue;
+                       if (strncmp(value, dev->id, sizeof(value)) != 0)
+                               continue;
+                       strcpy(attr->name, dev->attr.name);
+                       if (dev->attr.mode != 0) {
+                               attr->mode = dev->attr.mode;
+                               strcpy(attr->owner, dev->attr.owner);
+                               strcpy(attr->group, dev->attr.group);
+                       }
+                       dbg_parse("device callout '%s' becomes '%s' - owner = %s, group = %s, mode = %#o",
+                               dev->id, attr->name, 
+                               dev->attr.owner, dev->attr.group, dev->attr.mode);
+                       goto done;
+                       break;
+                       }
+               case REPLACE:
+                       if (strcmp(dev->kernel_name, class_dev->name) != 0)
+                               continue;
+                       strcpy(attr->name, dev->attr.name);
+                       if (dev->attr.mode != 0) {
+                               attr->mode = dev->attr.mode;
+                               strcpy(attr->owner, dev->attr.owner);
+                               strcpy(attr->group, dev->attr.group);
+                       }
+                       dbg_parse("'%s' becomes '%s' - owner = %s, group = %s, mode = %#o",
+                               dev->kernel_name, attr->name, 
+                               dev->attr.owner, dev->attr.group, dev->attr.mode);
+                       goto done;
+                       break;
+               case KERNEL_NAME:
+                       break;
+               default:
+                       dbg_parse("Unknown type of device '%d'", dev->type);
+                       break;
+               }       
        }
-       attr->mode = get_default_mode(class_dev);
-       attr->owner[0] = 0x00;
-       attr->group[0] = 0x00;
        strcpy(attr->name, class_dev->name);
-exit:
+       
+done:
+       if (attr->mode == -1) { 
+               attr->mode = get_default_mode(class_dev);
+               attr->owner[0] = 0x00;
+               attr->group[0] = 0x00;
+       }
        return retval;
 }