Merge remote-tracking branch 'kiszka/master'

[jailhouse.git] / hypervisor / arch / arm / entry.S

diff --git a/hypervisor/arch/arm/entry.S b/hypervisor/arch/arm/entry.S
index 25325a053a7dcd4ba15d0756039e65ffd8282348..430bb3ed212a9e92f0f3e293512375bddc57d701 100644 (file)
--- a/hypervisor/arch/arm/entry.S
+++ b/hypervisor/arch/arm/entry.S
@@ -10,6 +10,7 @@
  * the COPYING file in the top-level directory.
  */
 
+#include <asm/asm-defines.h>
 #include <asm/head.h>
 #include <asm/percpu.h>
 
@@ -17,11 +18,68 @@
        .text
        .globl arch_entry
 arch_entry:
-       mvn %r0,#~-38
-       bx %lr
+       /* r0: cpuid */
+       push    {r0 - r12}
 
+       ldr     r1, =__page_pool
+       mov     r4, #1
+       lsl     r4, #PERCPU_SIZE_SHIFT_ASM
+       /*
+        * percpu data = pool + cpuid * shift
+        * TODO: handle aff1 and aff2
+        */
+       mla     r1, r4, r0, r1
+       add     r4, r1, #PERCPU_LINUX_SP
 
-/* Fix up Global Offset Table with absolute hypervisor address */
-       .globl got_init
-got_init:
-       bx %lr
+       /*
+        * Save SP, LR, CPSR
+        * r4 is used so that they can be easily retrieved on failure.
+        */
+       str     sp, [r4], #4
+       str     lr, [r4], #4
+       mrs     r3, cpsr
+       str     r3, [r4]
+
+       mov     sp, r1
+       add     sp, #PERCPU_STACK_END
+       /*
+        * Keep some space for a struct registers, in case setup fails and needs
+        * to return to the driver through the arch_shutdown_self path.
+        */
+       sub     sp, #((NUM_USR_REGS + 1) * 4)
+       /* Call entry(cpuid, struct per_cpu*) */
+       bl      entry
+
+       /*
+        * entry only returns here when there is an error before setting up EL2
+        */
+       ldr     r3, [r4], #-4
+       msr     spsr, r3
+       ldr     lr, [r4], #-4
+       ldr     sp, [r4]
+
+       /* Keep the return value in r0 */
+       pop     {r1}
+       pop     {r1 - r12}
+       subs    pc, lr, #0
+
+       .globl bootstrap_vectors
+       .align 5
+bootstrap_vectors:
+       b       .
+       b       .
+       b       .
+       b       .
+       b       .
+       b       setup_el2
+       b       .
+       b       .
+
+setup_el2:
+       /*
+        * Load the physical values of lr and sp, and continue execution at EL2.
+        */
+       mov     lr, r0
+       mov     sp, r1
+
+       bx      lr