141 lines
5.3 KiB
C++
Executable File
141 lines
5.3 KiB
C++
Executable File
/**
|
|
* Handler for player data
|
|
* $Id$
|
|
* $HeadURL$
|
|
* $Author$
|
|
* Created by hjl, SLSE, 2017-02-20
|
|
*/
|
|
|
|
#include "settings.h"
|
|
#include "handler_target_config.h"
|
|
#include <LtsUtilsCore/qbytearray_byteaccess.h>
|
|
|
|
using namespace TargetManagement;
|
|
|
|
HandlerTargetConfig::HandlerTargetConfig(const std::shared_ptr<DdsHandler> &ddsHandler,
|
|
QObject *parent)
|
|
: QObject(parent)
|
|
, ConfigureTargetRequestHandler(ddsHandler->ftsTgt())
|
|
, m_ddsHandler(ddsHandler)
|
|
, m_dtcTab(ddsHandler->dtcTab())
|
|
, m_dtsTgt(ddsHandler->dtsTgt())
|
|
, m_logger(getLogger("HandlerTargetConfig"))
|
|
{
|
|
} // end of ctor()
|
|
//-----------------------------------------------------------------------------
|
|
|
|
bool HandlerTargetConfig::init()
|
|
{
|
|
INFO_LOG(m_logger) << "init";
|
|
connect(m_dtcTab.get(), &TrainingAreaBase::Interface::Dtc::targetDataChanged,
|
|
this, &HandlerTargetConfig::onTargetDataChanged);
|
|
|
|
return true;
|
|
} // end of init()
|
|
|
|
//-----------------------------------------------------------------------------
|
|
void HandlerTargetConfig::onTargetDataChanged(const TrainingAreaBase::TargetData &targetData, DataModification modType)
|
|
{
|
|
if (modType == DataModification::eRemoved)
|
|
return;
|
|
|
|
uint8_t responseCmd = 100;
|
|
TargetManagement::TargetConfig tgtTargetData;
|
|
INFO_LOG(m_logger) << "onTargetDataChanged payload.size=" << targetData.payload().size();
|
|
tgtTargetData.participantId(m_ddsHandler->equipNo2participantId(targetData.equipmentNumber()));
|
|
for (size_t i = 0; i < targetData.payload().size(); i++)
|
|
INFO_LOG(m_logger) << "payload[" << i << "]=" << targetData.payload()[i];
|
|
|
|
if (targetData.payload().size() < 6)
|
|
return;
|
|
tgtTargetData.id(0);
|
|
tgtTargetData.tgtCommand(static_cast <TargetManagement::TgtCommand_def::type>(targetData.payload()[0] - responseCmd));
|
|
tgtTargetData.mode(static_cast <TargetManagement::Mode_def::type>(targetData.payload()[1]));
|
|
tgtTargetData.weapon(targetData.payload()[2]);
|
|
INFO_LOG(m_logger) << "tgtTargetData.tgtCommand =" << tgtTargetData.tgtCommand()
|
|
<< " mode=" << tgtTargetData.mode()
|
|
<< " weapon=" << tgtTargetData.weapon();
|
|
if (!m_dtsTgt->publish(tgtTargetData))
|
|
ERROR_LOG(m_logger) << "Error publish targetData";
|
|
} // end of onTargetDataChanged
|
|
|
|
void HandlerTargetConfig::onSendTargetDataReply(const Core::FunctionReplyObject &replyObject)
|
|
{
|
|
if (replyObject.error())
|
|
WARNING_LOG(m_logger) << "Can not send target data to target participant : " << replyObject();
|
|
else
|
|
DEBUG_LOG(m_logger) << "onSendTargetDataReply for id " << replyObject.id() << " success";
|
|
}
|
|
|
|
// Send to TAB
|
|
void HandlerTargetConfig::onConfigureTargetRequest(const rti::core::SampleIdentity &cookie,
|
|
const ConfigureTargetRequest &request)
|
|
{
|
|
INFO_LOG(m_logger) << "onConfigureTargetRequest";
|
|
Core::FunctionReplyObject reply = Core::FunctionReplyObject(request.id());
|
|
|
|
DEBUG_LOG(m_logger) << "HandlerTargetConfig onTargetConfigChanged participantId=" << request.participantId();
|
|
|
|
TrainingAreaBase::SendTargetDataRequest tgt;
|
|
const int participantId = request.participantId();
|
|
tgt.equipmentNumber(m_ddsHandler->participantId2EquipNo(participantId));
|
|
tgt.participantId(request.participantId());
|
|
|
|
tgt.payload().push_back(request.tgtCommand().underlying());
|
|
|
|
switch (request.tgtCommand().underlying())
|
|
{
|
|
case TargetManagement::TgtCommand_def::Unknown:
|
|
case TargetManagement::TgtCommand_def::PlaySound:
|
|
{
|
|
WARNING_LOG(m_logger) << "onTargetConfigChanged Command =" << request.tgtCommand() << " not handled.";
|
|
m_ddsHandler->ftsTgt()->configureTargetReply(cookie, reply);
|
|
return;
|
|
}
|
|
case TargetManagement::TgtCommand_def::RequestTechnicalState:
|
|
case TargetManagement::TgtCommand_def::RequestParameter:
|
|
{
|
|
// No specific data to add to payload
|
|
break;
|
|
}
|
|
case TargetManagement::TgtCommand_def::SetMode:
|
|
{
|
|
if (!request.mode().is_set())
|
|
{
|
|
ERROR_LOG(m_logger) << "Set mode requested, but mode ist not set";
|
|
m_ddsHandler->ftsTgt()->configureTargetReply(cookie, Core::FunctionReplyObject(request.participantId(), tr_lts("dds", "Set mode requested, but mode is not set")));
|
|
return;
|
|
}
|
|
tgt.payload().push_back(request.mode().get().underlying());
|
|
break;
|
|
}
|
|
case TargetManagement::TgtCommand_def::SetWeapon:
|
|
{
|
|
if (!request.weapon().is_set())
|
|
{
|
|
ERROR_LOG(m_logger) << "Set weapon requested, but weapon ist not set";
|
|
m_ddsHandler->ftsTgt()->configureTargetReply(cookie, Core::FunctionReplyObject(request.participantId(), tr_lts("dds", "Set weapon requested, but weapon is not set")));
|
|
return;
|
|
}
|
|
tgt.payload().push_back(request.weapon().get());
|
|
break;
|
|
}
|
|
case TargetManagement::TgtCommand_def::SetParameter:
|
|
{
|
|
if (!request.parameterSet().is_set())
|
|
{
|
|
ERROR_LOG(m_logger) << "Set parameterset requested, but parameterset ist not set";
|
|
m_ddsHandler->ftsTgt()->configureTargetReply(cookie, Core::FunctionReplyObject(request.participantId(), tr_lts("dds", "Set parameterset requested, but parameterset is not set")));
|
|
return;
|
|
}
|
|
tgt.payload().push_back(request.parameterSet().get());
|
|
break;
|
|
}
|
|
}
|
|
m_ddsHandler->ftcTab()->sendTargetDataRequest(tgt, this);
|
|
// Todo: Wait for Reply and forward?
|
|
m_ddsHandler->ftsTgt()->configureTargetReply(cookie, reply);
|
|
} // end of onConfigureTargetRequest
|
|
|
|
|