Skip to main content

Module icp_matching

Module icp_matching 

Source
Expand description

Iterative Closest Point (ICP) SLAM implementation

This module implements the ICP algorithm for point cloud registration. It finds the optimal transformation (rotation and translation) between two point sets by iteratively minimizing the distance between corresponding points.

Ported from PythonRobotics Original authors: Atsushi Sakai (@Atsushi_twi), Göktuğ Karakaşlı, Shamil Gemuev

Structs§

ICPResult
ICPTraceFrame
One accepted ICP alignment, including the initial alignment. The points, nearest-neighbor indices and error all describe this same state, before the next rigid fit. Rejected divergent updates are not included.

Functions§

apply_2d_transformation
Apply 2D transformation to points
generate_2d_points
Generate random 2D point cloud for testing
icp_matching
Main ICP matching function
icp_matching_with_trace
Run the same solver as icp_matching, recording its accepted states. Inputs have the same requirements: nonempty finite 2xN point matrices. Frame zero is the input cloud with identity transform; the last frame describes the returned result. The legacy iterations count also includes an attempted assessment that rejects a divergent fit.