common/image.c

   1 /*
   2  * (C) Copyright 2008 Semihalf
   3  *
   4  * (C) Copyright 2000-2006
   5  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   6  *
   7  * See file CREDITS for list of people who contributed to this
   8  * project.
   9  *
  10  * This program is free software; you can redistribute it and/or
  11  * modify it under the terms of the GNU General Public License as
  12  * published by the Free Software Foundation; either version 2 of
  13  * the License, or (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23  * MA 02111-1307 USA
  24  */
  25
  26 #ifndef USE_HOSTCC
  27 #include <common.h>
  28 #include <watchdog.h>
  29
  30 #ifdef CONFIG_SHOW_BOOT_PROGRESS
  31 #include <status_led.h>
  32 #endif
  33
  34 #ifdef CONFIG_HAS_DATAFLASH
  35 #include <dataflash.h>
  36 #endif
  37
  38 #ifdef CONFIG_LOGBUFFER
  39 #include <logbuff.h>
  40 #endif
  41
  42 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
  43 #include <rtc.h>
  44 #endif
  45
  46 #include <image.h>
  47
  48 #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT)
  49 #include <fdt.h>
  50 #include <libfdt.h>
  51 #include <fdt_support.h>
  52 #endif
  53
  54 #if defined(CONFIG_FIT)
  55 #include <u-boot/md5.h>
  56 #include <sha1.h>
  57
  58 static int fit_check_ramdisk(const void *fit, int os_noffset,
  59                 uint8_t arch, int verify);
  60 #endif
  61
  62 #ifdef CONFIG_CMD_BDI
  63 extern int do_bdinfo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]);
  64 #endif
  65
  66 DECLARE_GLOBAL_DATA_PTR;
  67
  68 static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch,
  69                                                 int verify);
  70 #else
  71 #include "mkimage.h"
  72 #include <u-boot/md5.h>
  73 #include <time.h>
  74 #include <image.h>
  75 #endif /* !USE_HOSTCC*/
  76
  77 static const table_entry_t uimage_arch[] = {
  78         {       IH_ARCH_INVALID,        NULL,           "Invalid ARCH", },
  79         {       IH_ARCH_ALPHA,          "alpha",        "Alpha",        },
  80         {       IH_ARCH_ARM,            "arm",          "ARM",          },
  81         {       IH_ARCH_I386,           "x86",          "Intel x86",    },
  82         {       IH_ARCH_IA64,           "ia64",         "IA64",         },
  83         {       IH_ARCH_M68K,           "m68k",         "M68K",         },
  84         {       IH_ARCH_MICROBLAZE,     "microblaze",   "MicroBlaze",   },
  85         {       IH_ARCH_MIPS,           "mips",         "MIPS",         },
  86         {       IH_ARCH_MIPS64,         "mips64",       "MIPS 64 Bit",  },
  87         {       IH_ARCH_NIOS2,          "nios2",        "NIOS II",      },
  88         {       IH_ARCH_PPC,            "powerpc",      "PowerPC",      },
  89         {       IH_ARCH_PPC,            "ppc",          "PowerPC",      },
  90         {       IH_ARCH_S390,           "s390",         "IBM S390",     },
  91         {       IH_ARCH_SH,             "sh",           "SuperH",       },
  92         {       IH_ARCH_SPARC,          "sparc",        "SPARC",        },
  93         {       IH_ARCH_SPARC64,        "sparc64",      "SPARC 64 Bit", },
  94         {       IH_ARCH_BLACKFIN,       "blackfin",     "Blackfin",     },
  95         {       IH_ARCH_AVR32,          "avr32",        "AVR32",        },
  96         {       IH_ARCH_NDS32,          "nds32",        "NDS32",        },
  97         {       IH_ARCH_OPENRISC,       "or1k",         "OpenRISC 1000",},
  98         {       -1,                     "",             "",             },
  99 };
 100
 101 static const table_entry_t uimage_os[] = {
 102         {       IH_OS_INVALID,  NULL,           "Invalid OS",           },
 103         {       IH_OS_LINUX,    "linux",        "Linux",                },
 104 #if defined(CONFIG_LYNXKDI) || defined(USE_HOSTCC)
 105         {       IH_OS_LYNXOS,   "lynxos",       "LynxOS",               },
 106 #endif
 107         {       IH_OS_NETBSD,   "netbsd",       "NetBSD",               },
 108         {       IH_OS_OSE,      "ose",          "Enea OSE",             },
 109         {       IH_OS_RTEMS,    "rtems",        "RTEMS",                },
 110         {       IH_OS_U_BOOT,   "u-boot",       "U-Boot",               },
 111 #if defined(CONFIG_CMD_ELF) || defined(USE_HOSTCC)
 112         {       IH_OS_QNX,      "qnx",          "QNX",                  },
 113         {       IH_OS_VXWORKS,  "vxworks",      "VxWorks",              },
 114 #endif
 115 #if defined(CONFIG_INTEGRITY) || defined(USE_HOSTCC)
 116         {       IH_OS_INTEGRITY,"integrity",    "INTEGRITY",            },
 117 #endif
 118 #ifdef USE_HOSTCC
 119         {       IH_OS_4_4BSD,   "4_4bsd",       "4_4BSD",               },
 120         {       IH_OS_DELL,     "dell",         "Dell",                 },
 121         {       IH_OS_ESIX,     "esix",         "Esix",                 },
 122         {       IH_OS_FREEBSD,  "freebsd",      "FreeBSD",              },
 123         {       IH_OS_IRIX,     "irix",         "Irix",                 },
 124         {       IH_OS_NCR,      "ncr",          "NCR",                  },
 125         {       IH_OS_OPENBSD,  "openbsd",      "OpenBSD",              },
 126         {       IH_OS_PSOS,     "psos",         "pSOS",                 },
 127         {       IH_OS_SCO,      "sco",          "SCO",                  },
 128         {       IH_OS_SOLARIS,  "solaris",      "Solaris",              },
 129         {       IH_OS_SVR4,     "svr4",         "SVR4",                 },
 130 #endif
 131         {       -1,             "",             "",                     },
 132 };
 133
 134 static const table_entry_t uimage_type[] = {
 135         {       IH_TYPE_AISIMAGE,   "aisimage",   "Davinci AIS image",},
 136         {       IH_TYPE_FILESYSTEM, "filesystem", "Filesystem Image",   },
 137         {       IH_TYPE_FIRMWARE,   "firmware",   "Firmware",           },
 138         {       IH_TYPE_FLATDT,     "flat_dt",    "Flat Device Tree",   },
 139         {       IH_TYPE_KERNEL,     "kernel",     "Kernel Image",       },
 140         {       IH_TYPE_KERNEL_NOLOAD, "kernel_noload",  "Kernel Image (no loading done)", },
 141         {       IH_TYPE_KWBIMAGE,   "kwbimage",   "Kirkwood Boot Image",},
 142         {       IH_TYPE_IMXIMAGE,   "imximage",   "Freescale i.MX Boot Image",},
 143         {       IH_TYPE_INVALID,    NULL,         "Invalid Image",      },
 144         {       IH_TYPE_MULTI,      "multi",      "Multi-File Image",   },
 145         {       IH_TYPE_OMAPIMAGE,  "omapimage",  "TI OMAP SPL With GP CH",},
 146         {       IH_TYPE_RAMDISK,    "ramdisk",    "RAMDisk Image",      },
 147         {       IH_TYPE_SCRIPT,     "script",     "Script",             },
 148         {       IH_TYPE_STANDALONE, "standalone", "Standalone Program", },
 149         {       IH_TYPE_UBLIMAGE,   "ublimage",   "Davinci UBL image",},
 150         {       -1,                 "",           "",                   },
 151 };
 152
 153 static const table_entry_t uimage_comp[] = {
 154         {       IH_COMP_NONE,   "none",         "uncompressed",         },
 155         {       IH_COMP_BZIP2,  "bzip2",        "bzip2 compressed",     },
 156         {       IH_COMP_GZIP,   "gzip",         "gzip compressed",      },
 157         {       IH_COMP_LZMA,   "lzma",         "lzma compressed",      },
 158         {       IH_COMP_LZO,    "lzo",          "lzo compressed",       },
 159         {       -1,             "",             "",                     },
 160 };
 161
 162 uint32_t crc32(uint32_t, const unsigned char *, uint);
 163 uint32_t crc32_wd(uint32_t, const unsigned char *, uint, uint);
 164 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC)
 165 static void genimg_print_time(time_t timestamp);
 166 #endif
 167
 168 /*****************************************************************************/
 169 /* Legacy format routines */
 170 /*****************************************************************************/
 171 int image_check_hcrc(const image_header_t *hdr)
 172 {
 173         ulong hcrc;
 174         ulong len = image_get_header_size();
 175         image_header_t header;
 176
 177         /* Copy header so we can blank CRC field for re-calculation */
 178         memmove(&header, (char *)hdr, image_get_header_size());
 179         image_set_hcrc(&header, 0);
 180
 181         hcrc = crc32(0, (unsigned char *)&header, len);
 182
 183         return (hcrc == image_get_hcrc(hdr));
 184 }
 185
 186 int image_check_dcrc(const image_header_t *hdr)
 187 {
 188         ulong data = image_get_data(hdr);
 189         ulong len = image_get_data_size(hdr);
 190         ulong dcrc = crc32_wd(0, (unsigned char *)data, len, CHUNKSZ_CRC32);
 191
 192         return (dcrc == image_get_dcrc(hdr));
 193 }
 194
 195 /**
 196  * image_multi_count - get component (sub-image) count
 197  * @hdr: pointer to the header of the multi component image
 198  *
 199  * image_multi_count() returns number of components in a multi
 200  * component image.
 201  *
 202  * Note: no checking of the image type is done, caller must pass
 203  * a valid multi component image.
 204  *
 205  * returns:
 206  *     number of components
 207  */
 208 ulong image_multi_count(const image_header_t *hdr)
 209 {
 210         ulong i, count = 0;
 211         uint32_t *size;
 212
 213         /* get start of the image payload, which in case of multi
 214          * component images that points to a table of component sizes */
 215         size = (uint32_t *)image_get_data(hdr);
 216
 217         /* count non empty slots */
 218         for (i = 0; size[i]; ++i)
 219                 count++;
 220
 221         return count;
 222 }
 223
 224 /**
 225  * image_multi_getimg - get component data address and size
 226  * @hdr: pointer to the header of the multi component image
 227  * @idx: index of the requested component
 228  * @data: pointer to a ulong variable, will hold component data address
 229  * @len: pointer to a ulong variable, will hold component size
 230  *
 231  * image_multi_getimg() returns size and data address for the requested
 232  * component in a multi component image.
 233  *
 234  * Note: no checking of the image type is done, caller must pass
 235  * a valid multi component image.
 236  *
 237  * returns:
 238  *     data address and size of the component, if idx is valid
 239  *     0 in data and len, if idx is out of range
 240  */
 241 void image_multi_getimg(const image_header_t *hdr, ulong idx,
 242                         ulong *data, ulong *len)
 243 {
 244         int i;
 245         uint32_t *size;
 246         ulong offset, count, img_data;
 247
 248         /* get number of component */
 249         count = image_multi_count(hdr);
 250
 251         /* get start of the image payload, which in case of multi
 252          * component images that points to a table of component sizes */
 253         size = (uint32_t *)image_get_data(hdr);
 254
 255         /* get address of the proper component data start, which means
 256          * skipping sizes table (add 1 for last, null entry) */
 257         img_data = image_get_data(hdr) + (count + 1) * sizeof(uint32_t);
 258
 259         if (idx < count) {
 260                 *len = uimage_to_cpu(size[idx]);
 261                 offset = 0;
 262
 263                 /* go over all indices preceding requested component idx */
 264                 for (i = 0; i < idx; i++) {
 265                         /* add up i-th component size, rounding up to 4 bytes */
 266                         offset += (uimage_to_cpu(size[i]) + 3) & ~3 ;
 267                 }
 268
 269                 /* calculate idx-th component data address */
 270                 *data = img_data + offset;
 271         } else {
 272                 *len = 0;
 273                 *data = 0;
 274         }
 275 }
 276
 277 static void image_print_type(const image_header_t *hdr)
 278 {
 279         const char *os, *arch, *type, *comp;
 280
 281         os = genimg_get_os_name(image_get_os(hdr));
 282         arch = genimg_get_arch_name(image_get_arch(hdr));
 283         type = genimg_get_type_name(image_get_type(hdr));
 284         comp = genimg_get_comp_name(image_get_comp(hdr));
 285
 286         printf("%s %s %s (%s)\n", arch, os, type, comp);
 287 }
 288
 289 /**
 290  * image_print_contents - prints out the contents of the legacy format image
 291  * @ptr: pointer to the legacy format image header
 292  * @p: pointer to prefix string
 293  *
 294  * image_print_contents() formats a multi line legacy image contents description.
 295  * The routine prints out all header fields followed by the size/offset data
 296  * for MULTI/SCRIPT images.
 297  *
 298  * returns:
 299  *     no returned results
 300  */
 301 void image_print_contents(const void *ptr)
 302 {
 303         const image_header_t *hdr = (const image_header_t *)ptr;
 304         const char *p;
 305
 306 #ifdef USE_HOSTCC
 307         p = "";
 308 #else
 309         p = "   ";
 310 #endif
 311
 312         printf("%sImage Name:   %.*s\n", p, IH_NMLEN, image_get_name(hdr));
 313 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC)
 314         printf("%sCreated:      ", p);
 315         genimg_print_time((time_t)image_get_time(hdr));
 316 #endif
 317         printf("%sImage Type:   ", p);
 318         image_print_type(hdr);
 319         printf("%sData Size:    ", p);
 320         genimg_print_size(image_get_data_size(hdr));
 321         printf("%sLoad Address: %08x\n", p, image_get_load(hdr));
 322         printf("%sEntry Point:  %08x\n", p, image_get_ep(hdr));
 323
 324         if (image_check_type(hdr, IH_TYPE_MULTI) ||
 325                         image_check_type(hdr, IH_TYPE_SCRIPT)) {
 326                 int i;
 327                 ulong data, len;
 328                 ulong count = image_multi_count(hdr);
 329
 330                 printf("%sContents:\n", p);
 331                 for (i = 0; i < count; i++) {
 332                         image_multi_getimg(hdr, i, &data, &len);
 333
 334                         printf("%s   Image %d: ", p, i);
 335                         genimg_print_size(len);
 336
 337                         if (image_check_type(hdr, IH_TYPE_SCRIPT) && i > 0) {
 338                                 /*
 339                                  * the user may need to know offsets
 340                                  * if planning to do something with
 341                                  * multiple files
 342                                  */
 343                                 printf("%s    Offset = 0x%08lx\n", p, data);
 344                         }
 345                 }
 346         }
 347 }
 348
 349
 350 #ifndef USE_HOSTCC
 351 /**
 352  * image_get_ramdisk - get and verify ramdisk image
 353  * @rd_addr: ramdisk image start address
 354  * @arch: expected ramdisk architecture
 355  * @verify: checksum verification flag
 356  *
 357  * image_get_ramdisk() returns a pointer to the verified ramdisk image
 358  * header. Routine receives image start address and expected architecture
 359  * flag. Verification done covers data and header integrity and os/type/arch
 360  * fields checking.
 361  *
 362  * If dataflash support is enabled routine checks for dataflash addresses
 363  * and handles required dataflash reads.
 364  *
 365  * returns:
 366  *     pointer to a ramdisk image header, if image was found and valid
 367  *     otherwise, return NULL
 368  */
 369 static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch,
 370                                                 int verify)
 371 {
 372         const image_header_t *rd_hdr = (const image_header_t *)rd_addr;
 373
 374         if (!image_check_magic(rd_hdr)) {
 375                 puts("Bad Magic Number\n");
 376                 bootstage_error(BOOTSTAGE_ID_RD_MAGIC);
 377                 return NULL;
 378         }
 379
 380         if (!image_check_hcrc(rd_hdr)) {
 381                 puts("Bad Header Checksum\n");
 382                 bootstage_error(BOOTSTAGE_ID_RD_HDR_CHECKSUM);
 383                 return NULL;
 384         }
 385
 386         bootstage_mark(BOOTSTAGE_ID_RD_MAGIC);
 387         image_print_contents(rd_hdr);
 388
 389         if (verify) {
 390                 puts("   Verifying Checksum ... ");
 391                 if (!image_check_dcrc(rd_hdr)) {
 392                         puts("Bad Data CRC\n");
 393                         bootstage_error(BOOTSTAGE_ID_RD_CHECKSUM);
 394                         return NULL;
 395                 }
 396                 puts("OK\n");
 397         }
 398
 399         bootstage_mark(BOOTSTAGE_ID_RD_HDR_CHECKSUM);
 400
 401         if (!image_check_os(rd_hdr, IH_OS_LINUX) ||
 402             !image_check_arch(rd_hdr, arch) ||
 403             !image_check_type(rd_hdr, IH_TYPE_RAMDISK)) {
 404                 printf("No Linux %s Ramdisk Image\n",
 405                                 genimg_get_arch_name(arch));
 406                 bootstage_error(BOOTSTAGE_ID_RAMDISK);
 407                 return NULL;
 408         }
 409
 410         return rd_hdr;
 411 }
 412 #endif /* !USE_HOSTCC */
 413
 414 /*****************************************************************************/
 415 /* Shared dual-format routines */
 416 /*****************************************************************************/
 417 #ifndef USE_HOSTCC
 418 int getenv_yesno(char *var)
 419 {
 420         char *s = getenv(var);
 421         return (s && (*s == 'n')) ? 0 : 1;
 422 }
 423
 424 ulong getenv_bootm_low(void)
 425 {
 426         char *s = getenv("bootm_low");
 427         if (s) {
 428                 ulong tmp = simple_strtoul(s, NULL, 16);
 429                 return tmp;
 430         }
 431
 432 #if defined(CONFIG_SYS_SDRAM_BASE)
 433         return CONFIG_SYS_SDRAM_BASE;
 434 #elif defined(CONFIG_ARM)
 435         return gd->bd->bi_dram[0].start;
 436 #else
 437         return 0;
 438 #endif
 439 }
 440
 441 phys_size_t getenv_bootm_size(void)
 442 {
 443         phys_size_t tmp;
 444         char *s = getenv("bootm_size");
 445         if (s) {
 446                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 447                 return tmp;
 448         }
 449         s = getenv("bootm_low");
 450         if (s)
 451                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 452         else
 453                 tmp = 0;
 454
 455
 456 #if defined(CONFIG_ARM)
 457         return gd->bd->bi_dram[0].size - tmp;
 458 #else
 459         return gd->bd->bi_memsize - tmp;
 460 #endif
 461 }
 462
 463 phys_size_t getenv_bootm_mapsize(void)
 464 {
 465         phys_size_t tmp;
 466         char *s = getenv("bootm_mapsize");
 467         if (s) {
 468                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 469                 return tmp;
 470         }
 471
 472 #if defined(CONFIG_SYS_BOOTMAPSZ)
 473         return CONFIG_SYS_BOOTMAPSZ;
 474 #else
 475         return getenv_bootm_size();
 476 #endif
 477 }
 478
 479 void memmove_wd(void *to, void *from, size_t len, ulong chunksz)
 480 {
 481         if (to == from)
 482                 return;
 483
 484 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 485         while (len > 0) {
 486                 size_t tail = (len > chunksz) ? chunksz : len;
 487                 WATCHDOG_RESET();
 488                 memmove(to, from, tail);
 489                 to += tail;
 490                 from += tail;
 491                 len -= tail;
 492         }
 493 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 494         memmove(to, from, len);
 495 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 496 }
 497 #endif /* !USE_HOSTCC */
 498
 499 void genimg_print_size(uint32_t size)
 500 {
 501 #ifndef USE_HOSTCC
 502         printf("%d Bytes = ", size);
 503         print_size(size, "\n");
 504 #else
 505         printf("%d Bytes = %.2f kB = %.2f MB\n",
 506                         size, (double)size / 1.024e3,
 507                         (double)size / 1.048576e6);
 508 #endif
 509 }
 510
 511 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC)
 512 static void genimg_print_time(time_t timestamp)
 513 {
 514 #ifndef USE_HOSTCC
 515         struct rtc_time tm;
 516
 517         to_tm(timestamp, &tm);
 518         printf("%4d-%02d-%02d  %2d:%02d:%02d UTC\n",
 519                         tm.tm_year, tm.tm_mon, tm.tm_mday,
 520                         tm.tm_hour, tm.tm_min, tm.tm_sec);
 521 #else
 522         printf("%s", ctime(&timestamp));
 523 #endif
 524 }
 525 #endif /* CONFIG_TIMESTAMP || CONFIG_CMD_DATE || USE_HOSTCC */
 526
 527 /**
 528  * get_table_entry_name - translate entry id to long name
 529  * @table: pointer to a translation table for entries of a specific type
 530  * @msg: message to be returned when translation fails
 531  * @id: entry id to be translated
 532  *
 533  * get_table_entry_name() will go over translation table trying to find
 534  * entry that matches given id. If matching entry is found, its long
 535  * name is returned to the caller.
 536  *
 537  * returns:
 538  *     long entry name if translation succeeds
 539  *     msg otherwise
 540  */
 541 char *get_table_entry_name(const table_entry_t *table, char *msg, int id)
 542 {
 543         for (; table->id >= 0; ++table) {
 544                 if (table->id == id)
 545 #if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC)
 546                         return table->lname;
 547 #else
 548                         return table->lname + gd->reloc_off;
 549 #endif
 550         }
 551         return (msg);
 552 }
 553
 554 const char *genimg_get_os_name(uint8_t os)
 555 {
 556         return (get_table_entry_name(uimage_os, "Unknown OS", os));
 557 }
 558
 559 const char *genimg_get_arch_name(uint8_t arch)
 560 {
 561         return (get_table_entry_name(uimage_arch, "Unknown Architecture",
 562                                         arch));
 563 }
 564
 565 const char *genimg_get_type_name(uint8_t type)
 566 {
 567         return (get_table_entry_name(uimage_type, "Unknown Image", type));
 568 }
 569
 570 const char *genimg_get_comp_name(uint8_t comp)
 571 {
 572         return (get_table_entry_name(uimage_comp, "Unknown Compression",
 573                                         comp));
 574 }
 575
 576 /**
 577  * get_table_entry_id - translate short entry name to id
 578  * @table: pointer to a translation table for entries of a specific type
 579  * @table_name: to be used in case of error
 580  * @name: entry short name to be translated
 581  *
 582  * get_table_entry_id() will go over translation table trying to find
 583  * entry that matches given short name. If matching entry is found,
 584  * its id returned to the caller.
 585  *
 586  * returns:
 587  *     entry id if translation succeeds
 588  *     -1 otherwise
 589  */
 590 int get_table_entry_id(const table_entry_t *table,
 591                 const char *table_name, const char *name)
 592 {
 593         const table_entry_t *t;
 594 #ifdef USE_HOSTCC
 595         int first = 1;
 596
 597         for (t = table; t->id >= 0; ++t) {
 598                 if (t->sname && strcasecmp(t->sname, name) == 0)
 599                         return(t->id);
 600         }
 601
 602         fprintf(stderr, "\nInvalid %s Type - valid names are", table_name);
 603         for (t = table; t->id >= 0; ++t) {
 604                 if (t->sname == NULL)
 605                         continue;
 606                 fprintf(stderr, "%c %s", (first) ? ':' : ',', t->sname);
 607                 first = 0;
 608         }
 609         fprintf(stderr, "\n");
 610 #else
 611         for (t = table; t->id >= 0; ++t) {
 612 #ifdef CONFIG_NEEDS_MANUAL_RELOC
 613                 if (t->sname && strcmp(t->sname + gd->reloc_off, name) == 0)
 614 #else
 615                 if (t->sname && strcmp(t->sname, name) == 0)
 616 #endif
 617                         return (t->id);
 618         }
 619         debug("Invalid %s Type: %s\n", table_name, name);
 620 #endif /* USE_HOSTCC */
 621         return (-1);
 622 }
 623
 624 int genimg_get_os_id(const char *name)
 625 {
 626         return (get_table_entry_id(uimage_os, "OS", name));
 627 }
 628
 629 int genimg_get_arch_id(const char *name)
 630 {
 631         return (get_table_entry_id(uimage_arch, "CPU", name));
 632 }
 633
 634 int genimg_get_type_id(const char *name)
 635 {
 636         return (get_table_entry_id(uimage_type, "Image", name));
 637 }
 638
 639 int genimg_get_comp_id(const char *name)
 640 {
 641         return (get_table_entry_id(uimage_comp, "Compression", name));
 642 }
 643
 644 #ifndef USE_HOSTCC
 645 /**
 646  * genimg_get_format - get image format type
 647  * @img_addr: image start address
 648  *
 649  * genimg_get_format() checks whether provided address points to a valid
 650  * legacy or FIT image.
 651  *
 652  * New uImage format and FDT blob are based on a libfdt. FDT blob
 653  * may be passed directly or embedded in a FIT image. In both situations
 654  * genimg_get_format() must be able to dectect libfdt header.
 655  *
 656  * returns:
 657  *     image format type or IMAGE_FORMAT_INVALID if no image is present
 658  */
 659 int genimg_get_format(void *img_addr)
 660 {
 661         ulong format = IMAGE_FORMAT_INVALID;
 662         const image_header_t *hdr;
 663 #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT)
 664         char *fit_hdr;
 665 #endif
 666
 667         hdr = (const image_header_t *)img_addr;
 668         if (image_check_magic(hdr))
 669                 format = IMAGE_FORMAT_LEGACY;
 670 #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT)
 671         else {
 672                 fit_hdr = (char *)img_addr;
 673                 if (fdt_check_header(fit_hdr) == 0)
 674                         format = IMAGE_FORMAT_FIT;
 675         }
 676 #endif
 677
 678         return format;
 679 }
 680
 681 /**
 682  * genimg_get_image - get image from special storage (if necessary)
 683  * @img_addr: image start address
 684  *
 685  * genimg_get_image() checks if provided image start adddress is located
 686  * in a dataflash storage. If so, image is moved to a system RAM memory.
 687  *
 688  * returns:
 689  *     image start address after possible relocation from special storage
 690  */
 691 ulong genimg_get_image(ulong img_addr)
 692 {
 693         ulong ram_addr = img_addr;
 694
 695 #ifdef CONFIG_HAS_DATAFLASH
 696         ulong h_size, d_size;
 697
 698         if (addr_dataflash(img_addr)) {
 699                 /* ger RAM address */
 700                 ram_addr = CONFIG_SYS_LOAD_ADDR;
 701
 702                 /* get header size */
 703                 h_size = image_get_header_size();
 704 #if defined(CONFIG_FIT)
 705                 if (sizeof(struct fdt_header) > h_size)
 706                         h_size = sizeof(struct fdt_header);
 707 #endif
 708
 709                 /* read in header */
 710                 debug("   Reading image header from dataflash address "
 711                         "%08lx to RAM address %08lx\n", img_addr, ram_addr);
 712
 713                 read_dataflash(img_addr, h_size, (char *)ram_addr);
 714
 715                 /* get data size */
 716                 switch (genimg_get_format((void *)ram_addr)) {
 717                 case IMAGE_FORMAT_LEGACY:
 718                         d_size = image_get_data_size(
 719                                         (const image_header_t *)ram_addr);
 720                         debug("   Legacy format image found at 0x%08lx, "
 721                                         "size 0x%08lx\n",
 722                                         ram_addr, d_size);
 723                         break;
 724 #if defined(CONFIG_FIT)
 725                 case IMAGE_FORMAT_FIT:
 726                         d_size = fit_get_size((const void *)ram_addr) - h_size;
 727                         debug("   FIT/FDT format image found at 0x%08lx, "
 728                                         "size 0x%08lx\n",
 729                                         ram_addr, d_size);
 730                         break;
 731 #endif
 732                 default:
 733                         printf("   No valid image found at 0x%08lx\n",
 734                                 img_addr);
 735                         return ram_addr;
 736                 }
 737
 738                 /* read in image data */
 739                 debug("   Reading image remaining data from dataflash address "
 740                         "%08lx to RAM address %08lx\n", img_addr + h_size,
 741                         ram_addr + h_size);
 742
 743                 read_dataflash(img_addr + h_size, d_size,
 744                                 (char *)(ram_addr + h_size));
 745
 746         }
 747 #endif /* CONFIG_HAS_DATAFLASH */
 748
 749         return ram_addr;
 750 }
 751
 752 /**
 753  * fit_has_config - check if there is a valid FIT configuration
 754  * @images: pointer to the bootm command headers structure
 755  *
 756  * fit_has_config() checks if there is a FIT configuration in use
 757  * (if FTI support is present).
 758  *
 759  * returns:
 760  *     0, no FIT support or no configuration found
 761  *     1, configuration found
 762  */
 763 int genimg_has_config(bootm_headers_t *images)
 764 {
 765 #if defined(CONFIG_FIT)
 766         if (images->fit_uname_cfg)
 767                 return 1;
 768 #endif
 769         return 0;
 770 }
 771
 772 /**
 773  * boot_get_ramdisk - main ramdisk handling routine
 774  * @argc: command argument count
 775  * @argv: command argument list
 776  * @images: pointer to the bootm images structure
 777  * @arch: expected ramdisk architecture
 778  * @rd_start: pointer to a ulong variable, will hold ramdisk start address
 779  * @rd_end: pointer to a ulong variable, will hold ramdisk end
 780  *
 781  * boot_get_ramdisk() is responsible for finding a valid ramdisk image.
 782  * Curently supported are the following ramdisk sources:
 783  *      - multicomponent kernel/ramdisk image,
 784  *      - commandline provided address of decicated ramdisk image.
 785  *
 786  * returns:
 787  *     0, if ramdisk image was found and valid, or skiped
 788  *     rd_start and rd_end are set to ramdisk start/end addresses if
 789  *     ramdisk image is found and valid
 790  *
 791  *     1, if ramdisk image is found but corrupted, or invalid
 792  *     rd_start and rd_end are set to 0 if no ramdisk exists
 793  */
 794 int boot_get_ramdisk(int argc, char * const argv[], bootm_headers_t *images,
 795                 uint8_t arch, ulong *rd_start, ulong *rd_end)
 796 {
 797         ulong rd_addr, rd_load;
 798         ulong rd_data, rd_len;
 799         const image_header_t *rd_hdr;
 800         char *end;
 801 #if defined(CONFIG_FIT)
 802         void            *fit_hdr;
 803         const char      *fit_uname_config = NULL;
 804         const char      *fit_uname_ramdisk = NULL;
 805         ulong           default_addr;
 806         int             rd_noffset;
 807         int             cfg_noffset;
 808         const void      *data;
 809         size_t          size;
 810 #endif
 811
 812         *rd_start = 0;
 813         *rd_end = 0;
 814
 815         /*
 816          * Look for a '-' which indicates to ignore the
 817          * ramdisk argument
 818          */
 819         if ((argc >= 3) && (strcmp(argv[2], "-") ==  0)) {
 820                 debug("## Skipping init Ramdisk\n");
 821                 rd_len = rd_data = 0;
 822         } else if (argc >= 3 || genimg_has_config(images)) {
 823 #if defined(CONFIG_FIT)
 824                 if (argc >= 3) {
 825                         /*
 826                          * If the init ramdisk comes from the FIT image and
 827                          * the FIT image address is omitted in the command
 828                          * line argument, try to use os FIT image address or
 829                          * default load address.
 830                          */
 831                         if (images->fit_uname_os)
 832                                 default_addr = (ulong)images->fit_hdr_os;
 833                         else
 834                                 default_addr = load_addr;
 835
 836                         if (fit_parse_conf(argv[2], default_addr,
 837                                                 &rd_addr, &fit_uname_config)) {
 838                                 debug("*  ramdisk: config '%s' from image at "
 839                                                 "0x%08lx\n",
 840                                                 fit_uname_config, rd_addr);
 841                         } else if (fit_parse_subimage(argv[2], default_addr,
 842                                                 &rd_addr, &fit_uname_ramdisk)) {
 843                                 debug("*  ramdisk: subimage '%s' from image at "
 844                                                 "0x%08lx\n",
 845                                                 fit_uname_ramdisk, rd_addr);
 846                         } else
 847 #endif
 848                         {
 849                                 rd_addr = simple_strtoul(argv[2], NULL, 16);
 850                                 debug("*  ramdisk: cmdline image address = "
 851                                                 "0x%08lx\n",
 852                                                 rd_addr);
 853                         }
 854 #if defined(CONFIG_FIT)
 855                 } else {
 856                         /* use FIT configuration provided in first bootm
 857                          * command argument
 858                          */
 859                         rd_addr = (ulong)images->fit_hdr_os;
 860                         fit_uname_config = images->fit_uname_cfg;
 861                         debug("*  ramdisk: using config '%s' from image "
 862                                         "at 0x%08lx\n",
 863                                         fit_uname_config, rd_addr);
 864
 865                         /*
 866                          * Check whether configuration has ramdisk defined,
 867                          * if not, don't try to use it, quit silently.
 868                          */
 869                         fit_hdr = (void *)rd_addr;
 870                         cfg_noffset = fit_conf_get_node(fit_hdr,
 871                                                         fit_uname_config);
 872                         if (cfg_noffset < 0) {
 873                                 debug("*  ramdisk: no such config\n");
 874                                 return 1;
 875                         }
 876
 877                         rd_noffset = fit_conf_get_ramdisk_node(fit_hdr,
 878                                                                 cfg_noffset);
 879                         if (rd_noffset < 0) {
 880                                 debug("*  ramdisk: no ramdisk in config\n");
 881                                 return 0;
 882                         }
 883                 }
 884 #endif
 885
 886                 /* copy from dataflash if needed */
 887                 rd_addr = genimg_get_image(rd_addr);
 888
 889                 /*
 890                  * Check if there is an initrd image at the
 891                  * address provided in the second bootm argument
 892                  * check image type, for FIT images get FIT node.
 893                  */
 894                 switch (genimg_get_format((void *)rd_addr)) {
 895                 case IMAGE_FORMAT_LEGACY:
 896                         printf("## Loading init Ramdisk from Legacy "
 897                                         "Image at %08lx ...\n", rd_addr);
 898
 899                         bootstage_mark(BOOTSTAGE_ID_CHECK_RAMDISK);
 900                         rd_hdr = image_get_ramdisk(rd_addr, arch,
 901                                                         images->verify);
 902
 903                         if (rd_hdr == NULL)
 904                                 return 1;
 905
 906                         rd_data = image_get_data(rd_hdr);
 907                         rd_len = image_get_data_size(rd_hdr);
 908                         rd_load = image_get_load(rd_hdr);
 909                         break;
 910 #if defined(CONFIG_FIT)
 911                 case IMAGE_FORMAT_FIT:
 912                         fit_hdr = (void *)rd_addr;
 913                         printf("## Loading init Ramdisk from FIT "
 914                                         "Image at %08lx ...\n", rd_addr);
 915
 916                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_FORMAT);
 917                         if (!fit_check_format(fit_hdr)) {
 918                                 puts("Bad FIT ramdisk image format!\n");
 919                                 bootstage_error(
 920                                         BOOTSTAGE_ID_FIT_RD_FORMAT);
 921                                 return 1;
 922                         }
 923                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_FORMAT_OK);
 924
 925                         if (!fit_uname_ramdisk) {
 926                                 /*
 927                                  * no ramdisk image node unit name, try to get config
 928                                  * node first. If config unit node name is NULL
 929                                  * fit_conf_get_node() will try to find default config node
 930                                  */
 931                                 bootstage_mark(
 932                                         BOOTSTAGE_ID_FIT_RD_NO_UNIT_NAME);
 933                                 cfg_noffset = fit_conf_get_node(fit_hdr,
 934                                                         fit_uname_config);
 935                                 if (cfg_noffset < 0) {
 936                                         puts("Could not find configuration "
 937                                                 "node\n");
 938                                         bootstage_error(
 939                                         BOOTSTAGE_ID_FIT_RD_NO_UNIT_NAME);
 940                                         return 1;
 941                                 }
 942                                 fit_uname_config = fdt_get_name(fit_hdr,
 943                                                         cfg_noffset, NULL);
 944                                 printf("   Using '%s' configuration\n",
 945                                         fit_uname_config);
 946
 947                                 rd_noffset = fit_conf_get_ramdisk_node(fit_hdr,
 948                                                         cfg_noffset);
 949                                 fit_uname_ramdisk = fit_get_name(fit_hdr,
 950                                                         rd_noffset, NULL);
 951                         } else {
 952                                 /* get ramdisk component image node offset */
 953                                 bootstage_mark(
 954                                         BOOTSTAGE_ID_FIT_RD_UNIT_NAME);
 955                                 rd_noffset = fit_image_get_node(fit_hdr,
 956                                                 fit_uname_ramdisk);
 957                         }
 958                         if (rd_noffset < 0) {
 959                                 puts("Could not find subimage node\n");
 960                                 bootstage_error(BOOTSTAGE_ID_FIT_RD_SUBNODE);
 961                                 return 1;
 962                         }
 963
 964                         printf("   Trying '%s' ramdisk subimage\n",
 965                                 fit_uname_ramdisk);
 966
 967                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK);
 968                         if (!fit_check_ramdisk(fit_hdr, rd_noffset, arch,
 969                                                 images->verify))
 970                                 return 1;
 971
 972                         /* get ramdisk image data address and length */
 973                         if (fit_image_get_data(fit_hdr, rd_noffset, &data,
 974                                                 &size)) {
 975                                 puts("Could not find ramdisk subimage data!\n");
 976                                 bootstage_error(BOOTSTAGE_ID_FIT_RD_GET_DATA);
 977                                 return 1;
 978                         }
 979                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_GET_DATA_OK);
 980
 981                         rd_data = (ulong)data;
 982                         rd_len = size;
 983
 984                         if (fit_image_get_load(fit_hdr, rd_noffset, &rd_load)) {
 985                                 puts("Can't get ramdisk subimage load "
 986                                         "address!\n");
 987                                 bootstage_error(BOOTSTAGE_ID_FIT_RD_LOAD);
 988                                 return 1;
 989                         }
 990                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_LOAD);
 991
 992                         images->fit_hdr_rd = fit_hdr;
 993                         images->fit_uname_rd = fit_uname_ramdisk;
 994                         images->fit_noffset_rd = rd_noffset;
 995                         break;
 996 #endif
 997                 default:
 998 #ifdef CONFIG_SUPPORT_RAW_INITRD
 999                         if (argc >= 3 && (end = strchr(argv[2], ':'))) {
1000                                 rd_len = simple_strtoul(++end, NULL, 16);
1001                                 rd_data = rd_addr;
1002                         } else
1003 #endif
1004                         {
1005                                 puts("Wrong Ramdisk Image Format\n");
1006                                 rd_data = rd_len = rd_load = 0;
1007                                 return 1;
1008                         }
1009                 }
1010         } else if (images->legacy_hdr_valid &&
1011                         image_check_type(&images->legacy_hdr_os_copy,
1012                                                 IH_TYPE_MULTI)) {
1013
1014                 /*
1015                  * Now check if we have a legacy mult-component image,
1016                  * get second entry data start address and len.
1017                  */
1018                 bootstage_mark(BOOTSTAGE_ID_RAMDISK);
1019                 printf("## Loading init Ramdisk from multi component "
1020                                 "Legacy Image at %08lx ...\n",
1021                                 (ulong)images->legacy_hdr_os);
1022
1023                 image_multi_getimg(images->legacy_hdr_os, 1, &rd_data, &rd_len);
1024         } else {
1025                 /*
1026                  * no initrd image
1027                  */
1028                 bootstage_mark(BOOTSTAGE_ID_NO_RAMDISK);
1029                 rd_len = rd_data = 0;
1030         }
1031
1032         if (!rd_data) {
1033                 debug("## No init Ramdisk\n");
1034         } else {
1035                 *rd_start = rd_data;
1036                 *rd_end = rd_data + rd_len;
1037         }
1038         debug("   ramdisk start = 0x%08lx, ramdisk end = 0x%08lx\n",
1039                         *rd_start, *rd_end);
1040
1041         return 0;
1042 }
1043
1044 #ifdef CONFIG_SYS_BOOT_RAMDISK_HIGH
1045 /**
1046  * boot_ramdisk_high - relocate init ramdisk
1047  * @lmb: pointer to lmb handle, will be used for memory mgmt
1048  * @rd_data: ramdisk data start address
1049  * @rd_len: ramdisk data length
1050  * @initrd_start: pointer to a ulong variable, will hold final init ramdisk
1051  *      start address (after possible relocation)
1052  * @initrd_end: pointer to a ulong variable, will hold final init ramdisk
1053  *      end address (after possible relocation)
1054  *
1055  * boot_ramdisk_high() takes a relocation hint from "initrd_high" environement
1056  * variable and if requested ramdisk data is moved to a specified location.
1057  *
1058  * Initrd_start and initrd_end are set to final (after relocation) ramdisk
1059  * start/end addresses if ramdisk image start and len were provided,
1060  * otherwise set initrd_start and initrd_end set to zeros.
1061  *
1062  * returns:
1063  *      0 - success
1064  *     -1 - failure
1065  */
1066 int boot_ramdisk_high(struct lmb *lmb, ulong rd_data, ulong rd_len,
1067                   ulong *initrd_start, ulong *initrd_end)
1068 {
1069         char    *s;
1070         ulong   initrd_high;
1071         int     initrd_copy_to_ram = 1;
1072
1073         if ((s = getenv("initrd_high")) != NULL) {
1074                 /* a value of "no" or a similar string will act like 0,
1075                  * turning the "load high" feature off. This is intentional.
1076                  */
1077                 initrd_high = simple_strtoul(s, NULL, 16);
1078                 if (initrd_high == ~0)
1079                         initrd_copy_to_ram = 0;
1080         } else {
1081                 /* not set, no restrictions to load high */
1082                 initrd_high = ~0;
1083         }
1084
1085
1086 #ifdef CONFIG_LOGBUFFER
1087         /* Prevent initrd from overwriting logbuffer */
1088         lmb_reserve(lmb, logbuffer_base() - LOGBUFF_OVERHEAD, LOGBUFF_RESERVE);
1089 #endif
1090
1091         debug("## initrd_high = 0x%08lx, copy_to_ram = %d\n",
1092                         initrd_high, initrd_copy_to_ram);
1093
1094         if (rd_data) {
1095                 if (!initrd_copy_to_ram) {      /* zero-copy ramdisk support */
1096                         debug("   in-place initrd\n");
1097                         *initrd_start = rd_data;
1098                         *initrd_end = rd_data + rd_len;
1099                         lmb_reserve(lmb, rd_data, rd_len);
1100                 } else {
1101                         if (initrd_high)
1102                                 *initrd_start = (ulong)lmb_alloc_base(lmb,
1103                                                 rd_len, 0x1000, initrd_high);
1104                         else
1105                                 *initrd_start = (ulong)lmb_alloc(lmb, rd_len,
1106                                                                  0x1000);
1107
1108                         if (*initrd_start == 0) {
1109                                 puts("ramdisk - allocation error\n");
1110                                 goto error;
1111                         }
1112                         bootstage_mark(BOOTSTAGE_ID_COPY_RAMDISK);
1113
1114                         *initrd_end = *initrd_start + rd_len;
1115                         printf("   Loading Ramdisk to %08lx, end %08lx ... ",
1116                                         *initrd_start, *initrd_end);
1117
1118                         memmove_wd((void *)*initrd_start,
1119                                         (void *)rd_data, rd_len, CHUNKSZ);
1120
1121 #ifdef CONFIG_MP
1122                         /*
1123                          * Ensure the image is flushed to memory to handle
1124                          * AMP boot scenarios in which we might not be
1125                          * HW cache coherent
1126                          */
1127                         flush_cache((unsigned long)*initrd_start, rd_len);
1128 #endif
1129                         puts("OK\n");
1130                 }
1131         } else {
1132                 *initrd_start = 0;
1133                 *initrd_end = 0;
1134         }
1135         debug("   ramdisk load start = 0x%08lx, ramdisk load end = 0x%08lx\n",
1136                         *initrd_start, *initrd_end);
1137
1138         return 0;
1139
1140 error:
1141         return -1;
1142 }
1143 #endif /* CONFIG_SYS_BOOT_RAMDISK_HIGH */
1144
1145 #ifdef CONFIG_OF_LIBFDT
1146 static void fdt_error(const char *msg)
1147 {
1148         puts("ERROR: ");
1149         puts(msg);
1150         puts(" - must RESET the board to recover.\n");
1151 }
1152
1153 static const image_header_t *image_get_fdt(ulong fdt_addr)
1154 {
1155         const image_header_t *fdt_hdr = (const image_header_t *)fdt_addr;
1156
1157         image_print_contents(fdt_hdr);
1158
1159         puts("   Verifying Checksum ... ");
1160         if (!image_check_hcrc(fdt_hdr)) {
1161                 fdt_error("fdt header checksum invalid");
1162                 return NULL;
1163         }
1164
1165         if (!image_check_dcrc(fdt_hdr)) {
1166                 fdt_error("fdt checksum invalid");
1167                 return NULL;
1168         }
1169         puts("OK\n");
1170
1171         if (!image_check_type(fdt_hdr, IH_TYPE_FLATDT)) {
1172                 fdt_error("uImage is not a fdt");
1173                 return NULL;
1174         }
1175         if (image_get_comp(fdt_hdr) != IH_COMP_NONE) {
1176                 fdt_error("uImage is compressed");
1177                 return NULL;
1178         }
1179         if (fdt_check_header((char *)image_get_data(fdt_hdr)) != 0) {
1180                 fdt_error("uImage data is not a fdt");
1181                 return NULL;
1182         }
1183         return fdt_hdr;
1184 }
1185
1186 /**
1187  * fit_check_fdt - verify FIT format FDT subimage
1188  * @fit_hdr: pointer to the FIT  header
1189  * fdt_noffset: FDT subimage node offset within FIT image
1190  * @verify: data CRC verification flag
1191  *
1192  * fit_check_fdt() verifies integrity of the FDT subimage and from
1193  * specified FIT image.
1194  *
1195  * returns:
1196  *     1, on success
1197  *     0, on failure
1198  */
1199 #if defined(CONFIG_FIT)
1200 static int fit_check_fdt(const void *fit, int fdt_noffset, int verify)
1201 {
1202         fit_image_print(fit, fdt_noffset, "   ");
1203
1204         if (verify) {
1205                 puts("   Verifying Hash Integrity ... ");
1206                 if (!fit_image_check_hashes(fit, fdt_noffset)) {
1207                         fdt_error("Bad Data Hash");
1208                         return 0;
1209                 }
1210                 puts("OK\n");
1211         }
1212
1213         if (!fit_image_check_type(fit, fdt_noffset, IH_TYPE_FLATDT)) {
1214                 fdt_error("Not a FDT image");
1215                 return 0;
1216         }
1217
1218         if (!fit_image_check_comp(fit, fdt_noffset, IH_COMP_NONE)) {
1219                 fdt_error("FDT image is compressed");
1220                 return 0;
1221         }
1222
1223         return 1;
1224 }
1225 #endif /* CONFIG_FIT */
1226
1227 #ifndef CONFIG_SYS_FDT_PAD
1228 #define CONFIG_SYS_FDT_PAD 0x3000
1229 #endif
1230
1231 #if defined(CONFIG_OF_LIBFDT)
1232 /**
1233  * boot_fdt_add_mem_rsv_regions - Mark the memreserve sections as unusable
1234  * @lmb: pointer to lmb handle, will be used for memory mgmt
1235  * @fdt_blob: pointer to fdt blob base address
1236  *
1237  * Adds the memreserve regions in the dtb to the lmb block.  Adding the
1238  * memreserve regions prevents u-boot from using them to store the initrd
1239  * or the fdt blob.
1240  */
1241 void boot_fdt_add_mem_rsv_regions(struct lmb *lmb, void *fdt_blob)
1242 {
1243         uint64_t addr, size;
1244         int i, total;
1245
1246         if (fdt_check_header(fdt_blob) != 0)
1247                 return;
1248
1249         total = fdt_num_mem_rsv(fdt_blob);
1250         for (i = 0; i < total; i++) {
1251                 if (fdt_get_mem_rsv(fdt_blob, i, &addr, &size) != 0)
1252                         continue;
1253                 printf("   reserving fdt memory region: addr=%llx size=%llx\n",
1254                         (unsigned long long)addr, (unsigned long long)size);
1255                 lmb_reserve(lmb, addr, size);
1256         }
1257 }
1258
1259 /**
1260  * boot_relocate_fdt - relocate flat device tree
1261  * @lmb: pointer to lmb handle, will be used for memory mgmt
1262  * @of_flat_tree: pointer to a char* variable, will hold fdt start address
1263  * @of_size: pointer to a ulong variable, will hold fdt length
1264  *
1265  * boot_relocate_fdt() allocates a region of memory within the bootmap and
1266  * relocates the of_flat_tree into that region, even if the fdt is already in
1267  * the bootmap.  It also expands the size of the fdt by CONFIG_SYS_FDT_PAD
1268  * bytes.
1269  *
1270  * of_flat_tree and of_size are set to final (after relocation) values
1271  *
1272  * returns:
1273  *      0 - success
1274  *      1 - failure
1275  */
1276 int boot_relocate_fdt(struct lmb *lmb, char **of_flat_tree, ulong *of_size)
1277 {
1278         void    *fdt_blob = *of_flat_tree;
1279         void    *of_start = 0;
1280         char    *fdt_high;
1281         ulong   of_len = 0;
1282         int     err;
1283         int     disable_relocation = 0;
1284
1285         /* nothing to do */
1286         if (*of_size == 0)
1287                 return 0;
1288
1289         if (fdt_check_header(fdt_blob) != 0) {
1290                 fdt_error("image is not a fdt");
1291                 goto error;
1292         }
1293
1294         /* position on a 4K boundary before the alloc_current */
1295         /* Pad the FDT by a specified amount */
1296         of_len = *of_size + CONFIG_SYS_FDT_PAD;
1297
1298         /* If fdt_high is set use it to select the relocation address */
1299         fdt_high = getenv("fdt_high");
1300         if (fdt_high) {
1301                 void *desired_addr = (void *)simple_strtoul(fdt_high, NULL, 16);
1302
1303                 if (((ulong) desired_addr) == ~0UL) {
1304                         /* All ones means use fdt in place */
1305                         of_start = fdt_blob;
1306                         lmb_reserve(lmb, (ulong)of_start, of_len);
1307                         disable_relocation = 1;
1308                 } else if (desired_addr) {
1309                         of_start =
1310                             (void *)(ulong) lmb_alloc_base(lmb, of_len, 0x1000,
1311                                                            (ulong)desired_addr);
1312                         if (of_start == 0) {
1313                                 puts("Failed using fdt_high value for Device Tree");
1314                                 goto error;
1315                         }
1316                 } else {
1317                         of_start =
1318                             (void *)(ulong) lmb_alloc(lmb, of_len, 0x1000);
1319                 }
1320         } else {
1321                 of_start =
1322                     (void *)(ulong) lmb_alloc_base(lmb, of_len, 0x1000,
1323                                                    getenv_bootm_mapsize()
1324                                                    + getenv_bootm_low());
1325         }
1326
1327         if (of_start == 0) {
1328                 puts("device tree - allocation error\n");
1329                 goto error;
1330         }
1331
1332         if (disable_relocation) {
1333                 /* We assume there is space after the existing fdt to use for padding */
1334                 fdt_set_totalsize(of_start, of_len);
1335                 printf("   Using Device Tree in place at %p, end %p\n",
1336                        of_start, of_start + of_len - 1);
1337         } else {
1338                 debug("## device tree at %p ... %p (len=%ld [0x%lX])\n",
1339                         fdt_blob, fdt_blob + *of_size - 1, of_len, of_len);
1340
1341                 printf("   Loading Device Tree to %p, end %p ... ",
1342                         of_start, of_start + of_len - 1);
1343
1344                 err = fdt_open_into(fdt_blob, of_start, of_len);
1345                 if (err != 0) {
1346                         fdt_error("fdt move failed");
1347                         goto error;
1348                 }
1349                 puts("OK\n");
1350         }
1351
1352         *of_flat_tree = of_start;
1353         *of_size = of_len;
1354
1355         set_working_fdt_addr(*of_flat_tree);
1356         return 0;
1357
1358 error:
1359         return 1;
1360 }
1361 #endif /* CONFIG_OF_LIBFDT */
1362
1363 /**
1364  * boot_get_fdt - main fdt handling routine
1365  * @argc: command argument count
1366  * @argv: command argument list
1367  * @images: pointer to the bootm images structure
1368  * @of_flat_tree: pointer to a char* variable, will hold fdt start address
1369  * @of_size: pointer to a ulong variable, will hold fdt length
1370  *
1371  * boot_get_fdt() is responsible for finding a valid flat device tree image.
1372  * Curently supported are the following ramdisk sources:
1373  *      - multicomponent kernel/ramdisk image,
1374  *      - commandline provided address of decicated ramdisk image.
1375  *
1376  * returns:
1377  *     0, if fdt image was found and valid, or skipped
1378  *     of_flat_tree and of_size are set to fdt start address and length if
1379  *     fdt image is found and valid
1380  *
1381  *     1, if fdt image is found but corrupted
1382  *     of_flat_tree and of_size are set to 0 if no fdt exists
1383  */
1384 int boot_get_fdt(int flag, int argc, char * const argv[],
1385                 bootm_headers_t *images, char **of_flat_tree, ulong *of_size)
1386 {
1387         const image_header_t *fdt_hdr;
1388         ulong           fdt_addr;
1389         char            *fdt_blob = NULL;
1390         ulong           image_start, image_data, image_end;
1391         ulong           load_start, load_end;
1392 #if defined(CONFIG_FIT)
1393         void            *fit_hdr;
1394         const char      *fit_uname_config = NULL;
1395         const char      *fit_uname_fdt = NULL;
1396         ulong           default_addr;
1397         int             cfg_noffset;
1398         int             fdt_noffset;
1399         const void      *data;
1400         size_t          size;
1401 #endif
1402
1403         *of_flat_tree = NULL;
1404         *of_size = 0;
1405
1406         if (argc > 3 || genimg_has_config(images)) {
1407 #if defined(CONFIG_FIT)
1408                 if (argc > 3) {
1409                         /*
1410                          * If the FDT blob comes from the FIT image and the
1411                          * FIT image address is omitted in the command line
1412                          * argument, try to use ramdisk or os FIT image
1413                          * address or default load address.
1414                          */
1415                         if (images->fit_uname_rd)
1416                                 default_addr = (ulong)images->fit_hdr_rd;
1417                         else if (images->fit_uname_os)
1418                                 default_addr = (ulong)images->fit_hdr_os;
1419                         else
1420                                 default_addr = load_addr;
1421
1422                         if (fit_parse_conf(argv[3], default_addr,
1423                                                 &fdt_addr, &fit_uname_config)) {
1424                                 debug("*  fdt: config '%s' from image at "
1425                                                 "0x%08lx\n",
1426                                                 fit_uname_config, fdt_addr);
1427                         } else if (fit_parse_subimage(argv[3], default_addr,
1428                                                 &fdt_addr, &fit_uname_fdt)) {
1429                                 debug("*  fdt: subimage '%s' from image at "
1430                                                 "0x%08lx\n",
1431                                                 fit_uname_fdt, fdt_addr);
1432                         } else
1433 #endif
1434                         {
1435                                 fdt_addr = simple_strtoul(argv[3], NULL, 16);
1436                                 debug("*  fdt: cmdline image address = "
1437                                                 "0x%08lx\n",
1438                                                 fdt_addr);
1439                         }
1440 #if defined(CONFIG_FIT)
1441                 } else {
1442                         /* use FIT configuration provided in first bootm
1443                          * command argument
1444                          */
1445                         fdt_addr = (ulong)images->fit_hdr_os;
1446                         fit_uname_config = images->fit_uname_cfg;
1447                         debug("*  fdt: using config '%s' from image "
1448                                         "at 0x%08lx\n",
1449                                         fit_uname_config, fdt_addr);
1450
1451                         /*
1452                          * Check whether configuration has FDT blob defined,
1453                          * if not quit silently.
1454                          */
1455                         fit_hdr = (void *)fdt_addr;
1456                         cfg_noffset = fit_conf_get_node(fit_hdr,
1457                                         fit_uname_config);
1458                         if (cfg_noffset < 0) {
1459                                 debug("*  fdt: no such config\n");
1460                                 return 0;
1461                         }
1462
1463                         fdt_noffset = fit_conf_get_fdt_node(fit_hdr,
1464                                         cfg_noffset);
1465                         if (fdt_noffset < 0) {
1466                                 debug("*  fdt: no fdt in config\n");
1467                                 return 0;
1468                         }
1469                 }
1470 #endif
1471
1472                 debug("## Checking for 'FDT'/'FDT Image' at %08lx\n",
1473                                 fdt_addr);
1474
1475                 /* copy from dataflash if needed */
1476                 fdt_addr = genimg_get_image(fdt_addr);
1477
1478                 /*
1479                  * Check if there is an FDT image at the
1480                  * address provided in the second bootm argument
1481                  * check image type, for FIT images get a FIT node.
1482                  */
1483                 switch (genimg_get_format((void *)fdt_addr)) {
1484                 case IMAGE_FORMAT_LEGACY:
1485                         /* verify fdt_addr points to a valid image header */
1486                         printf("## Flattened Device Tree from Legacy Image "
1487                                         "at %08lx\n",
1488                                         fdt_addr);
1489                         fdt_hdr = image_get_fdt(fdt_addr);
1490                         if (!fdt_hdr)
1491                                 goto error;
1492
1493                         /*
1494                          * move image data to the load address,
1495                          * make sure we don't overwrite initial image
1496                          */
1497                         image_start = (ulong)fdt_hdr;
1498                         image_data = (ulong)image_get_data(fdt_hdr);
1499                         image_end = image_get_image_end(fdt_hdr);
1500
1501                         load_start = image_get_load(fdt_hdr);
1502                         load_end = load_start + image_get_data_size(fdt_hdr);
1503
1504                         if (load_start == image_start ||
1505                             load_start == image_data) {
1506                                 fdt_blob = (char *)image_data;
1507                                 break;
1508                         }
1509
1510                         if ((load_start < image_end) && (load_end > image_start)) {
1511                                 fdt_error("fdt overwritten");
1512                                 goto error;
1513                         }
1514
1515                         debug("   Loading FDT from 0x%08lx to 0x%08lx\n",
1516                                         image_data, load_start);
1517
1518                         memmove((void *)load_start,
1519                                         (void *)image_data,
1520                                         image_get_data_size(fdt_hdr));
1521
1522                         fdt_blob = (char *)load_start;
1523                         break;
1524                 case IMAGE_FORMAT_FIT:
1525                         /*
1526                          * This case will catch both: new uImage format
1527                          * (libfdt based) and raw FDT blob (also libfdt
1528                          * based).
1529                          */
1530 #if defined(CONFIG_FIT)
1531                         /* check FDT blob vs FIT blob */
1532                         if (fit_check_format((const void *)fdt_addr)) {
1533                                 /*
1534                                  * FIT image
1535                                  */
1536                                 fit_hdr = (void *)fdt_addr;
1537                                 printf("## Flattened Device Tree from FIT "
1538                                                 "Image at %08lx\n",
1539                                                 fdt_addr);
1540
1541                                 if (!fit_uname_fdt) {
1542                                         /*
1543                                          * no FDT blob image node unit name,
1544                                          * try to get config node first. If
1545                                          * config unit node name is NULL
1546                                          * fit_conf_get_node() will try to
1547                                          * find default config node
1548                                          */
1549                                         cfg_noffset = fit_conf_get_node(fit_hdr,
1550                                                         fit_uname_config);
1551
1552                                         if (cfg_noffset < 0) {
1553                                                 fdt_error("Could not find "
1554                                                             "configuration "
1555                                                             "node\n");
1556                                                 goto error;
1557                                         }
1558
1559                                         fit_uname_config = fdt_get_name(fit_hdr,
1560                                                         cfg_noffset, NULL);
1561                                         printf("   Using '%s' configuration\n",
1562                                                         fit_uname_config);
1563
1564                                         fdt_noffset = fit_conf_get_fdt_node(
1565                                                         fit_hdr,
1566                                                         cfg_noffset);
1567                                         fit_uname_fdt = fit_get_name(fit_hdr,
1568                                                         fdt_noffset, NULL);
1569                                 } else {
1570                                         /* get FDT component image node offset */
1571                                         fdt_noffset = fit_image_get_node(
1572                                                                 fit_hdr,
1573                                                                 fit_uname_fdt);
1574                                 }
1575                                 if (fdt_noffset < 0) {
1576                                         fdt_error("Could not find subimage "
1577                                                         "node\n");
1578                                         goto error;
1579                                 }
1580
1581                                 printf("   Trying '%s' FDT blob subimage\n",
1582                                                 fit_uname_fdt);
1583
1584                                 if (!fit_check_fdt(fit_hdr, fdt_noffset,
1585                                                         images->verify))
1586                                         goto error;
1587
1588                                 /* get ramdisk image data address and length */
1589                                 if (fit_image_get_data(fit_hdr, fdt_noffset,
1590                                                         &data, &size)) {
1591                                         fdt_error("Could not find FDT "
1592                                                         "subimage data");
1593                                         goto error;
1594                                 }
1595
1596                                 /* verift that image data is a proper FDT blob */
1597                                 if (fdt_check_header((char *)data) != 0) {
1598                                         fdt_error("Subimage data is not a FTD");
1599                                         goto error;
1600                                 }
1601
1602                                 /*
1603                                  * move image data to the load address,
1604                                  * make sure we don't overwrite initial image
1605                                  */
1606                                 image_start = (ulong)fit_hdr;
1607                                 image_end = fit_get_end(fit_hdr);
1608
1609                                 if (fit_image_get_load(fit_hdr, fdt_noffset,
1610                                                         &load_start) == 0) {
1611                                         load_end = load_start + size;
1612
1613                                         if ((load_start < image_end) &&
1614                                                         (load_end > image_start)) {
1615                                                 fdt_error("FDT overwritten");
1616                                                 goto error;
1617                                         }
1618
1619                                         printf("   Loading FDT from 0x%08lx "
1620                                                         "to 0x%08lx\n",
1621                                                         (ulong)data,
1622                                                         load_start);
1623
1624                                         memmove((void *)load_start,
1625                                                         (void *)data, size);
1626
1627                                         fdt_blob = (char *)load_start;
1628                                 } else {
1629                                         fdt_blob = (char *)data;
1630                                 }
1631
1632                                 images->fit_hdr_fdt = fit_hdr;
1633                                 images->fit_uname_fdt = fit_uname_fdt;
1634                                 images->fit_noffset_fdt = fdt_noffset;
1635                                 break;
1636                         } else
1637 #endif
1638                         {
1639                                 /*
1640                                  * FDT blob
1641                                  */
1642                                 fdt_blob = (char *)fdt_addr;
1643                                 debug("*  fdt: raw FDT blob\n");
1644                                 printf("## Flattened Device Tree blob at "
1645                                         "%08lx\n", (long)fdt_blob);
1646                         }
1647                         break;
1648                 default:
1649                         puts("ERROR: Did not find a cmdline Flattened Device "
1650                                 "Tree\n");
1651                         goto error;
1652                 }
1653
1654                 printf("   Booting using the fdt blob at 0x%p\n", fdt_blob);
1655
1656         } else if (images->legacy_hdr_valid &&
1657                         image_check_type(&images->legacy_hdr_os_copy,
1658                                                 IH_TYPE_MULTI)) {
1659
1660                 ulong fdt_data, fdt_len;
1661
1662                 /*
1663                  * Now check if we have a legacy multi-component image,
1664                  * get second entry data start address and len.
1665                  */
1666                 printf("## Flattened Device Tree from multi "
1667                         "component Image at %08lX\n",
1668                         (ulong)images->legacy_hdr_os);
1669
1670                 image_multi_getimg(images->legacy_hdr_os, 2, &fdt_data,
1671                                         &fdt_len);
1672                 if (fdt_len) {
1673
1674                         fdt_blob = (char *)fdt_data;
1675                         printf("   Booting using the fdt at 0x%p\n", fdt_blob);
1676
1677                         if (fdt_check_header(fdt_blob) != 0) {
1678                                 fdt_error("image is not a fdt");
1679                                 goto error;
1680                         }
1681
1682                         if (fdt_totalsize(fdt_blob) != fdt_len) {
1683                                 fdt_error("fdt size != image size");
1684                                 goto error;
1685                         }
1686                 } else {
1687                         debug("## No Flattened Device Tree\n");
1688                         return 0;
1689                 }
1690         } else {
1691                 debug("## No Flattened Device Tree\n");
1692                 return 0;
1693         }
1694
1695         *of_flat_tree = fdt_blob;
1696         *of_size = fdt_totalsize(fdt_blob);
1697         debug("   of_flat_tree at 0x%08lx size 0x%08lx\n",
1698                         (ulong)*of_flat_tree, *of_size);
1699
1700         return 0;
1701
1702 error:
1703         *of_flat_tree = 0;
1704         *of_size = 0;
1705         return 1;
1706 }
1707 #endif /* CONFIG_OF_LIBFDT */
1708
1709 #ifdef CONFIG_SYS_BOOT_GET_CMDLINE
1710 /**
1711  * boot_get_cmdline - allocate and initialize kernel cmdline
1712  * @lmb: pointer to lmb handle, will be used for memory mgmt
1713  * @cmd_start: pointer to a ulong variable, will hold cmdline start
1714  * @cmd_end: pointer to a ulong variable, will hold cmdline end
1715  *
1716  * boot_get_cmdline() allocates space for kernel command line below
1717  * BOOTMAPSZ + getenv_bootm_low() address. If "bootargs" U-boot environemnt
1718  * variable is present its contents is copied to allocated kernel
1719  * command line.
1720  *
1721  * returns:
1722  *      0 - success
1723  *     -1 - failure
1724  */
1725 int boot_get_cmdline(struct lmb *lmb, ulong *cmd_start, ulong *cmd_end)
1726 {
1727         char *cmdline;
1728         char *s;
1729
1730         cmdline = (char *)(ulong)lmb_alloc_base(lmb, CONFIG_SYS_BARGSIZE, 0xf,
1731                                 getenv_bootm_mapsize() + getenv_bootm_low());
1732
1733         if (cmdline == NULL)
1734                 return -1;
1735
1736         if ((s = getenv("bootargs")) == NULL)
1737                 s = "";
1738
1739         strcpy(cmdline, s);
1740
1741         *cmd_start = (ulong) & cmdline[0];
1742         *cmd_end = *cmd_start + strlen(cmdline);
1743
1744         debug("## cmdline at 0x%08lx ... 0x%08lx\n", *cmd_start, *cmd_end);
1745
1746         return 0;
1747 }
1748 #endif /* CONFIG_SYS_BOOT_GET_CMDLINE */
1749
1750 #ifdef CONFIG_SYS_BOOT_GET_KBD
1751 /**
1752  * boot_get_kbd - allocate and initialize kernel copy of board info
1753  * @lmb: pointer to lmb handle, will be used for memory mgmt
1754  * @kbd: double pointer to board info data
1755  *
1756  * boot_get_kbd() allocates space for kernel copy of board info data below
1757  * BOOTMAPSZ + getenv_bootm_low() address and kernel board info is initialized
1758  * with the current u-boot board info data.
1759  *
1760  * returns:
1761  *      0 - success
1762  *     -1 - failure
1763  */
1764 int boot_get_kbd(struct lmb *lmb, bd_t **kbd)
1765 {
1766         *kbd = (bd_t *)(ulong)lmb_alloc_base(lmb, sizeof(bd_t), 0xf,
1767                                 getenv_bootm_mapsize() + getenv_bootm_low());
1768         if (*kbd == NULL)
1769                 return -1;
1770
1771         **kbd = *(gd->bd);
1772
1773         debug("## kernel board info at 0x%08lx\n", (ulong)*kbd);
1774
1775 #if defined(DEBUG) && defined(CONFIG_CMD_BDI)
1776         do_bdinfo(NULL, 0, 0, NULL);
1777 #endif
1778
1779         return 0;
1780 }
1781 #endif /* CONFIG_SYS_BOOT_GET_KBD */
1782 #endif /* !USE_HOSTCC */
1783
1784 #if defined(CONFIG_FIT)
1785 /*****************************************************************************/
1786 /* New uImage format routines */
1787 /*****************************************************************************/
1788 #ifndef USE_HOSTCC
1789 static int fit_parse_spec(const char *spec, char sepc, ulong addr_curr,
1790                 ulong *addr, const char **name)
1791 {
1792         const char *sep;
1793
1794         *addr = addr_curr;
1795         *name = NULL;
1796
1797         sep = strchr(spec, sepc);
1798         if (sep) {
1799                 if (sep - spec > 0)
1800                         *addr = simple_strtoul(spec, NULL, 16);
1801
1802                 *name = sep + 1;
1803                 return 1;
1804         }
1805
1806         return 0;
1807 }
1808
1809 /**
1810  * fit_parse_conf - parse FIT configuration spec
1811  * @spec: input string, containing configuration spec
1812  * @add_curr: current image address (to be used as a possible default)
1813  * @addr: pointer to a ulong variable, will hold FIT image address of a given
1814  * configuration
1815  * @conf_name double pointer to a char, will hold pointer to a configuration
1816  * unit name
1817  *
1818  * fit_parse_conf() expects configuration spec in the for of [<addr>]#<conf>,
1819  * where <addr> is a FIT image address that contains configuration
1820  * with a <conf> unit name.
1821  *
1822  * Address part is optional, and if omitted default add_curr will
1823  * be used instead.
1824  *
1825  * returns:
1826  *     1 if spec is a valid configuration string,
1827  *     addr and conf_name are set accordingly
1828  *     0 otherwise
1829  */
1830 inline int fit_parse_conf(const char *spec, ulong addr_curr,
1831                 ulong *addr, const char **conf_name)
1832 {
1833         return fit_parse_spec(spec, '#', addr_curr, addr, conf_name);
1834 }
1835
1836 /**
1837  * fit_parse_subimage - parse FIT subimage spec
1838  * @spec: input string, containing subimage spec
1839  * @add_curr: current image address (to be used as a possible default)
1840  * @addr: pointer to a ulong variable, will hold FIT image address of a given
1841  * subimage
1842  * @image_name: double pointer to a char, will hold pointer to a subimage name
1843  *
1844  * fit_parse_subimage() expects subimage spec in the for of
1845  * [<addr>]:<subimage>, where <addr> is a FIT image address that contains
1846  * subimage with a <subimg> unit name.
1847  *
1848  * Address part is optional, and if omitted default add_curr will
1849  * be used instead.
1850  *
1851  * returns:
1852  *     1 if spec is a valid subimage string,
1853  *     addr and image_name are set accordingly
1854  *     0 otherwise
1855  */
1856 inline int fit_parse_subimage(const char *spec, ulong addr_curr,
1857                 ulong *addr, const char **image_name)
1858 {
1859         return fit_parse_spec(spec, ':', addr_curr, addr, image_name);
1860 }
1861 #endif /* !USE_HOSTCC */
1862
1863 static void fit_get_debug(const void *fit, int noffset,
1864                 char *prop_name, int err)
1865 {
1866         debug("Can't get '%s' property from FIT 0x%08lx, "
1867                 "node: offset %d, name %s (%s)\n",
1868                 prop_name, (ulong)fit, noffset,
1869                 fit_get_name(fit, noffset, NULL),
1870                 fdt_strerror(err));
1871 }
1872
1873 /**
1874  * fit_print_contents - prints out the contents of the FIT format image
1875  * @fit: pointer to the FIT format image header
1876  * @p: pointer to prefix string
1877  *
1878  * fit_print_contents() formats a multi line FIT image contents description.
1879  * The routine prints out FIT image properties (root node level) follwed by
1880  * the details of each component image.
1881  *
1882  * returns:
1883  *     no returned results
1884  */
1885 void fit_print_contents(const void *fit)
1886 {
1887         char *desc;
1888         char *uname;
1889         int images_noffset;
1890         int confs_noffset;
1891         int noffset;
1892         int ndepth;
1893         int count = 0;
1894         int ret;
1895         const char *p;
1896 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC)
1897         time_t timestamp;
1898 #endif
1899
1900 #ifdef USE_HOSTCC
1901         p = "";
1902 #else
1903         p = "   ";
1904 #endif
1905
1906         /* Root node properties */
1907         ret = fit_get_desc(fit, 0, &desc);
1908         printf("%sFIT description: ", p);
1909         if (ret)
1910                 printf("unavailable\n");
1911         else
1912                 printf("%s\n", desc);
1913
1914 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC)
1915         ret = fit_get_timestamp(fit, 0, &timestamp);
1916         printf("%sCreated:         ", p);
1917         if (ret)
1918                 printf("unavailable\n");
1919         else
1920                 genimg_print_time(timestamp);
1921 #endif
1922
1923         /* Find images parent node offset */
1924         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1925         if (images_noffset < 0) {
1926                 printf("Can't find images parent node '%s' (%s)\n",
1927                         FIT_IMAGES_PATH, fdt_strerror(images_noffset));
1928                 return;
1929         }
1930
1931         /* Process its subnodes, print out component images details */
1932         for (ndepth = 0, count = 0,
1933                 noffset = fdt_next_node(fit, images_noffset, &ndepth);
1934              (noffset >= 0) && (ndepth > 0);
1935              noffset = fdt_next_node(fit, noffset, &ndepth)) {
1936                 if (ndepth == 1) {
1937                         /*
1938                          * Direct child node of the images parent node,
1939                          * i.e. component image node.
1940                          */
1941                         printf("%s Image %u (%s)\n", p, count++,
1942                                         fit_get_name(fit, noffset, NULL));
1943
1944                         fit_image_print(fit, noffset, p);
1945                 }
1946         }
1947
1948         /* Find configurations parent node offset */
1949         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1950         if (confs_noffset < 0) {
1951                 debug("Can't get configurations parent node '%s' (%s)\n",
1952                         FIT_CONFS_PATH, fdt_strerror(confs_noffset));
1953                 return;
1954         }
1955
1956         /* get default configuration unit name from default property */
1957         uname = (char *)fdt_getprop(fit, noffset, FIT_DEFAULT_PROP, NULL);
1958         if (uname)
1959                 printf("%s Default Configuration: '%s'\n", p, uname);
1960
1961         /* Process its subnodes, print out configurations details */
1962         for (ndepth = 0, count = 0,
1963                 noffset = fdt_next_node(fit, confs_noffset, &ndepth);
1964              (noffset >= 0) && (ndepth > 0);
1965              noffset = fdt_next_node(fit, noffset, &ndepth)) {
1966                 if (ndepth == 1) {
1967                         /*
1968                          * Direct child node of the configurations parent node,
1969                          * i.e. configuration node.
1970                          */
1971                         printf("%s Configuration %u (%s)\n", p, count++,
1972                                         fit_get_name(fit, noffset, NULL));
1973
1974                         fit_conf_print(fit, noffset, p);
1975                 }
1976         }
1977 }
1978
1979 /**
1980  * fit_image_print - prints out the FIT component image details
1981  * @fit: pointer to the FIT format image header
1982  * @image_noffset: offset of the component image node
1983  * @p: pointer to prefix string
1984  *
1985  * fit_image_print() lists all mandatory properies for the processed component
1986  * image. If present, hash nodes are printed out as well. Load
1987  * address for images of type firmware is also printed out. Since the load
1988  * address is not mandatory for firmware images, it will be output as
1989  * "unavailable" when not present.
1990  *
1991  * returns:
1992  *     no returned results
1993  */
1994 void fit_image_print(const void *fit, int image_noffset, const char *p)
1995 {
1996         char *desc;
1997         uint8_t type, arch, os, comp;
1998         size_t size;
1999         ulong load, entry;
2000         const void *data;
2001         int noffset;
2002         int ndepth;
2003         int ret;
2004
2005         /* Mandatory properties */
2006         ret = fit_get_desc(fit, image_noffset, &desc);
2007         printf("%s  Description:  ", p);
2008         if (ret)
2009                 printf("unavailable\n");
2010         else
2011                 printf("%s\n", desc);
2012
2013         fit_image_get_type(fit, image_noffset, &type);
2014         printf("%s  Type:         %s\n", p, genimg_get_type_name(type));
2015
2016         fit_image_get_comp(fit, image_noffset, &comp);
2017         printf("%s  Compression:  %s\n", p, genimg_get_comp_name(comp));
2018
2019         ret = fit_image_get_data(fit, image_noffset, &data, &size);
2020
2021 #ifndef USE_HOSTCC
2022         printf("%s  Data Start:   ", p);
2023         if (ret)
2024                 printf("unavailable\n");
2025         else
2026                 printf("0x%08lx\n", (ulong)data);
2027 #endif
2028
2029         printf("%s  Data Size:    ", p);
2030         if (ret)
2031                 printf("unavailable\n");
2032         else
2033                 genimg_print_size(size);
2034
2035         /* Remaining, type dependent properties */
2036         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
2037             (type == IH_TYPE_RAMDISK) || (type == IH_TYPE_FIRMWARE) ||
2038             (type == IH_TYPE_FLATDT)) {
2039                 fit_image_get_arch(fit, image_noffset, &arch);
2040                 printf("%s  Architecture: %s\n", p, genimg_get_arch_name(arch));
2041         }
2042
2043         if (type == IH_TYPE_KERNEL) {
2044                 fit_image_get_os(fit, image_noffset, &os);
2045                 printf("%s  OS:           %s\n", p, genimg_get_os_name(os));
2046         }
2047
2048         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
2049                 (type == IH_TYPE_FIRMWARE)) {
2050                 ret = fit_image_get_load(fit, image_noffset, &load);
2051                 printf("%s  Load Address: ", p);
2052                 if (ret)
2053                         printf("unavailable\n");
2054                 else
2055                         printf("0x%08lx\n", load);
2056         }
2057
2058         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE)) {
2059                 fit_image_get_entry(fit, image_noffset, &entry);
2060                 printf("%s  Entry Point:  ", p);
2061                 if (ret)
2062                         printf("unavailable\n");
2063                 else
2064                         printf("0x%08lx\n", entry);
2065         }
2066
2067         /* Process all hash subnodes of the component image node */
2068         for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
2069              (noffset >= 0) && (ndepth > 0);
2070              noffset = fdt_next_node(fit, noffset, &ndepth)) {
2071                 if (ndepth == 1) {
2072                         /* Direct child node of the component image node */
2073                         fit_image_print_hash(fit, noffset, p);
2074                 }
2075         }
2076 }
2077
2078 /**
2079  * fit_image_print_hash - prints out the hash node details
2080  * @fit: pointer to the FIT format image header
2081  * @noffset: offset of the hash node
2082  * @p: pointer to prefix string
2083  *
2084  * fit_image_print_hash() lists properies for the processed hash node
2085  *
2086  * returns:
2087  *     no returned results
2088  */
2089 void fit_image_print_hash(const void *fit, int noffset, const char *p)
2090 {
2091         char *algo;
2092         uint8_t *value;
2093         int value_len;
2094         int i, ret;
2095
2096         /*
2097          * Check subnode name, must be equal to "hash".
2098          * Multiple hash nodes require unique unit node
2099          * names, e.g. hash@1, hash@2, etc.
2100          */
2101         if (strncmp(fit_get_name(fit, noffset, NULL),
2102                         FIT_HASH_NODENAME,
2103                         strlen(FIT_HASH_NODENAME)) != 0)
2104                 return;
2105
2106         debug("%s  Hash node:    '%s'\n", p,
2107                         fit_get_name(fit, noffset, NULL));
2108
2109         printf("%s  Hash algo:    ", p);
2110         if (fit_image_hash_get_algo(fit, noffset, &algo)) {
2111                 printf("invalid/unsupported\n");
2112                 return;
2113         }
2114         printf("%s\n", algo);
2115
2116         ret = fit_image_hash_get_value(fit, noffset, &value,
2117                                         &value_len);
2118         printf("%s  Hash value:   ", p);
2119         if (ret) {
2120                 printf("unavailable\n");
2121         } else {
2122                 for (i = 0; i < value_len; i++)
2123                         printf("%02x", value[i]);
2124                 printf("\n");
2125         }
2126
2127         debug("%s  Hash len:     %d\n", p, value_len);
2128 }
2129
2130 /**
2131  * fit_get_desc - get node description property
2132  * @fit: pointer to the FIT format image header
2133  * @noffset: node offset
2134  * @desc: double pointer to the char, will hold pointer to the descrption
2135  *
2136  * fit_get_desc() reads description property from a given node, if
2137  * description is found pointer to it is returened in third call argument.
2138  *
2139  * returns:
2140  *     0, on success
2141  *     -1, on failure
2142  */
2143 int fit_get_desc(const void *fit, int noffset, char **desc)
2144 {
2145         int len;
2146
2147         *desc = (char *)fdt_getprop(fit, noffset, FIT_DESC_PROP, &len);
2148         if (*desc == NULL) {
2149                 fit_get_debug(fit, noffset, FIT_DESC_PROP, len);
2150                 return -1;
2151         }
2152
2153         return 0;
2154 }
2155
2156 /**
2157  * fit_get_timestamp - get node timestamp property
2158  * @fit: pointer to the FIT format image header
2159  * @noffset: node offset
2160  * @timestamp: pointer to the time_t, will hold read timestamp
2161  *
2162  * fit_get_timestamp() reads timestamp poperty from given node, if timestamp
2163  * is found and has a correct size its value is retured in third call
2164  * argument.
2165  *
2166  * returns:
2167  *     0, on success
2168  *     -1, on property read failure
2169  *     -2, on wrong timestamp size
2170  */
2171 int fit_get_timestamp(const void *fit, int noffset, time_t *timestamp)
2172 {
2173         int len;
2174         const void *data;
2175
2176         data = fdt_getprop(fit, noffset, FIT_TIMESTAMP_PROP, &len);
2177         if (data == NULL) {
2178                 fit_get_debug(fit, noffset, FIT_TIMESTAMP_PROP, len);
2179                 return -1;
2180         }
2181         if (len != sizeof(uint32_t)) {
2182                 debug("FIT timestamp with incorrect size of (%u)\n", len);
2183                 return -2;
2184         }
2185
2186         *timestamp = uimage_to_cpu(*((uint32_t *)data));
2187         return 0;
2188 }
2189
2190 /**
2191  * fit_image_get_node - get node offset for component image of a given unit name
2192  * @fit: pointer to the FIT format image header
2193  * @image_uname: component image node unit name
2194  *
2195  * fit_image_get_node() finds a component image (withing the '/images'
2196  * node) of a provided unit name. If image is found its node offset is
2197  * returned to the caller.
2198  *
2199  * returns:
2200  *     image node offset when found (>=0)
2201  *     negative number on failure (FDT_ERR_* code)
2202  */
2203 int fit_image_get_node(const void *fit, const char *image_uname)
2204 {
2205         int noffset, images_noffset;
2206
2207         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
2208         if (images_noffset < 0) {
2209                 debug("Can't find images parent node '%s' (%s)\n",
2210                         FIT_IMAGES_PATH, fdt_strerror(images_noffset));
2211                 return images_noffset;
2212         }
2213
2214         noffset = fdt_subnode_offset(fit, images_noffset, image_uname);
2215         if (noffset < 0) {
2216                 debug("Can't get node offset for image unit name: '%s' (%s)\n",
2217                         image_uname, fdt_strerror(noffset));
2218         }
2219
2220         return noffset;
2221 }
2222
2223 /**
2224  * fit_image_get_os - get os id for a given component image node
2225  * @fit: pointer to the FIT format image header
2226  * @noffset: component image node offset
2227  * @os: pointer to the uint8_t, will hold os numeric id
2228  *
2229  * fit_image_get_os() finds os property in a given component image node.
2230  * If the property is found, its (string) value is translated to the numeric
2231  * id which is returned to the caller.
2232  *
2233  * returns:
2234  *     0, on success
2235  *     -1, on failure
2236  */
2237 int fit_image_get_os(const void *fit, int noffset, uint8_t *os)
2238 {
2239         int len;
2240         const void *data;
2241
2242         /* Get OS name from property data */
2243         data = fdt_getprop(fit, noffset, FIT_OS_PROP, &len);
2244         if (data == NULL) {
2245                 fit_get_debug(fit, noffset, FIT_OS_PROP, len);
2246                 *os = -1;
2247                 return -1;
2248         }
2249
2250         /* Translate OS name to id */
2251         *os = genimg_get_os_id(data);
2252         return 0;
2253 }
2254
2255 /**
2256  * fit_image_get_arch - get arch id for a given component image node
2257  * @fit: pointer to the FIT format image header
2258  * @noffset: component image node offset
2259  * @arch: pointer to the uint8_t, will hold arch numeric id
2260  *
2261  * fit_image_get_arch() finds arch property in a given component image node.
2262  * If the property is found, its (string) value is translated to the numeric
2263  * id which is returned to the caller.
2264  *
2265  * returns:
2266  *     0, on success
2267  *     -1, on failure
2268  */
2269 int fit_image_get_arch(const void *fit, int noffset, uint8_t *arch)
2270 {
2271         int len;
2272         const void *data;
2273
2274         /* Get architecture name from property data */
2275         data = fdt_getprop(fit, noffset, FIT_ARCH_PROP, &len);
2276         if (data == NULL) {
2277                 fit_get_debug(fit, noffset, FIT_ARCH_PROP, len);
2278                 *arch = -1;
2279                 return -1;
2280         }
2281
2282         /* Translate architecture name to id */
2283         *arch = genimg_get_arch_id(data);
2284         return 0;
2285 }
2286
2287 /**
2288  * fit_image_get_type - get type id for a given component image node
2289  * @fit: pointer to the FIT format image header
2290  * @noffset: component image node offset
2291  * @type: pointer to the uint8_t, will hold type numeric id
2292  *
2293  * fit_image_get_type() finds type property in a given component image node.
2294  * If the property is found, its (string) value is translated to the numeric
2295  * id which is returned to the caller.
2296  *
2297  * returns:
2298  *     0, on success
2299  *     -1, on failure
2300  */
2301 int fit_image_get_type(const void *fit, int noffset, uint8_t *type)
2302 {
2303         int len;
2304         const void *data;
2305
2306         /* Get image type name from property data */
2307         data = fdt_getprop(fit, noffset, FIT_TYPE_PROP, &len);
2308         if (data == NULL) {
2309                 fit_get_debug(fit, noffset, FIT_TYPE_PROP, len);
2310                 *type = -1;
2311                 return -1;
2312         }
2313
2314         /* Translate image type name to id */
2315         *type = genimg_get_type_id(data);
2316         return 0;
2317 }
2318
2319 /**
2320  * fit_image_get_comp - get comp id for a given component image node
2321  * @fit: pointer to the FIT format image header
2322  * @noffset: component image node offset
2323  * @comp: pointer to the uint8_t, will hold comp numeric id
2324  *
2325  * fit_image_get_comp() finds comp property in a given component image node.
2326  * If the property is found, its (string) value is translated to the numeric
2327  * id which is returned to the caller.
2328  *
2329  * returns:
2330  *     0, on success
2331  *     -1, on failure
2332  */
2333 int fit_image_get_comp(const void *fit, int noffset, uint8_t *comp)
2334 {
2335         int len;
2336         const void *data;
2337
2338         /* Get compression name from property data */
2339         data = fdt_getprop(fit, noffset, FIT_COMP_PROP, &len);
2340         if (data == NULL) {
2341                 fit_get_debug(fit, noffset, FIT_COMP_PROP, len);
2342                 *comp = -1;
2343                 return -1;
2344         }
2345
2346         /* Translate compression name to id */
2347         *comp = genimg_get_comp_id(data);
2348         return 0;
2349 }
2350
2351 /**
2352  * fit_image_get_load - get load address property for a given component image node
2353  * @fit: pointer to the FIT format image header
2354  * @noffset: component image node offset
2355  * @load: pointer to the uint32_t, will hold load address
2356  *
2357  * fit_image_get_load() finds load address property in a given component image node.
2358  * If the property is found, its value is returned to the caller.
2359  *
2360  * returns:
2361  *     0, on success
2362  *     -1, on failure
2363  */
2364 int fit_image_get_load(const void *fit, int noffset, ulong *load)
2365 {
2366         int len;
2367         const uint32_t *data;
2368
2369         data = fdt_getprop(fit, noffset, FIT_LOAD_PROP, &len);
2370         if (data == NULL) {
2371                 fit_get_debug(fit, noffset, FIT_LOAD_PROP, len);
2372                 return -1;
2373         }
2374
2375         *load = uimage_to_cpu(*data);
2376         return 0;
2377 }
2378
2379 /**
2380  * fit_image_get_entry - get entry point address property for a given component image node
2381  * @fit: pointer to the FIT format image header
2382  * @noffset: component image node offset
2383  * @entry: pointer to the uint32_t, will hold entry point address
2384  *
2385  * fit_image_get_entry() finds entry point address property in a given component image node.
2386  * If the property is found, its value is returned to the caller.
2387  *
2388  * returns:
2389  *     0, on success
2390  *     -1, on failure
2391  */
2392 int fit_image_get_entry(const void *fit, int noffset, ulong *entry)
2393 {
2394         int len;
2395         const uint32_t *data;
2396
2397         data = fdt_getprop(fit, noffset, FIT_ENTRY_PROP, &len);
2398         if (data == NULL) {
2399                 fit_get_debug(fit, noffset, FIT_ENTRY_PROP, len);
2400                 return -1;
2401         }
2402
2403         *entry = uimage_to_cpu(*data);
2404         return 0;
2405 }
2406
2407 /**
2408  * fit_image_get_data - get data property and its size for a given component image node
2409  * @fit: pointer to the FIT format image header
2410  * @noffset: component image node offset
2411  * @data: double pointer to void, will hold data property's data address
2412  * @size: pointer to size_t, will hold data property's data size
2413  *
2414  * fit_image_get_data() finds data property in a given component image node.
2415  * If the property is found its data start address and size are returned to
2416  * the caller.
2417  *
2418  * returns:
2419  *     0, on success
2420  *     -1, on failure
2421  */
2422 int fit_image_get_data(const void *fit, int noffset,
2423                 const void **data, size_t *size)
2424 {
2425         int len;
2426
2427         *data = fdt_getprop(fit, noffset, FIT_DATA_PROP, &len);
2428         if (*data == NULL) {
2429                 fit_get_debug(fit, noffset, FIT_DATA_PROP, len);
2430                 *size = 0;
2431                 return -1;
2432         }
2433
2434         *size = len;
2435         return 0;
2436 }
2437
2438 /**
2439  * fit_image_hash_get_algo - get hash algorithm name
2440  * @fit: pointer to the FIT format image header
2441  * @noffset: hash node offset
2442  * @algo: double pointer to char, will hold pointer to the algorithm name
2443  *
2444  * fit_image_hash_get_algo() finds hash algorithm property in a given hash node.
2445  * If the property is found its data start address is returned to the caller.
2446  *
2447  * returns:
2448  *     0, on success
2449  *     -1, on failure
2450  */
2451 int fit_image_hash_get_algo(const void *fit, int noffset, char **algo)
2452 {
2453         int len;
2454
2455         *algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len);
2456         if (*algo == NULL) {
2457                 fit_get_debug(fit, noffset, FIT_ALGO_PROP, len);
2458                 return -1;
2459         }
2460
2461         return 0;
2462 }
2463
2464 /**
2465  * fit_image_hash_get_value - get hash value and length
2466  * @fit: pointer to the FIT format image header
2467  * @noffset: hash node offset
2468  * @value: double pointer to uint8_t, will hold address of a hash value data
2469  * @value_len: pointer to an int, will hold hash data length
2470  *
2471  * fit_image_hash_get_value() finds hash value property in a given hash node.
2472  * If the property is found its data start address and size are returned to
2473  * the caller.
2474  *
2475  * returns:
2476  *     0, on success
2477  *     -1, on failure
2478  */
2479 int fit_image_hash_get_value(const void *fit, int noffset, uint8_t **value,
2480                                 int *value_len)
2481 {
2482         int len;
2483
2484         *value = (uint8_t *)fdt_getprop(fit, noffset, FIT_VALUE_PROP, &len);
2485         if (*value == NULL) {
2486                 fit_get_debug(fit, noffset, FIT_VALUE_PROP, len);
2487                 *value_len = 0;
2488                 return -1;
2489         }
2490
2491         *value_len = len;
2492         return 0;
2493 }
2494
2495 /**
2496  * fit_set_timestamp - set node timestamp property
2497  * @fit: pointer to the FIT format image header
2498  * @noffset: node offset
2499  * @timestamp: timestamp value to be set
2500  *
2501  * fit_set_timestamp() attempts to set timestamp property in the requested
2502  * node and returns operation status to the caller.
2503  *
2504  * returns:
2505  *     0, on success
2506  *     -1, on property read failure
2507  */
2508 int fit_set_timestamp(void *fit, int noffset, time_t timestamp)
2509 {
2510         uint32_t t;
2511         int ret;
2512
2513         t = cpu_to_uimage(timestamp);
2514         ret = fdt_setprop(fit, noffset, FIT_TIMESTAMP_PROP, &t,
2515                                 sizeof(uint32_t));
2516         if (ret) {
2517                 printf("Can't set '%s' property for '%s' node (%s)\n",
2518                         FIT_TIMESTAMP_PROP, fit_get_name(fit, noffset, NULL),
2519                         fdt_strerror(ret));
2520                 return -1;
2521         }
2522
2523         return 0;
2524 }
2525
2526 /**
2527  * calculate_hash - calculate and return hash for provided input data
2528  * @data: pointer to the input data
2529  * @data_len: data length
2530  * @algo: requested hash algorithm
2531  * @value: pointer to the char, will hold hash value data (caller must
2532  * allocate enough free space)
2533  * value_len: length of the calculated hash
2534  *
2535  * calculate_hash() computes input data hash according to the requested algorithm.
2536  * Resulting hash value is placed in caller provided 'value' buffer, length
2537  * of the calculated hash is returned via value_len pointer argument.
2538  *
2539  * returns:
2540  *     0, on success
2541  *    -1, when algo is unsupported
2542  */
2543 static int calculate_hash(const void *data, int data_len, const char *algo,
2544                         uint8_t *value, int *value_len)
2545 {
2546         if (strcmp(algo, "crc32") == 0) {
2547                 *((uint32_t *)value) = crc32_wd(0, data, data_len,
2548                                                         CHUNKSZ_CRC32);
2549                 *((uint32_t *)value) = cpu_to_uimage(*((uint32_t *)value));
2550                 *value_len = 4;
2551         } else if (strcmp(algo, "sha1") == 0) {
2552                 sha1_csum_wd((unsigned char *) data, data_len,
2553                                 (unsigned char *) value, CHUNKSZ_SHA1);
2554                 *value_len = 20;
2555         } else if (strcmp(algo, "md5") == 0) {
2556                 md5_wd((unsigned char *)data, data_len, value, CHUNKSZ_MD5);
2557                 *value_len = 16;
2558         } else {
2559                 debug("Unsupported hash alogrithm\n");
2560                 return -1;
2561         }
2562         return 0;
2563 }
2564
2565 #ifdef USE_HOSTCC
2566 /**
2567  * fit_set_hashes - process FIT component image nodes and calculate hashes
2568  * @fit: pointer to the FIT format image header
2569  *
2570  * fit_set_hashes() adds hash values for all component images in the FIT blob.
2571  * Hashes are calculated for all component images which have hash subnodes
2572  * with algorithm property set to one of the supported hash algorithms.
2573  *
2574  * returns
2575  *     0, on success
2576  *     libfdt error code, on failure
2577  */
2578 int fit_set_hashes(void *fit)
2579 {
2580         int images_noffset;
2581         int noffset;
2582         int ndepth;
2583         int ret;
2584
2585         /* Find images parent node offset */
2586         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
2587         if (images_noffset < 0) {
2588                 printf("Can't find images parent node '%s' (%s)\n",
2589                         FIT_IMAGES_PATH, fdt_strerror(images_noffset));
2590                 return images_noffset;
2591         }
2592
2593         /* Process its subnodes, print out component images details */
2594         for (ndepth = 0, noffset = fdt_next_node(fit, images_noffset, &ndepth);
2595              (noffset >= 0) && (ndepth > 0);
2596              noffset = fdt_next_node(fit, noffset, &ndepth)) {
2597                 if (ndepth == 1) {
2598                         /*
2599                          * Direct child node of the images parent node,
2600                          * i.e. component image node.
2601                          */
2602                         ret = fit_image_set_hashes(fit, noffset);
2603                         if (ret)
2604                                 return ret;
2605                 }
2606         }
2607
2608         return 0;
2609 }
2610
2611 /**
2612  * fit_image_set_hashes - calculate/set hashes for given component image node
2613  * @fit: pointer to the FIT format image header
2614  * @image_noffset: requested component image node
2615  *
2616  * fit_image_set_hashes() adds hash values for an component image node. All
2617  * existing hash subnodes are checked, if algorithm property is set to one of
2618  * the supported hash algorithms, hash value is computed and corresponding
2619  * hash node property is set, for example:
2620  *
2621  * Input component image node structure:
2622  *
2623  * o image@1 (at image_noffset)
2624  *   | - data = [binary data]
2625  *   o hash@1
2626  *     |- algo = "sha1"
2627  *
2628  * Output component image node structure:
2629  *
2630  * o image@1 (at image_noffset)
2631  *   | - data = [binary data]
2632  *   o hash@1
2633  *     |- algo = "sha1"
2634  *     |- value = sha1(data)
2635  *
2636  * returns:
2637  *     0 on sucess
2638  *    <0 on failure
2639  */
2640 int fit_image_set_hashes(void *fit, int image_noffset)
2641 {
2642         const void *data;
2643         size_t size;
2644         char *algo;
2645         uint8_t value[FIT_MAX_HASH_LEN];
2646         int value_len;
2647         int noffset;
2648         int ndepth;
2649
2650         /* Get image data and data length */
2651         if (fit_image_get_data(fit, image_noffset, &data, &size)) {
2652                 printf("Can't get image data/size\n");
2653                 return -1;
2654         }
2655
2656         /* Process all hash subnodes of the component image node */
2657         for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
2658              (noffset >= 0) && (ndepth > 0);
2659              noffset = fdt_next_node(fit, noffset, &ndepth)) {
2660                 if (ndepth == 1) {
2661                         /* Direct child node of the component image node */
2662
2663                         /*
2664                          * Check subnode name, must be equal to "hash".
2665                          * Multiple hash nodes require unique unit node
2666                          * names, e.g. hash@1, hash@2, etc.
2667                          */
2668                         if (strncmp(fit_get_name(fit, noffset, NULL),
2669                                                 FIT_HASH_NODENAME,
2670                                                 strlen(FIT_HASH_NODENAME)) != 0) {
2671                                 /* Not a hash subnode, skip it */
2672                                 continue;
2673                         }
2674
2675                         if (fit_image_hash_get_algo(fit, noffset, &algo)) {
2676                                 printf("Can't get hash algo property for "
2677                                         "'%s' hash node in '%s' image node\n",
2678                                         fit_get_name(fit, noffset, NULL),
2679                                         fit_get_name(fit, image_noffset, NULL));
2680                                 return -1;
2681                         }
2682
2683                         if (calculate_hash(data, size, algo, value,
2684                                                 &value_len)) {
2685                                 printf("Unsupported hash algorithm (%s) for "
2686                                         "'%s' hash node in '%s' image node\n",
2687                                         algo, fit_get_name(fit, noffset, NULL),
2688                                         fit_get_name(fit, image_noffset,
2689                                                         NULL));
2690                                 return -1;
2691                         }
2692
2693                         if (fit_image_hash_set_value(fit, noffset, value,
2694                                                         value_len)) {
2695                                 printf("Can't set hash value for "
2696                                         "'%s' hash node in '%s' image node\n",
2697                                         fit_get_name(fit, noffset, NULL),
2698                                         fit_get_name(fit, image_noffset, NULL));
2699                                 return -1;
2700                         }
2701                 }
2702         }
2703
2704         return 0;
2705 }
2706
2707 /**
2708  * fit_image_hash_set_value - set hash value in requested has node
2709  * @fit: pointer to the FIT format image header
2710  * @noffset: hash node offset
2711  * @value: hash value to be set
2712  * @value_len: hash value length
2713  *
2714  * fit_image_hash_set_value() attempts to set hash value in a node at offset
2715  * given and returns operation status to the caller.
2716  *
2717  * returns
2718  *     0, on success
2719  *     -1, on failure
2720  */
2721 int fit_image_hash_set_value(void *fit, int noffset, uint8_t *value,
2722                                 int value_len)
2723 {
2724         int ret;
2725
2726         ret = fdt_setprop(fit, noffset, FIT_VALUE_PROP, value, value_len);
2727         if (ret) {
2728                 printf("Can't set hash '%s' property for '%s' node(%s)\n",
2729                         FIT_VALUE_PROP, fit_get_name(fit, noffset, NULL),
2730                         fdt_strerror(ret));
2731                 return -1;
2732         }
2733
2734         return 0;
2735 }
2736 #endif /* USE_HOSTCC */
2737
2738 /**
2739  * fit_image_check_hashes - verify data intergity
2740  * @fit: pointer to the FIT format image header
2741  * @image_noffset: component image node offset
2742  *
2743  * fit_image_check_hashes() goes over component image hash nodes,
2744  * re-calculates each data hash and compares with the value stored in hash
2745  * node.
2746  *
2747  * returns:
2748  *     1, if all hashes are valid
2749  *     0, otherwise (or on error)
2750  */
2751 int fit_image_check_hashes(const void *fit, int image_noffset)
2752 {
2753         const void      *data;
2754         size_t          size;
2755         char            *algo;
2756         uint8_t         *fit_value;
2757         int             fit_value_len;
2758         uint8_t         value[FIT_MAX_HASH_LEN];
2759         int             value_len;
2760         int             noffset;
2761         int             ndepth;
2762         char            *err_msg = "";
2763
2764         /* Get image data and data length */
2765         if (fit_image_get_data(fit, image_noffset, &data, &size)) {
2766                 printf("Can't get image data/size\n");
2767                 return 0;
2768         }
2769
2770         /* Process all hash subnodes of the component image node */
2771         for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
2772              (noffset >= 0) && (ndepth > 0);
2773              noffset = fdt_next_node(fit, noffset, &ndepth)) {
2774                 if (ndepth == 1) {
2775                         /* Direct child node of the component image node */
2776
2777                         /*
2778                          * Check subnode name, must be equal to "hash".
2779                          * Multiple hash nodes require unique unit node
2780                          * names, e.g. hash@1, hash@2, etc.
2781                          */
2782                         if (strncmp(fit_get_name(fit, noffset, NULL),
2783                                         FIT_HASH_NODENAME,
2784                                         strlen(FIT_HASH_NODENAME)) != 0)
2785                                 continue;
2786
2787                         if (fit_image_hash_get_algo(fit, noffset, &algo)) {
2788                                 err_msg = " error!\nCan't get hash algo "
2789                                                 "property";
2790                                 goto error;
2791                         }
2792                         printf("%s", algo);
2793
2794                         if (fit_image_hash_get_value(fit, noffset, &fit_value,
2795                                                         &fit_value_len)) {
2796                                 err_msg = " error!\nCan't get hash value "
2797                                                 "property";
2798                                 goto error;
2799                         }
2800
2801                         if (calculate_hash(data, size, algo, value,
2802                                                 &value_len)) {
2803                                 err_msg = " error!\n"
2804                                                 "Unsupported hash algorithm";
2805                                 goto error;
2806                         }
2807
2808                         if (value_len != fit_value_len) {
2809                                 err_msg = " error !\nBad hash value len";
2810                                 goto error;
2811                         } else if (memcmp(value, fit_value, value_len) != 0) {
2812                                 err_msg = " error!\nBad hash value";
2813                                 goto error;
2814                         }
2815                         printf("+ ");
2816                 }
2817         }
2818
2819         return 1;
2820
2821 error:
2822         printf("%s for '%s' hash node in '%s' image node\n",
2823                         err_msg, fit_get_name(fit, noffset, NULL),
2824                         fit_get_name(fit, image_noffset, NULL));
2825         return 0;
2826 }
2827
2828 /**
2829  * fit_all_image_check_hashes - verify data intergity for all images
2830  * @fit: pointer to the FIT format image header
2831  *
2832  * fit_all_image_check_hashes() goes over all images in the FIT and
2833  * for every images checks if all it's hashes are valid.
2834  *
2835  * returns:
2836  *     1, if all hashes of all images are valid
2837  *     0, otherwise (or on error)
2838  */
2839 int fit_all_image_check_hashes(const void *fit)
2840 {
2841         int images_noffset;
2842         int noffset;
2843         int ndepth;
2844         int count;
2845
2846         /* Find images parent node offset */
2847         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
2848         if (images_noffset < 0) {
2849                 printf("Can't find images parent node '%s' (%s)\n",
2850                         FIT_IMAGES_PATH, fdt_strerror(images_noffset));
2851                 return 0;
2852         }
2853
2854         /* Process all image subnodes, check hashes for each */
2855         printf("## Checking hash(es) for FIT Image at %08lx ...\n",
2856                 (ulong)fit);
2857         for (ndepth = 0, count = 0,
2858                 noffset = fdt_next_node(fit, images_noffset, &ndepth);
2859                 (noffset >= 0) && (ndepth > 0);
2860                 noffset = fdt_next_node(fit, noffset, &ndepth)) {
2861                 if (ndepth == 1) {
2862                         /*
2863                          * Direct child node of the images parent node,
2864                          * i.e. component image node.
2865                          */
2866                         printf("   Hash(es) for Image %u (%s): ", count++,
2867                                         fit_get_name(fit, noffset, NULL));
2868
2869                         if (!fit_image_check_hashes(fit, noffset))
2870                                 return 0;
2871                         printf("\n");
2872                 }
2873         }
2874         return 1;
2875 }
2876
2877 /**
2878  * fit_image_check_os - check whether image node is of a given os type
2879  * @fit: pointer to the FIT format image header
2880  * @noffset: component image node offset
2881  * @os: requested image os
2882  *
2883  * fit_image_check_os() reads image os property and compares its numeric
2884  * id with the requested os. Comparison result is returned to the caller.
2885  *
2886  * returns:
2887  *     1 if image is of given os type
2888  *     0 otherwise (or on error)
2889  */
2890 int fit_image_check_os(const void *fit, int noffset, uint8_t os)
2891 {
2892         uint8_t image_os;
2893
2894         if (fit_image_get_os(fit, noffset, &image_os))
2895                 return 0;
2896         return (os == image_os);
2897 }
2898
2899 /**
2900  * fit_image_check_arch - check whether image node is of a given arch
2901  * @fit: pointer to the FIT format image header
2902  * @noffset: component image node offset
2903  * @arch: requested imagearch
2904  *
2905  * fit_image_check_arch() reads image arch property and compares its numeric
2906  * id with the requested arch. Comparison result is returned to the caller.
2907  *
2908  * returns:
2909  *     1 if image is of given arch
2910  *     0 otherwise (or on error)
2911  */
2912 int fit_image_check_arch(const void *fit, int noffset, uint8_t arch)
2913 {
2914         uint8_t image_arch;
2915
2916         if (fit_image_get_arch(fit, noffset, &image_arch))
2917                 return 0;
2918         return (arch == image_arch);
2919 }
2920
2921 /**
2922  * fit_image_check_type - check whether image node is of a given type
2923  * @fit: pointer to the FIT format image header
2924  * @noffset: component image node offset
2925  * @type: requested image type
2926  *
2927  * fit_image_check_type() reads image type property and compares its numeric
2928  * id with the requested type. Comparison result is returned to the caller.
2929  *
2930  * returns:
2931  *     1 if image is of given type
2932  *     0 otherwise (or on error)
2933  */
2934 int fit_image_check_type(const void *fit, int noffset, uint8_t type)
2935 {
2936         uint8_t image_type;
2937
2938         if (fit_image_get_type(fit, noffset, &image_type))
2939                 return 0;
2940         return (type == image_type);
2941 }
2942
2943 /**
2944  * fit_image_check_comp - check whether image node uses given compression
2945  * @fit: pointer to the FIT format image header
2946  * @noffset: component image node offset
2947  * @comp: requested image compression type
2948  *
2949  * fit_image_check_comp() reads image compression property and compares its
2950  * numeric id with the requested compression type. Comparison result is
2951  * returned to the caller.
2952  *
2953  * returns:
2954  *     1 if image uses requested compression
2955  *     0 otherwise (or on error)
2956  */
2957 int fit_image_check_comp(const void *fit, int noffset, uint8_t comp)
2958 {
2959         uint8_t image_comp;
2960
2961         if (fit_image_get_comp(fit, noffset, &image_comp))
2962                 return 0;
2963         return (comp == image_comp);
2964 }
2965
2966 /**
2967  * fit_check_format - sanity check FIT image format
2968  * @fit: pointer to the FIT format image header
2969  *
2970  * fit_check_format() runs a basic sanity FIT image verification.
2971  * Routine checks for mandatory properties, nodes, etc.
2972  *
2973  * returns:
2974  *     1, on success
2975  *     0, on failure
2976  */
2977 int fit_check_format(const void *fit)
2978 {
2979         /* mandatory / node 'description' property */
2980         if (fdt_getprop(fit, 0, FIT_DESC_PROP, NULL) == NULL) {
2981                 debug("Wrong FIT format: no description\n");
2982                 return 0;
2983         }
2984
2985 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE) || defined(USE_HOSTCC)
2986         /* mandatory / node 'timestamp' property */
2987         if (fdt_getprop(fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) {
2988                 debug("Wrong FIT format: no timestamp\n");
2989                 return 0;
2990         }
2991 #endif
2992
2993         /* mandatory subimages parent '/images' node */
2994         if (fdt_path_offset(fit, FIT_IMAGES_PATH) < 0) {
2995                 debug("Wrong FIT format: no images parent node\n");
2996                 return 0;
2997         }
2998
2999         return 1;
3000 }
3001
3002 /**
3003  * fit_conf_get_node - get node offset for configuration of a given unit name
3004  * @fit: pointer to the FIT format image header
3005  * @conf_uname: configuration node unit name
3006  *
3007  * fit_conf_get_node() finds a configuration (withing the '/configurations'
3008  * parant node) of a provided unit name. If configuration is found its node offset
3009  * is returned to the caller.
3010  *
3011  * When NULL is provided in second argument fit_conf_get_node() will search
3012  * for a default configuration node instead. Default configuration node unit name
3013  * is retrived from FIT_DEFAULT_PROP property of the '/configurations' node.
3014  *
3015  * returns:
3016  *     configuration node offset when found (>=0)
3017  *     negative number on failure (FDT_ERR_* code)
3018  */
3019 int fit_conf_get_node(const void *fit, const char *conf_uname)
3020 {
3021         int noffset, confs_noffset;
3022         int len;
3023
3024         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
3025         if (confs_noffset < 0) {
3026                 debug("Can't find configurations parent node '%s' (%s)\n",
3027                         FIT_CONFS_PATH, fdt_strerror(confs_noffset));
3028                 return confs_noffset;
3029         }
3030
3031         if (conf_uname == NULL) {
3032                 /* get configuration unit name from the default property */
3033                 debug("No configuration specified, trying default...\n");
3034                 conf_uname = (char *)fdt_getprop(fit, confs_noffset,
3035                                                  FIT_DEFAULT_PROP, &len);
3036                 if (conf_uname == NULL) {
3037                         fit_get_debug(fit, confs_noffset, FIT_DEFAULT_PROP,
3038                                         len);
3039                         return len;
3040                 }
3041                 debug("Found default configuration: '%s'\n", conf_uname);
3042         }
3043
3044         noffset = fdt_subnode_offset(fit, confs_noffset, conf_uname);
3045         if (noffset < 0) {
3046                 debug("Can't get node offset for configuration unit name: "
3047                         "'%s' (%s)\n",
3048                         conf_uname, fdt_strerror(noffset));
3049         }
3050
3051         return noffset;
3052 }
3053
3054 static int __fit_conf_get_prop_node(const void *fit, int noffset,
3055                 const char *prop_name)
3056 {
3057         char *uname;
3058         int len;
3059
3060         /* get kernel image unit name from configuration kernel property */
3061         uname = (char *)fdt_getprop(fit, noffset, prop_name, &len);
3062         if (uname == NULL)
3063                 return len;
3064
3065         return fit_image_get_node(fit, uname);
3066 }
3067
3068 /**
3069  * fit_conf_get_kernel_node - get kernel image node offset that corresponds to
3070  * a given configuration
3071  * @fit: pointer to the FIT format image header
3072  * @noffset: configuration node offset
3073  *
3074  * fit_conf_get_kernel_node() retrives kernel image node unit name from
3075  * configuration FIT_KERNEL_PROP property and translates it to the node
3076  * offset.
3077  *
3078  * returns:
3079  *     image node offset when found (>=0)
3080  *     negative number on failure (FDT_ERR_* code)
3081  */
3082 int fit_conf_get_kernel_node(const void *fit, int noffset)
3083 {
3084         return __fit_conf_get_prop_node(fit, noffset, FIT_KERNEL_PROP);
3085 }
3086
3087 /**
3088  * fit_conf_get_ramdisk_node - get ramdisk image node offset that corresponds to
3089  * a given configuration
3090  * @fit: pointer to the FIT format image header
3091  * @noffset: configuration node offset
3092  *
3093  * fit_conf_get_ramdisk_node() retrives ramdisk image node unit name from
3094  * configuration FIT_KERNEL_PROP property and translates it to the node
3095  * offset.
3096  *
3097  * returns:
3098  *     image node offset when found (>=0)
3099  *     negative number on failure (FDT_ERR_* code)
3100  */
3101 int fit_conf_get_ramdisk_node(const void *fit, int noffset)
3102 {
3103         return __fit_conf_get_prop_node(fit, noffset, FIT_RAMDISK_PROP);
3104 }
3105
3106 /**
3107  * fit_conf_get_fdt_node - get fdt image node offset that corresponds to
3108  * a given configuration
3109  * @fit: pointer to the FIT format image header
3110  * @noffset: configuration node offset
3111  *
3112  * fit_conf_get_fdt_node() retrives fdt image node unit name from
3113  * configuration FIT_KERNEL_PROP property and translates it to the node
3114  * offset.
3115  *
3116  * returns:
3117  *     image node offset when found (>=0)
3118  *     negative number on failure (FDT_ERR_* code)
3119  */
3120 int fit_conf_get_fdt_node(const void *fit, int noffset)
3121 {
3122         return __fit_conf_get_prop_node(fit, noffset, FIT_FDT_PROP);
3123 }
3124
3125 /**
3126  * fit_conf_print - prints out the FIT configuration details
3127  * @fit: pointer to the FIT format image header
3128  * @noffset: offset of the configuration node
3129  * @p: pointer to prefix string
3130  *
3131  * fit_conf_print() lists all mandatory properies for the processed
3132  * configuration node.
3133  *
3134  * returns:
3135  *     no returned results
3136  */
3137 void fit_conf_print(const void *fit, int noffset, const char *p)
3138 {
3139         char *desc;
3140         char *uname;
3141         int ret;
3142
3143         /* Mandatory properties */
3144         ret = fit_get_desc(fit, noffset, &desc);
3145         printf("%s  Description:  ", p);
3146         if (ret)
3147                 printf("unavailable\n");
3148         else
3149                 printf("%s\n", desc);
3150
3151         uname = (char *)fdt_getprop(fit, noffset, FIT_KERNEL_PROP, NULL);
3152         printf("%s  Kernel:       ", p);
3153         if (uname == NULL)
3154                 printf("unavailable\n");
3155         else
3156                 printf("%s\n", uname);
3157
3158         /* Optional properties */
3159         uname = (char *)fdt_getprop(fit, noffset, FIT_RAMDISK_PROP, NULL);
3160         if (uname)
3161                 printf("%s  Init Ramdisk: %s\n", p, uname);
3162
3163         uname = (char *)fdt_getprop(fit, noffset, FIT_FDT_PROP, NULL);
3164         if (uname)
3165                 printf("%s  FDT:          %s\n", p, uname);
3166 }
3167
3168 /**
3169  * fit_check_ramdisk - verify FIT format ramdisk subimage
3170  * @fit_hdr: pointer to the FIT ramdisk header
3171  * @rd_noffset: ramdisk subimage node offset within FIT image
3172  * @arch: requested ramdisk image architecture type
3173  * @verify: data CRC verification flag
3174  *
3175  * fit_check_ramdisk() verifies integrity of the ramdisk subimage and from
3176  * specified FIT image.
3177  *
3178  * returns:
3179  *     1, on success
3180  *     0, on failure
3181  */
3182 #ifndef USE_HOSTCC
3183 static int fit_check_ramdisk(const void *fit, int rd_noffset, uint8_t arch,
3184                                 int verify)
3185 {
3186         fit_image_print(fit, rd_noffset, "   ");
3187
3188         if (verify) {
3189                 puts("   Verifying Hash Integrity ... ");
3190                 if (!fit_image_check_hashes(fit, rd_noffset)) {
3191                         puts("Bad Data Hash\n");
3192                         bootstage_error(BOOTSTAGE_ID_FIT_RD_HASH);
3193                         return 0;
3194                 }
3195                 puts("OK\n");
3196         }
3197
3198         bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK_ALL);
3199         if (!fit_image_check_os(fit, rd_noffset, IH_OS_LINUX) ||
3200             !fit_image_check_arch(fit, rd_noffset, arch) ||
3201             !fit_image_check_type(fit, rd_noffset, IH_TYPE_RAMDISK)) {
3202                 printf("No Linux %s Ramdisk Image\n",
3203                                 genimg_get_arch_name(arch));
3204                 bootstage_error(BOOTSTAGE_ID_FIT_RD_CHECK_ALL);
3205                 return 0;
3206         }
3207
3208         bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK_ALL_OK);
3209         return 1;
3210 }
3211 #endif /* USE_HOSTCC */
3212 #endif /* CONFIG_FIT */