Home | History | Annotate | Line # | Download | only in arm32
arm32_machdep.c revision 1.93
      1  1.93      matt /*	$NetBSD: arm32_machdep.c,v 1.93 2013/06/12 17:13:05 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.93      matt __KERNEL_RCSID(0, "$NetBSD: arm32_machdep.c,v 1.93 2013/06/12 17:13:05 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.92      matt int cpu_umull_present;
    105  1.92      matt const char *cpu_arch = "";
    106  1.91      matt 
    107  1.91      matt int cpu_instruction_set_attributes[6];
    108  1.91      matt int cpu_memory_model_features[4];
    109  1.91      matt int cpu_processor_features[2];
    110  1.91      matt int cpu_media_and_vfp_features[2];
    111   1.1     chris 
    112  1.12   reinoud /* exported variable to be filled in by the bootloaders */
    113   1.1     chris char *booted_kernel;
    114   1.1     chris 
    115   1.1     chris /* Prototypes */
    116   1.1     chris 
    117  1.63       dsl void data_abort_handler(trapframe_t *frame);
    118  1.63       dsl void prefetch_abort_handler(trapframe_t *frame);
    119  1.63       dsl extern void configure(void);
    120   1.1     chris 
    121   1.1     chris /*
    122  1.22   thorpej  * arm32_vector_init:
    123  1.22   thorpej  *
    124  1.22   thorpej  *	Initialize the vector page, and select whether or not to
    125  1.22   thorpej  *	relocate the vectors.
    126  1.22   thorpej  *
    127  1.22   thorpej  *	NOTE: We expect the vector page to be mapped at its expected
    128  1.22   thorpej  *	destination.
    129  1.22   thorpej  */
    130  1.22   thorpej void
    131  1.22   thorpej arm32_vector_init(vaddr_t va, int which)
    132  1.22   thorpej {
    133  1.93      matt #if defined(CPU_ARMV7) || defined(CPU_ARM11)
    134  1.93      matt 	/*
    135  1.93      matt 	 * If this processor has the security extension, don't bother
    136  1.93      matt 	 * to move/map the vector page.  Simply point VBAR to the copy
    137  1.93      matt 	 * that exists in the .text segment.
    138  1.93      matt 	 */
    139  1.93      matt 	if (va == ARM_VECTORS_LOW
    140  1.93      matt 	    && (armreg_pfr1_read() && ARM_PFR1_SEC_MASK) != 0) {
    141  1.93      matt 		extern const uint32_t page0rel[];
    142  1.93      matt 		vector_page = (vaddr_t)page0rel;
    143  1.93      matt 		KASSERT((vector_page & 0x1f) == 0);
    144  1.93      matt 		armreg_vbar_write(vector_page);
    145  1.93      matt #ifdef VERBOSE_INIT_ARM
    146  1.93      matt 		printf(" vbar=%p", page0rel);
    147  1.93      matt #endif
    148  1.93      matt 		cpu_control(CPU_CONTROL_VECRELOC, 0);
    149  1.93      matt 		return;
    150  1.93      matt 	}
    151  1.93      matt #endif
    152  1.83      matt 	if (CPU_IS_PRIMARY(curcpu())) {
    153  1.83      matt 		extern unsigned int page0[], page0_data[];
    154  1.83      matt 		unsigned int *vectors = (int *) va;
    155  1.83      matt 		unsigned int *vectors_data = vectors + (page0_data - page0);
    156  1.83      matt 		int vec;
    157  1.22   thorpej 
    158  1.83      matt 		/*
    159  1.83      matt 		 * Loop through the vectors we're taking over, and copy the
    160  1.83      matt 		 * vector's insn and data word.
    161  1.83      matt 		 */
    162  1.83      matt 		for (vec = 0; vec < ARM_NVEC; vec++) {
    163  1.83      matt 			if ((which & (1 << vec)) == 0) {
    164  1.83      matt 				/* Don't want to take over this vector. */
    165  1.83      matt 				continue;
    166  1.83      matt 			}
    167  1.83      matt 			vectors[vec] = page0[vec];
    168  1.83      matt 			vectors_data[vec] = page0_data[vec];
    169  1.22   thorpej 		}
    170  1.22   thorpej 
    171  1.83      matt 		/* Now sync the vectors. */
    172  1.83      matt 		cpu_icache_sync_range(va, (ARM_NVEC * 2) * sizeof(u_int));
    173  1.22   thorpej 
    174  1.83      matt 		vector_page = va;
    175  1.83      matt 	}
    176  1.30       scw 
    177  1.30       scw 	if (va == ARM_VECTORS_HIGH) {
    178  1.30       scw 		/*
    179  1.30       scw 		 * Assume the MD caller knows what it's doing here, and
    180  1.30       scw 		 * really does want the vector page relocated.
    181  1.30       scw 		 *
    182  1.30       scw 		 * Note: This has to be done here (and not just in
    183  1.30       scw 		 * cpu_setup()) because the vector page needs to be
    184  1.30       scw 		 * accessible *before* cpu_startup() is called.
    185  1.30       scw 		 * Think ddb(9) ...
    186  1.32   thorpej 		 *
    187  1.32   thorpej 		 * NOTE: If the CPU control register is not readable,
    188  1.32   thorpej 		 * this will totally fail!  We'll just assume that
    189  1.32   thorpej 		 * any system that has high vector support has a
    190  1.32   thorpej 		 * readable CPU control register, for now.  If we
    191  1.32   thorpej 		 * ever encounter one that does not, we'll have to
    192  1.32   thorpej 		 * rethink this.
    193  1.30       scw 		 */
    194  1.30       scw 		cpu_control(CPU_CONTROL_VECRELOC, CPU_CONTROL_VECRELOC);
    195  1.30       scw 	}
    196  1.22   thorpej }
    197  1.22   thorpej 
    198  1.22   thorpej /*
    199   1.1     chris  * Debug function just to park the CPU
    200   1.1     chris  */
    201   1.1     chris 
    202   1.1     chris void
    203  1.65    cegger halt(void)
    204   1.1     chris {
    205   1.1     chris 	while (1)
    206   1.1     chris 		cpu_sleep(0);
    207   1.1     chris }
    208   1.1     chris 
    209   1.1     chris 
    210  1.88  jmcneill /* Sync the discs, unmount the filesystems, and adjust the todr */
    211   1.1     chris 
    212   1.1     chris void
    213   1.1     chris bootsync(void)
    214   1.1     chris {
    215  1.58      matt 	static bool bootsyncdone = false;
    216   1.1     chris 
    217   1.1     chris 	if (bootsyncdone) return;
    218   1.1     chris 
    219  1.58      matt 	bootsyncdone = true;
    220   1.1     chris 
    221   1.1     chris 	/* Make sure we can still manage to do things */
    222   1.1     chris 	if (GetCPSR() & I32_bit) {
    223   1.1     chris 		/*
    224   1.1     chris 		 * If we get here then boot has been called without RB_NOSYNC
    225   1.1     chris 		 * and interrupts were disabled. This means the boot() call
    226   1.1     chris 		 * did not come from a user process e.g. shutdown, but must
    227   1.1     chris 		 * have come from somewhere in the kernel.
    228   1.1     chris 		 */
    229   1.1     chris 		IRQenable;
    230   1.1     chris 		printf("Warning IRQ's disabled during boot()\n");
    231   1.1     chris 	}
    232   1.1     chris 
    233   1.1     chris 	vfs_shutdown();
    234  1.88  jmcneill 
    235  1.88  jmcneill 	resettodr();
    236   1.1     chris }
    237   1.1     chris 
    238   1.1     chris /*
    239   1.1     chris  * void cpu_startup(void)
    240   1.1     chris  *
    241  1.76       wiz  * Machine dependent startup code.
    242   1.1     chris  *
    243   1.1     chris  */
    244   1.1     chris void
    245  1.58      matt cpu_startup(void)
    246   1.1     chris {
    247  1.42        pk 	vaddr_t minaddr;
    248  1.42        pk 	vaddr_t maxaddr;
    249  1.42        pk 	u_int loop;
    250   1.1     chris 	char pbuf[9];
    251   1.1     chris 
    252  1.83      matt 	/*
    253  1.83      matt 	 * Until we better locking, we have to live under the kernel lock.
    254  1.83      matt 	 */
    255  1.83      matt 	//KERNEL_LOCK(1, NULL);
    256  1.83      matt 
    257  1.43       wiz 	/* Set the CPU control register */
    258   1.1     chris 	cpu_setup(boot_args);
    259   1.1     chris 
    260   1.1     chris 	/* Lock down zero page */
    261  1.22   thorpej 	vector_page_setprot(VM_PROT_READ);
    262   1.1     chris 
    263   1.1     chris 	/*
    264   1.1     chris 	 * Give pmap a chance to set up a few more things now the vm
    265   1.1     chris 	 * is initialised
    266   1.1     chris 	 */
    267   1.1     chris 	pmap_postinit();
    268   1.1     chris 
    269   1.1     chris 	/*
    270   1.1     chris 	 * Initialize error message buffer (at end of core).
    271   1.1     chris 	 */
    272   1.1     chris 
    273   1.1     chris 	/* msgbufphys was setup during the secondary boot strap */
    274   1.1     chris 	for (loop = 0; loop < btoc(MSGBUFSIZE); ++loop)
    275  1.29   thorpej 		pmap_kenter_pa((vaddr_t)msgbufaddr + loop * PAGE_SIZE,
    276  1.67    cegger 		    msgbufphys + loop * PAGE_SIZE,
    277  1.67    cegger 		    VM_PROT_READ|VM_PROT_WRITE, 0);
    278   1.5     chris 	pmap_update(pmap_kernel());
    279   1.1     chris 	initmsgbuf(msgbufaddr, round_page(MSGBUFSIZE));
    280   1.1     chris 
    281   1.1     chris 	/*
    282   1.1     chris 	 * Identify ourselves for the msgbuf (everything printed earlier will
    283   1.1     chris 	 * not be buffered).
    284   1.1     chris 	 */
    285  1.45     lukem 	printf("%s%s", copyright, version);
    286   1.1     chris 
    287  1.20   thorpej 	format_bytes(pbuf, sizeof(pbuf), arm_ptob(physmem));
    288   1.1     chris 	printf("total memory = %s\n", pbuf);
    289   1.1     chris 
    290  1.42        pk 	minaddr = 0;
    291   1.1     chris 
    292   1.1     chris 	/*
    293   1.1     chris 	 * Allocate a submap for physio
    294   1.1     chris 	 */
    295   1.1     chris 	phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr,
    296  1.47   thorpej 				   VM_PHYS_SIZE, 0, false, NULL);
    297   1.1     chris 
    298   1.1     chris 	format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free));
    299   1.1     chris 	printf("avail memory = %s\n", pbuf);
    300   1.1     chris 
    301  1.81      matt 	struct lwp * const l = &lwp0;
    302  1.81      matt 	struct pcb * const pcb = lwp_getpcb(l);
    303  1.86      matt 	pcb->pcb_ksp = uvm_lwp_getuarea(l) + USPACE_SVC_STACK_TOP;
    304  1.86      matt 	lwp_settrapframe(l, (struct trapframe *)pcb->pcb_ksp - 1);
    305   1.1     chris }
    306   1.1     chris 
    307   1.1     chris /*
    308   1.1     chris  * machine dependent system variables.
    309   1.1     chris  */
    310  1.39    atatat static int
    311  1.39    atatat sysctl_machdep_booted_device(SYSCTLFN_ARGS)
    312  1.39    atatat {
    313  1.39    atatat 	struct sysctlnode node;
    314  1.39    atatat 
    315  1.39    atatat 	if (booted_device == NULL)
    316  1.39    atatat 		return (EOPNOTSUPP);
    317  1.39    atatat 
    318  1.39    atatat 	node = *rnode;
    319  1.85       chs 	node.sysctl_data = __UNCONST(device_xname(booted_device));
    320  1.85       chs 	node.sysctl_size = strlen(device_xname(booted_device)) + 1;
    321  1.39    atatat 	return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    322  1.39    atatat }
    323   1.1     chris 
    324  1.39    atatat static int
    325  1.39    atatat sysctl_machdep_booted_kernel(SYSCTLFN_ARGS)
    326   1.1     chris {
    327  1.39    atatat 	struct sysctlnode node;
    328  1.39    atatat 
    329  1.39    atatat 	if (booted_kernel == NULL || booted_kernel[0] == '\0')
    330   1.1     chris 		return (EOPNOTSUPP);
    331   1.1     chris 
    332  1.39    atatat 	node = *rnode;
    333  1.39    atatat 	node.sysctl_data = booted_kernel;
    334  1.39    atatat 	node.sysctl_size = strlen(booted_kernel) + 1;
    335  1.39    atatat 	return (sysctl_lookup(SYSCTLFN_CALL(&node)));
    336  1.39    atatat }
    337  1.25   thorpej 
    338  1.39    atatat static int
    339  1.92      matt sysctl_machdep_cpu_arch(SYSCTLFN_ARGS)
    340  1.92      matt {
    341  1.92      matt 	struct sysctlnode node = *rnode;
    342  1.92      matt 	node.sysctl_data = __UNCONST(cpu_arch);
    343  1.92      matt 	node.sysctl_size = strlen(cpu_arch) + 1;
    344  1.92      matt 	return sysctl_lookup(SYSCTLFN_CALL(&node));
    345  1.92      matt }
    346  1.92      matt 
    347  1.92      matt static int
    348  1.39    atatat sysctl_machdep_powersave(SYSCTLFN_ARGS)
    349  1.39    atatat {
    350  1.39    atatat 	struct sysctlnode node = *rnode;
    351  1.39    atatat 	int error, newval;
    352  1.25   thorpej 
    353  1.39    atatat 	newval = cpu_do_powersave;
    354  1.39    atatat 	node.sysctl_data = &newval;
    355  1.39    atatat 	if (cpufuncs.cf_sleep == (void *) cpufunc_nullop)
    356  1.44    atatat 		node.sysctl_flags &= ~CTLFLAG_READWRITE;
    357  1.39    atatat 	error = sysctl_lookup(SYSCTLFN_CALL(&node));
    358  1.39    atatat 	if (error || newp == NULL || newval == cpu_do_powersave)
    359  1.39    atatat 		return (error);
    360  1.39    atatat 
    361  1.39    atatat 	if (newval < 0 || newval > 1)
    362  1.39    atatat 		return (EINVAL);
    363  1.39    atatat 	cpu_do_powersave = newval;
    364  1.25   thorpej 
    365  1.39    atatat 	return (0);
    366  1.39    atatat }
    367  1.25   thorpej 
    368  1.39    atatat SYSCTL_SETUP(sysctl_machdep_setup, "sysctl machdep subtree setup")
    369  1.39    atatat {
    370   1.1     chris 
    371  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    372  1.44    atatat 		       CTLFLAG_PERMANENT,
    373  1.39    atatat 		       CTLTYPE_NODE, "machdep", NULL,
    374  1.39    atatat 		       NULL, 0, NULL, 0,
    375  1.39    atatat 		       CTL_MACHDEP, CTL_EOL);
    376  1.39    atatat 
    377  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    378  1.44    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
    379  1.40    atatat 		       CTLTYPE_INT, "debug", NULL,
    380  1.39    atatat 		       NULL, 0, &kernel_debug, 0,
    381  1.41  rearnsha 		       CTL_MACHDEP, CPU_DEBUG, CTL_EOL);
    382  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    383  1.44    atatat 		       CTLFLAG_PERMANENT,
    384  1.39    atatat 		       CTLTYPE_STRING, "booted_device", NULL,
    385  1.39    atatat 		       sysctl_machdep_booted_device, 0, NULL, 0,
    386  1.39    atatat 		       CTL_MACHDEP, CPU_BOOTED_DEVICE, CTL_EOL);
    387  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    388  1.44    atatat 		       CTLFLAG_PERMANENT,
    389  1.39    atatat 		       CTLTYPE_STRING, "booted_kernel", NULL,
    390  1.39    atatat 		       sysctl_machdep_booted_kernel, 0, NULL, 0,
    391  1.39    atatat 		       CTL_MACHDEP, CPU_BOOTED_KERNEL, CTL_EOL);
    392  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    393  1.44    atatat 		       CTLFLAG_PERMANENT,
    394  1.39    atatat 		       CTLTYPE_STRUCT, "console_device", NULL,
    395  1.39    atatat 		       sysctl_consdev, 0, NULL, sizeof(dev_t),
    396  1.39    atatat 		       CTL_MACHDEP, CPU_CONSDEV, CTL_EOL);
    397  1.44    atatat 	sysctl_createv(clog, 0, NULL, NULL,
    398  1.92      matt 		       CTLFLAG_PERMANENT,
    399  1.92      matt 		       CTLTYPE_STRING, "cpu_arch", NULL,
    400  1.92      matt 		       sysctl_machdep_cpu_arch, 0, NULL, 0,
    401  1.92      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    402  1.92      matt 	sysctl_createv(clog, 0, NULL, NULL,
    403  1.44    atatat 		       CTLFLAG_PERMANENT|CTLFLAG_READWRITE,
    404  1.39    atatat 		       CTLTYPE_INT, "powersave", NULL,
    405  1.39    atatat 		       sysctl_machdep_powersave, 0, &cpu_do_powersave, 0,
    406  1.39    atatat 		       CTL_MACHDEP, CPU_POWERSAVE, CTL_EOL);
    407  1.90      matt 	sysctl_createv(clog, 0, NULL, NULL,
    408  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_IMMEDIATE,
    409  1.91      matt 		       CTLTYPE_INT, "cpu_id", NULL,
    410  1.91      matt 		       NULL, curcpu()->ci_arm_cpuid, NULL, 0,
    411  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    412  1.91      matt #ifdef FPU_VFP
    413  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    414  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    415  1.91      matt 		       CTLTYPE_INT, "fpu_id", NULL,
    416  1.91      matt 		       NULL, 0, &cpu_info_store.ci_vfp_id, 0,
    417  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    418  1.91      matt #endif
    419  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    420  1.90      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    421  1.90      matt 		       CTLTYPE_INT, "fpu_present", NULL,
    422  1.90      matt 		       NULL, 0, &cpu_fpu_present, 0,
    423  1.90      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    424  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    425  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    426  1.91      matt 		       CTLTYPE_INT, "neon_present", NULL,
    427  1.91      matt 		       NULL, 0, &cpu_neon_present, 0,
    428  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    429  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    430  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    431  1.91      matt 		       CTLTYPE_STRUCT, "id_isar", NULL,
    432  1.91      matt 		       NULL, 0,
    433  1.91      matt 		       cpu_instruction_set_attributes,
    434  1.91      matt 		       sizeof(cpu_instruction_set_attributes),
    435  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    436  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    437  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    438  1.91      matt 		       CTLTYPE_STRUCT, "id_mmfr", NULL,
    439  1.91      matt 		       NULL, 0,
    440  1.91      matt 		       cpu_memory_model_features,
    441  1.91      matt 		       sizeof(cpu_memory_model_features),
    442  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    443  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    444  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    445  1.91      matt 		       CTLTYPE_STRUCT, "id_pfr", NULL,
    446  1.91      matt 		       NULL, 0,
    447  1.91      matt 		       cpu_processor_features,
    448  1.91      matt 		       sizeof(cpu_processor_features),
    449  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    450  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    451  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    452  1.91      matt 		       CTLTYPE_STRUCT, "id_mvfr", NULL,
    453  1.91      matt 		       NULL, 0,
    454  1.91      matt 		       cpu_media_and_vfp_features,
    455  1.91      matt 		       sizeof(cpu_media_and_vfp_features),
    456  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    457  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    458  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    459  1.91      matt 		       CTLTYPE_INT, "simd_present", NULL,
    460  1.91      matt 		       NULL, 0, &cpu_simd_present, 0,
    461  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    462  1.91      matt 	sysctl_createv(clog, 0, NULL, NULL,
    463  1.91      matt 		       CTLFLAG_PERMANENT|CTLFLAG_READONLY,
    464  1.91      matt 		       CTLTYPE_INT, "simdex_present", NULL,
    465  1.91      matt 		       NULL, 0, &cpu_simdex_present, 0,
    466  1.91      matt 		       CTL_MACHDEP, CTL_CREATE, CTL_EOL);
    467   1.1     chris }
    468   1.1     chris 
    469   1.1     chris void
    470  1.64       dsl parse_mi_bootargs(char *args)
    471   1.1     chris {
    472   1.1     chris 	int integer;
    473   1.1     chris 
    474   1.1     chris 	if (get_bootconf_option(args, "single", BOOTOPT_TYPE_BOOLEAN, &integer)
    475   1.1     chris 	    || get_bootconf_option(args, "-s", BOOTOPT_TYPE_BOOLEAN, &integer))
    476   1.1     chris 		if (integer)
    477   1.1     chris 			boothowto |= RB_SINGLE;
    478   1.1     chris 	if (get_bootconf_option(args, "kdb", BOOTOPT_TYPE_BOOLEAN, &integer)
    479  1.89     skrll 	    || get_bootconf_option(args, "-k", BOOTOPT_TYPE_BOOLEAN, &integer)
    480  1.89     skrll 	    || get_bootconf_option(args, "-d", BOOTOPT_TYPE_BOOLEAN, &integer))
    481   1.1     chris 		if (integer)
    482   1.1     chris 			boothowto |= RB_KDB;
    483   1.1     chris 	if (get_bootconf_option(args, "ask", BOOTOPT_TYPE_BOOLEAN, &integer)
    484   1.1     chris 	    || get_bootconf_option(args, "-a", BOOTOPT_TYPE_BOOLEAN, &integer))
    485   1.1     chris 		if (integer)
    486   1.1     chris 			boothowto |= RB_ASKNAME;
    487   1.1     chris 
    488   1.1     chris #ifdef PMAP_DEBUG
    489   1.1     chris 	if (get_bootconf_option(args, "pmapdebug", BOOTOPT_TYPE_INT, &integer)) {
    490   1.1     chris 		pmap_debug_level = integer;
    491   1.1     chris 		pmap_debug(pmap_debug_level);
    492   1.1     chris 	}
    493   1.1     chris #endif	/* PMAP_DEBUG */
    494   1.1     chris 
    495   1.1     chris /*	if (get_bootconf_option(args, "nbuf", BOOTOPT_TYPE_INT, &integer))
    496   1.1     chris 		bufpages = integer;*/
    497   1.1     chris 
    498  1.74   hannken #if defined(MEMORY_DISK_HOOKS) && !defined(MEMORY_DISK_ROOT_SIZE)
    499   1.1     chris 	if (get_bootconf_option(args, "memorydisc", BOOTOPT_TYPE_INT, &integer)
    500   1.1     chris 	    || get_bootconf_option(args, "memorydisk", BOOTOPT_TYPE_INT, &integer)) {
    501  1.24  jdolecek 		md_root_size = integer;
    502  1.24  jdolecek 		md_root_size *= 1024;
    503  1.24  jdolecek 		if (md_root_size < 32*1024)
    504  1.24  jdolecek 			md_root_size = 32*1024;
    505  1.24  jdolecek 		if (md_root_size > 2048*1024)
    506  1.24  jdolecek 			md_root_size = 2048*1024;
    507   1.1     chris 	}
    508  1.74   hannken #endif	/* MEMORY_DISK_HOOKS && !MEMORY_DISK_ROOT_SIZE */
    509   1.1     chris 
    510   1.1     chris 	if (get_bootconf_option(args, "quiet", BOOTOPT_TYPE_BOOLEAN, &integer)
    511   1.1     chris 	    || get_bootconf_option(args, "-q", BOOTOPT_TYPE_BOOLEAN, &integer))
    512   1.1     chris 		if (integer)
    513   1.1     chris 			boothowto |= AB_QUIET;
    514   1.1     chris 	if (get_bootconf_option(args, "verbose", BOOTOPT_TYPE_BOOLEAN, &integer)
    515   1.1     chris 	    || get_bootconf_option(args, "-v", BOOTOPT_TYPE_BOOLEAN, &integer))
    516   1.1     chris 		if (integer)
    517   1.1     chris 			boothowto |= AB_VERBOSE;
    518   1.1     chris }
    519  1.49      yamt 
    520  1.56      matt #ifdef __HAVE_FAST_SOFTINTS
    521  1.56      matt #if IPL_SOFTSERIAL != IPL_SOFTNET + 1
    522  1.56      matt #error IPLs are screwed up
    523  1.58      matt #elif IPL_SOFTNET != IPL_SOFTBIO + 1
    524  1.58      matt #error IPLs are screwed up
    525  1.58      matt #elif IPL_SOFTBIO != IPL_SOFTCLOCK + 1
    526  1.56      matt #error IPLs are screwed up
    527  1.58      matt #elif !(IPL_SOFTCLOCK > IPL_NONE)
    528  1.56      matt #error IPLs are screwed up
    529  1.58      matt #elif (IPL_NONE != 0)
    530  1.56      matt #error IPLs are screwed up
    531  1.56      matt #endif
    532  1.58      matt 
    533  1.83      matt #ifndef __HAVE_PIC_FAST_SOFTINTS
    534  1.56      matt #define	SOFTINT2IPLMAP \
    535  1.58      matt 	(((IPL_SOFTSERIAL - IPL_SOFTCLOCK) << (SOFTINT_SERIAL * 4)) | \
    536  1.58      matt 	 ((IPL_SOFTNET    - IPL_SOFTCLOCK) << (SOFTINT_NET    * 4)) | \
    537  1.58      matt 	 ((IPL_SOFTBIO    - IPL_SOFTCLOCK) << (SOFTINT_BIO    * 4)) | \
    538  1.58      matt 	 ((IPL_SOFTCLOCK  - IPL_SOFTCLOCK) << (SOFTINT_CLOCK  * 4)))
    539  1.56      matt #define	SOFTINT2IPL(l)	((SOFTINT2IPLMAP >> ((l) * 4)) & 0x0f)
    540  1.56      matt 
    541  1.56      matt /*
    542  1.56      matt  * This returns a mask of softint IPLs that be dispatch at <ipl>
    543  1.59      matt  * SOFTIPLMASK(IPL_NONE)	= 0x0000000f
    544  1.59      matt  * SOFTIPLMASK(IPL_SOFTCLOCK)	= 0x0000000e
    545  1.59      matt  * SOFTIPLMASK(IPL_SOFTBIO)	= 0x0000000c
    546  1.59      matt  * SOFTIPLMASK(IPL_SOFTNET)	= 0x00000008
    547  1.59      matt  * SOFTIPLMASK(IPL_SOFTSERIAL)	= 0x00000000
    548  1.56      matt  */
    549  1.78     skrll #define	SOFTIPLMASK(ipl) ((0x0f << (ipl)) & 0x0f)
    550  1.56      matt 
    551  1.56      matt void softint_switch(lwp_t *, int);
    552  1.56      matt 
    553  1.56      matt void
    554  1.56      matt softint_trigger(uintptr_t mask)
    555  1.56      matt {
    556  1.56      matt 	curcpu()->ci_softints |= mask;
    557  1.56      matt }
    558  1.56      matt 
    559  1.56      matt void
    560  1.56      matt softint_init_md(lwp_t *l, u_int level, uintptr_t *machdep)
    561  1.56      matt {
    562  1.83      matt 	lwp_t ** lp = &l->l_cpu->ci_softlwps[level];
    563  1.56      matt 	KASSERT(*lp == NULL || *lp == l);
    564  1.56      matt 	*lp = l;
    565  1.56      matt 	*machdep = 1 << SOFTINT2IPL(level);
    566  1.59      matt 	KASSERT(level != SOFTINT_CLOCK || *machdep == (1 << (IPL_SOFTCLOCK - IPL_SOFTCLOCK)));
    567  1.59      matt 	KASSERT(level != SOFTINT_BIO || *machdep == (1 << (IPL_SOFTBIO - IPL_SOFTCLOCK)));
    568  1.59      matt 	KASSERT(level != SOFTINT_NET || *machdep == (1 << (IPL_SOFTNET - IPL_SOFTCLOCK)));
    569  1.59      matt 	KASSERT(level != SOFTINT_SERIAL || *machdep == (1 << (IPL_SOFTSERIAL - IPL_SOFTCLOCK)));
    570  1.56      matt }
    571  1.53       mrg 
    572  1.56      matt void
    573  1.56      matt dosoftints(void)
    574  1.56      matt {
    575  1.56      matt 	struct cpu_info * const ci = curcpu();
    576  1.56      matt 	const int opl = ci->ci_cpl;
    577  1.56      matt 	const uint32_t softiplmask = SOFTIPLMASK(opl);
    578  1.56      matt 
    579  1.77     skrll 	splhigh();
    580  1.56      matt 	for (;;) {
    581  1.56      matt 		u_int softints = ci->ci_softints & softiplmask;
    582  1.59      matt 		KASSERT((softints != 0) == ((ci->ci_softints >> opl) != 0));
    583  1.77     skrll 		KASSERT(opl == IPL_NONE || (softints & (1 << (opl - IPL_SOFTCLOCK))) == 0);
    584  1.77     skrll 		if (softints == 0) {
    585  1.77     skrll 			splx(opl);
    586  1.56      matt 			return;
    587  1.77     skrll 		}
    588  1.56      matt #define	DOSOFTINT(n) \
    589  1.77     skrll 		if (ci->ci_softints & (1 << (IPL_SOFT ## n - IPL_SOFTCLOCK))) { \
    590  1.58      matt 			ci->ci_softints &= \
    591  1.58      matt 			    ~(1 << (IPL_SOFT ## n - IPL_SOFTCLOCK)); \
    592  1.56      matt 			softint_switch(ci->ci_softlwps[SOFTINT_ ## n], \
    593  1.56      matt 			    IPL_SOFT ## n); \
    594  1.56      matt 			continue; \
    595  1.56      matt 		}
    596  1.56      matt 		DOSOFTINT(SERIAL);
    597  1.56      matt 		DOSOFTINT(NET);
    598  1.56      matt 		DOSOFTINT(BIO);
    599  1.56      matt 		DOSOFTINT(CLOCK);
    600  1.56      matt 		panic("dosoftints wtf (softints=%u?, ipl=%d)", softints, opl);
    601  1.56      matt 	}
    602  1.53       mrg }
    603  1.83      matt #endif /* !__HAVE_PIC_FAST_SOFTINTS */
    604  1.56      matt #endif /* __HAVE_FAST_SOFTINTS */
    605  1.72      jmmv 
    606  1.72      jmmv #ifdef MODULAR
    607  1.72      jmmv /*
    608  1.72      jmmv  * Push any modules loaded by the boot loader.
    609  1.72      jmmv  */
    610  1.72      jmmv void
    611  1.72      jmmv module_init_md(void)
    612  1.72      jmmv {
    613  1.72      jmmv }
    614  1.72      jmmv #endif /* MODULAR */
    615  1.75     rmind 
    616  1.75     rmind int
    617  1.75     rmind mm_md_physacc(paddr_t pa, vm_prot_t prot)
    618  1.75     rmind {
    619  1.75     rmind 
    620  1.75     rmind 	return (pa < ctob(physmem)) ? 0 : EFAULT;
    621  1.75     rmind }
    622  1.83      matt 
    623  1.83      matt #ifdef __HAVE_CPU_UAREA_ALLOC_IDLELWP
    624  1.83      matt vaddr_t
    625  1.83      matt cpu_uarea_alloc_idlelwp(struct cpu_info *ci)
    626  1.83      matt {
    627  1.83      matt 	const vaddr_t va = idlestack.pv_va + ci->ci_cpuid * USPACE;
    628  1.83      matt 	// printf("%s: %s: va=%lx\n", __func__, ci->ci_data.cpu_name, va);
    629  1.83      matt 	return va;
    630  1.83      matt }
    631  1.83      matt #endif
    632  1.83      matt 
    633  1.83      matt #ifdef MULTIPROCESSOR
    634  1.83      matt void
    635  1.83      matt cpu_boot_secondary_processors(void)
    636  1.83      matt {
    637  1.83      matt 	uint32_t mbox;
    638  1.84     rmind 	kcpuset_export_u32(kcpuset_attached, &mbox, sizeof(mbox));
    639  1.83      matt 	atomic_swap_32(&arm_cpu_mbox, mbox);
    640  1.83      matt 	membar_producer();
    641  1.83      matt #ifdef _ARM_ARCH_7
    642  1.83      matt 	__asm __volatile("sev; sev; sev");
    643  1.83      matt #endif
    644  1.83      matt }
    645  1.83      matt 
    646  1.83      matt void
    647  1.83      matt xc_send_ipi(struct cpu_info *ci)
    648  1.83      matt {
    649  1.83      matt 	KASSERT(kpreempt_disabled());
    650  1.83      matt 	KASSERT(curcpu() != ci);
    651  1.83      matt 
    652  1.83      matt 
    653  1.83      matt 	if (ci) {
    654  1.83      matt 		/* Unicast, remote CPU */
    655  1.83      matt 		printf("%s: -> %s", __func__, ci->ci_data.cpu_name);
    656  1.83      matt 		intr_ipi_send(ci->ci_kcpuset, IPI_XCALL);
    657  1.83      matt 	} else {
    658  1.83      matt 		printf("%s: -> !%s", __func__, ci->ci_data.cpu_name);
    659  1.83      matt 		/* Broadcast to all but ourselves */
    660  1.83      matt 		kcpuset_t *kcp;
    661  1.83      matt 		kcpuset_create(&kcp, (ci != NULL));
    662  1.83      matt 		KASSERT(kcp != NULL);
    663  1.83      matt 		kcpuset_copy(kcp, kcpuset_running);
    664  1.83      matt 		kcpuset_clear(kcp, cpu_index(ci));
    665  1.83      matt 		intr_ipi_send(kcp, IPI_XCALL);
    666  1.83      matt 		kcpuset_destroy(kcp);
    667  1.83      matt 	}
    668  1.83      matt 	printf("\n");
    669  1.83      matt }
    670  1.83      matt #endif /* MULTIPROCESSOR */
    671  1.87      matt 
    672  1.87      matt #ifdef __HAVE_MM_MD_DIRECT_MAPPED_PHYS
    673  1.87      matt bool
    674  1.87      matt mm_md_direct_mapped_phys(paddr_t pa, vaddr_t *vap)
    675  1.87      matt {
    676  1.87      matt 	if (physical_start <= pa && pa < physical_end) {
    677  1.87      matt 		*vap = KERNEL_BASE + (pa - physical_start);
    678  1.87      matt 		return true;
    679  1.87      matt 	}
    680  1.87      matt 
    681  1.87      matt 	return false;
    682  1.87      matt }
    683  1.87      matt #endif
    684