common/image.c

   1 /*
   2  * (C) Copyright 2008 Semihalf
   3  *
   4  * (C) Copyright 2000-2006
   5  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   6  *
   7  * See file CREDITS for list of people who contributed to this
   8  * project.
   9  *
  10  * This program is free software; you can redistribute it and/or
  11  * modify it under the terms of the GNU General Public License as
  12  * published by the Free Software Foundation; either version 2 of
  13  * the License, or (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  23  * MA 02111-1307 USA
  24  */
  25
  26 #ifndef USE_HOSTCC
  27 #include <common.h>
  28 #include <watchdog.h>
  29
  30 #ifdef CONFIG_SHOW_BOOT_PROGRESS
  31 #include <status_led.h>
  32 #endif
  33
  34 #ifdef CONFIG_HAS_DATAFLASH
  35 #include <dataflash.h>
  36 #endif
  37
  38 #ifdef CONFIG_LOGBUFFER
  39 #include <logbuff.h>
  40 #endif
  41
  42 #include <rtc.h>
  43
  44 #include <environment.h>
  45 #include <image.h>
  46
  47 #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT)
  48 #include <libfdt.h>
  49 #include <fdt_support.h>
  50 #endif
  51
  52 #include <u-boot/md5.h>
  53 #include <sha1.h>
  54
  55 #ifdef CONFIG_CMD_BDI
  56 extern int do_bdinfo(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]);
  57 #endif
  58
  59 DECLARE_GLOBAL_DATA_PTR;
  60
  61 static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch,
  62                                                 int verify);
  63 #else
  64 #include "mkimage.h"
  65 #include <u-boot/md5.h>
  66 #include <time.h>
  67 #include <image.h>
  68 #endif /* !USE_HOSTCC*/
  69
  70 #include <u-boot/crc.h>
  71
  72 static const table_entry_t uimage_arch[] = {
  73         {       IH_ARCH_INVALID,        NULL,           "Invalid ARCH", },
  74         {       IH_ARCH_ALPHA,          "alpha",        "Alpha",        },
  75         {       IH_ARCH_ARM,            "arm",          "ARM",          },
  76         {       IH_ARCH_I386,           "x86",          "Intel x86",    },
  77         {       IH_ARCH_IA64,           "ia64",         "IA64",         },
  78         {       IH_ARCH_M68K,           "m68k",         "M68K",         },
  79         {       IH_ARCH_MICROBLAZE,     "microblaze",   "MicroBlaze",   },
  80         {       IH_ARCH_MIPS,           "mips",         "MIPS",         },
  81         {       IH_ARCH_MIPS64,         "mips64",       "MIPS 64 Bit",  },
  82         {       IH_ARCH_NIOS2,          "nios2",        "NIOS II",      },
  83         {       IH_ARCH_PPC,            "powerpc",      "PowerPC",      },
  84         {       IH_ARCH_PPC,            "ppc",          "PowerPC",      },
  85         {       IH_ARCH_S390,           "s390",         "IBM S390",     },
  86         {       IH_ARCH_SH,             "sh",           "SuperH",       },
  87         {       IH_ARCH_SPARC,          "sparc",        "SPARC",        },
  88         {       IH_ARCH_SPARC64,        "sparc64",      "SPARC 64 Bit", },
  89         {       IH_ARCH_BLACKFIN,       "blackfin",     "Blackfin",     },
  90         {       IH_ARCH_AVR32,          "avr32",        "AVR32",        },
  91         {       IH_ARCH_NDS32,          "nds32",        "NDS32",        },
  92         {       IH_ARCH_OPENRISC,       "or1k",         "OpenRISC 1000",},
  93         {       -1,                     "",             "",             },
  94 };
  95
  96 static const table_entry_t uimage_os[] = {
  97         {       IH_OS_INVALID,  NULL,           "Invalid OS",           },
  98         {       IH_OS_LINUX,    "linux",        "Linux",                },
  99 #if defined(CONFIG_LYNXKDI) || defined(USE_HOSTCC)
 100         {       IH_OS_LYNXOS,   "lynxos",       "LynxOS",               },
 101 #endif
 102         {       IH_OS_NETBSD,   "netbsd",       "NetBSD",               },
 103         {       IH_OS_OSE,      "ose",          "Enea OSE",             },
 104         {       IH_OS_PLAN9,    "plan9",        "Plan 9",               },
 105         {       IH_OS_RTEMS,    "rtems",        "RTEMS",                },
 106         {       IH_OS_U_BOOT,   "u-boot",       "U-Boot",               },
 107 #if defined(CONFIG_CMD_ELF) || defined(USE_HOSTCC)
 108         {       IH_OS_QNX,      "qnx",          "QNX",                  },
 109         {       IH_OS_VXWORKS,  "vxworks",      "VxWorks",              },
 110 #endif
 111 #if defined(CONFIG_INTEGRITY) || defined(USE_HOSTCC)
 112         {       IH_OS_INTEGRITY,"integrity",    "INTEGRITY",            },
 113 #endif
 114 #ifdef USE_HOSTCC
 115         {       IH_OS_4_4BSD,   "4_4bsd",       "4_4BSD",               },
 116         {       IH_OS_DELL,     "dell",         "Dell",                 },
 117         {       IH_OS_ESIX,     "esix",         "Esix",                 },
 118         {       IH_OS_FREEBSD,  "freebsd",      "FreeBSD",              },
 119         {       IH_OS_IRIX,     "irix",         "Irix",                 },
 120         {       IH_OS_NCR,      "ncr",          "NCR",                  },
 121         {       IH_OS_OPENBSD,  "openbsd",      "OpenBSD",              },
 122         {       IH_OS_PSOS,     "psos",         "pSOS",                 },
 123         {       IH_OS_SCO,      "sco",          "SCO",                  },
 124         {       IH_OS_SOLARIS,  "solaris",      "Solaris",              },
 125         {       IH_OS_SVR4,     "svr4",         "SVR4",                 },
 126 #endif
 127         {       -1,             "",             "",                     },
 128 };
 129
 130 static const table_entry_t uimage_type[] = {
 131         {       IH_TYPE_AISIMAGE,   "aisimage",   "Davinci AIS image",},
 132         {       IH_TYPE_FILESYSTEM, "filesystem", "Filesystem Image",   },
 133         {       IH_TYPE_FIRMWARE,   "firmware",   "Firmware",           },
 134         {       IH_TYPE_FLATDT,     "flat_dt",    "Flat Device Tree",   },
 135         {       IH_TYPE_KERNEL,     "kernel",     "Kernel Image",       },
 136         {       IH_TYPE_KERNEL_NOLOAD, "kernel_noload",  "Kernel Image (no loading done)", },
 137         {       IH_TYPE_KWBIMAGE,   "kwbimage",   "Kirkwood Boot Image",},
 138         {       IH_TYPE_IMXIMAGE,   "imximage",   "Freescale i.MX Boot Image",},
 139         {       IH_TYPE_INVALID,    NULL,         "Invalid Image",      },
 140         {       IH_TYPE_MULTI,      "multi",      "Multi-File Image",   },
 141         {       IH_TYPE_OMAPIMAGE,  "omapimage",  "TI OMAP SPL With GP CH",},
 142         {       IH_TYPE_PBLIMAGE,   "pblimage",   "Freescale PBL Boot Image",},
 143         {       IH_TYPE_RAMDISK,    "ramdisk",    "RAMDisk Image",      },
 144         {       IH_TYPE_SCRIPT,     "script",     "Script",             },
 145         {       IH_TYPE_STANDALONE, "standalone", "Standalone Program", },
 146         {       IH_TYPE_UBLIMAGE,   "ublimage",   "Davinci UBL image",},
 147         {       -1,                 "",           "",                   },
 148 };
 149
 150 static const table_entry_t uimage_comp[] = {
 151         {       IH_COMP_NONE,   "none",         "uncompressed",         },
 152         {       IH_COMP_BZIP2,  "bzip2",        "bzip2 compressed",     },
 153         {       IH_COMP_GZIP,   "gzip",         "gzip compressed",      },
 154         {       IH_COMP_LZMA,   "lzma",         "lzma compressed",      },
 155         {       IH_COMP_LZO,    "lzo",          "lzo compressed",       },
 156         {       -1,             "",             "",                     },
 157 };
 158
 159 /*****************************************************************************/
 160 /* Legacy format routines */
 161 /*****************************************************************************/
 162 int image_check_hcrc(const image_header_t *hdr)
 163 {
 164         ulong hcrc;
 165         ulong len = image_get_header_size();
 166         image_header_t header;
 167
 168         /* Copy header so we can blank CRC field for re-calculation */
 169         memmove(&header, (char *)hdr, image_get_header_size());
 170         image_set_hcrc(&header, 0);
 171
 172         hcrc = crc32(0, (unsigned char *)&header, len);
 173
 174         return (hcrc == image_get_hcrc(hdr));
 175 }
 176
 177 int image_check_dcrc(const image_header_t *hdr)
 178 {
 179         ulong data = image_get_data(hdr);
 180         ulong len = image_get_data_size(hdr);
 181         ulong dcrc = crc32_wd(0, (unsigned char *)data, len, CHUNKSZ_CRC32);
 182
 183         return (dcrc == image_get_dcrc(hdr));
 184 }
 185
 186 /**
 187  * image_multi_count - get component (sub-image) count
 188  * @hdr: pointer to the header of the multi component image
 189  *
 190  * image_multi_count() returns number of components in a multi
 191  * component image.
 192  *
 193  * Note: no checking of the image type is done, caller must pass
 194  * a valid multi component image.
 195  *
 196  * returns:
 197  *     number of components
 198  */
 199 ulong image_multi_count(const image_header_t *hdr)
 200 {
 201         ulong i, count = 0;
 202         uint32_t *size;
 203
 204         /* get start of the image payload, which in case of multi
 205          * component images that points to a table of component sizes */
 206         size = (uint32_t *)image_get_data(hdr);
 207
 208         /* count non empty slots */
 209         for (i = 0; size[i]; ++i)
 210                 count++;
 211
 212         return count;
 213 }
 214
 215 /**
 216  * image_multi_getimg - get component data address and size
 217  * @hdr: pointer to the header of the multi component image
 218  * @idx: index of the requested component
 219  * @data: pointer to a ulong variable, will hold component data address
 220  * @len: pointer to a ulong variable, will hold component size
 221  *
 222  * image_multi_getimg() returns size and data address for the requested
 223  * component in a multi component image.
 224  *
 225  * Note: no checking of the image type is done, caller must pass
 226  * a valid multi component image.
 227  *
 228  * returns:
 229  *     data address and size of the component, if idx is valid
 230  *     0 in data and len, if idx is out of range
 231  */
 232 void image_multi_getimg(const image_header_t *hdr, ulong idx,
 233                         ulong *data, ulong *len)
 234 {
 235         int i;
 236         uint32_t *size;
 237         ulong offset, count, img_data;
 238
 239         /* get number of component */
 240         count = image_multi_count(hdr);
 241
 242         /* get start of the image payload, which in case of multi
 243          * component images that points to a table of component sizes */
 244         size = (uint32_t *)image_get_data(hdr);
 245
 246         /* get address of the proper component data start, which means
 247          * skipping sizes table (add 1 for last, null entry) */
 248         img_data = image_get_data(hdr) + (count + 1) * sizeof(uint32_t);
 249
 250         if (idx < count) {
 251                 *len = uimage_to_cpu(size[idx]);
 252                 offset = 0;
 253
 254                 /* go over all indices preceding requested component idx */
 255                 for (i = 0; i < idx; i++) {
 256                         /* add up i-th component size, rounding up to 4 bytes */
 257                         offset += (uimage_to_cpu(size[i]) + 3) & ~3 ;
 258                 }
 259
 260                 /* calculate idx-th component data address */
 261                 *data = img_data + offset;
 262         } else {
 263                 *len = 0;
 264                 *data = 0;
 265         }
 266 }
 267
 268 static void image_print_type(const image_header_t *hdr)
 269 {
 270         const char *os, *arch, *type, *comp;
 271
 272         os = genimg_get_os_name(image_get_os(hdr));
 273         arch = genimg_get_arch_name(image_get_arch(hdr));
 274         type = genimg_get_type_name(image_get_type(hdr));
 275         comp = genimg_get_comp_name(image_get_comp(hdr));
 276
 277         printf("%s %s %s (%s)\n", arch, os, type, comp);
 278 }
 279
 280 /**
 281  * image_print_contents - prints out the contents of the legacy format image
 282  * @ptr: pointer to the legacy format image header
 283  * @p: pointer to prefix string
 284  *
 285  * image_print_contents() formats a multi line legacy image contents description.
 286  * The routine prints out all header fields followed by the size/offset data
 287  * for MULTI/SCRIPT images.
 288  *
 289  * returns:
 290  *     no returned results
 291  */
 292 void image_print_contents(const void *ptr)
 293 {
 294         const image_header_t *hdr = (const image_header_t *)ptr;
 295         const char *p;
 296
 297 #ifdef USE_HOSTCC
 298         p = "";
 299 #else
 300         p = "   ";
 301 #endif
 302
 303         printf("%sImage Name:   %.*s\n", p, IH_NMLEN, image_get_name(hdr));
 304         if (IMAGE_ENABLE_TIMESTAMP) {
 305                 printf("%sCreated:      ", p);
 306                 genimg_print_time((time_t)image_get_time(hdr));
 307         }
 308         printf("%sImage Type:   ", p);
 309         image_print_type(hdr);
 310         printf("%sData Size:    ", p);
 311         genimg_print_size(image_get_data_size(hdr));
 312         printf("%sLoad Address: %08x\n", p, image_get_load(hdr));
 313         printf("%sEntry Point:  %08x\n", p, image_get_ep(hdr));
 314
 315         if (image_check_type(hdr, IH_TYPE_MULTI) ||
 316                         image_check_type(hdr, IH_TYPE_SCRIPT)) {
 317                 int i;
 318                 ulong data, len;
 319                 ulong count = image_multi_count(hdr);
 320
 321                 printf("%sContents:\n", p);
 322                 for (i = 0; i < count; i++) {
 323                         image_multi_getimg(hdr, i, &data, &len);
 324
 325                         printf("%s   Image %d: ", p, i);
 326                         genimg_print_size(len);
 327
 328                         if (image_check_type(hdr, IH_TYPE_SCRIPT) && i > 0) {
 329                                 /*
 330                                  * the user may need to know offsets
 331                                  * if planning to do something with
 332                                  * multiple files
 333                                  */
 334                                 printf("%s    Offset = 0x%08lx\n", p, data);
 335                         }
 336                 }
 337         }
 338 }
 339
 340
 341 #ifndef USE_HOSTCC
 342 /**
 343  * image_get_ramdisk - get and verify ramdisk image
 344  * @rd_addr: ramdisk image start address
 345  * @arch: expected ramdisk architecture
 346  * @verify: checksum verification flag
 347  *
 348  * image_get_ramdisk() returns a pointer to the verified ramdisk image
 349  * header. Routine receives image start address and expected architecture
 350  * flag. Verification done covers data and header integrity and os/type/arch
 351  * fields checking.
 352  *
 353  * If dataflash support is enabled routine checks for dataflash addresses
 354  * and handles required dataflash reads.
 355  *
 356  * returns:
 357  *     pointer to a ramdisk image header, if image was found and valid
 358  *     otherwise, return NULL
 359  */
 360 static const image_header_t *image_get_ramdisk(ulong rd_addr, uint8_t arch,
 361                                                 int verify)
 362 {
 363         const image_header_t *rd_hdr = (const image_header_t *)rd_addr;
 364
 365         if (!image_check_magic(rd_hdr)) {
 366                 puts("Bad Magic Number\n");
 367                 bootstage_error(BOOTSTAGE_ID_RD_MAGIC);
 368                 return NULL;
 369         }
 370
 371         if (!image_check_hcrc(rd_hdr)) {
 372                 puts("Bad Header Checksum\n");
 373                 bootstage_error(BOOTSTAGE_ID_RD_HDR_CHECKSUM);
 374                 return NULL;
 375         }
 376
 377         bootstage_mark(BOOTSTAGE_ID_RD_MAGIC);
 378         image_print_contents(rd_hdr);
 379
 380         if (verify) {
 381                 puts("   Verifying Checksum ... ");
 382                 if (!image_check_dcrc(rd_hdr)) {
 383                         puts("Bad Data CRC\n");
 384                         bootstage_error(BOOTSTAGE_ID_RD_CHECKSUM);
 385                         return NULL;
 386                 }
 387                 puts("OK\n");
 388         }
 389
 390         bootstage_mark(BOOTSTAGE_ID_RD_HDR_CHECKSUM);
 391
 392         if (!image_check_os(rd_hdr, IH_OS_LINUX) ||
 393             !image_check_arch(rd_hdr, arch) ||
 394             !image_check_type(rd_hdr, IH_TYPE_RAMDISK)) {
 395                 printf("No Linux %s Ramdisk Image\n",
 396                                 genimg_get_arch_name(arch));
 397                 bootstage_error(BOOTSTAGE_ID_RAMDISK);
 398                 return NULL;
 399         }
 400
 401         return rd_hdr;
 402 }
 403 #endif /* !USE_HOSTCC */
 404
 405 /*****************************************************************************/
 406 /* Shared dual-format routines */
 407 /*****************************************************************************/
 408 #ifndef USE_HOSTCC
 409 ulong load_addr = CONFIG_SYS_LOAD_ADDR; /* Default Load Address */
 410 ulong save_addr;                        /* Default Save Address */
 411 ulong save_size;                        /* Default Save Size (in bytes) */
 412
 413 static int on_loadaddr(const char *name, const char *value, enum env_op op,
 414         int flags)
 415 {
 416         switch (op) {
 417         case env_op_create:
 418         case env_op_overwrite:
 419                 load_addr = simple_strtoul(value, NULL, 16);
 420                 break;
 421         default:
 422                 break;
 423         }
 424
 425         return 0;
 426 }
 427 U_BOOT_ENV_CALLBACK(loadaddr, on_loadaddr);
 428
 429 ulong getenv_bootm_low(void)
 430 {
 431         char *s = getenv("bootm_low");
 432         if (s) {
 433                 ulong tmp = simple_strtoul(s, NULL, 16);
 434                 return tmp;
 435         }
 436
 437 #if defined(CONFIG_SYS_SDRAM_BASE)
 438         return CONFIG_SYS_SDRAM_BASE;
 439 #elif defined(CONFIG_ARM)
 440         return gd->bd->bi_dram[0].start;
 441 #else
 442         return 0;
 443 #endif
 444 }
 445
 446 phys_size_t getenv_bootm_size(void)
 447 {
 448         phys_size_t tmp;
 449         char *s = getenv("bootm_size");
 450         if (s) {
 451                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 452                 return tmp;
 453         }
 454         s = getenv("bootm_low");
 455         if (s)
 456                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 457         else
 458                 tmp = 0;
 459
 460
 461 #if defined(CONFIG_ARM)
 462         return gd->bd->bi_dram[0].size - tmp;
 463 #else
 464         return gd->bd->bi_memsize - tmp;
 465 #endif
 466 }
 467
 468 phys_size_t getenv_bootm_mapsize(void)
 469 {
 470         phys_size_t tmp;
 471         char *s = getenv("bootm_mapsize");
 472         if (s) {
 473                 tmp = (phys_size_t)simple_strtoull(s, NULL, 16);
 474                 return tmp;
 475         }
 476
 477 #if defined(CONFIG_SYS_BOOTMAPSZ)
 478         return CONFIG_SYS_BOOTMAPSZ;
 479 #else
 480         return getenv_bootm_size();
 481 #endif
 482 }
 483
 484 void memmove_wd(void *to, void *from, size_t len, ulong chunksz)
 485 {
 486         if (to == from)
 487                 return;
 488
 489 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 490         while (len > 0) {
 491                 size_t tail = (len > chunksz) ? chunksz : len;
 492                 WATCHDOG_RESET();
 493                 memmove(to, from, tail);
 494                 to += tail;
 495                 from += tail;
 496                 len -= tail;
 497         }
 498 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 499         memmove(to, from, len);
 500 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 501 }
 502 #endif /* !USE_HOSTCC */
 503
 504 void genimg_print_size(uint32_t size)
 505 {
 506 #ifndef USE_HOSTCC
 507         printf("%d Bytes = ", size);
 508         print_size(size, "\n");
 509 #else
 510         printf("%d Bytes = %.2f kB = %.2f MB\n",
 511                         size, (double)size / 1.024e3,
 512                         (double)size / 1.048576e6);
 513 #endif
 514 }
 515
 516 #if IMAGE_ENABLE_TIMESTAMP
 517 void genimg_print_time(time_t timestamp)
 518 {
 519 #ifndef USE_HOSTCC
 520         struct rtc_time tm;
 521
 522         to_tm(timestamp, &tm);
 523         printf("%4d-%02d-%02d  %2d:%02d:%02d UTC\n",
 524                         tm.tm_year, tm.tm_mon, tm.tm_mday,
 525                         tm.tm_hour, tm.tm_min, tm.tm_sec);
 526 #else
 527         printf("%s", ctime(&timestamp));
 528 #endif
 529 }
 530 #endif
 531
 532 /**
 533  * get_table_entry_name - translate entry id to long name
 534  * @table: pointer to a translation table for entries of a specific type
 535  * @msg: message to be returned when translation fails
 536  * @id: entry id to be translated
 537  *
 538  * get_table_entry_name() will go over translation table trying to find
 539  * entry that matches given id. If matching entry is found, its long
 540  * name is returned to the caller.
 541  *
 542  * returns:
 543  *     long entry name if translation succeeds
 544  *     msg otherwise
 545  */
 546 char *get_table_entry_name(const table_entry_t *table, char *msg, int id)
 547 {
 548         for (; table->id >= 0; ++table) {
 549                 if (table->id == id)
 550 #if defined(USE_HOSTCC) || !defined(CONFIG_NEEDS_MANUAL_RELOC)
 551                         return table->lname;
 552 #else
 553                         return table->lname + gd->reloc_off;
 554 #endif
 555         }
 556         return (msg);
 557 }
 558
 559 const char *genimg_get_os_name(uint8_t os)
 560 {
 561         return (get_table_entry_name(uimage_os, "Unknown OS", os));
 562 }
 563
 564 const char *genimg_get_arch_name(uint8_t arch)
 565 {
 566         return (get_table_entry_name(uimage_arch, "Unknown Architecture",
 567                                         arch));
 568 }
 569
 570 const char *genimg_get_type_name(uint8_t type)
 571 {
 572         return (get_table_entry_name(uimage_type, "Unknown Image", type));
 573 }
 574
 575 const char *genimg_get_comp_name(uint8_t comp)
 576 {
 577         return (get_table_entry_name(uimage_comp, "Unknown Compression",
 578                                         comp));
 579 }
 580
 581 /**
 582  * get_table_entry_id - translate short entry name to id
 583  * @table: pointer to a translation table for entries of a specific type
 584  * @table_name: to be used in case of error
 585  * @name: entry short name to be translated
 586  *
 587  * get_table_entry_id() will go over translation table trying to find
 588  * entry that matches given short name. If matching entry is found,
 589  * its id returned to the caller.
 590  *
 591  * returns:
 592  *     entry id if translation succeeds
 593  *     -1 otherwise
 594  */
 595 int get_table_entry_id(const table_entry_t *table,
 596                 const char *table_name, const char *name)
 597 {
 598         const table_entry_t *t;
 599 #ifdef USE_HOSTCC
 600         int first = 1;
 601
 602         for (t = table; t->id >= 0; ++t) {
 603                 if (t->sname && strcasecmp(t->sname, name) == 0)
 604                         return(t->id);
 605         }
 606
 607         fprintf(stderr, "\nInvalid %s Type - valid names are", table_name);
 608         for (t = table; t->id >= 0; ++t) {
 609                 if (t->sname == NULL)
 610                         continue;
 611                 fprintf(stderr, "%c %s", (first) ? ':' : ',', t->sname);
 612                 first = 0;
 613         }
 614         fprintf(stderr, "\n");
 615 #else
 616         for (t = table; t->id >= 0; ++t) {
 617 #ifdef CONFIG_NEEDS_MANUAL_RELOC
 618                 if (t->sname && strcmp(t->sname + gd->reloc_off, name) == 0)
 619 #else
 620                 if (t->sname && strcmp(t->sname, name) == 0)
 621 #endif
 622                         return (t->id);
 623         }
 624         debug("Invalid %s Type: %s\n", table_name, name);
 625 #endif /* USE_HOSTCC */
 626         return (-1);
 627 }
 628
 629 int genimg_get_os_id(const char *name)
 630 {
 631         return (get_table_entry_id(uimage_os, "OS", name));
 632 }
 633
 634 int genimg_get_arch_id(const char *name)
 635 {
 636         return (get_table_entry_id(uimage_arch, "CPU", name));
 637 }
 638
 639 int genimg_get_type_id(const char *name)
 640 {
 641         return (get_table_entry_id(uimage_type, "Image", name));
 642 }
 643
 644 int genimg_get_comp_id(const char *name)
 645 {
 646         return (get_table_entry_id(uimage_comp, "Compression", name));
 647 }
 648
 649 #ifndef USE_HOSTCC
 650 /**
 651  * genimg_get_format - get image format type
 652  * @img_addr: image start address
 653  *
 654  * genimg_get_format() checks whether provided address points to a valid
 655  * legacy or FIT image.
 656  *
 657  * New uImage format and FDT blob are based on a libfdt. FDT blob
 658  * may be passed directly or embedded in a FIT image. In both situations
 659  * genimg_get_format() must be able to dectect libfdt header.
 660  *
 661  * returns:
 662  *     image format type or IMAGE_FORMAT_INVALID if no image is present
 663  */
 664 int genimg_get_format(void *img_addr)
 665 {
 666         ulong format = IMAGE_FORMAT_INVALID;
 667         const image_header_t *hdr;
 668 #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT)
 669         char *fit_hdr;
 670 #endif
 671
 672         hdr = (const image_header_t *)img_addr;
 673         if (image_check_magic(hdr))
 674                 format = IMAGE_FORMAT_LEGACY;
 675 #if defined(CONFIG_FIT) || defined(CONFIG_OF_LIBFDT)
 676         else {
 677                 fit_hdr = (char *)img_addr;
 678                 if (fdt_check_header(fit_hdr) == 0)
 679                         format = IMAGE_FORMAT_FIT;
 680         }
 681 #endif
 682
 683         return format;
 684 }
 685
 686 /**
 687  * genimg_get_image - get image from special storage (if necessary)
 688  * @img_addr: image start address
 689  *
 690  * genimg_get_image() checks if provided image start adddress is located
 691  * in a dataflash storage. If so, image is moved to a system RAM memory.
 692  *
 693  * returns:
 694  *     image start address after possible relocation from special storage
 695  */
 696 ulong genimg_get_image(ulong img_addr)
 697 {
 698         ulong ram_addr = img_addr;
 699
 700 #ifdef CONFIG_HAS_DATAFLASH
 701         ulong h_size, d_size;
 702
 703         if (addr_dataflash(img_addr)) {
 704                 /* ger RAM address */
 705                 ram_addr = CONFIG_SYS_LOAD_ADDR;
 706
 707                 /* get header size */
 708                 h_size = image_get_header_size();
 709 #if defined(CONFIG_FIT)
 710                 if (sizeof(struct fdt_header) > h_size)
 711                         h_size = sizeof(struct fdt_header);
 712 #endif
 713
 714                 /* read in header */
 715                 debug("   Reading image header from dataflash address "
 716                         "%08lx to RAM address %08lx\n", img_addr, ram_addr);
 717
 718                 read_dataflash(img_addr, h_size, (char *)ram_addr);
 719
 720                 /* get data size */
 721                 switch (genimg_get_format((void *)ram_addr)) {
 722                 case IMAGE_FORMAT_LEGACY:
 723                         d_size = image_get_data_size(
 724                                         (const image_header_t *)ram_addr);
 725                         debug("   Legacy format image found at 0x%08lx, "
 726                                         "size 0x%08lx\n",
 727                                         ram_addr, d_size);
 728                         break;
 729 #if defined(CONFIG_FIT)
 730                 case IMAGE_FORMAT_FIT:
 731                         d_size = fit_get_size((const void *)ram_addr) - h_size;
 732                         debug("   FIT/FDT format image found at 0x%08lx, "
 733                                         "size 0x%08lx\n",
 734                                         ram_addr, d_size);
 735                         break;
 736 #endif
 737                 default:
 738                         printf("   No valid image found at 0x%08lx\n",
 739                                 img_addr);
 740                         return ram_addr;
 741                 }
 742
 743                 /* read in image data */
 744                 debug("   Reading image remaining data from dataflash address "
 745                         "%08lx to RAM address %08lx\n", img_addr + h_size,
 746                         ram_addr + h_size);
 747
 748                 read_dataflash(img_addr + h_size, d_size,
 749                                 (char *)(ram_addr + h_size));
 750
 751         }
 752 #endif /* CONFIG_HAS_DATAFLASH */
 753
 754         return ram_addr;
 755 }
 756
 757 /**
 758  * fit_has_config - check if there is a valid FIT configuration
 759  * @images: pointer to the bootm command headers structure
 760  *
 761  * fit_has_config() checks if there is a FIT configuration in use
 762  * (if FTI support is present).
 763  *
 764  * returns:
 765  *     0, no FIT support or no configuration found
 766  *     1, configuration found
 767  */
 768 int genimg_has_config(bootm_headers_t *images)
 769 {
 770 #if defined(CONFIG_FIT)
 771         if (images->fit_uname_cfg)
 772                 return 1;
 773 #endif
 774         return 0;
 775 }
 776
 777 /**
 778  * boot_get_ramdisk - main ramdisk handling routine
 779  * @argc: command argument count
 780  * @argv: command argument list
 781  * @images: pointer to the bootm images structure
 782  * @arch: expected ramdisk architecture
 783  * @rd_start: pointer to a ulong variable, will hold ramdisk start address
 784  * @rd_end: pointer to a ulong variable, will hold ramdisk end
 785  *
 786  * boot_get_ramdisk() is responsible for finding a valid ramdisk image.
 787  * Curently supported are the following ramdisk sources:
 788  *      - multicomponent kernel/ramdisk image,
 789  *      - commandline provided address of decicated ramdisk image.
 790  *
 791  * returns:
 792  *     0, if ramdisk image was found and valid, or skiped
 793  *     rd_start and rd_end are set to ramdisk start/end addresses if
 794  *     ramdisk image is found and valid
 795  *
 796  *     1, if ramdisk image is found but corrupted, or invalid
 797  *     rd_start and rd_end are set to 0 if no ramdisk exists
 798  */
 799 int boot_get_ramdisk(int argc, char * const argv[], bootm_headers_t *images,
 800                 uint8_t arch, ulong *rd_start, ulong *rd_end)
 801 {
 802         ulong rd_addr, rd_load;
 803         ulong rd_data, rd_len;
 804         const image_header_t *rd_hdr;
 805 #ifdef CONFIG_SUPPORT_RAW_INITRD
 806         char *end;
 807 #endif
 808 #if defined(CONFIG_FIT)
 809         void            *fit_hdr;
 810         const char      *fit_uname_config = NULL;
 811         const char      *fit_uname_ramdisk = NULL;
 812         ulong           default_addr;
 813         int             rd_noffset;
 814         int             cfg_noffset;
 815         const void      *data;
 816         size_t          size;
 817 #endif
 818
 819         *rd_start = 0;
 820         *rd_end = 0;
 821
 822         /*
 823          * Look for a '-' which indicates to ignore the
 824          * ramdisk argument
 825          */
 826         if ((argc >= 3) && (strcmp(argv[2], "-") ==  0)) {
 827                 debug("## Skipping init Ramdisk\n");
 828                 rd_len = rd_data = 0;
 829         } else if (argc >= 3 || genimg_has_config(images)) {
 830 #if defined(CONFIG_FIT)
 831                 if (argc >= 3) {
 832                         /*
 833                          * If the init ramdisk comes from the FIT image and
 834                          * the FIT image address is omitted in the command
 835                          * line argument, try to use os FIT image address or
 836                          * default load address.
 837                          */
 838                         if (images->fit_uname_os)
 839                                 default_addr = (ulong)images->fit_hdr_os;
 840                         else
 841                                 default_addr = load_addr;
 842
 843                         if (fit_parse_conf(argv[2], default_addr,
 844                                                 &rd_addr, &fit_uname_config)) {
 845                                 debug("*  ramdisk: config '%s' from image at "
 846                                                 "0x%08lx\n",
 847                                                 fit_uname_config, rd_addr);
 848                         } else if (fit_parse_subimage(argv[2], default_addr,
 849                                                 &rd_addr, &fit_uname_ramdisk)) {
 850                                 debug("*  ramdisk: subimage '%s' from image at "
 851                                                 "0x%08lx\n",
 852                                                 fit_uname_ramdisk, rd_addr);
 853                         } else
 854 #endif
 855                         {
 856                                 rd_addr = simple_strtoul(argv[2], NULL, 16);
 857                                 debug("*  ramdisk: cmdline image address = "
 858                                                 "0x%08lx\n",
 859                                                 rd_addr);
 860                         }
 861 #if defined(CONFIG_FIT)
 862                 } else {
 863                         /* use FIT configuration provided in first bootm
 864                          * command argument
 865                          */
 866                         rd_addr = (ulong)images->fit_hdr_os;
 867                         fit_uname_config = images->fit_uname_cfg;
 868                         debug("*  ramdisk: using config '%s' from image "
 869                                         "at 0x%08lx\n",
 870                                         fit_uname_config, rd_addr);
 871
 872                         /*
 873                          * Check whether configuration has ramdisk defined,
 874                          * if not, don't try to use it, quit silently.
 875                          */
 876                         fit_hdr = (void *)rd_addr;
 877                         cfg_noffset = fit_conf_get_node(fit_hdr,
 878                                                         fit_uname_config);
 879                         if (cfg_noffset < 0) {
 880                                 debug("*  ramdisk: no such config\n");
 881                                 return 1;
 882                         }
 883
 884                         rd_noffset = fit_conf_get_ramdisk_node(fit_hdr,
 885                                                                 cfg_noffset);
 886                         if (rd_noffset < 0) {
 887                                 debug("*  ramdisk: no ramdisk in config\n");
 888                                 return 0;
 889                         }
 890                 }
 891 #endif
 892
 893                 /* copy from dataflash if needed */
 894                 rd_addr = genimg_get_image(rd_addr);
 895
 896                 /*
 897                  * Check if there is an initrd image at the
 898                  * address provided in the second bootm argument
 899                  * check image type, for FIT images get FIT node.
 900                  */
 901                 switch (genimg_get_format((void *)rd_addr)) {
 902                 case IMAGE_FORMAT_LEGACY:
 903                         printf("## Loading init Ramdisk from Legacy "
 904                                         "Image at %08lx ...\n", rd_addr);
 905
 906                         bootstage_mark(BOOTSTAGE_ID_CHECK_RAMDISK);
 907                         rd_hdr = image_get_ramdisk(rd_addr, arch,
 908                                                         images->verify);
 909
 910                         if (rd_hdr == NULL)
 911                                 return 1;
 912
 913                         rd_data = image_get_data(rd_hdr);
 914                         rd_len = image_get_data_size(rd_hdr);
 915                         rd_load = image_get_load(rd_hdr);
 916                         break;
 917 #if defined(CONFIG_FIT)
 918                 case IMAGE_FORMAT_FIT:
 919                         fit_hdr = (void *)rd_addr;
 920                         printf("## Loading init Ramdisk from FIT "
 921                                         "Image at %08lx ...\n", rd_addr);
 922
 923                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_FORMAT);
 924                         if (!fit_check_format(fit_hdr)) {
 925                                 puts("Bad FIT ramdisk image format!\n");
 926                                 bootstage_error(
 927                                         BOOTSTAGE_ID_FIT_RD_FORMAT);
 928                                 return 1;
 929                         }
 930                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_FORMAT_OK);
 931
 932                         if (!fit_uname_ramdisk) {
 933                                 /*
 934                                  * no ramdisk image node unit name, try to get config
 935                                  * node first. If config unit node name is NULL
 936                                  * fit_conf_get_node() will try to find default config node
 937                                  */
 938                                 bootstage_mark(
 939                                         BOOTSTAGE_ID_FIT_RD_NO_UNIT_NAME);
 940                                 cfg_noffset = fit_conf_get_node(fit_hdr,
 941                                                         fit_uname_config);
 942                                 if (cfg_noffset < 0) {
 943                                         puts("Could not find configuration "
 944                                                 "node\n");
 945                                         bootstage_error(
 946                                         BOOTSTAGE_ID_FIT_RD_NO_UNIT_NAME);
 947                                         return 1;
 948                                 }
 949                                 fit_uname_config = fdt_get_name(fit_hdr,
 950                                                         cfg_noffset, NULL);
 951                                 printf("   Using '%s' configuration\n",
 952                                         fit_uname_config);
 953
 954                                 rd_noffset = fit_conf_get_ramdisk_node(fit_hdr,
 955                                                         cfg_noffset);
 956                                 fit_uname_ramdisk = fit_get_name(fit_hdr,
 957                                                         rd_noffset, NULL);
 958                         } else {
 959                                 /* get ramdisk component image node offset */
 960                                 bootstage_mark(
 961                                         BOOTSTAGE_ID_FIT_RD_UNIT_NAME);
 962                                 rd_noffset = fit_image_get_node(fit_hdr,
 963                                                 fit_uname_ramdisk);
 964                         }
 965                         if (rd_noffset < 0) {
 966                                 puts("Could not find subimage node\n");
 967                                 bootstage_error(BOOTSTAGE_ID_FIT_RD_SUBNODE);
 968                                 return 1;
 969                         }
 970
 971                         printf("   Trying '%s' ramdisk subimage\n",
 972                                 fit_uname_ramdisk);
 973
 974                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_CHECK);
 975                         if (!fit_check_ramdisk(fit_hdr, rd_noffset, arch,
 976                                                 images->verify))
 977                                 return 1;
 978
 979                         /* get ramdisk image data address and length */
 980                         if (fit_image_get_data(fit_hdr, rd_noffset, &data,
 981                                                 &size)) {
 982                                 puts("Could not find ramdisk subimage data!\n");
 983                                 bootstage_error(BOOTSTAGE_ID_FIT_RD_GET_DATA);
 984                                 return 1;
 985                         }
 986                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_GET_DATA_OK);
 987
 988                         rd_data = (ulong)data;
 989                         rd_len = size;
 990
 991                         if (fit_image_get_load(fit_hdr, rd_noffset, &rd_load)) {
 992                                 puts("Can't get ramdisk subimage load "
 993                                         "address!\n");
 994                                 bootstage_error(BOOTSTAGE_ID_FIT_RD_LOAD);
 995                                 return 1;
 996                         }
 997                         bootstage_mark(BOOTSTAGE_ID_FIT_RD_LOAD);
 998
 999                         images->fit_hdr_rd = fit_hdr;
1000                         images->fit_uname_rd = fit_uname_ramdisk;
1001                         images->fit_noffset_rd = rd_noffset;
1002                         break;
1003 #endif
1004                 default:
1005 #ifdef CONFIG_SUPPORT_RAW_INITRD
1006                         if (argc >= 3 && (end = strchr(argv[2], ':'))) {
1007                                 rd_len = simple_strtoul(++end, NULL, 16);
1008                                 rd_data = rd_addr;
1009                         } else
1010 #endif
1011                         {
1012                                 puts("Wrong Ramdisk Image Format\n");
1013                                 rd_data = rd_len = rd_load = 0;
1014                                 return 1;
1015                         }
1016                 }
1017         } else if (images->legacy_hdr_valid &&
1018                         image_check_type(&images->legacy_hdr_os_copy,
1019                                                 IH_TYPE_MULTI)) {
1020
1021                 /*
1022                  * Now check if we have a legacy mult-component image,
1023                  * get second entry data start address and len.
1024                  */
1025                 bootstage_mark(BOOTSTAGE_ID_RAMDISK);
1026                 printf("## Loading init Ramdisk from multi component "
1027                                 "Legacy Image at %08lx ...\n",
1028                                 (ulong)images->legacy_hdr_os);
1029
1030                 image_multi_getimg(images->legacy_hdr_os, 1, &rd_data, &rd_len);
1031         } else {
1032                 /*
1033                  * no initrd image
1034                  */
1035                 bootstage_mark(BOOTSTAGE_ID_NO_RAMDISK);
1036                 rd_len = rd_data = 0;
1037         }
1038
1039         if (!rd_data) {
1040                 debug("## No init Ramdisk\n");
1041         } else {
1042                 *rd_start = rd_data;
1043                 *rd_end = rd_data + rd_len;
1044         }
1045         debug("   ramdisk start = 0x%08lx, ramdisk end = 0x%08lx\n",
1046                         *rd_start, *rd_end);
1047
1048         return 0;
1049 }
1050
1051 #ifdef CONFIG_SYS_BOOT_RAMDISK_HIGH
1052 /**
1053  * boot_ramdisk_high - relocate init ramdisk
1054  * @lmb: pointer to lmb handle, will be used for memory mgmt
1055  * @rd_data: ramdisk data start address
1056  * @rd_len: ramdisk data length
1057  * @initrd_start: pointer to a ulong variable, will hold final init ramdisk
1058  *      start address (after possible relocation)
1059  * @initrd_end: pointer to a ulong variable, will hold final init ramdisk
1060  *      end address (after possible relocation)
1061  *
1062  * boot_ramdisk_high() takes a relocation hint from "initrd_high" environement
1063  * variable and if requested ramdisk data is moved to a specified location.
1064  *
1065  * Initrd_start and initrd_end are set to final (after relocation) ramdisk
1066  * start/end addresses if ramdisk image start and len were provided,
1067  * otherwise set initrd_start and initrd_end set to zeros.
1068  *
1069  * returns:
1070  *      0 - success
1071  *     -1 - failure
1072  */
1073 int boot_ramdisk_high(struct lmb *lmb, ulong rd_data, ulong rd_len,
1074                   ulong *initrd_start, ulong *initrd_end)
1075 {
1076         char    *s;
1077         ulong   initrd_high;
1078         int     initrd_copy_to_ram = 1;
1079
1080         if ((s = getenv("initrd_high")) != NULL) {
1081                 /* a value of "no" or a similar string will act like 0,
1082                  * turning the "load high" feature off. This is intentional.
1083                  */
1084                 initrd_high = simple_strtoul(s, NULL, 16);
1085                 if (initrd_high == ~0)
1086                         initrd_copy_to_ram = 0;
1087         } else {
1088                 /* not set, no restrictions to load high */
1089                 initrd_high = ~0;
1090         }
1091
1092
1093 #ifdef CONFIG_LOGBUFFER
1094         /* Prevent initrd from overwriting logbuffer */
1095         lmb_reserve(lmb, logbuffer_base() - LOGBUFF_OVERHEAD, LOGBUFF_RESERVE);
1096 #endif
1097
1098         debug("## initrd_high = 0x%08lx, copy_to_ram = %d\n",
1099                         initrd_high, initrd_copy_to_ram);
1100
1101         if (rd_data) {
1102                 if (!initrd_copy_to_ram) {      /* zero-copy ramdisk support */
1103                         debug("   in-place initrd\n");
1104                         *initrd_start = rd_data;
1105                         *initrd_end = rd_data + rd_len;
1106                         lmb_reserve(lmb, rd_data, rd_len);
1107                 } else {
1108                         if (initrd_high)
1109                                 *initrd_start = (ulong)lmb_alloc_base(lmb,
1110                                                 rd_len, 0x1000, initrd_high);
1111                         else
1112                                 *initrd_start = (ulong)lmb_alloc(lmb, rd_len,
1113                                                                  0x1000);
1114
1115                         if (*initrd_start == 0) {
1116                                 puts("ramdisk - allocation error\n");
1117                                 goto error;
1118                         }
1119                         bootstage_mark(BOOTSTAGE_ID_COPY_RAMDISK);
1120
1121                         *initrd_end = *initrd_start + rd_len;
1122                         printf("   Loading Ramdisk to %08lx, end %08lx ... ",
1123                                         *initrd_start, *initrd_end);
1124
1125                         memmove_wd((void *)*initrd_start,
1126                                         (void *)rd_data, rd_len, CHUNKSZ);
1127
1128 #ifdef CONFIG_MP
1129                         /*
1130                          * Ensure the image is flushed to memory to handle
1131                          * AMP boot scenarios in which we might not be
1132                          * HW cache coherent
1133                          */
1134                         flush_cache((unsigned long)*initrd_start, rd_len);
1135 #endif
1136                         puts("OK\n");
1137                 }
1138         } else {
1139                 *initrd_start = 0;
1140                 *initrd_end = 0;
1141         }
1142         debug("   ramdisk load start = 0x%08lx, ramdisk load end = 0x%08lx\n",
1143                         *initrd_start, *initrd_end);
1144
1145         return 0;
1146
1147 error:
1148         return -1;
1149 }
1150 #endif /* CONFIG_SYS_BOOT_RAMDISK_HIGH */
1151
1152 #ifdef CONFIG_OF_LIBFDT
1153 static void fdt_error(const char *msg)
1154 {
1155         puts("ERROR: ");
1156         puts(msg);
1157         puts(" - must RESET the board to recover.\n");
1158 }
1159
1160 static const image_header_t *image_get_fdt(ulong fdt_addr)
1161 {
1162         const image_header_t *fdt_hdr = (const image_header_t *)fdt_addr;
1163
1164         image_print_contents(fdt_hdr);
1165
1166         puts("   Verifying Checksum ... ");
1167         if (!image_check_hcrc(fdt_hdr)) {
1168                 fdt_error("fdt header checksum invalid");
1169                 return NULL;
1170         }
1171
1172         if (!image_check_dcrc(fdt_hdr)) {
1173                 fdt_error("fdt checksum invalid");
1174                 return NULL;
1175         }
1176         puts("OK\n");
1177
1178         if (!image_check_type(fdt_hdr, IH_TYPE_FLATDT)) {
1179                 fdt_error("uImage is not a fdt");
1180                 return NULL;
1181         }
1182         if (image_get_comp(fdt_hdr) != IH_COMP_NONE) {
1183                 fdt_error("uImage is compressed");
1184                 return NULL;
1185         }
1186         if (fdt_check_header((char *)image_get_data(fdt_hdr)) != 0) {
1187                 fdt_error("uImage data is not a fdt");
1188                 return NULL;
1189         }
1190         return fdt_hdr;
1191 }
1192
1193 /**
1194  * fit_check_fdt - verify FIT format FDT subimage
1195  * @fit_hdr: pointer to the FIT  header
1196  * fdt_noffset: FDT subimage node offset within FIT image
1197  * @verify: data CRC verification flag
1198  *
1199  * fit_check_fdt() verifies integrity of the FDT subimage and from
1200  * specified FIT image.
1201  *
1202  * returns:
1203  *     1, on success
1204  *     0, on failure
1205  */
1206 #if defined(CONFIG_FIT)
1207 static int fit_check_fdt(const void *fit, int fdt_noffset, int verify)
1208 {
1209         fit_image_print(fit, fdt_noffset, "   ");
1210
1211         if (verify) {
1212                 puts("   Verifying Hash Integrity ... ");
1213                 if (!fit_image_check_hashes(fit, fdt_noffset)) {
1214                         fdt_error("Bad Data Hash");
1215                         return 0;
1216                 }
1217                 puts("OK\n");
1218         }
1219
1220         if (!fit_image_check_type(fit, fdt_noffset, IH_TYPE_FLATDT)) {
1221                 fdt_error("Not a FDT image");
1222                 return 0;
1223         }
1224
1225         if (!fit_image_check_comp(fit, fdt_noffset, IH_COMP_NONE)) {
1226                 fdt_error("FDT image is compressed");
1227                 return 0;
1228         }
1229
1230         return 1;
1231 }
1232 #endif /* CONFIG_FIT */
1233
1234 #ifndef CONFIG_SYS_FDT_PAD
1235 #define CONFIG_SYS_FDT_PAD 0x3000
1236 #endif
1237
1238 #if defined(CONFIG_OF_LIBFDT)
1239 /**
1240  * boot_fdt_add_mem_rsv_regions - Mark the memreserve sections as unusable
1241  * @lmb: pointer to lmb handle, will be used for memory mgmt
1242  * @fdt_blob: pointer to fdt blob base address
1243  *
1244  * Adds the memreserve regions in the dtb to the lmb block.  Adding the
1245  * memreserve regions prevents u-boot from using them to store the initrd
1246  * or the fdt blob.
1247  */
1248 void boot_fdt_add_mem_rsv_regions(struct lmb *lmb, void *fdt_blob)
1249 {
1250         uint64_t addr, size;
1251         int i, total;
1252
1253         if (fdt_check_header(fdt_blob) != 0)
1254                 return;
1255
1256         total = fdt_num_mem_rsv(fdt_blob);
1257         for (i = 0; i < total; i++) {
1258                 if (fdt_get_mem_rsv(fdt_blob, i, &addr, &size) != 0)
1259                         continue;
1260                 printf("   reserving fdt memory region: addr=%llx size=%llx\n",
1261                         (unsigned long long)addr, (unsigned long long)size);
1262                 lmb_reserve(lmb, addr, size);
1263         }
1264 }
1265
1266 /**
1267  * boot_relocate_fdt - relocate flat device tree
1268  * @lmb: pointer to lmb handle, will be used for memory mgmt
1269  * @of_flat_tree: pointer to a char* variable, will hold fdt start address
1270  * @of_size: pointer to a ulong variable, will hold fdt length
1271  *
1272  * boot_relocate_fdt() allocates a region of memory within the bootmap and
1273  * relocates the of_flat_tree into that region, even if the fdt is already in
1274  * the bootmap.  It also expands the size of the fdt by CONFIG_SYS_FDT_PAD
1275  * bytes.
1276  *
1277  * of_flat_tree and of_size are set to final (after relocation) values
1278  *
1279  * returns:
1280  *      0 - success
1281  *      1 - failure
1282  */
1283 int boot_relocate_fdt(struct lmb *lmb, char **of_flat_tree, ulong *of_size)
1284 {
1285         void    *fdt_blob = *of_flat_tree;
1286         void    *of_start = NULL;
1287         char    *fdt_high;
1288         ulong   of_len = 0;
1289         int     err;
1290         int     disable_relocation = 0;
1291
1292         /* nothing to do */
1293         if (*of_size == 0)
1294                 return 0;
1295
1296         if (fdt_check_header(fdt_blob) != 0) {
1297                 fdt_error("image is not a fdt");
1298                 goto error;
1299         }
1300
1301         /* position on a 4K boundary before the alloc_current */
1302         /* Pad the FDT by a specified amount */
1303         of_len = *of_size + CONFIG_SYS_FDT_PAD;
1304
1305         /* If fdt_high is set use it to select the relocation address */
1306         fdt_high = getenv("fdt_high");
1307         if (fdt_high) {
1308                 void *desired_addr = (void *)simple_strtoul(fdt_high, NULL, 16);
1309
1310                 if (((ulong) desired_addr) == ~0UL) {
1311                         /* All ones means use fdt in place */
1312                         of_start = fdt_blob;
1313                         lmb_reserve(lmb, (ulong)of_start, of_len);
1314                         disable_relocation = 1;
1315                 } else if (desired_addr) {
1316                         of_start =
1317                             (void *)(ulong) lmb_alloc_base(lmb, of_len, 0x1000,
1318                                                            (ulong)desired_addr);
1319                         if (of_start == NULL) {
1320                                 puts("Failed using fdt_high value for Device Tree");
1321                                 goto error;
1322                         }
1323                 } else {
1324                         of_start =
1325                             (void *)(ulong) lmb_alloc(lmb, of_len, 0x1000);
1326                 }
1327         } else {
1328                 of_start =
1329                     (void *)(ulong) lmb_alloc_base(lmb, of_len, 0x1000,
1330                                                    getenv_bootm_mapsize()
1331                                                    + getenv_bootm_low());
1332         }
1333
1334         if (of_start == NULL) {
1335                 puts("device tree - allocation error\n");
1336                 goto error;
1337         }
1338
1339         if (disable_relocation) {
1340                 /* We assume there is space after the existing fdt to use for padding */
1341                 fdt_set_totalsize(of_start, of_len);
1342                 printf("   Using Device Tree in place at %p, end %p\n",
1343                        of_start, of_start + of_len - 1);
1344         } else {
1345                 debug("## device tree at %p ... %p (len=%ld [0x%lX])\n",
1346                         fdt_blob, fdt_blob + *of_size - 1, of_len, of_len);
1347
1348                 printf("   Loading Device Tree to %p, end %p ... ",
1349                         of_start, of_start + of_len - 1);
1350
1351                 err = fdt_open_into(fdt_blob, of_start, of_len);
1352                 if (err != 0) {
1353                         fdt_error("fdt move failed");
1354                         goto error;
1355                 }
1356                 puts("OK\n");
1357         }
1358
1359         *of_flat_tree = of_start;
1360         *of_size = of_len;
1361
1362         set_working_fdt_addr(*of_flat_tree);
1363         return 0;
1364
1365 error:
1366         return 1;
1367 }
1368 #endif /* CONFIG_OF_LIBFDT */
1369
1370 /**
1371  * boot_get_fdt - main fdt handling routine
1372  * @argc: command argument count
1373  * @argv: command argument list
1374  * @images: pointer to the bootm images structure
1375  * @of_flat_tree: pointer to a char* variable, will hold fdt start address
1376  * @of_size: pointer to a ulong variable, will hold fdt length
1377  *
1378  * boot_get_fdt() is responsible for finding a valid flat device tree image.
1379  * Curently supported are the following ramdisk sources:
1380  *      - multicomponent kernel/ramdisk image,
1381  *      - commandline provided address of decicated ramdisk image.
1382  *
1383  * returns:
1384  *     0, if fdt image was found and valid, or skipped
1385  *     of_flat_tree and of_size are set to fdt start address and length if
1386  *     fdt image is found and valid
1387  *
1388  *     1, if fdt image is found but corrupted
1389  *     of_flat_tree and of_size are set to 0 if no fdt exists
1390  */
1391 int boot_get_fdt(int flag, int argc, char * const argv[],
1392                 bootm_headers_t *images, char **of_flat_tree, ulong *of_size)
1393 {
1394         const image_header_t *fdt_hdr;
1395         ulong           fdt_addr;
1396         char            *fdt_blob = NULL;
1397         ulong           image_start, image_data, image_end;
1398         ulong           load_start, load_end;
1399 #if defined(CONFIG_FIT)
1400         void            *fit_hdr;
1401         const char      *fit_uname_config = NULL;
1402         const char      *fit_uname_fdt = NULL;
1403         ulong           default_addr;
1404         int             cfg_noffset;
1405         int             fdt_noffset;
1406         const void      *data;
1407         size_t          size;
1408 #endif
1409
1410         *of_flat_tree = NULL;
1411         *of_size = 0;
1412
1413         if (argc > 3 || genimg_has_config(images)) {
1414 #if defined(CONFIG_FIT)
1415                 if (argc > 3) {
1416                         /*
1417                          * If the FDT blob comes from the FIT image and the
1418                          * FIT image address is omitted in the command line
1419                          * argument, try to use ramdisk or os FIT image
1420                          * address or default load address.
1421                          */
1422                         if (images->fit_uname_rd)
1423                                 default_addr = (ulong)images->fit_hdr_rd;
1424                         else if (images->fit_uname_os)
1425                                 default_addr = (ulong)images->fit_hdr_os;
1426                         else
1427                                 default_addr = load_addr;
1428
1429                         if (fit_parse_conf(argv[3], default_addr,
1430                                                 &fdt_addr, &fit_uname_config)) {
1431                                 debug("*  fdt: config '%s' from image at "
1432                                                 "0x%08lx\n",
1433                                                 fit_uname_config, fdt_addr);
1434                         } else if (fit_parse_subimage(argv[3], default_addr,
1435                                                 &fdt_addr, &fit_uname_fdt)) {
1436                                 debug("*  fdt: subimage '%s' from image at "
1437                                                 "0x%08lx\n",
1438                                                 fit_uname_fdt, fdt_addr);
1439                         } else
1440 #endif
1441                         {
1442                                 fdt_addr = simple_strtoul(argv[3], NULL, 16);
1443                                 debug("*  fdt: cmdline image address = "
1444                                                 "0x%08lx\n",
1445                                                 fdt_addr);
1446                         }
1447 #if defined(CONFIG_FIT)
1448                 } else {
1449                         /* use FIT configuration provided in first bootm
1450                          * command argument
1451                          */
1452                         fdt_addr = (ulong)images->fit_hdr_os;
1453                         fit_uname_config = images->fit_uname_cfg;
1454                         debug("*  fdt: using config '%s' from image "
1455                                         "at 0x%08lx\n",
1456                                         fit_uname_config, fdt_addr);
1457
1458                         /*
1459                          * Check whether configuration has FDT blob defined,
1460                          * if not quit silently.
1461                          */
1462                         fit_hdr = (void *)fdt_addr;
1463                         cfg_noffset = fit_conf_get_node(fit_hdr,
1464                                         fit_uname_config);
1465                         if (cfg_noffset < 0) {
1466                                 debug("*  fdt: no such config\n");
1467                                 return 0;
1468                         }
1469
1470                         fdt_noffset = fit_conf_get_fdt_node(fit_hdr,
1471                                         cfg_noffset);
1472                         if (fdt_noffset < 0) {
1473                                 debug("*  fdt: no fdt in config\n");
1474                                 return 0;
1475                         }
1476                 }
1477 #endif
1478
1479                 debug("## Checking for 'FDT'/'FDT Image' at %08lx\n",
1480                                 fdt_addr);
1481
1482                 /* copy from dataflash if needed */
1483                 fdt_addr = genimg_get_image(fdt_addr);
1484
1485                 /*
1486                  * Check if there is an FDT image at the
1487                  * address provided in the second bootm argument
1488                  * check image type, for FIT images get a FIT node.
1489                  */
1490                 switch (genimg_get_format((void *)fdt_addr)) {
1491                 case IMAGE_FORMAT_LEGACY:
1492                         /* verify fdt_addr points to a valid image header */
1493                         printf("## Flattened Device Tree from Legacy Image "
1494                                         "at %08lx\n",
1495                                         fdt_addr);
1496                         fdt_hdr = image_get_fdt(fdt_addr);
1497                         if (!fdt_hdr)
1498                                 goto error;
1499
1500                         /*
1501                          * move image data to the load address,
1502                          * make sure we don't overwrite initial image
1503                          */
1504                         image_start = (ulong)fdt_hdr;
1505                         image_data = (ulong)image_get_data(fdt_hdr);
1506                         image_end = image_get_image_end(fdt_hdr);
1507
1508                         load_start = image_get_load(fdt_hdr);
1509                         load_end = load_start + image_get_data_size(fdt_hdr);
1510
1511                         if (load_start == image_start ||
1512                             load_start == image_data) {
1513                                 fdt_blob = (char *)image_data;
1514                                 break;
1515                         }
1516
1517                         if ((load_start < image_end) && (load_end > image_start)) {
1518                                 fdt_error("fdt overwritten");
1519                                 goto error;
1520                         }
1521
1522                         debug("   Loading FDT from 0x%08lx to 0x%08lx\n",
1523                                         image_data, load_start);
1524
1525                         memmove((void *)load_start,
1526                                         (void *)image_data,
1527                                         image_get_data_size(fdt_hdr));
1528
1529                         fdt_blob = (char *)load_start;
1530                         break;
1531                 case IMAGE_FORMAT_FIT:
1532                         /*
1533                          * This case will catch both: new uImage format
1534                          * (libfdt based) and raw FDT blob (also libfdt
1535                          * based).
1536                          */
1537 #if defined(CONFIG_FIT)
1538                         /* check FDT blob vs FIT blob */
1539                         if (fit_check_format((const void *)fdt_addr)) {
1540                                 /*
1541                                  * FIT image
1542                                  */
1543                                 fit_hdr = (void *)fdt_addr;
1544                                 printf("## Flattened Device Tree from FIT "
1545                                                 "Image at %08lx\n",
1546                                                 fdt_addr);
1547
1548                                 if (!fit_uname_fdt) {
1549                                         /*
1550                                          * no FDT blob image node unit name,
1551                                          * try to get config node first. If
1552                                          * config unit node name is NULL
1553                                          * fit_conf_get_node() will try to
1554                                          * find default config node
1555                                          */
1556                                         cfg_noffset = fit_conf_get_node(fit_hdr,
1557                                                         fit_uname_config);
1558
1559                                         if (cfg_noffset < 0) {
1560                                                 fdt_error("Could not find "
1561                                                             "configuration "
1562                                                             "node\n");
1563                                                 goto error;
1564                                         }
1565
1566                                         fit_uname_config = fdt_get_name(fit_hdr,
1567                                                         cfg_noffset, NULL);
1568                                         printf("   Using '%s' configuration\n",
1569                                                         fit_uname_config);
1570
1571                                         fdt_noffset = fit_conf_get_fdt_node(
1572                                                         fit_hdr,
1573                                                         cfg_noffset);
1574                                         fit_uname_fdt = fit_get_name(fit_hdr,
1575                                                         fdt_noffset, NULL);
1576                                 } else {
1577                                         /* get FDT component image node offset */
1578                                         fdt_noffset = fit_image_get_node(
1579                                                                 fit_hdr,
1580                                                                 fit_uname_fdt);
1581                                 }
1582                                 if (fdt_noffset < 0) {
1583                                         fdt_error("Could not find subimage "
1584                                                         "node\n");
1585                                         goto error;
1586                                 }
1587
1588                                 printf("   Trying '%s' FDT blob subimage\n",
1589                                                 fit_uname_fdt);
1590
1591                                 if (!fit_check_fdt(fit_hdr, fdt_noffset,
1592                                                         images->verify))
1593                                         goto error;
1594
1595                                 /* get ramdisk image data address and length */
1596                                 if (fit_image_get_data(fit_hdr, fdt_noffset,
1597                                                         &data, &size)) {
1598                                         fdt_error("Could not find FDT "
1599                                                         "subimage data");
1600                                         goto error;
1601                                 }
1602
1603                                 /* verift that image data is a proper FDT blob */
1604                                 if (fdt_check_header((char *)data) != 0) {
1605                                         fdt_error("Subimage data is not a FTD");
1606                                         goto error;
1607                                 }
1608
1609                                 /*
1610                                  * move image data to the load address,
1611                                  * make sure we don't overwrite initial image
1612                                  */
1613                                 image_start = (ulong)fit_hdr;
1614                                 image_end = fit_get_end(fit_hdr);
1615
1616                                 if (fit_image_get_load(fit_hdr, fdt_noffset,
1617                                                         &load_start) == 0) {
1618                                         load_end = load_start + size;
1619
1620                                         if ((load_start < image_end) &&
1621                                                         (load_end > image_start)) {
1622                                                 fdt_error("FDT overwritten");
1623                                                 goto error;
1624                                         }
1625
1626                                         printf("   Loading FDT from 0x%08lx "
1627                                                         "to 0x%08lx\n",
1628                                                         (ulong)data,
1629                                                         load_start);
1630
1631                                         memmove((void *)load_start,
1632                                                         (void *)data, size);
1633
1634                                         fdt_blob = (char *)load_start;
1635                                 } else {
1636                                         fdt_blob = (char *)data;
1637                                 }
1638
1639                                 images->fit_hdr_fdt = fit_hdr;
1640                                 images->fit_uname_fdt = fit_uname_fdt;
1641                                 images->fit_noffset_fdt = fdt_noffset;
1642                                 break;
1643                         } else
1644 #endif
1645                         {
1646                                 /*
1647                                  * FDT blob
1648                                  */
1649                                 fdt_blob = (char *)fdt_addr;
1650                                 debug("*  fdt: raw FDT blob\n");
1651                                 printf("## Flattened Device Tree blob at "
1652                                         "%08lx\n", (long)fdt_blob);
1653                         }
1654                         break;
1655                 default:
1656                         puts("ERROR: Did not find a cmdline Flattened Device "
1657                                 "Tree\n");
1658                         goto error;
1659                 }
1660
1661                 printf("   Booting using the fdt blob at 0x%p\n", fdt_blob);
1662
1663         } else if (images->legacy_hdr_valid &&
1664                         image_check_type(&images->legacy_hdr_os_copy,
1665                                                 IH_TYPE_MULTI)) {
1666
1667                 ulong fdt_data, fdt_len;
1668
1669                 /*
1670                  * Now check if we have a legacy multi-component image,
1671                  * get second entry data start address and len.
1672                  */
1673                 printf("## Flattened Device Tree from multi "
1674                         "component Image at %08lX\n",
1675                         (ulong)images->legacy_hdr_os);
1676
1677                 image_multi_getimg(images->legacy_hdr_os, 2, &fdt_data,
1678                                         &fdt_len);
1679                 if (fdt_len) {
1680
1681                         fdt_blob = (char *)fdt_data;
1682                         printf("   Booting using the fdt at 0x%p\n", fdt_blob);
1683
1684                         if (fdt_check_header(fdt_blob) != 0) {
1685                                 fdt_error("image is not a fdt");
1686                                 goto error;
1687                         }
1688
1689                         if (fdt_totalsize(fdt_blob) != fdt_len) {
1690                                 fdt_error("fdt size != image size");
1691                                 goto error;
1692                         }
1693                 } else {
1694                         debug("## No Flattened Device Tree\n");
1695                         return 0;
1696                 }
1697         } else {
1698                 debug("## No Flattened Device Tree\n");
1699                 return 0;
1700         }
1701
1702         *of_flat_tree = fdt_blob;
1703         *of_size = fdt_totalsize(fdt_blob);
1704         debug("   of_flat_tree at 0x%08lx size 0x%08lx\n",
1705                         (ulong)*of_flat_tree, *of_size);
1706
1707         return 0;
1708
1709 error:
1710         *of_flat_tree = NULL;
1711         *of_size = 0;
1712         return 1;
1713 }
1714 #endif /* CONFIG_OF_LIBFDT */
1715
1716 #ifdef CONFIG_SYS_BOOT_GET_CMDLINE
1717 /**
1718  * boot_get_cmdline - allocate and initialize kernel cmdline
1719  * @lmb: pointer to lmb handle, will be used for memory mgmt
1720  * @cmd_start: pointer to a ulong variable, will hold cmdline start
1721  * @cmd_end: pointer to a ulong variable, will hold cmdline end
1722  *
1723  * boot_get_cmdline() allocates space for kernel command line below
1724  * BOOTMAPSZ + getenv_bootm_low() address. If "bootargs" U-boot environemnt
1725  * variable is present its contents is copied to allocated kernel
1726  * command line.
1727  *
1728  * returns:
1729  *      0 - success
1730  *     -1 - failure
1731  */
1732 int boot_get_cmdline(struct lmb *lmb, ulong *cmd_start, ulong *cmd_end)
1733 {
1734         char *cmdline;
1735         char *s;
1736
1737         cmdline = (char *)(ulong)lmb_alloc_base(lmb, CONFIG_SYS_BARGSIZE, 0xf,
1738                                 getenv_bootm_mapsize() + getenv_bootm_low());
1739
1740         if (cmdline == NULL)
1741                 return -1;
1742
1743         if ((s = getenv("bootargs")) == NULL)
1744                 s = "";
1745
1746         strcpy(cmdline, s);
1747
1748         *cmd_start = (ulong) & cmdline[0];
1749         *cmd_end = *cmd_start + strlen(cmdline);
1750
1751         debug("## cmdline at 0x%08lx ... 0x%08lx\n", *cmd_start, *cmd_end);
1752
1753         return 0;
1754 }
1755 #endif /* CONFIG_SYS_BOOT_GET_CMDLINE */
1756
1757 #ifdef CONFIG_SYS_BOOT_GET_KBD
1758 /**
1759  * boot_get_kbd - allocate and initialize kernel copy of board info
1760  * @lmb: pointer to lmb handle, will be used for memory mgmt
1761  * @kbd: double pointer to board info data
1762  *
1763  * boot_get_kbd() allocates space for kernel copy of board info data below
1764  * BOOTMAPSZ + getenv_bootm_low() address and kernel board info is initialized
1765  * with the current u-boot board info data.
1766  *
1767  * returns:
1768  *      0 - success
1769  *     -1 - failure
1770  */
1771 int boot_get_kbd(struct lmb *lmb, bd_t **kbd)
1772 {
1773         *kbd = (bd_t *)(ulong)lmb_alloc_base(lmb, sizeof(bd_t), 0xf,
1774                                 getenv_bootm_mapsize() + getenv_bootm_low());
1775         if (*kbd == NULL)
1776                 return -1;
1777
1778         **kbd = *(gd->bd);
1779
1780         debug("## kernel board info at 0x%08lx\n", (ulong)*kbd);
1781
1782 #if defined(DEBUG) && defined(CONFIG_CMD_BDI)
1783         do_bdinfo(NULL, 0, 0, NULL);
1784 #endif
1785
1786         return 0;
1787 }
1788 #endif /* CONFIG_SYS_BOOT_GET_KBD */
1789 #endif /* !USE_HOSTCC */