多様体上のアンセンテッドカルマンフィルタによるAUV航法 — 実験結果
Unscented Kalman Filtering on Manifolds for AUV Navigation -- Experimental Results
AUVの慣性航法に多様体上のUKFを適用し、DVL・深度・音響測距・GPSを統合。外れ値除去を加え、実機でリアルタイム動作と大きな初期方位誤差からの収束を実証した。
著者: Stephen T. Krauss, Daniel J. Stilwell
分類: cs.RO, cs.SY, eess.SY
原文アブストラクト
In this work, we present an aided inertial navigation system for an autonomous underwater vehicle (AUV) using an unscented Kalman filter on manifolds (UKF-M). The inertial navigation estimate is aided by a Doppler velocity log (DVL), depth sensor, acoustic range and, while on the surface, GPS. The sensor model for each navigation sensor on the AUV is explicitly described, including compensation for lever arm offsets between the IMU and each sensor. Additionally, an outlier rejection step is proposed to reject measurement outliers that would degrade navigation performance. The UKF-M for AUV navigation is implemented for real-time navigation on the Virginia Tech 690 AUV and validated in the field. Finally, by post-processing the navigation sensor data, we show experimentally that the UKF-M is able to converge to the correct heading in the presence of arbitrarily large initial heading error.
