[2] [2] GRISETTI G,STACHNISS C,BURGARD W.Improved techniques for grid mapping with Rao-Blackwellized particle filters ［J］.IEEE Transactions on Robotics,2007,23(1):34-46.

[3] [3] GARULLI A,GIANNITRAPANI A,ROSSI A,et al.Mobile robot SLAM for line-based environment representation［C］//The 44th IEEE Conference on Decision and Control European Control Conference,IEEE,2005:2041-2046.

[4] [4] DIOSI A,TAYLOR G,KLEEMAN L.Interactive SLAM using laser and advanced sonar［C］//Robotics and Automation, 2005:1103-1108.

[5] [5] HUANG S D,DISSANAYAKE G.Convergence and consistency analysis for extended Kalman filter based SLAM ［J］.IEEE Transactions on Robotics,2007,23(5):1036-1049.

[6] [6] RIBO M,PINZ A.A comparison of three uncertainty calculi for building sonar-based occupancy grids［J］.Robotics and Autonomous Systems,2001,35(3):201-209.

[7] [7] ROS G,GUERRERO J,SAPPA A D,et al.VSLAM pose initialization via Lie group and Lie algebras optimization［C］//IEEE International Conference on Robotics and Automation,Karlsruhe,2013:5740-5747.

[8] [8] BARFOOT T D.State estimation for robotics:a matrix-Lie-group approach［EB/OL］.(2016-04-01)［2017-02-01］.http://asrl.utias.utoronto.ca.

[9] [9] FRAUNDORFER F,SCARAMUZZA D.Visual odometry part I:the first 30 years and fundamentals ［J］.IEEE Robotics and Automation Magazine,2011,18(4):80-92.

[13] [13] MUR-ARTAL R,MONTIEL J M M,TARDS J D.Orb-slam:a versatile and accurate monocular slam system［J］.IEEE Transactions on Robotics,2015,31(5):1147-1163.

[14] [14] KOHLBRECHER S.Hector_mapping［EB/OL］.(2012-08-01)［2017-02-01］.http://wiki.ros.org/hector_mapping.