A Robust Iterative Algorithm for SINS/USBL Integrated Navigation Based on Dual Hydrophone Differential Model

Bo Xu,Haibin Zhu,Yu Guo

DOI: https://doi.org/10.1016/j.measurement.2024.115854

IF: 5.6

2025-01-01

Measurement

Abstract:Aiming at the complex underwater environment which leads to large measurement errors and outliers in ulAiming at the complex underwater environment which leads to large measurement errors and outliers in ultrashort baseline, a robust iterative Kalman filtering algorithm based on the differential model of dual hydrotrashort baseline, a robust iterative Kalman filtering algorithm based on the differential model of dual hydrophones is proposed in this paper. Firstly, to achieve accurate navigation under large initial misalignment angles, phones is proposed in this paper. Firstly, to achieve accurate navigation under large initial misalignment angles, the algorithm builds an inertial navigation error equation based on the right invariant error definition of Lie the algorithm builds an inertial navigation error equation based on the right invariant error definition of Lie groups. Then a dual hydrophone differential model is proposed based on SINS/USBL tightly coupled. It sucgroups. Then a dual hydrophone differential model is proposed based on SINS/USBL tightly coupled. It successfully improves the accuracy of integrated navigation and significantly mitigating the issue of SINS/USBL cessfully improves the accuracy of integrated navigation and significantly mitigating the issue of SINS/USBL positioning accuracy degradation caused by USBL slant distance noise that grows with distance. Finally, a robust positioning accuracy degradation caused by USBL slant distance noise that grows with distance. Finally, a robust iterative Kalman filter based on the dual hydrophone differential model is proposed to counter the threat to the iterative Kalman filter based on the dual hydrophone differential model is proposed to counter the threat to the vehicle's safe operation and the accuracy loss caused by outliers. The algorithm's superiority and effectiveness vehicle's safe operation and the accuracy loss caused by outliers. The algorithm's superiority and effectiveness are verified through simulation and sea trial. are verified through simulation and sea trial.