extend goto controller to be able to use path following. Untested
merge
Merge pull request #45 from mlosch/master

Extend goto controller to be able to use path following.