some bugfixes
exclude forward controller update when goto is running. bugfixes in goto.
Merge pull request #49 from mlosch/master

Goto controller running