127 lines
4.1 KiB
C++
Executable File
127 lines
4.1 KiB
C++
Executable File
/**
|
|
* DdsHandlerTargetAreas for DDS
|
|
* $Id$
|
|
* $HeadURL$
|
|
* $Author$
|
|
* Created by gr, SLSE, 2015-09-02
|
|
*/
|
|
|
|
#include "dds_handler.h"
|
|
|
|
#include <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
|