Factor Graph Based SINS/DVL Integrated Navigation Method of AUV with Sparse Beacon Measurement

Jiarui Cui,Wenqi Wu,Maosong Wang,Xianfei Pan,Dongyao Yu
DOI: https://doi.org/10.1007/978-981-19-6613-2_547
2023-01-01
Abstract:Strapdown inertial navigation system (SINS) and doppler velocity log (DVL) integration generate continuous position information for the auto-nomous underwater vehicle (AUV). The beacon deployed on the sea bed or floating on the sea surface is used to provide position measurement for the AUV navigation system, however, the measurements are sometimes sparse during the mission of AUV, which brings a challenge for long time AUV navigation accuracy, in addition with the occasional outliers in the output of DVL. The popular Kalman filter-based integrated navigation method only estimates the current state, which limits its all-run positioning precision. In this paper, we propose a factor graph-based SINS/DVL integration navigation algorithm to deal with the sparse measurement problem, which is able to estimate and linearize the several recent states of AUV by reutilizing history information, resulting in smoother and more accurate positioning result. A simulation and experiment are conducted to compare the Kalman filter-based Rauch-Tung-Striebel smoother and factor graph optimization, which shows better performance in the position estimation of AVU under sparse measurement conditions, as well with DVL outliers.
What problem does this paper attempt to address?