112 lines
3.3 KiB
C++
Executable File
112 lines
3.3 KiB
C++
Executable File
/**
|
|
* @RDE_HEADER@
|
|
* DataTopic Unit test for DDS
|
|
* $Id$
|
|
* $HeadURL$
|
|
* $Author$
|
|
* Created by Hanna E. Rathje, SLSE, 2015-07-24
|
|
*/
|
|
#include "Initialisation.h"
|
|
|
|
#include <NGLLogger/NGLLoggerBootstrap.h>
|
|
|
|
#include <DDS/QosProfile/DDS_DefaultQos.h>
|
|
#include <Common/ProjectConfig/project_defines.h>
|
|
|
|
|
|
Initialisation::Initialisation()
|
|
: m_domainParticipant(nullptr)
|
|
, m_domainParticipantSub(nullptr)
|
|
, m_domainId(0)
|
|
, m_partitionId(-1)
|
|
, m_ddsPublisher(nullptr)
|
|
, m_ddsSubscriber(nullptr)
|
|
, m_subListener(new DTC::SubscriberListener)
|
|
, m_logger(NGL::NGLLoggerBootstrap::getNGLRootLogger().getNGLLogger("UnitTests.Initialisation"))
|
|
|
|
{
|
|
DDS::DefaultQos defaultQos;
|
|
|
|
//if (!defaultQos.setDefaultQos(QStringList("/shd/CTC/SV/.default_dds_profile.xml")))
|
|
if (!defaultQos.setDefaultQos())
|
|
ERROR_LOG(m_logger) << "Error setting default QoS from xml-file ";
|
|
|
|
}
|
|
|
|
Initialisation::~Initialisation()
|
|
{
|
|
cleanupSubscriberListener();
|
|
m_ddsSubscriber = nullptr;
|
|
m_ddsPublisher = nullptr;
|
|
}
|
|
|
|
void Initialisation::cleanupSubscriberListener()
|
|
{
|
|
if (m_ddsSubscriber != nullptr && m_subListener != nullptr)
|
|
{
|
|
m_ddsSubscriber.listener(nullptr, dds::core::status::StatusMask::none());
|
|
delete m_subListener;
|
|
m_subListener = nullptr;
|
|
}
|
|
}
|
|
|
|
|
|
bool Initialisation::initDDS(int domainId, int partitionId, PubSub pubsub)
|
|
{
|
|
if (m_domainParticipant == nullptr)
|
|
m_domainParticipant = dds::domain::DomainParticipant(domainId);
|
|
|
|
// SpatialData will be published to Partition $partitionId
|
|
|
|
if (pubsub == USE_PUBLISHER || pubsub == USE_PUB_SUB)
|
|
{
|
|
dds::pub::qos::PublisherQos publisherQos = m_domainParticipant.default_publisher_qos();
|
|
|
|
DEBUG_LOG(m_logger) << "Publish on partition " << IDL::getPartitionString(partitionId);
|
|
|
|
// use only selected partition
|
|
dds::core::policy::Partition partitionQos;
|
|
partitionQos.name( { IDL::getPartitionString(partitionId) } );
|
|
publisherQos << partitionQos;
|
|
|
|
m_ddsPublisher = dds::pub::Publisher(m_domainParticipant,
|
|
publisherQos);
|
|
}
|
|
|
|
if (pubsub == USE_SUBSCRIBER || pubsub == USE_PUB_SUB)
|
|
{
|
|
dds::domain::DomainParticipant domainPart = m_domainParticipant;
|
|
if ( domainPart == nullptr || m_domainParticipantSub == nullptr)
|
|
{
|
|
m_domainParticipantSub = dds::domain::DomainParticipant(domainId);
|
|
domainPart = m_domainParticipantSub;
|
|
}
|
|
|
|
dds::sub::qos::SubscriberQos subscriberQos = domainPart.default_subscriber_qos();
|
|
|
|
DEBUG_LOG(m_logger) << "Subsribing on partition " << IDL::getPartitionString(partitionId);
|
|
|
|
// use only selected partition
|
|
dds::core::policy::Partition partitionQos;
|
|
partitionQos.name( { IDL::getPartitionString(partitionId) } );
|
|
subscriberQos << partitionQos;
|
|
|
|
dds::core::status::StatusMask mask(DDS_REQUESTED_DEADLINE_MISSED_STATUS |
|
|
DDS_DATA_AVAILABLE_STATUS |
|
|
DDS_DATA_ON_READERS_STATUS);
|
|
|
|
m_ddsSubscriber = dds::sub::Subscriber(domainPart,
|
|
subscriberQos,
|
|
m_subListener,
|
|
mask);
|
|
}
|
|
|
|
if (m_domainId == 0)
|
|
m_domainId = domainId;
|
|
|
|
if (m_partitionId < 0)
|
|
m_partitionId = partitionId;
|
|
|
|
return true;
|
|
}
|