[people/ms/u-boot.git] / lib_ppc / bootm.c

/*
 * (C) Copyright 2008 Semihalf
 *
 * (C) Copyright 2000-2006
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#define DEBUG

#include <common.h>
#include <watchdog.h>
#include <command.h>
#include <image.h>
#include <malloc.h>
#include <zlib.h>
#include <bzlib.h>
#include <environment.h>
#include <asm/byteorder.h>

#if defined(CONFIG_OF_LIBFDT)
#include <fdt.h>
#include <libfdt.h>
#include <fdt_support.h>

static void fdt_error (const char *msg);
static void get_fdt (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
		bootm_headers_t *images, char **of_flat_tree, ulong *of_size);
static ulong fdt_relocate (ulong alloc_current,
		cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
		char **of_flat_tree, ulong *of_size);
#endif

#ifdef CFG_INIT_RAM_LOCK
#include <asm/cache.h>
#endif

DECLARE_GLOBAL_DATA_PTR;

extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
static ulong get_sp (void);
static void set_clocks_in_mhz (bd_t *kbd);

void  __attribute__((noinline))
do_bootm_linux(cmd_tbl_t *cmdtp, int flag,
		int	argc, char *argv[],
		bootm_headers_t *images,
		int	verify)
{
	ulong	sp, sp_limit, alloc_current;

	ulong	initrd_start, initrd_end;
	ulong	rd_data_start, rd_data_end, rd_len;

	ulong	cmd_start, cmd_end;
	bd_t	*kbd;
	ulong	ep = 0;
	void	(*kernel)(bd_t *, ulong, ulong, ulong, ulong);

#if defined(CONFIG_OF_LIBFDT)
	char	*of_flat_tree = NULL;
	ulong	of_size = 0;
#endif

	/*
	 * Booting a (Linux) kernel image
	 *
	 * Allocate space for command line and board info - the
	 * address should be as high as possible within the reach of
	 * the kernel (see CFG_BOOTMAPSZ settings), but in unused
	 * memory, which means far enough below the current stack
	 * pointer.
	 */
	sp = get_sp();
	debug ("## Current stack ends at 0x%08lx ", sp);

	alloc_current = sp_limit = get_boot_sp_limit(sp);
	debug ("=> set upper limit to 0x%08lx\n", sp_limit);

	/* allocate space and init command line */
	alloc_current = get_boot_cmdline (alloc_current, &cmd_start, &cmd_end);

	/* allocate space for kernel copy of board info */
	alloc_current = get_boot_kbd (alloc_current, &kbd);
	set_clocks_in_mhz(kbd);

	/* find kernel entry point */
	if (images->legacy_hdr_valid) {
		ep = image_get_ep (images->legacy_hdr_os);
#if defined(CONFIG_FIT)
	} else if (images->fit_uname_os) {
		fit_unsupported_reset ("PPC linux bootm");
		do_reset (cmdtp, flag, argc, argv);
#endif
	} else {
		puts ("Could not find kernel entry point!\n");
		do_reset (cmdtp, flag, argc, argv);
	}
	kernel = (void (*)(bd_t *, ulong, ulong, ulong, ulong))ep;

	/* find ramdisk */
	get_ramdisk (cmdtp, flag, argc, argv, images, verify,
			IH_ARCH_PPC, &rd_data_start, &rd_data_end);

	rd_len = rd_data_end - rd_data_start;

	alloc_current = ramdisk_high (alloc_current, rd_data_start, rd_len,
			kbd, sp_limit, get_sp (),
			&initrd_start, &initrd_end);

#if defined(CONFIG_OF_LIBFDT)
	/* find flattened device tree */
	get_fdt (cmdtp, flag, argc, argv, images, &of_flat_tree, &of_size);

	alloc_current = fdt_relocate (alloc_current,
			cmdtp, flag, argc, argv, &of_flat_tree, &of_size);

	/*
	 * Add the chosen node if it doesn't exist, add the env and bd_t
	 * if the user wants it (the logic is in the subroutines).
	 */
	if (of_size) {
		if (fdt_chosen(of_flat_tree, initrd_start, initrd_end, 0) < 0) {
			fdt_error ("/chosen node create failed");
			do_reset (cmdtp, flag, argc, argv);
		}
#ifdef CONFIG_OF_HAS_UBOOT_ENV
		if (fdt_env(of_flat_tree) < 0) {
			fdt_error ("/u-boot-env node create failed");
			do_reset (cmdtp, flag, argc, argv);
		}
#endif
#ifdef CONFIG_OF_HAS_BD_T
		if (fdt_bd_t(of_flat_tree) < 0) {
			fdt_error ("/bd_t node create failed");
			do_reset (cmdtp, flag, argc, argv);
		}
#endif
#ifdef CONFIG_OF_BOARD_SETUP
		/* Call the board-specific fixup routine */
		ft_board_setup(of_flat_tree, gd->bd);
#endif
	}
#endif	/* CONFIG_OF_LIBFDT */

	debug ("## Transferring control to Linux (at address %08lx) ...\n",
		(ulong)kernel);

	show_boot_progress (15);

#if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
	unlock_ram_in_cache();
#endif

#if defined(CONFIG_OF_LIBFDT)
	if (of_flat_tree) {	/* device tree; boot new style */
		/*
		 * Linux Kernel Parameters (passing device tree):
		 *   r3: pointer to the fdt, followed by the board info data
		 *   r4: physical pointer to the kernel itself
		 *   r5: NULL
		 *   r6: NULL
		 *   r7: NULL
		 */
		(*kernel) ((bd_t *)of_flat_tree, (ulong)kernel, 0, 0, 0);
		/* does not return */
	}
#endif
	/*
	 * Linux Kernel Parameters (passing board info data):
	 *   r3: ptr to board info data
	 *   r4: initrd_start or 0 if no initrd
	 *   r5: initrd_end - unused if r4 is 0
	 *   r6: Start of command line string
	 *   r7: End   of command line string
	 */
	(*kernel) (kbd, initrd_start, initrd_end, cmd_start, cmd_end);
	/* does not return */
}

static ulong get_sp (void)
{
	ulong sp;

	asm( "mr %0,1": "=r"(sp) : );
	return sp;
}

static void set_clocks_in_mhz (bd_t *kbd)
{
	char	*s;

	if ((s = getenv ("clocks_in_mhz")) != NULL) {
		/* convert all clock information to MHz */
		kbd->bi_intfreq /= 1000000L;
		kbd->bi_busfreq /= 1000000L;
#if defined(CONFIG_MPC8220)
		kbd->bi_inpfreq /= 1000000L;
		kbd->bi_pcifreq /= 1000000L;
		kbd->bi_pevfreq /= 1000000L;
		kbd->bi_flbfreq /= 1000000L;
		kbd->bi_vcofreq /= 1000000L;
#endif
#if defined(CONFIG_CPM2)
		kbd->bi_cpmfreq /= 1000000L;
		kbd->bi_brgfreq /= 1000000L;
		kbd->bi_sccfreq /= 1000000L;
		kbd->bi_vco     /= 1000000L;
#endif
#if defined(CONFIG_MPC5xxx)
		kbd->bi_ipbfreq /= 1000000L;
		kbd->bi_pcifreq /= 1000000L;
#endif /* CONFIG_MPC5xxx */
	}
}

#if defined(CONFIG_OF_LIBFDT)
static void fdt_error (const char *msg)
{
	puts ("ERROR: ");
	puts (msg);
	puts (" - must RESET the board to recover.\n");
}

static void get_fdt (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
		bootm_headers_t *images, char **of_flat_tree, ulong *of_size)
{
	ulong		fdt_addr;
	image_header_t	*fdt_hdr;
	char		*fdt_blob = NULL;
	ulong		image_start, image_end;
	ulong		load_start, load_end;
#if defined(CONFIG_FIT)
        void            *fit_hdr;
        const char      *fit_uname_config = NULL;
        const char      *fit_uname_fdt = NULL;
	ulong		default_addr;
#endif

	if (argc > 3) {
#if defined(CONFIG_FIT)
		/*
		 * If the FDT blob comes from the FIT image and the FIT image
		 * address is omitted in the command line argument, try to use
		 * ramdisk or os FIT image address or default load address.
		 */
		if (images->fit_uname_rd)
			default_addr = (ulong)images->fit_hdr_rd;
		else if (images->fit_uname_os)
			default_addr = (ulong)images->fit_hdr_os;
		else
			default_addr = load_addr;

		if (fit_parse_conf (argv[3], default_addr,
					&fdt_addr, &fit_uname_config)) {
			debug ("*  fdt: config '%s' from image at 0x%08lx\n",
					fit_uname_config, fdt_addr);
		} else if (fit_parse_subimage (argv[3], default_addr,
					&fdt_addr, &fit_uname_fdt)) {
			debug ("*  fdt: subimage '%s' from image at 0x%08lx\n",
					fit_uname_fdt, fdt_addr);
		} else
#endif
		{
			fdt_addr = simple_strtoul(argv[3], NULL, 16);
			debug ("*  fdt: cmdline image address = 0x%08lx\n",
					fdt_addr);
		}

		debug ("## Checking for 'FDT'/'FDT image' at %08lx\n",
				fdt_addr);

		/* copy from dataflash if needed */
		fdt_addr = gen_get_image (fdt_addr);

		/*
		 * Check if there is an FDT image at the
		 * address provided in the second bootm argument
		 * check image type, for FIT images get a FIT node.
		 */
		switch (gen_image_get_format ((void *)fdt_addr)) {
		case IMAGE_FORMAT_LEGACY:
			debug ("*  fdt: legacy format image\n");

			fdt_hdr = (image_header_t *)fdt_addr;
			printf ("## Flattened Device Tree Legacy Image at %08lx\n",
					fdt_hdr);

			image_print_contents (fdt_hdr);

			image_start = (ulong)fdt_hdr;
			image_end = image_get_image_end (fdt_hdr);

			load_start = image_get_load (fdt_hdr);
			load_end = load_start + image_get_data_size (fdt_hdr);

			if ((load_start < image_end) && (load_end > image_start)) {
				fdt_error ("fdt overwritten");
				do_reset (cmdtp, flag, argc, argv);
			}

			puts ("   Verifying Checksum ... ");
			if (!image_check_hcrc (fdt_hdr)) {
				fdt_error ("fdt header checksum invalid");
				do_reset (cmdtp, flag, argc, argv);
			}

			if (!image_check_dcrc (fdt_hdr)) {
				fdt_error ("fdt checksum invalid");
				do_reset (cmdtp, flag, argc, argv);
			}
			puts ("OK\n");

			if (!image_check_type (fdt_hdr, IH_TYPE_FLATDT)) {
				fdt_error ("uImage is not a fdt");
				do_reset (cmdtp, flag, argc, argv);
			}
			if (image_get_comp (fdt_hdr) != IH_COMP_NONE) {
				fdt_error ("uImage is compressed");
				do_reset (cmdtp, flag, argc, argv);
			}
			if (fdt_check_header ((char *)image_get_data (fdt_hdr)) != 0) {
				fdt_error ("uImage data is not a fdt");
				do_reset (cmdtp, flag, argc, argv);
			}

			memmove ((void *)image_get_load (fdt_hdr),
				(void *)image_get_data (fdt_hdr),
				image_get_data_size (fdt_hdr));

			fdt_blob = (char *)image_get_load (fdt_hdr);
			break;
#if defined(CONFIG_FIT)
		case IMAGE_FORMAT_FIT:

			/* check FDT blob vs FIT hdr */
			if (fit_uname_config || fit_uname_fdt) {
				/*
				 * FIT image
				 */
				fit_hdr = (void *)fdt_addr;
				debug ("*  fdt: FIT format image\n");
				fit_unsupported_reset ("PPC fdt");
				do_reset (cmdtp, flag, argc, argv);
			} else {
				/*
				 * FDT blob
				 */
				printf ("## Flattened Device Tree blob at %08lx\n", fdt_blob);
				fdt_blob = (char *)fdt_addr;
			}
			break;
#endif
		default:
			fdt_error ("Did not find a cmdline Flattened Device Tree");
			do_reset (cmdtp, flag, argc, argv);
		}

		printf ("   Booting using the fdt blob at 0x%x\n", fdt_blob);

	} else if (images->legacy_hdr_valid &&
			image_check_type (images->legacy_hdr_os, IH_TYPE_MULTI)) {

		ulong fdt_data, fdt_len;

		/*
		 * Now check if we have a legacy multi-component image,
		 * get second entry data start address and len.
		 */
		printf ("## Flattened Device Tree from multi "
			"component Image at %08lX\n",
			(ulong)images->legacy_hdr_os);

		image_multi_getimg (images->legacy_hdr_os, 2, &fdt_data, &fdt_len);
		if (fdt_len) {

			fdt_blob = (char *)fdt_data;
			printf ("   Booting using the fdt at 0x%x\n", fdt_blob);

			if (fdt_check_header (fdt_blob) != 0) {
				fdt_error ("image is not a fdt");
				do_reset (cmdtp, flag, argc, argv);
			}

			if (be32_to_cpu (fdt_totalsize (fdt_blob)) != fdt_len) {
				fdt_error ("fdt size != image size");
				do_reset (cmdtp, flag, argc, argv);
			}
		} else {
			fdt_error ("Did not find a Flattened Device Tree "
				"in a legacy multi-component image");
			do_reset (cmdtp, flag, argc, argv);
		}
	} else {
		debug ("## No Flattened Device Tree\n");
		*of_flat_tree = NULL;
		*of_size = 0;
		return;
	}

	*of_flat_tree = fdt_blob;
	*of_size = be32_to_cpu (fdt_totalsize (fdt_blob));
	debug ("   of_flat_tree at 0x%08lx size 0x%08lx\n",
			*of_flat_tree, *of_size);
}

static ulong fdt_relocate (ulong alloc_current,
		cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
		char **of_flat_tree, ulong *of_size)
{
	char	*fdt_blob = *of_flat_tree;
	ulong	relocate = 0;
	ulong	new_alloc_current;

	/* nothing to do */
	if (*of_size == 0)
		return alloc_current;

	if (fdt_check_header (fdt_blob) != 0) {
		fdt_error ("image is not a fdt");
		do_reset (cmdtp, flag, argc, argv);
	}

#ifndef CFG_NO_FLASH
	/* move the blob if it is in flash (set relocate) */
	if (addr2info ((ulong)fdt_blob) != NULL)
		relocate = 1;
#endif

#ifdef CFG_BOOTMAPSZ
	/*
	 * The blob must be within CFG_BOOTMAPSZ,
	 * so we flag it to be copied if it is not.
	 */
	if (fdt_blob >= (char *)CFG_BOOTMAPSZ)
		relocate = 1;
#endif

	/* move flattend device tree if needed */
	if (relocate) {
		int err;
		ulong of_start, of_len;

		of_len = *of_size;

		/* position on a 4K boundary before the alloc_current */
		of_start  = alloc_current - of_len;
		of_start &= ~(4096 - 1);	/* align on page */

		debug ("## device tree at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
			(ulong)fdt_blob, (ulong)fdt_blob + of_len - 1,
			of_len, of_len);

		printf ("   Loading Device Tree to %08lx, end %08lx ... ",
			of_start, of_start + of_len - 1);

		err = fdt_open_into (fdt_blob, (void *)of_start, of_len);
		if (err != 0) {
			fdt_error ("fdt move failed");
			do_reset (cmdtp, flag, argc, argv);
		}
		puts ("OK\n");

		*of_flat_tree = (char *)of_start;
		new_alloc_current = of_start;
	} else {
		*of_flat_tree = fdt_blob;
		new_alloc_current = alloc_current;
	}

	return new_alloc_current;
}
#endif
Commit	Line	Data
5d3cc55e MB	1	/*
	2	* (C) Copyright 2008 Semihalf
	3	*
	4	* (C) Copyright 2000-2006
	5	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	6	*
	7	* See file CREDITS for list of people who contributed to this
	8	* project.
	9	*
	10	* This program is free software; you can redistribute it and/or
	11	* modify it under the terms of the GNU General Public License as
	12	* published by the Free Software Foundation; either version 2 of
	13	* the License, or (at your option) any later version.
	14	*
	15	* This program is distributed in the hope that it will be useful,
	16	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	17	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	18	* GNU General Public License for more details.
	19	*
	20	* You should have received a copy of the GNU General Public License
	21	* along with this program; if not, write to the Free Software
	22	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	23	* MA 02111-1307 USA
	24	*/
	25
7582438c MB	26	#define DEBUG
7582438c MB	27
5d3cc55e MB	28	#include <common.h>
	29	#include <watchdog.h>
	30	#include <command.h>
	31	#include <image.h>
	32	#include <malloc.h>
	33	#include <zlib.h>
	34	#include <bzlib.h>
	35	#include <environment.h>
	36	#include <asm/byteorder.h>
	37
	38	#if defined(CONFIG_OF_LIBFDT)
	39	#include <fdt.h>
	40	#include <libfdt.h>
	41	#include <fdt_support.h>
d3c5eb6d MB	42
d3c5eb6d MB	43	static void fdt_error (const char *msg);
d2ced9eb MB	44	static void get_fdt (cmd_tbl_t cmdtp, int flag, int argc, char argv[],
	45	bootm_headers_t images, char of_flat_tree, ulong of_size);
	46	static ulong fdt_relocate (ulong alloc_current,
	47	cmd_tbl_t cmdtp, int flag, int argc, char argv[],
	48	char *of_flat_tree, ulong of_size);
5d3cc55e MB	49	#endif
5d3cc55e MB	50
5d3cc55e MB	51	#ifdef CFG_INIT_RAM_LOCK
	52	#include <asm/cache.h>
	53	#endif
	54
5d3cc55e	55	DECLARE_GLOBAL_DATA_PTR;
5d3cc55e	56
5d3cc55e	57	extern int do_reset (cmd_tbl_t cmdtp, int flag, int argc, char argv[]);
ceaed2b1	58	static ulong get_sp (void);
b6b0fe64	59	static void set_clocks_in_mhz (bd_t *kbd);
5d3cc55e MB	60
5d3cc55e MB	61	void __attribute__((noinline))
f13e7b2e	62	do_bootm_linux(cmd_tbl_t *cmdtp, int flag,
5d3cc55e	63	int argc, char *argv[],
d5934ad7	64	bootm_headers_t *images,
5d3cc55e MB	65	int verify)
5d3cc55e MB	66	{
b6b0fe64 MB	67	ulong sp, sp_limit, alloc_current;
b6b0fe64 MB	68
f13e7b2e	69	ulong initrd_start, initrd_end;
5ad03eb3	70	ulong rd_data_start, rd_data_end, rd_len;
f13e7b2e MB	71
f13e7b2e MB	72	ulong cmd_start, cmd_end;
5d3cc55e	73	bd_t *kbd;
d5934ad7	74	ulong ep = 0;
5d3cc55e	75	void (kernel)(bd_t , ulong, ulong, ulong, ulong);
f13e7b2e	76
4a2ad5ff	77	#if defined(CONFIG_OF_LIBFDT)
d2ced9eb MB	78	char *of_flat_tree = NULL;
d2ced9eb MB	79	ulong of_size = 0;
5d3cc55e MB	80	#endif
5d3cc55e MB	81
5d3cc55e MB	82	/*
	83	* Booting a (Linux) kernel image
	84	*
	85	* Allocate space for command line and board info - the
	86	* address should be as high as possible within the reach of
	87	* the kernel (see CFG_BOOTMAPSZ settings), but in unused
	88	* memory, which means far enough below the current stack
	89	* pointer.
	90	*/
b6b0fe64 MB	91	sp = get_sp();
b6b0fe64 MB	92	debug ("## Current stack ends at 0x%08lx ", sp);
5d3cc55e	93
b6b0fe64 MB	94	alloc_current = sp_limit = get_boot_sp_limit(sp);
b6b0fe64 MB	95	debug ("=> set upper limit to 0x%08lx\n", sp_limit);
5d3cc55e	96
b6b0fe64 MB	97	/* allocate space and init command line */
b6b0fe64 MB	98	alloc_current = get_boot_cmdline (alloc_current, &cmd_start, &cmd_end);
5d3cc55e	99
b6b0fe64 MB	100	/* allocate space for kernel copy of board info */
	101	alloc_current = get_boot_kbd (alloc_current, &kbd);
	102	set_clocks_in_mhz(kbd);
5d3cc55e	103
d5934ad7 MB	104	/* find kernel entry point */
	105	if (images->legacy_hdr_valid) {
	106	ep = image_get_ep (images->legacy_hdr_os);
	107	#if defined(CONFIG_FIT)
	108	} else if (images->fit_uname_os) {
	109	fit_unsupported_reset ("PPC linux bootm");
	110	do_reset (cmdtp, flag, argc, argv);
	111	#endif
	112	} else {
	113	puts ("Could not find kernel entry point!\n");
	114	do_reset (cmdtp, flag, argc, argv);
	115	}
	116	kernel = (void ()(bd_t , ulong, ulong, ulong, ulong))ep;
5d3cc55e	117
ceaed2b1	118	/* find ramdisk */
d5934ad7	119	get_ramdisk (cmdtp, flag, argc, argv, images, verify,
5ad03eb3	120	IH_ARCH_PPC, &rd_data_start, &rd_data_end);
ceaed2b1	121
5ad03eb3	122	rd_len = rd_data_end - rd_data_start;
5d3cc55e	123
b6b0fe64 MB	124	alloc_current = ramdisk_high (alloc_current, rd_data_start, rd_len,
b6b0fe64 MB	125	kbd, sp_limit, get_sp (),
ceaed2b1 MB	126	&initrd_start, &initrd_end);
ceaed2b1 MB	127
4a2ad5ff	128	#if defined(CONFIG_OF_LIBFDT)
ceaed2b1	129	/* find flattened device tree */
d2ced9eb MB	130	get_fdt (cmdtp, flag, argc, argv, images, &of_flat_tree, &of_size);
	131
	132	alloc_current = fdt_relocate (alloc_current,
	133	cmdtp, flag, argc, argv, &of_flat_tree, &of_size);
5d3cc55e	134
5d3cc55e MB	135	/*
	136	* Add the chosen node if it doesn't exist, add the env and bd_t
	137	* if the user wants it (the logic is in the subroutines).
	138	*/
d2ced9eb	139	if (of_size) {
5d3cc55e	140	if (fdt_chosen(of_flat_tree, initrd_start, initrd_end, 0) < 0) {
d3c5eb6d	141	fdt_error ("/chosen node create failed");
5d3cc55e MB	142	do_reset (cmdtp, flag, argc, argv);
	143	}
	144	#ifdef CONFIG_OF_HAS_UBOOT_ENV
	145	if (fdt_env(of_flat_tree) < 0) {
d3c5eb6d	146	fdt_error ("/u-boot-env node create failed");
5d3cc55e MB	147	do_reset (cmdtp, flag, argc, argv);
	148	}
	149	#endif
	150	#ifdef CONFIG_OF_HAS_BD_T
	151	if (fdt_bd_t(of_flat_tree) < 0) {
d3c5eb6d	152	fdt_error ("/bd_t node create failed");
5d3cc55e MB	153	do_reset (cmdtp, flag, argc, argv);
	154	}
	155	#endif
	156	#ifdef CONFIG_OF_BOARD_SETUP
	157	/* Call the board-specific fixup routine */
	158	ft_board_setup(of_flat_tree, gd->bd);
	159	#endif
	160	}
4a2ad5ff	161	#endif /* CONFIG_OF_LIBFDT */
d45d5a18	162
5d3cc55e MB	163	debug ("## Transferring control to Linux (at address %08lx) ...\n",
	164	(ulong)kernel);
	165
	166	show_boot_progress (15);
	167
	168	#if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
	169	unlock_ram_in_cache();
	170	#endif
	171
4a2ad5ff	172	#if defined(CONFIG_OF_LIBFDT)
5d3cc55e MB	173	if (of_flat_tree) { /* device tree; boot new style */
	174	/*
	175	* Linux Kernel Parameters (passing device tree):
	176	* r3: pointer to the fdt, followed by the board info data
	177	* r4: physical pointer to the kernel itself
	178	* r5: NULL
	179	* r6: NULL
	180	* r7: NULL
	181	*/
	182	(kernel) ((bd_t )of_flat_tree, (ulong)kernel, 0, 0, 0);
	183	/* does not return */
	184	}
	185	#endif
	186	/*
	187	* Linux Kernel Parameters (passing board info data):
	188	* r3: ptr to board info data
	189	* r4: initrd_start or 0 if no initrd
	190	* r5: initrd_end - unused if r4 is 0
	191	* r6: Start of command line string
	192	* r7: End of command line string
	193	*/
	194	(*kernel) (kbd, initrd_start, initrd_end, cmd_start, cmd_end);
	195	/* does not return */
	196	}
d3c5eb6d	197
ceaed2b1 MB	198	static ulong get_sp (void)
	199	{
	200	ulong sp;
	201
	202	asm( "mr %0,1": "=r"(sp) : );
	203	return sp;
	204	}
	205
b6b0fe64 MB	206	static void set_clocks_in_mhz (bd_t *kbd)
	207	{
	208	char *s;
	209
	210	if ((s = getenv ("clocks_in_mhz")) != NULL) {
	211	/* convert all clock information to MHz */
	212	kbd->bi_intfreq /= 1000000L;
	213	kbd->bi_busfreq /= 1000000L;
	214	#if defined(CONFIG_MPC8220)
	215	kbd->bi_inpfreq /= 1000000L;
	216	kbd->bi_pcifreq /= 1000000L;
	217	kbd->bi_pevfreq /= 1000000L;
	218	kbd->bi_flbfreq /= 1000000L;
	219	kbd->bi_vcofreq /= 1000000L;
	220	#endif
	221	#if defined(CONFIG_CPM2)
	222	kbd->bi_cpmfreq /= 1000000L;
	223	kbd->bi_brgfreq /= 1000000L;
	224	kbd->bi_sccfreq /= 1000000L;
	225	kbd->bi_vco /= 1000000L;
	226	#endif
	227	#if defined(CONFIG_MPC5xxx)
	228	kbd->bi_ipbfreq /= 1000000L;
	229	kbd->bi_pcifreq /= 1000000L;
	230	#endif /* CONFIG_MPC5xxx */
	231	}
	232	}
	233
d3c5eb6d MB	234	#if defined(CONFIG_OF_LIBFDT)
	235	static void fdt_error (const char *msg)
	236	{
	237	puts ("ERROR: ");
	238	puts (msg);
	239	puts (" - must RESET the board to recover.\n");
	240	}
7b325454	241
d2ced9eb MB	242	static void get_fdt (cmd_tbl_t cmdtp, int flag, int argc, char argv[],
d2ced9eb MB	243	bootm_headers_t images, char of_flat_tree, ulong of_size)
7b325454	244	{
d5934ad7	245	ulong fdt_addr;
7b325454	246	image_header_t *fdt_hdr;
d5934ad7	247	char *fdt_blob = NULL;
d5934ad7 MB	248	ulong image_start, image_end;
	249	ulong load_start, load_end;
	250	#if defined(CONFIG_FIT)
	251	void *fit_hdr;
	252	const char *fit_uname_config = NULL;
	253	const char *fit_uname_fdt = NULL;
	254	ulong default_addr;
	255	#endif
7b325454	256
d5934ad7 MB	257	if (argc > 3) {
	258	#if defined(CONFIG_FIT)
	259	/*
	260	* If the FDT blob comes from the FIT image and the FIT image
	261	* address is omitted in the command line argument, try to use
	262	* ramdisk or os FIT image address or default load address.
	263	*/
	264	if (images->fit_uname_rd)
	265	default_addr = (ulong)images->fit_hdr_rd;
	266	else if (images->fit_uname_os)
	267	default_addr = (ulong)images->fit_hdr_os;
	268	else
	269	default_addr = load_addr;
	270
	271	if (fit_parse_conf (argv[3], default_addr,
	272	&fdt_addr, &fit_uname_config)) {
	273	debug ("* fdt: config '%s' from image at 0x%08lx\n",
	274	fit_uname_config, fdt_addr);
	275	} else if (fit_parse_subimage (argv[3], default_addr,
	276	&fdt_addr, &fit_uname_fdt)) {
	277	debug ("* fdt: subimage '%s' from image at 0x%08lx\n",
	278	fit_uname_fdt, fdt_addr);
	279	} else
	280	#endif
	281	{
	282	fdt_addr = simple_strtoul(argv[3], NULL, 16);
	283	debug ("* fdt: cmdline image address = 0x%08lx\n",
	284	fdt_addr);
	285	}
fff888a1	286
d5934ad7 MB	287	debug ("## Checking for 'FDT'/'FDT image' at %08lx\n",
d5934ad7 MB	288	fdt_addr);
fff888a1 MB	289
fff888a1 MB	290	/* copy from dataflash if needed */
d5934ad7	291	fdt_addr = gen_get_image (fdt_addr);
7b325454	292
d5934ad7 MB	293	/*
	294	* Check if there is an FDT image at the
	295	* address provided in the second bootm argument
	296	* check image type, for FIT images get a FIT node.
	297	*/
	298	switch (gen_image_get_format ((void *)fdt_addr)) {
	299	case IMAGE_FORMAT_LEGACY:
	300	debug ("* fdt: legacy format image\n");
7b325454	301
d5934ad7 MB	302	fdt_hdr = (image_header_t *)fdt_addr;
d5934ad7 MB	303	printf ("## Flattened Device Tree Legacy Image at %08lx\n",
7b325454 MB	304	fdt_hdr);
7b325454 MB	305
2242f536	306	image_print_contents (fdt_hdr);
7b325454 MB	307
	308	image_start = (ulong)fdt_hdr;
	309	image_end = image_get_image_end (fdt_hdr);
	310
	311	load_start = image_get_load (fdt_hdr);
	312	load_end = load_start + image_get_data_size (fdt_hdr);
	313
	314	if ((load_start < image_end) && (load_end > image_start)) {
	315	fdt_error ("fdt overwritten");
	316	do_reset (cmdtp, flag, argc, argv);
	317	}
	318
	319	puts (" Verifying Checksum ... ");
	320	if (!image_check_hcrc (fdt_hdr)) {
	321	fdt_error ("fdt header checksum invalid");
	322	do_reset (cmdtp, flag, argc, argv);
	323	}
	324
	325	if (!image_check_dcrc (fdt_hdr)) {
	326	fdt_error ("fdt checksum invalid");
	327	do_reset (cmdtp, flag, argc, argv);
	328	}
	329	puts ("OK\n");
	330
	331	if (!image_check_type (fdt_hdr, IH_TYPE_FLATDT)) {
	332	fdt_error ("uImage is not a fdt");
	333	do_reset (cmdtp, flag, argc, argv);
	334	}
	335	if (image_get_comp (fdt_hdr) != IH_COMP_NONE) {
	336	fdt_error ("uImage is compressed");
	337	do_reset (cmdtp, flag, argc, argv);
	338	}
	339	if (fdt_check_header ((char *)image_get_data (fdt_hdr)) != 0) {
	340	fdt_error ("uImage data is not a fdt");
	341	do_reset (cmdtp, flag, argc, argv);
	342	}
	343
	344	memmove ((void *)image_get_load (fdt_hdr),
	345	(void *)image_get_data (fdt_hdr),
	346	image_get_data_size (fdt_hdr));
	347
d5934ad7 MB	348	fdt_blob = (char *)image_get_load (fdt_hdr);
	349	break;
	350	#if defined(CONFIG_FIT)
	351	case IMAGE_FORMAT_FIT:
	352
	353	/* check FDT blob vs FIT hdr */
	354	if (fit_uname_config \|\| fit_uname_fdt) {
	355	/*
	356	* FIT image
	357	*/
	358	fit_hdr = (void *)fdt_addr;
	359	debug ("* fdt: FIT format image\n");
	360	fit_unsupported_reset ("PPC fdt");
	361	do_reset (cmdtp, flag, argc, argv);
	362	} else {
	363	/*
	364	* FDT blob
	365	*/
	366	printf ("## Flattened Device Tree blob at %08lx\n", fdt_blob);
	367	fdt_blob = (char *)fdt_addr;
	368	}
	369	break;
	370	#endif
	371	default:
	372	fdt_error ("Did not find a cmdline Flattened Device Tree");
7b325454 MB	373	do_reset (cmdtp, flag, argc, argv);
7b325454 MB	374	}
d5934ad7 MB	375
	376	printf (" Booting using the fdt blob at 0x%x\n", fdt_blob);
	377
	378	} else if (images->legacy_hdr_valid &&
	379	image_check_type (images->legacy_hdr_os, IH_TYPE_MULTI)) {
	380
7b325454 MB	381	ulong fdt_data, fdt_len;
7b325454 MB	382
d5934ad7 MB	383	/*
	384	* Now check if we have a legacy multi-component image,
	385	* get second entry data start address and len.
	386	*/
7b325454	387	printf ("## Flattened Device Tree from multi "
d5934ad7 MB	388	"component Image at %08lX\n",
d5934ad7 MB	389	(ulong)images->legacy_hdr_os);
7b325454	390
d5934ad7	391	image_multi_getimg (images->legacy_hdr_os, 2, &fdt_data, &fdt_len);
7b325454 MB	392	if (fdt_len) {
7b325454 MB	393
d5934ad7 MB	394	fdt_blob = (char *)fdt_data;
d5934ad7 MB	395	printf (" Booting using the fdt at 0x%x\n", fdt_blob);
7b325454	396
d5934ad7	397	if (fdt_check_header (fdt_blob) != 0) {
7b325454 MB	398	fdt_error ("image is not a fdt");
	399	do_reset (cmdtp, flag, argc, argv);
	400	}
	401
d5934ad7	402	if (be32_to_cpu (fdt_totalsize (fdt_blob)) != fdt_len) {
7b325454 MB	403	fdt_error ("fdt size != image size");
	404	do_reset (cmdtp, flag, argc, argv);
	405	}
	406	} else {
d5934ad7 MB	407	fdt_error ("Did not find a Flattened Device Tree "
	408	"in a legacy multi-component image");
	409	do_reset (cmdtp, flag, argc, argv);
7b325454	410	}
d5934ad7 MB	411	} else {
	412	debug ("## No Flattened Device Tree\n");
	413	*of_flat_tree = NULL;
d2ced9eb MB	414	*of_size = 0;
	415	return;
	416	}
	417
	418	*of_flat_tree = fdt_blob;
	419	*of_size = be32_to_cpu (fdt_totalsize (fdt_blob));
	420	debug (" of_flat_tree at 0x%08lx size 0x%08lx\n",
	421	of_flat_tree, of_size);
	422	}
	423
	424	static ulong fdt_relocate (ulong alloc_current,
	425	cmd_tbl_t cmdtp, int flag, int argc, char argv[],
	426	char *of_flat_tree, ulong of_size)
	427	{
	428	char fdt_blob = of_flat_tree;
	429	ulong relocate = 0;
	430	ulong new_alloc_current;
	431
	432	/* nothing to do */
	433	if (*of_size == 0)
d5934ad7	434	return alloc_current;
d2ced9eb MB	435
	436	if (fdt_check_header (fdt_blob) != 0) {
	437	fdt_error ("image is not a fdt");
	438	do_reset (cmdtp, flag, argc, argv);
7b325454 MB	439	}
7b325454 MB	440
d5934ad7	441	#ifndef CFG_NO_FLASH
d2ced9eb	442	/* move the blob if it is in flash (set relocate) */
d5934ad7	443	if (addr2info ((ulong)fdt_blob) != NULL)
d2ced9eb	444	relocate = 1;
d5934ad7 MB	445	#endif
d5934ad7 MB	446
7b325454 MB	447	#ifdef CFG_BOOTMAPSZ
	448	/*
	449	* The blob must be within CFG_BOOTMAPSZ,
	450	* so we flag it to be copied if it is not.
	451	*/
d5934ad7	452	if (fdt_blob >= (char *)CFG_BOOTMAPSZ)
d2ced9eb	453	relocate = 1;
7b325454 MB	454	#endif
	455
	456	/* move flattend device tree if needed */
d2ced9eb	457	if (relocate) {
7b325454 MB	458	int err;
	459	ulong of_start, of_len;
	460
d2ced9eb	461	of_len = *of_size;
7b325454 MB	462
	463	/* position on a 4K boundary before the alloc_current */
	464	of_start = alloc_current - of_len;
	465	of_start &= ~(4096 - 1); /* align on page */
	466
	467	debug ("## device tree at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
d5934ad7	468	(ulong)fdt_blob, (ulong)fdt_blob + of_len - 1,
7b325454 MB	469	of_len, of_len);
	470
	471	printf (" Loading Device Tree to %08lx, end %08lx ... ",
	472	of_start, of_start + of_len - 1);
	473
d5934ad7	474	err = fdt_open_into (fdt_blob, (void *)of_start, of_len);
7b325454 MB	475	if (err != 0) {
	476	fdt_error ("fdt move failed");
	477	do_reset (cmdtp, flag, argc, argv);
	478	}
	479	puts ("OK\n");
	480
	481	of_flat_tree = (char )of_start;
	482	new_alloc_current = of_start;
	483	} else {
d5934ad7	484	*of_flat_tree = fdt_blob;
7b325454 MB	485	new_alloc_current = alloc_current;
	486	}
	487
	488	return new_alloc_current;
	489	}
d3c5eb6d	490	#endif