多航向传感器信息融合与容错联邦卡尔曼滤波器在舰艇综合导航系统中的应用

戴海发，卞鸿巍，王荣颖，马 恒

(海军工程大学 导航工程系，湖北 武汉 430033)

0 引 言

由于惯性器件误差的存在，惯性导航系统误差会随着时间迅速累积，因此惯导不能单独用于舰艇的长时间导航与定位。全球卫星定位系统能够提供较精确的当地位置信息，且不会随着时间发散，但是存在输出频率较低，容易受到干扰的缺点，所以常把全球卫星定位系统和惯导系统组合起来用于载体的导航与定位[1-2]。

当前舰艇上的航向传感器主要包括：平台罗经、天文导航系统、惯性导航系统以及卫星导航系统。它们均有各自的缺点，比如平台罗经和惯导航向误差会随着时间的积累而增大；天文导航系统容易受到天气环境的影响，在可见度低的条件下难以正常工作[3]，卫导系统在静止和大机动条件下航向指示误差大。因此这些航向传感器也不适合单独使用。

为了提高导航系统的可靠性和航向测量的精度，本文在惯导/卫导组合导航系统中加入了平台罗经和天文导航系统，并通过基于传感器输出误差协方差的权值分配方法实现航向信息的融合，从而更加准确地测量得到舰艇的航向信息。

图1为该组合导航系统的原理图。除了包含航向传感器和导航系统外，该结构还包含优化航向信息融合和故障容错卡尔曼滤波器2个模块。本文主要对这2个系统作特别的说明，并且通过船舶航行试验验证设计方案的可行性。

1 最优航向信息融合

本文通过权值法对多个位置传感器的数据进行融合：

权值的分配基于误差协方差，以电罗经输出的航向最优信息为例，其权重为：

按照以下方式得到航向融合解：

2 故障容错卡尔曼滤波器设计

2.1 卡尔曼滤波器

图2为故障容错卡尔曼滤波器的原理框图。其中滤波器O为标准SINS/GNSS组合导航系统，采用文献[4]的状态方程与观测方程，状态变量为，其中均为航姿误差，均为速度误差，均为位置误差，均为陀螺零偏，均为加速度计零偏；滤波器C，E，G分别为SINS与电罗经、天文导航、GPS以航向差为观测量组成的卡尔曼滤波器。本文选用的卡尔曼滤波器均为标准滤波器，以卡尔曼滤波器G为例，卡尔曼滤波器的状态向量为：Xg=

图 2 故障容错卡尔曼滤波器Fig. 2 Fault-tolerant Kalman filter

卡尔曼滤波器G的离散化状态方程为：

观测量为：

观测方程为：

卡尔曼滤波器C以及卡尔曼滤波器E与卡尔曼滤波G具有完全相同的结构，状态矩阵也一样，观测量分别为CNS、电罗经与SINS的航向差。

2.2 状态传播

状态传播器只对状态进行预测，不进行量测更新，所以不受故障观测值的影响，因此状态传播器的预测结果可作为子滤波器的参考信号，用于检测观测数据中的故障数据。状态传播器的状态传播方程为：

其中，下标i为第i个状态传播器。为了避免状态传播器发散，每隔一段时间利用主滤波器的信息交替对状态传播器进行校准。

2.3 故障检测

检验信号和参考信号之间一致性的卡方检验被广泛使用于随机动态系统中的故障检测。通过使用不同的方式来计算检验统计量，卡方检验可以分为3类[5-7]：1）使用滤波器残差的残差卡方检验，尽管该方法可以容易地检测传感器中的故障，但几乎不可能检测到渐变的故障；2）通过使用具有一个状态传播器的状态向量卡方检验，该方法可以检测到渐变故障，但信号的幅度随着运行时间增加最终发散；3）通过使用具有2个状态传播器的状态向量卡方检验，该方法可以通过在一段时间间隔后根据卡尔曼滤波器的输出交替地重置2个状态传播器，从而避免发散。但是，状态传播器的数量是滤波器数量的2倍，这可能严重影响计算速度。

本文采用下述变量作为卡尔曼滤波器G的故障检测的检测统计量：

该变量的协方差为：

假定卡尔曼滤波器G与状态传播器i的初始状态相同，可以得到，所以变量的协方差可以写成：

残差协方差为：

3 试验结果与比较分析

为了验证设计方案的可行性，本文以高精度天文导航系统的航向为参考基准，在船上做了验证试验。试验采集了几个设备3 h左右的输出数据，试验结果如下：

1）无故障检测的融合

采用无故障检测融合算法计算出的航向如图3所示。与卫导输出的航向相比，航向值的波动幅度明显减小，从原来的下降到。与惯导/卫导组合输出的航向相比，在船运动过程中，野值点的数量明显减少。

图 3 无故障检测与隔离算法的融合航向Fig. 3 Fusion heading without fault detection and isolation

滤波器G，E，C的残差及状态卡方检测统计量分别如图4和图5所示。从图4可以看出，滤波器G在船静止状态下的残差卡方检测统计量大多数都很大，而在运动状态下的数值较小，这说明卫导在静止条件下得到的航向不可用，动态性能较好，但也存在一些跳跃点。而滤波器E，C的故障检测统计量在整个航行过程中的数值都较小，只存在几个数值较大的点，这说明电罗经与天导系统输出的航向比较稳定，只含有一些幅值较大的故障信息。从图5可以看出，卫导航向数据中含有缓变干扰，而电罗经和天导航向不含有缓变干扰。

2）含有故障检测与隔离的融合算法

对比图3和图6，可以看出，经过故障检测与隔离算法后，融合得到的航向信息更加平滑，野值点得到抑制。从图7可以看出，加入故障检测与隔离后，融合出的航向，其相对误差明显减小，从原来的减小到。

图 4 残差卡方检测统计量Fig. 4 Heading test statistic of residue Chi-square test

图 5 状态卡方检测统计量Fig. 5 Heading test statistic of state Chi-square test

图 6 含有故障检测与隔离的算法融合航向Fig. 6 Fusion heading with fault detection and isolation

图 7 2 种算法融合航向的相对误差Fig. 7 Comparisons of fusion heading error with different method

4 结 语

本文提出了一种适用于舰艇的基于最优信息融合与容错卡尔曼滤波器的多航向传感器信息融合算法，该方法利用了基于协方差的权值分配方法以及状态卡方与残差卡方并行的故障检测策略，能够同时检测到突变故障与缓变故障，为了防止状态传播器的发散，本文还引入了双状态传播器，进一步提高了系统的可靠性，然后利用故障检测结果对故障传感器进行自动隔离和权值的重新分配，最后通过实际试验验证方案的可行性。试验结果表明，本文提出的航向融合算法能够明显的提高系统的可靠性以及航向精度，为工程实践提供参考。