主权项 |
一种基于信息融合伺服控制的无人机姿态控制系统,其特征在于,包括俯仰姿态控制律和滚转姿态控制律;所述俯仰姿态控制律为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mi>Δ</mi><msub><mi>δ</mi><mi>e</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>k</mi><msup><mi>θ</mi><mo>*</mo></msup></msub><msup><mi>θ</mi><mo>*</mo></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mi>δT</mi></msub><mi>Δ</mi><msub><mi>δ</mi><mi>T</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mi>xlon</mi></msub><msub><mi>X</mi><mi>lon</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000711949880000011.GIF" wi="1233" he="85" /></maths>所述滚转姿态控制律为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>Δ</mi><msub><mi>δ</mi><mi>a</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>k</mi><msup><mi>φ</mi><mo>*</mo></msup></msub><msup><mi>φ</mi><mo>*</mo></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mi>δr</mi></msub><mi>Δ</mi><msub><mi>δ</mi><mi>r</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mi>xlat</mi></msub><msub><mi>X</mi><mi>lat</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>.</mo></mrow>]]></math><img file="FDA0000711949880000012.GIF" wi="1238" he="90" /></maths> |