Hostname: page-component-586b7cd67f-t7czq Total loading time: 0 Render date: 2024-11-22T14:46:19.314Z Has data issue: false hasContentIssue false

Cooperative Localisation of AUVs based on Huber-based Robust Algorithm and Adaptive Noise Estimation

Published online by Cambridge University Press:  05 March 2019

Xu Bo
Affiliation:
(College of Automation, Harbin Engineering University, Harbin, China)
Asghar. A. Razzaqi*
Affiliation:
(College of Automation, Harbin Engineering University, Harbin, China)
Liu Yalong
Affiliation:
(China Electronic Technology Group Corporation Twentieth Research Institute)
*

Abstract

In this paper, adaptive noise estimation is used along with a previously proposed Huber-based robust algorithm for cooperative localisation of Autonomous Underwater Vehicles (AUVs). The Huber-based robust cooperative localisation algorithm named Huber-based Iterative Divided Difference Filtering (HIDDF), proposed in our previous work, effectively achieved a robust result against abnormal measurement noise, enhanced the stability of the filtering algorithm and improved the performance of cooperative localisation state estimation. However, its performance could be significantly further improved if it could estimate the system's noise statistical properties online in real time and then adaptively adjust the filtering gain matrix accordingly. In this paper, a novel adaptive noise estimation algorithm is proposed based on a covariance matching method. The proposed algorithm is suitable for adaptively estimating Gaussian and non-Gaussian measurement as well as process noise. The efficacy of the proposed algorithm has been verified through simulation results. In order to further verify the effectiveness of the proposed algorithm in practical systems, lake tests were conducted. Then, based on offline test data, the performance of the cooperative positioning algorithm under dual-pilot and single-pilot schemes was simulated. The advantages and feasibility of the algorithm are analysed and compared through performance comparison. Cooperative localisation accuracy of the previously proposed Huber-based robust algorithm has been enhanced significantly when used with the proposed adaptive noise estimation algorithm.

Type
Research Article
Copyright
Copyright © The Royal Institute of Navigation 2019 

Access options

Get access to the full version of this content by using one of the access options below. (Log in options will check for institutional or personal access. Content may require purchase if you do not have access.)

References

REFERENCES

Fallon, M.F., Papadopoulos, G. and Leonard, J.J. (2010a). A measurement distribution framework for cooperative navigation using multiple AUVs. IEEE International Conference on Robotics and Automation, Anchorage, 42564263, doi: 10.1109/ROBOT.2010.5509869.Google Scholar
Fallon, M.F., Papadopoulos, G., Leonard, J.J., and Patrikalakis, N.M. (2010b). Cooperative AUV Navigation using a Single Maneuvering Surface Craft. The International Journal of Robotics Research, 29(12), 14611474.10.1177/0278364910380760Google Scholar
Fang, J.C. and Yang, S. (2011). Study on innovation adaptive EKF for in-flight alignment of airborne POS. IEEE Transactions on Instrumentation and Measurement, 60(4), 13781388.Google Scholar
Gao, R. and Chitre, M. (2010). Cooperative positioning using range-only measurements between two AUVs. OCEANS'10 IEEE SYDNEY, 16.Google Scholar
Gao, W., Liu, Y., and Xu, B. (2014a). Robust Huber-based iterated divided difference filtering with application to cooperative localization of autonomous underwater vehicles. Sensors (Switzerland), 14(12), 2452324542.10.3390/s141224523Google Scholar
Gao, W., Liu, Y., Xu, B. and Che, Y. (2014b). An Improved Cooperative Localization Method for Multiple Autonomous Underwater Vehicles Based on Acoustic Round-Trip Ranging. PLANS 2014 IEEE/ION, 14201423.10.1109/PLANS.2014.6851518Google Scholar
Hagen, P.E., Størkersen, N., Vestgård, K., Kartvedt, P. and Sten, G. (2003). Operational military use of the HUGIN AUV in Norway, UDT Europe, Sweden, 16.Google Scholar
Hegrenæs, Ø. and Berglund, E. (2009). Doppler Water-Track Aided Inertial Navigation for Autonomous Underwater Vehicle. OCEANS 2009-EUROPE, 110.Google Scholar
Hegrenaes, Ø. and Hallingstad, O. (2011). Model-aided INS with sea current estimation for robust underwater navigation. IEEE Journal of Ocean. Engineering, 36(2), 316337.10.1109/JOE.2010.2100470Google Scholar
Huang, G.P., Trawny, N., Mourikis, A.I. and Roumeliotis, S.I. (2011). Observability-based consistent EKF estimators for multi-robot cooperative localization. Autonomous Robots, 30(1), 99122.10.1007/s10514-010-9207-yGoogle Scholar
Huang, Y., Zhang, Y., Xu, B., Wu, Z. and Chambers, J. (2017a). A New Adaptive Extended Kalman Filter for Cooperative Localization. IEEE Transactions on Aerospace and Electronic System, 9251(c), 114.Google Scholar
Huang, Y., Zhang, Y., Xu, B., Wu, Z. and Chambers, J. (2017b). A new outlier-robust Student's t based Gaussian Approximate Filter for Cooperative Localization. IEEE/ASME Transactions on Mechatronics, 22(5), 23802386.10.1109/TMECH.2017.2744651Google Scholar
Myers, K.A. and Tapley, B.D. (1976). Adaptive Sequential Estimation with Unknown Noise Statistics. IEEE Transactions on Automation and Control, 21(4), 520523.10.1109/TAC.1976.1101260Google Scholar
Kinsey, J.C., Eustice, R. and Whitcomb, L.L. (2006). A Survey of Underwater Vehicle Navigation: Recent Advances and New Challenges. 7th IFAC Conference On Manoeuvring and Control of Marine Craft, Portugal, 88, 112.Google Scholar
Mehra, R.K. (1972). Approaches to Adaptive Filtering. IEEE Transactions on Automation and Control, 17(5), 693698.10.1109/TAC.1972.1100100Google Scholar
Mili, L., Cheniae, M.G., Vichare, N.S. and Rousseeuw, P.J. (1996). Robust State Estimation Based on Projection Systems. IEEE Transactions on Power Systems, 11(2), 11181127.10.1109/59.496203Google Scholar
Newman, P. and Leonard, J. (2003). Pure range-only sub-sea SLAM. IEEE International Conference on Robotics and Automation (Cat. No.03CH37422), Taiwan, 19211926.10.1109/ROBOT.2003.1241875Google Scholar
Paull, L., Saeedi, S., Seto, M. and Li, H. (2014). AUV navigation and localization: A review. IEEE Journal of Ocean Engineering, 39(1), 131149.10.1109/JOE.2013.2278891Google Scholar
Petillot, Y., Maurelli, F., Valeyrie, N., Mallios, A., Ridao, P., Aulinas, J. and Salvi, J. (2010). Acoustic-based techniques for autonomous underwater vehicle localization. Proceedings of Institution of Mechanical Engineers Part M Journal of Engineering For the Maritime Environment, 224(4), 293307.10.1243/14750902JEME197Google Scholar
Plueddemann, A.J., Kukulya, A.L., Stokey, R. and Freitag, L. (2012). Autonomous Underwater Vehicle Operations Beneath Coastal Sea Ice. IEEE-ASME Transactions on Mechatronics, 17(1), 5464.10.1109/TMECH.2011.2174798Google Scholar
Qi, Y., Wang, B., Wang, S., and Fu, M. (2017). Cooperative navigation for multiple autonomous underwater vehicles with time delayed measurements. CGNCC 2016 – 2016 IEEE Chinese Guidance Navigation and Control Conference, 295299.Google Scholar
Roumeliotis, S.I. and Bekey, G.A. (2002). Distributed multirobot localization. IEEE Transactions on Robotics and Automation, 18(5), 781795.10.1109/TRA.2002.803461Google Scholar
Sarkk, S. and Nummenmaa, A. (2009). Recursive noise adaptive Kalman filtering by variational Bayesian approximations. IEEE Transactions on Automation and Control, 54(3), 596600.10.1109/TAC.2008.2008348Google Scholar
Stutters, L., Liu, H., Tiltman, C. and Brown, D.J. (2008). Navigation technologies for autonomous underwater vehicles. IEEE Transactions on Systems, Man and Cybernetics, Part C (Applications and Reviews), 38(4), 581589.10.1109/TSMCC.2008.919147Google Scholar
Tan, Y.T., Gao, R. and Chitre, M. (2014). Cooperative path planning for range-only localization using a single moving beacon. IEEE Journal of Ocean Engineering, 39(2), 371385.10.1109/JOE.2013.2296361Google Scholar
Webster, S.E., Walls, J.M., Whitcomb, L.L. and Eustice, R.M. (2013). Decentralized extended information filter for single-beacon cooperative acoustic navigation: Theory and experiments. IEEE Transactions on Robotics, 29(4), 957974.10.1109/TRO.2013.2252857Google Scholar
Xiao, G., Wang, B., Deng, Z., Fu, M. and Ling, Y. (2017). An Acoustic Communication Time Delays Compensation Approach for Master–Slave AUV Cooperative Navigation. IEEE Sensors Journal, 17(2), 504513.10.1109/JSEN.2016.2631478Google Scholar
Yu, M.J. (2012). INS/GPS integration system using adaptive filter for estimating measurement noise variance. IEEE Transactions on Aerospace and Electronic Systems, 48(2), 17861792.10.1109/TAES.2012.6178100Google Scholar