发明名称 基于天线周期扫描时间差无源定位方法
摘要 基于天线周期扫描时间差无源定位方法,本发明涉及时间差定位方法。本发明是为了解决目前采用的无源定位方法中存在跟踪收敛速度慢、精度低以及需要一定机动的问题。本发明建立了平台和目标之间坐标系,并根据所建立坐标系及转换关系,获得目标位置的一种计算方法,利用探测范围的限制对所得目标位置的解进行选取,最后对带有测量误差的定位结果采用递推最小二乘法进行优化,得到了优化后位置估计。本发明仅利用天线扫描时间观测值及平台状态即可完成对目标的定位,此外对观测平台运动形式的限定少,且定位精度随时间测量精度提高而提高,是一种新的定位方式,对目前的无源定位体制进行了有效补充。本发明应用于无源定位领域。
申请公布号 CN105403854A 申请公布日期 2016.03.16
申请号 CN201510741864.3 申请日期 2015.11.04
申请人 哈尔滨工业大学 发明人 刘梅;邓展涛;高扬
分类号 G01S1/08(2006.01)I 主分类号 G01S1/08(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 杨立超
主权项 基于天线周期扫描时间差无源定位方法,其特征在于,所述基于天线周期扫描时间差无源定位方法包括以下步骤:步骤一:建立坐标系并得到各坐标系间的转换关系;建立观测平台坐标系,以观测平台第一次接收到目标信号时的运动方向为y轴方向,垂直y轴为x轴,y轴正方向右侧为x轴正方向;建立目标坐标系,所述目标坐标系分为等效目标抖动模型坐标系和等效目标单向偏移模型坐标系;将观测平台的抖动和单向偏移等效到目标上,取观测平台第一次接收到目标信号时等效的目标运动方向为y'轴方向,垂直y'轴为x'轴,y'轴正方向右侧为x'轴正方向;设目标与观测平台在同一平面,目标雷达天线进行周期为T的圆周扫描,观测平台状态(x<sub>i</sub>,v<sub>x'i</sub>,y<sub>i</sub>,v<sub>y'i</sub>)<sup>T</sup>已知,所述x<sub>i</sub>为目标坐标系中第i时刻观测平台的x'方向坐标,y<sub>i</sub>为目标坐标系中第i时刻观测平台的y'方向坐标,v<sub>x'i</sub>为第i时刻观测平台的x'方向速度,v<sub>y'i</sub>为第i时刻观测平台的y'方向速度,每次目标雷达扫描过观测平台时信号都能被捕获并被记录扫描时刻t<sub>i</sub>,根据观测平台坐标系与目标坐标系的转换关系得到坐标变换x=x'和y=y',得到目标相对于观测平台在观测平台坐标系中的位置(x,y);建立大地坐标系,以正北方为Y轴方向,正东方为X轴方向;当目标坐标系中坐标需要转换到大地坐标下时,根据观测平台坐标系与大地坐标系的转换关系,即公式(1)‑(3),可得到大地坐标系下的目标坐标;<img file="FDA0000838951130000011.GIF" wi="1142" he="116" /><img file="FDA0000838951130000012.GIF" wi="1230" he="111" /><img file="FDA0000838951130000013.GIF" wi="1221" he="111" />γ是观测平台坐标系y方向和大地坐标系Y方向的夹角;<img file="FDA0000838951130000014.GIF" wi="45" he="53" />是目标在观测平台坐标系中的方位角,X<sub>T</sub>为目标在大地坐标系中X方向位置,Y<sub>T</sub>为目标在大地坐标系中Y方向位置,x<sub>0</sub>为观测平台在大地坐标系中X方向位置,y<sub>0</sub>为观测平台在大地坐标系中Y方向位置;步骤二:根据步骤一所述的观测平台坐标系与目标坐标系的转换关系以及大地坐标系与观测平台坐标系的转换关系,可以将目标坐标系中所求观测平台坐标转换为大地坐标系中目标坐标,直接在目标坐标系中对观测平台位置进行求解,当相邻两时刻目标与观测平台连线间的夹角大于0时,可以得到求解方程中x,y,T三个未知量需要的方程为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mi>2</mi><mi>&pi;</mi><mrow><mo>(</mo><msub><mi>&tau;</mi><mi>i</mi></msub><mo>-</mo><mi>T</mi><mo>)</mo></mrow><mo>&lsqb;</mo><msup><mi>x</mi><mn>2</mn></msup><mo>+</mo><msup><mi>y</mi><mn>2</mn></msup><mo>-</mo><mrow><mo>(</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>y</mi><mo>-</mo><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>x</mi><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><msub><mi>y</mi><mi>i</mi></msub><mo>+</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><msub><mi>x</mi><mi>i</mi></msub><mo>&rsqb;</mo><mo>-</mo><mi>T</mi><mo>&lsqb;</mo><mi>x</mi><mrow><mo>(</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>y</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>y</mi><mi>i</mi></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><msub><mi>x</mi><mi>i</mi></msub><mo>&rsqb;</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mi>2</mi><mi>&pi;</mi><mrow><mo>(</mo><msub><mi>&tau;</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><mi>T</mi><mo>)</mo></mrow><mo>&lsqb;</mo><msup><mi>x</mi><mn>2</mn></msup><mo>+</mo><msup><mi>y</mi><mn>2</mn></msup><mo>-</mo><mrow><mo>(</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mi>y</mi><mo>-</mo><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>+</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mi>x</mi><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>+</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>&rsqb;</mo><mo>-</mo><mi>T</mi><mo>&lsqb;</mo><mi>x</mi><mrow><mo>(</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>-</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>-</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>-</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>&rsqb;</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mi>2</mi><mi>&pi;</mi><mrow><mo>(</mo><msub><mi>&tau;</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>-</mo><mi>T</mi><mo>)</mo></mrow><mo>&lsqb;</mo><msup><mi>x</mi><mn>2</mn></msup><mo>+</mo><msup><mi>y</mi><mn>2</mn></msup><mo>-</mo><mrow><mo>(</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>)</mo></mrow><mi>y</mi><mo>-</mo><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><mo>+</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>)</mo></mrow><mi>x</mi><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>+</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>&rsqb;</mo><mo>-</mo><mi>T</mi><mo>&lsqb;</mo><mi>x</mi><mrow><mo>(</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><mo>-</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>)</mo></mrow><mo>-</mo><mi>y</mi><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><mo>-</mo><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><mo>-</mo><msub><mi>y</mi><mrow><mi>i</mi><mo>+</mo><mn>3</mn></mrow></msub><msub><mi>x</mi><mrow><mi>i</mi><mo>+</mo><mn>2</mn></mrow></msub><mo>&rsqb;</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>25</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000838951130000021.GIF" wi="1989" he="374" /></maths>所述T为天线扫描周期,τ<sub>i</sub>=t<sub>i+1</sub>‑t<sub>i</sub>,t<sub>i</sub>为第i时刻天线扫描时间测量值,t<sub>i+1</sub>为第i+1时刻天线扫描时间测量值,y<sub>i+1</sub>为目标坐标系中第i+1时刻观测平台的y'方向坐标,y<sub>i+2</sub>为目标坐标系中第i+2时刻观测平台的y'方向坐标,y<sub>i+3</sub>为目标坐标系中第i+3时刻观测平台的y'方向坐标,x<sub>i+1</sub>为目标坐标系中第i+1时刻观测平台的x'方向坐标,x<sub>i+2</sub>为目标坐标系中第i+2时刻观测平台的x'方向坐标,x<sub>i+3</sub>为目标坐标系中第i+3时刻观测平台的x'方向坐标;步骤三:求解公式(25)的方程组得到6组数学解,解的选取利用探测范围的限制,所述探测范围为100~350km,在探测范围内的解记为可行解,进一步筛选可行解集合时,若有唯一解则将其作为解,若无可行解则将解计为零,有多组解可以取各解的平均值;步骤四:求解递推最小二乘法的参数R<sub>i</sub>、<img file="FDA0000838951130000022.GIF" wi="72" he="78" />和P<sub>0</sub>,将遗忘因子与R<sub>i</sub>相乘得到R<sub>i</sub>',将R<sub>i</sub>'、<img file="FDA0000838951130000023.GIF" wi="67" he="79" />和P<sub>0</sub>带入递推最小二乘的基本公式,利用通过时间测量值计算得到的z<sub>i</sub>估计目标的真实位置得到估计值<img file="FDA0000838951130000024.GIF" wi="92" he="84" />所述z<sub>i</sub>为第i时刻的观测向量(x<sub>i</sub>,y<sub>i</sub>,T<sub>i</sub>)<sup>T</sup>,<img file="FDA0000838951130000025.GIF" wi="62" he="78" />为第i时刻的估计值矩阵<img file="FDA0000838951130000026.GIF" wi="247" he="78" />T<sub>i</sub>为第i时刻天线扫描周期计算值,<img file="FDA0000838951130000027.GIF" wi="52" he="77" />为第i时刻天线扫描周期估计值,<img file="FDA0000838951130000028.GIF" wi="45" he="70" />为目标在x'方向坐标的估计值,<img file="FDA0000838951130000029.GIF" wi="56" he="71" />为目标在y'方向坐标的估计值。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号