Browse Source

Commander: no battery time based RTL when already landed

v1.13.0-BW
Matthias Grob 3 years ago
parent
commit
db1fb6acf7
  1. 3
      src/modules/commander/Commander.cpp

3
src/modules/commander/Commander.cpp

@ -3857,9 +3857,10 @@ void Commander::battery_status_check() @@ -3857,9 +3857,10 @@ void Commander::battery_status_check()
// Compare estimate of RTL time to estimate of remaining flight time
if (_rtl_time_estimate_sub.copy(&rtl_time_estimate)
&& hrt_absolute_time() - rtl_time_estimate.timestamp < 2_s
&& (hrt_absolute_time() - rtl_time_estimate.timestamp) < 2_s
&& rtl_time_estimate.valid
&& _armed.armed
&& !_vehicle_land_detected.ground_contact // not in any landing stage
&& !_rtl_time_actions_done
&& PX4_ISFINITE(worst_battery_time_s)
&& rtl_time_estimate.safe_time_estimate >= worst_battery_time_s

Loading…
Cancel
Save