Fail-Aware LIDAR-Based Odometry for Autonomous Vehicles

Autonomous driving systems are set to become a reality in transport systems and, so, maximum acceptance is being sought among users. Currently, the most advanced architectures require driver intervention when functional system failures or critical sensor operations take place, presenting problems related to driver state, distractions, fatigue, and other factors that prevent safe control. Therefore, this work presents a redundant, accurate, robust, and scalable LiDAR odometry system with fail-aware system features that can allow other systems to perform a safe stop manoeuvre without driver mediation. All odometry systems have drift error, making it difficult to use them for localisation tasks over extended periods. For this reason, the paper presents an accurate LiDAR odometry system with a fail-aware indicator. This indicator estimates a time window in which the system manages the localisation tasks appropriately. The odometry error is minimised by applying a dynamic 6-DoF model and fusing measures based on the Iterative Closest Points (ICP), environment feature extraction, and Singular Value Decomposition (SVD) methods. The obtained results are promising for two reasons: First, in the KITTI odometry data set, the ranking achieved by the proposed method is twelfth, considering only LiDAR-based methods, where its translation and rotation errors are 1.00% and 0.0041 deg/m, respectively. Second, the encouraging results of the fail-aware indicator demonstrate the safety of the proposed LiDAR odometry system. The results depict that, in order to achieve an accurate odometry system, complex models and measurement fusion techniques must be used to improve its behaviour. Furthermore, if an odometry system is to be used for redundant localisation features, it must integrate a fail-aware indicator for use in a safe manner.

[1]  Guangming Xiong,et al.  CPFG-SLAM:a Robust Simultaneous Localization and Mapping based on LIDAR in Off-Road Environment , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[2]  Jean-Emmanuel Deschaud,et al.  IMLS-SLAM: Scan-to-Model Matching Based on 3D Data , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Michael Bosse,et al.  Keyframe-based visual–inertial odometry using nonlinear optimization , 2015, Int. J. Robotics Res..

[4]  H.F. Durrant-Whyte,et al.  A new approach for filtering nonlinear systems , 1995, Proceedings of 1995 American Control Conference - ACC'95.

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

[6]  Emanuele Obialero.  A Refined Vehicle Dynamic Model for Driving Simulators , 2013 .

[8]  Andriy Myronenko,et al.  Point Set Registration: Coherent Point Drift , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[9]  Steven Lake Waslander,et al.  3D Scan Registration Using Curvelet Features , 2014, 2014 Canadian Conference on Computer and Robot Vision.

[10]  Dietrich Paulus,et al.  MC2SLAM: Real-Time Inertial Lidar Odometry Using Two-Scan Motion Compensation , 2018, GCPR.

[11]  F. Fraundorfer,et al.  Visual Odometry : Part II: Matching, Robustness, Optimization, and Applications , 2012, IEEE Robotics & Automation Magazine.

[12]  Kok-Lim Low.  Linear Least-Squares Optimization for Point-to-Plane ICP Surface Registration , 2004 .

[13]  Rui Li,et al.  Fast Rigid 3D Registration Solution: A Simple Method Free of SVD and Eigen-Decomposition , 2018 .

[14]  Gérard G. Medioni,et al.  Object modeling by registration of multiple range images , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[15]  Ignacio Parra,et al.  Accurate Global Localization Using Visual Odometry and Digital Maps on Urban Environments , 2012, IEEE Transactions on Intelligent Transportation Systems.

[16]  C. J. Harris,et al.  Comparison of two measurement fusion methods for Kalman-filter-based multisensor data fusion , 2001 .

[17]  Yohan Dupuis,et al.  LiDAR point clouds correction acquired from a moving car based on CAN-bus data , 2017, ArXiv.

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

[19]  Chenkun Qi,et al.  A Point Cloud Distortion Removing and Mapping Algorithm based on Lidar and IMU UKF Fusion , 2019, 2019 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM).

[20]  Ignacio Parra,et al.  Robust visual odometry for vehicle localization in urban environments , 2009, Robotica.

[21]  Brigitte d'Andréa-Novel,et al.  The kinematic bicycle model: A consistent model for planning feasible trajectories for autonomous vehicles? , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[22]  Andrew W. Fitzgibbon,et al.  Robust Registration of 2D and 3D Point Sets , 2003, BMVC.

[23]  Martin Lauer,et al.  LIMO: Lidar-Monocular Visual Odometry , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[24]  Kumar U Pavan,et al.  Implementation of stereo visual odometry estimation for ground vehicles , 2017, 2017 2nd IEEE International Conference on Recent Trends in Electronics, Information & Communication Technology (RTEICT).

[25]  Ignacio Parra,et al.  WiFi-based urban localisation using CNNs , 2019, 2019 IEEE Intelligent Transportation Systems Conference (ITSC).

[26]  Juha Hyyppä,et al.  CAE-LO: LiDAR Odometry Leveraging Fully Unsupervised Convolutional Auto-Encoder for Interest Point Detection and Feature Description , 2020, ArXiv.

[27]  Beom Hee Lee,et al.  Probabilistic normal distributions transform representation for accurate 3D point cloud registration , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

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

[30]  Tao Liu,et al.  Improved Iterative Closest Point(ICP) 3D point cloud registration algorithm based on point cloud filtering and adaptive fireworks for coarse registration , 2019, International Journal of Remote Sensing.

[31]  Marc Levoy,et al.  Efficient variants of the ICP algorithm , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.

[32]  Rudolph van der Merwe,et al.  The unscented Kalman filter for nonlinear estimation , 2000, Proceedings of the IEEE 2000 Adaptive Systems for Signal Processing, Communications, and Control Symposium (Cat. No.00EX373).

[33]  Rudolph van der Merwe,et al.  Sigma-point kalman filters for probabilistic inference in dynamic state-space models , 2004 .

[34]  Ji Zhang,et al.  Low-drift and real-time lidar odometry and mapping , 2017, Auton. Robots.

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

[36]  D'AlfonsoLuigi,et al.  Mobile robot localization via EKF and UKF , 2015 .

[37]  Nico Blodow,et al.  Fast Point Feature Histograms (FPFH) for 3D registration , 2009, 2009 IEEE International Conference on Robotics and Automation.

[38]  Simon Fong,et al.  An ICP-Based Point Clouds Registration Method for Indoor Environment Modeling , 2019 .

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

[40]  Walter Lucia,et al.  Mobile robot localization via EKF and UKF: A comparison based on real data , 2015, Robotics Auton. Syst..

[41]  Vicente Milanés Montero,et al.  Autonomous vehicle based in cooperative GPS and inertial systems , 2008, Robotica.

[42]  Vladlen Koltun,et al.  Fast Global Registration , 2016, ECCV.