arm32_machdep.c revision 1.79 1 /* $NetBSD: arm32_machdep.c,v 1.79 2012/07/29 00:07:10 matt 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 dependent 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.79 2012/07/29 00:07:10 matt 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 <sys/sysctl.h>
63 #include <sys/cpu.h>
64 #include <sys/module.h>
65
66 #include <uvm/uvm_extern.h>
67
68 #include <dev/cons.h>
69 #include <dev/mm.h>
70
71 #include <arm/arm32/katelib.h>
72 #include <arm/arm32/machdep.h>
73 #include <machine/bootconfig.h>
74
75 struct vm_map *phys_map = NULL;
76
77 #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
78 extern size_t md_root_size; /* Memory disc size */
79 #endif /* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
80
81 pv_addr_t kernelstack;
82 pv_addr_t abtstack;
83 pv_addr_t fiqstack;
84 pv_addr_t irqstack;
85 pv_addr_t undstack;
86
87 void * msgbufaddr;
88 extern paddr_t msgbufphys;
89
90 int kernel_debug = 0;
91
92 /* exported variable to be filled in by the bootloaders */
93 char *booted_kernel;
94
95
96 /* Prototypes */
97
98 void data_abort_handler(trapframe_t *frame);
99 void prefetch_abort_handler(trapframe_t *frame);
100 extern void configure(void);
101
102 /*
103 * arm32_vector_init:
104 *
105 * Initialize the vector page, and select whether or not to
106 * relocate the vectors.
107 *
108 * NOTE: We expect the vector page to be mapped at its expected
109 * destination.
110 */
111 void
112 arm32_vector_init(vaddr_t va, int which)
113 {
114 extern unsigned int page0[], page0_data[];
115 unsigned int *vectors = (int *) va;
116 unsigned int *vectors_data = vectors + (page0_data - page0);
117 int vec;
118
119 /*
120 * Loop through the vectors we're taking over, and copy the
121 * vector's insn and data word.
122 */
123 for (vec = 0; vec < ARM_NVEC; vec++) {
124 if ((which & (1 << vec)) == 0) {
125 /* Don't want to take over this vector. */
126 continue;
127 }
128 vectors[vec] = page0[vec];
129 vectors_data[vec] = page0_data[vec];
130 }
131
132 /* Now sync the vectors. */
133 cpu_icache_sync_range(va, (ARM_NVEC * 2) * sizeof(u_int));
134
135 vector_page = va;
136
137 if (va == ARM_VECTORS_HIGH) {
138 /*
139 * Assume the MD caller knows what it's doing here, and
140 * really does want the vector page relocated.
141 *
142 * Note: This has to be done here (and not just in
143 * cpu_setup()) because the vector page needs to be
144 * accessible *before* cpu_startup() is called.
145 * Think ddb(9) ...
146 *
147 * NOTE: If the CPU control register is not readable,
148 * this will totally fail! We'll just assume that
149 * any system that has high vector support has a
150 * readable CPU control register, for now. If we
151 * ever encounter one that does not, we'll have to
152 * rethink this.
153 */
154 cpu_control(CPU_CONTROL_VECRELOC, CPU_CONTROL_VECRELOC);
155 }
156 }
157
158 /*
159 * Debug function just to park the CPU
160 */
161
162 void
163 halt(void)
164 {
165 while (1)
166 cpu_sleep(0);
167 }
168
169
170 /* Sync the discs and unmount the filesystems */
171
172 void
173 bootsync(void)
174 {
175 static bool bootsyncdone = false;
176
177 if (bootsyncdone) return;
178
179 bootsyncdone = true;
180
181 /* Make sure we can still manage to do things */
182 if (GetCPSR() & I32_bit) {
183 /*
184 * If we get here then boot has been called without RB_NOSYNC
185 * and interrupts were disabled. This means the boot() call
186 * did not come from a user process e.g. shutdown, but must
187 * have come from somewhere in the kernel.
188 */
189 IRQenable;
190 printf("Warning IRQ's disabled during boot()\n");
191 }
192
193 vfs_shutdown();
194 }
195
196 /*
197 * void cpu_startup(void)
198 *
199 * Machine dependent startup code.
200 *
201 */
202 void
203 cpu_startup(void)
204 {
205 vaddr_t minaddr;
206 vaddr_t maxaddr;
207 u_int loop;
208 char pbuf[9];
209
210 /* Set the CPU control register */
211 cpu_setup(boot_args);
212
213 /* Lock down zero page */
214 vector_page_setprot(VM_PROT_READ);
215
216 /*
217 * Give pmap a chance to set up a few more things now the vm
218 * is initialised
219 */
220 pmap_postinit();
221
222 /*
223 * Initialize error message buffer (at end of core).
224 */
225
226 /* msgbufphys was setup during the secondary boot strap */
227 for (loop = 0; loop < btoc(MSGBUFSIZE); ++loop)
228 pmap_kenter_pa((vaddr_t)msgbufaddr + loop * PAGE_SIZE,
229 msgbufphys + loop * PAGE_SIZE,
230 VM_PROT_READ|VM_PROT_WRITE, 0);
231 pmap_update(pmap_kernel());
232 initmsgbuf(msgbufaddr, round_page(MSGBUFSIZE));
233
234 /*
235 * Identify ourselves for the msgbuf (everything printed earlier will
236 * not be buffered).
237 */
238 printf("%s%s", copyright, version);
239
240 format_bytes(pbuf, sizeof(pbuf), arm_ptob(physmem));
241 printf("total memory = %s\n", pbuf);
242
243 minaddr = 0;
244
245 /*
246 * Allocate a submap for physio
247 */
248 phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
249 VM_PHYS_SIZE, 0, false, NULL);
250
251 format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
252 printf("avail memory = %s\n", pbuf);
253
254 curpcb = lwp_getpcb(&lwp0);
255 curpcb->pcb_flags = 0;
256 curpcb->pcb_un.un_32.pcb32_sp =
257 uvm_lwp_getuarea(&lwp0) + USPACE_SVC_STACK_TOP;
258 curpcb->pcb_tf = (struct trapframe *)curpcb->pcb_un.un_32.pcb32_sp - 1;
259 }
260
261 /*
262 * machine dependent system variables.
263 */
264 static int
265 sysctl_machdep_booted_device(SYSCTLFN_ARGS)
266 {
267 struct sysctlnode node;
268
269 if (booted_device == NULL)
270 return (EOPNOTSUPP);
271
272 node = *rnode;
273 node.sysctl_data = booted_device->dv_xname;
274 node.sysctl_size = strlen(booted_device->dv_xname) + 1;
275 return (sysctl_lookup(SYSCTLFN_CALL(&node)));
276 }
277
278 static int
279 sysctl_machdep_booted_kernel(SYSCTLFN_ARGS)
280 {
281 struct sysctlnode node;
282
283 if (booted_kernel == NULL || booted_kernel[0] == '\0')
284 return (EOPNOTSUPP);
285
286 node = *rnode;
287 node.sysctl_data = booted_kernel;
288 node.sysctl_size = strlen(booted_kernel) + 1;
289 return (sysctl_lookup(SYSCTLFN_CALL(&node)));
290 }
291
292 static int
293 sysctl_machdep_powersave(SYSCTLFN_ARGS)
294 {
295 struct sysctlnode node = *rnode;
296 int error, newval;
297
298 newval = cpu_do_powersave;
299 node.sysctl_data = &newval;
300 if (cpufuncs.cf_sleep == (void *) cpufunc_nullop)
301 node.sysctl_flags &= ~CTLFLAG_READWRITE;
302 error = sysctl_lookup(SYSCTLFN_CALL(&node));
303 if (error || newp == NULL || newval == cpu_do_powersave)
304 return (error);
305
306 if (newval < 0 || newval > 1)
307 return (EINVAL);
308 cpu_do_powersave = newval;
309
310 return (0);
311 }
312
313 SYSCTL_SETUP(sysctl_machdep_setup, "sysctl machdep subtree setup")
314 {
315
316 sysctl_createv(clog, 0, NULL, NULL,
317 CTLFLAG_PERMANENT,
318 CTLTYPE_NODE, "machdep", NULL,
319 NULL, 0, NULL, 0,
320 CTL_MACHDEP, CTL_EOL);
321
322 sysctl_createv(clog, 0, NULL, NULL,
323 CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
324 CTLTYPE_INT, "debug", NULL,
325 NULL, 0, &kernel_debug, 0,
326 CTL_MACHDEP, CPU_DEBUG, CTL_EOL);
327 sysctl_createv(clog, 0, NULL, NULL,
328 CTLFLAG_PERMANENT,
329 CTLTYPE_STRING, "booted_device", NULL,
330 sysctl_machdep_booted_device, 0, NULL, 0,
331 CTL_MACHDEP, CPU_BOOTED_DEVICE, CTL_EOL);
332 sysctl_createv(clog, 0, NULL, NULL,
333 CTLFLAG_PERMANENT,
334 CTLTYPE_STRING, "booted_kernel", NULL,
335 sysctl_machdep_booted_kernel, 0, NULL, 0,
336 CTL_MACHDEP, CPU_BOOTED_KERNEL, CTL_EOL);
337 sysctl_createv(clog, 0, NULL, NULL,
338 CTLFLAG_PERMANENT,
339 CTLTYPE_STRUCT, "console_device", NULL,
340 sysctl_consdev, 0, NULL, sizeof(dev_t),
341 CTL_MACHDEP, CPU_CONSDEV, CTL_EOL);
342 sysctl_createv(clog, 0, NULL, NULL,
343 CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
344 CTLTYPE_INT, "powersave", NULL,
345 sysctl_machdep_powersave, 0, &cpu_do_powersave, 0,
346 CTL_MACHDEP, CPU_POWERSAVE, CTL_EOL);
347 }
348
349 void
350 parse_mi_bootargs(char *args)
351 {
352 int integer;
353
354 if (get_bootconf_option(args, "single", BOOTOPT_TYPE_BOOLEAN, &integer)
355 || get_bootconf_option(args, "-s", BOOTOPT_TYPE_BOOLEAN, &integer))
356 if (integer)
357 boothowto |= RB_SINGLE;
358 if (get_bootconf_option(args, "kdb", BOOTOPT_TYPE_BOOLEAN, &integer)
359 || get_bootconf_option(args, "-k", BOOTOPT_TYPE_BOOLEAN, &integer))
360 if (integer)
361 boothowto |= RB_KDB;
362 if (get_bootconf_option(args, "ask", BOOTOPT_TYPE_BOOLEAN, &integer)
363 || get_bootconf_option(args, "-a", BOOTOPT_TYPE_BOOLEAN, &integer))
364 if (integer)
365 boothowto |= RB_ASKNAME;
366
367 #ifdef PMAP_DEBUG
368 if (get_bootconf_option(args, "pmapdebug", BOOTOPT_TYPE_INT, &integer)) {
369 pmap_debug_level = integer;
370 pmap_debug(pmap_debug_level);
371 }
372 #endif /* PMAP_DEBUG */
373
374 /* if (get_bootconf_option(args, "nbuf", BOOTOPT_TYPE_INT, &integer))
375 bufpages = integer;*/
376
377 #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
378 if (get_bootconf_option(args, "memorydisc", BOOTOPT_TYPE_INT, &integer)
379 || get_bootconf_option(args, "memorydisk", BOOTOPT_TYPE_INT, &integer)) {
380 md_root_size = integer;
381 md_root_size *= 1024;
382 if (md_root_size < 32*1024)
383 md_root_size = 32*1024;
384 if (md_root_size > 2048*1024)
385 md_root_size = 2048*1024;
386 }
387 #endif /* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
388
389 if (get_bootconf_option(args, "quiet", BOOTOPT_TYPE_BOOLEAN, &integer)
390 || get_bootconf_option(args, "-q", BOOTOPT_TYPE_BOOLEAN, &integer))
391 if (integer)
392 boothowto |= AB_QUIET;
393 if (get_bootconf_option(args, "verbose", BOOTOPT_TYPE_BOOLEAN, &integer)
394 || get_bootconf_option(args, "-v", BOOTOPT_TYPE_BOOLEAN, &integer))
395 if (integer)
396 boothowto |= AB_VERBOSE;
397 }
398
399 #ifdef __HAVE_FAST_SOFTINTS
400 #if IPL_SOFTSERIAL != IPL_SOFTNET + 1
401 #error IPLs are screwed up
402 #elif IPL_SOFTNET != IPL_SOFTBIO + 1
403 #error IPLs are screwed up
404 #elif IPL_SOFTBIO != IPL_SOFTCLOCK + 1
405 #error IPLs are screwed up
406 #elif !(IPL_SOFTCLOCK > IPL_NONE)
407 #error IPLs are screwed up
408 #elif (IPL_NONE != 0)
409 #error IPLs are screwed up
410 #endif
411
412 #define SOFTINT2IPLMAP \
413 (((IPL_SOFTSERIAL - IPL_SOFTCLOCK) << (SOFTINT_SERIAL * 4)) | \
414 ((IPL_SOFTNET - IPL_SOFTCLOCK) << (SOFTINT_NET * 4)) | \
415 ((IPL_SOFTBIO - IPL_SOFTCLOCK) << (SOFTINT_BIO * 4)) | \
416 ((IPL_SOFTCLOCK - IPL_SOFTCLOCK) << (SOFTINT_CLOCK * 4)))
417 #define SOFTINT2IPL(l) ((SOFTINT2IPLMAP >> ((l) * 4)) & 0x0f)
418
419 /*
420 * This returns a mask of softint IPLs that be dispatch at <ipl>
421 * SOFTIPLMASK(IPL_NONE) = 0x0000000f
422 * SOFTIPLMASK(IPL_SOFTCLOCK) = 0x0000000e
423 * SOFTIPLMASK(IPL_SOFTBIO) = 0x0000000c
424 * SOFTIPLMASK(IPL_SOFTNET) = 0x00000008
425 * SOFTIPLMASK(IPL_SOFTSERIAL) = 0x00000000
426 */
427 #define SOFTIPLMASK(ipl) ((0x0f << (ipl)) & 0x0f)
428
429 void softint_switch(lwp_t *, int);
430
431 void
432 softint_trigger(uintptr_t mask)
433 {
434 curcpu()->ci_softints |= mask;
435 }
436
437 void
438 softint_init_md(lwp_t *l, u_int level, uintptr_t *machdep)
439 {
440 lwp_t ** lp = &curcpu()->ci_softlwps[level];
441 KASSERT(*lp == NULL || *lp == l);
442 *lp = l;
443 *machdep = 1 << SOFTINT2IPL(level);
444 KASSERT(level != SOFTINT_CLOCK || *machdep == (1 << (IPL_SOFTCLOCK - IPL_SOFTCLOCK)));
445 KASSERT(level != SOFTINT_BIO || *machdep == (1 << (IPL_SOFTBIO - IPL_SOFTCLOCK)));
446 KASSERT(level != SOFTINT_NET || *machdep == (1 << (IPL_SOFTNET - IPL_SOFTCLOCK)));
447 KASSERT(level != SOFTINT_SERIAL || *machdep == (1 << (IPL_SOFTSERIAL - IPL_SOFTCLOCK)));
448 }
449
450 void
451 dosoftints(void)
452 {
453 struct cpu_info * const ci = curcpu();
454 const int opl = ci->ci_cpl;
455 const uint32_t softiplmask = SOFTIPLMASK(opl);
456
457 splhigh();
458 for (;;) {
459 u_int softints = ci->ci_softints & softiplmask;
460 KASSERT((softints != 0) == ((ci->ci_softints >> opl) != 0));
461 KASSERT(opl == IPL_NONE || (softints & (1 << (opl - IPL_SOFTCLOCK))) == 0);
462 if (softints == 0) {
463 splx(opl);
464 return;
465 }
466 #define DOSOFTINT(n) \
467 if (ci->ci_softints & (1 << (IPL_SOFT ## n - IPL_SOFTCLOCK))) { \
468 ci->ci_softints &= \
469 ~(1 << (IPL_SOFT ## n - IPL_SOFTCLOCK)); \
470 softint_switch(ci->ci_softlwps[SOFTINT_ ## n], \
471 IPL_SOFT ## n); \
472 continue; \
473 }
474 DOSOFTINT(SERIAL);
475 DOSOFTINT(NET);
476 DOSOFTINT(BIO);
477 DOSOFTINT(CLOCK);
478 panic("dosoftints wtf (softints=%u?, ipl=%d)", softints, opl);
479 }
480 }
481 #endif /* __HAVE_FAST_SOFTINTS */
482
483 #ifdef MODULAR
484 /*
485 * Push any modules loaded by the boot loader.
486 */
487 void
488 module_init_md(void)
489 {
490 }
491 #endif /* MODULAR */
492
493 int
494 mm_md_physacc(paddr_t pa, vm_prot_t prot)
495 {
496
497 return (pa < ctob(physmem)) ? 0 : EFAULT;
498 }
499