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