From 3f045a4905ac8af73301097b0d5d23fc3cb824f4 Mon Sep 17 00:00:00 2001 From: Pierre Kancir Date: Fri, 31 Mar 2017 12:27:22 +0200 Subject: [PATCH] AP_HAL_SITL: airspeed_simulated use is_zero --- libraries/AP_HAL_SITL/sitl_ins.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/libraries/AP_HAL_SITL/sitl_ins.cpp b/libraries/AP_HAL_SITL/sitl_ins.cpp index f5baf7c52a..2d6fdabb81 100644 --- a/libraries/AP_HAL_SITL/sitl_ins.cpp +++ b/libraries/AP_HAL_SITL/sitl_ins.cpp @@ -88,7 +88,7 @@ void SITL_State::_update_ins(float airspeed) return; } - float airspeed_simulated = (fabsf(_sitl->arspd_fail) > 1.0e-6f) ? _sitl->arspd_fail : airspeed; + const float airspeed_simulated = is_zero(_sitl->arspd_fail) ? airspeed : _sitl->arspd_fail; airspeed_pin_value = _airspeed_sensor(airspeed_simulated + (_sitl->arspd_noise * rand_float())); }