/* $NetBSD: vexpress_platform.c,v 1.2.2.1 2017/06/06 16:26:53 snj Exp $ */ /*- * Copyright (c) 2017 Jared McNeill * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ #include "opt_multiprocessor.h" #include "opt_fdt_arm.h" #include __KERNEL_RCSID(0, "$NetBSD: vexpress_platform.c,v 1.2.2.1 2017/06/06 16:26:53 snj Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define VEXPRESS_CLCD_NODE_PATH \ "/smb@08000000/motherboard/iofpga@3,00000000/clcd@1f0000" #define VEXPRESS_REF_FREQ 24000000 #define DEVMAP_ALIGN(a) ((a) & ~L1_S_OFFSET) #define DEVMAP_SIZE(s) roundup2((s), L1_S_SIZE) #define DEVMAP_ENTRY(va, pa, sz) \ { \ .pd_va = DEVMAP_ALIGN(va), \ .pd_pa = DEVMAP_ALIGN(pa), \ .pd_size = DEVMAP_SIZE(sz), \ .pd_prot = VM_PROT_READ|VM_PROT_WRITE, \ .pd_cache = PTE_NOCACHE \ } #define DEVMAP_ENTRY_END { 0 } extern struct bus_space armv7_generic_bs_tag; extern struct bus_space armv7_generic_a4x_bs_tag; extern struct arm32_bus_dma_tag armv7_generic_dma_tag; #define SYSREG_BASE 0x1c010000 #define SYSREG_SIZE 0x1000 #define SYS_FLAGS 0x0030 #define SYS_FLAGSCLR 0x0034 #define SYS_CFGDATA 0x00a0 #define SYS_CFGCTRL 0x00a4 #define SYS_CFGCTRL_START __BIT(31) #define SYS_CFGCTRL_WRITE __BIT(30) #define SYS_CFGCTRL_DCC __BITS(29,26) #define SYS_CFGCTRL_FUNCTION __BITS(25,20) #define SYS_CFGCTRL_FUNCTION_SHUTDOWN 8 #define SYS_CFGCTRL_FUNCTION_REBOOT 9 #define SYS_CFGCTRL_SITE __BITS(17,16) #define SYS_CFGCTRL_POSITION __BITS(15,12) #define SYS_CFGCTRL_DEVICE __BITS(11,0) #define SYS_CFGSTAT 0x00a8 #define SYS_CFGSTAT_ERROR __BIT(1) #define SYS_CFGSTAT_COMPLETE __BIT(0) static bus_space_tag_t sysreg_bst = &armv7_generic_bs_tag; static bus_space_handle_t sysreg_bsh; #define SYSREG_WRITE(o, v) \ bus_space_write_4(sysreg_bst, sysreg_bsh, (o), (v)) static void vexpress_a15_smp_init(void) { extern void cortex_mpstart(void); bus_space_tag_t gicd_bst = &armv7_generic_bs_tag; bus_space_handle_t gicd_bsh; int started = 0; /* Bitmask of CPUs (non-BSP) to start */ for (int i = 1; i < arm_cpu_max; i++) started |= __BIT(i); /* Write init vec to SYS_FLAGS register */ SYSREG_WRITE(SYS_FLAGSCLR, 0xffffffff); SYSREG_WRITE(SYS_FLAGS, (uint32_t)cortex_mpstart); /* Map GIC distributor */ bus_space_map(gicd_bst, VEXPRESS_GIC_PBASE + GICD_BASE, 0x1000, 0, &gicd_bsh); /* Enable GIC distributor */ bus_space_write_4(gicd_bst, gicd_bsh, GICD_CTRL, GICD_CTRL_Enable); /* Send sw interrupt to APs */ const uint32_t sgir = GICD_SGIR_TargetListFilter_NotMe; bus_space_write_4(gicd_bst, gicd_bsh, GICD_SGIR, sgir); /* Wait for APs to start */ for (u_int i = 0x10000000; i > 0; i--) { arm_dmb(); if (arm_cpu_hatched == started) break; } /* Disable GIC distributor */ bus_space_write_4(gicd_bst, gicd_bsh, GICD_CTRL, 0); } static const struct pmap_devmap * vexpress_platform_devmap(void) { static const struct pmap_devmap devmap[] = { DEVMAP_ENTRY(VEXPRESS_CORE_VBASE, VEXPRESS_CORE_PBASE, VEXPRESS_CORE_SIZE), DEVMAP_ENTRY(VEXPRESS_GIC_VBASE, VEXPRESS_GIC_PBASE, VEXPRESS_GIC_SIZE), DEVMAP_ENTRY_END }; return devmap; } static void vexpress_platform_bootstrap(void) { bus_space_map(sysreg_bst, SYSREG_BASE, SYSREG_SIZE, 0, &sysreg_bsh); arm_cpu_max = 1 + __SHIFTOUT(armreg_l2ctrl_read(), L2CTRL_NUMCPU); vexpress_a15_smp_init(); if (match_bootconf_option(boot_args, "console", "fb")) { void *fdt_data = __UNCONST(fdtbus_get_data()); const int chosen_off = fdt_path_offset(fdt_data, "/chosen"); if (chosen_off >= 0) fdt_setprop_string(fdt_data, chosen_off, "stdout-path", VEXPRESS_CLCD_NODE_PATH); } } static void vexpress_platform_init_attach_args(struct fdt_attach_args *faa) { faa->faa_bst = &armv7_generic_bs_tag; faa->faa_a4x_bst = &armv7_generic_a4x_bs_tag; faa->faa_dmat = &armv7_generic_dma_tag; } static void vexpress_platform_early_putchar(char c) { } static void vexpress_platform_device_register(device_t self, void *aux) { } static void vexpress_platform_reset(void) { SYSREG_WRITE(SYS_CFGSTAT, 0); SYSREG_WRITE(SYS_CFGDATA, 0); SYSREG_WRITE(SYS_CFGCTRL, SYS_CFGCTRL_START | SYS_CFGCTRL_WRITE | __SHIFTIN(SYS_CFGCTRL_FUNCTION_REBOOT, SYS_CFGCTRL_FUNCTION)); } static u_int vexpress_platform_uart_freq(void) { return VEXPRESS_REF_FREQ; } static const struct arm_platform vexpress_platform = { .devmap = vexpress_platform_devmap, .bootstrap = vexpress_platform_bootstrap, .init_attach_args = vexpress_platform_init_attach_args, .early_putchar = vexpress_platform_early_putchar, .device_register = vexpress_platform_device_register, .reset = vexpress_platform_reset, .delay = gtmr_delay, .uart_freq = vexpress_platform_uart_freq, }; ARM_PLATFORM(vexpress, "arm,vexpress", &vexpress_platform);