发明名称 一种飞行器俯仰通道攻角同步跟踪控制方法
摘要 本发明公开了一种飞行器俯仰通道攻角同步跟踪控制方法,包括同步系统的构造;误差系统同步控制律的设计;同步系统反演滑模跟踪器的设计;简化弹体模型的连续仿真验证;气动参数摄动下的鲁棒性检验与参数调整。本发明采用攻角与角速度的测量,配合同步系统的控制技术,提高了系统的抗干扰能力,而且减少了控制器对飞行器气动参数标称信息的依赖。本发明由于同步系统的巧妙构造,使得控制器完全不需要依赖飞行器气动参数的标称信息,而且对未知干扰有很强的鲁棒性。
申请公布号 CN105005311A 申请公布日期 2015.10.28
申请号 CN201510456184.7 申请日期 2015.07.29
申请人 中国人民解放军海军航空工程学院 发明人 雷军委;梁国强;刘迪;王玲玲;吴华丽;施建洪;于进勇;梁勇;李泽雪
分类号 G05D1/08(2006.01)I 主分类号 G05D1/08(2006.01)I
代理机构 北京国智京通知识产权代理有限公司 11501 代理人 张瑜
主权项 一种飞行器俯仰通道攻角同步跟踪控制方法,其特征在于,步骤包括:S1:采用攻角传感器测量飞行器攻角α,采用速率陀螺仪测量导弹的俯仰角速率ω<sub>z</sub>,控制器根据测量信号构成攻角同步跟踪控制器,给出输出控制信号u<sub>c</sub>,输送给舵机,通过舵机控制飞行器攻角信号α跟踪期望值α<sup>d</sup>;S2:得到飞行器在某一特征点附近的线性化模型,该模型为二阶系统,如下所示:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mover><mi>&alpha;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msub><mi>&omega;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>a</mi><mn>34</mn></msub><mi>&alpha;</mi><mo>-</mo><msub><mi>a</mi><mn>35</mn></msub><msub><mi>&delta;</mi><mi>z</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>&omega;</mi><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>=</mo><msub><mi>a</mi><mn>24</mn></msub><mi>&alpha;</mi><mo>+</mo><msub><mi>a</mi><mn>22</mn></msub><msub><mi>&omega;</mi><mi>z</mi></msub><mo>+</mo><msub><mi>a</mi><mn>25</mn></msub><msub><mi>&delta;</mi><mi>z</mi></msub></mrow></mtd></mtr></mtable><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000011.GIF" wi="531" he="156" /></maths>S3:根据S2中所述二阶系统,进行同步系统的构造与参数选取,构造二阶同步系统如下:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><mover><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mo>=</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>+</mo><msub><mi>v</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>&omega;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mi>z</mi></msub><mo>=</mo><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>-</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><msub><mi>&delta;</mi><mi>z</mi></msub><mo>+</mo><msub><mi>v</mi><mn>2</mn></msub></mrow></mtd></mtr></mtable><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000012.GIF" wi="471" he="176" /></maths>S4:根据所述步骤S2及S3中飞行器简化二阶线性系统模型与同步系统,定义误差变量如下:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msub><mi>e</mi><mi>&alpha;</mi></msub><mo>=</mo><mi>&alpha;</mi><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>e</mi><mi>&omega;</mi></msub><mo>=</mo><mi>&omega;</mi><mo>-</mo><mover><mi>&omega;</mi><mo>^</mo></mover></mrow></mtd></mtr></mtable><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000013.GIF" wi="256" he="156" /></maths>得到误差系统的模型如下:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mi>&alpha;</mi></msub><mo>=</mo><msub><mi>e</mi><mi>&omega;</mi></msub><mo>-</mo><msub><mi>a</mi><mn>34</mn></msub><mi>&alpha;</mi><mo>+</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>-</mo><msub><mi>a</mi><mn>35</mn></msub><msub><mi>&delta;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>v</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mi>&omega;</mi></msub><mo>=</mo><msub><mi>a</mi><mn>24</mn></msub><mi>&alpha;</mi><mo>+</mo><msub><mi>a</mi><mn>22</mn></msub><msub><mi>&omega;</mi><mi>z</mi></msub><mo>+</mo><msub><mi>a</mi><mn>25</mn></msub><msub><mi>&delta;</mi><mi>z</mi></msub><mo>+</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>+</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>+</mo><msub><mi>&delta;</mi><mi>z</mi></msub><mo>-</mo><msub><mi>v</mi><mn>2</mn></msub></mrow></mtd></mtr></mtable><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000014.GIF" wi="871" he="156" /></maths>设计同步控制律如下:v<sub>1</sub>=e<sub>ω</sub>+k<sub>α1</sub>e<sub>α</sub>+k<sub>α2</sub>∫e<sub>α</sub>dtv<sub>2</sub>=k<sub>ω1</sub>e<sub>ω</sub>+k<sub>ω2</sub>∫e<sub>ω</sub>dt;通过设计合适参数k<sub>α1</sub>,k<sub>α2</sub>,k<sub>ω1</sub>,k<sub>ω2</sub>使得同步控制器实现同步功能;S5:针对所述二阶同步系统,设计同步系统跟踪控制器:设定攻角期望信号为α<sup>d</sup>,定义误差信号为<img file="FDA0000770413360000015.GIF" wi="265" he="85" />首先设计滑模面<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>s</mi><mo>=</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>1</mn></mrow></msub><mi>e</mi><mo>+</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>2</mn></mrow></msub><mo>&Integral;</mo><mi>e</mi><mi>d</mi><mi>t</mi><mo>+</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000016.GIF" wi="449" he="104" /></maths>对所述滑模面求导得:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mover><mi>s</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mrow><mo>(</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>1</mn></mrow></msub><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mrow><mo>(</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>+</mo><msub><mi>v</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>2</mn></mrow></msub><mi>e</mi><mo>+</mo><mrow><mo>(</mo><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>-</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><msub><mi>&delta;</mi><mi>Z</mi></msub><mo>+</mo><msub><mi>v</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>+</mo><msub><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000017.GIF" wi="1173" he="77" /></maths>设计同步系统的跟踪控制器为:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>&delta;</mi><mi>z</mi></msub><mo>=</mo><mrow><mo>(</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>1</mn></mrow></msub><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mrow><mo>(</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>+</mo><msub><mi>v</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>2</mn></mrow></msub><mi>e</mi><mo>+</mo><mrow><mo>(</mo><mo>-</mo><mover><mi>&alpha;</mi><mo>^</mo></mover><mo>-</mo><msub><mover><mi>&omega;</mi><mo>^</mo></mover><mi>z</mi></msub><mo>+</mo><msub><mi>v</mi><mn>2</mn></msub><mo>)</mo></mrow><mo>+</mo><msub><mover><mi>v</mi><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>+</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>3</mn></mrow></msub><mi>s</mi><mo>+</mo><msub><mi>k</mi><mrow><mi>s</mi><mn>4</mn></mrow></msub><mfrac><mi>s</mi><mrow><mo>|</mo><mi>s</mi><mo>|</mo><mo>+</mo><mi>&epsiv;</mi></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0000770413360000018.GIF" wi="1395" he="137" /></maths>通过调节参数k<sub>s1</sub>,k<sub>s2</sub>,k<sub>s3</sub>,k<sub>s4</sub>,实现同步系统的攻角跟踪功能;S6:完成所述同步系统跟踪控制器参数设定后,对所述控制器进行气动参数鲁棒性检验及参数调整。
地址 264000 山东省烟台市芝罘区二马路188号