diff --git a/libraries/YarpPlugins/BasicCartesianControl/BasicCartesianControl.cpp b/libraries/YarpPlugins/BasicCartesianControl/BasicCartesianControl.cpp index 6577419b5..ad8b53177 100644 --- a/libraries/YarpPlugins/BasicCartesianControl/BasicCartesianControl.cpp +++ b/libraries/YarpPlugins/BasicCartesianControl/BasicCartesianControl.cpp @@ -4,6 +4,8 @@ #include +#include + #include // ----------------------------------------------------------------------------- @@ -130,7 +132,7 @@ bool roboticslab::BasicCartesianControl::setControlModes(int mode) if (!iControlMode->setControlModes(jointIds.size(), jointIds.data(), modes.data())) { - CD_WARNING("setControlModes failed.\n"); + CD_WARNING("setControlModes failed (%s).\n", yarp::os::Vocab::decode(mode).c_str()); return false; } } @@ -162,7 +164,7 @@ bool roboticslab::BasicCartesianControl::presetStreamingCommand(int command) return false; } - return true; + return ret; } // -----------------------------------------------------------------------------