Underwater Position and Attitude Estimation Using Acoustic, Inertial, and Depth Measurements
- 13 September 2019
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Journal of Oceanic Engineering
- Vol. 45 (4) , 1450-1465
Abstract
This article considers the problem of constructing an observer for estimating position, velocity, attitude, underwater wave speed, rate sensor bias, and accelerometer bias that has both proven stability and close-to-optimal performance with respect to noise. The observer takes pseudorange, pseudorange difference, depth, and inertial measurements as input, and has a cascade structure for which the equilibrium point is proven to be locally exponentially stable due to the singularities in the attitude representation. The design of the observer is based on the exogenous Kalman filter principle, in which estimators with proven stability provide a linearization point for a linearized Kalman filter, to achieve both proven stability and close-to-optimal noise properties. Experimental validation is provided, with ground truth values generated by a camera positioning system with millimeter accuracy. The observer is compared to an extended Kalman filter and to a nonimplementable linearized Kalman filter using the true state as the linearization point, and the estimation error is almost identical to the linearized Kalman filter using the true state as a linearization point.Keywords
Funding Information
- Norwegian University of Science and Technology Center of Autonomous Marine Operations and Systems (223254)
- NextGenIMR (234108)
This publication has 41 references indexed in Scilit:
- Sensor‐Based Long Baseline Navigation: Observability Analysis and Filter DesignAsian Journal of Control, 2013
- Study and implementation of an EKF GIB-based underwater positioning systemControl Engineering Practice, 2007
- Survey of Nonlinear Attitude Estimation MethodsJournal of Guidance, Control, and Dynamics, 2007
- Quaternion-Based Extended Kalman Filter for Determining Orientation by Inertial and Magnetic SensingIEEE Transactions on Biomedical Engineering, 2006
- Preliminary field experience with the DVLNAV integrated navigation system for oceanographic submersiblesControl Engineering Practice, 2004
- Beyond the kalman filter - Book ReviewIEEE Aerospace and Electronic Systems Magazine, 2004
- Attitude Error Representations for Kalman FilteringJournal of Guidance, Control, and Dynamics, 2003
- Comparison of fix computation and filtering for autonomous acoustic navigationInternational Journal of Systems Science, 1998
- A globally convergent angular velocity observer for rigid body motionIEEE Transactions on Automatic Control, 1991
- Generalized Inverses and Ranks of Block MatricesSIAM Journal on Applied Mathematics, 1973