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