Grid-Based Environment Estimation Using Evidential Mapping and Particle Tracking

Modeling and estimating the current local environment by processing sensor measurement data is essential for intelligent vehicles. Static obstacles, dynamic objects, and free space have to be appropriately represented, classified, and filtered. Occupancy grids, known for mapping static environments, provide a common low-level representation using occupancy probabilities with an implicit data association through the discrete grid structure. Extending this idea toward dynamic environments with moving objects requires a static/dynamic classification of measured occupancy and a tracking of the dynamic state of grid cells. In this paper, we propose a new dynamic grid mapping approach. An evidential representation using the Dempster–Shafer framework is used to model hypotheses for static occupancy, dynamic occupancy, free space, and their combined hypotheses. These hypotheses are consistently estimated and accumulated in a dynamic grid map by an adapted evidential filtering, allowing one to distinguish static and dynamic occupancy. The evidential grid mapping is combined with a low-level particle filter tracking that is used to estimate cell velocity distributions and predict dynamic occupancy of the grid map. Static occupancy is directly modeled in the grid map without requiring particles, increasing efficiency, and improving the static/dynamic classification due to the persistent map accumulation. Experimental results with real sensor data show the effectiveness of the proposed approach in challenging scenarios with occlusions and dense traffic.

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

[2]  Dominik Nuss,et al.  Representation of Fused Environment Data , 2015 .

[3]  Antonio Martínez-Álvarez,et al.  A Review of the Bayesian Occupancy Filter , 2017, Sensors.

[4]  Arthur P. Dempster,et al.  Upper and Lower Probabilities Induced by a Multivalued Mapping , 1967, Classic Works of the Dempster-Shafer Theory of Belief Functions.

[5]  Volker Willert,et al.  Grid mapping in dynamic road environments: Classification of dynamic cell hypothesis via tracking , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Torsten Bertram,et al.  Track-to-Track Fusion With Asynchronous Sensors Using Information Matrix Fusion for Surround Environment Perception , 2012, IEEE Transactions on Intelligent Transportation Systems.

[7]  Eric Lefevre,et al.  Belief function combination and conflict management , 2002, Inf. Fusion.

[8]  Y. Bar-Shalom,et al.  On optimal track-to-track fusion , 1997, IEEE Transactions on Aerospace and Electronic Systems.

[9]  Lukas Rummelhard,et al.  Hybrid sampling Bayesian Occupancy Filter , 2014, 2014 IEEE Intelligent Vehicles Symposium Proceedings.

[10]  Franz Korf,et al.  Object tracking and dynamic estimation on evidential grids , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[11]  Klaus C. J. Dietmayer,et al.  Fusion of laser and radar sensor data with a sequential Monte Carlo Bayesian occupancy filter , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[12]  Christian Laugier,et al.  Bayesian Occupancy Filtering for Multitarget Tracking: An Automotive Application , 2006, Int. J. Robotics Res..

[13]  Trung-Dung Vu,et al.  Online Localization and Mapping with Moving Object Tracking in Dynamic Outdoor Environments , 2007, 2007 IEEE Intelligent Vehicles Symposium.

[14]  Christian Laugier,et al.  The Bayesian Occupation Filter , 2008, Probabilistic Reasoning and Decision Making in Sensory-Motor Systems.

[15]  Véronique Berge-Cherfaoui,et al.  Map-Aided Evidential Grids for Driving Scene Understanding , 2015, IEEE Intelligent Transportation Systems Magazine.

[16]  Dirk Wollherr,et al.  Evidential Grid-Based Tracking and Mapping , 2017, IEEE Transactions on Intelligent Transportation Systems.

[17]  Sergiu Nedevschi,et al.  Particle Grid Tracking System Stereovision Based Obstacle Perception in Driving Environments , 2012, IEEE Intelligent Transportation Systems Magazine.

[18]  Dirk Wollherr,et al.  Object tracking based on evidential dynamic occupancy grids in urban environments , 2017, 2017 IEEE Intelligent Vehicles Symposium (IV).

[19]  Lukas Rummelhard,et al.  Conditional Monte Carlo Dense Occupancy Tracker , 2015, 2015 IEEE 18th International Conference on Intelligent Transportation Systems.

[20]  Glenn Shafer,et al.  A Mathematical Theory of Evidence , 2020, A Mathematical Theory of Evidence.

[21]  Stephan Matzka,et al.  A comparison of track-to-track fusion algorithms for automotive sensor fusion , 2008, 2008 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems.

[22]  Arthur P. Dempster,et al.  A Generalization of Bayesian Inference , 1968, Classic Works of the Dempster-Shafer Theory of Belief Functions.

[23]  Charles E. Thorpe,et al.  Simultaneous localization and mapping with detection and tracking of moving objects , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[24]  Alberto Elfes,et al.  Using occupancy grids for mobile robot perception and navigation , 1989, Computer.

[25]  Sergiu Nedevschi,et al.  Modeling and Tracking the Driving Environment With a Particle-Based Occupancy Grid , 2011, IEEE Transactions on Intelligent Transportation Systems.

[26]  Martin Buss,et al.  Grid-based mapping and tracking in dynamic environments using a uniform evidential environment representation , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[27]  Trung-Dung Vu,et al.  Laser-based detection and tracking moving objects using data-driven Markov chain Monte Carlo , 2009, 2009 IEEE International Conference on Robotics and Automation.

[28]  Ricardo Omar Chávez García,et al.  Multiple Sensor Fusion and Classification for Moving Object Detection and Tracking , 2016, IEEE Transactions on Intelligent Transportation Systems.

[29]  Klaus C. J. Dietmayer,et al.  A random finite set approach for dynamic occupancy grid maps with real-time application , 2016, Int. J. Robotics Res..

[30]  Véronique Berge-Cherfaoui,et al.  Credibilist occupancy grids for vehicle perception in dynamic environments , 2011, 2011 IEEE International Conference on Robotics and Automation.

[31]  Ulrich Hofmann,et al.  Fusion of occupancy grid mapping and model based object tracking for driver assistance systems using laser and radar sensors , 2010, 2010 IEEE Intelligent Vehicles Symposium.