From 5523b1ee4f118cb07794e2394d029b09eb4e595e Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Sun, 28 Jun 2015 16:29:46 +0200 Subject: [PATCH] Re-enable INAV verbose options --- .../position_estimator_inav_main.c | 38 +++++++++---------- 1 file changed, 19 insertions(+), 19 deletions(-) diff --git a/src/modules/position_estimator_inav/position_estimator_inav_main.c b/src/modules/position_estimator_inav/position_estimator_inav_main.c index 6f60e4878d..327276c5c1 100644 --- a/src/modules/position_estimator_inav/position_estimator_inav_main.c +++ b/src/modules/position_estimator_inav/position_estimator_inav_main.c @@ -1071,25 +1071,25 @@ int position_estimator_inav_thread_main(int argc, char *argv[]) inertial_filter_correct(-y_est[1], dt, y_est, 1, params.w_xy_res_v); } - // if (inav_verbose_mode) { - // /* print updates rate */ - // if (t > updates_counter_start + updates_counter_len) { - // float updates_dt = (t - updates_counter_start) * 0.000001f; - // warnx( - // "updates rate: accelerometer = %.1f/s, baro = %.1f/s, gps = %.1f/s, attitude = %.1f/s, flow = %.1f/s", - // (double)(accel_updates / updates_dt), - // (double)(baro_updates / updates_dt), - // (double)(gps_updates / updates_dt), - // (double)(attitude_updates / updates_dt), - // (double)(flow_updates / updates_dt)); - // updates_counter_start = t; - // accel_updates = 0; - // baro_updates = 0; - // gps_updates = 0; - // attitude_updates = 0; - // flow_updates = 0; - // } - // } + if (inav_verbose_mode) { + /* print updates rate */ + if (t > updates_counter_start + updates_counter_len) { + float updates_dt = (t - updates_counter_start) * 0.000001f; + warnx( + "updates rate: accelerometer = %.1f/s, baro = %.1f/s, gps = %.1f/s, attitude = %.1f/s, flow = %.1f/s", + (double)(accel_updates / updates_dt), + (double)(baro_updates / updates_dt), + (double)(gps_updates / updates_dt), + (double)(attitude_updates / updates_dt), + (double)(flow_updates / updates_dt)); + updates_counter_start = t; + accel_updates = 0; + baro_updates = 0; + gps_updates = 0; + attitude_updates = 0; + flow_updates = 0; + } + } if (t > pub_last + PUB_INTERVAL) { pub_last = t;