[論文レビュー] A DVL Aided Loosely Coupled Inertial Navigation Strategy for AUVs with Attitude Error Modeling and Variance Propagation

Jin Huang, Zichen Liu+3 more|arXiv (Cornell University)|Jan 27, 2026

Inertial Sensor and Navigation被引用数 0

ひとこと要約

本論文は、姿勢誤差を考慮したDVL速度変換と共分散に基づく分散伝播を導入し、AUVのSINS/DVL緩結合航法を強化する。シミュレーションと実地試験において長期的な精度向上を示す。

ABSTRACT

In underwater navigation systems, strap-down inertial navigation system/Doppler velocity log (SINS/DVL)-based loosely coupled architectures are widely adopted. Conventional approaches project DVL velocities from the body coordinate system to the navigation coordinate system using SINS-derived attitude; however, accumulated attitude estimation errors introduce biases into velocity projection and degrade navigation performance during long-term operation. To address this issue, two complementary improvements are introduced. First, a vehicle attitude error-aware DVL velocity transformation model is formulated by incorporating attitude error terms into the observation equation to reduce projection-induced velocity bias. Second, a covariance matrix-based variance propagation method is developed to transform DVL measurement uncertainty across coordinate systems, introducing an expectation-based attitude error compensation term to achieve statistically consistent noise modeling. Simulation and field experiment results demonstrate that both improvements individually enhance navigation accuracy and confirm that accumulated attitude errors affect both projected velocity measurements and their associated uncertainty. When jointly applied, long-term error divergence is effectively suppressed. Field experimental results show that the proposed approach achieves a 78.3% improvement in 3D position RMSE and a 71.8% reduction in the maximum component-wise position error compared with the baseline IMU+DVL method, providing a robust solution for improving long-term SINS/DVL navigation performance.

研究の動機と目的

• 姿勢推定のドリフトが速度射影へ与える影響を受ける際の頑健な長期水中航法の必要性を動機づける。
• SINS/DVL緩結合系に対する姿勢誤差対応のDVL速度変換モデルを提案する。
• フレーム間で統計的に一貫したノイズマッピングを実現する共分散行列ベースの分散伝播法を開発する。
• 提案手法をシミュレーションと実機実験で検証する。
• 従来のIMU+DVL解に対して長期的な航法精度と頑健性の改善を示す。

提案手法

• 車両姿勢誤差対応のDVL速度変換モデルを定式化し、射影由来の速度バイアスを低減する。
• DVL速度射影に姿勢誤差項を明示的に含む観測方程式を導出する。
• フレーム間でDVL測定不確かさを伝搬させる共分散伝播アプローチを、共分散行列を介した媒介として開発する。
• 一貫したノイズモデリングを実現するため、期待値ベースの姿勢誤差補償項を導入する。
• 2つの手法：姿勢誤差ベース航法（AE）と共分散伝播（CP）、およびAE+CPの組み合わせを提供する。
• 基準となるIMU+DVLと比較したシミュレーションと野外実験を通じて手法を検証する。

実験結果

リサーチクエスチョン

• RQ1 車両姿勢誤差はSINS/DVL緩結合航法におけるDVL速度射影へどのような影響を与えるのか。
• RQ2 姿勢誤差対応の速度変換は射影バイアスを低減し長期航法精度を改善できるか。
• RQ3 姿勢誤差が存在する場合、DVL測定不確かさを座標系間で一貫して伝搬させるにはどうすればよいか。
• RQ4 AEとCPの手法は、それぞれ単独および併用で、長時間運用下の位置・速度・姿勢推定を改善するか。

主な発見

方法	Pos RMSE (m)	Pos Max (m)	Vel RMSE (m/s)	Vel Max (m/s)	Att RMSE (deg)	Att Max (deg)
IMU+DVL	28.35	49.44	0.039	0.11	0.67	1.70
IMU+DVL (AE)	8.14	16.85	0.032	0.075	0.50	0.79
IMU+DVL (CP)	9.27	14.83	0.017	0.070	0.23	0.31
IMU+DVL (AE+CP)	7.86	12.46	0.017	0.072	0.26	0.30

• 基準のIMU+DVLは顕著な位置誤差とばらつきを示す。
• 姿勢誤差（AE）のみで位置RMSEが28.35 mから8.14 mに、最大誤差が49.44 mから16.85 mに低減。
• 共分散伝播（CP）は位置RMSEを9.27 m、最大を14.83 mへ低減。
• AE+CPは最良の結果を提供し、位置RMSEは7.86 m、最大は12.46 mとなり、速度および姿勢指標も改善。
• 速度のRMSE誤差はIMU+DVLから0.039 m/s→CPおよびAE+CPで0.017 m/sへ、姿勢RMSEはAE+CPで0.26°へ低下。
• 野外実験はシミュレーション結果を裏付け、AE+CP構成で最も低いRMSEと最大位置誤差を示した。