mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-09-09 22:56:34 -04:00
Add GS232 Rotator Controller feature plugin. Add altitude and station name to My Positon. Use QtDeploy to ensure all required Qt libraries are included (Should fix OpenGL issues)
249 lines
8.6 KiB
C++
249 lines
8.6 KiB
C++
///////////////////////////////////////////////////////////////////////////////////
|
|
// Copyright (C) 2020 Jon Beniston, M7RCE //
|
|
// Copyright (C) 2020 Edouard Griffiths, F4EXB //
|
|
// //
|
|
// This program is free software; you can redistribute it and/or modify //
|
|
// it under the terms of the GNU General Public License as published by //
|
|
// the Free Software Foundation as version 3 of the License, or //
|
|
// (at your option) any later version. //
|
|
// //
|
|
// This program is distributed in the hope that it will be useful, //
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of //
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the //
|
|
// GNU General Public License V3 for more details. //
|
|
// //
|
|
// You should have received a copy of the GNU General Public License //
|
|
// along with this program. If not, see <http://www.gnu.org/licenses/>. //
|
|
///////////////////////////////////////////////////////////////////////////////////
|
|
|
|
#include <QDebug>
|
|
#include <QTcpServer>
|
|
#include <QTcpSocket>
|
|
#include <QEventLoop>
|
|
#include <QTimer>
|
|
#include <QSerialPort>
|
|
#include <QRegularExpression>
|
|
|
|
#include "SWGDeviceState.h"
|
|
#include "SWGSuccessResponse.h"
|
|
#include "SWGErrorResponse.h"
|
|
#include "SWGDeviceSettings.h"
|
|
#include "SWGChannelSettings.h"
|
|
#include "SWGDeviceSet.h"
|
|
#include "SWGChannelReport.h"
|
|
|
|
#include "webapi/webapiadapterinterface.h"
|
|
#include "webapi/webapiutils.h"
|
|
|
|
#include "gs232controllerworker.h"
|
|
#include "gs232controllerreport.h"
|
|
|
|
MESSAGE_CLASS_DEFINITION(GS232ControllerWorker::MsgConfigureGS232ControllerWorker, Message)
|
|
MESSAGE_CLASS_DEFINITION(GS232ControllerReport::MsgReportAzAl, Message)
|
|
|
|
GS232ControllerWorker::GS232ControllerWorker(WebAPIAdapterInterface *webAPIAdapterInterface) :
|
|
m_webAPIAdapterInterface(webAPIAdapterInterface),
|
|
m_msgQueueToFeature(nullptr),
|
|
m_msgQueueToGUI(nullptr),
|
|
m_running(false),
|
|
m_mutex(QMutex::Recursive)
|
|
{
|
|
connect(&m_pollTimer, SIGNAL(timeout()), this, SLOT(update()));
|
|
m_pollTimer.start(1000);
|
|
}
|
|
|
|
GS232ControllerWorker::~GS232ControllerWorker()
|
|
{
|
|
m_inputMessageQueue.clear();
|
|
}
|
|
|
|
void GS232ControllerWorker::reset()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
m_inputMessageQueue.clear();
|
|
}
|
|
|
|
bool GS232ControllerWorker::startWork()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
connect(&m_inputMessageQueue, SIGNAL(messageEnqueued()), this, SLOT(handleInputMessages()));
|
|
connect(&m_serialPort, &QSerialPort::readyRead, this, &GS232ControllerWorker::readSerialData);
|
|
m_running = true;
|
|
return m_running;
|
|
}
|
|
|
|
void GS232ControllerWorker::stopWork()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
disconnect(&m_inputMessageQueue, SIGNAL(messageEnqueued()), this, SLOT(handleInputMessages()));
|
|
disconnect(&m_serialPort, &QSerialPort::readyRead, this, &GS232ControllerWorker::readSerialData);
|
|
m_running = false;
|
|
}
|
|
|
|
void GS232ControllerWorker::handleInputMessages()
|
|
{
|
|
Message* message;
|
|
|
|
while ((message = m_inputMessageQueue.pop()) != nullptr)
|
|
{
|
|
if (handleMessage(*message)) {
|
|
delete message;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool GS232ControllerWorker::handleMessage(const Message& cmd)
|
|
{
|
|
if (MsgConfigureGS232ControllerWorker::match(cmd))
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
MsgConfigureGS232ControllerWorker& cfg = (MsgConfigureGS232ControllerWorker&) cmd;
|
|
|
|
applySettings(cfg.getSettings(), cfg.getForce());
|
|
return true;
|
|
}
|
|
else
|
|
{
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void GS232ControllerWorker::applySettings(const GS232ControllerSettings& settings, bool force)
|
|
{
|
|
qDebug() << "GS232ControllerWorker::applySettings:"
|
|
<< " m_azimuth: " << settings.m_azimuth
|
|
<< " m_elevation: " << settings.m_elevation
|
|
<< " m_serialPort: " << settings.m_serialPort
|
|
<< " m_baudRate: " << settings.m_baudRate
|
|
<< " m_deviceIndex: " << settings.m_deviceIndex
|
|
<< " m_channelIndex: " << settings.m_channelIndex
|
|
<< " force: " << force;
|
|
|
|
if ((settings.m_serialPort != m_settings.m_serialPort) || force)
|
|
{
|
|
if (m_serialPort.isOpen())
|
|
m_serialPort.close();
|
|
m_serialPort.setPortName(settings.m_serialPort);
|
|
m_serialPort.setBaudRate(settings.m_baudRate);
|
|
if (!m_serialPort.open(QIODevice::ReadWrite))
|
|
qCritical() << "GS232ControllerWorker::applySettings: Failed to open serial port " << settings.m_serialPort << ". Error: " << m_serialPort.error();
|
|
}
|
|
else if ((settings.m_baudRate != m_settings.m_baudRate) || force)
|
|
{
|
|
m_serialPort.setBaudRate(settings.m_baudRate);
|
|
}
|
|
|
|
if ((settings.m_elevation != m_settings.m_elevation) || force)
|
|
{
|
|
setAzimuthElevation(settings.m_azimuth, settings.m_elevation);
|
|
}
|
|
else if ((settings.m_azimuth != m_settings.m_azimuth) || force)
|
|
{
|
|
setAzimuth(settings.m_azimuth);
|
|
}
|
|
|
|
m_settings = settings;
|
|
}
|
|
|
|
void GS232ControllerWorker::setAzimuth(int azimuth)
|
|
{
|
|
QString cmd = QString("M%1\r\n").arg(azimuth, 3, 10, QLatin1Char('0'));
|
|
QByteArray data = cmd.toLatin1();
|
|
m_serialPort.write(data);
|
|
}
|
|
|
|
void GS232ControllerWorker::setAzimuthElevation(int azimuth, int elevation)
|
|
{
|
|
QString cmd = QString("W%1 %2\r\n").arg(azimuth, 3, 10, QLatin1Char('0')).arg(elevation, 3, 10, QLatin1Char('0'));
|
|
QByteArray data = cmd.toLatin1();
|
|
m_serialPort.write(data);
|
|
}
|
|
|
|
void GS232ControllerWorker::readSerialData()
|
|
{
|
|
char buf[1024];
|
|
qint64 len;
|
|
|
|
while (m_serialPort.canReadLine())
|
|
{
|
|
len = m_serialPort.readLine(buf, sizeof(buf));
|
|
if (len != -1)
|
|
{
|
|
QString response = QString::fromUtf8(buf, len);
|
|
|
|
QRegularExpression re("AZ=(\\d\\d\\d)EL=(\\d\\d\\d)");
|
|
QRegularExpressionMatch match = re.match(response);
|
|
if (match.hasMatch())
|
|
{
|
|
QString az = match.captured(1);
|
|
QString el = match.captured(2);
|
|
//qDebug() << "GS232ControllerWorker::readSerialData read az " << az << " el " << el;
|
|
if (getMessageQueueToGUI())
|
|
{
|
|
GS232ControllerReport::MsgReportAzAl *msg = GS232ControllerReport::MsgReportAzAl::create(
|
|
az.toFloat(), el.toFloat(), GS232ControllerReport::ACTUAL);
|
|
getMessageQueueToGUI()->push(msg);
|
|
}
|
|
}
|
|
else
|
|
{
|
|
qDebug() << "GS232ControllerWorker::readSerialData unknown response " << response;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void GS232ControllerWorker::update()
|
|
{
|
|
// Request current Az/El from GS-232 controller
|
|
if (m_serialPort.isOpen())
|
|
{
|
|
QByteArray cmd("C2\r\n");
|
|
m_serialPort.write(cmd);
|
|
}
|
|
|
|
// Request target Az/EL from channel
|
|
if (m_settings.m_track)
|
|
{
|
|
SWGSDRangel::SWGChannelReport response;
|
|
SWGSDRangel::SWGErrorResponse errorResponse;
|
|
|
|
int httpRC = m_webAPIAdapterInterface->devicesetChannelReportGet(
|
|
m_settings.m_deviceIndex,
|
|
m_settings.m_channelIndex,
|
|
response,
|
|
errorResponse
|
|
);
|
|
|
|
if (httpRC/100 != 2)
|
|
{
|
|
qWarning("GS232ControllerWorker::update: get channel report error %d: %s",
|
|
httpRC, qPrintable(*errorResponse.getMessage()));
|
|
}
|
|
else
|
|
{
|
|
QJsonObject *jsonObj = response.asJsonObject();
|
|
double targetAzimuth;
|
|
double targetElevation;
|
|
bool gotElevation = false;
|
|
bool gotAzimuth = false;
|
|
|
|
if (WebAPIUtils::getSubObjectDouble(*jsonObj, "targetAzimuth", targetAzimuth))
|
|
gotAzimuth = true;
|
|
|
|
if (WebAPIUtils::getSubObjectDouble(*jsonObj, "targetElevation", targetElevation))
|
|
gotElevation = true;
|
|
|
|
if (gotAzimuth && gotElevation)
|
|
{
|
|
if (getMessageQueueToGUI())
|
|
{
|
|
GS232ControllerReport::MsgReportAzAl *msg = GS232ControllerReport::MsgReportAzAl::create(
|
|
targetAzimuth, targetElevation, GS232ControllerReport::TARGET);
|
|
getMessageQueueToGUI()->push(msg);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|