-
Notifications
You must be signed in to change notification settings - Fork 10
Expand file tree
/
Copy pathLineServer.cs
More file actions
134 lines (103 loc) · 3.63 KB
/
Copy pathLineServer.cs
File metadata and controls
134 lines (103 loc) · 3.63 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
using System;
using System.Threading;
using Microsoft.SPOT;
using Microsoft.SPOT.Hardware;
using SecretLabs.NETMF.Hardware;
using SecretLabs.NETMF.Hardware.Netduino;
using System.Net.Sockets;
using System.Net;
using System.Text;
namespace NetduinoSocketServer
{
public class LineServer
{
public LineServer()
{
}
public void Listen(int port)
{
using (Socket socket = new Socket(AddressFamily.InterNetwork, SocketType.Stream, ProtocolType.Tcp))
{
try
{
socket.Bind(new IPEndPoint(IPAddress.Any, port));
socket.Listen(1);
Debug.Print("Netduino is listening on port " + port);
while (true)
{
using (Socket commSocket = socket.Accept())
{
OnConnect(commSocket);
while (true)
{
Thread.Sleep(1);
if (commSocket.Poll(-1, SelectMode.SelectRead))
{
int available = commSocket.Available;
if (available == 0) break; // Disconnect from the other side
byte[] bytes = new byte[available];
int count = commSocket.Receive(bytes);
bool result = Process(bytes, commSocket);
if (!result) break;
}
}
commSocket.Close();
}
}
socket.Close();
Debug.Print("Netduino server stopped");
}
catch (Exception ex)
{
Debug.Print("ERROR: " + ex.Message + ex.StackTrace);
}
}
}
private const int MaxBufLen = 255;
private char[] mRecvBuf = new char[MaxBufLen];
private int mRecvBufPos = 0;
private bool Process(byte[] buffer, Socket socket)
{
char[] chars = Encoding.UTF8.GetChars(buffer);
bool result = true;
foreach (char c in chars)
{
switch (c)
{
case '\r':
case '\n':
if (mRecvBufPos > 0)
{
// ProcessLine
string line = new string(mRecvBuf, 0, mRecvBufPos);
result = ProcessLine(line, socket);
mRecvBufPos = 0;
}
break;
default:
mRecvBuf[mRecvBufPos++] = c;
break;
}
}
return result;
}
protected virtual void OnConnect(Socket socket)
{
}
protected virtual bool ProcessLine(string line, Socket socket)
{
//Debug.Print("LINE: " + line);
if (line.ToLower() == "exit") return false;
return true;
}
protected void SendString(string s, Socket socket)
{
byte[] buf = Encoding.UTF8.GetBytes(s);
int sent = 0;
while (sent < buf.Length)
{
sent += socket.Send(buf, sent, buf.Length - sent, SocketFlags.None);
}
}
}
}