Use snapit to snap the goal of footstep to the planes
Merge pull request #144 from garaemon/use-snapit

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