发明名称 一种对双观测系统量测噪声方差阵的自适应同步估计方法
摘要 本发明提出一种对双观测系统量测噪声方差阵的自适应同步估计方法,属于信号处理技术领域,该方法包括:得到两观测系统在各时刻的数据信号;计算两观测系统数据信号Z1(i)的自差分序列以及两个自差分序列的互差分序列;计算两观测系统数据信号在不同窗口长度下自差分序列的方差以及两个观测系统在不同窗口长度下互差分序列的方差,得到两观测系统不同窗口长度下的量测噪声方差阵;使用最优窗口长度计算得当前时刻的量测噪声方差阵。本发明利用双测量系统自差分序列和互差分序列信息,能够同时有效估计出两个测量系统的量测噪声方差阵,可实时调节计算噪声方差阵时的数据窗口长度,提高估计精度。本发明单纯利用测量系统信息,避免了误差耦合,精度较高。
申请公布号 CN102749096B 申请公布日期 2014.11.05
申请号 CN201210213914.7 申请日期 2012.06.25
申请人 北京航空航天大学 发明人 张海;周启帆;王嫣然
分类号 G01D18/00(2006.01)I 主分类号 G01D18/00(2006.01)I
代理机构 北京永创新实专利事务所 11121 代理人 官汉增
主权项 一种对双观测系统量测噪声方差阵的自适应同步估计方法,其特征在于:包括以下几个步骤:步骤一:分别得到观测系统A、观测系统B在各时刻的数据信号Z1(i)、Z2(i),其中i为观测系统的数据信号测量时刻;步骤二:分别计算观测系统A数据信号Z1(i)的自差分序列和观测系统B数据信号Z2(i)的自差分序列,并计算两个自差分序列的互差分序列,具体为:(1)观测系统A数据信号Z1(i)的自差分序列ΔZ1(i)为:ΔZ1(i)=Z1(i)‑Z1(i‑1)其中i‑1和i分别表示观测系统A的数据采集时刻;(2)观测系统B数据信号Z2(i)的自差分序列ΔZ2(i)为:ΔZ2(i)=Z2(i)‑Z2(i‑1)其中i‑1和i分别表示观测系统B的数据采集时刻;(3)观测系统A和观测系统B的两个自差分序列的互差分序列C(i)为:C(i)=ΔZ1(i)‑ΔZ2(i)步骤三:分别计算观测系统A数据信号在不同窗口长度下自差分序列的方差,观测系统B数据信号在不同窗口长度下自差分序列的方差,以及两个观测系统在不同窗口长度下互差分序列的方差,并利用方差进行相关计算得到观测系统A、观测系统B不同窗口长度下的量测噪声方差阵R1、R2,具体为:(1)首先选取最大窗口长度M<sub>Max</sub>、最小窗口长度M<sub>Min</sub>和窗口长度间隔M<sub>Dis</sub>,且M<sub>Max</sub>与M<sub>Min</sub>之差为窗口长度间隔M<sub>Dis</sub>的整数倍,若当前数据信号量测时刻k小于等于M<sub>Max</sub>,则直接采用窗口长度累积的方式计算观测系统A自差分序列的方差:<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>E</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><mi>&Delta;Z</mi><mn>1</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><msup><mrow><mo>[</mo><mi>&Delta;Z</mi><mn>1</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>E</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000011.GIF" wi="589" he="295" /></maths>其中E<sub>1</sub>(k)表示观测系统A的1到k时刻观测值序列的均值,σ<sub>1</sub>(k)表示观测系统A的1到k时刻观测值序列的方差;若当前数据信号量测时刻k大于M<sub>Max</sub>,则计算观测系统A数据信号在不同窗口长度下自差分序列的方差:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>E</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>k</mi><mo>-</mo><mi>M</mi></mrow><mi>k</mi></munderover><mi>&Delta;Z</mi><mn>1</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>k</mi><mo>-</mo><mi>M</mi></mrow><mi>k</mi></munderover><msup><mrow><mo>[</mo><mi>&Delta;Z</mi><mn>1</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>E</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced><mi>M</mi><mo>=</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>.</mo><mo>.</mo><mo>.</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Max</mi></msub></mrow>]]></math><img file="FDA0000524679830000021.GIF" wi="1668" he="297" /></maths>其中,k为观测系统A当前数据信号量测时刻,i为数据信号量测时刻,ΔZ1(i)为观测系统A自差分序列在i时刻的值,E<sub>1</sub>(M,k)为k时刻窗口长度为M时观测系统A自差分序列的均值,σ<sub>1</sub>(M,k)为k时刻窗口长度为M时自差分序列的方差,M为窗口长度序列;(2)若当前数据量测时刻k小于等于M<sub>Max</sub>,则直接采用窗口长度累积的方式计算观测系统B自差分序列的方差:<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>E</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><mi>&Delta;Z</mi><mn>2</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><msup><mrow><mo>[</mo><mi>&Delta;Z</mi><mn>2</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>E</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000022.GIF" wi="608" he="298" /></maths>其中E<sub>2</sub>(k)表示观测系统B的1到k时刻观测值序列的均值,σ<sub>2</sub>(k)表示观测系统B的1到k时刻观测值序列的方差;若当前数据量测时刻k大于M<sub>Max</sub>,则计算观测系统B数据信号在不同窗口长度下的自差分序列的方差:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>E</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>k</mi><mo>-</mo><mi>M</mi></mrow><mi>k</mi></munderover><mi>&Delta;Z</mi><mn>2</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>k</mi><mo>-</mo><mi>M</mi></mrow><mi>k</mi></munderover><msup><mrow><mo>[</mo><mi>&Delta;Z</mi><mn>2</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>E</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced><mi>M</mi><mo>=</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>.</mo><mo>.</mo><mo>.</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Max</mi></msub></mrow>]]></math><img file="FDA0000524679830000023.GIF" wi="1692" he="304" /></maths>其中,k为观测系统B当前数据信号量测时刻,i为数据信号量测时刻,ΔZ2(i)为观测系统B自差分序列在i时刻的值,E<sub>2</sub>(M,k)为k时刻窗口长度为M时观测系统B自差分序列的均值,σ<sub>2</sub>(M,k)为k时刻窗口长度为M时的自差分序列方差,M为窗口长度序列;(3)若当前数据量测时刻k小于等于M<sub>Max</sub>,计算两个观测系统互差分序列的方差σ<sub>C</sub>(k):<maths num="0005" id="cmaths0005"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mi>C</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>=</mo><mi>&Delta;Z</mi><mn>1</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><mi>&Delta;Z</mi><mn>2</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>E</mi><mi>C</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><mi>C</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mi>C</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>k</mi></munderover><msup><mrow><mo>[</mo><mi>C</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>E</mi><mi>C</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000024.GIF" wi="568" he="440" /></maths>其中,C(i)表示观测系统A和观测系统B自差分序列在i时刻的互差分序列;E<sub>C</sub>(k)表示k时刻互差分序列的均值;若当前系统数据量测时刻k大于M<sub>Max</sub>,则按下式计算两个量测系统互差分序列的方差:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><mi>C</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>=</mo><mi>&Delta;Z</mi><mn>1</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><mi>&Delta;Z</mi><mn>2</mn><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>E</mi><mi>C</mi></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>k</mi><mo>-</mo><mi>M</mi></mrow><mi>k</mi></munderover><mi>C</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mi>C</mi></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>k</mi><mo>-</mo><mi>M</mi></mrow><mi>k</mi></munderover><msup><mrow><mo>[</mo><mi>C</mi><mrow><mo>(</mo><mi>i</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>E</mi><mi>C</mi></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>]</mo></mrow><mn>2</mn></msup></mtd></mtr></mtable></mfenced><mi>M</mi><mo>=</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>.</mo><mo>.</mo><mo>.</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Max</mi></msub></mrow>]]></math><img file="FDA0000524679830000031.GIF" wi="1699" he="445" /></maths>其中,k为测量系统当前数据信号量测时刻,i为数据信号量测时刻,C(i)表示观测系统A和观测系统B自差分序列在i时刻的互差分序列,E<sub>C</sub>(M,k)为k时刻窗口长度为M时互差分序列的均值,σ<sub>C</sub>(M,k)为k时刻窗口长度为M时互差分序列的方差,M为窗口长度序列;(4)利用上述(1)、(2)、(3)步骤中得到的各个方差计算观测系统A和观测系统B的量测噪声方差阵;若当前数据信号量测时刻k小于等于M<sub>Max</sub>,量测噪声方差阵为:<maths num="0007" id="cmaths0007"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>R</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr><mtr><mtd><msub><mi>R</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000032.GIF" wi="668" he="277" /></maths>R<sub>1</sub>(k)表示数据量测时刻k小于等于M<sub>Max</sub>时观测系统A的量测噪声方差阵;R<sub>2</sub>(k)表示数据量测时刻k小于等于M<sub>Max</sub>时观测系统B的量测噪声方差阵;若当前数据信号量测时刻k大于M<sub>Max</sub>,量测噪声方差阵为:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>R</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr><mtr><mtd><msub><mi>R</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr></mtable></mfenced><mi>M</mi><mo>=</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>.</mo><mo>.</mo><mo>.</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><msub><mi>M</mi><mi>Max</mi></msub></mrow>]]></math><img file="FDA0000524679830000033.GIF" wi="1942" he="276" /></maths>其中,k为系统当前数据量测时刻,σ<sub>1</sub>(k)、σ<sub>2</sub>(k)分别为观测系统A、观测系统B自差分序列在k时刻的方差,σ<sub>C</sub>(k)为互差分序列在k时刻的方差,M为窗口长度,R<sub>1</sub>(M,k)表示数据量测时刻k大于M<sub>Max</sub>时观测系统A的量测噪声方差阵;R<sub>2</sub>(M,k)表示数据量测时刻k大于M<sub>Max</sub>时观测系统B的量测噪声方差阵;步骤四:根据两个观测系统在不同窗口长度下计算得到的量测噪声方差阵信息,得到当前时刻最优窗口长度,使用最优窗口长度计算得当前时刻的量测噪声方差阵,具体为:(1)当k小于等于M<sub>Max</sub>时,直接按照步骤三(4)中k小于等于M<sub>Max</sub>情况下的公式计算量测噪声方差阵:<maths num="0009" id="cmaths0009"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>R</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr><mtr><mtd><msub><mi>R</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000034.GIF" wi="668" he="281" /></maths>(2)当k大于M<sub>Max</sub>时,将k时刻不同窗口下计算得到的噪声方差阵序列使用一次线形函数进行拟合,并记录其斜率;<maths num="0010" id="cmaths0010"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>a</mi><mo>*</mo><mrow><mo>(</mo><mfrac><mrow><msub><mi>M</mi><mi>Min</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mi>b</mi></mtd></mtr><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>a</mi><mo>*</mo><mrow><mo>(</mo><mfrac><mrow><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mi>b</mi></mtd></mtr><mtr><mtd><mfenced open='' close=''><mtable><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mfenced open='' close=''><mtable><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mfenced open='' close=''><mtable><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr></mtable></mfenced></mtd></mtr><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>a</mi><mo>*</mo><mrow><mo>(</mo><mfrac><mrow><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mi>b</mi></mtd></mtr><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>a</mi><mo>*</mo><mrow><mo>(</mo><mfrac><mrow><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mi>b</mi></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000041.GIF" wi="1073" he="671" /></maths><maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Min</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><msup><mrow><mo>[</mo><mi>a</mi><mo>,</mo><mi>b</mi><mo>]</mo></mrow><mi>T</mi></msup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>R</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>Max</mi></msub><mo>,</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000524679830000042.GIF" wi="1164" he="671" /></maths>其中,k为当前时刻,a为拟合直线的斜率,b为拟合直线的截距:<maths num="0012" id="cmaths0012"><math><![CDATA[<mrow><mi>K</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Min</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Min</mi></msub><mo>+</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Dis</mi></msub><mo>-</mo><msub><mi>M</mi><mi>Min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>M</mi><mi>Max</mi></msub><mo>-</mo><msub><mi>M</mi><mi>min</mi></msub></mrow><msub><mi>M</mi><mi>Dis</mi></msub></mfrac><mo>+</mo><mn>1</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000524679830000043.GIF" wi="690" he="670" /></maths><img file="FDA0000524679830000044.GIF" wi="511" he="384" />则拟合直线的斜率和截距为:<img file="FDA0000524679830000046.GIF" wi="670" he="97" />其中R(M<sub>Min</sub>,k)、R(M<sub>Min</sub>+M<sub>Dis</sub>,k)、R(M<sub>Max</sub>‑M<sub>Dis</sub>,k)、R(M<sub>Max</sub>,k)分别表示窗口长度为M<sub>Min</sub>,(M<sub>Min</sub>+M<sub>Dis</sub>),(M<sub>Max</sub>‑M<sub>Dis</sub>),M<sub>Max</sub>时的量测噪声方差阵;(3)将拟合直线计算的斜率带入下式方程得到当前时刻k应使用的数据窗口长度M',若计算得到的窗口长度M'小于M<sub>Min</sub>,则取M'为M<sub>Min</sub>,且M<sub>Min</sub>取值为100:<img file="FDA0000524679830000045.GIF" wi="749" he="207" />其中:fix(·)表示取整,a<sub>max</sub>为所拟合的直线达到的最大斜率;(4)利用最优窗口内的序列信息计算得到最终噪声方差阵的估计值:<maths num="0013" id="cmaths0013"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><mrow><msub><mi>R</mi><mrow><mn>1</mn><mi>f</mi></mrow></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><msup><mi>M</mi><mo>&prime;</mo></msup><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><msup><mi>M</mi><mo>&prime;</mo></msup><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><msup><mi>M</mi><mo>&prime;</mo></msup><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mrow></mtd></mtr><mtr><mtd><msub><mi>R</mi><mrow><mn>2</mn><mi>f</mi></mrow></msub><mrow><mo>(</mo><mi>M</mi><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>&sigma;</mi><mi>c</mi></msub><mrow><mo>(</mo><msup><mi>M</mi><mo>&prime;</mo></msup><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mrow><mo>(</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mrow><mo>(</mo><msup><mi>M</mi><mo>&prime;</mo></msup><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mrow><mo>(</mo><msup><mi>M</mi><mo>&prime;</mo></msup><mo>,</mo><mi>k</mi><mo>)</mo></mrow><mo>)</mo></mrow></mrow><mn>4</mn></mfrac></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000524679830000051.GIF" wi="1007" he="281" /></maths>R<sub>1f</sub>(M,k)、R<sub>2f</sub>(M,k)分别表示观测系统A、观测系统B在k时刻估计得到的量测噪声方差阵。
地址 100191 北京市海淀区学院路37号