Abstract：A Position estimation algorithm for underwater vehicle is proposed based on the USBL/Doppler to cope with position feedback delay due to the underwater acoustic positioning system. The Kalman filter structure with the state equation and observation equation is established according to the navigation system for underwater vehicle. Moreover, the theory of adaptive Kalman filter is incorporated into the algorithm in order to enhance the estimation precision and make the system insensitive to the environment and initial conditions. Simulation result verifies the validity of the algorithm and conclusion is provided at the end of the paper.
[1] Myung-Hyun Kim. Nonlinear control and robust observer design for marine vehicle[D].Virginia State:Virginia State University, 2000. [2] Louis Whitecomb etc. Advances in doppler-based navigation of underwater robotic vehicle[A].In Proceedings of the IEEE International Conferences on Robotics & Automation[C] ,1999. 399-406. [3] Bennamon M, etc. The Development of an Integrated GPS/INS/SONAR Navigation System for Autonomous Underwater Vehicle Navigation[A].Proceedings of IEEE OCEAN's96 [C].1996. 256-261. [4] Mohamed A H, etc. Adaptive kalman filter for INS/GPS[J].Journal of Geodesy, 1999. 193-203. [5] Schmiegel A U. A Stabilized model-based kalman filter for underwater navigation[A].In Proceedings Conference on BAE SYSTEMS Signal & Data Processing[C].2002. [6] Andreas Huster etc. Relative position estimation for intervention-capable AUVs by fusing vision and inertial measurements[A].In Proceedings of the 12th International Symposium on Unmanned Untethered Submersible Technology[C].Durham NH:August 2001. Autonomous Undersea Systems Institute. [7] White NA. MMAE Detection of Interference/jamming and Spoofing in a DGPS-aided Inertial System[D].MS Thesis:Air Force Institute of Technology, Ohio, 1996. [8] Wang Jinling. Kinematics GPS Positioning with Adaptive Kalman Filtering Technology[A].Proc IAG'97[C].1997
