qt-migration-legatus/qt5-before/dlbo/Lts/Services/TargetManagement/handler_target_config.cpp

/**
  * 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