mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-03 16:27:46 +08:00
Info msg: added landmarkId field for convenience
This commit is contained in:
@@ -8,6 +8,7 @@ Header header
|
||||
int32 refId
|
||||
int32 loopClosureId
|
||||
int32 proximityDetectionId
|
||||
int32 landmarkId
|
||||
|
||||
geometry_msgs/Transform loopClosureTransform
|
||||
|
||||
|
||||
@@ -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);
|
||||
|
||||
|
||||
Reference in New Issue
Block a user