mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-21 11:44:01 +08:00
1af4b3fa19
Update the SMP code for EMEV2 to make use of the shared SCU function scu_power_mode() together with the early setup code in shmobile_secondary_vector_scu. With this patch in place the secondary CPUs modify the SCU setting during early boot instead of letting other CPUs deal with the coherency setting before boot. In other words, we used to setup coherency before boot in emev2_boot_secondary() but that bit is now instead handled by the code in shmobile_secondary_vector_scu. Signed-off-by: Magnus Damm <damm@opensource.se> Signed-off-by: Simon Horman <horms+renesas@verge.net.au>
75 lines
2.2 KiB
C
75 lines
2.2 KiB
C
/*
|
|
* SMP support for Emma Mobile EV2
|
|
*
|
|
* Copyright (C) 2012 Renesas Solutions Corp.
|
|
* Copyright (C) 2012 Magnus Damm
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; version 2 of the License.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/smp.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/io.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/irqchip/arm-gic.h>
|
|
#include <mach/common.h>
|
|
#include <mach/emev2.h>
|
|
#include <asm/smp_plat.h>
|
|
#include <asm/smp_scu.h>
|
|
|
|
#define EMEV2_SCU_BASE 0x1e000000
|
|
|
|
static void __cpuinit emev2_secondary_init(unsigned int cpu)
|
|
{
|
|
gic_secondary_init(0);
|
|
}
|
|
|
|
static int __cpuinit emev2_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
|
{
|
|
arch_send_wakeup_ipi_mask(cpumask_of(cpu_logical_map(cpu)));
|
|
return 0;
|
|
}
|
|
|
|
static void __init emev2_smp_prepare_cpus(unsigned int max_cpus)
|
|
{
|
|
scu_enable(shmobile_scu_base);
|
|
|
|
/* Tell ROM loader about our vector (in headsmp-scu.S) */
|
|
emev2_set_boot_vector(__pa(shmobile_secondary_vector_scu));
|
|
|
|
/* enable cache coherency on booting CPU */
|
|
scu_power_mode(shmobile_scu_base, SCU_PM_NORMAL);
|
|
}
|
|
|
|
static void __init emev2_smp_init_cpus(void)
|
|
{
|
|
unsigned int ncores;
|
|
|
|
/* setup EMEV2 specific SCU base */
|
|
shmobile_scu_base = ioremap(EMEV2_SCU_BASE, PAGE_SIZE);
|
|
emev2_clock_init(); /* need ioremapped SMU */
|
|
|
|
ncores = shmobile_scu_base ? scu_get_core_count(shmobile_scu_base) : 1;
|
|
|
|
shmobile_smp_init_cpus(ncores);
|
|
}
|
|
|
|
struct smp_operations emev2_smp_ops __initdata = {
|
|
.smp_init_cpus = emev2_smp_init_cpus,
|
|
.smp_prepare_cpus = emev2_smp_prepare_cpus,
|
|
.smp_secondary_init = emev2_secondary_init,
|
|
.smp_boot_secondary = emev2_boot_secondary,
|
|
};
|