Home | History | Annotate | Line # | Download | only in common
loader.c revision 1.3
      1  1.3  thorpej /*	$NetBSD: loader.c,v 1.3 2007/02/22 05:31:54 thorpej Exp $	*/
      2  1.1  tsutsui 
      3  1.1  tsutsui /*-
      4  1.1  tsutsui  * Copyright (c) 2004 The NetBSD Foundation, Inc.
      5  1.1  tsutsui  * All rights reserved.
      6  1.1  tsutsui  *
      7  1.1  tsutsui  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  tsutsui  * by UCHIYAMA Yasushi.
      9  1.1  tsutsui  *
     10  1.1  tsutsui  * Redistribution and use in source and binary forms, with or without
     11  1.1  tsutsui  * modification, are permitted provided that the following conditions
     12  1.1  tsutsui  * are met:
     13  1.1  tsutsui  * 1. Redistributions of source code must retain the above copyright
     14  1.1  tsutsui  *    notice, this list of conditions and the following disclaimer.
     15  1.1  tsutsui  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  tsutsui  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  tsutsui  *    documentation and/or other materials provided with the distribution.
     18  1.1  tsutsui  * 3. All advertising materials mentioning features or use of this software
     19  1.1  tsutsui  *    must display the following acknowledgement:
     20  1.1  tsutsui  *        This product includes software developed by the NetBSD
     21  1.1  tsutsui  *        Foundation, Inc. and its contributors.
     22  1.1  tsutsui  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1  tsutsui  *    contributors may be used to endorse or promote products derived
     24  1.1  tsutsui  *    from this software without specific prior written permission.
     25  1.1  tsutsui  *
     26  1.1  tsutsui  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1  tsutsui  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1  tsutsui  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1  tsutsui  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1  tsutsui  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1  tsutsui  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1  tsutsui  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1  tsutsui  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1  tsutsui  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1  tsutsui  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1  tsutsui  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1  tsutsui  */
     38  1.1  tsutsui 
     39  1.1  tsutsui #include <lib/libsa/stand.h>
     40  1.1  tsutsui #include <lib/libkern/libkern.h>
     41  1.1  tsutsui 
     42  1.1  tsutsui #include <lib/libsa/loadfile.h>
     43  1.1  tsutsui 
     44  1.1  tsutsui #include <machine/bootinfo.h>
     45  1.1  tsutsui 
     46  1.1  tsutsui #include "console.h"
     47  1.1  tsutsui #include "cmd.h"
     48  1.1  tsutsui #include "local.h"
     49  1.1  tsutsui 
     50  1.1  tsutsui void r4k_pdcache_wbinv_all(uint32_t);
     51  1.1  tsutsui void r4k_sdcache_wbinv_all(uint32_t, int);
     52  1.1  tsutsui void boot_usage(void);
     53  1.1  tsutsui 
     54  1.1  tsutsui int
     55  1.1  tsutsui cmd_jump(int argc, char *argp[], int interactive)
     56  1.1  tsutsui {
     57  1.1  tsutsui 	uint32_t addr;
     58  1.1  tsutsui 	uint32_t sp;
     59  1.1  tsutsui 
     60  1.1  tsutsui 	if (argc < 2) {
     61  1.1  tsutsui 		printf("jump jump_addr [stack_addr]\n");
     62  1.1  tsutsui 		return 1;
     63  1.1  tsutsui 	}
     64  1.1  tsutsui 	addr = strtoul(argp[1], 0, 0);
     65  1.1  tsutsui 	if (argc == 3)
     66  1.1  tsutsui 		sp = strtoul(argp[2], 0, 0);
     67  1.1  tsutsui 	else
     68  1.1  tsutsui 		__asm volatile("move %0, $29" : "=r"(sp)); /* current stack */
     69  1.1  tsutsui 
     70  1.2  tsutsui 	printf("jump to 0x%08x. sp=0x%08x Y/N\n", addr, sp);
     71  1.1  tsutsui 	if (prompt_yesno(interactive)) {
     72  1.1  tsutsui 		__asm volatile(
     73  1.1  tsutsui 			".set noreorder;"
     74  1.1  tsutsui 			"jalr	%0;"
     75  1.1  tsutsui 			"move	$29, %1;"
     76  1.1  tsutsui 			".set reorder" :: "r"(addr), "r"(sp));
     77  1.1  tsutsui 		/* NOTREACHED */
     78  1.1  tsutsui 	} else {
     79  1.1  tsutsui 		printf("canceled.\n");
     80  1.1  tsutsui 		return 1;
     81  1.1  tsutsui 	}
     82  1.1  tsutsui 
     83  1.1  tsutsui 	return 0;
     84  1.1  tsutsui }
     85  1.1  tsutsui 
     86  1.1  tsutsui int
     87  1.1  tsutsui cmd_load_binary(int argc, char *argp[], int interactive)
     88  1.1  tsutsui {
     89  1.1  tsutsui 	extern uint8_t kernel_binary[];
     90  1.1  tsutsui 	extern int kernel_binary_size;
     91  1.1  tsutsui 	extern char start[];
     92  1.1  tsutsui 	uint8_t *p, *q;
     93  1.1  tsutsui 	int i, j;
     94  1.1  tsutsui 
     95  1.1  tsutsui 	if (argc < 2) {
     96  1.1  tsutsui 		printf("load load_addr\n");
     97  1.1  tsutsui 		return 1;
     98  1.1  tsutsui 	}
     99  1.1  tsutsui 
    100  1.1  tsutsui 	if (kernel_binary_size == 0) {
    101  1.1  tsutsui 		printf("no kernel image\n");
    102  1.1  tsutsui 		return 1;
    103  1.1  tsutsui 	}
    104  1.1  tsutsui 
    105  1.1  tsutsui 	q = (uint8_t *)strtoul(argp[1], 0, 0);
    106  1.1  tsutsui 	p = kernel_binary;
    107  1.1  tsutsui 
    108  1.1  tsutsui 	/* check load reagion */
    109  1.1  tsutsui 	printf("load end=%p loader start=%p\n",
    110  1.1  tsutsui 	    q + kernel_binary_size, start);
    111  1.1  tsutsui 	if ((uint32_t)(q + kernel_binary_size) >= (uint32_t)start) {
    112  1.1  tsutsui 		printf("kernel load area is overlapped with loader.\n");
    113  1.1  tsutsui 		return 1;
    114  1.1  tsutsui 	}
    115  1.1  tsutsui 
    116  1.1  tsutsui 	printf("load kernel to %p %dbytes. Y/N\n", q, kernel_binary_size);
    117  1.1  tsutsui 	if (!prompt_yesno(interactive)) {
    118  1.1  tsutsui 		printf("canceled.\n");
    119  1.1  tsutsui 		return 1;
    120  1.1  tsutsui 	}
    121  1.1  tsutsui 
    122  1.1  tsutsui 	j = kernel_binary_size / 30;
    123  1.1  tsutsui 	for (i = 0; i < kernel_binary_size; i ++) {
    124  1.1  tsutsui 		*q++ = *p++;
    125  1.1  tsutsui 		if ((i % j) == 0)
    126  1.1  tsutsui 			printf("loading kernel. %d/%dbytes\r", i,
    127  1.1  tsutsui 			    kernel_binary_size);
    128  1.1  tsutsui 	}
    129  1.1  tsutsui 	r4k_pdcache_wbinv_all(PD_CACHE_SIZE);
    130  1.1  tsutsui 	r4k_sdcache_wbinv_all(SD_CACHE_SIZE, SD_CACHE_LINESIZE);
    131  1.1  tsutsui 
    132  1.1  tsutsui 	printf("loading kernel. %d/%d\r", i , kernel_binary_size);
    133  1.1  tsutsui 	printf("\ndone.\n");
    134  1.1  tsutsui 
    135  1.1  tsutsui 	return 0;
    136  1.1  tsutsui }
    137  1.1  tsutsui 
    138  1.1  tsutsui int
    139  1.1  tsutsui cmd_boot_ux(int argc, char *argp[], int interactive)
    140  1.1  tsutsui {
    141  1.1  tsutsui 	u_long marks[MARK_MAX];
    142  1.1  tsutsui 	uint32_t entry;
    143  1.1  tsutsui 
    144  1.1  tsutsui 	marks[MARK_START] = 0;
    145  1.3  thorpej 	console_cursor(false);
    146  1.1  tsutsui 	if (loadfile("sd0d:iopboot", marks, LOAD_KERNEL) != 0) {
    147  1.1  tsutsui 		printf("load iopboot failed.\n");
    148  1.1  tsutsui 		return 1;
    149  1.1  tsutsui 	}
    150  1.2  tsutsui 	printf("start=%lx entry=%lx nsym=%lx sym=%lx end=%lx\n",
    151  1.1  tsutsui 	    marks[MARK_START], marks[MARK_ENTRY], marks[MARK_NSYM],
    152  1.1  tsutsui 	    marks[MARK_SYM], marks[MARK_END]);
    153  1.1  tsutsui 
    154  1.1  tsutsui 	entry = marks[MARK_ENTRY];
    155  1.1  tsutsui 	printf("jump to iopboot entry.(0x%x) Y/N\n", entry);
    156  1.1  tsutsui 
    157  1.1  tsutsui 	r4k_pdcache_wbinv_all(PD_CACHE_SIZE);
    158  1.1  tsutsui 	r4k_sdcache_wbinv_all(SD_CACHE_SIZE, SD_CACHE_LINESIZE);
    159  1.1  tsutsui 
    160  1.1  tsutsui 	if (prompt_yesno(interactive)) {
    161  1.1  tsutsui 		__asm volatile(
    162  1.1  tsutsui 			".set noreorder;"
    163  1.1  tsutsui 			"lw	$4, %1;"
    164  1.1  tsutsui 			"lw	$2, %2;"
    165  1.1  tsutsui 			"lw	$3, %3;"
    166  1.1  tsutsui 			"jr	%0;"
    167  1.1  tsutsui 			"move	$29, %0;"
    168  1.1  tsutsui 			".set reorder"
    169  1.1  tsutsui 			:: "r"(entry),
    170  1.1  tsutsui 			"m"(ipl_args.a0),
    171  1.1  tsutsui 			"m"(ipl_args.v0),
    172  1.1  tsutsui 			"m"(ipl_args.v1));
    173  1.1  tsutsui 		/* NOTREACHED */
    174  1.1  tsutsui 	}
    175  1.3  thorpej 	console_cursor(true);
    176  1.1  tsutsui 
    177  1.1  tsutsui 	return 0;
    178  1.1  tsutsui }
    179  1.1  tsutsui 
    180  1.1  tsutsui int
    181  1.1  tsutsui cmd_boot(int argc, char *argp[], int interactive)
    182  1.1  tsutsui {
    183  1.1  tsutsui 	u_long marks[MARK_MAX];
    184  1.1  tsutsui 	uint32_t entry;
    185  1.1  tsutsui 	struct bootinfo bi;
    186  1.1  tsutsui 	char *filename;
    187  1.1  tsutsui 
    188  1.1  tsutsui 	if (argc < 2) {
    189  1.1  tsutsui 		boot_usage();
    190  1.1  tsutsui 		return 1;
    191  1.1  tsutsui 	} else {
    192  1.1  tsutsui 		filename = argp[1];
    193  1.1  tsutsui 	}
    194  1.1  tsutsui 
    195  1.1  tsutsui 	marks[MARK_START] = 0;
    196  1.3  thorpej 	console_cursor(false);
    197  1.1  tsutsui 	if (loadfile(filename, marks, LOAD_KERNEL) != 0) {
    198  1.1  tsutsui 		printf("load file failed.\n");
    199  1.1  tsutsui 		return 1;
    200  1.1  tsutsui 	}
    201  1.2  tsutsui 	printf("start=%lx entry=%lx nsym=%lx sym=%lx end=%lx\n",
    202  1.1  tsutsui 	    marks[MARK_START], marks[MARK_ENTRY], marks[MARK_NSYM],
    203  1.1  tsutsui 	    marks[MARK_SYM], marks[MARK_END]);
    204  1.1  tsutsui 
    205  1.1  tsutsui 	entry = marks[MARK_ENTRY];
    206  1.1  tsutsui 	printf("jump to kernel entry.(0x%x)%s\n", entry,
    207  1.1  tsutsui 	    interactive ? " Y/N" : "");
    208  1.1  tsutsui 
    209  1.1  tsutsui 	/* Setup argument */
    210  1.1  tsutsui 	bi.bi_version = 0x1;
    211  1.1  tsutsui 	bi.bi_size = sizeof bi;
    212  1.1  tsutsui 	bi.bi_nsym = marks[MARK_NSYM];
    213  1.1  tsutsui 	bi.bi_ssym = (uint8_t *)marks[MARK_SYM];
    214  1.1  tsutsui 	bi.bi_esym = (uint8_t *)marks[MARK_END];
    215  1.1  tsutsui 	bi.bi_mainfo = ipl_args.v1;
    216  1.1  tsutsui 
    217  1.1  tsutsui 	r4k_pdcache_wbinv_all(PD_CACHE_SIZE);
    218  1.1  tsutsui 	r4k_sdcache_wbinv_all(SD_CACHE_SIZE, SD_CACHE_LINESIZE);
    219  1.1  tsutsui 
    220  1.1  tsutsui 	if (prompt_yesno(interactive)) {
    221  1.1  tsutsui 		__asm volatile(
    222  1.1  tsutsui 			".set noreorder;"
    223  1.1  tsutsui 			"lw	$4, %1;"
    224  1.1  tsutsui 			"lw	$5, %2;"
    225  1.1  tsutsui 			"la	$6, %3;"
    226  1.1  tsutsui 			"jr	%0;"
    227  1.1  tsutsui 			"move	$29, %0;"
    228  1.1  tsutsui 			".set reorder"
    229  1.1  tsutsui 			:: "r"(entry), "m"(argc), "m"(argp), "m"(bi));
    230  1.1  tsutsui 		/* NOTREACHED */
    231  1.1  tsutsui 	}
    232  1.3  thorpej 	console_cursor(true);
    233  1.1  tsutsui 
    234  1.1  tsutsui 	return 0;
    235  1.1  tsutsui }
    236  1.1  tsutsui 
    237  1.1  tsutsui void
    238  1.1  tsutsui r4k_pdcache_wbinv_all(uint32_t pdcache_size)
    239  1.1  tsutsui {
    240  1.1  tsutsui 	uint32_t va = 0x80000000;
    241  1.1  tsutsui 	uint32_t eva = va + pdcache_size;
    242  1.1  tsutsui 
    243  1.1  tsutsui 	while (va < eva) {
    244  1.1  tsutsui 		__asm volatile(
    245  1.1  tsutsui 			".set noreorder;"
    246  1.1  tsutsui 			".set mips3;"
    247  1.1  tsutsui 			"cache %1, 0x000(%0); cache %1, 0x010(%0);"
    248  1.1  tsutsui 			"cache %1, 0x020(%0); cache %1, 0x030(%0);"
    249  1.1  tsutsui 			"cache %1, 0x040(%0); cache %1, 0x050(%0);"
    250  1.1  tsutsui 			"cache %1, 0x060(%0); cache %1, 0x070(%0);"
    251  1.1  tsutsui 			"cache %1, 0x080(%0); cache %1, 0x090(%0);"
    252  1.1  tsutsui 			"cache %1, 0x0a0(%0); cache %1, 0x0b0(%0);"
    253  1.1  tsutsui 			"cache %1, 0x0c0(%0); cache %1, 0x0d0(%0);"
    254  1.1  tsutsui 			"cache %1, 0x0e0(%0); cache %1, 0x0f0(%0);"
    255  1.1  tsutsui 			"cache %1, 0x100(%0); cache %1, 0x110(%0);"
    256  1.1  tsutsui 			"cache %1, 0x120(%0); cache %1, 0x130(%0);"
    257  1.1  tsutsui 			"cache %1, 0x140(%0); cache %1, 0x150(%0);"
    258  1.1  tsutsui 			"cache %1, 0x160(%0); cache %1, 0x170(%0);"
    259  1.1  tsutsui 			"cache %1, 0x180(%0); cache %1, 0x190(%0);"
    260  1.1  tsutsui 			"cache %1, 0x1a0(%0); cache %1, 0x1b0(%0);"
    261  1.1  tsutsui 			"cache %1, 0x1c0(%0); cache %1, 0x1d0(%0);"
    262  1.1  tsutsui 			"cache %1, 0x1e0(%0); cache %1, 0x1f0(%0);"
    263  1.1  tsutsui 			".set reorder"
    264  1.1  tsutsui 			: : "r" (va), "i" (1 |(0 << 2)) : "memory");
    265  1.1  tsutsui 		va += (32 * 16);
    266  1.1  tsutsui 	}
    267  1.1  tsutsui }
    268  1.1  tsutsui 
    269  1.1  tsutsui void
    270  1.1  tsutsui r4k_sdcache_wbinv_all(uint32_t sdcache_size, int line_size)
    271  1.1  tsutsui {
    272  1.1  tsutsui 	uint32_t va = 0x80000000;
    273  1.1  tsutsui 	uint32_t eva = va + sdcache_size;
    274  1.1  tsutsui 
    275  1.1  tsutsui 	while (va < eva) {
    276  1.1  tsutsui 		__asm volatile(
    277  1.1  tsutsui 			".set noreorder;"
    278  1.1  tsutsui 			".set mips3;"
    279  1.1  tsutsui 			"cache %1, 0(%0);"
    280  1.1  tsutsui 			".set reorder"
    281  1.1  tsutsui 			: : "r" (va), "i" (3 |(0 << 2)) : "memory");
    282  1.1  tsutsui 		va += line_size;
    283  1.1  tsutsui 	}
    284  1.1  tsutsui }
    285  1.1  tsutsui 
    286  1.1  tsutsui void
    287  1.1  tsutsui boot_usage(void)
    288  1.1  tsutsui {
    289  1.1  tsutsui 
    290  1.1  tsutsui 	printf("boot dev:filename [argument to kernel]\n");
    291  1.1  tsutsui 	printf("\tex).\n");
    292  1.1  tsutsui 	printf("\t Disk 0, Partition 10, /netbsd => sd0k:netbsd\n");
    293  1.1  tsutsui 	printf("\t NFS, /netbsd => nfs:netbsd\n");
    294  1.1  tsutsui 	printf("\t `kernel embeded in data section' => mem:\n");
    295  1.1  tsutsui }
    296