diff --git a/rtabmap_conversions/src/MsgConversion.cpp b/rtabmap_conversions/src/MsgConversion.cpp index b41c7ae5..aacdcc4f 100644 --- a/rtabmap_conversions/src/MsgConversion.cpp +++ b/rtabmap_conversions/src/MsgConversion.cpp @@ -1598,6 +1598,11 @@ std::map odomInfoToStatistics(const rtabmap::OdometryInfo & stats.insert(std::make_pair("Odometry/LocalBundleOutliers/", info.localBundleOutliers)); stats.insert(std::make_pair("Odometry/LocalBundleConstraints/", info.localBundleConstraints)); stats.insert(std::make_pair("Odometry/LocalBundleTime/ms", info.localBundleTime*1000.0f)); + stats.insert(std::make_pair("Odometry/localBundleAvgInlierDistance/pix", info.localBundleAvgInlierDistance)); + stats.insert(std::make_pair("Odometry/localBundleMaxKeyFramesForInlier/", info.localBundleMaxKeyFramesForInlier)); + + float32 localBundleAvgInlierDistance +int32 localBundleMaxKeyFramesForInlier stats.insert(std::make_pair("Odometry/KeyFrameAdded/", info.keyFrameAdded?1.0f:0.0f)); stats.insert(std::make_pair("Odometry/Interval/ms", (float)info.interval)); stats.insert(std::make_pair("Odometry/Distance/m", info.distanceTravelled)); @@ -1674,6 +1679,8 @@ rtabmap::OdometryInfo odomInfoFromROS(const rtabmap_msgs::OdomInfo & msg, bool i info.localBundleOutliers = msg.localBundleOutliers; info.localBundleConstraints = msg.localBundleConstraints; info.localBundleTime = msg.localBundleTime; + info.localBundleAvgInlierDistance = msg.localBundleAvgInlierDistance; + info.localBundleMaxKeyFramesForInlier = msg.localBundleMaxKeyFramesForInlier; UASSERT(msg.localBundleModels.size() == msg.localBundleIds.size()); UASSERT(msg.localBundleModels.size() == msg.localBundlePoses.size()); for(size_t i=0; i >::const_iterator iter=info.localBundleModels.begin(); iter!=info.localBundleModels.end(); diff --git a/rtabmap_msgs/msg/OdomInfo.msg b/rtabmap_msgs/msg/OdomInfo.msg index 473b4314..094cf3e1 100644 --- a/rtabmap_msgs/msg/OdomInfo.msg +++ b/rtabmap_msgs/msg/OdomInfo.msg @@ -18,6 +18,8 @@ int32 localKeyFrames int32 localBundleOutliers int32 localBundleConstraints float32 localBundleTime +float32 localBundleAvgInlierDistance +int32 localBundleMaxKeyFramesForInlier bool keyFrameAdded float32 timeEstimation float32 timeParticleFiltering