Gyrocompass Alignment Method Of Sins Based On Kalman Filtering Pretreatment And Dynamic Gain Adjustment On Rocking Base
Zongtao Li,Yunchun Yang,Tiejun Wu,Longhua Ma
2011-01-01
Abstract:At present, initial alignment of land combat vehicles generally uses stationary alignment. In order to achieve better performance of alignment, vehicle must remain stationary during the alignment process; but during the alignment process, vehicle is inevitably subject to the impact of vibration disturbance by wind gust or engine idling, etc. Therefore, the impact of vibration disturbance on alignment performance must be considered during the actual stationary alignment. Although compared to Kalman filter alignment method (Including the two stages of coarse alignment and fine alignment) based on method modern control theory, alignment time of gyrocompass alignment method (Including the two stages of level alignment and azimuth alignment) based on classical control theory is longer; but its robustness of vibration disturbance is better. This was mainly due to that Kalman filter alignment method is based on the error model of SINS. So vibration disturbance is stronger, the worse is the accuracy of the error model, indirectly aimed at the poorer performance. In order to guarantee the alignment accuracy under the rocking base, and shorten the convergence time of alignment, a gyrocompass alignment method of SINS based on Kalman filtering pretreatment and dynamic gain adjustment is proposed. In this method, the output of Gyros and accelerometers are firstly pre-filtered using Kalman filtering, and then the initial alignment of SINS is done using gyrocompass alignment based dynamic gain adjustment. Among them, the high-frequency low-amplitude rocking interference of vehicle is filtered out through Kalman filter; the low-frequency high-amplitude rocking interference of vehicle is tracked through dynamic gain adjustment of compass alignment based on the alignment time and the degree of attitude change. Through vehicle test analysis of some ring laser SINS, it shows that under the same alignment accuracy, the alignment time of the gyrocompass alignment method proposed by this paper compared to the traditional gyrocompass alignment method based on piecewise variable gain is shorter; under the same alignment time, the alignment accuracy of the gyrocompass alignment method proposed by this paper compared to the Kalman filter alignment method is higher. So, under the conditions of rocking base, the alignment performance of the gyrocompass alignment method proposed by this paper compared to the traditional gyrocompass alignment method based on piecewise variable gain and Kalman filter alignment method is improved.