mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-13 20:01:46 -05:00
460 lines
16 KiB
C++
460 lines
16 KiB
C++
///////////////////////////////////////////////////////////////////////////////////
|
|
// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany //
|
|
// written by Christian Daniel //
|
|
// Copyright (C) 2015-2017, 2019-2022 Edouard Griffiths, F4EXB <f4exb06@gmail.com> //
|
|
// Copyright (C) 2020-2021, 2024 Jon Beniston, M7RCE <jon@beniston.com> //
|
|
// //
|
|
// 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 <QColor>
|
|
|
|
#include "util/simpleserializer.h"
|
|
#include "settings/serializable.h"
|
|
|
|
#include "gs232controllersettings.h"
|
|
#include "inputcontrollersettings.h"
|
|
|
|
const QStringList GS232ControllerSettings::m_pipeURIs = {
|
|
QStringLiteral("sdrangel.channel.adsbdemod"),
|
|
QStringLiteral("sdrangel.feature.map"),
|
|
QStringLiteral("sdrangel.feature.skymap"),
|
|
QStringLiteral("sdrangel.feature.startracker"),
|
|
QStringLiteral("sdrangel.feature.satellitetracker")
|
|
};
|
|
|
|
GS232ControllerSettings::GS232ControllerSettings() :
|
|
m_rollupState(nullptr)
|
|
{
|
|
resetToDefaults();
|
|
}
|
|
|
|
void GS232ControllerSettings::resetToDefaults()
|
|
{
|
|
m_azimuth = 0.0f;
|
|
m_elevation = 0.0f;
|
|
m_serialPort = "";
|
|
m_baudRate = 9600;
|
|
m_host = "127.0.0.1";
|
|
m_port = 4533;
|
|
m_track = false;
|
|
m_source = "";
|
|
m_azimuthOffset = 0.0f;
|
|
m_elevationOffset = 0.0f;
|
|
m_azimuthMin = 0;
|
|
m_azimuthMax = 450;
|
|
m_elevationMin = 0;
|
|
m_elevationMax = 180;
|
|
m_tolerance = 1.0f;
|
|
m_protocol = GS232;
|
|
m_connection = SERIAL;
|
|
m_precision = 0;
|
|
m_coordinates = AZ_EL;
|
|
m_inputController = "None";
|
|
m_targetControlEnabled = true;
|
|
m_offsetControlEnabled = true;
|
|
m_highSensitivity = true;
|
|
m_inputControllerSettings.m_lowSensitivity = 5.0f;
|
|
m_inputControllerSettings.m_highSensitivity = 50.0f;
|
|
for (int i = 0; i < INPUTCONTROLLER_MAX_AXES; i++) {
|
|
m_inputControllerSettings.m_deadzone[i] = 10.0f;
|
|
}
|
|
m_dfmTrackOn = false;
|
|
m_dfmLubePumpsOn = false;
|
|
m_dfmBrakesOn = false;
|
|
m_dfmDrivesOn = false;
|
|
m_title = "Rotator Controller";
|
|
m_rgbColor = QColor(225, 25, 99).rgb();
|
|
m_useReverseAPI = false;
|
|
m_reverseAPIAddress = "127.0.0.1";
|
|
m_reverseAPIPort = 8888;
|
|
m_reverseAPIFeatureSetIndex = 0;
|
|
m_reverseAPIFeatureIndex = 0;
|
|
m_workspaceIndex = 0;
|
|
}
|
|
|
|
QByteArray GS232ControllerSettings::serialize() const
|
|
{
|
|
SimpleSerializer s(1);
|
|
|
|
s.writeFloat(1, m_azimuth);
|
|
s.writeFloat(2, m_elevation);
|
|
s.writeString(3, m_serialPort);
|
|
s.writeS32(4, m_baudRate);
|
|
s.writeBool(5, m_track);
|
|
s.writeString(6, m_source);
|
|
s.writeString(8, m_title);
|
|
s.writeU32(9, m_rgbColor);
|
|
s.writeBool(10, m_useReverseAPI);
|
|
s.writeString(11, m_reverseAPIAddress);
|
|
s.writeU32(12, m_reverseAPIPort);
|
|
s.writeU32(13, m_reverseAPIFeatureSetIndex);
|
|
s.writeU32(14, m_reverseAPIFeatureIndex);
|
|
s.writeFloat(15, m_azimuthOffset);
|
|
s.writeFloat(16, m_elevationOffset);
|
|
s.writeS32(17, m_azimuthMin);
|
|
s.writeS32(18, m_azimuthMax);
|
|
s.writeS32(19, m_elevationMin);
|
|
s.writeS32(20, m_elevationMax);
|
|
s.writeFloat(21, m_tolerance);
|
|
s.writeS32(22, (int)m_protocol);
|
|
s.writeS32(23, (int)m_connection);
|
|
s.writeString(24, m_host);
|
|
s.writeS32(25, m_port);
|
|
|
|
if (m_rollupState) {
|
|
s.writeBlob(26, m_rollupState->serialize());
|
|
}
|
|
|
|
s.writeS32(27, m_workspaceIndex);
|
|
s.writeBlob(28, m_geometryBytes);
|
|
s.writeS32(29, m_precision);
|
|
s.writeS32(30, (int)m_coordinates);
|
|
s.writeBool(31, m_dfmTrackOn);
|
|
s.writeBool(32, m_dfmLubePumpsOn);
|
|
s.writeBool(33, m_dfmBrakesOn);
|
|
s.writeBool(34, m_dfmDrivesOn);
|
|
s.writeString(35, m_inputController);
|
|
s.writeBool(37, m_targetControlEnabled);
|
|
s.writeBool(38, m_offsetControlEnabled);
|
|
s.writeBool(39, m_highSensitivity);
|
|
|
|
s.writeFloat(50, m_inputControllerSettings.m_lowSensitivity);
|
|
s.writeFloat(51, m_inputControllerSettings.m_highSensitivity);
|
|
for (int i = 0; i < INPUTCONTROLLER_MAX_AXES; i++) {
|
|
s.writeFloat(60+i, m_inputControllerSettings.m_deadzone[i]);
|
|
}
|
|
|
|
return s.final();
|
|
}
|
|
|
|
bool GS232ControllerSettings::deserialize(const QByteArray& data)
|
|
{
|
|
SimpleDeserializer d(data);
|
|
|
|
if (!d.isValid())
|
|
{
|
|
resetToDefaults();
|
|
return false;
|
|
}
|
|
|
|
if (d.getVersion() == 1)
|
|
{
|
|
QByteArray bytetmp;
|
|
uint32_t utmp;
|
|
QString strtmp;
|
|
|
|
d.readFloat(1, &m_azimuth, 0);
|
|
d.readFloat(2, &m_elevation, 0);
|
|
d.readString(3, &m_serialPort, "");
|
|
d.readS32(4, &m_baudRate, 9600);
|
|
d.readBool(5, &m_track, false);
|
|
d.readString(6, &m_source, "");
|
|
d.readString(8, &m_title, "Rotator Controller");
|
|
d.readU32(9, &m_rgbColor, QColor(225, 25, 99).rgb());
|
|
d.readBool(10, &m_useReverseAPI, false);
|
|
d.readString(11, &m_reverseAPIAddress, "127.0.0.1");
|
|
d.readU32(12, &utmp, 0);
|
|
|
|
if ((utmp > 1023) && (utmp < 65535)) {
|
|
m_reverseAPIPort = utmp;
|
|
} else {
|
|
m_reverseAPIPort = 8888;
|
|
}
|
|
|
|
d.readU32(13, &utmp, 0);
|
|
m_reverseAPIFeatureSetIndex = utmp > 99 ? 99 : utmp;
|
|
d.readU32(14, &utmp, 0);
|
|
m_reverseAPIFeatureIndex = utmp > 99 ? 99 : utmp;
|
|
d.readFloat(15, &m_azimuthOffset, 0.0f);
|
|
d.readFloat(16, &m_elevationOffset, 0.0f);
|
|
d.readS32(17, &m_azimuthMin, 0);
|
|
d.readS32(18, &m_azimuthMax, 450);
|
|
d.readS32(19, &m_elevationMin, 0);
|
|
d.readS32(20, &m_elevationMax, 180);
|
|
d.readFloat(21, &m_tolerance, 1.0f);
|
|
d.readS32(22, (int*)&m_protocol, GS232);
|
|
d.readS32(23, (int*)&m_connection, SERIAL);
|
|
d.readString(24, &m_host, "127.0.0.1");
|
|
d.readS32(25, &m_port, 4533);
|
|
|
|
if (m_rollupState)
|
|
{
|
|
d.readBlob(26, &bytetmp);
|
|
m_rollupState->deserialize(bytetmp);
|
|
}
|
|
|
|
d.readS32(27, &m_workspaceIndex, 0);
|
|
d.readBlob(28, &m_geometryBytes);
|
|
d.readS32(29, &m_precision, 0);
|
|
d.readS32(30, (int *)&m_coordinates, (int)AZ_EL);
|
|
d.readBool(31, &m_dfmTrackOn);
|
|
d.readBool(32, &m_dfmLubePumpsOn);
|
|
d.readBool(33, &m_dfmBrakesOn);
|
|
d.readBool(34, &m_dfmDrivesOn);
|
|
d.readString(35, &m_inputController, "None");
|
|
d.readBool(37, &m_targetControlEnabled, true);
|
|
d.readBool(38, &m_offsetControlEnabled, true);
|
|
d.readBool(39, &m_highSensitivity, true);
|
|
|
|
d.readFloat(50, &m_inputControllerSettings.m_lowSensitivity, 5.0f);
|
|
d.readFloat(51, &m_inputControllerSettings.m_highSensitivity, 50.0f);
|
|
for (int i = 0; i < INPUTCONTROLLER_MAX_AXES; i++) {
|
|
d.readFloat(60+i, &m_inputControllerSettings.m_deadzone[i], 10.0f);
|
|
}
|
|
|
|
return true;
|
|
}
|
|
else
|
|
{
|
|
resetToDefaults();
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void GS232ControllerSettings::calcTargetAzEl(float& targetAz, float& targetEl) const
|
|
{
|
|
// Apply offset then clamp
|
|
|
|
targetAz = m_azimuth;
|
|
targetAz += m_azimuthOffset;
|
|
targetAz = std::max(targetAz, (float)m_azimuthMin);
|
|
targetAz = std::min(targetAz, (float)m_azimuthMax);
|
|
|
|
targetEl = m_elevation;
|
|
targetEl += m_elevationOffset;
|
|
targetEl = std::max(targetEl, (float)m_elevationMin);
|
|
targetEl = std::min(targetEl, (float)m_elevationMax);
|
|
}
|
|
|
|
void GS232ControllerSettings::applySettings(const QStringList& settingsKeys, const GS232ControllerSettings& settings)
|
|
{
|
|
if (settingsKeys.contains("azimuth")) {
|
|
m_azimuth = settings.m_azimuth;
|
|
}
|
|
if (settingsKeys.contains("elevation")) {
|
|
m_elevation = settings.m_elevation;
|
|
}
|
|
if (settingsKeys.contains("serialPort")) {
|
|
m_serialPort = settings.m_serialPort;
|
|
}
|
|
if (settingsKeys.contains("baudRate")) {
|
|
m_baudRate = settings.m_baudRate;
|
|
}
|
|
if (settingsKeys.contains("host")) {
|
|
m_host = settings.m_host;
|
|
}
|
|
if (settingsKeys.contains("port")) {
|
|
m_port = settings.m_port;
|
|
}
|
|
if (settingsKeys.contains("track")) {
|
|
m_track = settings.m_track;
|
|
}
|
|
if (settingsKeys.contains("source")) {
|
|
m_source = settings.m_source;
|
|
}
|
|
if (settingsKeys.contains("azimuthOffset")) {
|
|
m_azimuthOffset = settings.m_azimuthOffset;
|
|
}
|
|
if (settingsKeys.contains("elevationOffset")) {
|
|
m_elevationOffset = settings.m_elevationOffset;
|
|
}
|
|
if (settingsKeys.contains("azimuthMin")) {
|
|
m_azimuthMin = settings.m_azimuthMin;
|
|
}
|
|
if (settingsKeys.contains("azimuthMax")) {
|
|
m_azimuthMax = settings.m_azimuthMax;
|
|
}
|
|
if (settingsKeys.contains("elevationMin")) {
|
|
m_elevationMin = settings.m_elevationMin;
|
|
}
|
|
if (settingsKeys.contains("elevationMax")) {
|
|
m_elevationMax = settings.m_elevationMax;
|
|
}
|
|
if (settingsKeys.contains("tolerance")) {
|
|
m_tolerance = settings.m_tolerance;
|
|
}
|
|
if (settingsKeys.contains("protocol")) {
|
|
m_protocol = settings.m_protocol;
|
|
}
|
|
if (settingsKeys.contains("connection")) {
|
|
m_connection = settings.m_connection;
|
|
}
|
|
if (settingsKeys.contains("precision")) {
|
|
m_precision = settings.m_precision;
|
|
}
|
|
if (settingsKeys.contains("coordinates")) {
|
|
m_coordinates = settings.m_coordinates;
|
|
}
|
|
if (settingsKeys.contains("inputController")) {
|
|
m_inputController = settings.m_inputController;
|
|
}
|
|
if (settingsKeys.contains("inputControllerSettings")) {
|
|
m_inputControllerSettings = settings.m_inputControllerSettings;
|
|
}
|
|
if (settingsKeys.contains("targetControlEnabled")) {
|
|
m_targetControlEnabled = settings.m_targetControlEnabled;
|
|
}
|
|
if (settingsKeys.contains("offsetControlEnabled")) {
|
|
m_offsetControlEnabled = settings.m_offsetControlEnabled;
|
|
}
|
|
if (settingsKeys.contains("highSensitivity")) {
|
|
m_highSensitivity = settings.m_highSensitivity;
|
|
}
|
|
if (settingsKeys.contains("dfmTrackOn")) {
|
|
m_dfmTrackOn = settings.m_dfmTrackOn;
|
|
}
|
|
if (settingsKeys.contains("dfmLubePumpsOn")) {
|
|
m_dfmLubePumpsOn = settings.m_dfmLubePumpsOn;
|
|
}
|
|
if (settingsKeys.contains("dfmBrakesOn")) {
|
|
m_dfmBrakesOn = settings.m_dfmBrakesOn;
|
|
}
|
|
if (settingsKeys.contains("dfmDrivesOn")) {
|
|
m_dfmDrivesOn = settings.m_dfmDrivesOn;
|
|
}
|
|
if (settingsKeys.contains("title")) {
|
|
m_title = settings.m_title;
|
|
}
|
|
if (settingsKeys.contains("rgbColor")) {
|
|
m_rgbColor = settings.m_rgbColor;
|
|
}
|
|
if (settingsKeys.contains("useReverseAPI")) {
|
|
m_useReverseAPI = settings.m_useReverseAPI;
|
|
}
|
|
if (settingsKeys.contains("reverseAPIAddress")) {
|
|
m_reverseAPIAddress = settings.m_reverseAPIAddress;
|
|
}
|
|
if (settingsKeys.contains("reverseAPIPort")) {
|
|
m_reverseAPIPort = settings.m_reverseAPIPort;
|
|
}
|
|
if (settingsKeys.contains("reverseAPIFeatureSetIndex")) {
|
|
m_reverseAPIFeatureSetIndex = settings.m_reverseAPIFeatureSetIndex;
|
|
}
|
|
if (settingsKeys.contains("reverseAPIFeatureIndex")) {
|
|
m_reverseAPIFeatureIndex = settings.m_reverseAPIFeatureIndex;
|
|
}
|
|
if (settingsKeys.contains("workspaceIndex")) {
|
|
m_workspaceIndex = settings.m_workspaceIndex;
|
|
}
|
|
}
|
|
|
|
QString GS232ControllerSettings::getDebugString(const QStringList& settingsKeys, bool force) const
|
|
{
|
|
std::ostringstream ostr;
|
|
|
|
if (settingsKeys.contains("azimuth") || force) {
|
|
ostr << " m_azimuth: " << m_azimuth;
|
|
}
|
|
if (settingsKeys.contains("elevation") || force) {
|
|
ostr << " m_elevation: " << m_elevation;
|
|
}
|
|
if (settingsKeys.contains("serialPort") || force) {
|
|
ostr << " m_serialPort: " << m_serialPort.toStdString();
|
|
}
|
|
if (settingsKeys.contains("baudRate") || force) {
|
|
ostr << " m_baudRate: " << m_baudRate;
|
|
}
|
|
if (settingsKeys.contains("host") || force) {
|
|
ostr << " m_host: " << m_host.toStdString();
|
|
}
|
|
if (settingsKeys.contains("port") || force) {
|
|
ostr << " m_port: " << m_port;
|
|
}
|
|
if (settingsKeys.contains("track") || force) {
|
|
ostr << " m_track: " << m_track;
|
|
}
|
|
if (settingsKeys.contains("source") || force) {
|
|
ostr << " m_source: " << m_source.toStdString();
|
|
}
|
|
if (settingsKeys.contains("azimuthOffset") || force) {
|
|
ostr << " m_azimuthOffset: " << m_azimuthOffset;
|
|
}
|
|
if (settingsKeys.contains("elevationOffset") || force) {
|
|
ostr << " m_elevationOffset: " << m_elevationOffset;
|
|
}
|
|
if (settingsKeys.contains("azimuthMin") || force) {
|
|
ostr << " m_azimuthMin: " << m_azimuthMin;
|
|
}
|
|
if (settingsKeys.contains("azimuthMax") || force) {
|
|
ostr << " m_azimuthMax: " << m_azimuthMax;
|
|
}
|
|
if (settingsKeys.contains("elevationMin") || force) {
|
|
ostr << " m_elevationMin: " << m_elevationMin;
|
|
}
|
|
if (settingsKeys.contains("elevationMax") || force) {
|
|
ostr << " m_elevationMax: " << m_elevationMax;
|
|
}
|
|
if (settingsKeys.contains("tolerance") || force) {
|
|
ostr << " m_tolerance: " << m_tolerance;
|
|
}
|
|
if (settingsKeys.contains("protocol") || force) {
|
|
ostr << " m_protocol: " << m_protocol;
|
|
}
|
|
if (settingsKeys.contains("connection") || force) {
|
|
ostr << " m_connection: " << m_connection;
|
|
}
|
|
if (settingsKeys.contains("precision") || force) {
|
|
ostr << " m_precision: " << m_precision;
|
|
}
|
|
if (settingsKeys.contains("coordinates") || force) {
|
|
ostr << " m_coordinates: " << m_precision;
|
|
}
|
|
if (settingsKeys.contains("inputController") || force) {
|
|
ostr << " m_inputController: " << m_inputController.toStdString();
|
|
}
|
|
if (settingsKeys.contains("inputControllerSettings") || force) {
|
|
ostr << " m_inputControllerSettings.m_lowSensitivity: " << m_inputControllerSettings.m_lowSensitivity;
|
|
ostr << " m_inputControllerSettings.m_highSensitivity: " << m_inputControllerSettings.m_highSensitivity;
|
|
for (int i = 0; i < INPUTCONTROLLER_MAX_AXES; i++) {
|
|
ostr << " m_inputControllerSettings.m_deadzone: " << m_inputControllerSettings.m_deadzone[i];
|
|
}
|
|
}
|
|
if (settingsKeys.contains("targetControlEnabled") || force) {
|
|
ostr << " m_targetControlEnabled: " << m_targetControlEnabled;
|
|
}
|
|
if (settingsKeys.contains("offsetControlEnabled") || force) {
|
|
ostr << " m_offsetControlEnabled: " << m_offsetControlEnabled;
|
|
}
|
|
if (settingsKeys.contains("highSensitivity") || force) {
|
|
ostr << " m_highSensitivity: " << m_highSensitivity;
|
|
}
|
|
if (settingsKeys.contains("title") || force) {
|
|
ostr << " m_title: " << m_title.toStdString();
|
|
}
|
|
if (settingsKeys.contains("rgbColor") || force) {
|
|
ostr << " m_rgbColor: " << m_rgbColor;
|
|
}
|
|
if (settingsKeys.contains("useReverseAPI") || force) {
|
|
ostr << " m_useReverseAPI: " << m_useReverseAPI;
|
|
}
|
|
if (settingsKeys.contains("azimuth") || force) {
|
|
ostr << " m_reverseAPIAddress: " << m_reverseAPIAddress.toStdString();
|
|
}
|
|
if (settingsKeys.contains("reverseAPIPort") || force) {
|
|
ostr << " m_reverseAPIPort: " << m_reverseAPIPort;
|
|
}
|
|
if (settingsKeys.contains("reverseAPIFeatureSetIndex") || force) {
|
|
ostr << " m_reverseAPIFeatureSetIndex: " << m_reverseAPIFeatureSetIndex;
|
|
}
|
|
if (settingsKeys.contains("reverseAPIFeatureIndex") || force) {
|
|
ostr << " m_reverseAPIFeatureIndex: " << m_reverseAPIFeatureIndex;
|
|
}
|
|
if (settingsKeys.contains("workspaceIndex") || force) {
|
|
ostr << " m_workspaceIndex: " << m_workspaceIndex;
|
|
}
|
|
|
|
return QString(ostr.str().c_str());
|
|
}
|