Semantic Localization Considering Uncertainty of Object Recognition

Semantics can be leveraged in ego-vehicle localization to improve robustness and accuracy because objects with the same labels can be correctly matched with each other. Object recognition has significantly improved owing to advances in machine learning algorithms. However, perfect object recognition is still challenging in real environments. Hence, the uncertainty of object recognition must be considered in localization. This letter proposes a novel localization method that integrates a supervised object recognition method, which predicts probabilistic distributions over object classes for individual sensor measurements, into the Bayesian network for localization. The proposed method uses the estimated probabilities and Dirichlet distribution to calculate the likelihood for estimating an ego-vehicle pose. Consequently, the uncertainty can be handled in localization. We present an implementation example of the proposed method using a particle filter and deep-neural-network-based point cloud semantic segmentation and evaluate it by simulation and the SemanticKITTI dataset. Experimental results show that the proposed method can accurately generate likelihood distribution even when object recognition accuracy is degraded, and its estimation accuracy is the highest compared to that of two conventional methods.

[1]  Joachim Hertzberg,et al.  3D Mapping with Semantic Knowledge , 2005, RoboCup.

[2]  Radford M. Neal Pattern Recognition and Machine Learning , 2007, Technometrics.

[3]  Hiroshi Murase,et al.  Hybrid Localization using Model- and Learning-Based Methods: Fusion of Monte Carlo and E2E Localizations via Importance Sampling , 2020, 2020 IEEE International Conference on Robotics and Automation (ICRA).

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

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

[6]  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.

[7]  Grzegorz Cielniak,et al.  Semantically Assisted Loop Closure in SLAM Using NDT Histograms , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  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.

[9]  Wolfram Burgard,et al.  Deep semantic classification for 3D LiDAR data , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Hiroshi Murase,et al.  3D Monte Carlo Localization with Efficient Distance Field Representation for Automated Driving in Dynamic Environments , 2020, 2020 IEEE Intelligent Vehicles Symposium (IV).

[11]  Torsten Sattler,et al.  Semantic Visual Localization , 2017, 2018 IEEE/CVF Conference on Computer Vision and Pattern Recognition.

[12]  Lars Hammarstrand,et al.  Long-Term Visual Localization Using Semantically Segmented Images , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Martin Simonovsky,et al.  Large-Scale Point Cloud Semantic Segmentation with Superpoint Graphs , 2017, 2018 IEEE/CVF Conference on Computer Vision and Pattern Recognition.

[14]  Trevor Darrell,et al.  Fully Convolutional Networks for Semantic Segmentation , 2017, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[15]  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).

[16]  Sean L. Bowman,et al.  Probabilistic data association for semantic SLAM , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

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

[18]  Roberto Cipolla,et al.  SegNet: A Deep Convolutional Encoder-Decoder Architecture for Image Segmentation , 2015, IEEE Transactions on Pattern Analysis and Machine Intelligence.

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

[20]  Cyrill Stachniss,et al.  SuMa++: Efficient LiDAR-based Semantic SLAM , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[21]  Li Sun,et al.  Integrating Deep Semantic Segmentation Into 3-D Point Cloud Registration , 2018, IEEE Robotics and Automation Letters.

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

[23]  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).

[24]  Trevor Darrell,et al.  Conditional Random Fields for Object Recognition , 2004, NIPS.

[25]  Maani Ghaffari Jadidi,et al.  Semantic Iterative Closest Point through Expectation-Maximization , 2018, BMVC.

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

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

[28]  Il Hong Suh,et al.  Active-semantic localization with a single consumer-grade camera , 2009, 2009 IEEE International Conference on Systems, Man and Cybernetics.

[29]  George J. Pappas,et al.  Localization from semantic observations via the matrix permanent , 2016, Int. J. Robotics Res..

[30]  Hiroshi Murase,et al.  Reliability Estimation of Vehicle Localization Result , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[31]  Francesc Moreno-Noguer,et al.  Improving Map Re-localization with Deep ‘Movable’ Objects Segmentation on 3D LiDAR Point Clouds , 2019, 2019 IEEE Intelligent Transportation Systems Conference (ITSC).

[32]  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).

[33]  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).

[34]  Naoki Akai,et al.  Autonomous Navigation Based on Magnetic and Geometric Landmarks on Environmental Structure in Real World , 2014, J. Robotics Mechatronics.

[35]  Grzegorz Cielniak,et al.  Semantic-assisted 3D normal distributions transform for scan registration in environments with limited structure , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).