btrfs-sb-mod.c

   1 /*
   2  * This program is free software; you can redistribute it and/or
   3  * modify it under the terms of the GNU General Public
   4  * License v2 as published by the Free Software Foundation.
   5  *
   6  * This program is distributed in the hope that it will be useful,
   7  * but WITHOUT ANY WARRANTY; without even the implied warranty of
   8  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
   9  * General Public License for more details.
  10  *
  11  * You should have received a copy of the GNU General Public
  12  * License along with this program; if not, write to the
  13  * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
  14  * Boston, MA 021110-1307, USA.
  15  */
  16
  17 #include "kerncompat.h"
  18 #include <stdio.h>
  19 #include <stdlib.h>
  20 #include <unistd.h>
  21 #include <sys/fcntl.h>
  22 #include <sys/stat.h>
  23 #include <inttypes.h>
  24 #include <string.h>
  25 #include <limits.h>
  26 #include <byteswap.h>
  27 #include <kernel-lib/crc32c.h>
  28 #include "disk-io.h"
  29
  30 #define BLOCKSIZE (4096)
  31 static char buf[BLOCKSIZE];
  32 static int csum_size;
  33
  34 static int check_csum_superblock(void *sb)
  35 {
  36         u8 result[csum_size];
  37         u32 crc = ~(u32)0;
  38
  39         crc = btrfs_csum_data((char *)sb + BTRFS_CSUM_SIZE,
  40                                 crc, BTRFS_SUPER_INFO_SIZE - BTRFS_CSUM_SIZE);
  41         btrfs_csum_final(crc, result);
  42
  43         return !memcmp(sb, &result, csum_size);
  44 }
  45
  46 static void update_block_csum(void *block, int is_sb)
  47 {
  48         u8 result[csum_size];
  49         struct btrfs_header *hdr;
  50         u32 crc = ~(u32)0;
  51
  52         if (is_sb) {
  53                 crc = btrfs_csum_data((char *)block + BTRFS_CSUM_SIZE, crc,
  54                                 BTRFS_SUPER_INFO_SIZE - BTRFS_CSUM_SIZE);
  55         } else {
  56                 crc = btrfs_csum_data((char *)block + BTRFS_CSUM_SIZE, crc,
  57                                 BLOCKSIZE - BTRFS_CSUM_SIZE);
  58         }
  59         btrfs_csum_final(crc, result);
  60         memset(block, 0, BTRFS_CSUM_SIZE);
  61         hdr = (struct btrfs_header *)block;
  62         memcpy(&hdr->csum, result, csum_size);
  63 }
  64
  65 static u64 arg_strtou64(const char *str)
  66 {
  67         u64 value;
  68         char *ptr_parse_end = NULL;
  69
  70         value = strtoull(str, &ptr_parse_end, 0);
  71         if (ptr_parse_end && *ptr_parse_end != '\0') {
  72                 fprintf(stderr, "ERROR: %s is not a valid numeric value.\n",
  73                         str);
  74                 exit(1);
  75         }
  76
  77         /*
  78          * if we pass a negative number to strtoull, it will return an
  79          * unexpected number to us, so let's do the check ourselves.
  80          */
  81         if (str[0] == '-') {
  82                 fprintf(stderr, "ERROR: %s: negative value is invalid.\n",
  83                         str);
  84                 exit(1);
  85         }
  86         if (value == ULLONG_MAX) {
  87                 fprintf(stderr, "ERROR: %s is too large.\n", str);
  88                 exit(1);
  89         }
  90         return value;
  91 }
  92
  93
  94 enum field_op {
  95         OP_GET,
  96         OP_SET,
  97         OP_ADD,
  98         OP_SUB,
  99         OP_XOR,
 100         OP_NAND,        /* broken */
 101         OP_BSWAP,
 102 };
 103
 104 struct fspec {
 105         const char *name;
 106         enum field_op fop;
 107         u64 value;
 108 };
 109
 110 enum field_type {
 111         TYPE_UNKNOWN,
 112         TYPE_U64,
 113         TYPE_U16,
 114 };
 115
 116 struct sb_field {
 117         const char *name;
 118         enum field_type type;
 119 } known_fields[] = {
 120         { .name = "total_bytes", .type = TYPE_U64 },
 121         { .name = "root", .type = TYPE_U64 },
 122         { .name = "generation", .type = TYPE_U64 },
 123         { .name = "chunk_root", .type = TYPE_U64 },
 124         { .name = "chunk_root_generation", .type = TYPE_U64 },
 125         { .name = "cache_generation", .type = TYPE_U64 },
 126         { .name = "uuid_tree_generation", .type = TYPE_U64 },
 127         { .name = "csum_type", .type = TYPE_U16 },
 128 };
 129
 130 #define MOD_FIELD_XX(fname, set, val, bits, f_dec, f_hex, f_type)       \
 131         else if (strcmp(name, #fname) == 0) {                           \
 132                 if (set) {                                              \
 133                         printf("SET: "#fname" "f_dec" (0x"f_hex")\n", \
 134                         (f_type)*val, (f_type)*val);                            \
 135                         sb->fname = cpu_to_le##bits(*val);                      \
 136                 } else {                                                        \
 137                         *val = le##bits##_to_cpu(sb->fname);                    \
 138                         printf("GET: "#fname" "f_dec" (0x"f_hex")\n",   \
 139                         (f_type)*val, (f_type)*val);                    \
 140                 }                                                       \
 141         }
 142
 143 #define MOD_FIELD64(fname, set, val)                                    \
 144         MOD_FIELD_XX(fname, set, val, 64, "%llu", "%llx", unsigned long long)
 145
 146 /* Alias for u64 */
 147 #define MOD_FIELD(fname, set, val)      MOD_FIELD64(fname, set, val)
 148
 149 /*
 150  * Support only GET and SET properly, ADD and SUB may work
 151  */
 152 #define MOD_FIELD32(fname, set, val)                                    \
 153         MOD_FIELD_XX(fname, set, val, 32, "%u", "%x", unsigned int)
 154
 155 #define MOD_FIELD16(fname, set, val)                                    \
 156         MOD_FIELD_XX(fname, set, val, 16, "%hu", "%hx", unsigned short int)
 157
 158 #define MOD_FIELD8(fname, set, val)                                     \
 159         MOD_FIELD_XX(fname, set, val, 8, "%hhu", "%hhx", unsigned char)
 160
 161 static void mod_field_by_name(struct btrfs_super_block *sb, int set, const char *name,
 162                 u64 *val)
 163 {
 164         if (0) { }
 165                 MOD_FIELD(total_bytes, set, val)
 166                 MOD_FIELD(root, set, val)
 167                 MOD_FIELD(generation, set, val)
 168                 MOD_FIELD(chunk_root, set, val)
 169                 MOD_FIELD(chunk_root_generation, set, val)
 170                 MOD_FIELD(cache_generation, set, val)
 171                 MOD_FIELD(uuid_tree_generation, set, val)
 172                 MOD_FIELD16(csum_type, set, val)
 173         else {
 174                 printf("ERROR: unhandled field: %s\n", name);
 175                 exit(1);
 176         }
 177 }
 178
 179 static int sb_edit(struct btrfs_super_block *sb, struct fspec *fsp)
 180 {
 181         u64 val;
 182         u64 newval;
 183
 184         mod_field_by_name(sb, 0, fsp->name, &val);
 185         switch (fsp->fop) {
 186         case OP_GET: newval = val; break;
 187         case OP_SET: newval = fsp->value; break;
 188         case OP_ADD: newval = val + fsp->value; break;
 189         case OP_SUB: newval = val - fsp->value; break;
 190         case OP_XOR: newval = val ^ fsp->value; break;
 191         case OP_NAND: newval = val & (~fsp->value); break;
 192         case OP_BSWAP: newval = bswap_64(val); break;
 193         default: printf("ERROR: unhandled operation: %d\n", fsp->fop); exit(1);
 194         }
 195
 196         mod_field_by_name(sb, 1, fsp->name, &newval);
 197
 198         return 0;
 199 }
 200
 201 static int is_known_field(const char *f)
 202 {
 203         int i;
 204
 205         for (i = 0; i < ARRAY_SIZE(known_fields); i++)
 206                 if (strcmp(f, known_fields[i].name) == 0)
 207                         return 1;
 208         return 0;
 209 }
 210
 211 static int arg_to_op_value(const char *arg, enum field_op *op, u64 *val)
 212 {
 213         switch (arg[0]) {
 214         case 0: return -1;
 215         case '.':
 216         case '?': *op = OP_GET; *val = 0; break;
 217         case '=': *op = OP_SET; *val = arg_strtou64(arg + 1); break;
 218         case '+': *op = OP_ADD; *val = arg_strtou64(arg + 1); break;
 219         case '-': *op = OP_SUB; *val = arg_strtou64(arg + 1); break;
 220         case '^': *op = OP_XOR; *val = arg_strtou64(arg + 1); break;
 221         case '~': *op = OP_NAND; *val = arg_strtou64(arg + 1); break;
 222         case '@': *op = OP_BSWAP; *val = arg_strtou64(arg + 1); break;
 223         default:
 224                   printf("ERROR: unknown op: %c\n", arg[0]);
 225                   return -1;
 226         }
 227
 228         return 0;
 229 }
 230
 231 int main(int argc, char **argv) {
 232         int fd;
 233         loff_t off;
 234         int ret;
 235         struct btrfs_header *hdr;
 236         struct btrfs_super_block *sb;
 237         int i;
 238         struct fspec spec[128];
 239         int specidx;
 240         int changed;
 241
 242         memset(spec, 0, sizeof(spec));
 243         if (argc <= 2) {
 244                 printf("Usage: %s image [fieldspec...]\n", argv[0]);
 245                 exit(1);
 246         }
 247         fd = open(argv[1], O_RDWR | O_EXCL);
 248         if (fd == -1) {
 249                 perror("open()");
 250                 exit(1);
 251         }
 252
 253         /* verify superblock */
 254         csum_size = btrfs_csum_sizes[BTRFS_CSUM_TYPE_CRC32];
 255         off = BTRFS_SUPER_INFO_OFFSET;
 256
 257         ret = pread(fd, buf, BLOCKSIZE, off);
 258         if (ret <= 0) {
 259                 printf("pread error %d at offset %llu\n",
 260                                 ret, (unsigned long long)off);
 261                 exit(1);
 262         }
 263         if (ret != BLOCKSIZE) {
 264                 printf("pread error at offset %llu: read only %d bytes\n",
 265                                 (unsigned long long)off, ret);
 266                 exit(1);
 267         }
 268         hdr = (struct btrfs_header *)buf;
 269         /* verify checksum */
 270         if (!check_csum_superblock(&hdr->csum)) {
 271                 printf("super block checksum does not match at offset %llu, will be corrected\n",
 272                                 (unsigned long long)off);
 273         } else {
 274                 printf("super block checksum is ok\n");
 275         }
 276         sb = (struct btrfs_super_block *)buf;
 277         changed = 0;
 278
 279         specidx = 0;
 280         for (i = 2; i < argc; i++) {
 281                 struct fspec *f;
 282
 283                 if (i + 1 >= argc) {
 284                         printf("ERROR: bad argument count\n");
 285                         ret = 1;
 286                         goto out;
 287                 }
 288
 289                 if (!is_known_field(argv[i])) {
 290                         printf("ERROR: unknown filed: %s\n", argv[i]);
 291                         ret = 1;
 292                         goto out;
 293                 }
 294                 f = &spec[specidx];
 295                 specidx++;
 296                 f->name = strdup(argv[i]);
 297                 i++;
 298                 if (arg_to_op_value(argv[i], &f->fop, &f->value)) {
 299                         ret = 1;
 300                         goto out;
 301                 }
 302         }
 303
 304         for (i = 0; i < specidx; i++) {
 305                 sb_edit(sb, &spec[i]);
 306                 changed = 1;
 307         }
 308
 309         if (changed) {
 310                 printf("Update csum\n");
 311                 update_block_csum(buf, 1);
 312                 ret = pwrite(fd, buf, BLOCKSIZE, off);
 313                 if (ret <= 0) {
 314                         printf("pwrite error %d at offset %llu\n",
 315                                         ret, (unsigned long long)off);
 316                         exit(1);
 317                 }
 318                 if (ret != BLOCKSIZE) {
 319                         printf("pwrite error at offset %llu: written only %d bytes\n",
 320                                         (unsigned long long)off, ret);
 321                         exit(1);
 322                 }
 323                 fsync(fd);
 324         } else {
 325                 printf("Nothing changed\n");
 326         }
 327         ret = 0;
 328 out:
 329         close(fd);
 330         return ret;
 331 }