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