enterModeandWait
add waitMotorReady
Merge branch 'indigo_new_structure' of https://github.com/ipa-fmw/ros_canopen into indigo_dev
Removes Exception
Merge pull request #10 from thiagodefreitas/indigo_new_structure

Removes Exception
Merge branch 'indigo_new_structure' of https://github.com/ipa-fmw/ros_canopen into indigo_dev