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