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