From 9cd14efb76a4ddbcd013f44d50dc1ff93d56c4ca Mon Sep 17 00:00:00 2001
From: Thomas Albers Raviola <thomas@thomaslabs.org>
Date: Mon, 2 Dec 2024 21:43:04 +0100
Subject: Move bootloader to payload

---
 asm/crt0.asm | 17 ++++++++++++++++-
 1 file changed, 16 insertions(+), 1 deletion(-)

(limited to 'asm/crt0.asm')

diff --git a/asm/crt0.asm b/asm/crt0.asm
index 6f92149..523c39e 100644
--- a/asm/crt0.asm
+++ b/asm/crt0.asm
@@ -10,7 +10,22 @@ start:
     ld      i, a
     ld      sp, #0x0000
     di
-
+    ;; Init PIO and check for KEY2
+    ld      a, #PIO_MODE_3
+    out     (PORT_B_CTRL), a
+    ld      a, #0x7F
+    out     (PORT_B_CTRL), a
+    in      a, (PORT_B_DATA)
+    and     #0x02               ; is KEY2 pressed? If so, start booloader
+    jr      NZ, main
+    ;; Load payload (bootloader)
+    ld      HL, #0x7000
+    ld      DE, #0x8000
+    ld      BC, #0x1000
+    ldir
+    ;; Start bootloader
+    jp      0x8000
+main:
     call	gsinit
 	call	_main
 1$:
-- 
cgit v1.2.3