An improved self-adaptive Kalman filter algorithm and its application in integrated navigation systems for AUV

Yushan Sun,Yueming Li,Lei Wan,Yongjie Pang
DOI: https://doi.org/10.3772/j.issn.1002-0470.2013.02.010
2013-01-01
Abstract:According to the working characteristics of autonomous underwater vehicles (AUVs) and their navigation requirements when performing underwater tasks, the architecture of integrated navigation systems for AUVs based on dead-reckoning was designed. The motion equation and the observation equation of underwater vehicles were constructed, and a self-adaptive Kalman filter was adopted for processing the data from underwater vehicles' sensors. To overcome the disadvantages of the self-adaptive Kalman filter, the forgetting factor was introduced based on the fading exponent method, and the residual prediction algorithm was used for computing the optimal forgetting factor. And some measures were taken to ensure the half positive of the matrix of system noisy estimation and the positive of the matrix of measure noisy estimation, which can avoid divergence. The sea experimental results show that the improved self-adaptive Kalman filter method is effective, and can meet the AUVs' demand in navigation and positioning when they carry out underwater missions.
What problem does this paper attempt to address?