2 * Copyright (C) 2004-2006 Kay Sievers <kay@vrfy.org>
3 * Copyright (C) 2006 Hannes Reinecke <hare@suse.de>
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation version 2 of the License.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * You should have received a copy of the GNU General Public License along
15 * with this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
32 #include <sys/types.h>
38 #define strlcpy(d,s,l) (strncpy(d,s,l), (d)[(l)-1] = '\0')
42 #define strlcat(d,s,l) strncat(d,s,(l)-strlen(d)-1)
48 static void log_message(int priority
, const char *format
, ...)
52 va_start(args
, format
);
53 vsyslog(priority
, format
, args
);
58 #define err(format, arg...) \
60 log_message(LOG_ERR ,"%s: " format ,__FUNCTION__ ,## arg); \
64 #define info(format, arg...) \
66 log_message(LOG_INFO ,"%s: " format ,__FUNCTION__ ,## arg); \
71 #define dbg(format, arg...) \
73 log_message(LOG_DEBUG ,"%s: " format ,__FUNCTION__ ,## arg); \
76 #define dbg(...) do {} while(0)
80 static void trigger_uevent(const char *devpath
)
82 char filename
[PATH_SIZE
];
85 strlcpy(filename
, "/sys", sizeof(filename
));
86 strlcat(filename
, devpath
, sizeof(filename
));
87 strlcat(filename
, "/uevent", sizeof(filename
));
90 printf("%s\n", devpath
);
95 fd
= open(filename
, O_WRONLY
);
97 dbg("error on opening %s: %s\n", filename
, strerror(errno
));
101 if (write(fd
, "add", 3) < 0)
102 info("error on triggering %s: %s\n", filename
, strerror(errno
));
107 static int sysfs_resolve_link(char *devpath
, size_t size
)
109 char link_path
[PATH_SIZE
];
110 char link_target
[PATH_SIZE
];
115 strlcpy(link_path
, "/sys", sizeof(link_path
));
116 strlcat(link_path
, devpath
, sizeof(link_path
));
117 len
= readlink(link_path
, link_target
, sizeof(link_target
));
120 link_target
[len
] = '\0';
121 dbg("path link '%s' points to '%s'", devpath
, link_target
);
123 for (back
= 0; strncmp(&link_target
[back
* 3], "../", 3) == 0; back
++)
125 dbg("base '%s', tail '%s', back %i", devpath
, &link_target
[back
* 3], back
);
126 for (i
= 0; i
<= back
; i
++) {
127 char *pos
= strrchr(devpath
, '/');
133 dbg("after moving back '%s'", devpath
);
134 strlcat(devpath
, "/", size
);
135 strlcat(devpath
, &link_target
[back
* 3], size
);
139 static bool device_has_attribute(const char *path
, const char *attr
,
142 char filename
[PATH_SIZE
];
145 strlcpy(filename
, path
, sizeof(filename
));
146 strlcat(filename
, attr
, sizeof(filename
));
148 if (stat(filename
, &statbuf
) < 0)
151 if (!(statbuf
.st_mode
& mode
))
157 static int device_list_insert(const char *path
)
159 char devpath
[PATH_SIZE
];
162 dbg("add '%s'" , path
);
164 /* we only have a device, if we have a dev and an uevent file */
165 if (!device_has_attribute(path
, "/dev", S_IRUSR
) ||
166 !device_has_attribute(path
, "/uevent", S_IWUSR
))
169 strlcpy(devpath
, &path
[4], sizeof(devpath
));
171 /* resolve possible link to real target */
172 if (lstat(path
, &statbuf
) < 0)
174 if (S_ISLNK(statbuf
.st_mode
))
175 if (sysfs_resolve_link(devpath
, sizeof(devpath
)) != 0)
178 trigger_uevent(devpath
);
182 static void scan_subdir(const char *base
)
191 for (dent
= readdir(dir
); dent
!= NULL
; dent
= readdir(dir
)) {
192 char dirname
[PATH_SIZE
];
194 if (dent
->d_name
[0] == '.')
197 strlcpy(dirname
, base
, sizeof(dirname
));
198 strlcat(dirname
, "/", sizeof(dirname
));
199 strlcat(dirname
, dent
->d_name
, sizeof(dirname
));
200 device_list_insert(dirname
);
206 static void scan_subsystem(const char *subsys
)
208 char base
[PATH_SIZE
];
212 strlcpy(base
, "/sys/", sizeof(base
));
213 strlcat(base
, subsys
, sizeof(base
));
219 for (dent
= readdir(dir
); dent
!= NULL
; dent
= readdir(dir
)) {
220 char dirname
[PATH_SIZE
];
222 if (dent
->d_name
[0] == '.')
225 strlcpy(dirname
, base
, sizeof(dirname
));
226 strlcat(dirname
, "/", sizeof(dirname
));
227 strlcat(dirname
, dent
->d_name
, sizeof(dirname
));
228 strlcat(dirname
, "/devices", sizeof(dirname
));
230 /* look for devices */
231 scan_subdir(dirname
);
237 static void scan_block(void)
239 char base
[PATH_SIZE
];
243 strlcpy(base
, "/sys/block", sizeof(base
));
249 for (dent
= readdir(dir
); dent
!= NULL
; dent
= readdir(dir
)) {
250 char dirname
[PATH_SIZE
];
252 if (dent
->d_name
[0] == '.')
255 strlcpy(dirname
, base
, sizeof(dirname
));
256 strlcat(dirname
, "/", sizeof(dirname
));
257 strlcat(dirname
, dent
->d_name
, sizeof(dirname
));
258 if (device_list_insert(dirname
) != 0)
261 /* look for partitions */
262 scan_subdir(dirname
);
268 static void scan_class(void)
270 char base
[PATH_SIZE
];
274 strlcpy(base
, "/sys/class", sizeof(base
));
280 for (dent
= readdir(dir
); dent
!= NULL
; dent
= readdir(dir
)) {
281 char dirname
[PATH_SIZE
];
283 if (dent
->d_name
[0] == '.')
286 strlcpy(dirname
, base
, sizeof(dirname
));
287 strlcat(dirname
, "/", sizeof(dirname
));
288 strlcat(dirname
, dent
->d_name
, sizeof(dirname
));
290 scan_subdir(dirname
);
296 int main(int argc
, char *argv
[], char *envp
[])
298 char base
[PATH_SIZE
];
302 openlog("udevtrigger", LOG_PID
| LOG_CONS
, LOG_DAEMON
);
305 option
= getopt(argc
, argv
, "vnh");
317 printf("Usage: udevtrigger OPTIONS\n"
318 " -v print the list of devices while running\n"
319 " -n do not actually trigger the events\n"
320 " -h print this text\n"
329 /* if we have /sys/subsystem, forget all the old stuff */
330 scan_subsystem("bus");
333 /* scan "block" if it isn't a "class" */
334 strlcpy(base
, "/sys/class/block", sizeof(base
));
335 if (stat(base
, &statbuf
) != 0)