From a621bee817320cc3e17b097da29b3d46c62a90b4 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Thu, 24 Feb 2022 18:24:59 -0700
Subject: Exit Hypervisor Mode

---
 src/boot.S | 10 +++++++---
 1 file changed, 7 insertions(+), 3 deletions(-)

(limited to 'src/boot.S')

diff --git a/src/boot.S b/src/boot.S
index 9d431d7..6da500b 100644
--- a/src/boot.S
+++ b/src/boot.S
@@ -9,6 +9,13 @@
 _start:
 reset:
 	cpsid aif
+	mrs r0, cpsr
+	bic r0, r0, #0x1f
+	orr r0, r0, #0x13
+	msr spsr_cxsf, r0
+	add r0, pc, #4
+	msr ELR_hyp, r0
+	eret
 	// disable core0,1,2.
 	mrc p15, #0, r1, c0, c0, #5
 	and r1, r1, #3
@@ -54,15 +61,12 @@ reset:
 
 runcore1:
 	init_core 1
-	core_task 1
 	b io_halt
 runcore2:
 	init_core 2
-	core_task 2
 	b io_halt
 runcore3:
 	init_core 3
-	core_task 3
 	b io_halt
 
 .globl io_halt
-- 
cgit v1.2.1