Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 1 | /* vi:set ts=4: |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 2 | * |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 3 | * mdev - Mini udev for busybox |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 4 | * |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 5 | * Copyright 2005 Rob Landley <rob@landley.net> |
| 6 | * Copyright 2005 Frank Sorenson <frank@tuxrocks.com> |
| 7 | * |
| 8 | * Licensed under GPLv2 or later, see file LICENSE in this tarball for details. |
| 9 | */ |
| 10 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 11 | #include <ctype.h> |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 12 | #include <dirent.h> |
| 13 | #include <errno.h> |
| 14 | #include <fcntl.h> |
| 15 | #include <stdio.h> |
| 16 | #include <string.h> |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 17 | #include <sys/mman.h> |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 18 | #include <sys/stat.h> |
Rob Landley | a7e3d05 | 2006-02-21 06:11:13 +0000 | [diff] [blame] | 19 | #include <sys/sysmacros.h> |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 20 | #include <sys/types.h> |
| 21 | #include <unistd.h> |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 22 | #include <stdlib.h> |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 23 | #include "busybox.h" |
| 24 | #include "xregex.h" |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 25 | |
Rob Landley | 9bdd742 | 2005-12-17 10:54:17 +0000 | [diff] [blame] | 26 | #define DEV_PATH "/dev" |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 27 | #define MDEV_CONF "/etc/mdev.conf" |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 28 | |
| 29 | #include <busybox.h> |
| 30 | |
Rob Landley | a7e3d05 | 2006-02-21 06:11:13 +0000 | [diff] [blame] | 31 | int root_major, root_minor; |
| 32 | |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 33 | /* mknod in /dev based on a path like "/sys/block/hda/hda1" */ |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 34 | static void make_device(char *path) |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 35 | { |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 36 | char *device_name, *s; |
| 37 | int major, minor, type, len, fd; |
| 38 | int mode = 0660; |
| 39 | uid_t uid = 0; |
| 40 | gid_t gid = 0; |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 41 | char *temp = path + strlen(path); |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 42 | |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 43 | /* Try to read major/minor string. Note that the kernel puts \n after |
| 44 | * the data, so we don't need to worry about null terminating the string |
| 45 | * because sscanf() will stop at the first nondigit, which \n is. We |
| 46 | * also depend on path having writeable space after it. */ |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 47 | |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 48 | strcat(path, "/dev"); |
| 49 | fd = open(path, O_RDONLY); |
| 50 | len = read(fd, temp + 1, 64); |
| 51 | *temp++ = 0; |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 52 | close(fd); |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 53 | if (len < 1) return; |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 54 | |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 55 | /* Determine device name, type, major and minor */ |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 56 | |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 57 | device_name = strrchr(path, '/') + 1; |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 58 | type = path[5]=='c' ? S_IFCHR : S_IFBLK; |
| 59 | if (sscanf(temp, "%d:%d", &major, &minor) != 2) return; |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 60 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 61 | /* If we have a config file, look up permissions for this device */ |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 62 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 63 | if (ENABLE_FEATURE_MDEV_CONF) { |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 64 | char *conf, *pos, *end; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 65 | |
| 66 | /* mmap the config file */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 67 | if (-1 != (fd=open(MDEV_CONF,O_RDONLY))) { |
| 68 | len = lseek(fd, 0, SEEK_END); |
| 69 | conf = mmap(NULL, len, PROT_READ, MAP_PRIVATE, fd, 0); |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 70 | if (conf) { |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 71 | int line = 0; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 72 | |
| 73 | /* Loop through lines in mmaped file*/ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 74 | for (pos=conf; pos-conf<len;) { |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 75 | int field; |
| 76 | char *end2; |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 77 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 78 | line++; |
| 79 | /* find end of this line */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 80 | for(end=pos; end-conf<len && *end!='\n'; end++) |
| 81 | ; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 82 | |
| 83 | /* Three fields: regex, uid:gid, mode */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 84 | for (field=3; field; field--) { |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 85 | /* Skip whitespace */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 86 | while (pos<end && isspace(*pos)) |
| 87 | pos++; |
| 88 | if (pos==end || *pos=='#') |
| 89 | break; |
| 90 | for (end2=pos; end2<end && !isspace(*end2) && *end2!='#'; end2++) |
| 91 | ; |
| 92 | |
| 93 | switch (field) { |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 94 | /* Regex to match this device */ |
| 95 | case 3: |
| 96 | { |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 97 | char *regex = strndupa(pos,end2-pos); |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 98 | regex_t match; |
| 99 | regmatch_t off; |
| 100 | int result; |
| 101 | |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 102 | /* Is this it? */ |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 103 | xregcomp(&match,regex,REG_EXTENDED); |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 104 | result = regexec(&match,device_name,1,&off,0); |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 105 | regfree(&match); |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 106 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 107 | /* If not this device, skip rest of line */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 108 | if (result || off.rm_so || off.rm_eo!=strlen(device_name)) |
| 109 | goto end_line; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 110 | |
| 111 | break; |
| 112 | } |
| 113 | /* uid:gid */ |
| 114 | case 2: |
| 115 | { |
| 116 | char *s2; |
| 117 | |
| 118 | /* Find : */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 119 | for(s=pos; s<end2 && *s!=':'; s++) |
| 120 | ; |
| 121 | if (s == end2) |
| 122 | goto end_line; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 123 | |
| 124 | /* Parse UID */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 125 | uid = strtoul(pos,&s2,10); |
| 126 | if (s != s2) { |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 127 | struct passwd *pass; |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 128 | pass = getpwnam(strndupa(pos,s-pos)); |
| 129 | if (!pass) |
| 130 | goto end_line; |
| 131 | uid = pass->pw_uid; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 132 | } |
| 133 | s++; |
| 134 | /* parse GID */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 135 | gid = strtoul(s,&s2,10); |
| 136 | if (end2 != s2) { |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 137 | struct group *grp; |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 138 | grp = getgrnam(strndupa(s,end2-s)); |
| 139 | if (!grp) |
| 140 | goto end_line; |
| 141 | gid = grp->gr_gid; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 142 | } |
| 143 | break; |
| 144 | } |
| 145 | /* mode */ |
| 146 | case 1: |
| 147 | { |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 148 | mode = strtoul(pos,&pos,8); |
| 149 | if (pos != end2) |
| 150 | goto end_line; |
| 151 | else |
| 152 | goto found_device; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 153 | } |
| 154 | } |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 155 | pos = end2; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 156 | } |
| 157 | end_line: |
| 158 | /* Did everything parse happily? */ |
| 159 | if (field && field!=3) |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 160 | bb_error_msg_and_die("Bad line %d",line); |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 161 | |
| 162 | /* Next line */ |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 163 | pos = ++end; |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 164 | } |
| 165 | found_device: |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 166 | munmap(conf, len); |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 167 | } |
| 168 | close(fd); |
| 169 | } |
| 170 | } |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 171 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 172 | umask(0); |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 173 | if (mknod(device_name, mode | type, makedev(major, minor)) && errno != EEXIST) |
| 174 | bb_perror_msg_and_die("mknod %s failed", device_name); |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 175 | |
Rob Landley | a7e3d05 | 2006-02-21 06:11:13 +0000 | [diff] [blame] | 176 | if (major==root_major && minor==root_minor) |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 177 | symlink(device_name, "root"); |
Rob Landley | a7e3d05 | 2006-02-21 06:11:13 +0000 | [diff] [blame] | 178 | |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 179 | if (ENABLE_FEATURE_MDEV_CONF) chown(device_name, uid, gid); |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 180 | } |
| 181 | |
| 182 | /* Recursive search of /sys/block or /sys/class. path must be a writeable |
| 183 | * buffer of size PATH_MAX containing the directory string to start at. */ |
| 184 | |
Rob Landley | b56c285 | 2005-12-17 10:52:30 +0000 | [diff] [blame] | 185 | static void find_dev(char *path) |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 186 | { |
| 187 | DIR *dir; |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 188 | size_t len = strlen(path); |
Mike Frysinger | 248d222 | 2006-02-03 00:19:42 +0000 | [diff] [blame] | 189 | struct dirent *entry; |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 190 | |
Mike Frysinger | 248d222 | 2006-02-03 00:19:42 +0000 | [diff] [blame] | 191 | if ((dir = opendir(path)) == NULL) |
| 192 | return; |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 193 | |
Mike Frysinger | 248d222 | 2006-02-03 00:19:42 +0000 | [diff] [blame] | 194 | while ((entry = readdir(dir)) != NULL) { |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 195 | |
| 196 | /* Skip "." and ".." (also skips hidden files, which is ok) */ |
| 197 | |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 198 | if (entry->d_name[0] == '.') |
| 199 | continue; |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 200 | |
| 201 | if (entry->d_type == DT_DIR) { |
| 202 | snprintf(path+len, PATH_MAX-len, "/%s", entry->d_name); |
| 203 | find_dev(path); |
Mike Frysinger | 271aa40 | 2006-02-07 06:10:45 +0000 | [diff] [blame] | 204 | path[len] = 0; |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 205 | } |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 206 | |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 207 | /* If there's a dev entry, mknod it */ |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 208 | |
Rob Landley | e927743 | 2006-01-22 23:14:16 +0000 | [diff] [blame] | 209 | if (!strcmp(entry->d_name, "dev")) make_device(path); |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 210 | } |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 211 | |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 212 | closedir(dir); |
| 213 | } |
| 214 | |
| 215 | int mdev_main(int argc, char *argv[]) |
| 216 | { |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 217 | char *action; |
| 218 | char *env_path; |
| 219 | RESERVE_CONFIG_BUFFER(temp,PATH_MAX); |
| 220 | |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 221 | bb_xchdir(DEV_PATH); |
| 222 | |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 223 | /* Scan */ |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 224 | |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 225 | if (argc == 2 && !strcmp(argv[1],"-s")) { |
Rob Landley | a7e3d05 | 2006-02-21 06:11:13 +0000 | [diff] [blame] | 226 | struct stat st; |
| 227 | |
| 228 | stat("/", &st); // If this fails, we have bigger problems. |
| 229 | root_major=major(st.st_dev); |
| 230 | root_minor=minor(st.st_dev); |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 231 | strcpy(temp,"/sys/block"); |
| 232 | find_dev(temp); |
| 233 | strcpy(temp,"/sys/class"); |
| 234 | find_dev(temp); |
| 235 | |
| 236 | /* Hotplug */ |
| 237 | |
| 238 | } else { |
| 239 | action = getenv("ACTION"); |
| 240 | env_path = getenv("DEVPATH"); |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 241 | if (!action || !env_path) |
| 242 | bb_show_usage(); |
Tim Riker | c1ef7bd | 2006-01-25 00:08:53 +0000 | [diff] [blame] | 243 | |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 244 | if (!strcmp(action, "add")) { |
| 245 | sprintf(temp, "/sys%s", env_path); |
| 246 | make_device(temp); |
| 247 | } else if (!strcmp(action, "remove")) { |
Rob Landley | 15fe2e1 | 2006-05-08 02:53:23 +0000 | [diff] [blame] | 248 | unlink(strrchr(env_path, '/') + 1); |
Rob Landley | 29e08ff | 2006-01-12 06:13:50 +0000 | [diff] [blame] | 249 | } |
| 250 | } |
| 251 | |
Mike Frysinger | a421ba8 | 2006-02-03 00:25:37 +0000 | [diff] [blame] | 252 | if (ENABLE_FEATURE_CLEAN_UP) RELEASE_CONFIG_BUFFER(temp); |
Rob Landley | 70f7ef7 | 2005-12-13 08:21:33 +0000 | [diff] [blame] | 253 | return 0; |
| 254 | } |