arm: keystone2: use ks2 aliased physical address for cpu_reset

KS2 system uses physical addresses outside of first 4GB memory range.
Once the cpu_reset() disables MMU that memory cannot be used.
To let the cpu_reset() successfully restart CPU we need to run it from
KS2 aliased memory address space.

Signed-off-by: Vitaly Andrianov <vitalya@ti.com>

1 files changed, 4 insertions, 0 deletions

diff --git a/arch/arm/kernel/process.c b/arch/arm/kernel/process.c
index ac4c2e5e17e..06f24f73110 100644
--- a/arch/arm/kernel/process.c
+++ b/arch/arm/kernel/process.c
@@ -86,7 +86,11 @@ static void __soft_restart(void *addr)
         flush_cache_all();
 
         /* Switch to the identity mapping. */
+#ifdef CONFIG_ARCH_KEYSTONE
+        phys_reset = (phys_reset_t)(unsigned long)virt_to_idmap(cpu_reset);
+#else
         phys_reset = (phys_reset_t)(unsigned long)virt_to_phys(cpu_reset);
+#endif
         phys_reset((unsigned long)addr);
 
         /* Should never get here. */