xref: /netbsd-src/sys/arch/ews4800mips/stand/common/loader.c (revision 4d29d221e2ecd8020e5dc38a6f18275f7e5f3386)
1*4d29d221Sandvar /*	$NetBSD: loader.c,v 1.6 2023/09/09 21:04:26 andvar Exp $	*/
204faabf0Stsutsui 
304faabf0Stsutsui /*-
404faabf0Stsutsui  * Copyright (c) 2004 The NetBSD Foundation, Inc.
504faabf0Stsutsui  * All rights reserved.
604faabf0Stsutsui  *
704faabf0Stsutsui  * This code is derived from software contributed to The NetBSD Foundation
804faabf0Stsutsui  * by UCHIYAMA Yasushi.
904faabf0Stsutsui  *
1004faabf0Stsutsui  * Redistribution and use in source and binary forms, with or without
1104faabf0Stsutsui  * modification, are permitted provided that the following conditions
1204faabf0Stsutsui  * are met:
1304faabf0Stsutsui  * 1. Redistributions of source code must retain the above copyright
1404faabf0Stsutsui  *    notice, this list of conditions and the following disclaimer.
1504faabf0Stsutsui  * 2. Redistributions in binary form must reproduce the above copyright
1604faabf0Stsutsui  *    notice, this list of conditions and the following disclaimer in the
1704faabf0Stsutsui  *    documentation and/or other materials provided with the distribution.
1804faabf0Stsutsui  *
1904faabf0Stsutsui  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
2004faabf0Stsutsui  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
2104faabf0Stsutsui  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
2204faabf0Stsutsui  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
2304faabf0Stsutsui  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
2404faabf0Stsutsui  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
2504faabf0Stsutsui  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
2604faabf0Stsutsui  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
2704faabf0Stsutsui  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
2804faabf0Stsutsui  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
2904faabf0Stsutsui  * POSSIBILITY OF SUCH DAMAGE.
3004faabf0Stsutsui  */
3104faabf0Stsutsui 
3204faabf0Stsutsui #include <lib/libsa/stand.h>
3304faabf0Stsutsui #include <lib/libkern/libkern.h>
3404faabf0Stsutsui 
3504faabf0Stsutsui #include <lib/libsa/loadfile.h>
3604faabf0Stsutsui 
3704faabf0Stsutsui #include <machine/bootinfo.h>
3804faabf0Stsutsui 
3904faabf0Stsutsui #include "console.h"
4004faabf0Stsutsui #include "cmd.h"
4104faabf0Stsutsui #include "local.h"
4204faabf0Stsutsui 
4304faabf0Stsutsui void r4k_pdcache_wbinv_all(uint32_t);
4404faabf0Stsutsui void r4k_sdcache_wbinv_all(uint32_t, int);
4504faabf0Stsutsui void boot_usage(void);
4604faabf0Stsutsui 
4704faabf0Stsutsui int
cmd_jump(int argc,char * argp[],int interactive)4804faabf0Stsutsui cmd_jump(int argc, char *argp[], int interactive)
4904faabf0Stsutsui {
5004faabf0Stsutsui 	uint32_t addr;
5104faabf0Stsutsui 	uint32_t sp;
5204faabf0Stsutsui 
5304faabf0Stsutsui 	if (argc < 2) {
5404faabf0Stsutsui 		printf("jump jump_addr [stack_addr]\n");
5504faabf0Stsutsui 		return 1;
5604faabf0Stsutsui 	}
5704faabf0Stsutsui 	addr = strtoul(argp[1], 0, 0);
5804faabf0Stsutsui 	if (argc == 3)
5904faabf0Stsutsui 		sp = strtoul(argp[2], 0, 0);
6004faabf0Stsutsui 	else
6104faabf0Stsutsui 		__asm volatile("move %0, $29" : "=r"(sp)); /* current stack */
6204faabf0Stsutsui 
6361373eecStsutsui 	printf("jump to 0x%08x. sp=0x%08x Y/N\n", addr, sp);
6404faabf0Stsutsui 	if (prompt_yesno(interactive)) {
6504faabf0Stsutsui 		__asm volatile(
6604faabf0Stsutsui 			".set noreorder;"
6704faabf0Stsutsui 			"jalr	%0;"
6804faabf0Stsutsui 			"move	$29, %1;"
6904faabf0Stsutsui 			".set reorder" :: "r"(addr), "r"(sp));
7004faabf0Stsutsui 		/* NOTREACHED */
7104faabf0Stsutsui 	} else {
7204faabf0Stsutsui 		printf("canceled.\n");
7304faabf0Stsutsui 		return 1;
7404faabf0Stsutsui 	}
7504faabf0Stsutsui 
7604faabf0Stsutsui 	return 0;
7704faabf0Stsutsui }
7804faabf0Stsutsui 
7904faabf0Stsutsui int
cmd_load_binary(int argc,char * argp[],int interactive)8004faabf0Stsutsui cmd_load_binary(int argc, char *argp[], int interactive)
8104faabf0Stsutsui {
8204faabf0Stsutsui 	extern uint8_t kernel_binary[];
8304faabf0Stsutsui 	extern int kernel_binary_size;
8404faabf0Stsutsui 	extern char start[];
8504faabf0Stsutsui 	uint8_t *p, *q;
8604faabf0Stsutsui 	int i, j;
8704faabf0Stsutsui 
8804faabf0Stsutsui 	if (argc < 2) {
8904faabf0Stsutsui 		printf("load load_addr\n");
9004faabf0Stsutsui 		return 1;
9104faabf0Stsutsui 	}
9204faabf0Stsutsui 
9304faabf0Stsutsui 	if (kernel_binary_size == 0) {
9404faabf0Stsutsui 		printf("no kernel image\n");
9504faabf0Stsutsui 		return 1;
9604faabf0Stsutsui 	}
9704faabf0Stsutsui 
9804faabf0Stsutsui 	q = (uint8_t *)strtoul(argp[1], 0, 0);
9904faabf0Stsutsui 	p = kernel_binary;
10004faabf0Stsutsui 
101*4d29d221Sandvar 	/* check load region */
10204faabf0Stsutsui 	printf("load end=%p loader start=%p\n",
10304faabf0Stsutsui 	    q + kernel_binary_size, start);
10404faabf0Stsutsui 	if ((uint32_t)(q + kernel_binary_size) >= (uint32_t)start) {
10504faabf0Stsutsui 		printf("kernel load area is overlapped with loader.\n");
10604faabf0Stsutsui 		return 1;
10704faabf0Stsutsui 	}
10804faabf0Stsutsui 
10904faabf0Stsutsui 	printf("load kernel to %p %dbytes. Y/N\n", q, kernel_binary_size);
11004faabf0Stsutsui 	if (!prompt_yesno(interactive)) {
11104faabf0Stsutsui 		printf("canceled.\n");
11204faabf0Stsutsui 		return 1;
11304faabf0Stsutsui 	}
11404faabf0Stsutsui 
11504faabf0Stsutsui 	j = kernel_binary_size / 30;
11604faabf0Stsutsui 	for (i = 0; i < kernel_binary_size; i ++) {
11704faabf0Stsutsui 		*q++ = *p++;
11804faabf0Stsutsui 		if ((i % j) == 0)
11904faabf0Stsutsui 			printf("loading kernel. %d/%dbytes\r", i,
12004faabf0Stsutsui 			    kernel_binary_size);
12104faabf0Stsutsui 	}
12204faabf0Stsutsui 	r4k_pdcache_wbinv_all(PD_CACHE_SIZE);
12304faabf0Stsutsui 	r4k_sdcache_wbinv_all(SD_CACHE_SIZE, SD_CACHE_LINESIZE);
12404faabf0Stsutsui 
12504faabf0Stsutsui 	printf("loading kernel. %d/%d\r", i , kernel_binary_size);
12604faabf0Stsutsui 	printf("\ndone.\n");
12704faabf0Stsutsui 
12804faabf0Stsutsui 	return 0;
12904faabf0Stsutsui }
13004faabf0Stsutsui 
13104faabf0Stsutsui int
cmd_boot_ux(int argc,char * argp[],int interactive)13204faabf0Stsutsui cmd_boot_ux(int argc, char *argp[], int interactive)
13304faabf0Stsutsui {
13404faabf0Stsutsui 	u_long marks[MARK_MAX];
13504faabf0Stsutsui 	uint32_t entry;
13604faabf0Stsutsui 
13704faabf0Stsutsui 	marks[MARK_START] = 0;
13816ed6645Sthorpej 	console_cursor(false);
13904faabf0Stsutsui 	if (loadfile("sd0d:iopboot", marks, LOAD_KERNEL) != 0) {
14004faabf0Stsutsui 		printf("load iopboot failed.\n");
14104faabf0Stsutsui 		return 1;
14204faabf0Stsutsui 	}
14361373eecStsutsui 	printf("start=%lx entry=%lx nsym=%lx sym=%lx end=%lx\n",
14404faabf0Stsutsui 	    marks[MARK_START], marks[MARK_ENTRY], marks[MARK_NSYM],
14504faabf0Stsutsui 	    marks[MARK_SYM], marks[MARK_END]);
14604faabf0Stsutsui 
14704faabf0Stsutsui 	entry = marks[MARK_ENTRY];
14804faabf0Stsutsui 	printf("jump to iopboot entry.(0x%x) Y/N\n", entry);
14904faabf0Stsutsui 
15004faabf0Stsutsui 	r4k_pdcache_wbinv_all(PD_CACHE_SIZE);
15104faabf0Stsutsui 	r4k_sdcache_wbinv_all(SD_CACHE_SIZE, SD_CACHE_LINESIZE);
15204faabf0Stsutsui 
15304faabf0Stsutsui 	if (prompt_yesno(interactive)) {
15404faabf0Stsutsui 		__asm volatile(
15504faabf0Stsutsui 			".set noreorder;"
15604faabf0Stsutsui 			"lw	$4, %1;"
15704faabf0Stsutsui 			"lw	$2, %2;"
15804faabf0Stsutsui 			"lw	$3, %3;"
15904faabf0Stsutsui 			"jr	%0;"
16004faabf0Stsutsui 			"move	$29, %0;"
16104faabf0Stsutsui 			".set reorder"
16204faabf0Stsutsui 			:: "r"(entry),
16304faabf0Stsutsui 			"m"(ipl_args.a0),
16404faabf0Stsutsui 			"m"(ipl_args.v0),
16504faabf0Stsutsui 			"m"(ipl_args.v1));
16604faabf0Stsutsui 		/* NOTREACHED */
16704faabf0Stsutsui 	}
16816ed6645Sthorpej 	console_cursor(true);
16904faabf0Stsutsui 
17004faabf0Stsutsui 	return 0;
17104faabf0Stsutsui }
17204faabf0Stsutsui 
17304faabf0Stsutsui int
cmd_boot(int argc,char * argp[],int interactive)17404faabf0Stsutsui cmd_boot(int argc, char *argp[], int interactive)
17504faabf0Stsutsui {
17604faabf0Stsutsui 	u_long marks[MARK_MAX];
17704faabf0Stsutsui 	uint32_t entry;
17804faabf0Stsutsui 	struct bootinfo bi;
17904faabf0Stsutsui 	char *filename;
18004faabf0Stsutsui 
18104faabf0Stsutsui 	if (argc < 2) {
18204faabf0Stsutsui 		boot_usage();
18304faabf0Stsutsui 		return 1;
18404faabf0Stsutsui 	} else {
18504faabf0Stsutsui 		filename = argp[1];
18604faabf0Stsutsui 	}
18704faabf0Stsutsui 
18804faabf0Stsutsui 	marks[MARK_START] = 0;
18916ed6645Sthorpej 	console_cursor(false);
19004faabf0Stsutsui 	if (loadfile(filename, marks, LOAD_KERNEL) != 0) {
19104faabf0Stsutsui 		printf("load file failed.\n");
19204faabf0Stsutsui 		return 1;
19304faabf0Stsutsui 	}
19461373eecStsutsui 	printf("start=%lx entry=%lx nsym=%lx sym=%lx end=%lx\n",
19504faabf0Stsutsui 	    marks[MARK_START], marks[MARK_ENTRY], marks[MARK_NSYM],
19604faabf0Stsutsui 	    marks[MARK_SYM], marks[MARK_END]);
19704faabf0Stsutsui 
19804faabf0Stsutsui 	entry = marks[MARK_ENTRY];
19904faabf0Stsutsui 	printf("jump to kernel entry.(0x%x)%s\n", entry,
20004faabf0Stsutsui 	    interactive ? " Y/N" : "");
20104faabf0Stsutsui 
20204faabf0Stsutsui 	/* Setup argument */
20304faabf0Stsutsui 	bi.bi_version = 0x1;
20404faabf0Stsutsui 	bi.bi_size = sizeof bi;
20504faabf0Stsutsui 	bi.bi_nsym = marks[MARK_NSYM];
20604faabf0Stsutsui 	bi.bi_ssym = (uint8_t *)marks[MARK_SYM];
20704faabf0Stsutsui 	bi.bi_esym = (uint8_t *)marks[MARK_END];
20804faabf0Stsutsui 	bi.bi_mainfo = ipl_args.v1;
20904faabf0Stsutsui 
21004faabf0Stsutsui 	r4k_pdcache_wbinv_all(PD_CACHE_SIZE);
21104faabf0Stsutsui 	r4k_sdcache_wbinv_all(SD_CACHE_SIZE, SD_CACHE_LINESIZE);
21204faabf0Stsutsui 
21304faabf0Stsutsui 	if (prompt_yesno(interactive)) {
21404faabf0Stsutsui 		__asm volatile(
21504faabf0Stsutsui 			".set noreorder;"
21604faabf0Stsutsui 			"lw	$4, %1;"
21704faabf0Stsutsui 			"lw	$5, %2;"
21804faabf0Stsutsui 			"la	$6, %3;"
21904faabf0Stsutsui 			"jr	%0;"
22004faabf0Stsutsui 			"move	$29, %0;"
22104faabf0Stsutsui 			".set reorder"
22204faabf0Stsutsui 			:: "r"(entry), "m"(argc), "m"(argp), "m"(bi));
22304faabf0Stsutsui 		/* NOTREACHED */
22404faabf0Stsutsui 	}
22516ed6645Sthorpej 	console_cursor(true);
22604faabf0Stsutsui 
22704faabf0Stsutsui 	return 0;
22804faabf0Stsutsui }
22904faabf0Stsutsui 
23004faabf0Stsutsui void
r4k_pdcache_wbinv_all(uint32_t pdcache_size)23104faabf0Stsutsui r4k_pdcache_wbinv_all(uint32_t pdcache_size)
23204faabf0Stsutsui {
23304faabf0Stsutsui 	uint32_t va = 0x80000000;
23404faabf0Stsutsui 	uint32_t eva = va + pdcache_size;
23504faabf0Stsutsui 
23604faabf0Stsutsui 	while (va < eva) {
23704faabf0Stsutsui 		__asm volatile(
23804faabf0Stsutsui 			".set noreorder;"
23904faabf0Stsutsui 			".set mips3;"
24004faabf0Stsutsui 			"cache %1, 0x000(%0); cache %1, 0x010(%0);"
24104faabf0Stsutsui 			"cache %1, 0x020(%0); cache %1, 0x030(%0);"
24204faabf0Stsutsui 			"cache %1, 0x040(%0); cache %1, 0x050(%0);"
24304faabf0Stsutsui 			"cache %1, 0x060(%0); cache %1, 0x070(%0);"
24404faabf0Stsutsui 			"cache %1, 0x080(%0); cache %1, 0x090(%0);"
24504faabf0Stsutsui 			"cache %1, 0x0a0(%0); cache %1, 0x0b0(%0);"
24604faabf0Stsutsui 			"cache %1, 0x0c0(%0); cache %1, 0x0d0(%0);"
24704faabf0Stsutsui 			"cache %1, 0x0e0(%0); cache %1, 0x0f0(%0);"
24804faabf0Stsutsui 			"cache %1, 0x100(%0); cache %1, 0x110(%0);"
24904faabf0Stsutsui 			"cache %1, 0x120(%0); cache %1, 0x130(%0);"
25004faabf0Stsutsui 			"cache %1, 0x140(%0); cache %1, 0x150(%0);"
25104faabf0Stsutsui 			"cache %1, 0x160(%0); cache %1, 0x170(%0);"
25204faabf0Stsutsui 			"cache %1, 0x180(%0); cache %1, 0x190(%0);"
25304faabf0Stsutsui 			"cache %1, 0x1a0(%0); cache %1, 0x1b0(%0);"
25404faabf0Stsutsui 			"cache %1, 0x1c0(%0); cache %1, 0x1d0(%0);"
25504faabf0Stsutsui 			"cache %1, 0x1e0(%0); cache %1, 0x1f0(%0);"
25604faabf0Stsutsui 			".set reorder"
25704faabf0Stsutsui 			: : "r" (va), "i" (1 |(0 << 2)) : "memory");
25804faabf0Stsutsui 		va += (32 * 16);
25904faabf0Stsutsui 	}
26004faabf0Stsutsui }
26104faabf0Stsutsui 
26204faabf0Stsutsui void
r4k_sdcache_wbinv_all(uint32_t sdcache_size,int line_size)26304faabf0Stsutsui r4k_sdcache_wbinv_all(uint32_t sdcache_size, int line_size)
26404faabf0Stsutsui {
26504faabf0Stsutsui 	uint32_t va = 0x80000000;
26604faabf0Stsutsui 	uint32_t eva = va + sdcache_size;
26704faabf0Stsutsui 
26804faabf0Stsutsui 	while (va < eva) {
26904faabf0Stsutsui 		__asm volatile(
27004faabf0Stsutsui 			".set noreorder;"
27104faabf0Stsutsui 			".set mips3;"
27204faabf0Stsutsui 			"cache %1, 0(%0);"
27304faabf0Stsutsui 			".set reorder"
27404faabf0Stsutsui 			: : "r" (va), "i" (3 |(0 << 2)) : "memory");
27504faabf0Stsutsui 		va += line_size;
27604faabf0Stsutsui 	}
27704faabf0Stsutsui }
27804faabf0Stsutsui 
27904faabf0Stsutsui void
boot_usage(void)28004faabf0Stsutsui boot_usage(void)
28104faabf0Stsutsui {
28204faabf0Stsutsui 
28304faabf0Stsutsui 	printf("boot dev:filename [argument to kernel]\n");
28404faabf0Stsutsui 	printf("\tex).\n");
28504faabf0Stsutsui 	printf("\t Disk 0, Partition 10, /netbsd => sd0k:netbsd\n");
28604faabf0Stsutsui 	printf("\t NFS, /netbsd => nfs:netbsd\n");
2878aaa114dSandvar 	printf("\t `kernel embedded in data section' => mem:\n");
28804faabf0Stsutsui }
289