发明名称 雷达网抗距离欺骗+SOJ复合干扰方法
摘要 本发明公开了一种雷达网抗距离欺骗+SOJ复合干扰方法,该方法隶属于雷达网抗干扰技术领域。距离欺骗+SOJ是一种典型的复合干扰,严重影响雷达网对目标的探测和跟踪,为了提高雷达网的抗干扰性能,本发明给出了一种雷达网抗距离欺骗+SOJ复合干扰方法。本发明的方法主要包括以下步骤:(一)将各雷达的数据输入雷达数据处理计算机;(二)利用假目标角度信息与真实目标的角度信息极为相近的特点,将各个雷达的量测分组;(三)对每个量测分组进行方位角、俯仰角数据压缩;(四)将不同雷达量测分组进行关联;(五)构建基于最小二乘法的等效量测;(六)利用等效量测进行目标跟踪。本发明解决了在此种复合干扰下只检测到虚假目标而漏掉真实目标所导致的目标跟踪错误和滤波发散问题,具有实现容易、稳定性好等优点,工程应用前景较好。
申请公布号 CN103809161A 申请公布日期 2014.05.21
申请号 CN201410018186.3 申请日期 2014.01.09
申请人 中国人民解放军海军航空工程学院 发明人 王国宏;孙殿星;吴巍;李世忠;于洪波
分类号 G01S7/36(2006.01)I 主分类号 G01S7/36(2006.01)I
代理机构 代理人
主权项 1.一种雷达网抗距离欺骗+SOJ复合干扰方法,其特征在于包括以下步骤:步骤1:录取数据在距离欺骗+SOJ复合干扰下,将组网雷达测得的信号(包含真实目标的回波信号和虚假目标的欺骗信号)送入雷达数据录取器,得到真实目标和虚假目标的距离、方位角、俯仰角,将录取的数据输入雷达数据处理计算机;由于SOJ的存在,真实目标的检测概率下降,在很多时刻会只检测到虚假目标而丢失真实目标;在雷达数据处理计算机中执行以下<u>步骤:</u>步骤2:雷达量测分组利用假目标角度信息与真实目标的角度信息极为相近的特点,将各个雷达的量测分组:(1)输入雷达量测<img file="FSA0000100430480000011.GIF" wi="209" he="70" />为k时刻雷达的第i个量测集;<img file="FSA0000100430480000012.GIF" wi="46" he="71" />为距离量测;<img file="FSA0000100430480000013.GIF" wi="51" he="70" />为俯仰角量测;<img file="FSA0000100430480000014.GIF" wi="50" he="65" />为方位角量测;<img file="FSA0000100430480000015.GIF" wi="225" he="71" />为k时刻雷达的第j个量测集;<img file="FSA0000100430480000016.GIF" wi="53" he="70" />为距离量测;<img file="FSA0000100430480000017.GIF" wi="58" he="70" />为俯仰角量测;<img file="FSA0000100430480000018.GIF" wi="53" he="69" />为方位角量测;(2)计算检验统计量<maths num="0001"><![CDATA[<math><mrow><mi>&zeta;</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msubsup><mi>&theta;</mi><mi>k</mi><mi>i</mi></msubsup><mo>-</mo><msubsup><mi>&theta;</mi><mi>k</mi><mi>j</mi></msubsup></mtd><mtd><msubsup><mi>&phi;</mi><mi>k</mi><mi>i</mi></msubsup><mo>-</mo><msubsup><mi>&phi;</mi><mi>k</mi><mi>j</mi></msubsup></mtd></mtr></mtable></mfenced><msup><mfenced open='(' close=')'><mtable><mtr><mtd><mn>2</mn><msubsup><mi>&sigma;</mi><mi>&theta;</mi><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>2</mn><msubsup><mi>&sigma;</mi><mi>&phi;</mi><mn>2</mn></msubsup></mtd></mtr></mtable></mfenced><mrow><mo>-</mo><mn>1</mn></mrow></msup><mfenced open='(' close=')'><mtable><mtr><mtd><msubsup><mi>&theta;</mi><mi>k</mi><mi>i</mi></msubsup><mo>-</mo><msubsup><mi>&theta;</mi><mi>k</mi><mi>j</mi></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>&phi;</mi><mi>k</mi><mi>i</mi></msubsup><mo>-</mo><msubsup><mi>&phi;</mi><mi>k</mi><mi>j</mi></msubsup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></math>]]></maths>σ<sub>θ</sub>为雷达的俯仰角量测误差标准差;σ<sub>φ</sub>为雷达的方位角量测误差标准差;(3)选定判决门限G<sub>α</sub>给定显著性水平α,根据2自由度χ<sup>2</sup>分布的显著性水平确定判决门限G<sub>α</sub>;当α=0.05时G<sub>α</sub>=5.991;当α=0.01时G<sub>α</sub>=9.210;(4)分组判决若ζ≤G<sub>α</sub>,则两量测集判定为同一组;若ζ≥G<sub>α</sub>,两量测集判定为不同组;任取雷达的两个量测,若这两个量测归为一组,则将其它量测与已有分组中的任意一个量测按相同的方法进行检验,如果某量测对所有的分组都不满足式ζ≤G<sub>α</sub>,则产生一个新的分组,并将这个量测归入其中;步骤3:对每个量测分组进行方位角、俯仰角数据压缩<maths num="0002"><![CDATA[<math><mrow><msub><mi>&theta;</mi><mi>lk</mi></msub><mo>=</mo><mfrac><mn>1</mn><msub><mi>n</mi><mi>l</mi></msub></mfrac><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>l</mi></mrow><msub><mi>n</mi><mi>l</mi></msub></munderover><msubsup><mi>&theta;</mi><mi>lk</mi><mi>i</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0003"><![CDATA[<math><mrow><msub><mi>&phi;</mi><mi>lk</mi></msub><mo>=</mo><mfrac><mn>1</mn><msub><mi>n</mi><mi>l</mi></msub></mfrac><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>l</mi></mrow><msub><mi>n</mi><mi>l</mi></msub></munderover><msubsup><mi>&phi;</mi><mi>lk</mi><mi>i</mi></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>θ<sub>lk</sub>为k时刻第l个类压缩后的俯仰角量测;<img file="FSA0000100430480000023.GIF" wi="57" he="70" />为k时刻第l个类压缩后的方位角量测;<img file="FSA0000100430480000024.GIF" wi="58" he="70" />为k时刻第l个类中的第i个俯仰角量测;<img file="FSA0000100430480000025.GIF" wi="56" he="71" />为k时刻第l个类中的第i个方位角量测;n<sub>l</sub>为第l个类中量测的数量;将步骤3处理后的数据传输给融合中心,在融合中心执行以下步骤:步骤4:不同雷达量测分组的关联(1)计算检验统计量η<maths num="0004"><![CDATA[<math><mrow><mi>&eta;</mi><mo>=</mo><mfrac><msup><mi>M</mi><mn>2</mn></msup><mrow><msup><mrow><mo>(</mo><mfrac><mrow><mo>&PartialD;</mo><mi>M</mi></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mi>i</mi></msub></mrow></mfrac><mo>)</mo></mrow><mn>2</mn></msup><msubsup><mi>&sigma;</mi><mi>&theta;i</mi><mn>2</mn></msubsup><mo>+</mo><msup><mrow><mo>(</mo><mfrac><mrow><mo>&PartialD;</mo><mi>M</mi></mrow><mrow><mo>&PartialD;</mo><msub><mi>&phi;</mi><mi>i</mi></msub></mrow></mfrac><mo>)</mo></mrow><mn>2</mn></msup><msubsup><mi>&sigma;</mi><mi>&phi;i</mi><mn>2</mn></msubsup><mo>+</mo><msup><mrow><mo>(</mo><mfrac><mrow><mo>&PartialD;</mo><mi>M</mi></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mi>j</mi></msub></mrow></mfrac><mo>)</mo></mrow><mn>2</mn></msup><msubsup><mi>&sigma;</mi><mi>&theta;j</mi><mn>2</mn></msubsup><mo>+</mo><msup><mrow><mo>(</mo><mfrac><mrow><mo>&PartialD;</mo><mi>M</mi></mrow><mrow><mo>&PartialD;</mo><msub><mi>&phi;</mi><mi>j</mi></msub></mrow></mfrac><mo>)</mo></mrow><mn>2</mn></msup><msubsup><mi>&sigma;</mi><mi>&phi;j</mi><mn>2</mn></msubsup></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0005"><![CDATA[<math><mrow><mi>M</mi><mo>=</mo><mfenced open='|' close='|'><mtable><mtr><mtd><msub><mi>x</mi><mi>i</mi></msub><mo>-</mo><msub><mi>x</mi><mi>j</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mi>i</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>i</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mi>j</mi></msub><mi>cos</mi><msub><mi>&phi;</mi><mi>j</mi></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>i</mi></msub><mo>-</mo><msub><mi>y</mi><mi>j</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mi>i</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>i</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mi>j</mi></msub><mi>sin</mi><msub><mi>&phi;</mi><mi>j</mi></msub></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>i</mi></msub><mo>-</mo><msub><mi>z</mi><mi>j</mi></msub></mtd><mtd><mi>sin</mi><msub><mi>&theta;</mi><mi>i</mi></msub></mtd><mtd><mi>sin</mi><msub><mi>&theta;</mi><mi>j</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>θ<sub>i</sub>为雷达i的某个“量测类”压缩后的俯仰角;φ<sub>i</sub>为雷达i的某个“量测类”压缩后的方位角;θ<sub>j</sub>为雷达j的某个“量测类”压缩后的俯仰角;φ<sub>j</sub>为雷达j的某个“量测类”压缩后的方位角;σ<sub>θi</sub>、σ<sub>φi</sub>分别为雷达i俯仰角、方位角的量测精度;σ<sub>θj</sub>、σ<sub>φj</sub>分别为雷达j俯仰角、方位角的量测精度;(2)选定判决门限G′<sub>α</sub>给定显著性水平α,根据1自由度χ<sup>2</sup>分布的显著性水平确定判决门限G′<sub>α</sub>;当α=0.05时G<sub>α</sub>=3.841;当α=0.01时G<sub>α</sub>=6.635;(3)关联判决若η≤G′<sub>α</sub>,则直线l<sub>i</sub>与直线l<sub>j</sub>关联成功;若η>G′<sub>α</sub>,则直线l<sub>i</sub>与直线l<sub>j</sub>关联失败;(4)多假目标欺骗下量测集合关联<img file="FSA0000100430480000031.GIF" wi="715" he="81" />为第i部雷达的方位角、俯仰角的量测集合,首先将量测集合Z<sub>1</sub>与量测集合Z<sub>2</sub>进行关联,关联成功的量测之间建立了对应关系,同时将未关联成功的量测去除;然后将量测集合Z<sub>2</sub>中关联成功的所有量测取出,组成量测集合Z′<sub>2</sub>;用同样的方法将量测集合Z′<sub>2</sub>与量测集合Z<sub>3</sub>进行关联,以此类推直至量测集合Z<sub>N</sub>;(5)提取方位角、俯仰角量测在量测集合两两关联的基础上,建立长度为N的“关联链条”,设其数目为P,则P既为真实目标的数量,某“关联链条”上的所有量测即为该目标在各个雷达中所对应的方位角、俯仰角量测;步骤5:构建基于最小二乘法的等效量测(1)建立三组量测对应方向线的方程<maths num="0006"><![CDATA[<math><mrow><mfrac><mrow><mi>x</mi><mo>-</mo><msub><mi>x</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mrow><mrow><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>y</mi><mo>-</mo><msub><mi>y</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mrow><mrow><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>z</mi><mo>-</mo><msub><mi>z</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mrow><mrow><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac></mrow></math>]]></maths><maths num="0007"><![CDATA[<math><mrow><mfrac><mrow><mi>x</mi><mo>-</mo><msub><mi>x</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub></mrow><mrow><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>2</mn></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>y</mi><mo>-</mo><msub><mi>y</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub></mrow><mrow><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>2</mn></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>z</mi><mo>-</mo><msub><mi>z</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub></mrow><mrow><mi>sin</mi><msub><mi>&theta;</mi><mn>2</mn></msub></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0008"><![CDATA[<math><mrow><mfrac><mrow><mi>x</mi><mo>-</mo><msub><mi>x</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub></mrow><mrow><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>3</mn></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>y</mi><mo>-</mo><msub><mi>y</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub></mrow><mrow><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>3</mn></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><mi>z</mi><mo>-</mo><msub><mi>z</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub></mrow><mrow><mi>sin</mi><msub><mi>&theta;</mi><mn>3</mn></msub></mrow></mfrac></mrow></math>]]></maths>(θ<sub>1</sub>,φ<sub>1</sub>)、(θ<sub>2</sub>,φ<sub>2</sub>)、(θ<sub>3</sub>,φ<sub>3</sub>)为三部雷达的量测中经步骤3关联成功的量测集;(x<sub>ri</sub>,y<sub>ri</sub>,z<sub>ri</sub>),i=1,2,3为三部雷达的位置坐标;(2)构建最小二乘等效量测Z<sub>m</sub><maths num="0009"><![CDATA[<math><mrow><msub><mi>Z</mi><mi>m</mi></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>x</mi></mtd></mtr><mtr><mtd><mi>y</mi></mtd></mtr><mtr><mtd><mi>z</mi></mtd></mtr></mtable></mfenced><mo>=</mo><msup><mrow><mo>(</mo><msup><mi>A</mi><mi>T</mi></msup><mi>A</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><msup><mi>A</mi><mi>T</mi></msup><mi>b</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0010"><![CDATA[<math><mrow><mi>b</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub><msub><mi>x</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>1</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub><msub><mi>z</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>2</mn></msub><msub><mi>x</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>2</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>2</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>2</mn></msub><msub><mi>z</mi><mrow><mi>r</mi><mn>2</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>3</mn></msub><msub><mi>x</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>3</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub></mtd></mtr><mtr><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>3</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>3</mn></msub><msub><mi>z</mi><mrow><mi>r</mi><mn>3</mn></mrow></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0011"><![CDATA[<math><mrow><mi>A</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>2</mn></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>2</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>2</mn></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>2</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>3</mn></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>3</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>3</mn></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>&theta;</mi><mn>3</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>3</mn></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow></math>]]></maths>步骤6:利用等效量测进行目标跟踪(1)计算等效量测误差协方差阵R(k+1)<maths num="0012"><![CDATA[<math><mrow><mi>R</mi><mrow><mo>(</mo><mi>k</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>=</mo><mi>P</mi><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>&sigma;</mi><mrow><mi>&theta;</mi><mn>1</mn></mrow><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msubsup><mi>&sigma;</mi><mrow><mi>&phi;</mi><mn>1</mn></mrow><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>&sigma;</mi><mrow><mi>&theta;</mi><mn>2</mn></mrow><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>&sigma;</mi><mrow><mi>&phi;</mi><mn>2</mn></mrow><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>&sigma;</mi><mrow><mi>&theta;</mi><mn>3</mn></mrow><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msubsup><mi>&sigma;</mi><mrow><mi>&phi;</mi><mn>3</mn></mrow><mn>2</mn></msubsup></mtd></mtr></mtable></mfenced><msup><mi>P</mi><mi>T</mi></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow></math>]]></maths>P=[P<sub>1</sub>,P<sub>2</sub>,P<sub>3</sub>,P<sub>4</sub>,P<sub>5</sub>,P<sub>6</sub>]    (11)<maths num="0013"><![CDATA[<math><mrow><msub><mi>P</mi><mn>1</mn></msub><mo>=</mo><mfrac><mrow><mo>&PartialD;</mo><msub><mi>z</mi><mi>m</mi></msub></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mo>=</mo><mo>=</mo><mo>-</mo><msup><mrow><mo>(</mo><msup><mi>A</mi><mi>T</mi></msup><mi>A</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>[</mo><mrow><mo>(</mo><mfrac><mrow><mo>&PartialD;</mo><msup><mi>A</mi><mi>T</mi></msup></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mi>A</mi><mo>+</mo><msup><mi>A</mi><mi>T</mi></msup><mfrac><mrow><mo>&PartialD;</mo><mi>A</mi></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mo>)</mo></mrow><msub><mi>Z</mi><mi>m</mi></msub><mo>-</mo><mfrac><mrow><mo>&PartialD;</mo><msup><mi>A</mi><mi>T</mi></msup></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mi>b</mi><mo>-</mo><msup><mi>A</mi><mi>T</mi></msup><mfrac><mrow><mo>&PartialD;</mo><mi>b</mi></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mo>]</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0014"><![CDATA[<math><mrow><mfrac><mrow><mo>&PartialD;</mo><msup><mi>A</mi><mi>T</mi></msup></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>13</mn><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0015"><![CDATA[<math><mrow><mfrac><mrow><mo>&PartialD;</mo><msup><mi>b</mi><mi>T</mi></msup></mrow><mrow><mo>&PartialD;</mo><msub><mi>&theta;</mi><mn>1</mn></msub></mrow></mfrac><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub><msub><mi>x</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>cos</mi><msub><mi>&phi;</mi><mn>1</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mtd><mtd><mi>cos</mi><msub><mi>&theta;</mi><mn>1</mn></msub><msub><mi>y</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>sin</mi><msub><mi>&theta;</mi><mn>1</mn></msub><mi>sin</mi><msub><mi>&phi;</mi><mn>1</mn></msub><msub><mi>z</mi><mrow><mi>r</mi><mn>1</mn></mrow></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>14</mn><mo>)</mo></mrow></mrow></math>]]></maths>P<sub>2</sub>,P<sub>3</sub>,P<sub>4</sub>,P<sub>5</sub>,P<sub>6</sub>的求解与P<sub>1</sub>类似;(2)以等效量测为量测输入,利用卡尔曼滤波方法进行滤波跟踪状态方程:X(k+1)=F(k)X(k)+V(k)(15)量测方程:Z(k+1)=Z<sub>m</sub>(k+1)+W(k+1)(16)状态转移矩阵:<maths num="0016"><![CDATA[<math><mrow><mi>F</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mi>T</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mi>T</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>17</mn><mo>)</mo></mrow></mrow></math>]]></maths>状态向量:<maths num="0017"><![CDATA[<math><mrow><mi>X</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd><mtd><mover><mrow><mi>x</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow><mo>.</mo></mover></mtd><mtd><mi>y</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd><mtd><mover><mrow><mi>y</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow><mo>.</mo></mover></mtd><mtd><mi>z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd><mtd><mover><mrow><mi>z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow><mo>.</mo></mover></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>18</mn><mo>)</mo></mrow></mrow></math>]]></maths>步骤7:进行下一时刻运算重复执行步骤1~步骤7进行下一周期的量测分组、数据关联、滤波跟踪过程。
地址 264001 山东省烟台二马路188号科研部