OSDN Git Service

Merge branch 'for-upstream' of git://git.kernel.org/pub/scm/linux/kernel/git/bluetoot...
[uclinux-h8/linux.git] / 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                 if (xwrite(wfd, victim, body_len) != body_len)
373                         error("write error");
374                 sys_close(wfd);
375                 do_utime(vcollected, mtime);
376                 kfree(vcollected);
377                 eat(body_len);
378                 state = SkipIt;
379                 return 0;
380         } else {
381                 if (xwrite(wfd, victim, count) != count)
382                         error("write error");
383                 body_len -= count;
384                 eat(count);
385                 return 1;
386         }
387 }
388
389 static int __init do_symlink(void)
390 {
391         collected[N_ALIGN(name_len) + body_len] = '\0';
392         clean_path(collected, 0);
393         sys_symlink(collected + N_ALIGN(name_len), collected);
394         sys_lchown(collected, uid, gid);
395         do_utime(collected, mtime);
396         state = SkipIt;
397         next_state = Reset;
398         return 0;
399 }
400
401 static __initdata int (*actions[])(void) = {
402         [Start]         = do_start,
403         [Collect]       = do_collect,
404         [GotHeader]     = do_header,
405         [SkipIt]        = do_skip,
406         [GotName]       = do_name,
407         [CopyFile]      = do_copy,
408         [GotSymlink]    = do_symlink,
409         [Reset]         = do_reset,
410 };
411
412 static long __init write_buffer(char *buf, unsigned long len)
413 {
414         count = len;
415         victim = buf;
416
417         while (!actions[state]())
418                 ;
419         return len - count;
420 }
421
422 static long __init flush_buffer(void *bufv, unsigned long len)
423 {
424         char *buf = (char *) bufv;
425         long written;
426         long origLen = len;
427         if (message)
428                 return -1;
429         while ((written = write_buffer(buf, len)) < len && !message) {
430                 char c = buf[written];
431                 if (c == '0') {
432                         buf += written;
433                         len -= written;
434                         state = Start;
435                 } else if (c == 0) {
436                         buf += written;
437                         len -= written;
438                         state = Reset;
439                 } else
440                         error("junk in compressed archive");
441         }
442         return origLen;
443 }
444
445 static unsigned long my_inptr; /* index of next byte to be processed in inbuf */
446
447 #include <linux/decompress/generic.h>
448
449 static char * __init unpack_to_rootfs(char *buf, unsigned long len)
450 {
451         long written;
452         decompress_fn decompress;
453         const char *compress_name;
454         static __initdata char msg_buf[64];
455
456         header_buf = kmalloc(110, GFP_KERNEL);
457         symlink_buf = kmalloc(PATH_MAX + N_ALIGN(PATH_MAX) + 1, GFP_KERNEL);
458         name_buf = kmalloc(N_ALIGN(PATH_MAX), GFP_KERNEL);
459
460         if (!header_buf || !symlink_buf || !name_buf)
461                 panic("can't allocate buffers");
462
463         state = Start;
464         this_header = 0;
465         message = NULL;
466         while (!message && len) {
467                 loff_t saved_offset = this_header;
468                 if (*buf == '0' && !(this_header & 3)) {
469                         state = Start;
470                         written = write_buffer(buf, len);
471                         buf += written;
472                         len -= written;
473                         continue;
474                 }
475                 if (!*buf) {
476                         buf++;
477                         len--;
478                         this_header++;
479                         continue;
480                 }
481                 this_header = 0;
482                 decompress = decompress_method(buf, len, &compress_name);
483                 pr_debug("Detected %s compressed data\n", compress_name);
484                 if (decompress) {
485                         int res = decompress(buf, len, NULL, flush_buffer, NULL,
486                                    &my_inptr, error);
487                         if (res)
488                                 error("decompressor failed");
489                 } else if (compress_name) {
490                         if (!message) {
491                                 snprintf(msg_buf, sizeof msg_buf,
492                                          "compression method %s not configured",
493                                          compress_name);
494                                 message = msg_buf;
495                         }
496                 } else
497                         error("junk in compressed archive");
498                 if (state != Reset)
499                         error("junk in compressed archive");
500                 this_header = saved_offset + my_inptr;
501                 buf += my_inptr;
502                 len -= my_inptr;
503         }
504         dir_utime();
505         kfree(name_buf);
506         kfree(symlink_buf);
507         kfree(header_buf);
508         return message;
509 }
510
511 static int __initdata do_retain_initrd;
512
513 static int __init retain_initrd_param(char *str)
514 {
515         if (*str)
516                 return 0;
517         do_retain_initrd = 1;
518         return 1;
519 }
520 __setup("retain_initrd", retain_initrd_param);
521
522 extern char __initramfs_start[];
523 extern unsigned long __initramfs_size;
524 #include <linux/initrd.h>
525 #include <linux/kexec.h>
526
527 static void __init free_initrd(void)
528 {
529 #ifdef CONFIG_KEXEC
530         unsigned long crashk_start = (unsigned long)__va(crashk_res.start);
531         unsigned long crashk_end   = (unsigned long)__va(crashk_res.end);
532 #endif
533         if (do_retain_initrd)
534                 goto skip;
535
536 #ifdef CONFIG_KEXEC
537         /*
538          * If the initrd region is overlapped with crashkernel reserved region,
539          * free only memory that is not part of crashkernel region.
540          */
541         if (initrd_start < crashk_end && initrd_end > crashk_start) {
542                 /*
543                  * Initialize initrd memory region since the kexec boot does
544                  * not do.
545                  */
546                 memset((void *)initrd_start, 0, initrd_end - initrd_start);
547                 if (initrd_start < crashk_start)
548                         free_initrd_mem(initrd_start, crashk_start);
549                 if (initrd_end > crashk_end)
550                         free_initrd_mem(crashk_end, initrd_end);
551         } else
552 #endif
553                 free_initrd_mem(initrd_start, initrd_end);
554 skip:
555         initrd_start = 0;
556         initrd_end = 0;
557 }
558
559 #ifdef CONFIG_BLK_DEV_RAM
560 #define BUF_SIZE 1024
561 static void __init clean_rootfs(void)
562 {
563         int fd;
564         void *buf;
565         struct linux_dirent64 *dirp;
566         int num;
567
568         fd = sys_open("/", O_RDONLY, 0);
569         WARN_ON(fd < 0);
570         if (fd < 0)
571                 return;
572         buf = kzalloc(BUF_SIZE, GFP_KERNEL);
573         WARN_ON(!buf);
574         if (!buf) {
575                 sys_close(fd);
576                 return;
577         }
578
579         dirp = buf;
580         num = sys_getdents64(fd, dirp, BUF_SIZE);
581         while (num > 0) {
582                 while (num > 0) {
583                         struct stat st;
584                         int ret;
585
586                         ret = sys_newlstat(dirp->d_name, &st);
587                         WARN_ON_ONCE(ret);
588                         if (!ret) {
589                                 if (S_ISDIR(st.st_mode))
590                                         sys_rmdir(dirp->d_name);
591                                 else
592                                         sys_unlink(dirp->d_name);
593                         }
594
595                         num -= dirp->d_reclen;
596                         dirp = (void *)dirp + dirp->d_reclen;
597                 }
598                 dirp = buf;
599                 memset(buf, 0, BUF_SIZE);
600                 num = sys_getdents64(fd, dirp, BUF_SIZE);
601         }
602
603         sys_close(fd);
604         kfree(buf);
605 }
606 #endif
607
608 static int __init populate_rootfs(void)
609 {
610         char *err = unpack_to_rootfs(__initramfs_start, __initramfs_size);
611         if (err)
612                 panic("%s", err); /* Failed to decompress INTERNAL initramfs */
613         if (initrd_start) {
614 #ifdef CONFIG_BLK_DEV_RAM
615                 int fd;
616                 printk(KERN_INFO "Trying to unpack rootfs image as initramfs...\n");
617                 err = unpack_to_rootfs((char *)initrd_start,
618                         initrd_end - initrd_start);
619                 if (!err) {
620                         free_initrd();
621                         goto done;
622                 } else {
623                         clean_rootfs();
624                         unpack_to_rootfs(__initramfs_start, __initramfs_size);
625                 }
626                 printk(KERN_INFO "rootfs image is not initramfs (%s)"
627                                 "; looks like an initrd\n", err);
628                 fd = sys_open("/initrd.image",
629                               O_WRONLY|O_CREAT, 0700);
630                 if (fd >= 0) {
631                         ssize_t written = xwrite(fd, (char *)initrd_start,
632                                                 initrd_end - initrd_start);
633
634                         if (written != initrd_end - initrd_start)
635                                 pr_err("/initrd.image: incomplete write (%zd != %ld)\n",
636                                        written, initrd_end - initrd_start);
637
638                         sys_close(fd);
639                         free_initrd();
640                 }
641         done:
642 #else
643                 printk(KERN_INFO "Unpacking initramfs...\n");
644                 err = unpack_to_rootfs((char *)initrd_start,
645                         initrd_end - initrd_start);
646                 if (err)
647                         printk(KERN_EMERG "Initramfs unpacking failed: %s\n", err);
648                 free_initrd();
649 #endif
650                 /*
651                  * Try loading default modules from initramfs.  This gives
652                  * us a chance to load before device_initcalls.
653                  */
654                 load_default_modules();
655         }
656         return 0;
657 }
658 rootfs_initcall(populate_rootfs);