Initial commit

Lts/Services/CentralEffectSimulation/Plugins/TargetAreas/dds_handler.cpp

@@ -0,0 +1,126 @@
+/**
+  * 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)
+  , m_logger(getLogger("DdsHandlerTargetAreas"))
+{
+  DEBUG_LOG(m_logger) << "DdsHandlerTargetAreas(" << domainId << ") for partition: " << m_ddsConnector->getDefaultPartition();
+}
+
+bool DdsHandlerTargetAreas::init(const QStringList &qosFileList)
+{
+  if (!m_ddsConnector->init(qosFileList))
+  {
+    ERROR_LOG(m_logger) << "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(m_logger) << "Could not enable SendCesHit";
+    return false;
+  }
+  m_dtcPpm = ParticipantManagement::Interface::Dtc::create(m_ddsConnector);
+  if (!m_dtcPpm->enableDynamicParticipantData())
+  {
+    ERROR_LOG(m_logger) << "Could not initialize ParticipantManagement enableDynamicParticipantData data topic client";
+    return false;
+  }
+  if (!m_dtcPpm->enableParticipantPosition())
+  {
+    ERROR_LOG(m_logger) << "Could not initialize ParticipantManagement enableParticipantPosition data topic client";
+    return false;
+  }
+  if (!m_dtcPpm->enableParticipant())
+  {
+    ERROR_LOG(m_logger) << "Could not initialize ParticipantManagement enableParticipant data topic client";
+    return false;
+  }
+  if (!m_dtcPpm->enableType())
+  {
+    ERROR_LOG(m_logger) << "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(m_logger) << " 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(m_logger) << "participantId2EquipNo participantId=" << participantId
+                       << " EquipmentNumber=" << ret;
+  return ret;
+} // end of participantId2EquipNo()
+
+} // Namespace CentralEffectSimulation