fixes latch_xy_goal_tolerance param not taken
Merge pull request #193 from efernandez/add_latch_xy_goal_tolerance_param

fixes latch_xy_goal_tolerance param not taken