From a9e89946ad7f6918b954d7416c755a90c0eace9d Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Thu, 24 Feb 2022 18:38:20 -0700
Subject: Fixed HYP Code

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

(limited to 'src/boot.S')

diff --git a/src/boot.S b/src/boot.S
index 6da500b..46ef3d0 100644
--- a/src/boot.S
+++ b/src/boot.S
@@ -9,13 +9,20 @@
 _start:
 reset:
 	cpsid aif
+
+	// Exit Hypervisor Mode
 	mrs r0, cpsr
+	and r1, r0, #0x1F
+	cmp r1, #0x1A
+	bne 1f
 	bic r0, r0, #0x1f
 	orr r0, r0, #0x13
 	msr spsr_cxsf, r0
 	add r0, pc, #4
 	msr ELR_hyp, r0
 	eret
+
+1:
 	// disable core0,1,2.
 	mrc p15, #0, r1, c0, c0, #5
 	and r1, r1, #3
-- 
cgit v1.2.1