fdtdump.c

Go to the documentation of this file.

/*
 * 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;
}