Commit 94a4e02d authored by dogmaphobic's avatar dogmaphobic

Merge remote-tracking branch 'MavLink/master' into offlineMap

* MavLink/master:
  Fix flight mode display for PX4. Missed reverse channel check
parents 6af467ba 07052d03
...@@ -114,7 +114,7 @@ Item { ...@@ -114,7 +114,7 @@ Item {
QGCLabel { QGCLabel {
anchors.baseline: modeCombo.baseline anchors.baseline: modeCombo.baseline
text: qsTr("Flight Mode %1:)").arg(index) text: qsTr("Flight Mode %1").arg(index)
color: controller.activeFlightMode == index ? "yellow" : qgcPal.text color: controller.activeFlightMode == index ? "yellow" : qgcPal.text
} }
......
...@@ -55,6 +55,8 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw ...@@ -55,6 +55,8 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw
int flightModeChannel = getParameterFact(-1, "RC_MAP_FLTMODE")->rawValue().toInt() - 1; int flightModeChannel = getParameterFact(-1, "RC_MAP_FLTMODE")->rawValue().toInt() - 1;
int flightModeReversed = getParameterFact(1, QString("RC%1_REV").arg(flightModeChannel + 1))->rawValue().toInt();
if (flightModeChannel < 0 || flightModeChannel > channelCount) { if (flightModeChannel < 0 || flightModeChannel > channelCount) {
return; return;
} }
...@@ -63,7 +65,7 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw ...@@ -63,7 +65,7 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw
int channelValue = pwmValues[flightModeChannel]; int channelValue = pwmValues[flightModeChannel];
if (channelValue != -1) { if (channelValue != -1) {
bool found = false; bool found = false;
int rgThreshold[] = { 1230, 1360, 1490, 1620, 1749 }; int rgThreshold[] = { 1200, 1360, 1490, 1620, 1900 };
for (int i=0; i<5; i++) { for (int i=0; i<5; i++) {
if (channelValue <= rgThreshold[i]) { if (channelValue <= rgThreshold[i]) {
_activeFlightMode = i + 1; _activeFlightMode = i + 1;
...@@ -71,9 +73,15 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw ...@@ -71,9 +73,15 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw
break; break;
} }
} }
if (!found) { if (!found) {
_activeFlightMode = 6; _activeFlightMode = 6;
} }
if (flightModeReversed == -1) {
_activeFlightMode = 6 - (_activeFlightMode - 1);
}
} }
emit activeFlightModeChanged(_activeFlightMode); emit activeFlightModeChanged(_activeFlightMode);
} }
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