#include <unistd.h>
#include <errno.h>
#include <sys/wait.h>
-#include <sys/stat.h>
#include "libsysfs/sysfs/libsysfs.h"
#include "list.h"
dbg("look for device attribute '%s'", name);
if (class_dev) {
+ dbg("look for class attribute '%s/%s'", class_dev->path, name);
tmpattr = sysfs_get_classdev_attr(class_dev, name);
if (tmpattr)
goto attr_found;
}
if (sysfs_device) {
+ dbg("look for devices attribute '%s/%s'", sysfs_device->path, name);
tmpattr = sysfs_get_device_attr(sysfs_device, name);
if (tmpattr)
goto attr_found;
}
-
return -1;
attr_found:
{
char temp[PATH_SIZE];
char temp2[PATH_SIZE];
- char *tail, *pos, *cpos, *attr, *rest;
+ char *head, *tail, *cpos, *attr, *rest;
int len;
int i;
- char c;
unsigned int next_free_number;
struct sysfs_class_device *class_dev_parent;
-
- pos = string;
+ enum subst_type {
+ SUBST_UNKNOWN,
+ SUBST_DEVPATH,
+ SUBST_ID,
+ SUBST_KERNEL_NUMBER,
+ SUBST_KERNEL_NAME,
+ SUBST_MAJOR,
+ SUBST_MINOR,
+ SUBST_RESULT,
+ SUBST_SYSFS,
+ SUBST_ENUM,
+ SUBST_PARENT,
+ SUBST_TEMP_NODE,
+ SUBST_ROOT,
+ SUBST_MODALIAS,
+ };
+ static const struct subst_map {
+ char *name;
+ char fmt;
+ enum subst_type type;
+ } map[] = {
+ { .name = "devpath", .fmt = 'p', .type = SUBST_DEVPATH },
+ { .name = "id", .fmt = 'b', .type = SUBST_ID },
+ { .name = "number", .fmt = 'n', .type = SUBST_KERNEL_NUMBER },
+ { .name = "kernel", .fmt = 'k', .type = SUBST_KERNEL_NAME },
+ { .name = "major", .fmt = 'M', .type = SUBST_MAJOR },
+ { .name = "minor", .fmt = 'm', .type = SUBST_MINOR },
+ { .name = "result", .fmt = 'c', .type = SUBST_RESULT },
+ { .name = "sysfs", .fmt = 's', .type = SUBST_SYSFS },
+ { .name = "enum", .fmt = 'e', .type = SUBST_ENUM },
+ { .name = "parent", .fmt = 'P', .type = SUBST_PARENT },
+ { .name = "tempnode", .fmt = 'N', .type = SUBST_TEMP_NODE },
+ { .name = "root", .fmt = 'r', .type = SUBST_ROOT },
+ { .name = "modalias", .fmt = 'A', .type = SUBST_MODALIAS },
+ {}
+ };
+ enum subst_type type;
+ const struct subst_map *subst;
+
+ head = string;
while (1) {
- pos = strchr(pos, '%');
- if (pos == NULL)
- break;
-
- pos[0] = '\0';
- tail = pos+1;
- len = get_format_len(&tail);
- c = tail[0];
- strlcpy(temp, tail+1, sizeof(temp));
- tail = temp;
- dbg("format=%c, string='%s', tail='%s'",c , string, tail);
+ len = -1;
+ while (head[0] != '\0') {
+ if (head[0] == '$') {
+ /* substitute named variable */
+ if (head[1] == '\0')
+ break;
+ if (head[1] == '$') {
+ strlcpy(temp, head+2, sizeof(temp));
+ strlcpy(head+1, temp, maxsize);
+ head++;
+ continue;
+ }
+ head[0] = '\0';
+ for (subst = map; subst->name; subst++) {
+ if (strncasecmp(&head[1], subst->name, strlen(subst->name)) == 0) {
+ type = subst->type;
+ tail = head + strlen(subst->name)+1;
+ dbg("will substitute format name '%s'", subst->name);
+ goto found;
+ }
+ }
+ }
+ else if (head[0] == '%') {
+ /* substitute format char */
+ if (head[1] == '\0')
+ break;
+ if (head[1] == '%') {
+ strlcpy(temp, head+2, sizeof(temp));
+ strlcpy(head+1, temp, maxsize);
+ head++;
+ continue;
+ }
+ head[0] = '\0';
+ tail = head+1;
+ len = get_format_len(&tail);
+ for (subst = map; subst->name; subst++) {
+ if (tail[0] == subst->fmt) {
+ type = subst->type;
+ tail++;
+ dbg("will substitute format char '%c'", subst->fmt);
+ goto found;
+ }
+ }
+ }
+ head++;
+ }
+ break;
+found:
attr = get_format_attribute(&tail);
+ strlcpy(temp, tail, sizeof(temp));
+ dbg("format=%i, string='%s', tail='%s', class_dev=%p, sysfs_dev=%p",
+ type ,string, tail, class_dev, sysfs_device);
- switch (c) {
- case 'p':
+ switch (type) {
+ case SUBST_DEVPATH:
strlcat(string, udev->devpath, maxsize);
- dbg("substitute kernel name '%s'", udev->kernel_name);
+ dbg("substitute devpath '%s'", udev->devpath);
break;
- case 'b':
+ case SUBST_ID:
strlcat(string, udev->bus_id, maxsize);
dbg("substitute bus_id '%s'", udev->bus_id);
break;
- case 'k':
+ case SUBST_KERNEL_NAME:
strlcat(string, udev->kernel_name, maxsize);
dbg("substitute kernel name '%s'", udev->kernel_name);
break;
- case 'n':
+ case SUBST_KERNEL_NUMBER:
strlcat(string, udev->kernel_number, maxsize);
dbg("substitute kernel number '%s'", udev->kernel_number);
- break;
- case 'm':
- sprintf(temp2, "%d", minor(udev->devt));
- strlcat(string, temp2, maxsize);
- dbg("substitute minor number '%s'", temp2);
break;
- case 'M':
+ case SUBST_MAJOR:
sprintf(temp2, "%d", major(udev->devt));
strlcat(string, temp2, maxsize);
dbg("substitute major number '%s'", temp2);
break;
- case 'c':
+ case SUBST_MINOR:
+ sprintf(temp2, "%d", minor(udev->devt));
+ strlcat(string, temp2, maxsize);
+ dbg("substitute minor number '%s'", temp2);
+ break;
+ case SUBST_RESULT:
if (udev->program_result[0] == '\0')
break;
/* get part part of the result string */
dbg("substitute result string '%s'", udev->program_result);
}
break;
- case 's':
+ case SUBST_SYSFS:
if (attr == NULL) {
dbg("missing attribute");
break;
strlcat(string, temp2, maxsize);
dbg("substitute sysfs value '%s'", temp2);
break;
- case '%':
- strlcat(string, "%", maxsize);
- pos++;
- break;
- case 'e':
+ case SUBST_ENUM:
next_free_number = find_free_number(udev, string);
if (next_free_number > 0) {
sprintf(temp2, "%d", next_free_number);
strlcat(string, temp2, maxsize);
}
break;
- case 'P':
+ case SUBST_PARENT:
if (!class_dev)
break;
class_dev_parent = sysfs_get_classdev_parent(class_dev);
struct udevice udev_parent;
dbg("found parent '%s', get the node name", class_dev_parent->path);
- udev_init_device(&udev_parent, NULL, NULL);
+ udev_init_device(&udev_parent, NULL, NULL, NULL);
/* lookup the name in the udev_db with the DEVPATH of the parent */
if (udev_db_get_device(&udev_parent, &class_dev_parent->path[strlen(sysfs_path)]) == 0) {
strlcat(string, udev_parent.name, maxsize);
udev_cleanup_device(&udev_parent);
}
break;
- case 'N':
+ case SUBST_TEMP_NODE:
if (udev->tmp_node[0] == '\0') {
dbg("create temporary device node for callout");
snprintf(udev->tmp_node, sizeof(udev->tmp_node), "%s/.tmp-%u-%u",
strlcat(string, udev->tmp_node, maxsize);
dbg("substitute temporary device node name '%s'", udev->tmp_node);
break;
- case 'r':
+ case SUBST_ROOT:
strlcat(string, udev_root, maxsize);
dbg("substitute udev_root '%s'", udev_root);
break;
+ case SUBST_MODALIAS:
+ if (find_sysfs_attribute(NULL, sysfs_device, "modalias", temp2, sizeof(temp2)) != 0)
+ break;
+ strlcat(string, temp2, maxsize);
+ dbg("substitute MODALIAS '%s'", temp2);
+ break;
default:
- err("unknown substitution type '%%%c'", c);
+ err("unknown substitution type=%i", type);
break;
}
- /* truncate to specified length */
- if (len > 0)
- pos[len] = '\0';
+ /* possibly truncate to format-char specified length */
+ if (len != -1) {
+ head[len] = '\0';
+ dbg("truncate to %i chars, subtitution string becomes '%s'", len, head);
+ }
- strlcat(string, tail, maxsize);
+ strlcat(string, temp, maxsize);
}
}
-static int execute_program(struct udevice *udev, const char *path, char *value, int len)
+static int execute_program_pipe(const char *command, const char *subsystem, char *value, int len)
{
int retval;
int count;
int status;
- int fds[2];
+ int pipefds[2];
pid_t pid;
char *pos;
char arg[PATH_SIZE];
char *argv[(sizeof(arg) / 2) + 1];
+ int devnull;
int i;
- strlcpy(arg, path, sizeof(arg));
+ strlcpy(arg, command, sizeof(arg));
i = 0;
- if (strchr(path, ' ')) {
+ if (strchr(arg, ' ')) {
pos = arg;
while (pos != NULL) {
if (pos[0] == '\'') {
dbg("execute '%s' with parsed arguments", arg);
} else {
argv[0] = arg;
- argv[1] = udev->subsystem;
+ argv[1] = (char *) subsystem;
argv[2] = NULL;
dbg("execute '%s' with subsystem '%s' argument", arg, argv[1]);
}
- retval = pipe(fds);
+ retval = pipe(pipefds);
if (retval != 0) {
err("pipe failed");
return -1;
switch(pid) {
case 0:
/* child dup2 write side of pipe to STDOUT */
- dup2(fds[1], STDOUT_FILENO);
+ devnull = open("/dev/null", O_RDWR);
+ if (devnull >= 0) {
+ dup2(devnull, STDIN_FILENO);
+ dup2(devnull, STDERR_FILENO);
+ close(devnull);
+ }
+ dup2(pipefds[1], STDOUT_FILENO);
retval = execv(arg, argv);
-
err("exec of program failed");
_exit(1);
case -1:
- err("fork of '%s' failed", path);
+ err("fork of '%s' failed", arg);
retval = -1;
break;
default:
- /* parent reads from fds[0] */
- close(fds[1]);
+ /* parent reads from pipefds[0] */
+ close(pipefds[1]);
retval = 0;
i = 0;
while (1) {
- count = read(fds[0], value + i, len - i-1);
+ count = read(pipefds[0], value + i, len - i-1);
if (count < 0) {
err("read failed with '%s'", strerror(errno));
retval = -1;
}
value[i] = '\0';
- close(fds[0]);
+ close(pipefds[0]);
waitpid(pid, &status, 0);
if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) {
{
struct sysfs_device *parent_device = sysfs_device;
+ if (rule->action_operation != KEY_OP_UNSET) {
+ dbg("check for " KEY_ACTION " rule->action='%s' udev->action='%s'",
+ rule->action, udev->action);
+ if (strcmp_pattern(rule->action, udev->action) != 0) {
+ dbg(KEY_ACTION " is not matching");
+ if (rule->action_operation != KEY_OP_NOMATCH)
+ goto exit;
+ } else {
+ dbg(KEY_ACTION " matches");
+ if (rule->action_operation == KEY_OP_NOMATCH)
+ goto exit;
+ }
+ dbg(KEY_ACTION " key is true");
+ }
+
if (rule->kernel_operation != KEY_OP_UNSET) {
- dbg("check for " KEY_KERNEL " rule->kernel='%s' class_dev->name='%s'",
- rule->kernel, class_dev->name);
- if (strcmp_pattern(rule->kernel, class_dev->name) != 0) {
+ dbg("check for " KEY_KERNEL " rule->kernel='%s' udev_kernel_name='%s'",
+ rule->kernel, udev->kernel_name);
+ if (strcmp_pattern(rule->kernel, udev->kernel_name) != 0) {
dbg(KEY_KERNEL " is not matching");
if (rule->kernel_operation != KEY_OP_NOMATCH)
goto exit;
}
if (rule->subsystem_operation != KEY_OP_UNSET) {
- dbg("check for " KEY_SUBSYSTEM " rule->subsystem='%s' class_dev->name='%s'",
- rule->subsystem, class_dev->name);
+ dbg("check for " KEY_SUBSYSTEM " rule->subsystem='%s' udev->subsystem='%s'",
+ rule->subsystem, udev->subsystem);
if (strcmp_pattern(rule->subsystem, udev->subsystem) != 0) {
dbg(KEY_SUBSYSTEM " is not matching");
if (rule->subsystem_operation != KEY_OP_NOMATCH)
dbg(KEY_SUBSYSTEM " key is true");
}
+ if (rule->devpath_operation != KEY_OP_UNSET) {
+ dbg("check for " KEY_DEVPATH " rule->devpath='%s' udev->devpath='%s'",
+ rule->devpath, udev->devpath);
+ if (strcmp_pattern(rule->devpath, udev->devpath) != 0) {
+ dbg(KEY_DEVPATH " is not matching");
+ if (rule->devpath_operation != KEY_OP_NOMATCH)
+ goto exit;
+ } else {
+ dbg(KEY_DEVPATH " matches");
+ if (rule->devpath_operation == KEY_OP_NOMATCH)
+ goto exit;
+ }
+ dbg(KEY_DEVPATH " key is true");
+ }
+
+ if (rule->modalias_operation != KEY_OP_UNSET) {
+ char value[NAME_SIZE];
+
+ if (find_sysfs_attribute(NULL, sysfs_device, "modalias", value, sizeof(value)) != 0) {
+ dbg(KEY_MODALIAS " value not found");
+ goto exit;
+ }
+ dbg("check for " KEY_MODALIAS " rule->modalias='%s' modalias='%s'",
+ rule->modalias, value);
+ if (strcmp_pattern(rule->modalias, value) != 0) {
+ dbg(KEY_MODALIAS " is not matching");
+ if (rule->modalias_operation != KEY_OP_NOMATCH)
+ goto exit;
+ } else {
+ dbg(KEY_MODALIAS " matches");
+ if (rule->modalias_operation == KEY_OP_NOMATCH)
+ goto exit;
+ }
+ dbg(KEY_MODALIAS " key is true");
+ }
+
if (rule->env_pair_count) {
int i;
dbg("check " KEY_PROGRAM);
strlcpy(program, rule->program, sizeof(program));
apply_format(udev, program, sizeof(program), class_dev, sysfs_device);
- if (execute_program(udev, program, udev->program_result, sizeof(udev->program_result)) != 0) {
+ if (execute_program_pipe(program, udev->subsystem,
+ udev->program_result, sizeof(udev->program_result)) != 0) {
dbg(KEY_PROGRAM " returned nonzero");
if (rule->program_operation != KEY_OP_NOMATCH)
goto exit;
/* look for a matching rule to apply */
list_for_each_entry(rule, &udev_rule_list, node) {
+ if (udev->name_set && rule->name_operation != KEY_OP_UNSET) {
+ dbg("node name already set, rule ignored");
+ continue;
+ }
+
dbg("process rule");
if (match_rule(udev, rule, class_dev, sysfs_device) == 0) {
-
/* apply options */
if (rule->ignore_device) {
info("configured rule in '%s[%i]' applied, '%s' is ignored",
rule->config_file, rule->config_line, udev->kernel_name);
- return -1;
+ udev->ignore_device = 1;
+ return 0;
}
if (rule->ignore_remove) {
udev->ignore_remove = 1;
}
/* apply permissions */
- if (rule->mode != 0000) {
+ if (!udev->mode_final && rule->mode != 0000) {
+ if (rule->mode_operation == KEY_OP_ASSIGN_FINAL)
+ udev->mode_final = 1;
udev->mode = rule->mode;
dbg("applied mode=%#o to '%s'", udev->mode, udev->kernel_name);
}
- if (rule->owner[0] != '\0') {
+ if (!udev->owner_final && rule->owner[0] != '\0') {
+ if (rule->owner_operation == KEY_OP_ASSIGN_FINAL)
+ udev->owner_final = 1;
strlcpy(udev->owner, rule->owner, sizeof(udev->owner));
apply_format(udev, udev->owner, sizeof(udev->owner), class_dev, sysfs_device);
dbg("applied owner='%s' to '%s'", udev->owner, udev->kernel_name);
}
- if (rule->group[0] != '\0') {
+ if (!udev->group_final && rule->group[0] != '\0') {
+ if (rule->group_operation == KEY_OP_ASSIGN_FINAL)
+ udev->group_final = 1;
strlcpy(udev->group, rule->group, sizeof(udev->group));
apply_format(udev, udev->group, sizeof(udev->group), class_dev, sysfs_device);
dbg("applied group='%s' to '%s'", udev->group, udev->kernel_name);
}
/* collect symlinks */
- if (rule->symlink[0] != '\0') {
+ if (!udev->symlink_final && rule->symlink_operation != KEY_OP_UNSET) {
char temp[PATH_SIZE];
char *pos, *next;
- info("configured rule in '%s[%i]' applied, added symlink '%s'",
- rule->config_file, rule->config_line, rule->symlink);
- strlcpy(temp, rule->symlink, sizeof(temp));
- apply_format(udev, temp, sizeof(temp), class_dev, sysfs_device);
-
- /* add multiple symlinks separated by spaces */
- pos = temp;
- next = strchr(temp, ' ');
- while (next) {
- next[0] = '\0';
+ if (rule->symlink_operation == KEY_OP_ASSIGN_FINAL)
+ udev->symlink_final = 1;
+ if (rule->symlink_operation == KEY_OP_ASSIGN || rule->symlink_operation == KEY_OP_ASSIGN_FINAL) {
+ struct name_entry *name_loop;
+ struct name_entry *temp_loop;
+
+ info("reset symlink list");
+ list_for_each_entry_safe(name_loop, temp_loop, &udev->symlink_list, node) {
+ list_del(&name_loop->node);
+ free(name_loop);
+ }
+ }
+ if (rule->symlink[0] != '\0') {
+ info("configured rule in '%s[%i]' applied, added symlink '%s'",
+ rule->config_file, rule->config_line, rule->symlink);
+ strlcpy(temp, rule->symlink, sizeof(temp));
+ apply_format(udev, temp, sizeof(temp), class_dev, sysfs_device);
+
+ /* add multiple symlinks separated by spaces */
+ pos = temp;
+ next = strchr(temp, ' ');
+ while (next) {
+ next[0] = '\0';
+ info("add symlink '%s'", pos);
+ name_list_add(&udev->symlink_list, pos, 0);
+ pos = &next[1];
+ next = strchr(pos, ' ');
+ }
info("add symlink '%s'", pos);
name_list_add(&udev->symlink_list, pos, 0);
- pos = &next[1];
- next = strchr(pos, ' ');
}
- info("add symlink '%s'", pos);
- name_list_add(&udev->symlink_list, pos, 0);
}
- /* rule matches */
- if (rule->name[0] != '\0') {
- info("configured rule in '%s[%i]' applied, '%s' becomes '%s'",
- rule->config_file, rule->config_line, udev->kernel_name, rule->name);
+ /* set name, later rules with name set will be ignored */
+ if (rule->name_operation != KEY_OP_UNSET) {
+ udev->name_set = 1;
+ if (rule->name[0] == '\0') {
+ info("configured rule in '%s[%i]' applied, node handling for '%s' supressed",
+ rule->config_file, rule->config_line, udev->kernel_name);
+ } else {
+ strlcpy(udev->name, rule->name, sizeof(udev->name));
+ apply_format(udev, udev->name, sizeof(udev->name), class_dev, sysfs_device);
+ strlcpy(udev->config_file, rule->config_file, sizeof(udev->config_file));
+ udev->config_line = rule->config_line;
+
+ info("configured rule in '%s:%i' applied, '%s' becomes '%s'",
+ rule->config_file, rule->config_line, udev->kernel_name, rule->name);
+ if (udev->type != DEV_NET)
+ dbg("name, '%s' is going to have owner='%s', group='%s', mode=%#o partitions=%i",
+ udev->name, udev->owner, udev->group, udev->mode, udev->partitions);
+ }
+ }
- strlcpy(udev->name, rule->name, sizeof(udev->name));
- apply_format(udev, udev->name, sizeof(udev->name), class_dev, sysfs_device);
- strlcpy(udev->config_file, rule->config_file, sizeof(udev->config_file));
- udev->config_line = rule->config_line;
+ if (!udev->run_final && rule->run_operation != KEY_OP_UNSET) {
+ char program[PATH_SIZE];
- if (udev->type != DEV_NET)
- dbg("name, '%s' is going to have owner='%s', group='%s', mode=%#o partitions=%i",
- udev->name, udev->owner, udev->group, udev->mode, udev->partitions);
+ if (rule->run_operation == KEY_OP_ASSIGN_FINAL)
+ udev->run_final = 1;
+ if (rule->run_operation == KEY_OP_ASSIGN || rule->run_operation == KEY_OP_ASSIGN_FINAL) {
+ struct name_entry *name_loop;
+ struct name_entry *temp_loop;
- break;
+ info("reset run list");
+ list_for_each_entry_safe(name_loop, temp_loop, &udev->run_list, node) {
+ list_del(&name_loop->node);
+ free(name_loop);
+ }
+ }
+ if (rule->run[0] != '\0') {
+ strlcpy(program, rule->run, sizeof(program));
+ apply_format(udev, program, sizeof(program), class_dev, sysfs_device);
+ dbg("add run '%s'", program);
+ name_list_add(&udev->run_list, program, 0);
+ }
}
if (rule->last_rule) {
dbg("last rule to be applied");
break;
}
-
}
}
if (udev->name[0] == '\0') {
- /* no rule matched, so we use the kernel name */
strlcpy(udev->name, udev->kernel_name, sizeof(udev->name));
info("no rule found, use kernel name '%s'", udev->name);
}
return 0;
}
+
+int udev_rules_get_run(struct udevice *udev, struct sysfs_device *sysfs_device)
+{
+ struct udev_rule *rule;
+
+ /* look for a matching rule to apply */
+ list_for_each_entry(rule, &udev_rule_list, node) {
+ dbg("process rule");
+
+ if (rule->run_operation == KEY_OP_UNSET)
+ continue;
+
+ if (rule->name_operation != KEY_OP_UNSET || rule->symlink_operation != KEY_OP_UNSET ||
+ rule->mode != 0000 || rule->owner[0] != '\0' || rule->group[0] != '\0') {
+ dbg("skip rule that names a device");
+ continue;
+ }
+
+ if (match_rule(udev, rule, NULL, sysfs_device) == 0) {
+ if (rule->ignore_device) {
+ info("configured rule in '%s[%i]' applied, '%s' is ignored",
+ rule->config_file, rule->config_line, udev->kernel_name);
+ udev->ignore_device = 1;
+ return 0;
+ }
+
+ if (!udev->run_final && rule->run_operation != KEY_OP_UNSET) {
+ char program[PATH_SIZE];
+
+ if (rule->run_operation == KEY_OP_ASSIGN || rule->run_operation == KEY_OP_ASSIGN_FINAL) {
+ struct name_entry *name_loop;
+ struct name_entry *temp_loop;
+
+ info("reset run list");
+ list_for_each_entry_safe(name_loop, temp_loop, &udev->run_list, node) {
+ list_del(&name_loop->node);
+ free(name_loop);
+ }
+ }
+ if (rule->run[0] != '\0') {
+ strlcpy(program, rule->run, sizeof(program));
+ apply_format(udev, program, sizeof(program), NULL, sysfs_device);
+ dbg("add run '%s'", program);
+ name_list_add(&udev->run_list, program, 0);
+ }
+ if (rule->run_operation == KEY_OP_ASSIGN_FINAL)
+ break;
+ }
+
+ if (rule->last_rule) {
+ dbg("last rule to be applied");
+ break;
+ }
+ }
+ }
+
+ return 0;
+}