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