]> CyberLeo.Net >> Repos - FreeBSD/releng/10.0.git/blob - contrib/dtc/fdtdump.c
- Copy stable/10 (r259064) to releng/10.0 as part of the
[FreeBSD/releng/10.0.git] / contrib / dtc / fdtdump.c
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 }