Localization of Non-Linearly Modeled Autonomous Mobile Robots Using Out-of-Sequence Measurements

This paper presents a state of the art of the estimation algorithms dealing with Out-of-Sequence (OOS) measurements for non-linearly modeled systems. The state of the art includes a critical analysis of the algorithm properties that takes into account the applicability of these techniques to autonomous mobile robot navigation based on the fusion of the measurements provided, delayed and OOS, by multiple sensors. Besides, it shows a representative example of the use of one of the most computationally efficient approaches in the localization module of the control software of a real robot (which has non-linear dynamics, and linear and non-linear sensors) and compares its performance against other approaches. The simulated results obtained with the selected OOS algorithm shows the computational requirements that each sensor of the robot imposes to it. The real experiments show how the inclusion of the selected OOS algorithm in the control software lets the robot successfully navigate in spite of receiving many OOS measurements. Finally, the comparison highlights that not only is the selected OOS algorithm among the best performing ones of the comparison, but it also has the lowest computational and memory cost.

[1]  Xuan Liu,et al.  Efficient delay-tolerant particle filtering through selective processing of out-of-sequence measurements , 2010, 2010 13th International Conference on Information Fusion.

[2]  Yuanqing Xia,et al.  Analysis and Synthesis of Networked Control Systems , 2011 .

[3]  Yunmin Zhu,et al.  Optimal Distributed Fusion Update with Same Lag Time Out-of-Sequence Measurements , 2008, 2008 IEEE Conference on Robotics, Automation and Mechatronics.

[4]  Yaakov Bar-Shalom,et al.  Update with out-of-sequence measurements in tracking: exact solution , 2000, SPIE Defense + Commercial Sensing.

[5]  Radford M. Neal.  Pattern Recognition and Machine Learning , 2007, Technometrics.

[6]  Bruno Sinopoli,et al.  Kalman filtering with intermittent observations , 2004, IEEE Transactions on Automatic Control.

[7]  S. Coraluppi,et al.  Advances in asynchronous and decentralized estimation , 2001, 2001 IEEE Aerospace Conference Proceedings (Cat. No.01TH8542).

[8]  Juan A. Besada,et al.  Multisensor fusion for linear control systems with asynchronous, Out-Of-Sequence and erroneous data , 2011, Autom..

[9]  Orton,et al.  Incorporation of out-of-sequence measurements in non-linear dynamic systems using particle filters , 2002 .

[10]  Thiagalingam Kirubarajan,et al.  Out-of-sequence measurement processing for tracking ground target using particle filters , 2002, Proceedings, IEEE Aerospace Conference.

[11]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[12]  Ali T. Alouani,et al.  On optimal asynchronous track fusion , 1996, Proceeding of 1st Australian Data Fusion Symposium.

[13]  Akiva Novoselsky,et al.  Track to track fusion using out-of-sequence track information , 2007, 2007 10th International Conference on Information Fusion.

[14]  Y. Bar-Shalom,et al.  Multi-sensor multi-target tracking using out-of-sequence measurements , 2002, Proceedings of the Fifth International Conference on Information Fusion. FUSION 2002. (IEEE Cat.No.02EX5997).

[15]  Petros G. Voulgaris,et al.  On optimal ℓ∞ to ℓ∞ filtering , 1995, Autom..

[16]  Avinash C. Kak,et al.  Vision-guided mobile robot navigation using retroactive updating of position uncertainty , 1993, [1993] Proceedings IEEE International Conference on Robotics and Automation.

[17]  A. Marrs,et al.  Particle filters for tracking with out-of-sequence measurements , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[18]  Alberto Sanfeliu,et al.  Integrating asynchronous observations for mobile robot position tracking in cooperative environments , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Yuanqing Xia,et al.  Networked Data Fusion With Packet Losses and Variable Delays , 2009, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[20]  B. Sonnerup,et al.  Vortex laws and field line invariants in polytropic field-aligned MHD flow , 1994 .

[21]  Hobart R. Everett,et al.  Sensors for Mobile Robots , 1995 .

[22]  Xinbo Gao,et al.  Single-step-lag OOSM algorithm based on unscented transformation , 2011, Science China Information Sciences.

[23]  Paulo Oliveira,et al.  Study and implementation of an EKF GIB-based underwater positioning system , 2004 .

[24]  Jun S. Liu,et al.  Metropolized independent sampling with comparisons to rejection sampling and importance sampling , 1996, Stat. Comput..

[25]  Y. Bar-Shalom,et al.  A two-step method for out-of-sequence measurements , 2004, 2004 IEEE Aerospace Conference Proceedings (IEEE Cat. No.04TH8720).

[26]  Yuanqing Xia,et al.  Analysis and Synthesis of Dynamical Systems with Time-Delays , 2009 .

[27]  José Antonio López Orozco,et al.  An Asynchronous, Robust, and Distributed Multisensor Fusion System for Mobile Robots , 2000, Int. J. Robotics Res..

[28]  Y. Bar-Shalom,et al.  One-step solution for the multistep out-of-sequence-measurement problem in tracking , 2004, IEEE Transactions on Aerospace and Electronic Systems.

[29]  Huimin Chen,et al.  One-step solution for the general out-of-sequence-measurement problem in tracking , 2002, Proceedings, IEEE Aerospace Conference.

[30]  Abder Rezak Benaskeur,et al.  Forward prediction-based approach to target-tracking with Out-of-Sequence Measurements , 2008, 2008 47th IEEE Conference on Decision and Control.

[31]  D.P. Atherton,et al.  Maneuvering target tracking using adaptive turn rate models in the interacting multiple model algorithm , 1995, Proceedings of 35th IEEE Conference on Decision and Control.

[32]  Feng Xue,et al.  Out-of-Sequence Measurements Processing Based on Unscented Particle Filter for Passive Target Tracking in Sensor Networks , 2006, 2006 8th international Conference on Signal Processing.

[33]  Nando de Freitas,et al.  Toward Practical N2 Monte Carlo: the Marginal Particle Filter , 2005, UAI.

[34]  E. Besada-Portas,et al.  Multisensor Out-Of-Sequence Data Fusion for Estimating the State of Dynamic Systems , 2007, 2007 Information, Decision and Control.

[35]  Yaakov Bar-Shalom,et al.  Estimation and Tracking: Principles, Techniques, and Software , 1993 .

[36]  Simon J. Godsill,et al.  On sequential Monte Carlo sampling methods for Bayesian filtering , 2000, Stat. Comput..

[37]  A. Marrs,et al.  A Bayesian approach to multi-target tracking and data fusion with out-of-sequence measurements , 2001 .

[38]  Xuan Liu,et al.  Efficient Delay-Tolerant Particle Filtering , 2011, IEEE Transactions on Signal Processing.

[39]  Klaus C. J. Dietmayer,et al.  Reliable automotive pre-crash system with out-of-sequence measurement processing , 2010, 2010 IEEE Intelligent Vehicles Symposium.

[40]  Subhash Challa,et al.  Sensor fusion-based visual target tracking for autonomous vehicles with the out-of-sequence measurements solution , 2008, Robotics Auton. Syst..

[41]  Charles E. Heckler,et al.  Applied Multivariate Statistical Analysis , 2005, Technometrics.

[42]  K. Dietmayer,et al.  DATA SYNCHRONIZATION STRATEGIES FOR MULTI-SENSOR FUSION , 2003 .

[43]  Masaki Yamakita,et al.  Ensemble Kalman filter for multisensor fusion with multistep delayed measurements , 2011, 2011 Aerospace Conference.

[44]  Jesús Manuel de la Cruz García,et al.  Versatile sensing architecture for autonomous mobile robots , 2002 .

[45]  G. Evensen.  Sequential data assimilation with a nonlinear quasi‐geostrophic model using Monte Carlo methods to forecast error statistics , 1994 .

[46]  Juan A. Besada,et al.  Multisensor Out of Sequence Data Fusion for Estimating the State of Discrete Control Systems , 2009, IEEE Transactions on Automatic Control.

[47]  Hobart R. Everett,et al.  Sensors for Mobile Robots: Theory and Application , 1995 .

[48]  Nando de Freitas,et al.  The Unscented Particle Filter , 2000, NIPS.

[49]  Fredrik Gustafsson,et al.  Storage efficient particle filters for the out of sequence measurement problem , 2008, 2008 11th International Conference on Information Fusion.

[50]  J.E. Gray,et al.  Theory of distributed estimation using multiple asynchronous sensors , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[51]  Subhash Challa,et al.  Track-to-track fusion of out-of-sequence tracks , 2002, Proceedings of the Fifth International Conference on Information Fusion. FUSION 2002. (IEEE Cat.No.02EX5997).

[52]  João Pedro Hespanha,et al.  A Survey of Recent Results in Networked Control Systems , 2007, Proceedings of the IEEE.

[53]  Yaakov Bar-Shalom,et al.  Nonlinear out-of-sequence measurement filtering with applications to GMTI tracking , 2002, SPIE Defense + Commercial Sensing.