Preliminary Results on 2-D Simultaneous Localization and Mapping for Aerial Robots in Dynamics Environments

This paper presents the design and validation of an Extend Kalman Filter (EKF) for Simultaneous Localization and Mapping with Moving Objects Tracking (SLAMMOT) with application to unmanned aerial vehicles (UAVs) in uncertain and dynamic environments. The proposed solution includes the tracking of Moving Objects (MO) using the Multiple Hypothesis Tracking (MHT) method, as well as the identification of the motion models of the environment’s objects applying the Interacting Multiple Model (IMM) algorithm. The consistency and performance of the devised SLAMMOT filter is successfully confirmed with simulation results.

[1]  X. Rong Li,et al.  A comparative study of multiple-model algorithms for maneuvering target tracking , 2005, SPIE Defense + Commercial Sensing.

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

[3]  Carlos Silvestre,et al.  Globally Asymptotically Stable Sensor-Based Simultaneous Localization and Mapping , 2013, IEEE Transactions on Robotics.

[4]  Y. Bar-Shalom,et al.  The probabilistic data association filter , 2009, IEEE Control Systems.

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

[6]  H. P. Blom.  An efficient filter for abruptly changing systems , 1984, The 23rd IEEE Conference on Decision and Control.

[7]  Chieh-Chih Wang,et al.  Stereo-based simultaneous localization, mapping and moving object tracking , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Anna Freud,et al.  Design And Analysis Of Modern Tracking Systems , 2016 .

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

[10]  Yaakov Bar-Shalom,et al.  Sonar tracking of multiple targets using joint probabilistic data association , 1983 .

[11]  Y. Bar-Shalom,et al.  The interacting multiple model algorithm for systems with Markovian switching coefficients , 1988 .

[12]  Petra Gomez-Krämer,et al.  Detecting and tracking honeybees in 3D at the beehive entrance using stereo vision , 2013, EURASIP J. Image Video Process..

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

[14]  Jean Gallice,et al.  Comparison of Data Association Methods. Application to Road Obstacle Tracking Using a Doppler Effect Radar , 1998 .

[15]  K. G. Murty.  An Algorithm for Ranking All the Assignment in Order of Increasing Cost , 1968 .

[16]  Jitendra Tugnait.  Detection and estimation for abruptly changing systems , 1981, CDC 1981.

[17]  Roy L. Streit,et al.  A comparison of the JPDAF and PMHT tracking algorithms , 1995, 1995 International Conference on Acoustics, Speech, and Signal Processing.

[18]  Anthony F. Genovese.  The interacting multiple model algorithm for accurate state estimation of maneuvering targets , 2001 .

[19]  Trung-Dung Vu,et al.  Grid-based localization and local mapping with moving object detection and tracking , 2011, Inf. Fusion.