Projekt

Obecné

Profil

Stáhnout (4.34 KB) Statistiky
| Větev: | Tag: | Revize:
1 681d1a97 Jakub Hejman
#ifndef CURVEDATASERVER_H
2
#define CURVEDATASERVER_H
3
4
#include <QObject>
5
#include <QTcpServer>
6
#include <QTcpSocket>
7 0cda8e8d Oto Šťáva
#include <map>
8
#include <mutex>
9 6d9543aa Jakub Hejman
#include <thread>
10 f06d5ae1 Jakub Hejman
11 313ff1dc Oto Šťáva
12
/**
13
 * Manages communication with clients who can connect to the server in order to receive real-time data about the current
14
 * exercise. The served data may be used e.g. for external visualization. A reference implementation of such a client is
15
 * the deltarobot-vr Unity application.
16
 */
17 681d1a97 Jakub Hejman
class CurveDataServer : QObject
18
{
19
    Q_OBJECT
20
21
public:
22 313ff1dc Oto Šťáva
23
    /**
24
     * Holds information about a client, its Qt socket, data buffer etc.
25
     */
26 0cda8e8d Oto Šťáva
    struct Client {
27 285c6fe5 Oto Šťáva
        /**
28
         * Size of the client buffer.
29
         *
30
         * @note Current implementation truncates any variable-length messages longer than what would fit in the buffer.
31
         */
32 6d9543aa Jakub Hejman
        static const size_t BUF_SIZE = 4096;
33 285c6fe5 Oto Šťáva
34 000564ed Oto Šťáva
        static const size_t MESSAGE_ID_SIZE = sizeof(uint16_t);      ///< Size of the protocol message identifier
35
        static const size_t MESSAGE_LENGTH_SIZE = sizeof(uint32_t);  ///< Size of the variable-length message's content length
36 0cda8e8d Oto Šťáva
37 313ff1dc Oto Šťáva
        QTcpSocket* socket;                 ///< Communication socket
38
        std::map<uint64_t, uint64_t> ping;  ///< Key: ping ID;  Value: ping timestamp (msec);
39
        uint64_t latency;                   ///< Current latency
40
        uint64_t lastPong;                  ///< Timestamp of the last pong
41 0cda8e8d Oto Šťáva
42 313ff1dc Oto Šťáva
        char buf[BUF_SIZE];                 ///< Message buffer
43
        size_t bufUsed = 0;                 ///< Number of bytes used up in the message buffer
44 0cda8e8d Oto Šťáva
45 000564ed Oto Šťáva
        bool magic = false;                 ///< Whether the client has sent the correct protocol magic
46
        bool version = false;               ///< Whether the client has sent the correct protocol version
47
        bool protocolValid = false;         ///< Whether the client has sent both the correct protocol magic and version.
48
49
        bool initialized = false;           ///< Whether the server has initialized this client with the current curve
50 6d9543aa Jakub Hejman
51 0cda8e8d Oto Šťáva
        Client(QTcpSocket* socket);
52
    };
53
54
    explicit CurveDataServer();
55
    ~CurveDataServer();
56
57 313ff1dc Oto Šťáva
    /** Sends the current actuator position. */
58 e6053a29 Oto Šťáva
    void sendActuatorPosition(float x, float y, float z);
59 313ff1dc Oto Šťáva
60
    /** Sends the actual direction the actuator is moving in. */
61 f06d5ae1 Jakub Hejman
    void sendActualDirection(float x, float y, float z);
62 313ff1dc Oto Šťáva
63
    /** Sends the direction the actuator *should* be moving in, in order to draw the curve. */
64 f06d5ae1 Jakub Hejman
    void sendTargetDirection(float x, float y, float z);
65 313ff1dc Oto Šťáva
66
    /** Stores and sends the specified curve. */
67 705930ed Jakub Hejman
    void sendNewCurve(QList<QVector4D> &points);
68 313ff1dc Oto Šťáva
69
    /** Stores and sends the specified curve. */
70 705930ed Jakub Hejman
    void sendNewCurve(QList<QVector3D> &points);
71 313ff1dc Oto Šťáva
72
    /** Sends the currently stored curve. This is used for newly connected clients. */
73 6d9543aa Jakub Hejman
    void sendCurve(Client &client);
74
75 313ff1dc Oto Šťáva
    /** Sends ping messages to the clients, checks whether any clients have timed out, and disconnects any that have. */
76
    void processPings();
77 681d1a97 Jakub Hejman
78
public slots:
79
    void onNewConnection();
80
    void onSocketStateChanged(QAbstractSocket::SocketState socketState);
81
    void onReadyRead();
82
83
private:
84 313ff1dc Oto Šťáva
    /** Gets the client that is connected via the specified socket. */
85 0cda8e8d Oto Šťáva
    QList<Client>::iterator clientOf(QTcpSocket *socket);
86
87 285c6fe5 Oto Šťáva
    void handleMessage(Client& client, uint16_t messageId, void* content, size_t contentSize);
88 6d9543aa Jakub Hejman
    void handleProtocolMagic(Client& client, char* content);
89
    void handleVersion(Client& client, uint8_t content);
90
    void handlePong(Client& client, uint64_t* content);
91 285c6fe5 Oto Šťáva
    void handleEOT(Client& client, char* content, size_t contentSize);
92 6d9543aa Jakub Hejman
93 000564ed Oto Šťáva
    /**
94
     * Checks whether the specified client has already sent both its protocol magic and version. If so, the appropriate
95
     * flag is set and a log is written out into qDebug.
96
     */
97
    void validateProtocol(Client& client);
98
99 6d9543aa Jakub Hejman
    void removeSocket(QTcpSocket *socket);
100
    void terminateConnection(Client& client, std::string&& reason);
101
    void sendPing(Client& client);
102 0cda8e8d Oto Šťáva
103 e60ade62 Jakub Hejman
    void sendPreamble(QTcpSocket *socket);
104
    void sendProtocolMagic(QTcpSocket *socket);
105
    void sendVersion(QTcpSocket *socket);
106 0cda8e8d Oto Šťáva
    void sendEot(QTcpSocket *socket, std::string&& message);
107 681d1a97 Jakub Hejman
108 6d9543aa Jakub Hejman
    void sendMessageToAllConnected(QByteArray &message);
109
110 681d1a97 Jakub Hejman
    QTcpServer _server;
111 0cda8e8d Oto Šťáva
112
    std::recursive_mutex _socketsLock;
113
    QList<Client> _sockets;
114 6d9543aa Jakub Hejman
115
    std::recursive_mutex _currentCurveLock;
116
    QList<QVector3D> _currentCurve;
117 681d1a97 Jakub Hejman
};
118
119
#endif // CURVEDATASERVER_H