AP_InertialSensor: Add config error for helis trying to use throttle notch

This commit is contained in:
MattKear 2024-12-05 04:47:20 +00:00 committed by Andrew Tridgell
parent ca0d50df73
commit 4f39a842b2

View File

@ -1006,6 +1006,16 @@ AP_InertialSensor::init(uint16_t loop_rate)
#endif
#if AP_INERTIALSENSOR_HARMONICNOTCH_ENABLED
#if APM_BUILD_TYPE(APM_BUILD_Heli)
// Throttle tracking does not make sense with heli because "throttle" is actually collective position in AP_MotorsHeli
for (auto &notch : harmonic_notches) {
if (notch.params.enabled() && notch.params.tracking_mode() == HarmonicNotchDynamicMode::UpdateThrottle) {
AP_BoardConfig::config_error("Throttle notch unavailable with heli");
}
}
#endif
// the center frequency of the harmonic notch is always taken from the calculated value so that it can be updated
// dynamically, the calculated value is always some multiple of the configured center frequency, so start with the
// configured value