New Monte Carlo Localization Using Deep Initialization: A Three-Dimensional LiDAR and a Camera Fusion Approach

Fast and accurate global localization of autonomous ground vehicles is often required in indoor environments and GPS-shaded areas. Typically, with regard to global localization problem, the entire environment should be observed for a long time to converge. To overcome this limitation, a new initialization method called deep initialization is proposed and it is applied to Monte Carlo localization (MCL). The proposed method is based on the combination of a three-dimensional (3D) light detection and ranging (LiDAR) and a camera. Using a camera, pose regression based on a deep convolutional neural network (CNN) is conducted to initialize particles of MCL. Particles are sampled from the tangent space to a manifold structure of the group of rigid motion. Using a 3D LiDAR as a sensor, a particle filter is applied to estimate the sensor pose. Furthermore, we propose a re-localization method for performing initialization whenever a localization failure or the situation of robot kidnapping is detected. Either the localization failure or the kidnapping is detected by combining the outputs from a camera and 3D LiDAR. Finally, the proposed method is applied to a mobile robot platform to prove the method’s effectiveness in terms of both the localization accuracy and time consumed for estimating the pose correctly.

[1]  Hyun Myung,et al.  GP-ICP: Ground Plane ICP for Mobile Robots , 2019, IEEE Access.

[2]  Cyrill Stachniss,et al.  Joint Ego-motion Estimation Using a Laser Scanner and a Monocular Camera Through Relative Orientation Estimation and 1-DoF ICP , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[3]  Frank Dellaert,et al.  On-Manifold Preintegration for Real-Time Visual--Inertial Odometry , 2015, IEEE Transactions on Robotics.

[4]  Zheng Fang,et al.  Real-time onboard 6DoF localization of an indoor MAV in degraded visual environments using a RGB-D camera , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Muhammad Sualeh,et al.  Simultaneous Localization and Mapping in the Epoch of Semantics: A Survey , 2018, International Journal of Control, Automation and Systems.

[6]  Euntai Kim,et al.  Simultaneous Global Localization and Mapping , 2014, IEEE/ASME Transactions on Mechatronics.

[7]  Dumitru Erhan,et al.  Going deeper with convolutions , 2014, 2015 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[8]  Wolfram Burgard,et al.  Deep regression for monocular camera-based 6-DoF global localization in outdoor environments , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[9]  Wolfram Burgard,et al.  Monocular camera localization in 3D LiDAR maps , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[11]  Yanlei Gu,et al.  Factors to Evaluate Capability of Map for Vehicle Localization , 2018, IEEE Access.

[12]  Ji Zhang,et al.  Visual-lidar odometry and mapping: low-drift, robust, and fast , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Yonghwan Jeong,et al.  AVM / LiDAR sensor based lane marking detection method for automated driving on complex urban roads , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[14]  Sebastian Thrun,et al.  Robust vehicle localization in urban environments using probabilistic maps , 2010, 2010 IEEE International Conference on Robotics and Automation.

[15]  Weinan Chen,et al.  Global localization of a mobile robot using lidar and visual features , 2017, 2017 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[16]  Jose Luis Blanco,et al.  A tutorial on SE(3) transformation parameterizations and on-manifold optimization , 2012 .

[17]  Roberto Cipolla,et al.  PoseNet: A Convolutional Network for Real-Time 6-DOF Camera Relocalization , 2015, 2015 IEEE International Conference on Computer Vision (ICCV).

[18]  Axel Barrau,et al.  Stochastic observers on Lie groups: a tutorial , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[19]  Roberto Cipolla,et al.  Modelling uncertainty in deep learning for camera relocalization , 2015, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[20]  Girish Chowdhary,et al.  GPS‐denied Indoor and Outdoor Monocular Vision Aided Navigation and Control of Unmanned Aircraft , 2013, J. Field Robotics.

[21]  Peter Cheeseman,et al.  A stochastic map for uncertain spatial relationships , 1988 .

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

[23]  Roberto Cipolla,et al.  Geometric Loss Functions for Camera Pose Regression with Deep Learning , 2017, 2017 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[24]  René Vidal,et al.  3D Pose Regression Using Convolutional Neural Networks , 2017, 2017 IEEE Conference on Computer Vision and Pattern Recognition Workshops (CVPRW).

[25]  Thomas Röfer,et al.  Vision-based fast and reactive monte-carlo localization , 2003, ICRA.

[26]  Maher Moakher,et al.  To appear in: SIAM J. MATRIX ANAL. APPL. MEANS AND AVERAGING IN THE GROUP OF ROTATIONS∗ , 2002 .

[27]  Adam Herout,et al.  Calibration of RGB camera with velodyne LiDAR , 2014 .

[28]  Denis Fernando Wolf,et al.  Feature Detection for Vehicle Localization in Urban Environments Using a Multilayer LIDAR , 2016, IEEE Transactions on Intelligent Transportation Systems.

[29]  T. Rofer,et al.  Vision-based fast and reactive Monte-Carlo localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[30]  Paul Newman,et al.  FAB-MAP: Probabilistic Localization and Mapping in the Space of Appearance , 2008, Int. J. Robotics Res..

[31]  Ji Zhang,et al.  LOAM: Lidar Odometry and Mapping in Real-time , 2014, Robotics: Science and Systems.

[32]  S. Shankar Sastry,et al.  An Invitation to 3-D Vision: From Images to Geometric Models , 2003 .

[33]  Hyun Myung,et al.  Robust Vehicle Localization Using Entropy-Weighted Particle Filter-based Data Fusion of Vertical and Road Intensity Information for a Large Scale Urban Area , 2017, IEEE Robotics and Automation Letters.

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

[35]  Ho Gi Jung,et al.  Sensor Fusion-Based Low-Cost Vehicle Localization System for Complex Urban Environments , 2017, IEEE Transactions on Intelligent Transportation Systems.

[36]  Jianping Shi,et al.  CamNet: Coarse-to-Fine Retrieval for Camera Re-Localization , 2019, 2019 IEEE/CVF International Conference on Computer Vision (ICCV).

[37]  Siddharth Agarwal,et al.  Ground-Edge-Based LIDAR Localization Without a Reflectivity Calibration for Autonomous Driving , 2017, IEEE Robotics and Automation Letters.

[38]  Antonio Giménez-Fernández,et al.  Benchmarking Particle Filter Algorithms for Efficient Velodyne-Based Vehicle Localization , 2019, Sensors.

[39]  Hae Min Cho,et al.  A Deep Convolutional Neural Network Based 6-DOF Relocalization with Sensor Fusion System , 2019 .

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

[41]  Wolfram Burgard,et al.  Monte Carlo localization in outdoor terrains using multilevel surface maps , 2008, J. Field Robotics.

[42]  Vincent Lepetit,et al.  Instant Outdoor Localization and SLAM Initialization from 2.5D Maps , 2015, IEEE Transactions on Visualization and Computer Graphics.

[43]  Juan D. Tardós,et al.  ORB-SLAM2: An Open-Source SLAM System for Monocular, Stereo, and RGB-D Cameras , 2016, IEEE Transactions on Robotics.