addded uart driver and cell stub driver

5 files changed, 181 insertions, 1 deletions

diff --git a/code/fe310/eos/Makefile b/code/fe310/eos/Makefile
index 485cd3c..36eefd7 100644
--- a/code/fe310/eos/Makefile
+++ b/code/fe310/eos/Makefile
@@ -2,7 +2,7 @@ include ../common.mk
 
 CFLAGS += -I../include -I../drivers
 
-obj = trap_entry.o eos.o msgq.o event.o interrupt.o timer.o i2s.o spi.o net.o wifi.o sock.o eve.o
+obj = trap_entry.o eos.o msgq.o event.o interrupt.o timer.o i2s.o uart.o spi.o net.o wifi.o cell.o sock.o eve.o
 
 
 %.o: %.c %.h
diff --git a/code/fe310/eos/cell.c b/code/fe310/eos/cell.c
new file mode 100644
index 0000000..b2d62f8
--- /dev/null
+++ b/code/fe310/eos/cell.c
@@ -0,0 +1,46 @@
+#include <stdlib.h>
+#include <stdint.h>
+#include <string.h>
+
+#include "eos.h"
+#include "event.h"
+#include "net.h"
+
+#include "cell.h"
+
+static eos_evt_fptr_t evt_handler[EOS_CELL_MAX_MTYPE];
+static uint16_t evt_handler_flags_buf_free = 0;
+static uint16_t evt_handler_flags_buf_acq = 0;
+
+static void cell_handler_evt(unsigned char type, unsigned char *buffer, uint16_t len) {
+    if ((buffer == NULL) || (len < 1)) {
+        eos_evtq_bad_handler(type, buffer, len);
+        eos_net_free(buffer, 0);
+        return;
+    }
+
+    uint8_t mtype = buffer[0];
+    if (mtype >= EOS_CELL_MAX_MTYPE) {
+        eos_evtq_bad_handler(type, buffer, len);
+        eos_net_free(buffer, 0);
+        return;
+    }
+
+    _eos_net_handle(type, buffer, len, mtype, evt_handler, &evt_handler_flags_buf_free, &evt_handler_flags_buf_acq);
+}
+
+void eos_cell_init(void) {
+    int i;
+
+    for (i=0; i<EOS_CELL_MAX_MTYPE; i++) {
+        evt_handler[i] = eos_evtq_bad_handler;
+    }
+    eos_net_set_handler(EOS_NET_MTYPE_CELL, cell_handler_evt, 0);
+}
+
+void eos_cell_set_handler(int mtype, eos_evt_fptr_t handler, uint8_t flags) {
+    if (mtype >= EOS_CELL_MAX_MTYPE) {
+        return;
+    }
+    _eos_net_set_handler(mtype, handler, evt_handler, flags, &evt_handler_flags_buf_free, &evt_handler_flags_buf_acq);
+}
diff --git a/code/fe310/eos/cell.h b/code/fe310/eos/cell.h
new file mode 100644
index 0000000..badce3d
--- /dev/null
+++ b/code/fe310/eos/cell.h
@@ -0,0 +1,16 @@
+#include <stdint.h>
+#include "event.h"
+
+#define EOS_CELL_MTYPE_DATA         0
+#define EOS_CELL_MTYPE_AUDIO        1
+
+#define EOS_CELL_MTYPE_DATA_START   2
+#define EOS_CELL_MTYPE_DATA_STOP    3
+
+#define EOS_CELL_MTYPE_AUDIO_START  2
+#define EOS_CELL_MTYPE_AUDIO_STOP   3
+
+#define EOS_CELL_MAX_MTYPE          2
+
+void eos_cell_init(void);
+void eos_cell_set_handler(int mtype, eos_evt_fptr_t handler, uint8_t flags);
\ No newline at end of file
diff --git a/code/fe310/eos/uart.c b/code/fe310/eos/uart.c
new file mode 100644
index 0000000..88931ab
--- /dev/null
+++ b/code/fe310/eos/uart.c
@@ -0,0 +1,100 @@
+#include <stdlib.h>
+#include <stdint.h>
+#include <string.h>
+
+#include "encoding.h"
+#include "platform.h"
+
+#include "eos.h"
+#include "interrupt.h"
+#include "event.h"
+
+#include "uart.h"
+#include "irq_def.h"
+
+static eos_uart_fptr_t uart_handler[EOS_UART_MAX_ETYPE];
+
+static void uart_handler_evt(unsigned char type, unsigned char *buffer, uint16_t len) {
+    unsigned char idx = (type & ~EOS_EVT_MASK) - 1;
+
+    if ((idx < EOS_UART_MAX_ETYPE) && uart_handler[idx]) {
+        uart_handler[idx](type);
+    } else {
+        eos_evtq_bad_handler(type, buffer, len);
+    }
+}
+
+static void uart_handler_intr(void) {
+    if (UART0_REG(UART_REG_IP) & UART_IP_TXWM) {
+        UART0_REG(UART_REG_IE) &= ~UART_IP_TXWM;
+        eos_evtq_push_isr(EOS_EVT_UART | EOS_UART_ETYPE_TX, NULL, 0);
+    }
+    if (UART0_REG(UART_REG_IP) & UART_IP_RXWM) {
+        UART0_REG(UART_REG_IE) &= ~UART_IP_RXWM;
+        eos_evtq_push_isr(EOS_EVT_UART | EOS_UART_ETYPE_RX, NULL, 0);
+    }
+}
+
+void eos_uart_init(void) {
+    int i;
+
+    for (i=0; i<EOS_UART_MAX_ETYPE; i++) {
+        uart_handler[i] = NULL;
+    }
+    eos_evtq_set_handler(EOS_EVT_UART, uart_handler_evt);
+    eos_intr_set(INT_UART0_BASE, IRQ_PRIORITY_UART, uart_handler_intr);
+}
+
+void eos_uart_set_handler(unsigned char type, eos_uart_fptr_t handler, uint8_t flags) {
+    if (type && (type <= EOS_UART_MAX_ETYPE)) {
+        type--;
+    } else {
+        return;
+    }
+    uart_handler[type] = handler;
+
+    if (flags) eos_evtq_set_flags(EOS_EVT_UART | type + 1, flags);
+}
+
+void eos_uart_txwm_set(uint8_t wm) {
+    UART0_REG(UART_REG_TXCTRL)  &= ~UART_TXWM(0xFFFF);
+    UART0_REG(UART_REG_TXCTRL)  |=  UART_TXWM(wm);
+    UART0_REG(UART_REG_IE)      |=  UART_IP_TXWM;
+}
+
+void eos_uart_txwm_clear(void) {
+    UART0_REG(UART_REG_IE)      &= ~UART_IP_TXWM;
+}
+
+void eos_uart_rxwm_set(uint8_t wm) {
+    UART0_REG(UART_REG_RXCTRL)  &= ~UART_RXWM(0xFFFF);
+    UART0_REG(UART_REG_RXCTRL)  |=  UART_RXWM(wm);
+    UART0_REG(UART_REG_IE)      |=  UART_IP_RXWM;
+}
+
+void eos_uart_rxwm_clear(void) {
+    UART0_REG(UART_REG_IE)      &= ~UART_IP_RXWM;
+}
+
+int eos_uart_putc(int c, char b) {
+    if (b) {
+        while (UART0_REG(UART_REG_TXFIFO) & 0x80000000);
+        UART0_REG(UART_REG_TXFIFO) = c & 0xff;
+    } else {
+        if (UART0_REG(UART_REG_TXFIFO) & 0x80000000) return EOS_ERR_FULL;
+        UART0_REG(UART_REG_TXFIFO) = c & 0xff;
+    }
+    return EOS_OK;
+}
+
+int eos_uart_getc(char b) {
+    volatile uint32_t r;
+
+    if (b) {
+        while ((r = UART0_REG(UART_REG_RXFIFO)) & 0x80000000);
+    } else {
+        r = UART0_REG(UART_REG_RXFIFO);
+        if (r & 0x80000000) return EOS_ERR_EMPTY;
+    }
+    return r & 0xff;
+}
\ No newline at end of file
diff --git a/code/fe310/eos/uart.h b/code/fe310/eos/uart.h
new file mode 100644
index 0000000..e6ce990
--- /dev/null
+++ b/code/fe310/eos/uart.h
@@ -0,0 +1,18 @@
+#include <stdint.h>
+
+#define EOS_UART_ETYPE_TX       1
+#define EOS_UART_ETYPE_RX       2
+
+#define EOS_UART_MAX_ETYPE      2
+
+typedef void (*eos_uart_fptr_t) (unsigned char);
+
+void eos_uart_init(void);
+void eos_uart_set_handler(unsigned char type, eos_uart_fptr_t handler, uint8_t flags);
+
+void eos_uart_txwm_set(uint8_t wm);
+void eos_uart_txwm_clear(void);
+void eos_uart_rxwm_set(uint8_t wm);
+void eos_uart_rxwm_clear(void);
+int eos_uart_putc(int c, char b);
+int eos_uart_getc(char b);
\ No newline at end of file