diff --git a/libraries/AP_RPM/AP_RPM.cpp b/libraries/AP_RPM/AP_RPM.cpp index 47a741427e..48f0e68fc5 100644 --- a/libraries/AP_RPM/AP_RPM.cpp +++ b/libraries/AP_RPM/AP_RPM.cpp @@ -132,9 +132,11 @@ void AP_RPM::update(void) for (uint8_t i=0; iupdate(); } } @@ -145,7 +147,7 @@ void AP_RPM::update(void) */ bool AP_RPM::healthy(uint8_t instance) const { - if (instance >= num_instances) { + if (instance >= num_instances || _type[instance] == RPM_TYPE_NONE) { return false; }