165 lines
4.2 KiB
C++
Executable File
165 lines
4.2 KiB
C++
Executable File
/**
|
|
* @RDE_HEADER@
|
|
* Display Panel Simulator TCP Server; observes the given port and emits the incoming messages
|
|
* $Id$
|
|
* $HeadURL$
|
|
* $Author$
|
|
* Created by Florian Schult, SLSE, 2016-03-18
|
|
*/
|
|
//===Include specifications==================================================
|
|
#include "displayPanelSimulatorTcpServer.h"
|
|
#include <QtNetwork/QTcpServer>
|
|
#include <QtNetwork/QTcpSocket>
|
|
|
|
#include <NGLLogger/NGLLoggerBootstrap.h>
|
|
|
|
//===DisplayPanelSimulatorTcpServer==========================================
|
|
|
|
//---Constructors/Destructors------------------------------------------------
|
|
|
|
/**
|
|
* Constructor.
|
|
*/
|
|
DisplayPanelSimulatorTcpServer::DisplayPanelSimulatorTcpServer(QObject *parent)
|
|
: QObject(parent)
|
|
, mp_server(new QTcpServer(this))
|
|
, mp_socket(nullptr)
|
|
, m_port(0)
|
|
, m_logger(NGL::NGLLoggerBootstrap::getNGLRootLogger().getNGLLogger("DispSim.DisplayPanelSimulatorWidget"))
|
|
{
|
|
}
|
|
|
|
/**
|
|
* Destructor.
|
|
*/
|
|
DisplayPanelSimulatorTcpServer::~DisplayPanelSimulatorTcpServer()
|
|
{
|
|
delete mp_server;
|
|
}
|
|
|
|
//---Private slots-----------------------------------------------------------
|
|
|
|
/**
|
|
* Handles the 'newConnection' signal of the TCP server.
|
|
*/
|
|
void DisplayPanelSimulatorTcpServer::handleServerNewConnection()
|
|
{
|
|
mp_socket = mp_server->nextPendingConnection();
|
|
connect(mp_socket, &QTcpSocket::readyRead,
|
|
this, &DisplayPanelSimulatorTcpServer::handleSocketReadyRead);
|
|
emit debugMessage(m_port, QStringLiteral("Socket connected!"), MSGLVL_DEBUG);
|
|
}
|
|
|
|
/**
|
|
* Handles the 'readyRead' signal of the TCP socket.
|
|
*/
|
|
void DisplayPanelSimulatorTcpServer::handleSocketReadyRead()
|
|
{
|
|
evaluateData(mp_socket->readAll());
|
|
}
|
|
|
|
//---Private methods---------------------------------------------------------
|
|
|
|
/**
|
|
* Evaluates the received data from the TCP socket.
|
|
*/
|
|
void DisplayPanelSimulatorTcpServer::evaluateData(const QByteArray &data)
|
|
{
|
|
QByteArray page;
|
|
QString message;
|
|
bool ackRequested = false;
|
|
bool dataOk = false;
|
|
|
|
if (data.isEmpty())
|
|
return;
|
|
|
|
char cs = data.at(data.size() - 1);
|
|
char csCalc = calculateChecksum(data);
|
|
if (data.size() >= 5)
|
|
ackRequested = data[4] & 0x08;
|
|
if (data.size() < 10)
|
|
{
|
|
message = tr("Message to small!");
|
|
|
|
ERROR_LOG(m_logger) << "Error in message data evaluation";
|
|
}
|
|
else if (data[0] != 0)
|
|
{
|
|
message = tr("No SYNC in Message!");
|
|
|
|
ERROR_LOG(m_logger) << "Error in message data evaluation";
|
|
}
|
|
else if (cs != csCalc)
|
|
{
|
|
const QByteArray ba = "Wrong Checksum: 0x" + QByteArray::number(cs, 16) + " <-> 0x" + QByteArray::number(csCalc, 16);
|
|
qDebug() << ba.data();
|
|
message = QString::fromLatin1(ba);
|
|
|
|
ERROR_LOG(m_logger) << "Error in message data evaluation";
|
|
}
|
|
else
|
|
{
|
|
page = data.mid(5, 3);
|
|
const QByteArray ba = data.mid(11, (data.size() - 13));
|
|
message = QString::fromUtf8(ba.data(), ba.size());
|
|
emit plainMessage(message);
|
|
emit debugMessage(m_port, tr("New message received: %1").arg(message), MSGLVL_INFO);
|
|
|
|
INFO_LOG(m_logger) << "New message received";
|
|
|
|
dataOk = true;
|
|
}
|
|
if (!dataOk/* || page == "001"*/)
|
|
{
|
|
emit debugMessage(m_port, message, MSGLVL_ERROR);
|
|
|
|
ERROR_LOG(m_logger) << "Error in message data evaluation";
|
|
|
|
}
|
|
if (ackRequested)
|
|
{
|
|
if (dataOk)
|
|
{
|
|
mp_socket->write("\x06"); // ACK
|
|
}
|
|
else
|
|
{
|
|
mp_socket->write("\x15"); // NAK
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Calculates the checksum of the received data from the TCP socket.
|
|
*/
|
|
char DisplayPanelSimulatorTcpServer::calculateChecksum(const QByteArray &data)
|
|
{
|
|
char checksum = 0;
|
|
for (const auto c : data)
|
|
checksum ^= c;
|
|
|
|
return checksum;
|
|
}
|
|
|
|
//---Public methods----------------------------------------------------------
|
|
|
|
/**
|
|
* Starts the TCP server.
|
|
*/
|
|
void DisplayPanelSimulatorTcpServer::start(int port)
|
|
{
|
|
m_port = port;
|
|
connect(mp_server, &QTcpServer::newConnection,
|
|
this, &DisplayPanelSimulatorTcpServer::handleServerNewConnection);
|
|
emit debugMessage(m_port, tr("Waiting for connection"), MSGLVL_DEBUG);
|
|
|
|
if (!mp_server->listen(QHostAddress::Any, port))
|
|
{
|
|
emit debugMessage(m_port, tr("Opening socket failed! May be in use!"), MSGLVL_ERROR);
|
|
|
|
ERROR_LOG(m_logger) << "Opening socket failed; Port: " << port;
|
|
}
|
|
}
|
|
|
|
//===========================================================================
|