fixes ipa320/ipa_canopen#45

@abubeck, @ipa-fmw

https://github.com/ipa320/ipa_canopen/issues/45