Performance of LiDAR-SLAM-based PNT with initial poses based on NDT scan matching algorithm
Open Access
- 12 January 2023
- journal article
- research article
- Published by Springer Nature in Satellite Navigation
- Vol. 4 (1) , 1-15
Abstract
To achieve higher automation level of vehicles defined by the Society of Automotive Engineers, safety is a key requirement affecting navigation accuracy. We apply Light Detection and Ranging (LiDAR) as a main auxiliary sensor and propose LiDAR-based Simultaneously Localization and Mapping (SLAM) approach for Positioning, Navigation, and Timing. Furthermore, point cloud registration is handled with 3D Normal Distribution Transform (NDT) method. The initial guess of the LiDAR pose for LiDAR-based SLAM comes from two sources: one is the differential Global Navigation Satellite System (GNSS) solution; the other is Inertial Navigation System (INS) and GNSS integrated solution, generated with Extended Kalman Filter and motion constraints added, including Zero Velocity Update and Non-Holonomic Constraint. The experiment compares two initial guesses for scan matching in terms navigation accuracy. To emphasize the importance of a multi-sensor scheme in contrast to the conventional navigation method using the stand-alone system, the tests are conducted in both open sky area and GNSS signal block area, the latter might cause Multipath and Non-Line-Of-Sight effects. To enhance the navigation accuracy, the Fault Detection and Exclusion (FDE) mechanism is applied to correct the navigation outcome. The results show that the application of NDT and FDE for INS/GNSS integrated system can not only reach where-in-lane level navigation accuracy (0.5 m), but also enable constructing the dynamic map.Keywords
Funding Information
- Ministry of Science and Technology, Taiwan (109-2121-M-006 -011 -MY3)
This publication has 25 references indexed in Scilit:
- Multi-sensor fusion approach with fault detection and exclusion based on the Kullback–Leibler Divergence: Application on collaborative multi-robot systemInformation Fusion, 2017
- Robust localization using 3D NDT scan matching with experimentally determined uncertainty and road marker matching2017
- Overview of frequency diverse array in radar and navigation applicationsIET Radar, Sonar & Navigation, 2016
- Robust Relative Navigation by Integration of ICP and Adaptive Kalman Filter Using Laser Scanner and IMUIEEE/ASME Transactions on Mechatronics, 2016
- INS/GPS/LiDAR Integrated Navigation System for Urban and Indoor Environments Using Hybrid Scan Matching AlgorithmSensors, 2015
- ORB-SLAM: A Versatile and Accurate Monocular SLAM SystemIEEE Transactions on Robotics, 2015
- Height Aiding, C/N0 Weighting and Consistency Checking for GNSS NLOS and Multipath Mitigation in Urban AreasJournal of Navigation, 2013
- An ANN–RTS smoother scheme for accurate INS/GPS integrated attitude determinationGPS Solutions, 2008
- Unscented Rauch--Tung--Striebel SmootherIEEE Transactions on Automatic Control, 2008
- Least-squares variance component estimationJournal of Geodesy, 2007