Skip to main content
. 2026 Oct 15;12(10):515. doi: 10.3390/jimaging12100515
Algorithm 1. Deformation-preserving classifier-guided ICP
Input: reference cloud P; current cloud Q; initial transform T0; trained classifier gθ; maximum iterations K.
 Output: rigid transform T^; class scores; signed-residual and deformation-score maps.
  1. Remove invalid points and apply identical optional filtering/downsampling.

  2. Estimate normals, neighbourhood covariance eigenvalues, and local densities.

  3. Obtain a transparent coarse alignment or apply the controlled initial pose.

  4. For k=0,…,K−1:
    1. Transform P by Tk.
    2. Construct candidate correspondences using a physical distance threshold.
    3. Compute interpretable feature vectors fij.
    4. Predict πijS, πijD, and πijO.
  5. Compute stable reliability and robust IRLS weights.

  6. Assemble and solve the weighted point-to-plane normal equations.

  7. Update the pose on SE3 and evaluate conditioning.

  8. Stop when pose and objective convergence criteria are satisfied.
    • 5.
      Recompute final correspondences and class scores.
    • 6.
      Calculate signed normal residuals and deformation scores.
  9. Apply spatial filtering only to the deformation map, not to the pose estimate.

  10. Return T^ and monitoring outputs.