projects / project / fstools.git / blob
? search:


107ba64d75b3545070a59b284d74c794ce0f0d69
[project/fstools.git] / block.c
1 /*
2 * Copyright (C) 2013 Felix Fietkau <nbd@openwrt.org>
3 * Copyright (C) 2013 John Crispin <blogic@openwrt.org>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU Lesser General Public License version 2.1
7 * as published by the Free Software Foundation
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 */
14
15 #define _GNU_SOURCE
16 #include <getopt.h>
17 #include <stdio.h>
18 #include <unistd.h>
19 #include <syslog.h>
20 #include <libgen.h>
21 #include <glob.h>
22
23 #include <sys/stat.h>
24 #include <sys/types.h>
25 #include <sys/swap.h>
26 #include <sys/mount.h>
27 #include <sys/wait.h>
28
29 #include <uci.h>
30 #include <uci_blob.h>
31
32 #include <libubox/list.h>
33 #include <libubox/vlist.h>
34 #include <libubox/blobmsg_json.h>
35 #include <libubox/avl-cmp.h>
36
37 #include "libblkid-tiny/libblkid-tiny.h"
38
39 #ifdef UBIFS_EXTROOT
40 #include "libubi/libubi.h"
41 #endif
42
43 #define ERROR(fmt, ...) do { \
44 syslog(LOG_ERR, fmt, ## __VA_ARGS__); \
45 fprintf(stderr, "block: "fmt, ## __VA_ARGS__); \
46 } while (0)
47
48 enum {
49 TYPE_MOUNT,
50 TYPE_SWAP,
51 };
52
53 struct mount {
54 struct vlist_node node;
55 int type;
56
57 char *target;
58 char *path;
59 char *options;
60 uint32_t flags;
61 char *uuid;
62 char *label;
63 char *device;
64 int extroot;
65 int overlay;
66 int disabled_fsck;
67 unsigned int prio;
68 };
69
70 static struct vlist_tree mounts;
71 static struct blob_buf b;
72 static LIST_HEAD(devices);
73 static int anon_mount, anon_swap, auto_mount, auto_swap, check_fs;
74 static unsigned int delay_root;
75
76 enum {
77 CFG_ANON_MOUNT,
78 CFG_ANON_SWAP,
79 CFG_AUTO_MOUNT,
80 CFG_AUTO_SWAP,
81 CFG_DELAY_ROOT,
82 CFG_CHECK_FS,
83 __CFG_MAX
84 };
85
86 static const struct blobmsg_policy config_policy[__CFG_MAX] = {
87 [CFG_ANON_SWAP] = { .name = "anon_swap", .type = BLOBMSG_TYPE_INT32 },
88 [CFG_ANON_MOUNT] = { .name = "anon_mount", .type = BLOBMSG_TYPE_INT32 },
89 [CFG_AUTO_SWAP] = { .name = "auto_swap", .type = BLOBMSG_TYPE_INT32 },
90 [CFG_AUTO_MOUNT] = { .name = "auto_mount", .type = BLOBMSG_TYPE_INT32 },
91 [CFG_DELAY_ROOT] = { .name = "delay_root", .type = BLOBMSG_TYPE_INT32 },
92 [CFG_CHECK_FS] = { .name = "check_fs", .type = BLOBMSG_TYPE_INT32 },
93 };
94
95 enum {
96 MOUNT_UUID,
97 MOUNT_LABEL,
98 MOUNT_ENABLE,
99 MOUNT_TARGET,
100 MOUNT_DEVICE,
101 MOUNT_OPTIONS,
102 __MOUNT_MAX
103 };
104
105 static const struct uci_blob_param_list config_attr_list = {
106 .n_params = __CFG_MAX,
107 .params = config_policy,
108 };
109
110 static const struct blobmsg_policy mount_policy[__MOUNT_MAX] = {
111 [MOUNT_UUID] = { .name = "uuid", .type = BLOBMSG_TYPE_STRING },
112 [MOUNT_LABEL] = { .name = "label", .type = BLOBMSG_TYPE_STRING },
113 [MOUNT_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
114 [MOUNT_TARGET] = { .name = "target", .type = BLOBMSG_TYPE_STRING },
115 [MOUNT_OPTIONS] = { .name = "options", .type = BLOBMSG_TYPE_STRING },
116 [MOUNT_ENABLE] = { .name = "enabled", .type = BLOBMSG_TYPE_INT32 },
117 };
118
119 static const struct uci_blob_param_list mount_attr_list = {
120 .n_params = __MOUNT_MAX,
121 .params = mount_policy,
122 };
123
124 enum {
125 SWAP_ENABLE,
126 SWAP_UUID,
127 SWAP_LABEL,
128 SWAP_DEVICE,
129 SWAP_PRIO,
130 __SWAP_MAX
131 };
132
133 static const struct blobmsg_policy swap_policy[__SWAP_MAX] = {
134 [SWAP_ENABLE] = { .name = "enabled", .type = BLOBMSG_TYPE_INT32 },
135 [SWAP_UUID] = { .name = "uuid", .type = BLOBMSG_TYPE_STRING },
136 [SWAP_LABEL] = { .name = "label", .type = BLOBMSG_TYPE_STRING },
137 [SWAP_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
138 [SWAP_PRIO] = { .name = "priority", .type = BLOBMSG_TYPE_INT32 },
139 };
140
141 static const struct uci_blob_param_list swap_attr_list = {
142 .n_params = __SWAP_MAX,
143 .params = swap_policy,
144 };
145
146 struct mount_flag {
147 const char *name;
148 int32_t flag;
149 };
150
151 #ifndef MS_DIRSYNC
152 # define MS_DIRSYNC (1 << 7)
153 #endif
154
155 #ifndef MS_RELATIME
156 # define MS_RELATIME (1 << 21)
157 #endif
158
159 #ifndef MS_STRICTATIME
160 # define MS_STRICTATIME (1 << 24)
161 #endif
162
163 static const struct mount_flag mount_flags[] = {
164 { "sync", MS_SYNCHRONOUS },
165 { "async", ~MS_SYNCHRONOUS },
166 { "dirsync", MS_DIRSYNC },
167 { "mand", MS_MANDLOCK },
168 { "nomand", ~MS_MANDLOCK },
169 { "atime", ~MS_NOATIME },
170 { "noatime", MS_NOATIME },
171 { "dev", ~MS_NODEV },
172 { "nodev", MS_NODEV },
173 { "diratime", ~MS_NODIRATIME },
174 { "nodiratime", MS_NODIRATIME },
175 { "exec", ~MS_NOEXEC },
176 { "noexec", MS_NOEXEC },
177 { "suid", ~MS_NOSUID },
178 { "nosuid", MS_NOSUID },
179 { "rw", ~MS_RDONLY },
180 { "ro", MS_RDONLY },
181 { "relatime", MS_RELATIME },
182 { "norelatime", ~MS_RELATIME },
183 { "strictatime", MS_STRICTATIME },
184 };
185
186 static char *blobmsg_get_strdup(struct blob_attr *attr)
187 {
188 if (!attr)
189 return NULL;
190
191 return strdup(blobmsg_get_string(attr));
192 }
193
194 static char *blobmsg_get_basename(struct blob_attr *attr)
195 {
196 if (!attr)
197 return NULL;
198
199 return strdup(basename(blobmsg_get_string(attr)));
200 }
201
202 static void parse_mount_options(struct mount *m, char *optstr)
203 {
204 int i;
205 bool is_flag;
206 char *p, *opts, *last;
207
208 m->flags = 0;
209 m->options = NULL;
210
211 if (!optstr || !*optstr)
212 return;
213
214 m->options = opts = calloc(1, strlen(optstr) + 1);
215
216 if (!m->options)
217 return;
218
219 p = last = optstr;
220
221 do {
222 p = strchr(p, ',');
223
224 if (p)
225 *p++ = 0;
226
227 for (i = 0, is_flag = false; i < ARRAY_SIZE(mount_flags); i++) {
228 if (!strcmp(last, mount_flags[i].name)) {
229 if (mount_flags[i].flag < 0)
230 m->flags &= (uint32_t)mount_flags[i].flag;
231 else
232 m->flags |= (uint32_t)mount_flags[i].flag;
233 is_flag = true;
234 break;
235 }
236 }
237
238 if (!is_flag)
239 opts += sprintf(opts, "%s%s", (opts > m->options) ? "," : "", last);
240
241 last = p;
242
243 } while (p);
244
245 free(optstr);
246 }
247
248 static int mount_add(struct uci_section *s)
249 {
250 struct blob_attr *tb[__MOUNT_MAX] = { 0 };
251 struct mount *m;
252
253 blob_buf_init(&b, 0);
254 uci_to_blob(&b, s, &mount_attr_list);
255 blobmsg_parse(mount_policy, __MOUNT_MAX, tb, blob_data(b.head), blob_len(b.head));
256
257 if (!tb[MOUNT_LABEL] && !tb[MOUNT_UUID] && !tb[MOUNT_DEVICE])
258 return -1;
259
260 if (tb[MOUNT_ENABLE] && !blobmsg_get_u32(tb[MOUNT_ENABLE]))
261 return -1;
262
263 m = malloc(sizeof(struct mount));
264 m->type = TYPE_MOUNT;
265 m->uuid = blobmsg_get_strdup(tb[MOUNT_UUID]);
266 m->label = blobmsg_get_strdup(tb[MOUNT_LABEL]);
267 m->target = blobmsg_get_strdup(tb[MOUNT_TARGET]);
268 m->device = blobmsg_get_basename(tb[MOUNT_DEVICE]);
269
270 parse_mount_options(m, blobmsg_get_strdup(tb[MOUNT_OPTIONS]));
271
272 m->overlay = m->extroot = 0;
273 if (m->target && !strcmp(m->target, "/"))
274 m->extroot = 1;
275 if (m->target && !strcmp(m->target, "/overlay"))
276 m->extroot = m->overlay = 1;
277
278 if (m->uuid)
279 vlist_add(&mounts, &m->node, m->uuid);
280 else if (m->label)
281 vlist_add(&mounts, &m->node, m->label);
282 else if (m->device)
283 vlist_add(&mounts, &m->node, m->device);
284
285 return 0;
286 }
287
288 static int swap_add(struct uci_section *s)
289 {
290 struct blob_attr *tb[__SWAP_MAX] = { 0 };
291 struct mount *m;
292
293 blob_buf_init(&b, 0);
294 uci_to_blob(&b, s, &swap_attr_list);
295 blobmsg_parse(swap_policy, __SWAP_MAX, tb, blob_data(b.head), blob_len(b.head));
296
297 if (!tb[SWAP_UUID] && !tb[SWAP_LABEL] && !tb[SWAP_DEVICE])
298 return -1;
299
300 m = malloc(sizeof(struct mount));
301 memset(m, 0, sizeof(struct mount));
302 m->type = TYPE_SWAP;
303 m->uuid = blobmsg_get_strdup(tb[SWAP_UUID]);
304 m->label = blobmsg_get_strdup(tb[SWAP_LABEL]);
305 m->device = blobmsg_get_basename(tb[SWAP_DEVICE]);
306 if (tb[SWAP_PRIO])
307 m->prio = blobmsg_get_u32(tb[SWAP_PRIO]);
308 if (m->prio)
309 m->prio = ((m->prio << SWAP_FLAG_PRIO_SHIFT) & SWAP_FLAG_PRIO_MASK) | SWAP_FLAG_PREFER;
310
311 if ((!tb[SWAP_ENABLE]) || blobmsg_get_u32(tb[SWAP_ENABLE])) {
312 /* store complete swap path */
313 if (tb[SWAP_DEVICE])
314 m->target = blobmsg_get_strdup(tb[SWAP_DEVICE]);
315
316 if (m->uuid)
317 vlist_add(&mounts, &m->node, m->uuid);
318 else if (m->label)
319 vlist_add(&mounts, &m->node, m->label);
320 else if (m->device)
321 vlist_add(&mounts, &m->node, m->device);
322 }
323
324 return 0;
325 }
326
327 static int global_add(struct uci_section *s)
328 {
329 struct blob_attr *tb[__CFG_MAX] = { 0 };
330
331 blob_buf_init(&b, 0);
332 uci_to_blob(&b, s, &config_attr_list);
333 blobmsg_parse(config_policy, __CFG_MAX, tb, blob_data(b.head), blob_len(b.head));
334
335 if ((tb[CFG_ANON_MOUNT]) && blobmsg_get_u32(tb[CFG_ANON_MOUNT]))
336 anon_mount = 1;
337 if ((tb[CFG_ANON_SWAP]) && blobmsg_get_u32(tb[CFG_ANON_SWAP]))
338 anon_swap = 1;
339
340 if ((tb[CFG_AUTO_MOUNT]) && blobmsg_get_u32(tb[CFG_AUTO_MOUNT]))
341 auto_mount = 1;
342 if ((tb[CFG_AUTO_SWAP]) && blobmsg_get_u32(tb[CFG_AUTO_SWAP]))
343 auto_swap = 1;
344
345 if (tb[CFG_DELAY_ROOT])
346 delay_root = blobmsg_get_u32(tb[CFG_DELAY_ROOT]);
347
348 if ((tb[CFG_CHECK_FS]) && blobmsg_get_u32(tb[CFG_CHECK_FS]))
349 check_fs = 1;
350
351 return 0;
352 }
353
354 static struct mount* find_swap(const char *uuid, const char *label, const char *device)
355 {
356 struct mount *m;
357
358 vlist_for_each_element(&mounts, m, node) {
359 if (m->type != TYPE_SWAP)
360 continue;
361 if (uuid && m->uuid && !strcasecmp(m->uuid, uuid))
362 return m;
363 if (label && m->label && !strcmp(m->label, label))
364 return m;
365 if (device && m->device && !strcmp(m->device, device))
366 return m;
367 }
368
369 return NULL;
370 }
371
372 static struct mount* find_block(const char *uuid, const char *label, const char *device,
373 const char *target)
374 {
375 struct mount *m;
376
377 vlist_for_each_element(&mounts, m, node) {
378 if (m->type != TYPE_MOUNT)
379 continue;
380 if (m->uuid && uuid && !strcasecmp(m->uuid, uuid))
381 return m;
382 if (m->label && label && !strcmp(m->label, label))
383 return m;
384 if (m->target && target && !strcmp(m->target, target))
385 return m;
386 if (m->device && device && !strcmp(m->device, device))
387 return m;
388 }
389
390 return NULL;
391 }
392
393 static void mounts_update(struct vlist_tree *tree, struct vlist_node *node_new,
394 struct vlist_node *node_old)
395 {
396 }
397
398 static int config_load(char *cfg)
399 {
400 struct uci_context *ctx;
401 struct uci_package *pkg;
402 struct uci_element *e;
403
404 vlist_init(&mounts, avl_strcmp, mounts_update);
405
406 ctx = uci_alloc_context();
407 if (cfg) {
408 char path[32];
409 snprintf(path, 32, "%s/etc/config", cfg);
410 uci_set_confdir(ctx, path);
411 }
412
413 if (uci_load(ctx, "fstab", &pkg))
414 {
415 char *err;
416 uci_get_errorstr(ctx, &err, "fstab");
417 ERROR("extroot: failed to load %s/etc/config/%s\n",
418 cfg ? cfg : "", err);
419 free(err);
420 return -1;
421 }
422
423 vlist_update(&mounts);
424 uci_foreach_element(&pkg->sections, e) {
425 struct uci_section *s = uci_to_section(e);
426
427 if (!strcmp(s->type, "mount"))
428 mount_add(s);
429 if (!strcmp(s->type, "swap"))
430 swap_add(s);
431 if (!strcmp(s->type, "global"))
432 global_add(s);
433 }
434 vlist_flush(&mounts);
435
436 return 0;
437 }
438
439 static struct blkid_struct_probe* _probe_path(char *path)
440 {
441 struct blkid_struct_probe *pr;
442
443 pr = malloc(sizeof(*pr));
444
445 if (!pr)
446 return NULL;
447
448 memset(pr, 0, sizeof(*pr));
449 probe_block(path, pr);
450
451 if (pr->err || !pr->id) {
452 free(pr);
453 return NULL;
454 }
455
456 return pr;
457 }
458
459 static int _cache_load(const char *path)
460 {
461 int gl_flags = GLOB_NOESCAPE | GLOB_MARK;
462 int j;
463 glob_t gl;
464
465 if (glob(path, gl_flags, NULL, &gl) < 0)
466 return -1;
467
468 for (j = 0; j < gl.gl_pathc; j++) {
469 struct blkid_struct_probe *pr = _probe_path(gl.gl_pathv[j]);
470 if (pr)
471 list_add_tail(&pr->list, &devices);
472 }
473
474 globfree(&gl);
475
476 return 0;
477 }
478
479 static void cache_load(int mtd)
480 {
481 if (mtd) {
482 _cache_load("/dev/mtdblock*");
483 _cache_load("/dev/ubiblock*");
484 _cache_load("/dev/ubi?*_?*");
485 }
486 _cache_load("/dev/mmcblk*");
487 _cache_load("/dev/sd*");
488 _cache_load("/dev/hd*");
489 _cache_load("/dev/md*");
490 _cache_load("/dev/vd*");
491 _cache_load("/dev/mapper/*");
492 }
493
494 static int print_block_info(struct blkid_struct_probe *pr)
495 {
496 printf("%s:", pr->dev);
497 if (pr->uuid[0])
498 printf(" UUID=\"%s\"", pr->uuid);
499
500 if (pr->label[0])
501 printf(" LABEL=\"%s\"", pr->label);
502
503 if (pr->name[0])
504 printf(" NAME=\"%s\"", pr->name);
505
506 if (pr->version[0])
507 printf(" VERSION=\"%s\"", pr->version);
508
509 printf(" TYPE=\"%s\"\n", pr->id->name);
510
511 return 0;
512 }
513
514 static int print_block_uci(struct blkid_struct_probe *pr)
515 {
516 if (!strcmp(pr->id->name, "swap")) {
517 printf("config 'swap'\n");
518 } else {
519 printf("config 'mount'\n");
520 printf("\toption\ttarget\t'/mnt/%s'\n", basename(pr->dev));
521 }
522 if (pr->uuid[0])
523 printf("\toption\tuuid\t'%s'\n", pr->uuid);
524 else
525 printf("\toption\tdevice\t'%s'\n", pr->dev);
526 printf("\toption\tenabled\t'0'\n\n");
527
528 return 0;
529 }
530
531 static struct blkid_struct_probe* find_block_info(char *uuid, char *label, char *path)
532 {
533 struct blkid_struct_probe *pr = NULL;
534
535 if (uuid)
536 list_for_each_entry(pr, &devices, list)
537 if (!strcasecmp(pr->uuid, uuid))
538 return pr;
539
540 if (label)
541 list_for_each_entry(pr, &devices, list)
542 if (!strcmp(pr->label, label))
543 return pr;
544
545 if (path)
546 list_for_each_entry(pr, &devices, list)
547 if (!strcmp(basename(pr->dev), basename(path)))
548 return pr;
549
550 return NULL;
551 }
552
553 static char* find_mount_point(char *block)
554 {
555 FILE *fp = fopen("/proc/mounts", "r");
556 static char line[256];
557 int len = strlen(block);
558 char *point = NULL;
559
560 if(!fp)
561 return NULL;
562
563 while (fgets(line, sizeof(line), fp)) {
564 if (!strncmp(line, block, len)) {
565 char *p = &line[len + 1];
566 char *t = strstr(p, " ");
567
568 if (!t) {
569 fclose(fp);
570 return NULL;
571 }
572 *t = '\0';
573 point = p;
574 break;
575 }
576 }
577
578 fclose(fp);
579
580 return point;
581 }
582
583 static void mkdir_p(char *dir)
584 {
585 char *l = strrchr(dir, '/');
586
587 if (l) {
588 *l = '\0';
589 mkdir_p(dir);
590 *l = '/';
591 mkdir(dir, 0755);
592 }
593 }
594
595 static void check_filesystem(struct blkid_struct_probe *pr)
596 {
597 pid_t pid;
598 struct stat statbuf;
599 char *e2fsck = "/usr/sbin/e2fsck";
600
601 /* UBIFS does not need stuff like fsck */
602 if (!strncmp(pr->id->name, "ubifs", 5))
603 return;
604
605 if (strncmp(pr->id->name, "ext", 3)) {
606 ERROR("check_filesystem: %s is not supported\n", pr->id->name);
607 return;
608 }
609
610 if (stat(e2fsck, &statbuf) < 0) {
611 ERROR("check_filesystem: %s not found\n", e2fsck);
612 return;
613 }
614
615 pid = fork();
616 if (!pid) {
617 execl(e2fsck, e2fsck, "-p", pr->dev, NULL);
618 exit(-1);
619 } else if (pid > 0) {
620 int status;
621
622 waitpid(pid, &status, 0);
623 if (WEXITSTATUS(status))
624 ERROR("check_filesystem: %s returned %d\n", e2fsck, WEXITSTATUS(status));
625 }
626 }
627
628 static void handle_swapfiles(bool on)
629 {
630 struct stat s;
631 struct mount *m;
632 struct blkid_struct_probe *pr;
633
634 vlist_for_each_element(&mounts, m, node)
635 {
636 if (m->type != TYPE_SWAP || !m->target)
637 continue;
638
639 if (stat(m->target, &s) || !S_ISREG(s.st_mode))
640 continue;
641
642 pr = _probe_path(m->target);
643
644 if (!pr)
645 continue;
646
647 if (!strcmp(pr->id->name, "swap")) {
648 if (on)
649 swapon(pr->dev, m->prio);
650 else
651 swapoff(pr->dev);
652 }
653
654 free(pr);
655 }
656 }
657
658 static int mount_device(struct blkid_struct_probe *pr, int hotplug)
659 {
660 struct mount *m;
661 char *device;
662
663 if (!pr)
664 return -1;
665
666 device = basename(pr->dev);
667
668 if (!strcmp(pr->id->name, "swap")) {
669 if (hotplug && !auto_swap)
670 return -1;
671 m = find_swap(pr->uuid, pr->label, device);
672 if (m || anon_swap)
673 swapon(pr->dev, (m) ? (m->prio) : (0));
674
675 return 0;
676 }
677
678 if (hotplug && !auto_mount)
679 return -1;
680
681 if (find_mount_point(pr->dev)) {
682 ERROR("%s is already mounted\n", pr->dev);
683 return -1;
684 }
685
686 m = find_block(pr->uuid, pr->label, device, NULL);
687 if (m && m->extroot)
688 return -1;
689
690 if (m) {
691 char *target = m->target;
692 char _target[32];
693 int err = 0;
694
695 if (!target) {
696 snprintf(_target, sizeof(_target), "/mnt/%s", device);
697 target = _target;
698 }
699 mkdir_p(target);
700
701 if (check_fs)
702 check_filesystem(pr);
703
704 err = mount(pr->dev, target, pr->id->name, m->flags,
705 (m->options) ? (m->options) : (""));
706 if (err)
707 ERROR("mounting %s (%s) as %s failed (%d) - %s\n",
708 pr->dev, pr->id->name, target, err, strerror(err));
709 else
710 handle_swapfiles(true);
711 return err;
712 }
713
714 if (anon_mount) {
715 char target[] = "/mnt/mmcblk123";
716 int err = 0;
717
718 snprintf(target, sizeof(target), "/mnt/%s", device);
719 mkdir_p(target);
720
721 if (check_fs)
722 check_filesystem(pr);
723
724 err = mount(pr->dev, target, pr->id->name, 0, "");
725 if (err)
726 ERROR("mounting %s (%s) as %s failed (%d) - %s\n",
727 pr->dev, pr->id->name, target, err, strerror(err));
728 else
729 handle_swapfiles(true);
730 return err;
731 }
732
733 return 0;
734 }
735
736 static int umount_device(struct blkid_struct_probe *pr)
737 {
738 struct mount *m;
739 char *device = basename(pr->dev);
740 char *mp;
741 int err;
742
743 if (!pr)
744 return -1;
745
746 if (!strcmp(pr->id->name, "swap"))
747 return -1;
748
749 mp = find_mount_point(pr->dev);
750 if (!mp)
751 return -1;
752
753 m = find_block(pr->uuid, pr->label, device, NULL);
754 if (m && m->extroot)
755 return -1;
756
757 err = umount2(mp, MNT_DETACH);
758 if (err)
759 ERROR("unmounting %s (%s) failed (%d) - %s\n",
760 pr->dev, mp, err, strerror(err));
761 else
762 ERROR("unmounted %s (%s)\n",
763 pr->dev, mp);
764
765 return err;
766 }
767
768 static int main_hotplug(int argc, char **argv)
769 {
770 char path[32];
771 char *action, *device, *mount_point;
772
773 action = getenv("ACTION");
774 device = getenv("DEVNAME");
775
776 if (!action || !device)
777 return -1;
778 snprintf(path, sizeof(path), "/dev/%s", device);
779
780 if (!strcmp(action, "remove")) {
781 int err = 0;
782 mount_point = find_mount_point(path);
783 if (mount_point)
784 err = umount2(mount_point, MNT_DETACH);
785
786 if (err)
787 ERROR("umount of %s failed (%d) - %s\n",
788 mount_point, err, strerror(err));
789
790 return 0;
791 } else if (strcmp(action, "add")) {
792 ERROR("Unkown action %s\n", action);
793
794 return -1;
795 }
796
797 if (config_load(NULL))
798 return -1;
799 cache_load(0);
800
801 return mount_device(find_block_info(NULL, NULL, path), 1);
802 }
803
804 static int find_block_mtd(char *name, char *part, int plen)
805 {
806 FILE *fp = fopen("/proc/mtd", "r");
807 static char line[256];
808 char *index = NULL;
809
810 if(!fp)
811 return -1;
812
813 while (!index && fgets(line, sizeof(line), fp)) {
814 if (strstr(line, name)) {
815 char *eol = strstr(line, ":");
816
817 if (!eol)
818 continue;
819
820 *eol = '\0';
821 index = &line[3];
822 }
823 }
824
825 fclose(fp);
826
827 if (!index)
828 return -1;
829
830 snprintf(part, plen, "/dev/mtdblock%s", index);
831
832 return 0;
833 }
834
835 #ifdef UBIFS_EXTROOT
836 static int find_ubi_vol(libubi_t libubi, char *name, int *dev_num, int *vol_id)
837 {
838 int dev = 0;
839
840 while (ubi_dev_present(libubi, dev))
841 {
842 struct ubi_dev_info dev_info;
843 struct ubi_vol_info vol_info;
844
845 if (ubi_get_dev_info1(libubi, dev++, &dev_info))
846 continue;
847 if (ubi_get_vol_info1_nm(libubi, dev_info.dev_num, name, &vol_info))
848 continue;
849
850 *dev_num = dev_info.dev_num;
851 *vol_id = vol_info.vol_id;
852
853 return 0;
854 }
855
856 return -1;
857 }
858
859 static int find_block_ubi(libubi_t libubi, char *name, char *part, int plen)
860 {
861 int dev_num;
862 int vol_id;
863 int err = -1;
864
865 err = find_ubi_vol(libubi, name, &dev_num, &vol_id);
866 if (!err)
867 snprintf(part, plen, "/dev/ubi%d_%d", dev_num, vol_id);
868
869 return err;
870 }
871
872 static int find_block_ubi_RO(libubi_t libubi, char *name, char *part, int plen)
873 {
874 int dev_num;
875 int vol_id;
876 int err = -1;
877
878 err = find_ubi_vol(libubi, name, &dev_num, &vol_id);
879 if (!err)
880 snprintf(part, plen, "/dev/ubiblock%d_%d", dev_num, vol_id);
881
882 return err;
883 }
884 #endif
885
886 static int check_extroot(char *path)
887 {
888 struct blkid_struct_probe *pr = NULL;
889 char fs[32];
890
891 #ifdef UBIFS_EXTROOT
892 if (find_block_mtd("rootfs", fs, sizeof(fs))) {
893 int err = -1;
894 libubi_t libubi;
895
896 libubi = libubi_open();
897 err = find_block_ubi_RO(libubi, "rootfs", fs, sizeof(fs));
898 libubi_close(libubi);
899 if (err)
900 return -1;
901 }
902 #else
903 if (find_block_mtd("rootfs", fs, sizeof(fs)))
904 return -1;
905 #endif
906
907 list_for_each_entry(pr, &devices, list) {
908 if (!strcmp(pr->dev, fs)) {
909 struct stat s;
910 FILE *fp = NULL;
911 char tag[64];
912 char uuid[64] = { 0 };
913
914 snprintf(tag, sizeof(tag), "%s/etc/.extroot-uuid", path);
915 if (stat(tag, &s)) {
916 fp = fopen(tag, "w+");
917 if (!fp) {
918 ERROR("extroot: failed to write uuid tag file\n");
919 /* return 0 to continue boot regardless of error */
920 return 0;
921 }
922 fputs(pr->uuid, fp);
923 fclose(fp);
924 return 0;
925 }
926
927 fp = fopen(tag, "r");
928 if (!fp) {
929 ERROR("extroot: failed to open uuid tag file\n");
930 return -1;
931 }
932
933 fgets(uuid, sizeof(uuid), fp);
934 fclose(fp);
935 if (!strcasecmp(uuid, pr->uuid))
936 return 0;
937 ERROR("extroot: uuid tag does not match rom uuid\n");
938 }
939 }
940 return -1;
941 }
942
943 /*
944 * Read info about extroot from UCI (using prefix) and mount it.
945 */
946 static int mount_extroot(char *cfg)
947 {
948 char overlay[] = "/tmp/extroot/overlay";
949 char mnt[] = "/tmp/extroot/mnt";
950 char *path = mnt;
951 struct blkid_struct_probe *pr;
952 struct mount *m;
953 int err = -1;
954
955 /* Load @cfg/etc/config/fstab */
956 if (config_load(cfg))
957 return -2;
958
959 /* See if there is extroot-specific mount config */
960 m = find_block(NULL, NULL, NULL, "/");
961 if (!m)
962 m = find_block(NULL, NULL, NULL, "/overlay");
963
964 if (!m || !m->extroot)
965 {
966 ERROR("extroot: no root or overlay mount defined\n");
967 return -1;
968 }
969
970 /* Find block device pointed by the mount config */
971 pr = find_block_info(m->uuid, m->label, m->device);
972
973 if (!pr && delay_root){
974 ERROR("extroot: is not ready yet, retrying in %u seconds\n", delay_root);
975 sleep(delay_root);
976 mkblkdev();
977 cache_load(0);
978 pr = find_block_info(m->uuid, m->label, m->device);
979 }
980 if (pr) {
981 if (strncmp(pr->id->name, "ext", 3) &&
982 strncmp(pr->id->name, "ubifs", 5)) {
983 ERROR("extroot: %s is not supported, try ext4\n", pr->id->name);
984 return -1;
985 }
986 if (m->overlay)
987 path = overlay;
988 mkdir_p(path);
989
990 if (check_fs)
991 check_filesystem(pr);
992
993 err = mount(pr->dev, path, pr->id->name, 0, (m->options) ? (m->options) : (""));
994
995 if (err) {
996 ERROR("mounting %s (%s) as %s failed (%d) - %s\n",
997 pr->dev, pr->id->name, path, err, strerror(err));
998 } else if (m->overlay) {
999 err = check_extroot(path);
1000 if (err)
1001 umount(path);
1002 }
1003 } else {
1004 ERROR("extroot: cannot find block device\n");
1005 }
1006
1007 return err;
1008 }
1009
1010 static int main_extroot(int argc, char **argv)
1011 {
1012 struct blkid_struct_probe *pr;
1013 char fs[32] = { 0 };
1014 char blkdev_path[32] = { 0 };
1015 int err = -1;
1016 #ifdef UBIFS_EXTROOT
1017 libubi_t libubi;
1018 #endif
1019
1020 if (!getenv("PREINIT"))
1021 return -1;
1022
1023 if (argc != 2) {
1024 fprintf(stderr, "Usage: block extroot mountpoint\n");
1025 return -1;
1026 }
1027
1028 mkblkdev();
1029 cache_load(1);
1030
1031 /*
1032 * Make sure there is "rootfs" MTD partition or UBI volume.
1033 * TODO: What for?
1034 */
1035 find_block_mtd("rootfs", fs, sizeof(fs));
1036 if (!fs[0]) {
1037 #ifdef UBIFS_EXTROOT
1038 libubi = libubi_open();
1039 find_block_ubi_RO(libubi, "rootfs", fs, sizeof(fs));
1040 libubi_close(libubi);
1041 if (!fs[0]) {
1042 ERROR("extroot: unable to locate rootfs mtdblock / ubiblock\n");
1043 return -2;
1044 }
1045 #else
1046 ERROR("extroot: unable to locate rootfs mtdblock\n");
1047 return -2;
1048 #endif
1049 }
1050
1051 pr = find_block_info(NULL, NULL, fs);
1052 if (!pr) {
1053 ERROR("extroot: unable to retrieve rootfs information\n");
1054 return -3;
1055 }
1056
1057 /*
1058 * Look for "rootfs_data". We will want to mount it and check for
1059 * extroot configuration.
1060 */
1061
1062 /* Start with looking for MTD partition */
1063 find_block_mtd("rootfs_data", blkdev_path, sizeof(blkdev_path));
1064 if (blkdev_path[0]) {
1065 pr = find_block_info(NULL, NULL, blkdev_path);
1066 if (pr && !strcmp(pr->id->name, "jffs2")) {
1067 char cfg[] = "/tmp/jffs_cfg";
1068
1069 /*
1070 * Mount MTD part and try extroot (using
1071 * /etc/config/fstab from that partition)
1072 */
1073 mkdir_p(cfg);
1074 if (!mount(blkdev_path, cfg, "jffs2", MS_NOATIME, NULL)) {
1075 err = mount_extroot(cfg);
1076 umount2(cfg, MNT_DETACH);
1077 }
1078 if (err < 0)
1079 rmdir("/tmp/overlay");
1080 rmdir(cfg);
1081 return err;
1082 }
1083 }
1084
1085 #ifdef UBIFS_EXTROOT
1086 /* ... but it also could be an UBI volume */
1087 memset(blkdev_path, 0, sizeof(blkdev_path));
1088 libubi = libubi_open();
1089 find_block_ubi(libubi, "rootfs_data", blkdev_path, sizeof(blkdev_path));
1090 libubi_close(libubi);
1091 if (blkdev_path[0]) {
1092 char cfg[] = "/tmp/ubifs_cfg";
1093
1094 /* Mount volume and try extroot (using fstab from that vol) */
1095 mkdir_p(cfg);
1096 if (!mount(blkdev_path, cfg, "ubifs", MS_NOATIME, NULL)) {
1097 err = mount_extroot(cfg);
1098 umount2(cfg, MNT_DETACH);
1099 }
1100 if (err < 0)
1101 rmdir("/tmp/overlay");
1102 rmdir(cfg);
1103 return err;
1104 }
1105 #endif
1106
1107 return mount_extroot(NULL);
1108 }
1109
1110 static int main_mount(int argc, char **argv)
1111 {
1112 struct blkid_struct_probe *pr;
1113
1114 if (config_load(NULL))
1115 return -1;
1116
1117 cache_load(1);
1118 list_for_each_entry(pr, &devices, list)
1119 mount_device(pr, 0);
1120
1121 handle_swapfiles(true);
1122
1123 return 0;
1124 }
1125
1126 static int main_umount(int argc, char **argv)
1127 {
1128 struct blkid_struct_probe *pr;
1129
1130 if (config_load(NULL))
1131 return -1;
1132
1133 handle_swapfiles(false);
1134
1135 cache_load(0);
1136 list_for_each_entry(pr, &devices, list)
1137 umount_device(pr);
1138
1139 return 0;
1140 }
1141
1142 static int main_detect(int argc, char **argv)
1143 {
1144 struct blkid_struct_probe *pr;
1145
1146 cache_load(0);
1147 printf("config 'global'\n");
1148 printf("\toption\tanon_swap\t'0'\n");
1149 printf("\toption\tanon_mount\t'0'\n");
1150 printf("\toption\tauto_swap\t'1'\n");
1151 printf("\toption\tauto_mount\t'1'\n");
1152 printf("\toption\tdelay_root\t'5'\n");
1153 printf("\toption\tcheck_fs\t'0'\n\n");
1154 list_for_each_entry(pr, &devices, list)
1155 print_block_uci(pr);
1156
1157 return 0;
1158 }
1159
1160 static int main_info(int argc, char **argv)
1161 {
1162 int i;
1163 struct blkid_struct_probe *pr;
1164
1165 cache_load(1);
1166 if (argc == 2) {
1167 list_for_each_entry(pr, &devices, list)
1168 print_block_info(pr);
1169
1170 return 0;
1171 };
1172
1173 for (i = 2; i < argc; i++) {
1174 struct stat s;
1175
1176 if (stat(argv[i], &s)) {
1177 ERROR("failed to stat %s\n", argv[i]);
1178 continue;
1179 }
1180 if (!S_ISBLK(s.st_mode)) {
1181 ERROR("%s is not a block device\n", argv[i]);
1182 continue;
1183 }
1184 pr = find_block_info(NULL, NULL, argv[i]);
1185 if (pr)
1186 print_block_info(pr);
1187 }
1188
1189 return 0;
1190 }
1191
1192 static int swapon_usage(void)
1193 {
1194 fprintf(stderr, "Usage: swapon [-s] [-a] [[-p pri] DEVICE]\n\n"
1195 "\tStart swapping on [DEVICE]\n"
1196 " -a\tStart swapping on all swap devices\n"
1197 " -p pri\tSet priority of swap device\n"
1198 " -s\tShow summary\n");
1199 return -1;
1200 }
1201
1202 static int main_swapon(int argc, char **argv)
1203 {
1204 int ch;
1205 FILE *fp;
1206 char *lineptr;
1207 size_t s;
1208 struct blkid_struct_probe *pr;
1209 int flags = 0;
1210 int pri;
1211 struct stat st;
1212 int err;
1213
1214 while ((ch = getopt(argc, argv, "ap:s")) != -1) {
1215 switch(ch) {
1216 case 's':
1217 fp = fopen("/proc/swaps", "r");
1218 lineptr = NULL;
1219
1220 if (!fp) {
1221 ERROR("failed to open /proc/swaps\n");
1222 return -1;
1223 }
1224 while (getline(&lineptr, &s, fp) > 0)
1225 printf(lineptr);
1226 if (lineptr)
1227 free(lineptr);
1228 fclose(fp);
1229 return 0;
1230 case 'a':
1231 cache_load(0);
1232 list_for_each_entry(pr, &devices, list) {
1233 if (strcmp(pr->id->name, "swap"))
1234 continue;
1235 if (swapon(pr->dev, 0))
1236 ERROR("failed to swapon %s\n", pr->dev);
1237 }
1238 return 0;
1239 case 'p':
1240 pri = atoi(optarg);
1241 if (pri >= 0)
1242 flags = ((pri << SWAP_FLAG_PRIO_SHIFT) & SWAP_FLAG_PRIO_MASK) | SWAP_FLAG_PREFER;
1243 break;
1244 default:
1245 return swapon_usage();
1246 }
1247
1248 }
1249
1250 if (optind != (argc - 1))
1251 return swapon_usage();
1252
1253 if (stat(argv[optind], &st) || (!S_ISBLK(st.st_mode) && !S_ISREG(st.st_mode))) {
1254 ERROR("%s is not a block device or file\n", argv[optind]);
1255 return -1;
1256 }
1257 err = swapon(argv[optind], flags);
1258 if (err) {
1259 ERROR("failed to swapon %s (%d)\n", argv[optind], err);
1260 return err;
1261 }
1262
1263 return 0;
1264 }
1265
1266 static int main_swapoff(int argc, char **argv)
1267 {
1268 if (argc != 2) {
1269 ERROR("Usage: swapoff [-a] [DEVICE]\n\n"
1270 "\tStop swapping on DEVICE\n"
1271 " -a\tStop swapping on all swap devices\n");
1272 return -1;
1273 }
1274
1275 if (!strcmp(argv[1], "-a")) {
1276 FILE *fp = fopen("/proc/swaps", "r");
1277 char line[256];
1278
1279 if (!fp) {
1280 ERROR("failed to open /proc/swaps\n");
1281 return -1;
1282 }
1283 fgets(line, sizeof(line), fp);
1284 while (fgets(line, sizeof(line), fp)) {
1285 char *end = strchr(line, ' ');
1286 int err;
1287
1288 if (!end)
1289 continue;
1290 *end = '\0';
1291 err = swapoff(line);
1292 if (err)
1293 ERROR("failed to swapoff %s (%d)\n", line, err);
1294 }
1295 fclose(fp);
1296 } else {
1297 struct stat s;
1298 int err;
1299
1300 if (stat(argv[1], &s) || (!S_ISBLK(s.st_mode) && !S_ISREG(s.st_mode))) {
1301 ERROR("%s is not a block device or file\n", argv[1]);
1302 return -1;
1303 }
1304 err = swapoff(argv[1]);
1305 if (err) {
1306 ERROR("fsiled to swapoff %s (%d)\n", argv[1], err);
1307 return err;
1308 }
1309 }
1310
1311 return 0;
1312 }
1313
1314 int main(int argc, char **argv)
1315 {
1316 char *base = basename(*argv);
1317
1318 umask(0);
1319
1320 if (!strcmp(base, "swapon"))
1321 return main_swapon(argc, argv);
1322
1323 if (!strcmp(base, "swapoff"))
1324 return main_swapoff(argc, argv);
1325
1326 if ((argc > 1) && !strcmp(base, "block")) {
1327 if (!strcmp(argv[1], "info"))
1328 return main_info(argc, argv);
1329
1330 if (!strcmp(argv[1], "detect"))
1331 return main_detect(argc, argv);
1332
1333 if (!strcmp(argv[1], "hotplug"))
1334 return main_hotplug(argc, argv);
1335
1336 if (!strcmp(argv[1], "extroot"))
1337 return main_extroot(argc, argv);
1338
1339 if (!strcmp(argv[1], "mount"))
1340 return main_mount(argc, argv);
1341
1342 if (!strcmp(argv[1], "umount"))
1343 return main_umount(argc, argv);
1344 }
1345
1346 fprintf(stderr, "Usage: block <info|mount|umount|detect>\n");
1347
1348 return -1;
1349 }
OpenWrt filesystem utilities