Odometry fix