code -> fw

1 files changed, 96 insertions, 0 deletions

diff --git a/fw/fe310/eos/sock.c b/fw/fe310/eos/sock.c
new file mode 100644
index 0000000..720e620
--- /dev/null
+++ b/fw/fe310/eos/sock.c
@@ -0,0 +1,96 @@
+#include <stdlib.h>
+#include <stdint.h>
+#include <string.h>
+
+#include "eos.h"
+#include "event.h"
+#include "net.h"
+
+#include "sock.h"
+
+static eos_evt_handler_t evt_handler[EOS_SOCK_MAX_SOCK];
+
+static void sock_handle_evt(unsigned char type, unsigned char *buffer, uint16_t len) {
+    unsigned char sock;
+    if ((buffer == NULL) || (len < 2)) {
+        eos_net_bad_handler(type, buffer, len);
+        return;
+    }
+
+    sock = buffer[1];
+    if ((sock == 0) || (sock > EOS_SOCK_MAX_SOCK)) {
+        eos_net_bad_handler(type, buffer, len);
+        return;
+    }
+
+    sock--;
+    switch(buffer[0]) {
+        case EOS_SOCK_MTYPE_PKT:
+            evt_handler[sock](type, buffer, len);
+            break;
+        default:
+            eos_net_bad_handler(type, buffer, len);
+            break;
+    }
+}
+
+void eos_sock_init(void) {
+    int i;
+
+    for (i=0; i<EOS_SOCK_MAX_SOCK; i++) {
+        evt_handler[i] = eos_net_bad_handler;
+    }
+    eos_net_set_handler(EOS_NET_MTYPE_SOCK, sock_handle_evt);
+}
+
+void eos_sock_set_handler(unsigned char sock, eos_evt_handler_t handler) {
+    if (handler == NULL) handler = eos_net_bad_handler;
+    if (sock && (sock <= EOS_SOCK_MAX_SOCK)) evt_handler[sock - 1] = handler;
+}
+
+int eos_sock_open_udp(void) {
+    unsigned char type = EOS_SOCK_MTYPE_OPEN_DGRAM;
+    unsigned char *buffer = eos_net_alloc();
+    uint16_t buf_size;
+    int rv, sock;
+
+    buffer[0] = type;
+    rv = eos_net_send(EOS_NET_MTYPE_SOCK, buffer, 1, 0);
+    if (rv) return rv;
+
+    eos_evtq_wait(EOS_NET_MTYPE_SOCK, &type, 1, &buffer, &buf_size);
+    if (buf_size < 2) {
+        eos_net_free(buffer, 0);
+        return EOS_ERR_NET;
+    }
+
+    sock = buffer[1];
+    eos_net_free(buffer, 1);
+
+    if (sock == 0) return EOS_ERR_NET;
+    return sock;
+}
+
+void eos_sock_close(unsigned char sock) {
+    unsigned char *buffer = eos_net_alloc();
+    buffer[0] = EOS_SOCK_MTYPE_CLOSE;
+    buffer[1] = sock;
+    eos_net_send(EOS_NET_MTYPE_SOCK, buffer, 2, 1);
+}
+
+int eos_sock_sendto(unsigned char sock, unsigned char *buffer, uint16_t size, unsigned char more, EOSNetAddr *addr) {
+    unsigned char type = EOS_NET_MTYPE_SOCK;
+
+    buffer[0] = EOS_SOCK_MTYPE_PKT;
+    buffer[1] = sock;
+    memcpy(buffer+2, addr->host, sizeof(addr->host));
+    memcpy(buffer+2+sizeof(addr->host), &addr->port, sizeof(addr->port));
+    return eos_net_send(type, buffer, size, more);
+}
+
+void eos_sock_getfrom(unsigned char *buffer, EOSNetAddr *addr) {
+    memcpy(addr->host, buffer+2, sizeof(addr->host));
+    memcpy(&addr->port, buffer+2+sizeof(addr->host), sizeof(addr->port));
+}
+
+