Vehicle pose estimation in cluttered urban environments using multilayer adaptive Monte Carlo localization

In this contribution, we propose multilayer adaptive Monte Carlo localization (ML-AMCL) in combination with 3D point registration algorithms as a GPS-independent framework for precise global vehicle pose estimation in challenging urban environments. Scans from a 3D LIDAR sensor are split into a set of horizontal layers which are then used for localization with separate instances of an AMCL algorithm. A consistency check is performed for the obtained pose estimates in every time step and feasible results are fused. It is shown, that ML-AMCL is superior to existing localization approaches and is well suited as a prior for 3D point registration algorithms for the refinement of the pose estimate. Our key contributions are: i) proposal of ML-AMCL. ii) Incorporation of prior information from ML-AMCL into different pose refinement procedures, i.e. ICP variants and normal distribution transform (NDT), for precise vehicle localization. By means of experimental evaluation with a challenging real data set, performance of the reference localization system is verified. The proposed localization framework achieves a mean Euclidean measurement error of 0:2m under severe adverse environment conditions. The latter include high clutter densities in the sensor measurements and semi-static objects in the localization map.

[1]  Minoru Tanaka,et al.  Detection of localization failure using logistic regression , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Wolfram Burgard,et al.  Experimental analysis of dynamic covariance scaling for robust map optimization under bad initial estimates , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

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

[4]  Wolfram Burgard,et al.  Temporary maps for robust localization in semi-static environments , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Emilio Frazzoli,et al.  Synthetic 2D LIDAR for precise vehicle localization in 3D urban environment , 2013, 2013 IEEE International Conference on Robotics and Automation.

[6]  Wolfram Burgard,et al.  A statistical measure for map consistency in SLAM , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Maarten Weyn,et al.  A Survey of Rigid 3D Pointcloud Registration Algorithms , 2014 .

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

[9]  Joachim Hertzberg,et al.  Evaluation of 3D registration reliability and speed - A comparison of ICP and NDT , 2009, 2009 IEEE International Conference on Robotics and Automation.

[10]  Stewart Worrall,et al.  GPS/GNSS Consistency in a Multi-path Environment and During Signal Outages , 2015, 2015 IEEE 18th International Conference on Intelligent Transportation Systems.

[11]  Wolfram Burgard,et al.  Monte Carlo localization for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[12]  Holger Mielenz,et al.  Localization accuracy estimation with application to perception design , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Erik Blasch,et al.  Uncertainty representation, quantification and evaluation for data and information fusion , 2015, 2015 18th International Conference on Information Fusion (Fusion).

[14]  Andreas Birk,et al.  Beyond points: Evaluating recent 3D scan-matching algorithms , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[15]  Basilio Bona,et al.  A comparative study on robust localization: Fault tolerance and robustness test on probabilistic filters for range-based positioning , 2009, 2009 International Conference on Advanced Robotics.

[16]  Holger Mielenz,et al.  Accurate and fast localization in unstructured environment based on shape context keypoints , 2014, 17th International Conference on Information Fusion (FUSION).

[17]  Zdenko Kovacic,et al.  Multi-layer mapping-based autonomous forklift localization in an industrial environment , 2014, 22nd Mediterranean Conference on Control and Automation.