Info msg: added landmarkId field for convenience

This commit is contained in:
matlabbe
2020-09-15 17:45:00 -04:00
parent cdc38640ec
commit 58dd3134be
2 changed files with 2 additions and 0 deletions
+1
View File
@@ -8,6 +8,7 @@ Header header
int32 refId
int32 loopClosureId
int32 proximityDetectionId
int32 landmarkId
geometry_msgs/Transform loopClosureTransform
+1
View File
@@ -445,6 +445,7 @@ void infoToROS(const rtabmap::Statistics & stats, rtabmap_ros::Info & info)
info.refId = stats.refImageId();
info.loopClosureId = stats.loopClosureId();
info.proximityDetectionId = stats.proximityDetectionId();
info.landmarkId = static_cast<int>(uValue(stats.data(), rtabmap::Statistics::kLoopLandmark_detected(), 0.0f));
rtabmap_ros::transformToGeometryMsg(stats.loopClosureTransform(), info.loopClosureTransform);