A Robust and Efficient 3D LADAR Odometer with Outlier Detection

摘要

This paper discusses the estimation algorithms for Three-Dimensional (3D) displacement and 3D rotation using Two-Dimensional (2D) laser scanners. An efficient outlier detection method is proposed for both algorithms to help protect the integrity of navigation. The algorithms have been evaluated using both simulation and field test results. They are able to produce a robust odometry solution for an autonomous aircraft in an indoor environment.