From 4f3775d647841096114d874b20c8d5b3febfe483 Mon Sep 17 00:00:00 2001
From: Miguel Prada <miguel.prada.sarasola@gmail.com>
Date: Tue, 26 Feb 2019 09:46:03 +0100
Subject: [PATCH] Publish "native" tool position/velocity even in ros_control
 mode. (#262)

---
 src/ros/rt_publisher.cpp | 5 ++---
 1 file changed, 2 insertions(+), 3 deletions(-)

diff --git a/src/ros/rt_publisher.cpp b/src/ros/rt_publisher.cpp
index 0709f50..eb8d216 100644
--- a/src/ros/rt_publisher.cpp
+++ b/src/ros/rt_publisher.cpp
@@ -94,11 +94,10 @@ bool RTPublisher::publish(RTShared& packet)
   bool res = true;
   if (!temp_only_)
   {
-    res = publishJoints(packet, time) && publishWrench(packet, time) && publishTool(packet, time) &&
-          publishTransform(packet, time);
+    res = publishJoints(packet, time) && publishWrench(packet, time);
   }
 
-  return res && publishTemperature(packet, time);
+  return res && publishTool(packet, time) && publishTransform(packet, time) && publishTemperature(packet, time);
 }
 
 bool RTPublisher::consume(RTState_V1_6__7& state)