[people/ms/u-boot.git] / arch / mips / lib / bootm.c

/*
 * (C) Copyright 2003
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <image.h>
#include <fdt_support.h>
#include <asm/addrspace.h>

DECLARE_GLOBAL_DATA_PTR;

#define	LINUX_MAX_ENVS		256
#define	LINUX_MAX_ARGS		256

#if defined(CONFIG_MALTA)
#define mips_boot_malta		1
#else
#define mips_boot_malta		0
#endif

#if defined(CONFIG_MIPS_BOOT_CMDLINE_LEGACY)
#define mips_boot_cmdline_legacy	1
#else
#define mips_boot_cmdline_legacy	0
#endif

#if defined(CONFIG_MIPS_BOOT_ENV_LEGACY)
#define mips_boot_env_legacy	1
#else
#define mips_boot_env_legacy	0
#endif

static int linux_argc;
static char **linux_argv;
static char *linux_argp;

static char **linux_env;
static char *linux_env_p;
static int linux_env_idx;

static ulong arch_get_sp(void)
{
	ulong ret;

	__asm__ __volatile__("move %0, $sp" : "=r"(ret) : );

	return ret;
}

void arch_lmb_reserve(struct lmb *lmb)
{
	ulong sp;

	sp = arch_get_sp();
	debug("## Current stack ends at 0x%08lx\n", sp);

	/* adjust sp by 4K to be safe */
	sp -= 4096;
	lmb_reserve(lmb, sp, CONFIG_SYS_SDRAM_BASE + gd->ram_size - sp);
}

static int boot_setup_linux(bootm_headers_t *images)
{
	int ret;
	ulong rd_len;

	rd_len = images->rd_end - images->rd_start;
	ret = boot_ramdisk_high(&images->lmb, images->rd_start,
		rd_len, &images->initrd_start, &images->initrd_end);
	if (ret)
		return ret;

#if defined(CONFIG_MIPS_BOOT_FDT) && defined(CONFIG_OF_LIBFDT)
	if (images->ft_len) {
		boot_fdt_add_mem_rsv_regions(&images->lmb, images->ft_addr);

		ret = boot_relocate_fdt(&images->lmb, &images->ft_addr,
			&images->ft_len);
		if (ret)
			return ret;
	}
#endif

	return 0;
}

static void boot_setup_fdt(bootm_headers_t *images)
{
#if defined(CONFIG_MIPS_BOOT_FDT) && defined(CONFIG_OF_LIBFDT)
	u64 mem_start = 0;
	u64 mem_size = gd->ram_size;

	debug("## setup FDT\n");

	fdt_chosen(images->ft_addr);
	fdt_fixup_memory_banks(images->ft_addr, &mem_start, &mem_size, 1);
	fdt_fixup_ethernet(images->ft_addr);
	fdt_initrd(images->ft_addr, images->initrd_start, images->initrd_end);

#if defined(CONFIG_OF_BOARD_SETUP)
	ft_board_setup(images->ft_addr, gd->bd);
#endif
#endif
}

static void linux_cmdline_init(void)
{
	linux_argc = 1;
	linux_argv = (char **)UNCACHED_SDRAM(gd->bd->bi_boot_params);
	linux_argv[0] = 0;
	linux_argp = (char *)(linux_argv + LINUX_MAX_ARGS);
}

static void linux_cmdline_set(const char *value, size_t len)
{
	linux_argv[linux_argc] = linux_argp;
	memcpy(linux_argp, value, len);
	linux_argp[len] = 0;

	linux_argp += len + 1;
	linux_argc++;
}

static void linux_cmdline_dump(void)
{
	int i;

	debug("## cmdline argv at 0x%p, argp at 0x%p\n",
	      linux_argv, linux_argp);

	for (i = 1; i < linux_argc; i++)
		debug("   arg %03d: %s\n", i, linux_argv[i]);
}

static void linux_cmdline_legacy(bootm_headers_t *images)
{
	const char *bootargs, *next, *quote;

	linux_cmdline_init();

	bootargs = getenv("bootargs");
	if (!bootargs)
		return;

	next = bootargs;

	while (bootargs && *bootargs && linux_argc < LINUX_MAX_ARGS) {
		quote = strchr(bootargs, '"');
		next = strchr(bootargs, ' ');

		while (next && quote && quote < next) {
			/*
			 * we found a left quote before the next blank
			 * now we have to find the matching right quote
			 */
			next = strchr(quote + 1, '"');
			if (next) {
				quote = strchr(next + 1, '"');
				next = strchr(next + 1, ' ');
			}
		}

		if (!next)
			next = bootargs + strlen(bootargs);

		linux_cmdline_set(bootargs, next - bootargs);

		if (*next)
			next++;

		bootargs = next;
	}
}

static void linux_cmdline_append(bootm_headers_t *images)
{
	char buf[24];
	ulong mem, rd_start, rd_size;

	/* append mem */
	mem = gd->ram_size >> 20;
	sprintf(buf, "mem=%luM", mem);
	linux_cmdline_set(buf, strlen(buf));

	/* append rd_start and rd_size */
	rd_start = images->initrd_start;
	rd_size = images->initrd_end - images->initrd_start;

	if (rd_size) {
		sprintf(buf, "rd_start=0x%08lX", rd_start);
		linux_cmdline_set(buf, strlen(buf));
		sprintf(buf, "rd_size=0x%lX", rd_size);
		linux_cmdline_set(buf, strlen(buf));
	}
}

static void boot_cmdline_linux(bootm_headers_t *images)
{
	if (mips_boot_cmdline_legacy && !images->ft_len) {
		linux_cmdline_legacy(images);

		if (!mips_boot_env_legacy)
			linux_cmdline_append(images);

		linux_cmdline_dump();
	}
}

static void linux_env_init(void)
{
	linux_env = (char **)(((ulong) linux_argp + 15) & ~15);
	linux_env[0] = 0;
	linux_env_p = (char *)(linux_env + LINUX_MAX_ENVS);
	linux_env_idx = 0;
}

static void linux_env_set(const char *env_name, const char *env_val)
{
	if (linux_env_idx < LINUX_MAX_ENVS - 1) {
		linux_env[linux_env_idx] = linux_env_p;

		strcpy(linux_env_p, env_name);
		linux_env_p += strlen(env_name);

		if (mips_boot_malta) {
			linux_env_p++;
			linux_env[++linux_env_idx] = linux_env_p;
		} else {
			*linux_env_p++ = '=';
		}

		strcpy(linux_env_p, env_val);
		linux_env_p += strlen(env_val);

		linux_env_p++;
		linux_env[++linux_env_idx] = 0;
	}
}

static void linux_env_legacy(bootm_headers_t *images)
{
	char env_buf[12];
	const char *cp;
	ulong rd_start, rd_size;

#ifdef CONFIG_MEMSIZE_IN_BYTES
	sprintf(env_buf, "%lu", (ulong)gd->ram_size);
	debug("## Giving linux memsize in bytes, %lu\n", (ulong)gd->ram_size);
#else
	sprintf(env_buf, "%lu", (ulong)(gd->ram_size >> 20));
	debug("## Giving linux memsize in MB, %lu\n",
	      (ulong)(gd->ram_size >> 20));
#endif /* CONFIG_MEMSIZE_IN_BYTES */

	rd_start = UNCACHED_SDRAM(images->initrd_start);
	rd_size = images->initrd_end - images->initrd_start;

	linux_env_init();

	linux_env_set("memsize", env_buf);

	sprintf(env_buf, "0x%08lX", rd_start);
	linux_env_set("initrd_start", env_buf);

	sprintf(env_buf, "0x%lX", rd_size);
	linux_env_set("initrd_size", env_buf);

	sprintf(env_buf, "0x%08X", (uint) (gd->bd->bi_flashstart));
	linux_env_set("flash_start", env_buf);

	sprintf(env_buf, "0x%X", (uint) (gd->bd->bi_flashsize));
	linux_env_set("flash_size", env_buf);

	cp = getenv("ethaddr");
	if (cp)
		linux_env_set("ethaddr", cp);

	cp = getenv("eth1addr");
	if (cp)
		linux_env_set("eth1addr", cp);

	if (mips_boot_malta) {
		sprintf(env_buf, "%un8r", gd->baudrate);
		linux_env_set("modetty0", env_buf);
	}
}

static void boot_prep_linux(bootm_headers_t *images)
{
	if (mips_boot_env_legacy && !images->ft_len)
		linux_env_legacy(images);

	if (images->ft_len)
		boot_setup_fdt(images);
}

static void boot_jump_linux(bootm_headers_t *images)
{
	typedef void __noreturn (*kernel_entry_t)(int, ulong, ulong, ulong);
	kernel_entry_t kernel = (kernel_entry_t) images->ep;
	ulong linux_extra = 0;

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

	bootstage_mark(BOOTSTAGE_ID_RUN_OS);

	if (mips_boot_malta)
		linux_extra = gd->ram_size;

#ifdef CONFIG_BOOTSTAGE_FDT
	bootstage_fdt_add_report();
#endif
#ifdef CONFIG_BOOTSTAGE_REPORT
	bootstage_report();
#endif

	if (images->ft_len)
		kernel(-2, (ulong)images->ft_addr, 0, 0);
	else
		kernel(linux_argc, (ulong)linux_argv, (ulong)linux_env,
			linux_extra);
}

int do_bootm_linux(int flag, int argc, char * const argv[],
			bootm_headers_t *images)
{
	int ret;

	/* No need for those on MIPS */
	if (flag & BOOTM_STATE_OS_BD_T)
		return -1;

	if (flag & BOOTM_STATE_OS_CMDLINE) {
		boot_cmdline_linux(images);
		return 0;
	}

	if (flag & BOOTM_STATE_OS_PREP) {
		boot_prep_linux(images);
		return 0;
	}

	if (flag & BOOTM_STATE_OS_GO) {
		boot_jump_linux(images);
		return 0;
	}

	ret = boot_setup_linux(images);
	if (ret)
		return ret;

	boot_cmdline_linux(images);
	boot_prep_linux(images);
	boot_jump_linux(images);

	/* does not return */
	return 1;
}
Commit	Line	Data
c021880a WD	1	/*
	2	* (C) Copyright 2003
	3	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	4	*
1a459660	5	* SPDX-License-Identifier: GPL-2.0+
c021880a WD	6	*/
	7
	8	#include <common.h>
c021880a	9	#include <image.h>
5002d8cc	10	#include <fdt_support.h>
c021880a WD	11	#include <asm/addrspace.h>
c021880a WD	12
d87080b7 WD	13	DECLARE_GLOBAL_DATA_PTR;
d87080b7 WD	14
c021880a WD	15	#define LINUX_MAX_ENVS 256
	16	#define LINUX_MAX_ARGS 256
	17
7a9d109b PB	18	#if defined(CONFIG_MALTA)
7a9d109b PB	19	#define mips_boot_malta 1
b87493f4	20	#else
7a9d109b	21	#define mips_boot_malta 0
b87493f4 DS	22	#endif
b87493f4 DS	23
25fc664f DS	24	#if defined(CONFIG_MIPS_BOOT_CMDLINE_LEGACY)
	25	#define mips_boot_cmdline_legacy 1
	26	#else
	27	#define mips_boot_cmdline_legacy 0
	28	#endif
	29
ca65e585 DS	30	#if defined(CONFIG_MIPS_BOOT_ENV_LEGACY)
	31	#define mips_boot_env_legacy 1
	32	#else
	33	#define mips_boot_env_legacy 0
	34	#endif
	35
e51a6b7a DS	36	static int linux_argc;
e51a6b7a DS	37	static char **linux_argv;
59e8cbdb	38	static char *linux_argp;
c021880a	39
e51a6b7a DS	40	static char **linux_env;
	41	static char *linux_env_p;
	42	static int linux_env_idx;
c021880a	43
f66cc1e3 DS	44	static ulong arch_get_sp(void)
	45	{
	46	ulong ret;
	47
	48	__asm__ __volatile__("move %0, $sp" : "=r"(ret) : );
	49
	50	return ret;
	51	}
	52
	53	void arch_lmb_reserve(struct lmb *lmb)
	54	{
	55	ulong sp;
	56
	57	sp = arch_get_sp();
	58	debug("## Current stack ends at 0x%08lx\n", sp);
	59
	60	/* adjust sp by 4K to be safe */
	61	sp -= 4096;
	62	lmb_reserve(lmb, sp, CONFIG_SYS_SDRAM_BASE + gd->ram_size - sp);
	63	}
	64
c9639421 DS	65	static int boot_setup_linux(bootm_headers_t *images)
	66	{
	67	int ret;
	68	ulong rd_len;
	69
	70	rd_len = images->rd_end - images->rd_start;
	71	ret = boot_ramdisk_high(&images->lmb, images->rd_start,
	72	rd_len, &images->initrd_start, &images->initrd_end);
	73	if (ret)
	74	return ret;
	75
5002d8cc DS	76	#if defined(CONFIG_MIPS_BOOT_FDT) && defined(CONFIG_OF_LIBFDT)
	77	if (images->ft_len) {
	78	boot_fdt_add_mem_rsv_regions(&images->lmb, images->ft_addr);
	79
	80	ret = boot_relocate_fdt(&images->lmb, &images->ft_addr,
	81	&images->ft_len);
	82	if (ret)
	83	return ret;
	84	}
	85	#endif
	86
c9639421 DS	87	return 0;
	88	}
	89
5002d8cc DS	90	static void boot_setup_fdt(bootm_headers_t *images)
	91	{
	92	#if defined(CONFIG_MIPS_BOOT_FDT) && defined(CONFIG_OF_LIBFDT)
	93	u64 mem_start = 0;
	94	u64 mem_size = gd->ram_size;
	95
	96	debug("## setup FDT\n");
	97
4adcb238	98	fdt_chosen(images->ft_addr);
5002d8cc DS	99	fdt_fixup_memory_banks(images->ft_addr, &mem_start, &mem_size, 1);
5002d8cc DS	100	fdt_fixup_ethernet(images->ft_addr);
4adcb238	101	fdt_initrd(images->ft_addr, images->initrd_start, images->initrd_end);
5002d8cc DS	102
	103	#if defined(CONFIG_OF_BOARD_SETUP)
	104	ft_board_setup(images->ft_addr, gd->bd);
	105	#endif
	106	#endif
	107	}
	108
59e8cbdb DS	109	static void linux_cmdline_init(void)
	110	{
	111	linux_argc = 1;
	112	linux_argv = (char **)UNCACHED_SDRAM(gd->bd->bi_boot_params);
	113	linux_argv[0] = 0;
	114	linux_argp = (char *)(linux_argv + LINUX_MAX_ARGS);
	115	}
	116
	117	static void linux_cmdline_set(const char *value, size_t len)
	118	{
	119	linux_argv[linux_argc] = linux_argp;
	120	memcpy(linux_argp, value, len);
	121	linux_argp[len] = 0;
	122
	123	linux_argp += len + 1;
	124	linux_argc++;
	125	}
	126
	127	static void linux_cmdline_dump(void)
	128	{
	129	int i;
	130
	131	debug("## cmdline argv at 0x%p, argp at 0x%p\n",
	132	linux_argv, linux_argp);
	133
	134	for (i = 1; i < linux_argc; i++)
	135	debug(" arg %03d: %s\n", i, linux_argv[i]);
	136	}
	137
25fc664f	138	static void linux_cmdline_legacy(bootm_headers_t *images)
59e8cbdb DS	139	{
	140	const char bootargs, next, *quote;
	141
	142	linux_cmdline_init();
	143
	144	bootargs = getenv("bootargs");
	145	if (!bootargs)
	146	return;
	147
	148	next = bootargs;
	149
	150	while (bootargs && *bootargs && linux_argc < LINUX_MAX_ARGS) {
	151	quote = strchr(bootargs, '"');
	152	next = strchr(bootargs, ' ');
	153
	154	while (next && quote && quote < next) {
	155	/*
	156	* we found a left quote before the next blank
	157	* now we have to find the matching right quote
	158	*/
	159	next = strchr(quote + 1, '"');
	160	if (next) {
	161	quote = strchr(next + 1, '"');
	162	next = strchr(next + 1, ' ');
	163	}
	164	}
	165
	166	if (!next)
	167	next = bootargs + strlen(bootargs);
	168
	169	linux_cmdline_set(bootargs, next - bootargs);
	170
	171	if (*next)
	172	next++;
	173
	174	bootargs = next;
	175	}
25fc664f	176	}
59e8cbdb	177
8cec725a DS	178	static void linux_cmdline_append(bootm_headers_t *images)
	179	{
	180	char buf[24];
	181	ulong mem, rd_start, rd_size;
	182
	183	/* append mem */
	184	mem = gd->ram_size >> 20;
	185	sprintf(buf, "mem=%luM", mem);
	186	linux_cmdline_set(buf, strlen(buf));
	187
	188	/* append rd_start and rd_size */
	189	rd_start = images->initrd_start;
	190	rd_size = images->initrd_end - images->initrd_start;
	191
	192	if (rd_size) {
	193	sprintf(buf, "rd_start=0x%08lX", rd_start);
	194	linux_cmdline_set(buf, strlen(buf));
	195	sprintf(buf, "rd_size=0x%lX", rd_size);
	196	linux_cmdline_set(buf, strlen(buf));
	197	}
	198	}
	199
25fc664f DS	200	static void boot_cmdline_linux(bootm_headers_t *images)
25fc664f DS	201	{
5002d8cc	202	if (mips_boot_cmdline_legacy && !images->ft_len) {
25fc664f	203	linux_cmdline_legacy(images);
8cec725a DS	204
	205	if (!mips_boot_env_legacy)
	206	linux_cmdline_append(images);
	207
25fc664f DS	208	linux_cmdline_dump();
25fc664f DS	209	}
59e8cbdb DS	210	}
59e8cbdb DS	211
15f8aa90 DS	212	static void linux_env_init(void)
	213	{
	214	linux_env = (char **)(((ulong) linux_argp + 15) & ~15);
	215	linux_env[0] = 0;
	216	linux_env_p = (char *)(linux_env + LINUX_MAX_ENVS);
	217	linux_env_idx = 0;
	218	}
	219
	220	static void linux_env_set(const char env_name, const char env_val)
	221	{
	222	if (linux_env_idx < LINUX_MAX_ENVS - 1) {
	223	linux_env[linux_env_idx] = linux_env_p;
	224
	225	strcpy(linux_env_p, env_name);
	226	linux_env_p += strlen(env_name);
	227
7a9d109b	228	if (mips_boot_malta) {
b87493f4 DS	229	linux_env_p++;
	230	linux_env[++linux_env_idx] = linux_env_p;
	231	} else {
	232	*linux_env_p++ = '=';
	233	}
15f8aa90 DS	234
	235	strcpy(linux_env_p, env_val);
	236	linux_env_p += strlen(env_val);
	237
	238	linux_env_p++;
	239	linux_env[++linux_env_idx] = 0;
	240	}
	241	}
	242
ca65e585	243	static void linux_env_legacy(bootm_headers_t *images)
c021880a	244	{
e51a6b7a	245	char env_buf[12];
15f8aa90	246	const char *cp;
6c154552	247	ulong rd_start, rd_size;
5da627a4 WD	248
5da627a4 WD	249	#ifdef CONFIG_MEMSIZE_IN_BYTES
e51a6b7a DS	250	sprintf(env_buf, "%lu", (ulong)gd->ram_size);
e51a6b7a DS	251	debug("## Giving linux memsize in bytes, %lu\n", (ulong)gd->ram_size);
5da627a4	252	#else
e51a6b7a DS	253	sprintf(env_buf, "%lu", (ulong)(gd->ram_size >> 20));
e51a6b7a DS	254	debug("## Giving linux memsize in MB, %lu\n",
45bde489	255	(ulong)(gd->ram_size >> 20));
5da627a4	256	#endif /* CONFIG_MEMSIZE_IN_BYTES */
c021880a	257
6c154552 DS	258	rd_start = UNCACHED_SDRAM(images->initrd_start);
	259	rd_size = images->initrd_end - images->initrd_start;
	260
15f8aa90 DS	261	linux_env_init();
15f8aa90 DS	262
e51a6b7a	263	linux_env_set("memsize", env_buf);
c021880a	264
6c154552	265	sprintf(env_buf, "0x%08lX", rd_start);
e51a6b7a	266	linux_env_set("initrd_start", env_buf);
c021880a	267
6c154552	268	sprintf(env_buf, "0x%lX", rd_size);
e51a6b7a	269	linux_env_set("initrd_size", env_buf);
c021880a	270
e51a6b7a DS	271	sprintf(env_buf, "0x%08X", (uint) (gd->bd->bi_flashstart));
e51a6b7a DS	272	linux_env_set("flash_start", env_buf);
c021880a	273
e51a6b7a DS	274	sprintf(env_buf, "0x%X", (uint) (gd->bd->bi_flashsize));
e51a6b7a DS	275	linux_env_set("flash_size", env_buf);
c021880a	276
e7c37452	277	cp = getenv("ethaddr");
e51a6b7a	278	if (cp)
e7c37452	279	linux_env_set("ethaddr", cp);
e7c37452 JM	280
e7c37452 JM	281	cp = getenv("eth1addr");
e51a6b7a	282	if (cp)
e7c37452	283	linux_env_set("eth1addr", cp);
b87493f4	284
d18d49d7 PB	285	if (mips_boot_malta) {
	286	sprintf(env_buf, "%un8r", gd->baudrate);
	287	linux_env_set("modetty0", env_buf);
	288	}
0ea7213f GJ	289	}
0ea7213f GJ	290
ca65e585 DS	291	static void boot_prep_linux(bootm_headers_t *images)
ca65e585 DS	292	{
5002d8cc	293	if (mips_boot_env_legacy && !images->ft_len)
ca65e585	294	linux_env_legacy(images);
5002d8cc DS	295
	296	if (images->ft_len)
	297	boot_setup_fdt(images);
ca65e585 DS	298	}
ca65e585 DS	299
0ea7213f GJ	300	static void boot_jump_linux(bootm_headers_t *images)
0ea7213f GJ	301	{
c4b37847 DS	302	typedef void __noreturn (*kernel_entry_t)(int, ulong, ulong, ulong);
c4b37847 DS	303	kernel_entry_t kernel = (kernel_entry_t) images->ep;
b87493f4	304	ulong linux_extra = 0;
0ea7213f	305
c4b37847	306	debug("## Transferring control to Linux (at address %p) ...\n", kernel);
0ea7213f GJ	307
	308	bootstage_mark(BOOTSTAGE_ID_RUN_OS);
	309
7a9d109b	310	if (mips_boot_malta)
b87493f4 DS	311	linux_extra = gd->ram_size;
b87493f4 DS	312
e13a50b3 DS	313	#ifdef CONFIG_BOOTSTAGE_FDT
	314	bootstage_fdt_add_report();
	315	#endif
	316	#ifdef CONFIG_BOOTSTAGE_REPORT
	317	bootstage_report();
	318	#endif
0ea7213f	319
90b1c9fa DS	320	if (images->ft_len)
	321	kernel(-2, (ulong)images->ft_addr, 0, 0);
	322	else
	323	kernel(linux_argc, (ulong)linux_argv, (ulong)linux_env,
	324	linux_extra);
0ea7213f GJ	325	}
	326
	327	int do_bootm_linux(int flag, int argc, char * const argv[],
	328	bootm_headers_t *images)
	329	{
c9639421 DS	330	int ret;
c9639421 DS	331
9c170e2e	332	/* No need for those on MIPS */
59e8cbdb	333	if (flag & BOOTM_STATE_OS_BD_T)
9c170e2e GJ	334	return -1;
9c170e2e GJ	335
59e8cbdb DS	336	if (flag & BOOTM_STATE_OS_CMDLINE) {
	337	boot_cmdline_linux(images);
	338	return 0;
	339	}
	340
9c170e2e GJ	341	if (flag & BOOTM_STATE_OS_PREP) {
	342	boot_prep_linux(images);
	343	return 0;
	344	}
	345
	346	if (flag & BOOTM_STATE_OS_GO) {
	347	boot_jump_linux(images);
	348	return 0;
	349	}
e7c37452	350
c9639421 DS	351	ret = boot_setup_linux(images);
	352	if (ret)
	353	return ret;
	354
59e8cbdb	355	boot_cmdline_linux(images);
0ea7213f	356	boot_prep_linux(images);
e08634c7	357	boot_jump_linux(images);
c021880a	358
cd7c596e	359	/* does not return */
40d7e99d	360	return 1;
c021880a	361	}