Correspondence Search

from F1TENTH

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).

1. Local Search with Early Termination
   • Search can be limited to neighbouring area
2. Jump table for scan points