common/cmd_bootm.c

   1 /*
   2  * (C) Copyright 2000-2006
   3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4  *
   5  * See file CREDITS for list of people who contributed to this
   6  * project.
   7  *
   8  * This program is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU General Public License as
  10  * published by the Free Software Foundation; either version 2 of
  11  * the License, or (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21  * MA 02111-1307 USA
  22  */
  23
  24 /*
  25  * Boot support
  26  */
  27 #include <common.h>
  28 #include <watchdog.h>
  29 #include <command.h>
  30 #include <image.h>
  31 #include <malloc.h>
  32 #include <zlib.h>
  33 #include <bzlib.h>
  34 #include <environment.h>
  35 #include <asm/byteorder.h>
  36
  37 #if defined(CONFIG_OF_LIBFDT)
  38 #include <fdt.h>
  39 #include <libfdt.h>
  40 #include <fdt_support.h>
  41 #endif
  42 #if defined(CONFIG_OF_FLAT_TREE)
  43 #include <ft_build.h>
  44 #endif
  45
  46 DECLARE_GLOBAL_DATA_PTR;
  47
  48 /*cmd_boot.c*/
  49 extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
  50
  51 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
  52 #include <rtc.h>
  53 #endif
  54
  55 #ifdef CFG_HUSH_PARSER
  56 #include <hush.h>
  57 #endif
  58
  59 #ifdef CFG_INIT_RAM_LOCK
  60 #include <asm/cache.h>
  61 #endif
  62
  63 #ifdef CONFIG_LOGBUFFER
  64 #include <logbuff.h>
  65 #endif
  66
  67 #ifdef CONFIG_HAS_DATAFLASH
  68 #include <dataflash.h>
  69 #endif
  70
  71 /*
  72  * Some systems (for example LWMON) have very short watchdog periods;
  73  * we must make sure to split long operations like memmove() or
  74  * crc32() into reasonable chunks.
  75  */
  76 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
  77 # define CHUNKSZ (64 * 1024)
  78 #endif
  79
  80 int  gunzip (void *, int, unsigned char *, unsigned long *);
  81
  82 static void *zalloc(void *, unsigned, unsigned);
  83 static void zfree(void *, void *, unsigned);
  84
  85 #if defined(CONFIG_CMD_IMI)
  86 static int image_info (unsigned long addr);
  87 #endif
  88
  89 #if defined(CONFIG_CMD_IMLS)
  90 #include <flash.h>
  91 extern flash_info_t flash_info[]; /* info for FLASH chips */
  92 static int do_imls (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
  93 #endif
  94
  95 static void print_type (image_header_t *hdr);
  96
  97 #ifdef __I386__
  98 image_header_t *fake_header(image_header_t *hdr, void *ptr, int size);
  99 #endif
 100
 101 /*
 102  *  Continue booting an OS image; caller already has:
 103  *  - copied image header to global variable `header'
 104  *  - checked header magic number, checksums (both header & image),
 105  *  - verified image architecture (PPC) and type (KERNEL or MULTI),
 106  *  - loaded (first part of) image to header load address,
 107  *  - disabled interrupts.
 108  */
 109 typedef void boot_os_Fcn (cmd_tbl_t *cmdtp, int flag,
 110                           int   argc, char *argv[],
 111                           ulong addr,           /* of image to boot */
 112                           ulong *len_ptr,       /* multi-file image length table */
 113                           int   verify);        /* getenv("verify")[0] != 'n' */
 114
 115 #ifdef  DEBUG
 116 extern int do_bdinfo ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
 117 #endif
 118
 119 #ifdef CONFIG_PPC
 120 static boot_os_Fcn do_bootm_linux;
 121 #else
 122 extern boot_os_Fcn do_bootm_linux;
 123 #endif
 124 #ifdef CONFIG_SILENT_CONSOLE
 125 static void fixup_silent_linux (void);
 126 #endif
 127 static boot_os_Fcn do_bootm_netbsd;
 128 static boot_os_Fcn do_bootm_rtems;
 129 #if defined(CONFIG_CMD_ELF)
 130 static boot_os_Fcn do_bootm_vxworks;
 131 static boot_os_Fcn do_bootm_qnxelf;
 132 int do_bootvx ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[] );
 133 int do_bootelf (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[] );
 134 #endif
 135 #if defined(CONFIG_ARTOS) && defined(CONFIG_PPC)
 136 static boot_os_Fcn do_bootm_artos;
 137 #endif
 138 #ifdef CONFIG_LYNXKDI
 139 static boot_os_Fcn do_bootm_lynxkdi;
 140 extern void lynxkdi_boot( image_header_t * );
 141 #endif
 142
 143 #ifndef CFG_BOOTM_LEN
 144 #define CFG_BOOTM_LEN   0x800000        /* use 8MByte as default max gunzip size */
 145 #endif
 146
 147 image_header_t header;
 148
 149 ulong load_addr = CFG_LOAD_ADDR;                /* Default Load Address */
 150
 151 int do_bootm (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 152 {
 153         ulong   iflag;
 154         ulong   addr;
 155         ulong   data, len, checksum;
 156         ulong  *len_ptr;
 157         uint    unc_len = CFG_BOOTM_LEN;
 158         int     i, verify;
 159         char    *name, *s;
 160         int     (*appl)(int, char *[]);
 161         image_header_t *hdr = &header;
 162
 163         s = getenv ("verify");
 164         verify = (s && (*s == 'n')) ? 0 : 1;
 165
 166         if (argc < 2) {
 167                 addr = load_addr;
 168         } else {
 169                 addr = simple_strtoul(argv[1], NULL, 16);
 170         }
 171
 172         show_boot_progress (1);
 173         printf ("## Booting image at %08lx ...\n", addr);
 174
 175         /* Copy header so we can blank CRC field for re-calculation */
 176 #ifdef CONFIG_HAS_DATAFLASH
 177         if (addr_dataflash(addr)){
 178                 read_dataflash(addr, sizeof(image_header_t), (char *)&header);
 179         } else
 180 #endif
 181         memmove (&header, (char *)addr, sizeof(image_header_t));
 182
 183         if (ntohl(hdr->ih_magic) != IH_MAGIC) {
 184 #ifdef __I386__ /* correct image format not implemented yet - fake it */
 185                 if (fake_header(hdr, (void*)addr, -1) != NULL) {
 186                         /* to compensate for the addition below */
 187                         addr -= sizeof(image_header_t);
 188                         /* turnof verify,
 189                          * fake_header() does not fake the data crc
 190                          */
 191                         verify = 0;
 192                 } else
 193 #endif  /* __I386__ */
 194             {
 195                 puts ("Bad Magic Number\n");
 196                 show_boot_progress (-1);
 197                 return 1;
 198             }
 199         }
 200         show_boot_progress (2);
 201
 202         data = (ulong)&header;
 203         len  = sizeof(image_header_t);
 204
 205         checksum = ntohl(hdr->ih_hcrc);
 206         hdr->ih_hcrc = 0;
 207
 208         if (crc32 (0, (uchar *)data, len) != checksum) {
 209                 puts ("Bad Header Checksum\n");
 210                 show_boot_progress (-2);
 211                 return 1;
 212         }
 213         show_boot_progress (3);
 214
 215 #ifdef CONFIG_HAS_DATAFLASH
 216         if (addr_dataflash(addr)){
 217                 len  = ntohl(hdr->ih_size) + sizeof(image_header_t);
 218                 read_dataflash(addr, len, (char *)CFG_LOAD_ADDR);
 219                 addr = CFG_LOAD_ADDR;
 220         }
 221 #endif
 222
 223
 224         /* for multi-file images we need the data part, too */
 225         print_image_hdr ((image_header_t *)addr);
 226
 227         data = addr + sizeof(image_header_t);
 228         len  = ntohl(hdr->ih_size);
 229
 230         if (verify) {
 231                 puts ("   Verifying Checksum ... ");
 232                 if (crc32 (0, (uchar *)data, len) != ntohl(hdr->ih_dcrc)) {
 233                         printf ("Bad Data CRC\n");
 234                         show_boot_progress (-3);
 235                         return 1;
 236                 }
 237                 puts ("OK\n");
 238         }
 239         show_boot_progress (4);
 240
 241         len_ptr = (ulong *)data;
 242
 243 #if defined(__ARM__)
 244         if (hdr->ih_arch != IH_CPU_ARM)
 245 #elif defined(__avr32__)
 246         if (hdr->ih_arch != IH_CPU_AVR32)
 247 #elif defined(__bfin__)
 248         if (hdr->ih_arch != IH_CPU_BLACKFIN)
 249 #elif defined(__I386__)
 250         if (hdr->ih_arch != IH_CPU_I386)
 251 #elif defined(__M68K__)
 252         if (hdr->ih_arch != IH_CPU_M68K)
 253 #elif defined(__microblaze__)
 254         if (hdr->ih_arch != IH_CPU_MICROBLAZE)
 255 #elif defined(__mips__)
 256         if (hdr->ih_arch != IH_CPU_MIPS)
 257 #elif defined(__nios__)
 258         if (hdr->ih_arch != IH_CPU_NIOS)
 259 #elif defined(__nios2__)
 260         if (hdr->ih_arch != IH_CPU_NIOS2)
 261 #elif defined(__PPC__)
 262         if (hdr->ih_arch != IH_CPU_PPC)
 263 #elif defined(__sh__)
 264         if (hdr->ih_arch != IH_CPU_SH)
 265 #else
 266 # error Unknown CPU type
 267 #endif
 268         {
 269                 printf ("Unsupported Architecture 0x%x\n", hdr->ih_arch);
 270                 show_boot_progress (-4);
 271                 return 1;
 272         }
 273         show_boot_progress (5);
 274
 275         switch (hdr->ih_type) {
 276         case IH_TYPE_STANDALONE:
 277                 name = "Standalone Application";
 278                 /* A second argument overwrites the load address */
 279                 if (argc > 2) {
 280                         hdr->ih_load = htonl(simple_strtoul(argv[2], NULL, 16));
 281                 }
 282                 break;
 283         case IH_TYPE_KERNEL:
 284                 name = "Kernel Image";
 285                 break;
 286         case IH_TYPE_MULTI:
 287                 name = "Multi-File Image";
 288                 len  = ntohl(len_ptr[0]);
 289                 /* OS kernel is always the first image */
 290                 data += 8; /* kernel_len + terminator */
 291                 for (i=1; len_ptr[i]; ++i)
 292                         data += 4;
 293                 break;
 294         default: printf ("Wrong Image Type for %s command\n", cmdtp->name);
 295                 show_boot_progress (-5);
 296                 return 1;
 297         }
 298         show_boot_progress (6);
 299
 300         /*
 301          * We have reached the point of no return: we are going to
 302          * overwrite all exception vector code, so we cannot easily
 303          * recover from any failures any more...
 304          */
 305
 306         iflag = disable_interrupts();
 307
 308 #ifdef CONFIG_AMIGAONEG3SE
 309         /*
 310          * We've possible left the caches enabled during
 311          * bios emulation, so turn them off again
 312          */
 313         icache_disable();
 314         invalidate_l1_instruction_cache();
 315         flush_data_cache();
 316         dcache_disable();
 317 #endif
 318
 319         switch (hdr->ih_comp) {
 320         case IH_COMP_NONE:
 321                 if(ntohl(hdr->ih_load) == addr) {
 322                         printf ("   XIP %s ... ", name);
 323                 } else {
 324 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 325                         size_t l = len;
 326                         void *to = (void *)ntohl(hdr->ih_load);
 327                         void *from = (void *)data;
 328
 329                         printf ("   Loading %s ... ", name);
 330
 331                         while (l > 0) {
 332                                 size_t tail = (l > CHUNKSZ) ? CHUNKSZ : l;
 333                                 WATCHDOG_RESET();
 334                                 memmove (to, from, tail);
 335                                 to += tail;
 336                                 from += tail;
 337                                 l -= tail;
 338                         }
 339 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 340                         memmove ((void *) ntohl(hdr->ih_load), (uchar *)data, len);
 341 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 342                 }
 343                 break;
 344         case IH_COMP_GZIP:
 345                 printf ("   Uncompressing %s ... ", name);
 346                 if (gunzip ((void *)ntohl(hdr->ih_load), unc_len,
 347                             (uchar *)data, &len) != 0) {
 348                         puts ("GUNZIP ERROR - must RESET board to recover\n");
 349                         show_boot_progress (-6);
 350                         do_reset (cmdtp, flag, argc, argv);
 351                 }
 352                 break;
 353 #ifdef CONFIG_BZIP2
 354         case IH_COMP_BZIP2:
 355                 printf ("   Uncompressing %s ... ", name);
 356                 /*
 357                  * If we've got less than 4 MB of malloc() space,
 358                  * use slower decompression algorithm which requires
 359                  * at most 2300 KB of memory.
 360                  */
 361                 i = BZ2_bzBuffToBuffDecompress ((char*)ntohl(hdr->ih_load),
 362                                                 &unc_len, (char *)data, len,
 363                                                 CFG_MALLOC_LEN < (4096 * 1024), 0);
 364                 if (i != BZ_OK) {
 365                         printf ("BUNZIP2 ERROR %d - must RESET board to recover\n", i);
 366                         show_boot_progress (-6);
 367                         do_reset (cmdtp, flag, argc, argv);
 368                 }
 369                 break;
 370 #endif /* CONFIG_BZIP2 */
 371         default:
 372                 if (iflag)
 373                         enable_interrupts();
 374                 printf ("Unimplemented compression type %d\n", hdr->ih_comp);
 375                 show_boot_progress (-7);
 376                 return 1;
 377         }
 378         puts ("OK\n");
 379         show_boot_progress (7);
 380
 381         switch (hdr->ih_type) {
 382         case IH_TYPE_STANDALONE:
 383                 if (iflag)
 384                         enable_interrupts();
 385
 386                 /* load (and uncompress), but don't start if "autostart"
 387                  * is set to "no"
 388                  */
 389                 if (((s = getenv("autostart")) != NULL) && (strcmp(s,"no") == 0)) {
 390                         char buf[32];
 391                         sprintf(buf, "%lX", len);
 392                         setenv("filesize", buf);
 393                         return 0;
 394                 }
 395                 appl = (int (*)(int, char *[]))ntohl(hdr->ih_ep);
 396                 (*appl)(argc-1, &argv[1]);
 397                 return 0;
 398         case IH_TYPE_KERNEL:
 399         case IH_TYPE_MULTI:
 400                 /* handled below */
 401                 break;
 402         default:
 403                 if (iflag)
 404                         enable_interrupts();
 405                 printf ("Can't boot image type %d\n", hdr->ih_type);
 406                 show_boot_progress (-8);
 407                 return 1;
 408         }
 409         show_boot_progress (8);
 410
 411         switch (hdr->ih_os) {
 412         default:                        /* handled by (original) Linux case */
 413         case IH_OS_LINUX:
 414 #ifdef CONFIG_SILENT_CONSOLE
 415             fixup_silent_linux();
 416 #endif
 417             do_bootm_linux  (cmdtp, flag, argc, argv,
 418                              addr, len_ptr, verify);
 419             break;
 420         case IH_OS_NETBSD:
 421             do_bootm_netbsd (cmdtp, flag, argc, argv,
 422                              addr, len_ptr, verify);
 423             break;
 424
 425 #ifdef CONFIG_LYNXKDI
 426         case IH_OS_LYNXOS:
 427             do_bootm_lynxkdi (cmdtp, flag, argc, argv,
 428                              addr, len_ptr, verify);
 429             break;
 430 #endif
 431
 432         case IH_OS_RTEMS:
 433             do_bootm_rtems (cmdtp, flag, argc, argv,
 434                              addr, len_ptr, verify);
 435             break;
 436
 437 #if defined(CONFIG_CMD_ELF)
 438         case IH_OS_VXWORKS:
 439             do_bootm_vxworks (cmdtp, flag, argc, argv,
 440                               addr, len_ptr, verify);
 441             break;
 442         case IH_OS_QNX:
 443             do_bootm_qnxelf (cmdtp, flag, argc, argv,
 444                               addr, len_ptr, verify);
 445             break;
 446 #endif
 447 #ifdef CONFIG_ARTOS
 448         case IH_OS_ARTOS:
 449             do_bootm_artos  (cmdtp, flag, argc, argv,
 450                              addr, len_ptr, verify);
 451             break;
 452 #endif
 453         }
 454
 455         show_boot_progress (-9);
 456 #ifdef DEBUG
 457         puts ("\n## Control returned to monitor - resetting...\n");
 458         do_reset (cmdtp, flag, argc, argv);
 459 #endif
 460         return 1;
 461 }
 462
 463 U_BOOT_CMD(
 464         bootm,  CFG_MAXARGS,    1,      do_bootm,
 465         "bootm   - boot application image from memory\n",
 466         "[addr [arg ...]]\n    - boot application image stored in memory\n"
 467         "\tpassing arguments 'arg ...'; when booting a Linux kernel,\n"
 468         "\t'arg' can be the address of an initrd image\n"
 469 #if defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)
 470         "\tWhen booting a Linux kernel which requires a flat device-tree\n"
 471         "\ta third argument is required which is the address of the\n"
 472         "\tdevice-tree blob. To boot that kernel without an initrd image,\n"
 473         "\tuse a '-' for the second argument. If you do not pass a third\n"
 474         "\ta bd_info struct will be passed instead\n"
 475 #endif
 476 );
 477
 478 #ifdef CONFIG_SILENT_CONSOLE
 479 static void
 480 fixup_silent_linux ()
 481 {
 482         char buf[256], *start, *end;
 483         char *cmdline = getenv ("bootargs");
 484
 485         /* Only fix cmdline when requested */
 486         if (!(gd->flags & GD_FLG_SILENT))
 487                 return;
 488
 489         debug ("before silent fix-up: %s\n", cmdline);
 490         if (cmdline) {
 491                 if ((start = strstr (cmdline, "console=")) != NULL) {
 492                         end = strchr (start, ' ');
 493                         strncpy (buf, cmdline, (start - cmdline + 8));
 494                         if (end)
 495                                 strcpy (buf + (start - cmdline + 8), end);
 496                         else
 497                                 buf[start - cmdline + 8] = '\0';
 498                 } else {
 499                         strcpy (buf, cmdline);
 500                         strcat (buf, " console=");
 501                 }
 502         } else {
 503                 strcpy (buf, "console=");
 504         }
 505
 506         setenv ("bootargs", buf);
 507         debug ("after silent fix-up: %s\n", buf);
 508 }
 509 #endif /* CONFIG_SILENT_CONSOLE */
 510
 511 #ifdef CONFIG_PPC
 512 static void  __attribute__((noinline))
 513 do_bootm_linux (cmd_tbl_t *cmdtp, int flag,
 514                 int     argc, char *argv[],
 515                 ulong   addr,
 516                 ulong   *len_ptr,
 517                 int     verify)
 518 {
 519         ulong   sp;
 520         ulong   len, checksum;
 521         ulong   initrd_start, initrd_end;
 522         ulong   cmd_start, cmd_end;
 523         ulong   initrd_high;
 524         ulong   data;
 525         int     initrd_copy_to_ram = 1;
 526         char    *cmdline;
 527         char    *s;
 528         bd_t    *kbd;
 529         void    (*kernel)(bd_t *, ulong, ulong, ulong, ulong);
 530         image_header_t *hdr = &header;
 531 #if defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)
 532         char    *of_flat_tree = NULL;
 533         ulong   of_data = 0;
 534 #endif
 535
 536         if ((s = getenv ("initrd_high")) != NULL) {
 537                 /* a value of "no" or a similar string will act like 0,
 538                  * turning the "load high" feature off. This is intentional.
 539                  */
 540                 initrd_high = simple_strtoul(s, NULL, 16);
 541                 if (initrd_high == ~0)
 542                         initrd_copy_to_ram = 0;
 543         } else {        /* not set, no restrictions to load high */
 544                 initrd_high = ~0;
 545         }
 546
 547 #ifdef CONFIG_LOGBUFFER
 548         kbd=gd->bd;
 549         /* Prevent initrd from overwriting logbuffer */
 550         if (initrd_high < (kbd->bi_memsize-LOGBUFF_LEN-LOGBUFF_OVERHEAD))
 551                 initrd_high = kbd->bi_memsize-LOGBUFF_LEN-LOGBUFF_OVERHEAD;
 552         debug ("## Logbuffer at 0x%08lX ", kbd->bi_memsize-LOGBUFF_LEN);
 553 #endif
 554
 555         /*
 556          * Booting a (Linux) kernel image
 557          *
 558          * Allocate space for command line and board info - the
 559          * address should be as high as possible within the reach of
 560          * the kernel (see CFG_BOOTMAPSZ settings), but in unused
 561          * memory, which means far enough below the current stack
 562          * pointer.
 563          */
 564
 565         asm( "mr %0,1": "=r"(sp) : );
 566
 567         debug ("## Current stack ends at 0x%08lX ", sp);
 568
 569         sp -= 2048;             /* just to be sure */
 570         if (sp > CFG_BOOTMAPSZ)
 571                 sp = CFG_BOOTMAPSZ;
 572         sp &= ~0xF;
 573
 574         debug ("=> set upper limit to 0x%08lX\n", sp);
 575
 576         cmdline = (char *)((sp - CFG_BARGSIZE) & ~0xF);
 577         kbd = (bd_t *)(((ulong)cmdline - sizeof(bd_t)) & ~0xF);
 578
 579         if ((s = getenv("bootargs")) == NULL)
 580                 s = "";
 581
 582         strcpy (cmdline, s);
 583
 584         cmd_start    = (ulong)&cmdline[0];
 585         cmd_end      = cmd_start + strlen(cmdline);
 586
 587         *kbd = *(gd->bd);
 588
 589 #ifdef  DEBUG
 590         printf ("## cmdline at 0x%08lX ... 0x%08lX\n", cmd_start, cmd_end);
 591
 592         do_bdinfo (NULL, 0, 0, NULL);
 593 #endif
 594
 595         if ((s = getenv ("clocks_in_mhz")) != NULL) {
 596                 /* convert all clock information to MHz */
 597                 kbd->bi_intfreq /= 1000000L;
 598                 kbd->bi_busfreq /= 1000000L;
 599 #if defined(CONFIG_MPC8220)
 600         kbd->bi_inpfreq /= 1000000L;
 601         kbd->bi_pcifreq /= 1000000L;
 602         kbd->bi_pevfreq /= 1000000L;
 603         kbd->bi_flbfreq /= 1000000L;
 604         kbd->bi_vcofreq /= 1000000L;
 605 #endif
 606 #if defined(CONFIG_CPM2)
 607                 kbd->bi_cpmfreq /= 1000000L;
 608                 kbd->bi_brgfreq /= 1000000L;
 609                 kbd->bi_sccfreq /= 1000000L;
 610                 kbd->bi_vco     /= 1000000L;
 611 #endif
 612 #if defined(CONFIG_MPC5xxx)
 613                 kbd->bi_ipbfreq /= 1000000L;
 614                 kbd->bi_pcifreq /= 1000000L;
 615 #endif /* CONFIG_MPC5xxx */
 616         }
 617
 618         kernel = (void (*)(bd_t *, ulong, ulong, ulong, ulong)) ntohl(hdr->ih_ep);
 619
 620         /*
 621          * Check if there is an initrd image
 622          */
 623
 624 #if defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)
 625         /* Look for a '-' which indicates to ignore the ramdisk argument */
 626         if (argc >= 3 && strcmp(argv[2], "-") ==  0) {
 627                         debug ("Skipping initrd\n");
 628                         len = data = 0;
 629                 }
 630         else
 631 #endif
 632         if (argc >= 3) {
 633                 debug ("Not skipping initrd\n");
 634                 show_boot_progress (9);
 635
 636                 addr = simple_strtoul(argv[2], NULL, 16);
 637
 638                 printf ("## Loading RAMDisk Image at %08lx ...\n", addr);
 639
 640                 /* Copy header so we can blank CRC field for re-calculation */
 641                 memmove (&header, (char *)addr, sizeof(image_header_t));
 642
 643                 if (ntohl(hdr->ih_magic)  != IH_MAGIC) {
 644                         puts ("Bad Magic Number\n");
 645                         show_boot_progress (-10);
 646                         do_reset (cmdtp, flag, argc, argv);
 647                 }
 648
 649                 data = (ulong)&header;
 650                 len  = sizeof(image_header_t);
 651
 652                 checksum = ntohl(hdr->ih_hcrc);
 653                 hdr->ih_hcrc = 0;
 654
 655                 if (crc32 (0, (uchar *)data, len) != checksum) {
 656                         puts ("Bad Header Checksum\n");
 657                         show_boot_progress (-11);
 658                         do_reset (cmdtp, flag, argc, argv);
 659                 }
 660
 661                 show_boot_progress (10);
 662
 663                 print_image_hdr (hdr);
 664
 665                 data = addr + sizeof(image_header_t);
 666                 len  = ntohl(hdr->ih_size);
 667
 668                 if (verify) {
 669                         ulong csum = 0;
 670 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 671                         ulong cdata = data, edata = cdata + len;
 672 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 673
 674                         puts ("   Verifying Checksum ... ");
 675
 676 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 677
 678                         while (cdata < edata) {
 679                                 ulong chunk = edata - cdata;
 680
 681                                 if (chunk > CHUNKSZ)
 682                                         chunk = CHUNKSZ;
 683                                 csum = crc32 (csum, (uchar *)cdata, chunk);
 684                                 cdata += chunk;
 685
 686                                 WATCHDOG_RESET();
 687                         }
 688 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 689                         csum = crc32 (0, (uchar *)data, len);
 690 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 691
 692                         if (csum != ntohl(hdr->ih_dcrc)) {
 693                                 puts ("Bad Data CRC\n");
 694                                 show_boot_progress (-12);
 695                                 do_reset (cmdtp, flag, argc, argv);
 696                         }
 697                         puts ("OK\n");
 698                 }
 699
 700                 show_boot_progress (11);
 701
 702                 if ((hdr->ih_os   != IH_OS_LINUX)       ||
 703                     (hdr->ih_arch != IH_CPU_PPC)        ||
 704                     (hdr->ih_type != IH_TYPE_RAMDISK)   ) {
 705                         puts ("No Linux PPC Ramdisk Image\n");
 706                         show_boot_progress (-13);
 707                         do_reset (cmdtp, flag, argc, argv);
 708                 }
 709
 710                 /*
 711                  * Now check if we have a multifile image
 712                  */
 713         } else if ((hdr->ih_type==IH_TYPE_MULTI) && (len_ptr[1])) {
 714                 u_long tail    = ntohl(len_ptr[0]) % 4;
 715                 int i;
 716
 717                 show_boot_progress (13);
 718
 719                 /* skip kernel length and terminator */
 720                 data = (ulong)(&len_ptr[2]);
 721                 /* skip any additional image length fields */
 722                 for (i=1; len_ptr[i]; ++i)
 723                         data += 4;
 724                 /* add kernel length, and align */
 725                 data += ntohl(len_ptr[0]);
 726                 if (tail) {
 727                         data += 4 - tail;
 728                 }
 729
 730                 len   = ntohl(len_ptr[1]);
 731
 732         } else {
 733                 /*
 734                  * no initrd image
 735                  */
 736                 show_boot_progress (14);
 737
 738                 len = data = 0;
 739         }
 740
 741 #if defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)
 742         if(argc > 3) {
 743                 of_flat_tree = (char *) simple_strtoul(argv[3], NULL, 16);
 744                 hdr = (image_header_t *)of_flat_tree;
 745 #if defined(CONFIG_OF_FLAT_TREE)
 746                 if (*((ulong *)(of_flat_tree + sizeof(image_header_t))) != OF_DT_HEADER) {
 747 #else
 748                 if (fdt_check_header(of_flat_tree + sizeof(image_header_t)) != 0) {
 749 #endif
 750 #ifndef CFG_NO_FLASH
 751                         if (addr2info((ulong)of_flat_tree) != NULL)
 752                                 of_data = (ulong)of_flat_tree;
 753 #endif
 754                 } else if (ntohl(hdr->ih_magic) == IH_MAGIC) {
 755                         printf("## Flat Device Tree at %08lX\n", hdr);
 756                         print_image_hdr(hdr);
 757
 758                         if ((ntohl(hdr->ih_load) <  ((unsigned long)hdr + ntohl(hdr->ih_size) + sizeof(hdr))) &&
 759                            ((ntohl(hdr->ih_load) + ntohl(hdr->ih_size)) > (unsigned long)hdr)) {
 760                                 puts ("ERROR: fdt overwritten - "
 761                                         "must RESET the board to recover.\n");
 762                                 do_reset (cmdtp, flag, argc, argv);
 763                         }
 764
 765                         puts ("   Verifying Checksum ... ");
 766                         memmove (&header, (char *)hdr, sizeof(image_header_t));
 767                         checksum = ntohl(header.ih_hcrc);
 768                         header.ih_hcrc = 0;
 769
 770                         if(checksum != crc32(0, (uchar *)&header, sizeof(image_header_t))) {
 771                                 puts ("ERROR: fdt header checksum invalid - "
 772                                         "must RESET the board to recover.\n");
 773                                 do_reset (cmdtp, flag, argc, argv);
 774                         }
 775
 776                         checksum = ntohl(hdr->ih_dcrc);
 777                         addr = (ulong)((uchar *)(hdr) + sizeof(image_header_t));
 778
 779                         if(checksum != crc32(0, (uchar *)addr, ntohl(hdr->ih_size))) {
 780                                 puts ("ERROR: fdt checksum invalid - "
 781                                         "must RESET the board to recover.\n");
 782                                 do_reset (cmdtp, flag, argc, argv);
 783                         }
 784                         puts ("OK\n");
 785
 786                         if (ntohl(hdr->ih_type) != IH_TYPE_FLATDT) {
 787                                 puts ("ERROR: uImage is not a fdt - "
 788                                         "must RESET the board to recover.\n");
 789                                 do_reset (cmdtp, flag, argc, argv);
 790                         }
 791                         if (ntohl(hdr->ih_comp) != IH_COMP_NONE) {
 792                                 puts ("ERROR: uImage is compressed - "
 793                                         "must RESET the board to recover.\n");
 794                                 do_reset (cmdtp, flag, argc, argv);
 795                         }
 796 #if defined(CONFIG_OF_FLAT_TREE)
 797                         if (*((ulong *)(of_flat_tree + sizeof(image_header_t))) != OF_DT_HEADER) {
 798 #else
 799                         if (fdt_check_header(of_flat_tree + sizeof(image_header_t)) != 0) {
 800 #endif
 801                                 puts ("ERROR: uImage data is not a fdt - "
 802                                         "must RESET the board to recover.\n");
 803                                 do_reset (cmdtp, flag, argc, argv);
 804                         }
 805
 806                         memmove((void *)ntohl(hdr->ih_load),
 807                                 (void *)(of_flat_tree + sizeof(image_header_t)),
 808                                 ntohl(hdr->ih_size));
 809                         of_flat_tree = (char *)ntohl(hdr->ih_load);
 810                 } else {
 811                         puts ("Did not find a flat Flat Device Tree.\n"
 812                                 "Must RESET the board to recover.\n");
 813                         do_reset (cmdtp, flag, argc, argv);
 814                 }
 815                 printf ("   Booting using the fdt at 0x%x\n",
 816                                 of_flat_tree);
 817         } else if ((hdr->ih_type==IH_TYPE_MULTI) && (len_ptr[1]) && (len_ptr[2])) {
 818                 u_long tail    = ntohl(len_ptr[0]) % 4;
 819                 int i;
 820
 821                 /* skip kernel length, initrd length, and terminator */
 822                 of_flat_tree = (char *)(&len_ptr[3]);
 823                 /* skip any additional image length fields */
 824                 for (i=2; len_ptr[i]; ++i)
 825                         of_flat_tree += 4;
 826                 /* add kernel length, and align */
 827                 of_flat_tree += ntohl(len_ptr[0]);
 828                 if (tail) {
 829                         of_flat_tree += 4 - tail;
 830                 }
 831
 832                 /* add initrd length, and align */
 833                 tail = ntohl(len_ptr[1]) % 4;
 834                 of_flat_tree += ntohl(len_ptr[1]);
 835                 if (tail) {
 836                         of_flat_tree += 4 - tail;
 837                 }
 838
 839 #ifndef CFG_NO_FLASH
 840                 /* move the blob if it is in flash (set of_data to !null) */
 841                 if (addr2info ((ulong)of_flat_tree) != NULL)
 842                         of_data = (ulong)of_flat_tree;
 843 #endif
 844
 845
 846 #if defined(CONFIG_OF_FLAT_TREE)
 847                 if (*((ulong *)(of_flat_tree)) != OF_DT_HEADER) {
 848 #else
 849                 if (fdt_check_header (of_flat_tree) != 0) {
 850 #endif
 851                         puts ("ERROR: image is not a fdt - "
 852                                 "must RESET the board to recover.\n");
 853                         do_reset (cmdtp, flag, argc, argv);
 854                 }
 855
 856 #if defined(CONFIG_OF_FLAT_TREE)
 857                 if (((struct boot_param_header *)of_flat_tree)->totalsize !=
 858                         ntohl (len_ptr[2])) {
 859 #else
 860                 if (be32_to_cpu (fdt_totalsize (of_flat_tree)) !=
 861                         ntohl(len_ptr[2])) {
 862 #endif
 863                         puts ("ERROR: fdt size != image size - "
 864                                 "must RESET the board to recover.\n");
 865                         do_reset (cmdtp, flag, argc, argv);
 866                 }
 867         }
 868 #endif
 869         if (!data) {
 870                 debug ("No initrd\n");
 871         }
 872
 873         if (data) {
 874             if (!initrd_copy_to_ram) {  /* zero-copy ramdisk support */
 875                 initrd_start = data;
 876                 initrd_end = initrd_start + len;
 877             } else {
 878                 initrd_start  = (ulong)kbd - len;
 879                 initrd_start &= ~(4096 - 1);    /* align on page */
 880
 881                 if (initrd_high) {
 882                         ulong nsp;
 883
 884                         /*
 885                          * the inital ramdisk does not need to be within
 886                          * CFG_BOOTMAPSZ as it is not accessed until after
 887                          * the mm system is initialised.
 888                          *
 889                          * do the stack bottom calculation again and see if
 890                          * the initrd will fit just below the monitor stack
 891                          * bottom without overwriting the area allocated
 892                          * above for command line args and board info.
 893                          */
 894                         asm( "mr %0,1": "=r"(nsp) : );
 895                         nsp -= 2048;            /* just to be sure */
 896                         nsp &= ~0xF;
 897                         if (nsp > initrd_high)  /* limit as specified */
 898                                 nsp = initrd_high;
 899                         nsp -= len;
 900                         nsp &= ~(4096 - 1);     /* align on page */
 901                         if (nsp >= sp)
 902                                 initrd_start = nsp;
 903                 }
 904
 905                 show_boot_progress (12);
 906
 907                 debug ("## initrd at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
 908                         data, data + len - 1, len, len);
 909
 910                 initrd_end    = initrd_start + len;
 911                 printf ("   Loading Ramdisk to %08lx, end %08lx ... ",
 912                         initrd_start, initrd_end);
 913 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 914                 {
 915                         size_t l = len;
 916                         void *to = (void *)initrd_start;
 917                         void *from = (void *)data;
 918
 919                         while (l > 0) {
 920                                 size_t tail = (l > CHUNKSZ) ? CHUNKSZ : l;
 921                                 WATCHDOG_RESET();
 922                                 memmove (to, from, tail);
 923                                 to += tail;
 924                                 from += tail;
 925                                 l -= tail;
 926                         }
 927                 }
 928 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 929                 memmove ((void *)initrd_start, (void *)data, len);
 930 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 931                 puts ("OK\n");
 932             }
 933         } else {
 934                 initrd_start = 0;
 935                 initrd_end = 0;
 936         }
 937
 938 #if defined(CONFIG_OF_LIBFDT)
 939
 940 #ifdef CFG_BOOTMAPSZ
 941         /*
 942          * The blob must be within CFG_BOOTMAPSZ,
 943          * so we flag it to be copied if it is not.
 944          */
 945         if (of_flat_tree >= (char *)CFG_BOOTMAPSZ)
 946                 of_data = (ulong)of_flat_tree;
 947 #endif
 948
 949         /* move of_flat_tree if needed */
 950         if (of_data) {
 951                 int err;
 952                 ulong of_start, of_len;
 953
 954                 of_len = be32_to_cpu(fdt_totalsize(of_data));
 955
 956                 /* position on a 4K boundary before the kbd */
 957                 of_start  = (ulong)kbd - of_len;
 958                 of_start &= ~(4096 - 1);        /* align on page */
 959                 debug ("## device tree at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
 960                         of_data, of_data + of_len - 1, of_len, of_len);
 961
 962                 of_flat_tree = (char *)of_start;
 963                 printf ("   Loading Device Tree to %08lx, end %08lx ... ",
 964                         of_start, of_start + of_len - 1);
 965                 err = fdt_open_into((void *)of_data, (void *)of_start, of_len);
 966                 if (err != 0) {
 967                         puts ("ERROR: fdt move failed - "
 968                                 "must RESET the board to recover.\n");
 969                         do_reset (cmdtp, flag, argc, argv);
 970                 }
 971                 puts ("OK\n");
 972         }
 973         /*
 974          * Add the chosen node if it doesn't exist, add the env and bd_t
 975          * if the user wants it (the logic is in the subroutines).
 976          */
 977         if (of_flat_tree) {
 978                 if (fdt_chosen(of_flat_tree, initrd_start, initrd_end, 0) < 0) {
 979                         puts ("ERROR: /chosen node create failed - "
 980                                 "must RESET the board to recover.\n");
 981                         do_reset (cmdtp, flag, argc, argv);
 982                 }
 983 #ifdef CONFIG_OF_HAS_UBOOT_ENV
 984                 if (fdt_env(of_flat_tree) < 0) {
 985                         puts ("ERROR: /u-boot-env node create failed - "
 986                                 "must RESET the board to recover.\n");
 987                         do_reset (cmdtp, flag, argc, argv);
 988                 }
 989 #endif
 990 #ifdef CONFIG_OF_HAS_BD_T
 991                 if (fdt_bd_t(of_flat_tree) < 0) {
 992                         puts ("ERROR: /bd_t node create failed - "
 993                                 "must RESET the board to recover.\n");
 994                         do_reset (cmdtp, flag, argc, argv);
 995                 }
 996 #endif
 997 #ifdef CONFIG_OF_BOARD_SETUP
 998                 /* Call the board-specific fixup routine */
 999                 ft_board_setup(of_flat_tree, gd->bd);
1000 #endif
1001         }
1002 #endif /* CONFIG_OF_LIBFDT */
1003 #if defined(CONFIG_OF_FLAT_TREE)
1004 #ifdef CFG_BOOTMAPSZ
1005         /*
1006          * The blob must be within CFG_BOOTMAPSZ,
1007          * so we flag it to be copied if it is not.
1008          */
1009         if (of_flat_tree >= (char *)CFG_BOOTMAPSZ)
1010                 of_data = (ulong)of_flat_tree;
1011 #endif
1012
1013         /* move of_flat_tree if needed */
1014         if (of_data) {
1015                 ulong of_start, of_len;
1016                 of_len = ((struct boot_param_header *)of_data)->totalsize;
1017
1018                 /* provide extra 8k pad */
1019                 of_start  = (ulong)kbd - of_len - 8192;
1020                 of_start &= ~(4096 - 1);        /* align on page */
1021                 debug ("## device tree at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
1022                         of_data, of_data + of_len - 1, of_len, of_len);
1023
1024                 of_flat_tree = (char *)of_start;
1025                 printf ("   Loading Device Tree to %08lx, end %08lx ... ",
1026                         of_start, of_start + of_len - 1);
1027                 memmove ((void *)of_start, (void *)of_data, of_len);
1028                 puts ("OK\n");
1029         }
1030         /*
1031          * Create the /chosen node and modify the blob with board specific
1032          * values as needed.
1033          */
1034         ft_setup(of_flat_tree, kbd, initrd_start, initrd_end);
1035         /* ft_dump_blob(of_flat_tree); */
1036 #endif
1037         debug ("## Transferring control to Linux (at address %08lx) ...\n",
1038                 (ulong)kernel);
1039
1040         show_boot_progress (15);
1041
1042 #if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
1043         unlock_ram_in_cache();
1044 #endif
1045
1046 #if defined(CONFIG_OF_FLAT_TREE) || defined(CONFIG_OF_LIBFDT)
1047         if (of_flat_tree) {     /* device tree; boot new style */
1048                 /*
1049                  * Linux Kernel Parameters (passing device tree):
1050                  *   r3: pointer to the fdt, followed by the board info data
1051                  *   r4: physical pointer to the kernel itself
1052                  *   r5: NULL
1053                  *   r6: NULL
1054                  *   r7: NULL
1055                  */
1056                 (*kernel) ((bd_t *)of_flat_tree, (ulong)kernel, 0, 0, 0);
1057                 /* does not return */
1058         }
1059 #endif
1060         /*
1061          * Linux Kernel Parameters (passing board info data):
1062          *   r3: ptr to board info data
1063          *   r4: initrd_start or 0 if no initrd
1064          *   r5: initrd_end - unused if r4 is 0
1065          *   r6: Start of command line string
1066          *   r7: End   of command line string
1067          */
1068         (*kernel) (kbd, initrd_start, initrd_end, cmd_start, cmd_end);
1069         /* does not return */
1070 }
1071 #endif /* CONFIG_PPC */
1072
1073 static void
1074 do_bootm_netbsd (cmd_tbl_t *cmdtp, int flag,
1075                 int     argc, char *argv[],
1076                 ulong   addr,
1077                 ulong   *len_ptr,
1078                 int     verify)
1079 {
1080         image_header_t *hdr = &header;
1081
1082         void    (*loader)(bd_t *, image_header_t *, char *, char *);
1083         image_header_t *img_addr;
1084         char     *consdev;
1085         char     *cmdline;
1086
1087
1088         /*
1089          * Booting a (NetBSD) kernel image
1090          *
1091          * This process is pretty similar to a standalone application:
1092          * The (first part of an multi-) image must be a stage-2 loader,
1093          * which in turn is responsible for loading & invoking the actual
1094          * kernel.  The only differences are the parameters being passed:
1095          * besides the board info strucure, the loader expects a command
1096          * line, the name of the console device, and (optionally) the
1097          * address of the original image header.
1098          */
1099
1100         img_addr = 0;
1101         if ((hdr->ih_type==IH_TYPE_MULTI) && (len_ptr[1]))
1102                 img_addr = (image_header_t *) addr;
1103
1104
1105         consdev = "";
1106 #if   defined (CONFIG_8xx_CONS_SMC1)
1107         consdev = "smc1";
1108 #elif defined (CONFIG_8xx_CONS_SMC2)
1109         consdev = "smc2";
1110 #elif defined (CONFIG_8xx_CONS_SCC2)
1111         consdev = "scc2";
1112 #elif defined (CONFIG_8xx_CONS_SCC3)
1113         consdev = "scc3";
1114 #endif
1115
1116         if (argc > 2) {
1117                 ulong len;
1118                 int   i;
1119
1120                 for (i=2, len=0 ; i<argc ; i+=1)
1121                         len += strlen (argv[i]) + 1;
1122                 cmdline = malloc (len);
1123
1124                 for (i=2, len=0 ; i<argc ; i+=1) {
1125                         if (i > 2)
1126                                 cmdline[len++] = ' ';
1127                         strcpy (&cmdline[len], argv[i]);
1128                         len += strlen (argv[i]);
1129                 }
1130         } else if ((cmdline = getenv("bootargs")) == NULL) {
1131                 cmdline = "";
1132         }
1133
1134         loader = (void (*)(bd_t *, image_header_t *, char *, char *)) ntohl(hdr->ih_ep);
1135
1136         printf ("## Transferring control to NetBSD stage-2 loader (at address %08lx) ...\n",
1137                 (ulong)loader);
1138
1139         show_boot_progress (15);
1140
1141         /*
1142          * NetBSD Stage-2 Loader Parameters:
1143          *   r3: ptr to board info data
1144          *   r4: image address
1145          *   r5: console device
1146          *   r6: boot args string
1147          */
1148         (*loader) (gd->bd, img_addr, consdev, cmdline);
1149 }
1150
1151 #if defined(CONFIG_ARTOS) && defined(CONFIG_PPC)
1152
1153 /* Function that returns a character from the environment */
1154 extern uchar (*env_get_char)(int);
1155
1156 static void
1157 do_bootm_artos (cmd_tbl_t *cmdtp, int flag,
1158                 int     argc, char *argv[],
1159                 ulong   addr,
1160                 ulong   *len_ptr,
1161                 int     verify)
1162 {
1163         ulong top;
1164         char *s, *cmdline;
1165         char **fwenv, **ss;
1166         int i, j, nxt, len, envno, envsz;
1167         bd_t *kbd;
1168         void (*entry)(bd_t *bd, char *cmdline, char **fwenv, ulong top);
1169         image_header_t *hdr = &header;
1170
1171         /*
1172          * Booting an ARTOS kernel image + application
1173          */
1174
1175         /* this used to be the top of memory, but was wrong... */
1176 #ifdef CONFIG_PPC
1177         /* get stack pointer */
1178         asm volatile ("mr %0,1" : "=r"(top) );
1179 #endif
1180         debug ("## Current stack ends at 0x%08lX ", top);
1181
1182         top -= 2048;            /* just to be sure */
1183         if (top > CFG_BOOTMAPSZ)
1184                 top = CFG_BOOTMAPSZ;
1185         top &= ~0xF;
1186
1187         debug ("=> set upper limit to 0x%08lX\n", top);
1188
1189         /* first check the artos specific boot args, then the linux args*/
1190         if ((s = getenv("abootargs")) == NULL && (s = getenv("bootargs")) == NULL)
1191                 s = "";
1192
1193         /* get length of cmdline, and place it */
1194         len = strlen(s);
1195         top = (top - (len + 1)) & ~0xF;
1196         cmdline = (char *)top;
1197         debug ("## cmdline at 0x%08lX ", top);
1198         strcpy(cmdline, s);
1199
1200         /* copy bdinfo */
1201         top = (top - sizeof(bd_t)) & ~0xF;
1202         debug ("## bd at 0x%08lX ", top);
1203         kbd = (bd_t *)top;
1204         memcpy(kbd, gd->bd, sizeof(bd_t));
1205
1206         /* first find number of env entries, and their size */
1207         envno = 0;
1208         envsz = 0;
1209         for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
1210                 for (nxt = i; env_get_char(nxt) != '\0'; ++nxt)
1211                         ;
1212                 envno++;
1213                 envsz += (nxt - i) + 1; /* plus trailing zero */
1214         }
1215         envno++;        /* plus the terminating zero */
1216         debug ("## %u envvars total size %u ", envno, envsz);
1217
1218         top = (top - sizeof(char **)*envno) & ~0xF;
1219         fwenv = (char **)top;
1220         debug ("## fwenv at 0x%08lX ", top);
1221
1222         top = (top - envsz) & ~0xF;
1223         s = (char *)top;
1224         ss = fwenv;
1225
1226         /* now copy them */
1227         for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
1228                 for (nxt = i; env_get_char(nxt) != '\0'; ++nxt)
1229                         ;
1230                 *ss++ = s;
1231                 for (j = i; j < nxt; ++j)
1232                         *s++ = env_get_char(j);
1233                 *s++ = '\0';
1234         }
1235         *ss++ = NULL;   /* terminate */
1236
1237         entry = (void (*)(bd_t *, char *, char **, ulong))ntohl(hdr->ih_ep);
1238         (*entry)(kbd, cmdline, fwenv, top);
1239 }
1240 #endif
1241
1242
1243 #if defined(CONFIG_CMD_BOOTD)
1244 int do_bootd (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1245 {
1246         int rcode = 0;
1247 #ifndef CFG_HUSH_PARSER
1248         if (run_command (getenv ("bootcmd"), flag) < 0) rcode = 1;
1249 #else
1250         if (parse_string_outer(getenv("bootcmd"),
1251                 FLAG_PARSE_SEMICOLON | FLAG_EXIT_FROM_LOOP) != 0 ) rcode = 1;
1252 #endif
1253         return rcode;
1254 }
1255
1256 U_BOOT_CMD(
1257         boot,   1,      1,      do_bootd,
1258         "boot    - boot default, i.e., run 'bootcmd'\n",
1259         NULL
1260 );
1261
1262 /* keep old command name "bootd" for backward compatibility */
1263 U_BOOT_CMD(
1264         bootd, 1,       1,      do_bootd,
1265         "bootd   - boot default, i.e., run 'bootcmd'\n",
1266         NULL
1267 );
1268
1269 #endif
1270
1271 #if defined(CONFIG_CMD_IMI)
1272 int do_iminfo ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1273 {
1274         int     arg;
1275         ulong   addr;
1276         int     rcode=0;
1277
1278         if (argc < 2) {
1279                 return image_info (load_addr);
1280         }
1281
1282         for (arg=1; arg <argc; ++arg) {
1283                 addr = simple_strtoul(argv[arg], NULL, 16);
1284                 if (image_info (addr) != 0) rcode = 1;
1285         }
1286         return rcode;
1287 }
1288
1289 static int image_info (ulong addr)
1290 {
1291         ulong   data, len, checksum;
1292         image_header_t *hdr = &header;
1293
1294         printf ("\n## Checking Image at %08lx ...\n", addr);
1295
1296         /* Copy header so we can blank CRC field for re-calculation */
1297         memmove (&header, (char *)addr, sizeof(image_header_t));
1298
1299         if (ntohl(hdr->ih_magic) != IH_MAGIC) {
1300                 puts ("   Bad Magic Number\n");
1301                 return 1;
1302         }
1303
1304         data = (ulong)&header;
1305         len  = sizeof(image_header_t);
1306
1307         checksum = ntohl(hdr->ih_hcrc);
1308         hdr->ih_hcrc = 0;
1309
1310         if (crc32 (0, (uchar *)data, len) != checksum) {
1311                 puts ("   Bad Header Checksum\n");
1312                 return 1;
1313         }
1314
1315         /* for multi-file images we need the data part, too */
1316         print_image_hdr ((image_header_t *)addr);
1317
1318         data = addr + sizeof(image_header_t);
1319         len  = ntohl(hdr->ih_size);
1320
1321         puts ("   Verifying Checksum ... ");
1322         if (crc32 (0, (uchar *)data, len) != ntohl(hdr->ih_dcrc)) {
1323                 puts ("   Bad Data CRC\n");
1324                 return 1;
1325         }
1326         puts ("OK\n");
1327         return 0;
1328 }
1329
1330 U_BOOT_CMD(
1331         iminfo, CFG_MAXARGS,    1,      do_iminfo,
1332         "iminfo  - print header information for application image\n",
1333         "addr [addr ...]\n"
1334         "    - print header information for application image starting at\n"
1335         "      address 'addr' in memory; this includes verification of the\n"
1336         "      image contents (magic number, header and payload checksums)\n"
1337 );
1338
1339 #endif
1340
1341 #if defined(CONFIG_CMD_IMLS)
1342 /*-----------------------------------------------------------------------
1343  * List all images found in flash.
1344  */
1345 int do_imls (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1346 {
1347         flash_info_t *info;
1348         int i, j;
1349         image_header_t *hdr;
1350         ulong data, len, checksum;
1351
1352         for (i=0, info=&flash_info[0]; i<CFG_MAX_FLASH_BANKS; ++i, ++info) {
1353                 if (info->flash_id == FLASH_UNKNOWN)
1354                         goto next_bank;
1355                 for (j=0; j<info->sector_count; ++j) {
1356
1357                         if (!(hdr=(image_header_t *)info->start[j]) ||
1358                             (ntohl(hdr->ih_magic) != IH_MAGIC))
1359                                 goto next_sector;
1360
1361                         /* Copy header so we can blank CRC field for re-calculation */
1362                         memmove (&header, (char *)hdr, sizeof(image_header_t));
1363
1364                         checksum = ntohl(header.ih_hcrc);
1365                         header.ih_hcrc = 0;
1366
1367                         if (crc32 (0, (uchar *)&header, sizeof(image_header_t))
1368                             != checksum)
1369                                 goto next_sector;
1370
1371                         printf ("Image at %08lX:\n", (ulong)hdr);
1372                         print_image_hdr( hdr );
1373
1374                         data = (ulong)hdr + sizeof(image_header_t);
1375                         len  = ntohl(hdr->ih_size);
1376
1377                         puts ("   Verifying Checksum ... ");
1378                         if (crc32 (0, (uchar *)data, len) != ntohl(hdr->ih_dcrc)) {
1379                                 puts ("   Bad Data CRC\n");
1380                         }
1381                         puts ("OK\n");
1382 next_sector:            ;
1383                 }
1384 next_bank:      ;
1385         }
1386
1387         return (0);
1388 }
1389
1390 U_BOOT_CMD(
1391         imls,   1,              1,      do_imls,
1392         "imls    - list all images found in flash\n",
1393         "\n"
1394         "    - Prints information about all images found at sector\n"
1395         "      boundaries in flash.\n"
1396 );
1397 #endif
1398
1399 void
1400 print_image_hdr (image_header_t *hdr)
1401 {
1402 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
1403         time_t timestamp = (time_t)ntohl(hdr->ih_time);
1404         struct rtc_time tm;
1405 #endif
1406
1407         printf ("   Image Name:   %.*s\n", IH_NMLEN, hdr->ih_name);
1408 #if defined(CONFIG_TIMESTAMP) || defined(CONFIG_CMD_DATE)
1409         to_tm (timestamp, &tm);
1410         printf ("   Created:      %4d-%02d-%02d  %2d:%02d:%02d UTC\n",
1411                 tm.tm_year, tm.tm_mon, tm.tm_mday,
1412                 tm.tm_hour, tm.tm_min, tm.tm_sec);
1413 #endif
1414         puts ("   Image Type:   "); print_type(hdr);
1415         printf ("\n   Data Size:    %d Bytes = ", ntohl(hdr->ih_size));
1416         print_size (ntohl(hdr->ih_size), "\n");
1417         printf ("   Load Address: %08x\n"
1418                 "   Entry Point:  %08x\n",
1419                  ntohl(hdr->ih_load), ntohl(hdr->ih_ep));
1420
1421         if (hdr->ih_type == IH_TYPE_MULTI) {
1422                 int i;
1423                 ulong len;
1424                 ulong *len_ptr = (ulong *)((ulong)hdr + sizeof(image_header_t));
1425
1426                 puts ("   Contents:\n");
1427                 for (i=0; (len = ntohl(*len_ptr)); ++i, ++len_ptr) {
1428                         printf ("   Image %d: %8ld Bytes = ", i, len);
1429                         print_size (len, "\n");
1430                 }
1431         }
1432 }
1433
1434
1435 static void
1436 print_type (image_header_t *hdr)
1437 {
1438         char *os, *arch, *type, *comp;
1439
1440         switch (hdr->ih_os) {
1441         case IH_OS_INVALID:     os = "Invalid OS";              break;
1442         case IH_OS_NETBSD:      os = "NetBSD";                  break;
1443         case IH_OS_LINUX:       os = "Linux";                   break;
1444         case IH_OS_VXWORKS:     os = "VxWorks";                 break;
1445         case IH_OS_QNX:         os = "QNX";                     break;
1446         case IH_OS_U_BOOT:      os = "U-Boot";                  break;
1447         case IH_OS_RTEMS:       os = "RTEMS";                   break;
1448 #ifdef CONFIG_ARTOS
1449         case IH_OS_ARTOS:       os = "ARTOS";                   break;
1450 #endif
1451 #ifdef CONFIG_LYNXKDI
1452         case IH_OS_LYNXOS:      os = "LynxOS";                  break;
1453 #endif
1454         default:                os = "Unknown OS";              break;
1455         }
1456
1457         switch (hdr->ih_arch) {
1458         case IH_CPU_INVALID:    arch = "Invalid CPU";           break;
1459         case IH_CPU_ALPHA:      arch = "Alpha";                 break;
1460         case IH_CPU_ARM:        arch = "ARM";                   break;
1461         case IH_CPU_AVR32:      arch = "AVR32";                 break;
1462         case IH_CPU_BLACKFIN:   arch = "Blackfin";              break;
1463         case IH_CPU_I386:       arch = "Intel x86";             break;
1464         case IH_CPU_IA64:       arch = "IA64";                  break;
1465         case IH_CPU_M68K:       arch = "M68K";                  break;
1466         case IH_CPU_MICROBLAZE: arch = "Microblaze";            break;
1467         case IH_CPU_MIPS64:     arch = "MIPS 64 Bit";           break;
1468         case IH_CPU_MIPS:       arch = "MIPS";                  break;
1469         case IH_CPU_NIOS2:      arch = "Nios-II";               break;
1470         case IH_CPU_NIOS:       arch = "Nios";                  break;
1471         case IH_CPU_PPC:        arch = "PowerPC";               break;
1472         case IH_CPU_S390:       arch = "IBM S390";              break;
1473         case IH_CPU_SH:         arch = "SuperH";                break;
1474         case IH_CPU_SPARC64:    arch = "SPARC 64 Bit";          break;
1475         case IH_CPU_SPARC:      arch = "SPARC";                 break;
1476         default:                arch = "Unknown Architecture";  break;
1477         }
1478
1479         switch (hdr->ih_type) {
1480         case IH_TYPE_INVALID:   type = "Invalid Image";         break;
1481         case IH_TYPE_STANDALONE:type = "Standalone Program";    break;
1482         case IH_TYPE_KERNEL:    type = "Kernel Image";          break;
1483         case IH_TYPE_RAMDISK:   type = "RAMDisk Image";         break;
1484         case IH_TYPE_MULTI:     type = "Multi-File Image";      break;
1485         case IH_TYPE_FIRMWARE:  type = "Firmware";              break;
1486         case IH_TYPE_SCRIPT:    type = "Script";                break;
1487         case IH_TYPE_FLATDT:    type = "Flat Device Tree";      break;
1488         default:                type = "Unknown Image";         break;
1489         }
1490
1491         switch (hdr->ih_comp) {
1492         case IH_COMP_NONE:      comp = "uncompressed";          break;
1493         case IH_COMP_GZIP:      comp = "gzip compressed";       break;
1494         case IH_COMP_BZIP2:     comp = "bzip2 compressed";      break;
1495         default:                comp = "unknown compression";   break;
1496         }
1497
1498         printf ("%s %s %s (%s)", arch, os, type, comp);
1499 }
1500
1501 #define ZALLOC_ALIGNMENT        16
1502
1503 static void *zalloc(void *x, unsigned items, unsigned size)
1504 {
1505         void *p;
1506
1507         size *= items;
1508         size = (size + ZALLOC_ALIGNMENT - 1) & ~(ZALLOC_ALIGNMENT - 1);
1509
1510         p = malloc (size);
1511
1512         return (p);
1513 }
1514
1515 static void zfree(void *x, void *addr, unsigned nb)
1516 {
1517         free (addr);
1518 }
1519
1520 #define HEAD_CRC        2
1521 #define EXTRA_FIELD     4
1522 #define ORIG_NAME       8
1523 #define COMMENT         0x10
1524 #define RESERVED        0xe0
1525
1526 #define DEFLATED        8
1527
1528 int gunzip(void *dst, int dstlen, unsigned char *src, unsigned long *lenp)
1529 {
1530         z_stream s;
1531         int r, i, flags;
1532
1533         /* skip header */
1534         i = 10;
1535         flags = src[3];
1536         if (src[2] != DEFLATED || (flags & RESERVED) != 0) {
1537                 puts ("Error: Bad gzipped data\n");
1538                 return (-1);
1539         }
1540         if ((flags & EXTRA_FIELD) != 0)
1541                 i = 12 + src[10] + (src[11] << 8);
1542         if ((flags & ORIG_NAME) != 0)
1543                 while (src[i++] != 0)
1544                         ;
1545         if ((flags & COMMENT) != 0)
1546                 while (src[i++] != 0)
1547                         ;
1548         if ((flags & HEAD_CRC) != 0)
1549                 i += 2;
1550         if (i >= *lenp) {
1551                 puts ("Error: gunzip out of data in header\n");
1552                 return (-1);
1553         }
1554
1555         s.zalloc = zalloc;
1556         s.zfree = zfree;
1557 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
1558         s.outcb = (cb_func)WATCHDOG_RESET;
1559 #else
1560         s.outcb = Z_NULL;
1561 #endif  /* CONFIG_HW_WATCHDOG */
1562
1563         r = inflateInit2(&s, -MAX_WBITS);
1564         if (r != Z_OK) {
1565                 printf ("Error: inflateInit2() returned %d\n", r);
1566                 return (-1);
1567         }
1568         s.next_in = src + i;
1569         s.avail_in = *lenp - i;
1570         s.next_out = dst;
1571         s.avail_out = dstlen;
1572         r = inflate(&s, Z_FINISH);
1573         if (r != Z_OK && r != Z_STREAM_END) {
1574                 printf ("Error: inflate() returned %d\n", r);
1575                 return (-1);
1576         }
1577         *lenp = s.next_out - (unsigned char *) dst;
1578         inflateEnd(&s);
1579
1580         return (0);
1581 }
1582
1583 #ifdef CONFIG_BZIP2
1584 void bz_internal_error(int errcode)
1585 {
1586         printf ("BZIP2 internal error %d\n", errcode);
1587 }
1588 #endif /* CONFIG_BZIP2 */
1589
1590 static void
1591 do_bootm_rtems (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
1592                 ulong addr, ulong *len_ptr, int verify)
1593 {
1594         image_header_t *hdr = &header;
1595         void    (*entry_point)(bd_t *);
1596
1597         entry_point = (void (*)(bd_t *)) ntohl(hdr->ih_ep);
1598
1599         printf ("## Transferring control to RTEMS (at address %08lx) ...\n",
1600                 (ulong)entry_point);
1601
1602         show_boot_progress (15);
1603
1604         /*
1605          * RTEMS Parameters:
1606          *   r3: ptr to board info data
1607          */
1608
1609         (*entry_point ) ( gd->bd );
1610 }
1611
1612 #if defined(CONFIG_CMD_ELF)
1613 static void
1614 do_bootm_vxworks (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
1615                   ulong addr, ulong *len_ptr, int verify)
1616 {
1617         image_header_t *hdr = &header;
1618         char str[80];
1619
1620         sprintf(str, "%x", ntohl(hdr->ih_ep)); /* write entry-point into string */
1621         setenv("loadaddr", str);
1622         do_bootvx(cmdtp, 0, 0, NULL);
1623 }
1624
1625 static void
1626 do_bootm_qnxelf (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
1627                  ulong addr, ulong *len_ptr, int verify)
1628 {
1629         image_header_t *hdr = &header;
1630         char *local_args[2];
1631         char str[16];
1632
1633         sprintf(str, "%x", ntohl(hdr->ih_ep)); /* write entry-point into string */
1634         local_args[0] = argv[0];
1635         local_args[1] = str;    /* and provide it via the arguments */
1636         do_bootelf(cmdtp, 0, 2, local_args);
1637 }
1638 #endif
1639
1640 #ifdef CONFIG_LYNXKDI
1641 static void
1642 do_bootm_lynxkdi (cmd_tbl_t *cmdtp, int flag,
1643                  int    argc, char *argv[],
1644                  ulong  addr,
1645                  ulong  *len_ptr,
1646                  int    verify)
1647 {
1648         lynxkdi_boot( &header );
1649 }
1650
1651 #endif /* CONFIG_LYNXKDI */