doesn't update odometry when dt < 0.0001 (note that befor the *_wheel_old_pos_ was changed every iteration)
Integrate odometry position even with very small intervals