diff --git a/src/modules/flight_mode_manager/tasks/Auto/FlightTaskAuto.cpp b/src/modules/flight_mode_manager/tasks/Auto/FlightTaskAuto.cpp index f31bf55ea8..09f8acf2fc 100644 --- a/src/modules/flight_mode_manager/tasks/Auto/FlightTaskAuto.cpp +++ b/src/modules/flight_mode_manager/tasks/Auto/FlightTaskAuto.cpp @@ -342,12 +342,11 @@ bool FlightTaskAuto::_evaluateTriplets() const float cruise_speed_from_triplet = _sub_triplet_setpoint.get().current.cruising_speed; if (PX4_ISFINITE(cruise_speed_from_triplet) - && (cruise_speed_from_triplet > 0.f) && (_sub_triplet_setpoint.get().current.timestamp > _time_last_cruise_speed_override)) { _mc_cruise_speed = cruise_speed_from_triplet; } - if (!PX4_ISFINITE(_mc_cruise_speed) || (_mc_cruise_speed < 0.0f)) { + if (!PX4_ISFINITE(_mc_cruise_speed) || (_mc_cruise_speed < FLT_EPSILON)) { // If no speed is planned use the default cruise speed as limit _mc_cruise_speed = _param_mpc_xy_cruise.get(); }