]>
Commit | Line | Data |
---|---|---|
ea733a2f GKH |
1 | /* |
2 | * udev-add.c | |
3 | * | |
4 | * Userspace devfs | |
5 | * | |
6 | * Copyright (C) 2003 Greg Kroah-Hartman <greg@kroah.com> | |
7 | * | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify it | |
10 | * under the terms of the GNU General Public License as published by the | |
11 | * Free Software Foundation version 2 of the License. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
16 | * General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License along | |
19 | * with this program; if not, write to the Free Software Foundation, Inc., | |
20 | * 675 Mass Ave, Cambridge, MA 02139, USA. | |
21 | * | |
22 | */ | |
23 | ||
24 | #include <stdlib.h> | |
25 | #include <string.h> | |
26 | #include <stdio.h> | |
27 | #include <fcntl.h> | |
28 | #include <unistd.h> | |
29 | #include <errno.h> | |
32ff5bca | 30 | #include <sys/stat.h> |
10950dfe GKH |
31 | #include <sys/types.h> |
32 | #include <grp.h> | |
f61d732a KS |
33 | #include <net/if.h> |
34 | #include <sys/socket.h> | |
35 | #include <sys/ioctl.h> | |
36 | #include <linux/sockios.h> | |
10950dfe GKH |
37 | #ifndef __KLIBC__ |
38 | #include <pwd.h> | |
534c853d | 39 | #include <utmp.h> |
10950dfe | 40 | #endif |
ea733a2f | 41 | |
c80da508 | 42 | #include "libsysfs/sysfs/libsysfs.h" |
ea733a2f | 43 | #include "udev.h" |
c81b35c0 | 44 | #include "udev_lib.h" |
ea733a2f | 45 | #include "udev_version.h" |
54988802 | 46 | #include "logging.h" |
ea733a2f | 47 | #include "namedev.h" |
8e41d35d | 48 | #include "udevdb.h" |
10950dfe | 49 | #include "klibc_fixups.h" |
ea733a2f | 50 | |
534c853d KS |
51 | #define LOCAL_USER "$local" |
52 | ||
ea733a2f GKH |
53 | /* |
54 | * Right now the major/minor of a device is stored in a file called | |
55 | * "dev" in sysfs. | |
56 | * The number is stored as: | |
727d1ba5 | 57 | * MM:mm |
ea733a2f GKH |
58 | * MM is the major |
59 | * mm is the minor | |
727d1ba5 | 60 | * The value is in decimal. |
ea733a2f | 61 | */ |
30defadd | 62 | static int get_major_minor(struct sysfs_class_device *class_dev, struct udevice *udev) |
ea733a2f | 63 | { |
5d4754f1 | 64 | struct sysfs_attribute *attr = NULL; |
ea733a2f | 65 | |
5d4754f1 DS |
66 | attr = sysfs_get_classdev_attr(class_dev, "dev"); |
67 | if (attr == NULL) | |
bbbe503e | 68 | goto error; |
5d4754f1 | 69 | dbg("dev='%s'", attr->value); |
ea733a2f | 70 | |
5d4754f1 | 71 | if (sscanf(attr->value, "%u:%u", &udev->major, &udev->minor) != 2) |
bbbe503e | 72 | goto error; |
f7b4eca4 | 73 | dbg("found major=%d, minor=%d", udev->major, udev->minor); |
ea733a2f | 74 | |
bbbe503e KS |
75 | return 0; |
76 | error: | |
77 | return -1; | |
ea733a2f GKH |
78 | } |
79 | ||
3d150dfb KS |
80 | static int create_path(char *file) |
81 | { | |
82 | char p[NAME_SIZE]; | |
83 | char *pos; | |
84 | int retval; | |
85 | struct stat stats; | |
86 | ||
c472e3c8 | 87 | strfieldcpy(p, file); |
3d150dfb KS |
88 | pos = strchr(p+1, '/'); |
89 | while (1) { | |
90 | pos = strchr(pos+1, '/'); | |
91 | if (pos == NULL) | |
92 | break; | |
93 | *pos = 0x00; | |
94 | if (stat(p, &stats)) { | |
95 | retval = mkdir(p, 0755); | |
c5118442 | 96 | if (retval != 0) { |
3d150dfb KS |
97 | dbg("mkdir(%s) failed with error '%s'", |
98 | p, strerror(errno)); | |
99 | return retval; | |
100 | } | |
101 | dbg("created '%s'", p); | |
102 | } | |
103 | *pos = '/'; | |
104 | } | |
105 | return 0; | |
106 | } | |
107 | ||
49747bdc | 108 | static int make_node(char *file, int major, int minor, unsigned int mode, uid_t uid, gid_t gid) |
50e5de03 | 109 | { |
49747bdc KS |
110 | struct stat stats; |
111 | int retval = 0; | |
112 | ||
113 | if (stat(file, &stats) != 0) | |
114 | goto create; | |
115 | ||
116 | /* preserve node with already correct numbers, to not change the inode number */ | |
117 | if (((stats.st_mode & S_IFMT) == S_IFBLK || (stats.st_mode & S_IFMT) == S_IFCHR) && | |
118 | (stats.st_rdev == makedev(major, minor))) { | |
119 | dbg("preserve file '%s', cause it has correct dev_t", file); | |
120 | goto perms; | |
121 | } | |
122 | ||
123 | if (unlink(file) != 0) | |
124 | dbg("unlink(%s) failed with error '%s'", file, strerror(errno)); | |
125 | else | |
126 | dbg("already present file '%s' unlinked", file); | |
50e5de03 | 127 | |
49747bdc KS |
128 | create: |
129 | retval = mknod(file, mode, makedev(major, minor)); | |
50e5de03 KS |
130 | if (retval != 0) { |
131 | dbg("mknod(%s, %#o, %u, %u) failed with error '%s'", | |
49747bdc | 132 | file, mode, major, minor, strerror(errno)); |
bbbe503e | 133 | goto exit; |
50e5de03 KS |
134 | } |
135 | ||
49747bdc KS |
136 | perms: |
137 | dbg("chmod(%s, %#o)", file, mode); | |
138 | if (chmod(file, mode) != 0) { | |
139 | dbg("chmod(%s, %#o) failed with error '%s'", file, mode, strerror(errno)); | |
bbbe503e | 140 | goto exit; |
50e5de03 KS |
141 | } |
142 | ||
143 | if (uid != 0 || gid != 0) { | |
49747bdc KS |
144 | dbg("chown(%s, %u, %u)", file, uid, gid); |
145 | if (chown(file, uid, gid) != 0) { | |
50e5de03 | 146 | dbg("chown(%s, %u, %u) failed with error '%s'", |
49747bdc | 147 | file, uid, gid, strerror(errno)); |
bbbe503e | 148 | goto exit; |
50e5de03 KS |
149 | } |
150 | } | |
151 | ||
bbbe503e KS |
152 | exit: |
153 | return retval; | |
50e5de03 KS |
154 | } |
155 | ||
534c853d KS |
156 | /* get the local logged in user */ |
157 | static void set_to_local_user(char *user) | |
158 | { | |
159 | struct utmp *u; | |
160 | time_t recent = 0; | |
161 | ||
17794d77 | 162 | strfieldcpymax(user, default_owner_str, OWNER_SIZE); |
534c853d KS |
163 | setutent(); |
164 | while (1) { | |
165 | u = getutent(); | |
166 | if (u == NULL) | |
167 | break; | |
168 | ||
169 | /* is this a user login ? */ | |
170 | if (u->ut_type != USER_PROCESS) | |
171 | continue; | |
172 | ||
173 | /* is this a local login ? */ | |
174 | if (strcmp(u->ut_host, "")) | |
175 | continue; | |
176 | ||
177 | if (u->ut_time > recent) { | |
178 | recent = u->ut_time; | |
17794d77 | 179 | strfieldcpymax(user, u->ut_user, OWNER_SIZE); |
534c853d KS |
180 | dbg("local user is '%s'", user); |
181 | break; | |
182 | } | |
183 | } | |
184 | endutent(); | |
185 | } | |
186 | ||
97853b4f GKH |
187 | static int create_node(struct udevice *dev, int fake) |
188 | { | |
9fe3f9a9 KS |
189 | char filename[NAME_SIZE]; |
190 | char linkname[NAME_SIZE]; | |
191 | char linktarget[NAME_SIZE]; | |
192 | char partitionname[NAME_SIZE]; | |
e308ebb7 GKH |
193 | uid_t uid = 0; |
194 | gid_t gid = 0; | |
3d150dfb KS |
195 | int i; |
196 | int tail; | |
ef672b3d KS |
197 | char *pos; |
198 | int len; | |
3d150dfb | 199 | |
c472e3c8 KS |
200 | strfieldcpy(filename, udev_root); |
201 | strfieldcat(filename, dev->name); | |
5840bc63 GKH |
202 | |
203 | switch (dev->type) { | |
1331c889 | 204 | case 'b': |
5840bc63 | 205 | dev->mode |= S_IFBLK; |
1331c889 GKH |
206 | break; |
207 | case 'c': | |
208 | case 'u': | |
5840bc63 | 209 | dev->mode |= S_IFCHR; |
1331c889 GKH |
210 | break; |
211 | case 'p': | |
5840bc63 | 212 | dev->mode |= S_IFIFO; |
1331c889 GKH |
213 | break; |
214 | default: | |
5840bc63 | 215 | dbg("unknown node type %c\n", dev->type); |
1331c889 GKH |
216 | return -EINVAL; |
217 | } | |
0abf54fc | 218 | |
3d150dfb KS |
219 | /* create parent directories if needed */ |
220 | if (strrchr(dev->name, '/')) | |
221 | create_path(filename); | |
218eae87 | 222 | |
c5118442 | 223 | if (dev->owner[0] != '\0') { |
c19a6b30 KS |
224 | char *endptr; |
225 | unsigned long id = strtoul(dev->owner, &endptr, 10); | |
765cbd97 | 226 | if (endptr[0] == '\0') |
c19a6b30 | 227 | uid = (uid_t) id; |
10950dfe | 228 | else { |
5895eb31 | 229 | struct passwd *pw; |
534c853d KS |
230 | if (strncmp(dev->owner, LOCAL_USER, sizeof(LOCAL_USER)) == 0) |
231 | set_to_local_user(dev->owner); | |
232 | ||
5895eb31 | 233 | pw = getpwnam(dev->owner); |
765cbd97 KS |
234 | if (pw == NULL) |
235 | dbg("specified user unknown '%s'", dev->owner); | |
10950dfe GKH |
236 | else |
237 | uid = pw->pw_uid; | |
238 | } | |
c19a6b30 KS |
239 | } |
240 | ||
c5118442 | 241 | if (dev->group[0] != '\0') { |
c19a6b30 KS |
242 | char *endptr; |
243 | unsigned long id = strtoul(dev->group, &endptr, 10); | |
765cbd97 | 244 | if (endptr[0] == '\0') |
c19a6b30 | 245 | gid = (gid_t) id; |
10950dfe GKH |
246 | else { |
247 | struct group *gr = getgrnam(dev->group); | |
765cbd97 KS |
248 | if (gr == NULL) |
249 | dbg("specified group unknown '%s'", dev->group); | |
10950dfe GKH |
250 | else |
251 | gid = gr->gr_gid; | |
252 | } | |
c19a6b30 KS |
253 | } |
254 | ||
ab2e5bd9 | 255 | if (!fake) { |
50e5de03 | 256 | info("creating device node '%s'", filename); |
bbbe503e KS |
257 | if (make_node(filename, dev->major, dev->minor, dev->mode, uid, gid) != 0) |
258 | goto error; | |
ab2e5bd9 GKH |
259 | } else { |
260 | info("creating device node '%s', major = '%d', minor = '%d', " | |
261 | "mode = '%#o', uid = '%d', gid = '%d'", filename, | |
262 | dev->major, dev->minor, (mode_t)dev->mode, uid, gid); | |
263 | } | |
50e5de03 | 264 | |
bbbe503e | 265 | /* create all_partitions if requested */ |
50e5de03 KS |
266 | if (dev->partitions > 0) { |
267 | info("creating device partition nodes '%s[1-%i]'", filename, dev->partitions); | |
ab2e5bd9 GKH |
268 | if (!fake) { |
269 | for (i = 1; i <= dev->partitions; i++) { | |
c58e36c0 KS |
270 | strfieldcpy(partitionname, filename); |
271 | strintcat(partitionname, i); | |
ab2e5bd9 GKH |
272 | make_node(partitionname, dev->major, |
273 | dev->minor + i, dev->mode, uid, gid); | |
274 | } | |
50e5de03 | 275 | } |
3d150dfb KS |
276 | } |
277 | ||
bbbe503e | 278 | /* create symlink(s) if requested */ |
9fe3f9a9 | 279 | foreach_strpart(dev->symlink, " ", pos, len) { |
17794d77 | 280 | strfieldcpymax(linkname, pos, len+1); |
9fe3f9a9 KS |
281 | strfieldcpy(filename, udev_root); |
282 | strfieldcat(filename, linkname); | |
283 | dbg("symlink '%s' to node '%s' requested", filename, dev->name); | |
284 | if (!fake) | |
285 | if (strrchr(linkname, '/')) | |
286 | create_path(filename); | |
287 | ||
288 | /* optimize relative link */ | |
289 | linktarget[0] = '\0'; | |
290 | i = 0; | |
291 | tail = 0; | |
292 | while ((dev->name[i] == linkname[i]) && dev->name[i]) { | |
293 | if (dev->name[i] == '/') | |
294 | tail = i+1; | |
295 | i++; | |
296 | } | |
297 | while (linkname[i] != '\0') { | |
298 | if (linkname[i] == '/') | |
299 | strfieldcat(linktarget, "../"); | |
300 | i++; | |
301 | } | |
3d150dfb | 302 | |
9fe3f9a9 | 303 | strfieldcat(linktarget, &dev->name[tail]); |
3d150dfb | 304 | |
9fe3f9a9 KS |
305 | dbg("symlink(%s, %s)", linktarget, filename); |
306 | if (!fake) { | |
49747bdc | 307 | unlink(filename); |
bbbe503e | 308 | if (symlink(linktarget, filename) != 0) |
9fe3f9a9 KS |
309 | dbg("symlink(%s, %s) failed with error '%s'", |
310 | linktarget, filename, strerror(errno)); | |
4763256c | 311 | } |
c19a6b30 KS |
312 | } |
313 | ||
bbbe503e KS |
314 | return 0; |
315 | error: | |
316 | return -1; | |
ea733a2f GKH |
317 | } |
318 | ||
d7e954a4 | 319 | static struct sysfs_class_device *get_class_dev(char *device_name) |
ea733a2f GKH |
320 | { |
321 | char dev_path[SYSFS_PATH_MAX]; | |
63dde9f8 GKH |
322 | struct sysfs_class_device *class_dev = NULL; |
323 | ||
c472e3c8 KS |
324 | strfieldcpy(dev_path, sysfs_path); |
325 | strfieldcat(dev_path, device_name); | |
f7b4eca4 | 326 | dbg("looking at '%s'", dev_path); |
ea733a2f GKH |
327 | |
328 | /* open up the sysfs class device for this thing... */ | |
bcbe2d8e | 329 | class_dev = sysfs_open_class_device_path(dev_path); |
ea733a2f | 330 | if (class_dev == NULL) { |
bcbe2d8e | 331 | dbg ("sysfs_open_class_device_path failed"); |
63dde9f8 | 332 | goto exit; |
ea733a2f | 333 | } |
f7b4eca4 | 334 | dbg("class_dev->name='%s'", class_dev->name); |
ea733a2f | 335 | |
63dde9f8 | 336 | exit: |
ea733a2f GKH |
337 | return class_dev; |
338 | } | |
339 | ||
29fd7e67 GKH |
340 | /* wait for the "dev" file to show up in the directory in sysfs. |
341 | * If it doesn't happen in about 10 seconds, give up. | |
342 | */ | |
f61d732a KS |
343 | #define SECONDS_TO_WAIT_FOR_FILE 10 |
344 | static int sleep_for_file(char *path, char* file) | |
29fd7e67 GKH |
345 | { |
346 | char filename[SYSFS_PATH_MAX + 6]; | |
f61d732a | 347 | int loop = SECONDS_TO_WAIT_FOR_FILE; |
c332cfc7 | 348 | int retval; |
29fd7e67 | 349 | |
c472e3c8 KS |
350 | strfieldcpy(filename, sysfs_path); |
351 | strfieldcat(filename, path); | |
f61d732a | 352 | strfieldcat(filename, file); |
29fd7e67 | 353 | |
c332cfc7 RL |
354 | while (loop--) { |
355 | struct stat buf; | |
356 | ||
f7b4eca4 | 357 | dbg("looking for '%s'", filename); |
29fd7e67 | 358 | retval = stat(filename, &buf); |
c5118442 | 359 | if (retval == 0) |
29fd7e67 | 360 | goto exit; |
29fd7e67 | 361 | |
f7b4eca4 | 362 | /* sleep to give the kernel a chance to create the dev file */ |
29fd7e67 GKH |
363 | sleep(1); |
364 | } | |
365 | retval = -ENODEV; | |
366 | exit: | |
367 | return retval; | |
368 | } | |
369 | ||
bbbe503e | 370 | static int rename_net_if(struct udevice *dev, int fake) |
f61d732a KS |
371 | { |
372 | int sk; | |
373 | struct ifreq ifr; | |
374 | int retval; | |
375 | ||
bbbe503e KS |
376 | dbg("changing net interface name from '%s' to '%s'", dev->kernel_name, dev->name); |
377 | if (fake) | |
378 | return 0; | |
379 | ||
f61d732a KS |
380 | sk = socket(PF_INET, SOCK_DGRAM, 0); |
381 | if (sk < 0) { | |
382 | dbg("error opening socket"); | |
383 | return -1; | |
384 | } | |
385 | ||
386 | memset(&ifr, 0x00, sizeof(struct ifreq)); | |
387 | strfieldcpy(ifr.ifr_name, dev->kernel_name); | |
388 | strfieldcpy(ifr.ifr_newname, dev->name); | |
389 | ||
f61d732a KS |
390 | retval = ioctl(sk, SIOCSIFNAME, &ifr); |
391 | if (retval != 0) | |
392 | dbg("error changing net interface name"); | |
4a539daf | 393 | close(sk); |
f61d732a KS |
394 | |
395 | return retval; | |
396 | } | |
397 | ||
eb10f97f | 398 | int udev_add_device(char *path, char *subsystem, int fake) |
ea733a2f | 399 | { |
bbbe503e | 400 | struct sysfs_class_device *class_dev; |
5840bc63 | 401 | struct udevice dev; |
9b28a52a | 402 | char devpath[DEVPATH_SIZE]; |
bbbe503e KS |
403 | char *pos; |
404 | int retval; | |
ea733a2f | 405 | |
f3b04a2e GKH |
406 | memset(&dev, 0x00, sizeof(dev)); |
407 | ||
f61d732a | 408 | dev.type = get_device_type(path, subsystem); |
f61d732a KS |
409 | switch (dev.type) { |
410 | case 'b': | |
411 | case 'c': | |
412 | retval = sleep_for_file(path, "/dev"); | |
413 | break; | |
414 | ||
415 | case 'n': | |
416 | retval = sleep_for_file(path, "/address"); | |
417 | break; | |
418 | ||
419 | default: | |
420 | dbg("unknown device type '%c'", dev.type); | |
bbbe503e | 421 | return -1; |
f61d732a | 422 | } |
63dde9f8 | 423 | |
5840bc63 | 424 | class_dev = get_class_dev(path); |
ea733a2f | 425 | if (class_dev == NULL) |
bbbe503e | 426 | return -1; |
ea733a2f | 427 | |
f61d732a KS |
428 | if (dev.type == 'b' || dev.type == 'c') { |
429 | retval = get_major_minor(class_dev, &dev); | |
430 | if (retval != 0) { | |
431 | dbg("get_major_minor failed"); | |
432 | goto exit; | |
433 | } | |
ea733a2f GKH |
434 | } |
435 | ||
bbbe503e | 436 | if (namedev_name_device(class_dev, &dev) != 0) |
30defadd GKH |
437 | goto exit; |
438 | ||
f7b4eca4 | 439 | dbg("name='%s'", dev.name); |
bbbe503e | 440 | |
f61d732a KS |
441 | switch (dev.type) { |
442 | case 'b': | |
443 | case 'c': | |
444 | retval = create_node(&dev, fake); | |
c4603a07 | 445 | if (retval != 0) |
bbbe503e | 446 | goto exit; |
c4603a07 | 447 | if ((!fake) && (udevdb_add_dev(path, &dev) != 0)) |
bbbe503e KS |
448 | dbg("udevdb_add_dev failed, but we are going to try " |
449 | "to create the node anyway. But remove might not " | |
450 | "work properly for this device."); | |
9b28a52a KS |
451 | |
452 | dev_d_send(&dev, subsystem, path); | |
f61d732a KS |
453 | break; |
454 | ||
455 | case 'n': | |
a41de030 | 456 | strfieldcpy(devpath, path); |
bbbe503e KS |
457 | if (strcmp(dev.name, dev.kernel_name) != 0) { |
458 | retval = rename_net_if(&dev, fake); | |
c4603a07 | 459 | if (retval != 0) |
bbbe503e KS |
460 | goto exit; |
461 | /* netif's are keyed with the configured name, cause | |
462 | * the original kernel name sleeps with the fishes | |
463 | */ | |
9b28a52a | 464 | pos = strrchr(devpath, '/'); |
bbbe503e KS |
465 | if (pos != NULL) { |
466 | pos[1] = '\0'; | |
9b28a52a | 467 | strfieldcat(devpath, dev.name); |
bbbe503e KS |
468 | } |
469 | } | |
c4603a07 | 470 | if ((!fake) && (udevdb_add_dev(devpath, &dev) != 0)) |
bbbe503e | 471 | dbg("udevdb_add_dev failed"); |
9b28a52a KS |
472 | |
473 | dev_d_send(&dev, subsystem, devpath); | |
f61d732a KS |
474 | break; |
475 | } | |
ea733a2f GKH |
476 | |
477 | exit: | |
bbbe503e | 478 | sysfs_close_class_device(class_dev); |
30defadd | 479 | |
ea733a2f GKH |
480 | return retval; |
481 | } |