多惯性导航系统信息融合方法研究

芈小龙，向 敏

(海军装备部，北京 100076)

0 引 言

对于船舶导航领域，多传感器组合导航已成为最主要的导航方法，通过多传感间的信息融合，能够有效利用和处理来自多传感器的数据，克服单一导航模式的不足，达到提高导航精度、增强船舶导航系统自主性和可靠性的目的[1-4]。

由于不同船舶配备的导航传感器形式和数量各有不同，形成了不同的导航方案，其中最为常用的是惯性导航系统（Inertial navigation system，INS）和卫星导航系统（Global positioning system，GPS）组合的方案[5-6]。任民魁等将提出了基于Rodrigues 参数的INS/GPS 组合导航鲁棒滤波方法，通过增加抗差因子提高了组合系统的稳定性和可靠性，但算法未经过试验检验，精度有待验证；Q i n 通过改善G P S 环路，提高了INS/GPS 的精度水平，但其对GPS 的器件精度要求较高，较难实现应用。另外采用船上计程仪辅助惯性导航系统的方案也广泛应用于水下组合导航系统[7-8]，赵俊波等对计程仪/INS 组合导航方法进行了总结，Liu 等针对计程仪信息有限条件下的组合导航进行研究，提出了一种紧组合导航方法，但该方法计算量较大，难以保证算法的实时性。上述方案中主要以INS 作为导航核心，辅以其他设备改善INS 长航时下精度发散的问题，实现较高精度的导航。而对于水下导航来说，由于计程仪的精度水平有待提高，造成了长周期条件下导航精度无法满足使用要求的问题，所以如何结合船上现有装备实现长周期条件下的高精度导航是目前船舶导航领域面临的一个巨大问题[9-12]。通常来说，为保证船舶导航系统的可靠性，船上一般会配备2 套惯导系统，所以开展多惯导系统信息融合研究是实现水下船舶导航的一种新思路，对提高长航时下的导航精度水平有重要意义。

1 多惯性导航系统融合方法

1.1 多惯性导航系统融合方案

对于静电惯导系统、激光惯导系统等高精度惯导系统而言，为提高其导航精度，一般会将惯性器件误差进行估计和补偿，以消减误差发散趋势，但惯导固有的随时间发散的特性仍然存在，使得惯导系统的振荡误差逐渐凸显出来[13-14]，因此，对于本方案来说，重点在于消除地球振荡误差，从而提升船舶导航系统长航时下的导航定位精度。

通过对长航时惯导误差模型进行分析，经度、纬度、航向的地球振荡误差幅值主要受航向初始角误差和陀螺漂移影响，起始振荡方向受航向初始角方向、北向和天向陀螺漂移的正负影响。基于此，设计多惯性导航系统融合方案如图1 所示。结合惯导系统基本原理，2 套惯导系统（以下简称惯导1、惯导2）相隔0.25 个地球周期（即6 h）分别启动，并以惯导系统位置、速度、姿态和陀螺加表误差作为观测量，以两惯导系统互为导航基准，利用对方输出的经纬度信息作为量测信息进行卡尔曼滤波，在估出陀螺加表误差后对两惯导系统进行补偿，之后输出组合导航下的导航信息。

1.2 多惯性导航系统融合模型

图1 多惯性导航系统融合方案Fig. 1 Multi-inertial navigation system integration scheme

根据系统方案，建立多惯性导航系统（分别以下标1，2 表示）量测方程，如下式：

其中：

以两惯导的经纬度误差作为观测量得到观测方程如下式：

通过式（1）和式（2）构建多惯性导航系统融合Kalman 滤波方程，实现多惯性导航系统的信息融合。

2 试验验证

为验证所提融合方法的有效性，分别采用仿真试验和半实物仿真试验进行验证。

2.1 模拟仿真试验

仿真条件及参数设置为：惯导1、惯导2 加表零位5×10-5g， 陀螺漂移 0.02°/h，采样频率10 Hz，仿真时间24 h。单惯导仿真误差曲线如图2 所示，基于融合算法的仿真结果如图3 所示。

图2 单惯导仿真误差曲线Fig. 2 Simulation error curve of single inertial navigation

图3 两套惯导融合后误差曲线Fig. 3 Simulation error curves after inertial navigation fusion

为便于比较，统计了惯导1、惯导2 在24 h 的定位精度为1.7 n mail，速度误差波动小于0.2 kn，从图2 可知，当采用多惯导系统信息融合方案时，24 h 定位精度为1.5 n mail，速度误差波动小于0.15 kn，可以从理论上验证所提方法的有效性。

2.2 半实物仿真试验

以2 套某型激光惯导系统静基座条件下工作5 d 的试验数据进行分析，2 台惯导系统和采用本文所提方案对两惯导系统信息进行融合的经度、纬度及位置误差曲线如图4 所示。

图4 误差曲线Fig. 4 Simulation error curves

由于2 套惯导系统精度相当，启动时间相差了6 h，导致地球振荡曲线相位相差1/4，在进行融合后，精度水平得以提升。可以看出，采用所提方法，导航系统定位精度可提升30%，可以很好解决导航系统定位精度低的问题。

3 结 语

为解决水下舰船导航信息来源少、精度低的问题，本文结合惯导系统自身原理，提出一种多惯性导航系统信息融合方法，模拟仿真结果和半实物仿真试验表明相较于传统的单惯导导航条件，所提方法可以使导航精度提升30%，提高了水下舰船综合导航能力，保障了其长航时条件下的导航精度水平。