A Fast North-Finding Algorithm on the Moving Pedestal Based on the Technology of Extended State Observer (ESO)

Sensors (Basel). 2022 Oct 5;22(19):7547. doi: 10.3390/s22197547.

Abstract

We propose a kind of fast and high-precision alignment algorithm based on the ESO technology. Firstly, in order to solve the problems of rapid, high-accuracy, and anti-interference alignment on the moving pedestal in the north-seeker, the ESO technology in control theory is introduced to improve the traditional Kalman fine-alignment model. This method includes two stages: the coarse alignment in the inertial frame and fine alignment based on the ESO technology. By utilizing the ESO technology, the convergence speed of the heading angle can be greatly accelerated. The advantages of this method are high-accuracy, fast-convergence, strong ability of anti-interference, and short time-cost (no need of KF recursive calculation). Then, the algorithm model, calculation process, and the setting initial-values of the filter are shown. Finally, taking the shipborne north-finder based on the FOG (fiber-optic gyroscope) as the investigated subject, the test on the moving ship is carried out. The results of first off-line simulation show that the misalignment angle of the heading angle of the proposed (traditional) method is ≤2.1' (1.8') after 5.5 (10) minutes of alignment. The results of second off-line simulation indicate that the misalignment angle of the heading angle of the proposed (traditional) method is ≤4.8' (14.2') after 5.5 (10) minutes of alignment. The simulations are based on the ship-running experimental data. The measurement precisions of Doppler velocity log (DVL) are different in these two experiments.

Keywords: fiber-optic gyroscope (FOG); inertial alignment; shipborne inertial systems.

Grants and funding

This research was funded by the Fundamental Research Funds for the Central Universities, Sun Yat-sen University. The funding number is 22qntd0601. In order to improve the independent innovation ability and high-level talent training ability of colleges and universities, the National Talent Government and the Ministry of Education have set up this fund. It mainly supports young teachers of Sun Yat-sen University to carry out free exploration and independent innovation research in frontier science, interdisciplinary, social welfare and other fields.