1 files changed, 71 insertions, 0 deletions
diff --git a/fw/fe310/eos/display.c b/fw/fe310/eos/display.c
new file mode 100644
index 0000000..bc181cb
--- /dev/null
+++ b/fw/fe310/eos/display.c
@@ -0,0 +1,71 @@
+#include <stdlib.h>
+#include <stdint.h>
+
+#include "encoding.h"
+#include "platform.h"
+
+#include "eos.h"
+
+#include "board.h"
+
+#include "i2s.h"
+#include "net.h"
+#include "spi_dev.h"
+#include "display.h"
+
+#define BIT_PUT(b, pin)     if (b) GPIO_REG(GPIO_OUTPUT_VAL) |= (1 << (pin)); else GPIO_REG(GPIO_OUTPUT_VAL) &= ~(1 << (pin));
+#define BIT_GET(pin)        ((GPIO_REG(GPIO_INPUT_VAL) & (1 << (pin))) >> (pin))
+
+int eos_disp_select(void) {
+    if (eos_i2s_running()) return EOS_ERR_BUSY;
+    if (eos_spi_dev() != EOS_SPI_DEV_NET) return EOS_ERR_BUSY;
+
+    eos_net_stop();
+    GPIO_REG(GPIO_IOF_EN) &= ~SPI_IOF_MASK;
+}
+
+void eos_disp_deselect(void) {
+    GPIO_REG(GPIO_OUTPUT_VAL) |= (1 << IOF_SPI1_MOSI);
+    GPIO_REG(GPIO_IOF_EN) |= SPI_IOF_MASK;
+    eos_net_start(0);
+}
+
+void eos_disp_cs_set(void) {
+    GPIO_REG(GPIO_OUTPUT_VAL) |= (1 << DISP_PIN_CS);
+}
+
+void eos_disp_cs_clear(void) {
+    GPIO_REG(GPIO_OUTPUT_VAL) &= ~(1 << DISP_PIN_CS);
+}
+
+void eos_disp_write(uint8_t dc, uint8_t data) {
+    int i;
+
+    BIT_PUT(dc, IOF_SPI1_MOSI);
+    // sleep
+    BIT_PUT(1, IOF_SPI1_SCK);
+    for (i=0; i<8; i++) {
+        // sleep
+        BIT_PUT(0, IOF_SPI1_SCK);
+        BIT_PUT(data & 0x80, IOF_SPI1_MOSI);
+        // sleep
+        BIT_PUT(1, IOF_SPI1_SCK);
+        data = data << 1;
+    }
+    // sleep
+    BIT_PUT(0, IOF_SPI1_SCK);
+}
+
+void eos_disp_read(uint8_t *data) {
+    int i;
+
+    *data = 0;
+    for (i=0; i<8; i++) {
+        // sleep
+        BIT_PUT(1, IOF_SPI1_SCK);
+        *data = *data << 1;
+        *data |= BIT_GET(IOF_SPI1_MISO);
+        // sleep
+        BIT_PUT(0, IOF_SPI1_SCK);
+    }
+}