[发明专利]一种地磁辅助惯性导航方法

说明书

技术领域

本发明涉及导航、制导技术，特别涉及航行器自主导航技术领域，尤其是一种地磁辅助惯性导航方法。

背景技术

目前，惯性导航是导航定位的主要方式之一，它能够在全天候条件下、在全球范围内和任何介质环境里自主地、隐蔽地进行连续的三维空间定位和三维空间定向，而不借助任何外来信息，也不向外辐射任何信息，能够完全自主地提供多种完整的导航参数，在许多领域都有广泛应用，但其导航误差随时间会不断积累，不适于长时间的单独导航。

针对上述技术问题，目前有利用地球固有的地磁场信息辅助惯性导航进行组合导航的方法，以地磁的长期稳定性来弥补惯性导航系统误差随时间累积的缺点，从而提高导航定位精度。

目前关注较多的地磁辅助惯性导航的方式为地磁匹配辅助惯性导航。地磁匹配，就是把航迹上某些区域的地磁场特征量绘制成基准图，存贮在载体计算机中，当载体经过这些区域时，由地磁测量仪器实时测量出经过点的地磁场特征量，以构成实时图，并在载体计算机中与参考图进行相关匹配，计算出载体的实时坐标位置，供导航计算机解算导航信息。

而目前常用的地磁辅助惯性导航算法很多，主要是将地形匹配中的相关概念和算法引入到地磁匹配中，如TERCOM、ICCP算法等。这类算法不仅耗时长、实时性差，而且容易受到噪声的干扰。

在现有技术中，利用实测地磁信息与地磁图匹配进行惯性地磁导航的方式，采用的方式是首先对实测地磁信息进行降噪处理，之后用单一匹配算法进行单独匹配导航或者采用两种匹配算法进行联合匹配导航，这种导航方式比较仅仅利用地磁信息进行的惯性地磁导航方式，导航精度得到了一定的提高，但是这种导航方式直接对运载体当前的实测地磁信息进行降噪处理，降噪信息量大，匹配信息量大，从而降噪与匹配的计算量大，大大增加了匹配强度，降低了匹配速率的同时，也影响了匹配的精度。这是现有技术所存在的不足之处。

发明内容

本发明所要解决的技术问题，就是克服地磁辅助惯性导航方法在匹配速度与精确性方面的不足，通过采取在去噪之前的粗匹配降低一些非匹配点的方式，降低去噪和精匹配的计算压力，使其增强去噪效果并提高精匹配的匹配精度，从而提高地磁匹配的质量。

本发明的技术解决方案是：一种地磁辅助惯性导航方法，步骤如下：

(1)通过测磁设备获得运载体当前位置的实时地磁信息，并确定粗匹配指标和精匹配指标；

(2)读取基准地磁图信息，并采用匹配算法将实测地磁信息与其进行粗匹配；

(3)使用降噪算法，去除粗匹配后的实时地磁信息中的噪声和干扰信息；

(4)读取基准地磁图信息，并与去噪后的地磁信息数据进行精匹配；

(5)根据精匹配结果，修正惯性导航系统的位置。

所述步骤(1)中的测磁设备至少有1台以上。

所述步骤(1)中的多台测磁设备同时进行测量。

所述步骤(2)中的粗匹配，若其匹配结果满足步骤(1)确定的粗匹配指标，则执行步骤(3)，否则去除该实时地磁信息，继续执行步骤(2)。

所述步骤(2)中的匹配算法为归一化积相关匹配(NProd)算法。

所述步骤(3)中的降噪算法为希尔伯特-黄变换(HHT)算法。

所述步骤(4)中精匹配的结果满足步骤(1)中确定的精匹配指标时，则执行步骤(5)，否则继续执行步骤(4)。

所述步骤(4)采用Hausdorff距离方法对去噪后的地磁信息数据进行精匹配。

本发明与现有技术相比的优点在于：

(1)本发明对测得的实时地磁信息采用依次进行粗匹配、降噪和精匹配的地磁匹配模式。这种模式的使用，消除了与基准地磁图的部分非匹配点，提高了实时地磁信息的降噪效率，节约了非匹配点的精匹配时间，提高了精匹配的速度并保证了导航的精度，进而提高了地磁辅助惯性导航的质量；

(2)采用NProd算法进行粗匹配，该算法是图像匹配工程应用中一种比较成熟的算法，匹配精度高且能在低信噪比条件下工作，具有不受比例因子误差影响的优势，且抗白噪声干扰能力强；

(3)和现有的小波去噪技术相比，本发明采用HHT算法进行地磁信息降噪。该算法规避了小波基难以选择的问题，可以在实际应用中处理非线性非平稳信号，且具有完全自适应性，并能够完全摆脱很多传统算法的Heisenberg测不准原理约束的限制，从而很好的对实时地磁信息进行降噪处理，提高实时地磁信息的信噪比；