From: Will Sowerbutts <will@sowerbutts.com>
Date: Fri, 26 Jun 2015 19:38:56 +0000 (+0100)
Subject: p112: Implement _trap_reboot
X-Git-Url: https://git.ndcode.org/public/gitweb.cgi?a=commitdiff_plain;h=03908455ea68143b8219c30393d210472cf83e6a;p=FUZIX.git

p112: Implement _trap_reboot
---

diff --git a/Kernel/platform-p112/p112.s b/Kernel/platform-p112/p112.s
index 3eb53b4f..3e22d4a3 100644
--- a/Kernel/platform-p112/p112.s
+++ b/Kernel/platform-p112/p112.s
@@ -12,7 +12,7 @@
         .globl outstring
         .globl outcharhex
         .globl platform_interrupt_all
-        .globl _trap_monitor
+        .globl _trap_reboot
 
         ; imported symbols
         .globl z180_init_hardware
@@ -111,5 +111,13 @@ inchar:
         in0 a, (ESCC_DATA_A)
         ret
 
+_trap_reboot:
+        in0 a, (Z182_SYSCONFIG)
+        res 3, a                    ; re-enable the ROM select line
+        out0 (Z182_SYSCONFIG), a
+        xor a
+        out0 (MMU_BBR), a           ; map ROM into the lower 60K
+        jp 0                        ; jump to the boot ROM entry vector
+
 platform_interrupt_all:
         ret