arm32_machdep.c revision 1.75 1 /* $NetBSD: arm32_machdep.c,v 1.75 2011/06/12 03:35:39 rmind Exp $ */
2
3 /*
4 * Copyright (c) 1994-1998 Mark Brinicombe.
5 * Copyright (c) 1994 Brini.
6 * All rights reserved.
7 *
8 * This code is derived from software written for Brini by Mark Brinicombe
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 * 3. All advertising materials mentioning features or use of this software
19 * must display the following acknowledgement:
20 * This product includes software developed by Mark Brinicombe
21 * for the NetBSD Project.
22 * 4. The name of the company nor the name of the author may be used to
23 * endorse or promote products derived from this software without specific
24 * prior written permission.
25 *
26 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
27 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
28 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
29 * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
30 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
31 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
32 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
33 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
34 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
35 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36 * SUCH DAMAGE.
37 *
38 * Machine dependant functions for kernel setup
39 *
40 * Created : 17/09/94
41 * Updated : 18/04/01 updated for new wscons
42 */
43
44 #include <sys/cdefs.h>
45 __KERNEL_RCSID(0, "$NetBSD: arm32_machdep.c,v 1.75 2011/06/12 03:35:39 rmind Exp $");
46
47 #include "opt_modular.h"
48 #include "opt_md.h"
49 #include "opt_pmap_debug.h"
50
51 #include <sys/param.h>
52 #include <sys/systm.h>
53 #include <sys/reboot.h>
54 #include <sys/proc.h>
55 #include <sys/kauth.h>
56 #include <sys/kernel.h>
57 #include <sys/mbuf.h>
58 #include <sys/mount.h>
59 #include <sys/buf.h>
60 #include <sys/msgbuf.h>
61 #include <sys/device.h>
62 #include <uvm/uvm_extern.h>
63 #include <sys/sysctl.h>
64 #include <sys/cpu.h>
65 #include <sys/module.h>
66
67 #include <dev/cons.h>
68 #include <dev/mm.h>
69
70 #include <arm/arm32/katelib.h>
71 #include <arm/arm32/machdep.h>
72 #include <machine/bootconfig.h>
73
74 struct vm_map *phys_map = NULL;
75
76 #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
77 extern size_t md_root_size; /* Memory disc size */
78 #endif /* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
79
80 pv_addr_t kernelstack;
81
82 void * msgbufaddr;
83 extern paddr_t msgbufphys;
84
85 int kernel_debug = 0;
86
87 /* exported variable to be filled in by the bootloaders */
88 char *booted_kernel;
89
90
91 /* Prototypes */
92
93 void data_abort_handler(trapframe_t *frame);
94 void prefetch_abort_handler(trapframe_t *frame);
95 extern void configure(void);
96
97 /*
98 * arm32_vector_init:
99 *
100 * Initialize the vector page, and select whether or not to
101 * relocate the vectors.
102 *
103 * NOTE: We expect the vector page to be mapped at its expected
104 * destination.
105 */
106 void
107 arm32_vector_init(vaddr_t va, int which)
108 {
109 extern unsigned int page0[], page0_data[];
110 unsigned int *vectors = (int *) va;
111 unsigned int *vectors_data = vectors + (page0_data - page0);
112 int vec;
113
114 /*
115 * Loop through the vectors we're taking over, and copy the
116 * vector's insn and data word.
117 */
118 for (vec = 0; vec < ARM_NVEC; vec++) {
119 if ((which & (1 << vec)) == 0) {
120 /* Don't want to take over this vector. */
121 continue;
122 }
123 vectors[vec] = page0[vec];
124 vectors_data[vec] = page0_data[vec];
125 }
126
127 /* Now sync the vectors. */
128 cpu_icache_sync_range(va, (ARM_NVEC * 2) * sizeof(u_int));
129
130 vector_page = va;
131
132 if (va == ARM_VECTORS_HIGH) {
133 /*
134 * Assume the MD caller knows what it's doing here, and
135 * really does want the vector page relocated.
136 *
137 * Note: This has to be done here (and not just in
138 * cpu_setup()) because the vector page needs to be
139 * accessible *before* cpu_startup() is called.
140 * Think ddb(9) ...
141 *
142 * NOTE: If the CPU control register is not readable,
143 * this will totally fail! We'll just assume that
144 * any system that has high vector support has a
145 * readable CPU control register, for now. If we
146 * ever encounter one that does not, we'll have to
147 * rethink this.
148 */
149 cpu_control(CPU_CONTROL_VECRELOC, CPU_CONTROL_VECRELOC);
150 }
151 }
152
153 /*
154 * Debug function just to park the CPU
155 */
156
157 void
158 halt(void)
159 {
160 while (1)
161 cpu_sleep(0);
162 }
163
164
165 /* Sync the discs and unmount the filesystems */
166
167 void
168 bootsync(void)
169 {
170 static bool bootsyncdone = false;
171
172 if (bootsyncdone) return;
173
174 bootsyncdone = true;
175
176 /* Make sure we can still manage to do things */
177 if (GetCPSR() & I32_bit) {
178 /*
179 * If we get here then boot has been called without RB_NOSYNC
180 * and interrupts were disabled. This means the boot() call
181 * did not come from a user process e.g. shutdown, but must
182 * have come from somewhere in the kernel.
183 */
184 IRQenable;
185 printf("Warning IRQ's disabled during boot()\n");
186 }
187
188 vfs_shutdown();
189 }
190
191 /*
192 * void cpu_startup(void)
193 *
194 * Machine dependant startup code.
195 *
196 */
197 void
198 cpu_startup(void)
199 {
200 vaddr_t minaddr;
201 vaddr_t maxaddr;
202 u_int loop;
203 char pbuf[9];
204
205 /* Set the CPU control register */
206 cpu_setup(boot_args);
207
208 /* Lock down zero page */
209 vector_page_setprot(VM_PROT_READ);
210
211 /*
212 * Give pmap a chance to set up a few more things now the vm
213 * is initialised
214 */
215 pmap_postinit();
216
217 /*
218 * Initialize error message buffer (at end of core).
219 */
220
221 /* msgbufphys was setup during the secondary boot strap */
222 for (loop = 0; loop < btoc(MSGBUFSIZE); ++loop)
223 pmap_kenter_pa((vaddr_t)msgbufaddr + loop * PAGE_SIZE,
224 msgbufphys + loop * PAGE_SIZE,
225 VM_PROT_READ|VM_PROT_WRITE, 0);
226 pmap_update(pmap_kernel());
227 initmsgbuf(msgbufaddr, round_page(MSGBUFSIZE));
228
229 /*
230 * Identify ourselves for the msgbuf (everything printed earlier will
231 * not be buffered).
232 */
233 printf("%s%s", copyright, version);
234
235 format_bytes(pbuf, sizeof(pbuf), arm_ptob(physmem));
236 printf("total memory = %s\n", pbuf);
237
238 minaddr = 0;
239
240 /*
241 * Allocate a submap for physio
242 */
243 phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
244 VM_PHYS_SIZE, 0, false, NULL);
245
246 format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
247 printf("avail memory = %s\n", pbuf);
248
249 curpcb = lwp_getpcb(&lwp0);
250 curpcb->pcb_flags = 0;
251 curpcb->pcb_un.un_32.pcb32_sp =
252 uvm_lwp_getuarea(&lwp0) + USPACE_SVC_STACK_TOP;
253 curpcb->pcb_tf = (struct trapframe *)curpcb->pcb_un.un_32.pcb32_sp - 1;
254 }
255
256 /*
257 * machine dependent system variables.
258 */
259 static int
260 sysctl_machdep_booted_device(SYSCTLFN_ARGS)
261 {
262 struct sysctlnode node;
263
264 if (booted_device == NULL)
265 return (EOPNOTSUPP);
266
267 node = *rnode;
268 node.sysctl_data = booted_device->dv_xname;
269 node.sysctl_size = strlen(booted_device->dv_xname) + 1;
270 return (sysctl_lookup(SYSCTLFN_CALL(&node)));
271 }
272
273 static int
274 sysctl_machdep_booted_kernel(SYSCTLFN_ARGS)
275 {
276 struct sysctlnode node;
277
278 if (booted_kernel == NULL || booted_kernel[0] == '\0')
279 return (EOPNOTSUPP);
280
281 node = *rnode;
282 node.sysctl_data = booted_kernel;
283 node.sysctl_size = strlen(booted_kernel) + 1;
284 return (sysctl_lookup(SYSCTLFN_CALL(&node)));
285 }
286
287 static int
288 sysctl_machdep_powersave(SYSCTLFN_ARGS)
289 {
290 struct sysctlnode node = *rnode;
291 int error, newval;
292
293 newval = cpu_do_powersave;
294 node.sysctl_data = &newval;
295 if (cpufuncs.cf_sleep == (void *) cpufunc_nullop)
296 node.sysctl_flags &= ~CTLFLAG_READWRITE;
297 error = sysctl_lookup(SYSCTLFN_CALL(&node));
298 if (error || newp == NULL || newval == cpu_do_powersave)
299 return (error);
300
301 if (newval < 0 || newval > 1)
302 return (EINVAL);
303 cpu_do_powersave = newval;
304
305 return (0);
306 }
307
308 SYSCTL_SETUP(sysctl_machdep_setup, "sysctl machdep subtree setup")
309 {
310
311 sysctl_createv(clog, 0, NULL, NULL,
312 CTLFLAG_PERMANENT,
313 CTLTYPE_NODE, "machdep", NULL,
314 NULL, 0, NULL, 0,
315 CTL_MACHDEP, CTL_EOL);
316
317 sysctl_createv(clog, 0, NULL, NULL,
318 CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
319 CTLTYPE_INT, "debug", NULL,
320 NULL, 0, &kernel_debug, 0,
321 CTL_MACHDEP, CPU_DEBUG, CTL_EOL);
322 sysctl_createv(clog, 0, NULL, NULL,
323 CTLFLAG_PERMANENT,
324 CTLTYPE_STRING, "booted_device", NULL,
325 sysctl_machdep_booted_device, 0, NULL, 0,
326 CTL_MACHDEP, CPU_BOOTED_DEVICE, CTL_EOL);
327 sysctl_createv(clog, 0, NULL, NULL,
328 CTLFLAG_PERMANENT,
329 CTLTYPE_STRING, "booted_kernel", NULL,
330 sysctl_machdep_booted_kernel, 0, NULL, 0,
331 CTL_MACHDEP, CPU_BOOTED_KERNEL, CTL_EOL);
332 sysctl_createv(clog, 0, NULL, NULL,
333 CTLFLAG_PERMANENT,
334 CTLTYPE_STRUCT, "console_device", NULL,
335 sysctl_consdev, 0, NULL, sizeof(dev_t),
336 CTL_MACHDEP, CPU_CONSDEV, CTL_EOL);
337 sysctl_createv(clog, 0, NULL, NULL,
338 CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
339 CTLTYPE_INT, "powersave", NULL,
340 sysctl_machdep_powersave, 0, &cpu_do_powersave, 0,
341 CTL_MACHDEP, CPU_POWERSAVE, CTL_EOL);
342 }
343
344 void
345 parse_mi_bootargs(char *args)
346 {
347 int integer;
348
349 if (get_bootconf_option(args, "single", BOOTOPT_TYPE_BOOLEAN, &integer)
350 || get_bootconf_option(args, "-s", BOOTOPT_TYPE_BOOLEAN, &integer))
351 if (integer)
352 boothowto |= RB_SINGLE;
353 if (get_bootconf_option(args, "kdb", BOOTOPT_TYPE_BOOLEAN, &integer)
354 || get_bootconf_option(args, "-k", BOOTOPT_TYPE_BOOLEAN, &integer))
355 if (integer)
356 boothowto |= RB_KDB;
357 if (get_bootconf_option(args, "ask", BOOTOPT_TYPE_BOOLEAN, &integer)
358 || get_bootconf_option(args, "-a", BOOTOPT_TYPE_BOOLEAN, &integer))
359 if (integer)
360 boothowto |= RB_ASKNAME;
361
362 #ifdef PMAP_DEBUG
363 if (get_bootconf_option(args, "pmapdebug", BOOTOPT_TYPE_INT, &integer)) {
364 pmap_debug_level = integer;
365 pmap_debug(pmap_debug_level);
366 }
367 #endif /* PMAP_DEBUG */
368
369 /* if (get_bootconf_option(args, "nbuf", BOOTOPT_TYPE_INT, &integer))
370 bufpages = integer;*/
371
372 #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
373 if (get_bootconf_option(args, "memorydisc", BOOTOPT_TYPE_INT, &integer)
374 || get_bootconf_option(args, "memorydisk", BOOTOPT_TYPE_INT, &integer)) {
375 md_root_size = integer;
376 md_root_size *= 1024;
377 if (md_root_size < 32*1024)
378 md_root_size = 32*1024;
379 if (md_root_size > 2048*1024)
380 md_root_size = 2048*1024;
381 }
382 #endif /* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
383
384 if (get_bootconf_option(args, "quiet", BOOTOPT_TYPE_BOOLEAN, &integer)
385 || get_bootconf_option(args, "-q", BOOTOPT_TYPE_BOOLEAN, &integer))
386 if (integer)
387 boothowto |= AB_QUIET;
388 if (get_bootconf_option(args, "verbose", BOOTOPT_TYPE_BOOLEAN, &integer)
389 || get_bootconf_option(args, "-v", BOOTOPT_TYPE_BOOLEAN, &integer))
390 if (integer)
391 boothowto |= AB_VERBOSE;
392 }
393
394 #ifdef __HAVE_FAST_SOFTINTS
395 #if IPL_SOFTSERIAL != IPL_SOFTNET + 1
396 #error IPLs are screwed up
397 #elif IPL_SOFTNET != IPL_SOFTBIO + 1
398 #error IPLs are screwed up
399 #elif IPL_SOFTBIO != IPL_SOFTCLOCK + 1
400 #error IPLs are screwed up
401 #elif !(IPL_SOFTCLOCK > IPL_NONE)
402 #error IPLs are screwed up
403 #elif (IPL_NONE != 0)
404 #error IPLs are screwed up
405 #endif
406
407 #define SOFTINT2IPLMAP \
408 (((IPL_SOFTSERIAL - IPL_SOFTCLOCK) << (SOFTINT_SERIAL * 4)) | \
409 ((IPL_SOFTNET - IPL_SOFTCLOCK) << (SOFTINT_NET * 4)) | \
410 ((IPL_SOFTBIO - IPL_SOFTCLOCK) << (SOFTINT_BIO * 4)) | \
411 ((IPL_SOFTCLOCK - IPL_SOFTCLOCK) << (SOFTINT_CLOCK * 4)))
412 #define SOFTINT2IPL(l) ((SOFTINT2IPLMAP >> ((l) * 4)) & 0x0f)
413
414 /*
415 * This returns a mask of softint IPLs that be dispatch at <ipl>
416 * SOFTIPLMASK(IPL_NONE) = 0x0000000f
417 * SOFTIPLMASK(IPL_SOFTCLOCK) = 0x0000000e
418 * SOFTIPLMASK(IPL_SOFTBIO) = 0x0000000c
419 * SOFTIPLMASK(IPL_SOFTNET) = 0x00000008
420 * SOFTIPLMASK(IPL_SOFTSERIAL) = 0x00000000
421 */
422 #define SOFTIPLMASK(ipl) (0x0f << (ipl))
423
424 void softint_switch(lwp_t *, int);
425
426 void
427 softint_trigger(uintptr_t mask)
428 {
429 curcpu()->ci_softints |= mask;
430 }
431
432 void
433 softint_init_md(lwp_t *l, u_int level, uintptr_t *machdep)
434 {
435 lwp_t ** lp = &curcpu()->ci_softlwps[level];
436 KASSERT(*lp == NULL || *lp == l);
437 *lp = l;
438 *machdep = 1 << SOFTINT2IPL(level);
439 KASSERT(level != SOFTINT_CLOCK || *machdep == (1 << (IPL_SOFTCLOCK - IPL_SOFTCLOCK)));
440 KASSERT(level != SOFTINT_BIO || *machdep == (1 << (IPL_SOFTBIO - IPL_SOFTCLOCK)));
441 KASSERT(level != SOFTINT_NET || *machdep == (1 << (IPL_SOFTNET - IPL_SOFTCLOCK)));
442 KASSERT(level != SOFTINT_SERIAL || *machdep == (1 << (IPL_SOFTSERIAL - IPL_SOFTCLOCK)));
443 }
444
445 void
446 dosoftints(void)
447 {
448 struct cpu_info * const ci = curcpu();
449 const int opl = ci->ci_cpl;
450 const uint32_t softiplmask = SOFTIPLMASK(opl);
451
452 for (;;) {
453 u_int softints = ci->ci_softints & softiplmask;
454 KASSERT((softints != 0) == ((ci->ci_softints >> opl) != 0));
455 if (softints == 0)
456 return;
457 ci->ci_cpl = IPL_HIGH;
458 #define DOSOFTINT(n) \
459 if (softints & (1 << (IPL_SOFT ## n - IPL_SOFTCLOCK))) { \
460 ci->ci_softints &= \
461 ~(1 << (IPL_SOFT ## n - IPL_SOFTCLOCK)); \
462 softint_switch(ci->ci_softlwps[SOFTINT_ ## n], \
463 IPL_SOFT ## n); \
464 ci->ci_cpl = opl; \
465 continue; \
466 }
467 DOSOFTINT(SERIAL);
468 DOSOFTINT(NET);
469 DOSOFTINT(BIO);
470 DOSOFTINT(CLOCK);
471 panic("dosoftints wtf (softints=%u?, ipl=%d)", softints, opl);
472 }
473 }
474 #endif /* __HAVE_FAST_SOFTINTS */
475
476 #ifdef MODULAR
477 /*
478 * Push any modules loaded by the boot loader.
479 */
480 void
481 module_init_md(void)
482 {
483 }
484 #endif /* MODULAR */
485
486 int
487 mm_md_physacc(paddr_t pa, vm_prot_t prot)
488 {
489
490 return (pa < ctob(physmem)) ? 0 : EFAULT;
491 }
492