From eb169ea5a89909b90794e0388f89d6d372754e46 Mon Sep 17 00:00:00 2001
From: Nao Pross <naopross@thearcway.org>
Date: Thu, 5 Oct 2017 16:09:59 +0200
Subject: Move test units to z80/tests, and drivers are now statically linked

Makefiles for the test units were getting messier, so now drivers
(that need to be tested) are statically compiled in their own
folder under z80/drivers.

The kernel makefile and is now broken since everything has been moved.
---
 sw/z80/drivers/pio.c | 50 ++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 50 insertions(+)
 create mode 100644 sw/z80/drivers/pio.c

(limited to 'sw/z80/drivers/pio.c')

diff --git a/sw/z80/drivers/pio.c b/sw/z80/drivers/pio.c
new file mode 100644
index 0000000..bdbe1c3
--- /dev/null
+++ b/sw/z80/drivers/pio.c
@@ -0,0 +1,50 @@
+#include "pio.h"
+
+static uint8_t *pio_port = (uint8_t *) ADDR_DEV_PIO;
+static uint8_t *pio_ctrl = (uint8_t *) (ADDR_DEV_PIO + 2);
+
+inline void _pio_data(int port, uint8_t data)
+{
+    *(pio_port + port) = data;
+}
+
+inline void _pio_control(int port, uint8_t cmd)
+{
+    *(pio_ctrl + port) = cmd;
+}
+
+void pio_set_mode(int port, int mode, uint8_t io)
+{
+    // 0x0F is a control sequence to set mode
+    _pio_control(port, ((mode << 6) | 0x0F));
+
+    // this mode requires an additional argument that sets
+    // a mode for each pin
+    if (mode == PIO_MODE_BIT_IO) {
+        _pio_control(port, io);
+    }
+}
+
+void pio_set_interrupts(int port, int control)
+{
+    // 0x07 is a control sequence to set interrupts
+    _pio_control(port, (control | 0x07));
+}
+
+void pio_set_interrupts_mask(int port, int control, uint8_t mask)
+{
+    // 0x17 is a control sequence to set interrupts
+    // AND interpret the next byte as a bitmask
+    _pio_control(port, (control | 0x17));
+    _pio_control(port, mask);
+}
+
+uint8_t pio_read(int port)
+{
+    return *(pio_port + port);
+}
+
+void pio_write(int port, uint8_t data)
+{
+    _pio_data(port, data);
+}
-- 
cgit v1.2.1