83 lines
2.6 KiB
C++
Executable File
83 lines
2.6 KiB
C++
Executable File
/*
|
|
* @RDE_HEADER@
|
|
* Simulate players
|
|
* $Id$
|
|
* $HeadURL$
|
|
* $Author$
|
|
* Created by Hanna E. Rathje, SLTE, 2022-03-29
|
|
*/
|
|
|
|
#include "simulated_player.h"
|
|
#include "position_helper.h"
|
|
|
|
#include <WirelessLocationSystem/wls_sfm_message_converter.h>
|
|
#include <NGLLogger/NGLLoggerBootstrap.h>
|
|
#include <LtsUtils/LtsUtilsCore/sfm_bytemessage_converter.h>
|
|
#include <LtsCoordTrans/lts_coord_trans.h>
|
|
|
|
#include <QTimer>
|
|
|
|
#include "math.h"
|
|
|
|
namespace WlsRandomPositions
|
|
{
|
|
|
|
SimulatedPlayer::SimulatedPlayer(int equipNo, qint64 mac, int msecs, int jitter, double maxDistance, QObject *parent)
|
|
: QObject(parent)
|
|
, m_equipNo(equipNo)
|
|
, m_macAddress(toMacString(mac))
|
|
, m_msecs(msecs)
|
|
, m_jitter(jitter)
|
|
, m_maxDistance(maxDistance)
|
|
, m_pos({{},0.0})
|
|
, m_logger(NGL::NGLLoggerBootstrap::getNGLRootLogger().getNGLLogger(QString::fromLatin1("SimulatedPlayer.%1").arg(QString::number(m_equipNo)).toStdString()))
|
|
{
|
|
}
|
|
|
|
void SimulatedPlayer::start()
|
|
{
|
|
QString eqNoString = QString::number(m_equipNo);
|
|
QString initialTelegram = QString::fromLatin1("%1;%2;%3").arg(4).arg(m_macAddress).arg(eqNoString);
|
|
|
|
INFO_LOG(m_logger) << "initTelegram: " << initialTelegram;
|
|
|
|
WirelessLocationSystem::SfmMsgEquipmentId msg;
|
|
msg.setEquipmentNumber(m_equipNo);
|
|
QByteArray ba = WirelessLocationSystem::SfmMessageConverter::generateTxMessage(msg);
|
|
|
|
emit sendInitTelegram(m_macAddress, ba);
|
|
|
|
QTimer::singleShot(m_msecs + (((rand() % 200) - 100) / 100) * m_jitter, this, &SimulatedPlayer::onTimerTimeout);
|
|
}
|
|
|
|
void SimulatedPlayer::onTimerTimeout()
|
|
{
|
|
QPair<QPointF,double> pos;
|
|
if (qFuzzyIsNull(m_maxDistance) || m_pos.first.isNull())
|
|
pos = PositionHelper::randPos();
|
|
else
|
|
pos = PositionHelper::randPos(m_pos.first, m_maxDistance);
|
|
|
|
DEBUG_LOG(m_logger) << "posTelegram: x: " << pos.first.x() << ", y: " << pos.first.y() << ", z: " << pos.second;
|
|
DEBUG_LOG(m_logger) << "MGRS: " << LtsCoordTrans::UtmCoordinate::fromGeographic(pos.first).mgrs(5, true);
|
|
|
|
emit sendPositionTelegram(m_macAddress, pos.first, pos.second);
|
|
|
|
m_pos = pos;
|
|
QTimer::singleShot(m_msecs + (((rand() % 200) - 100) / 100) * m_jitter, this, &SimulatedPlayer::onTimerTimeout);
|
|
}
|
|
|
|
QString SimulatedPlayer::toMacString(qint64 mac)
|
|
{
|
|
QString macString = QString::number(mac, 16);
|
|
macString = macString.prepend(QString(12 - macString.length(), QLatin1Char('0')));
|
|
macString.insert(10, QLatin1Char(':'));
|
|
macString.insert( 8, QLatin1Char(':'));
|
|
macString.insert( 6, QLatin1Char(':'));
|
|
macString.insert( 4, QLatin1Char(':'));
|
|
macString.insert( 2, QLatin1Char(':'));
|
|
return macString;
|
|
}
|
|
|
|
} // Namespace WlsRandomPositions
|