From 78f2b5364547d403c04fc2062afba4436ce71503 Mon Sep 17 00:00:00 2001
From: beeanyew <beeanyew@gmail.com>
Date: Wed, 11 Aug 2021 12:34:23 +0200
Subject: [PATCH] Various (some unused) GPIO things

---
 emulator.c         |   1 +
 gpio/ps_protocol.c |   7 +--
 gpio/ps_protocol.h | 103 +++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 108 insertions(+), 3 deletions(-)

diff --git a/emulator.c b/emulator.c
index dbcdbfb..d983d96 100644
--- a/emulator.c
+++ b/emulator.c
@@ -195,6 +195,7 @@ noppers:
 void *cpu_task() {
 	m68ki_cpu_core *state = &m68ki_cpu;
   state->ovl = ovl;
+  state->gpio = gpio;
 	m68k_pulse_reset(state);
 
 cpu_loop:
diff --git a/gpio/ps_protocol.c b/gpio/ps_protocol.c
index 68b12e7..0e9da82 100644
--- a/gpio/ps_protocol.c
+++ b/gpio/ps_protocol.c
@@ -11,6 +11,7 @@
 #include <stddef.h>
 #include <stdio.h>
 #include <stdlib.h>
+#include <stdint.h>
 #include <sys/mman.h>
 #include <sys/stat.h>
 #include <sys/types.h>
@@ -153,6 +154,8 @@ void ps_write_32(unsigned int address, unsigned int value) {
   ps_write_16(address + 2, value);
 }
 
+#define NOP asm("nop"); asm("nop");
+
 unsigned int ps_read_16(unsigned int address) {
   *(gpio + 0) = GPFSEL0_OUTPUT;
   *(gpio + 1) = GPFSEL1_OUTPUT;
@@ -219,9 +222,7 @@ unsigned int ps_read_8(unsigned int address) {
 }
 
 unsigned int ps_read_32(unsigned int address) {
-  unsigned int a = ps_read_16(address);
-  unsigned int b = ps_read_16(address + 2);
-  return (a << 16) | b;
+  return (ps_read_16(address) << 16) | ps_read_16(address + 2);
 }
 
 void ps_write_status_reg(unsigned int value) {
diff --git a/gpio/ps_protocol.h b/gpio/ps_protocol.h
index a4b0c25..4d0260b 100644
--- a/gpio/ps_protocol.h
+++ b/gpio/ps_protocol.h
@@ -63,6 +63,99 @@
 #define GPFSEL1_OUTPUT 0x09249249
 #define GPFSEL2_OUTPUT 0x00000249
 
+#define GPFSEL_OUTPUT \
+  *(gpio + 0) = GPFSEL0_OUTPUT; \
+  *(gpio + 1) = GPFSEL1_OUTPUT; \
+  *(gpio + 2) = GPFSEL2_OUTPUT;
+
+#define GPFSEL_INPUT \
+  *(gpio + 0) = GPFSEL0_INPUT; \
+  *(gpio + 1) = GPFSEL1_INPUT; \
+  *(gpio + 2) = GPFSEL2_INPUT;
+
+#define GPIO_WRITEREG(reg, val) \
+  *(gpio + 7) = (val << 8) | (reg << PIN_A0); \
+  *(gpio + 7) = 1 << PIN_WR; \
+  *(gpio + 10) = 1 << PIN_WR; \
+  *(gpio + 10) = 0xFFFFEC;
+
+#define GPIO_PIN_RD \
+  *(gpio + 7) = (REG_DATA << PIN_A0); \
+  *(gpio + 7) = 1 << PIN_RD;
+
+#define WAIT_TXN \
+  while (*(gpio + 13) & (1 << PIN_TXN_IN_PROGRESS)) {}
+
+#define END_TXN \
+  *(gpio + 10) = 0xFFFFEC;
+
+static inline void ps_write_8_ex(volatile uint32_t *gpio, uint32_t address, uint32_t data) {
+  if (address & 0x01) {
+    data &= 0xFF; // ODD , A0=1,LDS
+  } else {
+    data |= (data << 8); // EVEN, A0=0,UDS
+  }
+
+  GPFSEL_OUTPUT;
+
+  GPIO_WRITEREG(REG_DATA, (data & 0xFFFF));
+  GPIO_WRITEREG(REG_ADDR_LO, (address & 0xFFFF));
+  GPIO_WRITEREG(REG_ADDR_HI, (0x0100 |(address >> 16)));
+
+  GPFSEL_INPUT;
+
+  WAIT_TXN;
+}
+
+static inline void ps_write_16_ex(volatile uint32_t *gpio, uint32_t address, uint32_t data) {
+  GPFSEL_OUTPUT;
+
+  GPIO_WRITEREG(REG_DATA, (data & 0xFFFF));
+  GPIO_WRITEREG(REG_ADDR_LO, (address & 0xFFFF));
+  GPIO_WRITEREG(REG_ADDR_HI, (0x0000 |(address >> 16)));
+
+  GPFSEL_INPUT;
+
+  WAIT_TXN;
+}
+
+static inline uint32_t ps_read_8_ex(volatile uint32_t *gpio, uint32_t address) {
+    GPFSEL_OUTPUT;
+
+    GPIO_WRITEREG(REG_ADDR_LO, (address & 0xFFFF));
+    GPIO_WRITEREG(REG_ADDR_HI, (0x0300 |(address >> 16)));
+
+    asm("nop"); asm("nop");
+    GPFSEL_INPUT;
+    GPIO_PIN_RD;
+
+    WAIT_TXN;
+    uint32_t value = ((*(gpio + 13) >> 8) & 0xFFFF);
+    END_TXN;
+
+    if (address & 0x01)
+    return value & 0xff;  // ODD , A0=1,LDS
+    else
+    return (value >> 8);  // EVEN, A0=0,UDS
+}
+
+static inline uint32_t ps_read_16_ex(volatile uint32_t *gpio, uint32_t address) {
+    GPFSEL_OUTPUT;
+
+    GPIO_WRITEREG(REG_ADDR_LO, (address & 0xFFFF));
+    GPIO_WRITEREG(REG_ADDR_HI, (0x0200 |(address >> 16)));
+
+    asm("nop"); asm("nop");
+    GPFSEL_INPUT;
+    GPIO_PIN_RD;
+
+    WAIT_TXN;
+    uint32_t value = ((*(gpio + 13) >> 8) & 0xFFFF);
+    END_TXN;
+
+    return value;
+}
+
 unsigned int ps_read_8(unsigned int address);
 unsigned int ps_read_16(unsigned int address);
 unsigned int ps_read_32(unsigned int address);
@@ -88,6 +181,16 @@ unsigned int ps_get_ipl_zero();
 #define write16 ps_write_16
 #define write32 ps_write_32
 
+static inline void ps_write_32_ex(volatile uint32_t *gpio, uint32_t address, uint32_t data) {
+    ps_write_16_ex(gpio, address, data >> 16);
+    ps_write_16_ex(gpio, address + 2, data);
+}
+
+static inline uint32_t ps_read_32_ex(volatile uint32_t *gpio, uint32_t address) {
+    return (ps_read_16_ex(gpio, address) << 16) | ps_read_16_ex(gpio, address + 2);
+}
+
+
 #define write_reg ps_write_status_reg
 #define read_reg ps_read_status_reg