Receding Horizon Filtering for Mobile Robot Systems with Cross-Correlated Sensor Noises

Authors: Il Young Song, Du Yong Kim, Vladimir Shin

Abstract:

This paper reports on a receding horizon filtering for mobile robot systems with cross-correlated sensor noises and uncertainties. Also, the effect of uncertain parameters in the state of the tracking error model performance is considered. A distributed fusion receding horizon filter is proposed. The distributed fusion filtering algorithm represents the optimal linear combination of the local filters under the minimum mean square error criterion. The derivation of the error cross-covariances between the local receding horizon filters is the key of this paper. Simulation results of the tracking mobile robot-s motion demonstrate high accuracy and computational efficiency of the distributed fusion receding horizon filter.

Keywords: Distributed fusion, fusion formula, Kalman filter, multisensor, receding horizon, wheeled mobile robot

Digital Object Identifier (DOI): doi.org/10.5281/zenodo.1073497

References:

[1] J. P. Laumond, Robot Motion Planning and Control. http://www.laas.fr/˜jpl/book.html: Springer-Verlag, 1998.
[2] W. Burgard, D. Fox, and S. Thrun, Active mobile robot localization by entropy minimization, in Proc. of the Second Euromicro Workshop on Advanced Mobile Robotics, 1997.
[3] N. Roy, W. Burgard, D. Fox, and S. Thrun, Coastal navigation mobile robot navigation with uncertainty in dynamic environments, In Proc. of the ICRA, 1999.
[4] M. Ribo, S. Brahim-Belhouari, and L. Pronzato, Motion planning for the precise location of a mobile robot, In Proc. of European Control Conf., Brussels, Belgium, 1997..
[5] A. Mutambara, Decentralized Estimation and Control for. In: Multisensor Systems. CRC Press, 1998.
[6] E. Song, Y. zhu, J. Zhou and Z. You, Optimal Kalman filtering fusion with cross-correlated sensor noises, Automatica, Vol. 43, pp. 1450-1456, 2007.
[7] W. H. Kwon, P. S. Kim, and P. Park, A receding horizon Kalman FIR filter for linear continuous-time systems, IEEE Trans. on Automatic Control, Vol. 44, No. 11, pp. 2115-2120, 1999.
[8] D. Y. Kim and V. Shin, Optimal Receding Horizon Filter for Continuous-Time Nonlinear Stochastic Systems, Proc. 6th WSEAS Inter. Conf. on Signal Processing, Dallas, Texas, USA, pp. 112-116, 2007.
[9] D. Y. Kim, V. Shin, An Optimal Receding Horizon FIR Filter for Continuous-Time Linear Systems, Proceedings Intern. Conf. "SICE-ICCAS", Busan, Korea, pp. 263-265, 2006.
[10] V. Shin, Y. Lee and T-S. Choi, Generalized Millman's formula and its applications for estimation problems, Signal Processing, Vol. 86, No.2, pp. 257-266, 2006.
[11] W. H. Kwon, K. S. Lee, and O. K. Kwon, Optimal FIR filters for time-varying state-space models, IEEE Trans. on Aerospace and Electronic Systems, Vol. 26, pp.1011-1021, 1990.
[12] Zhou, J., Zhu, Y., You, Z. and E. Song., An efficient algorithm for optimal linear estimation fusion in distributed multisensory systems, IEEE Trans. Syst., Man, Cybern., Vol. 36, No. 5, pp. 1000-1009, 2006.
[13] V.Shin, G.Shevlyakov, K.Kim, A New Fusion Formula and Its Application to Continuous-Time Linear Systems with Multisensor Environment, Computational Statistics & Data Analysis, Vol. 52, Issue 2, pp. 840-854, 2007.
[14] Y. J. Kanayama, Y. Kimura, F. Miyazaki and T. Noguchi, A stable tracking control method for an autonomous mobile robot, In Proc. IEEE Int. Conf. Robot. Autom. pp. 384-389, 1990.
[15] J. E. Normey-Rico, J. Gomez-Ortega, E. F. Camacho, A Smith-predictor-based generalized predictive controller for mobile robot path-tracking, Control Engineering Practice, Vol.7, Issue 6, pp. 729- 740, 1999.
[16] D. Gu and H. Hu, Neural predictive control for a car-like mobile robot, International Journal of Robotics and Autonomous Systems, Vol.39, Issue 2, pp. 73-86, 2002.
[17] V. S. Pugachev and I. N. Sinitsyn, Stochastic Differential Systems: Analysis and Filtering, JohnWiley & Songs, N.Y., 1987.