Online Localization and Mapping with Moving Object Tracking in Dynamic Outdoor Environments

In this paper, we present a real-time algorithm for online simultaneous localization and mapping (SLAM) with detection and tracking of moving objects (DATMO) in dynamic outdoor environments from a moving vehicle equipped with laser sensor and odometry. To correct vehicle location from odometry we introduce a new fast implementation of incremental scan matching method that can work reliably in dynamic outdoor environments. After a good vehicle location is estimated, the surrounding map is updated incrementally and moving objects are detected without a priori knowledge of the targets. Detected moving objects are finally tracked using global nearest neighborhood (GNN) method. The experimental results on datasets collected from different scenarios such as: urban streets, country roads and highways demonstrate the efficiency of the proposed algorithm.

[1]  Sebastian Thrun,et al.  Learning Metric-Topological Maps for Indoor Mobile Robot Navigation , 1998, Artif. Intell..

[2]  Neil J. Gordon,et al.  A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking , 2002, IEEE Trans. Signal Process..

[3]  Marilena Vendittelli,et al.  Fuzzy maps: A new tool for mobile robot perception and planning , 1997, J. Field Robotics.

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

[5]  Brian Yamauchi,et al.  A frontier-based approach for autonomous exploration , 1997, Proceedings 1997 IEEE International Symposium on Computational Intelligence in Robotics and Automation CIRA'97. 'Towards New Computational Principles for Robotics and Automation'.

[6]  Hugh F. Durrant-Whyte,et al.  Simultaneous map building and localization for an autonomous mobile robot , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[7]  Christian Laugier,et al.  Adaptive Interacting Multiple Models applied on pedestrian tracking in car parks , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Gaurav S. Sukhatme,et al.  Mobile Robot Simultaneous Localization and Mapping in Dynamic Environments , 2005, Auton. Robots.

[9]  Trung-Dung Vu,et al.  Grid-based localization and online mapping with moving objects detection and tracking: new results , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[10]  Hugh F. Durrant-Whyte,et al.  An evidential approach to map-building for autonomous vehicles , 1998, IEEE Trans. Robotics Autom..

[11]  Trung-Dung Vu,et al.  Online localization and mapping with moving objects detection in dynamic outdoor environments , 2009, 2009 IEEE 5th International Conference on Intelligent Computer Communication and Processing.

[12]  Sergiu Nedevschi,et al.  Stereovision-Based Sensor for Intersection Assistance , 2009 .

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

[14]  V. Jilkov,et al.  Survey of maneuvering target tracking. Part V. Multiple-model methods , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[15]  Wolfram Burgard,et al.  A real-time algorithm for mobile robot mapping with applications to multi-robot and 3D mapping , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[16]  Trung-Dung Vu,et al.  High level sensor data fusion for automotive applications using occupancy grids , 2008, 2008 10th International Conference on Control, Automation, Robotics and Vision.

[17]  Olivier Aycard,et al.  Grid-based Localization and Online Mapping with Moving Object Detection and Tracking , 2007 .

[18]  Ingemar J. Cox,et al.  An Efficient Implementation of Reid's Multiple Hypothesis Tracking Algorithm and Its Evaluation for the Purpose of Visual Tracking , 1996, IEEE Trans. Pattern Anal. Mach. Intell..

[19]  Ingemar J. Cox,et al.  An efficient implementation and evaluation of Reid's multiple hypothesis tracking algorithm for visual tracking , 1994, Proceedings of 12th International Conference on Pattern Recognition.

[20]  Trung-Dung Vu,et al.  Mapping of environment , Detection and Tracking of Moving Objects using Occupancy Grids , 2008 .

[21]  Edmond Boyer,et al.  Fusion of multiview silhouette cues using a space occupancy grid , 2005, Tenth IEEE International Conference on Computer Vision (ICCV'05) Volume 1.

[22]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

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

[24]  Nils Appenrodt,et al.  Results of a precrash application based on Laserscanner and short range radars , 2008, 2008 IEEE Intelligent Vehicles Symposium.

[25]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[26]  Christian Laugier,et al.  Pedestrian Tracking in Car Parks : An Adaptive Interacting Multiple Models Based Filtering Method , 2006, 2006 IEEE Intelligent Transportation Systems Conference.

[27]  W. Burgard,et al.  Markov Localization for Mobile Robots in Dynamic Environments , 1999, J. Artif. Intell. Res..

[28]  Y. Bar-Shalom.  Tracking and data association , 1988 .

[29]  Wolfram Burgard,et al.  Mobile robot mapping in populated environments , 2003, Adv. Robotics.

[30]  Yakov Bar-Shalom,et al.  Multitarget-Multisensor Tracking: Principles and Techniques , 1995 .

[31]  Anne Spalanzani,et al.  Pedestrians Tracking Using Offboard Cameras , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  S.S. Blackman,et al.  Multiple hypothesis tracking for multiple target tracking , 2004, IEEE Aerospace and Electronic Systems Magazine.

[33]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization, Mapping and Moving Object Tracking , 2007, Int. J. Robotics Res..

[34]  Alberto Elfes,et al.  Occupancy grids: a probabilistic framework for robot perception and navigation , 1989 .

[35]  Amir Averbuch,et al.  Interacting Multiple Model Methods in Target Tracking: A Survey , 1988 .

[36]  Paolo Fiorini,et al.  Navigating a Robotic Wheelchair in a Railway Station during Rush Hour , 1999, Int. J. Robotics Res..