发明名称 一种卡尔曼滤波传感器信息融合的故障检测方法
摘要 本发明公开了一种卡尔曼滤波传感器信息融合的故障检测方法,包括以下几个步骤:步骤一:根据卡尔曼滤波理论,建立线性动态系统的状态方程和观测方程;步骤二:根据步骤一得出的观测方程,利用最小二乘方法获取状态估计和相应的均方误差阵、新息序列;步骤三:利用已知的新息序列,得到不同的渠道归一化的新息序列;并且组成m通道平行传感器的创新矩阵;步骤四:根据步骤三所得的创新矩阵,获取创新矩阵的谱范数和谱范数的均值;步骤五:对卡尔曼滤波传感器的信息融合进行故障检测;本发明采用数理统计和区间估计的方法,简化了复杂的计算,极大地提高了故障检测速度。
申请公布号 CN103217172A 申请公布日期 2013.07.24
申请号 CN201310092570.3 申请日期 2013.03.21
申请人 哈尔滨工程大学 发明人 沈锋;宋丽杰;张桂贤;陈潇;李平敏;刘海峰;李强;徐定杰;宋金阳
分类号 G01C25/00(2006.01)I;G01S19/20(2010.01)I 主分类号 G01C25/00(2006.01)I
代理机构 北京永创新实专利事务所 11121 代理人 赵文利
主权项 1.一种卡尔曼滤波传感器信息融合的故障检测方法,包括以下几个步骤:步骤一:建立线性动态系统的状态方程和观测方程;线性动态系统的状态方程为:x(k+1)=Φ(k+1,k)x(k)+G(k+1,k)ω(k)   (1)式中:x(k+1)是系统k+1时刻的n维状态向量,x(k)是系统n维状态向量,Φ(k+1,k)是系统n×n维转移矩阵,G(k+1,k)是n×n维系统噪声驱动阵,ω(k)是n维系统激励噪声序列,k表示卡尔曼滤波的更新时刻,状态x(k)是由m个测量通道所组成,第i个通道的观测方程:z<sub>i</sub>(k)=H<sub>i</sub>(k)x(k)+ν<sub>i</sub>(k)   (2)式中:z<sub>i</sub>(k)是第i个测量通道的n维测量向量,H<sub>i</sub>(k)是系统第i个通道的n×n维的测量矩阵,ν<sub>i</sub>(k)第i个通道的n维量测噪声序列,第i个通道的量测噪声ν(k)的均值是零方差为R<sub>ii</sub>(k),相关阵为<img file="FDA00002947155500011.GIF" wi="402" he="76" />(k)δ(kj),各通道相互独立,ν<sub>i</sub>(j)是第i个通道j时刻的量测噪声序列,<maths num="0001"><![CDATA[<math><mrow><mi>&delta;</mi><mrow><mo>(</mo><mi>kj</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mi>k</mi><mo>&NotEqual;</mo><mi>j</mi></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><mi>k</mi><mo>=</mo><mi>j</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow></math>]]></maths>步骤二:根据步骤一得出的观测方程,利用最小二乘方法获取状态估计和相应的均方误差阵、新息序列;系统的状态向量通过卡尔曼滤波传感器信息融合来估计,表示为:<maths num="0002"><![CDATA[<math><mrow><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>m</mi></munderover><mi>P</mi><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>)</mo></mrow><msup><msub><mi>H</mi><mi>i</mi></msub><mi>T</mi></msup><msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo><mi>R</mi></mrow><mi>ii</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><msub><mi>&Delta;</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中:<img file="FDA00002947155500019.GIF" wi="143" he="60" />是系统的状态估计,P(kk)表示估计均方误差的相关矩阵,Δ<sub>i</sub>(k)表示i通道的新息序列,<img file="FDA000029471555000110.GIF" wi="205" he="60" />是状态一步预测:<maths num="0003"><![CDATA[<math><mrow><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>=</mo><mi>&Phi;</mi><mrow><mo>(</mo><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>Δ<sub>i</sub>(k)是i通道的新息序列:<maths num="0004"><![CDATA[<math><mrow><msub><mi>&Delta;</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>z</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>H</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mover><mi>x</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>估计均方误差的相关矩阵:<maths num="0005"><![CDATA[<math><mrow><msup><mi>P</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msup><mi>P</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>m</mi></munderover><msubsup><mi>H</mi><mi>i</mi><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><msubsup><mi>R</mi><mn>11</mn><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><msub><mi>H</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths>一步预测均方误差的相关矩阵:P(k/k-1)=Φ(k,k-1)P(k-1/k-1)Φ<sup>T</sup>(k,k-1)+G(k,k-1)Q(k-1)G<sup>T</sup>(k,k-1)   (7)步骤三:利用已知的新息序列,得到不同的渠道归一化的新息序列,并且组成m通道平行传感器的创新矩阵;对于正常运作的卡尔曼滤波传感器信息融合,不同的通道归一化的新息序列为:<maths num="0006"><![CDATA[<math><mrow><msub><mover><mi>&Delta;</mi><mo>~</mo></mover><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msup><mrow><mo>[</mo><msub><mi>H</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mi>P</mi><mrow><mo>(</mo><mi>k</mi><mo>/</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><msubsup><mi>H</mi><mi>i</mi><mi>T</mi></msubsup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>R</mi><mi>ii</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mrow><mo>-</mo><mn>1</mn><mo>/</mo><mn>2</mn></mrow></msup><msub><mi>&Delta;</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,<img file="FDA00002947155500018.GIF" wi="122" he="79" />是第i个通道的归一化新息序列,服从N(0,1)分布;建立两种假设:γ<sub>0</sub>-Kalman滤波器工作在正常状态,γ<sub>1</sub>-估计系统发生故障;设定A是一个n×m矩阵且为m通道Kalman滤波器规范化创新矩阵,n≥2,m≥2,其中,各列为不同通道的规范化创新向量,创新矩阵为:<maths num="0007"><![CDATA[<math><mrow><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mo>[</mo><msub><mover><mi>&Delta;</mi><mo>~</mo></mover><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo><msub><mover><mi>&Delta;</mi><mo>~</mo></mover><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><msub><mover><mi>&Delta;</mi><mo>~</mo></mover><mi>m</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,A(k)是k时刻的m通道平行传感器信息融合kalman滤波器的规范化创新矩阵,<img file="FDA00002947155500022.GIF" wi="305" he="76" />是各通道k时刻的归一化新息序列;对于假设检验γ<sub>0</sub>和γ<sub>1</sub>,矩阵A<sup>T</sup>(k)A(k)服从白噪声分布;步骤四:根据步骤三所得的创新矩阵,获取创新矩阵的谱范数和谱范数的均值;实数矩阵A(k)的谱范数|| ||<sub>2</sub>为:<maths num="0008"><![CDATA[<math><mrow><msub><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msub><mo>&equiv;</mo><mi>max</mi><mo>{</mo><msup><mrow><mo>(</mo><msub><mi>&lambda;</mi><mi>i</mi></msub><mo>[</mo><msup><mi>A</mi><mi>T</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo><mo>)</mo></mrow><mrow><mn>1</mn><mo>/</mo><mn>2</mn></mrow></msup><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中:λ<sub>i</sub>[A<sup>T</sup>(k)A(k)]是A<sup>T</sup>(k)A(k)的特征值;A(k)的谱范数均值为:<maths num="0009"><![CDATA[<math><mrow><mi>E</mi><mo>{</mo><msub><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msub><mo>}</mo><mo>&ap;</mo><msub><mover><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>=</mo><mfrac><mn>1</mn><mi>k</mi></mfrac><munderover><mi>&Sigma;</mi><mrow><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><msub><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>j</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow></math>]]></maths>假设r<sub>i</sub>和a<sub>j</sub>代表规范化创新矩阵A的行和列,最大行-列范数为:μ≡max[||r<sub>i</sub>||<sub>2</sub>,||a<sub>j</sub>||<sub>2</sub>]   (12)其中||r<sub>i</sub>||和||a<sub>j</sub>||是向量r<sub>i</sub>和a<sub>j</sub>的范数,并且有下列不等式成立:E{μ}≤E{||A||<sub>2</sub>}≤[max(n,m)]<sup>1/2</sup>E{μ}   (13)把E{μ}用它的下界来替换:<img file="1.GIF" wi="1010" he="132" />所以公式(13)改为:<img file="2.GIF" wi="1300" he="80" />式中f为未知函数,并且有在n=m→∞时函数f渐近为2且f的区间是(1,2),所以定义f的估计值为2,针对以上所述,E{||A(k)||<sub>2</sub>}有以下定义:<maths num="0012"><![CDATA[<math><mrow><mi>&sigma;</mi><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>&le;</mo><mi>E</mi><mo>{</mo><msub><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mo>|</mo><mo>|</mo></mrow><mn>2</mn></msub><mo>}</mo><mo>&le;</mo><mn>2</mn><mi>&sigma;</mi><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>16</mn><mo>)</mo></mrow></mrow></math>]]></maths>表达式(16)表现了随机矩阵A标准差和它的二阶范数之间的关系;通过卡尔曼滤波器的归一化新息矩阵的元素a<sub>ij</sub>是否服从N(0,1)分布来确定,并要满足不等式(16);不满足不等式(16)则说明元素a<sub>ij</sub>的均值不在为零或者方差不再为单位方差或者{a<sub>ij</sub>}不再服从白噪声;鉴于σ=1和表达式(11)就得到谱范数均值符合以下关系形式:<maths num="0013"><![CDATA[<math><mrow><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>&le;</mo><msub><mover><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>&le;</mo><mn>2</mn><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow></math>]]></maths>步骤五:对卡尔曼滤波传感器的信息融合进行故障检测;测试传感器信息融合卡尔曼滤波器的故障检测问题,决策方法为以下形式:<maths num="0014"><![CDATA[<math><mrow><msub><mi>&gamma;</mi><mn>0</mn></msub><mo>:</mo><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>&lt;</mo><msub><mover><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>&lt;</mo><mn>2</mn><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>,</mo></mrow></math>]]></maths><img file="FDA00002947155500035.GIF" wi="73" he="48" />:无故障运行<maths num="0015"><![CDATA[<math><mrow><msub><mi>&gamma;</mi><mn>1</mn></msub><mo>:</mo><msub><mover><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>&le;</mo><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt></mrow></math>]]></maths>或<maths num="0016"><![CDATA[<math><mrow><msub><mover><mrow><mo>|</mo><mo>|</mo><mi>A</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>|</mo><mo>|</mo></mrow><mo>&OverBar;</mo></mover><mn>2</mn></msub><mo>&GreaterEqual;</mo><mn>2</mn><msqrt><mi>max</mi><mrow><mo>(</mo><mi>n</mi><mo>,</mo><mi>m</mi><mo>)</mo></mrow></msqrt><mo>,</mo></mrow></math>]]></maths><img file="FDA00002947155500034.GIF" wi="65" he="50" />:故障   (18)。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号