Rapid Localization of Unmanned Ground Vehicles in Dynamic Environment Using Point Cloud Maps

doi:10.3969/j.issn.1000-1093.2020.08.013

Abstract

Abstract: The use of on-board sensors to determine the position of unmanned ground vehicle in a map without global positioning system (GPS) signals is the key to realize the autonomous driving. The existing methods are mainly based on 2-D grid maps, and are not suitable for complex environment. A fast localization algorithm, which is based on 3D point cloud map in dynamic environment and uses a clustered bag-of-words model, is proposed. The dynamic obstacles are removed by backtracking the continuous multi-frame lidar point cloud data and using Bayesian formula. The word list and database are constructed by clustering the point clouds and extracting the viewpoint feature histogram (VFH) descriptors, which enables the unmanned ground vehicle to quickly find the starting position in the point cloud map. Then the subsequent precise positioning is achieved by using the lidar odometry and mapping (LOAM) real-time algorithm. The experimental results show that the proposed algorithm can be used to accurately localize an unmanned ground vehicle in the 3D point cloud map in dynamic environment and meet the real-time requirements.

Key words: unmannedgroundvehicle, relocalization, dynamicobstacle, pointcloudmap

CLC Number:

TJ810.2

ZHENG Zhuangzhuang, CAO Wanke, ZOU Yuan, ZHANG Xudong, DU Guangze. Rapid Localization of Unmanned Ground Vehicles in Dynamic Environment Using Point Cloud Maps[J]. Acta Armamentarii, 2020, 41(8): 1581-1589.

References

［1］仲崇慧, 贾喜花. 国外地面无人作战平台军用机器人发展概况综述［J］. 机器人技术与应用. 2005, 18(4): 18-24.
ZHONG C H, JIA X H. Overview of development of foreign unmanned ground combat platforms: military robots ［J］ Robot Technique and Application, 2005, 18(4):18-24.(in Chinese)
［2］ CADENA C, CARLONE L, CARRILLO H, et al. Past, present, and future of simultaneous localization and mapping: toward the robust-perception age［J］. IEEE Transactions on Robotics, 2016, 32(6): 1309-1332.
［3］ FOX D, THRUN S, BURGARD W, et al. Particle filters for mobile robot localization［M］. DOUCET A,DE FREITAS N, GORDON N. Sequential Monte Carlo Methods in Practice.New York, NY, US: Springer, 2001: 401-428.
［4］ DELLAERT F, FOX D, BURGARD W, et al. Monte Carlo localization for mobile robots［C］∥Proceedings of 1999 IEEE International Conference on Robotics and Automation. Detroit, MI, US: IEEE, 1999: 1322-1328.
［5］ THYUN S, FOX D, BURGARD W, et al. Robust Monte Carlo localization for mobile robots［J］. Artificial Intelligence, 2001, 128(1): 99-141.
［6］ ZLOT R, BOSSE M. Place recognition using keypoint similarities in 2D lidar maps［C］∥Proceedings of the 11th International Symposium on Experimental Robotics. Berlin, Germany: Springer,2009: 363- 372.
［7］危双丰,庞帆,刘振彬,等.基于激光雷达的同时定位与地图构建方法综述［J］.计算机应用研究,2020,37（2）:327-332.
WEI S F, PANG F, LIU Z B，et al. Survey of lidar-based SLAM algorithms ［J］.Application Research of Computers, 2020,37（2）: 327-332. (in Chinese)
［8］ BOSSE M, ZLOT R. Place recognition using keypoint voting in large 3D lidar datasets［C］∥ Proceedings of 2013 IEEE International Conference on Robotics and Automation. Karlsruhe,Germany: IEEE, 2013: 2677-2684.
［9］ GAWEL A, CIESLEWSKI T, DUB R, et al. Structure-based vision-laser matching［C］∥Proceedings of 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems. Daejeon, South Korea: IEEE,2016: 182-188.
［10］ DUB R, DUGAS D, STUMM E, et al. Segmatch: segment based place recognition in 3D point clouds［C］∥ Proceeding of 2017 IEEE International Conference on Robotics and Automation. Singapore: IEEE, 2017: 5266-5272.
［11］ ZHUANG Y, JIANG N, HU H S, et al. 3D-laser-based scene measurement and place recognition for mobile robots in dynamic indoor environments［J］. IEEE Transactions on Instrumentation and Measurement, 2012, 62(2): 438-450.
［12］ STEDER B, RUHNKE M, GRZONKA S, et al. Place recognition in 3D scans using a combination of bag of words and point feature based relative pose estimation［C］∥ Proceedings of 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems. San Francisco, CA, US: IEEE, 2011: 1249-1255.
［13］ GRANSTRM K, SCHN T B, NIETO J I, et al. Learning to close loops from range data［J］. The International Journal of Robotics Research, 2011, 30(14): 1728-1754.
［14］ YANG G C, CHEN Z J, LI Y, et al. Rapid relocation method for mobile robot based on improved ORB-SLAM2 algorithm［J］. Remote Sensing, 2019, 11(2): 149.
［15］季开进. 基于三维激光雷达的车辆定位研究［D］. 北京: 北京理工大学, 2019.
JI K J. Research on vehicle location based on 3D lidar［D］. Beijing: Beijing Institute of Technology, 2019. (in Chinese)
［16］ ZHANG J, SINGH S. LOAM: lidar odometry and mapping in real-time［C］∥ Proceedings of Robotics: Science and Systems.Berkeley, CA, US:the University of California Berkeley, 2014.
［17］ SHAN T, ENGLOT B. LeGO-LOAM: Lightweight and ground-optimized lidar odometry and mapping on variable terrain［C］∥ Proceedings of 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems. Madrid, Spain: IEEE, 2018: 4758-4765.

[1]	ZOU Yuan, JIAO Feixiang, CUI Xing, ZHANG Xudong, ZHANG Bin. A Review on Power Source Technology of Unmanned Ground Vehicles [J]. Acta Armamentarii, 2020, 41(10): 2131-2144.
[2]	LIU Zhongze, CHEN Huiyan, CUI Xing, XIONG Guangming, WANG Yuchun, TAO Yi. Real-time LiDAR SLAM in Off-road Environment for UGV [J]. Acta Armamentarii, 2019, 40(12): 2399-2406.