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 #define DEBUG
  27
  28 #ifndef USE_HOSTCC
  29 #include <common.h>
  30 #include <watchdog.h>
  31
  32 #ifdef CONFIG_SHOW_BOOT_PROGRESS
  33 #include <status_led.h>
  34 #endif
  35
  36 #ifdef CONFIG_HAS_DATAFLASH
  37 #include <dataflash.h>
  38 #endif
  39
  40 #ifdef CONFIG_LOGBUFFER
  41 #include <logbuff.h>
  42 #endif
  43
  44 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
  45 #include <rtc.h>
  46 #endif
  47
  48 #if defined(CONFIG_FIT)
  49 #include <fdt.h>
  50 #include <libfdt.h>
  51 #include <fdt_support.h>
  52 #endif
  53
  54 extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
  55
  56 #ifdef CONFIG_CMD_BDI
  57 extern int do_bdinfo(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
  58 #endif
  59
  60 DECLARE_GLOBAL_DATA_PTR;
  61 #else
  62 #include "mkimage.h"
  63 #endif /* USE_HOSTCC*/
  64
  65 #include <image.h>
  66
  67 unsigned long crc32 (unsigned long, const unsigned char *, unsigned int);
  68
  69 int image_check_hcrc (image_header_t *hdr)
  70 {
  71         ulong hcrc;
  72         ulong len = image_get_header_size ();
  73         image_header_t header;
  74
  75         /* Copy header so we can blank CRC field for re-calculation */
  76         memmove (&header, (char *)hdr, image_get_header_size ());
  77         image_set_hcrc (&header, 0);
  78
  79         hcrc = crc32 (0, (unsigned char *)&header, len);
  80
  81         return (hcrc == image_get_hcrc (hdr));
  82 }
  83
  84 int image_check_dcrc (image_header_t *hdr)
  85 {
  86         ulong data = image_get_data (hdr);
  87         ulong len = image_get_data_size (hdr);
  88         ulong dcrc = crc32 (0, (unsigned char *)data, len);
  89
  90         return (dcrc == image_get_dcrc (hdr));
  91 }
  92
  93 #ifndef USE_HOSTCC
  94 int image_check_dcrc_wd (image_header_t *hdr, ulong chunksz)
  95 {
  96         ulong dcrc = 0;
  97         ulong len = image_get_data_size (hdr);
  98         ulong data = image_get_data (hdr);
  99
 100 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 101         ulong cdata = data;
 102         ulong edata = cdata + len;
 103
 104         while (cdata < edata) {
 105                 ulong chunk = edata - cdata;
 106
 107                 if (chunk > chunksz)
 108                         chunk = chunksz;
 109                 dcrc = crc32 (dcrc, (unsigned char *)cdata, chunk);
 110                 cdata += chunk;
 111
 112                 WATCHDOG_RESET ();
 113         }
 114 #else
 115         dcrc = crc32 (0, (unsigned char *)data, len);
 116 #endif
 117
 118         return (dcrc == image_get_dcrc (hdr));
 119 }
 120
 121 int getenv_verify (void)
 122 {
 123         char *s = getenv ("verify");
 124         return (s && (*s == 'n')) ? 0 : 1;
 125 }
 126
 127 void memmove_wd (void *to, void *from, size_t len, ulong chunksz)
 128 {
 129 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 130         while (len > 0) {
 131                 size_t tail = (len > chunksz) ? chunksz : len;
 132                 WATCHDOG_RESET ();
 133                 memmove (to, from, tail);
 134                 to += tail;
 135                 from += tail;
 136                 len -= tail;
 137         }
 138 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 139         memmove (to, from, len);
 140 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 141 }
 142 #endif /* USE_HOSTCC */
 143
 144 /**
 145  * image_multi_count - get component (sub-image) count
 146  * @hdr: pointer to the header of the multi component image
 147  *
 148  * image_multi_count() returns number of components in a multi
 149  * component image.
 150  *
 151  * Note: no checking of the image type is done, caller must pass
 152  * a valid multi component image.
 153  *
 154  * returns:
 155  *     number of components
 156  */
 157 ulong image_multi_count (image_header_t *hdr)
 158 {
 159         ulong i, count = 0;
 160         ulong *size;
 161
 162         /* get start of the image payload, which in case of multi
 163          * component images that points to a table of component sizes */
 164         size = (ulong *)image_get_data (hdr);
 165
 166         /* count non empty slots */
 167         for (i = 0; size[i]; ++i)
 168                 count++;
 169
 170         return count;
 171 }
 172
 173 /**
 174  * image_multi_getimg - get component data address and size
 175  * @hdr: pointer to the header of the multi component image
 176  * @idx: index of the requested component
 177  * @data: pointer to a ulong variable, will hold component data address
 178  * @len: pointer to a ulong variable, will hold component size
 179  *
 180  * image_multi_getimg() returns size and data address for the requested
 181  * component in a multi component image.
 182  *
 183  * Note: no checking of the image type is done, caller must pass
 184  * a valid multi component image.
 185  *
 186  * returns:
 187  *     data address and size of the component, if idx is valid
 188  *     0 in data and len, if idx is out of range
 189  */
 190 void image_multi_getimg (image_header_t *hdr, ulong idx,
 191                         ulong *data, ulong *len)
 192 {
 193         int i;
 194         ulong *size;
 195         ulong offset, tail, count, img_data;
 196
 197         /* get number of component */
 198         count = image_multi_count (hdr);
 199
 200         /* get start of the image payload, which in case of multi
 201          * component images that points to a table of component sizes */
 202         size = (ulong *)image_get_data (hdr);
 203
 204         /* get address of the proper component data start, which means
 205          * skipping sizes table (add 1 for last, null entry) */
 206         img_data = image_get_data (hdr) + (count + 1) * sizeof (ulong);
 207
 208         if (idx < count) {
 209                 *len = size[idx];
 210                 offset = 0;
 211                 tail = 0;
 212
 213                 /* go over all indices preceding requested component idx */
 214                 for (i = 0; i < idx; i++) {
 215                         /* add up i-th component size */
 216                         offset += size[i];
 217
 218                         /* add up alignment for i-th component */
 219                         tail += (4 - size[i] % 4);
 220                 }
 221
 222                 /* calculate idx-th component data address */
 223                 *data = img_data + offset + tail;
 224         } else {
 225                 *len = 0;
 226                 *data = 0;
 227         }
 228 }
 229
 230 #ifndef USE_HOSTCC
 231 const char* image_get_os_name (uint8_t os)
 232 {
 233         const char *name;
 234
 235         switch (os) {
 236         case IH_OS_INVALID:     name = "Invalid OS";            break;
 237         case IH_OS_NETBSD:      name = "NetBSD";                break;
 238         case IH_OS_LINUX:       name = "Linux";                 break;
 239         case IH_OS_VXWORKS:     name = "VxWorks";               break;
 240         case IH_OS_QNX:         name = "QNX";                   break;
 241         case IH_OS_U_BOOT:      name = "U-Boot";                break;
 242         case IH_OS_RTEMS:       name = "RTEMS";                 break;
 243 #ifdef CONFIG_ARTOS
 244         case IH_OS_ARTOS:       name = "ARTOS";                 break;
 245 #endif
 246 #ifdef CONFIG_LYNXKDI
 247         case IH_OS_LYNXOS:      name = "LynxOS";                break;
 248 #endif
 249         default:                name = "Unknown OS";            break;
 250         }
 251
 252         return name;
 253 }
 254
 255 const char* image_get_arch_name (uint8_t arch)
 256 {
 257         const char *name;
 258
 259         switch (arch) {
 260         case IH_ARCH_INVALID:   name = "Invalid Architecture";  break;
 261         case IH_ARCH_ALPHA:     name = "Alpha";                 break;
 262         case IH_ARCH_ARM:       name = "ARM";                   break;
 263         case IH_ARCH_AVR32:     name = "AVR32";                 break;
 264         case IH_ARCH_BLACKFIN:  name = "Blackfin";              break;
 265         case IH_ARCH_I386:      name = "Intel x86";             break;
 266         case IH_ARCH_IA64:      name = "IA64";                  break;
 267         case IH_ARCH_M68K:      name = "M68K";                  break;
 268         case IH_ARCH_MICROBLAZE:name = "Microblaze";            break;
 269         case IH_ARCH_MIPS64:    name = "MIPS 64 Bit";           break;
 270         case IH_ARCH_MIPS:      name = "MIPS";                  break;
 271         case IH_ARCH_NIOS2:     name = "Nios-II";               break;
 272         case IH_ARCH_NIOS:      name = "Nios";                  break;
 273         case IH_ARCH_PPC:       name = "PowerPC";               break;
 274         case IH_ARCH_S390:      name = "IBM S390";              break;
 275         case IH_ARCH_SH:        name = "SuperH";                break;
 276         case IH_ARCH_SPARC64:   name = "SPARC 64 Bit";          break;
 277         case IH_ARCH_SPARC:     name = "SPARC";                 break;
 278         default:                name = "Unknown Architecture";  break;
 279         }
 280
 281         return name;
 282 }
 283
 284 const char* image_get_type_name (uint8_t type)
 285 {
 286         const char *name;
 287
 288         switch (type) {
 289         case IH_TYPE_INVALID:   name = "Invalid Image";         break;
 290         case IH_TYPE_STANDALONE:name = "Standalone Program";    break;
 291         case IH_TYPE_KERNEL:    name = "Kernel Image";          break;
 292         case IH_TYPE_RAMDISK:   name = "RAMDisk Image";         break;
 293         case IH_TYPE_MULTI:     name = "Multi-File Image";      break;
 294         case IH_TYPE_FIRMWARE:  name = "Firmware";              break;
 295         case IH_TYPE_SCRIPT:    name = "Script";                break;
 296         case IH_TYPE_FLATDT:    name = "Flat Device Tree";      break;
 297         default:                name = "Unknown Image";         break;
 298         }
 299
 300         return name;
 301 }
 302
 303 const char* image_get_comp_name (uint8_t comp)
 304 {
 305         const char *name;
 306
 307         switch (comp) {
 308         case IH_COMP_NONE:      name = "uncompressed";          break;
 309         case IH_COMP_GZIP:      name = "gzip compressed";       break;
 310         case IH_COMP_BZIP2:     name = "bzip2 compressed";      break;
 311         default:                name = "unknown compression";   break;
 312         }
 313
 314         return name;
 315 }
 316
 317 static void image_print_type (image_header_t *hdr)
 318 {
 319         const char *os, *arch, *type, *comp;
 320
 321         os = image_get_os_name (image_get_os (hdr));
 322         arch = image_get_arch_name (image_get_arch (hdr));
 323         type = image_get_type_name (image_get_type (hdr));
 324         comp = image_get_comp_name (image_get_comp (hdr));
 325
 326         printf ("%s %s %s (%s)", arch, os, type, comp);
 327 }
 328
 329 void image_print_contents (image_header_t *hdr)
 330 {
 331 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
 332         time_t timestamp = (time_t)image_get_time (hdr);
 333         struct rtc_time tm;
 334 #endif
 335
 336         printf ("   Image Name:   %.*s\n", IH_NMLEN, image_get_name (hdr));
 337
 338 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
 339         to_tm (timestamp, &tm);
 340         printf ("   Created:      %4d-%02d-%02d  %2d:%02d:%02d UTC\n",
 341                 tm.tm_year, tm.tm_mon, tm.tm_mday,
 342                 tm.tm_hour, tm.tm_min, tm.tm_sec);
 343 #endif
 344         puts ("   Image Type:   ");
 345         image_print_type (hdr);
 346
 347         printf ("\n   Data Size:    %d Bytes = ", image_get_data_size (hdr));
 348         print_size (image_get_data_size (hdr), "\n");
 349         printf ("   Load Address: %08x\n"
 350                 "   Entry Point:  %08x\n",
 351                  image_get_load (hdr), image_get_ep (hdr));
 352
 353         if (image_check_type (hdr, IH_TYPE_MULTI)) {
 354                 int i;
 355                 ulong data, len;
 356                 ulong count = image_multi_count (hdr);
 357
 358                 puts ("   Contents:\n");
 359                 for (i = 0; i < count; i++) {
 360                         image_multi_getimg (hdr, i, &data, &len);
 361                         printf ("   Image %d: %8ld Bytes = ", i, len);
 362                         print_size (len, "\n");
 363                 }
 364         }
 365 }
 366
 367 /**
 368  * gen_image_get_format - get image format type
 369  * @img_addr: image start address
 370  *
 371  * gen_image_get_format() checks whether provided address points to a valid
 372  * legacy or FIT image.
 373  *
 374  * returns:
 375  *     image format type or IMAGE_FORMAT_INVALID if no image is present
 376  */
 377 int gen_image_get_format (void *img_addr)
 378 {
 379         ulong           format = IMAGE_FORMAT_INVALID;
 380         image_header_t  *hdr;
 381 #if defined(CONFIG_FIT)
 382         char            *fit_hdr;
 383 #endif
 384
 385         hdr = (image_header_t *)img_addr;
 386         if (image_check_magic(hdr))
 387                 format = IMAGE_FORMAT_LEGACY;
 388 #if defined(CONFIG_FIT)
 389         else {
 390                 fit_hdr = (char *)img_addr;
 391                 if (fdt_check_header (fit_hdr) == 0)
 392                         format = IMAGE_FORMAT_FIT;
 393         }
 394 #endif
 395
 396         return format;
 397 }
 398
 399 /**
 400  * gen_get_image - get image from special storage (if necessary)
 401  * @img_addr: image start address
 402  *
 403  * gen_get_image() checks if provided image start adddress is located
 404  * in a dataflash storage. If so, image is moved to a system RAM memory.
 405  *
 406  * returns:
 407  *     image start address after possible relocation from special storage
 408  */
 409 ulong gen_get_image (ulong img_addr)
 410 {
 411         ulong ram_addr, h_size, d_size;
 412
 413         h_size = image_get_header_size ();
 414 #if defined(CONFIG_FIT)
 415         if (sizeof(struct fdt_header) > h_size)
 416                 h_size = sizeof(struct fdt_header);
 417 #endif
 418
 419 #ifdef CONFIG_HAS_DATAFLASH
 420         if (addr_dataflash (img_addr)){
 421                 ram_addr = CFG_LOAD_ADDR;
 422                 debug ("   Reading image header from dataflash address "
 423                         "%08lx to RAM address %08lx\n", img_addr, ram_addr);
 424                 read_dataflash (img_addr, h_size, (char *)ram_addr);
 425         } else
 426 #endif
 427                 return img_addr;
 428
 429         ram_addr = img_addr;
 430
 431         switch (gen_image_get_format ((void *)ram_addr)) {
 432         case IMAGE_FORMAT_LEGACY:
 433                 d_size = image_get_data_size ((image_header_t *)ram_addr);
 434                 debug ("   Legacy format image found at 0x%08lx, size 0x%08lx\n",
 435                                 ram_addr, d_size);
 436                 break;
 437 #if defined(CONFIG_FIT)
 438         case IMAGE_FORMAT_FIT:
 439                 d_size = fdt_totalsize((void *)ram_addr) - h_size;
 440                 debug ("   FIT/FDT format image found at 0x%08lx, size 0x%08lx\n",
 441                                 ram_addr, d_size);
 442
 443                 break;
 444 #endif
 445         default:
 446                 printf ("   No valid image found at 0x%08lx\n", img_addr);
 447                 return ram_addr;
 448         }
 449
 450 #ifdef CONFIG_HAS_DATAFLASH
 451         if (addr_dataflash (img_addr)) {
 452                 debug ("   Reading image remaining data from dataflash address "
 453                         "%08lx to RAM address %08lx\n", img_addr + h_size,
 454                         ram_addr + h_size);
 455
 456                 read_dataflash (img_addr + h_size, d_size,
 457                                 (char *)(ram_addr + h_size));
 458         }
 459 #endif
 460
 461         return ram_addr;
 462 }
 463
 464 /**
 465  * image_get_ramdisk - get and verify ramdisk image
 466  * @cmdtp: command table pointer
 467  * @flag: command flag
 468  * @argc: command argument count
 469  * @argv: command argument list
 470  * @rd_addr: ramdisk image start address
 471  * @arch: expected ramdisk architecture
 472  * @verify: checksum verification flag
 473  *
 474  * image_get_ramdisk() returns a pointer to the verified ramdisk image
 475  * header. Routine receives image start address and expected architecture
 476  * flag. Verification done covers data and header integrity and os/type/arch
 477  * fields checking.
 478  *
 479  * If dataflash support is enabled routine checks for dataflash addresses
 480  * and handles required dataflash reads.
 481  *
 482  * returns:
 483  *     pointer to a ramdisk image header, if image was found and valid
 484  *     otherwise, board is reset
 485  */
 486 image_header_t* image_get_ramdisk (cmd_tbl_t *cmdtp, int flag,
 487                 int argc, char *argv[],
 488                 ulong rd_addr, uint8_t arch, int verify)
 489 {
 490         image_header_t *rd_hdr;
 491
 492         show_boot_progress (9);
 493         rd_hdr = (image_header_t *)rd_addr;
 494
 495         if (!image_check_magic (rd_hdr)) {
 496                 puts ("Bad Magic Number\n");
 497                 show_boot_progress (-10);
 498                 do_reset (cmdtp, flag, argc, argv);
 499         }
 500
 501         if (!image_check_hcrc (rd_hdr)) {
 502                 puts ("Bad Header Checksum\n");
 503                 show_boot_progress (-11);
 504                 do_reset (cmdtp, flag, argc, argv);
 505         }
 506
 507         show_boot_progress (10);
 508         image_print_contents (rd_hdr);
 509
 510         if (verify) {
 511                 puts("   Verifying Checksum ... ");
 512                 if (!image_check_dcrc_wd (rd_hdr, CHUNKSZ)) {
 513                         puts ("Bad Data CRC\n");
 514                         show_boot_progress (-12);
 515                         do_reset (cmdtp, flag, argc, argv);
 516                 }
 517                 puts("OK\n");
 518         }
 519
 520         show_boot_progress (11);
 521
 522         if (!image_check_os (rd_hdr, IH_OS_LINUX) ||
 523             !image_check_arch (rd_hdr, arch) ||
 524             !image_check_type (rd_hdr, IH_TYPE_RAMDISK)) {
 525                 printf ("No Linux %s Ramdisk Image\n",
 526                                 image_get_arch_name(arch));
 527                 show_boot_progress (-13);
 528                 do_reset (cmdtp, flag, argc, argv);
 529         }
 530
 531         return rd_hdr;
 532 }
 533
 534 /**
 535  * get_ramdisk - main ramdisk handling routine
 536  * @cmdtp: command table pointer
 537  * @flag: command flag
 538  * @argc: command argument count
 539  * @argv: command argument list
 540  * @images: pointer to the bootm images strcture
 541  * @verify: checksum verification flag
 542  * @arch: expected ramdisk architecture
 543  * @rd_start: pointer to a ulong variable, will hold ramdisk start address
 544  * @rd_end: pointer to a ulong variable, will hold ramdisk end
 545  *
 546  * get_ramdisk() is responsible for finding a valid ramdisk image.
 547  * Curently supported are the following ramdisk sources:
 548  *      - multicomponent kernel/ramdisk image,
 549  *      - commandline provided address of decicated ramdisk image.
 550  *
 551  * returns:
 552  *     rd_start and rd_end are set to ramdisk start/end addresses if
 553  *     ramdisk image is found and valid
 554  *     rd_start and rd_end are set to 0 if no ramdisk exists
 555  *     board is reset if ramdisk image is found but corrupted
 556  */
 557 void get_ramdisk (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
 558                 bootm_headers_t *images, int verify, uint8_t arch,
 559                 ulong *rd_start, ulong *rd_end)
 560 {
 561         ulong rd_addr, rd_load;
 562         ulong rd_data, rd_len;
 563         image_header_t *rd_hdr;
 564 #if defined(CONFIG_FIT)
 565         void            *fit_hdr;
 566         const char      *fit_uname_config = NULL;
 567         const char      *fit_uname_ramdisk = NULL;
 568         ulong           default_addr;
 569 #endif
 570
 571         /*
 572          * Look for a '-' which indicates to ignore the
 573          * ramdisk argument
 574          */
 575         if ((argc >= 3) && (strcmp(argv[2], "-") ==  0)) {
 576                 debug ("## Skipping init Ramdisk\n");
 577                 rd_len = rd_data = 0;
 578         } else if (argc >= 3) {
 579 #if defined(CONFIG_FIT)
 580                 /*
 581                  * If the init ramdisk comes from the FIT image and the FIT image
 582                  * address is omitted in the command line argument, try to use
 583                  * os FIT image address or default load address.
 584                  */
 585                 if (images->fit_uname_os)
 586                         default_addr = (ulong)images->fit_hdr_os;
 587                 else
 588                         default_addr = load_addr;
 589
 590                 if (fit_parse_conf (argv[2], default_addr,
 591                                         &rd_addr, &fit_uname_config)) {
 592                         debug ("*  ramdisk: config '%s' from image at 0x%08lx\n",
 593                                         fit_uname_config, rd_addr);
 594                 } else if (fit_parse_subimage (argv[2], default_addr,
 595                                         &rd_addr, &fit_uname_ramdisk)) {
 596                         debug ("*  ramdisk: subimage '%s' from image at 0x%08lx\n",
 597                                         fit_uname_ramdisk, rd_addr);
 598                 } else
 599 #endif
 600                 {
 601                         rd_addr = simple_strtoul(argv[2], NULL, 16);
 602                         debug ("*  ramdisk: cmdline image address = 0x%08lx\n",
 603                                         rd_addr);
 604                 }
 605
 606                 /* copy from dataflash if needed */
 607                 printf ("## Loading init Ramdisk Image at %08lx ...\n",
 608                                 rd_addr);
 609                 rd_addr = gen_get_image (rd_addr);
 610
 611                 /*
 612                  * Check if there is an initrd image at the
 613                  * address provided in the second bootm argument
 614                  * check image type, for FIT images get FIT node.
 615                  */
 616                 switch (gen_image_get_format ((void *)rd_addr)) {
 617                 case IMAGE_FORMAT_LEGACY:
 618
 619                         debug ("*  ramdisk: legacy format image\n");
 620
 621                         rd_hdr = image_get_ramdisk (cmdtp, flag, argc, argv,
 622                                                 rd_addr, arch, verify);
 623
 624                         rd_data = image_get_data (rd_hdr);
 625                         rd_len = image_get_data_size (rd_hdr);
 626                         rd_load = image_get_load (rd_hdr);
 627                         break;
 628 #if defined(CONFIG_FIT)
 629                 case IMAGE_FORMAT_FIT:
 630                         fit_hdr = (void *)rd_addr;
 631                         debug ("*  ramdisk: FIT format image\n");
 632                         fit_unsupported_reset ("ramdisk");
 633                         do_reset (cmdtp, flag, argc, argv);
 634 #endif
 635                 default:
 636                         printf ("Wrong Image Format for %s command\n",
 637                                         cmdtp->name);
 638                         rd_data = rd_len = 0;
 639                 }
 640
 641 #if defined(CONFIG_B2) || defined(CONFIG_EVB4510) || defined(CONFIG_ARMADILLO)
 642                 /*
 643                  * We need to copy the ramdisk to SRAM to let Linux boot
 644                  */
 645                 if (rd_data) {
 646                         memmove ((void *)rd_load, (uchar *)rd_data, rd_len);
 647                         rd_data = rd_load;
 648                 }
 649 #endif /* CONFIG_B2 || CONFIG_EVB4510 || CONFIG_ARMADILLO */
 650
 651         } else if (images->legacy_hdr_valid &&
 652                         image_check_type (images->legacy_hdr_os, IH_TYPE_MULTI)) {
 653                 /*
 654                  * Now check if we have a legacy mult-component image,
 655                  * get second entry data start address and len.
 656                  */
 657                 show_boot_progress (13);
 658                 printf ("## Loading init Ramdisk from multi component "
 659                                 "Image at %08lx ...\n",
 660                                 (ulong)images->legacy_hdr_os);
 661
 662                 image_multi_getimg (images->legacy_hdr_os, 1, &rd_data, &rd_len);
 663         } else {
 664                 /*
 665                  * no initrd image
 666                  */
 667                 show_boot_progress (14);
 668                 rd_len = rd_data = 0;
 669         }
 670
 671         if (!rd_data) {
 672                 debug ("## No init Ramdisk\n");
 673                 *rd_start = 0;
 674                 *rd_end = 0;
 675         } else {
 676                 *rd_start = rd_data;
 677                 *rd_end = rd_data + rd_len;
 678         }
 679         debug ("   ramdisk start = 0x%08lx, ramdisk end = 0x%08lx\n",
 680                         *rd_start, *rd_end);
 681 }
 682
 683 #if defined(CONFIG_PPC) || defined(CONFIG_M68K)
 684 /**
 685  * ramdisk_high - relocate init ramdisk
 686  * @rd_data: ramdisk data start address
 687  * @rd_len: ramdisk data length
 688  * @kbd: kernel board info copy (within BOOTMAPSZ boundary)
 689  * @sp_limit: stack pointer limit (including BOOTMAPSZ)
 690  * @sp: current stack pointer
 691  * @initrd_start: pointer to a ulong variable, will hold final init ramdisk
 692  *      start address (after possible relocation)
 693  * @initrd_end: pointer to a ulong variable, will hold final init ramdisk
 694  *      end address (after possible relocation)
 695  *
 696  * ramdisk_high() takes a relocation hint from "initrd_high" environement
 697  * variable and if requested ramdisk data is moved to a specified location.
 698  *
 699  * returns:
 700  *     - initrd_start and initrd_end are set to final (after relocation) ramdisk
 701  *     start/end addresses if ramdisk image start and len were provided
 702  *     otherwise set initrd_start and initrd_end set to zeros
 703  *     - returns new allc_current, next free address below BOOTMAPSZ
 704  */
 705 ulong ramdisk_high (ulong alloc_current, ulong rd_data, ulong rd_len,
 706                 bd_t *kbd, ulong sp_limit, ulong sp,
 707                 ulong *initrd_start, ulong *initrd_end)
 708 {
 709         char    *s;
 710         ulong   initrd_high;
 711         int     initrd_copy_to_ram = 1;
 712         ulong   new_alloc_current = alloc_current;
 713
 714         if ((s = getenv ("initrd_high")) != NULL) {
 715                 /* a value of "no" or a similar string will act like 0,
 716                  * turning the "load high" feature off. This is intentional.
 717                  */
 718                 initrd_high = simple_strtoul (s, NULL, 16);
 719                 if (initrd_high == ~0)
 720                         initrd_copy_to_ram = 0;
 721         } else {
 722                 /* not set, no restrictions to load high */
 723                 initrd_high = ~0;
 724         }
 725
 726 #ifdef CONFIG_LOGBUFFER
 727         /* Prevent initrd from overwriting logbuffer */
 728         if (initrd_high < (kbd->bi_memsize - LOGBUFF_LEN - LOGBUFF_OVERHEAD))
 729                 initrd_high = kbd->bi_memsize - LOGBUFF_LEN - LOGBUFF_OVERHEAD;
 730         debug ("## Logbuffer at 0x%08lx ", kbd->bi_memsize - LOGBUFF_LEN);
 731 #endif
 732         debug ("## initrd_high = 0x%08lx, copy_to_ram = %d\n",
 733                         initrd_high, initrd_copy_to_ram);
 734
 735         if (rd_data) {
 736                 if (!initrd_copy_to_ram) {      /* zero-copy ramdisk support */
 737                         debug ("   in-place initrd\n");
 738                         *initrd_start = rd_data;
 739                         *initrd_end = rd_data + rd_len;
 740                 } else {
 741                         new_alloc_current = alloc_current - rd_len;
 742                         *initrd_start  = new_alloc_current;
 743                         *initrd_start &= ~(4096 - 1);   /* align on page */
 744
 745                         if (initrd_high) {
 746                                 ulong nsp;
 747
 748                                 /*
 749                                  * the inital ramdisk does not need to be within
 750                                  * CFG_BOOTMAPSZ as it is not accessed until after
 751                                  * the mm system is initialised.
 752                                  *
 753                                  * do the stack bottom calculation again and see if
 754                                  * the initrd will fit just below the monitor stack
 755                                  * bottom without overwriting the area allocated
 756                                  * for command line args and board info.
 757                                  */
 758                                 nsp = sp;
 759                                 nsp -= 2048;            /* just to be sure */
 760                                 nsp &= ~0xF;
 761
 762                                 if (nsp > initrd_high)  /* limit as specified */
 763                                         nsp = initrd_high;
 764
 765                                 nsp -= rd_len;
 766                                 nsp &= ~(4096 - 1);     /* align on page */
 767
 768                                 if (nsp >= sp_limit) {
 769                                         *initrd_start = nsp;
 770                                         new_alloc_current = alloc_current;
 771                                 }
 772                         }
 773
 774                         show_boot_progress (12);
 775
 776                         *initrd_end = *initrd_start + rd_len;
 777                         printf ("   Loading Ramdisk to %08lx, end %08lx ... ",
 778                                         *initrd_start, *initrd_end);
 779
 780                         memmove_wd((void *)*initrd_start,
 781                                         (void *)rd_data, rd_len, CHUNKSZ);
 782
 783                         puts ("OK\n");
 784                 }
 785         } else {
 786                 *initrd_start = 0;
 787                 *initrd_end = 0;
 788         }
 789         debug ("   ramdisk load start = 0x%08lx, ramdisk load end = 0x%08lx\n",
 790                         *initrd_start, *initrd_end);
 791
 792         return new_alloc_current;
 793 }
 794
 795 /**
 796  * get_boot_sp_limit - calculate stack pointer limit
 797  * @sp: current stack pointer
 798  *
 799  * get_boot_sp_limit() takes current stack pointer adrress and calculates
 800  * stack pointer limit, below which kernel boot data (cmdline, board info,
 801  * etc.) will be allocated.
 802  *
 803  * returns:
 804  *     stack pointer limit
 805  */
 806 ulong get_boot_sp_limit(ulong sp)
 807 {
 808         ulong sp_limit = sp;
 809
 810         sp_limit -= 2048;       /* just to be sure */
 811
 812         /* make sure sp_limit is within kernel mapped space */
 813         if (sp_limit > CFG_BOOTMAPSZ)
 814                 sp_limit = CFG_BOOTMAPSZ;
 815         sp_limit &= ~0xF;
 816
 817         return sp_limit;
 818 }
 819
 820 /**
 821  * get_boot_cmdline - allocate and initialize kernel cmdline
 822  * @alloc_current: current boot allocation address (counting down
 823  *      from sp_limit)
 824  * @cmd_start: pointer to a ulong variable, will hold cmdline start
 825  * @cmd_end: pointer to a ulong variable, will hold cmdline end
 826  *
 827  * get_boot_cmdline() allocates space for kernel command line below
 828  * provided alloc_current address. If "bootargs" U-boot environemnt
 829  * variable is present its contents is copied to allocated kernel
 830  * command line.
 831  *
 832  * returns:
 833  *     alloc_current after cmdline allocation
 834  */
 835 ulong get_boot_cmdline (ulong alloc_current, ulong *cmd_start, ulong *cmd_end)
 836 {
 837         char *cmdline;
 838         char *s;
 839
 840         cmdline = (char *)((alloc_current - CFG_BARGSIZE) & ~0xF);
 841
 842         if ((s = getenv("bootargs")) == NULL)
 843                 s = "";
 844
 845         strcpy(cmdline, s);
 846
 847         *cmd_start = (ulong) & cmdline[0];
 848         *cmd_end = *cmd_start + strlen(cmdline);
 849
 850         debug ("## cmdline at 0x%08lx ... 0x%08lx\n", *cmd_start, *cmd_end);
 851
 852         return (ulong)cmdline;
 853 }
 854
 855 /**
 856  * get_boot_kbd - allocate and initialize kernel copy of board info
 857  * @alloc_current: current boot allocation address (counting down
 858  *      from sp_limit)
 859  * @kbd: double pointer to board info data
 860  *
 861  * get_boot_kbd() - allocates space for kernel copy of board info data.
 862  * Space is allocated below provided alloc_current address and kernel
 863  * board info is initialized with the current u-boot board info data.
 864  *
 865  * returns:
 866  *     alloc_current after kbd allocation
 867  */
 868 ulong get_boot_kbd (ulong alloc_current, bd_t **kbd)
 869 {
 870         *kbd = (bd_t *) (((ulong)alloc_current - sizeof(bd_t)) & ~0xF);
 871         **kbd = *(gd->bd);
 872
 873         debug ("## kernel board info at 0x%08lx\n", (ulong)*kbd);
 874
 875 #if defined(DEBUG) && defined(CONFIG_CMD_BDI)
 876         do_bdinfo(NULL, 0, 0, NULL);
 877 #endif
 878
 879         return (ulong)*kbd;
 880 }
 881 #endif /* CONFIG_PPC || CONFIG_M68K */
 882
 883 #if defined(CONFIG_FIT)
 884 /*****************************************************************************/
 885 /* New uImage format routines */
 886 /*****************************************************************************/
 887 static int fit_parse_spec (const char *spec, char sepc, ulong addr_curr,
 888                 ulong *addr, const char **name)
 889 {
 890         const char *sep;
 891
 892         *addr = addr_curr;
 893         *name = NULL;
 894
 895         sep = strchr (spec, sepc);
 896         if (sep) {
 897                 if (sep - spec > 0)
 898                         *addr = simple_strtoul (spec, NULL, 16);
 899
 900                 *name = sep + 1;
 901                 return 1;
 902         }
 903
 904         return 0;
 905 }
 906
 907 /**
 908  * fit_parse_conf - parse FIT configuration spec
 909  * @spec: input string, containing configuration spec
 910  * @add_curr: current image address (to be used as a possible default)
 911  * @addr: pointer to a ulong variable, will hold FIT image address of a given
 912  * configuration
 913  * @conf_name double pointer to a char, will hold pointer to a configuration
 914  * unit name
 915  *
 916  * fit_parse_conf() expects configuration spec in the for of [<addr>]#<conf>,
 917  * where <addr> is a FIT image address that contains configuration
 918  * with a <conf> unit name.
 919  *
 920  * Address part is optional, and if omitted default add_curr will
 921  * be used instead.
 922  *
 923  * returns:
 924  *     1 if spec is a valid configuration string,
 925  *     addr and conf_name are set accordingly
 926  *     0 otherwise
 927  */
 928 inline int fit_parse_conf (const char *spec, ulong addr_curr,
 929                 ulong *addr, const char **conf_name)
 930 {
 931         return fit_parse_spec (spec, '#', addr_curr, addr, conf_name);
 932 }
 933
 934 /**
 935  * fit_parse_subimage - parse FIT subimage spec
 936  * @spec: input string, containing subimage spec
 937  * @add_curr: current image address (to be used as a possible default)
 938  * @addr: pointer to a ulong variable, will hold FIT image address of a given
 939  * subimage
 940  * @image_name: double pointer to a char, will hold pointer to a subimage name
 941  *
 942  * fit_parse_subimage() expects subimage spec in the for of
 943  * [<addr>]:<subimage>, where <addr> is a FIT image address that contains
 944  * subimage with a <subimg> unit name.
 945  *
 946  * Address part is optional, and if omitted default add_curr will
 947  * be used instead.
 948  *
 949  * returns:
 950  *     1 if spec is a valid subimage string,
 951  *     addr and image_name are set accordingly
 952  *     0 otherwise
 953  */
 954 inline int fit_parse_subimage (const char *spec, ulong addr_curr,
 955                 ulong *addr, const char **image_name)
 956 {
 957         return fit_parse_spec (spec, ':', addr_curr, addr, image_name);
 958 }
 959
 960 #endif /* CONFIG_FIT */
 961
 962 #endif /* USE_HOSTCC */