Integrator: fix comparison

Signed-off-by: Nicolae Rosia <nicolae.rosia@gmail.com>
This commit is contained in:
Nicolae Rosia
2017-06-28 22:14:37 +03:00
committed by Lorenz Meier
parent 9bb3ab4a71
commit 2092770361

View File

@@ -105,7 +105,7 @@ Integrator::put(uint64_t timestamp, math::Vector<3> &val, math::Vector<3> &integ
_last_integration_time = timestamp; _last_integration_time = timestamp;
// Only do auto reset if auto reset interval is not 0. // 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 // apply coning corrections if required
if (_coning_comp_on) { if (_coning_comp_on) {