2 * Copyright (C) 2013 Felix Fietkau <nbd@openwrt.org>
3 * Copyright (C) 2013 John Crispin <blogic@openwrt.org>
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
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.
23 #include <sys/types.h>
25 #include <sys/mount.h>
31 #include <libubox/list.h>
32 #include <libubox/vlist.h>
33 #include <libubox/blobmsg_json.h>
34 #include <libubox/avl-cmp.h>
36 #include "libblkid-tiny/libblkid-tiny.h"
44 struct vlist_node node;
59 static struct vlist_tree mounts;
60 static struct blob_buf b;
61 static LIST_HEAD(devices);
62 static int anon_mount, anon_swap, auto_mount, auto_swap, check_fs;
63 static unsigned int delay_root;
75 static const struct blobmsg_policy config_policy[__CFG_MAX] = {
76 [CFG_ANON_SWAP] = { .name = "anon_swap", .type = BLOBMSG_TYPE_INT32 },
77 [CFG_ANON_MOUNT] = { .name = "anon_mount", .type = BLOBMSG_TYPE_INT32 },
78 [CFG_AUTO_SWAP] = { .name = "auto_swap", .type = BLOBMSG_TYPE_INT32 },
79 [CFG_AUTO_MOUNT] = { .name = "auto_mount", .type = BLOBMSG_TYPE_INT32 },
80 [CFG_DELAY_ROOT] = { .name = "delay_root", .type = BLOBMSG_TYPE_INT32 },
81 [CFG_CHECK_FS] = { .name = "check_fs", .type = BLOBMSG_TYPE_INT32 },
94 static const struct uci_blob_param_list config_attr_list = {
95 .n_params = __CFG_MAX,
96 .params = config_policy,
99 static const struct blobmsg_policy mount_policy[__MOUNT_MAX] = {
100 [MOUNT_UUID] = { .name = "uuid", .type = BLOBMSG_TYPE_STRING },
101 [MOUNT_LABEL] = { .name = "label", .type = BLOBMSG_TYPE_STRING },
102 [MOUNT_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
103 [MOUNT_TARGET] = { .name = "target", .type = BLOBMSG_TYPE_STRING },
104 [MOUNT_OPTIONS] = { .name = "options", .type = BLOBMSG_TYPE_STRING },
105 [MOUNT_ENABLE] = { .name = "enabled", .type = BLOBMSG_TYPE_INT32 },
108 static const struct uci_blob_param_list mount_attr_list = {
109 .n_params = __MOUNT_MAX,
110 .params = mount_policy,
121 static const struct blobmsg_policy swap_policy[__SWAP_MAX] = {
122 [SWAP_ENABLE] = { .name = "enabled", .type = BLOBMSG_TYPE_INT32 },
123 [SWAP_UUID] = { .name = "uuid", .type = BLOBMSG_TYPE_STRING },
124 [SWAP_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
125 [SWAP_PRIO] = { .name = "priority", .type = BLOBMSG_TYPE_INT32 },
128 static const struct uci_blob_param_list swap_attr_list = {
129 .n_params = __SWAP_MAX,
130 .params = swap_policy,
133 static char *blobmsg_get_strdup(struct blob_attr *attr)
138 return strdup(blobmsg_get_string(attr));
141 static char *blobmsg_get_basename(struct blob_attr *attr)
146 return strdup(basename(blobmsg_get_string(attr)));
149 static int mount_add(struct uci_section *s)
151 struct blob_attr *tb[__MOUNT_MAX] = { 0 };
154 blob_buf_init(&b, 0);
155 uci_to_blob(&b, s, &mount_attr_list);
156 blobmsg_parse(mount_policy, __MOUNT_MAX, tb, blob_data(b.head), blob_len(b.head));
158 if (!tb[MOUNT_LABEL] && !tb[MOUNT_UUID] && !tb[MOUNT_DEVICE])
161 if (tb[MOUNT_ENABLE] && !blobmsg_get_u32(tb[MOUNT_ENABLE]))
164 m = malloc(sizeof(struct mount));
165 m->type = TYPE_MOUNT;
166 m->uuid = blobmsg_get_strdup(tb[MOUNT_UUID]);
167 m->label = blobmsg_get_strdup(tb[MOUNT_LABEL]);
168 m->target = blobmsg_get_strdup(tb[MOUNT_TARGET]);
169 m->options = blobmsg_get_strdup(tb[MOUNT_OPTIONS]);
170 m->device = blobmsg_get_basename(tb[MOUNT_DEVICE]);
171 m->overlay = m->extroot = 0;
172 if (m->target && !strcmp(m->target, "/"))
174 if (m->target && !strcmp(m->target, "/overlay"))
175 m->extroot = m->overlay = 1;
178 vlist_add(&mounts, &m->node, m->uuid);
180 vlist_add(&mounts, &m->node, m->label);
182 vlist_add(&mounts, &m->node, m->device);
187 static int swap_add(struct uci_section *s)
189 struct blob_attr *tb[__SWAP_MAX] = { 0 };
192 blob_buf_init(&b, 0);
193 uci_to_blob(&b, s, &swap_attr_list);
194 blobmsg_parse(swap_policy, __SWAP_MAX, tb, blob_data(b.head), blob_len(b.head));
196 if (!tb[SWAP_UUID] && !tb[SWAP_DEVICE])
199 m = malloc(sizeof(struct mount));
200 memset(m, 0, sizeof(struct mount));
202 m->uuid = blobmsg_get_strdup(tb[SWAP_UUID]);
203 m->device = blobmsg_get_basename(tb[SWAP_DEVICE]);
205 m->prio = blobmsg_get_u32(tb[SWAP_PRIO]);
207 m->prio = ((m->prio << SWAP_FLAG_PRIO_SHIFT) & SWAP_FLAG_PRIO_MASK) | SWAP_FLAG_PREFER;
209 if ((!tb[SWAP_ENABLE]) || blobmsg_get_u32(tb[SWAP_ENABLE]))
210 vlist_add(&mounts, &m->node, (m->uuid) ? (m->uuid) : (m->device));
215 static int global_add(struct uci_section *s)
217 struct blob_attr *tb[__CFG_MAX] = { 0 };
219 blob_buf_init(&b, 0);
220 uci_to_blob(&b, s, &config_attr_list);
221 blobmsg_parse(config_policy, __CFG_MAX, tb, blob_data(b.head), blob_len(b.head));
223 if ((tb[CFG_ANON_MOUNT]) && blobmsg_get_u32(tb[CFG_ANON_MOUNT]))
225 if ((tb[CFG_ANON_SWAP]) && blobmsg_get_u32(tb[CFG_ANON_SWAP]))
228 if ((tb[CFG_AUTO_MOUNT]) && blobmsg_get_u32(tb[CFG_AUTO_MOUNT]))
230 if ((tb[CFG_AUTO_SWAP]) && blobmsg_get_u32(tb[CFG_AUTO_SWAP]))
233 if (tb[CFG_DELAY_ROOT])
234 delay_root = blobmsg_get_u32(tb[CFG_DELAY_ROOT]);
236 if ((tb[CFG_CHECK_FS]) && blobmsg_get_u32(tb[CFG_CHECK_FS]))
242 static struct mount* find_swap(const char *uuid, const char *device)
246 vlist_for_each_element(&mounts, m, node) {
247 if (m->type != TYPE_SWAP)
249 if (uuid && m->uuid && !strcmp(m->uuid, uuid))
251 if (device && m->device && !strcmp(m->device, device))
258 static struct mount* find_block(const char *uuid, const char *label, const char *device,
263 vlist_for_each_element(&mounts, m, node) {
264 if (m->type != TYPE_MOUNT)
266 if (m->uuid && uuid && !strcmp(m->uuid, uuid))
268 if (m->label && label && !strcmp(m->label, label))
270 if (m->target && target && !strcmp(m->target, target))
272 if (m->device && device && !strcmp(m->device, device))
279 static void mounts_update(struct vlist_tree *tree, struct vlist_node *node_new,
280 struct vlist_node *node_old)
284 static int config_load(char *cfg)
286 struct uci_context *ctx;
287 struct uci_package *pkg;
288 struct uci_element *e;
290 vlist_init(&mounts, avl_strcmp, mounts_update);
292 ctx = uci_alloc_context();
295 snprintf(path, 32, "%s/etc/config", cfg);
296 uci_set_confdir(ctx, path);
299 if (uci_load(ctx, "fstab", &pkg))
302 vlist_update(&mounts);
303 uci_foreach_element(&pkg->sections, e) {
304 struct uci_section *s = uci_to_section(e);
306 if (!strcmp(s->type, "mount"))
308 if (!strcmp(s->type, "swap"))
310 if (!strcmp(s->type, "global"))
313 vlist_flush(&mounts);
318 static int _cache_load(const char *path)
320 int gl_flags = GLOB_NOESCAPE | GLOB_MARK;
324 if (glob(path, gl_flags, NULL, &gl) < 0)
327 for (j = 0; j < gl.gl_pathc; j++) {
328 struct blkid_struct_probe *pr = malloc(sizeof(struct blkid_struct_probe));
329 memset(pr, 0, sizeof(struct blkid_struct_probe));
330 probe_block(gl.gl_pathv[j], pr);
331 if (pr->err || !pr->id)
334 list_add_tail(&pr->list, &devices);
342 static void cache_load(int mtd)
345 _cache_load("/dev/mtdblock*");
346 _cache_load("/dev/mmcblk*");
347 _cache_load("/dev/sd*");
348 _cache_load("/dev/sdc*");
349 _cache_load("/dev/hd*");
350 _cache_load("/dev/md*");
351 _cache_load("/dev/mapper/*");
354 static int print_block_info(struct blkid_struct_probe *pr)
356 printf("%s:", pr->dev);
358 printf(" UUID=\"%s\"", pr->uuid);
361 printf(" LABEL=\"%s\"", pr->label);
364 printf(" NAME=\"%s\"", pr->name);
367 printf(" VERSION=\"%s\"", pr->version);
369 printf(" TYPE=\"%s\"\n", pr->id->name);
374 static int print_block_uci(struct blkid_struct_probe *pr)
376 if (!strcmp(pr->id->name, "swap")) {
377 printf("config 'swap'\n");
379 printf("config 'mount'\n");
380 printf("\toption\ttarget\t'/mnt/%s'\n", basename(pr->dev));
383 printf("\toption\tuuid\t'%s'\n", pr->uuid);
385 printf("\toption\tdevice\t'%s'\n", pr->dev);
386 printf("\toption\tenabled\t'0'\n\n");
391 static struct blkid_struct_probe* find_block_info(char *uuid, char *label, char *path)
393 struct blkid_struct_probe *pr = NULL;
396 list_for_each_entry(pr, &devices, list)
397 if (!strcmp(pr->uuid, uuid))
401 list_for_each_entry(pr, &devices, list)
402 if (strcmp(pr->label, label))
406 list_for_each_entry(pr, &devices, list)
407 if (!strcmp(pr->dev, path))
413 static char* find_mount_point(char *block)
415 FILE *fp = fopen("/proc/mounts", "r");
416 static char line[256];
417 int len = strlen(block);
423 while (fgets(line, sizeof(line), fp)) {
424 if (!strncmp(line, block, len)) {
425 char *p = &line[len + 1];
426 char *t = strstr(p, " ");
441 static void mkdir_p(char *dir)
443 char *l = strrchr(dir, '/');
453 static void check_filesystem(struct blkid_struct_probe *pr)
457 char *e2fsck = "/usr/sbin/e2fsck";
459 if (strncmp(pr->id->name, "ext", 3)) {
460 fprintf(stderr, "check_filesystem: %s is not supported\n", pr->id->name);
464 if (stat(e2fsck, &statbuf) < 0) {
465 fprintf(stderr, "check_filesystem: %s not found\n", e2fsck);
471 execl(e2fsck, e2fsck, "-p", pr->dev, NULL);
473 } else if (pid > 0) {
476 waitpid(pid, &status, 0);
477 if (WEXITSTATUS(status))
478 fprintf(stderr, "check_filesystem: %s returned %d\n", e2fsck, WEXITSTATUS(status));
482 static int mount_device(struct blkid_struct_probe *pr, int hotplug)
490 device = basename(pr->dev);
492 if (!strcmp(pr->id->name, "swap")) {
493 if (hotplug && !auto_swap)
495 m = find_swap(pr->uuid, device);
497 swapon(pr->dev, (m) ? (m->prio) : (0));
502 if (hotplug && !auto_mount)
505 if (find_mount_point(pr->dev)) {
506 fprintf(stderr, "%s is already mounted\n", pr->dev);
510 m = find_block(pr->uuid, pr->label, device, NULL);
515 char *target = m->target;
516 char _target[] = "/mnt/mmcblk123";
520 snprintf(_target, sizeof(_target), "/mnt/%s", device);
526 check_filesystem(pr);
528 err = mount(pr->dev, target, pr->id->name, 0, (m->options) ? (m->options) : (""));
530 fprintf(stderr, "mounting %s (%s) as %s failed (%d) - %s\n",
531 pr->dev, pr->id->name, target, err, strerror(err));
536 char target[] = "/mnt/mmcblk123";
539 snprintf(target, sizeof(target), "/mnt/%s", device);
543 check_filesystem(pr);
545 err = mount(pr->dev, target, pr->id->name, 0, "");
547 fprintf(stderr, "mounting %s (%s) as %s failed (%d) - %s\n",
548 pr->dev, pr->id->name, target, err, strerror(err));
555 static int umount_device(struct blkid_struct_probe *pr)
558 char *device = basename(pr->dev);
565 if (!strcmp(pr->id->name, "swap"))
568 mp = find_mount_point(pr->dev);
572 m = find_block(pr->uuid, pr->label, device, NULL);
576 err = umount2(mp, MNT_DETACH);
578 fprintf(stderr, "unmounting %s (%s) failed (%d) - %s\n",
579 pr->dev, mp, err, strerror(err));
581 fprintf(stderr, "unmounted %s (%s)\n",
587 static int main_hotplug(int argc, char **argv)
590 char *action, *device, *mount_point;
592 action = getenv("ACTION");
593 device = getenv("DEVNAME");
595 if (!action || !device)
597 snprintf(path, sizeof(path), "/dev/%s", device);
599 if (!strcmp(action, "remove")) {
601 mount_point = find_mount_point(path);
603 err = umount2(mount_point, MNT_DETACH);
606 fprintf(stderr, "umount of %s failed (%d) - %s\n",
607 mount_point, err, strerror(err));
610 } else if (strcmp(action, "add")) {
611 fprintf(stderr, "Unkown action %s\n", action);
616 if (config_load(NULL))
620 return mount_device(find_block_info(NULL, NULL, path), 1);
623 static int find_block_mtd(char *name, char *part, int plen)
625 FILE *fp = fopen("/proc/mtd", "r");
626 static char line[256];
632 while (!index && fgets(line, sizeof(line), fp)) {
633 if (strstr(line, name)) {
634 char *eol = strstr(line, ":");
649 snprintf(part, plen, "/dev/mtdblock%s", index);
654 static int check_extroot(char *path)
656 struct blkid_struct_probe *pr = NULL;
659 if (find_block_mtd("rootfs", fs, sizeof(fs)))
662 list_for_each_entry(pr, &devices, list) {
663 if (!strcmp(pr->dev, fs)) {
667 char uuid[32] = { 0 };
669 snprintf(tag, sizeof(tag), "%s/etc/.extroot-uuid", path);
671 fp = fopen(tag, "w+");
673 fprintf(stderr, "extroot: failed to write uuid tag file\n");
674 /* return 0 to continue boot regardless of error */
682 fp = fopen(tag, "r");
684 fprintf(stderr, "extroot: failed to open uuid tag file\n");
688 fgets(uuid, sizeof(uuid), fp);
690 if (!strcmp(uuid, pr->uuid))
692 fprintf(stderr, "extroot: uuid tag does not match rom uuid\n");
698 static int mount_extroot(char *cfg)
700 char overlay[] = "/tmp/overlay";
701 char mnt[] = "/tmp/mnt";
703 struct blkid_struct_probe *pr;
707 if (config_load(cfg))
710 m = find_block(NULL, NULL, NULL, "/");
712 m = find_block(NULL, NULL, NULL, "/overlay");
714 if (!m || !m->extroot)
717 pr = find_block_info(m->uuid, m->label, NULL);
719 if (!pr && delay_root){
720 fprintf(stderr, "extroot: is not ready yet, retrying in %ui seconds\n", delay_root);
724 pr = find_block_info(m->uuid, m->label, NULL);
727 if (strncmp(pr->id->name, "ext", 3)) {
728 fprintf(stderr, "extroot: %s is not supported, try ext4\n", pr->id->name);
736 check_filesystem(pr);
738 err = mount(pr->dev, path, pr->id->name, 0, (m->options) ? (m->options) : (""));
741 fprintf(stderr, "mounting %s (%s) as %s failed (%d) - %s\n",
742 pr->dev, pr->id->name, path, err, strerror(err));
743 } else if (m->overlay) {
744 err = check_extroot(path);
753 static int main_extroot(int argc, char **argv)
755 struct blkid_struct_probe *pr;
757 char fs_data[32] = { 0 };
760 if (!getenv("PREINIT"))
764 fprintf(stderr, "Usage: block extroot mountpoint\n");
771 find_block_mtd("rootfs", fs, sizeof(fs));
775 pr = find_block_info(NULL, NULL, fs);
779 find_block_mtd("rootfs_data", fs_data, sizeof(fs_data));
781 pr = find_block_info(NULL, NULL, fs_data);
782 if (pr && !strcmp(pr->id->name, "jffs2")) {
783 char cfg[] = "/tmp/jffs_cfg";
786 if (!mount(fs_data, cfg, "jffs2", MS_NOATIME, NULL)) {
787 err = mount_extroot(cfg);
788 umount2(cfg, MNT_DETACH);
791 rmdir("/tmp/overlay");
797 return mount_extroot(NULL);
800 static int main_mount(int argc, char **argv)
802 struct blkid_struct_probe *pr;
804 if (config_load(NULL))
808 list_for_each_entry(pr, &devices, list)
814 static int main_umount(int argc, char **argv)
816 struct blkid_struct_probe *pr;
818 if (config_load(NULL))
822 list_for_each_entry(pr, &devices, list)
828 static int main_detect(int argc, char **argv)
830 struct blkid_struct_probe *pr;
833 printf("config 'global'\n");
834 printf("\toption\tanon_swap\t'0'\n");
835 printf("\toption\tanon_mount\t'0'\n");
836 printf("\toption\tauto_swap\t'1'\n");
837 printf("\toption\tauto_mount\t'1'\n");
838 printf("\toption\tdelay_root\t'0'\n");
839 printf("\toption\tcheck_fs\t'0'\n\n");
840 list_for_each_entry(pr, &devices, list)
846 static int main_info(int argc, char **argv)
849 struct blkid_struct_probe *pr;
853 list_for_each_entry(pr, &devices, list)
854 print_block_info(pr);
859 for (i = 2; i < argc; i++) {
862 if (stat(argv[i], &s)) {
863 fprintf(stderr, "failed to stat %s\n", argv[i]);
866 if (!S_ISBLK(s.st_mode)) {
867 fprintf(stderr, "%s is not a block device\n", argv[i]);
870 pr = find_block_info(NULL, NULL, argv[i]);
872 print_block_info(pr);
878 static int main_swapon(int argc, char **argv)
881 fprintf(stderr, "Usage: swapon <-s> <-a> [DEVICE]\n\n\tStart swapping on [DEVICE]\n -a\tStart swapping on all swap devices\n -s\tShow summary\n");
885 if (!strcmp(argv[1], "-s")) {
886 FILE *fp = fopen("/proc/swaps", "r");
887 char *lineptr = NULL;
891 fprintf(stderr, "failed to open /proc/swaps\n");
894 while (getline(&lineptr, &s, fp) > 0)
899 } else if (!strcmp(argv[1], "-a")) {
900 struct blkid_struct_probe *pr;
903 list_for_each_entry(pr, &devices, list) {
904 if (strcmp(pr->id->name, "swap"))
906 if (swapon(pr->dev, 0))
907 fprintf(stderr, "failed to swapon %s\n", pr->dev);
913 if (stat(argv[1], &s) || !S_ISBLK(s.st_mode)) {
914 fprintf(stderr, "%s is not a block device\n", argv[1]);
917 err = swapon(argv[1], 0);
919 fprintf(stderr, "failed to swapon %s (%d)\n", argv[1], err);
927 static int main_swapoff(int argc, char **argv)
930 fprintf(stderr, "Usage: swapoff [-a] [DEVICE]\n\n\tStop swapping on DEVICE\n -a\tStop swapping on all swap devices\n");
934 if (!strcmp(argv[1], "-a")) {
935 FILE *fp = fopen("/proc/swaps", "r");
939 fprintf(stderr, "failed to open /proc/swaps\n");
942 fgets(line, sizeof(line), fp);
943 while (fgets(line, sizeof(line), fp)) {
944 char *end = strchr(line, ' ');
952 fprintf(stderr, "failed to swapoff %s (%d)\n", line, err);
959 if (stat(argv[1], &s) || !S_ISBLK(s.st_mode)) {
960 fprintf(stderr, "%s is not a block device\n", argv[1]);
963 err = swapoff(argv[1]);
965 fprintf(stderr, "fsiled to swapoff %s (%d)\n", argv[1], err);
973 int main(int argc, char **argv)
975 char *base = basename(*argv);
979 if (!strcmp(base, "swapon"))
980 return main_swapon(argc, argv);
982 if (!strcmp(base, "swapoff"))
983 return main_swapoff(argc, argv);
985 if ((argc > 1) && !strcmp(base, "block")) {
986 if (!strcmp(argv[1], "info"))
987 return main_info(argc, argv);
989 if (!strcmp(argv[1], "detect"))
990 return main_detect(argc, argv);
992 if (!strcmp(argv[1], "hotplug"))
993 return main_hotplug(argc, argv);
995 if (!strcmp(argv[1], "extroot"))
996 return main_extroot(argc, argv);
998 if (!strcmp(argv[1], "mount"))
999 return main_mount(argc, argv);
1001 if (!strcmp(argv[1], "umount"))
1002 return main_umount(argc, argv);
1005 fprintf(stderr, "Usage: block <info|mount|umount|detect>\n");