ARM: mvebu: move Armada XP specific SMP initialization to platsmp.c
The pmsu.c driver contained an armada_xp_boot_cpu() function that sets the boot address of a secondary CPUs and deasserts the reset. However, the Armada 375 needs a slightly different logic, so it makes more sense to move this code into the Armada XP specific platsmp.c. In order to achieve this, the mvebu_pmsu_set_cpu_boot_addr() function is exported. It will be needed for both the Armada XP and Armada 38x SMP implementations. Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com> Link: https://lkml.kernel.org/r/1397483648-26611-2-git-send-email-thomas.petazzoni@free-electrons.com Signed-off-by: Jason Cooper <jason@lakedaemon.net>
This commit is contained in:
parent
d269a36ae7
commit
05ad690608
@ -19,6 +19,7 @@
|
|||||||
|
|
||||||
void mvebu_restart(enum reboot_mode mode, const char *cmd);
|
void mvebu_restart(enum reboot_mode mode, const char *cmd);
|
||||||
int mvebu_cpu_reset_deassert(int cpu);
|
int mvebu_cpu_reset_deassert(int cpu);
|
||||||
|
void mvebu_pmsu_set_cpu_boot_addr(int hw_cpu, void *boot_addr);
|
||||||
|
|
||||||
void armada_xp_cpu_die(unsigned int cpu);
|
void armada_xp_cpu_die(unsigned int cpu);
|
||||||
|
|
||||||
|
@ -77,9 +77,17 @@ static void armada_xp_secondary_init(unsigned int cpu)
|
|||||||
|
|
||||||
static int armada_xp_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
static int armada_xp_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
||||||
{
|
{
|
||||||
|
int ret, hw_cpu;
|
||||||
|
|
||||||
pr_info("Booting CPU %d\n", cpu);
|
pr_info("Booting CPU %d\n", cpu);
|
||||||
|
|
||||||
armada_xp_boot_cpu(cpu, armada_xp_secondary_startup);
|
hw_cpu = cpu_logical_map(cpu);
|
||||||
|
mvebu_pmsu_set_cpu_boot_addr(hw_cpu, armada_xp_secondary_startup);
|
||||||
|
ret = mvebu_cpu_reset_deassert(hw_cpu);
|
||||||
|
if (ret) {
|
||||||
|
pr_warn("unable to boot CPU: %d\n", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -41,36 +41,12 @@ static struct of_device_id of_pmsu_table[] = {
|
|||||||
{ /* end of list */ },
|
{ /* end of list */ },
|
||||||
};
|
};
|
||||||
|
|
||||||
static void mvebu_pmsu_set_cpu_boot_addr(int hw_cpu, void *boot_addr)
|
void mvebu_pmsu_set_cpu_boot_addr(int hw_cpu, void *boot_addr)
|
||||||
{
|
{
|
||||||
writel(virt_to_phys(boot_addr), pmsu_mp_base +
|
writel(virt_to_phys(boot_addr), pmsu_mp_base +
|
||||||
PMSU_BOOT_ADDR_REDIRECT_OFFSET(hw_cpu));
|
PMSU_BOOT_ADDR_REDIRECT_OFFSET(hw_cpu));
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_SMP
|
|
||||||
int armada_xp_boot_cpu(unsigned int cpu_id, void *boot_addr)
|
|
||||||
{
|
|
||||||
int hw_cpu, ret;
|
|
||||||
|
|
||||||
if (!pmsu_mp_base) {
|
|
||||||
pr_warn("Can't boot CPU. PMSU is uninitialized\n");
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
|
|
||||||
hw_cpu = cpu_logical_map(cpu_id);
|
|
||||||
|
|
||||||
mvebu_pmsu_set_cpu_boot_addr(hw_cpu, boot_addr);
|
|
||||||
|
|
||||||
ret = mvebu_cpu_reset_deassert(hw_cpu);
|
|
||||||
if (ret) {
|
|
||||||
pr_warn("unable to boot CPU: %d\n", ret);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static int __init armada_370_xp_pmsu_init(void)
|
static int __init armada_370_xp_pmsu_init(void)
|
||||||
{
|
{
|
||||||
struct device_node *np;
|
struct device_node *np;
|
||||||
|
Loading…
x
Reference in New Issue
Block a user