First functional and hardware tested version of the multiple_chains node, fixes ipa320/ipa_canopen#57
fixes ipa320/cob4#58
Changes on diagnostics
Some init chains
Seeing EMCY
Seeing EMCY
Small clean
Fixes the move_device and homing tools for the multiple chains version