mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2025-01-08 19:46:06 +01:00
338 lines
12 KiB
C++
338 lines
12 KiB
C++
/**
|
|
******************************************************************************
|
|
*
|
|
* @file configtxpidswidget.cpp
|
|
* @author The OpenPilot Team, http://www.openpilot.org Copyright (C) 2012.
|
|
* @addtogroup GCSPlugins GCS Plugins
|
|
* @{
|
|
* @addtogroup ConfigPlugin Config Plugin
|
|
* @{
|
|
* @brief The Configuration Gadget used to configure the PipXtreme
|
|
*****************************************************************************/
|
|
/*
|
|
* 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; either 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
|
|
* for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
#include "configpipxtremewidget.h"
|
|
|
|
#include <oplinksettings.h>
|
|
#include <oplinkstatus.h>
|
|
|
|
ConfigPipXtremeWidget::ConfigPipXtremeWidget(QWidget *parent) : ConfigTaskWidget(parent)
|
|
{
|
|
m_oplink = new Ui_PipXtremeWidget();
|
|
m_oplink->setupUi(this);
|
|
|
|
// Connect to the OPLinkStatus object updates
|
|
ExtensionSystem::PluginManager *pm = ExtensionSystem::PluginManager::instance();
|
|
UAVObjectManager *objManager = pm->getObject<UAVObjectManager>();
|
|
oplinkStatusObj = dynamic_cast<UAVDataObject*>(objManager->getObject("OPLinkStatus"));
|
|
if (oplinkStatusObj != NULL ) {
|
|
connect(oplinkStatusObj, SIGNAL(objectUpdated(UAVObject*)), this, SLOT(updateStatus(UAVObject*)));
|
|
} else {
|
|
qDebug() << "Error: Object is unknown (OPLinkStatus).";
|
|
}
|
|
|
|
// Connect to the OPLinkSettings object updates
|
|
oplinkSettingsObj = dynamic_cast<UAVDataObject*>(objManager->getObject("OPLinkSettings"));
|
|
if (oplinkSettingsObj != NULL ) {
|
|
connect(oplinkSettingsObj, SIGNAL(objectUpdated(UAVObject*)), this, SLOT(updateSettings(UAVObject*)));
|
|
} else {
|
|
qDebug() << "Error: Object is unknown (OPLinkSettings).";
|
|
}
|
|
autoLoadWidgets();
|
|
addApplySaveButtons(m_oplink->Apply, m_oplink->Save);
|
|
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "Coordinator", m_oplink->Coordinator);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "PPM", m_oplink->PPM);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "UAVTalk", m_oplink->UAVTalk);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "InputConnection", m_oplink->InputConnection);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "OutputConnection", m_oplink->OutputConnection);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "ComSpeed", m_oplink->ComSpeed);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "MaxRFPower", m_oplink->MaxRFTxPower);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "SendTimeout", m_oplink->SendTimeout);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "MinPacketSize", m_oplink->MinPacketSize);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "FrequencyCalibration", m_oplink->FrequencyCalibration);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "MinFrequency", m_oplink->MinFrequency);
|
|
addUAVObjectToWidgetRelation("OPLinkSettings", "MaxFrequency", m_oplink->MaxFrequency);
|
|
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "RxGood", m_oplink->Good);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "RxCorrected", m_oplink->Corrected);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "RxErrors", m_oplink->Errors);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "RxMissed", m_oplink->Missed);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "UAVTalkErrors", m_oplink->UAVTalkErrors);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "TxDropped", m_oplink->Dropped);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "Resets", m_oplink->Resets);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "Timeouts", m_oplink->Timeouts);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "RSSI", m_oplink->RSSI);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "AFCCorrection", m_oplink->AFCCorrection);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "LinkQuality", m_oplink->LinkQuality);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "RXRate", m_oplink->RXRate);
|
|
addUAVObjectToWidgetRelation("OPLinkStatus", "TXRate", m_oplink->TXRate);
|
|
|
|
// Connect to the pair ID radio buttons.
|
|
connect(m_oplink->PairSelectB, SIGNAL(toggled(bool)), this, SLOT(pairBToggled(bool)));
|
|
connect(m_oplink->PairSelect1, SIGNAL(toggled(bool)), this, SLOT(pair1Toggled(bool)));
|
|
connect(m_oplink->PairSelect2, SIGNAL(toggled(bool)), this, SLOT(pair2Toggled(bool)));
|
|
connect(m_oplink->PairSelect3, SIGNAL(toggled(bool)), this, SLOT(pair3Toggled(bool)));
|
|
connect(m_oplink->PairSelect4, SIGNAL(toggled(bool)), this, SLOT(pair4Toggled(bool)));
|
|
|
|
//Add scroll bar when necessary
|
|
QScrollArea *scroll = new QScrollArea;
|
|
scroll->setWidget(m_oplink->frame_3);
|
|
scroll->setWidgetResizable(true);
|
|
m_oplink->verticalLayout_3->addWidget(scroll);
|
|
|
|
// Request and update of the setting object.
|
|
settingsUpdated = false;
|
|
|
|
disableMouseWheelEvents();
|
|
}
|
|
|
|
ConfigPipXtremeWidget::~ConfigPipXtremeWidget()
|
|
{
|
|
// Do nothing
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::refreshValues()
|
|
{
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::applySettings()
|
|
{
|
|
OPLinkSettings *oplinkSettings = OPLinkSettings::GetInstance(getObjectManager());
|
|
OPLinkSettings::DataFields oplinkSettingsData = oplinkSettings->getData();
|
|
|
|
// Get the pair ID.
|
|
quint32 pairID = 0;
|
|
bool okay;
|
|
if (m_oplink->PairSelect1->isChecked())
|
|
pairID = m_oplink->PairID1->text().toUInt(&okay, 16);
|
|
else if (m_oplink->PairSelect2->isChecked())
|
|
pairID = m_oplink->PairID2->text().toUInt(&okay, 16);
|
|
else if (m_oplink->PairSelect3->isChecked())
|
|
pairID = m_oplink->PairID3->text().toUInt(&okay, 16);
|
|
else if (m_oplink->PairSelect4->isChecked())
|
|
pairID = m_oplink->PairID4->text().toUInt(&okay, 16);
|
|
oplinkSettingsData.PairID = pairID;
|
|
oplinkSettings->setData(oplinkSettingsData);
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::saveSettings()
|
|
{
|
|
//applySettings();
|
|
UAVObject *obj = OPLinkSettings::GetInstance(getObjectManager());
|
|
saveObjectToSD(obj);
|
|
}
|
|
|
|
/*!
|
|
\brief Called by updates to @OPLinkStatus
|
|
*/
|
|
void ConfigPipXtremeWidget::updateStatus(UAVObject *object)
|
|
{
|
|
|
|
// Request and update of the setting object if we haven't received it yet.
|
|
if (!settingsUpdated)
|
|
oplinkSettingsObj->requestUpdate();
|
|
|
|
// Get the current pairID
|
|
OPLinkSettings *oplinkSettings = OPLinkSettings::GetInstance(getObjectManager());
|
|
quint32 pairID = 0;
|
|
if (oplinkSettings)
|
|
pairID = oplinkSettings->getPairID();
|
|
|
|
// Update the detected devices.
|
|
UAVObjectField* pairIdField = object->getField("PairIDs");
|
|
if (pairIdField) {
|
|
quint32 pairid1 = pairIdField->getValue(0).toUInt();
|
|
m_oplink->PairID1->setText(QString::number(pairid1, 16).toUpper());
|
|
m_oplink->PairID1->setEnabled(false);
|
|
m_oplink->PairSelect1->setChecked(pairID && (pairID == pairid1));
|
|
m_oplink->PairSelect1->setEnabled(pairid1);
|
|
quint32 pairid2 = pairIdField->getValue(1).toUInt();
|
|
m_oplink->PairID2->setText(QString::number(pairIdField->getValue(1).toUInt(), 16).toUpper());
|
|
m_oplink->PairID2->setEnabled(false);
|
|
m_oplink->PairSelect2->setChecked(pairID && (pairID == pairid2));
|
|
m_oplink->PairSelect2->setEnabled(pairid2);
|
|
quint32 pairid3 = pairIdField->getValue(2).toUInt();
|
|
m_oplink->PairID3->setText(QString::number(pairIdField->getValue(2).toUInt(), 16).toUpper());
|
|
m_oplink->PairID3->setEnabled(false);
|
|
m_oplink->PairSelect3->setChecked(pairID && (pairID == pairid3));
|
|
m_oplink->PairSelect3->setEnabled(pairid3);
|
|
quint32 pairid4 = pairIdField->getValue(3).toUInt();
|
|
m_oplink->PairID4->setText(QString::number(pairIdField->getValue(3).toUInt(), 16).toUpper());
|
|
m_oplink->PairID4->setEnabled(false);
|
|
m_oplink->PairSelect4->setChecked(pairID && (pairID == pairid4));
|
|
m_oplink->PairSelect4->setEnabled(pairid4);
|
|
} else {
|
|
qDebug() << "PipXtremeGadgetWidget: Count not read PairID field.";
|
|
}
|
|
UAVObjectField* pairRssiField = object->getField("PairSignalStrengths");
|
|
if (pairRssiField) {
|
|
m_oplink->PairSignalStrengthBar1->setValue(pairRssiField->getValue(0).toInt());
|
|
m_oplink->PairSignalStrengthBar2->setValue(pairRssiField->getValue(1).toInt());
|
|
m_oplink->PairSignalStrengthBar3->setValue(pairRssiField->getValue(2).toInt());
|
|
m_oplink->PairSignalStrengthBar4->setValue(pairRssiField->getValue(3).toInt());
|
|
m_oplink->PairSignalStrengthLabel1->setText(QString("%1dB").arg(pairRssiField->getValue(0).toInt()));
|
|
m_oplink->PairSignalStrengthLabel2->setText(QString("%1dB").arg(pairRssiField->getValue(1).toInt()));
|
|
m_oplink->PairSignalStrengthLabel3->setText(QString("%1dB").arg(pairRssiField->getValue(2).toInt()));
|
|
m_oplink->PairSignalStrengthLabel4->setText(QString("%1dB").arg(pairRssiField->getValue(3).toInt()));
|
|
} else {
|
|
qDebug() << "PipXtremeGadgetWidget: Count not read PairID field.";
|
|
}
|
|
|
|
// Update the Description field
|
|
UAVObjectField* descField = object->getField("Description");
|
|
if (descField) {
|
|
/*
|
|
* This looks like a binary with a description at the end
|
|
* 4 bytes: header: "OpFw"
|
|
* 4 bytes: git commit hash (short version of SHA1)
|
|
* 4 bytes: Unix timestamp of last git commit
|
|
* 2 bytes: target platform. Should follow same rule as BOARD_TYPE and BOARD_REVISION in board define files.
|
|
* 26 bytes: commit tag if it is there, otherwise "Unreleased". Zero-padded
|
|
* ---- 40 bytes limit ---
|
|
* 20 bytes: SHA1 sum of the firmware.
|
|
* 40 bytes: free for now.
|
|
*/
|
|
char buf[OPLinkStatus::DESCRIPTION_NUMELEM];
|
|
for (unsigned int i = 0; i < 26; ++i)
|
|
buf[i] = descField->getValue(i + 14).toChar().toAscii();
|
|
buf[26] = '\0';
|
|
QString descstr(buf);
|
|
quint32 gitDate = descField->getValue(11).toChar().toAscii() & 0xFF;
|
|
for (int i = 1; i < 4; i++) {
|
|
gitDate = gitDate << 8;
|
|
gitDate += descField->getValue(11-i).toChar().toAscii() & 0xFF;
|
|
}
|
|
QString date = QDateTime::fromTime_t(gitDate).toUTC().toString("yyyy-MM-dd HH:mm");
|
|
m_oplink->FirmwareVersion->setText(descstr + " " + date);
|
|
} else {
|
|
qDebug() << "PipXtremeGadgetWidget: Count not read Description field.";
|
|
}
|
|
|
|
// Update the serial number field
|
|
UAVObjectField* serialField = object->getField("CPUSerial");
|
|
if (serialField) {
|
|
char buf[OPLinkStatus::CPUSERIAL_NUMELEM * 2 + 1];
|
|
for (unsigned int i = 0; i < OPLinkStatus::CPUSERIAL_NUMELEM; ++i)
|
|
{
|
|
unsigned char val = serialField->getValue(i).toUInt() >> 4;
|
|
buf[i * 2] = ((val < 10) ? '0' : '7') + val;
|
|
val = serialField->getValue(i).toUInt() & 0xf;
|
|
buf[i * 2 + 1] = ((val < 10) ? '0' : '7') + val;
|
|
}
|
|
buf[OPLinkStatus::CPUSERIAL_NUMELEM * 2] = '\0';
|
|
m_oplink->SerialNumber->setText(buf);
|
|
} else {
|
|
qDebug() << "PipXtremeGadgetWidget: Count not read Description field.";
|
|
}
|
|
|
|
// Update the DeviceID field
|
|
UAVObjectField* idField = object->getField("DeviceID");
|
|
if (idField) {
|
|
m_oplink->DeviceID->setText(QString::number(idField->getValue().toUInt(), 16).toUpper());
|
|
} else {
|
|
qDebug() << "PipXtremeGadgetWidget: Count not read DeviceID field.";
|
|
}
|
|
|
|
// Update the PairID field
|
|
m_oplink->PairID->setText(QString::number(pairID, 16).toUpper());
|
|
|
|
// Update the link state
|
|
UAVObjectField* linkField = object->getField("LinkState");
|
|
if (linkField) {
|
|
m_oplink->LinkState->setText(linkField->getValue().toString());
|
|
} else {
|
|
qDebug() << "PipXtremeGadgetWidget: Count not read link state field.";
|
|
}
|
|
}
|
|
|
|
/*!
|
|
\brief Called by updates to @OPLinkSettings
|
|
*/
|
|
void ConfigPipXtremeWidget::updateSettings(UAVObject *object)
|
|
{
|
|
Q_UNUSED(object);
|
|
|
|
if (!settingsUpdated)
|
|
{
|
|
settingsUpdated = true;
|
|
enableControls(true);
|
|
}
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::disconnected()
|
|
{
|
|
if (settingsUpdated)
|
|
{
|
|
settingsUpdated = false;
|
|
enableControls(false);
|
|
}
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::pairIDToggled(bool checked, quint8 idx)
|
|
{
|
|
if(checked)
|
|
{
|
|
OPLinkStatus *oplinkStatus = OPLinkStatus::GetInstance(getObjectManager());
|
|
OPLinkSettings *oplinkSettings = OPLinkSettings::GetInstance(getObjectManager());
|
|
|
|
if (oplinkStatus && oplinkSettings)
|
|
{
|
|
if (idx == 4)
|
|
{
|
|
oplinkSettings->setPairID(0);
|
|
}
|
|
else
|
|
{
|
|
quint32 pairID = oplinkStatus->getPairIDs(idx);
|
|
if (pairID)
|
|
oplinkSettings->setPairID(pairID);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::pair1Toggled(bool checked)
|
|
{
|
|
pairIDToggled(checked, 0);
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::pair2Toggled(bool checked)
|
|
{
|
|
pairIDToggled(checked, 1);
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::pair3Toggled(bool checked)
|
|
{
|
|
pairIDToggled(checked, 2);
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::pair4Toggled(bool checked)
|
|
{
|
|
pairIDToggled(checked, 3);
|
|
}
|
|
|
|
void ConfigPipXtremeWidget::pairBToggled(bool checked)
|
|
{
|
|
pairIDToggled(checked, 4);
|
|
}
|
|
|
|
/**
|
|
@}
|
|
@}
|
|
*/
|