/**
  * Handle incoming Function Topic Requests (and send them to SFM)
  * $Id$
  * $HeadURL$
  * $Author$
  * Created by Philipp Dassow, NLST, 2018-01-23
  */

#include "recv_from_dds_fts.h"
#include "dds_handler.h"
#include "main_handler.h"

namespace TrainingAreaBaseOC
{

RecvFromDdsFts::RecvFromDdsFts(MainHandler *mainHandler)
  : Interface::Fts::DemandCyclicPositionsRequestHandler(mainHandler->dds()->ftsTaboc())
  , Interface::Fts::DemandSfmSelfTestRequestHandler(mainHandler->dds()->ftsTaboc())
  , Interface::Fts::SendTechnicalStateOcRequestHandler(mainHandler->dds()->ftsTaboc())
  , TrainingAreaBase::Interface::Fts::SendOcDataRequestHandler(mainHandler->dds()->ftsTab())
  , TrainingAreaBase::Interface::Fts::SendFireSmokeMarkerDataRequestHandler(mainHandler->dds()->ftsTab())
  , m_ftsTaboc(mainHandler->dds()->ftsTaboc())
  , m_ftsTab(mainHandler->dds()->ftsTab())
  , m_txCallback(mainHandler->txHandler())
  , m_logger(getLogger("RecvFromDdsFts"))
{}

void RecvFromDdsFts::onDemandCyclicPositionsRequest(const rti::core::SampleIdentity &cookie, const DemandCyclicPositionsRequest &request)
{
  OcTelegrams::DemandCyclicPositions data;
  data.cycleTime = request.cycleTime();

  m_ftsTaboc->demandCyclicPositionsReply(cookie, fillFro(m_txCallback->txData(data)));
}

void RecvFromDdsFts::onDemandSfmSelfTestRequest(const rti::core::SampleIdentity &cookie, const DemandSfmSelfTestRequest &)
{
  OcTelegrams::DemandSelftestSfm data;
  m_ftsTaboc->demandSfmSelfTestReply(cookie, fillFro(m_txCallback->txData(data)));
}

void RecvFromDdsFts::onSendTechnicalStateOcRequest(const rti::core::SampleIdentity &cookie, const SendTechnicalStateOcRequest &request)
{
  OcTelegrams::TechnicalStateOc data;
  data.errorCode = request.errorCode();

  m_ftsTaboc->sendTechnicalStateOcReply(cookie, fillFro(m_txCallback->txData(data)));
}

void RecvFromDdsFts::onSendOcDataRequest(const rti::core::SampleIdentity &cookie, const TrainingAreaBase::SendOcDataRequest &request)
{
  TrainingAreaBase::TetraIcd::OpaquePayloadDataOut data;
  data.payloadType = TrainingAreaBase::TetraIcd::OpaquePayloadDataBase::Type::OC;
  data.payload = request.payload();

  m_ftsTab->sendOcDataReply(cookie, fillFro(m_txCallback->txData(data)));
}

void RecvFromDdsFts::onSendFireSmokeMarkerDataRequest(const rti::core::SampleIdentity &cookie, const TrainingAreaBase::SendFireSmokeMarkerDataRequest &request)
{
  TrainingAreaBase::TetraIcd::OpaquePayloadDataOut data;
  data.payloadType = TrainingAreaBase::TetraIcd::OpaquePayloadDataBase::Type::FireSmokeMarker;
  data.payload = request.payload();

  m_ftsTab->sendFireSmokeMarkerDataReply(cookie, fillFro(m_txCallback->txData(data)));
}

Core::FunctionReplyObject RecvFromDdsFts::fillFro(bool bSuccess)
{
  if (bSuccess)
    return Core::FunctionReplyObject();
  return Core::FunctionReplyObject(tr_lts("dds", "Error sending telegram to sfm."));
}

} // namespace TrainingAreaBaseOC