×

Robust particle filter formulations with application to terrain-aided navigation. (English) Zbl 1369.93654

Summary: The work described in this paper is motivated by the need to develop efficient and robust estimation filters with application to terrain-aided navigation of underwater robotic vehicles. One of the main problems addressed is the development of navigation particle filters that can deal with the scarcity of landmarks and the terrain ambiguity that characterize vast regions of the ocean floor. As a contribution to solve this problem, the paper proposes three novel particle filter algorithms and assesses their estimation efficiency and robustness to non-informative measurements using two well-known benchmarking tests. The performance of the new filters in these tests demonstrates their potential to solve a class of nonlinear problems that include, but are not limited to, the type of underwater navigation problem that motivated the present work. Our study concludes by examining the performance of the filters in terms of determining the position and velocity of an autonomous underwater vehicle in the presence of unknown ocean currents. When applied to terrain-aided navigation, the novel particle filter formulations formulations mitigate filter divergence issues frequently caused by terrain symmetries and are more robust than other well-known versions when used in scenarios with poor terrain information. The theoretical developments presented and the results obtained in simulations are validated using real data acquired during tests with an autonomous marine robot.

MSC:

93E11 Filtering in stochastic control theory
93E10 Estimation and detection in stochastic control theory
93C85 Automated systems (robots, etc.) in control theory
93C10 Nonlinear systems in control theory

Software:

sm
Full Text: DOI

References:

[1] BarkbyS, WilliamsSB, PizarroO, JakubaMV. A featureless approach to efficient bathymetric SLAM using distributed particle mapping. Journal of Field Robotics2011; 28(1):19-39. · Zbl 1243.68283
[2] ArulampalamS, MaskellS, GordonNJ, ClappT. A tutorial on particle filters for on‐line nonlinear/non‐Gaussian Bayesian tracking. IEEE Transactions on Signal Processing2002; 50(2):174-188.
[3] RisticB, ArulampalamS, GordonNJ. Beyond the Kalman Filter ‐ Particle Filters for Tracking Applications. Artech House, 2004. · Zbl 1092.93041
[4] EkütekinV. Navigation and control studies on Cruise missiles. Middle East Technical University: PhD Thesis, 2007.
[5] HollowellJ. HELI/SITAN: A terrain referenced navigation algorithm for helicopters. Position Location and Navigation Symposium, 1990. The 1990’s ‐ A Decade of Excellence in the Navigation Sciences. IEEE PLANS ’90. IEEE, Las Vegas, NV, USA, 1990; 616-625.
[6] BergmanN, LjungL, GustafssonF. Terrain navigation using Bayesian statistics. IEEE Control Systems Magazine1999; 19(3):33-40.
[7] RiceH, MendelsohnL, AaronsR, MazzolaD. Next generation marine precise navigation system. IEEE Position Location and Navigation Symposium. PLANS 2000, PLANS IEEE Position, San Diego, CA, USA, 2000; 200-206.
[8] RiceH, KelmensonS, MendelsohnL. Geophysical navigation technologies and applications. IEEE Position Location and Navigation Symposium. PLANS’04, Monterey, California, USA, 2004; 618-624.
[9] NygrenI, JanssonM. Terrain navigation for underwater vehicles using the correlator method. IEEE Journal of Oceanic Engineering2004; 29(3):906-915.
[10] NygrenI. Terrain navigation for underwater vehicles. PhD Thesis, Royal Institute of Technology, Sweden, 2005.
[11] CarrenoS, WilsonP, RidaoP, PetillotY. A survey on terrain based navigation for AUVs. OCEANS 2010. IEEE, Seattle, WA, 2010; 1752-1758.
[12] MeloJ, MatosA. On the use of particle filters for terrain based navigation of sensor‐limited AUVs. OCEANS 2013 MTS/IEEE. IEEE, Bergen, 2013; 294-301.
[13] JalvingB, MandtM, HagenOK. Terrain referenced navigation of AUVs and submarines using multibeam echo sounders. Undersea Defence Technology Conference ‐ UDT Europe 2004, Nice, France, 2004; 1-10.
[14] NygrenI. Robust and efficient terrain navigation of underwater vehicles. IEEE/ION Position, Location and Navigation Symposium (PLANS’ 2008), IEEE, Monterey, CA, 2008; 923-932.
[15] MoriceC, VeresS, McphailS. Terrain referencing for autonomous navigation of underwater vehicles. Oceans 2009, Europe, Bremen, 2009; 441-447.
[16] MedunaDK, RockSM, McEwenR. Low‐cost terrain relative navigation for long‐range AUVs. OCEANS’2008. MTS/IEEE Oceans Conf., Quebec, CA, 2008; 1643-1649.
[17] MedunaD, RockS, McewenR. Closed‐loop terrain relative navigation for AUVs with non‐inertial grade navigation sensors. Autonomous Underwater Vehicles (AUV), 2010, IEEE/OES, vol. 2010, Monterey, CA; 1-8.
[18] MedunaD. Terrain relative navigation for sensor‐limited systems with application to underwater vehicles. PhD Thesis, Stanford, 2011.
[19] AnonsenKB, HagenOK. An analysis of real‐time terrain aided navigation results from a HUGIN AUV. OCEANS 2010 IEEE‐MTS Conference, IEEE, Seattle, WA, 2010; 1431-1439.
[20] HagenOK, AnonsenKB, MandtM. The HUGIN real‐time terrain navigation system. OCEANS 2010 IEEE‐MTS Conference, IEEE, Seattle, WA, 2010; 950-956.
[21] AnonsenKB, HagenOK, HegrenaesO, HagenPE. The HUGIN AUV terrain navigation module. OCEANS 2013 IEEE‐MTS Conference, IEEE, San Diego, CA, 2013; 1966-1973.
[22] HagenOK, AnonsenKB, SaeboT. Low altitude AUV terrain navigation using an interferometric sidescan sonar. OCEANS 2011, IEEE, Waikoloa, HI, 2011; 2649-2656.
[23] DonovanG. Position error correction for an autonomous underwater vehicle inertial navigation system (INS) using a particle filter. IEEE Journal of Oceanic Engineering2012; 37(3):431-445.
[24] BergmanN. Recursive Bayesian estimation ‐ navigation and tracking applications. PhD Thesis, Linköping University, Sweden, 1999.
[25] GustafssonF, GunnarssonF, BergmanN, ForssellU, JanssonJ, KarlssonR, Nordlund P‐J. Particle filters for positioning, navigation and tracking. IEEE Transactions on Signal Processing2002; 50(2):425-437.
[26] NordlundPJ. Sequential Monte Carlo filters and integrated navigation. Licenciate thesis, Linköpings University, Sweden, 2002.
[27] FrykmanP. Applied particle filters in integrated aircraft navigation. MSc thesis, Linköpings Universitet, Sweden, 2003.
[28] ShidanL, LiguoS, XinL, DeshengW. Research on an improved terrain aided positioning model. Journal of Software2011; 6(5):937-943.
[29] NordlundPJ, GustafssonF. Research on an improved terrain aided positioning model. In LiTH‐ISY‐R‐2870, Linköpings Universitet, Sweden, 2008.
[30] AnonsenKB, HallingstadO. Terrain aided underwater navigation using point mass and particle filters. IEEE/ION Position Location and Navigation Symposium, San Diego, CA, 2006; 1027-1035.
[31] KarlssonR, GustafssonF, KarlssonT. Particle filtering and Cramér‐Rao lower bound for underwater navigation. 2003 International Conference on Acoustics, Speech, and Signal Processing (ICASSP’03), Hong‐Kong, 2003; VI-65-68.
[32] MussoC, OudjaneN. Recent particle filter applied to terrain navigation. Third International Conference on Information Fusion, 2000. FUSION 2000, IEEE, Paris, France, 2000; 26-33.
[33] MussoC, OudjaneN, Le GlandF, Improving regularised particle filters. In Sequential Monte Carlo Methods in Practice, DoucetA (ed.), deFreitasN (ed.), GordonNJ (ed.) (eds). Springer‐Verlag: New York, 2001.
[34] CasarinR. Online data processing: Comparison of Bayesian regularized particle filters. Electronic Journal of Statistics2009; 3:239-258. · Zbl 1267.65008
[35] FlamentM, FleuryG, DavoustME. Particle filter and Gaussian‐mixture filter efficiency evaluation for terrain‐aided navigation. 12th European Signal Processing Conference (EUSIPCO‐2004). EURASIP, Vienna, Austria, 2004; 605-608.
[36] TeixeiraFC. Terrain‐aided navigation and geophysical navigation of autonomous underwater vehicles. PhD Thesis, Instituto Superior Técnico, Lisboa, 2007.
[37] MurangiraA, MussoC, DahiaK, AllardJM. Robust regularized particle filter for terrain navigation. 14th International Conference on Information Fusion (FUSION’2011), IEEE, Chicago, IL, 2011; 890-897.
[38] DonovanG. Development and testing of a real‐time terrain navigation method for AUVs. OCEANS 2011, IEEE, Waikoloa, HI, 2011; 420-428.
[39] MurangiraA, MussoC, NikiforovI. Particle filter divergence monitoring with application to terrain navigation. 15th International Conference on Information Fusion (FUSION 2012), Vol. 2012, IEEE, Singapore, 2012; 794-801.
[40] ZhangK, LiY, ZhaoJ, RizosC. A study of underwater terrain navigation based on the robust matching method. Journal of Navigation2014; 67(4):569-578.
[41] HoutsSE, DektorSG, RockSM. A robust framework for failure detection and recovery for terrain‐relative navigation. Unmanned Untethered Submersible Technology 2013, Portsmouth, NH, 2013; 189-195.
[42] ZhaoB, SkjetneR, BlankeM, DukanF. Particle filter for fault diagnosis and robust navigation of underwater robot. IEEE Transactions on Control Systems Technology2014; 22(6):2399-2407.
[43] TeixeiraFC, QuintasJ, PascoalA. AUV terrain‐aided Doppler navigation using complementary filtering. 9th IFAC Conference on Manoeuvring and Control of Marine Craft (MCMC‐2012), Arenzano, Italy, 2012; 313-318.
[44] LiuJS, ChenR. Sequential Monte Carlo methods for dynamic systems. Journal of the American Statistical Association1998; 93(443):1032-1044. · Zbl 1064.65500
[45] CappéO, GodsillSJ, MoulinesE. An overview of existing methods and recent advances in sequential Monte Carlo. Proceedings of the IEEE2007; 95(5):899-924.
[46] HoY, LeeR. A Bayesian approach to problems in stochastic estimation and control. IEEE Transactions on Automatic Control1964; AC‐9(4):333-339.
[47] TannerMA. Tools for Statistical Inference, Springer series on statistics. Springer ‐Verlag: New York, 1996. · Zbl 0846.62001
[48] ChopinN. Central limit theorem for sequential Monte Carlo methods and its applications to Bayesian inference. Annals of Statistics2004; 32(6):2385-2411. · Zbl 1079.65006
[49] RipleyB. Stochastic Simulation. John Wiley and Sons: New York, 1987. · Zbl 0613.65006
[50] TanizakiH. Computational Methods in Statistics and Econometrics. Marcel Dekker Inc.: New York, 2004. · Zbl 1054.62001
[51] KongA, LiuJS, WongWH. Sequential imputations and Bayesian missing data problems. Journal of the American Statistical Association1994; 89(425):278-288. · Zbl 0800.62166
[52] GordonNJ, SalmondD, SmithAFM. Novel approach to nonlinear/non‐Gaussian Bayesian state estimation. IEE Proceedings ‐ Radar and Signal Processing1993; 140(2):107-113.
[53] DoucetA, GodsillS, AndrieuC. On sequential Monte Carlo sampling methods for Bayesian filtering. Statistics and Computing2000; 10(3):197-208.
[54] GustafssonF. Particle filter theory and practice with positioning applications. IEEE A & E Systems Magazine2010; 25(7):53-81.
[55] PittM, ShephardN. Filtering via simulation: auxiliary particle filters. Journal of the American Statistical Association1999; 94(446):590-599. · Zbl 1072.62639
[56] HolJD, SchönTB, GustafssonF. On resampling algorithms for particle filters. Nonlinear Statistical Signal Processing Workshop, Cambridge, United Kingdom, 2006; 79-82.
[57] YuJX, TangYL, ChenXC, ZhaoQ. An adaptive resampling strategy in particle filter. Int Conf. on Wavelet Analysis and Pattern Recognition, Guilin, 2011; 144-149.
[58] BachmannA, WilliamsS. Outlier handling when using particle filters in terrain‐aided navigation. IAV2004 ‐ 5th IFAC Symposium on Intelligent Autonomous Vehicles, Lisbon, 2004; 359-364.
[59] TeixeiraFC, PascoalA, MauryaP. A novel particle filter formulation with application to terrain‐aided navigation. IFAC Workshop on Navigation Guidance and Control of Underwater Vehicles (NGCUV’2012), Porto, Portugal, 2012; 132-139.
[60] ThrunS, BurgardW, FoxD. Probabilistic Robotics. MIT Press: Cambridge, MA, USA, 2005. · Zbl 1081.68703
[61] ThrunS, FoxD, BurgardW. Monte Carlo localization with mixture proposal distribution. National Conference on Artificial Inteligence, AAAI, Austin, TX, 2000; 859-865.
[62] PapoulisA. Probability, Random Variables, and Stochastic Processes. McGraw‐Hill: New York, 1965. · Zbl 0191.46704
[63] PaulinoCD, TurkmanMAA, MurteiraB. Estatstica Bayesiana. Fundação Calouste Gulbenkian: Lisbon, 2003; 1386-1396.
[64] RobertCP, ChopinN, RousseauJ. Harold Jeffreys’s theory of probability revisited. Statistical Science2009; 24(2):141-172. · Zbl 1328.62012
[65] KaySM. Fundamentals of Statistical Signal Processing: Estimation Theory. Prentice Hall: Upper Saddle River, NJ, USA, 1993. · Zbl 0803.62002
[66] KotechaJ, DjuricPM. Gaussian particle filtering. IEEE Transactions on Signal Processing2003; 51(10):2592-2601. · Zbl 1369.94195
[67] GilksWR, BerzuiniC. Following a moving target ‐ Monte Carlo inference for dynamic Bayesian models. Journal of the Royal Statistical Society2001; 63 B(1):127-146. · Zbl 0976.62021
[68] HeijdenFvd. Consistency checks for particle filters. IEEE Transactions on Pattern Analysis and Machine Intelligence2006; 28(1):140-145.
[69] HamiltonJD. A new approach to the economic analysis of nonstationary time series and the business cycle. Econometrica1989; 57(2):357-384. · Zbl 0685.62092
[70] BowmanAW, AzzaliniA. Applied Smoothing Techniques for Data Analysis : the Kernel approach with S‐Plus Illustrations. Oxford University Press: New York, USA, 1997. · Zbl 0889.62027
[71] LinX, KirubarajanT, Bar‐ShalomY, MaskellS, Comparison of EKF, pseudomeasurement, and particle filters for a bearing‐only target tracking problem. In Signal and Data Processing of Small Targets 2002, DrummondOE (ed.) (ed.)., SPIE ‐ International Society for Optics and Photonics, vol. 4728: Bellingham, Washington, USA, 2002; 240-250.
[72] FarinaA. Target tracking with bearings‐only measurements. Signal Processing1999; 78:61-78. · Zbl 1025.93031
[73] TichavskyP, MuravchikCH, NehoraiA. Posterior Cramér‐Rao bounds for discrete‐time nonlinear filtering. IEEE Transactions on Signal Processing1998; 46(5).
[74] Van TreesHL. Detection, Estimation, and Modulation Theory. John Wiley & Sons: New York, 1968. · Zbl 0202.18002
[75] ZuoL. Conditional Posterior Cramér‐Rao Lower Bound and Distributed Target Tracking in Sensor Networks. Phd Thesis, Syracuse University, 2011.
[76] TeixeiraFC, QuintasJ, MauryaP, PascoalA. Novel particle filters with application to Terrain‐Aided Navigation. In GEONAV‐01‐2016, Instituto Superior Tecnico, Univ. of Lisbon, 2016.
[77] BlackwellD. Conditional expectation and unbiased sequential estimation. Annals of Mathematical Statistics1947; 18(1):105-110. · Zbl 0033.07603
[78] NordlundPJ, GustafssonF. Marginalized particle filter for accurate and reliable terrain‐aided navigation. IEEE Transactions on Aerospace and Electronic Systems2009; 5(4):1385-1399.
[79] PascoalA, OliveiraP, SilvestreC, SebastiãoL, RufinoMC, BarrosoV, GomesJ, PascoalA, OliveiraP, SilvestreC, other. Robotic ocean vehicles for marine science applications: the Europen ASIMOV project. OCEANS 2000 MTS/IEEE Conference and Exhibition, Vol. 1, Providence, RI, USA, 2000; 409-415.
This reference list is based on information provided by the publisher or from digital mathematics libraries. Its items are heuristically matched to zbMATH identifiers and may contain data conversion errors. In some cases that data have been complemented/enhanced by data from zbMATH Open. This attempts to reflect the references listed in the original paper as accurately as possible without claiming completeness or a perfect matching.