Use SnapIt to snap the input for footstep planner to the planes