3D Monte Carlo Localization with Efficient Distance Field Representation for Automated Driving in Dynamic Environments

This paper presents a LiDAR-based 3D Monte Carlo localization (MCL) with an efficient distance field (DF) representation method. To implement 3D MCL, high computing capacity is required because the likelihood of many pose candidates, i.e., particles, must be calculated in real time by comparing sensor measurements and a map. Additionally, a large-scale map is needed for allocation to embedded computers since autonomous vehicles are required to navigate wide areas. These make it difficult for 3D MCL implementation. This paper first presents an efficient DF representation method while considering the 3D LiDAR-based localization characteristics. Because each DF voxel has the closest distance from occupied voxels, swift comparison of the sensor measurements and map can be achieved. Consequently, 3D MCL using the likelihood field model (LFM) can be executed in real time. Furthermore, this paper presents a method for improving the localization robustness to environmental changes without increasing memory and computational cost from that of the LFM-based MCL. Through experiments using the SemanticKITTI dataset, we show that the presented method can efficiently and robustly work in dynamic environments.

[1]  Jaime Valls Miró,et al.  Gaussian processes autonomous mapping and exploration for range-sensing mobile robots , 2016, Autonomous Robots.

[2]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[3]  Radu Bogdan Rusu,et al.  3D is here: Point Cloud Library (PCL) , 2011, 2011 IEEE International Conference on Robotics and Automation.

[4]  David G. Lowe,et al.  Fast Approximate Nearest Neighbors with Automatic Algorithm Configuration , 2009, VISAPP.

[5]  Hiroshi Murase,et al.  Toward Localization-Based Automated Driving in Highly Dynamic Environments: Comparison and Discussion of Observation Models , 2018, 2018 21st International Conference on Intelligent Transportation Systems (ITSC).

[6]  Eijiro Takeuchi,et al.  Robust localization using 3D NDT scan matching with experimentally determined uncertainty and road marker matching , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[7]  Daniel P. Huttenlocher,et al.  Distance Transforms of Sampled Functions , 2012, Theory Comput..

[8]  Shinpei Kato,et al.  An Open Approach to Autonomous Vehicles , 2015, IEEE Micro.

[9]  Donald Meagher,et al.  Geometric modeling using octree encoding , 1982, Comput. Graph. Image Process..

[10]  Peter Biber,et al.  The normal distributions transform: a new approach to laser scan matching , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[11]  Xuemin Lin,et al.  Approximate Nearest Neighbor Search on High Dimensional Data — Experiments, Analyses, and Improvement , 2016, IEEE Transactions on Knowledge and Data Engineering.

[12]  Fabio Tozeto Ramos,et al.  Hilbert maps: Scalable continuous occupancy mapping with stochastic gradient descent , 2015, Robotics: Science and Systems.

[13]  Gamini Dissanayake,et al.  Vector Distance Function Based Map Representation for Robot Localisation , 2017 .

[14]  Ronald N. Perry,et al.  Adaptively sampled distance fields: a general representation of shape for computer graphics , 2000, SIGGRAPH.

[15]  Hiroshi Murase,et al.  Misalignment Recognition Using Markov Random Fields With Fully Connected Latent Variables for Detecting Localization Failures , 2019, IEEE Robotics and Automation Letters.

[16]  Hiroshi Murase,et al.  Mobile Robot Localization Considering Class of Sensor Observations , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[17]  Juan Andrade-Cetto,et al.  Localization in highly dynamic environments using dual-timescale NDT-MCL , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[18]  Jari Saarinen,et al.  Normal distributions transform Monte-Carlo localization (NDT-MCL) , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Wolfram Burgard,et al.  DCT Maps: Compact Differentiable Lidar Maps Based on the Cosine Transform , 2018, IEEE Robotics and Automation Letters.

[20]  Tom Duckett,et al.  Scan registration for autonomous mining vehicles using 3D‐NDT , 2007, J. Field Robotics.

[21]  Wolfram Burgard,et al.  Efficient grid-based spatial representations for robot navigation in dynamic environments , 2013, Robotics Auton. Syst..

[22]  P. Danielsson.  Euclidean distance mapping , 1980 .

[23]  Joachim Hertzberg,et al.  Evaluation of 3D registration reliability and speed - A comparison of ICP and NDT , 2009, 2009 IEEE International Conference on Robotics and Automation.

[24]  Wolfram Burgard,et al.  Multi-Level Surface Maps for Outdoor Terrain Mapping and Loop Closing , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Jari Saarinen,et al.  Normal Distributions Transform Occupancy Maps: Application to large-scale online 3D mapping , 2013, 2013 IEEE International Conference on Robotics and Automation.

[26]  Eijiro Takeuchi,et al.  Autonomous driving based on accurate localization using multilayer LiDAR and dead reckoning , 2017, 2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC).

[27]  Andreas Geiger,et al.  Are we ready for autonomous driving? The KITTI vision benchmark suite , 2012, 2012 IEEE Conference on Computer Vision and Pattern Recognition.

[28]  L. Dagum,et al.  OpenMP: an industry standard API for shared-memory programming , 1998 .

[29]  Wolfram Burgard,et al.  Monte Carlo localization for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[30]  Wolfram Burgard,et al.  An Analytical Lidar Sensor Model Based on Ray Path Information , 2017, IEEE Robotics and Automation Letters.

[31]  Hiroshi Murase,et al.  Simultaneous pose and reliability estimation using convolutional neural network and Rao–Blackwellized particle filter , 2018, Adv. Robotics.

[32]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[33]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[34]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[35]  Roland Siegwart,et al.  Signed Distance Fields: A Natural Representation for Both Mapping and Planning , 2016 .

[36]  Takeo Kanade,et al.  Terrain mapping for a roving planetary explorer , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[37]  Jizhong Xiao,et al.  Multi-volume occupancy grids: An efficient probabilistic 3D mapping model for micro aerial vehicles , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[38]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[39]  David Wettergreen,et al.  Real‐Time SLAM with Octree Evidence Grids for Exploration in Underwater Tunnels , 2007, J. Field Robotics.

[40]  Cyrill Stachniss,et al.  SemanticKITTI: A Dataset for Semantic Scene Understanding of LiDAR Sequences , 2019, 2019 IEEE/CVF International Conference on Computer Vision (ICCV).