Update canopen_ros.cpp