发明名称 航天器抓捕目标后组合体无模型快速消旋稳定控制方法
摘要 本发明公开了一种航天器抓捕目标后组合体无模型快速消旋稳定控制方法,在不需要组合体动力学模型信息的基础上,实现对组合体的低复杂度鲁棒控制器设计。同时,组合体的瞬态与稳态性能能够得到先验设计和保障。本发明在不需要对系统未知动力学模型在线辨识以及未知外界干扰观测条件下,就可以实现对服务星抓捕后组合体的快速消旋与稳定控制,控制系统设计的复杂度大大降低;本发明实现了对组合体控制系统的瞬态态与稳态性能的先验设计,且组合体控制系统的性能不依赖于大量繁复的控制器调参过程,控制系统设计简单,易于实际工程应用。
申请公布号 CN106502101A 申请公布日期 2017.03.15
申请号 CN201611209110.4 申请日期 2016.12.23
申请人 西北工业大学 发明人 罗建军;魏才盛;袁建平;王明明;朱战霞;殷泽阳;夏鹏程
分类号 G05B13/04(2006.01)I;G05D1/08(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 西安通大专利代理有限责任公司 61200 代理人 徐文权
主权项 航天器抓捕目标后组合体无模型快速消旋稳定控制方法,其特征在于,包括以下步骤:步骤一:组合体姿态动力学模型针对抓捕后形成的组合体姿态动力学模型为:<maths num="0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mover><mi>&sigma;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>&Gamma;</mi><mrow><mo>(</mo><mi>&sigma;</mi><mo>)</mo></mrow><mi>&omega;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>&omega;</mi><mo>&CenterDot;</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>&lsqb;</mo><msup><mi>&omega;</mi><mo>&times;</mo></msup><mrow><mo>(</mo><mi>J</mi><mi>&omega;</mi><mo>+</mo><msub><mi>CH</mi><mi>w</mi></msub><mi>&Omega;</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>Cu</mi><mi>w</mi></msub><mo>-</mo><msub><mi>&tau;</mi><mrow><mi>e</mi><mi>x</mi><mi>t</mi></mrow></msub><mo>&rsqb;</mo></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>&Omega;</mi><mo>&CenterDot;</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>&omega;</mi><mo>&CenterDot;</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>&sigma;</mi><mo>&times;</mo></msup><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>3</mn></msub></mrow></mtd><mtd><msub><mi>&sigma;</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msub><mi>&sigma;</mi><mn>3</mn></msub></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>1</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>2</mn></msub></mrow></mtd><mtd><msub><mi>&sigma;</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>&sigma;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mi>&chi;</mi></mrow></mtd></mtr><mtr><mtd><mrow><mover><mi>&chi;</mi><mo>&CenterDot;</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>&Pi;</mo><mi>&sigma;</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>&delta;</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>&delta;</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>&CenterDot;</mo></mover><mo>=</mo><mi>&xi;</mi><mrow><mo>(</mo><mo>&Pi;</mo><mover><mi>&sigma;</mi><mo>&CenterDot;</mo></mover><mo>-</mo><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>-</mo><mi>&Lambda;</mi><mover><mi>&mu;</mi><mo>&CenterDot;</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)式进行内外最值进行优化,则实现控制力矩的鲁棒分配。
地址 710072 陕西省西安市碑林区友谊西路127号