1 /*- 2 * Copyright (c) 2014 Ruslan Bukin <br@bsdpad.com> 3 * All rights reserved. 4 * 5 * This software was developed by SRI International and the University of 6 * Cambridge Computer Laboratory under DARPA/AFRL contract (FA8750-10-C-0237) 7 * ("CTSRD"), as part of the DARPA CRASH research programme. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 */ 30 31 #include <sys/cdefs.h> 32 __FBSDID("$FreeBSD$"); 33 #include <sys/param.h> 34 #include <sys/systm.h> 35 #include <sys/bus.h> 36 #include <sys/kernel.h> 37 #include <sys/lock.h> 38 #include <sys/mutex.h> 39 #include <sys/smp.h> 40 41 #include <machine/smp.h> 42 #include <machine/fdt.h> 43 #include <machine/intr.h> 44 45 #define SCU_PHYSBASE 0xFFFEC000 46 #define SCU_SIZE 0x100 47 48 #define SCU_CONTROL_REG 0x00 49 #define SCU_CONTROL_ENABLE (1 << 0) 50 #define SCU_CONFIG_REG 0x04 51 #define SCU_CONFIG_REG_NCPU_MASK 0x03 52 #define SCU_CPUPOWER_REG 0x08 53 #define SCU_INV_TAGS_REG 0x0c 54 #define SCU_DIAG_CONTROL 0x30 55 #define SCU_DIAG_DISABLE_MIGBIT (1 << 0) 56 #define SCU_FILTER_START_REG 0x40 57 #define SCU_FILTER_END_REG 0x44 58 #define SCU_SECURE_ACCESS_REG 0x50 59 #define SCU_NONSECURE_ACCESS_REG 0x54 60 61 #define RSTMGR_PHYSBASE 0xFFD05000 62 #define RSTMGR_SIZE 0x100 63 #define MPUMODRST 0x10 64 #define MPUMODRST_CPU1 (1 << 1) 65 66 #define RAM_PHYSBASE 0x0 67 #define RAM_SIZE 0x1000 68 69 extern char *mpentry_addr; 70 static void socfpga_trampoline(void); 71 72 static void 73 socfpga_trampoline(void) 74 { 75 76 __asm __volatile( 77 "ldr pc, 1f\n" 78 ".globl mpentry_addr\n" 79 "mpentry_addr:\n" 80 "1: .space 4\n"); 81 } 82 83 void 84 platform_mp_init_secondary(void) 85 { 86 87 gic_init_secondary(); 88 } 89 90 void 91 platform_mp_setmaxid(void) 92 { 93 int hwcpu, ncpu; 94 95 /* If we've already set this don't bother to do it again. */ 96 if (mp_ncpus != 0) 97 return; 98 99 hwcpu = 2; 100 101 ncpu = hwcpu; 102 TUNABLE_INT_FETCH("hw.ncpu", &ncpu); 103 if (ncpu < 1 || ncpu > hwcpu) 104 ncpu = hwcpu; 105 106 mp_ncpus = ncpu; 107 mp_maxid = ncpu - 1; 108 } 109 110 int 111 platform_mp_probe(void) 112 { 113 114 if (mp_ncpus == 0) 115 platform_mp_setmaxid(); 116 117 return (mp_ncpus > 1); 118 } 119 120 void 121 platform_mp_start_ap(void) 122 { 123 bus_space_handle_t scu, rst, ram; 124 int reg; 125 126 if (bus_space_map(fdtbus_bs_tag, SCU_PHYSBASE, 127 SCU_SIZE, 0, &scu) != 0) 128 panic("Couldn't map the SCU\n"); 129 if (bus_space_map(fdtbus_bs_tag, RSTMGR_PHYSBASE, 130 RSTMGR_SIZE, 0, &rst) != 0) 131 panic("Couldn't map the reset manager (RSTMGR)\n"); 132 if (bus_space_map(fdtbus_bs_tag, RAM_PHYSBASE, 133 RAM_SIZE, 0, &ram) != 0) 134 panic("Couldn't map the first physram page\n"); 135 136 /* Invalidate SCU cache tags */ 137 bus_space_write_4(fdtbus_bs_tag, scu, 138 SCU_INV_TAGS_REG, 0x0000ffff); 139 140 /* 141 * Erratum ARM/MP: 764369 (problems with cache maintenance). 142 * Setting the "disable-migratory bit" in the undocumented SCU 143 * Diagnostic Control Register helps work around the problem. 144 */ 145 reg = bus_space_read_4(fdtbus_bs_tag, scu, SCU_DIAG_CONTROL); 146 reg |= (SCU_DIAG_DISABLE_MIGBIT); 147 bus_space_write_4(fdtbus_bs_tag, scu, SCU_DIAG_CONTROL, reg); 148 149 /* Put CPU1 to reset state */ 150 bus_space_write_4(fdtbus_bs_tag, rst, MPUMODRST, MPUMODRST_CPU1); 151 152 /* Enable the SCU, then clean the cache on this core */ 153 reg = bus_space_read_4(fdtbus_bs_tag, scu, SCU_CONTROL_REG); 154 reg |= (SCU_CONTROL_ENABLE); 155 bus_space_write_4(fdtbus_bs_tag, scu, SCU_CONTROL_REG, reg); 156 157 /* Set up trampoline code */ 158 mpentry_addr = (char *)pmap_kextract((vm_offset_t)mpentry); 159 bus_space_write_region_4(fdtbus_bs_tag, ram, 0, 160 (uint32_t *)&socfpga_trampoline, 8); 161 162 cpu_idcache_wbinv_all(); 163 cpu_l2cache_wbinv_all(); 164 165 /* Put CPU1 out from reset */ 166 bus_space_write_4(fdtbus_bs_tag, rst, MPUMODRST, 0); 167 168 armv7_sev(); 169 170 bus_space_unmap(fdtbus_bs_tag, scu, SCU_SIZE); 171 bus_space_unmap(fdtbus_bs_tag, rst, RSTMGR_SIZE); 172 bus_space_unmap(fdtbus_bs_tag, ram, RAM_SIZE); 173 } 174 175 void 176 platform_ipi_send(cpuset_t cpus, u_int ipi) 177 { 178 179 pic_ipi_send(cpus, ipi); 180 } 181