Odometry correction is working