发明名称 一种公务机下降着陆控制方法
摘要 本发明公开了一种公务机下降着陆控制方法,包括下滑波束导引控制系统,以俯仰姿态控制回路作为内回路,根据公务机下降着陆过程中的三个阶段,选择定对应的控制律作为外回路,实现公务机在下滑波束的导引下准确跟踪和保持预定的飞行轨迹;侧向波束导引控制系统,以倾斜姿态保持控制回路作为内回路,以侧向波束导引自动飞行控制律作为外回路,以无线电波束等强度线的偏差角作为系统的被控量,实现着陆过程中侧向运动轨迹和航向的精确控制;速度保持控制系统控制公务机的速度,达到公务机下降着陆过程中对速度的要求。该方法能够在下滑波束和侧向波束的导引下,确保公务机能够准确跟踪和保持预定的飞行轨迹,保证公务机安全下降着陆。
申请公布号 CN104656661A 申请公布日期 2015.05.27
申请号 CN201510037067.7 申请日期 2015.01.23
申请人 南京航空航天大学 发明人 甄子洋;李康伟;袁锁中;陈挚;孙一利
分类号 G05D1/10(2006.01)I;G05B13/04(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 南京瑞弘专利商标事务所(普通合伙) 32249 代理人 杨晓玲
主权项 一种公务机下降着陆控制方法,其特征在于:所述公务机下降着陆控制方法包括下滑波束导引控制系统、侧向波束导引控制系统以及速度保持控制系统;其中:所述下滑波束导引控制系统以俯仰姿态控制回路作为内回路,根据公务机下降着陆过程中定高、下滑和拉平三个阶段,相应选择定高飞行控制律、下滑波束导引自动飞行控制律以及自动拉平着陆控制律作为外回路,实现公务机在下滑波束的导引下准确跟踪和保持预定的飞行轨迹;所述定高过程中以定高飞行控制律作为外回路,以俯仰姿态控制回路作为内回路,通过改变升降舵偏角实现飞行高度控制,所述定高飞行控制律如式(1)所示:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>&Delta;&delta;</mi><mi>e</mi></msub><mo>=</mo><mo>{</mo><mo>[</mo><mrow><mo>(</mo><msub><mi>h</mi><mi>g</mi></msub><mo>-</mo><mi>h</mi><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>h</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>h</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>h</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><msub><mi>K</mi><mover><mi>h</mi><mo>.</mo></mover></msub><mover><mi>h</mi><mo>.</mo></mover><mo>]</mo><mo>-</mo><mi>&theta;</mi><mo>}</mo><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>&alpha;</mi><mo>*</mo><mfrac><mrow><msub><mi>V</mi><mn>0</mn></msub><msub><mi>Z</mi><mi>&alpha;</mi></msub></mrow><mi>g</mi></mfrac><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>nz</mi></mrow></msub><mo>-</mo><msub><mi>qK</mi><mrow><mi>p</mi><mo>_</mo><mi>q</mi></mrow></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000660608970000011.GIF" wi="1927" he="178" /></maths>其中,Δδ<sub>e</sub>为升降舵偏角增量,h<sub>g</sub>为设定的飞行高度,h为实际飞行高度反馈量,K<sub>p_h</sub>、K<sub>i_h</sub>、K<sub>d_h</sub>为定高飞行控制律P、I、D参数,<img file="FDA0000660608970000013.GIF" wi="42" he="80" />为实际下滑垂向速度反馈量,<img file="FDA0000660608970000014.GIF" wi="79" he="90" />为垂向速度反馈控制律P参数,θ为实际俯仰角反馈量,K<sub>p_θ</sub>、K<sub>i_θ</sub>、K<sub>d_θ</sub>为俯仰姿态控制律P、I、D参数,α为实际迎角反馈量,V<sub>0</sub>为实际初始速度值,Z<sub>α</sub>为迎角量纲导数,g为重力加速度,K<sub>p_nz</sub>为法向过载反馈控制律P参数,q为实际俯仰角速率反馈量,K<sub>p_q</sub>为俯仰角速率反馈控制律P参数,s为复变量;所述下滑过程中以下滑波束导引自动飞行控制律作为外回路,以俯仰姿态控制回路作为内回路,实现公务机的飞行姿态控制,所述下滑波束导引自动飞行控制律如式(2)所示:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>&Delta;&delta;</mi><mi>e</mi></msub><mo>=</mo><mo>{</mo><mo>[</mo><mrow><mo>(</mo><msub><mi>&Gamma;</mi><mi>g</mi></msub><mo>-</mo><mi>&Gamma;</mi><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>&Gamma;</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>&Gamma;</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>&Gamma;</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>&theta;</mi><mo>}</mo><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>&alpha;</mi><mo>*</mo><mfrac><mrow><msub><mi>V</mi><mn>0</mn></msub><msub><mi>Z</mi><mi>&alpha;</mi></msub></mrow><mi>g</mi></mfrac><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>nz</mi></mrow></msub><mo>-</mo><msub><mi>qK</mi><mrow><mi>p</mi><mo>_</mo><mi>q</mi></mrow></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000660608970000012.GIF" wi="1867" he="155" /></maths>其中,Γ<sub>g</sub>为设定的下滑波束角,Γ为实际下滑波束角反馈,K<sub>p_Γ</sub>、K<sub>i_Γ</sub>、K<sub>d_Γ</sub>为下滑波束导引自动飞行控制律P、I、D参数;所述拉平过程中以自动拉平着陆控制律作为外回路,以俯仰姿态控制回路作为内回路,实现公务机的下滑垂向速度控制,所述下滑波束导引自动飞行控制律如式(3)所示:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>&Delta;&delta;</mi><mi>e</mi></msub><mo>=</mo><mo>{</mo><mo>[</mo><mrow><mo>(</mo><msub><mover><mi>h</mi><mo>.</mo></mover><mi>g</mi></msub><mo>-</mo><mfrac><mn>1</mn><mi>&tau;</mi></mfrac><mi>h</mi><mo>-</mo><mover><mi>h</mi><mo>.</mo></mover><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mover><mi>h</mi><mo>.</mo></mover><mi></mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mover><mi>h</mi><mo>.</mo></mover><mi></mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mover><mi>h</mi><mo>.</mo></mover><mi></mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>&theta;</mi><mo>}</mo><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>&theta;</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>&alpha;</mi><mo>*</mo><mfrac><mrow><msub><mi>V</mi><mn>0</mn></msub><msub><mi>Z</mi><mi>&alpha;</mi></msub></mrow><mi>g</mi></mfrac><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>nz</mi></mrow></msub><mo>-</mo><msub><mi>qK</mi><mrow><mi>p</mi><mo>_</mo><mi>q</mi></mrow></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000660608970000021.GIF" wi="1867" he="162" /></maths>其中,<img file="FDA0000660608970000024.GIF" wi="57" he="90" />为设定的下滑垂向速度,τ为拉平时间常数,<img file="FDA0000660608970000025.GIF" wi="379" he="102" />为自动拉平着陆控制律P、I、D参数;所述侧向波束导引控制系统以倾斜姿态保持控制回路作为内回路,以侧向波束导引自动飞行控制律作为外回路,以机场的公务机偏离航向信标台发射的无线电波束等强度线的偏差角作为系统的被控量,通过副翼控制滚转转弯来修正侧向偏离,实现着陆过程中侧向运动轨迹和航向的精确控制,所述侧向波束导引自动飞行控制律如式(4)所示:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mi>&Delta;&delta;</mi><mi>a</mi></msub><mo>=</mo><mo>{</mo><mo>[</mo><mrow><mo>(</mo><msub><mi>&lambda;</mi><mi>g</mi></msub><mo>-</mo><mi>&lambda;</mi><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>&lambda;</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>&lambda;</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>&lambda;</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>&phi;</mi><mo>}</mo><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>&phi;</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>&phi;</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>&phi;</mi></mrow></msub><mi>s</mi></mfrac><mo>)</mo></mrow><mo>-</mo><mi>p</mi><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>p</mi></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>p</mi></mrow></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000660608970000022.GIF" wi="1741" he="152" /></maths>其中,Δδ<sub>a</sub>为副翼偏角增量,λ<sub>g</sub>为设定的公务机偏离航向信标台发射的无线电波束等强度线的偏差角,λ为公务机偏离航向信标台发射的无线电波束等强度线的偏差角实际反馈量,K<sub>p_λ</sub>、K<sub>i_λ</sub>、K<sub>d_λ</sub>为侧向波束导引自动飞行控制律P、I、D参数,φ为实际滚转角反馈量,K<sub>p_φ</sub>、K<sub>i_φ</sub>、K<sub>d_φ</sub>为倾斜姿态保持控制回路中滚转角控制律P、I、D参数,p为实际滚转角速率反馈量,K<sub>p_p</sub>、K<sub>d_p</sub>为倾斜姿态保持控制回路中滚转角速率控制律P、D参数;所述速度保持控制系统包括PID控制器,通过控制油门来实现公务机下降着陆过程中对速度的要求,所述速度保持控制系统的控制律如式(5)所示:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>&Delta;&delta;</mi><mi>T</mi></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>V</mi><mi>g</mi></msub><mo>-</mo><mi>V</mi><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>K</mi><mrow><mi>p</mi><mo>_</mo><mi>v</mi></mrow></msub><mo>+</mo><mfrac><msub><mi>K</mi><mrow><mi>i</mi><mo>_</mo><mi>v</mi></mrow></msub><mi>s</mi></mfrac><mo>+</mo><msub><mi>K</mi><mrow><mi>d</mi><mo>_</mo><mi>v</mi></mrow></msub><mi>s</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000660608970000023.GIF" wi="1232" he="142" /></maths>其中,Δδ<sub>T</sub>为油门增量,V<sub>g</sub>为设定的飞行速度,V为实际速度反馈量,K<sub>p_v</sub>、K<sub>i_v</sub>、K<sub>d_v</sub>为速度保持控制系统控制律P、I、D参数。
地址 210016 江苏省南京市秦淮区御道街29号