Fast correspondence search is implemented in the PL-ICP algorithm.
We make use of the assumption that the scans are done radially increasing (like how a really LiDAR is scanning).
- Local Search with Early Termination
- Search can be limited to neighbouring area
- Jump table for scan points