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