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] >= '0' && 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'0'\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(0);
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'0'\n");
1723         printf("\toption\tanon_mount\t'0'\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'0'\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 }