Conic Feature Based Simultaneous Localization and Mapping in Open Environment via 2D Lidar

The conventional planar scan matching approach cannot cope well with the open environment as lacking of sufficient edges and corners. This paper presents a conic feature based simultaneous localization and mapping (SLAM) algorithm via 2D lidar which can adapt to an open environment nicely. The novelty of this work includes threefold: (1) defining a conic feature based parametrization approach; (2) developing a method to utilize feature’s conic geometric information and odometry information since open environments are short of regular linear geometric features; (3) developing a factor graph based framework which can be adapted with the proposed parametrization. Simulation experiments and real environment experiments demonstrated that the proposed SLAM algorithm can get accurate and convincing results for the open environment and the map in our representation can express accurately the environment situation.

[1]  Ayoung Kim,et al.  Direct Visual SLAM Using Sparse Depth for Camera-LiDAR System , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[2]  Wolfram Burgard,et al.  Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[3]  Achim J. Lilienthal,et al.  Fast and accurate scan registration through minimization of the distance between compact 3D NDT representations , 2012, Int. J. Robotics Res..

[4]  Goran Marjanovic,et al.  On $l_q$ Optimization and Matrix Completion , 2012, IEEE Transactions on Signal Processing.

[5]  Hao Fu,et al.  Large-Scale Outdoor SLAM Based on 2D Lidar , 2019, Electronics.

[6]  Sang Wook Lee,et al.  ICP Registration Using Invariant Features , 2002, IEEE Trans. Pattern Anal. Mach. Intell..

[7]  Guolai Jiang,et al.  A Simultaneous Localization and Mapping (SLAM) Framework for 2.5D Map Building Based on Low-Cost LiDAR and Vision Fusion , 2019, Applied Sciences.

[8]  Sebastian Thrun,et al.  Learning Occupancy Grid Maps with Forward Sensor Models , 2003, Auton. Robots.

[9]  Paul J. Besl,et al.  Method for registration of 3-D shapes , 1992, Other Conferences.

[10]  Basilio Bona,et al.  Scan Matching for Graph SLAM in Indoor Dynamic Scenarios , 2014, FLAIRS Conference.

[11]  B. Benet,et al.  Multi-sensor fusion method for crop row tracking and traversability operations , 2017 .

[12]  Edwin Olson,et al.  M3RSM: Many-to-many multi-resolution scan matching , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Gamini Dissanayake,et al.  Convergence and Consistency Analysis for Extended Kalman Filter Based SLAM , 2007, IEEE Transactions on Robotics.

[14]  Wei Wu,et al.  LOW-COST WHEELED ROBOT-BORNE LASER SCANNING SYSTEM FOR INDOOR AND OUTDOOR 3D MAPPING APPLICATION , 2019, The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences.

[15]  Edwin Olson,et al.  Occupancy grid rasterization in large environments for teams of robots , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[17]  Ruofei Zhong,et al.  Feature-Based Laser Scan Matching and Its Application for Indoor Mapping , 2016, Sensors.

[18]  Roland Siegwart,et al.  Two different tools for three-dimensional mapping: DE-based scan matching and feature-based loop detection , 2013, Robotica.

[19]  Jian Wang,et al.  Feature‐based detection and classification of moving objects using LiDAR sensor , 2019, IET Intelligent Transport Systems.

[20]  M. Holopainen,et al.  SLAM-Aided Stem Mapping for Forest Inventory with Small-Footprint Mobile LiDAR , 2015 .

[21]  Horst-Michael Groß,et al.  Generic 2D/3D SLAM with NDT maps for lifelong application , 2013, 2013 European Conference on Mobile Robots.

[22]  Per Bergström,et al.  Robust registration of point sets using iteratively reweighted least squares , 2014, Computational Optimization and Applications.

[23]  Gamini Dissanayake,et al.  MIS-SLAM: Real-Time Large-Scale Dense Deformable SLAM System in Minimal Invasive Surgery Based on Heterogeneous Computing , 2018, IEEE Robotics and Automation Letters.

[24]  Haihong Zhu,et al.  An Improved MbICP Algorithm for Mobile Robot Pose Estimation , 2018 .

[25]  Wolfram Burgard,et al.  Efficient Sparse Pose Adjustment for 2D mapping , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Jun Wang,et al.  Dynamic Reconstruction of Deformable Soft-Tissue With Stereo Scope in Minimal Invasive Surgery , 2020, IEEE Robotics and Automation Letters.

[27]  Favio R. Masson,et al.  Simultaneous localization and map building using natural features and absolute information , 2002, Robotics Auton. Syst..

[28]  Qingquan Li,et al.  A random forest classifier based on pixel comparison features for urban LiDAR data , 2019, ISPRS Journal of Photogrammetry and Remote Sensing.

[29]  Michael Bosse,et al.  Continuous 3D scan-matching with a spinning 2D laser , 2009, 2009 IEEE International Conference on Robotics and Automation.

[30]  Suliman A. Gargoum,et al.  A literature synthesis of LiDAR applications in transportation: feature extraction and geometric assessments of highways , 2019, GIScience & Remote Sensing.

[31]  Daniel King,et al.  Fetch & Freight : Standard Platforms for Service Robot Applications , 2016 .

[32]  Li Zhang,et al.  Line segment based map building and localization using 2D laser rangefinder , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[33]  Eduardo Mario Nebot,et al.  Consistency of the FastSLAM algorithm , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

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

[35]  Jiaolong Yang,et al.  Go-ICP: Solving 3D Registration Efficiently and Globally Optimally , 2013, 2013 IEEE International Conference on Computer Vision.

[36]  Shoudong Huang,et al.  Constrained Gaussian mixture models based scan matching method , 2018 .

[37]  Wolfgang Hess,et al.  Real-time loop closure in 2D LIDAR SLAM , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[38]  Goran Marjanovic,et al.  $l_{q}$ Sparsity Penalized Linear Regression With Cyclic Descent , 2014, IEEE Transactions on Signal Processing.

[39]  Sung Joon Ahn,et al.  Ellipse fitting and parameter assessment of circular object targets for robot vision , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[40]  Hao Fu,et al.  IMU-Aided High-Frequency Lidar Odometry for Autonomous Driving , 2019, Applied Sciences.

[41]  Nuno Lau,et al.  Efficient localization based on scan matching with a continuous likelihood field , 2017, 2017 IEEE International Conference on Autonomous Robot Systems and Competitions (ICARSC).

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

[43]  Baba C. Vemuri,et al.  Robust Point Set Registration Using Gaussian Mixture Models , 2011, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[44]  Ying Chen,et al.  A Rubber-Tapping Robot Forest Navigation and Information Collection System Based on 2D LiDAR and a Gyroscope , 2019, Sensors.

[45]  R Keicher,et al.  Automatic guidance for agricultural vehicles in Europe , 2000 .