This is the base address register for the vector table when in
hypervisor mode.

Signed-off-by: Jim Posen <[email protected]>
---

 arch/arm/cpu/armv7/start.S | 5 +++++
 arch/arm/lib/relocate.S    | 8 ++++++++
 2 files changed, 13 insertions(+)

diff --git a/arch/arm/cpu/armv7/start.S b/arch/arm/cpu/armv7/start.S
index 698e15b8e1..bce8ddb1b0 100644
--- a/arch/arm/cpu/armv7/start.S
+++ b/arch/arm/cpu/armv7/start.S
@@ -113,6 +113,11 @@ switch_to_hypervisor_ret:
        ldr     r0, =_start
        mcr     p15, 0, r0, c12, c0, 0  @Set VBAR
 #endif
+#ifdef CPU_V7_HAS_VIRT
+       /* Set vector address in CP15 VBAR register */
+       ldr     r0, =hyp_vector_table
+       mcr     p15, 0, r0, c12, c0, 0  @Set HVBAR
+#endif
 #endif
 
        /* the mask ROM code should have PLL and others stable */
diff --git a/arch/arm/lib/relocate.S b/arch/arm/lib/relocate.S
index 14b7f61c1a..3ebf6a519e 100644
--- a/arch/arm/lib/relocate.S
+++ b/arch/arm/lib/relocate.S
@@ -60,6 +60,14 @@ ENTRY(relocate_vectors)
        ldmia   r0!, {r2-r8,r10}
        stmia   r1!, {r2-r8,r10}
 #endif
+#ifdef CONFIG_CPU_V7_HAS_VIRT
+       /*
+       * If the ARM processor has the virtualization extensions,
+       * use HVBAR to relocate the EL2 exception vectors.
+       */
+       ldr     r0, =hyp_vector_table   /* load dynamically relocated address */
+       mcr     p15, 4, r0, c12, c0, 0  /* Set HVBAR */
+#endif
 #endif
        bx      lr
 
-- 
2.25.1

Reply via email to