发明名称 一种带倾角约束的火箭弹纵向导引方法
摘要 一种带倾角约束的火箭弹纵向导引方法,对重力项及阻力项进行了补偿,补偿项的系数随弹道特性变化,更好地提高了导引规律对不同弹道的适应性;附加的变系数速度倾角约束项,在远距离时充分利用弹道下降过程中自身速度方向变化的固有规律,主要进行比例导引,在近距离时进行末端速度倾角控制,有效降低了倾角约束项的过载需求,实施对末段速度倾角控制的同时,减小约束项对机动能力的影响。该制导律还能够根据弹种不同自适应的选取速度倾角期望值和导引参数,以满足不同战斗部对落地速度倾角的不同要求。
申请公布号 CN105043171A 申请公布日期 2015.11.11
申请号 CN201510374499.7 申请日期 2015.06.30
申请人 北京航天长征飞行器研究所;中国运载火箭技术研究院 发明人 孙月光;方海红;吴学森;方岳;宋蔚阳;鞠晓燕;赵春明;李涛;孙忠旭;黄朝东;董越;刘欣;张红岳;董春杨;秦卓;秦雪;田源
分类号 F42B15/01(2006.01)I 主分类号 F42B15/01(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 臧春喜
主权项 一种带倾角约束的火箭弹纵向导引方法,其特征在于步骤如下:(1)判断火箭弹是否进入降弧飞行阶段,即飞行时间t是否大于等于比例导引开始时间t<sub>gb</sub>,若t≥t<sub>gb</sub>,则进入步骤(2),否则,令平滑处理系数Kguid=0,进入步骤(5);(2)利用火箭弹速度、位置、姿态运动信息与目标点位置信息,计算制导指令;具体由公式:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>N</mi><mrow><mi>y</mi><mi>c</mi></mrow></msub><mo>=</mo><msub><mi>k</mi><mn>1</mn></msub><mo>*</mo><mrow><mo>(</mo><msub><mi>k</mi><mi>y</mi></msub><mo>*</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>y</mi></msub><mo>*</mo><mi>v</mi><mi>v</mi><mo>/</mo><msub><mi>G</mi><mn>0</mn></msub><mo>+</mo><mi>c</mi><mi>o</mi><mi>s</mi><mo>(</mo><msub><mi>q</mi><mi>y</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>k</mi><mn>2</mn></msub><mo>&CenterDot;</mo><msub><mi>n</mi><mrow><mi>x</mi><mn>1</mn></mrow></msub><mo>)</mo><mo>+</mo><msub><mi>k</mi><mn>4</mn></msub><mo>&CenterDot;</mo><msub><mi>k</mi><mrow><mi>l</mi><mi>d</mi></mrow></msub><mo>*</mo><mrow><mo>(</mo><msub><mi>q</mi><mi>y</mi></msub><mo>-</mo><msub><mi>&theta;</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>/</mo><msub><mi>t</mi><mi>g</mi></msub><mo>&CenterDot;</mo><mi>v</mi><mi>v</mi><mo>/</mo><msub><mi>G</mi><mn>0</mn></msub><mo>,</mo><msub><mi>x</mi><mi>r</mi></msub><mo>&GreaterEqual;</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000748871330000011.GIF" wi="1803" he="103" /></maths><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>N</mi><mrow><mi>y</mi><mi>c</mi></mrow></msub><mo>=</mo><msub><mi>k</mi><mn>1</mn></msub><mo>*</mo><mrow><mo>(</mo><msub><mi>k</mi><mi>y</mi></msub><mo>*</mo><mo>(</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>y</mi></msub><mo>)</mo></mrow><mo>*</mo><mi>v</mi><mi>v</mi><mo>/</mo><msub><mi>G</mi><mn>0</mn></msub><mo>+</mo><mi>c</mi><mi>o</mi><mi>s</mi><mrow><mo>(</mo><msub><mi>q</mi><mi>y</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>k</mi><mn>2</mn></msub><mo>&CenterDot;</mo><msub><mi>n</mi><mrow><mi>x</mi><mn>1</mn></mrow></msub><mo>)</mo><mo>+</mo><msub><mi>k</mi><mn>4</mn></msub><mo>&CenterDot;</mo><msub><mi>k</mi><mrow><mi>l</mi><mi>d</mi></mrow></msub><mo>*</mo><mrow><mo>(</mo><mo>-</mo><msub><mi>p</mi><mi>i</mi></msub><mo>-</mo><msub><mi>q</mi><mi>y</mi></msub><mo>-</mo><msub><mi>&theta;</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>/</mo><msub><mi>t</mi><mi>g</mi></msub><mo>&CenterDot;</mo><mi>v</mi><mi>v</mi><mo>/</mo><msub><mi>G</mi><mn>0</mn></msub><mo>,</mo><msub><mi>x</mi><mi>r</mi></msub><mo>&lt;</mo><mn>0</mn><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000748871330000012.GIF" wi="1953" he="109" /></maths>给出,式中,k<sub>y</sub>、k<sub>1</sub>、k<sub>2</sub>、k<sub>ld</sub>、k<sub>4</sub>为导引系数;x,y,z为弹头在发射系的坐标分量;G<sub>0</sub>为重力加速度常数;n<sub>x1</sub>为加速度计敏感到的轴向过载;θ<sub>f</sub>为期望的速度倾角;vv为火箭弹合速度;p<sub>i</sub>为圆周率π;所述发射系的坐标原点与发射点O固连,X轴在发射点水平面内,指向发射瞄准方向,Y轴垂直于发射点水平面指向上方,Z轴与XOY平面垂直并构成右手直角坐标系;q<sub>y</sub>为视线高低角,具体由公式:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>q</mi><mi>y</mi></msub><mo>=</mo><msup><mi>sin</mi><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><msub><mi>y</mi><mi>r</mi></msub><mo>/</mo><msqrt><mrow><msubsup><mi>x</mi><mi>r</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>r</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mi>r</mi><mn>2</mn></msubsup></mrow></msqrt><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000748871330000013.GIF" wi="626" he="100" /></maths>给出;x<sub>r</sub>、y<sub>r</sub>、z<sub>r</sub>是火箭弹与目标之间的相对位置,具体由公式:x<sub>r</sub>=x<sub>t</sub>‑x,y<sub>r</sub>=y<sub>t</sub>‑y,z<sub>r</sub>=z<sub>t</sub>‑z;给出,其中,x<sub>t</sub>,y<sub>t</sub>,z<sub>t</sub>为目标在发射系的坐标分量;<img file="FDA0000748871330000016.GIF" wi="71" he="82" />为视线高低角转率,具体由公式:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>y</mi></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><msub><mi>x</mi><mi>r</mi></msub><mo>&CenterDot;</mo><msub><mi>v</mi><mi>y</mi></msub><mo>+</mo><msub><mi>y</mi><mi>r</mi></msub><mo>&CenterDot;</mo><msub><mi>v</mi><mi>x</mi></msub><mo>)</mo></mrow><mo>/</mo><mrow><mo>(</mo><msubsup><mi>x</mi><mi>r</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>r</mi><mn>2</mn></msubsup><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000748871330000014.GIF" wi="697" he="93" /></maths>给出;v<sub>x</sub>,v<sub>y</sub>,v<sub>z</sub>为弹头在发射系的速度分量;t<sub>g</sub>为预估剩余飞行时间,具体由公式:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>t</mi><mi>g</mi></msub><mo>=</mo><msqrt><mrow><msubsup><mi>x</mi><mi>r</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>y</mi><mi>r</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>z</mi><mi>r</mi><mn>2</mn></msubsup></mrow></msqrt><mo>/</mo><mi>v</mi><mi>v</mi></mrow>]]></math><img file="FDA0000748871330000015.GIF" wi="461" he="97" /></maths>给出;(3)若步骤(2)中x<sub>r</sub>≥0,则利用公式(2)计算纵向过载指令N<sub>yc</sub>,否则,利用公式(1)计算纵向过载指令N<sub>yc</sub>;(4)计算平滑处理系数Kguid;具体由公式:Kguid=(t‑t<sub>gb</sub>)/t<sub>gd1</sub>给出,其中t<sub>gd1</sub>为过渡时间,取值范围为:[1,4];(5)利用步骤(3)中得到的纵向过载指令N<sub>yc</sub>和步骤(4)中得到的平滑处理系数Kguid计算最终的纵向过载指令NN<sub>yc</sub>,具体由公式:NN<sub>yc</sub>=N<sub>yc</sub>*Kguid给出。
地址 100076 北京市丰台区北京9200信箱76分箱6号