From 3ad901e51d78996fe07af97d031b880009fae678 Mon Sep 17 00:00:00 2001 From: Silvan Fuhrer Date: Tue, 12 Oct 2021 11:38:40 +0200 Subject: [PATCH] Wind Estimator: use time_literals Signed-off-by: Silvan Fuhrer --- src/lib/wind_estimator/WindEstimator.cpp | 8 ++++---- src/lib/wind_estimator/WindEstimator.hpp | 2 ++ 2 files changed, 6 insertions(+), 4 deletions(-) diff --git a/src/lib/wind_estimator/WindEstimator.cpp b/src/lib/wind_estimator/WindEstimator.cpp index 2b6b828059..28851c31d6 100644 --- a/src/lib/wind_estimator/WindEstimator.cpp +++ b/src/lib/wind_estimator/WindEstimator.cpp @@ -104,7 +104,7 @@ WindEstimator::update(uint64_t time_now) _wind_estimator_reset = false; // run covariance prediction at 1Hz - if (time_now - _time_last_update < 1000 * 1000 || _time_last_update == 0) { + if (time_now - _time_last_update < 1_s || _time_last_update == 0) { if (_time_last_update == 0) { _time_last_update = time_now; } @@ -149,7 +149,7 @@ WindEstimator::fuse_airspeed(uint64_t time_now, const float true_airspeed, const } // don't fuse faster than 10Hz - if (time_now - _time_last_airspeed_fuse < 100 * 1000) { + if (time_now - _time_last_airspeed_fuse < 100_ms) { return; } @@ -228,7 +228,7 @@ WindEstimator::fuse_beta(uint64_t time_now, const matrix::Vector3f &velI, const } // don't fuse faster than 10Hz - if (time_now - _time_last_beta_fuse < 100 * 1000) { + if (time_now - _time_last_beta_fuse < 100_ms) { return; } @@ -362,7 +362,7 @@ WindEstimator::check_if_meas_is_rejected(uint64_t time_now, float innov, float i time_meas_rejected = 0; } - reinit_filter = time_now - time_meas_rejected > 5 * 1000 * 1000 && time_meas_rejected != 0; + reinit_filter = time_now - time_meas_rejected > 5_s && time_meas_rejected != 0; return time_meas_rejected != 0; } diff --git a/src/lib/wind_estimator/WindEstimator.hpp b/src/lib/wind_estimator/WindEstimator.hpp index e81539adfe..18ca105830 100644 --- a/src/lib/wind_estimator/WindEstimator.hpp +++ b/src/lib/wind_estimator/WindEstimator.hpp @@ -41,6 +41,8 @@ #include #include +using namespace time_literals; + class WindEstimator { public: