mirror of
https://github.com/introlab/rtabmap_ros.git
synced 2026-10-04 00:37:46 +08:00
icp: set epsilon^2 as in pcl::DefaultConvergenceCriteria
This commit is contained in:
@@ -326,7 +326,7 @@ Transform icp(const pcl::PointCloud<pcl::PointXYZ>::ConstPtr & cloud_source,
|
|||||||
// Set the maximum number of iterations (criterion 1)
|
// Set the maximum number of iterations (criterion 1)
|
||||||
icp.setMaximumIterations (maximumIterations);
|
icp.setMaximumIterations (maximumIterations);
|
||||||
// Set the transformation epsilon (criterion 2)
|
// Set the transformation epsilon (criterion 2)
|
||||||
icp.setTransformationEpsilon (epsilon);
|
icp.setTransformationEpsilon (epsilon*epsilon);
|
||||||
// Set the euclidean distance difference epsilon (criterion 3)
|
// Set the euclidean distance difference epsilon (criterion 3)
|
||||||
//icp.setEuclideanFitnessEpsilon (1);
|
//icp.setEuclideanFitnessEpsilon (1);
|
||||||
//icp.setRANSACOutlierRejectionThreshold(maxCorrespondenceDistance);
|
//icp.setRANSACOutlierRejectionThreshold(maxCorrespondenceDistance);
|
||||||
@@ -362,7 +362,7 @@ Transform icpPointToPlane(
|
|||||||
// Set the maximum number of iterations (criterion 1)
|
// Set the maximum number of iterations (criterion 1)
|
||||||
icp.setMaximumIterations (maximumIterations);
|
icp.setMaximumIterations (maximumIterations);
|
||||||
// Set the transformation epsilon (criterion 2)
|
// Set the transformation epsilon (criterion 2)
|
||||||
icp.setTransformationEpsilon (epsilon);
|
icp.setTransformationEpsilon (epsilon*epsilon);
|
||||||
// Set the euclidean distance difference epsilon (criterion 3)
|
// Set the euclidean distance difference epsilon (criterion 3)
|
||||||
//icp.setEuclideanFitnessEpsilon (1);
|
//icp.setEuclideanFitnessEpsilon (1);
|
||||||
//icp.setRANSACOutlierRejectionThreshold(maxCorrespondenceDistance);
|
//icp.setRANSACOutlierRejectionThreshold(maxCorrespondenceDistance);
|
||||||
|
|||||||
Reference in New Issue
Block a user