Override the switch_to_hypervisor function to switch cpu to hypervisor
mode using the available ROM code hook early in the boot phase before
the boot loader checks for HYP mode.
Based on the work done by Jonathan Bergsagel jbergsa...@ti.com.
Cc: beagleboard-...@googlegroups.com
Signed-off-by: Keerthy <j-keer...@ti.com>
Acked-by: Nishanth Menon <n...@ti.com>
---
arch/arm/cpu/armv7/omap-common/lowlevel_init.S | 21 +++++++++++++++++++++
1 file changed, 21 insertions(+)
diff --git a/arch/arm/cpu/armv7/omap-common/lowlevel_init.S
b/arch/arm/cpu/armv7/omap-common/lowlevel_init.S
index 5283135..c7707e5 100644
--- a/arch/arm/cpu/armv7/omap-common/lowlevel_init.S
+++ b/arch/arm/cpu/armv7/omap-common/lowlevel_init.S
@@ -23,7 +23,28 @@ ENTRY(save_boot_params)
str r0, [r1]
b save_boot_params_ret
ENDPROC(save_boot_params)
+
+ENTRY(switch_to_hypervisor)
+/*
+ * Switch to hypervisor mode
+ */
+ adr r0, save_sp
+ str sp, [r0]
+ adr r1, restore_from_hyp
+ ldr r0, =0x102
+#ifdef CONFIG_TI_SECURE_DEVICE
+ b omap_smc_sec
+#else
+ b omap_smc1
+#endif
+restore_from_hyp:
+ adr r0, save_sp
+ ldr sp, [r0]
#endif
+ b switch_to_hypervisor_ret
+save_sp:
+ .word 0x0
+ENDPROC(switch_to_hypervisor)
ENTRY(omap_smc1)
PUSH {r4-r12, lr} @ save registers - ROM code may pollute
--
1.9.1
_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot
