2016-06-29 20:21:42 +08:00
|
|
|
#include <linux/delay.h>
|
2016-01-06 17:27:43 +08:00
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/smp.h>
|
|
|
|
#include "smc.h"
|
|
|
|
|
|
|
|
static int tango_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
|
|
|
{
|
|
|
|
tango_set_aux_boot_addr(virt_to_phys(secondary_startup));
|
|
|
|
tango_start_aux_core(cpu);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2016-06-29 20:21:42 +08:00
|
|
|
#ifdef CONFIG_HOTPLUG_CPU
|
|
|
|
/*
|
|
|
|
* cpu_kill() and cpu_die() run concurrently on different cores.
|
|
|
|
* Firmware will only "kill" a core once it has properly "died".
|
|
|
|
* Try a few times to kill a core before giving up, and sleep
|
|
|
|
* between tries to give that core enough time to die.
|
|
|
|
*/
|
|
|
|
static int tango_cpu_kill(unsigned int cpu)
|
|
|
|
{
|
|
|
|
int i, err;
|
|
|
|
|
|
|
|
for (i = 0; i < 10; ++i) {
|
|
|
|
msleep(10);
|
|
|
|
err = tango_aux_core_kill(cpu);
|
|
|
|
if (!err)
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void tango_cpu_die(unsigned int cpu)
|
|
|
|
{
|
|
|
|
while (tango_aux_core_die(cpu) < 0)
|
|
|
|
cpu_relax();
|
|
|
|
|
|
|
|
panic("cpu %d failed to die\n", cpu);
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
#define tango_cpu_kill NULL
|
|
|
|
#define tango_cpu_die NULL
|
|
|
|
#endif
|
|
|
|
|
2016-01-25 19:33:42 +08:00
|
|
|
static const struct smp_operations tango_smp_ops __initconst = {
|
2016-01-06 17:27:43 +08:00
|
|
|
.smp_boot_secondary = tango_boot_secondary,
|
2016-06-29 20:21:42 +08:00
|
|
|
.cpu_kill = tango_cpu_kill,
|
|
|
|
.cpu_die = tango_cpu_die,
|
2016-01-06 17:27:43 +08:00
|
|
|
};
|
|
|
|
|
|
|
|
CPU_METHOD_OF_DECLARE(tango4_smp, "sigma,tango4-smp", &tango_smp_ops);
|