int shmobile_platform_cpu_kill(unsigned int cpu) { if (is_r8a7779()) return r8a7779_platform_cpu_kill(cpu); return 1; }
static int r8a7779_cpu_kill(unsigned int cpu) { if (shmobile_smp_scu_cpu_kill(cpu)) return r8a7779_platform_cpu_kill(cpu); return 0; }
static void __init r8a7779_smp_prepare_cpus(unsigned int max_cpus) { /* Map the reset vector (in headsmp-scu.S, headsmp.S) */ __raw_writel(__pa(shmobile_boot_vector), AVECR); shmobile_boot_fn = virt_to_phys(shmobile_boot_scu); shmobile_boot_arg = (unsigned long)shmobile_scu_base; /* setup r8a7779 specific SCU bits */ shmobile_scu_base = IOMEM(R8A7779_SCU_BASE); shmobile_smp_scu_prepare_cpus(max_cpus); r8a7779_pm_init(); /* power off secondary CPUs */ r8a7779_platform_cpu_kill(1); r8a7779_platform_cpu_kill(2); r8a7779_platform_cpu_kill(3); }
void __init r8a7779_smp_prepare_cpus(void) { int cpu = cpu_logical_map(0); scu_enable(scu_base_addr()); /* Map the reset vector (in headsmp.S) */ __raw_writel(__pa(shmobile_secondary_vector), AVECR); /* enable cache coherency on CPU0 */ modify_scu_cpu_psr(0, 3 << (cpu * 8)); r8a7779_pm_init(); /* power off secondary CPUs */ r8a7779_platform_cpu_kill(1); r8a7779_platform_cpu_kill(2); r8a7779_platform_cpu_kill(3); }
static int __maybe_unused r8a7779_cpu_kill(unsigned int cpu) { int k; /* this function is running on another CPU than the offline target, * here we need wait for shutdown code in platform_cpu_die() to * finish before asking SoC-specific code to power off the CPU core. */ for (k = 0; k < 1000; k++) { if (shmobile_cpu_is_dead(cpu)) return r8a7779_platform_cpu_kill(cpu); mdelay(1); } return 0; }