qt-migration-legatus/qt6-after/qt6-migrated-legatus/Lts/Proxies/TrainingAreaBase/Plugins/ApacheHlaJson/ppm_handler.cpp

#include "ppm_handler.h"

#include <QJsonDocument>


namespace ApHlaJson
{



PpmHandler::PpmHandler(QObject *parent)
  : QObject(parent)
{}

bool PpmHandler::init(MainDispatcher* mainDispatcher)
{
  if (m_dtcPpm)
    return true;

  m_dtcPpm = ParticipantManagement::Interface::Dtc::create(mainDispatcher->ddsHandler()->ddsConnector());

  if (!m_dtcPpm->enableParticipant() || !m_dtcPpm->enableDynamicParticipantData() || !m_dtcPpm->enableParticipantPosition())
  {
    ERROR_LOG() << "Can not read data from Ppm";
    return false;
  }

  m_dtcPpm->waitForHistoricalDataParticipant(1000);
  m_dtcPpm->waitForHistoricalDataDynamicParticipantData(1000);
  m_dtcPpm->waitForHistoricalDataParticipantPosition(1000);

  connect(m_dtcPpm.get(), &ParticipantManagement::Interface::Dtc::participantChanged,
          this, &PpmHandler::onParticipantChanged);

  connect(m_dtcPpm.get(), &ParticipantManagement::Interface::Dtc::participantPositionChanged,
          this, &PpmHandler::onParticipantPositionChanged);

  connect(m_dtcPpm.get(), &ParticipantManagement::Interface::Dtc::dynamicParticipantDataChanged,
          this, &PpmHandler::onDynamicParticipantDataChanged);

  return true;
}

QString PpmHandler::fromDisInt(qint64 value)
{
  QString s;

  s.prepend(QString::number(value % 1000));
  s.prepend(QLatin1Literal("."));
  value /= 1000;
  s.prepend(QString::number(value % 1000));
  s.prepend(QLatin1Literal("."));
  value /= 1000;
  s.prepend(QString::number(value % 1000));
  s.prepend(QLatin1Literal("."));
  value /= 1000;
  s.prepend(QString::number(value % 1000));
  s.prepend(QLatin1Literal("."));
  value /= 1000;
  s.prepend(QString::number(value % 1000));
  s.prepend(QLatin1Literal("."));
  value /= 1000;
  s.prepend(QString::number(value % 1000));
  s.prepend(QLatin1Literal("."));
  value /= 1000;
  s.prepend(QString::number(value % 1000));
  return s;
}

void PpmHandler::getParticipants()
{

  if(!m_dtcPpm)
    return;

  for (const auto participant : m_dtcPpm->participants())
  {
    onParticipantChanged(participant, DataModification::eAdded);
  }
}

bool PpmHandler::isEqNumberInExercise(int equipmentNumber) const
{
  bool result = m_dtcPpm->participantIdByEquipmentNumber(equipmentNumber) > 0;

  return result;
  
}








void PpmHandler::onParticipantChanged(const ParticipantManagement::Participant &participant, DataModification modType)
{



  if(!participant.equipmentNumber().is_set())
  {
    for(auto it = m_participantIdsByEqNo.begin(); it != m_participantIdsByEqNo.end(); ++it)
      if (it.value() == participant.id())
      {
        m_participantIdsByEqNo.remove(it.key());
        break;
      }
    return;
  }
  if (participant.externalId() > 0)
    return;

  QJsonObject headerJson;
  headerJson[QStringLiteral("equipmentNumber")] = participant.equipmentNumber().get();
  headerJson[QStringLiteral("timeStamp")] = QDateTime::currentMSecsSinceEpoch();

  if (modType == DataModification::eRemoved)
  {
    m_participantIdsByEqNo.remove(participant.equipmentNumber().get());
    QJsonObject telegram;
    QJsonObject data;
    data[QStringLiteral("header")] = headerJson;

    telegram[QStringLiteral("data")] = data;
    telegram[QStringLiteral("type")] = QStringLiteral("ApacheHlaRemoveParticipant");
    telegram[QStringLiteral("typeId")] = 8001;
    emit participantChanged(telegram);

    return;
  }
  if (m_participantIdsByEqNo.contains(participant.equipmentNumber().get()))
  {
    if (m_participantIdsByEqNo[participant.equipmentNumber().get()] != participant.id())
    {
      for(auto it = m_participantIdsByEqNo.begin(); it != m_participantIdsByEqNo.end(); ++it)
        if (it.value() == participant.id())
        {
          m_participantIdsByEqNo.remove(it.key());
          break;
        }
      m_participantIdsByEqNo[participant.equipmentNumber().get()] = participant.id();
    }
  }
  else
    m_participantIdsByEqNo[participant.equipmentNumber().get()] = participant.id();


  ParticipantManagement::DynamicParticipantData dynamicData = m_dtcPpm->dynamicParticipantData(participant.id());
  ParticipantManagement::Party party = m_dtcPpm->party(participant.partyId());
  ParticipantManagement::Type type = m_dtcPpm->type(participant.typeId());
  ParticipantManagement::ParticipantPosition partPos = m_dtcPpm->participantPosition(participant.id());

  QJsonObject telegram;

  QJsonObject geoPositionObj;
  geoPositionObj[QStringLiteral("lon")] = partPos.pos().lon();
  geoPositionObj[QStringLiteral("lat")] = partPos.pos().lat();
  geoPositionObj[QStringLiteral("z")]   = partPos.pos().z();

  QJsonObject data;
  data[QStringLiteral("header")] = headerJson;

  data[QStringLiteral("status")] = static_cast<int>(m_dtcPpm->youngestStateInformation(dynamicData.stateHistory()).vulnerabilityState().underlying());
  data[QStringLiteral("forceIdentifier")] = static_cast<int>(party.hlaForceIdentifier().underlying());

  data[QStringLiteral("ets")] = type.disEntities().empty() ? QStringLiteral("2.0.0.0.0.0.1") : fromDisInt(type.disEntities().front());
  data[QStringLiteral("geoPosition")] = geoPositionObj;
  telegram[QStringLiteral("data")] = data;
  telegram[QStringLiteral("type")] = QStringLiteral("ApacheHlaAddParticipant");
  telegram[QStringLiteral("typeId")] = 8000;
  emit participantChanged(telegram);
}



void PpmHandler::onParticipantPositionChanged(const ParticipantManagement::ParticipantPosition &position, DataModification modType)
{
  if (modType == DataModification::eRemoved)
    return;

  ParticipantManagement::Participant part = m_dtcPpm->participant(position.participantId());

  if (part.externalId() > 0 || !part.equipmentNumber().is_set())
    return;

  QJsonObject telegram;
  telegram[QStringLiteral("typeId")] = 8002;
  telegram[QStringLiteral("type")] = QStringLiteral("ApacheHlaPositionChanged");

  QJsonObject headerJson;
  headerJson[QStringLiteral("equipmentNumber")] = part.equipmentNumber().get();
  headerJson[QStringLiteral("timeStamp")] = QDateTime::currentMSecsSinceEpoch();

  QJsonObject data;
  data[QStringLiteral("header")] = headerJson;
  data[QStringLiteral("lon")] = position.pos().lon();
  data[QStringLiteral("lat")] = position.pos().lat();
  data[QStringLiteral("z")] = position.pos().z();

  telegram[QStringLiteral("data")] = data;
  emit participantChanged(telegram);

}



void PpmHandler::onDynamicParticipantDataChanged(const ParticipantManagement::DynamicParticipantData &dynPartData, DataModification modType)
{
  if (modType == DataModification::eRemoved)
    return;

  ParticipantManagement::Participant part = m_dtcPpm->participant(dynPartData.participantId());

  if (part.externalId() > 0 || !part.equipmentNumber().is_set())
    return;

  QJsonObject telegram;
  telegram[QStringLiteral("typeId")] = 8003;
  telegram[QStringLiteral("type")] = QStringLiteral("ApacheHlaVulnerabilityStateChanged");

  QJsonObject headerJson;
  headerJson[QStringLiteral("equipmentNumber")] =  part.equipmentNumber().get();
  headerJson[QStringLiteral("timeStamp")] = QDateTime::currentMSecsSinceEpoch();

  QJsonObject data;
  data[QStringLiteral("header")] = headerJson;

  data[QStringLiteral("status")] = static_cast<int>(m_dtcPpm->youngestStateInformation(dynPartData.stateHistory()).vulnerabilityState().underlying());
  telegram[QStringLiteral("data")] = data;

  emit participantChanged(telegram);
}

}