A Computational Geometry Approach for Localization and Tracking in GPS-denied Environments

Localization and tracking of vehicles is still an important issue in GPS-denied environments both indoors and outdoors, where accurate motion is required. In this work, a localization system based on the random disposition of LiDAR sensors which share a partially common field of view and on the use of the Hausdorff distance is addressed. The proposed system uses the Hausdorff distance to estimate both the position of the LiDAR sensors and the pose of the vehicle as it drives within the environment. Our approach is not restricted to the number of LiDAR sensors the estimation procedure is asynchronous, the number of vehicles it is a multidimensional approach, or the nature of the environment. However, it is implemented in open spaces, limited by the range of the LiDAR sensors and the geometry of the vehicle. An empirical analysis of the presented approach is also included here, showing that the error in the localization estimation remains bounded in approximately 50 cm. Real-time experimentation as validation of the proposed localization and tracking techniques as well as the pros and cons of our proposal are also shown in this work.

[1]  Eduardo Mario Nebot,et al.  Optimization of the simultaneous localization and map-building algorithm for real-time implementation , 2001, IEEE Trans. Robotics Autom..

[2]  Joakim Lindblad,et al.  Linear Time Distances Between Fuzzy Sets With Applications to Pattern Matching and Classification , 2014, IEEE Transactions on Image Processing.

[3]  Kostas E. Bekris,et al.  Robotics-Based Location Sensing Using Wireless Ethernet , 2002, MobiCom '02.

[4]  A. Soto,et al.  Real-Time Robot Localization in Indoor Environments Using Structural Information , 2008, 2008 IEEE Latin American Robotic Symposium.

[5]  Andreas Geiger,et al.  Visual odometry based on stereo image sequences with RANSAC-based outlier rejection scheme , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[6]  Timothy D. Barfoot,et al.  Three‐dimensional SLAM for mapping planetary work site environments , 2012, J. Field Robotics.

[7]  Ricardo Carelli,et al.  Optimized EIF-SLAM algorithm for precision agriculture mapping based on stems detection , 2011 .

[8]  Javier González,et al.  Mobile robot motion estimation by 2D scan matching with genetic and iterative closest point algorithms , 2006, J. Field Robotics.

[9]  Wolfram Burgard,et al.  Probabilistic Robotics (Intelligent Robotics and Autonomous Agents) , 2005 .

[10]  Wolfram Burgard,et al.  A benchmark for the evaluation of RGB-D SLAM systems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Andrew W. Fitzgibbon,et al.  KinectFusion: real-time 3D reconstruction and interaction using a moving depth camera , 2011, UIST.

[12]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[13]  Dechang Pi,et al.  Density-based trajectory outlier detection algorithm , 2013 .

[14]  David A. Clausi,et al.  Mapping, Planning, and Sample Detection Strategies for Autonomous Exploration , 2014, J. Field Robotics.

[15]  Luke Fletcher,et al.  A perception‐driven autonomous urban vehicle , 2008, J. Field Robotics.

[16]  Wolfram Burgard,et al.  Robust Monte Carlo localization for mobile robots , 2001, Artif. Intell..

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

[18]  Anil K. Jain,et al.  A modified Hausdorff distance for object matching , 1994, Proceedings of 12th International Conference on Pattern Recognition.

[19]  Klaus J. Kirchberg,et al.  Robust Face Detection Using the Hausdorff Distance , 2001, AVBPA.

[20]  Sebastian Thrun,et al.  Map-Based Precision Vehicle Localization in Urban Environments , 2007, Robotics: Science and Systems.

[21]  Luke Fletcher,et al.  A perception-driven autonomous urban vehicle , 2008 .

[22]  Michael Bosse,et al.  Three‐dimensional localization for the MagneBike inspection robot , 2011, J. Field Robotics.

[23]  Ricardo Carelli,et al.  Agricultural Robotics: Unmanned Robotic Service Units in Agricultural Tasks , 2013, IEEE Industrial Electronics Magazine.

[24]  Neil D. Lawrence,et al.  WiFi-SLAM Using Gaussian Process Latent Variable Models , 2007, IJCAI.

[25]  Xindong Wu,et al.  3-D Object Retrieval With Hausdorff Distance Learning , 2014, IEEE Transactions on Industrial Electronics.

[26]  Ricardo O. Carelli,et al.  Autonomous Simultaneous Localization and Mapping driven by Monte Carlo uncertainty maps-based navigation , 2012, The Knowledge Engineering Review.

[27]  Facundo Mémoli,et al.  Eurographics Symposium on Point-based Graphics (2007) on the Use of Gromov-hausdorff Distances for Shape Comparison , 2022 .

[28]  L. Moreno,et al.  Evolutionary Filter for Mobile Robot Global Localization , 2007, 2007 IEEE International Symposium on Intelligent Signal Processing.

[29]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

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

[31]  Gustavo Scaglia,et al.  Laser-Based Trespassing Prediction in Restrictive Environments: A Linear Approach , 2012, Sensors.

[32]  Ben J. A. Kröse,et al.  Active Appearance-Based Robot Localization Using Stereo Vision , 2005, Auton. Robots.

[33]  Andreas Geiger,et al.  Lost! Leveraging the Crowd for Probabilistic Visual Self-Localization , 2013, 2013 IEEE Conference on Computer Vision and Pattern Recognition.

[34]  Miguel Torres-Torriti,et al.  Mobile robot localization using the Hausdorff distance , 2008, Robotica.

[35]  Michael Fleming,et al.  Team Cornell's Skynet: Robust perception and planning in an urban environment , 2008 .

[36]  Moe Z. Win,et al.  Cooperative Localization in Wireless Networks , 2009, Proceedings of the IEEE.

[37]  Daniel P. Huttenlocher,et al.  Comparing Images Using the Hausdorff Distance , 1993, IEEE Trans. Pattern Anal. Mach. Intell..

[38]  Yongli Hu,et al.  An Automatic Non-rigid Point Matching Method for Dense 3D Face Scans , 2009, 2009 International Conference on Computational Science and Its Applications.

[39]  Dirk Haehnel,et al.  Junior: The Stanford entry in the Urban Challenge , 2008 .

[40]  Wang Dong,et al.  An automatic 3D face mesh transform based on point matching and its application , 2010, 2010 International Conference on Intelligent Computing and Integrated Systems.

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

[42]  Sanjiv Singh,et al.  The DARPA Urban Challenge: Autonomous Vehicles in City Traffic, George Air Force Base, Victorville, California, USA , 2009, The DARPA Urban Challenge.

[43]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[44]  Saeed Shiry Ghidary,et al.  Hybrid adaptive differential evolution for mobile robot localization , 2012, Intell. Serv. Robotics.

[45]  Saeed Shiry Ghidary,et al.  Mobile robot global localization using differential evolution and particle swarm optimization , 2007, 2007 IEEE Congress on Evolutionary Computation.

[46]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[47]  Joachim Hertzberg,et al.  Three-dimensional mapping with time-of-flight cameras , 2009 .

[48]  William Whittaker,et al.  Autonomous driving in urban environments: Boss and the Urban Challenge , 2008 .