berrux-dev
c3eda18234
Converts accessor calls to plain member access across the residual service set.
141 lines
5.2 KiB
C++
Executable File
141 lines
5.2 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);
|
|
|
|
switch (request.tgtCommand)
|
|
{
|
|
case TargetManagement::TgtCommand::Unknown:
|
|
case TargetManagement::TgtCommand::PlaySound:
|
|
{
|
|
WARNING_LOG(m_logger) << "onTargetConfigChanged Command =" << request.tgtCommand << " not handled.";
|
|
m_ddsHandler->ftsTgt()->configureTargetReply(cookie, reply);
|
|
return;
|
|
}
|
|
case TargetManagement::TgtCommand::RequestTechnicalState:
|
|
case TargetManagement::TgtCommand::RequestParameter:
|
|
{
|
|
// No specific data to add to payload
|
|
break;
|
|
}
|
|
case TargetManagement::TgtCommand::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());
|
|
break;
|
|
}
|
|
case TargetManagement::TgtCommand::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::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
|
|
|
|
|