common/image-android-dt.c

   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