snap the goal direction to the planes even with joy stick command
Merge pull request #117 from garaemon/snap-footstep-to-plane-for-joy-command

Snap footstep to plane for joy command