发明名称 一种基于航迹外推的低慢小目标拦截方法
摘要 本发明公开了一种基于航迹外推的低慢小目标拦截方法,通过发控装置、探测装置、发射转塔、拦截弹、托架、通讯总线a、通讯总线b和通讯总线c来完成。系统的探测装置获取低慢小目标空间位置数据,发控装置将数据进行坐标转换,求出低慢小目标的速度大小和方向,从而预测低慢小目标在此之后的飞行速度和飞行航迹,根据航迹解算发射角、发射时间,最终实现目标拦截。本发明缩短了射击诸元解算时间,降低了拦截反应时间,提高了拦截命中概率。
申请公布号 CN104880126B 申请公布日期 2017.01.18
申请号 CN201510254726.2 申请日期 2015.05.19
申请人 北京机械设备研究所 发明人 申研;许诺;邱旭阳;王彦丰;刘海平;李佳辉;王三舟
分类号 F41H11/02(2006.01)I 主分类号 F41H11/02(2006.01)I
代理机构 中国航天科工集团公司专利中心 11024 代理人 岳洁菱;张国虹
主权项 一种基于航迹外推的低慢小目标拦截方法,其特征在于具体步骤为:第一步搭建转塔式拦截系统转塔式拦截系统包括:发控装置、探测装置、发射转塔、拦截弹、托架、通讯总线a、通讯总线b和通讯总线c,其中探测装置包括:电视成像模块、测距模块和测角模块;发控装置包括:数据接收模块、解算模块和发射执行模块;电视成像模块的功能为:对低慢小目标进行搜索、识别和跟踪;测距模块的功能为:测量低慢小目标相对于探测装置的斜线距离数据;测角模块的功能为:测量低慢小目标相对探测装置的方位和俯仰角度数据;数据接收模块的功能为:接收低慢小目标数据,滤波提出野值,并将数据转换为相对发射原点坐标的数据;解算模块的功能为:解算低慢小目标速度和外推航迹,解算射击诸元和拦截弹装定时间参数;发射执行模块的功能为:控制发射转塔调转,装定拦截弹时间参数,输出点火信号;探测装置与发控装置通过通讯总线a连接;发控装置与发射转塔通过通讯总线b连接;发控装置与拦截弹通过通讯总线c连接;拦截弹与发射转塔通过托架连接;第二步探测装置获取低慢小目标空间位置数据和坐标转换电视成像模块发现低慢小目标,测距模块测量低慢小目标斜距l,测角模块测量低慢小目标方位角θ和高低角α;数据接收模块通过通讯总线a获得探测装置测量的低慢小目标空间位置数据,并进行滤波剔除野值处理,再根据探测装置与发射点相对位置,将低慢小目标斜距l、低慢小目标方位角θ和高低角α通过坐标转换变为以发射点为原点的坐标数据;第三步解算模块预测低慢小目标飞行速度及外推航迹解算模块首先判断获取的低慢小目标飞行数据误差最小的两个点A和B;假设A点数据为斜距l<sub>1</sub>、方位角θ<sub>1</sub>、高低角α<sub>1</sub>,B点数据为斜距l<sub>2</sub>,方位角θ<sub>2</sub>,高低角α<sub>2</sub>;低慢小目标从A点飞行至B点时间为Δt;通过v=(l<sub>1</sub>‑l<sub>2</sub>)/Δt计算低慢小目标的速度,其中v表示低慢小目标的速度,低慢小目标的速度方向以向量方式表示;把所测得的A、B两点数据转换到笛卡尔坐标系中有:<maths num="0001"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mn>1</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>z</mi><mn>1</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mn>2</mn></msub><mo>=</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>cos&theta;</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mn>2</mn></msub><mo>=</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>sin&alpha;</mi><mn>2</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>z</mi><mn>2</mn></msub><mo>=</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>sin&theta;</mi><mn>2</mn></msub></mrow></mtd></mtr></mtable><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000021.GIF" wi="1157" he="435" /></maths>其中,(x<sub>1</sub>y<sub>1</sub>z<sub>1</sub>)表示A点在笛卡尔坐标系下的坐标,(x<sub>2</sub>y<sub>2</sub>z<sub>2</sub>)表示B点在笛卡尔坐标系下的坐标;则速度的向量形式<img file="FDA0001068711020000022.GIF" wi="34" he="46" />表示为:<maths num="0002"><math><![CDATA[<mrow><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mo>=</mo><mfrac><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mover><mi>i</mi><mo>&RightArrow;</mo></mover><mo>+</mo><mfrac><mrow><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>y</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mover><mi>j</mi><mo>&RightArrow;</mo></mover><mo>+</mo><mfrac><mrow><msub><mi>z</mi><mn>1</mn></msub><mo>-</mo><msub><mi>z</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mover><mi>k</mi><mo>&RightArrow;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000023.GIF" wi="1309" he="111" /></maths>把x<sub>1</sub>,y<sub>1</sub>,z<sub>1</sub>,x<sub>2</sub>,y<sub>2</sub>,z<sub>2</sub>代入<img file="FDA0001068711020000024.GIF" wi="34" he="45" />的表达式中,则有:<maths num="0003"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mo>=</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>cos&theta;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mover><mi>i</mi><mo>&RightArrow;</mo></mover><mo>+</mo><mfrac><mrow><msub><mi>l</mi><mi>i</mi></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>sin&alpha;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mover><mi>j</mi><mo>&RightArrow;</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><mo>+</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>sin&theta;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mover><mi>k</mi><mo>&RightArrow;</mo></mover></mrow></mtd></mtr></mtable><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000025.GIF" wi="1526" he="253" /></maths>根据公式(1)~(3)求出低慢小目标的速度大小和方向,从而预测低慢小目标在此之后的飞行速度和飞行航迹;第四步解算模块解算发射角低慢小目标飞行速度和航迹确定后,假设低慢小目标在距离发射点斜距为d被拦截,拦截点的坐标为C点(x<sub>0</sub>,y<sub>0</sub>,z<sub>0</sub>),解算模块求解出拦截点的坐标;假设C点位拦截点,低慢小目标从A点到C点所用时间为t<sub>0</sub>,C点距发射点的斜距为d,此时低慢小目标的坐标为:<maths num="0004"><math><![CDATA[<mrow><msub><mi>x</mi><mn>0</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub><mo>+</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>cos&theta;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><msub><mi>t</mi><mn>0</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000026.GIF" wi="1458" he="118" /></maths><maths num="0005"><math><![CDATA[<mrow><msub><mi>y</mi><mn>0</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub><mo>+</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>sin&alpha;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><msub><mi>t</mi><mn>0</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000027.GIF" wi="1453" he="118" /></maths><maths num="0006"><math><![CDATA[<mrow><msub><mi>z</mi><mn>0</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>+</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>sin&theta;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><msub><mi>t</mi><mn>0</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000028.GIF" wi="1454" he="118" /></maths><img file="FDA0001068711020000029.GIF" wi="366" he="63" />令<maths num="0007"><math><![CDATA[<mrow><msub><mi>v</mi><mi>x</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>cos&theta;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010687110200000210.GIF" wi="1333" he="119" /></maths><maths num="0008"><math><![CDATA[<mrow><msub><mi>v</mi><mi>y</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>sin&alpha;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00010687110200000211.GIF" wi="1326" he="119" /></maths><maths num="0009"><math><![CDATA[<mrow><msub><mi>v</mi><mi>z</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><msub><mi>cos&alpha;</mi><mn>2</mn></msub><msub><mi>sin&theta;</mi><mn>2</mn></msub></mrow><mrow><mi>&Delta;</mi><mi>t</mi></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000031.GIF" wi="1311" he="115" /></maths>其中v<sub>x</sub>表示低慢小目标沿笛卡尔坐标系x轴方向的速度,v<sub>y</sub>表示低慢小目标沿笛卡尔坐标系y轴方向的速度,v<sub>z</sub>表示低慢小目标沿笛卡尔坐标系z轴方向的速度;则原方程写为:<maths num="0010"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msup><mi>d</mi><mn>2</mn></msup><mo>=</mo><msubsup><mi>x</mi><mn>0</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mn>0</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mn>0</mn><mn>2</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>x</mi><mn>0</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>v</mi><mi>x</mi></msub><msub><mi>t</mi><mn>0</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mn>0</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>v</mi><mi>y</mi></msub><msub><mi>t</mi><mn>0</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>z</mi><mn>0</mn></msub><mo>=</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>v</mi><mi>z</mi></msub><msub><mi>t</mi><mn>0</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000032.GIF" wi="1100" he="303" /></maths>化简得:<maths num="0011"><math><![CDATA[<mrow><mo>(</mo><msubsup><mi>v</mi><mi>x</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>v</mi><mi>y</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>v</mi><mi>z</mi><mn>2</mn></msubsup><mo>)</mo><msubsup><mi>t</mi><mn>0</mn><mn>2</mn></msubsup><mo>+</mo><mn>2</mn><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>cos&theta;</mi><mn>1</mn></msub><msub><mi>v</mi><mi>x</mi></msub><mo>+</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>sin&alpha;</mi><mn>1</mn></msub><msub><mi>v</mi><mi>y</mi></msub><mo>+</mo><msub><mi>l</mi><mn>1</mn></msub><msub><mi>cos&alpha;</mi><mn>1</mn></msub><msub><mi>sin&theta;</mi><mn>1</mn></msub><msub><mi>v</mi><mi>z</mi></msub><mo>)</mo><msub><mi>t</mi><mn>0</mn></msub><mo>+</mo><msubsup><mi>l</mi><mn>1</mn><mn>2</mn></msubsup><mo>-</mo><msup><mi>d</mi><mn>2</mn></msup><mo>=</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000033.GIF" wi="1709" he="78" /></maths>因为<img file="FDA0001068711020000034.GIF" wi="238" he="70" />故求解t<sub>0</sub>值;时间t<sub>0</sub>确定之后,(x<sub>0</sub>,y<sub>0</sub>,z<sub>0</sub>)根据式(4)~(6)求解,此时发射的方位角θ<sub>0</sub>,此时<maths num="0012"><math><![CDATA[<mrow><msub><mi>&theta;</mi><mn>0</mn></msub><mo>=</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mrow><mo>(</mo><mfrac><msub><mi>z</mi><mn>0</mn></msub><msub><mi>x</mi><mn>0</mn></msub></mfrac><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>12</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001068711020000035.GIF" wi="1077" he="117" /></maths>发射方位角确定后,根据拦截点的坐标(x<sub>0</sub>,y<sub>0</sub>,z<sub>0</sub>),查询解算模块中的射表选择发射需要的俯仰角α<sub>0</sub>;第五步解算模块解算发射时间解算模块选择在射表中经过<img file="FDA0001068711020000036.GIF" wi="291" he="86" />点附近的两个发射俯仰角下的弹道数据;弹道数据选定后,由两组弹道数据的插值确定拦截弹飞行至拦截点C的时间T;考虑发射转塔调转反应时间T<sub>f</sub>,以及内弹道、开伞开网时间T<sub>e</sub>,则发射时间T<sub>0</sub>=t<sub>0</sub>‑T‑T<sub>f</sub>‑T<sub>e</sub>,其中t<sub>0</sub>≥T‑T<sub>f</sub>‑T<sub>e</sub>;第六步发射执行模块发射拦截弹执行拦截发射执行模块通过通讯总线a获得解算模块解算数据,发射执行模块通过通讯总线b将发射俯仰角度α<sub>0</sub>和方位角度θ<sub>0</sub>数据发送至发射转塔,发射转塔按照接收到的发射俯仰角度α<sub>0</sub>和方位角度θ<sub>0</sub>数据调转到位,发射执行模块通过通讯总线c将拦截弹飞行至拦截点时间T装定在拦截弹上,拦截弹点火发射;至此实现了基于航迹外推的低慢小目标拦截。
地址 100854 北京市海淀区北京142信箱208分箱