BUGFIX: NULL pointer access -> issue #45 solved
BUGFIX: now it works after emergency stop