Robust Initialization of Underwater Monocular Visual–Inertial–Pressure Odometry
- 10 July 2025
- journal article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Sensors Journal
- Vol. 25 (16) , 31086-31096
Abstract
In the underwater environment, image degradation and insufficient IMU excitation make the initialization of visual-inertial odometry a serious challenge. The traditional method improves the performance of initialization by fusing depth information, but does not consider the camera-depth misalignment effect, and the estimation accuracy of gyroscope bias is affected by inaccurate visual Structure-from-Motion (SfM). To address these issues, this article proposes a robust initialization method by introducing the robust cost function and depth information to provide a high-quality initial state for Underwater Monocular Visual-Inertial-Pressure Odometry (UM-VIPO). Our method begins with a vision-only structure. The Truncated Least Squares (TLS) algorithm is used to suppress outliers in feature matching, thereby significantly improving the accuracy and robustness of visual SfM. In addition, the Graduated Non-Convexity (GNC) algorithm is used to solve the non-convex optimization problem induced by the TLS, effectively avoiding convergence to local minima. During visual-depth alignment, depth measurements are introduced to recover the metric scale of the visual poses. By aligning the visual poses and depth measurements with the world coordinate system, the camera-depth misalignment effect is effectively mitigated. In the visual-inertial alignment phase, the gyroscope bias is estimated from the vision-only structure, while the IMU pre-integration is leveraged to calculate the initial velocity in the world coordinate system. Then, all initialized parameters are used to execute a local Bundle Adjustment (BA). Finally, the proposed method is validated on the AQUALOC dataset, demonstrating its effectiveness and superiority.Keywords
Funding Information
- National Natural Science Foundation of China (52371368)
This publication has 41 references indexed in Scilit:
- A Rotation-Translation-Decoupled Solution for Robust and Efficient Visual-Inertial Initialization2023
- U-VIP-SLAM: Underwater Visual-Inertial-Pressure SLAM for Navigation of Turbid and Dynamic EnvironmentsArabian Journal for Science and Engineering, 2023
- Survey of Terrain-Aided Navigation Methods for Underwater VehiclesIEEE Access, 2023
- Fast and Robust Initialization for Visual-Inertial SLAM2019
- Online Initialization and Automatic Camera-IMU Extrinsic Calibration for Monocular Visual-Inertial SLAM2018
- Closed-Form Solution of Visual-Inertial Structure from MotionInternational Journal of Computer Vision, 2013
- Closed-form solution for absolute scale velocity determination combining inertial measurements and a single feature correspondence2011
- EPnP: An Accurate O(n) Solution to the PnP ProblemInternational Journal of Computer Vision, 2008
- Bundle Adjustment — A Modern Synthesis2000
- Generalised Epipolar ConstraintsInternational Journal of Computer Vision, 1999