Home | History | Annotate | Line # | Download | only in arm32
arm32_machdep.c revision 1.91
      1  1.91      matt /*	$NetBSD: arm32_machdep.c,v 1.91 2013/01/31 22:34:26 matt Exp $	*/
      2   1.1     chris 
      3   1.1     chris /*
      4   1.1     chris  * Copyright (c) 1994-1998 Mark Brinicombe.
      5   1.1     chris  * Copyright (c) 1994 Brini.
      6   1.1     chris  * All rights reserved.
      7   1.1     chris  *
      8   1.1     chris  * This code is derived from software written for Brini by Mark Brinicombe
      9   1.1     chris  *
     10   1.1     chris  * Redistribution and use in source and binary forms, with or without
     11   1.1     chris  * modification, are permitted provided that the following conditions
     12   1.1     chris  * are met:
     13   1.1     chris  * 1. Redistributions of source code must retain the above copyright
     14   1.1     chris  *    notice, this list of conditions and the following disclaimer.
     15   1.1     chris  * 2. Redistributions in binary form must reproduce the above copyright
     16   1.1     chris  *    notice, this list of conditions and the following disclaimer in the
     17   1.1     chris  *    documentation and/or other materials provided with the distribution.
     18   1.1     chris  * 3. All advertising materials mentioning features or use of this software
     19   1.1     chris  *    must display the following acknowledgement:
     20   1.1     chris  *	This product includes software developed by Mark Brinicombe
     21   1.1     chris  *	for the NetBSD Project.
     22   1.1     chris  * 4. The name of the company nor the name of the author may be used to
     23   1.1     chris  *    endorse or promote products derived from this software without specific
     24   1.1     chris  *    prior written permission.
     25   1.1     chris  *
     26   1.1     chris  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     27   1.1     chris  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     28   1.1     chris  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     29   1.1     chris  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     30   1.1     chris  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     31   1.1     chris  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     32   1.1     chris  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     33   1.1     chris  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     34   1.1     chris  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     35   1.1     chris  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     36   1.1     chris  * SUCH DAMAGE.
     37   1.1     chris  *
     38  1.76       wiz  * Machine dependent functions for kernel setup
     39   1.1     chris  *
     40   1.1     chris  * Created      : 17/09/94
     41   1.1     chris  * Updated	: 18/04/01 updated for new wscons
     42   1.1     chris  */
     43  1.37     lukem 
     44  1.37     lukem #include <sys/cdefs.h>
     45  1.91      matt __KERNEL_RCSID(0, "$NetBSD: arm32_machdep.c,v 1.91 2013/01/31 22:34:26 matt Exp $");
     46   1.1     chris 
     47  1.72      jmmv #include "opt_modular.h"
     48   1.1     chris #include "opt_md.h"
     49   1.1     chris #include "opt_pmap_debug.h"
     50   1.1     chris 
     51   1.1     chris #include <sys/param.h>
     52   1.1     chris #include <sys/systm.h>
     53   1.1     chris #include <sys/reboot.h>
     54   1.1     chris #include <sys/proc.h>
     55  1.75     rmind #include <sys/kauth.h>
     56   1.1     chris #include <sys/kernel.h>
     57   1.1     chris #include <sys/mbuf.h>
     58   1.1     chris #include <sys/mount.h>
     59   1.1     chris #include <sys/buf.h>
     60   1.1     chris #include <sys/msgbuf.h>
     61   1.1     chris #include <sys/device.h>
     62   1.1     chris #include <sys/sysctl.h>
     63  1.49      yamt #include <sys/cpu.h>
     64  1.83      matt #include <sys/intr.h>
     65  1.72      jmmv #include <sys/module.h>
     66  1.83      matt #include <sys/atomic.h>
     67  1.83      matt #include <sys/xcall.h>
     68   1.1     chris 
     69  1.77     skrll #include <uvm/uvm_extern.h>
     70  1.77     skrll 
     71   1.1     chris #include <dev/cons.h>
     72  1.75     rmind #include <dev/mm.h>
     73   1.1     chris 
     74   1.7   thorpej #include <arm/arm32/katelib.h>
     75   1.9     chris #include <arm/arm32/machdep.h>
     76  1.81      matt 
     77   1.1     chris #include <machine/bootconfig.h>
     78  1.81      matt #include <machine/pcb.h>
     79  1.81      matt 
     80  1.82      matt void (*cpu_reset_address)(void);	/* Used by locore */
     81  1.82      matt paddr_t cpu_reset_address_paddr;	/* Used by locore */
     82   1.1     chris 
     83   1.1     chris struct vm_map *phys_map = NULL;
     84   1.1     chris 
     85  1.74   hannken #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
     86  1.24  jdolecek extern size_t md_root_size;		/* Memory disc size */
     87  1.74   hannken #endif	/* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
     88   1.1     chris 
     89   1.1     chris pv_addr_t kernelstack;
     90  1.79      matt pv_addr_t abtstack;
     91  1.79      matt pv_addr_t fiqstack;
     92  1.79      matt pv_addr_t irqstack;
     93  1.79      matt pv_addr_t undstack;
     94  1.83      matt pv_addr_t idlestack;
     95   1.1     chris 
     96  1.48  christos void *	msgbufaddr;
     97   1.1     chris extern paddr_t msgbufphys;
     98   1.1     chris 
     99   1.1     chris int kernel_debug = 0;
    100  1.90      matt int cpu_fpu_present;
    101  1.91      matt int cpu_neon_present;
    102  1.91      matt int cpu_simd_present;
    103  1.91      matt int cpu_simdex_present;
    104  1.91      matt 
    105  1.91      matt int cpu_instruction_set_attributes[6];
    106  1.91      matt int cpu_memory_model_features[4];
    107  1.91      matt int cpu_processor_features[2];
    108  1.91      matt int cpu_media_and_vfp_features[2];
    109   1.1     chris 
    110  1.12   reinoud /* exported variable to be filled in by the bootloaders */
    111   1.1     chris char *booted_kernel;
    112   1.1     chris 
    113   1.1     chris /* Prototypes */
    114   1.1     chris 
    115  1.63       dsl void data_abort_handler(trapframe_t *frame);
    116  1.63       dsl void prefetch_abort_handler(trapframe_t *frame);
    117  1.63       dsl extern void configure(void);
    118   1.1     chris 
    119   1.1     chris /*
    120  1.22   thorpej  * arm32_vector_init:
    121  1.22   thorpej  *
    122  1.22   thorpej  *	Initialize the vector page, and select whether or not to
    123  1.22   thorpej  *	relocate the vectors.
    124  1.22   thorpej  *
    125  1.22   thorpej  *	NOTE: We expect the vector page to be mapped at its expected
    126  1.22   thorpej  *	destination.
    127  1.22   thorpej  */
    128  1.22   thorpej void
    129  1.22   thorpej arm32_vector_init(vaddr_t va, int which)
    130  1.22   thorpej {
    131  1.83      matt 	if (CPU_IS_PRIMARY(curcpu())) {
    132  1.83      matt 		extern unsigned int page0[], page0_data[];
    133  1.83      matt 		unsigned int *vectors = (int *) va;
    134  1.83      matt 		unsigned int *vectors_data = vectors + (page0_data - page0);
    135  1.83      matt 		int vec;
    136  1.22   thorpej 
    137  1.83      matt 		/*
    138  1.83      matt 		 * Loop through the vectors we're taking over, and copy the
    139  1.83      matt 		 * vector's insn and data word.
    140  1.83      matt 		 */
    141  1.83      matt 		for (vec = 0; vec < ARM_NVEC; vec++) {
    142  1.83      matt 			if ((which & (1 << vec)) == 0) {
    143  1.83      matt 				/* Don't want to take over this vector. */
    144  1.83      matt 				continue;
    145  1.83      matt 			}
    146  1.83      matt 			vectors[vec] = page0[vec];
    147  1.83      matt 			vectors_data[vec] = page0_data[vec];
    148  1.22   thorpej 		}
    149  1.22   thorpej 
    150  1.83      matt 		/* Now sync the vectors. */
    151  1.83      matt 		cpu_icache_sync_range(va, (ARM_NVEC * 2) * sizeof(u_int));
    152  1.22   thorpej 
    153  1.83      matt 		vector_page = va;
    154  1.83      matt 	}
    155  1.30       scw 
    156  1.30       scw 	if (va == ARM_VECTORS_HIGH) {
    157  1.30       scw 		/*
    158  1.30       scw 		 * Assume the MD caller knows what it's doing here, and
    159  1.30       scw 		 * really does want the vector page relocated.
    160  1.30       scw 		 *
    161  1.30       scw 		 * Note: This has to be done here (and not just in
    162  1.30       scw 		 * cpu_setup()) because the vector page needs to be
    163  1.30       scw 		 * accessible *before* cpu_startup() is called.
    164  1.30       scw 		 * Think ddb(9) ...
    165  1.32   thorpej 		 *
    166  1.32   thorpej 		 * NOTE: If the CPU control register is not readable,
    167  1.32   thorpej 		 * this will totally fail!  We'll just assume that
    168  1.32   thorpej 		 * any system that has high vector support has a
    169  1.32   thorpej 		 * readable CPU control register, for now.  If we
    170  1.32   thorpej 		 * ever encounter one that does not, we'll have to
    171  1.32   thorpej 		 * rethink this.
    172  1.30       scw 		 */
    173  1.30       scw 		cpu_control(CPU_CONTROL_VECRELOC, CPU_CONTROL_VECRELOC);
    174  1.30       scw 	}
    175  1.22   thorpej }
    176  1.22   thorpej 
    177  1.22   thorpej /*
    178   1.1     chris  * Debug function just to park the CPU
    179   1.1     chris  */
    180   1.1     chris 
    181   1.1     chris void
    182  1.65    cegger halt(void)
    183   1.1     chris {
    184   1.1     chris 	while (1)
    185   1.1     chris 		cpu_sleep(0);
    186   1.1     chris }
    187   1.1     chris 
    188   1.1     chris 
    189  1.88  jmcneill /* Sync the discs, unmount the filesystems, and adjust the todr */
    190   1.1     chris 
    191   1.1     chris void
    192   1.1     chris bootsync(void)
    193   1.1     chris {
    194  1.58      matt 	static bool bootsyncdone = false;
    195   1.1     chris 
    196   1.1     chris 	if (bootsyncdone) return;
    197   1.1     chris 
    198  1.58      matt 	bootsyncdone = true;
    199   1.1     chris 
    200   1.1     chris 	/* Make sure we can still manage to do things */
    201   1.1     chris 	if (GetCPSR() & I32_bit) {
    202   1.1     chris 		/*
    203   1.1     chris 		 * If we get here then boot has been called without RB_NOSYNC
    204   1.1     chris 		 * and interrupts were disabled. This means the boot() call
    205   1.1     chris 		 * did not come from a user process e.g. shutdown, but must
    206   1.1     chris 		 * have come from somewhere in the kernel.
    207   1.1     chris 		 */
    208   1.1     chris 		IRQenable;
    209   1.1     chris 		printf("Warning IRQ's disabled during boot()\n");
    210   1.1     chris 	}
    211   1.1     chris 
    212   1.1     chris 	vfs_shutdown();
    213  1.88  jmcneill 
    214  1.88  jmcneill 	resettodr();
    215   1.1     chris }
    216   1.1     chris 
    217   1.1     chris /*
    218   1.1     chris  * void cpu_startup(void)
    219   1.1     chris  *
    220  1.76       wiz  * Machine dependent startup code.
    221   1.1     chris  *
    222   1.1     chris  */
    223   1.1     chris void
    224  1.58      matt cpu_startup(void)
    225   1.1     chris {
    226  1.42        pk 	vaddr_t minaddr;
    227  1.42        pk 	vaddr_t maxaddr;
    228  1.42        pk 	u_int loop;
    229   1.1     chris 	char pbuf[9];
    230   1.1     chris 
    231  1.83      matt 	/*
    232  1.83      matt 	 * Until we better locking, we have to live under the kernel lock.
    233  1.83      matt 	 */
    234  1.83      matt 	//KERNEL_LOCK(1, NULL);
    235  1.83      matt 
    236  1.43       wiz 	/* Set the CPU control register */
    237   1.1     chris 	cpu_setup(boot_args);
    238   1.1     chris 
    239   1.1     chris 	/* Lock down zero page */
    240  1.22   thorpej 	vector_page_setprot(VM_PROT_READ);
    241   1.1     chris 
    242   1.1     chris 	/*
    243   1.1     chris 	 * Give pmap a chance to set up a few more things now the vm
    244   1.1     chris 	 * is initialised
    245   1.1     chris 	 */
    246   1.1     chris 	pmap_postinit();
    247   1.1     chris 
    248   1.1     chris 	/*
    249   1.1     chris 	 * Initialize error message buffer (at end of core).
    250   1.1     chris 	 */
    251   1.1     chris 
    252   1.1     chris 	/* msgbufphys was setup during the secondary boot strap */
    253   1.1     chris 	for (loop = 0; loop < btoc(MSGBUFSIZE); ++loop)
    254  1.29   thorpej 		pmap_kenter_pa((vaddr_t)msgbufaddr + loop * PAGE_SIZE,
    255  1.67    cegger 		    msgbufphys + loop * PAGE_SIZE,
    256  1.67    cegger 		    VM_PROT_READ|VM_PROT_WRITE, 0);
    257   1.5     chris 	pmap_update(pmap_kernel());
    258   1.1     chris 	initmsgbuf(msgbufaddr, round_page(MSGBUFSIZE));
    259   1.1     chris 
    260   1.1     chris 	/*
    261   1.1     chris 	 * Identify ourselves for the msgbuf (everything printed earlier will
    262   1.1     chris 	 * not be buffered).
    263   1.1     chris 	 */
    264  1.45     lukem 	printf("%s%s", copyright, version);
    265   1.1     chris 
    266  1.20   thorpej 	format_bytes(pbuf, sizeof(pbuf), arm_ptob(physmem));
    267   1.1     chris 	printf("total memory = %s\n", pbuf);
    268   1.1     chris 
    269  1.42        pk 	minaddr = 0;
    270   1.1     chris 
    271   1.1     chris 	/*
    272   1.1     chris 	 * Allocate a submap for physio
    273   1.1     chris 	 */
    274   1.1     chris 	phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
    275  1.47   thorpej 				   VM_PHYS_SIZE, 0, false, NULL);
    276   1.1     chris 
    277   1.1     chris 	format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
    278   1.1     chris 	printf("avail memory = %s\n", pbuf);
    279   1.1     chris 
    280  1.81      matt 	struct lwp * const l = &lwp0;
    281  1.81      matt 	struct pcb * const pcb = lwp_getpcb(l);
    282  1.86      matt 	pcb->pcb_ksp = uvm_lwp_getuarea(l) + USPACE_SVC_STACK_TOP;
    283  1.86      matt 	lwp_settrapframe(l, (struct trapframe *)pcb->pcb_ksp - 1);
    284   1.1     chris }
    285   1.1     chris 
    286   1.1     chris /*
    287   1.1     chris  * machine dependent system variables.
    288   1.1     chris  */
    289  1.39    atatat static int
    290  1.39    atatat sysctl_machdep_booted_device(SYSCTLFN_ARGS)
    291  1.39    atatat {
    292  1.39    atatat 	struct sysctlnode node;
    293  1.39    atatat 
    294  1.39    atatat 	if (booted_device == NULL)
    295  1.39    atatat 		return (EOPNOTSUPP);
    296  1.39    atatat 
    297  1.39    atatat 	node = *rnode;
    298  1.85       chs 	node.sysctl_data = __UNCONST(device_xname(booted_device));
    299  1.85       chs 	node.sysctl_size = strlen(device_xname(booted_device)) + 1;
    300  1.39    atatat 	return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    301  1.39    atatat }
    302   1.1     chris 
    303  1.39    atatat static int
    304  1.39    atatat sysctl_machdep_booted_kernel(SYSCTLFN_ARGS)
    305   1.1     chris {
    306  1.39    atatat 	struct sysctlnode node;
    307  1.39    atatat 
    308  1.39    atatat 	if (booted_kernel == NULL || booted_kernel[0] == '\0')
    309   1.1     chris 		return (EOPNOTSUPP);
    310   1.1     chris 
    311  1.39    atatat 	node = *rnode;
    312  1.39    atatat 	node.sysctl_data = booted_kernel;
    313  1.39    atatat 	node.sysctl_size = strlen(booted_kernel) + 1;
    314  1.39    atatat 	return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    315  1.39    atatat }
    316  1.25   thorpej 
    317  1.39    atatat static int
    318  1.39    atatat sysctl_machdep_powersave(SYSCTLFN_ARGS)
    319  1.39    atatat {
    320  1.39    atatat 	struct sysctlnode node = *rnode;
    321  1.39    atatat 	int error, newval;
    322  1.25   thorpej 
    323  1.39    atatat 	newval = cpu_do_powersave;
    324  1.39    atatat 	node.sysctl_data = &newval;
    325  1.39    atatat 	if (cpufuncs.cf_sleep == (void *) cpufunc_nullop)
    326  1.44    atatat 		node.sysctl_flags &= ~CTLFLAG_READWRITE;
    327  1.39    atatat 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
    328  1.39    atatat 	if (error || newp == NULL || newval == cpu_do_powersave)
    329  1.39    atatat 		return (error);
    330  1.39    atatat 
    331  1.39    atatat 	if (newval < 0 || newval > 1)
    332  1.39    atatat 		return (EINVAL);
    333  1.39    atatat 	cpu_do_powersave = newval;
    334  1.25   thorpej 
    335  1.39    atatat 	return (0);
    336  1.39    atatat }
    337  1.25   thorpej 
    338  1.39    atatat SYSCTL_SETUP(sysctl_machdep_setup, "sysctl machdep subtree setup")
    339  1.39    atatat {
    340   1.1     chris 
    341  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    342  1.44    atatat 		       CTLFLAG_PERMANENT,
    343  1.39    atatat 		       CTLTYPE_NODE, "machdep", NULL,
    344  1.39    atatat 		       NULL, 0, NULL, 0,
    345  1.39    atatat 		       CTL_MACHDEP, CTL_EOL);
    346  1.39    atatat 
    347  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    348  1.44    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
    349  1.40    atatat 		       CTLTYPE_INT, "debug", NULL,
    350  1.39    atatat 		       NULL, 0, &kernel_debug, 0,
    351  1.41  rearnsha 		       CTL_MACHDEP, CPU_DEBUG, CTL_EOL);
    352  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    353  1.44    atatat 		       CTLFLAG_PERMANENT,
    354  1.39    atatat 		       CTLTYPE_STRING, "booted_device", NULL,
    355  1.39    atatat 		       sysctl_machdep_booted_device, 0, NULL, 0,
    356  1.39    atatat 		       CTL_MACHDEP, CPU_BOOTED_DEVICE, CTL_EOL);
    357  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    358  1.44    atatat 		       CTLFLAG_PERMANENT,
    359  1.39    atatat 		       CTLTYPE_STRING, "booted_kernel", NULL,
    360  1.39    atatat 		       sysctl_machdep_booted_kernel, 0, NULL, 0,
    361  1.39    atatat 		       CTL_MACHDEP, CPU_BOOTED_KERNEL, CTL_EOL);
    362  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    363  1.44    atatat 		       CTLFLAG_PERMANENT,
    364  1.39    atatat 		       CTLTYPE_STRUCT, "console_device", NULL,
    365  1.39    atatat 		       sysctl_consdev, 0, NULL, sizeof(dev_t),
    366  1.39    atatat 		       CTL_MACHDEP, CPU_CONSDEV, CTL_EOL);
    367  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    368  1.44    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
    369  1.39    atatat 		       CTLTYPE_INT, "powersave", NULL,
    370  1.39    atatat 		       sysctl_machdep_powersave, 0, &cpu_do_powersave, 0,
    371  1.39    atatat 		       CTL_MACHDEP, CPU_POWERSAVE, CTL_EOL);
    372  1.90      matt 	sysctl_createv(clog, 0, NULL, NULL,
    373  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_IMMEDIATE,
    374  1.91      matt 		       CTLTYPE_INT, "cpu_id", NULL,
    375  1.91      matt 		       NULL, curcpu()->ci_arm_cpuid, NULL, 0,
    376  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    377  1.91      matt #ifdef FPU_VFP
    378  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    379  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    380  1.91      matt 		       CTLTYPE_INT, "fpu_id", NULL,
    381  1.91      matt 		       NULL, 0, &cpu_info_store.ci_vfp_id, 0,
    382  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    383  1.91      matt #endif
    384  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    385  1.90      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    386  1.90      matt 		       CTLTYPE_INT, "fpu_present", NULL,
    387  1.90      matt 		       NULL, 0, &cpu_fpu_present, 0,
    388  1.90      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    389  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    390  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    391  1.91      matt 		       CTLTYPE_INT, "neon_present", NULL,
    392  1.91      matt 		       NULL, 0, &cpu_neon_present, 0,
    393  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    394  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    395  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    396  1.91      matt 		       CTLTYPE_STRUCT, "id_isar", NULL,
    397  1.91      matt 		       NULL, 0,
    398  1.91      matt 		       cpu_instruction_set_attributes,
    399  1.91      matt 		       sizeof(cpu_instruction_set_attributes),
    400  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    401  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    402  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    403  1.91      matt 		       CTLTYPE_STRUCT, "id_mmfr", NULL,
    404  1.91      matt 		       NULL, 0,
    405  1.91      matt 		       cpu_memory_model_features,
    406  1.91      matt 		       sizeof(cpu_memory_model_features),
    407  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    408  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    409  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    410  1.91      matt 		       CTLTYPE_STRUCT, "id_pfr", NULL,
    411  1.91      matt 		       NULL, 0,
    412  1.91      matt 		       cpu_processor_features,
    413  1.91      matt 		       sizeof(cpu_processor_features),
    414  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    415  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    416  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    417  1.91      matt 		       CTLTYPE_STRUCT, "id_mvfr", NULL,
    418  1.91      matt 		       NULL, 0,
    419  1.91      matt 		       cpu_media_and_vfp_features,
    420  1.91      matt 		       sizeof(cpu_media_and_vfp_features),
    421  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    422  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    423  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    424  1.91      matt 		       CTLTYPE_INT, "simd_present", NULL,
    425  1.91      matt 		       NULL, 0, &cpu_simd_present, 0,
    426  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    427  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    428  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    429  1.91      matt 		       CTLTYPE_INT, "simdex_present", NULL,
    430  1.91      matt 		       NULL, 0, &cpu_simdex_present, 0,
    431  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    432   1.1     chris }
    433   1.1     chris 
    434   1.1     chris void
    435  1.64       dsl parse_mi_bootargs(char *args)
    436   1.1     chris {
    437   1.1     chris 	int integer;
    438   1.1     chris 
    439   1.1     chris 	if (get_bootconf_option(args, "single", BOOTOPT_TYPE_BOOLEAN, &integer)
    440   1.1     chris 	    || get_bootconf_option(args, "-s", BOOTOPT_TYPE_BOOLEAN, &integer))
    441   1.1     chris 		if (integer)
    442   1.1     chris 			boothowto |= RB_SINGLE;
    443   1.1     chris 	if (get_bootconf_option(args, "kdb", BOOTOPT_TYPE_BOOLEAN, &integer)
    444  1.89     skrll 	    || get_bootconf_option(args, "-k", BOOTOPT_TYPE_BOOLEAN, &integer)
    445  1.89     skrll 	    || get_bootconf_option(args, "-d", BOOTOPT_TYPE_BOOLEAN, &integer))
    446   1.1     chris 		if (integer)
    447   1.1     chris 			boothowto |= RB_KDB;
    448   1.1     chris 	if (get_bootconf_option(args, "ask", BOOTOPT_TYPE_BOOLEAN, &integer)
    449   1.1     chris 	    || get_bootconf_option(args, "-a", BOOTOPT_TYPE_BOOLEAN, &integer))
    450   1.1     chris 		if (integer)
    451   1.1     chris 			boothowto |= RB_ASKNAME;
    452   1.1     chris 
    453   1.1     chris #ifdef PMAP_DEBUG
    454   1.1     chris 	if (get_bootconf_option(args, "pmapdebug", BOOTOPT_TYPE_INT, &integer)) {
    455   1.1     chris 		pmap_debug_level = integer;
    456   1.1     chris 		pmap_debug(pmap_debug_level);
    457   1.1     chris 	}
    458   1.1     chris #endif	/* PMAP_DEBUG */
    459   1.1     chris 
    460   1.1     chris /*	if (get_bootconf_option(args, "nbuf", BOOTOPT_TYPE_INT, &integer))
    461   1.1     chris 		bufpages = integer;*/
    462   1.1     chris 
    463  1.74   hannken #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
    464   1.1     chris 	if (get_bootconf_option(args, "memorydisc", BOOTOPT_TYPE_INT, &integer)
    465   1.1     chris 	    || get_bootconf_option(args, "memorydisk", BOOTOPT_TYPE_INT, &integer)) {
    466  1.24  jdolecek 		md_root_size = integer;
    467  1.24  jdolecek 		md_root_size *= 1024;
    468  1.24  jdolecek 		if (md_root_size < 32*1024)
    469  1.24  jdolecek 			md_root_size = 32*1024;
    470  1.24  jdolecek 		if (md_root_size > 2048*1024)
    471  1.24  jdolecek 			md_root_size = 2048*1024;
    472   1.1     chris 	}
    473  1.74   hannken #endif	/* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
    474   1.1     chris 
    475   1.1     chris 	if (get_bootconf_option(args, "quiet", BOOTOPT_TYPE_BOOLEAN, &integer)
    476   1.1     chris 	    || get_bootconf_option(args, "-q", BOOTOPT_TYPE_BOOLEAN, &integer))
    477   1.1     chris 		if (integer)
    478   1.1     chris 			boothowto |= AB_QUIET;
    479   1.1     chris 	if (get_bootconf_option(args, "verbose", BOOTOPT_TYPE_BOOLEAN, &integer)
    480   1.1     chris 	    || get_bootconf_option(args, "-v", BOOTOPT_TYPE_BOOLEAN, &integer))
    481   1.1     chris 		if (integer)
    482   1.1     chris 			boothowto |= AB_VERBOSE;
    483   1.1     chris }
    484  1.49      yamt 
    485  1.56      matt #ifdef __HAVE_FAST_SOFTINTS
    486  1.56      matt #if IPL_SOFTSERIAL != IPL_SOFTNET + 1
    487  1.56      matt #error IPLs are screwed up
    488  1.58      matt #elif IPL_SOFTNET != IPL_SOFTBIO + 1
    489  1.58      matt #error IPLs are screwed up
    490  1.58      matt #elif IPL_SOFTBIO != IPL_SOFTCLOCK + 1
    491  1.56      matt #error IPLs are screwed up
    492  1.58      matt #elif !(IPL_SOFTCLOCK > IPL_NONE)
    493  1.56      matt #error IPLs are screwed up
    494  1.58      matt #elif (IPL_NONE != 0)
    495  1.56      matt #error IPLs are screwed up
    496  1.56      matt #endif
    497  1.58      matt 
    498  1.83      matt #ifndef __HAVE_PIC_FAST_SOFTINTS
    499  1.56      matt #define	SOFTINT2IPLMAP \
    500  1.58      matt 	(((IPL_SOFTSERIAL - IPL_SOFTCLOCK) << (SOFTINT_SERIAL * 4)) | \
    501  1.58      matt 	 ((IPL_SOFTNET    - IPL_SOFTCLOCK) << (SOFTINT_NET    * 4)) | \
    502  1.58      matt 	 ((IPL_SOFTBIO    - IPL_SOFTCLOCK) << (SOFTINT_BIO    * 4)) | \
    503  1.58      matt 	 ((IPL_SOFTCLOCK  - IPL_SOFTCLOCK) << (SOFTINT_CLOCK  * 4)))
    504  1.56      matt #define	SOFTINT2IPL(l)	((SOFTINT2IPLMAP >> ((l) * 4)) & 0x0f)
    505  1.56      matt 
    506  1.56      matt /*
    507  1.56      matt  * This returns a mask of softint IPLs that be dispatch at <ipl>
    508  1.59      matt  * SOFTIPLMASK(IPL_NONE)	= 0x0000000f
    509  1.59      matt  * SOFTIPLMASK(IPL_SOFTCLOCK)	= 0x0000000e
    510  1.59      matt  * SOFTIPLMASK(IPL_SOFTBIO)	= 0x0000000c
    511  1.59      matt  * SOFTIPLMASK(IPL_SOFTNET)	= 0x00000008
    512  1.59      matt  * SOFTIPLMASK(IPL_SOFTSERIAL)	= 0x00000000
    513  1.56      matt  */
    514  1.78     skrll #define	SOFTIPLMASK(ipl) ((0x0f << (ipl)) & 0x0f)
    515  1.56      matt 
    516  1.56      matt void softint_switch(lwp_t *, int);
    517  1.56      matt 
    518  1.56      matt void
    519  1.56      matt softint_trigger(uintptr_t mask)
    520  1.56      matt {
    521  1.56      matt 	curcpu()->ci_softints |= mask;
    522  1.56      matt }
    523  1.56      matt 
    524  1.56      matt void
    525  1.56      matt softint_init_md(lwp_t *l, u_int level, uintptr_t *machdep)
    526  1.56      matt {
    527  1.83      matt 	lwp_t ** lp = &l->l_cpu->ci_softlwps[level];
    528  1.56      matt 	KASSERT(*lp == NULL || *lp == l);
    529  1.56      matt 	*lp = l;
    530  1.56      matt 	*machdep = 1 << SOFTINT2IPL(level);
    531  1.59      matt 	KASSERT(level != SOFTINT_CLOCK || *machdep == (1 << (IPL_SOFTCLOCK - IPL_SOFTCLOCK)));
    532  1.59      matt 	KASSERT(level != SOFTINT_BIO || *machdep == (1 << (IPL_SOFTBIO - IPL_SOFTCLOCK)));
    533  1.59      matt 	KASSERT(level != SOFTINT_NET || *machdep == (1 << (IPL_SOFTNET - IPL_SOFTCLOCK)));
    534  1.59      matt 	KASSERT(level != SOFTINT_SERIAL || *machdep == (1 << (IPL_SOFTSERIAL - IPL_SOFTCLOCK)));
    535  1.56      matt }
    536  1.53       mrg 
    537  1.56      matt void
    538  1.56      matt dosoftints(void)
    539  1.56      matt {
    540  1.56      matt 	struct cpu_info * const ci = curcpu();
    541  1.56      matt 	const int opl = ci->ci_cpl;
    542  1.56      matt 	const uint32_t softiplmask = SOFTIPLMASK(opl);
    543  1.56      matt 
    544  1.77     skrll 	splhigh();
    545  1.56      matt 	for (;;) {
    546  1.56      matt 		u_int softints = ci->ci_softints & softiplmask;
    547  1.59      matt 		KASSERT((softints != 0) == ((ci->ci_softints >> opl) != 0));
    548  1.77     skrll 		KASSERT(opl == IPL_NONE || (softints & (1 << (opl - IPL_SOFTCLOCK))) == 0);
    549  1.77     skrll 		if (softints == 0) {
    550  1.77     skrll 			splx(opl);
    551  1.56      matt 			return;
    552  1.77     skrll 		}
    553  1.56      matt #define	DOSOFTINT(n) \
    554  1.77     skrll 		if (ci->ci_softints & (1 << (IPL_SOFT ## n - IPL_SOFTCLOCK))) { \
    555  1.58      matt 			ci->ci_softints &= \
    556  1.58      matt 			    ~(1 << (IPL_SOFT ## n - IPL_SOFTCLOCK)); \
    557  1.56      matt 			softint_switch(ci->ci_softlwps[SOFTINT_ ## n], \
    558  1.56      matt 			    IPL_SOFT ## n); \
    559  1.56      matt 			continue; \
    560  1.56      matt 		}
    561  1.56      matt 		DOSOFTINT(SERIAL);
    562  1.56      matt 		DOSOFTINT(NET);
    563  1.56      matt 		DOSOFTINT(BIO);
    564  1.56      matt 		DOSOFTINT(CLOCK);
    565  1.56      matt 		panic("dosoftints wtf (softints=%u?, ipl=%d)", softints, opl);
    566  1.56      matt 	}
    567  1.53       mrg }
    568  1.83      matt #endif /* !__HAVE_PIC_FAST_SOFTINTS */
    569  1.56      matt #endif /* __HAVE_FAST_SOFTINTS */
    570  1.72      jmmv 
    571  1.72      jmmv #ifdef MODULAR
    572  1.72      jmmv /*
    573  1.72      jmmv  * Push any modules loaded by the boot loader.
    574  1.72      jmmv  */
    575  1.72      jmmv void
    576  1.72      jmmv module_init_md(void)
    577  1.72      jmmv {
    578  1.72      jmmv }
    579  1.72      jmmv #endif /* MODULAR */
    580  1.75     rmind 
    581  1.75     rmind int
    582  1.75     rmind mm_md_physacc(paddr_t pa, vm_prot_t prot)
    583  1.75     rmind {
    584  1.75     rmind 
    585  1.75     rmind 	return (pa < ctob(physmem)) ? 0 : EFAULT;
    586  1.75     rmind }
    587  1.83      matt 
    588  1.83      matt #ifdef __HAVE_CPU_UAREA_ALLOC_IDLELWP
    589  1.83      matt vaddr_t
    590  1.83      matt cpu_uarea_alloc_idlelwp(struct cpu_info *ci)
    591  1.83      matt {
    592  1.83      matt 	const vaddr_t va = idlestack.pv_va + ci->ci_cpuid * USPACE;
    593  1.83      matt 	// printf("%s: %s: va=%lx\n", __func__, ci->ci_data.cpu_name, va);
    594  1.83      matt 	return va;
    595  1.83      matt }
    596  1.83      matt #endif
    597  1.83      matt 
    598  1.83      matt #ifdef MULTIPROCESSOR
    599  1.83      matt void
    600  1.83      matt cpu_boot_secondary_processors(void)
    601  1.83      matt {
    602  1.83      matt 	uint32_t mbox;
    603  1.84     rmind 	kcpuset_export_u32(kcpuset_attached, &mbox, sizeof(mbox));
    604  1.83      matt 	atomic_swap_32(&arm_cpu_mbox, mbox);
    605  1.83      matt 	membar_producer();
    606  1.83      matt #ifdef _ARM_ARCH_7
    607  1.83      matt 	__asm __volatile("sev; sev; sev");
    608  1.83      matt #endif
    609  1.83      matt }
    610  1.83      matt 
    611  1.83      matt void
    612  1.83      matt xc_send_ipi(struct cpu_info *ci)
    613  1.83      matt {
    614  1.83      matt 	KASSERT(kpreempt_disabled());
    615  1.83      matt 	KASSERT(curcpu() != ci);
    616  1.83      matt 
    617  1.83      matt 
    618  1.83      matt 	if (ci) {
    619  1.83      matt 		/* Unicast, remote CPU */
    620  1.83      matt 		printf("%s: -> %s", __func__, ci->ci_data.cpu_name);
    621  1.83      matt 		intr_ipi_send(ci->ci_kcpuset, IPI_XCALL);
    622  1.83      matt 	} else {
    623  1.83      matt 		printf("%s: -> !%s", __func__, ci->ci_data.cpu_name);
    624  1.83      matt 		/* Broadcast to all but ourselves */
    625  1.83      matt 		kcpuset_t *kcp;
    626  1.83      matt 		kcpuset_create(&kcp, (ci != NULL));
    627  1.83      matt 		KASSERT(kcp != NULL);
    628  1.83      matt 		kcpuset_copy(kcp, kcpuset_running);
    629  1.83      matt 		kcpuset_clear(kcp, cpu_index(ci));
    630  1.83      matt 		intr_ipi_send(kcp, IPI_XCALL);
    631  1.83      matt 		kcpuset_destroy(kcp);
    632  1.83      matt 	}
    633  1.83      matt 	printf("\n");
    634  1.83      matt }
    635  1.83      matt #endif /* MULTIPROCESSOR */
    636  1.87      matt 
    637  1.87      matt #ifdef __HAVE_MM_MD_DIRECT_MAPPED_PHYS
    638  1.87      matt bool
    639  1.87      matt mm_md_direct_mapped_phys(paddr_t pa, vaddr_t *vap)
    640  1.87      matt {
    641  1.87      matt 	if (physical_start <= pa && pa < physical_end) {
    642  1.87      matt 		*vap = KERNEL_BASE + (pa - physical_start);
    643  1.87      matt 		return true;
    644  1.87      matt 	}
    645  1.87      matt 
    646  1.87      matt 	return false;
    647  1.87      matt }
    648  1.87      matt #endif
    649