162 lines
3.6 KiB
C
162 lines
3.6 KiB
C
/*
|
|
* fdtdump.c - Contributed by Pantelis Antoniou <pantelis.antoniou AT gmail.com>
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <ctype.h>
|
|
|
|
#include <fdt.h>
|
|
#include <libfdt_env.h>
|
|
|
|
#include "util.h"
|
|
|
|
#define ALIGN(x, a) (((x) + ((a) - 1)) & ~((a) - 1))
|
|
#define PALIGN(p, a) ((void *)(ALIGN((unsigned long)(p), (a))))
|
|
#define GET_CELL(p) (p += 4, *((const uint32_t *)(p-4)))
|
|
|
|
static void print_data(const char *data, int len)
|
|
{
|
|
int i;
|
|
const char *p = data;
|
|
|
|
/* no data, don't print */
|
|
if (len == 0)
|
|
return;
|
|
|
|
if (util_is_printable_string(data, len)) {
|
|
printf(" = \"%s\"", (const char *)data);
|
|
} else if ((len % 4) == 0) {
|
|
printf(" = <");
|
|
for (i = 0; i < len; i += 4)
|
|
printf("0x%08x%s", fdt32_to_cpu(GET_CELL(p)),
|
|
i < (len - 4) ? " " : "");
|
|
printf(">");
|
|
} else {
|
|
printf(" = [");
|
|
for (i = 0; i < len; i++)
|
|
printf("%02x%s", *p++, i < len - 1 ? " " : "");
|
|
printf("]");
|
|
}
|
|
}
|
|
|
|
static void dump_blob(void *blob)
|
|
{
|
|
struct fdt_header *bph = blob;
|
|
uint32_t off_mem_rsvmap = fdt32_to_cpu(bph->off_mem_rsvmap);
|
|
uint32_t off_dt = fdt32_to_cpu(bph->off_dt_struct);
|
|
uint32_t off_str = fdt32_to_cpu(bph->off_dt_strings);
|
|
struct fdt_reserve_entry *p_rsvmap =
|
|
(struct fdt_reserve_entry *)((char *)blob + off_mem_rsvmap);
|
|
const char *p_struct = (const char *)blob + off_dt;
|
|
const char *p_strings = (const char *)blob + off_str;
|
|
uint32_t version = fdt32_to_cpu(bph->version);
|
|
uint32_t totalsize = fdt32_to_cpu(bph->totalsize);
|
|
uint32_t tag;
|
|
const char *p, *s, *t;
|
|
int depth, sz, shift;
|
|
int i;
|
|
uint64_t addr, size;
|
|
|
|
depth = 0;
|
|
shift = 4;
|
|
|
|
printf("/dts-v1/;\n");
|
|
printf("// magic:\t\t0x%x\n", fdt32_to_cpu(bph->magic));
|
|
printf("// totalsize:\t\t0x%x (%d)\n", totalsize, totalsize);
|
|
printf("// off_dt_struct:\t0x%x\n", off_dt);
|
|
printf("// off_dt_strings:\t0x%x\n", off_str);
|
|
printf("// off_mem_rsvmap:\t0x%x\n", off_mem_rsvmap);
|
|
printf("// version:\t\t%d\n", version);
|
|
printf("// last_comp_version:\t%d\n",
|
|
fdt32_to_cpu(bph->last_comp_version));
|
|
if (version >= 2)
|
|
printf("// boot_cpuid_phys:\t0x%x\n",
|
|
fdt32_to_cpu(bph->boot_cpuid_phys));
|
|
|
|
if (version >= 3)
|
|
printf("// size_dt_strings:\t0x%x\n",
|
|
fdt32_to_cpu(bph->size_dt_strings));
|
|
if (version >= 17)
|
|
printf("// size_dt_struct:\t0x%x\n",
|
|
fdt32_to_cpu(bph->size_dt_struct));
|
|
printf("\n");
|
|
|
|
for (i = 0; ; i++) {
|
|
addr = fdt64_to_cpu(p_rsvmap[i].address);
|
|
size = fdt64_to_cpu(p_rsvmap[i].size);
|
|
if (addr == 0 && size == 0)
|
|
break;
|
|
|
|
printf("/memreserve/ %llx %llx;\n",
|
|
(unsigned long long)addr, (unsigned long long)size);
|
|
}
|
|
|
|
p = p_struct;
|
|
while ((tag = fdt32_to_cpu(GET_CELL(p))) != FDT_END) {
|
|
|
|
/* printf("tag: 0x%08x (%d)\n", tag, p - p_struct); */
|
|
|
|
if (tag == FDT_BEGIN_NODE) {
|
|
s = p;
|
|
p = PALIGN(p + strlen(s) + 1, 4);
|
|
|
|
if (*s == '\0')
|
|
s = "/";
|
|
|
|
printf("%*s%s {\n", depth * shift, "", s);
|
|
|
|
depth++;
|
|
continue;
|
|
}
|
|
|
|
if (tag == FDT_END_NODE) {
|
|
depth--;
|
|
|
|
printf("%*s};\n", depth * shift, "");
|
|
continue;
|
|
}
|
|
|
|
if (tag == FDT_NOP) {
|
|
printf("%*s// [NOP]\n", depth * shift, "");
|
|
continue;
|
|
}
|
|
|
|
if (tag != FDT_PROP) {
|
|
fprintf(stderr, "%*s ** Unknown tag 0x%08x\n", depth * shift, "", tag);
|
|
break;
|
|
}
|
|
sz = fdt32_to_cpu(GET_CELL(p));
|
|
s = p_strings + fdt32_to_cpu(GET_CELL(p));
|
|
if (version < 16 && sz >= 8)
|
|
p = PALIGN(p, 8);
|
|
t = p;
|
|
|
|
p = PALIGN(p + sz, 4);
|
|
|
|
printf("%*s%s", depth * shift, "", s);
|
|
print_data(t, sz);
|
|
printf(";\n");
|
|
}
|
|
}
|
|
|
|
|
|
int main(int argc, char *argv[])
|
|
{
|
|
char *buf;
|
|
|
|
if (argc < 2) {
|
|
fprintf(stderr, "supply input filename\n");
|
|
return 5;
|
|
}
|
|
|
|
buf = utilfdt_read(argv[1]);
|
|
if (buf)
|
|
dump_blob(buf);
|
|
else
|
|
return 10;
|
|
|
|
return 0;
|
|
}
|