航天器抓捕目标后组合体无模型快速消旋稳定控制方法与流程

文档序号:12121125阅读:来源:国知局

技术特征:

1.航天器抓捕目标后组合体无模型快速消旋稳定控制方法,其特征在于,包括以下步骤:

步骤一:组合体姿态动力学模型

针对抓捕后形成的组合体姿态动力学模型为:

<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>

其中:姿态采用修正罗格里格斯参数—MRPs,σ=[σ123]T∈R3,ω∈R3分别为在MRPs表示下的姿态角和角速度;J∈R3×3为组合体惯性坐标系的转动惯量;Hw=diag(Jw1,Jw2,Jw3,Jw4),Ω=[Ω1234]T分别为四个反作用轮的转动惯量和转速;C∈R3×4为四个反作用轮的安装矩阵;τext∈R3为未知干扰力矩;Γ(σ)=1/4[(1-σTσ)I3+2σ×+2σσT].σ×是反对称矩阵,具体形式为:

<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>

步骤二:姿态动力学模型转换

定义χ=Γ(σ)ω,对式(1)进行简化得:

<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>

其中:v=[σTT]T;Π是对角正定矩阵;uc:=-Cuw为虚拟控制力;

G(v)=Γ(σ)g,g=(J-CHwCT)-1,其中参数F(·),G(·),d(·)为未知参数;

假定输出跟踪轨迹为yr,则输出误差为ε=[ε123]T=y-yr∈R3,定义如下性能指标:

i,1μi(t)<εi(t)<δi,2μi(t) (4)

其中:δi,1i,2为待设计常值参数;μi(t)>0为严格递减函数,并且取为μi0>μi∞>0,κi>0;在预设性能(4)下,为了降低控制系统设计复杂度,定义εi(t):=μi(t)P(zi),且P(zi)取为:

<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>

则有对新定义的转化误差zi求导得

<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>

其中:z=[z1,z2,z3]T.μ=[μ123]T,ξ=diag(ξ123),Λ=diag(Λ123).

步骤三:无模型鲁棒控制器设计

设计的无模型鲁棒控制器为

其中:k=diag{k1,k2,k3},η=diag{η123}是正定对角矩阵;其中i=1,2,3;

步骤四:控制力矩鲁棒分配

虚拟控制力与四个反作用轮之间的关系为

uc=-Cuw=-(C0+ΔC0)uw (8)

其中:C0,ΔC0∈R3×4分别为反作用轮标称安装矩阵和偏差矩阵;则控制力矩鲁棒分配的优化问题为:

其中:θminmax,c#分别为反作用轮的控制上下界,以及偏差矩阵的范数上界;为Lagrangian乘子;Q为待设计正定矩阵;对(9)式进行内外最值进行优化,则实现控制力矩的鲁棒分配。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1