With commit a0ae0240 (ARM: kernel: add device tree init map function), the cpu id value may include the cluster id and is no longer 0-3, so we need to mask it now to get the right hard cpu index.
Unified · Split
| @@ -28,6 +28,7 @@ · 27 unmodified lines | ||
| 28 | 28 | |
| 29 | 29 | #include <asm/arch_timer.h> |
| 30 | 30 | #include <asm/cacheflush.h> |
| 31 | +#include <asm/cputype.h> | |
| 31 | 32 | #include <asm/smp_plat.h> |
| 32 | 33 | #include <asm/smp_twd.h> |
| 33 | 34 | #include <asm/hardware/arm_timer.h> |
| @@ -59,7 +60,7 @@ static void __init highbank_scu_map_io(void) · 25 unmodified lines | ||
| 59 | 60 | |
| 60 | 61 | void highbank_set_cpu_jump(int cpu, void *jump_addr) |
| 61 | 62 | { |
| 62 | − cpu = cpu_logical_map(cpu); | |
| 63 | + cpu = MPIDR_AFFINITY_LEVEL(cpu_logical_map(cpu), 0); | |
| 63 | 64 | writel(virt_to_phys(jump_addr), HB_JUMP_TABLE_VIRT(cpu)); |
| 64 | 65 | __cpuc_flush_dcache_area(HB_JUMP_TABLE_VIRT(cpu), 16); |
| 65 | 66 | outer_clean_range(HB_JUMP_TABLE_PHYS(cpu), |
| @@ -37,7 +37,7 @@ extern void __iomem *sregs_base; · 36 unmodified lines | ||
| 37 | 37 | |
| 38 | 38 | static inline void highbank_set_core_pwr(void) |
| 39 | 39 | { |
| 40 | − int cpu = cpu_logical_map(smp_processor_id()); | |
| 40 | + int cpu = MPIDR_AFFINITY_LEVEL(cpu_logical_map(smp_processor_id()), 0); | |
| 41 | 41 | if (scu_base_addr) |
| 42 | 42 | scu_power_mode(scu_base_addr, SCU_PM_POWEROFF); |
| 43 | 43 | else |
| @@ -46,7 +46,7 @@ static inline void highbank_set_core_pwr(void) · 2 unmodified lines | ||
| 46 | 46 | |
| 47 | 47 | static inline void highbank_clear_core_pwr(void) |
| 48 | 48 | { |
| 49 | − int cpu = cpu_logical_map(smp_processor_id()); | |
| 49 | + int cpu = MPIDR_AFFINITY_LEVEL(cpu_logical_map(smp_processor_id()), 0); | |
| 50 | 50 | if (scu_base_addr) |
| 51 | 51 | scu_power_mode(scu_base_addr, SCU_PM_NORMAL); |
| 52 | 52 | else |