Halt works again

Reopening #44

https://github.com/ipa320/ros_canopen/pull/44 was merged to early --> resetted #44 and reopened PR