diff --git a/canopen_master/src/emcy.cpp b/canopen_master/src/emcy.cpp index 78bfbf5da..7e509fcef 100644 --- a/canopen_master/src/emcy.cpp +++ b/canopen_master/src/emcy.cpp @@ -42,7 +42,11 @@ struct EMCYmsg{ void EMCYHandler::handleEMCY(const can::Frame & msg){ EMCYmsg::Frame em(msg); - ROSCANOPEN_ERROR("canopen_master", "EMCY received: " << msg); + if (em.data.error_code == 0) { + ROSCANOPEN_INFO("canopen_master", "EMCY reset: " << msg); + } else { + ROSCANOPEN_ERROR("canopen_master", "EMCY received: " << msg); + } has_error_ = (em.data.error_register & ~32) != 0; }