发明名称 一种机动目标状态方程的多项式预测模型及跟踪方法
摘要 本发明属于机动目标跟踪技术领域,具体为一种机动目标状态方程的多项预测模型及跟踪算法。本发明根据匀变速运动的多项式形式,将变加速运动作为分段匀变速运动处理,提出了一种新的机动目标动态模型——多项式预测模型。该模型能够完全避免对描述未知运动的多项式系数的依赖,用本发明方法建立的状态方程始终能准确描述运动的动态。因此本发明提出的模型能够适用于各种运动目标状态方程,本发明提出的多项式预测模型的最优滤波算法适用于任何可以用多项式描述的机动目标状态估计问题,既不需要关于目标运动参数的先验信息,又不需要通过参数辨识等手段调整建立状态模型的参数,从而完全避免了由于状态模型不准确而带来的估计性能恶化问题。
申请公布号 CN101299271A 申请公布日期 2008.11.05
申请号 CN200810038855.8 申请日期 2008.06.12
申请人 复旦大学 发明人 高羽;张建秋;尹建君
分类号 G06T7/20(2006.01) 主分类号 G06T7/20(2006.01)
代理机构 上海正旦专利代理有限公司 代理人 陆飞;盛志范
主权项 1、一种机动目标状态方程的多项式预测模型,其特征在于假设信号x(n)是由下述方程描述的一个L阶多项式:<math><mrow><mi>x</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>l</mi><mo>=</mo><mn>0</mn></mrow><mi>L</mi></munderover><mi>p</mi><mrow><mo>(</mo><mi>l</mi><mo>)</mo></mrow><msup><mi>n</mi><mn>1</mn></msup><mo>,</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>其中,p(l)为多项式的系数,l=0,...,L;如果用信号x(n)的前K个时刻的值x(n-K+1),...,x(n)来预测信号式(2)的将来值x(n+N),即:<math><mrow><mi>x</mi><mrow><mo>(</mo><mi>n</mi><mo>+</mo><mi>N</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>k</mi><mo>=</mo><mn>0</mn></mrow><mrow><mi>K</mi><mo>-</mo><mn>1</mn></mrow></munderover><mi>h</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mi>x</mi><mrow><mo>(</mo><mi>n</mi><mo>-</mo><mi>k</mi><mo>)</mo></mrow><mo>,</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>对于作匀变速运动的目标,其运动由下述方程描述:<math><mrow><mi>J</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mi>J</mi><mrow><mo>(</mo><mn>0</mn><mo>)</mo></mrow><mo>+</mo><mi>v</mi><mrow><mo>(</mo><mn>0</mn><mo>)</mo></mrow><mo>&CenterDot;</mo><mi>t</mi><mo>+</mo><mfrac><mn>1</mn><mn>2</mn></mfrac><mi>a</mi><mo>&CenterDot;</mo><msup><mi>t</mi><mn>2</mn></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>v(t)=v(0)+a·t (12)其中,J(t),v(t)为目标在t时刻的位移和速度,J(0),v(0)为目标的初始位置和初始速度,a为目标的加速度;当式(11)和(12)被离散化后,在数学上它们用预测滤波器严格等效,即:<math><mrow><mi>J</mi><mrow><mo>(</mo><mi>n</mi><mo>+</mo><mi>N</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>k</mi><mo>=</mo><mn>0</mn></mrow><mrow><mi>K</mi><mo>-</mo><mn>1</mn></mrow></munderover><mi>h</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mi>J</mi><mrow><mo>(</mo><mi>n</mi><mo>-</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow>等效式(11),<math><mrow><mrow><mo>(</mo><mi>n</mi><mo>+</mo><mi>N</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>k</mi><mo>=</mo><mn>0</mn></mrow><mrow><mi>K</mi><mo>-</mo><mn>1</mn></mrow></munderover><mi>h</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mi>v</mi><mrow><mo>(</mo><mi>n</mi><mo>-</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow>等效式(12),其中:式(13)和(14)的系数h(k),k=0,...,K-1,由式(9)或(10)预先计算获得;当式(2)给出机动目标位置和/或速度的观测时,式(11)和(12)离散化的状态空间模型统一等效描述为:X(n+1)=FppfX(n) (15a)Y(n)=HppfX(n)+W(n) (15b)其中,式(15b)是根据测量原理而确定的测量方程,X(n+1)=[x(n+1),x(n),...,x(n-K+2)]T,X(n)=[x(n),x(n-1),...,x(n-K+1)]T,观测向量为Y(n)=[y(n),y(n-1),...,y(n-K+1)]T,观测噪声向量为W(n)=[w(n),w(n-1),...,w(n-K+1)],方差E(WjWn T)=diag(R(n),...,R(n-K+1)),误差R(n)=E(w(n)wT(n)),y(n)=cx(n)+w(n),状态转移矩阵为<math><mrow><msub><mi>F</mi><mi>ppf</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>h</mi><mrow><mo>(</mo><mn>0</mn><mo>)</mo></mrow></mtd><mtd><mi>h</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mi>h</mi><mrow><mo>(</mo><mi>K</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>h(0),…h(K-1)由式(9)或(10)计算得出;状态观测矩阵为<math><mrow><msub><mi>H</mi><mi>ppf</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>c</mi></mtd><mtd><mn>0</mn></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>c</mi></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd><mtd><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>c</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>这里C为与测量原理有关的测量函数,由实际测量对象确定;当N=1,L=1时,<math><mrow><mi>h</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mn>4</mn><mi>K</mi><mo>-</mo><mn>6</mn><mi>k</mi><mo>-</mo><mn>4</mn></mrow><mrow><mi>K</mi><mrow><mo>(</mo><mi>K</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mrow></mfrac><mo>,</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>当N=1,L=2时,<math><mrow><mi>h</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mn>9</mn><msup><mi>K</mi><mn>2</mn></msup><mo>+</mo><mrow><mo>(</mo><mo>-</mo><mn>27</mn><mo>-</mo><mn>36</mn><mi>k</mi><mo>)</mo></mrow><mi>K</mi><mo>+</mo><mn>30</mn><msup><mi>k</mi><mn>2</mn></msup><mo>+</mo><mn>42</mn><mi>k</mi><mo>+</mo><mn>18</mn></mrow><mrow><msup><mi>K</mi><mn>3</mn></msup><mo>-</mo><mn>3</mn><msup><mi>K</mi><mn>2</mn></msup><mo>+</mo><mn>2</mn><mi>K</mi></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>其中,k=0,1,...K-1。
地址 200433上海市邯郸路220号