Fix RosTfListener when there is no transform

jmirabel · jmirabel · commit 287ce30d54b6 · 2018-06-27T15:56:02.000+02:00
diff --git 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)

Original file line number	Diff line number	Diff line change
`@@ -43,6 +43,7 @@ namespace dynamicgraph {`
`43`	`43`	`} catch (const tf::TransformException& ex) {`
`44`	`44`	`res.setIdentity();`
`45`	`45`	`ROS_ERROR("Enable to get transform at time %i: %s",time,ex.what());`
	`46`	`+ return res;`
`46`	`47`	`}`
`47`	`48`	`for (sot::MatrixHomogeneous::Index r = 0; r < 3; ++r) {`
`48`	`49`	`for (sot::MatrixHomogeneous::Index c = 0; c < 3; ++c)`