fixes latch_xy_goal_tolerance param not taken