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.
hard reset all controllers when crash signal received
hard reset when imu reports crash
fix timer does not callback
Merge pull request #48 from mlosch/master

Hard reset controllers when imu sends signal