Actually use return value, report vocab code

roboticslab-uc3m · Mar 29, 2019 · c836b94 · c836b94
1 parent 7f85494
commit c836b94
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/libraries/YarpPlugins/BasicCartesianControl/BasicCartesianControl.cpp b/libraries/YarpPlugins/BasicCartesianControl/BasicCartesianControl.cpp
@@ -4,6 +4,8 @@
 
 #include <cmath>
 
+#include <yarp/os/Vocab.h>
+
 #include <ColorDebug.h>
 
 // -----------------------------------------------------------------------------
@@ -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;
 }
 
 // -----------------------------------------------------------------------------