主权项 |
航天器抓捕目标后组合体无模型快速消旋稳定控制方法,其特征在于,包括以下步骤:步骤一:组合体姿态动力学模型针对抓捕后形成的组合体姿态动力学模型为:<maths num="0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mover><mi>σ</mi><mo>·</mo></mover><mo>=</mo><mi>Γ</mi><mrow><mo>(</mo><mi>σ</mi><mo>)</mo></mrow><mi>ω</mi></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>ω</mi><mo>·</mo></mover><mo>=</mo><mo>-</mo><msup><mrow><mo>(</mo><mi>J</mi><mo>-</mo><msub><mi>CH</mi><mi>w</mi></msub><msup><mi>C</mi><mi>T</mi></msup><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>[</mo><msup><mi>ω</mi><mo>×</mo></msup><mrow><mo>(</mo><mi>J</mi><mi>ω</mi><mo>+</mo><msub><mi>CH</mi><mi>w</mi></msub><mi>Ω</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>Cu</mi><mi>w</mi></msub><mo>-</mo><msub><mi>τ</mi><mrow><mi>e</mi><mi>x</mi><mi>t</mi></mrow></msub><mo>]</mo></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>Ω</mi><mo>·</mo></mover><mo>=</mo><msubsup><mi>H</mi><mi>w</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msub><mi>u</mi><mi>w</mi></msub><mo>-</mo><msup><mi>C</mi><mi>T</mi></msup><mover><mi>ω</mi><mo>·</mo></mover></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001190605880000011.GIF" wi="1421" he="263" /></maths>其中:姿态采用修正罗格里格斯参数—MRPs,σ=[σ<sub>1</sub>,σ<sub>2</sub>,σ<sub>3</sub>]<sup>T</sup>∈R<sup>3</sup>,ω∈R<sup>3</sup>分别为在MRPs表示下的姿态角和角速度;J∈R<sup>3×3</sup>为组合体惯性坐标系的转动惯量;H<sub>w</sub>=diag(J<sub>w1</sub>,J<sub>w2</sub>,J<sub>w3</sub>,J<sub>w4</sub>),Ω=[Ω<sub>1</sub>,Ω<sub>2</sub>,Ω<sub>3</sub>,Ω<sub>4</sub>]<sup>T</sup>分别为四个反作用轮的转动惯量和转速;C∈R<sup>3×4</sup>为四个反作用轮的安装矩阵;τ<sub>ext</sub>∈R<sup>3</sup>为未知干扰力矩;Γ(σ)=1/4[(1‑σ<sup>T</sup>σ)I<sub>3</sub>+2σ<sup>×</sup>+2σσ<sup>T</sup>].σ<sup>×</sup>是反对称矩阵,具体形式为:<maths num="0002"><math><![CDATA[<mrow><msup><mi>σ</mi><mo>×</mo></msup><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>σ</mi><mn>3</mn></msub></mrow></mtd><mtd><msub><mi>σ</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msub><mi>σ</mi><mn>3</mn></msub></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>σ</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>σ</mi><mn>2</mn></msub></mrow></mtd><mtd><msub><mi>σ</mi><mn>1</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001190605880000012.GIF" wi="1108" he="222" /></maths>步骤二:姿态动力学模型转换定义χ=Γ(σ)ω,对式(1)进行简化得:<maths num="0003"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mover><mi>σ</mi><mo>·</mo></mover><mo>=</mo><mi>χ</mi></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>χ</mi><mo>·</mo></mover><mo>=</mo><mi>F</mi><mrow><mo>(</mo><mi>v</mi><mo>)</mo></mrow><mo>+</mo><mi>G</mi><mrow><mo>(</mo><mi>v</mi><mo>)</mo></mrow><msub><mi>u</mi><mi>c</mi></msub><mo>+</mo><mi>d</mi></mrow></mtd></mtr><mtr><mtd><mrow><mi>y</mi><mo>=</mo><mo>Π</mo><mi>σ</mi></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001190605880000013.GIF" wi="1110" he="222" /></maths>其中:v=[σ<sup>T</sup>,χ<sup>T</sup>]<sup>T</sup>;Π是对角正定矩阵;u<sub>c</sub>:=‑Cu<sub>w</sub>为虚拟控制力;<img file="FDA0001190605880000014.GIF" wi="1693" he="87" />G(v)=Γ(σ)g,g=(J‑CH<sub>w</sub>C<sup>T</sup>)<sup>‑1</sup>,<img file="FDA0001190605880000015.GIF" wi="473" he="87" />其中参数F(·),G(·),d(·)为未知参数;假定输出跟踪轨迹为y<sub>r</sub>,则输出误差为ε=[ε<sub>1</sub>,ε<sub>2</sub>,ε<sub>3</sub>]<sup>T</sup>=y‑y<sub>r</sub>∈R<sup>3</sup>,定义如下性能指标:‑δ<sub>i,1</sub>μ<sub>i</sub>(t)<ε<sub>i</sub>(t)<δ<sub>i,2</sub>μ<sub>i</sub>(t) (4)其中:δ<sub>i,1</sub>,δ<sub>i,2</sub>为待设计常值参数;μ<sub>i</sub>(t)>0为严格递减函数,并且取为<img file="FDA0001190605880000021.GIF" wi="574" he="71" />μ<sub>i0</sub>>μ<sub>i∞</sub>>0,κ<sub>i</sub>>0;在预设性能(4)下,为了降低控制系统设计复杂度,定义ε<sub>i</sub>(t):=μ<sub>i</sub>(t)P(z<sub>i</sub>),且P(z<sub>i</sub>)取为:<maths num="0004"><math><![CDATA[<mrow><mi>P</mi><mrow><mo>(</mo><msub><mi>z</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>δ</mi><mrow><mi>i</mi><mo>,</mo><mn>2</mn></mrow></msub><msup><mi>e</mi><msub><mi>z</mi><mi>i</mi></msub></msup><mo>-</mo><msub><mi>δ</mi><mrow><mi>i</mi><mo>,</mo><mn>1</mn></mrow></msub><msup><mi>e</mi><mrow><mo>-</mo><msub><mi>z</mi><mi>i</mi></msub></mrow></msup></mrow><mrow><msup><mi>e</mi><msub><mi>z</mi><mi>i</mi></msub></msup><mo>+</mo><msup><mi>e</mi><mrow><mo>-</mo><msub><mi>z</mi><mi>i</mi></msub></mrow></msup></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001190605880000022.GIF" wi="1094" he="127" /></maths>则有<img file="FDA0001190605880000023.GIF" wi="603" he="163" />对新定义的转化误差z<sub>i</sub>求导得<maths num="0005"><math><![CDATA[<mrow><mover><mi>z</mi><mo>·</mo></mover><mo>=</mo><mi>ξ</mi><mrow><mo>(</mo><mo>Π</mo><mover><mi>σ</mi><mo>·</mo></mover><mo>-</mo><msub><mover><mi>y</mi><mo>·</mo></mover><mi>r</mi></msub><mo>-</mo><mi>Λ</mi><mover><mi>μ</mi><mo>·</mo></mover><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001190605880000024.GIF" wi="1077" he="71" /></maths>其中:z=[z<sub>1</sub>,z<sub>2</sub>,z<sub>3</sub>]<sup>T</sup>.μ=[μ<sub>1</sub>,μ<sub>2</sub>,μ<sub>3</sub>]<sup>T</sup>,ξ=diag(ξ<sub>1</sub>,ξ<sub>2</sub>,ξ<sub>3</sub>),Λ=diag(Λ<sub>1</sub>,Λ<sub>2</sub>,Λ<sub>3</sub>).步骤三:无模型鲁棒控制器设计设计的无模型鲁棒控制器为<img file="FDA0001190605880000025.GIF" wi="1190" he="134" />其中:k=diag{k<sub>1</sub>,k<sub>2</sub>,k<sub>3</sub>},<img file="FDA0001190605880000026.GIF" wi="450" he="70" />η=diag{η<sub>1</sub>,η<sub>2</sub>,η<sub>3</sub>}是正定对角矩阵;<img file="FDA0001190605880000027.GIF" wi="1574" he="79" />其中i=1,2,3;步骤四:控制力矩鲁棒分配虚拟控制力与四个反作用轮之间的关系为u<sub>c</sub>=‑Cu<sub>w</sub>=‑(C<sub>0</sub>+ΔC<sub>0</sub>)u<sub>w</sub> (8)其中:C<sub>0</sub>,ΔC<sub>0</sub>∈R<sup>3×4</sup>分别为反作用轮标称安装矩阵和偏差矩阵;则控制力矩鲁棒分配的优化问题为:<img file="FDA0001190605880000028.GIF" wi="1470" he="111" />其中:θ<sub>min</sub>,θ<sub>max</sub>,c<sup>#</sup>分别为反作用轮的控制上下界,以及偏差矩阵的范数上界;<img file="FDA0001190605880000031.GIF" wi="42" he="47" />为Lagrangian乘子;Q为待设计正定矩阵;对(9)式进行内外最值进行优化,则实现控制力矩的鲁棒分配。 |