[U-Boot] [PATCH v2 12/12] tegra: Set CNTFRQ for secondary CPUs

Jan Kiszka
2015-02-16T12:54:49Z

We only set CNTFRQ in arch_timer_init for the boot CPU. But this has to
happen for all cores.

Fixing this resolves problems of KVM with emulating the generic
timer/counter.

Signed-off-by: Jan Kiszka <jan.kiszka@siemens.com>
---
arch/arm/cpu/armv7/tegra-common/psci.S | 13 +++++++++++++
1 file changed, 13 insertions(+)

diff --git a/arch/arm/cpu/armv7/tegra-common/psci.S b/arch/arm/cpu/armv7/tegra-common/psci.S
index b7501fb..119c246 100644
--- a/arch/arm/cpu/armv7/tegra-common/psci.S
+++ b/arch/arm/cpu/armv7/tegra-common/psci.S
@@ -51,12 +51,25 @@ ENTRY(psci_arch_init)

mrc p15, 0, r4, c0, c0, 5 @ MPIDR
and r4, r4, #7 @ number of CPUs in cluster
+
+ adr r5, _sys_clock_freq
+ cmp r4, #0
+
+ mrceq p15, 0, r7, c14, c0, 0 @ read CNTFRQ from CPU0
+ streq r7, [r5]
+
+ ldrne r7, [r5]
+ mcrne p15, 0, r7, c14, c0, 0 @ write CNTFRQ to CPU1..3
+
bl psci_get_cpu_stack_top
mov sp, r5

bx r6
ENDPROC(psci_arch_init)

+_sys_clock_freq:
+ .word
+
ENTRY(psci_cpu_off)
bl psci_cpu_off_common

--
2.1.4