qt-migration-legatus/qt6-after/qt6-migrated-legatus/Lts/Services/CentralEffectSimulation/Plugins/TargetAreas/dds_handler.cpp

/**
  * DdsHandlerTargetAreas for DDS
  * $Id$
  * $HeadURL$
  * $Author$
  * Created by gr, SLSE, 2015-09-02
  */

#include "dds_handler.h"

#include <DDS/Core/core_dtc.h>

namespace TargetAreas
{

DdsHandlerTargetAreas::DdsHandlerTargetAreas(int domainId, int exerciseId)
  : m_ddsConnector(std::make_shared<DDSConnector::DdsConnector>(domainId, IDL::PartitionType::Exercise, exerciseId))
  , m_participantEventId(0)
  , m_exerciseId(exerciseId)
{
  DEBUG_LOG() << "DdsHandlerTargetAreas(" << domainId << ") for partition: " << m_ddsConnector->getDefaultPartition();
}

bool DdsHandlerTargetAreas::init(const QStringList &qosFileList)
{
  if (!m_ddsConnector->init(qosFileList))
  {
    ERROR_LOG() << "Error initializing dds connections - aborting";
    return false;
  }

  // default initialize Publisher and Subscriber
  m_ddsConnector->initPublisherSubscriber();
  m_ddsConnector->enableBatchedWriter(false);

  m_topicLockMaster = std::make_shared<Core::TopicLockMaster>(m_ddsConnector);

  m_dtcCore = Core::Interface::Dtc::create(m_ddsConnector);
  m_dtcCore->enablePartitionTime();

  m_ftcTab = TrainingAreaBase::Interface::Ftc::create(m_ddsConnector);
  if (!m_ftcTab->enableSendCesHit() ||
      !m_ftcTab->enableSendCesHitInformation() ||
      !m_ftcTab->enableSendGeopairingData() ||
      !m_ftcTab->enableSendParticipantBlockedArea() ||
      !m_ftcTab->enableSendParticipantBeStillWarning() ||
      !m_ftcTab->enableSendControlData())
  {
    ERROR_LOG() << "Could not enable SendCesHit";
    return false;
  }
  m_dtcPpm = ParticipantManagement::Interface::Dtc::create(m_ddsConnector);
  if (!m_dtcPpm->enableDynamicParticipantData())
  {
    ERROR_LOG() << "Could not initialize ParticipantManagement enableDynamicParticipantData data topic client";
    return false;
  }
  if (!m_dtcPpm->enableParticipantPosition())
  {
    ERROR_LOG() << "Could not initialize ParticipantManagement enableParticipantPosition data topic client";
    return false;
  }
  if (!m_dtcPpm->enableParticipant())
  {
    ERROR_LOG() << "Could not initialize ParticipantManagement enableParticipant data topic client";
    return false;
  }
  if (!m_dtcPpm->enableType())
  {
    ERROR_LOG() << "Could not initialize ParticipantManagement enableType data topic client";
    return false;
  }

  connect(m_dtcPpm.get(), &ParticipantManagement::Interface::Dtc::participantChanged,
          this, &DdsHandlerTargetAreas::onParticipantChanged);
  // Get 'static' data for all participants (playerdata)
  // Player in Referenzmap eintragen
  {
    auto cb = [this](const ParticipantManagement::Participant & participant)
    {
      onParticipantChanged(participant, DataModification::eAdded);
    };
    m_dtcPpm->participants(cb);
  }

  return true;
} // end of init

// ///////////////////////////////////
// P P M (ParticipantManagement)
// ///////////////////////////////////
void DdsHandlerTargetAreas::onParticipantChanged(const ParticipantManagement::Participant &data, DataModification modType)
{
  if (modType == DataModification::eRemoved)
    m_partId2EquipNoMap.remove(data.id());
  else
    m_partId2EquipNoMap[data.id()] = data.equipmentNumber().is_set() ? data.equipmentNumber().get() : 0;

  if (m_logger.isTraceEnabled())
  {
    for (auto i = m_partId2EquipNoMap.begin(); i != m_partId2EquipNoMap.end(); ++i)
    {
      TRACE_LOG() << " partId2EquipNoMap.size(): " << m_partId2EquipNoMap.size()
                          << " partId: " << i.key()
                          << " eqNo: " << i.value();
    }
  }
} // end of onParticipantChanged()

//-----------------------------------------------------------------------------
qint64 DdsHandlerTargetAreas::currentPartitionTime() const
{
  return m_dtcCore->partitionTime().timeStamp();
}

int DdsHandlerTargetAreas::participantId2EquipNo(const int participantId) const
{
  int ret = m_partId2EquipNoMap.value(participantId, 0);
  if (ret > 0)
    INFO_LOG() << "participantId2EquipNo participantId=" << participantId
                       << " EquipmentNumber=" << ret;
  return ret;
} // end of participantId2EquipNo()

} // Namespace CentralEffectSimulation