1 /*
2 * (C) Copyright 2018 Linaro Ltd.
3 * Sam Protsenko <semen.protsenko@linaro.org>
4 *
5 * SPDX-License-Identifier: GPL-2.0+
6 */
7
8 #include <image-android-dt.h>
9 #include <dt_table.h>
10 #include <common.h>
11 #include <linux/libfdt.h>
12 #include <mapmem.h>
13
14 /**
15 * Check if image header is correct.
16 *
17 * @param hdr_addr Start address of DT image
18 * @return true if header is correct or false if header is incorrect
19 */
android_dt_check_header(ulong hdr_addr)20 bool android_dt_check_header(ulong hdr_addr)
21 {
22 const struct dt_table_header *hdr;
23 u32 magic;
24
25 hdr = map_sysmem(hdr_addr, sizeof(*hdr));
26 magic = fdt32_to_cpu(hdr->magic);
27 unmap_sysmem(hdr);
28
29 return magic == DT_TABLE_MAGIC;
30 }
31
32 /**
33 * Get the address of FDT (dtb or dtbo) in memory by its index in image.
34 *
35 * @param hdr_addr Start address of DT image
36 * @param index Index of desired FDT in image (starting from 0)
37 * @param[out] addr If not NULL, will contain address to specified FDT
38 * @param[out] size If not NULL, will contain size of specified FDT
39 *
40 * @return true on success or false on error
41 */
android_dt_get_fdt_by_index(ulong hdr_addr,u32 index,ulong * addr,u32 * size)42 bool android_dt_get_fdt_by_index(ulong hdr_addr, u32 index, ulong *addr,
43 u32 *size)
44 {
45 const struct dt_table_header *hdr;
46 const struct dt_table_entry *e;
47 u32 entry_count, entries_offset, entry_size;
48 ulong e_addr;
49 u32 dt_offset, dt_size;
50
51 hdr = map_sysmem(hdr_addr, sizeof(*hdr));
52 entry_count = fdt32_to_cpu(hdr->dt_entry_count);
53 entries_offset = fdt32_to_cpu(hdr->dt_entries_offset);
54 entry_size = fdt32_to_cpu(hdr->dt_entry_size);
55 unmap_sysmem(hdr);
56
57 if (index > entry_count) {
58 printf("Error: index > dt_entry_count (%u > %u)\n", index,
59 entry_count);
60 return false;
61 }
62
63 e_addr = hdr_addr + entries_offset + index * entry_size;
64 e = map_sysmem(e_addr, sizeof(*e));
65 dt_offset = fdt32_to_cpu(e->dt_offset);
66 dt_size = fdt32_to_cpu(e->dt_size);
67 unmap_sysmem(e);
68
69 if (addr)
70 *addr = hdr_addr + dt_offset;
71 if (size)
72 *size = dt_size;
73
74 return true;
75 }
76
77 #if !defined(CONFIG_SPL_BUILD)
android_dt_print_fdt_info(const struct fdt_header * fdt)78 static void android_dt_print_fdt_info(const struct fdt_header *fdt)
79 {
80 u32 fdt_size;
81 int root_node_off;
82 const char *compatible = NULL;
83
84 fdt_size = fdt_totalsize(fdt);
85 root_node_off = fdt_path_offset(fdt, "/");
86 if (root_node_off < 0) {
87 printf("Error: Root node not found\n");
88 } else {
89 compatible = fdt_getprop(fdt, root_node_off, "compatible",
90 NULL);
91 }
92
93 printf(" (FDT)size = %d\n", fdt_size);
94 printf(" (FDT)compatible = %s\n",
95 compatible ? compatible : "(unknown)");
96 }
97
98 /**
99 * Print information about DT image structure.
100 *
101 * @param hdr_addr Start address of DT image
102 */
android_dt_print_contents(ulong hdr_addr)103 void android_dt_print_contents(ulong hdr_addr)
104 {
105 const struct dt_table_header *hdr;
106 u32 entry_count, entries_offset, entry_size;
107 u32 i;
108
109 hdr = map_sysmem(hdr_addr, sizeof(*hdr));
110 entry_count = fdt32_to_cpu(hdr->dt_entry_count);
111 entries_offset = fdt32_to_cpu(hdr->dt_entries_offset);
112 entry_size = fdt32_to_cpu(hdr->dt_entry_size);
113
114 /* Print image header info */
115 printf("dt_table_header:\n");
116 printf(" magic = %08x\n", fdt32_to_cpu(hdr->magic));
117 printf(" total_size = %d\n", fdt32_to_cpu(hdr->total_size));
118 printf(" header_size = %d\n", fdt32_to_cpu(hdr->header_size));
119 printf(" dt_entry_size = %d\n", entry_size);
120 printf(" dt_entry_count = %d\n", entry_count);
121 printf(" dt_entries_offset = %d\n", entries_offset);
122 printf(" page_size = %d\n", fdt32_to_cpu(hdr->page_size));
123 printf(" version = %08x\n", fdt32_to_cpu(hdr->version));
124
125 unmap_sysmem(hdr);
126
127 /* Print image entries info */
128 for (i = 0; i < entry_count; ++i) {
129 const ulong e_addr = hdr_addr + entries_offset + i * entry_size;
130 const struct dt_table_entry *e;
131 const struct fdt_header *fdt;
132 u32 dt_offset, dt_size;
133 u32 j;
134
135 e = map_sysmem(e_addr, sizeof(*e));
136 dt_offset = fdt32_to_cpu(e->dt_offset);
137 dt_size = fdt32_to_cpu(e->dt_size);
138
139 printf("dt_table_entry[%d]:\n", i);
140 printf(" dt_size = %d\n", dt_size);
141 printf(" dt_offset = %d\n", dt_offset);
142 printf(" id = %08x\n", fdt32_to_cpu(e->id));
143 printf(" rev = %08x\n", fdt32_to_cpu(e->rev));
144 for (j = 0; j < 4; ++j) {
145 printf(" custom[%d] = %08x\n", j,
146 fdt32_to_cpu(e->custom[j]));
147 }
148
149 unmap_sysmem(e);
150
151 /* Print FDT info for this entry */
152 fdt = map_sysmem(hdr_addr + dt_offset, sizeof(*fdt));
153 android_dt_print_fdt_info(fdt);
154 unmap_sysmem(fdt);
155 }
156 }
157 #endif
158
159 /**
160 * Get dt entry count of DT image structure.
161 *
162 * @param hdr_addr Start address of DT image
163 */
android_dt_get_count(ulong hdr_addr)164 int android_dt_get_count(ulong hdr_addr)
165 {
166 const struct dt_table_header *hdr;
167 int count;
168
169 hdr = map_sysmem(hdr_addr, sizeof(*hdr));
170 count = fdt32_to_cpu(hdr->dt_entry_count);
171 unmap_sysmem(hdr);
172
173 return count;
174 }
175