1 files changed, 19 insertions, 0 deletions
diff --git a/sw/z80/kernel/drivers/pio.c b/sw/z80/kernel/drivers/pio.c
new file mode 100644
index 0000000..e29383f
--- /dev/null
+++ b/sw/z80/kernel/drivers/pio.c
@@ -0,0 +1,19 @@
+#include "drivers/pio.h"
+
+static uint8_t *pio_port = (uint8_t *) ADDR_DEV_PIO;
+static uint8_t *pio_ctrl = (uint8_t *) (ADDR_DEV_PIO + 2);
+
+void _pio_data(int port, uint8_t data)
+{
+    *(pio_port + port) = data;
+}
+
+void _pio_command(int port, uint8_t cmd)
+{
+    *(pio_ctrl + port) = cmd;
+}
+
+void pio_set_mode(int port, int mode)
+{
+	
+}