Commit b40f81ba authored by Lorenz Meier's avatar Lorenz Meier

Rock-solid RC calibration, not leaving out any steps

parent 5313da41
...@@ -209,6 +209,9 @@ void QGCPX4VehicleConfig::identifyChannelMapping(int aert_index) ...@@ -209,6 +209,9 @@ void QGCPX4VehicleConfig::identifyChannelMapping(int aert_index)
{ {
if (chanCount == 0) if (chanCount == 0)
return; return;
int oldmapping = rcMapping[aert_index];
channelWanted = aert_index; channelWanted = aert_index;
for (unsigned i = 0; i < sizeof(channelWantedList) / sizeof(channelWantedList[0]); i++) for (unsigned i = 0; i < sizeof(channelWantedList) / sizeof(channelWantedList[0]); i++)
...@@ -220,6 +223,17 @@ void QGCPX4VehicleConfig::identifyChannelMapping(int aert_index) ...@@ -220,6 +223,17 @@ void QGCPX4VehicleConfig::identifyChannelMapping(int aert_index)
} }
} }
msgBox.setText(tr("Identifying %1 channel").arg(channelNames[channelWanted]));
msgBox.setInformativeText(tr("Please move stick, switch or potentiometer for the %1 channel\n all the way up/down or left/right.").arg(channelNames[channelWanted]));
msgBox.setStandardButtons(QMessageBox::Ok | QMessageBox::Cancel);
msgBox.setDefaultButton(QMessageBox::Cancel);
if (QMessageBox::Cancel == msgBox.exec())
{
channelWanted = -1;
rcMapping[aert_index] = oldmapping;
return;
}
} }
QGCPX4VehicleConfig::~QGCPX4VehicleConfig() QGCPX4VehicleConfig::~QGCPX4VehicleConfig()
...@@ -289,7 +303,14 @@ void QGCPX4VehicleConfig::detectChannelInversion() ...@@ -289,7 +303,14 @@ void QGCPX4VehicleConfig::detectChannelInversion()
void QGCPX4VehicleConfig::startCalibrationRC() void QGCPX4VehicleConfig::startCalibrationRC()
{ {
QMessageBox::information(0,"Warning!","You are about to start radio calibration.\nPlease ensure all motor power is disconnected AND all props are removed from the vehicle.\nAlso ensure transmitter and reciever are powered and connected\n\nClick OK to confirm"); QMessageBox::warning(0,"Warning!","You are about to start radio calibration.\nPlease ensure all motor power is disconnected AND all props are removed from the vehicle.\nAlso ensure transmitter and receiver are powered and connected\n\nDo not move the RC sticks, then click OK to confirm");
for (int i = 0; i < 5; i++) {
identifyChannelMapping(i);
}
QMessageBox::information(0,"Information","Additional channels have not been mapped, but can be mapped in the channel table below.");
QMessageBox::information(0,"Information","Click OK, then move all sticks to their extreme positions, watching the min/max values to ensure you get the most range from your controller. This includes all switches"); QMessageBox::information(0,"Information","Click OK, then move all sticks to their extreme positions, watching the min/max values to ensure you get the most range from your controller. This includes all switches");
ui->rcCalibrationButton->setText(tr("Stop RC Calibration")); ui->rcCalibrationButton->setText(tr("Stop RC Calibration"));
resetCalibrationRC(); resetCalibrationRC();
...@@ -307,6 +328,7 @@ void QGCPX4VehicleConfig::startCalibrationRC() ...@@ -307,6 +328,7 @@ void QGCPX4VehicleConfig::startCalibrationRC()
void QGCPX4VehicleConfig::stopCalibrationRC() void QGCPX4VehicleConfig::stopCalibrationRC()
{ {
QMessageBox::information(0,"Trims","Ensure all sticks are centeres and throttle is in the downmost position, click OK to continue"); QMessageBox::information(0,"Trims","Ensure all sticks are centeres and throttle is in the downmost position, click OK to continue");
calibrationEnabled = false; calibrationEnabled = false;
ui->rcCalibrationButton->setText(tr("Start RC Calibration")); ui->rcCalibrationButton->setText(tr("Start RC Calibration"));
...@@ -322,11 +344,18 @@ void QGCPX4VehicleConfig::stopCalibrationRC() ...@@ -322,11 +344,18 @@ void QGCPX4VehicleConfig::stopCalibrationRC()
for (int i=0;i<chanCount;i++) for (int i=0;i<chanCount;i++)
{ {
if (rcMin[i] > 1350) if (rcMin[i] > 1350)
{
rcMin[i] = 1000; rcMin[i] = 1000;
}
if (rcMax[i] < 1650) if (rcMax[i] < 1650)
{
rcMax[i] = 2000; rcMax[i] = 2000;
} }
}
qDebug() << "SETTING TRIM";
setTrimPositions();
QString statusstr; QString statusstr;
statusstr = "Below you will find the detected radio calibration information that will be sent to the autopilot\n"; statusstr = "Below you will find the detected radio calibration information that will be sent to the autopilot\n";
...@@ -338,6 +367,8 @@ void QGCPX4VehicleConfig::stopCalibrationRC() ...@@ -338,6 +367,8 @@ void QGCPX4VehicleConfig::stopCalibrationRC()
statusstr += QString::number(i) +"\t"+ QString::number(rcMin[i]) +"\t"+ QString::number(rcValue[i]) +"\t"+ QString::number(rcMax[i]) +"\n"; statusstr += QString::number(i) +"\t"+ QString::number(rcMin[i]) +"\t"+ QString::number(rcValue[i]) +"\t"+ QString::number(rcMax[i]) +"\n";
} }
QMessageBox::information(0,"Status",statusstr); QMessageBox::information(0,"Status",statusstr);
} }
void QGCPX4VehicleConfig::loadQgcConfig(bool primary) void QGCPX4VehicleConfig::loadQgcConfig(bool primary)
...@@ -1038,8 +1069,6 @@ void QGCPX4VehicleConfig::writeCalibrationRC() ...@@ -1038,8 +1069,6 @@ void QGCPX4VehicleConfig::writeCalibrationRC()
{ {
if (!mav) return; if (!mav) return;
setTrimPositions();
QString minTpl("RC%1_MIN"); QString minTpl("RC%1_MIN");
QString maxTpl("RC%1_MAX"); QString maxTpl("RC%1_MAX");
QString trimTpl("RC%1_TRIM"); QString trimTpl("RC%1_TRIM");
...@@ -1128,7 +1157,6 @@ void QGCPX4VehicleConfig::remoteControlChannelRawChanged(int chan, float val) ...@@ -1128,7 +1157,6 @@ void QGCPX4VehicleConfig::remoteControlChannelRawChanged(int chan, float val)
channelWanted = -1; channelWanted = -1;
// Confirm found channel // Confirm found channel
QMessageBox msgBox;
msgBox.setText(tr("%1 Channel found.").arg(channelNames[chanFound])); msgBox.setText(tr("%1 Channel found.").arg(channelNames[chanFound]));
msgBox.setInformativeText(tr("Found %1 to be on the raw RC channel %2").arg(channelNames[chanFound]).arg(chan + 1)); msgBox.setInformativeText(tr("Found %1 to be on the raw RC channel %2").arg(channelNames[chanFound]).arg(chan + 1));
msgBox.setStandardButtons(QMessageBox::Ok); msgBox.setStandardButtons(QMessageBox::Ok);
......
...@@ -7,6 +7,7 @@ ...@@ -7,6 +7,7 @@
#include <QGroupBox> #include <QGroupBox>
#include <QPushButton> #include <QPushButton>
#include <QStringList> #include <QStringList>
#include <QMessageBox>
#include "QGCToolWidget.h" #include "QGCToolWidget.h"
#include "UASInterface.h" #include "UASInterface.h"
...@@ -209,7 +210,7 @@ protected: ...@@ -209,7 +210,7 @@ protected:
bool doneLoadingConfig; bool doneLoadingConfig;
UASInterface* mav; ///< The current MAV UASInterface* mav; ///< The current MAV
QGCUASParamManager* paramMgr; ///< params mgr for the mav QGCUASParamManager* paramMgr; ///< params mgr for the mav
static const unsigned int chanMax = 8; ///< Maximum number of channels static const unsigned int chanMax = 16; ///< Maximum number of channels
unsigned int chanCount; ///< Actual channels unsigned int chanCount; ///< Actual channels
int rcType; ///< Type of the remote control int rcType; ///< Type of the remote control
quint64 rcTypeUpdateRequested; ///< Zero if not requested, non-zero if requested quint64 rcTypeUpdateRequested; ///< Zero if not requested, non-zero if requested
...@@ -252,6 +253,7 @@ protected: ...@@ -252,6 +253,7 @@ protected:
QGCPX4AirframeConfig* px4AirframeConfig; QGCPX4AirframeConfig* px4AirframeConfig;
DialogBare* firmwareDialog; DialogBare* firmwareDialog;
QMessageBox msgBox;
private: private:
Ui::QGCPX4VehicleConfig *ui; Ui::QGCPX4VehicleConfig *ui;
......
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment