common/image.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2008 Semihalf
   4  *
   5  * (C) Copyright 2000-2006
   6  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   7  */
   8
   9 #ifndef USE_HOSTCC
  10 #include <common.h>
  11 #include <bootstage.h>
  12 #include <cpu_func.h>
  13 #include <env.h>
  14 #include <lmb.h>
  15 #include <log.h>
  16 #include <malloc.h>
  17 #include <asm/cache.h>
  18 #include <u-boot/crc.h>
  19 #include <watchdog.h>
  20
  21 #ifdef CONFIG_SHOW_BOOT_PROGRESS
  22 #include <status_led.h>
  23 #endif
  24
  25 #include <rtc.h>
  26
  27 #include <gzip.h>
  28 #include <image.h>
  29 #include <lz4.h>
  30 #include <mapmem.h>
  31
  32 #if IMAGE_ENABLE_FIT || IMAGE_ENABLE_OF_LIBFDT
  33 #include <linux/libfdt.h>
  34 #include <fdt_support.h>
  35 #include <fpga.h>
  36 #include <xilinx.h>
  37 #endif
  38
  39 #include <u-boot/md5.h>
  40 #include <u-boot/sha1.h>
  41 #include <linux/errno.h>
  42 #include <asm/io.h>
  43
  44 #include <bzlib.h>
  45 #include <linux/lzo.h>
  46 #include <lzma/LzmaTypes.h>
  47 #include <lzma/LzmaDec.h>
  48 #include <lzma/LzmaTools.h>
  49 #include <linux/zstd.h>
  50
  51 #ifdef CONFIG_CMD_BDI
  52 extern int do_bdinfo(struct cmd_tbl *cmdtp, int flag, int argc,
  53                      char *const argv[]);
  54 #endif
  55
  56 DECLARE_GLOBAL_DATA_PTR;
  57
  58 #if CONFIG_IS_ENABLED(LEGACY_IMAGE_FORMAT)
  59 static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch,
  60                                                 int verify);
  61 #endif
  62 #else
  63 #include "mkimage.h"
  64 #include <u-boot/md5.h>
  65 #include <time.h>
  66 #include <image.h>
  67
  68 #ifndef __maybe_unused
  69 # define __maybe_unused         /* unimplemented */
  70 #endif
  71 #endif /* !USE_HOSTCC*/
  72
  73 #include <u-boot/crc.h>
  74 #include <imximage.h>
  75
  76 #ifndef CONFIG_SYS_BARGSIZE
  77 #define CONFIG_SYS_BARGSIZE 512
  78 #endif
  79
  80 static const table_entry_t uimage_arch[] = {
  81         {       IH_ARCH_INVALID,        "invalid",      "Invalid ARCH", },
  82         {       IH_ARCH_ALPHA,          "alpha",        "Alpha",        },
  83         {       IH_ARCH_ARM,            "arm",          "ARM",          },
  84         {       IH_ARCH_I386,           "x86",          "Intel x86",    },
  85         {       IH_ARCH_IA64,           "ia64",         "IA64",         },
  86         {       IH_ARCH_M68K,           "m68k",         "M68K",         },
  87         {       IH_ARCH_MICROBLAZE,     "microblaze",   "MicroBlaze",   },
  88         {       IH_ARCH_MIPS,           "mips",         "MIPS",         },
  89         {       IH_ARCH_MIPS64,         "mips64",       "MIPS 64 Bit",  },
  90         {       IH_ARCH_NIOS2,          "nios2",        "NIOS II",      },
  91         {       IH_ARCH_PPC,            "powerpc",      "PowerPC",      },
  92         {       IH_ARCH_PPC,            "ppc",          "PowerPC",      },
  93         {       IH_ARCH_S390,           "s390",         "IBM S390",     },
  94         {       IH_ARCH_SH,             "sh",           "SuperH",       },
  95         {       IH_ARCH_SPARC,          "sparc",        "SPARC",        },
  96         {       IH_ARCH_SPARC64,        "sparc64",      "SPARC 64 Bit", },
  97         {       IH_ARCH_BLACKFIN,       "blackfin",     "Blackfin",     },
  98         {       IH_ARCH_AVR32,          "avr32",        "AVR32",        },
  99         {       IH_ARCH_NDS32,          "nds32",        "NDS32",        },
 100         {       IH_ARCH_OPENRISC,       "or1k",         "OpenRISC 1000",},
 101         {       IH_ARCH_SANDBOX,        "sandbox",      "Sandbox",      },
 102         {       IH_ARCH_ARM64,          "arm64",        "AArch64",      },
 103         {       IH_ARCH_ARC,            "arc",          "ARC",          },
 104         {       IH_ARCH_X86_64,         "x86_64",       "AMD x86_64",   },
 105         {       IH_ARCH_XTENSA,         "xtensa",       "Xtensa",       },
 106         {       IH_ARCH_RISCV,          "riscv",        "RISC-V",       },
 107         {       -1,                     "",             "",             },
 108 };
 109
 110 static const table_entry_t uimage_os[] = {
 111         {       IH_OS_INVALID,  "invalid",      "Invalid OS",           },
 112         {       IH_OS_ARM_TRUSTED_FIRMWARE, "arm-trusted-firmware", "ARM Trusted Firmware"  },
 113         {       IH_OS_LINUX,    "linux",        "Linux",                },
 114 #if defined(CONFIG_LYNXKDI) || defined(USE_HOSTCC)
 115         {       IH_OS_LYNXOS,   "lynxos",       "LynxOS",               },
 116 #endif
 117         {       IH_OS_NETBSD,   "netbsd",       "NetBSD",               },
 118         {       IH_OS_OSE,      "ose",          "Enea OSE",             },
 119         {       IH_OS_PLAN9,    "plan9",        "Plan 9",               },
 120         {       IH_OS_RTEMS,    "rtems",        "RTEMS",                },
 121         {       IH_OS_TEE,      "tee",          "Trusted Execution Environment" },
 122         {       IH_OS_U_BOOT,   "u-boot",       "U-Boot",               },
 123         {       IH_OS_VXWORKS,  "vxworks",      "VxWorks",              },
 124 #if defined(CONFIG_CMD_ELF) || defined(USE_HOSTCC)
 125         {       IH_OS_QNX,      "qnx",          "QNX",                  },
 126 #endif
 127 #if defined(CONFIG_INTEGRITY) || defined(USE_HOSTCC)
 128         {       IH_OS_INTEGRITY,"integrity",    "INTEGRITY",            },
 129 #endif
 130 #ifdef USE_HOSTCC
 131         {       IH_OS_4_4BSD,   "4_4bsd",       "4_4BSD",               },
 132         {       IH_OS_DELL,     "dell",         "Dell",                 },
 133         {       IH_OS_ESIX,     "esix",         "Esix",                 },
 134         {       IH_OS_FREEBSD,  "freebsd",      "FreeBSD",              },
 135         {       IH_OS_IRIX,     "irix",         "Irix",                 },
 136         {       IH_OS_NCR,      "ncr",          "NCR",                  },
 137         {       IH_OS_OPENBSD,  "openbsd",      "OpenBSD",              },
 138         {       IH_OS_PSOS,     "psos",         "pSOS",                 },
 139         {       IH_OS_SCO,      "sco",          "SCO",                  },
 140         {       IH_OS_SOLARIS,  "solaris",      "Solaris",              },
 141         {       IH_OS_SVR4,     "svr4",         "SVR4",                 },
 142 #endif
 143 #if defined(CONFIG_BOOTM_OPENRTOS) || defined(USE_HOSTCC)
 144         {       IH_OS_OPENRTOS, "openrtos",     "OpenRTOS",             },
 145 #endif
 146         {       IH_OS_OPENSBI,  "opensbi",      "RISC-V OpenSBI",       },
 147         {       IH_OS_EFI,      "efi",          "EFI Firmware" },
 148
 149         {       -1,             "",             "",                     },
 150 };
 151
 152 static const table_entry_t uimage_type[] = {
 153         {       IH_TYPE_AISIMAGE,   "aisimage",   "Davinci AIS image",},
 154         {       IH_TYPE_FILESYSTEM, "filesystem", "Filesystem Image",   },
 155         {       IH_TYPE_FIRMWARE,   "firmware",   "Firmware",           },
 156         {       IH_TYPE_FLATDT,     "flat_dt",    "Flat Device Tree",   },
 157         {       IH_TYPE_GPIMAGE,    "gpimage",    "TI Keystone SPL Image",},
 158         {       IH_TYPE_KERNEL,     "kernel",     "Kernel Image",       },
 159         {       IH_TYPE_KERNEL_NOLOAD, "kernel_noload",  "Kernel Image (no loading done)", },
 160         {       IH_TYPE_KWBIMAGE,   "kwbimage",   "Kirkwood Boot Image",},
 161         {       IH_TYPE_IMXIMAGE,   "imximage",   "Freescale i.MX Boot Image",},
 162         {       IH_TYPE_IMX8IMAGE,  "imx8image",  "NXP i.MX8 Boot Image",},
 163         {       IH_TYPE_IMX8MIMAGE, "imx8mimage", "NXP i.MX8M Boot Image",},
 164         {       IH_TYPE_INVALID,    "invalid",    "Invalid Image",      },
 165         {       IH_TYPE_MULTI,      "multi",      "Multi-File Image",   },
 166         {       IH_TYPE_OMAPIMAGE,  "omapimage",  "TI OMAP SPL With GP CH",},
 167         {       IH_TYPE_PBLIMAGE,   "pblimage",   "Freescale PBL Boot Image",},
 168         {       IH_TYPE_RAMDISK,    "ramdisk",    "RAMDisk Image",      },
 169         {       IH_TYPE_SCRIPT,     "script",     "Script",             },
 170         {       IH_TYPE_SOCFPGAIMAGE, "socfpgaimage", "Altera SoCFPGA CV/AV preloader",},
 171         {       IH_TYPE_SOCFPGAIMAGE_V1, "socfpgaimage_v1", "Altera SoCFPGA A10 preloader",},
 172         {       IH_TYPE_STANDALONE, "standalone", "Standalone Program", },
 173         {       IH_TYPE_UBLIMAGE,   "ublimage",   "Davinci UBL image",},
 174         {       IH_TYPE_MXSIMAGE,   "mxsimage",   "Freescale MXS Boot Image",},
 175         {       IH_TYPE_ATMELIMAGE, "atmelimage", "ATMEL ROM-Boot Image",},
 176         {       IH_TYPE_X86_SETUP,  "x86_setup",  "x86 setup.bin",    },
 177         {       IH_TYPE_LPC32XXIMAGE, "lpc32xximage",  "LPC32XX Boot Image", },
 178         {       IH_TYPE_RKIMAGE,    "rkimage",    "Rockchip Boot Image" },
 179         {       IH_TYPE_RKSD,       "rksd",       "Rockchip SD Boot Image" },
 180         {       IH_TYPE_RKSPI,      "rkspi",      "Rockchip SPI Boot Image" },
 181         {       IH_TYPE_VYBRIDIMAGE, "vybridimage",  "Vybrid Boot Image", },
 182         {       IH_TYPE_ZYNQIMAGE,  "zynqimage",  "Xilinx Zynq Boot Image" },
 183         {       IH_TYPE_ZYNQMPIMAGE, "zynqmpimage", "Xilinx ZynqMP Boot Image" },
 184         {       IH_TYPE_ZYNQMPBIF,  "zynqmpbif",  "Xilinx ZynqMP Boot Image (bif)" },
 185         {       IH_TYPE_FPGA,       "fpga",       "FPGA Image" },
 186         {       IH_TYPE_TEE,        "tee",        "Trusted Execution Environment Image",},
 187         {       IH_TYPE_FIRMWARE_IVT, "firmware_ivt", "Firmware with HABv4 IVT" },
 188         {       IH_TYPE_PMMC,        "pmmc",        "TI Power Management Micro-Controller Firmware",},
 189         {       IH_TYPE_STM32IMAGE, "stm32image", "STMicroelectronics STM32 Image" },
 190         {       IH_TYPE_MTKIMAGE,   "mtk_image",   "MediaTek BootROM loadable Image" },
 191         {       IH_TYPE_COPRO, "copro", "Coprocessor Image"},
 192         {       IH_TYPE_SUNXI_EGON, "sunxi_egon",  "Allwinner eGON Boot Image" },
 193         {       -1,                 "",           "",                   },
 194 };
 195
 196 static const table_entry_t uimage_comp[] = {
 197         {       IH_COMP_NONE,   "none",         "uncompressed",         },
 198         {       IH_COMP_BZIP2,  "bzip2",        "bzip2 compressed",     },
 199         {       IH_COMP_GZIP,   "gzip",         "gzip compressed",      },
 200         {       IH_COMP_LZMA,   "lzma",         "lzma compressed",      },
 201         {       IH_COMP_LZO,    "lzo",          "lzo compressed",       },
 202         {       IH_COMP_LZ4,    "lz4",          "lz4 compressed",       },
 203         {       IH_COMP_ZSTD,   "zstd",         "zstd compressed",      },
 204         {       -1,             "",             "",                     },
 205 };
 206
 207 struct table_info {
 208         const char *desc;
 209         int count;
 210         const table_entry_t *table;
 211 };
 212
 213 static const struct comp_magic_map image_comp[] = {
 214         {       IH_COMP_BZIP2,  "bzip2",        {0x42, 0x5a},},
 215         {       IH_COMP_GZIP,   "gzip",         {0x1f, 0x8b},},
 216         {       IH_COMP_LZMA,   "lzma",         {0x5d, 0x00},},
 217         {       IH_COMP_LZO,    "lzo",          {0x89, 0x4c},},
 218         {       IH_COMP_NONE,   "none",         {},     },
 219 };
 220
 221 static const struct table_info table_info[IH_COUNT] = {
 222         { "architecture", IH_ARCH_COUNT, uimage_arch },
 223         { "compression", IH_COMP_COUNT, uimage_comp },
 224         { "operating system", IH_OS_COUNT, uimage_os },
 225         { "image type", IH_TYPE_COUNT, uimage_type },
 226 };
 227
 228 /*****************************************************************************/
 229 /* Legacy format routines */
 230 /*****************************************************************************/
 231 int image_check_hcrc(const image_header_t *hdr)
 232 {
 233         ulong hcrc;
 234         ulong len = image_get_header_size();
 235         image_header_t header;
 236
 237         /* Copy header so we can blank CRC field for re-calculation */
 238         memmove(&header, (char *)hdr, image_get_header_size());
 239         image_set_hcrc(&header, 0);
 240
 241         hcrc = crc32(0, (unsigned char *)&header, len);
 242
 243         return (hcrc == image_get_hcrc(hdr));
 244 }
 245
 246 int image_check_dcrc(const image_header_t *hdr)
 247 {
 248         ulong data = image_get_data(hdr);
 249         ulong len = image_get_data_size(hdr);
 250         ulong dcrc = crc32_wd(0, (unsigned char *)data, len, CHUNKSZ_CRC32);
 251
 252         return (dcrc == image_get_dcrc(hdr));
 253 }
 254
 255 /**
 256  * image_multi_count - get component (sub-image) count
 257  * @hdr: pointer to the header of the multi component image
 258  *
 259  * image_multi_count() returns number of components in a multi
 260  * component image.
 261  *
 262  * Note: no checking of the image type is done, caller must pass
 263  * a valid multi component image.
 264  *
 265  * returns:
 266  *     number of components
 267  */
 268 ulong image_multi_count(const image_header_t *hdr)
 269 {
 270         ulong i, count = 0;
 271         uint32_t *size;
 272
 273         /* get start of the image payload, which in case of multi
 274          * component images that points to a table of component sizes */
 275         size = (uint32_t *)image_get_data(hdr);
 276
 277         /* count non empty slots */
 278         for (i = 0; size[i]; ++i)
 279                 count++;
 280
 281         return count;
 282 }
 283
 284 /**
 285  * image_multi_getimg - get component data address and size
 286  * @hdr: pointer to the header of the multi component image
 287  * @idx: index of the requested component
 288  * @data: pointer to a ulong variable, will hold component data address
 289  * @len: pointer to a ulong variable, will hold component size
 290  *
 291  * image_multi_getimg() returns size and data address for the requested
 292  * component in a multi component image.
 293  *
 294  * Note: no checking of the image type is done, caller must pass
 295  * a valid multi component image.
 296  *
 297  * returns:
 298  *     data address and size of the component, if idx is valid
 299  *     0 in data and len, if idx is out of range
 300  */
 301 void image_multi_getimg(const image_header_t *hdr, ulong idx,
 302                         ulong *data, ulong *len)
 303 {
 304         int i;
 305         uint32_t *size;
 306         ulong offset, count, img_data;
 307
 308         /* get number of component */
 309         count = image_multi_count(hdr);
 310
 311         /* get start of the image payload, which in case of multi
 312          * component images that points to a table of component sizes */
 313         size = (uint32_t *)image_get_data(hdr);
 314
 315         /* get address of the proper component data start, which means
 316          * skipping sizes table (add 1 for last, null entry) */
 317         img_data = image_get_data(hdr) + (count + 1) * sizeof(uint32_t);
 318
 319         if (idx < count) {
 320                 *len = uimage_to_cpu(size[idx]);
 321                 offset = 0;
 322
 323                 /* go over all indices preceding requested component idx */
 324                 for (i = 0; i < idx; i++) {
 325                         /* add up i-th component size, rounding up to 4 bytes */
 326                         offset += (uimage_to_cpu(size[i]) + 3) & ~3 ;
 327                 }
 328
 329                 /* calculate idx-th component data address */
 330                 *data = img_data + offset;
 331         } else {
 332                 *len = 0;
 333                 *data = 0;
 334         }
 335 }
 336
 337 static void image_print_type(const image_header_t *hdr)
 338 {
 339         const char __maybe_unused *os, *arch, *type, *comp;
 340
 341         os = genimg_get_os_name(image_get_os(hdr));
 342         arch = genimg_get_arch_name(image_get_arch(hdr));
 343         type = genimg_get_type_name(image_get_type(hdr));
 344         comp = genimg_get_comp_name(image_get_comp(hdr));
 345
 346         printf("%s %s %s (%s)\n", arch, os, type, comp);
 347 }
 348
 349 /**
 350  * image_print_contents - prints out the contents of the legacy format image
 351  * @ptr: pointer to the legacy format image header
 352  * @p: pointer to prefix string
 353  *
 354  * image_print_contents() formats a multi line legacy image contents description.
 355  * The routine prints out all header fields followed by the size/offset data
 356  * for MULTI/SCRIPT images.
 357  *
 358  * returns:
 359  *     no returned results
 360  */
 361 void image_print_contents(const void *ptr)
 362 {
 363         const image_header_t *hdr = (const image_header_t *)ptr;
 364         const char __maybe_unused *p;
 365
 366         p = IMAGE_INDENT_STRING;
 367         printf("%sImage Name:   %.*s\n", p, IH_NMLEN, image_get_name(hdr));
 368         if (IMAGE_ENABLE_TIMESTAMP) {
 369                 printf("%sCreated:      ", p);
 370                 genimg_print_time((time_t)image_get_time(hdr));
 371         }
 372         printf("%sImage Type:   ", p);
 373         image_print_type(hdr);
 374         printf("%sData Size:    ", p);
 375         genimg_print_size(image_get_data_size(hdr));
 376         printf("%sLoad Address: %08x\n", p, image_get_load(hdr));
 377         printf("%sEntry Point:  %08x\n", p, image_get_ep(hdr));
 378
 379         if (image_check_type(hdr, IH_TYPE_MULTI) ||
 380                         image_check_type(hdr, IH_TYPE_SCRIPT)) {
 381                 int i;
 382                 ulong data, len;
 383                 ulong count = image_multi_count(hdr);
 384
 385                 printf("%sContents:\n", p);
 386                 for (i = 0; i < count; i++) {
 387                         image_multi_getimg(hdr, i, &data, &len);
 388
 389                         printf("%s   Image %d: ", p, i);
 390                         genimg_print_size(len);
 391
 392                         if (image_check_type(hdr, IH_TYPE_SCRIPT) && i > 0) {
 393                                 /*
 394                                  * the user may need to know offsets
 395                                  * if planning to do something with
 396                                  * multiple files
 397                                  */
 398                                 printf("%s    Offset = 0x%08lx\n", p, data);
 399                         }
 400                 }
 401         } else if (image_check_type(hdr, IH_TYPE_FIRMWARE_IVT)) {
 402                 printf("HAB Blocks:   0x%08x   0x0000   0x%08x\n",
 403                         image_get_load(hdr) - image_get_header_size(),
 404                         (int)(image_get_size(hdr) + image_get_header_size()
 405                         + sizeof(flash_header_v2_t) - 0x2060));
 406         }
 407 }
 408
 409 /**
 410  * print_decomp_msg() - Print a suitable decompression/loading message
 411  *
 412  * @type:       OS type (IH_OS_...)
 413  * @comp_type:  Compression type being used (IH_COMP_...)
 414  * @is_xip:     true if the load address matches the image start
 415  */
 416 static void print_decomp_msg(int comp_type, int type, bool is_xip)
 417 {
 418         const char *name = genimg_get_type_name(type);
 419
 420         if (comp_type == IH_COMP_NONE)
 421                 printf("   %s %s\n", is_xip ? "XIP" : "Loading", name);
 422         else
 423                 printf("   Uncompressing %s\n", name);
 424 }
 425
 426 int image_decomp_type(const unsigned char *buf, ulong len)
 427 {
 428         const struct comp_magic_map *cmagic = image_comp;
 429
 430         if (len < 2)
 431                 return -EINVAL;
 432
 433         for (; cmagic->comp_id > 0; cmagic++) {
 434                 if (!memcmp(buf, cmagic->magic, 2))
 435                         break;
 436         }
 437
 438         return cmagic->comp_id;
 439 }
 440
 441 int image_decomp(int comp, ulong load, ulong image_start, int type,
 442                  void *load_buf, void *image_buf, ulong image_len,
 443                  uint unc_len, ulong *load_end)
 444 {
 445         int ret = 0;
 446
 447         *load_end = load;
 448         print_decomp_msg(comp, type, load == image_start);
 449
 450         /*
 451          * Load the image to the right place, decompressing if needed. After
 452          * this, image_len will be set to the number of uncompressed bytes
 453          * loaded, ret will be non-zero on error.
 454          */
 455         switch (comp) {
 456         case IH_COMP_NONE:
 457                 if (load == image_start)
 458                         break;
 459                 if (image_len <= unc_len)
 460                         memmove_wd(load_buf, image_buf, image_len, CHUNKSZ);
 461                 else
 462                         ret = -ENOSPC;
 463                 break;
 464 #ifdef CONFIG_GZIP
 465         case IH_COMP_GZIP: {
 466                 ret = gunzip(load_buf, unc_len, image_buf, &image_len);
 467                 break;
 468         }
 469 #endif /* CONFIG_GZIP */
 470 #ifdef CONFIG_BZIP2
 471         case IH_COMP_BZIP2: {
 472                 uint size = unc_len;
 473
 474                 /*
 475                  * If we've got less than 4 MB of malloc() space,
 476                  * use slower decompression algorithm which requires
 477                  * at most 2300 KB of memory.
 478                  */
 479                 ret = BZ2_bzBuffToBuffDecompress(load_buf, &size,
 480                         image_buf, image_len,
 481                         CONFIG_SYS_MALLOC_LEN < (4096 * 1024), 0);
 482                 image_len = size;
 483                 break;
 484         }
 485 #endif /* CONFIG_BZIP2 */
 486 #ifdef CONFIG_LZMA
 487         case IH_COMP_LZMA: {
 488                 SizeT lzma_len = unc_len;
 489
 490                 ret = lzmaBuffToBuffDecompress(load_buf, &lzma_len,
 491                                                image_buf, image_len);
 492                 image_len = lzma_len;
 493                 break;
 494         }
 495 #endif /* CONFIG_LZMA */
 496 #ifdef CONFIG_LZO
 497         case IH_COMP_LZO: {
 498                 size_t size = unc_len;
 499
 500                 ret = lzop_decompress(image_buf, image_len, load_buf, &size);
 501                 image_len = size;
 502                 break;
 503         }
 504 #endif /* CONFIG_LZO */
 505 #ifdef CONFIG_LZ4
 506         case IH_COMP_LZ4: {
 507                 size_t size = unc_len;
 508
 509                 ret = ulz4fn(image_buf, image_len, load_buf, &size);
 510                 image_len = size;
 511                 break;
 512         }
 513 #endif /* CONFIG_LZ4 */
 514 #ifdef CONFIG_ZSTD
 515         case IH_COMP_ZSTD: {
 516                 size_t size = unc_len;
 517                 ZSTD_DStream *dstream;
 518                 ZSTD_inBuffer in_buf;
 519                 ZSTD_outBuffer out_buf;
 520                 void *workspace;
 521                 size_t wsize;
 522
 523                 wsize = ZSTD_DStreamWorkspaceBound(image_len);
 524                 workspace = malloc(wsize);
 525                 if (!workspace) {
 526                         debug("%s: cannot allocate workspace of size %zu\n", __func__,
 527                               wsize);
 528                         return -1;
 529                 }
 530
 531                 dstream = ZSTD_initDStream(image_len, workspace, wsize);
 532                 if (!dstream) {
 533                         printf("%s: ZSTD_initDStream failed\n", __func__);
 534                         return ZSTD_getErrorCode(ret);
 535                 }
 536
 537                 in_buf.src = image_buf;
 538                 in_buf.pos = 0;
 539                 in_buf.size = image_len;
 540
 541                 out_buf.dst = load_buf;
 542                 out_buf.pos = 0;
 543                 out_buf.size = size;
 544
 545                 while (1) {
 546                         size_t ret;
 547
 548                         ret = ZSTD_decompressStream(dstream, &out_buf, &in_buf);
 549                         if (ZSTD_isError(ret)) {
 550                                 printf("%s: ZSTD_decompressStream error %d\n", __func__,
 551                                        ZSTD_getErrorCode(ret));
 552                                 return ZSTD_getErrorCode(ret);
 553                         }
 554
 555                         if (in_buf.pos >= image_len || !ret)
 556                                 break;
 557                 }
 558
 559                 image_len = out_buf.pos;
 560
 561                 break;
 562         }
 563 #endif /* CONFIG_ZSTD */
 564         default:
 565                 printf("Unimplemented compression type %d\n", comp);
 566                 return -ENOSYS;
 567         }
 568
 569         *load_end = load + image_len;
 570
 571         return ret;
 572 }
 573
 574
 575 #ifndef USE_HOSTCC
 576 #if CONFIG_IS_ENABLED(LEGACY_IMAGE_FORMAT)
 577 /**
 578  * image_get_ramdisk - get and verify ramdisk image
 579  * @rd_addr: ramdisk image start address
 580  * @arch: expected ramdisk architecture
 581  * @verify: checksum verification flag
 582  *
 583  * image_get_ramdisk() returns a pointer to the verified ramdisk image
 584  * header. Routine receives image start address and expected architecture
 585  * flag. Verification done covers data and header integrity and os/type/arch
 586  * fields checking.
 587  *
 588  * returns:
 589  *     pointer to a ramdisk image header, if image was found and valid
 590  *     otherwise, return NULL
 591  */
 592 static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch,
 593                                                 int verify)
 594 {
 595         const image_header_t *rd_hdr = (const image_header_t *)rd_addr;
 596
 597         if (!image_check_magic(rd_hdr)) {
 598                 puts("Bad Magic Number\n");
 599                 bootstage_error(BOOTSTAGE_ID_RD_MAGIC);
 600                 return NULL;
 601         }
 602
 603         if (!image_check_hcrc(rd_hdr)) {
 604                 puts("Bad Header Checksum\n");
 605                 bootstage_error(BOOTSTAGE_ID_RD_HDR_CHECKSUM);
 606                 return NULL;
 607         }
 608
 609         bootstage_mark(BOOTSTAGE_ID_RD_MAGIC);
 610         image_print_contents(rd_hdr);
 611
 612         if (verify) {
 613                 puts("   Verifying Checksum ... ");
 614                 if (!image_check_dcrc(rd_hdr)) {
 615                         puts("Bad Data CRC\n");
 616                         bootstage_error(BOOTSTAGE_ID_RD_CHECKSUM);
 617                         return NULL;
 618                 }
 619                 puts("OK\n");
 620         }
 621
 622         bootstage_mark(BOOTSTAGE_ID_RD_HDR_CHECKSUM);
 623
 624         if (!image_check_os(rd_hdr, IH_OS_LINUX) ||
 625             !image_check_arch(rd_hdr, arch) ||
 626             !image_check_type(rd_hdr, IH_TYPE_RAMDISK)) {
 627                 printf("No Linux %s Ramdisk Image\n",
 628                                 genimg_get_arch_name(arch));
 629                 bootstage_error(BOOTSTAGE_ID_RAMDISK);
 630                 return NULL;
 631         }
 632
 633         return rd_hdr;
 634 }
 635 #endif
 636 #endif /* !USE_HOSTCC */
 637
 638 /*****************************************************************************/
 639 /* Shared dual-format routines */
 640 /*****************************************************************************/
 641 #ifndef USE_HOSTCC
 642 ulong image_load_addr = CONFIG_SYS_LOAD_ADDR;   /* Default Load Address */
 643 ulong image_save_addr;                  /* Default Save Address */
 644 ulong image_save_size;                  /* Default Save Size (in bytes) */
 645
 646 static int on_loadaddr(const char *name, const char *value, enum env_op op,
 647         int flags)
 648 {
 649         switch (op) {
 650         case env_op_create:
 651         case env_op_overwrite:
 652                 image_load_addr = simple_strtoul(value, NULL, 16);
 653                 break;
 654         default:
 655                 break;
 656         }
 657
 658         return 0;
 659 }
 660 U_BOOT_ENV_CALLBACK(loadaddr, on_loadaddr);
 661
 662 ulong env_get_bootm_low(void)
 663 {
 664         char *s = env_get("bootm_low");
 665         if (s) {
 666                 ulong tmp = simple_strtoul(s, NULL, 16);
 667                 return tmp;
 668         }
 669
 670 #if defined(CONFIG_SYS_SDRAM_BASE)
 671         return CONFIG_SYS_SDRAM_BASE;
 672 #elif defined(CONFIG_ARM) || defined(CONFIG_MICROBLAZE)
 673         return gd->bd->bi_dram[0].start;
 674 #else
 675         return 0;
 676 #endif
 677 }
 678
 679 phys_size_t env_get_bootm_size(void)
 680 {
 681         phys_size_t tmp, size;
 682         phys_addr_t start;
 683         char *s = env_get("bootm_size");
 684         if (s) {
 685                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 686                 return tmp;
 687         }
 688
 689         start = gd->ram_base;
 690         size = gd->ram_size;
 691
 692         if (start + size > gd->ram_top)
 693                 size = gd->ram_top - start;
 694
 695         s = env_get("bootm_low");
 696         if (s)
 697                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 698         else
 699                 tmp = start;
 700
 701         return size - (tmp - start);
 702 }
 703
 704 phys_size_t env_get_bootm_mapsize(void)
 705 {
 706         phys_size_t tmp;
 707         char *s = env_get("bootm_mapsize");
 708         if (s) {
 709                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 710                 return tmp;
 711         }
 712
 713 #if defined(CONFIG_SYS_BOOTMAPSZ)
 714         return CONFIG_SYS_BOOTMAPSZ;
 715 #else
 716         return env_get_bootm_size();
 717 #endif
 718 }
 719
 720 void memmove_wd(void *to, void *from, size_t len, ulong chunksz)
 721 {
 722         if (to == from)
 723                 return;
 724
 725 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 726         if (to > from) {
 727                 from += len;
 728                 to += len;
 729         }
 730         while (len > 0) {
 731                 size_t tail = (len > chunksz) ? chunksz : len;
 732                 WATCHDOG_RESET();
 733                 if (to > from) {
 734                         to -= tail;
 735                         from -= tail;
 736                 }
 737                 memmove(to, from, tail);
 738                 if (to < from) {
 739                         to += tail;
 740                         from += tail;
 741                 }
 742                 len -= tail;
 743         }
 744 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 745         memmove(to, from, len);
 746 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 747 }
 748 #else   /* USE_HOSTCC */
 749 void memmove_wd(void *to, void *from, size_t len, ulong chunksz)
 750 {
 751         memmove(to, from, len);
 752 }
 753 #endif /* !USE_HOSTCC */
 754
 755 void genimg_print_size(uint32_t size)
 756 {
 757 #ifndef USE_HOSTCC
 758         printf("%d Bytes = ", size);
 759         print_size(size, "\n");
 760 #else
 761         printf("%d Bytes = %.2f KiB = %.2f MiB\n",
 762                         size, (double)size / 1.024e3,
 763                         (double)size / 1.048576e6);
 764 #endif
 765 }
 766
 767 #if IMAGE_ENABLE_TIMESTAMP
 768 void genimg_print_time(time_t timestamp)
 769 {
 770 #ifndef USE_HOSTCC
 771         struct rtc_time tm;
 772
 773         rtc_to_tm(timestamp, &tm);
 774         printf("%4d-%02d-%02d  %2d:%02d:%02d UTC\n",
 775                         tm.tm_year, tm.tm_mon, tm.tm_mday,
 776                         tm.tm_hour, tm.tm_min, tm.tm_sec);
 777 #else
 778         printf("%s", ctime(&timestamp));
 779 #endif
 780 }
 781 #endif
 782
 783 const table_entry_t *get_table_entry(const table_entry_t *table, int id)
 784 {
 785         for (; table->id >= 0; ++table) {
 786                 if (table->id == id)
 787                         return table;
 788         }
 789         return NULL;
 790 }
 791
 792 static const char *unknown_msg(enum ih_category category)
 793 {
 794         static const char unknown_str[] = "Unknown ";
 795         static char msg[30];
 796
 797         strcpy(msg, unknown_str);
 798         strncat(msg, table_info[category].desc,
 799                 sizeof(msg) - sizeof(unknown_str));
 800
 801         return msg;
 802 }
 803
 804 /**
 805  * genimg_get_cat_name - translate entry id to long name
 806  * @category: category to look up (enum ih_category)
 807  * @id: entry id to be translated
 808  *
 809  * This will scan the translation table trying to find the entry that matches
 810  * the given id.
 811  *
 812  * @return long entry name if translation succeeds; error string on failure
 813  */
 814 const char *genimg_get_cat_name(enum ih_category category, uint id)
 815 {
 816         const table_entry_t *entry;
 817
 818         entry = get_table_entry(table_info[category].table, id);
 819         if (!entry)
 820                 return unknown_msg(category);
 821 #if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC)
 822         return entry->lname;
 823 #else
 824         return entry->lname + gd->reloc_off;
 825 #endif
 826 }
 827
 828 /**
 829  * genimg_get_cat_short_name - translate entry id to short name
 830  * @category: category to look up (enum ih_category)
 831  * @id: entry id to be translated
 832  *
 833  * This will scan the translation table trying to find the entry that matches
 834  * the given id.
 835  *
 836  * @return short entry name if translation succeeds; error string on failure
 837  */
 838 const char *genimg_get_cat_short_name(enum ih_category category, uint id)
 839 {
 840         const table_entry_t *entry;
 841
 842         entry = get_table_entry(table_info[category].table, id);
 843         if (!entry)
 844                 return unknown_msg(category);
 845 #if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC)
 846         return entry->sname;
 847 #else
 848         return entry->sname + gd->reloc_off;
 849 #endif
 850 }
 851
 852 int genimg_get_cat_count(enum ih_category category)
 853 {
 854         return table_info[category].count;
 855 }
 856
 857 const char *genimg_get_cat_desc(enum ih_category category)
 858 {
 859         return table_info[category].desc;
 860 }
 861
 862 /**
 863  * genimg_cat_has_id - check whether category has entry id
 864  * @category: category to look up (enum ih_category)
 865  * @id: entry id to be checked
 866  *
 867  * This will scan the translation table trying to find the entry that matches
 868  * the given id.
 869  *
 870  * @return true if category has entry id; false if not
 871  */
 872 bool genimg_cat_has_id(enum ih_category category, uint id)
 873 {
 874         if (get_table_entry(table_info[category].table, id))
 875                 return true;
 876
 877         return false;
 878 }
 879
 880 /**
 881  * get_table_entry_name - translate entry id to long name
 882  * @table: pointer to a translation table for entries of a specific type
 883  * @msg: message to be returned when translation fails
 884  * @id: entry id to be translated
 885  *
 886  * get_table_entry_name() will go over translation table trying to find
 887  * entry that matches given id. If matching entry is found, its long
 888  * name is returned to the caller.
 889  *
 890  * returns:
 891  *     long entry name if translation succeeds
 892  *     msg otherwise
 893  */
 894 char *get_table_entry_name(const table_entry_t *table, char *msg, int id)
 895 {
 896         table = get_table_entry(table, id);
 897         if (!table)
 898                 return msg;
 899 #if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC)
 900         return table->lname;
 901 #else
 902         return table->lname + gd->reloc_off;
 903 #endif
 904 }
 905
 906 const char *genimg_get_os_name(uint8_t os)
 907 {
 908         return (get_table_entry_name(uimage_os, "Unknown OS", os));
 909 }
 910
 911 const char *genimg_get_arch_name(uint8_t arch)
 912 {
 913         return (get_table_entry_name(uimage_arch, "Unknown Architecture",
 914                                         arch));
 915 }
 916
 917 const char *genimg_get_type_name(uint8_t type)
 918 {
 919         return (get_table_entry_name(uimage_type, "Unknown Image", type));
 920 }
 921
 922 const char *genimg_get_comp_name(uint8_t comp)
 923 {
 924         return (get_table_entry_name(uimage_comp, "Unknown Compression",
 925                                         comp));
 926 }
 927
 928 static const char *genimg_get_short_name(const table_entry_t *table, int val)
 929 {
 930         table = get_table_entry(table, val);
 931         if (!table)
 932                 return "unknown";
 933 #if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC)
 934         return table->sname;
 935 #else
 936         return table->sname + gd->reloc_off;
 937 #endif
 938 }
 939
 940 const char *genimg_get_type_short_name(uint8_t type)
 941 {
 942         return genimg_get_short_name(uimage_type, type);
 943 }
 944
 945 const char *genimg_get_comp_short_name(uint8_t comp)
 946 {
 947         return genimg_get_short_name(uimage_comp, comp);
 948 }
 949
 950 const char *genimg_get_os_short_name(uint8_t os)
 951 {
 952         return genimg_get_short_name(uimage_os, os);
 953 }
 954
 955 const char *genimg_get_arch_short_name(uint8_t arch)
 956 {
 957         return genimg_get_short_name(uimage_arch, arch);
 958 }
 959
 960 /**
 961  * get_table_entry_id - translate short entry name to id
 962  * @table: pointer to a translation table for entries of a specific type
 963  * @table_name: to be used in case of error
 964  * @name: entry short name to be translated
 965  *
 966  * get_table_entry_id() will go over translation table trying to find
 967  * entry that matches given short name. If matching entry is found,
 968  * its id returned to the caller.
 969  *
 970  * returns:
 971  *     entry id if translation succeeds
 972  *     -1 otherwise
 973  */
 974 int get_table_entry_id(const table_entry_t *table,
 975                 const char *table_name, const char *name)
 976 {
 977         const table_entry_t *t;
 978
 979         for (t = table; t->id >= 0; ++t) {
 980 #ifdef CONFIG_NEEDS_MANUAL_RELOC
 981                 if (t->sname && strcasecmp(t->sname + gd->reloc_off, name) == 0)
 982 #else
 983                 if (t->sname && strcasecmp(t->sname, name) == 0)
 984 #endif
 985                         return (t->id);
 986         }
 987         debug("Invalid %s Type: %s\n", table_name, name);
 988
 989         return -1;
 990 }
 991
 992 int genimg_get_os_id(const char *name)
 993 {
 994         return (get_table_entry_id(uimage_os, "OS", name));
 995 }
 996
 997 int genimg_get_arch_id(const char *name)
 998 {
 999         return (get_table_entry_id(uimage_arch, "CPU", name));
1000 }
1001
1002 int genimg_get_type_id(const char *name)
1003 {
1004         return (get_table_entry_id(uimage_type, "Image", name));
1005 }
1006
1007 int genimg_get_comp_id(const char *name)
1008 {
1009         return (get_table_entry_id(uimage_comp, "Compression", name));
1010 }
1011
1012 #ifndef USE_HOSTCC
1013 /**
1014  * genimg_get_kernel_addr_fit - get the real kernel address and return 2
1015  *                              FIT strings
1016  * @img_addr: a string might contain real image address
1017  * @fit_uname_config: double pointer to a char, will hold pointer to a
1018  *                    configuration unit name
1019  * @fit_uname_kernel: double pointer to a char, will hold pointer to a subimage
1020  *                    name
1021  *
1022  * genimg_get_kernel_addr_fit get the real kernel start address from a string
1023  * which is normally the first argv of bootm/bootz
1024  *
1025  * returns:
1026  *     kernel start address
1027  */
1028 ulong genimg_get_kernel_addr_fit(char * const img_addr,
1029                              const char **fit_uname_config,
1030                              const char **fit_uname_kernel)
1031 {
1032         ulong kernel_addr;
1033
1034         /* find out kernel image address */
1035         if (!img_addr) {
1036                 kernel_addr = image_load_addr;
1037                 debug("*  kernel: default image load address = 0x%08lx\n",
1038                       image_load_addr);
1039 #if CONFIG_IS_ENABLED(FIT)
1040         } else if (fit_parse_conf(img_addr, image_load_addr, &kernel_addr,
1041                                   fit_uname_config)) {
1042                 debug("*  kernel: config '%s' from image at 0x%08lx\n",
1043                       *fit_uname_config, kernel_addr);
1044         } else if (fit_parse_subimage(img_addr, image_load_addr, &kernel_addr,
1045                                      fit_uname_kernel)) {
1046                 debug("*  kernel: subimage '%s' from image at 0x%08lx\n",
1047                       *fit_uname_kernel, kernel_addr);
1048 #endif
1049         } else {
1050                 kernel_addr = simple_strtoul(img_addr, NULL, 16);
1051                 debug("*  kernel: cmdline image address = 0x%08lx\n",
1052                       kernel_addr);
1053         }
1054
1055         return kernel_addr;
1056 }
1057
1058 /**
1059  * genimg_get_kernel_addr() is the simple version of
1060  * genimg_get_kernel_addr_fit(). It ignores those return FIT strings
1061  */
1062 ulong genimg_get_kernel_addr(char * const img_addr)
1063 {
1064         const char *fit_uname_config = NULL;
1065         const char *fit_uname_kernel = NULL;
1066
1067         return genimg_get_kernel_addr_fit(img_addr, &fit_uname_config,
1068                                           &fit_uname_kernel);
1069 }
1070
1071 /**
1072  * genimg_get_format - get image format type
1073  * @img_addr: image start address
1074  *
1075  * genimg_get_format() checks whether provided address points to a valid
1076  * legacy or FIT image.
1077  *
1078  * New uImage format and FDT blob are based on a libfdt. FDT blob
1079  * may be passed directly or embedded in a FIT image. In both situations
1080  * genimg_get_format() must be able to dectect libfdt header.
1081  *
1082  * returns:
1083  *     image format type or IMAGE_FORMAT_INVALID if no image is present
1084  */
1085 int genimg_get_format(const void *img_addr)
1086 {
1087 #if CONFIG_IS_ENABLED(LEGACY_IMAGE_FORMAT)
1088         const image_header_t *hdr;
1089
1090         hdr = (const image_header_t *)img_addr;
1091         if (image_check_magic(hdr))
1092                 return IMAGE_FORMAT_LEGACY;
1093 #endif
1094 #if IMAGE_ENABLE_FIT || IMAGE_ENABLE_OF_LIBFDT
1095         if (fdt_check_header(img_addr) == 0)
1096                 return IMAGE_FORMAT_FIT;
1097 #endif
1098 #ifdef CONFIG_ANDROID_BOOT_IMAGE
1099         if (android_image_check_header(img_addr) == 0)
1100                 return IMAGE_FORMAT_ANDROID;
1101 #endif
1102
1103         return IMAGE_FORMAT_INVALID;
1104 }
1105
1106 /**
1107  * fit_has_config - check if there is a valid FIT configuration
1108  * @images: pointer to the bootm command headers structure
1109  *
1110  * fit_has_config() checks if there is a FIT configuration in use
1111  * (if FTI support is present).
1112  *
1113  * returns:
1114  *     0, no FIT support or no configuration found
1115  *     1, configuration found
1116  */
1117 int genimg_has_config(bootm_headers_t *images)
1118 {
1119 #if IMAGE_ENABLE_FIT
1120         if (images->fit_uname_cfg)
1121                 return 1;
1122 #endif
1123         return 0;
1124 }
1125
1126 /**
1127  * boot_get_ramdisk - main ramdisk handling routine
1128  * @argc: command argument count
1129  * @argv: command argument list
1130  * @images: pointer to the bootm images structure
1131  * @arch: expected ramdisk architecture
1132  * @rd_start: pointer to a ulong variable, will hold ramdisk start address
1133  * @rd_end: pointer to a ulong variable, will hold ramdisk end
1134  *
1135  * boot_get_ramdisk() is responsible for finding a valid ramdisk image.
1136  * Curently supported are the following ramdisk sources:
1137  *      - multicomponent kernel/ramdisk image,
1138  *      - commandline provided address of decicated ramdisk image.
1139  *
1140  * returns:
1141  *     0, if ramdisk image was found and valid, or skiped
1142  *     rd_start and rd_end are set to ramdisk start/end addresses if
1143  *     ramdisk image is found and valid
1144  *
1145  *     1, if ramdisk image is found but corrupted, or invalid
1146  *     rd_start and rd_end are set to 0 if no ramdisk exists
1147  */
1148 int boot_get_ramdisk(int argc, char *const argv[], bootm_headers_t *images,
1149                      uint8_t arch, ulong *rd_start, ulong *rd_end)
1150 {
1151         ulong rd_addr, rd_load;
1152         ulong rd_data, rd_len;
1153 #if CONFIG_IS_ENABLED(LEGACY_IMAGE_FORMAT)
1154         const image_header_t *rd_hdr;
1155 #endif
1156         void *buf;
1157 #ifdef CONFIG_SUPPORT_RAW_INITRD
1158         char *end;
1159 #endif
1160 #if IMAGE_ENABLE_FIT
1161         const char      *fit_uname_config = images->fit_uname_cfg;
1162         const char      *fit_uname_ramdisk = NULL;
1163         ulong           default_addr;
1164         int             rd_noffset;
1165 #endif
1166         const char *select = NULL;
1167
1168         *rd_start = 0;
1169         *rd_end = 0;
1170
1171 #ifdef CONFIG_ANDROID_BOOT_IMAGE
1172         /*
1173          * Look for an Android boot image.
1174          */
1175         buf = map_sysmem(images->os.start, 0);
1176         if (buf && genimg_get_format(buf) == IMAGE_FORMAT_ANDROID)
1177                 select = (argc == 0) ? env_get("loadaddr") : argv[0];
1178 #endif
1179
1180         if (argc >= 2)
1181                 select = argv[1];
1182
1183         /*
1184          * Look for a '-' which indicates to ignore the
1185          * ramdisk argument
1186          */
1187         if (select && strcmp(select, "-") ==  0) {
1188                 debug("## Skipping init Ramdisk\n");
1189                 rd_len = rd_data = 0;
1190         } else if (select || genimg_has_config(images)) {
1191 #if IMAGE_ENABLE_FIT
1192                 if (select) {
1193                         /*
1194                          * If the init ramdisk comes from the FIT image and
1195                          * the FIT image address is omitted in the command
1196                          * line argument, try to use os FIT image address or
1197                          * default load address.
1198                          */
1199                         if (images->fit_uname_os)
1200                                 default_addr = (ulong)images->fit_hdr_os;
1201                         else
1202                                 default_addr = image_load_addr;
1203
1204                         if (fit_parse_conf(select, default_addr,
1205                                            &rd_addr, &fit_uname_config)) {
1206                                 debug("*  ramdisk: config '%s' from image at "
1207                                                 "0x%08lx\n",
1208                                                 fit_uname_config, rd_addr);
1209                         } else if (fit_parse_subimage(select, default_addr,
1210                                                 &rd_addr, &fit_uname_ramdisk)) {
1211                                 debug("*  ramdisk: subimage '%s' from image at "
1212                                                 "0x%08lx\n",
1213                                                 fit_uname_ramdisk, rd_addr);
1214                         } else
1215 #endif
1216                         {
1217                                 rd_addr = simple_strtoul(select, NULL, 16);
1218                                 debug("*  ramdisk: cmdline image address = "
1219                                                 "0x%08lx\n",
1220                                                 rd_addr);
1221                         }
1222 #if IMAGE_ENABLE_FIT
1223                 } else {
1224                         /* use FIT configuration provided in first bootm
1225                          * command argument. If the property is not defined,
1226                          * quit silently.
1227                          */
1228                         rd_addr = map_to_sysmem(images->fit_hdr_os);
1229                         rd_noffset = fit_get_node_from_config(images,
1230                                         FIT_RAMDISK_PROP, rd_addr);
1231                         if (rd_noffset == -ENOENT)
1232                                 return 0;
1233                         else if (rd_noffset < 0)
1234                                 return 1;
1235                 }
1236 #endif
1237
1238                 /*
1239                  * Check if there is an initrd image at the
1240                  * address provided in the second bootm argument
1241                  * check image type, for FIT images get FIT node.
1242                  */
1243                 buf = map_sysmem(rd_addr, 0);
1244                 switch (genimg_get_format(buf)) {
1245 #if CONFIG_IS_ENABLED(LEGACY_IMAGE_FORMAT)
1246                 case IMAGE_FORMAT_LEGACY:
1247                         printf("## Loading init Ramdisk from Legacy "
1248                                         "Image at %08lx ...\n", rd_addr);
1249
1250                         bootstage_mark(BOOTSTAGE_ID_CHECK_RAMDISK);
1251                         rd_hdr = image_get_ramdisk(rd_addr, arch,
1252                                                         images->verify);
1253
1254                         if (rd_hdr == NULL)
1255                                 return 1;
1256
1257                         rd_data = image_get_data(rd_hdr);
1258                         rd_len = image_get_data_size(rd_hdr);
1259                         rd_load = image_get_load(rd_hdr);
1260                         break;
1261 #endif
1262 #if IMAGE_ENABLE_FIT
1263                 case IMAGE_FORMAT_FIT:
1264                         rd_noffset = fit_image_load(images,
1265                                         rd_addr, &fit_uname_ramdisk,
1266                                         &fit_uname_config, arch,
1267                                         IH_TYPE_RAMDISK,
1268                                         BOOTSTAGE_ID_FIT_RD_START,
1269                                         FIT_LOAD_OPTIONAL_NON_ZERO,
1270                                         &rd_data, &rd_len);
1271                         if (rd_noffset < 0)
1272                                 return 1;
1273
1274                         images->fit_hdr_rd = map_sysmem(rd_addr, 0);
1275                         images->fit_uname_rd = fit_uname_ramdisk;
1276                         images->fit_noffset_rd = rd_noffset;
1277                         break;
1278 #endif
1279 #ifdef CONFIG_ANDROID_BOOT_IMAGE
1280                 case IMAGE_FORMAT_ANDROID:
1281                         android_image_get_ramdisk((void *)images->os.start,
1282                                 &rd_data, &rd_len);
1283                         break;
1284 #endif
1285                 default:
1286 #ifdef CONFIG_SUPPORT_RAW_INITRD
1287                         end = NULL;
1288                         if (select)
1289                                 end = strchr(select, ':');
1290                         if (end) {
1291                                 rd_len = simple_strtoul(++end, NULL, 16);
1292                                 rd_data = rd_addr;
1293                         } else
1294 #endif
1295                         {
1296                                 puts("Wrong Ramdisk Image Format\n");
1297                                 rd_data = rd_len = rd_load = 0;
1298                                 return 1;
1299                         }
1300                 }
1301         } else if (images->legacy_hdr_valid &&
1302                         image_check_type(&images->legacy_hdr_os_copy,
1303                                                 IH_TYPE_MULTI)) {
1304
1305                 /*
1306                  * Now check if we have a legacy mult-component image,
1307                  * get second entry data start address and len.
1308                  */
1309                 bootstage_mark(BOOTSTAGE_ID_RAMDISK);
1310                 printf("## Loading init Ramdisk from multi component "
1311                                 "Legacy Image at %08lx ...\n",
1312                                 (ulong)images->legacy_hdr_os);
1313
1314                 image_multi_getimg(images->legacy_hdr_os, 1, &rd_data, &rd_len);
1315         } else {
1316                 /*
1317                  * no initrd image
1318                  */
1319                 bootstage_mark(BOOTSTAGE_ID_NO_RAMDISK);
1320                 rd_len = rd_data = 0;
1321         }
1322
1323         if (!rd_data) {
1324                 debug("## No init Ramdisk\n");
1325         } else {
1326                 *rd_start = rd_data;
1327                 *rd_end = rd_data + rd_len;
1328         }
1329         debug("   ramdisk start = 0x%08lx, ramdisk end = 0x%08lx\n",
1330                         *rd_start, *rd_end);
1331
1332         return 0;
1333 }
1334
1335 #ifdef CONFIG_SYS_BOOT_RAMDISK_HIGH
1336 /**
1337  * boot_ramdisk_high - relocate init ramdisk
1338  * @lmb: pointer to lmb handle, will be used for memory mgmt
1339  * @rd_data: ramdisk data start address
1340  * @rd_len: ramdisk data length
1341  * @initrd_start: pointer to a ulong variable, will hold final init ramdisk
1342  *      start address (after possible relocation)
1343  * @initrd_end: pointer to a ulong variable, will hold final init ramdisk
1344  *      end address (after possible relocation)
1345  *
1346  * boot_ramdisk_high() takes a relocation hint from "initrd_high" environment
1347  * variable and if requested ramdisk data is moved to a specified location.
1348  *
1349  * Initrd_start and initrd_end are set to final (after relocation) ramdisk
1350  * start/end addresses if ramdisk image start and len were provided,
1351  * otherwise set initrd_start and initrd_end set to zeros.
1352  *
1353  * returns:
1354  *      0 - success
1355  *     -1 - failure
1356  */
1357 int boot_ramdisk_high(struct lmb *lmb, ulong rd_data, ulong rd_len,
1358                   ulong *initrd_start, ulong *initrd_end)
1359 {
1360         char    *s;
1361         ulong   initrd_high;
1362         int     initrd_copy_to_ram = 1;
1363
1364         s = env_get("initrd_high");
1365         if (s) {
1366                 /* a value of "no" or a similar string will act like 0,
1367                  * turning the "load high" feature off. This is intentional.
1368                  */
1369                 initrd_high = simple_strtoul(s, NULL, 16);
1370                 if (initrd_high == ~0)
1371                         initrd_copy_to_ram = 0;
1372         } else {
1373                 initrd_high = env_get_bootm_mapsize() + env_get_bootm_low();
1374         }
1375
1376
1377         debug("## initrd_high = 0x%08lx, copy_to_ram = %d\n",
1378                         initrd_high, initrd_copy_to_ram);
1379
1380         if (rd_data) {
1381                 if (!initrd_copy_to_ram) {      /* zero-copy ramdisk support */
1382                         debug("   in-place initrd\n");
1383                         *initrd_start = rd_data;
1384                         *initrd_end = rd_data + rd_len;
1385                         lmb_reserve(lmb, rd_data, rd_len);
1386                 } else {
1387                         if (initrd_high)
1388                                 *initrd_start = (ulong)lmb_alloc_base(lmb,
1389                                                 rd_len, 0x1000, initrd_high);
1390                         else
1391                                 *initrd_start = (ulong)lmb_alloc(lmb, rd_len,
1392                                                                  0x1000);
1393
1394                         if (*initrd_start == 0) {
1395                                 puts("ramdisk - allocation error\n");
1396                                 goto error;
1397                         }
1398                         bootstage_mark(BOOTSTAGE_ID_COPY_RAMDISK);
1399
1400                         *initrd_end = *initrd_start + rd_len;
1401                         printf("   Loading Ramdisk to %08lx, end %08lx ... ",
1402                                         *initrd_start, *initrd_end);
1403
1404                         memmove_wd((void *)*initrd_start,
1405                                         (void *)rd_data, rd_len, CHUNKSZ);
1406
1407 #ifdef CONFIG_MP
1408                         /*
1409                          * Ensure the image is flushed to memory to handle
1410                          * AMP boot scenarios in which we might not be
1411                          * HW cache coherent
1412                          */
1413                         flush_cache((unsigned long)*initrd_start,
1414                                     ALIGN(rd_len, ARCH_DMA_MINALIGN));
1415 #endif
1416                         puts("OK\n");
1417                 }
1418         } else {
1419                 *initrd_start = 0;
1420                 *initrd_end = 0;
1421         }
1422         debug("   ramdisk load start = 0x%08lx, ramdisk load end = 0x%08lx\n",
1423                         *initrd_start, *initrd_end);
1424
1425         return 0;
1426
1427 error:
1428         return -1;
1429 }
1430 #endif /* CONFIG_SYS_BOOT_RAMDISK_HIGH */
1431
1432 int boot_get_setup(bootm_headers_t *images, uint8_t arch,
1433                    ulong *setup_start, ulong *setup_len)
1434 {
1435 #if IMAGE_ENABLE_FIT
1436         return boot_get_setup_fit(images, arch, setup_start, setup_len);
1437 #else
1438         return -ENOENT;
1439 #endif
1440 }
1441
1442 #if IMAGE_ENABLE_FIT
1443 #if defined(CONFIG_FPGA)
1444 int boot_get_fpga(int argc, char *const argv[], bootm_headers_t *images,
1445                   uint8_t arch, const ulong *ld_start, ulong * const ld_len)
1446 {
1447         ulong tmp_img_addr, img_data, img_len;
1448         void *buf;
1449         int conf_noffset;
1450         int fit_img_result;
1451         const char *uname, *name;
1452         int err;
1453         int devnum = 0; /* TODO support multi fpga platforms */
1454
1455         /* Check to see if the images struct has a FIT configuration */
1456         if (!genimg_has_config(images)) {
1457                 debug("## FIT configuration was not specified\n");
1458                 return 0;
1459         }
1460
1461         /*
1462          * Obtain the os FIT header from the images struct
1463          */
1464         tmp_img_addr = map_to_sysmem(images->fit_hdr_os);
1465         buf = map_sysmem(tmp_img_addr, 0);
1466         /*
1467          * Check image type. For FIT images get FIT node
1468          * and attempt to locate a generic binary.
1469          */
1470         switch (genimg_get_format(buf)) {
1471         case IMAGE_FORMAT_FIT:
1472                 conf_noffset = fit_conf_get_node(buf, images->fit_uname_cfg);
1473
1474                 uname = fdt_stringlist_get(buf, conf_noffset, FIT_FPGA_PROP, 0,
1475                                            NULL);
1476                 if (!uname) {
1477                         debug("## FPGA image is not specified\n");
1478                         return 0;
1479                 }
1480                 fit_img_result = fit_image_load(images,
1481                                                 tmp_img_addr,
1482                                                 (const char **)&uname,
1483                                                 &(images->fit_uname_cfg),
1484                                                 arch,
1485                                                 IH_TYPE_FPGA,
1486                                                 BOOTSTAGE_ID_FPGA_INIT,
1487                                                 FIT_LOAD_OPTIONAL_NON_ZERO,
1488                                                 &img_data, &img_len);
1489
1490                 debug("FPGA image (%s) loaded to 0x%lx/size 0x%lx\n",
1491                       uname, img_data, img_len);
1492
1493                 if (fit_img_result < 0) {
1494                         /* Something went wrong! */
1495                         return fit_img_result;
1496                 }
1497
1498                 if (!fpga_is_partial_data(devnum, img_len)) {
1499                         name = "full";
1500                         err = fpga_loadbitstream(devnum, (char *)img_data,
1501                                                  img_len, BIT_FULL);
1502                         if (err)
1503                                 err = fpga_load(devnum, (const void *)img_data,
1504                                                 img_len, BIT_FULL);
1505                 } else {
1506                         name = "partial";
1507                         err = fpga_loadbitstream(devnum, (char *)img_data,
1508                                                  img_len, BIT_PARTIAL);
1509                         if (err)
1510                                 err = fpga_load(devnum, (const void *)img_data,
1511                                                 img_len, BIT_PARTIAL);
1512                 }
1513
1514                 if (err)
1515                         return err;
1516
1517                 printf("   Programming %s bitstream... OK\n", name);
1518                 break;
1519         default:
1520                 printf("The given image format is not supported (corrupt?)\n");
1521                 return 1;
1522         }
1523
1524         return 0;
1525 }
1526 #endif
1527
1528 static void fit_loadable_process(uint8_t img_type,
1529                                  ulong img_data,
1530                                  ulong img_len)
1531 {
1532         int i;
1533         const unsigned int count =
1534                         ll_entry_count(struct fit_loadable_tbl, fit_loadable);
1535         struct fit_loadable_tbl *fit_loadable_handler =
1536                         ll_entry_start(struct fit_loadable_tbl, fit_loadable);
1537         /* For each loadable handler */
1538         for (i = 0; i < count; i++, fit_loadable_handler++)
1539                 /* matching this type */
1540                 if (fit_loadable_handler->type == img_type)
1541                         /* call that handler with this image data */
1542                         fit_loadable_handler->handler(img_data, img_len);
1543 }
1544
1545 int boot_get_loadable(int argc, char *const argv[], bootm_headers_t *images,
1546                       uint8_t arch, const ulong *ld_start, ulong * const ld_len)
1547 {
1548         /*
1549          * These variables are used to hold the current image location
1550          * in system memory.
1551          */
1552         ulong tmp_img_addr;
1553         /*
1554          * These two variables are requirements for fit_image_load, but
1555          * their values are not used
1556          */
1557         ulong img_data, img_len;
1558         void *buf;
1559         int loadables_index;
1560         int conf_noffset;
1561         int fit_img_result;
1562         const char *uname;
1563         uint8_t img_type;
1564
1565         /* Check to see if the images struct has a FIT configuration */
1566         if (!genimg_has_config(images)) {
1567                 debug("## FIT configuration was not specified\n");
1568                 return 0;
1569         }
1570
1571         /*
1572          * Obtain the os FIT header from the images struct
1573          */
1574         tmp_img_addr = map_to_sysmem(images->fit_hdr_os);
1575         buf = map_sysmem(tmp_img_addr, 0);
1576         /*
1577          * Check image type. For FIT images get FIT node
1578          * and attempt to locate a generic binary.
1579          */
1580         switch (genimg_get_format(buf)) {
1581         case IMAGE_FORMAT_FIT:
1582                 conf_noffset = fit_conf_get_node(buf, images->fit_uname_cfg);
1583
1584                 for (loadables_index = 0;
1585                      uname = fdt_stringlist_get(buf, conf_noffset,
1586                                         FIT_LOADABLE_PROP, loadables_index,
1587                                         NULL), uname;
1588                      loadables_index++)
1589                 {
1590                         fit_img_result = fit_image_load(images,
1591                                 tmp_img_addr,
1592                                 &uname,
1593                                 &(images->fit_uname_cfg), arch,
1594                                 IH_TYPE_LOADABLE,
1595                                 BOOTSTAGE_ID_FIT_LOADABLE_START,
1596                                 FIT_LOAD_OPTIONAL_NON_ZERO,
1597                                 &img_data, &img_len);
1598                         if (fit_img_result < 0) {
1599                                 /* Something went wrong! */
1600                                 return fit_img_result;
1601                         }
1602
1603                         fit_img_result = fit_image_get_node(buf, uname);
1604                         if (fit_img_result < 0) {
1605                                 /* Something went wrong! */
1606                                 return fit_img_result;
1607                         }
1608                         fit_img_result = fit_image_get_type(buf,
1609                                                             fit_img_result,
1610                                                             &img_type);
1611                         if (fit_img_result < 0) {
1612                                 /* Something went wrong! */
1613                                 return fit_img_result;
1614                         }
1615
1616                         fit_loadable_process(img_type, img_data, img_len);
1617                 }
1618                 break;
1619         default:
1620                 printf("The given image format is not supported (corrupt?)\n");
1621                 return 1;
1622         }
1623
1624         return 0;
1625 }
1626 #endif
1627
1628 #ifdef CONFIG_SYS_BOOT_GET_CMDLINE
1629 /**
1630  * boot_get_cmdline - allocate and initialize kernel cmdline
1631  * @lmb: pointer to lmb handle, will be used for memory mgmt
1632  * @cmd_start: pointer to a ulong variable, will hold cmdline start
1633  * @cmd_end: pointer to a ulong variable, will hold cmdline end
1634  *
1635  * boot_get_cmdline() allocates space for kernel command line below
1636  * BOOTMAPSZ + env_get_bootm_low() address. If "bootargs" U-Boot environment
1637  * variable is present its contents is copied to allocated kernel
1638  * command line.
1639  *
1640  * returns:
1641  *      0 - success
1642  *     -1 - failure
1643  */
1644 int boot_get_cmdline(struct lmb *lmb, ulong *cmd_start, ulong *cmd_end)
1645 {
1646         char *cmdline;
1647         char *s;
1648
1649         cmdline = (char *)(ulong)lmb_alloc_base(lmb, CONFIG_SYS_BARGSIZE, 0xf,
1650                                 env_get_bootm_mapsize() + env_get_bootm_low());
1651
1652         if (cmdline == NULL)
1653                 return -1;
1654
1655         s = env_get("bootargs");
1656         if (!s)
1657                 s = "";
1658
1659         strcpy(cmdline, s);
1660
1661         *cmd_start = (ulong) & cmdline[0];
1662         *cmd_end = *cmd_start + strlen(cmdline);
1663
1664         debug("## cmdline at 0x%08lx ... 0x%08lx\n", *cmd_start, *cmd_end);
1665
1666         return 0;
1667 }
1668 #endif /* CONFIG_SYS_BOOT_GET_CMDLINE */
1669
1670 #ifdef CONFIG_SYS_BOOT_GET_KBD
1671 /**
1672  * boot_get_kbd - allocate and initialize kernel copy of board info
1673  * @lmb: pointer to lmb handle, will be used for memory mgmt
1674  * @kbd: double pointer to board info data
1675  *
1676  * boot_get_kbd() allocates space for kernel copy of board info data below
1677  * BOOTMAPSZ + env_get_bootm_low() address and kernel board info is initialized
1678  * with the current u-boot board info data.
1679  *
1680  * returns:
1681  *      0 - success
1682  *     -1 - failure
1683  */
1684 int boot_get_kbd(struct lmb *lmb, struct bd_info **kbd)
1685 {
1686         *kbd = (struct bd_info *)(ulong)lmb_alloc_base(lmb,
1687                                                        sizeof(struct bd_info),
1688                                                        0xf,
1689                                                        env_get_bootm_mapsize() + env_get_bootm_low());
1690         if (*kbd == NULL)
1691                 return -1;
1692
1693         **kbd = *(gd->bd);
1694
1695         debug("## kernel board info at 0x%08lx\n", (ulong)*kbd);
1696
1697 #if defined(DEBUG) && defined(CONFIG_CMD_BDI)
1698         do_bdinfo(NULL, 0, 0, NULL);
1699 #endif
1700
1701         return 0;
1702 }
1703 #endif /* CONFIG_SYS_BOOT_GET_KBD */
1704
1705 #ifdef CONFIG_LMB
1706 int image_setup_linux(bootm_headers_t *images)
1707 {
1708         ulong of_size = images->ft_len;
1709         char **of_flat_tree = &images->ft_addr;
1710         struct lmb *lmb = &images->lmb;
1711         int ret;
1712
1713         if (IMAGE_ENABLE_OF_LIBFDT)
1714                 boot_fdt_add_mem_rsv_regions(lmb, *of_flat_tree);
1715
1716         if (IMAGE_BOOT_GET_CMDLINE) {
1717                 ret = boot_get_cmdline(lmb, &images->cmdline_start,
1718                                 &images->cmdline_end);
1719                 if (ret) {
1720                         puts("ERROR with allocation of cmdline\n");
1721                         return ret;
1722                 }
1723         }
1724
1725         if (IMAGE_ENABLE_OF_LIBFDT) {
1726                 ret = boot_relocate_fdt(lmb, of_flat_tree, &of_size);
1727                 if (ret)
1728                         return ret;
1729         }
1730
1731         if (IMAGE_ENABLE_OF_LIBFDT && of_size) {
1732                 ret = image_setup_libfdt(images, *of_flat_tree, of_size, lmb);
1733                 if (ret)
1734                         return ret;
1735         }
1736
1737         return 0;
1738 }
1739 #endif /* CONFIG_LMB */
1740 #endif /* !USE_HOSTCC */