From f28a88dc99c4535f9f698d724297a700769bf85b Mon Sep 17 00:00:00 2001
From: SarahW <SarahW@localhost>
Date: Fri, 24 Feb 2017 18:26:13 +0000
Subject: [PATCH] Added missing PS/2 model 30 files

---
 src/ps2.c | 136 ++++++++++++++++++++++++++++++++++++++++++++++++++++++
 src/ps2.h |   1 +
 2 files changed, 137 insertions(+)
 create mode 100644 src/ps2.c
 create mode 100644 src/ps2.h

diff --git a/src/ps2.c b/src/ps2.c
new file mode 100644
index 0000000..9b78c15
--- /dev/null
+++ b/src/ps2.c
@@ -0,0 +1,136 @@
+#include "ibm.h"
+#include "mem.h"
+#include "ps2.h"
+#include "rom.h"
+#include "lpt.h"
+
+static uint8_t ps2_92, ps2_94, ps2_102, ps2_103, ps2_104, ps2_105, ps2_190;
+
+static struct
+{
+        uint8_t status, int_status;
+        uint8_t attention, ctrl;
+} ps2_hd;
+
+uint8_t ps2_read(uint16_t port, void *p)
+{
+        uint8_t temp;
+
+        switch (port)
+        {
+                case 0x91:
+                return 0;
+                case 0x92:
+                return ps2_92;
+                case 0x94:
+                return ps2_94;
+                case 0x102:
+                return ps2_102 | 8;
+                case 0x103:
+                return ps2_103;
+                case 0x104:
+                return ps2_104;
+                case 0x105:
+                return ps2_105;
+                case 0x190:
+                return ps2_190;
+                
+                case 0x322:
+                temp = ps2_hd.status;
+                break;
+                case 0x324:
+                temp = ps2_hd.int_status;
+                ps2_hd.int_status &= ~0x02;
+                break;
+                
+                default:
+                temp = 0xff;
+                break;
+        }
+        
+        return temp;
+}
+
+void ps2_write(uint16_t port, uint8_t val, void *p)
+{
+        switch (port)
+        {
+                case 0x0092:
+                ps2_92 = val;    
+                mem_a20_alt = val & 2;
+                mem_a20_recalc();
+                break;
+                case 0x94:
+                ps2_94 = val;
+                break;
+                case 0x102:
+                lpt1_remove();
+                if (val & 0x04)
+                        serial1_init(0x3f8, 4);
+                else
+                        serial1_remove();
+                if (val & 0x10)
+                {
+                        switch ((val >> 5) & 3)
+                        {
+                                case 0:
+                                lpt1_init(0x3bc);
+                                break;
+                                case 1:
+                                lpt1_init(0x378);
+                                break;
+                                case 2:
+                                lpt1_init(0x278);
+                                break;
+                        }
+                }
+                ps2_102 = val;
+                break;
+                case 0x103:
+                ps2_103 = val;
+                break;
+                case 0x104:
+                ps2_104 = val;
+                break;
+                case 0x105:
+                ps2_105 = val;
+                break;
+                case 0x190:
+                ps2_190 = val;
+                break;
+                
+                case 0x322:
+                ps2_hd.ctrl = val;
+                if (val & 0x80)
+                        ps2_hd.status |= 0x02;
+                break;
+                case 0x324:
+                ps2_hd.attention = val & 0xf0;
+                if (ps2_hd.attention)
+                        ps2_hd.status = 0x14;
+                break;
+        }
+}
+
+void ps2board_init()
+{
+        io_sethandler(0x0091, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0092, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0094, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0102, 0x0004, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0190, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0320, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0322, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        io_sethandler(0x0324, 0x0001, ps2_read, NULL, NULL, ps2_write, NULL, NULL, NULL);
+        
+        ps2_190 = 0;
+        
+        lpt1_remove();
+        lpt2_remove();
+        lpt1_init(0x3bc);
+        
+        serial1_remove();
+        serial2_remove();
+        
+        memset(&ps2_hd, 0, sizeof(ps2_hd));
+}
diff --git a/src/ps2.h b/src/ps2.h
new file mode 100644
index 0000000..9a71bbc
--- /dev/null
+++ b/src/ps2.h
@@ -0,0 +1 @@
+void ps2board_init();
\ No newline at end of file