Put more trust into odometry system