Harden code for missing params, handle APM special case

src/AutoPilotPlugins/Common/RadioComponentController.cc

@@ -121,6 +121,10 @@ RadioComponentController::RadioComponentController(void) :
     connect(_vehicle, &Vehicle::rcChannelsChanged, this, &RadioComponentController::_rcChannelsChanged);
     _loadSettings();
 
+    // APM Stack has a bug where some RC params are missing. We need to know what these are so we can skip them if missing
+    // instead of popping missing param warnings.
+    _apmPossibleMissingRCChannelParams << 9 << 11 << 12 << 13 << 14;
+    
     _resetInternalCalibrationValues();
 }
 
@@ -704,8 +708,10 @@ void RadioComponentController::_resetInternalCalibrationValues(void)
             QVariant value;
             enum rcCalFunctions curFunction = rgFlightModeFunctions[i];
 
+            Fact* paramFact = getParameterFact(FactSystem::defaultComponentId, _functionInfo()[curFunction].parameterName);
+            if (paramFact) {
                 bool ok;
-            int switchChannel = getParameterFact(FactSystem::defaultComponentId, _functionInfo()[curFunction].parameterName)->rawValue().toInt(&ok);
+                int switchChannel = paramFact->rawValue().toInt(&ok);
                 Q_ASSERT(ok);
 
                 // Parameter: 1-based channel, 0=not mapped
@@ -718,6 +724,7 @@ void RadioComponentController::_resetInternalCalibrationValues(void)
                 }
             }
         }
+    }
     
     _signalAllAttiudeValueChanges();
 }
@@ -748,27 +755,52 @@ void RadioComponentController::_setInternalCalibrationValuesFromParameters(void)
     for (int i = 0; i < _chanMax(); ++i) {
         struct ChannelInfo* info = &_rgChannelInfo[i];
 
-        info->rcTrim = getParameterFact(FactSystem::defaultComponentId, trimTpl.arg(i+1))->rawValue().toInt(&convertOk);
+        if (_px4Vehicle() && _apmPossibleMissingRCChannelParams.contains(i+1)) {
+            if (!parameterExists(FactSystem::defaultComponentId, minTpl.arg(i+1))) {
+                // Parameter is missing from this version of APM
+                info->rcTrim = 1500;
+                info->rcMin = 1100;
+                info->rcMax = 1900;
+                info->reversed = false;
+                continue;
+            }
+        }
+        
+        Fact* paramFact = getParameterFact(FactSystem::defaultComponentId, trimTpl.arg(i+1));
+        if (paramFact) {
+            info->rcTrim = paramFact->rawValue().toInt(&convertOk);
             Q_ASSERT(convertOk);
+        }
         
-        info->rcMin = getParameterFact(FactSystem::defaultComponentId, minTpl.arg(i+1))->rawValue().toInt(&convertOk);
+        paramFact = getParameterFact(FactSystem::defaultComponentId, minTpl.arg(i+1));
+        if (paramFact) {
+            info->rcMin = paramFact->rawValue().toInt(&convertOk);
             Q_ASSERT(convertOk);
+        }
 
+        paramFact = getParameterFact(FactSystem::defaultComponentId, maxTpl.arg(i+1));
+        if (paramFact) {
             info->rcMax = getParameterFact(FactSystem::defaultComponentId, maxTpl.arg(i+1))->rawValue().toInt(&convertOk);
             Q_ASSERT(convertOk);
+        }
 
-        float floatReversed = getParameterFact(FactSystem::defaultComponentId, revTpl.arg(i+1))->rawValue().toFloat(&convertOk);
+        paramFact = getParameterFact(FactSystem::defaultComponentId, revTpl.arg(i+1));
+        if (paramFact) {
+            float floatReversed = paramFact->rawValue().toFloat(&convertOk);
             Q_ASSERT(convertOk);
             Q_ASSERT(floatReversed == 1.0f || floatReversed == -1.0f);
             info->reversed = floatReversed == -1.0f;
         }
+    }
     
     for (int i=0; i<rcCalFunctionMax; i++) {
         int32_t paramChannel;
         
         const char* paramName = _functionInfo()[i].parameterName;
         if (paramName) {
-            paramChannel = getParameterFact(FactSystem::defaultComponentId, paramName)->rawValue().toInt(&convertOk);
+            Fact* paramFact = getParameterFact(FactSystem::defaultComponentId, paramName);
+            if (paramFact) {
+                paramChannel = paramFact->rawValue().toInt(&convertOk);
                 Q_ASSERT(convertOk);
 
                 if (paramChannel != 0) {
@@ -777,6 +809,7 @@ void RadioComponentController::_setInternalCalibrationValuesFromParameters(void)
                 }
             }
         }
+    }
     
     _signalAllAttiudeValueChanges();
 }
@@ -851,9 +884,23 @@ void RadioComponentController::_writeCalibration(void)
         struct ChannelInfo* info = &_rgChannelInfo[chan];
         int                 oneBasedChannel = chan + 1;
         
-        getParameterFact(FactSystem::defaultComponentId, trimTpl.arg(oneBasedChannel))->setRawValue((float)info->rcTrim);
-        getParameterFact(FactSystem::defaultComponentId, minTpl.arg(oneBasedChannel))->setRawValue((float)info->rcMin);
-        getParameterFact(FactSystem::defaultComponentId, maxTpl.arg(oneBasedChannel))->setRawValue((float)info->rcMax);
+        if (_px4Vehicle() && _apmPossibleMissingRCChannelParams.contains(chan+1) && !parameterExists(FactSystem::defaultComponentId, minTpl.arg(chan+1))) {
+            // RC parameters for this channel are missing from this version of APM
+            continue;
+        }
+
+        Fact* paramFact = getParameterFact(FactSystem::defaultComponentId, trimTpl.arg(oneBasedChannel));
+        if (paramFact) {
+            paramFact->setRawValue((float)info->rcTrim);
+        }
+        paramFact = getParameterFact(FactSystem::defaultComponentId, minTpl.arg(oneBasedChannel));
+        if (paramFact) {
+            paramFact->setRawValue((float)info->rcMin);
+        }
+        paramFact = getParameterFact(FactSystem::defaultComponentId, maxTpl.arg(oneBasedChannel));
+        if (paramFact) {
+            paramFact->setRawValue((float)info->rcMax);
+        }
 
         // APM has a backwards interpretation of "reversed" on the Pitch control. So be careful.
         float reversedParamValue;
@@ -862,7 +909,10 @@ void RadioComponentController::_writeCalibration(void)
         } else {
             reversedParamValue = info->reversed ? 1.0f : -1.0f;
         }
-        getParameterFact(FactSystem::defaultComponentId, revTpl.arg(oneBasedChannel))->setRawValue(reversedParamValue);
+        paramFact = getParameterFact(FactSystem::defaultComponentId, revTpl.arg(oneBasedChannel));
+        if (paramFact) {
+            paramFact->setRawValue(reversedParamValue);
+        }
     }
     
     // Write function mapping parameters
@@ -880,9 +930,12 @@ void RadioComponentController::_writeCalibration(void)
         if (paramName) {
             Fact* paramFact = getParameterFact(FactSystem::defaultComponentId, _functionInfo()[i].parameterName);
 
-            if (paramFact->rawValue().toInt() != paramChannel) {
+            if (paramFact && paramFact->rawValue().toInt() != paramChannel) {
                 functionMappingChanged = true;
-                getParameterFact(FactSystem::defaultComponentId, _functionInfo()[i].parameterName)->setRawValue(paramChannel);
+                paramFact = getParameterFact(FactSystem::defaultComponentId, _functionInfo()[i].parameterName);
+                if (paramFact) {
+                    paramFact->setRawValue(paramChannel);
+                }
             }
         }
     }

src/AutoPilotPlugins/Common/RadioComponentController.h

@@ -301,6 +301,8 @@ private:
     
     struct ChannelInfo _rgChannelInfo[_chanMaxAny];    ///< Information associated with each rc channel
 
+    QList<int> _apmPossibleMissingRCChannelParams;  ///< List of possible missing RC*_* params for APM stack
+    
     enum rcCalStates _rcCalState;       ///< Current calibration state
     int _rcCalStateCurrentChannel;      ///< Current channel being worked on in rcCalStateIdentify and rcCalStateDetectInversion
     bool _rcCalStateChannelComplete;    ///< Work associated with current channel is complete