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