udev/udev-watch.c

   1 /*
   2  * Copyright (C) 2004-2010 Kay Sievers <kay.sievers@vrfy.org>
   3  * Copyright (C) 2009 Canonical Ltd.
   4  * Copyright (C) 2009 Scott James Remnant <scott@netsplit.com>
   5  *
   6  * This program is free software: you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation, either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include <sys/types.h>
  21 #include <errno.h>
  22 #include <fcntl.h>
  23 #include <stdio.h>
  24 #include <dirent.h>
  25 #include <stddef.h>
  26 #include <stdlib.h>
  27 #include <string.h>
  28 #include <unistd.h>
  29 #include <sys/inotify.h>
  30
  31 #include "udev.h"
  32
  33 static int inotify_fd = -1;
  34
  35 /* inotify descriptor, will be shared with rules directory;
  36  * set to cloexec since we need our children to be able to add
  37  * watches for us
  38  */
  39 int udev_watch_init(struct udev *udev)
  40 {
  41         inotify_fd = inotify_init1(IN_CLOEXEC);
  42         if (inotify_fd < 0)
  43                 err(udev, "inotify_init failed: %m\n");
  44         return inotify_fd;
  45 }
  46
  47 /* move any old watches directory out of the way, and then restore
  48  * the watches
  49  */
  50 void udev_watch_restore(struct udev *udev)
  51 {
  52         char filename[UTIL_PATH_SIZE], oldname[UTIL_PATH_SIZE];
  53
  54         if (inotify_fd < 0)
  55                 return;
  56
  57         util_strscpyl(oldname, sizeof(oldname), udev_get_dev_path(udev), "/.udev/watch.old", NULL);
  58         util_strscpyl(filename, sizeof(filename), udev_get_dev_path(udev), "/.udev/watch", NULL);
  59         if (rename(filename, oldname) == 0) {
  60                 DIR *dir;
  61                 struct dirent *ent;
  62
  63                 dir = opendir(oldname);
  64                 if (dir == NULL) {
  65                         err(udev, "unable to open old watches dir '%s', old watches will not be restored: %m", oldname);
  66                         return;
  67                 }
  68
  69                 for (ent = readdir(dir); ent != NULL; ent = readdir(dir)) {
  70                         char device[UTIL_PATH_SIZE];
  71                         char *s;
  72                         size_t l;
  73                         ssize_t len;
  74                         struct udev_device *dev;
  75                         int maj, min;
  76                         char type;
  77
  78                         if (ent->d_name[0] == '.')
  79                                 continue;
  80
  81                         s = device;
  82                         l = util_strpcpy(&s, sizeof(device), udev_get_sys_path(udev));
  83                         len = readlinkat(dirfd(dir), ent->d_name, s, l);
  84                         if (len <= 0 || len >= (ssize_t)l)
  85                                 goto unlink;
  86                         s[len] = '\0';
  87
  88                         if (sscanf(s, "%c%i:%i", &type, &maj, &min) != 3)
  89                                 goto unlink;
  90                         dev = udev_device_new_from_devnum(udev, type, makedev(maj, min));
  91                         if (dev == NULL)
  92                                 goto unlink;
  93
  94                         info(udev, "restoring old watch on '%s'\n", udev_device_get_devnode(dev));
  95                         udev_watch_begin(udev, dev);
  96                         udev_device_unref(dev);
  97 unlink:
  98                         unlinkat(dirfd(dir), ent->d_name, 0);
  99                 }
 100
 101                 closedir(dir);
 102                 rmdir(oldname);
 103
 104         } else if (errno != ENOENT) {
 105                 err(udev, "unable to move watches dir '%s', old watches will not be restored: %m", filename);
 106         }
 107 }
 108
 109 void udev_watch_begin(struct udev *udev, struct udev_device *dev)
 110 {
 111         char filename[UTIL_PATH_SIZE];
 112         char majmin[UTIL_PATH_SIZE];
 113         int wd;
 114
 115         if (inotify_fd < 0)
 116                 return;
 117
 118         info(udev, "adding watch on '%s'\n", udev_device_get_devnode(dev));
 119         wd = inotify_add_watch(inotify_fd, udev_device_get_devnode(dev), IN_CLOSE_WRITE);
 120         if (wd < 0) {
 121                 err(udev, "inotify_add_watch(%d, %s, %o) failed: %m\n",
 122                     inotify_fd, udev_device_get_devnode(dev), IN_CLOSE_WRITE);
 123                 return;
 124         }
 125
 126         snprintf(majmin, sizeof(majmin), "%c%i:%i",
 127                  strcmp(udev_device_get_subsystem(dev), "block") == 0 ? 'b' : 'c',
 128                  major(udev_device_get_devnum(dev)), minor(udev_device_get_devnum(dev)));
 129         snprintf(filename, sizeof(filename), "%s/.udev/watch/%d", udev_get_dev_path(udev), wd);
 130         util_create_path(udev, filename);
 131         unlink(filename);
 132         symlink(majmin, filename);
 133
 134         udev_device_set_watch_handle(dev, wd);
 135 }
 136
 137 void udev_watch_end(struct udev *udev, struct udev_device *dev)
 138 {
 139         int wd;
 140         char filename[UTIL_PATH_SIZE];
 141
 142         if (inotify_fd < 0)
 143                 return;
 144
 145         wd = udev_device_get_watch_handle(dev);
 146         if (wd < 0)
 147                 return;
 148
 149         info(udev, "removing watch on '%s'\n", udev_device_get_devnode(dev));
 150         inotify_rm_watch(inotify_fd, wd);
 151
 152         snprintf(filename, sizeof(filename), "%s/.udev/watch/%d", udev_get_dev_path(udev), wd);
 153         unlink(filename);
 154
 155         udev_device_set_watch_handle(dev, -1);
 156 }
 157
 158 struct udev_device *udev_watch_lookup(struct udev *udev, int wd)
 159 {
 160         char filename[UTIL_PATH_SIZE];
 161         char majmin[UTIL_PATH_SIZE];
 162         char *s;
 163         size_t l;
 164         ssize_t len;
 165         int maj, min;
 166         char type;
 167         dev_t devnum;
 168
 169         if (inotify_fd < 0 || wd < 0)
 170                 return NULL;
 171
 172         snprintf(filename, sizeof(filename), "%s/.udev/watch/%d", udev_get_dev_path(udev), wd);
 173         s = majmin;
 174         l = util_strpcpy(&s, sizeof(majmin), udev_get_sys_path(udev));
 175         len = readlink(filename, s, l);
 176         if (len < 0 || (size_t)len >= l)
 177                 return NULL;
 178         s[len] = '\0';
 179
 180         if (sscanf(s, "%c%i:%i", &type, &maj, &min) != 3)
 181                 return NULL;
 182         devnum = makedev(maj, min);
 183         return udev_device_new_from_devnum(udev, type, devnum);
 184 }