diff --git a/src/drivers/device/integrator.cpp b/src/drivers/device/integrator.cpp index dc5a880a1b..cc01bc92c8 100644 --- a/src/drivers/device/integrator.cpp +++ b/src/drivers/device/integrator.cpp @@ -105,7 +105,7 @@ Integrator::put(uint64_t timestamp, math::Vector<3> &val, math::Vector<3> &integ _last_integration_time = timestamp; // Only do auto reset if auto reset interval is not 0. - if (_auto_reset_interval > 0 && (timestamp - _last_reset_time) > _auto_reset_interval) { + if (_auto_reset_interval > 0 && (timestamp - _last_reset_time) >= _auto_reset_interval) { // apply coning corrections if required if (_coning_comp_on) {