init/initramfs.c

   1 /*
   2  * Many of the syscalls used in this file expect some of the arguments
   3  * to be __user pointers not __kernel pointers.  To limit the sparse
   4  * noise, turn off sparse checking for this file.
   5  */
   6 #ifdef __CHECKER__
   7 #undef __CHECKER__
   8 #warning "Sparse checking disabled for this file"
   9 #endif
  10
  11 #include <linux/init.h>
  12 #include <linux/fs.h>
  13 #include <linux/slab.h>
  14 #include <linux/types.h>
  15 #include <linux/fcntl.h>
  16 #include <linux/delay.h>
  17 #include <linux/string.h>
  18 #include <linux/dirent.h>
  19 #include <linux/syscalls.h>
  20 #include <linux/utime.h>
  21
  22 static ssize_t __init xwrite(int fd, const char *p, size_t count)
  23 {
  24         ssize_t out = 0;
  25
  26         /* sys_write only can write MAX_RW_COUNT aka 2G-4K bytes at most */
  27         while (count) {
  28                 ssize_t rv = sys_write(fd, p, count);
  29
  30                 if (rv < 0) {
  31                         if (rv == -EINTR || rv == -EAGAIN)
  32                                 continue;
  33                         return out ? out : rv;
  34                 } else if (rv == 0)
  35                         break;
  36
  37                 p += rv;
  38                 out += rv;
  39                 count -= rv;
  40         }
  41
  42         return out;
  43 }
  44
  45 static __initdata char *message;
  46 static void __init error(char *x)
  47 {
  48         if (!message)
  49                 message = x;
  50 }
  51
  52 /* link hash */
  53
  54 #define N_ALIGN(len) ((((len) + 1) & ~3) + 2)
  55
  56 static __initdata struct hash {
  57         int ino, minor, major;
  58         umode_t mode;
  59         struct hash *next;
  60         char name[N_ALIGN(PATH_MAX)];
  61 } *head[32];
  62
  63 static inline int hash(int major, int minor, int ino)
  64 {
  65         unsigned long tmp = ino + minor + (major << 3);
  66         tmp += tmp >> 5;
  67         return tmp & 31;
  68 }
  69
  70 static char __init *find_link(int major, int minor, int ino,
  71                               umode_t mode, char *name)
  72 {
  73         struct hash **p, *q;
  74         for (p = head + hash(major, minor, ino); *p; p = &(*p)->next) {
  75                 if ((*p)->ino != ino)
  76                         continue;
  77                 if ((*p)->minor != minor)
  78                         continue;
  79                 if ((*p)->major != major)
  80                         continue;
  81                 if (((*p)->mode ^ mode) & S_IFMT)
  82                         continue;
  83                 return (*p)->name;
  84         }
  85         q = kmalloc(sizeof(struct hash), GFP_KERNEL);
  86         if (!q)
  87                 panic("can't allocate link hash entry");
  88         q->major = major;
  89         q->minor = minor;
  90         q->ino = ino;
  91         q->mode = mode;
  92         strcpy(q->name, name);
  93         q->next = NULL;
  94         *p = q;
  95         return NULL;
  96 }
  97
  98 static void __init free_hash(void)
  99 {
 100         struct hash **p, *q;
 101         for (p = head; p < head + 32; p++) {
 102                 while (*p) {
 103                         q = *p;
 104                         *p = q->next;
 105                         kfree(q);
 106                 }
 107         }
 108 }
 109
 110 static long __init do_utime(char *filename, time_t mtime)
 111 {
 112         struct timespec t[2];
 113
 114         t[0].tv_sec = mtime;
 115         t[0].tv_nsec = 0;
 116         t[1].tv_sec = mtime;
 117         t[1].tv_nsec = 0;
 118
 119         return do_utimes(AT_FDCWD, filename, t, AT_SYMLINK_NOFOLLOW);
 120 }
 121
 122 static __initdata LIST_HEAD(dir_list);
 123 struct dir_entry {
 124         struct list_head list;
 125         char *name;
 126         time_t mtime;
 127 };
 128
 129 static void __init dir_add(const char *name, time_t mtime)
 130 {
 131         struct dir_entry *de = kmalloc(sizeof(struct dir_entry), GFP_KERNEL);
 132         if (!de)
 133                 panic("can't allocate dir_entry buffer");
 134         INIT_LIST_HEAD(&de->list);
 135         de->name = kstrdup(name, GFP_KERNEL);
 136         de->mtime = mtime;
 137         list_add(&de->list, &dir_list);
 138 }
 139
 140 static void __init dir_utime(void)
 141 {
 142         struct dir_entry *de, *tmp;
 143         list_for_each_entry_safe(de, tmp, &dir_list, list) {
 144                 list_del(&de->list);
 145                 do_utime(de->name, de->mtime);
 146                 kfree(de->name);
 147                 kfree(de);
 148         }
 149 }
 150
 151 static __initdata time_t mtime;
 152
 153 /* cpio header parsing */
 154
 155 static __initdata unsigned long ino, major, minor, nlink;
 156 static __initdata umode_t mode;
 157 static __initdata unsigned long body_len, name_len;
 158 static __initdata uid_t uid;
 159 static __initdata gid_t gid;
 160 static __initdata unsigned rdev;
 161
 162 static void __init parse_header(char *s)
 163 {
 164         unsigned long parsed[12];
 165         char buf[9];
 166         int i;
 167
 168         buf[8] = '\0';
 169         for (i = 0, s += 6; i < 12; i++, s += 8) {
 170                 memcpy(buf, s, 8);
 171                 parsed[i] = simple_strtoul(buf, NULL, 16);
 172         }
 173         ino = parsed[0];
 174         mode = parsed[1];
 175         uid = parsed[2];
 176         gid = parsed[3];
 177         nlink = parsed[4];
 178         mtime = parsed[5];
 179         body_len = parsed[6];
 180         major = parsed[7];
 181         minor = parsed[8];
 182         rdev = new_encode_dev(MKDEV(parsed[9], parsed[10]));
 183         name_len = parsed[11];
 184 }
 185
 186 /* FSM */
 187
 188 static __initdata enum state {
 189         Start,
 190         Collect,
 191         GotHeader,
 192         SkipIt,
 193         GotName,
 194         CopyFile,
 195         GotSymlink,
 196         Reset
 197 } state, next_state;
 198
 199 static __initdata char *victim;
 200 static unsigned long count __initdata;
 201 static __initdata loff_t this_header, next_header;
 202
 203 static inline void __init eat(unsigned n)
 204 {
 205         victim += n;
 206         this_header += n;
 207         count -= n;
 208 }
 209
 210 static __initdata char *vcollected;
 211 static __initdata char *collected;
 212 static long remains __initdata;
 213 static __initdata char *collect;
 214
 215 static void __init read_into(char *buf, unsigned size, enum state next)
 216 {
 217         if (count >= size) {
 218                 collected = victim;
 219                 eat(size);
 220                 state = next;
 221         } else {
 222                 collect = collected = buf;
 223                 remains = size;
 224                 next_state = next;
 225                 state = Collect;
 226         }
 227 }
 228
 229 static __initdata char *header_buf, *symlink_buf, *name_buf;
 230
 231 static int __init do_start(void)
 232 {
 233         read_into(header_buf, 110, GotHeader);
 234         return 0;
 235 }
 236
 237 static int __init do_collect(void)
 238 {
 239         unsigned long n = remains;
 240         if (count < n)
 241                 n = count;
 242         memcpy(collect, victim, n);
 243         eat(n);
 244         collect += n;
 245         if ((remains -= n) != 0)
 246                 return 1;
 247         state = next_state;
 248         return 0;
 249 }
 250
 251 static int __init do_header(void)
 252 {
 253         if (memcmp(collected, "070707", 6)==0) {
 254                 error("incorrect cpio method used: use -H newc option");
 255                 return 1;
 256         }
 257         if (memcmp(collected, "070701", 6)) {
 258                 error("no cpio magic");
 259                 return 1;
 260         }
 261         parse_header(collected);
 262         next_header = this_header + N_ALIGN(name_len) + body_len;
 263         next_header = (next_header + 3) & ~3;
 264         state = SkipIt;
 265         if (name_len <= 0 || name_len > PATH_MAX)
 266                 return 0;
 267         if (S_ISLNK(mode)) {
 268                 if (body_len > PATH_MAX)
 269                         return 0;
 270                 collect = collected = symlink_buf;
 271                 remains = N_ALIGN(name_len) + body_len;
 272                 next_state = GotSymlink;
 273                 state = Collect;
 274                 return 0;
 275         }
 276         if (S_ISREG(mode) || !body_len)
 277                 read_into(name_buf, N_ALIGN(name_len), GotName);
 278         return 0;
 279 }
 280
 281 static int __init do_skip(void)
 282 {
 283         if (this_header + count < next_header) {
 284                 eat(count);
 285                 return 1;
 286         } else {
 287                 eat(next_header - this_header);
 288                 state = next_state;
 289                 return 0;
 290         }
 291 }
 292
 293 static int __init do_reset(void)
 294 {
 295         while(count && *victim == '\0')
 296                 eat(1);
 297         if (count && (this_header & 3))
 298                 error("broken padding");
 299         return 1;
 300 }
 301
 302 static int __init maybe_link(void)
 303 {
 304         if (nlink >= 2) {
 305                 char *old = find_link(major, minor, ino, mode, collected);
 306                 if (old)
 307                         return (sys_link(old, collected) < 0) ? -1 : 1;
 308         }
 309         return 0;
 310 }
 311
 312 static void __init clean_path(char *path, umode_t mode)
 313 {
 314         struct stat st;
 315
 316         if (!sys_newlstat(path, &st) && (st.st_mode^mode) & S_IFMT) {
 317                 if (S_ISDIR(st.st_mode))
 318                         sys_rmdir(path);
 319                 else
 320                         sys_unlink(path);
 321         }
 322 }
 323
 324 static __initdata int wfd;
 325
 326 static int __init do_name(void)
 327 {
 328         state = SkipIt;
 329         next_state = Reset;
 330         if (strcmp(collected, "TRAILER!!!") == 0) {
 331                 free_hash();
 332                 return 0;
 333         }
 334         clean_path(collected, mode);
 335         if (S_ISREG(mode)) {
 336                 int ml = maybe_link();
 337                 if (ml >= 0) {
 338                         int openflags = O_WRONLY|O_CREAT;
 339                         if (ml != 1)
 340                                 openflags |= O_TRUNC;
 341                         wfd = sys_open(collected, openflags, mode);
 342
 343                         if (wfd >= 0) {
 344                                 sys_fchown(wfd, uid, gid);
 345                                 sys_fchmod(wfd, mode);
 346                                 if (body_len)
 347                                         sys_ftruncate(wfd, body_len);
 348                                 vcollected = kstrdup(collected, GFP_KERNEL);
 349                                 state = CopyFile;
 350                         }
 351                 }
 352         } else if (S_ISDIR(mode)) {
 353                 sys_mkdir(collected, mode);
 354                 sys_chown(collected, uid, gid);
 355                 sys_chmod(collected, mode);
 356                 dir_add(collected, mtime);
 357         } else if (S_ISBLK(mode) || S_ISCHR(mode) ||
 358                    S_ISFIFO(mode) || S_ISSOCK(mode)) {
 359                 if (maybe_link() == 0) {
 360                         sys_mknod(collected, mode, rdev);
 361                         sys_chown(collected, uid, gid);
 362                         sys_chmod(collected, mode);
 363                         do_utime(collected, mtime);
 364                 }
 365         }
 366         return 0;
 367 }
 368
 369 static int __init do_copy(void)
 370 {
 371         if (count >= body_len) {
 372                 xwrite(wfd, victim, body_len);
 373                 sys_close(wfd);
 374                 do_utime(vcollected, mtime);
 375                 kfree(vcollected);
 376                 eat(body_len);
 377                 state = SkipIt;
 378                 return 0;
 379         } else {
 380                 xwrite(wfd, victim, count);
 381                 body_len -= count;
 382                 eat(count);
 383                 return 1;
 384         }
 385 }
 386
 387 static int __init do_symlink(void)
 388 {
 389         collected[N_ALIGN(name_len) + body_len] = '\0';
 390         clean_path(collected, 0);
 391         sys_symlink(collected + N_ALIGN(name_len), collected);
 392         sys_lchown(collected, uid, gid);
 393         do_utime(collected, mtime);
 394         state = SkipIt;
 395         next_state = Reset;
 396         return 0;
 397 }
 398
 399 static __initdata int (*actions[])(void) = {
 400         [Start]         = do_start,
 401         [Collect]       = do_collect,
 402         [GotHeader]     = do_header,
 403         [SkipIt]        = do_skip,
 404         [GotName]       = do_name,
 405         [CopyFile]      = do_copy,
 406         [GotSymlink]    = do_symlink,
 407         [Reset]         = do_reset,
 408 };
 409
 410 static long __init write_buffer(char *buf, unsigned long len)
 411 {
 412         count = len;
 413         victim = buf;
 414
 415         while (!actions[state]())
 416                 ;
 417         return len - count;
 418 }
 419
 420 static long __init flush_buffer(void *bufv, unsigned long len)
 421 {
 422         char *buf = (char *) bufv;
 423         long written;
 424         long origLen = len;
 425         if (message)
 426                 return -1;
 427         while ((written = write_buffer(buf, len)) < len && !message) {
 428                 char c = buf[written];
 429                 if (c == '0') {
 430                         buf += written;
 431                         len -= written;
 432                         state = Start;
 433                 } else if (c == 0) {
 434                         buf += written;
 435                         len -= written;
 436                         state = Reset;
 437                 } else
 438                         error("junk in compressed archive");
 439         }
 440         return origLen;
 441 }
 442
 443 static unsigned long my_inptr; /* index of next byte to be processed in inbuf */
 444
 445 #include <linux/decompress/generic.h>
 446
 447 static char * __init unpack_to_rootfs(char *buf, unsigned long len)
 448 {
 449         long written;
 450         decompress_fn decompress;
 451         const char *compress_name;
 452         static __initdata char msg_buf[64];
 453
 454         header_buf = kmalloc(110, GFP_KERNEL);
 455         symlink_buf = kmalloc(PATH_MAX + N_ALIGN(PATH_MAX) + 1, GFP_KERNEL);
 456         name_buf = kmalloc(N_ALIGN(PATH_MAX), GFP_KERNEL);
 457
 458         if (!header_buf || !symlink_buf || !name_buf)
 459                 panic("can't allocate buffers");
 460
 461         state = Start;
 462         this_header = 0;
 463         message = NULL;
 464         while (!message && len) {
 465                 loff_t saved_offset = this_header;
 466                 if (*buf == '0' && !(this_header & 3)) {
 467                         state = Start;
 468                         written = write_buffer(buf, len);
 469                         buf += written;
 470                         len -= written;
 471                         continue;
 472                 }
 473                 if (!*buf) {
 474                         buf++;
 475                         len--;
 476                         this_header++;
 477                         continue;
 478                 }
 479                 this_header = 0;
 480                 decompress = decompress_method(buf, len, &compress_name);
 481                 pr_debug("Detected %s compressed data\n", compress_name);
 482                 if (decompress) {
 483                         int res = decompress(buf, len, NULL, flush_buffer, NULL,
 484                                    &my_inptr, error);
 485                         if (res)
 486                                 error("decompressor failed");
 487                 } else if (compress_name) {
 488                         if (!message) {
 489                                 snprintf(msg_buf, sizeof msg_buf,
 490                                          "compression method %s not configured",
 491                                          compress_name);
 492                                 message = msg_buf;
 493                         }
 494                 } else
 495                         error("junk in compressed archive");
 496                 if (state != Reset)
 497                         error("junk in compressed archive");
 498                 this_header = saved_offset + my_inptr;
 499                 buf += my_inptr;
 500                 len -= my_inptr;
 501         }
 502         dir_utime();
 503         kfree(name_buf);
 504         kfree(symlink_buf);
 505         kfree(header_buf);
 506         return message;
 507 }
 508
 509 static int __initdata do_retain_initrd;
 510
 511 static int __init retain_initrd_param(char *str)
 512 {
 513         if (*str)
 514                 return 0;
 515         do_retain_initrd = 1;
 516         return 1;
 517 }
 518 __setup("retain_initrd", retain_initrd_param);
 519
 520 extern char __initramfs_start[];
 521 extern unsigned long __initramfs_size;
 522 #include <linux/initrd.h>
 523 #include <linux/kexec.h>
 524
 525 static void __init free_initrd(void)
 526 {
 527 #ifdef CONFIG_KEXEC
 528         unsigned long crashk_start = (unsigned long)__va(crashk_res.start);
 529         unsigned long crashk_end   = (unsigned long)__va(crashk_res.end);
 530 #endif
 531         if (do_retain_initrd)
 532                 goto skip;
 533
 534 #ifdef CONFIG_KEXEC
 535         /*
 536          * If the initrd region is overlapped with crashkernel reserved region,
 537          * free only memory that is not part of crashkernel region.
 538          */
 539         if (initrd_start < crashk_end && initrd_end > crashk_start) {
 540                 /*
 541                  * Initialize initrd memory region since the kexec boot does
 542                  * not do.
 543                  */
 544                 memset((void *)initrd_start, 0, initrd_end - initrd_start);
 545                 if (initrd_start < crashk_start)
 546                         free_initrd_mem(initrd_start, crashk_start);
 547                 if (initrd_end > crashk_end)
 548                         free_initrd_mem(crashk_end, initrd_end);
 549         } else
 550 #endif
 551                 free_initrd_mem(initrd_start, initrd_end);
 552 skip:
 553         initrd_start = 0;
 554         initrd_end = 0;
 555 }
 556
 557 #ifdef CONFIG_BLK_DEV_RAM
 558 #define BUF_SIZE 1024
 559 static void __init clean_rootfs(void)
 560 {
 561         int fd;
 562         void *buf;
 563         struct linux_dirent64 *dirp;
 564         int num;
 565
 566         fd = sys_open("/", O_RDONLY, 0);
 567         WARN_ON(fd < 0);
 568         if (fd < 0)
 569                 return;
 570         buf = kzalloc(BUF_SIZE, GFP_KERNEL);
 571         WARN_ON(!buf);
 572         if (!buf) {
 573                 sys_close(fd);
 574                 return;
 575         }
 576
 577         dirp = buf;
 578         num = sys_getdents64(fd, dirp, BUF_SIZE);
 579         while (num > 0) {
 580                 while (num > 0) {
 581                         struct stat st;
 582                         int ret;
 583
 584                         ret = sys_newlstat(dirp->d_name, &st);
 585                         WARN_ON_ONCE(ret);
 586                         if (!ret) {
 587                                 if (S_ISDIR(st.st_mode))
 588                                         sys_rmdir(dirp->d_name);
 589                                 else
 590                                         sys_unlink(dirp->d_name);
 591                         }
 592
 593                         num -= dirp->d_reclen;
 594                         dirp = (void *)dirp + dirp->d_reclen;
 595                 }
 596                 dirp = buf;
 597                 memset(buf, 0, BUF_SIZE);
 598                 num = sys_getdents64(fd, dirp, BUF_SIZE);
 599         }
 600
 601         sys_close(fd);
 602         kfree(buf);
 603 }
 604 #endif
 605
 606 static int __init populate_rootfs(void)
 607 {
 608         char *err = unpack_to_rootfs(__initramfs_start, __initramfs_size);
 609         if (err)
 610                 panic("%s", err); /* Failed to decompress INTERNAL initramfs */
 611         if (initrd_start) {
 612 #ifdef CONFIG_BLK_DEV_RAM
 613                 int fd;
 614                 printk(KERN_INFO "Trying to unpack rootfs image as initramfs...\n");
 615                 err = unpack_to_rootfs((char *)initrd_start,
 616                         initrd_end - initrd_start);
 617                 if (!err) {
 618                         free_initrd();
 619                         goto done;
 620                 } else {
 621                         clean_rootfs();
 622                         unpack_to_rootfs(__initramfs_start, __initramfs_size);
 623                 }
 624                 printk(KERN_INFO "rootfs image is not initramfs (%s)"
 625                                 "; looks like an initrd\n", err);
 626                 fd = sys_open("/initrd.image",
 627                               O_WRONLY|O_CREAT, 0700);
 628                 if (fd >= 0) {
 629                         ssize_t written = xwrite(fd, (char *)initrd_start,
 630                                                 initrd_end - initrd_start);
 631
 632                         if (written != initrd_end - initrd_start)
 633                                 pr_err("/initrd.image: incomplete write (%zd != %ld)\n",
 634                                        written, initrd_end - initrd_start);
 635
 636                         sys_close(fd);
 637                         free_initrd();
 638                 }
 639         done:
 640 #else
 641                 printk(KERN_INFO "Unpacking initramfs...\n");
 642                 err = unpack_to_rootfs((char *)initrd_start,
 643                         initrd_end - initrd_start);
 644                 if (err)
 645                         printk(KERN_EMERG "Initramfs unpacking failed: %s\n", err);
 646                 free_initrd();
 647 #endif
 648                 /*
 649                  * Try loading default modules from initramfs.  This gives
 650                  * us a chance to load before device_initcalls.
 651                  */
 652                 load_default_modules();
 653         }
 654         return 0;
 655 }
 656 rootfs_initcall(populate_rootfs);