发明名称 一种基于卡尔曼滤波的钢轨裂纹声发射信号与提取去噪方法
摘要 本发明公开了一种基于卡尔曼滤波的钢轨裂纹声发射信号提取与去噪方法,其步骤如下:步骤一:钢轨裂纹声发射信号到达时间自动识别;步骤二:建立有色轮轨接触噪声AR模型及其噪声方程;步骤三:建立钢轨裂纹信号时变参数AR模型及钢轨裂纹信号卡尔曼滤波基本方程;步骤四:有色轮轨接触噪声卡尔曼滤波估计钢轨裂纹信号。本发明具有如下优点:1)在检测到钢轨裂纹信号的基础上,进一步建立钢轨裂纹信号的时变参数AR模型,采用有色测量噪声卡尔曼滤波方法,直接对钢轨裂纹信号进行估计,提取出钢轨裂纹信号;2)将有色轮轨接触噪声情况下的卡尔曼滤波递推公式化简为与一般卡尔曼滤波递推公式一致的一般形式,简化了算法,减小了算法复杂度。
申请公布号 CN104977357A 申请公布日期 2015.10.14
申请号 CN201510471722.X 申请日期 2015.08.04
申请人 哈尔滨工业大学 发明人 沈毅;郝秋实;章欣
分类号 G01N29/04(2006.01)I;G01N29/44(2006.01)I 主分类号 G01N29/04(2006.01)I
代理机构 哈尔滨龙科专利代理有限公司 23206 代理人 高媛
主权项 一种基于卡尔曼滤波的钢轨裂纹声发射信号提取与去噪方法,其特征在于所述方法步骤如下:步骤一、钢轨裂纹声发射信号到达时间自动识别:1)对含噪声发射信号S进行钢轨裂纹信号检测;2)取检测到的钢轨裂纹声发射信号投影P;3)全局AIC值法对钢轨裂纹声发射信号投影P判断钢轨裂纹信号到达时间T:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>A</mi><mi>I</mi><mi>C</mi><mrow><mo>(</mo><mi>p</mi><mo>)</mo></mrow><mo>=</mo><mi>l</mi><mi>n</mi><mrow><mo>(</mo><msubsup><mi>&sigma;</mi><mi>w</mi><mn>2</mn></msubsup><mo>)</mo></mrow><mo>+</mo><mn>2</mn><mi>p</mi><mo>/</mo><mi>N</mi><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000011.GIF" wi="566" he="85" /></maths>上式为p阶AR模型AIC值计算公式,式中<img file="FDA0000774398500000012.GIF" wi="56" he="60" />为窗口内信号AR模型x(k)+a<sub>1</sub>x(k11)+a<sub>2</sub>x(k‑2)…+a<sub>p</sub>x(k‑p)=w(k)中零均值白噪声模型误差w(k)的方差,N为建模信号长度;全局AIC值定义为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>A</mi><mi>I</mi><mi>C</mi><mo>=</mo><msub><mi>AIC</mi><mi>n</mi></msub><mo>+</mo><msub><mi>AIC</mi><mi>s</mi></msub><mo>=</mo><msubsup><mi>ln&sigma;</mi><mrow><mi>w</mi><mi>n</mi></mrow><mn>2</mn></msubsup><mo>+</mo><mfrac><mrow><mn>2</mn><msub><mi>p</mi><mi>n</mi></msub></mrow><mrow><mi>K</mi><mo>-</mo><msub><mi>N</mi><mi>n</mi></msub></mrow></mfrac><mo>+</mo><msubsup><mi>ln&sigma;</mi><mrow><mi>w</mi><mi>s</mi></mrow><mn>2</mn></msubsup><mo>+</mo><mfrac><mrow><mn>2</mn><msub><mi>p</mi><mi>s</mi></msub></mrow><mrow><msub><mi>N</mi><mi>s</mi></msub><mo>-</mo><mi>K</mi></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000013.GIF" wi="1164" he="152" /></maths>式中全局AIC值由噪声信号窗口AIC<sub>n</sub>和钢轨裂纹信号窗口AIC<sub>s</sub>组成,K=1,2,…,N<sub>n</sub>+N<sub>s</sub>为噪声信号与钢轨裂纹信号的分界点,将声发射信号投影划分为起始于点N<sub>n</sub>的噪声窗口序列{x<sub>n</sub>(k)}和结束于点N<sub>s</sub>的钢轨裂纹信号窗口序列{x<sub>s</sub>(k)},<img file="FDA0000774398500000014.GIF" wi="69" he="60" />和<img file="FDA0000774398500000015.GIF" wi="67" he="60" />分别为噪声窗口和钢轨裂纹信号窗口的AR模型误差方差,p<sub>n</sub>和p<sub>s</sub>分别为噪声窗口和钢轨裂纹信号窗口AR模型的阶数;步骤二、建立有色轮轨接触噪声AR模型及其噪声方程:1)噪声信号序列{n(k)}一阶AR模型:n(k)+a<sub>1</sub>n(k11)=w<sub>1</sub>(k),其中a<sub>1</sub>为模型参数,模型误差w<sub>1</sub>(k)是均值为零方差为<img file="FDA0000774398500000021.GIF" wi="67" he="60" />的高斯白噪声;2)由噪声信号一阶AR模型建立有色轮轨接触噪声方程:V<sub>k</sub>=ψ<sub>k,k‑1</sub>V<sub>k‑1</sub>+ζ<sub>k‑1</sub>,式中转移矩阵ψ<sub>k,k‑1</sub>=‑a<sub>1</sub>,测量噪声系统噪声ζ<sub>k‑1</sub>=w<sub>1</sub>(k);步骤三、建立钢轨裂纹信号时变参数AR模型及钢轨裂纹信号卡尔曼滤波基本方程:1)钢轨裂纹信号{x(k)}的时变参数AR模型:x(k)+a<sub>1</sub>(k‑1)x(k‑1)+a<sub>2</sub>(k‑2)x(k‑2)+…+a<sub>p</sub>(k‑p)x(k‑p)=w<sub>p</sub>(k),其中a<sub>1</sub>(k),a<sub>2</sub>(k),…,a<sub>p</sub>(k)为模型时变参数,模型误差w<sub>p</sub>(k)是均值为零方差为<img file="FDA0000774398500000022.GIF" wi="73" he="66" />的高斯白噪声;2)时变参数基函数展开:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>a</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mrow><mi>i</mi><mn>0</mn></mrow></msub><mo>+</mo><msub><mi>a</mi><mrow><mi>i</mi><mn>1</mn></mrow></msub><mi>k</mi><mo>+</mo><msub><mi>a</mi><mrow><mi>i</mi><mn>2</mn></mrow></msub><mfrac><msup><mi>k</mi><mn>2</mn></msup><mn>2</mn></mfrac><mo>+</mo><mo>...</mo><mo>+</mo><msub><mi>a</mi><mrow><mi>i</mi><mi>m</mi></mrow></msub><mfrac><msup><mi>k</mi><mi>m</mi></msup><mrow><mi>m</mi><mo>!</mo></mrow></mfrac><mo>,</mo><mrow><mo>(</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mo>...</mo><mo>,</mo><mi>p</mi><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000774398500000023.GIF" wi="1102" he="144" /></maths>式中令基函数<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msub><mi>f</mi><mn>0</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mn>1</mn></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>f</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>k</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>f</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><msup><mi>k</mi><mn>2</mn></msup><mn>2</mn></mfrac></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mrow><msub><mi>f</mi><mi>m</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><msup><mi>k</mi><mi>m</mi></msup><mrow><mi>m</mi><mo>!</mo></mrow></mfrac></mrow></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000774398500000024.GIF" wi="289" he="436" /></maths>对应系数<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mfenced open = '{' close = ''><mtable><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mn>0</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mn>2</mn></mrow></msub></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msub><mi>a</mi><mrow><mi>i</mi><mi>m</mi></mrow></msub></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000774398500000025.GIF" wi="122" he="370" /></maths>则<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>a</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mo>&Sigma;</mo><mrow><mi>j</mi><mo>=</mo><mn>0</mn></mrow><mi>m</mi></munderover><msub><mi>a</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><msub><mi>f</mi><mi>j</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000026.GIF" wi="395" he="133" /></maths>3)定义矢量<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mover><mi>x</mi><mo>&OverBar;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msup><mrow><mo>&lsqb;</mo><msub><mi>f</mi><mn>0</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><msub><mi>f</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>,</mo><mo>...</mo><mo>,</mo><msub><mi>f</mi><mi>m</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mi>x</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>&rsqb;</mo></mrow><mi>T</mi></msup><mo>,</mo></mrow>]]></math><img file="FDA0000774398500000027.GIF" wi="844" he="69" /></maths>则p阶AR模型可表示为:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><mo>&lsqb;</mo><msup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mi>T</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>,</mo><msup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mi>T</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>2</mn><mo>)</mo></mrow><mo>,</mo><mo>...</mo><mo>,</mo><msup><mover><mi>x</mi><mo>&OverBar;</mo></mover><mi>T</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mi>p</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mi>&theta;</mi><mo>=</mo><msub><mi>w</mi><mi>p</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000774398500000028.GIF" wi="1048" he="75" /></maths>将时变参数估计问题转化为时不变参数θ的估计问题,进而得到非平稳钢轨裂纹信号的时变参数AR模型;4)由时变参数建立卡尔曼滤波状态方程:定义状态量:<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mi>X</mi><mi>k</mi></msub><mo>=</mo><mfenced open = '[' close = ']'><mtable><mtr><mtd><mrow><msub><mi>x</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mrow><mi>p</mi><mo>-</mo><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mi>p</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = '[' close = ']'><mtable><mtr><mtd><mrow><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mi>p</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mi>p</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mrow><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>2</mn><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000031.GIF" wi="646" he="380" /></maths>状态向量X<sub>k</sub>为p维,p维状态分量有关系:<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msub><mi>x</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mn>3</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mrow><mi>p</mi><mo>-</mo><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>x</mi><mi>p</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000032.GIF" wi="432" he="315" /></maths>由钢轨裂纹信号时变参数AR模型关系得状态方程:<img file="FDA0000774398500000033.GIF" wi="1645" he="391" />状态方程的一步转移矩阵:<img file="FDA0000774398500000034.GIF" wi="1432" he="390" />系统噪声驱动矩阵:<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><msub><mi>&Gamma;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>=</mo><mfenced open = '[' close = ']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000035.GIF" wi="266" he="383" /></maths>则可得卡尔曼滤波状态方程:X<sub>k</sub>=Φ<sub>k,k‑1</sub>X<sub>k‑1</sub>+Γ<sub>k,k‑1</sub>W<sub>k‑1</sub>,式中系统噪声W<sub>k</sub>=w<sub>p</sub>(k);5)测量扩增法建立卡尔曼滤波新的测量方程:<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><msubsup><mi>Z</mi><mi>k</mi><mo>*</mo></msubsup><mo>=</mo><msubsup><mi>H</mi><mi>k</mi><mo>*</mo></msubsup><msub><mi>X</mi><mi>k</mi></msub><mo>+</mo><msubsup><mi>V</mi><mi>k</mi><mo>*</mo></msubsup><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000041.GIF" wi="370" he="84" /></maths>原卡尔曼滤波测量方程:Z<sub>k</sub>=H<sub>k</sub>X<sub>k</sub>+V<sub>k</sub>,式中H<sub>k</sub>为测量矩阵,V<sub>k</sub>为测量噪声,定义新的测量量<img file="FDA0000774398500000042.GIF" wi="79" he="60" />测量矩阵<img file="FDA0000774398500000043.GIF" wi="92" he="60" />测量噪声<img file="FDA0000774398500000044.GIF" wi="75" he="60" /><maths num="0013" id="cmaths0013"><math><![CDATA[<mrow><mfenced open = '{' close = ''><mtable><mtr><mtd><mrow><msubsup><mi>Z</mi><mi>k</mi><mo>*</mo></msubsup><mo>=</mo><msub><mi>Z</mi><mi>k</mi></msub><mo>-</mo><msub><mi>&Psi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>Z</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>H</mi><mi>k</mi><mo>*</mo></msubsup><mo>=</mo><mrow><mo>(</mo><msub><mi>H</mi><mi>k</mi></msub><msub><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>&Psi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>H</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><msubsup><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>V</mi><mi>k</mi><mo>*</mo></msubsup><mo>=</mo><msub><mi>H</mi><mi>k</mi></msub><msub><mi>&Gamma;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>W</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mi>&zeta;</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub></mrow></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000045.GIF" wi="792" he="281" /></maths>其中Z<sub>k</sub>=z(k),{z(k)}为测得含噪声发射信号,<img file="FDA0000774398500000046.GIF" wi="51" he="60" />为零均值的白噪声,方差为:<maths num="0014" id="cmaths0014"><math><![CDATA[<mrow><msubsup><mi>R</mi><mi>k</mi><mo>*</mo></msubsup><mo>=</mo><msub><mi>H</mi><mi>k</mi></msub><msub><mi>&Gamma;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>Q</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msubsup><mi>&Gamma;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>T</mi></msubsup><msubsup><mi>H</mi><mi>k</mi><mi>T</mi></msubsup><mo>+</mo><msub><mi>R</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>,</mo></mrow>]]></math><img file="FDA0000774398500000047.GIF" wi="674" he="85" /></maths>式中R<sub>k</sub>为ζ<sub>k‑1</sub>的方差,<img file="FDA0000774398500000048.GIF" wi="196" he="60" />Q<sub>k</sub>为W<sub>k</sub>的方差,<img file="FDA0000774398500000049.GIF" wi="203" he="66" />步骤四、有色轮轨接触噪声卡尔曼滤波估计钢轨裂纹信号:1)有色测量噪声卡尔曼滤波递推算法:状态一步预测<img file="FDA00007743985000000410.GIF" wi="137" he="70" /><maths num="0015" id="cmaths0015"><math><![CDATA[<mrow><msub><mover><mi>X</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>=</mo><msub><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mover><mi>X</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>;</mo></mrow>]]></math><img file="FDA00007743985000000411.GIF" wi="404" he="94" /></maths>状态一步预测误差方差阵P<sub>k,k‑1</sub>:<maths num="0016" id="cmaths0016"><math><![CDATA[<mrow><msub><mi>P</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>=</mo><msub><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>P</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msubsup><mi>&Phi;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>T</mi></msubsup><mo>+</mo><msub><mi>&Gamma;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msub><mi>Q</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msubsup><mi>&Gamma;</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>T</mi></msubsup><mo>;</mo></mrow>]]></math><img file="FDA00007743985000000412.GIF" wi="796" he="88" /></maths>滤波增益矩阵K<sub>k</sub>:<maths num="0017" id="cmaths0017"><math><![CDATA[<mrow><msub><mi>K</mi><mi>k</mi></msub><mo>=</mo><msub><mi>P</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msubsup><mi>H</mi><mi>k</mi><mrow><mo>*</mo><mi>T</mi></mrow></msubsup><msup><mrow><mo>(</mo><msubsup><mi>H</mi><mi>k</mi><mo>*</mo></msubsup><msub><mi>P</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><msubsup><mi>H</mi><mi>k</mi><mrow><mo>*</mo><mi>T</mi></mrow></msubsup><mo>+</mo><msubsup><mi>R</mi><mi>k</mi><mo>*</mo></msubsup><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>;</mo></mrow>]]></math><img file="FDA00007743985000000413.GIF" wi="745" he="95" /></maths>状态滤波估计<img file="FDA0000774398500000051.GIF" wi="83" he="65" /><maths num="0018" id="cmaths0018"><math><![CDATA[<mrow><msub><mover><mi>X</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><msub><mover><mi>X</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mi>K</mi><mi>k</mi></msub><msup><mrow><mo>&lsqb;</mo><msubsup><mi>Z</mi><mi>k</mi><mo>*</mo></msubsup><mo>-</mo><msubsup><mi>H</mi><mi>k</mi><mo>*</mo></msubsup><msub><mover><mi>X</mi><mo>^</mo></mover><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>&rsqb;</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000052.GIF" wi="697" he="99" /></maths>滤波误差方差阵P<sub>k</sub>:<maths num="0019" id="cmaths0019"><math><![CDATA[<mrow><msub><mi>P</mi><mi>k</mi></msub><mo>=</mo><mo>&lsqb;</mo><mi>I</mi><mo>-</mo><msub><mi>K</mi><mi>k</mi></msub><msubsup><mi>H</mi><mi>k</mi><mo>*</mo></msubsup><mo>&rsqb;</mo><msub><mi>P</mi><mrow><mi>k</mi><mo>,</mo><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000053.GIF" wi="447" he="94" /></maths>式中I为单位阵;2)滤波初值确定:<maths num="0020" id="cmaths0020"><math><![CDATA[<mrow><msub><mover><mi>X</mi><mo>^</mo></mover><mn>0</mn></msub><mo>=</mo><msub><mi>&mu;</mi><msub><mi>X</mi><mn>0</mn></msub></msub><mo>+</mo><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><msubsup><mi>H</mi><mn>0</mn><mi>T</mi></msubsup><msup><mrow><mo>(</mo><msub><mi>H</mi><mn>0</mn></msub><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><msubsup><mi>H</mi><mn>0</mn><mi>T</mi></msubsup><mo>+</mo><msub><mi>R</mi><mn>0</mn></msub><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><msub><mi>Z</mi><mn>0</mn></msub><mo>-</mo><msub><mi>H</mi><mn>0</mn></msub><msub><mi>&mu;</mi><msub><mi>Z</mi><mn>0</mn></msub></msub><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000054.GIF" wi="1046" he="102" /></maths><maths num="0021" id="cmaths0021"><math><![CDATA[<mrow><msub><mi>P</mi><mn>0</mn></msub><mo>=</mo><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><mo>+</mo><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><msubsup><mi>H</mi><mn>0</mn><mi>T</mi></msubsup><msup><mrow><mo>(</mo><msub><mi>H</mi><mn>0</mn></msub><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><msubsup><mi>H</mi><mn>0</mn><mi>T</mi></msubsup><mo>+</mo><msub><mi>R</mi><mn>0</mn></msub><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msub><mi>H</mi><mn>0</mn></msub><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><mo>;</mo></mrow>]]></math><img file="FDA0000774398500000055.GIF" wi="891" he="87" /></maths>式中<img file="FDA0000774398500000056.GIF" wi="273" he="74" />是X<sub>0</sub>的均值,<img file="FDA0000774398500000057.GIF" wi="250" he="69" />是Z<sub>0</sub>的均值,<maths num="0022" id="cmaths0022"><math><![CDATA[<mrow><msub><mi>C</mi><msub><mi>X</mi><mn>0</mn></msub></msub><mo>=</mo><mi>E</mi><mo>&lsqb;</mo><msub><mi>X</mi><mn>0</mn></msub><msubsup><mi>X</mi><mn>0</mn><mi>T</mi></msubsup><mo>&rsqb;</mo></mrow>]]></math><img file="FDA0000774398500000058.GIF" wi="333" he="86" /></maths>表示X<sub>0</sub>的方差。
地址 150000 黑龙江省哈尔滨市南岗区西大直街92号