David Gibson
20 years ago
3 changed files with 201 additions and 7 deletions
@ -0,0 +1,188 @@ |
|||||||
|
/* |
||||||
|
* ftdump.c - Contributed by Pantelis Antoniou <pantelis.antoniou AT gmail.com> |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <stdint.h> |
||||||
|
#include <stdio.h> |
||||||
|
#include <string.h> |
||||||
|
#include <ctype.h> |
||||||
|
#include <netinet/in.h> |
||||||
|
#include <byteswap.h> |
||||||
|
|
||||||
|
#include "flat_dt.h" |
||||||
|
|
||||||
|
#define cpu_to_be16(x) htons(x) |
||||||
|
#define be16_to_cpu(x) ntohs(x) |
||||||
|
|
||||||
|
#define cpu_to_be32(x) htonl(x) |
||||||
|
#define be32_to_cpu(x) ntohl(x) |
||||||
|
|
||||||
|
#if __BYTE_ORDER == __BIG_ENDIAN |
||||||
|
#define cpu_to_be64(x) (x) |
||||||
|
#define be64_to_cpu(x) (x) |
||||||
|
#else |
||||||
|
#define cpu_to_be64(x) bswap_64(x) |
||||||
|
#define be64_to_cpu(x) bswap_64(x) |
||||||
|
#endif |
||||||
|
|
||||||
|
#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, *((uint32_t *)(p-4))) |
||||||
|
|
||||||
|
static int is_printable_string(const void *data, int len) |
||||||
|
{ |
||||||
|
const char *s = data; |
||||||
|
const char *ss; |
||||||
|
|
||||||
|
/* zero length is not */ |
||||||
|
if (len == 0) |
||||||
|
return 0; |
||||||
|
|
||||||
|
/* must terminate with zero */ |
||||||
|
if (s[len - 1] != '\0') |
||||||
|
return 0; |
||||||
|
|
||||||
|
ss = s; |
||||||
|
while (*s && isprint(*s)) |
||||||
|
s++; |
||||||
|
|
||||||
|
/* not zero, or not done yet */ |
||||||
|
if (*s != '\0' || (s + 1 - ss) < len) |
||||||
|
return 0; |
||||||
|
|
||||||
|
return 1; |
||||||
|
} |
||||||
|
|
||||||
|
static void print_data(const void *data, int len) |
||||||
|
{ |
||||||
|
int i; |
||||||
|
const uint8_t *s; |
||||||
|
|
||||||
|
/* no data, don't print */ |
||||||
|
if (len == 0) |
||||||
|
return; |
||||||
|
|
||||||
|
if (is_printable_string(data, len)) { |
||||||
|
printf(" = \"%s\"", (char *)data); |
||||||
|
} else if ((len % 4) == 0) { |
||||||
|
printf(" = <"); |
||||||
|
for (i = 0; i < len; i += 4) |
||||||
|
printf("%08x%s", *((uint32_t *)data + i), |
||||||
|
i < (len - 4) ? " " : ""); |
||||||
|
printf(">"); |
||||||
|
} else { |
||||||
|
printf(" = ["); |
||||||
|
for (i = 0, s = data; i < len; i++) |
||||||
|
printf("%02x%s", s[i], i < len - 1 ? " " : ""); |
||||||
|
printf("]"); |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
static void dump_blob(void *blob) |
||||||
|
{ |
||||||
|
struct boot_param_header *bph = blob; |
||||||
|
struct reserve_entry *p_rsvmap = |
||||||
|
(struct reserve_entry *)(blob |
||||||
|
+ be32_to_cpu(bph->off_mem_rsvmap)); |
||||||
|
char *p_struct = blob + be32_to_cpu(bph->off_dt_struct); |
||||||
|
char *p_strings = blob + be32_to_cpu(bph->off_dt_strings); |
||||||
|
uint32_t version = be32_to_cpu(bph->version); |
||||||
|
uint32_t tag; |
||||||
|
char *p; |
||||||
|
char *s, *t; |
||||||
|
int depth, sz, shift; |
||||||
|
int i; |
||||||
|
uint64_t addr, size; |
||||||
|
|
||||||
|
depth = 0; |
||||||
|
shift = 4; |
||||||
|
|
||||||
|
printf("// Version 0x%x tree\n", version); |
||||||
|
for (i = 0; ; i++) { |
||||||
|
addr = be64_to_cpu(p_rsvmap[i].address); |
||||||
|
size = be64_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 = be32_to_cpu(GET_CELL(p))) != OF_DT_END) { |
||||||
|
|
||||||
|
/* printf("tag: 0x%08x (%d)\n", tag, p - p_struct); */ |
||||||
|
|
||||||
|
if (tag == OF_DT_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 == OF_DT_END_NODE) { |
||||||
|
depth--; |
||||||
|
|
||||||
|
printf("%*s};\n", depth * shift, ""); |
||||||
|
continue; |
||||||
|
} |
||||||
|
|
||||||
|
if (tag == OF_DT_NOP) { |
||||||
|
printf("%*s// [NOP]\n", depth * shift, ""); |
||||||
|
continue; |
||||||
|
} |
||||||
|
|
||||||
|
if (tag != OF_DT_PROP) { |
||||||
|
fprintf(stderr, "%*s ** Unknown tag 0x%08x\n", depth * shift, "", tag); |
||||||
|
break; |
||||||
|
} |
||||||
|
sz = GET_CELL(p); |
||||||
|
s = p_strings + be32_to_cpu(GET_CELL(p)); |
||||||
|
if (version < 0x10 && 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[]) |
||||||
|
{ |
||||||
|
FILE *fp; |
||||||
|
char buf[16384]; /* 16k max */ |
||||||
|
int size; |
||||||
|
|
||||||
|
if (argc < 2) { |
||||||
|
fprintf(stderr, "supply input filename\n"); |
||||||
|
return 5; |
||||||
|
} |
||||||
|
|
||||||
|
fp = fopen(argv[1], "rb"); |
||||||
|
if (fp == NULL) { |
||||||
|
fprintf(stderr, "unable to open %s\n", argv[1]); |
||||||
|
return 10; |
||||||
|
} |
||||||
|
|
||||||
|
size = fread(buf, 1, sizeof(buf), fp); |
||||||
|
if (size == sizeof(buf)) { /* too large */ |
||||||
|
fprintf(stderr, "file too large\n"); |
||||||
|
return 10; |
||||||
|
} |
||||||
|
|
||||||
|
dump_blob(buf); |
||||||
|
|
||||||
|
fclose(fp); |
||||||
|
|
||||||
|
return 0; |
||||||
|
} |
Loading…
Reference in new issue