1 files changed, 91 insertions, 0 deletions
diff --git a/libraries/Ethernet/Server.cpp b/libraries/Ethernet/Server.cpp
new file mode 100644
index 0000000..d17a5d3
--- /dev/null
+++ b/libraries/Ethernet/Server.cpp
@@ -0,0 +1,91 @@
+extern "C" {
+  #include "types.h"
+  #include "w5100.h"
+  #include "socket.h"
+  #include "string.h"
+}
+
+#include "Ethernet.h"
+#include "Client.h"
+#include "Server.h"
+
+Server::Server(uint16_t port)
+{
+  _port = port;
+}
+
+void Server::begin()
+{
+  for (int sock = 0; sock < MAX_SOCK_NUM; sock++) {
+    Client client(sock);
+    if (client.status() == SOCK_CLOSED) {
+      socket(sock, Sn_MR_TCP, _port, 0);
+      listen(sock);
+      EthernetClass::_server_port[sock] = _port;
+      break;
+    }
+  }  
+}
+
+void Server::accept()
+{
+  int listening = 0;
+  
+  for (int sock = 0; sock < MAX_SOCK_NUM; sock++) {
+    Client client(sock);
+    
+    if (EthernetClass::_server_port[sock] == _port) {
+      if (client.status() == SOCK_LISTEN) {
+        listening = 1;
+      } else if (client.status() == SOCK_CLOSE_WAIT && !client.available()) {
+        client.stop();
+      }
+    } 
+  }
+  
+  if (!listening) {
+    begin();
+  }
+}
+
+Client Server::available()
+{
+  accept();
+  
+  for (int sock = 0; sock < MAX_SOCK_NUM; sock++) {
+    Client client(sock);
+    if (EthernetClass::_server_port[sock] == _port &&
+        client.status() == SOCK_ESTABLISHED) {
+      if (client.available()) {
+        // XXX: don't always pick the lowest numbered socket.
+        return client;
+      }
+    }
+  }
+  
+  return Client(255);
+}
+
+void Server::write(uint8_t b) 
+{
+  write(&b, 1);
+}
+
+void Server::write(const char *str) 
+{
+  write((const uint8_t *)str, strlen(str));
+}
+
+void Server::write(const uint8_t *buffer, size_t size) 
+{
+  accept();
+  
+  for (int sock = 0; sock < MAX_SOCK_NUM; sock++) {
+    Client client(sock);
+    
+    if (EthernetClass::_server_port[sock] == _port &&
+        client.status() == SOCK_ESTABLISHED) {
+      client.write(buffer, size);
+    }
+  }
+}