主权项 |
一种飞行器俯仰通道攻角同步跟踪控制方法,其特征在于,步骤包括: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>α</mi><mo>·</mo></mover><mo>=</mo><msub><mi>ω</mi><mi>z</mi></msub><mo>-</mo><msub><mi>a</mi><mn>34</mn></msub><mi>α</mi><mo>-</mo><msub><mi>a</mi><mn>35</mn></msub><msub><mi>δ</mi><mi>z</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>ω</mi><mo>·</mo></mover><mi>z</mi></msub><mo>=</mo><msub><mi>a</mi><mn>24</mn></msub><mi>α</mi><mo>+</mo><msub><mi>a</mi><mn>22</mn></msub><msub><mi>ω</mi><mi>z</mi></msub><mo>+</mo><msub><mi>a</mi><mn>25</mn></msub><msub><mi>δ</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>α</mi><mo>^</mo></mover><mo>·</mo></mover><mo>=</mo><msub><mover><mi>ω</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><mover><mi>α</mi><mo>^</mo></mover><mo>+</mo><msub><mi>v</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mover><mi>ω</mi><mo>^</mo></mover><mo>·</mo></mover><mi>z</mi></msub><mo>=</mo><mo>-</mo><mover><mi>α</mi><mo>^</mo></mover><mo>-</mo><msub><mover><mi>ω</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><msub><mi>δ</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>α</mi></msub><mo>=</mo><mi>α</mi><mo>-</mo><mover><mi>α</mi><mo>^</mo></mover></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>e</mi><mi>ω</mi></msub><mo>=</mo><mi>ω</mi><mo>-</mo><mover><mi>ω</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>·</mo></mover><mi>α</mi></msub><mo>=</mo><msub><mi>e</mi><mi>ω</mi></msub><mo>-</mo><msub><mi>a</mi><mn>34</mn></msub><mi>α</mi><mo>+</mo><mover><mi>α</mi><mo>^</mo></mover><mo>-</mo><msub><mi>a</mi><mn>35</mn></msub><msub><mi>δ</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>·</mo></mover><mi>ω</mi></msub><mo>=</mo><msub><mi>a</mi><mn>24</mn></msub><mi>α</mi><mo>+</mo><msub><mi>a</mi><mn>22</mn></msub><msub><mi>ω</mi><mi>z</mi></msub><mo>+</mo><msub><mi>a</mi><mn>25</mn></msub><msub><mi>δ</mi><mi>z</mi></msub><mo>+</mo><mover><mi>α</mi><mo>^</mo></mover><mo>+</mo><msub><mover><mi>ω</mi><mo>^</mo></mover><mi>z</mi></msub><mo>+</mo><msub><mi>δ</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>∫</mo><mi>e</mi><mi>d</mi><mi>t</mi><mo>+</mo><mover><mi>e</mi><mo>·</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>·</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>ω</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><mover><mi>α</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>α</mi><mo>^</mo></mover><mo>-</mo><msub><mover><mi>ω</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><msub><mi>δ</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>·</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>δ</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>ω</mi><mo>^</mo></mover><mi>z</mi></msub><mo>-</mo><mover><mi>α</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>α</mi><mo>^</mo></mover><mo>-</mo><msub><mover><mi>ω</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>·</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>ϵ</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:完成所述同步系统跟踪控制器参数设定后,对所述控制器进行气动参数鲁棒性检验及参数调整。 |