Better airspeed feedback

This commit is contained in:
Lorenz Meier 2014-07-12 21:47:26 +02:00
parent 5a22ef1c28
commit 7bf0e6f3e2
1 changed files with 2 additions and 2 deletions

View File

@ -200,13 +200,13 @@ int do_airspeed_calibration(int mavlink_fd)
float curr_avg = (diff_pres_offset / calibration_counter);
if (calc_indicated_airspeed(fabsf(curr_avg)) < 10.0f) {
mavlink_log_critical(mavlink_fd, "Put a finger on front hole of pitot");
mavlink_log_critical(mavlink_fd, "Put a finger on front hole of pitot (%.1f m/s)", curr_avg);
usleep(5000 * 1000);
continue;
}
/* do not log negative values in the second go */
if (curr_avg < calc_indicated_airspeed(-5.0f)) {
if (curr_avg < -calc_indicated_airspeed(5.0f)) {
mavlink_log_critical(mavlink_fd, "Negative val: swap static<->dynamic ports,restart");
close(diff_pres_sub);