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
|
/**
* @file MockServer.cpp
* @brief Mock XPL2 server — listens on all three protocol ports.
*/
#include "MockServer.h"
#include <QTcpSocket>
MockServer::MockServer (QObject *parent) : QObject (parent)
{
setupPort (m_command, "Command", 9110);
setupPort (m_imaging, "Imaging", 9111);
setupPort (m_status, "Status", 9112);
connect (&m_pingTimer, &QTimer::timeout, this, &MockServer::sendKaPing);
m_pingTimer.start (1000);
}
void
MockServer::setupPort (Port &port, const char *name, quint16 number)
{
port.name = name;
port.number = number;
connect (&port.server, &QTcpServer::newConnection, this,
&MockServer::onNewConnection);
if (!port.server.listen (QHostAddress::Any, number))
qCritical ("Failed to listen on %s port %d: %s", name, number,
qPrintable (port.server.errorString ()));
else
qInfo ("Listening on %s port %d", name, number);
}
const char *
MockServer::portName (quint16 localPort) const
{
if (localPort == m_command.number)
return m_command.name;
if (localPort == m_imaging.number)
return m_imaging.name;
if (localPort == m_status.number)
return m_status.name;
return "Unknown";
}
void
MockServer::onNewConnection ()
{
auto *server = qobject_cast<QTcpServer *> (sender ());
while (auto *sock = server->nextPendingConnection ())
{
quint16 lp = sock->localPort ();
qInfo ("[%s:%d] client connected", portName (lp), lp);
m_clients.append (sock);
connect (sock, &QTcpSocket::readyRead, this,
&MockServer::onClientMessageReady);
connect (sock, &QTcpSocket::disconnected, this,
&MockServer::onClientDisconnected);
}
}
void
MockServer::onClientMessageReady ()
{
auto *sock = qobject_cast<QTcpSocket *> (sender ());
while (sock->canReadLine ())
{
QByteArray line = sock->readLine ();
handleCommand (sock, line);
}
}
void
MockServer::onClientDisconnected ()
{
auto *sock = qobject_cast<QTcpSocket *> (sender ());
quint16 lp = sock->localPort ();
qInfo ("[%s:%d] client disconnected", portName (lp), lp);
m_clients.removeOne (sock);
sock->deleteLater ();
}
void
MockServer::sendKaPing ()
{
for (auto *client : m_clients)
{
if (client->state () == QAbstractSocket::ConnectedState)
client->write ("KA_PING\n");
}
}
void
MockServer::handleCommand (QTcpSocket *client, const QByteArray &line)
{
QByteArray trimmed = line.trimmed ();
if (trimmed.isEmpty ())
return;
quint16 lp = client->localPort ();
/* Split on first comma to get command token. */
int comma = trimmed.indexOf (',');
QByteArray cmd = (comma >= 0) ? trimmed.left (comma) : trimmed;
if (cmd == "KA_PING")
{
qDebug ("[%s:%d] KA_PING ACK received", portName (lp), lp);
return;
}
if (cmd == "GS_JC_VERSION")
{
qInfo ("[%s:%d] -> GS_JC_VERSION reply", portName (lp), lp);
client->write ("GS_JC_VERSION,1,\"1.05\",\"2.00\",15\n");
return;
}
qWarning ("[%s:%d] Unknown command: %s", portName (lp), lp,
trimmed.constData ());
}
|
