Add service to (re)plan between feet as start and goal.
Changelog
"0.3.0"
Merge pull request #3 from ahornung/devel

Merge devel branch on master (v0.3.0 release)