一种极区集中滤波组合导航系统残差向量故障检测与隔离方法与流程

本发明涉及一种极区集中滤波组合导航故障检测方法，尤其涉及一种极区集中滤波组合导航系统残差向量故障检测与隔离方法。

背景技术：

高精度高可靠性导航技术是运载器在极区工作与安全航行的重要前提之一，导航可靠性是保证导航精度的前提。为了得到较高的组合导航可靠性，可进行故障检测与隔离的联邦滤波器常常被应用与组合导航。然而，联邦滤波器并非最优滤波器。与联邦滤波器相比，具有最优估计特性的集中卡尔曼滤波可以提供更高估计精度，但是集中滤波器无法进行故障检测与隔离，可靠性较差，因为传统的状态χ²故障检测法或残差χ²故障检测方法可以检测组合导航量测信息故障检测，却无法定位并隔离集中滤波器的故障观测信息。综上所述，现有的故障检测与隔离方法无法隔离具有最优估计特性的组合导航集中滤波的故障观测信息。

技术实现要素：

本发明的目的是为了提供一种极区集中滤波组合导航系统残差向量故障检测与隔离方法，实现极区组合导航系统可靠性的提高。

本发明的目的是这样实现的：步骤如下：

步骤一：选取格网坐标系为导航坐标系，惯性导航系统为主导航系统，引入外部观测信息，构建极区组合导航系统；

步骤二：根据组合导航系统量测信息发生故障情况是否独立，对量测信息进行分组，z＝[z1z2…zn]^t，并设计每个量测信息组的故障门限；

步骤三：根据上一滤波周期k-1时刻的滤波器输出状态估计，对本滤波周期k时刻的量测信息进行预测；

步骤四：根据实测量测信息与预测量测信息计算量测信息预测残差rk；

步骤五：计算各量测信息组量测残差方差；

步骤六：设计二元假设，通过检验残差均值，检验量测信息是否故障：

步骤七：设计故障检测向量函数，计算故障检测向量γ；

步骤八：构建故障检测残差标志位向量h＝[h1h2…hn]，标准量测信息故障情况；

步骤九：利用步骤八中得到的向量h，判断组合导航系统量测信息故障情况，若无故障，则进行滤波估计，并重复步骤三至步骤八；若某量测信息组存在故障，则进行滤波器重构，隔离故障观测信息，重复步骤三至步骤八。

本发明还包括这样一些结构特征：

1.步骤二中的不同量测信息组中的信息发生故障概率相互独立，同一量测信息组中的信息发生故障情况相互关联。

2.步骤三以第i组量测信息为例，对本滤波周期量测信息进行预测：

其中，角标k表示k时刻，为第i组量测信息k时刻的预测值，为量测模型中第i组量测信息对应的量测矩阵，φk,k-1为k时刻状态转移矩阵，为k-1时刻滤波器状态估计值；对第1到n组量测信息进行预测，获得量测信息预测向量组。

3.步骤四中的量测信息预测残差rk为：

4.步骤五以第i组量测信息为例，计算量测残差方差为：

其中，pk/k-1为一步预测均方差，ri为量测噪声方差；

计算第1到n组量测信息的量测残差方差到

5.步骤六具体为：若第i组量测信息无故障，则量测信息预测残差可以被视为服从正态分布的零均值高斯白噪声，即ri～n(0,ai)；若组合导航系统的量测信息存在故障，则残差统计特性改变，均值不为零；因此，设计二元假设，通过检验残差均值，检验量测信息是否故障：

无故障发生：

e{ri}＝0,e{riri^t}＝ai

有故障发生：

e{ri}＝μ,e{(ri-μ)(ri-μ)^t}＝ai。

6.步骤七中的计算故障检测向量γ为：

其中，γi(i＝1,2,…,n)服从χ²分布，可以反映第i组量测信息组的故障情况。

8.步骤八具体包括：故障判定准则为：

其中hi构成故障检测残差标志位向量h＝[h1h2…hn]，若h为零向量，则说明组合导航系统量测信息无故障，若h为非零向量，则非零项对应的量测信息组发生故障。

与现有技术相比，本发明的有益效果是：本发明创新的提出一种可用于集中滤波的故障检测方法，通过设计并使用故障检测向量，实现对集中滤波器量测故障的检测与定位，可检测并隔离基于集中滤波的极区组合导航量测信息故障，使集中滤波组合导航系统的可靠性得到有效提高，提升极区组合导航综合性能，保证极区运载器导航精度与可靠性，性能稳定易于实现，因此本发明具有很高的工程应用价值。

附图说明

图1为本发明提出的格网惯导系统误差抑制方法的基本流程框图；

图2为量测信息误差与故障检测标志位向量中相应标志值的示意图；

图3为导航系统姿态角误差曲线；

图4为导航系统速度误差曲线；

图5为导航系统位置误差曲线；

图6是导航系统速度误差曲线和位置误差曲线的局部放大示意图。

具体实施方式

下面结合附图与具体实施方式对本发明作进一步详细描述。

本发明公开了一种极区集中滤波组合导航系统残差向量χ²故障检测与隔离方法。该方法针对以格网惯导系统为基础导航设备的极区组合导航系统，以残差χ²检验法为基础，通过设计残差向量，设计一种残差向量χ²故障检测与隔离方法，实现对集中滤波器的故障检测与隔离，提高极区基于集中滤波器组的组合导航系统的可靠性。与联邦滤波器相比集中滤波器滤波精度更优，该方法使集中滤波器具有故障检测与隔离能力，在不牺牲滤波器估计精度的前提下实现了组合导航系统容错能力的提升。

结合图1至图5，本发明提出一种声学测速辅助的极区格网惯性导航误差抑制方法，其流程图如附图1所示，该方法的主要步骤如下：

(1)选取格网坐标系为导航坐标系，惯性导航系统为主导航系统，引入外部观测信息，构建极区组合导航系统；

(2)根据组合导航系统量测信息发生故障情况是否独立，对量测信息进行分组，z＝[z1z2…zi…zn]^t，并设计每个量测信息组的故障门限。不同量测信息组中的信息发生故障概率相互独立，同一量测信息组中的信息发生故障情况相互关联。

(3)以第i组量测信息为例，根据上一滤波周期(k-1时刻)滤波器输出状态估计，对本滤波周期(k时刻)量测信息进行预测：

其中，角标k表示k时刻，为第i组量测信息k时刻的预测值，为量测模型中第i组量测信息对应的量测矩阵，φk,k-1为k时刻状态转移矩阵，为k-1时刻滤波器状态估计值。

对第1到n组量测信息进行预测，获得量测信息预测向量组。

(4)根据实测量测信息与预测量测信息计算量测信息预测残差rk：

(5)以第i组量测信息为例，计算量测残差方差：

其中，pk/k-1为一步预测均方差，ri为量测噪声方差。

计算第1到n组量测信息的量测残差方差到

(6)以第i组量测信息为例，若第i组量测信息无故障，则量测信息预测残差可以被视为服从正态分布的零均值高斯白噪声，即ri～n(0,ai)；若组合导航系统的量测信息存在故障，则残差统计特性改变，均值不为零。因此，设计二元假设，通过检验残差均值，检验量测信息是否故障：

无故障发生：e{ri}＝0,e{riri^t}＝ai

有故障发生：e{ri}＝μ,e{(ri-μ)(ri-μ)^t}＝ai

(7)设计故障检测向量函数，计算故障检测向量γ：

其中，γi(i＝1,2,…,n)服从χ²分布，可以反映第i组量测信息组的故障情况。

(8)故障判定准则为：

hi构成故障检测残差标志位向量h＝[h1h2…hn]，若h为零向量，则说明组合导航系统量测信息无故障，若h为非零向量，则非零项对应的量测信息组发生故障。

(9)利用步骤8中得到的向量h，判断组合导航系统量测信息故障情况，若无故障，则进行滤波估计，并重复步骤3至8；若某量测信息组存在故障，则进行滤波器重构，隔离故障观测信息，重复步骤3至8。

为了验证本发明的合理性、可行性，基于visualstudio2010设计程序，以基于集中卡尔曼滤波的极区格网惯导/多普勒/超短基线组合导航系统为实验对象，进行仿真实验验证，仿真的方案、条件及结果如下所示：

(1)仿真时间设置

仿真时长为4h，仿真步长为0.01s。

(2)载体运动设置

初始纬度75°n，初始经度126°e。

模拟载体静基座条件下的工作状态，即载体无线运动和角运动。

(3)误差参数设置

三个陀螺仪的常值漂移分别设置为0.03°/h、0.03°/h和0.03°/h；加速度计的零偏设置为3×10^-5g；超短基线定位系统测距精度为10米，测向精度为1°，噪声为零均值白噪声；在1.0h＜t＜1.3h期间，将常值误差加入到多普勒输出速度中，用来模拟组合导航多普勒设备输出故障。

(4)仿真结果

依上述仿真条件，对所设计的故障检测与隔离算法性能进行仿真，图2为量测信息误差与故障检测标志位向量中相应标志值的曲线。量测信息根据故障发生情况是否独立，被分为三个量测信息组，分别是：超短基线斜距测量信息、超短基线角度测量信息(方位角与俯仰角)与多普勒速度测量信息。如图2所示，在整个仿真实验中，超短基线量测信息未出现故障，所以超短基线斜距测量信息与角度测量信息对应的故障检测标志位始终为0，表示无故障发生。在0h＜t＜1.0h时间段内，多普勒量测信息未发生故障，多普勒量测信息故障检测标志位为0，表示无故障发生；在1.0h＜t＜1.3h时间段内，多普勒速度发生突变故障，多普勒量测信息故障检测标志位为1，表示有故障发生，则系统进行重构，隔离故障观测量；在1.3h＜t＜4.0h时间段内，多普勒量测信息故障结束，重新恢复正常，多普勒量测信息故障检测标志位为0，表示故障已解除，系统进行重构，重新加入速度信息为量测。图3、图4、图5分别为格网惯导/多普勒/超短基线组合导航算法姿态、速度、位置误差曲线，仿真图中包括了格网惯导算法导航误差曲线与格网惯导/多普勒/超短基线紧组合导航算法误差曲线；图6为故障发生阶段组合导航误差的局部放大图。由图3-6可知，加入故障检测算法的组合导航系统，导航精度不受量测信息故障影响。最终仿真结果表明，本发明中的极区集中滤波组合导航系统残差向量χ²故障检测与隔离方法可以有效检测集中滤波器故障，集中滤波器具有较高估计精度，本方法可以提高基于集中滤波器的组合组合导航系统的可靠性。

综合上述分析，得到如下分析结果：极区集中滤波组合导航系统残差向量χ²故障检测与隔离方法，可以保证导航系统在极区长航时工作的导航性能与可靠性。因此，本发明可以更为全面的提升导航性能，满足导航系统在极区长时间工作对可靠性与精度的应用需求。