主权项 |
异步组网雷达系统误差校正方法,包括如下步骤:1)设定目标l在三维笛卡尔公共坐标系中的动态模型为匀速运动模型;2)设定包含系统误差的目标观测模型为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msubsup><mi>z</mi><mi>k</mi><mrow><mi>m</mi><mo>,</mo><mi>l</mi></mrow></msubsup><mo>=</mo><mi>h</mi><mrow><mo>(</mo><mi>R</mi><mo>(</mo><mrow><msub><mi>ω</mi><mi>m</mi></msub><mo>+</mo><msub><mi>Δω</mi><mi>m</mi></msub></mrow><mo>)</mo><mo>·</mo><mo>(</mo><mrow><msubsup><mover><mi>ξ</mi><mo>‾</mo></mover><mi>k</mi><mi>l</mi></msubsup><mo>-</mo><msub><mi>p</mi><mi>m</mi></msub></mrow><mo>)</mo><mo>)</mo></mrow><mo>-</mo><msub><mi>Δz</mi><mi>m</mi></msub><mo>+</mo><msubsup><mi>w</mi><mi>k</mi><mrow><mi>m</mi><mo>,</mo><mi>l</mi></mrow></msubsup><mo>,</mo><mi>m</mi><mo>∈</mo><msubsup><mi>M</mi><mi>k</mi><mi>l</mi></msubsup></mrow>]]></math><img file="FDA0000834492300000011.GIF" wi="1205" he="103" /></maths>其中,<img file="FDA0000834492300000012.GIF" wi="78" he="78" />表示雷达m在k时刻对目标l的量测值,该量测值包括距离,方位角和俯仰角;<img file="FDA0000834492300000013.GIF" wi="87" he="78" />表示k时刻观测到目标l的雷达标号的集合,且<img file="FDA0000834492300000014.GIF" wi="293" he="94" />M为雷达总数,|·|表示计算集合内元素的个数;<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msubsup><mover><mi>ξ</mi><mo>‾</mo></mover><mi>k</mi><mi>l</mi></msubsup><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><msubsup><mi>x</mi><mi>k</mi><mi>l</mi></msubsup></mtd><mtd><msubsup><mi>y</mi><mi>k</mi><mi>l</mi></msubsup></mtd><mtd><msubsup><mi>z</mi><mi>k</mi><mi>l</mi></msubsup></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA0000834492300000015.GIF" wi="395" he="102" /></maths>为k时刻目标l在三维笛卡尔公共坐标系中的坐标值,T表示取矩阵转置;p<sub>m</sub>=[x<sub>m</sub> y<sub>m</sub> z<sub>m</sub>]<sup>T</sup>为雷达m在三维笛卡尔公共坐标系中的坐标矢量,x<sub>m</sub>是雷达m在x轴上的位置,y<sub>m</sub>是雷达m在y轴上的位置,z<sub>m</sub>是雷达m在z轴上的位置;<img file="FDA0000834492300000016.GIF" wi="557" he="87" />为雷达m的系统误差矢量,Δρ<sub>m</sub>是雷达m的距离误差,<img file="FDA0000834492300000017.GIF" wi="100" he="69" />是雷达m的方位角误差,Δη<sub>m</sub>是雷达m的俯仰角误差;ω<sub>m</sub>=[α<sub>m</sub> β<sub>m</sub> γ<sub>m</sub>]<sup>T</sup>为雷达m自身直角坐标系到笛卡尔公共坐标系坐标轴的旋转角度,α<sub>m</sub>是x轴的旋转角度,β<sub>m</sub>是y轴的旋转角度,γ<sub>m</sub>是z轴的旋转角度;Δω<sub>m</sub>=[Δα<sub>m</sub> Δβ<sub>m</sub> Δγ<sub>m</sub>]<sup>T</sup>为旋转角度ω<sub>m</sub>所对应的系统误差,Δα<sub>m</sub>是α<sub>m</sub>对应的系统误差,Δβ<sub>m</sub>是β<sub>m</sub>对应的系统误差,Δγ<sub>m</sub>是γ<sub>m</sub>对应的系统误差;R(·)为三维坐标旋转函数;<img file="FDA0000834492300000018.GIF" wi="100" he="78" />为观测噪声;h(·)为直角坐标系到极坐标系的坐标转换函数;根据<img file="FDA0000834492300000019.GIF" wi="105" he="70" />与Δγ<sub>m</sub>在空间变换上完全耦合的特性,将二者合为一个系统误差<img file="FDA00008344923000000110.GIF" wi="390" he="70" />并用变量<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>Δ</mi><msub><mover><mi>z</mi><mo>‾</mo></mover><mi>m</mi></msub><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>Δρ</mi><mi>m</mi></msub></mrow></mtd><mtd><mrow><msub><mi>Δφ</mi><mi>m</mi></msub></mrow></mtd><mtd><mrow><msub><mi>Δη</mi><mi>m</mi></msub></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA00008344923000000111.GIF" wi="535" he="87" /></maths>替代雷达m的量测系统误差Δz<sub>m</sub>,用<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>Δ</mi><msub><mover><mi>ω</mi><mo>‾</mo></mover><mi>m</mi></msub><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>Δα</mi><mi>m</mi></msub></mrow></mtd><mtd><mrow><msub><mi>Δβ</mi><mi>m</mi></msub></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA00008344923000000112.GIF" wi="427" he="86" /></maths>替代雷达m的坐标转换系统误差Δω<sub>m</sub>;3)结合步骤1)和步骤2)中分别设定的目标动态模型和目标观测模型,建立系统误差校正目标函数如下:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><munder><mi>min</mi><mi>θ</mi></munder><munderover><mo>Σ</mo><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>L</mi></munderover><munderover><mo>Σ</mo><mrow><mi>k</mi><mo>=</mo><mn>2</mn></mrow><msub><mi>K</mi><mi>l</mi></msub></munderover><mo>|</mo><mo>|</mo><msubsup><mi>μ</mi><mi>k</mi><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>μ</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>T</mi><mi>k</mi><mi>l</mi></msubsup><msubsup><mi>v</mi><mi>k</mi><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>|</mo><msup><mo>|</mo><mn>2</mn></msup><mo>,</mo></mrow>]]></math><img file="FDA00008344923000000113.GIF" wi="805" he="143" /></maths>其中,<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mi>θ</mi><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>Δ</mi><msup><mover><mi>z</mi><mo>‾</mo></mover><mi>T</mi></msup></mrow></mtd><mtd><mrow><mi>Δ</mi><msup><mover><mi>ω</mi><mo>‾</mo></mover><mi>T</mi></msup></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo><mi>Δ</mi><mover><mi>z</mi><mo>‾</mo></mover><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>Δ</mi><msubsup><mover><mi>z</mi><mo>‾</mo></mover><mn>1</mn><mi>T</mi></msubsup></mrow></mtd><mtd><mo>...</mo></mtd><mtd><mrow><mi>Δ</mi><msubsup><mover><mi>z</mi><mo>‾</mo></mover><mi>M</mi><mi>T</mi></msubsup></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>,</mo><mi>Δ</mi><mover><mi>ω</mi><mo>‾</mo></mover><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>Δ</mi><msubsup><mover><mi>ω</mi><mo>‾</mo></mover><mn>1</mn><mi>T</mi></msubsup></mrow></mtd><mtd><mo>...</mo></mtd><mtd><mrow><mi>Δ</mi><msubsup><mover><mi>ω</mi><mo>‾</mo></mover><mi>M</mi><mi>T</mi></msubsup></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>;</mo></mrow>]]></math><img file="FDA0000834492300000021.GIF" wi="1398" he="102" /></maths>L表示目标的总数;K<sub>l</sub>表示目标l总的观测数;||·||表示2‑范数;<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msubsup><mi>μ</mi><mi>k</mi><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mn>1</mn><mrow><mo>|</mo><msubsup><mi>M</mi><mi>k</mi><mi>l</mi></msubsup><mo>|</mo></mrow></mfrac><munderover><mo>Σ</mo><mrow><mi>m</mi><mo>=</mo><mn>1</mn></mrow><mrow><mo>|</mo><msubsup><mi>M</mi><mi>k</mi><mi>l</mi></msubsup><mo>|</mo></mrow></munderover><msup><mi>R</mi><mi>T</mi></msup><mrow><mo>(</mo><msub><mi>ω</mi><mi>m</mi></msub><mo>+</mo><mi>Δ</mi><msub><mover><mi>ω</mi><mo>‾</mo></mover><mi>m</mi></msub><mo>)</mo></mrow><mo>·</mo><msup><mi>h</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><msubsup><mi>z</mi><mi>k</mi><mrow><mi>m</mi><mo>,</mo><mi>l</mi></mrow></msubsup><mo>+</mo><mi>Δ</mi><msub><mover><mi>z</mi><mo>‾</mo></mover><mi>m</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>p</mi><mi>m</mi></msub><mo>,</mo></mrow>]]></math><img file="FDA0000834492300000022.GIF" wi="1070" he="181" /></maths>h<sup>‑1</sup>(·)表示直角坐标系到极坐标系的坐标转换函数h(·)的反函数;<img file="FDA0000834492300000023.GIF" wi="54" he="78" />为目标l从k时刻到k+1时刻的观测时间间隔;<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msubsup><mi>v</mi><mi>k</mi><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>=</mo><mo>[</mo><msubsup><mi>μ</mi><mi>k</mi><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>μ</mi><mn>1</mn><mi>l</mi></msubsup><mrow><mo>(</mo><mi>θ</mi><mo>)</mo></mrow><mo>]</mo><mo>/</mo><munderover><mo>Σ</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></munderover><msubsup><mi>T</mi><mi>i</mi><mi>l</mi></msubsup><mo>;</mo></mrow>]]></math><img file="FDA0000834492300000024.GIF" wi="670" he="142" /></maths><img file="FDA0000834492300000025.GIF" wi="140" he="79" />和<img file="FDA0000834492300000026.GIF" wi="127" he="87" />都是非线性函数;4)求解步骤3)建立的系统误差校正目标函数,得到系统的校正误差θ。 |