基于激光雷达的SLAM和融合定位方法综述A Review of LiDAR Based SLAM and Multi-Sensor Fusion for Localization
代凯,申棋仁,吴官朴,赵阳,马芳武
摘要(Abstract):
基于激光雷达的同步定位和建图(SLAM)及融合定位技术是无人驾驶的关键技术。激光雷达可以从环境中获取精确的距离及强度信息,被广泛应用于高精度地图构建及基于地图的匹配定位,可有效增强基于卫星定位在弱GNSS区域的鲁棒性。基于当前无人驾驶背景下激光SLAM及融合定位方法的研究现状,对应用于无人驾驶车辆的激光SLAM和融合定位方法的架构原理、标志性成果和研究热点展开综述,并探讨其发展趋势。
关键词(KeyWords): 激光雷达;无人驾驶;同步定位和建图;多传感器融合
基金项目(Foundation):
作者(Author): 代凯,申棋仁,吴官朴,赵阳,马芳武
DOI: 10.19822/j.cnki.1671-6329.20200167
参考文献(References):
- [1]Kuutti S,Fallah S,Katsaros K,et al.A Survey of the Stateof-the-Art Localization Techniques and Their Potentials for Autonomous Vehicle Applications[J].IEEE Internet of Things Journal,2018:829-846.
- [2]Wan G,et al.Robust and precise vehicle localization based on multi-sensor fusion in diverse city scenes[C].IEEEInternational Conference on Robotics and Automation(ICRA).2018.
- [3]Ye H,Y Chen,M Liu.Tightly Coupled 3D Lidar Inertial Odometry and Mapping[J].ar Xiv preprint ar Xiv,2019:1904.06993.
- [4]段续庭,田大新,王云鹏.基于V2 X通信网络的车辆协同定位增强方法[J].汽车工程,2018,40(08):947-951,959.
- [5]曹立波,陈峥,颜凌波,等.基于RFID,视觉和UWB的车辆定位系统[J].汽车工程,2017(2):225-231.
- [6]Levinson J,Montemerlo M,Thrun S.Map-Based Precision Vehicle Localization in Urban Environments[C]//Robotics:Science and Systems III,June 27-30,2007,Georgia Institute of Technology,Atlanta,Georgia,USA.DBLP,2007.
- [7]Rozenberszki D,A Majdik.LOL:Lidar-Only Odometry and Localization in 3D Point Cloud Maps[J].Ar Xiv,2020:abs/2007.01595.
- [8]Zhang J,Singh S.LOAM:Lidar Odometry and Mapping in Real-time[C]//Robotics:Science and Systems Conference.2014.
- [9]DubéRenaud,Cramariuc A,Dugas D,et al.Seg Map:3DSegment Mapping using Data-Driven Descriptors[C]//Robotics:Science&Systems.2018.
- [10]Jingren Wen,Chuang,et al.2D Li DAR SLAM Back-End Optimization with Control Network Constraint for Mobile Mapping.[J].Sensors (Basel,Switzerland),2018.(11):3668.
- [11]Rusinkiewicz,S,M Levoy.Efficient variants of the ICPalgorithm[C]//Proceedings Third International Conference on 3-D Digital Imaging and Modeling,2001:145-152.
- [12]Segal A,Hhnel D,Thrun S.Generalized-ICP[C]//Robotics:Science and Systems V,University of Washington,Seattle,USA,2009.
- [13]Minguez J,Lamiraux F,Montesano L.Metric-Based Scan Matching Algorithms for Mobile Robot Displacement Estimation[C]//IEEE International Conference on Robotics&Automation.IEEE,2005.
- [14]Censi A.An ICP variant using a point-to-line metric[C]//IEEE International Conference on Robotics&Automation.IEEE,2008:19-25.
- [15]Moosmann F,Stiller C.Velodyne SLAM[C]//Intelligent Vehicles Symposium.IEEE,2011:393-398.
- [16]Kuramachi R,Ohsato A,Sasaki Y,et al.G-ICP SLAM:An odometry-free 3D mapping system with robust 6Do F pose estimation[C]//2015 IEEE International Conference on Robotics and Biomimetics (ROBIO).IEEE,2015:176-181.
- [17]Biber P.The normal distributions transform:a new approach to laser scan matching[J].Proc.of IEEE/RSJ Intl Conf.on Intelligent Robots&Systems,2003.
- [18]Magnusson M,Lilienthal A,Duckett T.Scan registration for autonomous mining vehicles using 3D-NDT[J].Journal of Field Robotics,2007,24(10):803-827.
- [19]Stoyanov T,Magnusson M,Andreasson H,et al.Fast and Accurate Scan Registration through Minimization of the Distance between Compact 3D NDT Representations[J].International Journal of Robotics Research,2012,31(12):1377-1393.
- [20]Magnusson M,Nuchter A,Lorken C,et al.Evaluation of3D registration reliability and speed-A comparison of ICP and NDT[C]//IEEE International Conference on Robotics&Automation.IEEE,2009:3907-3912.
- [21]Einhorn E,Gross H M.Generic NDT mapping in dynamic environments and its application for lifelong SLAM[J].Robotics&Autonomous Systems,2015(69):28-39.
- [22]Wen W,Hsu L T,Zhang G.Performance Analysis of NDT-based Graph SLAM for Autonomous Vehicle in Diverse Typical Driving Scenarios of Hong Kong[J].Sensors,2018,18(11):3928.
- [23]Wold S,K Esbensen,P Geladi.Principal component analysis[J].Chemometrics and intelligent laboratory systems,1987,2(1-3):37-52.
- [24]Dudani S A.The Distance-Weighted k-NearestNeighbor Rule[J].IEEE Trans Systems Man&Cybernetics,1976,6(4):325-327.
- [25]Geiger A,Lenz P,Urtasun R.Are we ready for autonomous driving?The KITTI vision benchmark suite[C]//IEEEConference on Computer Vision&Pattern Recognition.IEEE,2012.
- [26]Shan,T,B Englot.Le GO-LOAM:Lightweight and groundoptimized lidar odometry and mapping on variable terrain[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).2018.
- [27]Ye H,Y Chen,M Liu.Tightly Coupled 3D Lidar Inertial Odometry and Mapping.in international conference on robotics and automation[C]//International Conference on Robotics and Automation,2019:3144-3150.
- [28]Shan T,Englot B,Meyers D,et al.LIO-SAM:Tightlycoupled Lidar Inertial Odometry via Smoothing and Mapping[J].ar Xiv preprint ar Xiv,2020:2007.00258.
- [29]Huang G P,A I Mourikis,S I Roumeliotis.On the complexity and consistency of UKF-based SLAM.in 2009IEEE international conference on robotics and automation.2009.IEEE.
- [30]Grisetti G,Stachniss C,Burgard W.Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling[C]//Proceedings of the 2005 IEEE International Conference on Robotics and Automation,ICRA 2005,April 18-22,2005,Barcelona,Spain.IEEE,2005.
- [31]Kummerle R,Grisetti G,Strasdat H,et al.G2o:A general framework for graph optimization[C]//IEEE International Conference on Robotics&Automation.IEEE,2011.
- [32]Hess W,Kohler D,Rapp H,et al.Real-time loop closure in 2D LIDAR SLAM[C]//2016 IEEE International Conference on Robotics and Automation (ICRA).IEEE,2016.
- [33]Grisetti G,Ku Mmerle R,Stachniss C,et al.A Tutorial on Graph-Based SLAM[J].IEEE Intelligent Transportation Systems Magazine,2011,2(4):31-43.
- [34]熊万龙.基于Kalman滤波器的自主车辆定位方法研究[D].北京:国防科学技术大学,2005.
- [35]Jo K,Chu K,Lee K,et al.Integration of multiple vehicle models with an IMM filter for vehicle localization[C]//Intelligent Vehicles Symposium.IEEE,2010.
- [36]Wischnewski A,Stahl T,Betz J,et al.Vehicle Dynamics State Estimation and Localization for High Performance Race Cars[C]//IFAC IAV 2019.2019.52(8):154-161.
- [37]汪涛.智能行驶车辆定位技术研究[D].长春:吉林大学,2017.
- [38]余恭敏.车辆运动学/动力学模型辅助的车载自主导航系统[D].南昌:南昌大学,2014.
- [39]张月新.三自由度车辆模型-车辆动力学模型辅助的惯性导航系统[J].中国惯性技术学报,2017.
- [40]房素素.基于车辆动力学模型辅助的低成本车载组合导航系统研究[D].济南:山东大学,2019.
- [41]Julier S J,Durrant-Whyte H F.On the role of process models in autonomous land vehicle navigation systems[J].IEEE Transactions on Robotics and Automation,2003,19(1):1-14.
- [42]Kang R,Xiong L,Xu M,et al.VINS-Vehicle:A TightlyCoupled Vehicle Dynamics Extension to Visual-Inertial State Estimator[C]//2019 IEEE Intelligent Transportation Systems Conference-ITSC.IEEE,2019.
- [43]Forster C,Carlone L,Dellaert F,et al.IMU Preintegration on Manifold for Efficient Visual-Inertial Maximum-aPosteriori Estimation (supplementary material)[J].Georgia Institute of Technology,2015.
- [44]Wu K J,Guo C X,Georgiou G,et al.VINS on wheels[C]//2017 IEEE International Conference on Robotics and Automation (ICRA).IEEE,2017.
- [45]Zhang M,Chen Y,Li M.Vision-Aided Localization For Ground Robots[C]//2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).IEEE,2019.
- [46]Ma F,Shi J,Yang Y,et al.ACK-MSCKF:TightlyCoupled Ackermann Multi-State Constraint Kalman Filter for Autonomous Vehicle Localization[J].Sensors,2019,19(21):4816.
- [47]Dang Z,Wang T,Pang F.Tightly-coupled Data Fusion of VINS and Odometer Based on Wheel Slip Estimation[C]//2018 IEEE International Conference on Robotics and Biomimetics (ROBIO).IEEE,2018.
- [48]H Min,X Wu,C Cheng,et al.Kinematic and Dynamic Vehicle Model-Assisted Global Positioning Method for Autonomous Vehicles with Low-Cost GPS/Camera/InVehicle Sensors[J].Sensors (Basel,Switzerland),2019,19(24):5430.
- [49]Vivo G,et al.SAFESPOT Core Architecture-LDM API and Usage Reference[J].SAFESPOT INTEGRATEDPROJECT,2010:1-56.
- [50]Takeuchi E,Tsubouchi T.A 3-D Scan Matching using Improved 3-D Normal Distributions Transform for Mobile Robotic Mapping[C]//2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.IEEE,2006.
- [51]Zhu Y,Xue B,Zheng L,et al.Real-Time Environmentally-Robust 3D Li DAR Localization[C]//2019 IEEE International Conference on Imaging Systems and Techniques (IST).IEEE,2019:1910.12728.
- [52]Ding W,Hou S,Gao H,et al.Li DAR Inertial Odometry Aided Robust LiDAR Localization System in Changing City Scenes[C]//2020 IEEE International Conference on Robotics and Automation (ICRA).IEEE,2020.