主权项 |
一种带倾角约束的火箭弹纵向导引方法,其特征在于步骤如下:(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>·</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>·</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>·</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>θ</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>/</mo><msub><mi>t</mi><mi>g</mi></msub><mo>·</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>≥</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>·</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>·</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>·</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>θ</mi><mi>f</mi></msub><mo>)</mo></mrow><mo>/</mo><msub><mi>t</mi><mi>g</mi></msub><mo>·</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><</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>·</mo></mover><mi>y</mi></msub><mo>=</mo><mrow><mo>(</mo><mo>-</mo><msub><mi>x</mi><mi>r</mi></msub><mo>·</mo><msub><mi>v</mi><mi>y</mi></msub><mo>+</mo><msub><mi>y</mi><mi>r</mi></msub><mo>·</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给出。 |