EUVIMEDEUVIMED entdecken
Open Access · CC BY 4.0

IFA-ICP: A Low-Complexity and Image Feature-Assisted Iterative Closest Point (ICP) Scheme for Odometry Estimation in SLAM, and Its FPGA-Based Hardware Accelerator Design

Jia-En Li, Yin-Tsung Hwang iD

Sensors · 09.04.2026 · 26 (8) · 2326

DOI: 10.3390/s26082326 ↗

Kurz gefasst

Fachartikel in der Zeitschrift Sensors, online erschienen am 09.04.2026. Verfasst von Jia-En Li und 1 weiteren Autor:innen. Beteiligte Einrichtung: Graduate Program in Semiconductor and Green Technology, Academy of Circular Economy, National Chung Hsing University, Nantou 540216, Taiwan. Die Arbeit nennt 38 Literaturangaben. Der Volltext ist frei zugänglich (Open Access, CC BY 4.0). Gefördert von: National Science and Technology Council, Taiwan.

AbstractSchlagwörterBibliografische AngabenZitierenVerwandte Studien

Abstract (Originalsprache)

Odometry estimation, which calculates the trajectory of a moving object across timeframes, is a critical and time-consuming function in SLAM (Simultaneous Localization and Mapping) systems. Although LiDAR-based sensing is most popular for outdoor and long-range applications because of its ranging accuracy, the sparsity of laser point cloud poses a significant challenge to feature extraction and matching in odometry estimation. In this paper, we investigate odometry estimation from two aspects, i.e., algorithm optimization, and system design/implementation. In algorithm optimization, we present an image feature-assisted odometry estimation scheme that leverages the richness of image information captured by a companion camera to enhance the accuracy of laser point cloud matching. This also serves as a screening mechanism to reduce the matching size and lower the computing complexity for a higher estimation rate. In addition, various schemes, such as adaptive threshold in image feature point selection, principal component analysis (PCA)-based plane fitting for laser point interpolation, and Gauss–Newton optimization for calculating the transform matrix, are also employed to improve the accuracy of odometry estimation. The performance of improved odometry estimation is verified using an existing FLOAM (Fast Lidar Odometry and Mapping) framework. The KITTI dataset for autonomous vehicles with ground truth was used as the test bench. Simulation results indicate that the translation error and rotation error can be reduced by 16.6% and 1.3%, respectively. Computing complexity, measured as the software execution time, also reduced by 63%. In system implementation, a hardware/software (HW/SW) co-design strategy was adopted, where complexity profiling was first conducted to determine the task partitioning and time-consuming tasks are offloaded to a hardware accelerator. This facilitates real-time execution on a resource-constrained embedded platform consisting of a microprocessor module (Raspberry Pi) and an attached FPGA board (Pynq Z2). Efficient hardware designs for customized DSP functions (adaptive threshold and PCA) were developed in an FPGA capable of completing one data frame in 20ms. The final system implementation met the target throughput of 10 estimations per second, and can be scaled up further.

Schlagwörter

Stichwörter der Autor:innen

FPGAIterative Closest Point algorithmhardware accelerationimage featuresodometry estimationsimultaneous localization and mapping

Autor:innen und Institutionen

  • Graduate Program in Semiconductor and Green Technology, Academy of Circular Economy, National Chung Hsing University, Nantou 540216, Taiwan.
  • Department of Electrical Engineering, National Chung Hsing University, Taichung 402202, Taiwan.

ORCID-Profile: Yin-Tsung Hwang

Förderung

  • National Science and Technology Council, Taiwan

Zitieren

APA

Li, J. E., & Hwang, Y. T. (2026). IFA-ICP: A Low-Complexity and Image Feature-Assisted Iterative Closest Point (ICP) Scheme for Odometry Estimation in SLAM, and Its FPGA-Based Hardware Accelerator Design. Sensors, 26(8), 2326. https://doi.org/10.3390/s26082326

Vancouver

Li JE, Hwang YT. IFA-ICP: A Low-Complexity and Image Feature-Assisted Iterative Closest Point (ICP) Scheme for Odometry Estimation in SLAM, and Its FPGA-Based Hardware Accelerator Design. Sensors. 2026;26(8):2326. doi:10.3390/s26082326

BibTeX
@article{Li2026,
  author = {Li, Jia-En and Hwang, Yin-Tsung},
  title = {IFA-ICP: A Low-Complexity and Image Feature-Assisted Iterative Closest Point (ICP) Scheme for Odometry Estimation in SLAM, and Its FPGA-Based Hardware Accelerator Design},
  journal = {Sensors},
  year = {2026},
  volume = {26},
  number = {8},
  pages = {2326},
  doi = {10.3390/s26082326}
}
Kostenlos starten →