AP_Soaring: Make the trigger VSPEED take account of thermalling sink.

This commit is contained in:
Samuel Tabor 2019-06-22 21:08:44 +01:00 committed by Andrew Tridgell
parent 650b464831
commit 8072f6b858
1 changed files with 1 additions and 1 deletions

View File

@ -181,7 +181,7 @@ bool SoaringController::check_thermal_criteria()
{ {
return (soar_active return (soar_active
&& ((AP_HAL::micros64() - _cruise_start_time_us) > ((unsigned)min_cruise_s * 1e6)) && ((AP_HAL::micros64() - _cruise_start_time_us) > ((unsigned)min_cruise_s * 1e6))
&& _vario.filtered_reading > thermal_vspeed && (_vario.filtered_reading - _vario.get_exp_thermalling_sink()) > thermal_vspeed
&& _vario.alt < alt_max && _vario.alt < alt_max
&& _vario.alt > alt_min); && _vario.alt > alt_min);
} }