Fixed delays when initializing
Merge branch 'almost_merged' of github.com:thiagodefreitas/ipa_canopen into almost_merged

Conflicts:
	ipa_canopen_core/src/canopen.cpp
Merge pull request #5 from thiagodefreitas/almost_merged

Fixes the "long delay" issue for init