1 files changed, 61 insertions, 0 deletions
diff --git a/src/telnet.c b/src/telnet.c
new file mode 100644
index 0000000..2e86195
--- /dev/null
+++ b/src/telnet.c
@@ -0,0 +1,61 @@
+#include "netcosm.h"
+
+void telnet_handle_command(const unsigned char *buf)
+{
+    bool cmd = false;
+
+    while(*buf)
+    {
+        unsigned char c = *buf;
+
+        const struct telnet_cmd {
+            int val;
+            const char *name;
+        } commands[] = {
+            {  IAC,     "IAC"     },
+            {  DONT,    "DONT"    },
+            {  DO,      "DO"      },
+            {  WONT,    "WONT"    },
+            {  WILL,    "WILL"    },
+            {  GA,      "GA"      },
+            {  AYT,     "AYT"     },
+            {  NOP,     "NOP"     },
+            {  SB,      "SB"      },
+            {  SE,      "SE"      },
+            {  ECHO,    "ECHO"    },
+            {  SGA,     "SGA"     },
+            {  STATUS,  "STATUS"  },
+            {  NAWS,    "NAWS"    }
+        };
+
+        for(unsigned int i = 0; i < ARRAYLEN(commands); ++i)
+        {
+            if(c == commands[i].val)
+            {
+                printf("%s ", commands[i].name);
+                cmd = true;
+                goto found;
+            }
+        }
+        printf("??? ");
+    found:
+
+        ++buf;
+    }
+
+    if(cmd)
+        printf("\n");
+}
+
+void telnet_init(void)
+{
+    const unsigned char init_seq[] = {
+        IAC, WONT, SGA,
+        IAC, DONT, SGA,
+        IAC, WONT, NAWS,
+        IAC, DONT, NAWS,
+        IAC, WONT, STATUS,
+        IAC, DONT, STATUS,
+    };
+    out_raw(init_seq, ARRAYLEN(init_seq));
+}