State Transition for Statistical SLAM Using Planar Features in 3D Point Clouds

There is a large body of literature on solving the SLAM problem for various autonomous vehicle applications. A substantial part of the solutions is formulated based on using statistical (mainly Bayesian) filters such as Kalman filter and its extended version. In such solutions, the measurements are commonly some point features or detections collected by the sensor(s) on board the autonomous vehicle. With the increasing utilization of scanners with common autonomous cars, and availability of 3D point clouds in real-time and at fast rates, it is now possible to use more sophisticated features extracted from the point clouds for filtering. This paper presents the idea of using planar features with multi-object Bayesian filters for SLAM. With Bayesian filters, the first step is prediction, where the object states are propagated to the next time based on a stochastic transition model. We first present how such a transition model can be developed, and then propose a solution for state prediction. In the simulation studies, using a dataset of measurements acquired from real vehicle sensors, we apply the proposed model to predict the next planar features and vehicle states. The results show reasonable accuracy and efficiency for statistical filtering-based SLAM applications.

[1]  Lindsay Kleeman,et al.  Simultaneous landmark classification, localization and map building for an advanced sonar ring , 2006, Robotica.

[2]  Alireza Bab-Hadiashar,et al.  Sensor-Management for Multitarget Filters via Minimization of Posterior Dispersion , 2017, IEEE Transactions on Aerospace and Electronic Systems.

[3]  Rostislav Khlebnikov,et al.  Lecture Notes in Computer Science (including subseries Lecture Notes in Artificial Intelligence and Lecture Notes in Bioinformatics) , 2016 .

[4]  Dieter Fox,et al.  RGB-D mapping: Using Kinect-style depth cameras for dense 3D modeling of indoor environments , 2012, Int. J. Robotics Res..

[5]  Wan Kyun Chung,et al.  Efficient SLAM algorithm with hybrid visual map in an indoor environment , 2007, 2007 International Conference on Control, Automation and Systems.

[6]  LI X.RONG,et al.  Survey of maneuvering target tracking. Part I. Dynamic models , 2003 .

[7]  H. Jin Kim,et al.  Linear RGB-D SLAM for Planar Environments , 2018, ECCV.

[8]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[9]  Klaus C. J. Dietmayer,et al.  The Labeled Multi-Bernoulli SLAM Filter , 2015, IEEE Signal Processing Letters.

[10]  Reza N. Jazar,et al.  Vehicle Dynamics: Theory and Application , 2009 .

[11]  Hugh F. Durrant-Whyte,et al.  Simultaneous Mapping and Localization with Sparse Extended Information Filters: Theory and Initial Results , 2004, WAFR.

[12]  Wei Yi,et al.  Multiobject Tracking for Generic Observation Model Using Labeled Random Finite Sets , 2016, IEEE Transactions on Signal Processing.

[13]  David Suter,et al.  Robust segmentation of visual data using ranked unbiased scale estimate , 1999, Robotica.

[14]  Wolfram Burgard,et al.  An evaluation of the RGB-D SLAM system , 2012, 2012 IEEE International Conference on Robotics and Automation.

[15]  Gyu-In Jee,et al.  Extended Line Map-Based Precise Vehicle Localization Using 3D LIDAR , 2018, Sensors.

[16]  Reza N. Jazar,et al.  Advanced Dynamics: Rigid Body, Multibody, and Aerospace Applications , 2011 .

[17]  Tobias Pietzsch Planar Features for Visual SLAM , 2008, KI.

[18]  Xianfeng Yuan,et al.  Real-Time Photometric Calibrated Monocular Direct Visual SLAM , 2019, Sensors.

[19]  Karl Tuyls,et al.  OctoSLAM: A 3D mapping approach to situational awareness of unmanned aerial vehicles , 2013, 2013 International Conference on Unmanned Aircraft Systems (ICUAS).

[20]  Alireza Bab-Hadiashar,et al.  Visual Mitosis Detection and Cell Tracking Using Labeled Multi-Bernoulli Filter , 2018, 2018 21st International Conference on Information Fusion (FUSION).

[21]  Yuan Zhou,et al.  Research on active SLAM with fusion of monocular vision and laser range data , 2010, 2010 8th World Congress on Intelligent Control and Automation.

[22]  Klaus C. J. Dietmayer,et al.  The Labeled Multi-Bernoulli Filter , 2014, IEEE Transactions on Signal Processing.

[23]  Masahiro Tomono Robust 3D SLAM with a stereo camera based on an edge-point ICP algorithm , 2009, 2009 IEEE International Conference on Robotics and Automation.

[24]  Zoltan Rozsa,et al.  Obstacle Prediction for Automated Guided Vehicles Based on Point Clouds Measured by a Tilted LIDAR Sensor , 2018, IEEE Transactions on Intelligent Transportation Systems.

[25]  Andrew J. Davison,et al.  Real-time simultaneous localisation and mapping with a single camera , 2003, Proceedings Ninth IEEE International Conference on Computer Vision.

[26]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[27]  Wei Wang,et al.  Point-Plane SLAM Using Supposed Planes for Indoor Environments , 2019, Sensors.

[28]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[29]  Jagath Samarabandu,et al.  Recent advances in simultaneous localization and map-building using computer vision , 2007, Adv. Robotics.

[30]  Xiaoying Wang,et al.  Constrained Sensor Control for Labeled Multi-Bernoulli Filter Using Cauchy-Schwarz Divergence , 2017, IEEE Signal Processing Letters.

[31]  Andreas Geiger,et al.  Vision meets robotics: The KITTI dataset , 2013, Int. J. Robotics Res..

[32]  Laurent Itti,et al.  Efficient Velodyne SLAM with point and plane features , 2018, Autonomous Robots.

[33]  Alireza Bab-Hadiashar,et al.  Sensor control for multi-object tracking using labeled multi-Bernoulli filter , 2015, 17th International Conference on Information Fusion (FUSION).

[34]  Benlian Xu,et al.  Multi-sensor control for multi-object Bayes filters , 2018, Signal Process..

[35]  Stephan Reuter,et al.  Multi-object tracking using random finite sets , 2014 .

[36]  Alireza Bab-Hadiashar,et al.  An M-estimator for high breakdown robust estimation in computer vision , 2011, Comput. Vis. Image Underst..

[37]  Ba-Ngu Vo,et al.  A Random-Finite-Set Approach to Bayesian SLAM , 2011, IEEE Transactions on Robotics.