From 43d360ebb3e7b67c57c05a8c3f55f292f3d00f52 Mon Sep 17 00:00:00 2001 From: matlabbe Date: Mon, 26 May 2025 16:00:16 -0700 Subject: [PATCH] Fixed build with latest rtabmap version --- rtabmap_conversions/src/MsgConversion.cpp | 5 ++--- 1 file changed, 2 insertions(+), 3 deletions(-) diff --git a/rtabmap_conversions/src/MsgConversion.cpp b/rtabmap_conversions/src/MsgConversion.cpp index be80ce78..3c97a2c4 100644 --- a/rtabmap_conversions/src/MsgConversion.cpp +++ b/rtabmap_conversions/src/MsgConversion.cpp @@ -1652,9 +1652,8 @@ std::map odomInfoToStatistics(const rtabmap::OdometryInfo & { if(!info.transform.isNull()) { - rtabmap::Transform diff = info.transformGroundTruth.inverse()*info.transform; - stats.insert(std::make_pair("Odometry/TG_error_lin/m", diff.getNorm())); - stats.insert(std::make_pair("Odometry/TG_error_ang/deg", diff.getAngle()*180.0/CV_PI)); + stats.insert(std::make_pair("Odometry/TG_error_lin/m", info.transformGroundTruth.getDistance(info.transform))); + stats.insert(std::make_pair("Odometry/TG_error_ang/deg", info.transformGroundTruth.getAngle(info.transform)*180.0/CV_PI)); } info.transformGroundTruth.getTranslationAndEulerAngles(x,y,z,roll,pitch,yaw);