lib_m68k/m68k_linux.c - u-boot - Git at Google

 /*
  * (C) Copyright 2003
  * 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
  *
  */

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

 DECLARE_GLOBAL_DATA_PTR;

 #define PHYSADDR(x) x

 #define LINUX_MAX_ENVS		256
 #define LINUX_MAX_ARGS		256

 #define CHUNKSZ			(64 * 1024)

 #ifdef CONFIG_SHOW_BOOT_PROGRESS
 # include <status_led.h>
 # define SHOW_BOOT_PROGRESS(arg)	show_boot_progress(arg)
 #else
 # define SHOW_BOOT_PROGRESS(arg)
 #endif

 extern image_header_t header;

 void do_bootm_linux(cmd_tbl_t * cmdtp, int flag,
 		    int argc, char *argv[],
 		    ulong addr, ulong * len_ptr, int verify)
 {
 	ulong sp;
 	ulong len, checksum;
 	ulong initrd_start, initrd_end;
 	ulong cmd_start, cmd_end;
 	ulong initrd_high;
 	ulong data;
 	int initrd_copy_to_ram = 1;
 	char *cmdline;
 	char *s;
 	bd_t *kbd;
 	void (*kernel) (bd_t *, ulong, ulong, ulong, ulong);
 	image_header_t *hdr = &header;

 	if ((s = getenv("initrd_high")) != NULL) {
 		/* a value of "no" or a similar string will act like 0,
 		 * turning the "load high" feature off. This is intentional.
 		 */
 		initrd_high = simple_strtoul(s, NULL, 16);
 		if (initrd_high == ~0)
 			initrd_copy_to_ram = 0;
 	} else {		/* not set, no restrictions to load high */
 		initrd_high = ~0;
 	}

 #ifdef CONFIG_LOGBUFFER
 	kbd = gd->bd;
 	/* Prevent initrd from overwriting logbuffer */
 	if (initrd_high < (kbd->bi_memsize - LOGBUFF_LEN - LOGBUFF_OVERHEAD))
 		initrd_high = kbd->bi_memsize - LOGBUFF_LEN - LOGBUFF_OVERHEAD;
 	debug("## Logbuffer at 0x%08lX ", kbd->bi_memsize - LOGBUFF_LEN);
 #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.
 	 */
 	asm("movel %%a7, %%d0\n"
 	    "movel %%d0, %0\n": "=d"(sp): :"%d0");

 	debug("## Current stack ends at 0x%08lX ", sp);

 	sp -= 2048;		/* just to be sure */
 	if (sp > CFG_BOOTMAPSZ)
 		sp = CFG_BOOTMAPSZ;
 	sp &= ~0xF;

 	debug("=> set upper limit to 0x%08lX\n", sp);

 	cmdline = (char *)((sp - CFG_BARGSIZE) & ~0xF);
 	kbd = (bd_t *) (((ulong) cmdline - sizeof(bd_t)) & ~0xF);

 	if ((s = getenv("bootargs")) == NULL)
 		s = "";

 	strcpy(cmdline, s);

 	cmd_start = (ulong) & cmdline[0];
 	cmd_end = cmd_start + strlen(cmdline);

 	*kbd = *(gd->bd);

 #ifdef	DEBUG
 	printf("## cmdline at 0x%08lX ... 0x%08lX\n", cmd_start, cmd_end);

 	do_bdinfo(NULL, 0, 0, NULL);
 #endif

 	if ((s = getenv("clocks_in_mhz")) != NULL) {
 		/* convert all clock information to MHz */
 		kbd->bi_intfreq /= 1000000L;
 		kbd->bi_busfreq /= 1000000L;
 	}

 	kernel =
 	    (void (*)(bd_t *, ulong, ulong, ulong, ulong))ntohl(hdr->ih_ep);

 	/*
 	 * Check if there is an initrd image
 	 */

 	if (argc >= 3) {
 		debug("Not skipping initrd\n");
 		SHOW_BOOT_PROGRESS(9);

 		addr = simple_strtoul(argv[2], NULL, 16);

 		printf("## Loading RAMDisk Image at %08lx ...\n", addr);

 		/* Copy header so we can blank CRC field for re-calculation */
 		memmove(&header, (char *)addr, sizeof(image_header_t));

 		if (ntohl(hdr->ih_magic) != IH_MAGIC) {
 			puts("Bad Magic Number\n");
 			SHOW_BOOT_PROGRESS(-10);
 			do_reset(cmdtp, flag, argc, argv);
 		}

 		data = (ulong) & header;
 		len = sizeof(image_header_t);

 		checksum = ntohl(hdr->ih_hcrc);
 		hdr->ih_hcrc = 0;

 		if (crc32(0, (uchar *) data, len) != checksum) {
 			puts("Bad Header Checksum\n");
 			SHOW_BOOT_PROGRESS(-11);
 			do_reset(cmdtp, flag, argc, argv);
 		}

 		SHOW_BOOT_PROGRESS(10);

 		print_image_hdr(hdr);

 		data = addr + sizeof(image_header_t);
 		len = ntohl(hdr->ih_size);

 		if (verify) {
 			ulong csum = 0;
 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 			ulong cdata = data, edata = cdata + len;
 #endif				/* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */

 			puts("   Verifying Checksum ... ");

 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)

 			while (cdata < edata) {
 				ulong chunk = edata - cdata;

 				if (chunk > CHUNKSZ)
 					chunk = CHUNKSZ;
 				csum = crc32(csum, (uchar *) cdata, chunk);
 				cdata += chunk;

 				WATCHDOG_RESET();
 			}
 #else				/* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 			csum = crc32(0, (uchar *) data, len);
 #endif				/* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */

 			if (csum != ntohl(hdr->ih_dcrc)) {
 				puts("Bad Data CRC\n");
 				SHOW_BOOT_PROGRESS(-12);
 				do_reset(cmdtp, flag, argc, argv);
 			}
 			puts("OK\n");
 		}

 		SHOW_BOOT_PROGRESS(11);

 		if ((hdr->ih_os != IH_OS_LINUX) ||
 		    (hdr->ih_arch != IH_CPU_M68K) ||
 		    (hdr->ih_type != IH_TYPE_RAMDISK)) {
 			puts("No Linux ColdFire Ramdisk Image\n");
 			SHOW_BOOT_PROGRESS(-13);
 			do_reset(cmdtp, flag, argc, argv);
 		}

 		/*
 		 * Now check if we have a multifile image
 		 */
 	} else if ((hdr->ih_type == IH_TYPE_MULTI) && (len_ptr[1])) {
 		u_long tail = ntohl(len_ptr[0]) % 4;
 		int i;

 		SHOW_BOOT_PROGRESS(13);

 		/* skip kernel length and terminator */
 		data = (ulong) (&len_ptr[2]);
 		/* skip any additional image length fields */
 		for (i = 1; len_ptr[i]; ++i)
 			data += 4;
 		/* add kernel length, and align */
 		data += ntohl(len_ptr[0]);
 		if (tail) {
 			data += 4 - tail;
 		}

 		len = ntohl(len_ptr[1]);

 	} else {
 		/*
 		 * no initrd image
 		 */
 		SHOW_BOOT_PROGRESS(14);

 		len = data = 0;
 	}

 	if (!data) {
 		debug("No initrd\n");
 	}

 	if (data) {
 		if (!initrd_copy_to_ram) {	/* zero-copy ramdisk support */
 			initrd_start = data;
 			initrd_end = initrd_start + len;
 		} else {
 			initrd_start = (ulong) kbd - len;
 			initrd_start &= ~(4096 - 1);	/* align on page */

 			if (initrd_high) {
 				ulong nsp;

 				/*
 				 * the inital ramdisk does not need to be within
 				 * CFG_BOOTMAPSZ as it is not accessed until after
 				 * the mm system is initialised.
 				 *
 				 * do the stack bottom calculation again and see if
 				 * the initrd will fit just below the monitor stack
 				 * bottom without overwriting the area allocated
 				 * above for command line args and board info.
 				 */
 				asm("movel %%a7, %%d0\n"
 				    "movel %%d0, %0\n": "=d"(nsp): :"%d0");

 				nsp -= 2048;	/* just to be sure */
 				nsp &= ~0xF;

 				if (nsp > initrd_high)	/* limit as specified */
 					nsp = initrd_high;

 					nsp -= len;
 				nsp &= ~(4096 - 1);	/* align on page */

 				if (nsp >= sp)
 					initrd_start = nsp;
 			}

 			SHOW_BOOT_PROGRESS(12);

 			debug
 			    ("## initrd at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
 			     data, data + len - 1, len, len);

 			initrd_end = initrd_start + len;
 			printf("   Loading Ramdisk to %08lx, end %08lx ... ",
 			       initrd_start, initrd_end);
 #if defined(CONFIG_HW_WATCHDOG) || defined(CONFIG_WATCHDOG)
 			{
 				size_t l = len;
 				void *to = (void *)initrd_start;
 				void *from = (void *)data;

 				while (l > 0) {
 					size_t tail =
 					    (l > CHUNKSZ) ? CHUNKSZ : l;
 					WATCHDOG_RESET();
 					memmove(to, from, tail);
 					to += tail;
 					from += tail;
 					l -= tail;
 				}
 			}
 #else				/* !(CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG) */
 			memmove((void *)initrd_start, (void *)data, len);
 #endif				/* CONFIG_HW_WATCHDOG || CONFIG_WATCHDOG */
 			puts("OK\n");
 		}
 	} else {
 		initrd_start = 0;
 		initrd_end = 0;
 	}

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

 	SHOW_BOOT_PROGRESS(15);

 	/*
 	 * 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 */
 }
	/*
	* (C) Copyright 2003
	* 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
	*
	*/

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

	DECLARE_GLOBAL_DATA_PTR;

	#define PHYSADDR(x) x

	#define LINUX_MAX_ENVS 256
	#define LINUX_MAX_ARGS 256

	#define CHUNKSZ (64 * 1024)

	#ifdef CONFIG_SHOW_BOOT_PROGRESS
	# include <status_led.h>
	# define SHOW_BOOT_PROGRESS(arg) show_boot_progress(arg)
	#else
	# define SHOW_BOOT_PROGRESS(arg)
	#endif

	extern image_header_t header;

	void do_bootm_linux(cmd_tbl_t * cmdtp, int flag,
	int argc, char *argv[],
	ulong addr, ulong * len_ptr, int verify)
	{
	ulong sp;
	ulong len, checksum;
	ulong initrd_start, initrd_end;
	ulong cmd_start, cmd_end;
	ulong initrd_high;
	ulong data;
	int initrd_copy_to_ram = 1;
	char *cmdline;
	char *s;
	bd_t *kbd;
	void (kernel) (bd_t , ulong, ulong, ulong, ulong);
	image_header_t *hdr = &header;

	if ((s = getenv("initrd_high")) != NULL) {
	/* a value of "no" or a similar string will act like 0,
	* turning the "load high" feature off. This is intentional.
	*/
	initrd_high = simple_strtoul(s, NULL, 16);
	if (initrd_high == ~0)
	initrd_copy_to_ram = 0;
	} else { /* not set, no restrictions to load high */
	initrd_high = ~0;
	}

	#ifdef CONFIG_LOGBUFFER
	kbd = gd->bd;
	/* Prevent initrd from overwriting logbuffer */
	if (initrd_high < (kbd->bi_memsize - LOGBUFF_LEN - LOGBUFF_OVERHEAD))
	initrd_high = kbd->bi_memsize - LOGBUFF_LEN - LOGBUFF_OVERHEAD;
	debug("## Logbuffer at 0x%08lX ", kbd->bi_memsize - LOGBUFF_LEN);
	#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.
	*/
	asm("movel %%a7, %%d0\n"
	"movel %%d0, %0\n": "=d"(sp): :"%d0");

	debug("## Current stack ends at 0x%08lX ", sp);

	sp -= 2048; /* just to be sure */
	if (sp > CFG_BOOTMAPSZ)
	sp = CFG_BOOTMAPSZ;
	sp &= ~0xF;

	debug("=> set upper limit to 0x%08lX\n", sp);

	cmdline = (char *)((sp - CFG_BARGSIZE) & ~0xF);
	kbd = (bd_t *) (((ulong) cmdline - sizeof(bd_t)) & ~0xF);

	if ((s = getenv("bootargs")) == NULL)
	s = "";

	strcpy(cmdline, s);

	cmd_start = (ulong) & cmdline[0];
	cmd_end = cmd_start + strlen(cmdline);

	kbd = (gd->bd);

	#ifdef DEBUG
	printf("## cmdline at 0x%08lX ... 0x%08lX\n", cmd_start, cmd_end);

	do_bdinfo(NULL, 0, 0, NULL);
	#endif

	if ((s = getenv("clocks_in_mhz")) != NULL) {
	/* convert all clock information to MHz */
	kbd->bi_intfreq /= 1000000L;
	kbd->bi_busfreq /= 1000000L;
	}

	kernel =
	(void ()(bd_t , ulong, ulong, ulong, ulong))ntohl(hdr->ih_ep);

	/*
	* Check if there is an initrd image
	*/

	if (argc >= 3) {
	debug("Not skipping initrd\n");
	SHOW_BOOT_PROGRESS(9);

	addr = simple_strtoul(argv[2], NULL, 16);

	printf("## Loading RAMDisk Image at %08lx ...\n", addr);

	/* Copy header so we can blank CRC field for re-calculation */
	memmove(&header, (char *)addr, sizeof(image_header_t));

	if (ntohl(hdr->ih_magic) != IH_MAGIC) {
	puts("Bad Magic Number\n");
	SHOW_BOOT_PROGRESS(-10);
	do_reset(cmdtp, flag, argc, argv);
	}

	data = (ulong) & header;
	len = sizeof(image_header_t);

	checksum = ntohl(hdr->ih_hcrc);
	hdr->ih_hcrc = 0;

	if (crc32(0, (uchar *) data, len) != checksum) {
	puts("Bad Header Checksum\n");
	SHOW_BOOT_PROGRESS(-11);
	do_reset(cmdtp, flag, argc, argv);
	}

	SHOW_BOOT_PROGRESS(10);

	print_image_hdr(hdr);

	data = addr + sizeof(image_header_t);
	len = ntohl(hdr->ih_size);

	if (verify) {
	ulong csum = 0;
	#if defined(CONFIG_HW_WATCHDOG) \|\| defined(CONFIG_WATCHDOG)
	ulong cdata = data, edata = cdata + len;
	#endif /* CONFIG_HW_WATCHDOG \|\| CONFIG_WATCHDOG */

	puts(" Verifying Checksum ... ");

	#if defined(CONFIG_HW_WATCHDOG) \|\| defined(CONFIG_WATCHDOG)

	while (cdata < edata) {
	ulong chunk = edata - cdata;

	if (chunk > CHUNKSZ)
	chunk = CHUNKSZ;
	csum = crc32(csum, (uchar *) cdata, chunk);
	cdata += chunk;

	WATCHDOG_RESET();
	}
	#else /* !(CONFIG_HW_WATCHDOG \|\| CONFIG_WATCHDOG) */
	csum = crc32(0, (uchar *) data, len);
	#endif /* CONFIG_HW_WATCHDOG \|\| CONFIG_WATCHDOG */

	if (csum != ntohl(hdr->ih_dcrc)) {
	puts("Bad Data CRC\n");
	SHOW_BOOT_PROGRESS(-12);
	do_reset(cmdtp, flag, argc, argv);
	}
	puts("OK\n");
	}

	SHOW_BOOT_PROGRESS(11);

	if ((hdr->ih_os != IH_OS_LINUX) \|\|
	(hdr->ih_arch != IH_CPU_M68K) \|\|
	(hdr->ih_type != IH_TYPE_RAMDISK)) {
	puts("No Linux ColdFire Ramdisk Image\n");
	SHOW_BOOT_PROGRESS(-13);
	do_reset(cmdtp, flag, argc, argv);
	}

	/*
	* Now check if we have a multifile image
	*/
	} else if ((hdr->ih_type == IH_TYPE_MULTI) && (len_ptr[1])) {
	u_long tail = ntohl(len_ptr[0]) % 4;
	int i;

	SHOW_BOOT_PROGRESS(13);

	/* skip kernel length and terminator */
	data = (ulong) (&len_ptr[2]);
	/* skip any additional image length fields */
	for (i = 1; len_ptr[i]; ++i)
	data += 4;
	/* add kernel length, and align */
	data += ntohl(len_ptr[0]);
	if (tail) {
	data += 4 - tail;
	}

	len = ntohl(len_ptr[1]);

	} else {
	/*
	* no initrd image
	*/
	SHOW_BOOT_PROGRESS(14);

	len = data = 0;
	}

	if (!data) {
	debug("No initrd\n");
	}

	if (data) {
	if (!initrd_copy_to_ram) { /* zero-copy ramdisk support */
	initrd_start = data;
	initrd_end = initrd_start + len;
	} else {
	initrd_start = (ulong) kbd - len;
	initrd_start &= ~(4096 - 1); /* align on page */

	if (initrd_high) {
	ulong nsp;

	/*
	* the inital ramdisk does not need to be within
	* CFG_BOOTMAPSZ as it is not accessed until after
	* the mm system is initialised.
	*
	* do the stack bottom calculation again and see if
	* the initrd will fit just below the monitor stack
	* bottom without overwriting the area allocated
	* above for command line args and board info.
	*/
	asm("movel %%a7, %%d0\n"
	"movel %%d0, %0\n": "=d"(nsp): :"%d0");

	nsp -= 2048; /* just to be sure */
	nsp &= ~0xF;

	if (nsp > initrd_high) /* limit as specified */
	nsp = initrd_high;

	nsp -= len;
	nsp &= ~(4096 - 1); /* align on page */

	if (nsp >= sp)
	initrd_start = nsp;
	}

	SHOW_BOOT_PROGRESS(12);

	debug
	("## initrd at 0x%08lX ... 0x%08lX (len=%ld=0x%lX)\n",
	data, data + len - 1, len, len);

	initrd_end = initrd_start + len;
	printf(" Loading Ramdisk to %08lx, end %08lx ... ",
	initrd_start, initrd_end);
	#if defined(CONFIG_HW_WATCHDOG) \|\| defined(CONFIG_WATCHDOG)
	{
	size_t l = len;
	void to = (void )initrd_start;
	void from = (void )data;

	while (l > 0) {
	size_t tail =
	(l > CHUNKSZ) ? CHUNKSZ : l;
	WATCHDOG_RESET();
	memmove(to, from, tail);
	to += tail;
	from += tail;
	l -= tail;
	}
	}
	#else /* !(CONFIG_HW_WATCHDOG \|\| CONFIG_WATCHDOG) */
	memmove((void )initrd_start, (void )data, len);
	#endif /* CONFIG_HW_WATCHDOG \|\| CONFIG_WATCHDOG */
	puts("OK\n");
	}
	} else {
	initrd_start = 0;
	initrd_end = 0;
	}

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

	SHOW_BOOT_PROGRESS(15);

	/*
	* 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 */
	}