|
@@ -90,7 +90,8 @@ static void exynos_secondary_init(unsigned int cpu)
|
|
static int exynos_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
|
static int exynos_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
|
{
|
|
{
|
|
unsigned long timeout;
|
|
unsigned long timeout;
|
|
- unsigned long phys_cpu = cpu_logical_map(cpu);
|
|
|
|
|
|
+ u32 mpidr = cpu_logical_map(cpu);
|
|
|
|
+ u32 core_id = MPIDR_AFFINITY_LEVEL(mpidr, 0);
|
|
int ret = -ENOSYS;
|
|
int ret = -ENOSYS;
|
|
|
|
|
|
/*
|
|
/*
|
|
@@ -104,17 +105,18 @@ static int exynos_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
|
* the holding pen - release it, then wait for it to flag
|
|
* the holding pen - release it, then wait for it to flag
|
|
* that it has been released by resetting pen_release.
|
|
* that it has been released by resetting pen_release.
|
|
*
|
|
*
|
|
- * Note that "pen_release" is the hardware CPU ID, whereas
|
|
|
|
|
|
+ * Note that "pen_release" is the hardware CPU core ID, whereas
|
|
* "cpu" is Linux's internal ID.
|
|
* "cpu" is Linux's internal ID.
|
|
*/
|
|
*/
|
|
- write_pen_release(phys_cpu);
|
|
|
|
|
|
+ write_pen_release(core_id);
|
|
|
|
|
|
- if (!exynos_cpu_power_state(cpu)) {
|
|
|
|
- exynos_cpu_power_up(cpu);
|
|
|
|
|
|
+ if (!exynos_cpu_power_state(core_id)) {
|
|
|
|
+ exynos_cpu_power_up(core_id);
|
|
timeout = 10;
|
|
timeout = 10;
|
|
|
|
|
|
/* wait max 10 ms until cpu1 is on */
|
|
/* wait max 10 ms until cpu1 is on */
|
|
- while (exynos_cpu_power_state(cpu) != S5P_CORE_LOCAL_PWR_EN) {
|
|
|
|
|
|
+ while (exynos_cpu_power_state(core_id)
|
|
|
|
+ != S5P_CORE_LOCAL_PWR_EN) {
|
|
if (timeout-- == 0)
|
|
if (timeout-- == 0)
|
|
break;
|
|
break;
|
|
|
|
|
|
@@ -145,20 +147,20 @@ static int exynos_boot_secondary(unsigned int cpu, struct task_struct *idle)
|
|
* Try to set boot address using firmware first
|
|
* Try to set boot address using firmware first
|
|
* and fall back to boot register if it fails.
|
|
* and fall back to boot register if it fails.
|
|
*/
|
|
*/
|
|
- ret = call_firmware_op(set_cpu_boot_addr, phys_cpu, boot_addr);
|
|
|
|
|
|
+ ret = call_firmware_op(set_cpu_boot_addr, core_id, boot_addr);
|
|
if (ret && ret != -ENOSYS)
|
|
if (ret && ret != -ENOSYS)
|
|
goto fail;
|
|
goto fail;
|
|
if (ret == -ENOSYS) {
|
|
if (ret == -ENOSYS) {
|
|
- void __iomem *boot_reg = cpu_boot_reg(phys_cpu);
|
|
|
|
|
|
+ void __iomem *boot_reg = cpu_boot_reg(core_id);
|
|
|
|
|
|
if (IS_ERR(boot_reg)) {
|
|
if (IS_ERR(boot_reg)) {
|
|
ret = PTR_ERR(boot_reg);
|
|
ret = PTR_ERR(boot_reg);
|
|
goto fail;
|
|
goto fail;
|
|
}
|
|
}
|
|
- __raw_writel(boot_addr, cpu_boot_reg(phys_cpu));
|
|
|
|
|
|
+ __raw_writel(boot_addr, cpu_boot_reg(core_id));
|
|
}
|
|
}
|
|
|
|
|
|
- call_firmware_op(cpu_boot, phys_cpu);
|
|
|
|
|
|
+ call_firmware_op(cpu_boot, core_id);
|
|
|
|
|
|
arch_send_wakeup_ipi_mask(cpumask_of(cpu));
|
|
arch_send_wakeup_ipi_mask(cpumask_of(cpu));
|
|
|
|
|
|
@@ -227,22 +229,24 @@ static void __init exynos_smp_prepare_cpus(unsigned int max_cpus)
|
|
* boot register if it fails.
|
|
* boot register if it fails.
|
|
*/
|
|
*/
|
|
for (i = 1; i < max_cpus; ++i) {
|
|
for (i = 1; i < max_cpus; ++i) {
|
|
- unsigned long phys_cpu;
|
|
|
|
unsigned long boot_addr;
|
|
unsigned long boot_addr;
|
|
|
|
+ u32 mpidr;
|
|
|
|
+ u32 core_id;
|
|
int ret;
|
|
int ret;
|
|
|
|
|
|
- phys_cpu = cpu_logical_map(i);
|
|
|
|
|
|
+ mpidr = cpu_logical_map(i);
|
|
|
|
+ core_id = MPIDR_AFFINITY_LEVEL(mpidr, 0);
|
|
boot_addr = virt_to_phys(exynos4_secondary_startup);
|
|
boot_addr = virt_to_phys(exynos4_secondary_startup);
|
|
|
|
|
|
- ret = call_firmware_op(set_cpu_boot_addr, phys_cpu, boot_addr);
|
|
|
|
|
|
+ ret = call_firmware_op(set_cpu_boot_addr, core_id, boot_addr);
|
|
if (ret && ret != -ENOSYS)
|
|
if (ret && ret != -ENOSYS)
|
|
break;
|
|
break;
|
|
if (ret == -ENOSYS) {
|
|
if (ret == -ENOSYS) {
|
|
- void __iomem *boot_reg = cpu_boot_reg(phys_cpu);
|
|
|
|
|
|
+ void __iomem *boot_reg = cpu_boot_reg(core_id);
|
|
|
|
|
|
if (IS_ERR(boot_reg))
|
|
if (IS_ERR(boot_reg))
|
|
break;
|
|
break;
|
|
- __raw_writel(boot_addr, cpu_boot_reg(phys_cpu));
|
|
|
|
|
|
+ __raw_writel(boot_addr, cpu_boot_reg(core_id));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|