torstenandCopilot
7a6be7474e
- training_area_telegrams.cpp: Fixed QJsonObject initializer syntax (Qt6 requires {{}} not ({}))
- training_area_telegrams.cpp: Fixed fromJson() methods to access m_* members directly
- training_area_telegrams.cpp: Fixed brace mismatches in multiple toJson() methods
- training_area_telegrams.h: Changed Header struct to public members for consistency
- tx_mixin.cpp: Fixed getEquipmentNumber() template for direct member access
- lts_coordinate.cpp: Added missing #include <iomanip>
- MIGRATION_STATUS.md: Added migration progress tracking document
C++17 constraint enforced due to RTI Connext DDS 7.7.0 incompatibility with C++20+
Build status: BUILD_RTI=OFF successful (0 errors, warnings only)
Co-authored-by: Copilot <223556219+Copilot@users.noreply.github.com>
90 lines
2.1 KiB
C++
Executable File
90 lines
2.1 KiB
C++
Executable File
|
|
|
|
#include "trimble_if.h"
|
|
|
|
#include "mainthread.h"
|
|
#include "dgps_config.h"
|
|
|
|
#include <NGLLogger/NGLLoggerBootstrap.h>
|
|
#include <QtNetwork/QTcpSocket>
|
|
#include <QtNetwork/QHostAddress>
|
|
#include <QtCore/QFile>
|
|
#include <QtCore/QTimer>
|
|
|
|
namespace DifferentialGPS
|
|
{
|
|
TrimbleIF::TrimbleIF()
|
|
: TcpSocket("TrimbleIF")
|
|
, m_main(nullptr)
|
|
, m_rxCycle_ms(10000)
|
|
, m_socketTimeout(nullptr)
|
|
, m_socketReconnect(nullptr)
|
|
, m_threadIndex(0)
|
|
{
|
|
}
|
|
|
|
TrimbleIF::~TrimbleIF()
|
|
{
|
|
}
|
|
|
|
void TrimbleIF::startThread(int threadIndex, MainThread *main)
|
|
{
|
|
const DgpsConfig::TrimbleConfig_t &cfg = DgpsConfig::instance().getTrimbleConfig();
|
|
m_threadIndex = threadIndex;
|
|
m_main = main;
|
|
startThreadInternal(cfg.ip[threadIndex], cfg.port[threadIndex]);
|
|
}
|
|
|
|
void TrimbleIF::run()
|
|
{
|
|
m_socketTimeout = new QTimer;
|
|
connect(m_socketTimeout, &QTimer::timeout, this, &TrimbleIF::onTimeout);
|
|
m_socketReconnect = new QTimer;
|
|
m_socketReconnect->setInterval(60 * 1000);
|
|
connect(m_socketReconnect, &QTimer::timeout, this, &TrimbleIF::doConnect);
|
|
|
|
TcpSocket::run();
|
|
|
|
delete m_socketTimeout;
|
|
delete m_socketReconnect;
|
|
}
|
|
|
|
void TrimbleIF::onError(QAbstractSocket::SocketError err)
|
|
{
|
|
m_socketTimeout->stop();
|
|
|
|
TcpSocket::onError(err);
|
|
}
|
|
|
|
|
|
void TrimbleIF::onReadyRead()
|
|
{
|
|
DEBUG_LOG(m_logger) << "Reading " << m_socket->bytesAvailable()
|
|
<< " bytes from " << m_socket->peerAddress().toString()
|
|
<< ":" << m_socket->peerPort();
|
|
m_buf = m_socket->readAll();
|
|
|
|
m_main->addNewData(m_buf, m_threadIndex);
|
|
|
|
const DgpsConfig::TrimbleConfig_t &cfg = DgpsConfig::instance().getTrimbleConfig();
|
|
m_socketTimeout->start(3 * cfg.rxCycle_ms);
|
|
}
|
|
|
|
|
|
void TrimbleIF::onTimeout()
|
|
{
|
|
ERROR_LOG(m_logger) << "Socket timeout "
|
|
<< m_socket->peerAddress().toString()
|
|
<< ":" << m_socket->peerPort()
|
|
<< " - trying to reconnect in " << m_socketReconnect->interval() / 1000 << " seconds";
|
|
|
|
m_socketTimeout->stop();
|
|
|
|
m_socket->disconnectFromHost();
|
|
if (m_socket->state() != QAbstractSocket::UnconnectedState)
|
|
m_socket->waitForDisconnected();
|
|
|
|
m_socketReconnect->start();
|
|
}
|
|
}
|