diff --git a/src/AutoPilotPlugins/PX4/PX4SimpleFlightModesController.cc b/src/AutoPilotPlugins/PX4/PX4SimpleFlightModesController.cc index 5ed00d31b73bd15346d7f27e289325b3b31c0193..8f0bebfd525663d0142678f6ed007b87593c8ba9 100644 --- a/src/AutoPilotPlugins/PX4/PX4SimpleFlightModesController.cc +++ b/src/AutoPilotPlugins/PX4/PX4SimpleFlightModesController.cc @@ -51,6 +51,12 @@ void PX4SimpleFlightModesController::_rcChannelsChanged(int channelCount, int pw } int flightModeChannel = pFact->rawValue().toInt() - 1; + if (flightModeChannel == -1) { + // Flight mode channel not set, can't track active flight mode + _activeFlightMode = 0; + emit activeFlightModeChanged(_activeFlightMode); + return; + } pFact = getParameterFact(-1, QString("RC%1_REV").arg(flightModeChannel + 1)); if(!pFact) {