release/src/router/busybox/miscutils/ubi_tools.c

   1 /* Ported to busybox from mtd-utils.
   2  *
   3  * Licensed under GPLv2, see file LICENSE in this source tree.
   4  */
   5
   6 //config:config UBIATTACH
   7 //config:       bool "ubiattach"
   8 //config:       default y
   9 //config:       select PLATFORM_LINUX
  10 //config:       help
  11 //config:         Attach MTD device to an UBI device.
  12 //config:
  13 //config:config UBIDETACH
  14 //config:       bool "ubidetach"
  15 //config:       default y
  16 //config:       select PLATFORM_LINUX
  17 //config:       help
  18 //config:         Detach MTD device from an UBI device.
  19 //config:
  20 //config:config UBIMKVOL
  21 //config:       bool "ubimkvol"
  22 //config:       default y
  23 //config:       select PLATFORM_LINUX
  24 //config:       help
  25 //config:         Create a UBI volume.
  26 //config:
  27 //config:config UBIRMVOL
  28 //config:       bool "ubirmvol"
  29 //config:       default y
  30 //config:       select PLATFORM_LINUX
  31 //config:       help
  32 //config:         Delete a UBI volume.
  33 //config:
  34 //config:config UBIRSVOL
  35 //config:       bool "ubirsvol"
  36 //config:       default y
  37 //config:       select PLATFORM_LINUX
  38 //config:       help
  39 //config:         Resize a UBI volume.
  40 //config:
  41 //config:config UBIUPDATEVOL
  42 //config:       bool "ubiupdatevol"
  43 //config:       default y
  44 //config:       select PLATFORM_LINUX
  45 //config:       help
  46 //config:         Update a UBI volume.
  47
  48 //applet:IF_UBIATTACH(APPLET_ODDNAME(ubiattach, ubi_tools, BB_DIR_USR_SBIN, BB_SUID_DROP, ubiattach))
  49 //applet:IF_UBIDETACH(APPLET_ODDNAME(ubidetach, ubi_tools, BB_DIR_USR_SBIN, BB_SUID_DROP, ubidetach))
  50 //applet:IF_UBIMKVOL(APPLET_ODDNAME(ubimkvol, ubi_tools, BB_DIR_USR_SBIN, BB_SUID_DROP, ubimkvol))
  51 //applet:IF_UBIRMVOL(APPLET_ODDNAME(ubirmvol, ubi_tools, BB_DIR_USR_SBIN, BB_SUID_DROP, ubirmvol))
  52 //applet:IF_UBIRSVOL(APPLET_ODDNAME(ubirsvol, ubi_tools, BB_DIR_USR_SBIN, BB_SUID_DROP, ubirsvol))
  53 //applet:IF_UBIUPDATEVOL(APPLET_ODDNAME(ubiupdatevol, ubi_tools, BB_DIR_USR_SBIN, BB_SUID_DROP, ubiupdatevol))
  54
  55 //kbuild:lib-$(CONFIG_UBIATTACH) += ubi_tools.o
  56 //kbuild:lib-$(CONFIG_UBIDETACH) += ubi_tools.o
  57 //kbuild:lib-$(CONFIG_UBIMKVOL)  += ubi_tools.o
  58 //kbuild:lib-$(CONFIG_UBIRMVOL)  += ubi_tools.o
  59 //kbuild:lib-$(CONFIG_UBIRSVOL)  += ubi_tools.o
  60 //kbuild:lib-$(CONFIG_UBIUPDATEVOL) += ubi_tools.o
  61
  62 #include "libbb.h"
  63 /* Some versions of kernel have broken headers, need this hack */
  64 #ifndef __packed
  65 # define __packed __attribute__((packed))
  66 #endif
  67 #include <mtd/ubi-user.h>
  68
  69 #define do_attach (ENABLE_UBIATTACH && applet_name[3] == 'a')
  70 #define do_detach (ENABLE_UBIDETACH && applet_name[3] == 'd')
  71 #define do_mkvol  (ENABLE_UBIMKVOL  && applet_name[3] == 'm')
  72 #define do_rmvol  (ENABLE_UBIRMVOL  && applet_name[4] == 'm')
  73 #define do_rsvol  (ENABLE_UBIRSVOL  && applet_name[4] == 's')
  74 #define do_update (ENABLE_UBIUPDATEVOL && applet_name[3] == 'u')
  75
  76 static unsigned get_num_from_file(const char *path, unsigned max, const char *errmsg)
  77 {
  78         char buf[sizeof(long long)*3];
  79         unsigned long long num;
  80
  81         if (open_read_close(path, buf, sizeof(buf)) < 0)
  82                 bb_perror_msg_and_die(errmsg, path);
  83         /* It can be \n terminated, xatoull won't work well */
  84         if (sscanf(buf, "%llu", &num) != 1 || num > max)
  85                 bb_error_msg_and_die(errmsg, path);
  86         return num;
  87 }
  88
  89 /* To prevent malloc(1G) accidents */
  90 #define MAX_SANE_ERASEBLOCK (16*1024*1024)
  91
  92 int ubi_tools_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
  93 int ubi_tools_main(int argc UNUSED_PARAM, char **argv)
  94 {
  95         static const struct suffix_mult size_suffixes[] = {
  96                 { "KiB", 1024 },
  97                 { "MiB", 1024*1024 },
  98                 { "GiB", 1024*1024*1024 },
  99                 { "", 0 }
 100         };
 101
 102         unsigned opts;
 103         char *ubi_ctrl;
 104         int fd;
 105         int mtd_num;
 106         int dev_num = UBI_DEV_NUM_AUTO;
 107         int vol_id = UBI_VOL_NUM_AUTO;
 108         char *vol_name;
 109         unsigned long long size_bytes = size_bytes; /* for compiler */
 110         char *size_bytes_str;
 111         int alignment = 1;
 112         char *type;
 113         union {
 114                 struct ubi_attach_req attach_req;
 115                 struct ubi_mkvol_req  mkvol_req;
 116                 struct ubi_rsvol_req  rsvol_req;
 117         } req_structs;
 118 #define attach_req req_structs.attach_req
 119 #define mkvol_req  req_structs.mkvol_req
 120 #define rsvol_req  req_structs.rsvol_req
 121         char path[sizeof("/sys/class/ubi/ubi%d_%d/usable_eb_size")
 122                                 + 2 * sizeof(int)*3 + /*just in case:*/ 16];
 123 #define path_sys_class_ubi_ubi (path + sizeof("/sys/class/ubi/ubi")-1)
 124
 125         strcpy(path, "/sys/class/ubi/ubi");
 126         memset(&req_structs, 0, sizeof(req_structs));
 127
 128 #define OPTION_m  (1 << 0)
 129 #define OPTION_d  (1 << 1)
 130 #define OPTION_n  (1 << 2)
 131 #define OPTION_N  (1 << 3)
 132 #define OPTION_s  (1 << 4)
 133 #define OPTION_a  (1 << 5)
 134 #define OPTION_t  (1 << 6)
 135         if (do_mkvol) {
 136                 opt_complementary = "-1:d+:n+:a+";
 137                 opts = getopt32(argv, "md:n:N:s:a:t:",
 138                                 &dev_num, &vol_id,
 139                                 &vol_name, &size_bytes_str, &alignment, &type
 140                         );
 141         } else
 142         if (do_update) {
 143                 opt_complementary = "-1";
 144                 opts = getopt32(argv, "s:at", &size_bytes_str);
 145                 opts *= OPTION_s;
 146         } else {
 147                 opt_complementary = "-1:m+:d+:n+:a+";
 148                 opts = getopt32(argv, "m:d:n:N:s:a:t:",
 149                                 &mtd_num, &dev_num, &vol_id,
 150                                 &vol_name, &size_bytes_str, &alignment, &type
 151                 );
 152         }
 153
 154         if (opts & OPTION_s)
 155                 size_bytes = xatoull_sfx(size_bytes_str, size_suffixes);
 156         argv += optind;
 157         ubi_ctrl = *argv++;
 158
 159         fd = xopen(ubi_ctrl, O_RDWR);
 160         //xfstat(fd, &st, ubi_ctrl);
 161         //if (!S_ISCHR(st.st_mode))
 162         //      bb_error_msg_and_die("%s: not a char device", ubi_ctrl);
 163
 164 //usage:#define ubiattach_trivial_usage
 165 //usage:       "-m MTD_NUM [-d UBI_NUM] UBI_CTRL_DEV"
 166 //usage:#define ubiattach_full_usage "\n\n"
 167 //usage:       "Attach MTD device to UBI\n"
 168 //usage:     "\n        -m MTD_NUM      MTD device number to attach"
 169 //usage:     "\n        -d UBI_NUM      UBI device number to assign"
 170         if (do_attach) {
 171                 if (!(opts & OPTION_m))
 172                         bb_error_msg_and_die("%s device not specified", "MTD");
 173
 174                 attach_req.mtd_num = mtd_num;
 175                 attach_req.ubi_num = dev_num;
 176
 177                 xioctl(fd, UBI_IOCATT, &attach_req);
 178         } else
 179
 180 //usage:#define ubidetach_trivial_usage
 181 //usage:       "-d UBI_NUM UBI_CTRL_DEV"
 182 //usage:#define ubidetach_full_usage "\n\n"
 183 //usage:       "Detach MTD device from UBI\n"
 184 //usage:     "\n        -d UBI_NUM      UBI device number"
 185         if (do_detach) {
 186                 if (!(opts & OPTION_d))
 187                         bb_error_msg_and_die("%s device not specified", "UBI");
 188
 189                 /* FIXME? kernel expects int32_t* here: */
 190                 xioctl(fd, UBI_IOCDET, &dev_num);
 191         } else
 192
 193 //usage:#define ubimkvol_trivial_usage
 194 //usage:       "UBI_DEVICE -N NAME [-s SIZE | -m]"
 195 //usage:#define ubimkvol_full_usage "\n\n"
 196 //usage:       "Create UBI volume\n"
 197 //usage:     "\n        -a ALIGNMENT    Volume alignment (default 1)"
 198 //usage:     "\n        -m              Set volume size to maximum available"
 199 //usage:     "\n        -n VOLID        Volume ID. If not specified,"
 200 //usage:     "\n                        assigned automatically"
 201 //usage:     "\n        -N NAME         Volume name"
 202 //usage:     "\n        -s SIZE         Size in bytes"
 203 //usage:     "\n        -t TYPE         Volume type (static|dynamic)"
 204         if (do_mkvol) {
 205                 if (opts & OPTION_m) {
 206                         unsigned leb_avail;
 207                         unsigned leb_size;
 208                         unsigned num;
 209                         char *p;
 210
 211                         if (sscanf(ubi_ctrl, "/dev/ubi%u", &num) != 1)
 212                                 bb_error_msg_and_die("wrong format of UBI device name");
 213
 214                         p = path_sys_class_ubi_ubi + sprintf(path_sys_class_ubi_ubi, "%u/", num);
 215
 216                         strcpy(p, "avail_eraseblocks");
 217                         leb_avail = get_num_from_file(path, UINT_MAX, "Can't get available eraseblocks from '%s'");
 218
 219                         strcpy(p, "eraseblock_size");
 220                         leb_size = get_num_from_file(path, MAX_SANE_ERASEBLOCK, "Can't get eraseblock size from '%s'");
 221
 222                         size_bytes = leb_avail * (unsigned long long)leb_size;
 223                         //if (size_bytes <= 0)
 224                         //      bb_error_msg_and_die("%s invalid maximum size calculated", "UBI");
 225                 } else
 226                 if (!(opts & OPTION_s))
 227                         bb_error_msg_and_die("size not specified");
 228
 229                 if (!(opts & OPTION_N))
 230                         bb_error_msg_and_die("name not specified");
 231
 232                 mkvol_req.vol_id = vol_id;
 233                 mkvol_req.vol_type = UBI_DYNAMIC_VOLUME;
 234                 if ((opts & OPTION_t) && type[0] == 's')
 235                         mkvol_req.vol_type = UBI_STATIC_VOLUME;
 236                 mkvol_req.alignment = alignment;
 237                 mkvol_req.bytes = size_bytes; /* signed int64_t */
 238                 strncpy(mkvol_req.name, vol_name, UBI_MAX_VOLUME_NAME);
 239                 mkvol_req.name_len = strlen(vol_name);
 240                 if (mkvol_req.name_len > UBI_MAX_VOLUME_NAME)
 241                         bb_error_msg_and_die("volume name too long: '%s'", vol_name);
 242
 243                 xioctl(fd, UBI_IOCMKVOL, &mkvol_req);
 244         } else
 245
 246 //usage:#define ubirmvol_trivial_usage
 247 //usage:       "UBI_DEVICE -n VOLID"
 248 //usage:#define ubirmvol_full_usage "\n\n"
 249 //usage:       "Remove UBI volume\n"
 250 //usage:     "\n        -n VOLID        Volume ID"
 251         if (do_rmvol) {
 252                 if (!(opts & OPTION_n))
 253                         bb_error_msg_and_die("volume id not specified");
 254
 255                 /* FIXME? kernel expects int32_t* here: */
 256                 xioctl(fd, UBI_IOCRMVOL, &vol_id);
 257         } else
 258
 259 //usage:#define ubirsvol_trivial_usage
 260 //usage:       "UBI_DEVICE -n VOLID -s SIZE"
 261 //usage:#define ubirsvol_full_usage "\n\n"
 262 //usage:       "Resize UBI volume\n"
 263 //usage:     "\n        -n VOLID        Volume ID"
 264 //usage:     "\n        -s SIZE         Size in bytes"
 265         if (do_rsvol) {
 266                 if (!(opts & OPTION_s))
 267                         bb_error_msg_and_die("size not specified");
 268                 if (!(opts & OPTION_n))
 269                         bb_error_msg_and_die("volume id not specified");
 270
 271                 rsvol_req.bytes = size_bytes; /* signed int64_t */
 272                 rsvol_req.vol_id = vol_id;
 273
 274                 xioctl(fd, UBI_IOCRSVOL, &rsvol_req);
 275         } else
 276
 277 //usage:#define ubiupdatevol_trivial_usage
 278 //usage:       "UBI_DEVICE [-t | [-s SIZE] IMG_FILE]"
 279 //usage:#define ubiupdatevol_full_usage "\n\n"
 280 //usage:       "Update UBI volume\n"
 281 //usage:     "\n        -t      Truncate to zero size"
 282 //usage:     "\n        -s SIZE Size in bytes to resize to"
 283         if (do_update) {
 284                 int64_t bytes64;
 285
 286                 if (opts & OPTION_t) {
 287                         /* truncate the volume by starting an update for size 0 */
 288                         bytes64 = 0;
 289                         /* this ioctl expects int64_t* parameter */
 290                         xioctl(fd, UBI_IOCVOLUP, &bytes64);
 291                 }
 292                 else {
 293                         struct stat st;
 294                         unsigned ubinum, volnum;
 295                         unsigned leb_size;
 296                         ssize_t len;
 297                         char *input_data;
 298
 299                         /* Assume that device is in normal format. */
 300                         /* Removes need for scanning sysfs tree as full libubi does. */
 301                         if (sscanf(ubi_ctrl, "/dev/ubi%u_%u", &ubinum, &volnum) != 2)
 302                                 bb_error_msg_and_die("wrong format of UBI device name");
 303
 304                         sprintf(path_sys_class_ubi_ubi, "%u_%u/usable_eb_size", ubinum, volnum);
 305                         leb_size = get_num_from_file(path, MAX_SANE_ERASEBLOCK, "Can't get usable eraseblock size from '%s'");
 306
 307                         if (!(opts & OPTION_s)) {
 308                                 if (!*argv)
 309                                         bb_show_usage();
 310                                 xmove_fd(xopen(*argv, O_RDONLY), STDIN_FILENO);
 311                                 xfstat(STDIN_FILENO, &st, *argv);
 312                                 size_bytes = st.st_size;
 313                         }
 314
 315                         bytes64 = size_bytes;
 316                         /* this ioctl expects signed int64_t* parameter */
 317                         xioctl(fd, UBI_IOCVOLUP, &bytes64);
 318
 319                         input_data = xmalloc(leb_size);
 320                         while ((len = full_read(STDIN_FILENO, input_data, leb_size)) > 0) {
 321                                 xwrite(fd, input_data, len);
 322                         }
 323                         if (len < 0)
 324                                 bb_perror_msg_and_die("UBI volume update failed");
 325                 }
 326         }
 327
 328         if (ENABLE_FEATURE_CLEAN_UP)
 329                 close(fd);
 330
 331         return EXIT_SUCCESS;
 332 }