Abstract:Applications of the particle filter(PF) and Rao-Blackwellised particle filter(RBPF) to AUV(autonomous underwater vehicle) integrated navigation are discussed.The specific mathematical model for implementation of the integrated navigation method on AUV is presented.And those methods are compared with the extended Kalman filter(EKF).The results of AUV navigation experiment at Qiandao Lake show that the method based on RBPF can provide the best navigation performance.However,algorithm analysis shows that this method requires more computational effort compared with the other two filter algorithms.
[1] Fiorelli E,Leonard N E,Bhatta P,et al.Multi-AUV control and adaptive sampling in Monterey bay[J].IEEE Transactions on Oceanic Engineering,2008,31(4):935-948.
[2] Ura T,Kojima J,Nakano T,et al.Experimental result of AUVbased acoustic tracking system of sperm whales[C]//OCEANS.Piscataway,NJ,USA:IEEE,2007:1-5.
[3] Kobayashi M,Ando T,Honda M,et al.System design of an autonomous underwater robot 'DaryaBird'[C/OL]//AUVSI& ONR's 13th International Autonomous Underwater Vehicle Competition.2010:1-7.[2010-07-13].http://www.auvsi.org/.
[4] Leonard J J,Bennett A A,Smith C M,et al.Autonomous underwater vehicle navigation[R].Massachusetts,MA,USA:MIT Marine Robotics Laboratory,1998.
[5] Manolakis D G,Ingle V K,Kogon S M.Statistical and adaptive signal processing:Spectral estimation,adaptive filtering and array processing[M].Norwood,MA,USA:Artech,2000:378-387.
[6] Zhang B,Xu W,Chen Q,et al.Extended Kalman filter-based data fusion for inertial-Doppler AUV navigation[C]//IEEE/OES 6th International Symposium on Underwater Technology.Piscataway,NJ,USA:IEEE,2009:227-232.
[7] 李良群,姬红兵,罗军辉.迭代扩展卡尔曼粒子滤波器[J].西安电子科学大学学报:自然科学版,2007,34(2):233-238.Li L Q,Ji H B,Luo J H.Iterated extended Kalman particle filtering[J].Journal of Xidian University:Natural Science,2007,34(2):233-238.
[8] Sun F,Xu W,Li J L,et al.Enhancement of the aided inertial navigation system for an AUV via micronavigation[C]//OCEANS.Piscataway,N J,USA:IEEE,2010:1-4.
[9] Nordlund P J,Gustafsson E Sequential Monte Carlo filtering techniques applied to integrated navigation systems[C]//American Control Conference.Piscataway,NJ,USA:IEEE,2001:4375-4380.
[10] Gordon N J,Salmond D J,Smith A F M.Novel approach to nonlinear/non-Gaussian Bayesian state estimation[C]//IEE Proceedings on Radar and Signal Processing.Piscataway,NJ,USA:IEEE,1993,140:107-113.
[11] Doucet A,Godsill S J,Andrieu C.On sequential Monte Carlo sampling methods for Bayesian filtering[J].Statistics and Computing,2000,10(3):197-208.
[12] Arulampalam M S,Maskell S,Gordon N,et al.A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking[J].IEEE Transactions on Signal Processing,2002,50(2):174-188.
[13] Bergman N.Recursive Bayesian estimation:Navigation and tracking applications[D].Link(o)ping,Sweden:Link(o)ping University,1999.
[14] Doucet A.On sequential Monte Carlo methods for Bayesian filtering[R].Cambridge,UK:University of Cambridge,1998.
[15] 杨丽丽.基于粒子滤波器的大尺度环境下水下机器人的自主导航定位[D].青岛:中国海洋大学,2009.Yang L L.Localization and map building based on particle filter in large environment for an AUV[D].Qingdao:Ocean University of China,2009.