2 * (C) Copyright David Gibson <dwg@au1.ibm.com>, IBM Corporation. 2005.
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License as
7 * published by the Free Software Foundation; either version 2 of the
8 * License, or (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
24 #define FTF_FULLPATH 0x1
25 #define FTF_VARALIGN 0x2
26 #define FTF_NAMEPROPS 0x4
27 #define FTF_BOOTCPUID 0x8
28 #define FTF_STRTABSIZE 0x10
29 #define FTF_STRUCTSIZE 0x20
32 static struct version_info
{
34 int last_comp_version
;
39 FTF_FULLPATH
|FTF_VARALIGN
|FTF_NAMEPROPS
},
41 FTF_FULLPATH
|FTF_VARALIGN
|FTF_NAMEPROPS
|FTF_BOOTCPUID
},
43 FTF_FULLPATH
|FTF_VARALIGN
|FTF_NAMEPROPS
|FTF_BOOTCPUID
|FTF_STRTABSIZE
},
45 FTF_BOOTCPUID
|FTF_STRTABSIZE
|FTF_NOPS
},
46 {17, 16, FDT_V17_SIZE
,
47 FTF_BOOTCPUID
|FTF_STRTABSIZE
|FTF_STRUCTSIZE
|FTF_NOPS
},
51 void (*cell
)(void *, cell_t
);
52 void (*string
)(void *, const char *, int);
53 void (*align
)(void *, int);
54 void (*data
)(void *, struct data
);
55 void (*beginnode
)(void *, struct label
*labels
);
56 void (*endnode
)(void *, struct label
*labels
);
57 void (*property
)(void *, struct label
*labels
);
60 static void bin_emit_cell(void *e
, cell_t val
)
62 struct data
*dtbuf
= e
;
64 *dtbuf
= data_append_cell(*dtbuf
, val
);
67 static void bin_emit_string(void *e
, const char *str
, int len
)
69 struct data
*dtbuf
= e
;
74 *dtbuf
= data_append_data(*dtbuf
, str
, len
);
75 *dtbuf
= data_append_byte(*dtbuf
, '\0');
78 static void bin_emit_align(void *e
, int a
)
80 struct data
*dtbuf
= e
;
82 *dtbuf
= data_append_align(*dtbuf
, a
);
85 static void bin_emit_data(void *e
, struct data d
)
87 struct data
*dtbuf
= e
;
89 *dtbuf
= data_append_data(*dtbuf
, d
.val
, d
.len
);
92 static void bin_emit_beginnode(void *e
, struct label
*labels
)
94 bin_emit_cell(e
, FDT_BEGIN_NODE
);
97 static void bin_emit_endnode(void *e
, struct label
*labels
)
99 bin_emit_cell(e
, FDT_END_NODE
);
102 static void bin_emit_property(void *e
, struct label
*labels
)
104 bin_emit_cell(e
, FDT_PROP
);
107 static struct emitter bin_emitter
= {
108 .cell
= bin_emit_cell
,
109 .string
= bin_emit_string
,
110 .align
= bin_emit_align
,
111 .data
= bin_emit_data
,
112 .beginnode
= bin_emit_beginnode
,
113 .endnode
= bin_emit_endnode
,
114 .property
= bin_emit_property
,
117 static void emit_label(FILE *f
, const char *prefix
, const char *label
)
119 fprintf(f
, "\t.globl\t%s_%s\n", prefix
, label
);
120 fprintf(f
, "%s_%s:\n", prefix
, label
);
121 fprintf(f
, "_%s_%s:\n", prefix
, label
);
124 static void emit_offset_label(FILE *f
, const char *label
, int offset
)
126 fprintf(f
, "\t.globl\t%s\n", label
);
127 fprintf(f
, "%s\t= . + %d\n", label
, offset
);
130 #define ASM_EMIT_BELONG(f, fmt, ...) \
132 fprintf((f), "\t.byte\t((" fmt ") >> 24) & 0xff\n", __VA_ARGS__); \
133 fprintf((f), "\t.byte\t((" fmt ") >> 16) & 0xff\n", __VA_ARGS__); \
134 fprintf((f), "\t.byte\t((" fmt ") >> 8) & 0xff\n", __VA_ARGS__); \
135 fprintf((f), "\t.byte\t(" fmt ") & 0xff\n", __VA_ARGS__); \
138 static void asm_emit_cell(void *e
, cell_t val
)
142 fprintf(f
, "\t.byte 0x%02x; .byte 0x%02x; .byte 0x%02x; .byte 0x%02x\n",
143 (val
>> 24) & 0xff, (val
>> 16) & 0xff,
144 (val
>> 8) & 0xff, val
& 0xff);
147 static void asm_emit_string(void *e
, const char *str
, int len
)
152 fprintf(f
, "\t.string\t\"%.*s\"\n", len
, str
);
154 fprintf(f
, "\t.string\t\"%s\"\n", str
);
157 static void asm_emit_align(void *e
, int a
)
161 fprintf(f
, "\t.balign\t%d, 0\n", a
);
164 static void asm_emit_data(void *e
, struct data d
)
168 struct marker
*m
= d
.markers
;
170 for_each_marker_of_type(m
, LABEL
)
171 emit_offset_label(f
, m
->ref
, m
->offset
);
173 while ((d
.len
- off
) >= sizeof(uint32_t)) {
174 asm_emit_cell(e
, fdt32_to_cpu(*((fdt32_t
*)(d
.val
+off
))));
175 off
+= sizeof(uint32_t);
178 while ((d
.len
- off
) >= 1) {
179 fprintf(f
, "\t.byte\t0x%hhx\n", d
.val
[off
]);
183 assert(off
== d
.len
);
186 static void asm_emit_beginnode(void *e
, struct label
*labels
)
191 for_each_label(labels
, l
) {
192 fprintf(f
, "\t.globl\t%s\n", l
->label
);
193 fprintf(f
, "%s:\n", l
->label
);
195 fprintf(f
, "\t/* FDT_BEGIN_NODE */\n");
196 asm_emit_cell(e
, FDT_BEGIN_NODE
);
199 static void asm_emit_endnode(void *e
, struct label
*labels
)
204 fprintf(f
, "\t/* FDT_END_NODE */\n");
205 asm_emit_cell(e
, FDT_END_NODE
);
206 for_each_label(labels
, l
) {
207 fprintf(f
, "\t.globl\t%s_end\n", l
->label
);
208 fprintf(f
, "%s_end:\n", l
->label
);
212 static void asm_emit_property(void *e
, struct label
*labels
)
217 for_each_label(labels
, l
) {
218 fprintf(f
, "\t.globl\t%s\n", l
->label
);
219 fprintf(f
, "%s:\n", l
->label
);
221 fprintf(f
, "\t/* FDT_PROP */\n");
222 asm_emit_cell(e
, FDT_PROP
);
225 static struct emitter asm_emitter
= {
226 .cell
= asm_emit_cell
,
227 .string
= asm_emit_string
,
228 .align
= asm_emit_align
,
229 .data
= asm_emit_data
,
230 .beginnode
= asm_emit_beginnode
,
231 .endnode
= asm_emit_endnode
,
232 .property
= asm_emit_property
,
235 static int stringtable_insert(struct data
*d
, const char *str
)
239 /* FIXME: do this more efficiently? */
241 for (i
= 0; i
< d
->len
; i
++) {
242 if (streq(str
, d
->val
+ i
))
246 *d
= data_append_data(*d
, str
, strlen(str
)+1);
250 static void flatten_tree(struct node
*tree
, struct emitter
*emit
,
251 void *etarget
, struct data
*strbuf
,
252 struct version_info
*vi
)
254 struct property
*prop
;
256 bool seen_name_prop
= false;
261 emit
->beginnode(etarget
, tree
->labels
);
263 if (vi
->flags
& FTF_FULLPATH
)
264 emit
->string(etarget
, tree
->fullpath
, 0);
266 emit
->string(etarget
, tree
->name
, 0);
268 emit
->align(etarget
, sizeof(cell_t
));
270 for_each_property(tree
, prop
) {
273 if (streq(prop
->name
, "name"))
274 seen_name_prop
= true;
276 nameoff
= stringtable_insert(strbuf
, prop
->name
);
278 emit
->property(etarget
, prop
->labels
);
279 emit
->cell(etarget
, prop
->val
.len
);
280 emit
->cell(etarget
, nameoff
);
282 if ((vi
->flags
& FTF_VARALIGN
) && (prop
->val
.len
>= 8))
283 emit
->align(etarget
, 8);
285 emit
->data(etarget
, prop
->val
);
286 emit
->align(etarget
, sizeof(cell_t
));
289 if ((vi
->flags
& FTF_NAMEPROPS
) && !seen_name_prop
) {
290 emit
->property(etarget
, NULL
);
291 emit
->cell(etarget
, tree
->basenamelen
+1);
292 emit
->cell(etarget
, stringtable_insert(strbuf
, "name"));
294 if ((vi
->flags
& FTF_VARALIGN
) && ((tree
->basenamelen
+1) >= 8))
295 emit
->align(etarget
, 8);
297 emit
->string(etarget
, tree
->name
, tree
->basenamelen
);
298 emit
->align(etarget
, sizeof(cell_t
));
301 for_each_child(tree
, child
) {
302 flatten_tree(child
, emit
, etarget
, strbuf
, vi
);
305 emit
->endnode(etarget
, tree
->labels
);
308 static struct data
flatten_reserve_list(struct reserve_info
*reservelist
,
309 struct version_info
*vi
)
311 struct reserve_info
*re
;
312 struct data d
= empty_data
;
315 for (re
= reservelist
; re
; re
= re
->next
) {
316 d
= data_append_re(d
, re
->address
, re
->size
);
319 * Add additional reserved slots if the user asked for them.
321 for (j
= 0; j
< reservenum
; j
++) {
322 d
= data_append_re(d
, 0, 0);
328 static void make_fdt_header(struct fdt_header
*fdt
,
329 struct version_info
*vi
,
330 int reservesize
, int dtsize
, int strsize
,
335 reservesize
+= sizeof(struct fdt_reserve_entry
);
337 memset(fdt
, 0xff, sizeof(*fdt
));
339 fdt
->magic
= cpu_to_fdt32(FDT_MAGIC
);
340 fdt
->version
= cpu_to_fdt32(vi
->version
);
341 fdt
->last_comp_version
= cpu_to_fdt32(vi
->last_comp_version
);
343 /* Reserve map should be doubleword aligned */
344 reserve_off
= ALIGN(vi
->hdr_size
, 8);
346 fdt
->off_mem_rsvmap
= cpu_to_fdt32(reserve_off
);
347 fdt
->off_dt_struct
= cpu_to_fdt32(reserve_off
+ reservesize
);
348 fdt
->off_dt_strings
= cpu_to_fdt32(reserve_off
+ reservesize
350 fdt
->totalsize
= cpu_to_fdt32(reserve_off
+ reservesize
+ dtsize
+ strsize
);
352 if (vi
->flags
& FTF_BOOTCPUID
)
353 fdt
->boot_cpuid_phys
= cpu_to_fdt32(boot_cpuid_phys
);
354 if (vi
->flags
& FTF_STRTABSIZE
)
355 fdt
->size_dt_strings
= cpu_to_fdt32(strsize
);
356 if (vi
->flags
& FTF_STRUCTSIZE
)
357 fdt
->size_dt_struct
= cpu_to_fdt32(dtsize
);
360 void dt_to_blob(FILE *f
, struct dt_info
*dti
, int version
)
362 struct version_info
*vi
= NULL
;
364 struct data blob
= empty_data
;
365 struct data reservebuf
= empty_data
;
366 struct data dtbuf
= empty_data
;
367 struct data strbuf
= empty_data
;
368 struct fdt_header fdt
;
371 for (i
= 0; i
< ARRAY_SIZE(version_table
); i
++) {
372 if (version_table
[i
].version
== version
)
373 vi
= &version_table
[i
];
376 die("Unknown device tree blob version %d\n", version
);
378 flatten_tree(dti
->dt
, &bin_emitter
, &dtbuf
, &strbuf
, vi
);
379 bin_emit_cell(&dtbuf
, FDT_END
);
381 reservebuf
= flatten_reserve_list(dti
->reservelist
, vi
);
384 make_fdt_header(&fdt
, vi
, reservebuf
.len
, dtbuf
.len
, strbuf
.len
,
385 dti
->boot_cpuid_phys
);
388 * If the user asked for more space than is used, adjust the totalsize.
391 padlen
= minsize
- fdt32_to_cpu(fdt
.totalsize
);
396 "Warning: blob size %d >= minimum size %d\n",
397 fdt32_to_cpu(fdt
.totalsize
), minsize
);
405 padlen
= ALIGN(fdt32_to_cpu(fdt
.totalsize
) + padlen
, alignsize
)
406 - fdt32_to_cpu(fdt
.totalsize
);
409 int tsize
= fdt32_to_cpu(fdt
.totalsize
);
411 fdt
.totalsize
= cpu_to_fdt32(tsize
);
415 * Assemble the blob: start with the header, add with alignment
416 * the reserve buffer, add the reserve map terminating zeroes,
417 * the device tree itself, and finally the strings.
419 blob
= data_append_data(blob
, &fdt
, vi
->hdr_size
);
420 blob
= data_append_align(blob
, 8);
421 blob
= data_merge(blob
, reservebuf
);
422 blob
= data_append_zeroes(blob
, sizeof(struct fdt_reserve_entry
));
423 blob
= data_merge(blob
, dtbuf
);
424 blob
= data_merge(blob
, strbuf
);
427 * If the user asked for more space than is used, pad out the blob.
430 blob
= data_append_zeroes(blob
, padlen
);
432 if (fwrite(blob
.val
, blob
.len
, 1, f
) != 1) {
434 die("Error writing device tree blob: %s\n",
437 die("Short write on device tree blob\n");
441 * data_merge() frees the right-hand element so only the blob
442 * remains to be freed.
447 static void dump_stringtable_asm(FILE *f
, struct data strbuf
)
454 while (p
< (strbuf
.val
+ strbuf
.len
)) {
456 fprintf(f
, "\t.string \"%s\"\n", p
);
461 void dt_to_asm(FILE *f
, struct dt_info
*dti
, int version
)
463 struct version_info
*vi
= NULL
;
465 struct data strbuf
= empty_data
;
466 struct reserve_info
*re
;
467 const char *symprefix
= "dt";
469 for (i
= 0; i
< ARRAY_SIZE(version_table
); i
++) {
470 if (version_table
[i
].version
== version
)
471 vi
= &version_table
[i
];
474 die("Unknown device tree blob version %d\n", version
);
476 fprintf(f
, "/* autogenerated by dtc, do not edit */\n\n");
478 emit_label(f
, symprefix
, "blob_start");
479 emit_label(f
, symprefix
, "header");
480 fprintf(f
, "\t/* magic */\n");
481 asm_emit_cell(f
, FDT_MAGIC
);
482 fprintf(f
, "\t/* totalsize */\n");
483 ASM_EMIT_BELONG(f
, "_%s_blob_abs_end - _%s_blob_start",
484 symprefix
, symprefix
);
485 fprintf(f
, "\t/* off_dt_struct */\n");
486 ASM_EMIT_BELONG(f
, "_%s_struct_start - _%s_blob_start",
487 symprefix
, symprefix
);
488 fprintf(f
, "\t/* off_dt_strings */\n");
489 ASM_EMIT_BELONG(f
, "_%s_strings_start - _%s_blob_start",
490 symprefix
, symprefix
);
491 fprintf(f
, "\t/* off_mem_rsvmap */\n");
492 ASM_EMIT_BELONG(f
, "_%s_reserve_map - _%s_blob_start",
493 symprefix
, symprefix
);
494 fprintf(f
, "\t/* version */\n");
495 asm_emit_cell(f
, vi
->version
);
496 fprintf(f
, "\t/* last_comp_version */\n");
497 asm_emit_cell(f
, vi
->last_comp_version
);
499 if (vi
->flags
& FTF_BOOTCPUID
) {
500 fprintf(f
, "\t/* boot_cpuid_phys */\n");
501 asm_emit_cell(f
, dti
->boot_cpuid_phys
);
504 if (vi
->flags
& FTF_STRTABSIZE
) {
505 fprintf(f
, "\t/* size_dt_strings */\n");
506 ASM_EMIT_BELONG(f
, "_%s_strings_end - _%s_strings_start",
507 symprefix
, symprefix
);
510 if (vi
->flags
& FTF_STRUCTSIZE
) {
511 fprintf(f
, "\t/* size_dt_struct */\n");
512 ASM_EMIT_BELONG(f
, "_%s_struct_end - _%s_struct_start",
513 symprefix
, symprefix
);
517 * Reserve map entries.
518 * Align the reserve map to a doubleword boundary.
519 * Each entry is an (address, size) pair of u64 values.
520 * Always supply a zero-sized temination entry.
522 asm_emit_align(f
, 8);
523 emit_label(f
, symprefix
, "reserve_map");
525 fprintf(f
, "/* Memory reserve map from source file */\n");
528 * Use .long on high and low halfs of u64s to avoid .quad
529 * as it appears .quad isn't available in some assemblers.
531 for (re
= dti
->reservelist
; re
; re
= re
->next
) {
534 for_each_label(re
->labels
, l
) {
535 fprintf(f
, "\t.globl\t%s\n", l
->label
);
536 fprintf(f
, "%s:\n", l
->label
);
538 ASM_EMIT_BELONG(f
, "0x%08x", (unsigned int)(re
->address
>> 32));
539 ASM_EMIT_BELONG(f
, "0x%08x",
540 (unsigned int)(re
->address
& 0xffffffff));
541 ASM_EMIT_BELONG(f
, "0x%08x", (unsigned int)(re
->size
>> 32));
542 ASM_EMIT_BELONG(f
, "0x%08x", (unsigned int)(re
->size
& 0xffffffff));
544 for (i
= 0; i
< reservenum
; i
++) {
545 fprintf(f
, "\t.long\t0, 0\n\t.long\t0, 0\n");
548 fprintf(f
, "\t.long\t0, 0\n\t.long\t0, 0\n");
550 emit_label(f
, symprefix
, "struct_start");
551 flatten_tree(dti
->dt
, &asm_emitter
, f
, &strbuf
, vi
);
553 fprintf(f
, "\t/* FDT_END */\n");
554 asm_emit_cell(f
, FDT_END
);
555 emit_label(f
, symprefix
, "struct_end");
557 emit_label(f
, symprefix
, "strings_start");
558 dump_stringtable_asm(f
, strbuf
);
559 emit_label(f
, symprefix
, "strings_end");
561 emit_label(f
, symprefix
, "blob_end");
564 * If the user asked for more space than is used, pad it out.
567 fprintf(f
, "\t.space\t%d - (_%s_blob_end - _%s_blob_start), 0\n",
568 minsize
, symprefix
, symprefix
);
571 fprintf(f
, "\t.space\t%d, 0\n", padsize
);
574 asm_emit_align(f
, alignsize
);
575 emit_label(f
, symprefix
, "blob_abs_end");
581 char *base
, *limit
, *ptr
;
584 static void inbuf_init(struct inbuf
*inb
, void *base
, void *limit
)
588 inb
->ptr
= inb
->base
;
591 static void flat_read_chunk(struct inbuf
*inb
, void *p
, int len
)
593 if ((inb
->ptr
+ len
) > inb
->limit
)
594 die("Premature end of data parsing flat device tree\n");
596 memcpy(p
, inb
->ptr
, len
);
601 static uint32_t flat_read_word(struct inbuf
*inb
)
605 assert(((inb
->ptr
- inb
->base
) % sizeof(val
)) == 0);
607 flat_read_chunk(inb
, &val
, sizeof(val
));
609 return fdt32_to_cpu(val
);
612 static void flat_realign(struct inbuf
*inb
, int align
)
614 int off
= inb
->ptr
- inb
->base
;
616 inb
->ptr
= inb
->base
+ ALIGN(off
, align
);
617 if (inb
->ptr
> inb
->limit
)
618 die("Premature end of data parsing flat device tree\n");
621 static char *flat_read_string(struct inbuf
*inb
)
624 const char *p
= inb
->ptr
;
629 die("Premature end of data parsing flat device tree\n");
631 } while ((*p
++) != '\0');
633 str
= xstrdup(inb
->ptr
);
637 flat_realign(inb
, sizeof(uint32_t));
642 static struct data
flat_read_data(struct inbuf
*inb
, int len
)
644 struct data d
= empty_data
;
649 d
= data_grow_for(d
, len
);
652 flat_read_chunk(inb
, d
.val
, len
);
654 flat_realign(inb
, sizeof(uint32_t));
659 static char *flat_read_stringtable(struct inbuf
*inb
, int offset
)
663 p
= inb
->base
+ offset
;
665 if (p
>= inb
->limit
|| p
< inb
->base
)
666 die("String offset %d overruns string table\n",
675 return xstrdup(inb
->base
+ offset
);
678 static struct property
*flat_read_property(struct inbuf
*dtbuf
,
679 struct inbuf
*strbuf
, int flags
)
681 uint32_t proplen
, stroff
;
685 proplen
= flat_read_word(dtbuf
);
686 stroff
= flat_read_word(dtbuf
);
688 name
= flat_read_stringtable(strbuf
, stroff
);
690 if ((flags
& FTF_VARALIGN
) && (proplen
>= 8))
691 flat_realign(dtbuf
, 8);
693 val
= flat_read_data(dtbuf
, proplen
);
695 return build_property(name
, val
);
699 static struct reserve_info
*flat_read_mem_reserve(struct inbuf
*inb
)
701 struct reserve_info
*reservelist
= NULL
;
702 struct reserve_info
*new;
703 struct fdt_reserve_entry re
;
706 * Each entry is a pair of u64 (addr, size) values for 4 cell_t's.
707 * List terminates at an entry with size equal to zero.
709 * First pass, count entries.
712 uint64_t address
, size
;
714 flat_read_chunk(inb
, &re
, sizeof(re
));
715 address
= fdt64_to_cpu(re
.address
);
716 size
= fdt64_to_cpu(re
.size
);
720 new = build_reserve_entry(address
, size
);
721 reservelist
= add_reserve_entry(reservelist
, new);
728 static char *nodename_from_path(const char *ppath
, const char *cpath
)
732 plen
= strlen(ppath
);
734 if (!strstarts(cpath
, ppath
))
735 die("Path \"%s\" is not valid as a child of \"%s\"\n",
738 /* root node is a special case */
739 if (!streq(ppath
, "/"))
742 return xstrdup(cpath
+ plen
);
745 static struct node
*unflatten_tree(struct inbuf
*dtbuf
,
746 struct inbuf
*strbuf
,
747 const char *parent_flatname
, int flags
)
753 node
= build_node(NULL
, NULL
);
755 flatname
= flat_read_string(dtbuf
);
757 if (flags
& FTF_FULLPATH
)
758 node
->name
= nodename_from_path(parent_flatname
, flatname
);
760 node
->name
= flatname
;
763 struct property
*prop
;
766 val
= flat_read_word(dtbuf
);
770 fprintf(stderr
, "Warning: Flat tree input has "
771 "subnodes preceding a property.\n");
772 prop
= flat_read_property(dtbuf
, strbuf
, flags
);
773 add_property(node
, prop
);
777 child
= unflatten_tree(dtbuf
,strbuf
, flatname
, flags
);
778 add_child(node
, child
);
785 die("Premature FDT_END in device tree blob\n");
789 if (!(flags
& FTF_NOPS
))
790 fprintf(stderr
, "Warning: NOP tag found in flat tree"
797 die("Invalid opcode word %08x in device tree blob\n",
800 } while (val
!= FDT_END_NODE
);
802 if (node
->name
!= flatname
) {
810 struct dt_info
*dt_from_blob(const char *fname
)
813 fdt32_t magic_buf
, totalsize_buf
;
814 uint32_t magic
, totalsize
, version
, size_dt
, boot_cpuid_phys
;
815 uint32_t off_dt
, off_str
, off_mem_rsvmap
;
818 struct fdt_header
*fdt
;
820 struct inbuf dtbuf
, strbuf
;
821 struct inbuf memresvbuf
;
823 struct reserve_info
*reservelist
;
828 f
= srcfile_relative_open(fname
, NULL
);
830 rc
= fread(&magic_buf
, sizeof(magic_buf
), 1, f
);
832 die("Error reading DT blob magic number: %s\n",
836 die("EOF reading DT blob magic number\n");
838 die("Mysterious short read reading magic number\n");
841 magic
= fdt32_to_cpu(magic_buf
);
842 if (magic
!= FDT_MAGIC
)
843 die("Blob has incorrect magic number\n");
845 rc
= fread(&totalsize_buf
, sizeof(totalsize_buf
), 1, f
);
847 die("Error reading DT blob size: %s\n", strerror(errno
));
850 die("EOF reading DT blob size\n");
852 die("Mysterious short read reading blob size\n");
855 totalsize
= fdt32_to_cpu(totalsize_buf
);
856 if (totalsize
< FDT_V1_SIZE
)
857 die("DT blob size (%d) is too small\n", totalsize
);
859 blob
= xmalloc(totalsize
);
861 fdt
= (struct fdt_header
*)blob
;
862 fdt
->magic
= cpu_to_fdt32(magic
);
863 fdt
->totalsize
= cpu_to_fdt32(totalsize
);
865 sizeleft
= totalsize
- sizeof(magic
) - sizeof(totalsize
);
866 p
= blob
+ sizeof(magic
) + sizeof(totalsize
);
870 die("EOF before reading %d bytes of DT blob\n",
873 rc
= fread(p
, 1, sizeleft
, f
);
875 die("Error reading DT blob: %s\n",
882 off_dt
= fdt32_to_cpu(fdt
->off_dt_struct
);
883 off_str
= fdt32_to_cpu(fdt
->off_dt_strings
);
884 off_mem_rsvmap
= fdt32_to_cpu(fdt
->off_mem_rsvmap
);
885 version
= fdt32_to_cpu(fdt
->version
);
886 boot_cpuid_phys
= fdt32_to_cpu(fdt
->boot_cpuid_phys
);
888 if (off_mem_rsvmap
>= totalsize
)
889 die("Mem Reserve structure offset exceeds total size\n");
891 if (off_dt
>= totalsize
)
892 die("DT structure offset exceeds total size\n");
894 if (off_str
> totalsize
)
895 die("String table offset exceeds total size\n");
898 uint32_t size_str
= fdt32_to_cpu(fdt
->size_dt_strings
);
899 if ((off_str
+size_str
< off_str
) || (off_str
+size_str
> totalsize
))
900 die("String table extends past total size\n");
901 inbuf_init(&strbuf
, blob
+ off_str
, blob
+ off_str
+ size_str
);
903 inbuf_init(&strbuf
, blob
+ off_str
, blob
+ totalsize
);
907 size_dt
= fdt32_to_cpu(fdt
->size_dt_struct
);
908 if ((off_dt
+size_dt
< off_dt
) || (off_dt
+size_dt
> totalsize
))
909 die("Structure block extends past total size\n");
913 flags
|= FTF_FULLPATH
| FTF_NAMEPROPS
| FTF_VARALIGN
;
918 inbuf_init(&memresvbuf
,
919 blob
+ off_mem_rsvmap
, blob
+ totalsize
);
920 inbuf_init(&dtbuf
, blob
+ off_dt
, blob
+ totalsize
);
922 reservelist
= flat_read_mem_reserve(&memresvbuf
);
924 val
= flat_read_word(&dtbuf
);
926 if (val
!= FDT_BEGIN_NODE
)
927 die("Device tree blob doesn't begin with FDT_BEGIN_NODE (begins with 0x%08x)\n", val
);
929 tree
= unflatten_tree(&dtbuf
, &strbuf
, "", flags
);
931 val
= flat_read_word(&dtbuf
);
933 die("Device tree blob doesn't end with FDT_END\n");
939 return build_dt_info(DTSF_V1
, reservelist
, tree
, boot_cpuid_phys
);