A SINS/DVL Integrated Positioning System through Filtering Gain Compensation Adaptive Filtering

摘要

Because of the complex task environment, long working distance, and random drift of the gyro, the positioning error gradually diverges with time in the design of a strapdown inertial navigation system (SINS)/Doppler velocity log (DVL) integrated positioning system. The use of velocity information in the DVL system cannot completely suppress the divergence of the SINS navigation error, which will result in low positioning accuracy and instability. To address this problem, this paper proposes a SINS/DVL integrated positioning system based on a filtering gain compensation adaptive filtering technology that considers the source of error in SINS and the mechanism that influences the positioning results. In the integrated positioning system, an organic combination of a filtering gain compensation adaptive filter and a filtering gain compensation strong tracking filter is explored to fuse position information to obtain higher accuracy and a more stable positioning result. Firstly, the system selects the indirect filtering method and uses the integrated positioning error to model the navigation parameters of the system. Then, a filtering gain compensation adaptive filtering method is developed by using the filtering gain compensation algorithm based on the error statistics of the positioning parameters. The positioning parameters of the system are filtered and information on errors in the navigation parameters is obtained. Finally, integrated with the positioning parameter error information, the positioning parameters of the system are solved, and high-precision positioning results are obtained to accurately position autonomous underwater vehicles (AUVs). The simulation results show that the SINS/DVL integrated positioning method, based on the filtering gain compensation adaptive filtering technology, can effectively enhance the positioning accuracy.