Adaptive Covariance Estimation Method for LiDAR-Aided Multi-Sensor Integrated Navigation Systems
Open Access
- 28 January 2015
- journal article
- research article
- Published by MDPI AG in Micromachines
- Vol. 6 (2) , 196-215
Abstract
The accurate estimation of measurements covariance is a fundamental problem in sensors fusion algorithms and is crucial for the proper operation of filtering algorithms. This paper provides an innovative solution for this problem and realizes the proposed solution on a 2D indoor navigation system for unmanned ground vehicles (UGVs) that fuses measurements from a MEMS-grade gyroscope, speed measurements and a light detection and ranging (LiDAR) sensor. A computationally efficient weighted line extraction method is introduced, where the LiDAR intensity measurements are used, such that the random range errors and systematic errors due to surface reflectivity in LiDAR measurements are considered. The vehicle pose change is obtained from LiDAR line feature matching, and the corresponding pose change covariance is also estimated by a weighted least squares-based technique. The estimated LiDAR-based pose changes are applied as periodic updates to the Inertial Navigation System (INS) in an innovative extended Kalman filter (EKF) design. Besides, the influences of the environment geometry layout and line estimation error are discussed. Real experiments in indoor environment are performed to evaluate the proposed algorithm. The results showed the great consistency between the LiDAR-estimated pose change covariance and the true accuracy. Therefore, this leads to a significant improvement in the vehicle’s integrated navigation accuracy.Keywords
This publication has 25 references indexed in Scilit:
- A novel Hough transform method for line detection by enhancing accumulator arrayPattern Recognition Letters, 2011
- Lidar Scan-Matching for Mobile Robot LocalizationInformation Technology Journal, 2009
- Fast laser scan matching approach based on adaptive curvature estimation for mobile robotsRobotica, 2009
- On the use of likelihood fields to perform sonar scan matching localizationAutonomous Robots, 2009
- Natural landmark extraction for mobile robot navigation based on an adaptive curvature estimationRobotics and Autonomous Systems, 2008
- Real-time line detection through an improved Hough transform voting schemePattern Recognition, 2008
- Tight Coupling of Laser Scanner and Inertial Measurements for a Fully Autonomous Relative Navigation SolutionNAVIGATION: Journal of the Institute of Navigation, 2007
- Mobile robot motion estimation by 2D scan matching with genetic and iterative closest point algorithmsJournal of Field Robotics, 2006
- High-speed laser localization for mobile robotsRobotics and Autonomous Systems, 2005
- Line Extraction in 2D Range Images for Mobile RoboticsJournal of Intelligent & Robotic Systems, 2004