Mapping of environment , Detection and Tracking of Moving Objects using Occupancy Grids

In this paper, we present a real-time algorithm for local simultaneous localization and mapping (SLAM) with detection and tracking of moving objects (DATMO) in dynamic outdoor environments from a moving vehicle equipped with a laser scanner and two radars. 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 by a Multiple Hypothesis Tracker (MHT) coupled with an adaptive IMM (Interacting Multiple Models) Filter. The experimental results on datasets collected from different scenarios such as: urban streets, country roads and highways demonstrate the efficiency of the proposed algorithm on a Daimler Mercedes demonstrator in the framework of the European Project PReVENT-ProFusion2.

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

[2]  N. Floudas,et al.  High Level Sensor Data Fusion Approaches For Object Recognition In Road Environment , 2007, 2007 IEEE Intelligent Vehicles Symposium.

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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