i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-10-03 16:47:47 +08:00
Code Issues Packages Projects Releases Wiki Activity

Statistics: added x,y,z map corrections. Report: added options --stats to show available statistics to plot in a database

Browse Source
This commit is contained in:
matlabbe
2020-04-30 15:48:47 -04:00
parent 803c99cee2
commit 40804d9120
3 changed files with 43 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
corelib/src/Rtabmap.cpp
+5 -2
View File
@@ -3115,8 +3115,11 @@ bool Rtabmap::process(
// Map correction (/map -> /odom)
statistics_.addStatistic(Statistics::kLoopMap_correction_norm(), _mapCorrection.getNorm());
float roll,pitch,yaw;
_mapCorrection.getEulerAngles(roll, pitch, yaw);
float x,y,z,roll,pitch,yaw;
_mapCorrection.getTranslationAndEulerAngles(x, y, z, roll, pitch, yaw);
statistics_.addStatistic(Statistics::kLoopMap_correction_x(), x);
statistics_.addStatistic(Statistics::kLoopMap_correction_y(), y);
statistics_.addStatistic(Statistics::kLoopMap_correction_z(), z);
statistics_.addStatistic(Statistics::kLoopMap_correction_roll(), roll*180/M_PI);
statistics_.addStatistic(Statistics::kLoopMap_correction_pitch(), pitch*180/M_PI);
statistics_.addStatistic(Statistics::kLoopMap_correction_yaw(), yaw*180/M_PI);