A new algorithm of gravity matching aided navigation

Up to now, TERCOM hasn't been used in the gravity matching aided navigation, because of its disability in precise positioning. So does ICCP which needs precise initial values, whereas the initial values provided by INS are not accurate enough. This paper starts from the introduction of the basic principles of TERCOM and ICCP, and compares their advantages and disadvantages, then incorporates these two methods into a new algorithm in which TERCOM provides the initial position and ICCP does the precise positioning. At last simulation data is used in the experiments, with the purpose to shed light on the effect of this new algorithm in gravity matching aided navigation. It is proved that the new method is precise and needs no initial values. It is very fit for gravity matching aided navigation.