Home | History | Annotate | Line # | Download | only in arm32
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