[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)
{
	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);
	int	ret;
	ulong	of_size = 0;

#if defined(CONFIG_OF_LIBFDT)
	char	*of_flat_tree = NULL;
#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);

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

	if (!of_size) {
		/* 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,
			IH_ARCH_PPC, &rd_data_start, &rd_data_end);

	rd_len = rd_data_end - rd_data_start;

#if defined(CONFIG_OF_LIBFDT)
	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) {
		/* pass in dummy initrd info, we'll fix up later */
		if (fdt_chosen(of_flat_tree, rd_data_start, rd_data_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 */

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

#if defined(CONFIG_OF_LIBFDT)
	/* fixup the initrd now that we know where it should be */
	if ((of_flat_tree) && (initrd_start && initrd_end)) {
		uint64_t addr, size;
		int  total = fdt_num_mem_rsv(of_flat_tree);
		int  j;

		/* Look for the dummy entry and delete it */
		for (j = 0; j < total; j++) {
			fdt_get_mem_rsv(of_flat_tree, j, &addr, &size);
			if (addr == rd_data_start) {
				fdt_del_mem_rsv(of_flat_tree, j);
				break;
			}
		}

		ret = fdt_add_mem_rsv(of_flat_tree, initrd_start,
					initrd_end - initrd_start + 1);
		if (ret < 0) {
			printf("fdt_chosen: %s\n", fdt_strerror(ret));
			do_reset (cmdtp, flag, argc, argv);
		}

		do_fixup_by_path_u32(of_flat_tree, "/chosen",
					"linux,initrd-start", initrd_start, 0);
		do_fixup_by_path_u32(of_flat_tree, "/chosen",
					"linux,initrd-end", initrd_end, 0);
	}
#endif
	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 image_header_t *image_get_fdt (ulong fdt_addr)
{
	image_header_t *fdt_hdr = (image_header_t *)fdt_addr;

	image_print_contents (fdt_hdr);

	puts ("   Verifying Checksum ... ");
	if (!image_check_hcrc (fdt_hdr)) {
		fdt_error ("fdt header checksum invalid");
		return NULL;
	}

	if (!image_check_dcrc (fdt_hdr)) {
		fdt_error ("fdt checksum invalid");
		return NULL;
	}
	puts ("OK\n");

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

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");

			/* verify fdt_addr points to a valid image header */
			printf ("## Flattened Device Tree Legacy Image at %08lx\n",
					fdt_addr);
			fdt_hdr = image_get_fdt (fdt_addr);
			if (!fdt_hdr)
				do_reset (cmdtp, flag, argc, argv);

			/*
			 * move image data to the load address,
			 * make sure we don't overwrite initial image
			 */
			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);
			}
			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;
		case IMAGE_FORMAT_FIT:
			/*
			 * This case will catch both: new uImage format
			 * (libfdt based) and raw FDT blob (also libfdt
			 * based).
			 */
#if defined(CONFIG_FIT)
			/* check FDT blob vs FIT blob */
			if (0) { /* FIXME: call FIT format verification */
				/*
				 * 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
#endif
			{
				/*
				 * FDT blob
				 */
				debug ("*  fdt: raw FDT blob\n");
				printf ("## Flattened Device Tree blob at %08lx\n", fdt_blob);
				fdt_blob = (char *)fdt_addr;
			}
			break;
		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))
8a5ea3e6 MB	62	do_bootm_linux(cmd_tbl_t cmdtp, int flag, int argc, char argv[],
8a5ea3e6 MB	63	bootm_headers_t *images)
5d3cc55e	64	{
b6b0fe64 MB	65	ulong sp, sp_limit, alloc_current;
b6b0fe64 MB	66
f13e7b2e	67	ulong initrd_start, initrd_end;
5ad03eb3	68	ulong rd_data_start, rd_data_end, rd_len;
f13e7b2e MB	69
f13e7b2e MB	70	ulong cmd_start, cmd_end;
5d3cc55e	71	bd_t *kbd;
d5934ad7	72	ulong ep = 0;
5d3cc55e	73	void (kernel)(bd_t , ulong, ulong, ulong, ulong);
d2bc095a	74	int ret;
27953493	75	ulong of_size = 0;
f13e7b2e	76
4a2ad5ff	77	#if defined(CONFIG_OF_LIBFDT)
d2ced9eb	78	char *of_flat_tree = NULL;
5d3cc55e MB	79	#endif
5d3cc55e MB	80
5d3cc55e MB	81	/*
	82	* Booting a (Linux) kernel image
	83	*
	84	* Allocate space for command line and board info - the
	85	* address should be as high as possible within the reach of
	86	* the kernel (see CFG_BOOTMAPSZ settings), but in unused
	87	* memory, which means far enough below the current stack
	88	* pointer.
	89	*/
b6b0fe64 MB	90	sp = get_sp();
b6b0fe64 MB	91	debug ("## Current stack ends at 0x%08lx ", sp);
5d3cc55e	92
b6b0fe64 MB	93	alloc_current = sp_limit = get_boot_sp_limit(sp);
b6b0fe64 MB	94	debug ("=> set upper limit to 0x%08lx\n", sp_limit);
5d3cc55e	95
27953493 KG	96	#if defined(CONFIG_OF_LIBFDT)
	97	/* find flattened device tree */
	98	get_fdt (cmdtp, flag, argc, argv, images, &of_flat_tree, &of_size);
	99	#endif
5d3cc55e	100
27953493 KG	101	if (!of_size) {
	102	/* allocate space and init command line */
	103	alloc_current = get_boot_cmdline (alloc_current, &cmd_start, &cmd_end);
	104
	105	/* allocate space for kernel copy of board info */
	106	alloc_current = get_boot_kbd (alloc_current, &kbd);
	107	set_clocks_in_mhz(kbd);
	108	}
5d3cc55e	109
d5934ad7 MB	110	/* find kernel entry point */
	111	if (images->legacy_hdr_valid) {
	112	ep = image_get_ep (images->legacy_hdr_os);
	113	#if defined(CONFIG_FIT)
	114	} else if (images->fit_uname_os) {
	115	fit_unsupported_reset ("PPC linux bootm");
	116	do_reset (cmdtp, flag, argc, argv);
	117	#endif
	118	} else {
	119	puts ("Could not find kernel entry point!\n");
	120	do_reset (cmdtp, flag, argc, argv);
	121	}
	122	kernel = (void ()(bd_t , ulong, ulong, ulong, ulong))ep;
5d3cc55e	123
ceaed2b1	124	/* find ramdisk */
8a5ea3e6	125	get_ramdisk (cmdtp, flag, argc, argv, images,
5ad03eb3	126	IH_ARCH_PPC, &rd_data_start, &rd_data_end);
ceaed2b1	127
5ad03eb3	128	rd_len = rd_data_end - rd_data_start;
5d3cc55e	129
4a2ad5ff	130	#if defined(CONFIG_OF_LIBFDT)
d2ced9eb MB	131	alloc_current = fdt_relocate (alloc_current,
d2ced9eb MB	132	cmdtp, flag, argc, argv, &of_flat_tree, &of_size);
5d3cc55e	133
5d3cc55e MB	134	/*
	135	* Add the chosen node if it doesn't exist, add the env and bd_t
	136	* if the user wants it (the logic is in the subroutines).
	137	*/
d2ced9eb	138	if (of_size) {
d2bc095a KG	139	/* pass in dummy initrd info, we'll fix up later */
d2bc095a KG	140	if (fdt_chosen(of_flat_tree, rd_data_start, rd_data_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
d2bc095a KG	163	alloc_current = ramdisk_high (alloc_current, rd_data_start, rd_len,
	164	sp_limit, get_sp (), &initrd_start, &initrd_end);
	165
	166	#if defined(CONFIG_OF_LIBFDT)
	167	/* fixup the initrd now that we know where it should be */
	168	if ((of_flat_tree) && (initrd_start && initrd_end)) {
	169	uint64_t addr, size;
	170	int total = fdt_num_mem_rsv(of_flat_tree);
	171	int j;
	172
	173	/* Look for the dummy entry and delete it */
	174	for (j = 0; j < total; j++) {
	175	fdt_get_mem_rsv(of_flat_tree, j, &addr, &size);
	176	if (addr == rd_data_start) {
	177	fdt_del_mem_rsv(of_flat_tree, j);
	178	break;
	179	}
	180	}
	181
	182	ret = fdt_add_mem_rsv(of_flat_tree, initrd_start,
	183	initrd_end - initrd_start + 1);
	184	if (ret < 0) {
	185	printf("fdt_chosen: %s\n", fdt_strerror(ret));
	186	do_reset (cmdtp, flag, argc, argv);
	187	}
	188
	189	do_fixup_by_path_u32(of_flat_tree, "/chosen",
	190	"linux,initrd-start", initrd_start, 0);
	191	do_fixup_by_path_u32(of_flat_tree, "/chosen",
	192	"linux,initrd-end", initrd_end, 0);
	193	}
	194	#endif
5d3cc55e MB	195	debug ("## Transferring control to Linux (at address %08lx) ...\n",
	196	(ulong)kernel);
	197
	198	show_boot_progress (15);
	199
	200	#if defined(CFG_INIT_RAM_LOCK) && !defined(CONFIG_E500)
	201	unlock_ram_in_cache();
	202	#endif
	203
4a2ad5ff	204	#if defined(CONFIG_OF_LIBFDT)
5d3cc55e MB	205	if (of_flat_tree) { /* device tree; boot new style */
	206	/*
	207	* Linux Kernel Parameters (passing device tree):
	208	* r3: pointer to the fdt, followed by the board info data
	209	* r4: physical pointer to the kernel itself
	210	* r5: NULL
	211	* r6: NULL
	212	* r7: NULL
	213	*/
	214	(kernel) ((bd_t )of_flat_tree, (ulong)kernel, 0, 0, 0);
	215	/* does not return */
	216	}
	217	#endif
	218	/*
	219	* Linux Kernel Parameters (passing board info data):
	220	* r3: ptr to board info data
	221	* r4: initrd_start or 0 if no initrd
	222	* r5: initrd_end - unused if r4 is 0
	223	* r6: Start of command line string
	224	* r7: End of command line string
	225	*/
	226	(*kernel) (kbd, initrd_start, initrd_end, cmd_start, cmd_end);
	227	/* does not return */
	228	}
d3c5eb6d	229
ceaed2b1 MB	230	static ulong get_sp (void)
	231	{
	232	ulong sp;
	233
	234	asm( "mr %0,1": "=r"(sp) : );
	235	return sp;
	236	}
	237
b6b0fe64 MB	238	static void set_clocks_in_mhz (bd_t *kbd)
	239	{
	240	char *s;
	241
	242	if ((s = getenv ("clocks_in_mhz")) != NULL) {
	243	/* convert all clock information to MHz */
	244	kbd->bi_intfreq /= 1000000L;
	245	kbd->bi_busfreq /= 1000000L;
	246	#if defined(CONFIG_MPC8220)
	247	kbd->bi_inpfreq /= 1000000L;
	248	kbd->bi_pcifreq /= 1000000L;
	249	kbd->bi_pevfreq /= 1000000L;
	250	kbd->bi_flbfreq /= 1000000L;
	251	kbd->bi_vcofreq /= 1000000L;
	252	#endif
	253	#if defined(CONFIG_CPM2)
	254	kbd->bi_cpmfreq /= 1000000L;
	255	kbd->bi_brgfreq /= 1000000L;
	256	kbd->bi_sccfreq /= 1000000L;
	257	kbd->bi_vco /= 1000000L;
	258	#endif
	259	#if defined(CONFIG_MPC5xxx)
	260	kbd->bi_ipbfreq /= 1000000L;
	261	kbd->bi_pcifreq /= 1000000L;
	262	#endif /* CONFIG_MPC5xxx */
	263	}
	264	}
	265
d3c5eb6d MB	266	#if defined(CONFIG_OF_LIBFDT)
	267	static void fdt_error (const char *msg)
	268	{
	269	puts ("ERROR: ");
	270	puts (msg);
	271	puts (" - must RESET the board to recover.\n");
	272	}
7b325454	273
ff0734cf MB	274	static image_header_t *image_get_fdt (ulong fdt_addr)
	275	{
	276	image_header_t fdt_hdr = (image_header_t )fdt_addr;
	277
	278	image_print_contents (fdt_hdr);
	279
	280	puts (" Verifying Checksum ... ");
	281	if (!image_check_hcrc (fdt_hdr)) {
	282	fdt_error ("fdt header checksum invalid");
	283	return NULL;
	284	}
	285
	286	if (!image_check_dcrc (fdt_hdr)) {
	287	fdt_error ("fdt checksum invalid");
	288	return NULL;
	289	}
	290	puts ("OK\n");
	291
	292	if (!image_check_type (fdt_hdr, IH_TYPE_FLATDT)) {
	293	fdt_error ("uImage is not a fdt");
	294	return NULL;
	295	}
	296	if (image_get_comp (fdt_hdr) != IH_COMP_NONE) {
	297	fdt_error ("uImage is compressed");
	298	return NULL;
	299	}
	300	if (fdt_check_header ((char *)image_get_data (fdt_hdr)) != 0) {
	301	fdt_error ("uImage data is not a fdt");
	302	return NULL;
	303	}
	304	return fdt_hdr;
	305	}
	306
d2ced9eb MB	307	static void get_fdt (cmd_tbl_t cmdtp, int flag, int argc, char argv[],
d2ced9eb MB	308	bootm_headers_t images, char of_flat_tree, ulong of_size)
7b325454	309	{
d5934ad7	310	ulong fdt_addr;
7b325454	311	image_header_t *fdt_hdr;
d5934ad7	312	char *fdt_blob = NULL;
d5934ad7 MB	313	ulong image_start, image_end;
	314	ulong load_start, load_end;
	315	#if defined(CONFIG_FIT)
	316	void *fit_hdr;
	317	const char *fit_uname_config = NULL;
	318	const char *fit_uname_fdt = NULL;
	319	ulong default_addr;
	320	#endif
7b325454	321
d5934ad7 MB	322	if (argc > 3) {
	323	#if defined(CONFIG_FIT)
	324	/*
	325	* If the FDT blob comes from the FIT image and the FIT image
	326	* address is omitted in the command line argument, try to use
	327	* ramdisk or os FIT image address or default load address.
	328	*/
	329	if (images->fit_uname_rd)
	330	default_addr = (ulong)images->fit_hdr_rd;
	331	else if (images->fit_uname_os)
	332	default_addr = (ulong)images->fit_hdr_os;
	333	else
	334	default_addr = load_addr;
	335
	336	if (fit_parse_conf (argv[3], default_addr,
	337	&fdt_addr, &fit_uname_config)) {
	338	debug ("* fdt: config '%s' from image at 0x%08lx\n",
	339	fit_uname_config, fdt_addr);
	340	} else if (fit_parse_subimage (argv[3], default_addr,
	341	&fdt_addr, &fit_uname_fdt)) {
	342	debug ("* fdt: subimage '%s' from image at 0x%08lx\n",
	343	fit_uname_fdt, fdt_addr);
	344	} else
	345	#endif
	346	{
	347	fdt_addr = simple_strtoul(argv[3], NULL, 16);
	348	debug ("* fdt: cmdline image address = 0x%08lx\n",
	349	fdt_addr);
	350	}
fff888a1	351
d5934ad7 MB	352	debug ("## Checking for 'FDT'/'FDT image' at %08lx\n",
d5934ad7 MB	353	fdt_addr);
fff888a1 MB	354
fff888a1 MB	355	/* copy from dataflash if needed */
d5934ad7	356	fdt_addr = gen_get_image (fdt_addr);
7b325454	357
d5934ad7 MB	358	/*
	359	* Check if there is an FDT image at the
	360	* address provided in the second bootm argument
	361	* check image type, for FIT images get a FIT node.
	362	*/
	363	switch (gen_image_get_format ((void *)fdt_addr)) {
	364	case IMAGE_FORMAT_LEGACY:
	365	debug ("* fdt: legacy format image\n");
7b325454	366
ff0734cf	367	/* verify fdt_addr points to a valid image header */
d5934ad7	368	printf ("## Flattened Device Tree Legacy Image at %08lx\n",
ff0734cf MB	369	fdt_addr);
	370	fdt_hdr = image_get_fdt (fdt_addr);
	371	if (!fdt_hdr)
	372	do_reset (cmdtp, flag, argc, argv);
7b325454	373
ff0734cf MB	374	/*
	375	* move image data to the load address,
	376	* make sure we don't overwrite initial image
	377	*/
7b325454 MB	378	image_start = (ulong)fdt_hdr;
	379	image_end = image_get_image_end (fdt_hdr);
	380
	381	load_start = image_get_load (fdt_hdr);
	382	load_end = load_start + image_get_data_size (fdt_hdr);
	383
	384	if ((load_start < image_end) && (load_end > image_start)) {
	385	fdt_error ("fdt overwritten");
	386	do_reset (cmdtp, flag, argc, argv);
	387	}
7b325454	388	memmove ((void *)image_get_load (fdt_hdr),
ff0734cf MB	389	(void *)image_get_data (fdt_hdr),
ff0734cf MB	390	image_get_data_size (fdt_hdr));
7b325454	391
d5934ad7 MB	392	fdt_blob = (char *)image_get_load (fdt_hdr);
d5934ad7 MB	393	break;
d5934ad7	394	case IMAGE_FORMAT_FIT:
4efbe9db MB	395	/*
	396	* This case will catch both: new uImage format
	397	* (libfdt based) and raw FDT blob (also libfdt
	398	* based).
	399	*/
	400	#if defined(CONFIG_FIT)
	401	/* check FDT blob vs FIT blob */
	402	if (0) { /* FIXME: call FIT format verification */
d5934ad7 MB	403	/*
	404	* FIT image
	405	*/
	406	fit_hdr = (void *)fdt_addr;
	407	debug ("* fdt: FIT format image\n");
	408	fit_unsupported_reset ("PPC fdt");
	409	do_reset (cmdtp, flag, argc, argv);
4efbe9db MB	410	} else
	411	#endif
	412	{
d5934ad7 MB	413	/*
	414	* FDT blob
	415	*/
4efbe9db	416	debug ("* fdt: raw FDT blob\n");
d5934ad7 MB	417	printf ("## Flattened Device Tree blob at %08lx\n", fdt_blob);
	418	fdt_blob = (char *)fdt_addr;
	419	}
	420	break;
d5934ad7 MB	421	default:
d5934ad7 MB	422	fdt_error ("Did not find a cmdline Flattened Device Tree");
7b325454 MB	423	do_reset (cmdtp, flag, argc, argv);
7b325454 MB	424	}
d5934ad7 MB	425
	426	printf (" Booting using the fdt blob at 0x%x\n", fdt_blob);
	427
	428	} else if (images->legacy_hdr_valid &&
	429	image_check_type (images->legacy_hdr_os, IH_TYPE_MULTI)) {
	430
7b325454 MB	431	ulong fdt_data, fdt_len;
7b325454 MB	432
d5934ad7 MB	433	/*
	434	* Now check if we have a legacy multi-component image,
	435	* get second entry data start address and len.
	436	*/
7b325454	437	printf ("## Flattened Device Tree from multi "
d5934ad7 MB	438	"component Image at %08lX\n",
d5934ad7 MB	439	(ulong)images->legacy_hdr_os);
7b325454	440
d5934ad7	441	image_multi_getimg (images->legacy_hdr_os, 2, &fdt_data, &fdt_len);
7b325454 MB	442	if (fdt_len) {
7b325454 MB	443
d5934ad7 MB	444	fdt_blob = (char *)fdt_data;
d5934ad7 MB	445	printf (" Booting using the fdt at 0x%x\n", fdt_blob);
7b325454	446
d5934ad7	447	if (fdt_check_header (fdt_blob) != 0) {
7b325454 MB	448	fdt_error ("image is not a fdt");
	449	do_reset (cmdtp, flag, argc, argv);
	450	}
	451
d5934ad7	452	if (be32_to_cpu (fdt_totalsize (fdt_blob)) != fdt_len) {
7b325454 MB	453	fdt_error ("fdt size != image size");
	454	do_reset (cmdtp, flag, argc, argv);
	455	}
	456	} else {
d5934ad7 MB	457	fdt_error ("Did not find a Flattened Device Tree "
	458	"in a legacy multi-component image");
	459	do_reset (cmdtp, flag, argc, argv);
7b325454	460	}
d5934ad7 MB	461	} else {
	462	debug ("## No Flattened Device Tree\n");
	463	*of_flat_tree = NULL;
d2ced9eb MB	464	*of_size = 0;
	465	return;
	466	}
	467
	468	*of_flat_tree = fdt_blob;
	469	*of_size = be32_to_cpu (fdt_totalsize (fdt_blob));
	470	debug (" of_flat_tree at 0x%08lx size 0x%08lx\n",
	471	of_flat_tree, of_size);
	472	}
	473
	474	static ulong fdt_relocate (ulong alloc_current,
	475	cmd_tbl_t cmdtp, int flag, int argc, char argv[],
	476	char *of_flat_tree, ulong of_size)
	477	{
	478	char fdt_blob = of_flat_tree;
	479	ulong relocate = 0;
	480	ulong new_alloc_current;
	481
	482	/* nothing to do */
	483	if (*of_size == 0)
d5934ad7	484	return alloc_current;
d2ced9eb MB	485
	486	if (fdt_check_header (fdt_blob) != 0) {
	487	fdt_error ("image is not a fdt");
	488	do_reset (cmdtp, flag, argc, argv);
7b325454 MB	489	}
7b325454 MB	490
d5934ad7	491	#ifndef CFG_NO_FLASH
d2ced9eb	492	/* move the blob if it is in flash (set relocate) */
d5934ad7	493	if (addr2info ((ulong)fdt_blob) != NULL)
d2ced9eb	494	relocate = 1;
d5934ad7 MB	495	#endif
d5934ad7 MB	496
7b325454 MB	497	#ifdef CFG_BOOTMAPSZ
	498	/*
	499	* The blob must be within CFG_BOOTMAPSZ,
	500	* so we flag it to be copied if it is not.
	501	*/
d5934ad7	502	if (fdt_blob >= (char *)CFG_BOOTMAPSZ)
d2ced9eb	503	relocate = 1;
7b325454 MB	504	#endif
	505
	506	/* move flattend device tree if needed */
d2ced9eb	507	if (relocate) {
7b325454 MB	508	int err;
	509	ulong of_start, of_len;
	510
d2ced9eb	511	of_len = *of_size;
7b325454 MB	512
	513	/* position on a 4K boundary before the alloc_current */
	514	of_start = alloc_current - of_len;
	515	of_start &= ~(4096 - 1); /* align on page */
	516
	517	debug ("## device tree at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
d5934ad7	518	(ulong)fdt_blob, (ulong)fdt_blob + of_len - 1,
7b325454 MB	519	of_len, of_len);
	520
	521	printf (" Loading Device Tree to %08lx, end %08lx ... ",
	522	of_start, of_start + of_len - 1);
	523
d5934ad7	524	err = fdt_open_into (fdt_blob, (void *)of_start, of_len);
7b325454 MB	525	if (err != 0) {
	526	fdt_error ("fdt move failed");
	527	do_reset (cmdtp, flag, argc, argv);
	528	}
	529	puts ("OK\n");
	530
	531	of_flat_tree = (char )of_start;
	532	new_alloc_current = of_start;
	533	} else {
d5934ad7	534	*of_flat_tree = fdt_blob;
7b325454 MB	535	new_alloc_current = alloc_current;
	536	}
	537
	538	return new_alloc_current;
	539	}
d3c5eb6d	540	#endif