chiark / gitweb /
[PATCH] D-BUS patch for udev-008
[elogind.git] / udev-add.c
index 6f0e3bf10521d6e3f480262c24acb3b93ec90f29..174331fadeae7318c24894e0fca79ace631d4e7b 100644 (file)
 #include <unistd.h>
 #include <errno.h>
 #include <sys/stat.h>
+#include <sys/types.h>
+#include <grp.h>
+#ifndef __KLIBC__
+#include <pwd.h>
+#endif
 
 #include "udev.h"
 #include "udev_version.h"
 #include "namedev.h"
 #include "udevdb.h"
 #include "libsysfs/libsysfs.h"
+#include "klibc_fixups.h"
 
 /* 
  * Right now the major/minor of a device is stored in a file called
@@ -54,18 +60,82 @@ static int get_major_minor(struct sysfs_class_device *class_dev, struct udevice
        if (dev == NULL)
                goto exit;
 
-       dbg("dev = %s", dev);
+       dbg("dev='%s'", dev);
 
        if (sscanf(dev, "%u:%u", &udev->major, &udev->minor) != 2)
                goto exit;
 
-       dbg("found major = %d, minor = %d", udev->major, udev->minor);
+       dbg("found major=%d, minor=%d", udev->major, udev->minor);
 
        retval = 0;
 exit:
        return retval;
 }
 
+static int create_path(char *file)
+{
+       char p[NAME_SIZE];
+       char *pos;
+       int retval;
+       struct stat stats;
+       
+       strncpy(p, file, sizeof(p));
+       pos = strchr(p+1, '/');
+       while (1) {
+               pos = strchr(pos+1, '/');
+               if (pos == NULL)
+                       break;
+               *pos = 0x00;
+               if (stat(p, &stats)) {
+                       retval = mkdir(p, 0755);
+                       if (retval) {
+                               dbg("mkdir(%s) failed with error '%s'",
+                                   p, strerror(errno));
+                               return retval;
+                       }
+                       dbg("created '%s'", p);
+               }
+               *pos = '/';
+       }
+       return 0;
+}
+
+#ifdef USE_DBUS
+/** Send out a signal that a device node is created
+ *
+ *  @param  dev                 udevice object
+ *  @param  path                Sysfs path of device
+ */
+static void sysbus_send_create(struct udevice *dev, const char *path)
+{
+        char filename[255];
+        DBusMessage* message;
+        DBusMessageIter iter;
+
+        if (sysbus_connection == NULL)
+                return;
+
+        strncpy(filename, udev_root, sizeof(filename));
+        strncat(filename, dev->name, sizeof(filename));
+
+        /* object, interface, member */
+        message = dbus_message_new_signal("/org/kernel/udev/NodeMonitor", 
+                                          "org.kernel.udev.NodeMonitor",
+                                          "NodeCreated");
+        
+        dbus_message_iter_init(message, &iter);
+        dbus_message_iter_append_string(&iter, filename);
+        dbus_message_iter_append_string(&iter, path);
+
+        if ( !dbus_connection_send(sysbus_connection, message, NULL) )
+                dbg("error sending d-bus signal");
+
+        dbus_message_unref(message);
+        
+        dbus_connection_flush(sysbus_connection);
+}
+#endif /* USE_DBUS */
+
 /*
  * we possibly want to add some symlinks here
  * only numeric owner/group id's are supported
@@ -73,10 +143,14 @@ exit:
 static int create_node(struct udevice *dev)
 {
        char filename[255];
+       char linktarget[255];
        int retval = 0;
        uid_t uid = 0;
        gid_t gid = 0;
        dev_t res;
+       int i;
+       int tail;
+
 
        strncpy(filename, udev_root, sizeof(filename));
        strncat(filename, dev->name, sizeof(filename));
@@ -103,31 +177,9 @@ static int create_node(struct udevice *dev)
                return -EINVAL;
        }
 
-       /* create subdirectories if requested */
-       if (strchr(dev->name, '/')) {
-               char path[255];
-               char *pos;
-               struct stat stats;
-
-               strncpy(path, filename, sizeof(path));
-               pos = strchr(path+1, '/');
-               while (1) {
-                       pos = strchr(pos+1, '/');
-                       if (pos == NULL)
-                               break;
-                       *pos = 0x00;
-                       if (stat(path, &stats)) {
-                               retval = mkdir(path, 0755);
-                               if (retval) {
-                                       dbg("mkdir(%s) failed with error '%s'",
-                                           path, strerror(errno));
-                                       return retval;
-                               }
-                               dbg("created %s", path);
-                       }
-                       *pos = '/';
-               }
-       }
+       /* create parent directories if needed */
+       if (strrchr(dev->name, '/'))
+               create_path(filename);
 
        dbg("mknod(%s, %#o, %u, %u)", filename, dev->mode, dev->major, dev->minor);
        retval = mknod(filename, dev->mode, res);
@@ -135,13 +187,24 @@ static int create_node(struct udevice *dev)
                dbg("mknod(%s, %#o, %u, %u) failed with error '%s'",
                    filename, dev->mode, dev->major, dev->minor, strerror(errno));
 
+       dbg("chmod(%s, %#o)", filename, dev->mode);
+       retval = chmod(filename, dev->mode);
+       if (retval)
+               dbg("chmod(%s, %#o) failed with error '%s'",
+                   filename, dev->mode, strerror(errno));
+
        if (*dev->owner) {
                char *endptr;
                unsigned long id = strtoul(dev->owner, &endptr, 10);
                if (*endptr == 0x00)
                        uid = (uid_t) id;
-               else
-                       dbg("only numeric owner id supported: %s", dev->owner);
+               else {
+                       struct passwd *pw = getpwnam(dev->owner);
+                       if (!pw)
+                               dbg("user unknown '%s'", dev->owner);
+                       else
+                               uid = pw->pw_uid;
+               }
        }
 
        if (*dev->group) {
@@ -149,16 +212,56 @@ static int create_node(struct udevice *dev)
                unsigned long id = strtoul(dev->group, &endptr, 10);
                if (*endptr == 0x00)
                        gid = (gid_t) id;
-               else
-                       dbg("only numeric group id supported: %s", dev->group);
+               else {
+                       struct group *gr = getgrnam(dev->group);
+                       if (!gr)
+                               dbg("group unknown '%s'", dev->group);
+                       else
+                               gid = gr->gr_gid;
+               }
        }
 
        if (uid || gid) {
                dbg("chown(%s, %u, %u)", filename, uid, gid);
                retval = chown(filename, uid, gid);
                if (retval)
-                       dbg("chown(%s, %u, %u) failed with error '%s'", filename,
-                           uid, gid, strerror(errno));
+                       dbg("chown(%s, %u, %u) failed with error '%s'",
+                           filename, uid, gid, strerror(errno));
+       }
+
+
+       /* create symlink if requested */
+       if (*dev->symlink) {
+               strncpy(filename, udev_root, sizeof(filename));
+               strncat(filename, dev->symlink, sizeof(filename));
+               dbg("symlink '%s' to node '%s' requested", filename, dev->name);
+               if (strrchr(dev->symlink, '/'))
+                       create_path(filename);
+
+               /* optimize relative link */
+               linktarget[0] = '\0';
+               i = 0;
+               tail = 0;
+               while ((dev->name[i] == dev->symlink[i]) && dev->name[i]) {
+                       if (dev->name[i] == '/')
+                               tail = i+1;
+                       i++;
+               }
+               while (dev->symlink[i]) {
+                       if (dev->symlink[i] == '/')
+                               strcat(linktarget, "../");
+                       i++;
+               }
+
+               if (*linktarget == '\0')
+                       strcpy(linktarget, "./");
+               strcat(linktarget, &dev->name[tail]);
+
+               dbg("symlink(%s, %s)", linktarget, filename);
+               retval = symlink(linktarget, filename);
+               if (retval)
+                       dbg("symlink(%s, %s) failed with error '%s'",
+                           linktarget, filename, strerror(errno));
        }
 
        return retval;
@@ -172,7 +275,7 @@ static struct sysfs_class_device *get_class_dev(char *device_name)
        strcpy(dev_path, sysfs_path);
        strcat(dev_path, device_name);
 
-       dbg("looking at %s", dev_path);
+       dbg("looking at '%s'", dev_path);
 
        /* open up the sysfs class device for this thing... */
        class_dev = sysfs_open_class_device(dev_path);
@@ -180,7 +283,7 @@ static struct sysfs_class_device *get_class_dev(char *device_name)
                dbg ("sysfs_open_class_device failed");
                goto exit;
        }
-       dbg("class_dev->name = %s", class_dev->name);
+       dbg("class_dev->name='%s'", class_dev->name);
 
 exit:
        return class_dev;
@@ -203,13 +306,12 @@ static int sleep_for_dev(char *path)
        while (loop--) {
                struct stat buf;
 
-               dbg("looking for %s", filename);
+               dbg("looking for '%s'", filename);
                retval = stat(filename, &buf);
                if (!retval)
                        goto exit;
 
-               /* sleep for a second or two to give the kernel a chance to
-                * create the dev file */
+               /* sleep to give the kernel a chance to create the dev file */
                sleep(1);
        }
        retval = -ENODEV;
@@ -223,6 +325,8 @@ int udev_add_device(char *path, char *subsystem)
        struct udevice dev;
        int retval = -EINVAL;
 
+       memset(&dev, 0x00, sizeof(dev));
+
        /* for now, the block layer is the only place where block devices are */
        if (strcmp(subsystem, "block") == 0)
                dev.type = 'b';
@@ -252,13 +356,18 @@ int udev_add_device(char *path, char *subsystem)
                dbg("udevdb_add_dev failed, but we are going to try to create the node anyway. "
                    "But remove might not work properly for this device.");
 
-       dbg("name = %s", dev.name);
+       dbg("name='%s'", dev.name);
        retval = create_node(&dev);
 
+#ifdef USE_DBUS
+        if (retval == 0) {
+                sysbus_send_create(&dev, path);
+        }
+#endif /* USE_DBUS */
+
 exit:
        if (class_dev)
                sysfs_close_class_device(class_dev);
 
        return retval;
 }
-