From 287ce30d54b6d6c732b4da27917d1a6400745d01 Mon Sep 17 00:00:00 2001
From: Joseph Mirabel <jmirabel@laas.fr>
Date: Wed, 27 Jun 2018 15:56:02 +0200
Subject: [PATCH] Fix RosTfListener when there is no transform

---
 src/ros_tf_listener.hh | 1 +
 1 file changed, 1 insertion(+)

diff --git a/src/ros_tf_listener.hh b/src/ros_tf_listener.hh
index d09433e..3c07251 100644
--- a/src/ros_tf_listener.hh
+++ b/src/ros_tf_listener.hh
@@ -43,6 +43,7 @@ namespace dynamicgraph {
         } catch (const tf::TransformException& ex) {
           res.setIdentity();
           ROS_ERROR("Enable to get transform at time %i: %s",time,ex.what());
+          return res;
         }
         for (sot::MatrixHomogeneous::Index r = 0; r < 3; ++r) {
           for (sot::MatrixHomogeneous::Index c = 0; c < 3; ++c)
-- 
GitLab