摘要

The current matching algorithm for real-time gravity aided navigation has some deficiencies such as low matching accuracy, big influence of initial position on matching ratios and poor real-time nature. To solve these problems, this work proposes a new algorithm which uses relative position from inertial navigation to construct the constraint model of radius and azimuth. Then it measures similarity to choose points to be matched and yield optimal matching parameters. Even if in the case of big initial errors of inertial navigation, this algorithm can perform real-time matching at a high efficiency. The experimental results show that this method is not sensitive to initial errors of inertial navigation, robust, accurate, and of good real-time nature.

全文