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