initial try to make DSM G-600 support
[u-boot.git] / common / cmd_bootm.c
1 /*
2  * (C) Copyright 2000-2002
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 #ifdef CONFIG_OF_FLAT_TREE
38 #include <ft_build.h>
39 #endif
40
41  /*cmd_boot.c*/
42  extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
43
44 #if (CONFIG_COMMANDS & CFG_CMD_DATE) || defined(CONFIG_TIMESTAMP)
45 #include <rtc.h>
46 #endif
47
48 #ifdef CFG_HUSH_PARSER
49 #include <hush.h>
50 #endif
51
52 #ifdef CONFIG_SHOW_BOOT_PROGRESS
53 # include <status_led.h>
54 # define SHOW_BOOT_PROGRESS(arg)        show_boot_progress(arg)
55 #else
56 # define SHOW_BOOT_PROGRESS(arg)
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 (CONFIG_COMMANDS & CFG_CMD_IMI)
86 static int image_info (unsigned long addr);
87 #endif
88
89 #if (CONFIG_COMMANDS & CFG_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 (CONFIG_COMMANDS & CFG_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 /* CFG_CMD_ELF */
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 image_header_t header;
144
145 ulong load_addr = CFG_LOAD_ADDR;                /* Default Load Address */
146
147 int do_bootm (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
148 {
149         ulong   iflag;
150         ulong   addr;
151         ulong   data, len, checksum;
152         ulong  *len_ptr;
153         uint    unc_len = 0x400000;
154         int     i, verify;
155         char    *name, *s;
156         int     (*appl)(int, char *[]);
157         image_header_t *hdr = &header;
158
159         s = getenv ("verify");
160         verify = (s && (*s == 'n')) ? 0 : 1;
161
162         if (argc < 2) {
163                 addr = load_addr;
164         } else {
165                 addr = simple_strtoul(argv[1], NULL, 16);
166         }
167
168         SHOW_BOOT_PROGRESS (1);
169         printf ("## Booting image at %08lx ...\n", addr);
170
171         /* Copy header so we can blank CRC field for re-calculation */
172 #ifdef CONFIG_HAS_DATAFLASH
173         if (addr_dataflash(addr)){
174                 read_dataflash(addr, sizeof(image_header_t), (char *)&header);
175         } else
176 #endif
177         memmove (&header, (char *)addr, sizeof(image_header_t));
178
179         if (ntohl(hdr->ih_magic) != IH_MAGIC) {
180 #ifdef __I386__ /* correct image format not implemented yet - fake it */
181                 if (fake_header(hdr, (void*)addr, -1) != NULL) {
182                         /* to compensate for the addition below */
183                         addr -= sizeof(image_header_t);
184                         /* turnof verify,
185                          * fake_header() does not fake the data crc
186                          */
187                         verify = 0;
188                 } else
189 #endif  /* __I386__ */
190 #ifdef CONFIG_LINKSTATION
191                 extern boot_os_Fcn do_boot_lskernel;
192                 do_boot_lskernel(cmdtp, flag, argc, argv,
193                                 addr, NULL, verify);
194                 return 1; /* Only returns on error */
195 #endif
196 // FIXME boot_kernel!!
197             {
198                 puts ("Bad Magic Number\n");
199                 SHOW_BOOT_PROGRESS (-1);
200                 return 1;
201             }
202         }
203         SHOW_BOOT_PROGRESS (2);
204
205         data = (ulong)&header;
206         len  = sizeof(image_header_t);
207
208         checksum = ntohl(hdr->ih_hcrc);
209         hdr->ih_hcrc = 0;
210
211         if (crc32 (0, (uchar *)data, len) != checksum) {
212                 puts ("Bad Header Checksum\n");
213                 SHOW_BOOT_PROGRESS (-2);
214                 return 1;
215         }
216         SHOW_BOOT_PROGRESS (3);
217
218 #ifdef CONFIG_HAS_DATAFLASH
219         if (addr_dataflash(addr)){
220                 len  = ntohl(hdr->ih_size) + sizeof(image_header_t);
221                 read_dataflash(addr, len, (char *)CFG_LOAD_ADDR);
222                 addr = CFG_LOAD_ADDR;
223         }
224 #endif
225
226
227         /* for multi-file images we need the data part, too */
228         print_image_hdr ((image_header_t *)addr);
229
230         data = addr + sizeof(image_header_t);
231         len  = ntohl(hdr->ih_size);
232
233         if (verify) {
234                 puts ("   Verifying Checksum ... ");
235                 if (crc32 (0, (uchar *)data, len) != ntohl(hdr->ih_dcrc)) {
236                         printf ("Bad Data CRC\n");
237                         SHOW_BOOT_PROGRESS (-3);
238                         return 1;
239                 }
240                 puts ("OK\n");
241         }
242         SHOW_BOOT_PROGRESS (4);
243
244         len_ptr = (ulong *)data;
245
246 #if defined(__PPC__)
247         if (hdr->ih_arch != IH_CPU_PPC)
248 #elif defined(__ARM__)
249         if (hdr->ih_arch != IH_CPU_ARM)
250 #elif defined(__I386__)
251         if (hdr->ih_arch != IH_CPU_I386)
252 #elif defined(__mips__)
253         if (hdr->ih_arch != IH_CPU_MIPS)
254 #elif defined(__nios__)
255         if (hdr->ih_arch != IH_CPU_NIOS)
256 #elif defined(__M68K__)
257         if (hdr->ih_arch != IH_CPU_M68K)
258 #elif defined(__microblaze__)
259         if (hdr->ih_arch != IH_CPU_MICROBLAZE)
260 #elif defined(__nios2__)
261         if (hdr->ih_arch != IH_CPU_NIOS2)
262 #else
263 # error Unknown CPU type
264 #endif
265         {
266                 printf ("Unsupported Architecture 0x%x\n", hdr->ih_arch);
267                 SHOW_BOOT_PROGRESS (-4);
268                 return 1;
269         }
270         SHOW_BOOT_PROGRESS (5);
271
272         switch (hdr->ih_type) {
273         case IH_TYPE_STANDALONE:
274                 name = "Standalone Application";
275                 /* A second argument overwrites the load address */
276                 if (argc > 2) {
277                         hdr->ih_load = htonl(simple_strtoul(argv[2], NULL, 16));
278                 }
279                 break;
280         case IH_TYPE_KERNEL:
281                 name = "Kernel Image";
282                 break;
283         case IH_TYPE_MULTI:
284                 name = "Multi-File Image";
285                 len  = ntohl(len_ptr[0]);
286                 /* OS kernel is always the first image */
287                 data += 8; /* kernel_len + terminator */
288                 for (i=1; len_ptr[i]; ++i)
289                         data += 4;
290                 break;
291         default: printf ("Wrong Image Type for %s command\n", cmdtp->name);
292                 SHOW_BOOT_PROGRESS (-5);
293                 return 1;
294         }
295         SHOW_BOOT_PROGRESS (6);
296
297         /*
298          * We have reached the point of no return: we are going to
299          * overwrite all exception vector code, so we cannot easily
300          * recover from any failures any more...
301          */
302
303         iflag = disable_interrupts();
304
305 #ifdef CONFIG_AMIGAONEG3SE
306         /*
307          * We've possible left the caches enabled during
308          * bios emulation, so turn them off again
309          */
310         icache_disable();
311         invalidate_l1_instruction_cache();
312         flush_data_cache();
313         dcache_disable();
314 #endif
315
316         switch (hdr->ih_comp) {
317         case IH_COMP_NONE:
318                 if(ntohl(hdr->ih_load) == addr) {
319                         printf ("   XIP %s ... ", name);
320                 } else {
321 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
322                         size_t l = len;
323                         void *to = (void *)ntohl(hdr->ih_load);
324                         void *from = (void *)data;
325
326                         printf ("   Loading %s ... ", name);
327
328                         while (l > 0) {
329                                 size_t tail = (l > CHUNKSZ) ? CHUNKSZ : l;
330                                 WATCHDOG_RESET();
331                                 memmove (to, from, tail);
332                                 to += tail;
333                                 from += tail;
334                                 l -= tail;
335                         }
336 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
337                         memmove ((void *) ntohl(hdr->ih_load), (uchar *)data, len);
338 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
339                 }
340                 break;
341         case IH_COMP_GZIP:
342                 printf ("   Uncompressing %s ... ", name);
343                 if (gunzip ((void *)ntohl(hdr->ih_load), unc_len,
344                             (uchar *)data, &len) != 0) {
345                         puts ("GUNZIP ERROR - must RESET board to recover\n");
346                         SHOW_BOOT_PROGRESS (-6);
347                         do_reset (cmdtp, flag, argc, argv);
348                 }
349                 break;
350 #ifdef CONFIG_BZIP2
351         case IH_COMP_BZIP2:
352                 printf ("   Uncompressing %s ... ", name);
353                 /*
354                  * If we've got less than 4 MB of malloc() space,
355                  * use slower decompression algorithm which requires
356                  * at most 2300 KB of memory.
357                  */
358                 i = BZ2_bzBuffToBuffDecompress ((char*)ntohl(hdr->ih_load),
359                                                 &unc_len, (char *)data, len,
360                                                 CFG_MALLOC_LEN < (4096 * 1024), 0);
361                 if (i != BZ_OK) {
362                         printf ("BUNZIP2 ERROR %d - must RESET board to recover\n", i);
363                         SHOW_BOOT_PROGRESS (-6);
364                         udelay(100000);
365                         do_reset (cmdtp, flag, argc, argv);
366                 }
367                 break;
368 #endif /* CONFIG_BZIP2 */
369         default:
370                 if (iflag)
371                         enable_interrupts();
372                 printf ("Unimplemented compression type %d\n", hdr->ih_comp);
373                 SHOW_BOOT_PROGRESS (-7);
374                 return 1;
375         }
376         puts ("OK\n");
377         SHOW_BOOT_PROGRESS (7);
378
379         switch (hdr->ih_type) {
380         case IH_TYPE_STANDALONE:
381                 if (iflag)
382                         enable_interrupts();
383
384                 /* load (and uncompress), but don't start if "autostart"
385                  * is set to "no"
386                  */
387                 if (((s = getenv("autostart")) != NULL) && (strcmp(s,"no") == 0)) {
388                         char buf[32];
389                         sprintf(buf, "%lX", len);
390                         setenv("filesize", buf);
391                         return 0;
392                 }
393                 appl = (int (*)(int, char *[]))ntohl(hdr->ih_ep);
394                 (*appl)(argc-1, &argv[1]);
395                 return 0;
396         case IH_TYPE_KERNEL:
397         case IH_TYPE_MULTI:
398                 /* handled below */
399                 break;
400         default:
401                 if (iflag)
402                         enable_interrupts();
403                 printf ("Can't boot image type %d\n", hdr->ih_type);
404                 SHOW_BOOT_PROGRESS (-8);
405                 return 1;
406         }
407         SHOW_BOOT_PROGRESS (8);
408
409         switch (hdr->ih_os) {
410         default:                        /* handled by (original) Linux case */
411         case IH_OS_LINUX:
412 #ifdef CONFIG_SILENT_CONSOLE
413             fixup_silent_linux();
414 #endif
415             do_bootm_linux  (cmdtp, flag, argc, argv,
416                              addr, len_ptr, verify);
417             break;
418         case IH_OS_NETBSD:
419             do_bootm_netbsd (cmdtp, flag, argc, argv,
420                              addr, len_ptr, verify);
421             break;
422
423 #ifdef CONFIG_LYNXKDI
424         case IH_OS_LYNXOS:
425             do_bootm_lynxkdi (cmdtp, flag, argc, argv,
426                              addr, len_ptr, verify);
427             break;
428 #endif
429
430         case IH_OS_RTEMS:
431             do_bootm_rtems (cmdtp, flag, argc, argv,
432                              addr, len_ptr, verify);
433             break;
434
435 #if (CONFIG_COMMANDS & CFG_CMD_ELF)
436         case IH_OS_VXWORKS:
437             do_bootm_vxworks (cmdtp, flag, argc, argv,
438                               addr, len_ptr, verify);
439             break;
440         case IH_OS_QNX:
441             do_bootm_qnxelf (cmdtp, flag, argc, argv,
442                               addr, len_ptr, verify);
443             break;
444 #endif /* CFG_CMD_ELF */
445 #ifdef CONFIG_ARTOS
446         case IH_OS_ARTOS:
447             do_bootm_artos  (cmdtp, flag, argc, argv,
448                              addr, len_ptr, verify);
449             break;
450 #endif
451         }
452
453         SHOW_BOOT_PROGRESS (-9);
454 #ifdef DEBUG
455         puts ("\n## Control returned to monitor - resetting...\n");
456         do_reset (cmdtp, flag, argc, argv);
457 #endif
458         return 1;
459 }
460
461 U_BOOT_CMD(
462         bootm,  CFG_MAXARGS,    1,      do_bootm,
463         "bootm   - boot application image from memory\n",
464         "[addr [arg ...]]\n    - boot application image stored in memory\n"
465         "\tpassing arguments 'arg ...'; when booting a Linux kernel,\n"
466         "\t'arg' can be the address of an initrd image\n"
467 );
468
469 #ifdef CONFIG_SILENT_CONSOLE
470 static void
471 fixup_silent_linux ()
472 {
473         DECLARE_GLOBAL_DATA_PTR;
474         char buf[256], *start, *end;
475         char *cmdline = getenv ("bootargs");
476
477         /* Only fix cmdline when requested */
478         if (!(gd->flags & GD_FLG_SILENT))
479                 return;
480
481         debug ("before silent fix-up: %s\n", cmdline);
482         if (cmdline) {
483                 if ((start = strstr (cmdline, "console=")) != NULL) {
484                         end = strchr (start, ' ');
485                         strncpy (buf, cmdline, (start - cmdline + 8));
486                         if (end)
487                                 strcpy (buf + (start - cmdline + 8), end);
488                         else
489                                 buf[start - cmdline + 8] = '\0';
490                 } else {
491                         strcpy (buf, cmdline);
492                         strcat (buf, " console=");
493                 }
494         } else {
495                 strcpy (buf, "console=");
496         }
497
498         setenv ("bootargs", buf);
499         debug ("after silent fix-up: %s\n", buf);
500 }
501 #endif /* CONFIG_SILENT_CONSOLE */
502
503 #ifdef CONFIG_OF_FLAT_TREE
504 extern const unsigned char oftree_dtb[];
505 extern const unsigned int oftree_dtb_len;
506 #endif
507
508 #ifdef CONFIG_PPC
509 static void
510 do_bootm_linux (cmd_tbl_t *cmdtp, int flag,
511                 int     argc, char *argv[],
512                 ulong   addr,
513                 ulong   *len_ptr,
514                 int     verify)
515 {
516         DECLARE_GLOBAL_DATA_PTR;
517
518         ulong   sp;
519         ulong   len, checksum;
520         ulong   initrd_start, initrd_end;
521         ulong   cmd_start, cmd_end;
522         ulong   initrd_high;
523         ulong   data;
524         int     initrd_copy_to_ram = 1;
525         char    *cmdline;
526         char    *s;
527         bd_t    *kbd;
528         void    (*kernel)(bd_t *, ulong, ulong, ulong, ulong);
529         image_header_t *hdr = &header;
530 #ifdef CONFIG_OF_FLAT_TREE
531         char    *of_flat_tree;
532 #endif
533
534         if ((s = getenv ("initrd_high")) != NULL) {
535                 /* a value of "no" or a similar string will act like 0,
536                  * turning the "load high" feature off. This is intentional.
537                  */
538                 initrd_high = simple_strtoul(s, NULL, 16);
539                 if (initrd_high == ~0)
540                         initrd_copy_to_ram = 0;
541         } else {        /* not set, no restrictions to load high */
542                 initrd_high = ~0;
543         }
544
545 #ifdef CONFIG_LOGBUFFER
546         kbd=gd->bd;
547         /* Prevent initrd from overwriting logbuffer */
548         if (initrd_high < (kbd->bi_memsize-LOGBUFF_LEN-LOGBUFF_OVERHEAD))
549                 initrd_high = kbd->bi_memsize-LOGBUFF_LEN-LOGBUFF_OVERHEAD;
550         debug ("## Logbuffer at 0x%08lX ", kbd->bi_memsize-LOGBUFF_LEN);
551 #endif
552
553         /*
554          * Booting a (Linux) kernel image
555          *
556          * Allocate space for command line and board info - the
557          * address should be as high as possible within the reach of
558          * the kernel (see CFG_BOOTMAPSZ settings), but in unused
559          * memory, which means far enough below the current stack
560          * pointer.
561          */
562
563         asm( "mr %0,1": "=r"(sp) : );
564
565         debug ("## Current stack ends at 0x%08lX ", sp);
566
567         sp -= 2048;             /* just to be sure */
568         if (sp > CFG_BOOTMAPSZ)
569                 sp = CFG_BOOTMAPSZ;
570         sp &= ~0xF;
571
572         debug ("=> set upper limit to 0x%08lX\n", sp);
573
574         cmdline = (char *)((sp - CFG_BARGSIZE) & ~0xF);
575         kbd = (bd_t *)(((ulong)cmdline - sizeof(bd_t)) & ~0xF);
576
577         if ((s = getenv("bootargs")) == NULL)
578                 s = "";
579
580         strcpy (cmdline, s);
581
582         cmd_start    = (ulong)&cmdline[0];
583         cmd_end      = cmd_start + strlen(cmdline);
584
585         *kbd = *(gd->bd);
586
587 #ifdef  DEBUG
588         printf ("## cmdline at 0x%08lX ... 0x%08lX\n", cmd_start, cmd_end);
589
590         do_bdinfo (NULL, 0, 0, NULL);
591 #endif
592
593         if ((s = getenv ("clocks_in_mhz")) != NULL) {
594                 /* convert all clock information to MHz */
595                 kbd->bi_intfreq /= 1000000L;
596                 kbd->bi_busfreq /= 1000000L;
597 #if defined(CONFIG_MPC8220)
598         kbd->bi_inpfreq /= 1000000L;
599         kbd->bi_pcifreq /= 1000000L;
600         kbd->bi_pevfreq /= 1000000L;
601         kbd->bi_flbfreq /= 1000000L;
602         kbd->bi_vcofreq /= 1000000L;
603 #endif
604 #if defined(CONFIG_CPM2)
605                 kbd->bi_cpmfreq /= 1000000L;
606                 kbd->bi_brgfreq /= 1000000L;
607                 kbd->bi_sccfreq /= 1000000L;
608                 kbd->bi_vco     /= 1000000L;
609 #endif
610 #if defined(CONFIG_MPC5xxx)
611                 kbd->bi_ipbfreq /= 1000000L;
612                 kbd->bi_pcifreq /= 1000000L;
613 #endif /* CONFIG_MPC5xxx */
614         }
615
616         kernel = (void (*)(bd_t *, ulong, ulong, ulong, ulong))hdr->ih_ep;
617
618         /*
619          * Check if there is an initrd image
620          */
621         if (argc >= 3) {
622                 SHOW_BOOT_PROGRESS (9);
623
624                 addr = simple_strtoul(argv[2], NULL, 16);
625
626                 printf ("## Loading RAMDisk Image at %08lx ...\n", addr);
627
628                 /* Copy header so we can blank CRC field for re-calculation */
629                 memmove (&header, (char *)addr, sizeof(image_header_t));
630
631                 if (hdr->ih_magic  != IH_MAGIC) {
632                         puts ("Bad Magic Number\n");
633                         SHOW_BOOT_PROGRESS (-10);
634                         do_reset (cmdtp, flag, argc, argv);
635                 }
636
637                 data = (ulong)&header;
638                 len  = sizeof(image_header_t);
639
640                 checksum = hdr->ih_hcrc;
641                 hdr->ih_hcrc = 0;
642
643                 if (crc32 (0, (uchar *)data, len) != checksum) {
644                         puts ("Bad Header Checksum\n");
645                         SHOW_BOOT_PROGRESS (-11);
646                         do_reset (cmdtp, flag, argc, argv);
647                 }
648
649                 SHOW_BOOT_PROGRESS (10);
650
651                 print_image_hdr (hdr);
652
653                 data = addr + sizeof(image_header_t);
654                 len  = hdr->ih_size;
655
656                 if (verify) {
657                         ulong csum = 0;
658 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
659                         ulong cdata = data, edata = cdata + len;
660 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
661
662                         puts ("   Verifying Checksum ... ");
663
664 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
665
666                         while (cdata < edata) {
667                                 ulong chunk = edata - cdata;
668
669                                 if (chunk > CHUNKSZ)
670                                         chunk = CHUNKSZ;
671                                 csum = crc32 (csum, (uchar *)cdata, chunk);
672                                 cdata += chunk;
673
674                                 WATCHDOG_RESET();
675                         }
676 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
677                         csum = crc32 (0, (uchar *)data, len);
678 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
679
680                         if (csum != hdr->ih_dcrc) {
681                                 puts ("Bad Data CRC\n");
682                                 SHOW_BOOT_PROGRESS (-12);
683                                 do_reset (cmdtp, flag, argc, argv);
684                         }
685                         puts ("OK\n");
686                 }
687
688                 SHOW_BOOT_PROGRESS (11);
689
690                 if ((hdr->ih_os   != IH_OS_LINUX)       ||
691                     (hdr->ih_arch != IH_CPU_PPC)        ||
692                     (hdr->ih_type != IH_TYPE_RAMDISK)   ) {
693                         puts ("No Linux PPC Ramdisk Image\n");
694                         SHOW_BOOT_PROGRESS (-13);
695                         do_reset (cmdtp, flag, argc, argv);
696                 }
697
698                 /*
699                  * Now check if we have a multifile image
700                  */
701         } else if ((hdr->ih_type==IH_TYPE_MULTI) && (len_ptr[1])) {
702                 u_long tail    = ntohl(len_ptr[0]) % 4;
703                 int i;
704
705                 SHOW_BOOT_PROGRESS (13);
706
707                 /* skip kernel length and terminator */
708                 data = (ulong)(&len_ptr[2]);
709                 /* skip any additional image length fields */
710                 for (i=1; len_ptr[i]; ++i)
711                         data += 4;
712                 /* add kernel length, and align */
713                 data += ntohl(len_ptr[0]);
714                 if (tail) {
715                         data += 4 - tail;
716                 }
717
718                 len   = ntohl(len_ptr[1]);
719
720         } else {
721                 /*
722                  * no initrd image
723                  */
724                 SHOW_BOOT_PROGRESS (14);
725
726                 len = data = 0;
727         }
728
729         if (!data) {
730                 debug ("No initrd\n");
731         }
732
733         if (data) {
734             if (!initrd_copy_to_ram) {  /* zero-copy ramdisk support */
735                 initrd_start = data;
736                 initrd_end = initrd_start + len;
737             } else {
738                 initrd_start  = (ulong)kbd - len;
739                 initrd_start &= ~(4096 - 1);    /* align on page */
740
741                 if (initrd_high) {
742                         ulong nsp;
743
744                         /*
745                          * the inital ramdisk does not need to be within
746                          * CFG_BOOTMAPSZ as it is not accessed until after
747                          * the mm system is initialised.
748                          *
749                          * do the stack bottom calculation again and see if
750                          * the initrd will fit just below the monitor stack
751                          * bottom without overwriting the area allocated
752                          * above for command line args and board info.
753                          */
754                         asm( "mr %0,1": "=r"(nsp) : );
755                         nsp -= 2048;            /* just to be sure */
756                         nsp &= ~0xF;
757                         if (nsp > initrd_high)  /* limit as specified */
758                                 nsp = initrd_high;
759                         nsp -= len;
760                         nsp &= ~(4096 - 1);     /* align on page */
761                         if (nsp >= sp)
762                                 initrd_start = nsp;
763                 }
764
765                 SHOW_BOOT_PROGRESS (12);
766
767                 debug ("## initrd at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
768                         data, data + len - 1, len, len);
769
770                 initrd_end    = initrd_start + len;
771                 printf ("   Loading Ramdisk to %08lx, end %08lx ... ",
772                         initrd_start, initrd_end);
773 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
774                 {
775                         size_t l = len;
776                         void *to = (void *)initrd_start;
777                         void *from = (void *)data;
778
779                         while (l > 0) {
780                                 size_t tail = (l > CHUNKSZ) ? CHUNKSZ : l;
781                                 WATCHDOG_RESET();
782                                 memmove (to, from, tail);
783                                 to += tail;
784                                 from += tail;
785                                 l -= tail;
786                         }
787                 }
788 #else   /* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
789                 memmove ((void *)initrd_start, (void *)data, len);
790 #endif  /* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
791                 puts ("OK\n");
792             }
793         } else {
794                 initrd_start = 0;
795                 initrd_end = 0;
796         }
797
798 #ifdef CONFIG_OF_FLAT_TREE
799         if (initrd_start == 0)
800                 of_flat_tree = (char *)(((ulong)kbd - OF_FLAT_TREE_MAX_SIZE -
801                                         sizeof(bd_t)) & ~0xF);
802         else
803                 of_flat_tree = (char *)((initrd_start - OF_FLAT_TREE_MAX_SIZE -
804                                         sizeof(bd_t)) & ~0xF);
805 #endif
806
807         debug ("## Transferring control to Linux (at address %08lx) ...\n",
808                 (ulong)kernel);
809
810         SHOW_BOOT_PROGRESS (15);
811
812 #ifndef CONFIG_OF_FLAT_TREE
813
814 #if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
815         unlock_ram_in_cache();
816 #endif
817
818         /*
819          * Linux Kernel Parameters:
820          *   r3: ptr to board info data
821          *   r4: initrd_start or 0 if no initrd
822          *   r5: initrd_end - unused if r4 is 0
823          *   r6: Start of command line string
824          *   r7: End   of command line string
825          */
826         (*kernel) (kbd, initrd_start, initrd_end, cmd_start, cmd_end);
827
828 #else
829         ft_setup(of_flat_tree, OF_FLAT_TREE_MAX_SIZE, kbd);
830         /* ft_dump_blob(of_flat_tree); */
831
832 #if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
833         unlock_ram_in_cache();
834 #endif
835         /*
836          * Linux Kernel Parameters:
837          *   r3: ptr to OF flat tree, followed by the board info data
838          *   r4: initrd_start or 0 if no initrd
839          *   r5: initrd_end - unused if r4 is 0
840          *   r6: Start of command line string
841          *   r7: End   of command line string
842          */
843         (*kernel) ((bd_t *)of_flat_tree, initrd_start, initrd_end, cmd_start, cmd_end);
844
845 #endif
846 }
847 #endif /* CONFIG_PPC */
848
849 static void
850 do_bootm_netbsd (cmd_tbl_t *cmdtp, int flag,
851                 int     argc, char *argv[],
852                 ulong   addr,
853                 ulong   *len_ptr,
854                 int     verify)
855 {
856         DECLARE_GLOBAL_DATA_PTR;
857
858         image_header_t *hdr = &header;
859
860         void    (*loader)(bd_t *, image_header_t *, char *, char *);
861         image_header_t *img_addr;
862         char     *consdev;
863         char     *cmdline;
864
865
866         /*
867          * Booting a (NetBSD) kernel image
868          *
869          * This process is pretty similar to a standalone application:
870          * The (first part of an multi-) image must be a stage-2 loader,
871          * which in turn is responsible for loading & invoking the actual
872          * kernel.  The only differences are the parameters being passed:
873          * besides the board info strucure, the loader expects a command
874          * line, the name of the console device, and (optionally) the
875          * address of the original image header.
876          */
877
878         img_addr = 0;
879         if ((hdr->ih_type==IH_TYPE_MULTI) && (len_ptr[1]))
880                 img_addr = (image_header_t *) addr;
881
882
883         consdev = "";
884 #if   defined (CONFIG_8xx_CONS_SMC1)
885         consdev = "smc1";
886 #elif defined (CONFIG_8xx_CONS_SMC2)
887         consdev = "smc2";
888 #elif defined (CONFIG_8xx_CONS_SCC2)
889         consdev = "scc2";
890 #elif defined (CONFIG_8xx_CONS_SCC3)
891         consdev = "scc3";
892 #endif
893
894         if (argc > 2) {
895                 ulong len;
896                 int   i;
897
898                 for (i=2, len=0 ; i<argc ; i+=1)
899                         len += strlen (argv[i]) + 1;
900                 cmdline = malloc (len);
901
902                 for (i=2, len=0 ; i<argc ; i+=1) {
903                         if (i > 2)
904                                 cmdline[len++] = ' ';
905                         strcpy (&cmdline[len], argv[i]);
906                         len += strlen (argv[i]);
907                 }
908         } else if ((cmdline = getenv("bootargs")) == NULL) {
909                 cmdline = "";
910         }
911
912         loader = (void (*)(bd_t *, image_header_t *, char *, char *)) hdr->ih_ep;
913
914         printf ("## Transferring control to NetBSD stage-2 loader (at address %08lx) ...\n",
915                 (ulong)loader);
916
917         SHOW_BOOT_PROGRESS (15);
918
919         /*
920          * NetBSD Stage-2 Loader Parameters:
921          *   r3: ptr to board info data
922          *   r4: image address
923          *   r5: console device
924          *   r6: boot args string
925          */
926         (*loader) (gd->bd, img_addr, consdev, cmdline);
927 }
928
929 #if defined(CONFIG_ARTOS) && defined(CONFIG_PPC)
930
931 /* Function that returns a character from the environment */
932 extern uchar (*env_get_char)(int);
933
934 static void
935 do_bootm_artos (cmd_tbl_t *cmdtp, int flag,
936                 int     argc, char *argv[],
937                 ulong   addr,
938                 ulong   *len_ptr,
939                 int     verify)
940 {
941         DECLARE_GLOBAL_DATA_PTR;
942         ulong top;
943         char *s, *cmdline;
944         char **fwenv, **ss;
945         int i, j, nxt, len, envno, envsz;
946         bd_t *kbd;
947         void (*entry)(bd_t *bd, char *cmdline, char **fwenv, ulong top);
948         image_header_t *hdr = &header;
949
950         /*
951          * Booting an ARTOS kernel image + application
952          */
953
954         /* this used to be the top of memory, but was wrong... */
955 #ifdef CONFIG_PPC
956         /* get stack pointer */
957         asm volatile ("mr %0,1" : "=r"(top) );
958 #endif
959         debug ("## Current stack ends at 0x%08lX ", top);
960
961         top -= 2048;            /* just to be sure */
962         if (top > CFG_BOOTMAPSZ)
963                 top = CFG_BOOTMAPSZ;
964         top &= ~0xF;
965
966         debug ("=> set upper limit to 0x%08lX\n", top);
967
968         /* first check the artos specific boot args, then the linux args*/
969         if ((s = getenv("abootargs")) == NULL && (s = getenv("bootargs")) == NULL)
970                 s = "";
971
972         /* get length of cmdline, and place it */
973         len = strlen(s);
974         top = (top - (len + 1)) & ~0xF;
975         cmdline = (char *)top;
976         debug ("## cmdline at 0x%08lX ", top);
977         strcpy(cmdline, s);
978
979         /* copy bdinfo */
980         top = (top - sizeof(bd_t)) & ~0xF;
981         debug ("## bd at 0x%08lX ", top);
982         kbd = (bd_t *)top;
983         memcpy(kbd, gd->bd, sizeof(bd_t));
984
985         /* first find number of env entries, and their size */
986         envno = 0;
987         envsz = 0;
988         for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
989                 for (nxt = i; env_get_char(nxt) != '\0'; ++nxt)
990                         ;
991                 envno++;
992                 envsz += (nxt - i) + 1; /* plus trailing zero */
993         }
994         envno++;        /* plus the terminating zero */
995         debug ("## %u envvars total size %u ", envno, envsz);
996
997         top = (top - sizeof(char **)*envno) & ~0xF;
998         fwenv = (char **)top;
999         debug ("## fwenv at 0x%08lX ", top);
1000
1001         top = (top - envsz) & ~0xF;
1002         s = (char *)top;
1003         ss = fwenv;
1004
1005         /* now copy them */
1006         for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
1007                 for (nxt = i; env_get_char(nxt) != '\0'; ++nxt)
1008                         ;
1009                 *ss++ = s;
1010                 for (j = i; j < nxt; ++j)
1011                         *s++ = env_get_char(j);
1012                 *s++ = '\0';
1013         }
1014         *ss++ = NULL;   /* terminate */
1015
1016         entry = (void (*)(bd_t *, char *, char **, ulong))ntohl(hdr->ih_ep);
1017         (*entry)(kbd, cmdline, fwenv, top);
1018 }
1019 #endif
1020
1021
1022 #if (CONFIG_COMMANDS & CFG_CMD_BOOTD)
1023 int do_bootd (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1024 {
1025         int rcode = 0;
1026 #ifndef CFG_HUSH_PARSER
1027         if (run_command (getenv ("bootcmd"), flag) < 0) rcode = 1;
1028 #else
1029         if (parse_string_outer(getenv("bootcmd"),
1030                 FLAG_PARSE_SEMICOLON | FLAG_EXIT_FROM_LOOP) != 0 ) rcode = 1;
1031 #endif
1032         return rcode;
1033 }
1034
1035 U_BOOT_CMD(
1036         boot,   1,      1,      do_bootd,
1037         "boot    - boot default, i.e., run 'bootcmd'\n",
1038         NULL
1039 );
1040
1041 /* keep old command name "bootd" for backward compatibility */
1042 U_BOOT_CMD(
1043         bootd, 1,       1,      do_bootd,
1044         "bootd   - boot default, i.e., run 'bootcmd'\n",
1045         NULL
1046 );
1047
1048 #endif
1049
1050 #if (CONFIG_COMMANDS & CFG_CMD_IMI)
1051 int do_iminfo ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1052 {
1053         int     arg;
1054         ulong   addr;
1055         int     rcode=0;
1056
1057         if (argc < 2) {
1058                 return image_info (load_addr);
1059         }
1060
1061         for (arg=1; arg <argc; ++arg) {
1062                 addr = simple_strtoul(argv[arg], NULL, 16);
1063                 if (image_info (addr) != 0) rcode = 1;
1064         }
1065         return rcode;
1066 }
1067
1068 static int image_info (ulong addr)
1069 {
1070         ulong   data, len, checksum;
1071         image_header_t *hdr = &header;
1072
1073         printf ("\n## Checking Image at %08lx ...\n", addr);
1074
1075         /* Copy header so we can blank CRC field for re-calculation */
1076         memmove (&header, (char *)addr, sizeof(image_header_t));
1077
1078         if (ntohl(hdr->ih_magic) != IH_MAGIC) {
1079                 puts ("   Bad Magic Number\n");
1080                 return 1;
1081         }
1082
1083         data = (ulong)&header;
1084         len  = sizeof(image_header_t);
1085
1086         checksum = ntohl(hdr->ih_hcrc);
1087         hdr->ih_hcrc = 0;
1088
1089         if (crc32 (0, (uchar *)data, len) != checksum) {
1090                 puts ("   Bad Header Checksum\n");
1091                 return 1;
1092         }
1093
1094         /* for multi-file images we need the data part, too */
1095         print_image_hdr ((image_header_t *)addr);
1096
1097         data = addr + sizeof(image_header_t);
1098         len  = ntohl(hdr->ih_size);
1099
1100         puts ("   Verifying Checksum ... ");
1101         if (crc32 (0, (uchar *)data, len) != ntohl(hdr->ih_dcrc)) {
1102                 puts ("   Bad Data CRC\n");
1103                 return 1;
1104         }
1105         puts ("OK\n");
1106         return 0;
1107 }
1108
1109 U_BOOT_CMD(
1110         iminfo, CFG_MAXARGS,    1,      do_iminfo,
1111         "iminfo  - print header information for application image\n",
1112         "addr [addr ...]\n"
1113         "    - print header information for application image starting at\n"
1114         "      address 'addr' in memory; this includes verification of the\n"
1115         "      image contents (magic number, header and payload checksums)\n"
1116 );
1117
1118 #endif  /* CFG_CMD_IMI */
1119
1120 #if (CONFIG_COMMANDS & CFG_CMD_IMLS)
1121 /*-----------------------------------------------------------------------
1122  * List all images found in flash.
1123  */
1124 int do_imls (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1125 {
1126         flash_info_t *info;
1127         int i, j;
1128         image_header_t *hdr;
1129         ulong data, len, checksum;
1130
1131         for (i=0, info=&flash_info[0]; i<CFG_MAX_FLASH_BANKS; ++i, ++info) {
1132                 if (info->flash_id == FLASH_UNKNOWN)
1133                         goto next_bank;
1134                 for (j=0; j<info->sector_count; ++j) {
1135
1136                         if (!(hdr=(image_header_t *)info->start[j]) ||
1137                             (ntohl(hdr->ih_magic) != IH_MAGIC))
1138                                 goto next_sector;
1139
1140                         /* Copy header so we can blank CRC field for re-calculation */
1141                         memmove (&header, (char *)hdr, sizeof(image_header_t));
1142
1143                         checksum = ntohl(header.ih_hcrc);
1144                         header.ih_hcrc = 0;
1145
1146                         if (crc32 (0, (uchar *)&header, sizeof(image_header_t))
1147                             != checksum)
1148                                 goto next_sector;
1149
1150                         printf ("Image at %08lX:\n", (ulong)hdr);
1151                         print_image_hdr( hdr );
1152
1153                         data = (ulong)hdr + sizeof(image_header_t);
1154                         len  = ntohl(hdr->ih_size);
1155
1156                         puts ("   Verifying Checksum ... ");
1157                         if (crc32 (0, (uchar *)data, len) != ntohl(hdr->ih_dcrc)) {
1158                                 puts ("   Bad Data CRC\n");
1159                         }
1160                         puts ("OK\n");
1161 next_sector:            ;
1162                 }
1163 next_bank:      ;
1164         }
1165
1166         return (0);
1167 }
1168
1169 U_BOOT_CMD(
1170         imls,   1,              1,      do_imls,
1171         "imls    - list all images found in flash\n",
1172         "\n"
1173         "    - Prints information about all images found at sector\n"
1174         "      boundaries in flash.\n"
1175 );
1176 #endif  /* CFG_CMD_IMLS */
1177
1178 void
1179 print_image_hdr (image_header_t *hdr)
1180 {
1181 #if (CONFIG_COMMANDS & CFG_CMD_DATE) || defined(CONFIG_TIMESTAMP)
1182         time_t timestamp = (time_t)ntohl(hdr->ih_time);
1183         struct rtc_time tm;
1184 #endif
1185
1186         printf ("   Image Name:   %.*s\n", IH_NMLEN, hdr->ih_name);
1187 #if (CONFIG_COMMANDS & CFG_CMD_DATE) || defined(CONFIG_TIMESTAMP)
1188         to_tm (timestamp, &tm);
1189         printf ("   Created:      %4d-%02d-%02d  %2d:%02d:%02d UTC\n",
1190                 tm.tm_year, tm.tm_mon, tm.tm_mday,
1191                 tm.tm_hour, tm.tm_min, tm.tm_sec);
1192 #endif  /* CFG_CMD_DATE, CONFIG_TIMESTAMP */
1193         puts ("   Image Type:   "); print_type(hdr);
1194         printf ("\n   Data Size:    %d Bytes = ", ntohl(hdr->ih_size));
1195         print_size (ntohl(hdr->ih_size), "\n");
1196         printf ("   Load Address: %08x\n"
1197                 "   Entry Point:  %08x\n",
1198                  ntohl(hdr->ih_load), ntohl(hdr->ih_ep));
1199
1200         if (hdr->ih_type == IH_TYPE_MULTI) {
1201                 int i;
1202                 ulong len;
1203                 ulong *len_ptr = (ulong *)((ulong)hdr + sizeof(image_header_t));
1204
1205                 puts ("   Contents:\n");
1206                 for (i=0; (len = ntohl(*len_ptr)); ++i, ++len_ptr) {
1207                         printf ("   Image %d: %8ld Bytes = ", i, len);
1208                         print_size (len, "\n");
1209                 }
1210         }
1211 }
1212
1213
1214 static void
1215 print_type (image_header_t *hdr)
1216 {
1217         char *os, *arch, *type, *comp;
1218
1219         switch (hdr->ih_os) {
1220         case IH_OS_INVALID:     os = "Invalid OS";              break;
1221         case IH_OS_NETBSD:      os = "NetBSD";                  break;
1222         case IH_OS_LINUX:       os = "Linux";                   break;
1223         case IH_OS_VXWORKS:     os = "VxWorks";                 break;
1224         case IH_OS_QNX:         os = "QNX";                     break;
1225         case IH_OS_U_BOOT:      os = "U-Boot";                  break;
1226         case IH_OS_RTEMS:       os = "RTEMS";                   break;
1227 #ifdef CONFIG_ARTOS
1228         case IH_OS_ARTOS:       os = "ARTOS";                   break;
1229 #endif
1230 #ifdef CONFIG_LYNXKDI
1231         case IH_OS_LYNXOS:      os = "LynxOS";                  break;
1232 #endif
1233         default:                os = "Unknown OS";              break;
1234         }
1235
1236         switch (hdr->ih_arch) {
1237         case IH_CPU_INVALID:    arch = "Invalid CPU";           break;
1238         case IH_CPU_ALPHA:      arch = "Alpha";                 break;
1239         case IH_CPU_ARM:        arch = "ARM";                   break;
1240         case IH_CPU_I386:       arch = "Intel x86";             break;
1241         case IH_CPU_IA64:       arch = "IA64";                  break;
1242         case IH_CPU_MIPS:       arch = "MIPS";                  break;
1243         case IH_CPU_MIPS64:     arch = "MIPS 64 Bit";           break;
1244         case IH_CPU_PPC:        arch = "PowerPC";               break;
1245         case IH_CPU_S390:       arch = "IBM S390";              break;
1246         case IH_CPU_SH:         arch = "SuperH";                break;
1247         case IH_CPU_SPARC:      arch = "SPARC";                 break;
1248         case IH_CPU_SPARC64:    arch = "SPARC 64 Bit";          break;
1249         case IH_CPU_M68K:       arch = "M68K";                  break;
1250         case IH_CPU_MICROBLAZE: arch = "Microblaze";            break;
1251         case IH_CPU_NIOS:       arch = "Nios";                  break;
1252         case IH_CPU_NIOS2:      arch = "Nios-II";               break;
1253         default:                arch = "Unknown Architecture";  break;
1254         }
1255
1256         switch (hdr->ih_type) {
1257         case IH_TYPE_INVALID:   type = "Invalid Image";         break;
1258         case IH_TYPE_STANDALONE:type = "Standalone Program";    break;
1259         case IH_TYPE_KERNEL:    type = "Kernel Image";          break;
1260         case IH_TYPE_RAMDISK:   type = "RAMDisk Image";         break;
1261         case IH_TYPE_MULTI:     type = "Multi-File Image";      break;
1262         case IH_TYPE_FIRMWARE:  type = "Firmware";              break;
1263         case IH_TYPE_SCRIPT:    type = "Script";                break;
1264         default:                type = "Unknown Image";         break;
1265         }
1266
1267         switch (hdr->ih_comp) {
1268         case IH_COMP_NONE:      comp = "uncompressed";          break;
1269         case IH_COMP_GZIP:      comp = "gzip compressed";       break;
1270         case IH_COMP_BZIP2:     comp = "bzip2 compressed";      break;
1271         default:                comp = "unknown compression";   break;
1272         }
1273
1274         printf ("%s %s %s (%s)", arch, os, type, comp);
1275 }
1276
1277 #define ZALLOC_ALIGNMENT        16
1278
1279 static void *zalloc(void *x, unsigned items, unsigned size)
1280 {
1281         void *p;
1282
1283         size *= items;
1284         size = (size + ZALLOC_ALIGNMENT - 1) & ~(ZALLOC_ALIGNMENT - 1);
1285
1286         p = malloc (size);
1287
1288         return (p);
1289 }
1290
1291 static void zfree(void *x, void *addr, unsigned nb)
1292 {
1293         free (addr);
1294 }
1295
1296 #define HEAD_CRC        2
1297 #define EXTRA_FIELD     4
1298 #define ORIG_NAME       8
1299 #define COMMENT         0x10
1300 #define RESERVED        0xe0
1301
1302 #define DEFLATED        8
1303
1304 int gunzip(void *dst, int dstlen, unsigned char *src, unsigned long *lenp)
1305 {
1306         z_stream s;
1307         int r, i, flags;
1308
1309         /* skip header */
1310         i = 10;
1311         flags = src[3];
1312         if (src[2] != DEFLATED || (flags & RESERVED) != 0) {
1313                 puts ("Error: Bad gzipped data\n");
1314                 return (-1);
1315         }
1316         if ((flags & EXTRA_FIELD) != 0)
1317                 i = 12 + src[10] + (src[11] << 8);
1318         if ((flags & ORIG_NAME) != 0)
1319                 while (src[i++] != 0)
1320                         ;
1321         if ((flags & COMMENT) != 0)
1322                 while (src[i++] != 0)
1323                         ;
1324         if ((flags & HEAD_CRC) != 0)
1325                 i += 2;
1326         if (i >= *lenp) {
1327                 puts ("Error: gunzip out of data in header\n");
1328                 return (-1);
1329         }
1330
1331         s.zalloc = zalloc;
1332         s.zfree = zfree;
1333 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
1334         s.outcb = (cb_func)WATCHDOG_RESET;
1335 #else
1336         s.outcb = Z_NULL;
1337 #endif  /* CONFIG_HW_WATCHDOG */
1338
1339         r = inflateInit2(&s, -MAX_WBITS);
1340         if (r != Z_OK) {
1341                 printf ("Error: inflateInit2() returned %d\n", r);
1342                 return (-1);
1343         }
1344         s.next_in = src + i;
1345         s.avail_in = *lenp - i;
1346         s.next_out = dst;
1347         s.avail_out = dstlen;
1348         r = inflate(&s, Z_FINISH);
1349         if (r != Z_OK && r != Z_STREAM_END) {
1350                 printf ("Error: inflate() returned %d\n", r);
1351                 return (-1);
1352         }
1353         *lenp = s.next_out - (unsigned char *) dst;
1354         inflateEnd(&s);
1355
1356         return (0);
1357 }
1358
1359 #ifdef CONFIG_BZIP2
1360 void bz_internal_error(int errcode)
1361 {
1362         printf ("BZIP2 internal error %d\n", errcode);
1363 }
1364 #endif /* CONFIG_BZIP2 */
1365
1366 static void
1367 do_bootm_rtems (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
1368                 ulong addr, ulong *len_ptr, int verify)
1369 {
1370         DECLARE_GLOBAL_DATA_PTR;
1371         image_header_t *hdr = &header;
1372         void    (*entry_point)(bd_t *);
1373
1374         entry_point = (void (*)(bd_t *)) hdr->ih_ep;
1375
1376         printf ("## Transferring control to RTEMS (at address %08lx) ...\n",
1377                 (ulong)entry_point);
1378
1379         SHOW_BOOT_PROGRESS (15);
1380
1381         /*
1382          * RTEMS Parameters:
1383          *   r3: ptr to board info data
1384          */
1385
1386         (*entry_point ) ( gd->bd );
1387 }
1388
1389 #if (CONFIG_COMMANDS & CFG_CMD_ELF)
1390 static void
1391 do_bootm_vxworks (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
1392                   ulong addr, ulong *len_ptr, int verify)
1393 {
1394         image_header_t *hdr = &header;
1395         char str[80];
1396
1397         sprintf(str, "%x", hdr->ih_ep); /* write entry-point into string */
1398         setenv("loadaddr", str);
1399         do_bootvx(cmdtp, 0, 0, NULL);
1400 }
1401
1402 static void
1403 do_bootm_qnxelf (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
1404                  ulong addr, ulong *len_ptr, int verify)
1405 {
1406         image_header_t *hdr = &header;
1407         char *local_args[2];
1408         char str[16];
1409
1410         sprintf(str, "%x", hdr->ih_ep); /* write entry-point into string */
1411         local_args[0] = argv[0];
1412         local_args[1] = str;    /* and provide it via the arguments */
1413         do_bootelf(cmdtp, 0, 2, local_args);
1414 }
1415 #endif /* CFG_CMD_ELF */
1416
1417 #ifdef CONFIG_LYNXKDI
1418 static void
1419 do_bootm_lynxkdi (cmd_tbl_t *cmdtp, int flag,
1420                  int    argc, char *argv[],
1421                  ulong  addr,
1422                  ulong  *len_ptr,
1423                  int    verify)
1424 {
1425         lynxkdi_boot( &header );
1426 }
1427
1428 #endif /* CONFIG_LYNXKDI */