mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 09:30:25 +08:00
RegistrationIcp: libpointmatcher setting PointToPLane force2D parameter
This commit is contained in:
@@ -331,9 +331,15 @@ void RegistrationIcp::parseParameters(const ParametersMap & parameters)
|
|||||||
params["maxAngle"] = uNumber2Str(_maxRotation<=0.0f?M_PI:_maxRotation);
|
params["maxAngle"] = uNumber2Str(_maxRotation<=0.0f?M_PI:_maxRotation);
|
||||||
icp->outlierFilters.push_back(PM::get().OutlierFilterRegistrar.create("SurfaceNormalOutlierFilter", params));
|
icp->outlierFilters.push_back(PM::get().OutlierFilterRegistrar.create("SurfaceNormalOutlierFilter", params));
|
||||||
params.clear();
|
params.clear();
|
||||||
}
|
|
||||||
|
|
||||||
icp->errorMinimizer.reset(PM::get().ErrorMinimizerRegistrar.create(_pointToPlane?"PointToPlaneErrorMinimizer":"PointToPointErrorMinimizer"));
|
params["force2D"] = force3DoF()?"1":"0";
|
||||||
|
icp->errorMinimizer.reset(PM::get().ErrorMinimizerRegistrar.create("PointToPlaneErrorMinimizer", params));
|
||||||
|
params.clear();
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
icp->errorMinimizer.reset(PM::get().ErrorMinimizerRegistrar.create("PointToPointErrorMinimizer"));
|
||||||
|
}
|
||||||
|
|
||||||
icp->transformationCheckers.clear();
|
icp->transformationCheckers.clear();
|
||||||
params["maxIterationCount"] = uNumber2Str(_maxIterations);
|
params["maxIterationCount"] = uNumber2Str(_maxIterations);
|
||||||
|
|||||||
Reference in New Issue
Block a user