From c836b944889889329687499c9839d0d3b1dbd471 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Bartek=20=C5=81ukawski?= <bwmn.peter@gmail.com>
Date: Fri, 29 Mar 2019 12:25:36 +0100
Subject: [PATCH] Actually use return value, report vocab code

---
 .../BasicCartesianControl/BasicCartesianControl.cpp         | 6 ++++--
 1 file changed, 4 insertions(+), 2 deletions(-)

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 <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;
 }
 
 // -----------------------------------------------------------------------------