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
print_data(const char * data,int len)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
dump_blob(void * blob)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
main(int argc,char * argv[])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 }
163