qt5-legatus-legacy/Lts/Tools/WlsRandomPositions/worker.cpp

/*
 * @RDE_HEADER@
 * Sending of telegrams to websocket
 * $Id$
 * $HeadURL$
 * $Author$
 * Created by Hanna E. Rathje, SLTE, 2022-03-29
 */

#include "worker.h"

#include <NGLLogger/NGLLoggerBootstrap.h>
#include <LtsCoordTrans/lts_coord_trans.h>

#include <QDateTime>
#include <QPointF>

namespace WlsRandomPositions
{

static inline QByteArray escapeData(const QByteArray &bufferData)
{
  QByteArray ret;
  ret.reserve(bufferData.size() * 6 / 5);
  for (const unsigned char c : bufferData)
  {
    if (c >= 0x20 && c < 0x7f)
      ret += c;
    else
      ret += "\\x" + QByteArray::number(static_cast<unsigned char>(c), 16);
  }
  return ret;
}


Worker::Worker(QObject *parent)
  : QObject(parent)  
  , m_logger(NGL::NGLLoggerBootstrap::getNGLRootLogger().getNGLLogger("Worker"))
{
  m_tcpClient = new QTcpSocket(this);

  connect(m_tcpClient, &QTcpSocket::connected, this, &Worker::onTcpConnected);
  connect(m_tcpClient, QOverload<QAbstractSocket::SocketError>::of(&QTcpSocket::error), this, &Worker::error);
  connect(m_tcpClient, &QTcpSocket::disconnected, this, &Worker::onTcpDisconnected);
}

Worker::~Worker()
{
  delete m_tcpClient;
}

void Worker::connectToServer(const QString &serverName, int serverPort)
{
  m_server = serverName;
  m_serverPort = serverPort;

  m_tcpClient->connectToHost(m_server, m_serverPort);
}

void Worker::onTcpConnected()
{
  INFO_LOG(m_logger) << "Connected to " << m_server << ", Port: " << m_serverPort;
  QString status =  tr("Connected to %1, Port: %2").arg(m_server).arg(m_serverPort);
  emit connectionStateChanged(true, status);
}

void Worker::onTcpDisconnected()
{
  INFO_LOG(m_logger) << "Disconnected";
  QString status =  tr("Disconnected");
  emit connectionStateChanged(false, status);
}

void Worker::error()
{
  ERROR_LOG(m_logger) << "SocketError " << m_tcpClient->errorString();
  emit connectionStateChanged(false, m_tcpClient->errorString());
}

void Worker::start(int numberParticipants, int firstEquipNo, qint64 firstMacAddress, int mSecs, int jitter, double maxDistance)
{
  m_sentTelegrams = 0;
  int equipNo = firstEquipNo;
  qint64 mac = firstMacAddress;

  for (int i=0; i<numberParticipants; ++i)
  {
    DEBUG_LOG(m_logger) << "SimulatedPlayer: equipNo: " << equipNo << ", macAddress: " << mac;
    SimulatedPlayer *sp = new SimulatedPlayer(equipNo++, mac++, mSecs, jitter, maxDistance, this);
    connect(sp, &SimulatedPlayer::sendInitTelegram, this, &Worker::onInit);
    connect(sp, &SimulatedPlayer::sendPositionTelegram, this, &Worker::onPosition);
    m_players << sp;
    sp->start();
  }

  INFO_LOG(m_logger) << numberParticipants << " Players started";
}

void Worker::onInit(const QString &macAddress, const QByteArray &content)
{
  QDateTime dt = QDateTime::currentDateTime();
  QByteArray data;

  data.clear();

  data.append(0x7F);                                                  // Startkennung
  data.append(QByteArray::number(3)); //
  data.append(';');                                                   // Trennzeichen
  data.append(dt.toString(QStringLiteral("yyyy-MM-dd hh:mm:ss.zzz")).toLatin1());     // Aktuelle Zeit
  data.append(';');                                                   // Trennzeichen
  data.append(macAddress.toUtf8());                                                 // Tag-ID
  data.append(';');                                                   // Trennzeichen
  data.append(content); // ba < 80 Zeichen!
  data.append(0x8F);                                                  // Endekennung

  qint64 ret = m_tcpClient->write(data);
  if (ret < 0)
  {
    ERROR_LOG(m_logger) << "Could not send init data for macAddress " << macAddress;
  }
  else
  {    
    DEBUG_LOG(m_logger) << "Sending telegram to wls: " << escapeData(data);
    m_tcpClient->flush();
    emit telegramsIncremented(++m_sentTelegrams);
  }
}

void Worker::onPosition(const QString &macAddress, QPointF pos, double height)
{
  QString mgrs = LtsCoordTrans::mgrsFromGeographic(pos.x(), pos.y(), 7, false);
  QString value = mgrs.right(14);
  QString x = value.left(7);
  QString y = value.right(7);
  QString z = QString::number(height);

  QDateTime dt = QDateTime::currentDateTime();
  QByteArray data;

  data.clear();

  data.append(0x7F);                                                  // Startkennung
  data.append(QByteArray::number(1)); //
  data.append(';');                                                   // Trennzeichen
  data.append(dt.toString(QStringLiteral("yyyy-MM-dd hh:mm:ss.zzz")).toLatin1());     // Aktuelle Zeit
  data.append(';');                                                   // Trennzeichen
  data.append(macAddress.toUtf8());                                                 // Tag-ID
  data.append(';');                                                   // Trennzeichen
  data.append(x.toUtf8());
  data.append(';');                                                   // Trennzeichen
  data.append(y.toUtf8());
  data.append(';');                                                   // Trennzeichen
  data.append(z.toUtf8());
  data.append(";1;0;0;-1;-1");
  data.append(0x8F);                                                  // Endekennung

  qint64 ret = m_tcpClient->write(data);
  if (ret < 0)
  {
    ERROR_LOG(m_logger) << "Could not send pos data for macAddress " << macAddress;
  }
  else
  {
    DEBUG_LOG(m_logger) << "Sending telegram to wls: " << escapeData(data);
    m_tcpClient->flush();
    emit telegramsIncremented(++m_sentTelegrams);
  }
}

void Worker::stop()
{
  INFO_LOG(m_logger) << "stop worker";

  for (SimulatedPlayer* sp : m_players)
    sp->deleteLater();
  m_players.clear();

  m_tcpClient->close();
}

} // Namespace WlsRandomPositions