1 /* 2 * Copyright 2011 Freescale Semiconductor, Inc. 3 * Copyright 2011 Linaro Ltd. 4 * 5 * The code contained herein is licensed under the GNU General Public 6 * License. You may obtain a copy of the GNU General Public License 7 * Version 2 or later at the following locations: 8 * 9 * http://www.opensource.org/licenses/gpl-license.html 10 * http://www.gnu.org/copyleft/gpl.html 11 */ 12 13 #include <linux/init.h> 14 #include <linux/smp.h> 15 #include <asm/page.h> 16 #include <asm/smp_scu.h> 17 #include <asm/hardware/gic.h> 18 #include <asm/mach/map.h> 19 #include <mach/common.h> 20 #include <mach/hardware.h> 21 22 static void __iomem *scu_base; 23 24 static struct map_desc scu_io_desc __initdata = { 25 /* .virtual and .pfn are run-time assigned */ 26 .length = SZ_4K, 27 .type = MT_DEVICE, 28 }; 29 30 void __init imx_scu_map_io(void) 31 { 32 unsigned long base; 33 34 /* Get SCU base */ 35 asm("mrc p15, 4, %0, c15, c0, 0" : "=r" (base)); 36 37 scu_io_desc.virtual = IMX_IO_P2V(base); 38 scu_io_desc.pfn = __phys_to_pfn(base); 39 iotable_init(&scu_io_desc, 1); 40 41 scu_base = IMX_IO_ADDRESS(base); 42 } 43 44 static void __cpuinit imx_secondary_init(unsigned int cpu) 45 { 46 /* 47 * if any interrupts are already enabled for the primary 48 * core (e.g. timer irq), then they will not have been enabled 49 * for us: do so 50 */ 51 gic_secondary_init(0); 52 } 53 54 static int __cpuinit imx_boot_secondary(unsigned int cpu, struct task_struct *idle) 55 { 56 imx_set_cpu_jump(cpu, v7_secondary_startup); 57 imx_enable_cpu(cpu, true); 58 return 0; 59 } 60 61 /* 62 * Initialise the CPU possible map early - this describes the CPUs 63 * which may be present or become present in the system. 64 */ 65 static void __init imx_smp_init_cpus(void) 66 { 67 int i, ncores; 68 69 ncores = scu_get_core_count(scu_base); 70 71 for (i = 0; i < ncores; i++) 72 set_cpu_possible(i, true); 73 74 set_smp_cross_call(gic_raise_softirq); 75 } 76 77 void imx_smp_prepare(void) 78 { 79 scu_enable(scu_base); 80 } 81 82 static void __init imx_smp_prepare_cpus(unsigned int max_cpus) 83 { 84 imx_smp_prepare(); 85 } 86 87 struct smp_operations imx_smp_ops __initdata = { 88 .smp_init_cpus = imx_smp_init_cpus, 89 .smp_prepare_cpus = imx_smp_prepare_cpus, 90 .smp_secondary_init = imx_secondary_init, 91 .smp_boot_secondary = imx_boot_secondary, 92 #ifdef CONFIG_HOTPLUG_CPU 93 .cpu_die = imx_cpu_die, 94 #endif 95 }; 96