1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
|
#include <apos/initrd.h>
#include <apos/vmem.h>
#include <apos/string.h>
#include <apos/utils.h>
#include <apos/attrs.h>
#include <libfdt.h>
/* GNU cpio, use POSIX 'newc' format */
struct __packed cpio_header {
char c_magic[6];
char c_ino[8];
char c_mode[8];
char c_uid[8];
char c_gid[8];
char c_nlink[8];
char c_mtime[8];
char c_filesize[8];
char c_devmajor[8];
char c_devminor[8];
char c_rdevmajor[8];
char c_rdevminor[8];
char c_namesize[8];
char c_check[8];
};
static struct cpio_header *next_entry(struct cpio_header *cp)
{
size_t blen = align_up(sizeof(struct cpio_header) + convnum(cp->c_namesize, 8, 16), 4);
size_t tlen = align_up(convnum(cp->c_filesize, 8, 16), 4);
return (struct cpio_header *)(((char *)cp) + blen + tlen);
}
static struct cpio_header *find_file(char *c, char* fname, size_t fname_len)
{
struct cpio_header *cp = (struct cpio_header *)c;
for(; cp; cp = next_entry(cp)){
size_t namelen = convnum(cp->c_namesize, 8, 16);
if(namelen == 0)
return 0;
if(namelen < fname_len)
continue;
char *name = (char *)(cp + 1);
if(fname[0] != '/')
name += namelen - (fname_len + 1); /* match ending */
if(strncmp(name, fname, fname_len) == 0)
return cp;
}
return 0;
}
pm_t get_initrdtop(void *fdt)
{
int chosen_offset = fdt_path_offset(fdt, "/chosen");
struct cell_info ci = get_cellinfo(fdt, chosen_offset);
void *initrd_end_ptr = (void *)fdt_getprop(fdt, chosen_offset,
"linux,initrd-end", NULL);
/* fdt is only aware of physical memory pointers */
return (pm_t)__va(fdt_load_int_ptr(ci.addr_cells, initrd_end_ptr));
}
pm_t get_initrdbase(void *fdt)
{
int chosen_offset = fdt_path_offset(fdt, "/chosen");
struct cell_info ci = get_cellinfo(fdt, chosen_offset);
void *initrd_base_ptr = (void *)fdt_getprop(fdt, chosen_offset,
"linux,initrd-start", NULL);
return (pm_t)__va(fdt_load_int_ptr(ci.addr_cells, initrd_base_ptr));
}
static char init_n[] = "init";
static size_t init_nlen = ARRAY_SIZE(init_n) - 1; /* ignore trailing NULL */
size_t get_init_size(void *fdt)
{
char *c = (char *)get_initrdbase(fdt);
struct cpio_header *cp = find_file(c, init_n, init_nlen);
return convnum(cp->c_filesize, 8, 16);
}
vm_t get_init_base(void *fdt)
{
char *c = (char *)get_initrdbase(fdt);
struct cpio_header *cp = find_file(c, init_n, init_nlen);
size_t name_len = convnum(cp->c_namesize, 8, 16);
return ((vm_t)cp) + align_up(sizeof(struct cpio_header) + name_len, 4);
}
void move_init(void *fdt, void *target)
{
char *c = (char *)get_initrdbase(fdt);
struct cpio_header *cp = find_file(c, init_n, init_nlen);
size_t name_len = convnum(cp->c_namesize, 8, 16);
size_t file_len = convnum(cp->c_filesize, 8, 16);
char *fp = (char *)cp;
fp += align_up(sizeof(struct cpio_header) + name_len, 4);
memmove(target, fp, file_len);
}
|
