Commit | Line | Data |
---|---|---|
cd296721 SW |
1 | /* |
2 | * fdtdump.c - Contributed by Pantelis Antoniou <pantelis.antoniou AT gmail.com> | |
3 | */ | |
4 | ||
5 | #include <stdint.h> | |
6 | #include <stdio.h> | |
7 | #include <stdlib.h> | |
8 | #include <string.h> | |
9 | #include <ctype.h> | |
10 | ||
11 | #include <fdt.h> | |
12 | #include <libfdt_env.h> | |
13 | ||
14 | #include "util.h" | |
15 | ||
16 | #define ALIGN(x, a) (((x) + ((a) - 1)) & ~((a) - 1)) | |
17 | #define PALIGN(p, a) ((void *)(ALIGN((unsigned long)(p), (a)))) | |
18 | #define GET_CELL(p) (p += 4, *((const uint32_t *)(p-4))) | |
19 | ||
20 | static void print_data(const char *data, int len) | |
21 | { | |
22 | int i; | |
23 | const char *p = data; | |
24 | ||
25 | /* no data, don't print */ | |
26 | if (len == 0) | |
27 | return; | |
28 | ||
29 | if (util_is_printable_string(data, len)) { | |
30 | printf(" = \"%s\"", (const char *)data); | |
31 | } else if ((len % 4) == 0) { | |
32 | printf(" = <"); | |
33 | for (i = 0; i < len; i += 4) | |
34 | printf("0x%08x%s", fdt32_to_cpu(GET_CELL(p)), | |
35 | i < (len - 4) ? " " : ""); | |
36 | printf(">"); | |
37 | } else { | |
38 | printf(" = ["); | |
39 | for (i = 0; i < len; i++) | |
40 | printf("%02x%s", *p++, i < len - 1 ? " " : ""); | |
41 | printf("]"); | |
42 | } | |
43 | } | |
44 | ||
45 | static void dump_blob(void *blob) | |
46 | { | |
47 | struct fdt_header *bph = blob; | |
48 | uint32_t off_mem_rsvmap = fdt32_to_cpu(bph->off_mem_rsvmap); | |
49 | uint32_t off_dt = fdt32_to_cpu(bph->off_dt_struct); | |
50 | uint32_t off_str = fdt32_to_cpu(bph->off_dt_strings); | |
51 | struct fdt_reserve_entry *p_rsvmap = | |
52 | (struct fdt_reserve_entry *)((char *)blob + off_mem_rsvmap); | |
53 | const char *p_struct = (const char *)blob + off_dt; | |
54 | const char *p_strings = (const char *)blob + off_str; | |
55 | uint32_t version = fdt32_to_cpu(bph->version); | |
56 | uint32_t totalsize = fdt32_to_cpu(bph->totalsize); | |
57 | uint32_t tag; | |
58 | const char *p, *s, *t; | |
59 | int depth, sz, shift; | |
60 | int i; | |
61 | uint64_t addr, size; | |
62 | ||
63 | depth = 0; | |
64 | shift = 4; | |
65 | ||
66 | printf("/dts-v1/;\n"); | |
67 | printf("// magic:\t\t0x%x\n", fdt32_to_cpu(bph->magic)); | |
68 | printf("// totalsize:\t\t0x%x (%d)\n", totalsize, totalsize); | |
69 | printf("// off_dt_struct:\t0x%x\n", off_dt); | |
70 | printf("// off_dt_strings:\t0x%x\n", off_str); | |
71 | printf("// off_mem_rsvmap:\t0x%x\n", off_mem_rsvmap); | |
72 | printf("// version:\t\t%d\n", version); | |
73 | printf("// last_comp_version:\t%d\n", | |
74 | fdt32_to_cpu(bph->last_comp_version)); | |
75 | if (version >= 2) | |
76 | printf("// boot_cpuid_phys:\t0x%x\n", | |
77 | fdt32_to_cpu(bph->boot_cpuid_phys)); | |
78 | ||
79 | if (version >= 3) | |
80 | printf("// size_dt_strings:\t0x%x\n", | |
81 | fdt32_to_cpu(bph->size_dt_strings)); | |
82 | if (version >= 17) | |
83 | printf("// size_dt_struct:\t0x%x\n", | |
84 | fdt32_to_cpu(bph->size_dt_struct)); | |
85 | printf("\n"); | |
86 | ||
87 | for (i = 0; ; i++) { | |
88 | addr = fdt64_to_cpu(p_rsvmap[i].address); | |
89 | size = fdt64_to_cpu(p_rsvmap[i].size); | |
90 | if (addr == 0 && size == 0) | |
91 | break; | |
92 | ||
93 | printf("/memreserve/ %llx %llx;\n", | |
94 | (unsigned long long)addr, (unsigned long long)size); | |
95 | } | |
96 | ||
97 | p = p_struct; | |
98 | while ((tag = fdt32_to_cpu(GET_CELL(p))) != FDT_END) { | |
99 | ||
100 | /* printf("tag: 0x%08x (%d)\n", tag, p - p_struct); */ | |
101 | ||
102 | if (tag == FDT_BEGIN_NODE) { | |
103 | s = p; | |
104 | p = PALIGN(p + strlen(s) + 1, 4); | |
105 | ||
106 | if (*s == '\0') | |
107 | s = "/"; | |
108 | ||
109 | printf("%*s%s {\n", depth * shift, "", s); | |
110 | ||
111 | depth++; | |
112 | continue; | |
113 | } | |
114 | ||
115 | if (tag == FDT_END_NODE) { | |
116 | depth--; | |
117 | ||
118 | printf("%*s};\n", depth * shift, ""); | |
119 | continue; | |
120 | } | |
121 | ||
122 | if (tag == FDT_NOP) { | |
123 | printf("%*s// [NOP]\n", depth * shift, ""); | |
124 | continue; | |
125 | } | |
126 | ||
127 | if (tag != FDT_PROP) { | |
128 | fprintf(stderr, "%*s ** Unknown tag 0x%08x\n", depth * shift, "", tag); | |
129 | break; | |
130 | } | |
131 | sz = fdt32_to_cpu(GET_CELL(p)); | |
132 | s = p_strings + fdt32_to_cpu(GET_CELL(p)); | |
133 | if (version < 16 && sz >= 8) | |
134 | p = PALIGN(p, 8); | |
135 | t = p; | |
136 | ||
137 | p = PALIGN(p + sz, 4); | |
138 | ||
139 | printf("%*s%s", depth * shift, "", s); | |
140 | print_data(t, sz); | |
141 | printf(";\n"); | |
142 | } | |
143 | } | |
144 | ||
145 | ||
146 | int main(int argc, char *argv[]) | |
147 | { | |
148 | char *buf; | |
149 | ||
150 | if (argc < 2) { | |
151 | fprintf(stderr, "supply input filename\n"); | |
152 | return 5; | |
153 | } | |
154 | ||
155 | buf = utilfdt_read(argv[1]); | |
156 | if (buf) | |
157 | dump_blob(buf); | |
158 | else | |
159 | return 10; | |
160 | ||
161 | return 0; | |
162 | } |