• source navigation  • diff markup  • identifier search  • freetext search  • 

Sources/fstools/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 #include <dirent.h>
 23 #include <stdarg.h>
 24 #include <string.h>
 25 #include <errno.h>
 26 #include <fcntl.h>
 27 #include <limits.h>
 28 
 29 #include <sys/stat.h>
 30 #include <sys/types.h>
 31 #include <sys/swap.h>
 32 #include <sys/mount.h>
 33 #include <sys/wait.h>
 34 #include <sys/sysmacros.h>
 35 
 36 #include <linux/fs.h>
 37 
 38 #include <uci.h>
 39 #include <uci_blob.h>
 40 
 41 #include <libubox/ulog.h>
 42 #include <libubox/list.h>
 43 #include <libubox/vlist.h>
 44 #include <libubox/blobmsg_json.h>
 45 #include <libubox/avl-cmp.h>
 46 #include <libubus.h>
 47 
 48 #include "probe.h"
 49 
 50 #define AUTOFS_MOUNT_PATH       "/tmp/run/blockd/"
 51 
 52 #ifdef UBIFS_EXTROOT
 53 #include "libubi/libubi.h"
 54 #endif
 55 
 56 enum {
 57         TYPE_MOUNT,
 58         TYPE_SWAP,
 59 };
 60 
 61 enum {
 62         TYPE_DEV,
 63         TYPE_HOTPLUG,
 64         TYPE_AUTOFS,
 65 };
 66 
 67 struct mount {
 68         struct vlist_node node;
 69         int type;
 70 
 71         char *target;
 72         char *path;
 73         char *options;
 74         uint32_t flags;
 75         char *uuid;
 76         char *label;
 77         char *device;
 78         int extroot;
 79         int autofs;
 80         int overlay;
 81         int disabled_fsck;
 82         unsigned int prio;
 83 };
 84 
 85 struct device {
 86         struct vlist_node node;
 87 
 88         struct probe_info *pr;
 89         struct mount *m;
 90 };
 91 
 92 static void vlist_nop_update(struct vlist_tree *tree, struct vlist_node *node_new,
 93                           struct vlist_node *node_old);
 94 static int devices_cmp(const void *k1, const void *k2, void *ptr);
 95 
 96 static struct blob_buf b;
 97 static VLIST_TREE(mounts, avl_strcmp, vlist_nop_update, false, false);
 98 static VLIST_TREE(devices, devices_cmp, vlist_nop_update, false, false);
 99 static int anon_mount, anon_swap, auto_mount, auto_swap, check_fs;
100 static unsigned int delay_root;
101 
102 enum {
103         CFG_ANON_MOUNT,
104         CFG_ANON_SWAP,
105         CFG_AUTO_MOUNT,
106         CFG_AUTO_SWAP,
107         CFG_DELAY_ROOT,
108         CFG_CHECK_FS,
109         __CFG_MAX
110 };
111 
112 static const struct blobmsg_policy config_policy[__CFG_MAX] = {
113         [CFG_ANON_SWAP] = { .name = "anon_swap", .type = BLOBMSG_TYPE_INT32 },
114         [CFG_ANON_MOUNT] = { .name = "anon_mount", .type = BLOBMSG_TYPE_INT32 },
115         [CFG_AUTO_SWAP] = { .name = "auto_swap", .type = BLOBMSG_TYPE_INT32 },
116         [CFG_AUTO_MOUNT] = { .name = "auto_mount", .type = BLOBMSG_TYPE_INT32 },
117         [CFG_DELAY_ROOT] = { .name = "delay_root", .type = BLOBMSG_TYPE_INT32 },
118         [CFG_CHECK_FS] = { .name = "check_fs", .type = BLOBMSG_TYPE_INT32 },
119 };
120 
121 enum {
122         MOUNT_UUID,
123         MOUNT_LABEL,
124         MOUNT_ENABLE,
125         MOUNT_TARGET,
126         MOUNT_DEVICE,
127         MOUNT_OPTIONS,
128         MOUNT_AUTOFS,
129         __MOUNT_MAX
130 };
131 
132 static const struct uci_blob_param_list config_attr_list = {
133         .n_params = __CFG_MAX,
134         .params = config_policy,
135 };
136 
137 static const struct blobmsg_policy mount_policy[__MOUNT_MAX] = {
138         [MOUNT_UUID] = { .name = "uuid", .type = BLOBMSG_TYPE_STRING },
139         [MOUNT_LABEL] = { .name = "label", .type = BLOBMSG_TYPE_STRING },
140         [MOUNT_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
141         [MOUNT_TARGET] = { .name = "target", .type = BLOBMSG_TYPE_STRING },
142         [MOUNT_OPTIONS] = { .name = "options", .type = BLOBMSG_TYPE_STRING },
143         [MOUNT_ENABLE] = { .name = "enabled", .type = BLOBMSG_TYPE_INT32 },
144         [MOUNT_AUTOFS] = { .name = "autofs", .type = BLOBMSG_TYPE_INT32 },
145 };
146 
147 static const struct uci_blob_param_list mount_attr_list = {
148         .n_params = __MOUNT_MAX,
149         .params = mount_policy,
150 };
151 
152 enum {
153         SWAP_ENABLE,
154         SWAP_UUID,
155         SWAP_LABEL,
156         SWAP_DEVICE,
157         SWAP_PRIO,
158         __SWAP_MAX
159 };
160 
161 static const struct blobmsg_policy swap_policy[__SWAP_MAX] = {
162         [SWAP_ENABLE] = { .name = "enabled", .type = BLOBMSG_TYPE_INT32 },
163         [SWAP_UUID] = { .name = "uuid", .type = BLOBMSG_TYPE_STRING },
164         [SWAP_LABEL] = { .name = "label", .type = BLOBMSG_TYPE_STRING },
165         [SWAP_DEVICE] = { .name = "device", .type = BLOBMSG_TYPE_STRING },
166         [SWAP_PRIO] = { .name = "priority", .type = BLOBMSG_TYPE_INT32 },
167 };
168 
169 static const struct uci_blob_param_list swap_attr_list = {
170         .n_params = __SWAP_MAX,
171         .params = swap_policy,
172 };
173 
174 struct mount_flag {
175         const char *name;
176         int32_t flag;
177 };
178 
179 static const struct mount_flag mount_flags[] = {
180         { "sync",               MS_SYNCHRONOUS  },
181         { "async",              ~MS_SYNCHRONOUS },
182         { "dirsync",            MS_DIRSYNC      },
183         { "mand",               MS_MANDLOCK     },
184         { "nomand",             ~MS_MANDLOCK    },
185         { "atime",              ~MS_NOATIME     },
186         { "noatime",            MS_NOATIME      },
187         { "dev",                ~MS_NODEV       },
188         { "nodev",              MS_NODEV        },
189         { "diratime",           ~MS_NODIRATIME  },
190         { "nodiratime",         MS_NODIRATIME   },
191         { "exec",               ~MS_NOEXEC      },
192         { "noexec",             MS_NOEXEC       },
193         { "suid",               ~MS_NOSUID      },
194         { "nosuid",             MS_NOSUID       },
195         { "rw",                 ~MS_RDONLY      },
196         { "ro",                 MS_RDONLY       },
197         { "relatime",           MS_RELATIME     },
198         { "norelatime",         ~MS_RELATIME    },
199         { "strictatime",        MS_STRICTATIME  },
200         { "acl",                MS_POSIXACL     },
201         { "noacl",              ~MS_POSIXACL    },
202         { "nouser_xattr",       MS_NOUSER       },
203         { "user_xattr",         ~MS_NOUSER      },
204 };
205 
206 static char *blobmsg_get_strdup(struct blob_attr *attr)
207 {
208         if (!attr)
209                 return NULL;
210 
211         return strdup(blobmsg_get_string(attr));
212 }
213 
214 static char *blobmsg_get_basename(struct blob_attr *attr)
215 {
216         if (!attr)
217                 return NULL;
218 
219         return strdup(basename(blobmsg_get_string(attr)));
220 }
221 
222 static void parse_mount_options(struct mount *m, char *optstr)
223 {
224         int i;
225         bool is_flag;
226         char *p, *opts, *last;
227 
228         m->flags = 0;
229         m->options = NULL;
230 
231         if (!optstr || !*optstr)
232                 return;
233 
234         m->options = opts = calloc(1, strlen(optstr) + 1);
235 
236         if (!m->options)
237                 return;
238 
239         p = last = optstr;
240 
241         do {
242                 p = strchr(p, ',');
243 
244                 if (p)
245                         *p++ = 0;
246 
247                 for (i = 0, is_flag = false; i < ARRAY_SIZE(mount_flags); i++) {
248                         if (!strcmp(last, mount_flags[i].name)) {
249                                 if (mount_flags[i].flag < 0)
250                                         m->flags &= (uint32_t)mount_flags[i].flag;
251                                 else
252                                         m->flags |= (uint32_t)mount_flags[i].flag;
253                                 is_flag = true;
254                                 break;
255                         }
256                 }
257 
258                 if (!is_flag)
259                         opts += sprintf(opts, "%s%s", (opts > m->options) ? "," : "", last);
260 
261                 last = p;
262 
263         } while (p);
264 
265         free(optstr);
266 }
267 
268 static int mount_add(struct uci_section *s)
269 {
270         struct blob_attr *tb[__MOUNT_MAX] = { 0 };
271         struct mount *m;
272 
273         blob_buf_init(&b, 0);
274         uci_to_blob(&b, s, &mount_attr_list);
275         blobmsg_parse(mount_policy, __MOUNT_MAX, tb, blob_data(b.head), blob_len(b.head));
276 
277         if (!tb[MOUNT_LABEL] && !tb[MOUNT_UUID] && !tb[MOUNT_DEVICE])
278                 return -1;
279 
280         if (tb[MOUNT_ENABLE] && !blobmsg_get_u32(tb[MOUNT_ENABLE]))
281                 return -1;
282 
283         m = malloc(sizeof(struct mount));
284         m->type = TYPE_MOUNT;
285         m->uuid = blobmsg_get_strdup(tb[MOUNT_UUID]);
286         m->label = blobmsg_get_strdup(tb[MOUNT_LABEL]);
287         m->target = blobmsg_get_strdup(tb[MOUNT_TARGET]);
288         m->device = blobmsg_get_basename(tb[MOUNT_DEVICE]);
289         if (tb[MOUNT_AUTOFS])
290                 m->autofs = blobmsg_get_u32(tb[MOUNT_AUTOFS]);
291         else
292                 m->autofs = 0;
293         parse_mount_options(m, blobmsg_get_strdup(tb[MOUNT_OPTIONS]));
294 
295         m->overlay = m->extroot = 0;
296         if (m->target && !strcmp(m->target, "/"))
297                 m->extroot = 1;
298         if (m->target && !strcmp(m->target, "/overlay"))
299                 m->extroot = m->overlay = 1;
300 
301         if (m->target && *m->target != '/') {
302                 ULOG_WARN("ignoring mount section %s due to invalid target '%s'\n",
303                           s->e.name, m->target);
304                 free(m);
305                 return -1;
306         }
307 
308         if (m->uuid)
309                 vlist_add(&mounts, &m->node, m->uuid);
310         else if (m->label)
311                 vlist_add(&mounts, &m->node, m->label);
312         else if (m->device)
313                 vlist_add(&mounts, &m->node, m->device);
314 
315         return 0;
316 }
317 
318 static int swap_add(struct uci_section *s)
319 {
320         struct blob_attr *tb[__SWAP_MAX] = { 0 };
321         struct mount *m;
322 
323         blob_buf_init(&b, 0);
324         uci_to_blob(&b, s, &swap_attr_list);
325         blobmsg_parse(swap_policy, __SWAP_MAX, tb, blob_data(b.head), blob_len(b.head));
326 
327         if (!tb[SWAP_UUID] && !tb[SWAP_LABEL] && !tb[SWAP_DEVICE])
328                 return -1;
329 
330         m = malloc(sizeof(struct mount));
331         memset(m, 0, sizeof(struct mount));
332         m->type = TYPE_SWAP;
333         m->uuid = blobmsg_get_strdup(tb[SWAP_UUID]);
334         m->label = blobmsg_get_strdup(tb[SWAP_LABEL]);
335         m->device = blobmsg_get_basename(tb[SWAP_DEVICE]);
336         if (tb[SWAP_PRIO])
337                 m->prio = blobmsg_get_u32(tb[SWAP_PRIO]);
338         if (m->prio)
339                 m->prio = ((m->prio << SWAP_FLAG_PRIO_SHIFT) & SWAP_FLAG_PRIO_MASK) | SWAP_FLAG_PREFER;
340 
341         if ((!tb[SWAP_ENABLE]) || blobmsg_get_u32(tb[SWAP_ENABLE])) {
342                 /* store complete swap path */
343                 if (tb[SWAP_DEVICE])
344                         m->target = blobmsg_get_strdup(tb[SWAP_DEVICE]);
345 
346                 if (m->uuid)
347                         vlist_add(&mounts, &m->node, m->uuid);
348                 else if (m->label)
349                         vlist_add(&mounts, &m->node, m->label);
350                 else if (m->device)
351                         vlist_add(&mounts, &m->node, m->device);
352         }
353 
354         return 0;
355 }
356 
357 static int global_add(struct uci_section *s)
358 {
359         struct blob_attr *tb[__CFG_MAX] = { 0 };
360 
361         blob_buf_init(&b, 0);
362         uci_to_blob(&b, s, &config_attr_list);
363         blobmsg_parse(config_policy, __CFG_MAX, tb, blob_data(b.head), blob_len(b.head));
364 
365         if ((tb[CFG_ANON_MOUNT]) && blobmsg_get_u32(tb[CFG_ANON_MOUNT]))
366                 anon_mount = 1;
367         if ((tb[CFG_ANON_SWAP]) && blobmsg_get_u32(tb[CFG_ANON_SWAP]))
368                 anon_swap = 1;
369 
370         if ((tb[CFG_AUTO_MOUNT]) && blobmsg_get_u32(tb[CFG_AUTO_MOUNT]))
371                 auto_mount = 1;
372         if ((tb[CFG_AUTO_SWAP]) && blobmsg_get_u32(tb[CFG_AUTO_SWAP]))
373                 auto_swap = 1;
374 
375         if (tb[CFG_DELAY_ROOT])
376                 delay_root = blobmsg_get_u32(tb[CFG_DELAY_ROOT]);
377 
378         if ((tb[CFG_CHECK_FS]) && blobmsg_get_u32(tb[CFG_CHECK_FS]))
379                 check_fs = 1;
380 
381         return 0;
382 }
383 
384 static struct mount* find_swap(const char *uuid, const char *label, const char *device)
385 {
386         struct mount *m;
387 
388         vlist_for_each_element(&mounts, m, node) {
389                 if (m->type != TYPE_SWAP)
390                         continue;
391                 if (uuid && m->uuid && !strcasecmp(m->uuid, uuid))
392                         return m;
393                 if (label && m->label && !strcmp(m->label, label))
394                         return m;
395                 if (device && m->device && !strcmp(m->device, device))
396                         return m;
397         }
398 
399         return NULL;
400 }
401 
402 static struct mount* find_block(const char *uuid, const char *label, const char *device,
403                                 const char *target)
404 {
405         struct mount *m;
406 
407         vlist_for_each_element(&mounts, m, node) {
408                 if (m->type != TYPE_MOUNT)
409                         continue;
410                 if (m->uuid && uuid && !strcasecmp(m->uuid, uuid))
411                         return m;
412                 if (m->label && label && !strcmp(m->label, label))
413                         return m;
414                 if (m->target && target && !strcmp(m->target, target))
415                         return m;
416                 if (m->device && device && !strcmp(m->device, device))
417                         return m;
418         }
419 
420         return NULL;
421 }
422 
423 static void vlist_nop_update(struct vlist_tree *tree, struct vlist_node *node_new,
424                           struct vlist_node *node_old)
425 {
426         // NOTE: free on delete skipped
427 }
428 
429 static struct uci_package * config_try_load(struct uci_context *ctx, char *path)
430 {
431         char *file = basename(path);
432         char *dir = dirname(path);
433         char *err;
434         struct uci_package *pkg;
435 
436         uci_set_confdir(ctx, dir);
437         ULOG_INFO("attempting to load %s/%s\n", dir, file);
438 
439         if (uci_load(ctx, file, &pkg)) {
440                 uci_get_errorstr(ctx, &err, file);
441                 ULOG_ERR("unable to load configuration (%s)\n", err);
442 
443                 free(err);
444                 return NULL;
445         }
446 
447         return pkg;
448 }
449 
450 static int config_load(char *cfg)
451 {
452         struct uci_context *ctx = uci_alloc_context();
453         struct uci_package *pkg = NULL;
454         struct uci_element *e;
455         char path[64];
456 
457         if (cfg) {
458                 snprintf(path, sizeof(path), "%s/upper/etc/config/fstab", cfg);
459                 pkg = config_try_load(ctx, path);
460 
461                 if (!pkg) {
462                         snprintf(path, sizeof(path), "%s/etc/config/fstab", cfg);
463                         pkg = config_try_load(ctx, path);
464                 }
465         }
466 
467         if (!pkg) {
468                 snprintf(path, sizeof(path), "/etc/config/fstab");
469                 pkg = config_try_load(ctx, path);
470         }
471 
472         if (!pkg) {
473                 ULOG_ERR("no usable configuration\n");
474                 return -1;
475         }
476 
477         vlist_update(&mounts);
478         uci_foreach_element(&pkg->sections, e) {
479                 struct uci_section *s = uci_to_section(e);
480 
481                 if (!strcmp(s->type, "mount"))
482                         mount_add(s);
483                 if (!strcmp(s->type, "swap"))
484                         swap_add(s);
485                 if (!strcmp(s->type, "global"))
486                         global_add(s);
487         }
488         vlist_flush(&mounts);
489 
490         return 0;
491 }
492 
493 static struct probe_info* _probe_path(char *path)
494 {
495         struct device *dev;
496         char tmppath[64];
497 
498         /* skip ubi device if ubiblock device is present */
499         if (path[5] == 'u' && path[6] == 'b' && path[7] == 'i' &&
500             path[8] >= '' && path[8] <= '9' ) {
501                 snprintf(tmppath, sizeof(tmppath), "/dev/ubiblock%s", path + 8);
502                 vlist_for_each_element(&devices, dev, node)
503                         if (!strcasecmp(dev->pr->dev, tmppath))
504                                 return NULL;
505         }
506 
507         return probe_path(path);
508 }
509 
510 static int _cache_load(const char *path)
511 {
512         int gl_flags = GLOB_NOESCAPE | GLOB_MARK;
513         int j;
514         glob_t gl;
515         struct device *dev;
516 
517         if (glob(path, gl_flags, NULL, &gl) < 0)
518                 return -1;
519 
520         for (j = 0; j < gl.gl_pathc; j++) {
521                 struct probe_info *pr = _probe_path(gl.gl_pathv[j]);
522                 if (pr) {
523                         dev = malloc(sizeof(struct device));
524                         dev->pr = pr;
525                         dev->m = find_block(pr->uuid, pr->label,
526                                         basename(pr->dev), NULL);
527                         vlist_add(&devices, &dev->node, dev);
528                 }
529         }
530 
531         globfree(&gl);
532 
533         return 0;
534 }
535 
536 static int devices_cmp(const void *k1, const void *k2, void *ptr)
537 {
538         struct device *dev1 = (struct device *)k1;
539         struct device *dev2 = (struct device *)k2;
540 
541         if (dev1->m) {
542                 if (!dev2->m)
543                         return -1;
544                 if (dev1->m->type == TYPE_MOUNT && dev2->m->type == TYPE_MOUNT &&
545                                 dev1->m->target && dev2->m->target) {
546                         int len1 = strlen(dev1->m->target);
547                         int len2 = strlen(dev2->m->target);
548                         if (len1 != len2)
549                                 return len1 - len2;
550                 }
551         } else if (dev2->m) {
552                 return 1;
553         }
554         return strcmp(dev1->pr->dev, dev2->pr->dev);
555 }
556 
557 static void cache_load(int mtd)
558 {
559         vlist_update(&devices);
560         if (mtd) {
561                 _cache_load("/dev/mtdblock*");
562                 _cache_load("/dev/ubiblock*");
563                 _cache_load("/dev/ubi[0-9]*");
564         }
565         _cache_load("/dev/loop*");
566         _cache_load("/dev/mmcblk*");
567         _cache_load("/dev/sd*");
568         _cache_load("/dev/hd*");
569         _cache_load("/dev/md*");
570         _cache_load("/dev/nvme*");
571         _cache_load("/dev/vd*");
572         _cache_load("/dev/xvd*");
573         _cache_load("/dev/mapper/*");
574         vlist_flush(&devices);
575 }
576 
577 
578 static struct device* find_block_device(char *uuid, char *label, char *path)
579 {
580         struct device *dev;
581 
582         if (uuid)
583                 vlist_for_each_element(&devices, dev, node)
584                         if (dev->pr->uuid && !strcasecmp(dev->pr->uuid, uuid))
585                                 return dev;
586 
587         if (label)
588                 vlist_for_each_element(&devices, dev, node)
589                         if (dev->pr->label && !strcmp(dev->pr->label, label))
590                                 return dev;
591 
592         if (path)
593                 vlist_for_each_element(&devices, dev, node)
594                         if (dev->pr->dev && !strcmp(basename(dev->pr->dev), basename(path)))
595                                 return dev;
596 
597         return NULL;
598 }
599 
600 static char* find_mount_point(char *block)
601 {
602         FILE *fp = fopen("/proc/self/mountinfo", "r");
603         static char line[256];
604         char *point = NULL, *pos, *tmp, *cpoint, *devname;
605         struct stat s;
606         int rstat;
607         unsigned int minor, major;
608 
609         if (!fp)
610                 return NULL;
611 
612         rstat = stat(block, &s);
613 
614         while (fgets(line, sizeof(line), fp)) {
615                 pos = strchr(line, ' ');
616                 if (!pos)
617                         continue;
618 
619                 pos = strchr(pos + 1, ' ');
620                 if (!pos)
621                         continue;
622 
623                 tmp = ++pos;
624                 pos = strchr(pos, ':');
625                 if (!pos)
626                         continue;
627 
628                 *pos = '\0';
629                 major = atoi(tmp);
630                 tmp = ++pos;
631                 pos = strchr(pos, ' ');
632                 if (!pos)
633                         continue;
634 
635                 *pos = '\0';
636                 minor = atoi(tmp);
637                 pos = strchr(pos + 1, ' ');
638                 if (!pos)
639                         continue;
640                 tmp = ++pos;
641 
642                 pos = strchr(pos, ' ');
643                 if (!pos)
644                         continue;
645                 *pos = '\0';
646                 cpoint = tmp;
647 
648                 pos = strchr(pos + 1, ' ');
649                 if (!pos)
650                         continue;
651 
652                 pos = strchr(pos + 1, ' ');
653                 if (!pos)
654                         continue;
655 
656                 pos = strchr(pos + 1, ' ');
657                 if (!pos)
658                         continue;
659 
660                 tmp = ++pos;
661                 pos = strchr(pos, ' ');
662                 if (!pos)
663                         continue;
664 
665                 *pos = '\0';
666                 devname = tmp;
667                 if (!strcmp(block, devname)) {
668                         point = strdup(cpoint);
669                         break;
670                 }
671 
672                 if (rstat)
673                         continue;
674 
675                 if (!S_ISBLK(s.st_mode))
676                         continue;
677 
678                 if (major == major(s.st_rdev) &&
679                     minor == minor(s.st_rdev)) {
680                         point = strdup(cpoint);
681                         break;
682                 }
683         }
684 
685         fclose(fp);
686 
687         return point;
688 }
689 
690 static int print_block_uci(struct probe_info *pr)
691 {
692         if (!strcmp(pr->type, "swap")) {
693                 printf("config 'swap'\n");
694         } else {
695                 char *mp = find_mount_point(pr->dev);
696 
697                 printf("config 'mount'\n");
698                 if (mp) {
699                         printf("\toption\ttarget\t'%s'\n", mp);
700                         free(mp);
701                 } else {
702                         printf("\toption\ttarget\t'/mnt/%s'\n", basename(pr->dev));
703                 }
704         }
705         if (pr->uuid)
706                 printf("\toption\tuuid\t'%s'\n", pr->uuid);
707         else
708                 printf("\toption\tdevice\t'%s'\n", pr->dev);
709         printf("\toption\tenabled\t''\n\n");
710 
711         return 0;
712 }
713 
714 static int print_block_info(struct probe_info *pr)
715 {
716         static char *mp;
717 
718         mp = find_mount_point(pr->dev);
719         printf("%s:", pr->dev);
720         if (pr->uuid)
721                 printf(" UUID=\"%s\"", pr->uuid);
722 
723         if (pr->label)
724                 printf(" LABEL=\"%s\"", pr->label);
725 
726         if (pr->version)
727                 printf(" VERSION=\"%s\"", pr->version);
728 
729         if (mp) {
730                 printf(" MOUNT=\"%s\"", mp);
731                 free(mp);
732         }
733 
734         printf(" TYPE=\"%s\"\n", pr->type);
735 
736         return 0;
737 }
738 
739 static void mkdir_p(char *dir)
740 {
741         char *l = strrchr(dir, '/');
742 
743         if (l) {
744                 *l = '\0';
745                 mkdir_p(dir);
746                 *l = '/';
747                 mkdir(dir, 0755);
748         }
749 }
750 
751 static void check_filesystem(struct probe_info *pr)
752 {
753         pid_t pid;
754         struct stat statbuf;
755         const char *e2fsck = "/usr/sbin/e2fsck";
756         const char *f2fsck = "/usr/sbin/fsck.f2fs";
757         const char *fatfsck = "/usr/sbin/fsck.fat";
758         const char *btrfsck = "/usr/bin/btrfsck";
759         const char *ntfsck = "/usr/bin/ntfsfix";
760         const char *ckfs;
761 
762         /* UBIFS does not need stuff like fsck */
763         if (!strncmp(pr->type, "ubifs", 5))
764                 return;
765 
766         if (!strncmp(pr->type, "vfat", 4)) {
767                 ckfs = fatfsck;
768         } else if (!strncmp(pr->type, "f2fs", 4)) {
769                 ckfs = f2fsck;
770         } else if (!strncmp(pr->type, "ext", 3)) {
771                 ckfs = e2fsck;
772         } else if (!strncmp(pr->type, "btrfs", 5)) {
773                 ckfs = btrfsck;
774         } else if (!strncmp(pr->type, "ntfs", 4)) {
775                 ckfs = ntfsck;
776         } else {
777                 ULOG_ERR("check_filesystem: %s is not supported\n", pr->type);
778                 return;
779         }
780 
781         if (stat(ckfs, &statbuf) < 0) {
782                 ULOG_ERR("check_filesystem: %s not found\n", ckfs);
783                 return;
784         }
785 
786         pid = fork();
787         if (!pid) {
788                 if(!strncmp(pr->type, "f2fs", 4)) {
789                         execl(ckfs, ckfs, "-f", pr->dev, NULL);
790                         exit(EXIT_FAILURE);
791                 } else if(!strncmp(pr->type, "btrfs", 5)) {
792                         execl(ckfs, ckfs, "--repair", pr->dev, NULL);
793                         exit(EXIT_FAILURE);
794                 } else if(!strncmp(pr->type, "ntfs", 4)) {
795                         execl(ckfs, ckfs, "-b", pr->dev, NULL);
796                         exit(EXIT_FAILURE);
797                 } else {
798                         execl(ckfs, ckfs, "-p", pr->dev, NULL);
799                         exit(EXIT_FAILURE);
800                 }
801         } else if (pid > 0) {
802                 int status;
803 
804                 waitpid(pid, &status, 0);
805                 if (WIFEXITED(status) && WEXITSTATUS(status))
806                         ULOG_ERR("check_filesystem: %s returned %d\n", ckfs, WEXITSTATUS(status));
807                 if (WIFSIGNALED(status))
808                         ULOG_ERR("check_filesystem: %s terminated by %s\n", ckfs, strsignal(WTERMSIG(status)));
809         }
810 }
811 
812 static void handle_swapfiles(bool on)
813 {
814         struct stat s;
815         struct mount *m;
816         struct probe_info *pr;
817 
818         vlist_for_each_element(&mounts, m, node)
819         {
820                 if (m->type != TYPE_SWAP || !m->target)
821                         continue;
822 
823                 if (stat(m->target, &s) || !S_ISREG(s.st_mode))
824                         continue;
825 
826                 pr = _probe_path(m->target);
827 
828                 if (!pr)
829                         continue;
830 
831                 if (!strcmp(pr->type, "swap")) {
832                         if (on)
833                                 swapon(pr->dev, m->prio);
834                         else
835                                 swapoff(pr->dev);
836                 }
837 
838                 free(pr);
839         }
840 }
841 
842 static void to_devnull(int fd)
843 {
844         int devnull = open("/dev/null", fd ? O_WRONLY : O_RDONLY);
845 
846         if (devnull >= 0)
847                 dup2(devnull, fd);
848 
849         if (devnull > STDERR_FILENO)
850                 close(devnull);
851 }
852 
853 static int exec_mount(const char *source, const char *target,
854                       const char *fstype, const char *options)
855 {
856         pid_t pid;
857         struct stat s;
858         FILE *mount_fd;
859         int err, status, pfds[2];
860         char errmsg[128], cmd[sizeof("/sbin/mount.XXXXXXXXXXXXXXXX\0")];
861 
862         snprintf(cmd, sizeof(cmd), "/sbin/mount.%s", fstype);
863 
864         if (stat(cmd, &s) < 0 || !S_ISREG(s.st_mode) || !(s.st_mode & S_IXUSR)) {
865                 ULOG_ERR("No \"mount.%s\" utility available\n", fstype);
866                 return -1;
867         }
868 
869         if (pipe(pfds) < 0)
870                 return -1;
871 
872         fcntl(pfds[0], F_SETFD, fcntl(pfds[0], F_GETFD) | FD_CLOEXEC);
873         fcntl(pfds[1], F_SETFD, fcntl(pfds[1], F_GETFD) | FD_CLOEXEC);
874 
875         pid = vfork();
876 
877         switch (pid) {
878         case -1:
879                 close(pfds[0]);
880                 close(pfds[1]);
881 
882                 return -1;
883 
884         case 0:
885                 to_devnull(STDIN_FILENO);
886                 to_devnull(STDOUT_FILENO);
887 
888                 dup2(pfds[1], STDERR_FILENO);
889                 close(pfds[0]);
890                 close(pfds[1]);
891 
892                 if (options && *options)
893                         execl(cmd, cmd, "-o", options, source, target, NULL);
894                 else
895                         execl(cmd, cmd, source, target, NULL);
896 
897                 return -1;
898 
899         default:
900                 close(pfds[1]);
901 
902                 mount_fd = fdopen(pfds[0], "r");
903 
904                 while (fgets(errmsg, sizeof(errmsg), mount_fd))
905                         ULOG_ERR("mount.%s: %s", fstype, errmsg);
906 
907                 fclose(mount_fd);
908 
909                 err = waitpid(pid, &status, 0);
910 
911                 if (err != -1) {
912                         if (status != 0) {
913                                 ULOG_ERR("mount.%s: failed with status %d\n", fstype, status);
914                                 errno = EINVAL;
915                                 err = -1;
916                         } else {
917                                 errno = 0;
918                                 err = 0;
919                         }
920                 }
921 
922                 break;
923         }
924 
925         return err;
926 }
927 
928 static int hotplug_call_mount(const char *action, const char *device)
929 {
930         pid_t pid;
931         int err = 0;
932 
933         pid = fork();
934         if (!pid) {
935                 char * const argv[] = { "hotplug-call", "mount", NULL };
936 
937                 setenv("ACTION", action, 1);
938                 setenv("DEVICE", device, 1);
939 
940                 execv("/sbin/hotplug-call", argv);
941                 exit(-1);
942         } else if (pid > 0) {
943                 int status;
944 
945                 pid = waitpid(pid, &status, 0);
946                 if (pid <= 0 || !WIFEXITED(status) || WEXITSTATUS(status)) {
947                         err = -ENOEXEC;
948                         ULOG_ERR("hotplug-call call failed\n");
949                 }
950         } else {
951                 err = -errno;
952         }
953 
954         return err;
955 }
956 
957 static int handle_mount(const char *source, const char *target,
958                         const char *fstype, struct mount *m)
959 {
960         int i, err;
961         size_t mount_opts_len;
962         char *mount_opts = NULL, *ptr;
963 
964         err = mount(source, target, fstype, m ? m->flags : 0,
965                     (m && m->options) ? m->options : "");
966 
967         /* Requested file system type is not available in kernel,
968            attempt to call mount helper. */
969         if (err == -1 && errno == ENODEV) {
970                 if (m) {
971                         /* Convert mount flags back into string representation,
972                            first calculate needed length of string buffer... */
973                         mount_opts_len = 1 + (m->options ? strlen(m->options) : 0);
974 
975                         for (i = 0; i < ARRAY_SIZE(mount_flags); i++)
976                                 if ((mount_flags[i].flag > 0) &&
977                                     (mount_flags[i].flag < INT_MAX) &&
978                                     (m->flags & (uint32_t)mount_flags[i].flag))
979                                         mount_opts_len += strlen(mount_flags[i].name) + 1;
980 
981                         /* ... then now allocate and fill it ... */
982                         ptr = mount_opts = calloc(1, mount_opts_len);
983 
984                         if (!ptr) {
985                                 errno = ENOMEM;
986                                 return -1;
987                         }
988 
989                         if (m->options)
990                                 ptr += sprintf(ptr, "%s,", m->options);
991 
992                         for (i = 0; i < ARRAY_SIZE(mount_flags); i++)
993                                 if ((mount_flags[i].flag > 0) &&
994                                     (mount_flags[i].flag < INT_MAX) &&
995                                     (m->flags & (uint32_t)mount_flags[i].flag))
996                                         ptr += sprintf(ptr, "%s,", mount_flags[i].name);
997 
998                         mount_opts[mount_opts_len - 1] = 0;
999                 }
1000 
1001                 /* ... and now finally invoke the external mount program */
1002                 err = exec_mount(source, target, fstype, mount_opts);
1003         }
1004 
1005         return err;
1006 }
1007 
1008 static int blockd_notify(char *device, struct mount *m, struct probe_info *pr)
1009 {
1010         struct ubus_context *ctx = ubus_connect(NULL);
1011         uint32_t id;
1012         int err;
1013 
1014         if (!ctx)
1015                 return -ENXIO;
1016 
1017         if (!ubus_lookup_id(ctx, "block", &id)) {
1018                 struct blob_buf buf = { 0 };
1019                 char *d = strrchr(device, '/');
1020 
1021                 if (d)
1022                         d++;
1023                 else
1024                         d = device;
1025 
1026                 blob_buf_init(&buf, 0);
1027 
1028                 if (m) {
1029 
1030                         blobmsg_add_string(&buf, "device", d);
1031                         if (m->uuid)
1032                                 blobmsg_add_string(&buf, "uuid", m->uuid);
1033                         if (m->label)
1034                                 blobmsg_add_string(&buf, "label", m->label);
1035                         if (m->target)
1036                                 blobmsg_add_string(&buf, "target", m->target);
1037                         if (m->options)
1038                                 blobmsg_add_string(&buf, "options", m->options);
1039                         if (m->autofs)
1040                                 blobmsg_add_u32(&buf, "autofs", m->autofs);
1041                         if (pr->type)
1042                                 blobmsg_add_string(&buf, "type", pr->type);
1043                         if (pr->version)
1044                                 blobmsg_add_string(&buf, "version", pr->version);
1045                 } else if (pr) {
1046                         blobmsg_add_string(&buf, "device", d);
1047                         if (pr->uuid)
1048                                 blobmsg_add_string(&buf, "uuid", pr->uuid);
1049                         if (pr->label)
1050                                 blobmsg_add_string(&buf, "label", pr->label);
1051                         if (pr->type)
1052                                 blobmsg_add_string(&buf, "type", pr->type);
1053                         if (pr->version)
1054                                 blobmsg_add_string(&buf, "version", pr->version);
1055                         blobmsg_add_u32(&buf, "anon", 1);
1056                 } else {
1057                         blobmsg_add_string(&buf, "device", d);
1058                         blobmsg_add_u32(&buf, "remove", 1);
1059                 }
1060 
1061                 err = ubus_invoke(ctx, id, "hotplug", buf.head, NULL, NULL, 3000);
1062         } else {
1063                 err = -ENOENT;
1064         }
1065 
1066         ubus_free(ctx);
1067 
1068         return err;
1069 }
1070 
1071 static int mount_device(struct device *dev, int type)
1072 {
1073         struct mount *m;
1074         struct probe_info *pr;
1075         char _target[32];
1076         char *target;
1077         char *device;
1078         char *mp;
1079         int err;
1080 
1081         if (!dev)
1082                 return -1;
1083 
1084         pr = dev->pr;
1085         device = basename(pr->dev);
1086 
1087         if (!strcmp(pr->type, "swap")) {
1088                 if ((type == TYPE_HOTPLUG) && !auto_swap)
1089                         return -1;
1090                 m = find_swap(pr->uuid, pr->label, device);
1091                 if (m || anon_swap)
1092                         swapon(pr->dev, (m) ? (m->prio) : (0));
1093 
1094                 return 0;
1095         }
1096 
1097         m = dev->m;
1098         if (m && m->extroot)
1099                 return -1;
1100 
1101         mp = find_mount_point(pr->dev);
1102         if (mp) {
1103                 if (m && m->type == TYPE_MOUNT && strcmp(m->target, mp)) {
1104                         ULOG_ERR("%s is already mounted on %s\n", pr->dev, mp);
1105                         err = -1;
1106                 } else
1107                         err = 0;
1108                 free(mp);
1109                 return err;
1110         }
1111 
1112         if (type == TYPE_HOTPLUG)
1113                 blockd_notify(device, m, pr);
1114 
1115         /* Check if device should be mounted & set the target directory */
1116         if (m) {
1117                 switch (type) {
1118                 case TYPE_HOTPLUG:
1119                         if (m->autofs)
1120                                 return 0;
1121                         if (!auto_mount)
1122                                 return -1;
1123                         break;
1124                 case TYPE_AUTOFS:
1125                         if (!m->autofs)
1126                                 return -1;
1127                         break;
1128                 case TYPE_DEV:
1129                         if (m->autofs)
1130                                 return -1;
1131                         break;
1132                 }
1133 
1134                 if (m->autofs) {
1135                         snprintf(_target, sizeof(_target), "/tmp/run/blockd/%s", device);
1136                         target = _target;
1137                 } else if (m->target) {
1138                         target = m->target;
1139                 } else {
1140                         snprintf(_target, sizeof(_target), "/mnt/%s", device);
1141                         target = _target;
1142                 }
1143         } else if (anon_mount) {
1144                 snprintf(_target, sizeof(_target), "/mnt/%s", device);
1145                 target = _target;
1146         } else {
1147                 /* No reason to mount this device */
1148                 return 0;
1149         }
1150 
1151         /* Mount the device */
1152 
1153         if (check_fs)
1154                 check_filesystem(pr);
1155 
1156         mkdir_p(target);
1157 
1158         err = handle_mount(pr->dev, target, pr->type, m);
1159         if (err) {
1160                 ULOG_ERR("mounting %s (%s) as %s failed (%d) - %m\n",
1161                                 pr->dev, pr->type, target, errno);
1162                 return err;
1163         }
1164 
1165         handle_swapfiles(true);
1166 
1167         if (type != TYPE_AUTOFS)
1168                 hotplug_call_mount("add", device);
1169 
1170         return 0;
1171 }
1172 
1173 static int umount_device(char *path, int type, bool all)
1174 {
1175         char *mp;
1176         int err;
1177 
1178         mp = find_mount_point(path);
1179         if (!mp)
1180                 return -1;
1181         if (!strcmp(mp, "/") && !all)
1182                 return 0;
1183 
1184         if (type != TYPE_AUTOFS)
1185                 hotplug_call_mount("remove", basename(path));
1186 
1187         err = umount2(mp, MNT_DETACH);
1188         if (err) {
1189                 ULOG_ERR("unmounting %s (%s) failed (%d) - %m\n", path, mp,
1190                          errno);
1191         } else {
1192                 ULOG_INFO("unmounted %s (%s)\n", path, mp);
1193                 rmdir(mp);
1194         }
1195 
1196         free(mp);
1197         return err;
1198 }
1199 
1200 static int mount_action(char *action, char *device, int type)
1201 {
1202         struct device *the_dev, *dev;
1203         char path[32];
1204 
1205         if (!action || !device)
1206                 return -1;
1207 
1208         if (config_load(NULL))
1209                 return -1;
1210         cache_load(0);
1211 
1212         the_dev = find_block_device(NULL, NULL, device);
1213 
1214         if (!strcmp(action, "remove")) {
1215                 if (type == TYPE_HOTPLUG)
1216                         blockd_notify(device, NULL, NULL);
1217 
1218                 if (!the_dev || !the_dev->m || the_dev->m->type != TYPE_MOUNT) {
1219                         snprintf(path, sizeof(path), "/dev/%s", device);
1220                         umount_device(path, type, true);
1221                 } else
1222                         vlist_for_element_to_last_reverse(&devices, the_dev, dev, node)
1223                                 if (dev->m && dev->m->type == TYPE_MOUNT)
1224                                         umount_device(dev->pr->dev, type, true);
1225                 return 0;
1226         } else if (!strcmp(action, "add")) {
1227                 if (!the_dev)
1228                         return -1;
1229                 if (the_dev->m && the_dev->m->type == TYPE_MOUNT) {
1230                         vlist_for_first_to_element(&devices, the_dev, dev, node) {
1231                                 if (dev->m && dev->m->type == TYPE_MOUNT) {
1232                                         int err = mount_device(dev, type);
1233                                         if (err)
1234                                                 return err;
1235                                 }
1236                         }
1237                         return 0;
1238                 } else
1239                         return mount_device(the_dev, type);
1240         }
1241         ULOG_ERR("Unkown action %s\n", action);
1242         return -1;
1243 }
1244 
1245 static int main_hotplug(int argc, char **argv)
1246 {
1247         return mount_action(getenv("ACTION"), getenv("DEVNAME"), TYPE_HOTPLUG);
1248 }
1249 
1250 static int main_autofs(int argc, char **argv)
1251 {
1252         int err = 0;
1253 
1254         if (argc < 3)
1255                 return -1;
1256 
1257         if (!strcmp(argv[2], "start")) {
1258                 struct device *dev;
1259                 struct probe_info *pr;
1260 
1261                 if (config_load(NULL))
1262                         return -1;
1263 
1264                 cache_load(0);
1265                 vlist_for_each_element(&devices, dev, node) {
1266                         struct mount *m;
1267 
1268                         pr = dev->pr;
1269                         if (!strcmp(pr->type, "swap"))
1270                                 continue;
1271 
1272                         m = dev->m;
1273                         if (m && m->extroot)
1274                                 continue;
1275 
1276                         blockd_notify(pr->dev, m, pr);
1277                 }
1278         } else if (!strcmp(argv[2], "available")) {
1279                 err = hotplug_call_mount("add", argv[3]);
1280         } else if (!strcmp(argv[2], "unavailable")) {
1281                 err = hotplug_call_mount("remove", argv[3]);
1282         } else {
1283                 if (argc < 4)
1284                         return -EINVAL;
1285 
1286                 err = mount_action(argv[2], argv[3], TYPE_AUTOFS);
1287         }
1288 
1289         if (err) {
1290                 ULOG_ERR("autofs: \"%s\" action has failed: %d\n", argv[2], err);
1291         }
1292 
1293         return err;
1294 }
1295 
1296 static int find_block_mtd(char *name, char *part, int plen)
1297 {
1298         FILE *fp = fopen("/proc/mtd", "r");
1299         static char line[256];
1300         char *index = NULL;
1301 
1302         if(!fp)
1303                 return -1;
1304 
1305         while (!index && fgets(line, sizeof(line), fp)) {
1306                 if (strstr(line, name)) {
1307                         char *eol = strstr(line, ":");
1308 
1309                         if (!eol)
1310                                 continue;
1311 
1312                         *eol = '\0';
1313                         index = &line[3];
1314                 }
1315         }
1316 
1317         fclose(fp);
1318 
1319         if (!index)
1320                 return -1;
1321 
1322         snprintf(part, plen, "/dev/mtdblock%s", index);
1323 
1324         return 0;
1325 }
1326 
1327 #ifdef UBIFS_EXTROOT
1328 static int find_ubi_vol(libubi_t libubi, char *name, int *dev_num, int *vol_id)
1329 {
1330         int dev = 0;
1331 
1332         while (ubi_dev_present(libubi, dev))
1333         {
1334                 struct ubi_dev_info dev_info;
1335                 struct ubi_vol_info vol_info;
1336 
1337                 if (ubi_get_dev_info1(libubi, dev++, &dev_info))
1338                         continue;
1339                 if (ubi_get_vol_info1_nm(libubi, dev_info.dev_num, name, &vol_info))
1340                         continue;
1341 
1342                 *dev_num = dev_info.dev_num;
1343                 *vol_id = vol_info.vol_id;
1344 
1345                 return 0;
1346         }
1347 
1348         return -1;
1349 }
1350 
1351 static int find_block_ubi(libubi_t libubi, char *name, char *part, int plen)
1352 {
1353         int dev_num;
1354         int vol_id;
1355         int err = -1;
1356 
1357         err = find_ubi_vol(libubi, name, &dev_num, &vol_id);
1358         if (!err)
1359                 snprintf(part, plen, "/dev/ubi%d_%d", dev_num, vol_id);
1360 
1361         return err;
1362 }
1363 
1364 static int find_block_ubi_RO(libubi_t libubi, char *name, char *part, int plen)
1365 {
1366         int dev_num;
1367         int vol_id;
1368         int err = -1;
1369 
1370         err = find_ubi_vol(libubi, name, &dev_num, &vol_id);
1371         if (!err)
1372                 snprintf(part, plen, "/dev/ubiblock%d_%d", dev_num, vol_id);
1373 
1374         return err;
1375 }
1376 
1377 #else
1378 
1379 static int find_root_dev(char *buf, int len)
1380 {
1381         DIR *d;
1382         dev_t root;
1383         struct stat s;
1384         struct dirent *e;
1385 
1386         if (stat("/", &s))
1387                 return -1;
1388 
1389         if (!(d = opendir("/dev")))
1390                 return -1;
1391 
1392         root = s.st_dev;
1393 
1394         while ((e = readdir(d)) != NULL) {
1395                 snprintf(buf, len, "/dev/%s", e->d_name);
1396 
1397                 if (stat(buf, &s) || s.st_rdev != root)
1398                         continue;
1399 
1400                 closedir(d);
1401                 return 0;
1402         }
1403 
1404         closedir(d);
1405         return -1;
1406 }
1407 
1408 #endif
1409 
1410 static int test_fs_support(const char *name)
1411 {
1412         char line[128], *p;
1413         int rv = -1;
1414         FILE *f;
1415 
1416         if ((f = fopen("/proc/filesystems", "r")) != NULL) {
1417                 while (fgets(line, sizeof(line), f)) {
1418                         p = strtok(line, "\t\n");
1419 
1420                         if (p && !strcmp(p, "nodev"))
1421                                 p = strtok(NULL, "\t\n");
1422 
1423                         if (p && !strcmp(p, name)) {
1424                                 rv = 0;
1425                                 break;
1426                         }
1427                 }
1428                 fclose(f);
1429         }
1430 
1431         return rv;
1432 }
1433 
1434 static int check_extroot(char *path)
1435 {
1436         struct device *dev;
1437         struct probe_info *pr;
1438         char devpath[32];
1439 
1440 #ifdef UBIFS_EXTROOT
1441         if (find_block_mtd("\"rootfs\"", devpath, sizeof(devpath))) {
1442                 int err = -1;
1443                 libubi_t libubi;
1444 
1445                 libubi = libubi_open();
1446                 err = find_block_ubi_RO(libubi, "rootfs", devpath, sizeof(devpath));
1447                 libubi_close(libubi);
1448                 if (err)
1449                         return -1;
1450         }
1451 #else
1452         if (find_block_mtd("\"rootfs\"", devpath, sizeof(devpath))) {
1453                 if (find_root_dev(devpath, sizeof(devpath))) {
1454                         ULOG_ERR("extroot: unable to determine root device\n");
1455                         return -1;
1456                 }
1457         }
1458 #endif
1459 
1460         vlist_for_each_element(&devices, dev, node) {
1461                 pr = dev->pr;
1462                 if (!strcmp(pr->dev, devpath)) {
1463                         struct stat s;
1464                         FILE *fp = NULL;
1465                         char tag[64];
1466                         char uuid[64] = { 0 };
1467 
1468                         snprintf(tag, sizeof(tag), "%s/etc", path);
1469                         if (stat(tag, &s))
1470                                 mkdir_p(tag);
1471 
1472                         snprintf(tag, sizeof(tag), "%s/etc/.extroot-uuid", path);
1473                         if (stat(tag, &s)) {
1474                                 fp = fopen(tag, "w+");
1475                                 if (!fp) {
1476                                         ULOG_ERR("extroot: failed to write UUID to %s: %d (%m)\n",
1477                                                  tag, errno);
1478                                         /* return 0 to continue boot regardless of error */
1479                                         return 0;
1480                                 }
1481                                 fputs(pr->uuid, fp);
1482                                 fclose(fp);
1483                                 return 0;
1484                         }
1485 
1486                         fp = fopen(tag, "r");
1487                         if (!fp) {
1488                                 ULOG_ERR("extroot: failed to read UUID from %s: %d (%m)\n",
1489                                          tag, errno);
1490                                 return -1;
1491                         }
1492 
1493                         if (!fgets(uuid, sizeof(uuid), fp))
1494                                 ULOG_ERR("extroot: failed to read UUID from %s: %d (%m)\n",
1495                                          tag, errno);
1496                         fclose(fp);
1497 
1498                         if (*uuid && !strcasecmp(uuid, pr->uuid))
1499                                 return 0;
1500 
1501                         ULOG_ERR("extroot: UUID mismatch (root: %s, %s: %s)\n",
1502                                  pr->uuid, basename(path), uuid);
1503                         return -1;
1504                 }
1505         }
1506 
1507         ULOG_ERR("extroot: unable to lookup root device %s\n", devpath);
1508         return -1;
1509 }
1510 
1511 /*
1512  * Read info about extroot from UCI (using prefix) and mount it.
1513  */
1514 static int mount_extroot(char *cfg)
1515 {
1516         char overlay[] = "/tmp/extroot/overlay";
1517         char mnt[] = "/tmp/extroot/mnt";
1518         char *path = mnt;
1519         struct device *dev;
1520         struct probe_info *pr;
1521         struct mount *m;
1522         int err = -1;
1523 
1524         /* Load @cfg/etc/config/fstab */
1525         if (config_load(cfg))
1526                 return -2;
1527 
1528         /* See if there is extroot-specific mount config */
1529         m = find_block(NULL, NULL, NULL, "/");
1530         if (!m)
1531                 m = find_block(NULL, NULL, NULL, "/overlay");
1532 
1533         if (!m || !m->extroot)
1534         {
1535                 ULOG_INFO("extroot: not configured\n");
1536                 return -1;
1537         }
1538 
1539         /* Find block device pointed by the mount config */
1540         dev = find_block_device(m->uuid, m->label, m->device);
1541 
1542         if (!dev && delay_root){
1543                 ULOG_INFO("extroot: device not present, retrying in %u seconds\n", delay_root);
1544                 sleep(delay_root);
1545                 make_devs();
1546                 cache_load(1);
1547                 dev = find_block_device(m->uuid, m->label, m->device);
1548         }
1549         if (dev) {
1550                 pr = dev->pr;
1551                 if (strncmp(pr->type, "ext", 3) &&
1552                     strncmp(pr->type, "f2fs", 4) &&
1553                     strncmp(pr->type, "btrfs", 5) &&
1554                     strncmp(pr->type, "ntfs", 4) &&
1555                     strncmp(pr->type, "ubifs", 5)) {
1556                         ULOG_ERR("extroot: unsupported filesystem %s, try ext4, f2fs, btrfs, ntfs or ubifs\n", pr->type);
1557                         return -1;
1558                 }
1559 
1560                 if (test_fs_support(pr->type)) {
1561                         ULOG_ERR("extroot: filesystem %s not supported by kernel\n", pr->type);
1562                         return -1;
1563                 }
1564 
1565                 if (m->overlay)
1566                         path = overlay;
1567                 mkdir_p(path);
1568 
1569                 if (check_fs)
1570                         check_filesystem(pr);
1571 
1572                 err = mount(pr->dev, path, pr->type, m->flags,
1573                             (m->options) ? (m->options) : (""));
1574 
1575                 if (err) {
1576                         ULOG_ERR("extroot: mounting %s (%s) on %s failed: %d (%m)\n",
1577                                  pr->dev, pr->type, path, errno);
1578                 } else if (m->overlay) {
1579                         err = check_extroot(path);
1580                         if (err)
1581                                 umount(path);
1582                 }
1583         } else {
1584                 ULOG_ERR("extroot: cannot find device %s%s\n",
1585                          (m->uuid ? "with UUID " : (m->label ? "with label " : "")),
1586                          (m->uuid ? m->uuid : (m->label ? m->label : m->device)));
1587         }
1588 
1589         return err;
1590 }
1591 
1592 static int main_extroot(int argc, char **argv)
1593 {
1594         char blkdev_path[32] = { 0 };
1595         int err = -1;
1596 #ifdef UBIFS_EXTROOT
1597         libubi_t libubi;
1598 #endif
1599 
1600         if (!getenv("PREINIT"))
1601                 return -1;
1602 
1603         if (argc != 2) {
1604                 ULOG_ERR("Usage: block extroot\n");
1605                 return -1;
1606         }
1607 
1608         make_devs();
1609         cache_load(1);
1610 
1611         /* enable LOG_INFO messages */
1612         ulog_threshold(LOG_INFO);
1613 
1614         /*
1615          * Look for "rootfs_data". We will want to mount it and check for
1616          * extroot configuration.
1617          */
1618 
1619         /* Start with looking for MTD partition */
1620         find_block_mtd("\"rootfs_data\"", blkdev_path, sizeof(blkdev_path));
1621         if (blkdev_path[0]) {
1622                 struct device *dev = find_block_device(NULL, NULL, blkdev_path);
1623                 if (dev && !strcmp(dev->pr->type, "jffs2")) {
1624                         char cfg[] = "/tmp/jffs_cfg";
1625 
1626                         /*
1627                          * Mount MTD part and try extroot (using
1628                          * /etc/config/fstab from that partition)
1629                          */
1630                         mkdir_p(cfg);
1631                         if (!mount(blkdev_path, cfg, "jffs2", MS_NOATIME, NULL)) {
1632                                 err = mount_extroot(cfg);
1633                                 umount2(cfg, MNT_DETACH);
1634                         }
1635                         if (err < 0)
1636                                 rmdir("/tmp/overlay");
1637                         rmdir(cfg);
1638                         return err;
1639                 }
1640         }
1641 
1642 #ifdef UBIFS_EXTROOT
1643         /* ... but it also could be an UBI volume */
1644         memset(blkdev_path, 0, sizeof(blkdev_path));
1645         libubi = libubi_open();
1646         find_block_ubi(libubi, "rootfs_data", blkdev_path, sizeof(blkdev_path));
1647         libubi_close(libubi);
1648         if (blkdev_path[0]) {
1649                 char cfg[] = "/tmp/ubifs_cfg";
1650 
1651                 /* Mount volume and try extroot (using fstab from that vol) */
1652                 mkdir_p(cfg);
1653                 if (!mount(blkdev_path, cfg, "ubifs", MS_NOATIME, NULL)) {
1654                         err = mount_extroot(cfg);
1655                         umount2(cfg, MNT_DETACH);
1656                 }
1657                 if (err < 0)
1658                         rmdir("/tmp/overlay");
1659                 rmdir(cfg);
1660                 return err;
1661        }
1662 #endif
1663 
1664         return mount_extroot(NULL);
1665 }
1666 
1667 static int main_mount(int argc, char **argv)
1668 {
1669         struct device *dev;
1670 
1671         if (config_load(NULL))
1672                 return -1;
1673 
1674         cache_load(1);
1675         vlist_for_each_element(&devices, dev, node)
1676                 mount_device(dev, TYPE_DEV);
1677 
1678         handle_swapfiles(true);
1679 
1680         return 0;
1681 }
1682 
1683 static int main_umount(int argc, char **argv)
1684 {
1685         struct device *dev;
1686         struct probe_info *pr;
1687         bool all = false;
1688 
1689         if (config_load(NULL))
1690                 return -1;
1691 
1692         handle_swapfiles(false);
1693 
1694         cache_load(0);
1695 
1696         if (argc == 3)
1697                 all = !strcmp(argv[2], "-a");
1698 
1699         vlist_for_each_element_reverse(&devices, dev, node) {
1700                 struct mount *m;
1701 
1702                 pr = dev->pr;
1703                 if (!strcmp(pr->type, "swap"))
1704                         continue;
1705 
1706                 m = dev->m;
1707                 if (m && m->extroot)
1708                         continue;
1709 
1710                 umount_device(pr->dev, TYPE_DEV, all);
1711         }
1712 
1713         return 0;
1714 }
1715 
1716 static int main_detect(int argc, char **argv)
1717 {
1718         struct device *dev;
1719 
1720         cache_load(0);
1721         printf("config 'global'\n");
1722         printf("\toption\tanon_swap\t''\n");
1723         printf("\toption\tanon_mount\t''\n");
1724         printf("\toption\tauto_swap\t'1'\n");
1725         printf("\toption\tauto_mount\t'1'\n");
1726         printf("\toption\tdelay_root\t'5'\n");
1727         printf("\toption\tcheck_fs\t''\n\n");
1728         vlist_for_each_element(&devices, dev, node)
1729                 print_block_uci(dev->pr);
1730 
1731         return 0;
1732 }
1733 
1734 static int main_info(int argc, char **argv)
1735 {
1736         int i;
1737         struct device *dev;
1738 
1739         cache_load(1);
1740         if (argc == 2) {
1741                 vlist_for_each_element(&devices, dev, node)
1742                         print_block_info(dev->pr);
1743 
1744                 return 0;
1745         };
1746 
1747         for (i = 2; i < argc; i++) {
1748                 struct stat s;
1749 
1750                 if (stat(argv[i], &s)) {
1751                         ULOG_ERR("failed to stat %s\n", argv[i]);
1752                         continue;
1753                 }
1754                 if (!S_ISBLK(s.st_mode) && !(S_ISCHR(s.st_mode) && major(s.st_rdev) == 250)) {
1755                         ULOG_ERR("%s is not a block device\n", argv[i]);
1756                         continue;
1757                 }
1758                 dev = find_block_device(NULL, NULL, argv[i]);
1759                 if (dev)
1760                         print_block_info(dev->pr);
1761         }
1762 
1763         return 0;
1764 }
1765 
1766 static int swapon_usage(void)
1767 {
1768         fprintf(stderr, "Usage: swapon [-s] [-a] [[-p pri] DEVICE]\n\n"
1769                 "\tStart swapping on [DEVICE]\n"
1770                 " -a\tStart swapping on all swap devices\n"
1771                 " -p pri\tSet priority of swap device\n"
1772                 " -s\tShow summary\n");
1773         return -1;
1774 }
1775 
1776 static int main_swapon(int argc, char **argv)
1777 {
1778         int ch;
1779         FILE *fp;
1780         char *lineptr;
1781         size_t s;
1782         struct device *dev;
1783         struct probe_info *pr;
1784         int flags = 0;
1785         int pri;
1786         struct stat st;
1787         int err;
1788 
1789         while ((ch = getopt(argc, argv, "ap:s")) != -1) {
1790                 switch(ch) {
1791                 case 's':
1792                         fp = fopen("/proc/swaps", "r");
1793                         lineptr = NULL;
1794 
1795                         if (!fp) {
1796                                 ULOG_ERR("failed to open /proc/swaps\n");
1797                                 return -1;
1798                         }
1799                         while (getline(&lineptr, &s, fp) > 0)
1800                                 printf("%s", lineptr);
1801                         if (lineptr)
1802                                 free(lineptr);
1803                         fclose(fp);
1804                         return 0;
1805                 case 'a':
1806                         cache_load(0);
1807                         vlist_for_each_element(&devices, dev, node) {
1808                                 pr = dev->pr;
1809                                 if (strcmp(pr->type, "swap"))
1810                                         continue;
1811                                 if (swapon(pr->dev, 0))
1812                                         ULOG_ERR("failed to swapon %s\n", pr->dev);
1813                         }
1814                         return 0;
1815                 case 'p':
1816                         pri = atoi(optarg);
1817                         if (pri >= 0)
1818                                 flags = ((pri << SWAP_FLAG_PRIO_SHIFT) & SWAP_FLAG_PRIO_MASK) | SWAP_FLAG_PREFER;
1819                         break;
1820                 default:
1821                         return swapon_usage();
1822                 }
1823         }
1824 
1825         if (optind != (argc - 1))
1826                 return swapon_usage();
1827 
1828         if (stat(argv[optind], &st) || (!S_ISBLK(st.st_mode) && !S_ISREG(st.st_mode))) {
1829                 ULOG_ERR("%s is not a block device or file\n", argv[optind]);
1830                 return -1;
1831         }
1832         err = swapon(argv[optind], flags);
1833         if (err) {
1834                 ULOG_ERR("failed to swapon %s (%d)\n", argv[optind], err);
1835                 return err;
1836         }
1837 
1838         return 0;
1839 }
1840 
1841 static int main_swapoff(int argc, char **argv)
1842 {
1843         if (argc != 2) {
1844                 ULOG_ERR("Usage: swapoff [-a] [DEVICE]\n\n"
1845                         "\tStop swapping on DEVICE\n"
1846                         " -a\tStop swapping on all swap devices\n");
1847                 return -1;
1848         }
1849 
1850         if (!strcmp(argv[1], "-a")) {
1851                 FILE *fp = fopen("/proc/swaps", "r");
1852                 char line[256];
1853 
1854                 if (!fp) {
1855                         ULOG_ERR("failed to open /proc/swaps\n");
1856                         return -1;
1857                 }
1858                 if (fgets(line, sizeof(line), fp))
1859                         while (fgets(line, sizeof(line), fp)) {
1860                                 char *end = strchr(line, ' ');
1861                                 int err;
1862 
1863                                 if (!end)
1864                                         continue;
1865                                 *end = '\0';
1866                                 err = swapoff(line);
1867                                 if (err)
1868                                         ULOG_ERR("failed to swapoff %s (%d)\n", line, err);
1869                         }
1870                 fclose(fp);
1871         } else {
1872                 struct stat s;
1873                 int err;
1874 
1875                 if (stat(argv[1], &s) || (!S_ISBLK(s.st_mode) && !S_ISREG(s.st_mode))) {
1876                         ULOG_ERR("%s is not a block device or file\n", argv[1]);
1877                         return -1;
1878                 }
1879                 err = swapoff(argv[1]);
1880                 if (err) {
1881                         ULOG_ERR("failed to swapoff %s (%d)\n", argv[1], err);
1882                         return err;
1883                 }
1884         }
1885 
1886         return 0;
1887 }
1888 
1889 int main(int argc, char **argv)
1890 {
1891         char *base = basename(*argv);
1892 
1893         umask(0);
1894 
1895         ulog_open(-1, -1, "block");
1896         ulog_threshold(LOG_NOTICE);
1897 
1898         if (!strcmp(base, "swapon"))
1899                 return main_swapon(argc, argv);
1900 
1901         if (!strcmp(base, "swapoff"))
1902                 return main_swapoff(argc, argv);
1903 
1904         if ((argc > 1) && !strcmp(base, "block")) {
1905                 if (!strcmp(argv[1], "info"))
1906                         return main_info(argc, argv);
1907 
1908                 if (!strcmp(argv[1], "detect"))
1909                         return main_detect(argc, argv);
1910 
1911                 if (!strcmp(argv[1], "hotplug"))
1912                         return main_hotplug(argc, argv);
1913 
1914                 if (!strcmp(argv[1], "autofs"))
1915                         return main_autofs(argc, argv);
1916 
1917                 if (!strcmp(argv[1], "extroot"))
1918                         return main_extroot(argc, argv);
1919 
1920                 if (!strcmp(argv[1], "mount"))
1921                         return main_mount(argc, argv);
1922 
1923                 if (!strcmp(argv[1], "umount"))
1924                         return main_umount(argc, argv);
1925 
1926                 if (!strcmp(argv[1], "remount")) {
1927                         int ret = main_umount(argc, argv);
1928 
1929                         if (!ret)
1930                                 ret = main_mount(argc, argv);
1931                         return ret;
1932                 }
1933         }
1934 
1935         ULOG_ERR("Usage: block <info|mount|umount|detect>\n");
1936 
1937         return -1;
1938 }
1939 

This page was automatically generated by LXR 0.3.1.  •  OpenWrt