/**
  * SocketHandler
  * $Id$
  * $HeadURL$
  * $Author$
  * Created by Gerlinde Rudolphus, SLTE, 2022-06-09
  */

#include "socket_handler.h"
#include <QTimer>
#include <QLatin1String>
#include "nmea_handler.h"
#include  <QHostAddress>

namespace NmeaManagement
{


SocketHandler::SocketHandler(const std::shared_ptr<DdsHandler> &ddsHandler,
                             const std::shared_ptr<NmeaHandler> &nmeaHandler,
                             QObject *parent) :
  QObject(parent)
  , TurnRadioMasterOffRequestHandler(ddsHandler->fts())
  , m_ddsHandler(ddsHandler)
  , m_nmeaHandler(nmeaHandler)
  , m_logger(getLogger("SocketHandler"))
{
  // create a timer
  m_reconnectTimer = new QTimer(this);

  // setup signal and slot
  connect(m_reconnectTimer, SIGNAL(timeout()),
          this, SLOT(reconnectTimerSlot()));

}

void SocketHandler::init(QString nmeaHost, int nmeaPort)
{
  m_nmeaHost = nmeaHost;
  m_nmeaPort = nmeaPort;
  socket = new QUdpSocket(this);
  connect(socket, SIGNAL(connected()), this, SLOT(connected()));
  connect(socket, SIGNAL(disconnected()), this, SLOT(disconnected()));
  connect(socket, SIGNAL(readyRead()), this, SLOT(readyRead()));

  connect(socket, SIGNAL(bytesWritten(qint64)), this, SLOT(bytesWritten(qint64)));

  INFO_LOG(m_logger) << "Connecting,..";
  INFO_LOG(m_logger) << nmeaHost << " port: " << nmeaPort;
  //socket->connectToHost(QHostAddress::LocalHost, nmeaPort);
  //socket->connectToHost(nmeaHost, nmeaPort);
  reconnect();

}

void SocketHandler::reconnect()
{
    INFO_LOG(m_logger) << "Connecting,.." << " host = " << m_nmeaHost
                     <<  " port = " << m_nmeaPort;;

  if(!socket->bind(m_nmeaPort, QAbstractSocket::BindFlag::ShareAddress))
  {
    ERROR_LOG(m_logger) << "Error from Socket: " << socket->errorString();
    m_reconnectTimer->start(10000);
  }

}

void SocketHandler::connected()
{
  m_reconnectTimer->stop();

  INFO_LOG(m_logger) << "Connected!";
}


void SocketHandler::disconnected()
{
  INFO_LOG(m_logger) << "Disconnected!";
}

void SocketHandler::bytesWritten(qint64 bytes)
{
  TRACE_LOG(m_logger) << "We wrote: " << bytes;
}

void SocketHandler::reconnectTimerSlot()
{
  m_reconnectTimer->stop();
  INFO_LOG(m_logger) << "Reconnect NMEA-Socket "
                      << " host = " << m_nmeaHost
                      <<  " port = " << m_nmeaPort;
  reconnect();
}


void SocketHandler::readyRead()
{
  bool hasData = true;
  INFO_LOG(m_logger) << "Reading...";
 // QByteArray ba = socket->readDatagram();
 
  QByteArray ba;

  while (socket->hasPendingDatagrams()) 
  {

    ba.resize(int(socket->pendingDatagramSize()));
    socket->readDatagram(ba.data(), ba.size());
    INFO_LOG(m_logger) << ba;
    QByteArray nmeaDataBa = ba; // ba.mid(startNmeaData, endNmeaData);
    std::string nmeaDataStd = nmeaDataBa.toStdString() ;
    QString nmeaData = QString::fromLocal8Bit(nmeaDataStd.c_str());


    INFO_LOG(m_logger) << "nmeaDecoder :" << nmeaData;
    //ba = ba.mid(endNmeaData, ba.length());
    m_nmeaHandler->decode(nmeaData);

    INFO_LOG(m_logger) << "NMEA-Data=" << nmeaData;
    INFO_LOG(m_logger) << "NMEA-Data ba=" << ba;
  }
}

void SocketHandler::onTurnRadioMasterOffRequest(const rti::core::SampleIdentity &cookie, const TurnRadioMasterOffRequest &request)
{
    //patric: Du hattest den Reply 端berschrieben nicht den Request ;)

  Core::FunctionReplyObject reply;
  if (reply.error())
    WARNING_LOG(m_logger) << "onTurnRadioMasterOffReply: " << reply();

  m_ddsHandler->fts()->turnRadioMasterOffReply(cookie, reply);

  QByteArray queryTimeline ("$IIXDR,S,1,,SERVICE_CONTROL_PRESHUTDOWN*79");
  qDebug() << queryTimeline;
  socket->writeDatagram(queryTimeline, QHostAddress(m_nmeaHost), m_nmeaPort);

}
}