navigator: don't complain 'Using minimum takeoff altitude' in case of numerical inaccuracies

Happend in SITL.
This commit is contained in:
Beat Küng
2018-05-09 07:59:46 +02:00
parent 473fa15026
commit c6b0d5c76a
+5 -2
View File
@@ -96,9 +96,12 @@ Takeoff::set_takeoff_position()
// If the altitude suggestion is lower than home + minimum clearance, raise it and complain.
if (abs_altitude < min_abs_altitude) {
if (abs_altitude < min_abs_altitude - 0.1f) { // don't complain if difference is smaller than 10cm
mavlink_log_critical(_navigator->get_mavlink_log_pub(),
"Using minimum takeoff altitude: %.2f m", (double)_navigator->get_takeoff_min_alt());
}
abs_altitude = min_abs_altitude;
mavlink_log_critical(_navigator->get_mavlink_log_pub(),
"Using minimum takeoff altitude: %.2f m", (double)_navigator->get_takeoff_min_alt());
}
} else {