|
Algorithm 1. Deformation-preserving classifier-guided ICP |
Input: reference cloud ; current cloud ; initial transform ; trained classifier ; maximum iterations . Output: rigid transform ; class scores; signed-residual and deformation-score maps.
Remove invalid points and apply identical optional filtering/downsampling.
Estimate normals, neighbourhood covariance eigenvalues, and local densities.
Obtain a transparent coarse alignment or apply the controlled initial pose.
For :
Transform by .
Construct candidate correspondences using a physical distance threshold.
Compute interpretable feature vectors .
Predict , , and .
Compute stable reliability and robust IRLS weights.
Assemble and solve the weighted point-to-plane normal equations.
Update the pose on and evaluate conditioning.
Stop when pose and objective convergence criteria are satisfied.
Apply spatial filtering only to the deformation map, not to the pose estimate.
Return and monitoring outputs.
|