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

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

#include <common.h>
#include <bootstage.h>
#include <env.h>
#include <image.h>
#include <fdt_support.h>
#include <lmb.h>
#include <asm/addrspace.h>
#include <asm/io.h>

DECLARE_GLOBAL_DATA_PTR;

#define	LINUX_MAX_ENVS		256
#define	LINUX_MAX_ARGS		256

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, gd->ram_top - sp);
}

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 = env_get("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 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 (CONFIG_IS_ENABLED(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;

	if (CONFIG_IS_ENABLED(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));
	}

	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 = env_get("ethaddr");
	if (cp)
		linux_env_set("ethaddr", cp);

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

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

static int boot_reloc_fdt(bootm_headers_t *images)
{
	/*
	 * In case of legacy uImage's, relocation of FDT is already done
	 * by do_bootm_states() and should not repeated in 'bootm prep'.
	 */
	if (images->state & BOOTM_STATE_FDT) {
		debug("## FDT already relocated\n");
		return 0;
	}

#if CONFIG_IS_ENABLED(MIPS_BOOT_FDT) && CONFIG_IS_ENABLED(OF_LIBFDT)
	boot_fdt_add_mem_rsv_regions(&images->lmb, images->ft_addr);
	return boot_relocate_fdt(&images->lmb, &images->ft_addr,
		&images->ft_len);
#else
	return 0;
#endif
}

#if CONFIG_IS_ENABLED(MIPS_BOOT_FDT) && CONFIG_IS_ENABLED(OF_LIBFDT)
int arch_fixup_fdt(void *blob)
{
	u64 mem_start = virt_to_phys((void *)gd->bd->bi_memstart);
	u64 mem_size = gd->ram_size;

	return fdt_fixup_memory_banks(blob, &mem_start, &mem_size, 1);
}
#endif

static int boot_setup_fdt(bootm_headers_t *images)
{
	images->initrd_start = virt_to_phys((void *)images->initrd_start);
	images->initrd_end = virt_to_phys((void *)images->initrd_end);
	return image_setup_libfdt(images, images->ft_addr, images->ft_len,
		&images->lmb);
}

static void boot_prep_linux(bootm_headers_t *images)
{
	if (CONFIG_IS_ENABLED(MIPS_BOOT_FDT) && images->ft_len) {
		boot_reloc_fdt(images);
		boot_setup_fdt(images);
	} else {
		if (CONFIG_IS_ENABLED(MIPS_BOOT_CMDLINE_LEGACY)) {
			linux_cmdline_legacy(images);

			if (!CONFIG_IS_ENABLED(MIPS_BOOT_ENV_LEGACY))
				linux_cmdline_append(images);

			linux_cmdline_dump();
		}

		if (CONFIG_IS_ENABLED(MIPS_BOOT_ENV_LEGACY))
			linux_env_legacy(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 (CONFIG_IS_ENABLED(MALTA))
		linux_extra = gd->ram_size;

#if CONFIG_IS_ENABLED(BOOTSTAGE_FDT)
	bootstage_fdt_add_report();
#endif
#if CONFIG_IS_ENABLED(BOOTSTAGE_REPORT)
	bootstage_report();
#endif

	if (CONFIG_IS_ENABLED(RESTORE_EXCEPTION_VECTOR_BASE))
		trap_restore();

	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)
{
	/* No need for those on MIPS */
	if (flag & BOOTM_STATE_OS_BD_T)
		return -1;

	/*
	 * Cmdline init has been moved to 'bootm prep' because it has to be
	 * done after relocation of ramdisk to always pass correct values
	 * for rd_start and rd_size to Linux kernel.
	 */
	if (flag & BOOTM_STATE_OS_CMDLINE)
		return 0;

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

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

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