libfstools: ubi: rework reading volumes
[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", path);
915                         if (stat(tag, &s))
916                                 mkdir_p(tag);
917
918                         snprintf(tag, sizeof(tag), "%s/etc/.extroot-uuid", path);
919                         if (stat(tag, &s)) {
920                                 fp = fopen(tag, "w+");
921                                 if (!fp) {
922                                         ERROR("extroot: failed to write uuid tag file\n");
923                                         /* return 0 to continue boot regardless of error */
924                                         return 0;
925                                 }
926                                 fputs(pr->uuid, fp);
927                                 fclose(fp);
928                                 return 0;
929                         }
930
931                         fp = fopen(tag, "r");
932                         if (!fp) {
933                                 ERROR("extroot: failed to open uuid tag file\n");
934                                 return -1;
935                         }
936
937                         fgets(uuid, sizeof(uuid), fp);
938                         fclose(fp);
939                         if (!strcasecmp(uuid, pr->uuid))
940                                 return 0;
941                         ERROR("extroot: uuid tag does not match rom uuid\n");
942                 }
943         }
944         return -1;
945 }
946
947 /*
948  * Read info about extroot from UCI (using prefix) and mount it.
949  */
950 static int mount_extroot(char *cfg)
951 {
952         char overlay[] = "/tmp/extroot/overlay";
953         char mnt[] = "/tmp/extroot/mnt";
954         char *path = mnt;
955         struct blkid_struct_probe *pr;
956         struct mount *m;
957         int err = -1;
958
959         /* Load @cfg/etc/config/fstab */
960         if (config_load(cfg))
961                 return -2;
962
963         /* See if there is extroot-specific mount config */
964         m = find_block(NULL, NULL, NULL, "/");
965         if (!m)
966                 m = find_block(NULL, NULL, NULL, "/overlay");
967
968         if (!m || !m->extroot)
969         {
970                 ERROR("extroot: no root or overlay mount defined\n");
971                 return -1;
972         }
973
974         /* Find block device pointed by the mount config */
975         pr = find_block_info(m->uuid, m->label, m->device);
976
977         if (!pr && delay_root){
978                 ERROR("extroot: is not ready yet, retrying in %u seconds\n", delay_root);
979                 sleep(delay_root);
980                 mkblkdev();
981                 cache_load(0);
982                 pr = find_block_info(m->uuid, m->label, m->device);
983         }
984         if (pr) {
985                 if (strncmp(pr->id->name, "ext", 3) &&
986                     strncmp(pr->id->name, "ubifs", 5)) {
987                         ERROR("extroot: %s is not supported, try ext4\n", pr->id->name);
988                         return -1;
989                 }
990                 if (m->overlay)
991                         path = overlay;
992                 mkdir_p(path);
993
994                 if (check_fs)
995                         check_filesystem(pr);
996
997                 err = mount(pr->dev, path, pr->id->name, 0, (m->options) ? (m->options) : (""));
998
999                 if (err) {
1000                         ERROR("mounting %s (%s) as %s failed (%d) - %s\n",
1001                                         pr->dev, pr->id->name, path, err, strerror(err));
1002                 } else if (m->overlay) {
1003                         err = check_extroot(path);
1004                         if (err)
1005                                 umount(path);
1006                 }
1007         } else {
1008                 ERROR("extroot: cannot find block device\n");
1009         }
1010
1011         return err;
1012 }
1013
1014 static int main_extroot(int argc, char **argv)
1015 {
1016         struct blkid_struct_probe *pr;
1017         char fs[32] = { 0 };
1018         char blkdev_path[32] = { 0 };
1019         int err = -1;
1020 #ifdef UBIFS_EXTROOT
1021         libubi_t libubi;
1022 #endif
1023
1024         if (!getenv("PREINIT"))
1025                 return -1;
1026
1027         if (argc != 2) {
1028                 fprintf(stderr, "Usage: block extroot mountpoint\n");
1029                 return -1;
1030         }
1031
1032         mkblkdev();
1033         cache_load(1);
1034
1035         /*
1036          * Make sure there is "rootfs" MTD partition or UBI volume.
1037          * TODO: What for?
1038          */
1039         find_block_mtd("rootfs", fs, sizeof(fs));
1040         if (!fs[0]) {
1041 #ifdef UBIFS_EXTROOT
1042                 libubi = libubi_open();
1043                 find_block_ubi_RO(libubi, "rootfs", fs, sizeof(fs));
1044                 libubi_close(libubi);
1045                 if (!fs[0]) {
1046                         ERROR("extroot: unable to locate rootfs mtdblock / ubiblock\n");
1047                         return -2;
1048                 }
1049 #else
1050                 ERROR("extroot: unable to locate rootfs mtdblock\n");
1051                 return -2;
1052 #endif
1053         }
1054
1055         pr = find_block_info(NULL, NULL, fs);
1056         if (!pr) {
1057                 ERROR("extroot: unable to retrieve rootfs information\n");
1058                 return -3;
1059         }
1060
1061         /*
1062          * Look for "rootfs_data". We will want to mount it and check for
1063          * extroot configuration.
1064          */
1065
1066         /* Start with looking for MTD partition */
1067         find_block_mtd("rootfs_data", blkdev_path, sizeof(blkdev_path));
1068         if (blkdev_path[0]) {
1069                 pr = find_block_info(NULL, NULL, blkdev_path);
1070                 if (pr && !strcmp(pr->id->name, "jffs2")) {
1071                         char cfg[] = "/tmp/jffs_cfg";
1072
1073                         /*
1074                          * Mount MTD part and try extroot (using
1075                          * /etc/config/fstab from that partition)
1076                          */
1077                         mkdir_p(cfg);
1078                         if (!mount(blkdev_path, cfg, "jffs2", MS_NOATIME, NULL)) {
1079                                 err = mount_extroot(cfg);
1080                                 umount2(cfg, MNT_DETACH);
1081                         }
1082                         if (err < 0)
1083                                 rmdir("/tmp/overlay");
1084                         rmdir(cfg);
1085                         return err;
1086                 }
1087         }
1088
1089 #ifdef UBIFS_EXTROOT
1090         /* ... but it also could be an UBI volume */
1091         memset(blkdev_path, 0, sizeof(blkdev_path));
1092         libubi = libubi_open();
1093         find_block_ubi(libubi, "rootfs_data", blkdev_path, sizeof(blkdev_path));
1094         libubi_close(libubi);
1095         if (blkdev_path[0]) {
1096                 char cfg[] = "/tmp/ubifs_cfg";
1097
1098                 /* Mount volume and try extroot (using fstab from that vol) */
1099                 mkdir_p(cfg);
1100                 if (!mount(blkdev_path, cfg, "ubifs", MS_NOATIME, NULL)) {
1101                         err = mount_extroot(cfg);
1102                         umount2(cfg, MNT_DETACH);
1103                 }
1104                 if (err < 0)
1105                         rmdir("/tmp/overlay");
1106                 rmdir(cfg);
1107                 return err;
1108        }
1109 #endif
1110
1111         return mount_extroot(NULL);
1112 }
1113
1114 static int main_mount(int argc, char **argv)
1115 {
1116         struct blkid_struct_probe *pr;
1117
1118         if (config_load(NULL))
1119                 return -1;
1120
1121         cache_load(1);
1122         list_for_each_entry(pr, &devices, list)
1123                 mount_device(pr, 0);
1124
1125         handle_swapfiles(true);
1126
1127         return 0;
1128 }
1129
1130 static int main_umount(int argc, char **argv)
1131 {
1132         struct blkid_struct_probe *pr;
1133
1134         if (config_load(NULL))
1135                 return -1;
1136
1137         handle_swapfiles(false);
1138
1139         cache_load(0);
1140         list_for_each_entry(pr, &devices, list)
1141                 umount_device(pr);
1142
1143         return 0;
1144 }
1145
1146 static int main_detect(int argc, char **argv)
1147 {
1148         struct blkid_struct_probe *pr;
1149
1150         cache_load(0);
1151         printf("config 'global'\n");
1152         printf("\toption\tanon_swap\t'0'\n");
1153         printf("\toption\tanon_mount\t'0'\n");
1154         printf("\toption\tauto_swap\t'1'\n");
1155         printf("\toption\tauto_mount\t'1'\n");
1156         printf("\toption\tdelay_root\t'5'\n");
1157         printf("\toption\tcheck_fs\t'0'\n\n");
1158         list_for_each_entry(pr, &devices, list)
1159                 print_block_uci(pr);
1160
1161         return 0;
1162 }
1163
1164 static int main_info(int argc, char **argv)
1165 {
1166         int i;
1167         struct blkid_struct_probe *pr;
1168
1169         cache_load(1);
1170         if (argc == 2) {
1171                 list_for_each_entry(pr, &devices, list)
1172                         print_block_info(pr);
1173
1174                 return 0;
1175         };
1176
1177         for (i = 2; i < argc; i++) {
1178                 struct stat s;
1179
1180                 if (stat(argv[i], &s)) {
1181                         ERROR("failed to stat %s\n", argv[i]);
1182                         continue;
1183                 }
1184                 if (!S_ISBLK(s.st_mode)) {
1185                         ERROR("%s is not a block device\n", argv[i]);
1186                         continue;
1187                 }
1188                 pr = find_block_info(NULL, NULL, argv[i]);
1189                 if (pr)
1190                         print_block_info(pr);
1191         }
1192
1193         return 0;
1194 }
1195
1196 static int swapon_usage(void)
1197 {
1198         fprintf(stderr, "Usage: swapon [-s] [-a] [[-p pri] DEVICE]\n\n"
1199                 "\tStart swapping on [DEVICE]\n"
1200                 " -a\tStart swapping on all swap devices\n"
1201                 " -p pri\tSet priority of swap device\n"
1202                 " -s\tShow summary\n");
1203         return -1;
1204 }
1205
1206 static int main_swapon(int argc, char **argv)
1207 {
1208         int ch;
1209         FILE *fp;
1210         char *lineptr;
1211         size_t s;
1212         struct blkid_struct_probe *pr;
1213         int flags = 0;
1214         int pri;
1215         struct stat st;
1216         int err;
1217
1218         while ((ch = getopt(argc, argv, "ap:s")) != -1) {
1219                 switch(ch) {
1220                 case 's':
1221                         fp = fopen("/proc/swaps", "r");
1222                         lineptr = NULL;
1223
1224                         if (!fp) {
1225                                 ERROR("failed to open /proc/swaps\n");
1226                                 return -1;
1227                         }
1228                         while (getline(&lineptr, &s, fp) > 0)
1229                                 printf(lineptr);
1230                         if (lineptr)
1231                                 free(lineptr);
1232                         fclose(fp);
1233                         return 0;
1234                 case 'a':
1235                         cache_load(0);
1236                         list_for_each_entry(pr, &devices, list) {
1237                                 if (strcmp(pr->id->name, "swap"))
1238                                         continue;
1239                                 if (swapon(pr->dev, 0))
1240                                         ERROR("failed to swapon %s\n", pr->dev);
1241                         }
1242                         return 0;
1243                 case 'p':
1244                         pri = atoi(optarg);
1245                         if (pri >= 0)
1246                                 flags = ((pri << SWAP_FLAG_PRIO_SHIFT) & SWAP_FLAG_PRIO_MASK) | SWAP_FLAG_PREFER;
1247                         break;
1248                 default:
1249                         return swapon_usage();
1250                 }
1251
1252         }
1253
1254         if (optind != (argc - 1))
1255                 return swapon_usage();
1256
1257         if (stat(argv[optind], &st) || (!S_ISBLK(st.st_mode) && !S_ISREG(st.st_mode))) {
1258                 ERROR("%s is not a block device or file\n", argv[optind]);
1259                 return -1;
1260         }
1261         err = swapon(argv[optind], flags);
1262         if (err) {
1263                 ERROR("failed to swapon %s (%d)\n", argv[optind], err);
1264                 return err;
1265         }
1266
1267         return 0;
1268 }
1269
1270 static int main_swapoff(int argc, char **argv)
1271 {
1272         if (argc != 2) {
1273                 ERROR("Usage: swapoff [-a] [DEVICE]\n\n"
1274                         "\tStop swapping on DEVICE\n"
1275                         " -a\tStop swapping on all swap devices\n");
1276                 return -1;
1277         }
1278
1279         if (!strcmp(argv[1], "-a")) {
1280                 FILE *fp = fopen("/proc/swaps", "r");
1281                 char line[256];
1282
1283                 if (!fp) {
1284                         ERROR("failed to open /proc/swaps\n");
1285                         return -1;
1286                 }
1287                 fgets(line, sizeof(line), fp);
1288                 while (fgets(line, sizeof(line), fp)) {
1289                         char *end = strchr(line, ' ');
1290                         int err;
1291
1292                         if (!end)
1293                                 continue;
1294                         *end = '\0';
1295                         err = swapoff(line);
1296                         if (err)
1297                                 ERROR("failed to swapoff %s (%d)\n", line, err);
1298                 }
1299                 fclose(fp);
1300         } else {
1301                 struct stat s;
1302                 int err;
1303
1304                 if (stat(argv[1], &s) || (!S_ISBLK(s.st_mode) && !S_ISREG(s.st_mode))) {
1305                         ERROR("%s is not a block device or file\n", argv[1]);
1306                         return -1;
1307                 }
1308                 err = swapoff(argv[1]);
1309                 if (err) {
1310                         ERROR("fsiled to swapoff %s (%d)\n", argv[1], err);
1311                         return err;
1312                 }
1313         }
1314
1315         return 0;
1316 }
1317
1318 int main(int argc, char **argv)
1319 {
1320         char *base = basename(*argv);
1321
1322         umask(0);
1323
1324         if (!strcmp(base, "swapon"))
1325                 return main_swapon(argc, argv);
1326
1327         if (!strcmp(base, "swapoff"))
1328                 return main_swapoff(argc, argv);
1329
1330         if ((argc > 1) && !strcmp(base, "block")) {
1331                 if (!strcmp(argv[1], "info"))
1332                         return main_info(argc, argv);
1333
1334                 if (!strcmp(argv[1], "detect"))
1335                         return main_detect(argc, argv);
1336
1337                 if (!strcmp(argv[1], "hotplug"))
1338                         return main_hotplug(argc, argv);
1339
1340                 if (!strcmp(argv[1], "extroot"))
1341                         return main_extroot(argc, argv);
1342
1343                 if (!strcmp(argv[1], "mount"))
1344                         return main_mount(argc, argv);
1345
1346                 if (!strcmp(argv[1], "umount"))
1347                         return main_umount(argc, argv);
1348         }
1349
1350         fprintf(stderr, "Usage: block <info|mount|umount|detect>\n");
1351
1352         return -1;
1353 }