Revize 681d1a97

Re #8629 - Server skeleton implementation

deltarobot/curvedataserver.cpp

@@ +1 @@
+#include "curvedataserver.h"
+
+#include <QDebug>
+#include <QHostAddress>
+#include <QAbstractSocket>
+
+CurveDataServer::CurveDataServer() :
+    _server(this),
+    _sockets()
+{
+    _server.listen(QHostAddress::Any, 4242);
+    connect(&_server, SIGNAL(newConnection()), this, SLOT(onNewConnection()));
+}
+
+CurveDataServer::~CurveDataServer()
+{
+    // asi vlastne neni co
+}
+
+void CurveDataServer::onNewConnection()
+{
+    QTcpSocket *clientSocket = _server.nextPendingConnection();
+    connect(clientSocket, SIGNAL(readyRead()), this, SLOT(onReadyRead()));
+    connect(clientSocket, SIGNAL(stateChanged(QAbstractSocket::SocketState)), this, SLOT(onSocketStateChanged(QAbstractSocket::SocketState)));
+
+    _sockets.push_back(clientSocket);
+    for (QTcpSocket* socket : _sockets) {
+        socket->write(QByteArray::fromStdString(clientSocket->peerAddress().toString().toStdString() + " connected to server !\n"));
+    }
+}
+
+void CurveDataServer::onSocketStateChanged(QAbstractSocket::SocketState socketState)
+{
+    if (socketState == QAbstractSocket::UnconnectedState)
+    {
+        QTcpSocket* sender = static_cast<QTcpSocket*>(QObject::sender());
+        _sockets.removeOne(sender);
+    }
+}
+
+void CurveDataServer::onReadyRead()
+{
+    // tady actually nakonec switch zpracovani ruznych zprav dle identifikatoru
+    QTcpSocket* sender = static_cast<QTcpSocket*>(QObject::sender());
+    QByteArray data = sender->readAll();
+    for (QTcpSocket* socket : _sockets) {
+        if (socket != sender)
+            socket->write(QByteArray::fromStdString(sender->peerAddress().toString().toStdString() + ": " + data.toStdString()));
+    }
+}
+
+QByteArray *CurveDataServer::createMessageId(int sizeId, int typeId)
+{
+    QByteArray *id = new QByteArray();
+
+    id->append((sizeId & 0x0F) << 4 + ((typeId & 0x0F00) >> 12));
+    id->append(typeId & 0xFF);
+
+    return id;
+}
+/*
+QByteArray *CurveDataServer::appendFloatToMessage(QByteArray *message, float f)
+{
+    if (!message)
+        return message;
+
+    unsigned char *c = reinterpret_cast<unsigned char *>(&f);
+
+    for (int i = 0; i < 4; i++)
+    {
+        message->append(c[3 - i]);
+    }
+
+    return message;
+}
+*/
+QByteArray *CurveDataServer::putFloatIntoMessage(QByteArray *message, int index, float f)
+{
+    if (!message || message->size() < index + 4)
+        return message;
+
+    unsigned char *c = reinterpret_cast<unsigned char *>(&f);
+
+    for (int i = 0; i < 4; i++)
+    {
+        (*message)[index + i] = c[i];
+    }
+
+    return message;
+}
+
+
+void CurveDataServer::sendApplicatorPoint(float x, float y, float z)
+{
+    QByteArray message(18, 0);
+    message[0] = 0x40;
+    message[1] = 0x03;
+
+    putFloatIntoMessage(&message, 2, x);
+    putFloatIntoMessage(&message, 6, y);
+    putFloatIntoMessage(&message, 10, z);
+    putFloatIntoMessage(&message, 14, 0.0);
+
+    for (QTcpSocket* socket : _sockets) {
+            socket->write(message);
+    }
+    qDebug() << message.toHex();
+}

deltarobot/curvedataserver.h

@@ +1 @@
+#ifndef CURVEDATASERVER_H
+#define CURVEDATASERVER_H
+
+#include <QObject>
+#include <QTcpServer>
+#include <QTcpSocket>
+
+class CurveDataServer : QObject
+{
+    Q_OBJECT
+
+public:
+    CurveDataServer();
+    ~CurveDataServer();
+    void sendApplicatorPoint(float x, float y, float z);
+
+public slots:
+    void onNewConnection();
+    void onSocketStateChanged(QAbstractSocket::SocketState socketState);
+    void onReadyRead();
+
+private:
+    QByteArray *createMessageId(int sizeId, int typId);
+    //QByteArray *appendFloatToMessage(QByteArray *message, float f);
+    QByteArray *putFloatIntoMessage(QByteArray *message, int index, float f);
+
+    QTcpServer _server;
+    QList<QTcpSocket*> _sockets;
+};
+
+#endif // CURVEDATASERVER_H

deltarobot/mainwindow.cpp

@@ -1 +1 @@
 #include "mainwindow.h"
 #include "curvedialog.h"
 #include "infodialog.h"
+#include "curvedataserver.h"
 #include "selectpatientdlg.h"
 #include "ui_mainwindow.h"
 #include <QModbusTcpClient>
@@ -93 +94 @@
 
 MainWindow::MainWindow(QWidget *parent) :
     QMainWindow(parent),
-    ui(new Ui::MainWindow)
+    ui(new Ui::MainWindow),
+    cdServer(new CurveDataServer)
 {
     ui->setupUi(this);
 
     mbClient = new QModbusTcpClient(this);
+
     pendingRead = pendingWrite = lastPacket = initStep = bSpeedUpdated = false;
     calcCurvePoints[0] = calcCurvePoints[1] = staticSpherePos = spherePos = QVector3D(0,0,0);
     dirArrow = QVector3D(0,0,0);
@@ -265 +268 @@
     }
     delete db;
     delete ui;
+    delete cdServer;
 }
 
 //! Připojit/Odpojit modbus server
@@ -1067 +1071 @@
         connectionGuard->restart();
     }
 #endif
+    cdServer->sendApplicatorPoint(spherePos.x(), spherePos.y(), spherePos.z());
 }
 
 //! Příjem dat ze stroje

deltarobot/mainwindow.h

@@ -7 +7 @@
 #include "QsLog.h"
 #include "../db_browser/dbaccess.h"
 
+#include "curvedataserver.h"
+
 #include <QFile>
 #include <QTextStream>
 
@@ -98 +100 @@
     QModbusClient *mbClient;
     //! Databázové spojení
     dbAccess *db;
+
+    //! TCP Server dat křivky
+    CurveDataServer *cdServer;
+
     //! Status spojení s databází
     bool dbConnected;
     //! Proměnná obsahující info, má-li být databáze použita

deltarobot/modbusSlave.pro

@@ -4 +4 @@
 #
 #-------------------------------------------------
 
-QT       += core gui serialbus opengl charts sql
+QT       += core gui serialbus opengl charts sql network
 
 greaterThan(QT_MAJOR_VERSION, 4): QT += widgets
 
@@ -31 +31 @@
 }
 
 SOURCES += \
+    curvedataserver.cpp \
         main.cpp \
         mainwindow.cpp \
     curvedialog.cpp \
@@ -46 +47 @@
     selectpatientdlg.cpp
 
 HEADERS += \
+    curvedataserver.h \
         mainwindow.h \
     curvedialog.h \
     element/arrow.hpp \