common/image-fit.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (c) 2013, Google Inc.
   4  *
   5  * (C) Copyright 2008 Semihalf
   6  *
   7  * (C) Copyright 2000-2006
   8  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   9  */
  10
  11 #ifdef USE_HOSTCC
  12 #include "mkimage.h"
  13 #include <time.h>
  14 #include <u-boot/crc.h>
  15 #else
  16 #include <linux/compiler.h>
  17 #include <linux/kconfig.h>
  18 #include <common.h>
  19 #include <errno.h>
  20 #include <mapmem.h>
  21 #include <asm/io.h>
  22 #include <malloc.h>
  23 DECLARE_GLOBAL_DATA_PTR;
  24 #endif /* !USE_HOSTCC*/
  25
  26 #include <bootm.h>
  27 #include <image.h>
  28 #include <bootstage.h>
  29 #include <u-boot/crc.h>
  30 #include <u-boot/md5.h>
  31 #include <u-boot/sha1.h>
  32 #include <u-boot/sha256.h>
  33
  34 /*****************************************************************************/
  35 /* New uImage format routines */
  36 /*****************************************************************************/
  37 #ifndef USE_HOSTCC
  38 static int fit_parse_spec(const char *spec, char sepc, ulong addr_curr,
  39                 ulong *addr, const char **name)
  40 {
  41         const char *sep;
  42
  43         *addr = addr_curr;
  44         *name = NULL;
  45
  46         sep = strchr(spec, sepc);
  47         if (sep) {
  48                 if (sep - spec > 0)
  49                         *addr = simple_strtoul(spec, NULL, 16);
  50
  51                 *name = sep + 1;
  52                 return 1;
  53         }
  54
  55         return 0;
  56 }
  57
  58 /**
  59  * fit_parse_conf - parse FIT configuration spec
  60  * @spec: input string, containing configuration spec
  61  * @add_curr: current image address (to be used as a possible default)
  62  * @addr: pointer to a ulong variable, will hold FIT image address of a given
  63  * configuration
  64  * @conf_name double pointer to a char, will hold pointer to a configuration
  65  * unit name
  66  *
  67  * fit_parse_conf() expects configuration spec in the form of [<addr>]#<conf>,
  68  * where <addr> is a FIT image address that contains configuration
  69  * with a <conf> unit name.
  70  *
  71  * Address part is optional, and if omitted default add_curr will
  72  * be used instead.
  73  *
  74  * returns:
  75  *     1 if spec is a valid configuration string,
  76  *     addr and conf_name are set accordingly
  77  *     0 otherwise
  78  */
  79 int fit_parse_conf(const char *spec, ulong addr_curr,
  80                 ulong *addr, const char **conf_name)
  81 {
  82         return fit_parse_spec(spec, '#', addr_curr, addr, conf_name);
  83 }
  84
  85 /**
  86  * fit_parse_subimage - parse FIT subimage spec
  87  * @spec: input string, containing subimage spec
  88  * @add_curr: current image address (to be used as a possible default)
  89  * @addr: pointer to a ulong variable, will hold FIT image address of a given
  90  * subimage
  91  * @image_name: double pointer to a char, will hold pointer to a subimage name
  92  *
  93  * fit_parse_subimage() expects subimage spec in the form of
  94  * [<addr>]:<subimage>, where <addr> is a FIT image address that contains
  95  * subimage with a <subimg> unit name.
  96  *
  97  * Address part is optional, and if omitted default add_curr will
  98  * be used instead.
  99  *
 100  * returns:
 101  *     1 if spec is a valid subimage string,
 102  *     addr and image_name are set accordingly
 103  *     0 otherwise
 104  */
 105 int fit_parse_subimage(const char *spec, ulong addr_curr,
 106                 ulong *addr, const char **image_name)
 107 {
 108         return fit_parse_spec(spec, ':', addr_curr, addr, image_name);
 109 }
 110 #endif /* !USE_HOSTCC */
 111
 112 static void fit_get_debug(const void *fit, int noffset,
 113                 char *prop_name, int err)
 114 {
 115         debug("Can't get '%s' property from FIT 0x%08lx, node: offset %d, name %s (%s)\n",
 116               prop_name, (ulong)fit, noffset, fit_get_name(fit, noffset, NULL),
 117               fdt_strerror(err));
 118 }
 119
 120 /**
 121  * fit_get_subimage_count - get component (sub-image) count
 122  * @fit: pointer to the FIT format image header
 123  * @images_noffset: offset of images node
 124  *
 125  * returns:
 126  *     number of image components
 127  */
 128 int fit_get_subimage_count(const void *fit, int images_noffset)
 129 {
 130         int noffset;
 131         int ndepth;
 132         int count = 0;
 133
 134         /* Process its subnodes, print out component images details */
 135         for (ndepth = 0, count = 0,
 136                 noffset = fdt_next_node(fit, images_noffset, &ndepth);
 137              (noffset >= 0) && (ndepth > 0);
 138              noffset = fdt_next_node(fit, noffset, &ndepth)) {
 139                 if (ndepth == 1) {
 140                         count++;
 141                 }
 142         }
 143
 144         return count;
 145 }
 146
 147 #if !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_FIT_PRINT)
 148 /**
 149  * fit_image_print_data() - prints out the hash node details
 150  * @fit: pointer to the FIT format image header
 151  * @noffset: offset of the hash node
 152  * @p: pointer to prefix string
 153  * @type: Type of information to print ("hash" or "sign")
 154  *
 155  * fit_image_print_data() lists properties for the processed hash node
 156  *
 157  * This function avoid using puts() since it prints a newline on the host
 158  * but does not in U-Boot.
 159  *
 160  * returns:
 161  *     no returned results
 162  */
 163 static void fit_image_print_data(const void *fit, int noffset, const char *p,
 164                                  const char *type)
 165 {
 166         const char *keyname;
 167         uint8_t *value;
 168         int value_len;
 169         char *algo;
 170         const char *padding;
 171         int required;
 172         int ret, i;
 173
 174         debug("%s  %s node:    '%s'\n", p, type,
 175               fit_get_name(fit, noffset, NULL));
 176         printf("%s  %s algo:    ", p, type);
 177         if (fit_image_hash_get_algo(fit, noffset, &algo)) {
 178                 printf("invalid/unsupported\n");
 179                 return;
 180         }
 181         printf("%s", algo);
 182         keyname = fdt_getprop(fit, noffset, "key-name-hint", NULL);
 183         required = fdt_getprop(fit, noffset, "required", NULL) != NULL;
 184         if (keyname)
 185                 printf(":%s", keyname);
 186         if (required)
 187                 printf(" (required)");
 188         printf("\n");
 189
 190         padding = fdt_getprop(fit, noffset, "padding", NULL);
 191         if (padding)
 192                 printf("%s  %s padding: %s\n", p, type, padding);
 193
 194         ret = fit_image_hash_get_value(fit, noffset, &value,
 195                                        &value_len);
 196         printf("%s  %s value:   ", p, type);
 197         if (ret) {
 198                 printf("unavailable\n");
 199         } else {
 200                 for (i = 0; i < value_len; i++)
 201                         printf("%02x", value[i]);
 202                 printf("\n");
 203         }
 204
 205         debug("%s  %s len:     %d\n", p, type, value_len);
 206
 207         /* Signatures have a time stamp */
 208         if (IMAGE_ENABLE_TIMESTAMP && keyname) {
 209                 time_t timestamp;
 210
 211                 printf("%s  Timestamp:    ", p);
 212                 if (fit_get_timestamp(fit, noffset, &timestamp))
 213                         printf("unavailable\n");
 214                 else
 215                         genimg_print_time(timestamp);
 216         }
 217 }
 218
 219 /**
 220  * fit_image_print_verification_data() - prints out the hash/signature details
 221  * @fit: pointer to the FIT format image header
 222  * @noffset: offset of the hash or signature node
 223  * @p: pointer to prefix string
 224  *
 225  * This lists properties for the processed hash node
 226  *
 227  * returns:
 228  *     no returned results
 229  */
 230 static void fit_image_print_verification_data(const void *fit, int noffset,
 231                                               const char *p)
 232 {
 233         const char *name;
 234
 235         /*
 236          * Check subnode name, must be equal to "hash" or "signature".
 237          * Multiple hash/signature nodes require unique unit node
 238          * names, e.g. hash-1, hash-2, signature-1, signature-2, etc.
 239          */
 240         name = fit_get_name(fit, noffset, NULL);
 241         if (!strncmp(name, FIT_HASH_NODENAME, strlen(FIT_HASH_NODENAME))) {
 242                 fit_image_print_data(fit, noffset, p, "Hash");
 243         } else if (!strncmp(name, FIT_SIG_NODENAME,
 244                                 strlen(FIT_SIG_NODENAME))) {
 245                 fit_image_print_data(fit, noffset, p, "Sign");
 246         }
 247 }
 248
 249 /**
 250  * fit_conf_print - prints out the FIT configuration details
 251  * @fit: pointer to the FIT format image header
 252  * @noffset: offset of the configuration node
 253  * @p: pointer to prefix string
 254  *
 255  * fit_conf_print() lists all mandatory properties for the processed
 256  * configuration node.
 257  *
 258  * returns:
 259  *     no returned results
 260  */
 261 static void fit_conf_print(const void *fit, int noffset, const char *p)
 262 {
 263         char *desc;
 264         const char *uname;
 265         int ret;
 266         int fdt_index, loadables_index;
 267         int ndepth;
 268
 269         /* Mandatory properties */
 270         ret = fit_get_desc(fit, noffset, &desc);
 271         printf("%s  Description:  ", p);
 272         if (ret)
 273                 printf("unavailable\n");
 274         else
 275                 printf("%s\n", desc);
 276
 277         uname = fdt_getprop(fit, noffset, FIT_KERNEL_PROP, NULL);
 278         printf("%s  Kernel:       ", p);
 279         if (!uname)
 280                 printf("unavailable\n");
 281         else
 282                 printf("%s\n", uname);
 283
 284         /* Optional properties */
 285         uname = fdt_getprop(fit, noffset, FIT_RAMDISK_PROP, NULL);
 286         if (uname)
 287                 printf("%s  Init Ramdisk: %s\n", p, uname);
 288
 289         uname = fdt_getprop(fit, noffset, FIT_FIRMWARE_PROP, NULL);
 290         if (uname)
 291                 printf("%s  Firmware:     %s\n", p, uname);
 292
 293         for (fdt_index = 0;
 294              uname = fdt_stringlist_get(fit, noffset, FIT_FDT_PROP,
 295                                         fdt_index, NULL), uname;
 296              fdt_index++) {
 297                 if (fdt_index == 0)
 298                         printf("%s  FDT:          ", p);
 299                 else
 300                         printf("%s                ", p);
 301                 printf("%s\n", uname);
 302         }
 303
 304         uname = fdt_getprop(fit, noffset, FIT_FPGA_PROP, NULL);
 305         if (uname)
 306                 printf("%s  FPGA:         %s\n", p, uname);
 307
 308         /* Print out all of the specified loadables */
 309         for (loadables_index = 0;
 310              uname = fdt_stringlist_get(fit, noffset, FIT_LOADABLE_PROP,
 311                                         loadables_index, NULL), uname;
 312              loadables_index++) {
 313                 if (loadables_index == 0) {
 314                         printf("%s  Loadables:    ", p);
 315                 } else {
 316                         printf("%s                ", p);
 317                 }
 318                 printf("%s\n", uname);
 319         }
 320
 321         /* Process all hash subnodes of the component configuration node */
 322         for (ndepth = 0, noffset = fdt_next_node(fit, noffset, &ndepth);
 323              (noffset >= 0) && (ndepth > 0);
 324              noffset = fdt_next_node(fit, noffset, &ndepth)) {
 325                 if (ndepth == 1) {
 326                         /* Direct child node of the component configuration node */
 327                         fit_image_print_verification_data(fit, noffset, p);
 328                 }
 329         }
 330 }
 331
 332 /**
 333  * fit_print_contents - prints out the contents of the FIT format image
 334  * @fit: pointer to the FIT format image header
 335  * @p: pointer to prefix string
 336  *
 337  * fit_print_contents() formats a multi line FIT image contents description.
 338  * The routine prints out FIT image properties (root node level) followed by
 339  * the details of each component image.
 340  *
 341  * returns:
 342  *     no returned results
 343  */
 344 void fit_print_contents(const void *fit)
 345 {
 346         char *desc;
 347         char *uname;
 348         int images_noffset;
 349         int confs_noffset;
 350         int noffset;
 351         int ndepth;
 352         int count = 0;
 353         int ret;
 354         const char *p;
 355         time_t timestamp;
 356
 357         /* Indent string is defined in header image.h */
 358         p = IMAGE_INDENT_STRING;
 359
 360         /* Root node properties */
 361         ret = fit_get_desc(fit, 0, &desc);
 362         printf("%sFIT description: ", p);
 363         if (ret)
 364                 printf("unavailable\n");
 365         else
 366                 printf("%s\n", desc);
 367
 368         if (IMAGE_ENABLE_TIMESTAMP) {
 369                 ret = fit_get_timestamp(fit, 0, &timestamp);
 370                 printf("%sCreated:         ", p);
 371                 if (ret)
 372                         printf("unavailable\n");
 373                 else
 374                         genimg_print_time(timestamp);
 375         }
 376
 377         /* Find images parent node offset */
 378         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
 379         if (images_noffset < 0) {
 380                 printf("Can't find images parent node '%s' (%s)\n",
 381                        FIT_IMAGES_PATH, fdt_strerror(images_noffset));
 382                 return;
 383         }
 384
 385         /* Process its subnodes, print out component images details */
 386         for (ndepth = 0, count = 0,
 387                 noffset = fdt_next_node(fit, images_noffset, &ndepth);
 388              (noffset >= 0) && (ndepth > 0);
 389              noffset = fdt_next_node(fit, noffset, &ndepth)) {
 390                 if (ndepth == 1) {
 391                         /*
 392                          * Direct child node of the images parent node,
 393                          * i.e. component image node.
 394                          */
 395                         printf("%s Image %u (%s)\n", p, count++,
 396                                fit_get_name(fit, noffset, NULL));
 397
 398                         fit_image_print(fit, noffset, p);
 399                 }
 400         }
 401
 402         /* Find configurations parent node offset */
 403         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
 404         if (confs_noffset < 0) {
 405                 debug("Can't get configurations parent node '%s' (%s)\n",
 406                       FIT_CONFS_PATH, fdt_strerror(confs_noffset));
 407                 return;
 408         }
 409
 410         /* get default configuration unit name from default property */
 411         uname = (char *)fdt_getprop(fit, noffset, FIT_DEFAULT_PROP, NULL);
 412         if (uname)
 413                 printf("%s Default Configuration: '%s'\n", p, uname);
 414
 415         /* Process its subnodes, print out configurations details */
 416         for (ndepth = 0, count = 0,
 417                 noffset = fdt_next_node(fit, confs_noffset, &ndepth);
 418              (noffset >= 0) && (ndepth > 0);
 419              noffset = fdt_next_node(fit, noffset, &ndepth)) {
 420                 if (ndepth == 1) {
 421                         /*
 422                          * Direct child node of the configurations parent node,
 423                          * i.e. configuration node.
 424                          */
 425                         printf("%s Configuration %u (%s)\n", p, count++,
 426                                fit_get_name(fit, noffset, NULL));
 427
 428                         fit_conf_print(fit, noffset, p);
 429                 }
 430         }
 431 }
 432
 433 /**
 434  * fit_image_print - prints out the FIT component image details
 435  * @fit: pointer to the FIT format image header
 436  * @image_noffset: offset of the component image node
 437  * @p: pointer to prefix string
 438  *
 439  * fit_image_print() lists all mandatory properties for the processed component
 440  * image. If present, hash nodes are printed out as well. Load
 441  * address for images of type firmware is also printed out. Since the load
 442  * address is not mandatory for firmware images, it will be output as
 443  * "unavailable" when not present.
 444  *
 445  * returns:
 446  *     no returned results
 447  */
 448 void fit_image_print(const void *fit, int image_noffset, const char *p)
 449 {
 450         char *desc;
 451         uint8_t type, arch, os, comp;
 452         size_t size;
 453         ulong load, entry;
 454         const void *data;
 455         int noffset;
 456         int ndepth;
 457         int ret;
 458
 459         /* Mandatory properties */
 460         ret = fit_get_desc(fit, image_noffset, &desc);
 461         printf("%s  Description:  ", p);
 462         if (ret)
 463                 printf("unavailable\n");
 464         else
 465                 printf("%s\n", desc);
 466
 467         if (IMAGE_ENABLE_TIMESTAMP) {
 468                 time_t timestamp;
 469
 470                 ret = fit_get_timestamp(fit, 0, &timestamp);
 471                 printf("%s  Created:      ", p);
 472                 if (ret)
 473                         printf("unavailable\n");
 474                 else
 475                         genimg_print_time(timestamp);
 476         }
 477
 478         fit_image_get_type(fit, image_noffset, &type);
 479         printf("%s  Type:         %s\n", p, genimg_get_type_name(type));
 480
 481         fit_image_get_comp(fit, image_noffset, &comp);
 482         printf("%s  Compression:  %s\n", p, genimg_get_comp_name(comp));
 483
 484         ret = fit_image_get_data_and_size(fit, image_noffset, &data, &size);
 485
 486 #ifndef USE_HOSTCC
 487         printf("%s  Data Start:   ", p);
 488         if (ret) {
 489                 printf("unavailable\n");
 490         } else {
 491                 void *vdata = (void *)data;
 492
 493                 printf("0x%08lx\n", (ulong)map_to_sysmem(vdata));
 494         }
 495 #endif
 496
 497         printf("%s  Data Size:    ", p);
 498         if (ret)
 499                 printf("unavailable\n");
 500         else
 501                 genimg_print_size(size);
 502
 503         /* Remaining, type dependent properties */
 504         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
 505             (type == IH_TYPE_RAMDISK) || (type == IH_TYPE_FIRMWARE) ||
 506             (type == IH_TYPE_FLATDT)) {
 507                 fit_image_get_arch(fit, image_noffset, &arch);
 508                 printf("%s  Architecture: %s\n", p, genimg_get_arch_name(arch));
 509         }
 510
 511         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_RAMDISK) ||
 512             (type == IH_TYPE_FIRMWARE)) {
 513                 fit_image_get_os(fit, image_noffset, &os);
 514                 printf("%s  OS:           %s\n", p, genimg_get_os_name(os));
 515         }
 516
 517         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
 518             (type == IH_TYPE_FIRMWARE) || (type == IH_TYPE_RAMDISK) ||
 519             (type == IH_TYPE_FPGA)) {
 520                 ret = fit_image_get_load(fit, image_noffset, &load);
 521                 printf("%s  Load Address: ", p);
 522                 if (ret)
 523                         printf("unavailable\n");
 524                 else
 525                         printf("0x%08lx\n", load);
 526         }
 527
 528         /* optional load address for FDT */
 529         if (type == IH_TYPE_FLATDT && !fit_image_get_load(fit, image_noffset, &load))
 530                 printf("%s  Load Address: 0x%08lx\n", p, load);
 531
 532         if ((type == IH_TYPE_KERNEL) || (type == IH_TYPE_STANDALONE) ||
 533             (type == IH_TYPE_RAMDISK)) {
 534                 ret = fit_image_get_entry(fit, image_noffset, &entry);
 535                 printf("%s  Entry Point:  ", p);
 536                 if (ret)
 537                         printf("unavailable\n");
 538                 else
 539                         printf("0x%08lx\n", entry);
 540         }
 541
 542         /* Process all hash subnodes of the component image node */
 543         for (ndepth = 0, noffset = fdt_next_node(fit, image_noffset, &ndepth);
 544              (noffset >= 0) && (ndepth > 0);
 545              noffset = fdt_next_node(fit, noffset, &ndepth)) {
 546                 if (ndepth == 1) {
 547                         /* Direct child node of the component image node */
 548                         fit_image_print_verification_data(fit, noffset, p);
 549                 }
 550         }
 551 }
 552 #else
 553 void fit_print_contents(const void *fit) { }
 554 void fit_image_print(const void *fit, int image_noffset, const char *p) { }
 555 #endif /* !defined(CONFIG_SPL_BUILD) || defined(CONFIG_SPL_FIT_PRINT) */
 556
 557 /**
 558  * fit_get_desc - get node description property
 559  * @fit: pointer to the FIT format image header
 560  * @noffset: node offset
 561  * @desc: double pointer to the char, will hold pointer to the description
 562  *
 563  * fit_get_desc() reads description property from a given node, if
 564  * description is found pointer to it is returned in third call argument.
 565  *
 566  * returns:
 567  *     0, on success
 568  *     -1, on failure
 569  */
 570 int fit_get_desc(const void *fit, int noffset, char **desc)
 571 {
 572         int len;
 573
 574         *desc = (char *)fdt_getprop(fit, noffset, FIT_DESC_PROP, &len);
 575         if (*desc == NULL) {
 576                 fit_get_debug(fit, noffset, FIT_DESC_PROP, len);
 577                 return -1;
 578         }
 579
 580         return 0;
 581 }
 582
 583 /**
 584  * fit_get_timestamp - get node timestamp property
 585  * @fit: pointer to the FIT format image header
 586  * @noffset: node offset
 587  * @timestamp: pointer to the time_t, will hold read timestamp
 588  *
 589  * fit_get_timestamp() reads timestamp property from given node, if timestamp
 590  * is found and has a correct size its value is returned in third call
 591  * argument.
 592  *
 593  * returns:
 594  *     0, on success
 595  *     -1, on property read failure
 596  *     -2, on wrong timestamp size
 597  */
 598 int fit_get_timestamp(const void *fit, int noffset, time_t *timestamp)
 599 {
 600         int len;
 601         const void *data;
 602
 603         data = fdt_getprop(fit, noffset, FIT_TIMESTAMP_PROP, &len);
 604         if (data == NULL) {
 605                 fit_get_debug(fit, noffset, FIT_TIMESTAMP_PROP, len);
 606                 return -1;
 607         }
 608         if (len != sizeof(uint32_t)) {
 609                 debug("FIT timestamp with incorrect size of (%u)\n", len);
 610                 return -2;
 611         }
 612
 613         *timestamp = uimage_to_cpu(*((uint32_t *)data));
 614         return 0;
 615 }
 616
 617 /**
 618  * fit_image_get_node - get node offset for component image of a given unit name
 619  * @fit: pointer to the FIT format image header
 620  * @image_uname: component image node unit name
 621  *
 622  * fit_image_get_node() finds a component image (within the '/images'
 623  * node) of a provided unit name. If image is found its node offset is
 624  * returned to the caller.
 625  *
 626  * returns:
 627  *     image node offset when found (>=0)
 628  *     negative number on failure (FDT_ERR_* code)
 629  */
 630 int fit_image_get_node(const void *fit, const char *image_uname)
 631 {
 632         int noffset, images_noffset;
 633
 634         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
 635         if (images_noffset < 0) {
 636                 debug("Can't find images parent node '%s' (%s)\n",
 637                       FIT_IMAGES_PATH, fdt_strerror(images_noffset));
 638                 return images_noffset;
 639         }
 640
 641         noffset = fdt_subnode_offset(fit, images_noffset, image_uname);
 642         if (noffset < 0) {
 643                 debug("Can't get node offset for image unit name: '%s' (%s)\n",
 644                       image_uname, fdt_strerror(noffset));
 645         }
 646
 647         return noffset;
 648 }
 649
 650 /**
 651  * fit_image_get_os - get os id for a given component image node
 652  * @fit: pointer to the FIT format image header
 653  * @noffset: component image node offset
 654  * @os: pointer to the uint8_t, will hold os numeric id
 655  *
 656  * fit_image_get_os() finds os property in a given component image node.
 657  * If the property is found, its (string) value is translated to the numeric
 658  * id which is returned to the caller.
 659  *
 660  * returns:
 661  *     0, on success
 662  *     -1, on failure
 663  */
 664 int fit_image_get_os(const void *fit, int noffset, uint8_t *os)
 665 {
 666         int len;
 667         const void *data;
 668
 669         /* Get OS name from property data */
 670         data = fdt_getprop(fit, noffset, FIT_OS_PROP, &len);
 671         if (data == NULL) {
 672                 fit_get_debug(fit, noffset, FIT_OS_PROP, len);
 673                 *os = -1;
 674                 return -1;
 675         }
 676
 677         /* Translate OS name to id */
 678         *os = genimg_get_os_id(data);
 679         return 0;
 680 }
 681
 682 /**
 683  * fit_image_get_arch - get arch id for a given component image node
 684  * @fit: pointer to the FIT format image header
 685  * @noffset: component image node offset
 686  * @arch: pointer to the uint8_t, will hold arch numeric id
 687  *
 688  * fit_image_get_arch() finds arch property in a given component image node.
 689  * If the property is found, its (string) value is translated to the numeric
 690  * id which is returned to the caller.
 691  *
 692  * returns:
 693  *     0, on success
 694  *     -1, on failure
 695  */
 696 int fit_image_get_arch(const void *fit, int noffset, uint8_t *arch)
 697 {
 698         int len;
 699         const void *data;
 700
 701         /* Get architecture name from property data */
 702         data = fdt_getprop(fit, noffset, FIT_ARCH_PROP, &len);
 703         if (data == NULL) {
 704                 fit_get_debug(fit, noffset, FIT_ARCH_PROP, len);
 705                 *arch = -1;
 706                 return -1;
 707         }
 708
 709         /* Translate architecture name to id */
 710         *arch = genimg_get_arch_id(data);
 711         return 0;
 712 }
 713
 714 /**
 715  * fit_image_get_type - get type id for a given component image node
 716  * @fit: pointer to the FIT format image header
 717  * @noffset: component image node offset
 718  * @type: pointer to the uint8_t, will hold type numeric id
 719  *
 720  * fit_image_get_type() finds type property in a given component image node.
 721  * If the property is found, its (string) value is translated to the numeric
 722  * id which is returned to the caller.
 723  *
 724  * returns:
 725  *     0, on success
 726  *     -1, on failure
 727  */
 728 int fit_image_get_type(const void *fit, int noffset, uint8_t *type)
 729 {
 730         int len;
 731         const void *data;
 732
 733         /* Get image type name from property data */
 734         data = fdt_getprop(fit, noffset, FIT_TYPE_PROP, &len);
 735         if (data == NULL) {
 736                 fit_get_debug(fit, noffset, FIT_TYPE_PROP, len);
 737                 *type = -1;
 738                 return -1;
 739         }
 740
 741         /* Translate image type name to id */
 742         *type = genimg_get_type_id(data);
 743         return 0;
 744 }
 745
 746 /**
 747  * fit_image_get_comp - get comp id for a given component image node
 748  * @fit: pointer to the FIT format image header
 749  * @noffset: component image node offset
 750  * @comp: pointer to the uint8_t, will hold comp numeric id
 751  *
 752  * fit_image_get_comp() finds comp property in a given component image node.
 753  * If the property is found, its (string) value is translated to the numeric
 754  * id which is returned to the caller.
 755  *
 756  * returns:
 757  *     0, on success
 758  *     -1, on failure
 759  */
 760 int fit_image_get_comp(const void *fit, int noffset, uint8_t *comp)
 761 {
 762         int len;
 763         const void *data;
 764
 765         /* Get compression name from property data */
 766         data = fdt_getprop(fit, noffset, FIT_COMP_PROP, &len);
 767         if (data == NULL) {
 768                 fit_get_debug(fit, noffset, FIT_COMP_PROP, len);
 769                 *comp = -1;
 770                 return -1;
 771         }
 772
 773         /* Translate compression name to id */
 774         *comp = genimg_get_comp_id(data);
 775         return 0;
 776 }
 777
 778 static int fit_image_get_address(const void *fit, int noffset, char *name,
 779                           ulong *load)
 780 {
 781         int len, cell_len;
 782         const fdt32_t *cell;
 783         uint64_t load64 = 0;
 784
 785         cell = fdt_getprop(fit, noffset, name, &len);
 786         if (cell == NULL) {
 787                 fit_get_debug(fit, noffset, name, len);
 788                 return -1;
 789         }
 790
 791         if (len > sizeof(ulong)) {
 792                 printf("Unsupported %s address size\n", name);
 793                 return -1;
 794         }
 795
 796         cell_len = len >> 2;
 797         /* Use load64 to avoid compiling warning for 32-bit target */
 798         while (cell_len--) {
 799                 load64 = (load64 << 32) | uimage_to_cpu(*cell);
 800                 cell++;
 801         }
 802         *load = (ulong)load64;
 803
 804         return 0;
 805 }
 806 /**
 807  * fit_image_get_load() - get load addr property for given component image node
 808  * @fit: pointer to the FIT format image header
 809  * @noffset: component image node offset
 810  * @load: pointer to the uint32_t, will hold load address
 811  *
 812  * fit_image_get_load() finds load address property in a given component
 813  * image node. If the property is found, its value is returned to the caller.
 814  *
 815  * returns:
 816  *     0, on success
 817  *     -1, on failure
 818  */
 819 int fit_image_get_load(const void *fit, int noffset, ulong *load)
 820 {
 821         return fit_image_get_address(fit, noffset, FIT_LOAD_PROP, load);
 822 }
 823
 824 /**
 825  * fit_image_get_entry() - get entry point address property
 826  * @fit: pointer to the FIT format image header
 827  * @noffset: component image node offset
 828  * @entry: pointer to the uint32_t, will hold entry point address
 829  *
 830  * This gets the entry point address property for a given component image
 831  * node.
 832  *
 833  * fit_image_get_entry() finds entry point address property in a given
 834  * component image node.  If the property is found, its value is returned
 835  * to the caller.
 836  *
 837  * returns:
 838  *     0, on success
 839  *     -1, on failure
 840  */
 841 int fit_image_get_entry(const void *fit, int noffset, ulong *entry)
 842 {
 843         return fit_image_get_address(fit, noffset, FIT_ENTRY_PROP, entry);
 844 }
 845
 846 /**
 847  * fit_image_get_data - get data property and its size for a given component image node
 848  * @fit: pointer to the FIT format image header
 849  * @noffset: component image node offset
 850  * @data: double pointer to void, will hold data property's data address
 851  * @size: pointer to size_t, will hold data property's data size
 852  *
 853  * fit_image_get_data() finds data property in a given component image node.
 854  * If the property is found its data start address and size are returned to
 855  * the caller.
 856  *
 857  * returns:
 858  *     0, on success
 859  *     -1, on failure
 860  */
 861 int fit_image_get_data(const void *fit, int noffset,
 862                 const void **data, size_t *size)
 863 {
 864         int len;
 865
 866         *data = fdt_getprop(fit, noffset, FIT_DATA_PROP, &len);
 867         if (*data == NULL) {
 868                 fit_get_debug(fit, noffset, FIT_DATA_PROP, len);
 869                 *size = 0;
 870                 return -1;
 871         }
 872
 873         *size = len;
 874         return 0;
 875 }
 876
 877 /**
 878  * Get 'data-offset' property from a given image node.
 879  *
 880  * @fit: pointer to the FIT image header
 881  * @noffset: component image node offset
 882  * @data_offset: holds the data-offset property
 883  *
 884  * returns:
 885  *     0, on success
 886  *     -ENOENT if the property could not be found
 887  */
 888 int fit_image_get_data_offset(const void *fit, int noffset, int *data_offset)
 889 {
 890         const fdt32_t *val;
 891
 892         val = fdt_getprop(fit, noffset, FIT_DATA_OFFSET_PROP, NULL);
 893         if (!val)
 894                 return -ENOENT;
 895
 896         *data_offset = fdt32_to_cpu(*val);
 897
 898         return 0;
 899 }
 900
 901 /**
 902  * Get 'data-position' property from a given image node.
 903  *
 904  * @fit: pointer to the FIT image header
 905  * @noffset: component image node offset
 906  * @data_position: holds the data-position property
 907  *
 908  * returns:
 909  *     0, on success
 910  *     -ENOENT if the property could not be found
 911  */
 912 int fit_image_get_data_position(const void *fit, int noffset,
 913                                 int *data_position)
 914 {
 915         const fdt32_t *val;
 916
 917         val = fdt_getprop(fit, noffset, FIT_DATA_POSITION_PROP, NULL);
 918         if (!val)
 919                 return -ENOENT;
 920
 921         *data_position = fdt32_to_cpu(*val);
 922
 923         return 0;
 924 }
 925
 926 /**
 927  * Get 'data-size' property from a given image node.
 928  *
 929  * @fit: pointer to the FIT image header
 930  * @noffset: component image node offset
 931  * @data_size: holds the data-size property
 932  *
 933  * returns:
 934  *     0, on success
 935  *     -ENOENT if the property could not be found
 936  */
 937 int fit_image_get_data_size(const void *fit, int noffset, int *data_size)
 938 {
 939         const fdt32_t *val;
 940
 941         val = fdt_getprop(fit, noffset, FIT_DATA_SIZE_PROP, NULL);
 942         if (!val)
 943                 return -ENOENT;
 944
 945         *data_size = fdt32_to_cpu(*val);
 946
 947         return 0;
 948 }
 949
 950 /**
 951  * Get 'data-size-unciphered' property from a given image node.
 952  *
 953  * @fit: pointer to the FIT image header
 954  * @noffset: component image node offset
 955  * @data_size: holds the data-size property
 956  *
 957  * returns:
 958  *     0, on success
 959  *     -ENOENT if the property could not be found
 960  */
 961 int fit_image_get_data_size_unciphered(const void *fit, int noffset,
 962                                        size_t *data_size)
 963 {
 964         const fdt32_t *val;
 965
 966         val = fdt_getprop(fit, noffset, "data-size-unciphered", NULL);
 967         if (!val)
 968                 return -ENOENT;
 969
 970         *data_size = (size_t)fdt32_to_cpu(*val);
 971
 972         return 0;
 973 }
 974
 975 /**
 976  * fit_image_get_data_and_size - get data and its size including
 977  *                               both embedded and external data
 978  * @fit: pointer to the FIT format image header
 979  * @noffset: component image node offset
 980  * @data: double pointer to void, will hold data property's data address
 981  * @size: pointer to size_t, will hold data property's data size
 982  *
 983  * fit_image_get_data_and_size() finds data and its size including
 984  * both embedded and external data. If the property is found
 985  * its data start address and size are returned to the caller.
 986  *
 987  * returns:
 988  *     0, on success
 989  *     otherwise, on failure
 990  */
 991 int fit_image_get_data_and_size(const void *fit, int noffset,
 992                                 const void **data, size_t *size)
 993 {
 994         bool external_data = false;
 995         int offset;
 996         int len;
 997         int ret;
 998
 999         if (!fit_image_get_data_position(fit, noffset, &offset)) {
1000                 external_data = true;
1001         } else if (!fit_image_get_data_offset(fit, noffset, &offset)) {
1002                 external_data = true;
1003                 /*
1004                  * For FIT with external data, figure out where
1005                  * the external images start. This is the base
1006                  * for the data-offset properties in each image.
1007                  */
1008                 offset += ((fdt_totalsize(fit) + 3) & ~3);
1009         }
1010
1011         if (external_data) {
1012                 debug("External Data\n");
1013                 ret = fit_image_get_data_size(fit, noffset, &len);
1014                 *data = fit + offset;
1015                 *size = len;
1016         } else {
1017                 ret = fit_image_get_data(fit, noffset, data, size);
1018         }
1019
1020         return ret;
1021 }
1022
1023 /**
1024  * fit_image_hash_get_algo - get hash algorithm name
1025  * @fit: pointer to the FIT format image header
1026  * @noffset: hash node offset
1027  * @algo: double pointer to char, will hold pointer to the algorithm name
1028  *
1029  * fit_image_hash_get_algo() finds hash algorithm property in a given hash node.
1030  * If the property is found its data start address is returned to the caller.
1031  *
1032  * returns:
1033  *     0, on success
1034  *     -1, on failure
1035  */
1036 int fit_image_hash_get_algo(const void *fit, int noffset, char **algo)
1037 {
1038         int len;
1039
1040         *algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len);
1041         if (*algo == NULL) {
1042                 fit_get_debug(fit, noffset, FIT_ALGO_PROP, len);
1043                 return -1;
1044         }
1045
1046         return 0;
1047 }
1048
1049 /**
1050  * fit_image_hash_get_value - get hash value and length
1051  * @fit: pointer to the FIT format image header
1052  * @noffset: hash node offset
1053  * @value: double pointer to uint8_t, will hold address of a hash value data
1054  * @value_len: pointer to an int, will hold hash data length
1055  *
1056  * fit_image_hash_get_value() finds hash value property in a given hash node.
1057  * If the property is found its data start address and size are returned to
1058  * the caller.
1059  *
1060  * returns:
1061  *     0, on success
1062  *     -1, on failure
1063  */
1064 int fit_image_hash_get_value(const void *fit, int noffset, uint8_t **value,
1065                                 int *value_len)
1066 {
1067         int len;
1068
1069         *value = (uint8_t *)fdt_getprop(fit, noffset, FIT_VALUE_PROP, &len);
1070         if (*value == NULL) {
1071                 fit_get_debug(fit, noffset, FIT_VALUE_PROP, len);
1072                 *value_len = 0;
1073                 return -1;
1074         }
1075
1076         *value_len = len;
1077         return 0;
1078 }
1079
1080 /**
1081  * fit_image_hash_get_ignore - get hash ignore flag
1082  * @fit: pointer to the FIT format image header
1083  * @noffset: hash node offset
1084  * @ignore: pointer to an int, will hold hash ignore flag
1085  *
1086  * fit_image_hash_get_ignore() finds hash ignore property in a given hash node.
1087  * If the property is found and non-zero, the hash algorithm is not verified by
1088  * u-boot automatically.
1089  *
1090  * returns:
1091  *     0, on ignore not found
1092  *     value, on ignore found
1093  */
1094 static int fit_image_hash_get_ignore(const void *fit, int noffset, int *ignore)
1095 {
1096         int len;
1097         int *value;
1098
1099         value = (int *)fdt_getprop(fit, noffset, FIT_IGNORE_PROP, &len);
1100         if (value == NULL || len != sizeof(int))
1101                 *ignore = 0;
1102         else
1103                 *ignore = *value;
1104
1105         return 0;
1106 }
1107
1108 /**
1109  * fit_image_cipher_get_algo - get cipher algorithm name
1110  * @fit: pointer to the FIT format image header
1111  * @noffset: cipher node offset
1112  * @algo: double pointer to char, will hold pointer to the algorithm name
1113  *
1114  * fit_image_cipher_get_algo() finds cipher algorithm property in a given
1115  * cipher node. If the property is found its data start address is returned
1116  * to the caller.
1117  *
1118  * returns:
1119  *     0, on success
1120  *     -1, on failure
1121  */
1122 int fit_image_cipher_get_algo(const void *fit, int noffset, char **algo)
1123 {
1124         int len;
1125
1126         *algo = (char *)fdt_getprop(fit, noffset, FIT_ALGO_PROP, &len);
1127         if (!*algo) {
1128                 fit_get_debug(fit, noffset, FIT_ALGO_PROP, len);
1129                 return -1;
1130         }
1131
1132         return 0;
1133 }
1134
1135 ulong fit_get_end(const void *fit)
1136 {
1137         return map_to_sysmem((void *)(fit + fdt_totalsize(fit)));
1138 }
1139
1140 /**
1141  * fit_set_timestamp - set node timestamp property
1142  * @fit: pointer to the FIT format image header
1143  * @noffset: node offset
1144  * @timestamp: timestamp value to be set
1145  *
1146  * fit_set_timestamp() attempts to set timestamp property in the requested
1147  * node and returns operation status to the caller.
1148  *
1149  * returns:
1150  *     0, on success
1151  *     -ENOSPC if no space in device tree, -1 for other error
1152  */
1153 int fit_set_timestamp(void *fit, int noffset, time_t timestamp)
1154 {
1155         uint32_t t;
1156         int ret;
1157
1158         t = cpu_to_uimage(timestamp);
1159         ret = fdt_setprop(fit, noffset, FIT_TIMESTAMP_PROP, &t,
1160                                 sizeof(uint32_t));
1161         if (ret) {
1162                 debug("Can't set '%s' property for '%s' node (%s)\n",
1163                       FIT_TIMESTAMP_PROP, fit_get_name(fit, noffset, NULL),
1164                       fdt_strerror(ret));
1165                 return ret == -FDT_ERR_NOSPACE ? -ENOSPC : -1;
1166         }
1167
1168         return 0;
1169 }
1170
1171 /**
1172  * calculate_hash - calculate and return hash for provided input data
1173  * @data: pointer to the input data
1174  * @data_len: data length
1175  * @algo: requested hash algorithm
1176  * @value: pointer to the char, will hold hash value data (caller must
1177  * allocate enough free space)
1178  * value_len: length of the calculated hash
1179  *
1180  * calculate_hash() computes input data hash according to the requested
1181  * algorithm.
1182  * Resulting hash value is placed in caller provided 'value' buffer, length
1183  * of the calculated hash is returned via value_len pointer argument.
1184  *
1185  * returns:
1186  *     0, on success
1187  *    -1, when algo is unsupported
1188  */
1189 int calculate_hash(const void *data, int data_len, const char *algo,
1190                         uint8_t *value, int *value_len)
1191 {
1192         if (IMAGE_ENABLE_CRC32 && strcmp(algo, "crc32") == 0) {
1193                 *((uint32_t *)value) = crc32_wd(0, data, data_len,
1194                                                         CHUNKSZ_CRC32);
1195                 *((uint32_t *)value) = cpu_to_uimage(*((uint32_t *)value));
1196                 *value_len = 4;
1197         } else if (IMAGE_ENABLE_SHA1 && strcmp(algo, "sha1") == 0) {
1198                 sha1_csum_wd((unsigned char *)data, data_len,
1199                              (unsigned char *)value, CHUNKSZ_SHA1);
1200                 *value_len = 20;
1201         } else if (IMAGE_ENABLE_SHA256 && strcmp(algo, "sha256") == 0) {
1202                 sha256_csum_wd((unsigned char *)data, data_len,
1203                                (unsigned char *)value, CHUNKSZ_SHA256);
1204                 *value_len = SHA256_SUM_LEN;
1205         } else if (IMAGE_ENABLE_MD5 && strcmp(algo, "md5") == 0) {
1206                 md5_wd((unsigned char *)data, data_len, value, CHUNKSZ_MD5);
1207                 *value_len = 16;
1208         } else {
1209                 debug("Unsupported hash alogrithm\n");
1210                 return -1;
1211         }
1212         return 0;
1213 }
1214
1215 static int fit_image_check_hash(const void *fit, int noffset, const void *data,
1216                                 size_t size, char **err_msgp)
1217 {
1218         uint8_t value[FIT_MAX_HASH_LEN];
1219         int value_len;
1220         char *algo;
1221         uint8_t *fit_value;
1222         int fit_value_len;
1223         int ignore;
1224
1225         *err_msgp = NULL;
1226
1227         if (fit_image_hash_get_algo(fit, noffset, &algo)) {
1228                 *err_msgp = "Can't get hash algo property";
1229                 return -1;
1230         }
1231         printf("%s", algo);
1232
1233         if (IMAGE_ENABLE_IGNORE) {
1234                 fit_image_hash_get_ignore(fit, noffset, &ignore);
1235                 if (ignore) {
1236                         printf("-skipped ");
1237                         return 0;
1238                 }
1239         }
1240
1241         if (fit_image_hash_get_value(fit, noffset, &fit_value,
1242                                      &fit_value_len)) {
1243                 *err_msgp = "Can't get hash value property";
1244                 return -1;
1245         }
1246
1247         if (calculate_hash(data, size, algo, value, &value_len)) {
1248                 *err_msgp = "Unsupported hash algorithm";
1249                 return -1;
1250         }
1251
1252         if (value_len != fit_value_len) {
1253                 *err_msgp = "Bad hash value len";
1254                 return -1;
1255         } else if (memcmp(value, fit_value, value_len) != 0) {
1256                 *err_msgp = "Bad hash value";
1257                 return -1;
1258         }
1259
1260         return 0;
1261 }
1262
1263 int fit_image_verify_with_data(const void *fit, int image_noffset,
1264                                const void *data, size_t size)
1265 {
1266         int             noffset = 0;
1267         char            *err_msg = "";
1268         int verify_all = 1;
1269         int ret;
1270
1271         /* Verify all required signatures */
1272         if (IMAGE_ENABLE_VERIFY &&
1273             fit_image_verify_required_sigs(fit, image_noffset, data, size,
1274                                            gd_fdt_blob(), &verify_all)) {
1275                 err_msg = "Unable to verify required signature";
1276                 goto error;
1277         }
1278
1279         /* Process all hash subnodes of the component image node */
1280         fdt_for_each_subnode(noffset, fit, image_noffset) {
1281                 const char *name = fit_get_name(fit, noffset, NULL);
1282
1283                 /*
1284                  * Check subnode name, must be equal to "hash".
1285                  * Multiple hash nodes require unique unit node
1286                  * names, e.g. hash-1, hash-2, etc.
1287                  */
1288                 if (!strncmp(name, FIT_HASH_NODENAME,
1289                              strlen(FIT_HASH_NODENAME))) {
1290                         if (fit_image_check_hash(fit, noffset, data, size,
1291                                                  &err_msg))
1292                                 goto error;
1293                         puts("+ ");
1294                 } else if (IMAGE_ENABLE_VERIFY && verify_all &&
1295                                 !strncmp(name, FIT_SIG_NODENAME,
1296                                         strlen(FIT_SIG_NODENAME))) {
1297                         ret = fit_image_check_sig(fit, noffset, data,
1298                                                         size, -1, &err_msg);
1299
1300                         /*
1301                          * Show an indication on failure, but do not return
1302                          * an error. Only keys marked 'required' can cause
1303                          * an image validation failure. See the call to
1304                          * fit_image_verify_required_sigs() above.
1305                          */
1306                         if (ret)
1307                                 puts("- ");
1308                         else
1309                                 puts("+ ");
1310                 }
1311         }
1312
1313         if (noffset == -FDT_ERR_TRUNCATED || noffset == -FDT_ERR_BADSTRUCTURE) {
1314                 err_msg = "Corrupted or truncated tree";
1315                 goto error;
1316         }
1317
1318         return 1;
1319
1320 error:
1321         printf(" error!\n%s for '%s' hash node in '%s' image node\n",
1322                err_msg, fit_get_name(fit, noffset, NULL),
1323                fit_get_name(fit, image_noffset, NULL));
1324         return 0;
1325 }
1326
1327 /**
1328  * fit_image_verify - verify data integrity
1329  * @fit: pointer to the FIT format image header
1330  * @image_noffset: component image node offset
1331  *
1332  * fit_image_verify() goes over component image hash nodes,
1333  * re-calculates each data hash and compares with the value stored in hash
1334  * node.
1335  *
1336  * returns:
1337  *     1, if all hashes are valid
1338  *     0, otherwise (or on error)
1339  */
1340 int fit_image_verify(const void *fit, int image_noffset)
1341 {
1342         const void      *data;
1343         size_t          size;
1344         int             noffset = 0;
1345         char            *err_msg = "";
1346
1347         /* Get image data and data length */
1348         if (fit_image_get_data_and_size(fit, image_noffset, &data, &size)) {
1349                 err_msg = "Can't get image data/size";
1350                 printf("error!\n%s for '%s' hash node in '%s' image node\n",
1351                        err_msg, fit_get_name(fit, noffset, NULL),
1352                        fit_get_name(fit, image_noffset, NULL));
1353                 return 0;
1354         }
1355
1356         return fit_image_verify_with_data(fit, image_noffset, data, size);
1357 }
1358
1359 /**
1360  * fit_all_image_verify - verify data integrity for all images
1361  * @fit: pointer to the FIT format image header
1362  *
1363  * fit_all_image_verify() goes over all images in the FIT and
1364  * for every images checks if all it's hashes are valid.
1365  *
1366  * returns:
1367  *     1, if all hashes of all images are valid
1368  *     0, otherwise (or on error)
1369  */
1370 int fit_all_image_verify(const void *fit)
1371 {
1372         int images_noffset;
1373         int noffset;
1374         int ndepth;
1375         int count;
1376
1377         /* Find images parent node offset */
1378         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1379         if (images_noffset < 0) {
1380                 printf("Can't find images parent node '%s' (%s)\n",
1381                        FIT_IMAGES_PATH, fdt_strerror(images_noffset));
1382                 return 0;
1383         }
1384
1385         /* Process all image subnodes, check hashes for each */
1386         printf("## Checking hash(es) for FIT Image at %08lx ...\n",
1387                (ulong)fit);
1388         for (ndepth = 0, count = 0,
1389              noffset = fdt_next_node(fit, images_noffset, &ndepth);
1390                         (noffset >= 0) && (ndepth > 0);
1391                         noffset = fdt_next_node(fit, noffset, &ndepth)) {
1392                 if (ndepth == 1) {
1393                         /*
1394                          * Direct child node of the images parent node,
1395                          * i.e. component image node.
1396                          */
1397                         printf("   Hash(es) for Image %u (%s): ", count,
1398                                fit_get_name(fit, noffset, NULL));
1399                         count++;
1400
1401                         if (!fit_image_verify(fit, noffset))
1402                                 return 0;
1403                         printf("\n");
1404                 }
1405         }
1406         return 1;
1407 }
1408
1409 #ifdef CONFIG_FIT_CIPHER
1410 static int fit_image_uncipher(const void *fit, int image_noffset,
1411                               void **data, size_t *size)
1412 {
1413         int cipher_noffset, ret;
1414         void *dst;
1415         size_t size_dst;
1416
1417         cipher_noffset = fdt_subnode_offset(fit, image_noffset,
1418                                             FIT_CIPHER_NODENAME);
1419         if (cipher_noffset < 0)
1420                 return 0;
1421
1422         ret = fit_image_decrypt_data(fit, image_noffset, cipher_noffset,
1423                                      *data, *size, &dst, &size_dst);
1424         if (ret)
1425                 goto out;
1426
1427         *data = dst;
1428         *size = size_dst;
1429
1430  out:
1431         return ret;
1432 }
1433 #endif /* CONFIG_FIT_CIPHER */
1434
1435 /**
1436  * fit_image_check_os - check whether image node is of a given os type
1437  * @fit: pointer to the FIT format image header
1438  * @noffset: component image node offset
1439  * @os: requested image os
1440  *
1441  * fit_image_check_os() reads image os property and compares its numeric
1442  * id with the requested os. Comparison result is returned to the caller.
1443  *
1444  * returns:
1445  *     1 if image is of given os type
1446  *     0 otherwise (or on error)
1447  */
1448 int fit_image_check_os(const void *fit, int noffset, uint8_t os)
1449 {
1450         uint8_t image_os;
1451
1452         if (fit_image_get_os(fit, noffset, &image_os))
1453                 return 0;
1454         return (os == image_os);
1455 }
1456
1457 /**
1458  * fit_image_check_arch - check whether image node is of a given arch
1459  * @fit: pointer to the FIT format image header
1460  * @noffset: component image node offset
1461  * @arch: requested imagearch
1462  *
1463  * fit_image_check_arch() reads image arch property and compares its numeric
1464  * id with the requested arch. Comparison result is returned to the caller.
1465  *
1466  * returns:
1467  *     1 if image is of given arch
1468  *     0 otherwise (or on error)
1469  */
1470 int fit_image_check_arch(const void *fit, int noffset, uint8_t arch)
1471 {
1472         uint8_t image_arch;
1473         int aarch32_support = 0;
1474
1475 #ifdef CONFIG_ARM64_SUPPORT_AARCH32
1476         aarch32_support = 1;
1477 #endif
1478
1479         if (fit_image_get_arch(fit, noffset, &image_arch))
1480                 return 0;
1481         return (arch == image_arch) ||
1482                 (arch == IH_ARCH_I386 && image_arch == IH_ARCH_X86_64) ||
1483                 (arch == IH_ARCH_ARM64 && image_arch == IH_ARCH_ARM &&
1484                  aarch32_support);
1485 }
1486
1487 /**
1488  * fit_image_check_type - check whether image node is of a given type
1489  * @fit: pointer to the FIT format image header
1490  * @noffset: component image node offset
1491  * @type: requested image type
1492  *
1493  * fit_image_check_type() reads image type property and compares its numeric
1494  * id with the requested type. Comparison result is returned to the caller.
1495  *
1496  * returns:
1497  *     1 if image is of given type
1498  *     0 otherwise (or on error)
1499  */
1500 int fit_image_check_type(const void *fit, int noffset, uint8_t type)
1501 {
1502         uint8_t image_type;
1503
1504         if (fit_image_get_type(fit, noffset, &image_type))
1505                 return 0;
1506         return (type == image_type);
1507 }
1508
1509 /**
1510  * fit_image_check_comp - check whether image node uses given compression
1511  * @fit: pointer to the FIT format image header
1512  * @noffset: component image node offset
1513  * @comp: requested image compression type
1514  *
1515  * fit_image_check_comp() reads image compression property and compares its
1516  * numeric id with the requested compression type. Comparison result is
1517  * returned to the caller.
1518  *
1519  * returns:
1520  *     1 if image uses requested compression
1521  *     0 otherwise (or on error)
1522  */
1523 int fit_image_check_comp(const void *fit, int noffset, uint8_t comp)
1524 {
1525         uint8_t image_comp;
1526
1527         if (fit_image_get_comp(fit, noffset, &image_comp))
1528                 return 0;
1529         return (comp == image_comp);
1530 }
1531
1532 /**
1533  * fit_check_format - sanity check FIT image format
1534  * @fit: pointer to the FIT format image header
1535  *
1536  * fit_check_format() runs a basic sanity FIT image verification.
1537  * Routine checks for mandatory properties, nodes, etc.
1538  *
1539  * returns:
1540  *     1, on success
1541  *     0, on failure
1542  */
1543 int fit_check_format(const void *fit)
1544 {
1545         /* mandatory / node 'description' property */
1546         if (fdt_getprop(fit, 0, FIT_DESC_PROP, NULL) == NULL) {
1547                 debug("Wrong FIT format: no description\n");
1548                 return 0;
1549         }
1550
1551         if (IMAGE_ENABLE_TIMESTAMP) {
1552                 /* mandatory / node 'timestamp' property */
1553                 if (fdt_getprop(fit, 0, FIT_TIMESTAMP_PROP, NULL) == NULL) {
1554                         debug("Wrong FIT format: no timestamp\n");
1555                         return 0;
1556                 }
1557         }
1558
1559         /* mandatory subimages parent '/images' node */
1560         if (fdt_path_offset(fit, FIT_IMAGES_PATH) < 0) {
1561                 debug("Wrong FIT format: no images parent node\n");
1562                 return 0;
1563         }
1564
1565         return 1;
1566 }
1567
1568
1569 /**
1570  * fit_conf_find_compat
1571  * @fit: pointer to the FIT format image header
1572  * @fdt: pointer to the device tree to compare against
1573  *
1574  * fit_conf_find_compat() attempts to find the configuration whose fdt is the
1575  * most compatible with the passed in device tree.
1576  *
1577  * Example:
1578  *
1579  * / o image-tree
1580  *   |-o images
1581  *   | |-o fdt-1
1582  *   | |-o fdt-2
1583  *   |
1584  *   |-o configurations
1585  *     |-o config-1
1586  *     | |-fdt = fdt-1
1587  *     |
1588  *     |-o config-2
1589  *       |-fdt = fdt-2
1590  *
1591  * / o U-Boot fdt
1592  *   |-compatible = "foo,bar", "bim,bam"
1593  *
1594  * / o kernel fdt1
1595  *   |-compatible = "foo,bar",
1596  *
1597  * / o kernel fdt2
1598  *   |-compatible = "bim,bam", "baz,biz"
1599  *
1600  * Configuration 1 would be picked because the first string in U-Boot's
1601  * compatible list, "foo,bar", matches a compatible string in the root of fdt1.
1602  * "bim,bam" in fdt2 matches the second string which isn't as good as fdt1.
1603  *
1604  * As an optimization, the compatible property from the FDT's root node can be
1605  * copied into the configuration node in the FIT image. This is required to
1606  * match configurations with compressed FDTs.
1607  *
1608  * returns:
1609  *     offset to the configuration to use if one was found
1610  *     -1 otherwise
1611  */
1612 int fit_conf_find_compat(const void *fit, const void *fdt)
1613 {
1614         int ndepth = 0;
1615         int noffset, confs_noffset, images_noffset;
1616         const void *fdt_compat;
1617         int fdt_compat_len;
1618         int best_match_offset = 0;
1619         int best_match_pos = 0;
1620
1621         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1622         images_noffset = fdt_path_offset(fit, FIT_IMAGES_PATH);
1623         if (confs_noffset < 0 || images_noffset < 0) {
1624                 debug("Can't find configurations or images nodes.\n");
1625                 return -1;
1626         }
1627
1628         fdt_compat = fdt_getprop(fdt, 0, "compatible", &fdt_compat_len);
1629         if (!fdt_compat) {
1630                 debug("Fdt for comparison has no \"compatible\" property.\n");
1631                 return -1;
1632         }
1633
1634         /*
1635          * Loop over the configurations in the FIT image.
1636          */
1637         for (noffset = fdt_next_node(fit, confs_noffset, &ndepth);
1638                         (noffset >= 0) && (ndepth > 0);
1639                         noffset = fdt_next_node(fit, noffset, &ndepth)) {
1640                 const void *fdt;
1641                 const char *kfdt_name;
1642                 int kfdt_noffset, compat_noffset;
1643                 const char *cur_fdt_compat;
1644                 int len;
1645                 size_t sz;
1646                 int i;
1647
1648                 if (ndepth > 1)
1649                         continue;
1650
1651                 /* If there's a compat property in the config node, use that. */
1652                 if (fdt_getprop(fit, noffset, "compatible", NULL)) {
1653                         fdt = fit;                /* search in FIT image */
1654                         compat_noffset = noffset; /* search under config node */
1655                 } else {        /* Otherwise extract it from the kernel FDT. */
1656                         kfdt_name = fdt_getprop(fit, noffset, "fdt", &len);
1657                         if (!kfdt_name) {
1658                                 debug("No fdt property found.\n");
1659                                 continue;
1660                         }
1661                         kfdt_noffset = fdt_subnode_offset(fit, images_noffset,
1662                                                           kfdt_name);
1663                         if (kfdt_noffset < 0) {
1664                                 debug("No image node named \"%s\" found.\n",
1665                                       kfdt_name);
1666                                 continue;
1667                         }
1668
1669                         if (!fit_image_check_comp(fit, kfdt_noffset,
1670                                                   IH_COMP_NONE)) {
1671                                 debug("Can't extract compat from \"%s\" "
1672                                       "(compressed)\n", kfdt_name);
1673                                 continue;
1674                         }
1675
1676                         /* search in this config's kernel FDT */
1677                         if (fit_image_get_data(fit, kfdt_noffset, &fdt, &sz)) {
1678                                 debug("Failed to get fdt \"%s\".\n", kfdt_name);
1679                                 continue;
1680                         }
1681
1682                         compat_noffset = 0;  /* search kFDT under root node */
1683                 }
1684
1685                 len = fdt_compat_len;
1686                 cur_fdt_compat = fdt_compat;
1687                 /*
1688                  * Look for a match for each U-Boot compatibility string in
1689                  * turn in the compat string property.
1690                  */
1691                 for (i = 0; len > 0 &&
1692                      (!best_match_offset || best_match_pos > i); i++) {
1693                         int cur_len = strlen(cur_fdt_compat) + 1;
1694
1695                         if (!fdt_node_check_compatible(fdt, compat_noffset,
1696                                                        cur_fdt_compat)) {
1697                                 best_match_offset = noffset;
1698                                 best_match_pos = i;
1699                                 break;
1700                         }
1701                         len -= cur_len;
1702                         cur_fdt_compat += cur_len;
1703                 }
1704         }
1705         if (!best_match_offset) {
1706                 debug("No match found.\n");
1707                 return -1;
1708         }
1709
1710         return best_match_offset;
1711 }
1712
1713 /**
1714  * fit_conf_get_node - get node offset for configuration of a given unit name
1715  * @fit: pointer to the FIT format image header
1716  * @conf_uname: configuration node unit name
1717  *
1718  * fit_conf_get_node() finds a configuration (within the '/configurations'
1719  * parent node) of a provided unit name. If configuration is found its node
1720  * offset is returned to the caller.
1721  *
1722  * When NULL is provided in second argument fit_conf_get_node() will search
1723  * for a default configuration node instead. Default configuration node unit
1724  * name is retrieved from FIT_DEFAULT_PROP property of the '/configurations'
1725  * node.
1726  *
1727  * returns:
1728  *     configuration node offset when found (>=0)
1729  *     negative number on failure (FDT_ERR_* code)
1730  */
1731 int fit_conf_get_node(const void *fit, const char *conf_uname)
1732 {
1733         int noffset, confs_noffset;
1734         int len;
1735         const char *s;
1736         char *conf_uname_copy = NULL;
1737
1738         confs_noffset = fdt_path_offset(fit, FIT_CONFS_PATH);
1739         if (confs_noffset < 0) {
1740                 debug("Can't find configurations parent node '%s' (%s)\n",
1741                       FIT_CONFS_PATH, fdt_strerror(confs_noffset));
1742                 return confs_noffset;
1743         }
1744
1745         if (conf_uname == NULL) {
1746                 /* get configuration unit name from the default property */
1747                 debug("No configuration specified, trying default...\n");
1748                 conf_uname = (char *)fdt_getprop(fit, confs_noffset,
1749                                                  FIT_DEFAULT_PROP, &len);
1750                 if (conf_uname == NULL) {
1751                         fit_get_debug(fit, confs_noffset, FIT_DEFAULT_PROP,
1752                                       len);
1753                         return len;
1754                 }
1755                 debug("Found default configuration: '%s'\n", conf_uname);
1756         }
1757
1758         s = strchr(conf_uname, '#');
1759         if (s) {
1760                 len = s - conf_uname;
1761                 conf_uname_copy = malloc(len + 1);
1762                 if (!conf_uname_copy) {
1763                         debug("Can't allocate uname copy: '%s'\n",
1764                                         conf_uname);
1765                         return -ENOMEM;
1766                 }
1767                 memcpy(conf_uname_copy, conf_uname, len);
1768                 conf_uname_copy[len] = '\0';
1769                 conf_uname = conf_uname_copy;
1770         }
1771
1772         noffset = fdt_subnode_offset(fit, confs_noffset, conf_uname);
1773         if (noffset < 0) {
1774                 debug("Can't get node offset for configuration unit name: '%s' (%s)\n",
1775                       conf_uname, fdt_strerror(noffset));
1776         }
1777
1778         if (conf_uname_copy)
1779                 free(conf_uname_copy);
1780
1781         return noffset;
1782 }
1783
1784 int fit_conf_get_prop_node_count(const void *fit, int noffset,
1785                 const char *prop_name)
1786 {
1787         return fdt_stringlist_count(fit, noffset, prop_name);
1788 }
1789
1790 int fit_conf_get_prop_node_index(const void *fit, int noffset,
1791                 const char *prop_name, int index)
1792 {
1793         const char *uname;
1794         int len;
1795
1796         /* get kernel image unit name from configuration kernel property */
1797         uname = fdt_stringlist_get(fit, noffset, prop_name, index, &len);
1798         if (uname == NULL)
1799                 return len;
1800
1801         return fit_image_get_node(fit, uname);
1802 }
1803
1804 int fit_conf_get_prop_node(const void *fit, int noffset,
1805                 const char *prop_name)
1806 {
1807         return fit_conf_get_prop_node_index(fit, noffset, prop_name, 0);
1808 }
1809
1810 static int fit_image_select(const void *fit, int rd_noffset, int verify)
1811 {
1812         fit_image_print(fit, rd_noffset, "   ");
1813
1814         if (verify) {
1815                 puts("   Verifying Hash Integrity ... ");
1816                 if (!fit_image_verify(fit, rd_noffset)) {
1817                         puts("Bad Data Hash\n");
1818                         return -EACCES;
1819                 }
1820                 puts("OK\n");
1821         }
1822
1823         return 0;
1824 }
1825
1826 int fit_get_node_from_config(bootm_headers_t *images, const char *prop_name,
1827                         ulong addr)
1828 {
1829         int cfg_noffset;
1830         void *fit_hdr;
1831         int noffset;
1832
1833         debug("*  %s: using config '%s' from image at 0x%08lx\n",
1834               prop_name, images->fit_uname_cfg, addr);
1835
1836         /* Check whether configuration has this property defined */
1837         fit_hdr = map_sysmem(addr, 0);
1838         cfg_noffset = fit_conf_get_node(fit_hdr, images->fit_uname_cfg);
1839         if (cfg_noffset < 0) {
1840                 debug("*  %s: no such config\n", prop_name);
1841                 return -EINVAL;
1842         }
1843
1844         noffset = fit_conf_get_prop_node(fit_hdr, cfg_noffset, prop_name);
1845         if (noffset < 0) {
1846                 debug("*  %s: no '%s' in config\n", prop_name, prop_name);
1847                 return -ENOENT;
1848         }
1849
1850         return noffset;
1851 }
1852
1853 /**
1854  * fit_get_image_type_property() - get property name for IH_TYPE_...
1855  *
1856  * @return the properly name where we expect to find the image in the
1857  * config node
1858  */
1859 static const char *fit_get_image_type_property(int type)
1860 {
1861         /*
1862          * This is sort-of available in the uimage_type[] table in image.c
1863          * but we don't have access to the short name, and "fdt" is different
1864          * anyway. So let's just keep it here.
1865          */
1866         switch (type) {
1867         case IH_TYPE_FLATDT:
1868                 return FIT_FDT_PROP;
1869         case IH_TYPE_KERNEL:
1870                 return FIT_KERNEL_PROP;
1871         case IH_TYPE_RAMDISK:
1872                 return FIT_RAMDISK_PROP;
1873         case IH_TYPE_X86_SETUP:
1874                 return FIT_SETUP_PROP;
1875         case IH_TYPE_LOADABLE:
1876                 return FIT_LOADABLE_PROP;
1877         case IH_TYPE_FPGA:
1878                 return FIT_FPGA_PROP;
1879         case IH_TYPE_STANDALONE:
1880                 return FIT_STANDALONE_PROP;
1881         }
1882
1883         return "unknown";
1884 }
1885
1886 int fit_image_load(bootm_headers_t *images, ulong addr,
1887                    const char **fit_unamep, const char **fit_uname_configp,
1888                    int arch, int image_type, int bootstage_id,
1889                    enum fit_load_op load_op, ulong *datap, ulong *lenp)
1890 {
1891         int cfg_noffset, noffset;
1892         const char *fit_uname;
1893         const char *fit_uname_config;
1894         const char *fit_base_uname_config;
1895         const void *fit;
1896         void *buf;
1897         void *loadbuf;
1898         size_t size;
1899         int type_ok, os_ok;
1900         ulong load, load_end, data, len;
1901         uint8_t os, comp;
1902 #ifndef USE_HOSTCC
1903         uint8_t os_arch;
1904 #endif
1905         const char *prop_name;
1906         int ret;
1907
1908         fit = map_sysmem(addr, 0);
1909         fit_uname = fit_unamep ? *fit_unamep : NULL;
1910         fit_uname_config = fit_uname_configp ? *fit_uname_configp : NULL;
1911         fit_base_uname_config = NULL;
1912         prop_name = fit_get_image_type_property(image_type);
1913         printf("## Loading %s from FIT Image at %08lx ...\n", prop_name, addr);
1914
1915         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1916         if (!fit_check_format(fit)) {
1917                 printf("Bad FIT %s image format!\n", prop_name);
1918                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_FORMAT);
1919                 return -ENOEXEC;
1920         }
1921         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_FORMAT_OK);
1922         if (fit_uname) {
1923                 /* get FIT component image node offset */
1924                 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_UNIT_NAME);
1925                 noffset = fit_image_get_node(fit, fit_uname);
1926         } else {
1927                 /*
1928                  * no image node unit name, try to get config
1929                  * node first. If config unit node name is NULL
1930                  * fit_conf_get_node() will try to find default config node
1931                  */
1932                 bootstage_mark(bootstage_id + BOOTSTAGE_SUB_NO_UNIT_NAME);
1933                 if (IMAGE_ENABLE_BEST_MATCH && !fit_uname_config) {
1934                         cfg_noffset = fit_conf_find_compat(fit, gd_fdt_blob());
1935                 } else {
1936                         cfg_noffset = fit_conf_get_node(fit,
1937                                                         fit_uname_config);
1938                 }
1939                 if (cfg_noffset < 0) {
1940                         puts("Could not find configuration node\n");
1941                         bootstage_error(bootstage_id +
1942                                         BOOTSTAGE_SUB_NO_UNIT_NAME);
1943                         return -ENOENT;
1944                 }
1945
1946                 fit_base_uname_config = fdt_get_name(fit, cfg_noffset, NULL);
1947                 printf("   Using '%s' configuration\n", fit_base_uname_config);
1948                 /* Remember this config */
1949                 if (image_type == IH_TYPE_KERNEL)
1950                         images->fit_uname_cfg = fit_base_uname_config;
1951
1952                 if (IMAGE_ENABLE_VERIFY && images->verify) {
1953                         puts("   Verifying Hash Integrity ... ");
1954                         if (fit_config_verify(fit, cfg_noffset)) {
1955                                 puts("Bad Data Hash\n");
1956                                 bootstage_error(bootstage_id +
1957                                         BOOTSTAGE_SUB_HASH);
1958                                 return -EACCES;
1959                         }
1960                         puts("OK\n");
1961                 }
1962
1963                 bootstage_mark(BOOTSTAGE_ID_FIT_CONFIG);
1964
1965                 noffset = fit_conf_get_prop_node(fit, cfg_noffset,
1966                                                  prop_name);
1967                 fit_uname = fit_get_name(fit, noffset, NULL);
1968         }
1969         if (noffset < 0) {
1970                 puts("Could not find subimage node\n");
1971                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_SUBNODE);
1972                 return -ENOENT;
1973         }
1974
1975         printf("   Trying '%s' %s subimage\n", fit_uname, prop_name);
1976
1977         ret = fit_image_select(fit, noffset, images->verify);
1978         if (ret) {
1979                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_HASH);
1980                 return ret;
1981         }
1982
1983         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1984 #if !defined(USE_HOSTCC) && !defined(CONFIG_SANDBOX)
1985         if (!fit_image_check_target_arch(fit, noffset)) {
1986                 puts("Unsupported Architecture\n");
1987                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ARCH);
1988                 return -ENOEXEC;
1989         }
1990 #endif
1991
1992 #ifndef USE_HOSTCC
1993         fit_image_get_arch(fit, noffset, &os_arch);
1994         images->os.arch = os_arch;
1995 #endif
1996
1997         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
1998         type_ok = fit_image_check_type(fit, noffset, image_type) ||
1999                   fit_image_check_type(fit, noffset, IH_TYPE_FIRMWARE) ||
2000                   (image_type == IH_TYPE_KERNEL &&
2001                    fit_image_check_type(fit, noffset, IH_TYPE_KERNEL_NOLOAD));
2002
2003         os_ok = image_type == IH_TYPE_FLATDT ||
2004                 image_type == IH_TYPE_FPGA ||
2005                 fit_image_check_os(fit, noffset, IH_OS_LINUX) ||
2006                 fit_image_check_os(fit, noffset, IH_OS_U_BOOT) ||
2007                 fit_image_check_os(fit, noffset, IH_OS_OPENRTOS) ||
2008                 fit_image_check_os(fit, noffset, IH_OS_EFI);
2009
2010         /*
2011          * If either of the checks fail, we should report an error, but
2012          * if the image type is coming from the "loadables" field, we
2013          * don't care what it is
2014          */
2015         if ((!type_ok || !os_ok) && image_type != IH_TYPE_LOADABLE) {
2016                 fit_image_get_os(fit, noffset, &os);
2017                 printf("No %s %s %s Image\n",
2018                        genimg_get_os_name(os),
2019                        genimg_get_arch_name(arch),
2020                        genimg_get_type_name(image_type));
2021                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL);
2022                 return -EIO;
2023         }
2024
2025         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_CHECK_ALL_OK);
2026
2027         /* get image data address and length */
2028         if (fit_image_get_data_and_size(fit, noffset,
2029                                         (const void **)&buf, &size)) {
2030                 printf("Could not find %s subimage data!\n", prop_name);
2031                 bootstage_error(bootstage_id + BOOTSTAGE_SUB_GET_DATA);
2032                 return -ENOENT;
2033         }
2034
2035 #ifdef CONFIG_FIT_CIPHER
2036         /* Decrypt data before uncompress/move */
2037         if (IMAGE_ENABLE_DECRYPT) {
2038                 puts("   Decrypting Data ... ");
2039                 if (fit_image_uncipher(fit, noffset, &buf, &size)) {
2040                         puts("Error\n");
2041                         return -EACCES;
2042                 }
2043                 puts("OK\n");
2044         }
2045 #endif
2046
2047 #if !defined(USE_HOSTCC) && defined(CONFIG_FIT_IMAGE_POST_PROCESS)
2048         /* perform any post-processing on the image data */
2049         board_fit_image_post_process(&buf, &size);
2050 #endif
2051
2052         len = (ulong)size;
2053
2054         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_GET_DATA_OK);
2055
2056         data = map_to_sysmem(buf);
2057         load = data;
2058         if (load_op == FIT_LOAD_IGNORED) {
2059                 /* Don't load */
2060         } else if (fit_image_get_load(fit, noffset, &load)) {
2061                 if (load_op == FIT_LOAD_REQUIRED) {
2062                         printf("Can't get %s subimage load address!\n",
2063                                prop_name);
2064                         bootstage_error(bootstage_id + BOOTSTAGE_SUB_LOAD);
2065                         return -EBADF;
2066                 }
2067         } else if (load_op != FIT_LOAD_OPTIONAL_NON_ZERO || load) {
2068                 ulong image_start, image_end;
2069
2070                 /*
2071                  * move image data to the load address,
2072                  * make sure we don't overwrite initial image
2073                  */
2074                 image_start = addr;
2075                 image_end = addr + fit_get_size(fit);
2076
2077                 load_end = load + len;
2078                 if (image_type != IH_TYPE_KERNEL &&
2079                     load < image_end && load_end > image_start) {
2080                         printf("Error: %s overwritten\n", prop_name);
2081                         return -EXDEV;
2082                 }
2083
2084                 printf("   Loading %s from 0x%08lx to 0x%08lx\n",
2085                        prop_name, data, load);
2086         } else {
2087                 load = data;    /* No load address specified */
2088         }
2089
2090         comp = IH_COMP_NONE;
2091         loadbuf = buf;
2092         /* Kernel images get decompressed later in bootm_load_os(). */
2093         if (!fit_image_get_comp(fit, noffset, &comp) &&
2094             comp != IH_COMP_NONE &&
2095             !(image_type == IH_TYPE_KERNEL ||
2096               image_type == IH_TYPE_KERNEL_NOLOAD ||
2097               image_type == IH_TYPE_RAMDISK)) {
2098                 ulong max_decomp_len = len * 20;
2099                 if (load == data) {
2100                         loadbuf = malloc(max_decomp_len);
2101                         load = map_to_sysmem(loadbuf);
2102                 } else {
2103                         loadbuf = map_sysmem(load, max_decomp_len);
2104                 }
2105                 if (image_decomp(comp, load, data, image_type,
2106                                 loadbuf, buf, len, max_decomp_len, &load_end)) {
2107                         printf("Error decompressing %s\n", prop_name);
2108
2109                         return -ENOEXEC;
2110                 }
2111                 len = load_end - load;
2112         } else if (load != data) {
2113                 loadbuf = map_sysmem(load, len);
2114                 memcpy(loadbuf, buf, len);
2115         }
2116
2117         if (image_type == IH_TYPE_RAMDISK && comp != IH_COMP_NONE)
2118                 puts("WARNING: 'compression' nodes for ramdisks are deprecated,"
2119                      " please fix your .its file!\n");
2120
2121         /* verify that image data is a proper FDT blob */
2122         if (image_type == IH_TYPE_FLATDT && fdt_check_header(loadbuf)) {
2123                 puts("Subimage data is not a FDT");
2124                 return -ENOEXEC;
2125         }
2126
2127         bootstage_mark(bootstage_id + BOOTSTAGE_SUB_LOAD);
2128
2129         *datap = load;
2130         *lenp = len;
2131         if (fit_unamep)
2132                 *fit_unamep = (char *)fit_uname;
2133         if (fit_uname_configp)
2134                 *fit_uname_configp = (char *)(fit_uname_config ? :
2135                                               fit_base_uname_config);
2136
2137         return noffset;
2138 }
2139
2140 int boot_get_setup_fit(bootm_headers_t *images, uint8_t arch,
2141                         ulong *setup_start, ulong *setup_len)
2142 {
2143         int noffset;
2144         ulong addr;
2145         ulong len;
2146         int ret;
2147
2148         addr = map_to_sysmem(images->fit_hdr_os);
2149         noffset = fit_get_node_from_config(images, FIT_SETUP_PROP, addr);
2150         if (noffset < 0)
2151                 return noffset;
2152
2153         ret = fit_image_load(images, addr, NULL, NULL, arch,
2154                              IH_TYPE_X86_SETUP, BOOTSTAGE_ID_FIT_SETUP_START,
2155                              FIT_LOAD_REQUIRED, setup_start, &len);
2156
2157         return ret;
2158 }
2159
2160 #ifndef USE_HOSTCC
2161 int boot_get_fdt_fit(bootm_headers_t *images, ulong addr,
2162                    const char **fit_unamep, const char **fit_uname_configp,
2163                    int arch, ulong *datap, ulong *lenp)
2164 {
2165         int fdt_noffset, cfg_noffset, count;
2166         const void *fit;
2167         const char *fit_uname = NULL;
2168         const char *fit_uname_config = NULL;
2169         char *fit_uname_config_copy = NULL;
2170         char *next_config = NULL;
2171         ulong load, len;
2172 #ifdef CONFIG_OF_LIBFDT_OVERLAY
2173         ulong image_start, image_end;
2174         ulong ovload, ovlen;
2175         const char *uconfig;
2176         const char *uname;
2177         void *base, *ov;
2178         int i, err, noffset, ov_noffset;
2179 #endif
2180
2181         fit_uname = fit_unamep ? *fit_unamep : NULL;
2182
2183         if (fit_uname_configp && *fit_uname_configp) {
2184                 fit_uname_config_copy = strdup(*fit_uname_configp);
2185                 if (!fit_uname_config_copy)
2186                         return -ENOMEM;
2187
2188                 next_config = strchr(fit_uname_config_copy, '#');
2189                 if (next_config)
2190                         *next_config++ = '\0';
2191                 if (next_config - 1 > fit_uname_config_copy)
2192                         fit_uname_config = fit_uname_config_copy;
2193         }
2194
2195         fdt_noffset = fit_image_load(images,
2196                 addr, &fit_uname, &fit_uname_config,
2197                 arch, IH_TYPE_FLATDT,
2198                 BOOTSTAGE_ID_FIT_FDT_START,
2199                 FIT_LOAD_OPTIONAL, &load, &len);
2200
2201         if (fdt_noffset < 0)
2202                 goto out;
2203
2204         debug("fit_uname=%s, fit_uname_config=%s\n",
2205                         fit_uname ? fit_uname : "<NULL>",
2206                         fit_uname_config ? fit_uname_config : "<NULL>");
2207
2208         fit = map_sysmem(addr, 0);
2209
2210         cfg_noffset = fit_conf_get_node(fit, fit_uname_config);
2211
2212         /* single blob, or error just return as well */
2213         count = fit_conf_get_prop_node_count(fit, cfg_noffset, FIT_FDT_PROP);
2214         if (count <= 1 && !next_config)
2215                 goto out;
2216
2217         /* we need to apply overlays */
2218
2219 #ifdef CONFIG_OF_LIBFDT_OVERLAY
2220         image_start = addr;
2221         image_end = addr + fit_get_size(fit);
2222         /* verify that relocation took place by load address not being in fit */
2223         if (load >= image_start && load < image_end) {
2224                 /* check is simplified; fit load checks for overlaps */
2225                 printf("Overlayed FDT requires relocation\n");
2226                 fdt_noffset = -EBADF;
2227                 goto out;
2228         }
2229
2230         base = map_sysmem(load, len);
2231
2232         /* apply extra configs in FIT first, followed by args */
2233         for (i = 1; ; i++) {
2234                 if (i < count) {
2235                         noffset = fit_conf_get_prop_node_index(fit, cfg_noffset,
2236                                                                FIT_FDT_PROP, i);
2237                         uname = fit_get_name(fit, noffset, NULL);
2238                         uconfig = NULL;
2239                 } else {
2240                         if (!next_config)
2241                                 break;
2242                         uconfig = next_config;
2243                         next_config = strchr(next_config, '#');
2244                         if (next_config)
2245                                 *next_config++ = '\0';
2246                         uname = NULL;
2247
2248                         /*
2249                          * fit_image_load() would load the first FDT from the
2250                          * extra config only when uconfig is specified.
2251                          * Check if the extra config contains multiple FDTs and
2252                          * if so, load them.
2253                          */
2254                         cfg_noffset = fit_conf_get_node(fit, uconfig);
2255
2256                         i = 0;
2257                         count = fit_conf_get_prop_node_count(fit, cfg_noffset,
2258                                                              FIT_FDT_PROP);
2259                 }
2260
2261                 debug("%d: using uname=%s uconfig=%s\n", i, uname, uconfig);
2262
2263                 ov_noffset = fit_image_load(images,
2264                         addr, &uname, &uconfig,
2265                         arch, IH_TYPE_FLATDT,
2266                         BOOTSTAGE_ID_FIT_FDT_START,
2267                         FIT_LOAD_REQUIRED, &ovload, &ovlen);
2268                 if (ov_noffset < 0) {
2269                         printf("load of %s failed\n", uname);
2270                         continue;
2271                 }
2272                 debug("%s loaded at 0x%08lx len=0x%08lx\n",
2273                                 uname, ovload, ovlen);
2274                 ov = map_sysmem(ovload, ovlen);
2275
2276                 base = map_sysmem(load, len + ovlen);
2277                 err = fdt_open_into(base, base, len + ovlen);
2278                 if (err < 0) {
2279                         printf("failed on fdt_open_into\n");
2280                         fdt_noffset = err;
2281                         goto out;
2282                 }
2283                 /* the verbose method prints out messages on error */
2284                 err = fdt_overlay_apply_verbose(base, ov);
2285                 if (err < 0) {
2286                         fdt_noffset = err;
2287                         goto out;
2288                 }
2289                 fdt_pack(base);
2290                 len = fdt_totalsize(base);
2291         }
2292 #else
2293         printf("config with overlays but CONFIG_OF_LIBFDT_OVERLAY not set\n");
2294         fdt_noffset = -EBADF;
2295 #endif
2296
2297 out:
2298         if (datap)
2299                 *datap = load;
2300         if (lenp)
2301                 *lenp = len;
2302         if (fit_unamep)
2303                 *fit_unamep = fit_uname;
2304         if (fit_uname_configp)
2305                 *fit_uname_configp = fit_uname_config;
2306
2307         if (fit_uname_config_copy)
2308                 free(fit_uname_config_copy);
2309         return fdt_noffset;
2310 }
2311 #endif