1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * SMP support for Emma Mobile EV2
4  *
5  * Copyright (C) 2012  Renesas Solutions Corp.
6  * Copyright (C) 2012  Magnus Damm
7  */
8 #include <linux/kernel.h>
9 #include <linux/init.h>
10 #include <linux/smp.h>
11 #include <linux/spinlock.h>
12 #include <linux/io.h>
13 #include <linux/delay.h>
14 #include <asm/smp_plat.h>
15 #include <asm/smp_scu.h>
16 
17 #include "common.h"
18 #include "emev2.h"
19 
20 #define EMEV2_SCU_BASE 0x1e000000
21 #define EMEV2_SMU_BASE 0xe0110000
22 #define SMU_GENERAL_REG0 0x7c0
23 
emev2_boot_secondary(unsigned int cpu,struct task_struct * idle)24 static int emev2_boot_secondary(unsigned int cpu, struct task_struct *idle)
25 {
26 	arch_send_wakeup_ipi_mask(cpumask_of(cpu_logical_map(cpu)));
27 	return 0;
28 }
29 
emev2_smp_prepare_cpus(unsigned int max_cpus)30 static void __init emev2_smp_prepare_cpus(unsigned int max_cpus)
31 {
32 	void __iomem *smu;
33 
34 	/* Tell ROM loader about our vector (in headsmp.S) */
35 	smu = ioremap(EMEV2_SMU_BASE, PAGE_SIZE);
36 	if (smu) {
37 		iowrite32(__pa(shmobile_boot_vector), smu + SMU_GENERAL_REG0);
38 		iounmap(smu);
39 	}
40 
41 	/* setup EMEV2 specific SCU bits */
42 	shmobile_smp_scu_prepare_cpus(EMEV2_SCU_BASE, max_cpus);
43 }
44 
45 const struct smp_operations emev2_smp_ops __initconst = {
46 	.smp_prepare_cpus	= emev2_smp_prepare_cpus,
47 	.smp_boot_secondary	= emev2_boot_secondary,
48 };
49