i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 01:20:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

ICP: when max laser scan max pts is not set, use relative correspondence ratio (backward compatibility)

Browse Source
This commit is contained in:
matlabbe
2015-08-05 20:32:33 -04:00
parent a88e8dd013
commit 0350e475b2
1 changed files with 5 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
corelib/src/Memory.cpp
View File

@@ -2346,7 +2346,7 @@ Transform Memory::computeIcpTransform(
bool hasConverged = false;
Transform icpT;
int correspondences = 0;
float correspondencesRatio = -1.0f;
float correspondencesRatio = 0.0f;
double variance = 1;
if(_icpPointToPlane)
{
@@ -2561,8 +2561,9 @@ Transform Memory::computeIcpTransform(
}
else
{
UWARN("Maximum laser scans points not set for signature %d, correspondences ratio set to 0!",
UWARN("Maximum laser scans points not set for signature %d, correspondences ratio set relative instead of absolute!",
newS.id());
correspondencesRatio = float(correspondences)/float(newCloud->size()>oldCloud->size()?newCloud->size():oldCloud->size());
}
UDEBUG("%d->%d hasConverged=%s, variance=%f, correspondences=%d/%d (%f%%)",
@@ -2756,8 +2757,9 @@ Transform Memory::computeScanMatchingTransform(
}
else
{
UWARN("Maximum laser scans points not set for signature %d, correspondences ratio set to 0!",
UWARN("Maximum laser scans points not set for signature %d, correspondences ratio set relative instead of absolute!",
newS->id());
correspondencesRatio = float(correspondences)/float(newCloud->size());
}
UDEBUG("variance=%f, correspondences=%d/%d (%f%%) %f",