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

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.

Authors:

• Il Young Song
• Du Yong Kim
• Vladimir Shin

Keywords:

• Distributed fusion
• fusion formula
• Kalman filter
• multisensor
• receding horizon
• wheeled mobile robot

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.