working odometry correction before we tried to make code nicer