1 files changed, 59 insertions, 0 deletions
diff --git a/code/fe310/eos/spi_dev.c b/code/fe310/eos/spi_dev.c
new file mode 100644
index 0000000..aed26bc
--- /dev/null
+++ b/code/fe310/eos/spi_dev.c
@@ -0,0 +1,59 @@
+#include <stdlib.h>
+#include <stdint.h>
+
+#include "encoding.h"
+#include "platform.h"
+
+#include "spi.h"
+#include "net.h"
+
+#include "spi_def.h"
+#include "spi_dev.h"
+
+
+#define SPI_DIV_DISP        16
+#define SPI_DIV_CARD        16
+#define SPI_DIV_CAM         16
+
+#define SPI_CSID_DISP       2
+#define SPI_CSID_CARD       0
+
+#define SPI_CSPIN_CAM       23
+
+static uint16_t spi_dev_div[EOS_DEV_MAX_DEV];
+
+void eos_spi_dev_start(unsigned char dev) {
+    eos_net_stop();
+    switch (dev) {
+        case EOS_DEV_DISP:
+            eos_spi_start(dev, spi_dev_div[dev-1], SPI_CSID_DISP, 0);
+            break;
+        case EOS_DEV_CARD:
+            eos_spi_start(dev, spi_dev_div[dev-1], SPI_CSID_CARD, 0);
+            break;
+        case EOS_DEV_CAM:
+            eos_spi_start(dev, spi_dev_div[dev-1], SPI_CSID_NONE, SPI_CSPIN_CAM);
+            break;
+    }
+}
+
+void eos_spi_dev_stop(void) {
+    eos_spi_stop();
+    eos_net_start();
+}
+
+void eos_spi_dev_init(void) {
+    spi_dev_div[EOS_DEV_DISP - 1] = SPI_DIV_DISP;
+    spi_dev_div[EOS_DEV_CARD - 1] = SPI_DIV_CARD;
+    spi_dev_div[EOS_DEV_CAM  - 1] = SPI_DIV_CAM;
+
+    GPIO_REG(GPIO_INPUT_EN)     &= ~(1 << SPI_CSPIN_CAM);
+    GPIO_REG(GPIO_OUTPUT_EN)    |=  (1 << SPI_CSPIN_CAM);
+    GPIO_REG(GPIO_PULLUP_EN)    &= ~(1 << SPI_CSPIN_CAM);
+    GPIO_REG(GPIO_OUTPUT_XOR)   &= ~(1 << SPI_CSPIN_CAM);
+    GPIO_REG(GPIO_OUTPUT_VAL)   |=  (1 << SPI_CSPIN_CAM);
+}
+
+void eos_spi_dev_set_div(unsigned char dev, uint16_t div) {
+    spi_dev_div[dev-1] = div;
+}