Probabilistic Object Maps for Long-Term Robot Localization

Robots deployed in settings such as warehouses and parking lots must cope with frequent and substantial changes when localizing in their environments. While many previous localization and mapping algorithms have explored methods of identifying and focusing on long-term features to handle change in such environments, we propose a different approach – can a robot understand the distribution of movable objects and relate it to observations of such objects to reason about global localization? In this paper, we present probabilistic object maps (POMs), which represent the distributions of movable objects using pose-likelihood sample pairs derived from prior trajectories through the environment and use a Gaussian process classifier to generate the likelihood of an object at a query pose. We also introduce POM-Localization, which uses an observation model based on POMs to perform inference on a factor graph for globally consistent long-term localization. We present empirical results showing that POMLocalization is indeed effective at producing globally consistent localization estimates in challenging real-world environments, and that POM-Localization improves trajectory estimates even when the POM is formed from partially incorrect data.

[1]  Manuela M. Veloso,et al.  Episodic non-Markov localization , 2017, Robotics Auton. Syst..

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

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

[4]  Paul Ozog,et al.  Online Probabilistic Change Detection in Feature-Based Maps , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Wolfram Burgard,et al.  Lifelong localization in changing environments , 2013, Int. J. Robotics Res..

[6]  John J. Leonard,et al.  Dynamic pose graph SLAM: Long-term mapping in low dynamic environments , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  Brendan Englot,et al.  LeGO-LOAM: Lightweight and Ground-Optimized Lidar Odometry and Mapping on Variable Terrain , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[8]  Dehann Fourie,et al.  Multimodal Semantic SLAM with Probabilistic Data Association , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[9]  Tom Duckett,et al.  FreMEn: Frequency Map Enhancement for Long-Term Mobile Robot Autonomy in Changing Environments , 2017, IEEE Transactions on Robotics.

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

[11]  Wolfram Burgard,et al.  Mobile Robot Mapping and Localization in Non-Static Environments , 2005, AAAI.

[12]  John J. Leonard,et al.  Towards lifelong feature-based mapping in semi-static environments , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

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

[14]  Fabio Tozeto Ramos,et al.  Gaussian process occupancy maps* , 2012, Int. J. Robotics Res..

[15]  Jon Louis Bentley,et al.  Multidimensional binary search trees used for associative searching , 1975, CACM.

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

[17]  Shichao Yang,et al.  CubeSLAM: Monocular 3-D Object SLAM , 2018, IEEE Transactions on Robotics.

[18]  David Baxter,et al.  Probabilistic Data Association via Mixture Models for Robust Semantic SLAM , 2019, 2020 IEEE International Conference on Robotics and Automation (ICRA).

[19]  Zheng Fang,et al.  A Robust Laser-Inertial Odometry and Mapping Method for Large-Scale Highway Environments , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).