亚洲成年人黄色一级片,日本香港三级亚洲三级,黄色成人小视频,国产青草视频,国产一区二区久久精品,91在线免费公开视频,成年轻人网站色直接看

空間繩系機(jī)器人抓捕撓性目標(biāo)衛(wèi)星后的姿態(tài)接管控制方法與流程

文檔序號(hào):12121628閱讀:來(lái)源:國(guó)知局

技術(shù)特征:

1.一種空間繩系機(jī)器人抓捕撓性目標(biāo)衛(wèi)星后的姿態(tài)接管控制方法,其特征在于步驟如下:

步驟1、建立空間繩系機(jī)器人抓捕撓性目標(biāo)后跟蹤誤差姿態(tài)動(dòng)力學(xué)方程:

<mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> <msub> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>e</mi> </msub> <mo>=</mo> <mi>&tau;</mi> <mo>-</mo> <msup> <mi>&omega;</mi> <mo>&times;</mo> </msup> <msub> <mi>J</mi> <mn>0</mn> </msub> <mi>&omega;</mi> <mo>-</mo> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> <msub> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>+</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> <mo>+</mo> <mover> <mi>d</mi> <mo>&OverBar;</mo> </mover> </mrow>

其中,ω=[ω1 ω2 ω3]T∈R3,ω12和ω3為復(fù)合體絕對(duì)角速度在本體坐標(biāo)系下的分量;J∈R3×3為復(fù)合體轉(zhuǎn)動(dòng)慣量的名義值;ωd為期望的姿態(tài)角速度;

為總干擾力矩;τ為空間繩系機(jī)器人的控制力矩;ω×為角速度ω的反對(duì)稱矩陣;ΔJ為轉(zhuǎn)動(dòng)慣量的不確定量;TL∈R3×1為系繩擺動(dòng)力矩;角速度跟蹤誤差ωe=ω-R(σed;

所述ωe=ω-R(σed中,R(σe)=R(σ)[R(σd)]T,σ=[σ1 σ2 σ3]T∈R3為修正的羅德里格參數(shù)表示,σd為期望的修正羅德里格數(shù),E3為3階單位矩陣;

所述中,δ∈R3×N為撓性部件與剛性體之間的耦合系數(shù);Λ為撓性部件模態(tài)振型頻率;Λ2=diag{Λ12,…,ΛN2}為撓性部件的剛度矩陣;ξ為撓性模態(tài)阻尼系數(shù),2ξΛ=diag{2ξ1Λ1,…,2ξNΛN}為撓性部件的阻尼矩陣,N為所考慮的撓性部件模態(tài)階數(shù);η∈RN為撓性部件模態(tài)坐標(biāo);為外部干擾力矩,包括太陽(yáng)光壓力、地球重力梯度等擾動(dòng)的影響;

步驟2、內(nèi)外環(huán)終端滑??刂破骱拖鄳?yīng)的自適應(yīng)律設(shè)計(jì):

1、內(nèi)環(huán)快速終端滑模面:

其中,z2=ωec2,χ2為指令濾波中設(shè)計(jì)的變量;K1=diag{k11,k12,k13},K2=diag{k21,k22,k23}為待設(shè)計(jì)參數(shù),且滿足k1i>0,k2i>0(i=1,2,3),SIn=[SIn1,SIn2,SIn3]T,|ωe|psign(ωe)=[|ωe1|psign(ωe1),|ωe2|psign(ωe2),|ωe3|psign(ωe3)]T,0.5<p<1,sign(ωe)為符號(hào)函數(shù);

內(nèi)環(huán)控制律:τ=τnormcom,其中,

<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&tau;</mi> <mrow> <mi>n</mi> <mi>o</mi> <mi>r</mi> <mi>m</mi> </mrow> </msub> <mo>=</mo> <msup> <mi>&omega;</mi> <mo>&times;</mo> </msup> <msub> <mi>J</mi> <mn>0</mn> </msub> <mi>&omega;</mi> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>R</mi> <mo>(</mo> <msub> <mi>&sigma;</mi> <mi>e</mi> </msub> <mo>)</mo> <msub> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>-</mo> <msup> <msub> <mi>&omega;</mi> <mi>e</mi> </msub> <mo>&times;</mo> </msup> <mi>R</mi> <mo>(</mo> <msub> <mi>&sigma;</mi> <mi>e</mi> </msub> <mo>)</mo> <msub> <mi>&omega;</mi> <mi>d</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> </mrow> <msub> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>c</mi> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> </mrow> <msub> <mi>a</mi> <mn>2</mn> </msub> <msub> <mi>&chi;</mi> <mn>2</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> </mrow> <msub> <mi>K</mi> <mn>1</mn> </msub> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> <mo>)</mo> </mrow> <msub> <mi>K</mi> <mn>2</mn> </msub> <mo>|</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <msup> <mo>|</mo> <mi>p</mi> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&tau;</mi> <mrow> <mi>c</mi> <mi>o</mi> <mi>m</mi> </mrow> </msub> <mo>=</mo> <mo>-</mo> <msup> <mover> <mi>&alpha;</mi> <mo>^</mo> </mover> <mi>T</mi> </msup> <mover> <mi>&alpha;</mi> <mo>^</mo> </mover> <msub> <mi>S</mi> <mrow> <mi>I</mi> <mi>n</mi> </mrow> </msub> <mo>-</mo> <mfrac> <msup> <mi>&epsiv;</mi> <mn>2</mn> </msup> <mn>4</mn> </mfrac> <msub> <mi>S</mi> <mrow> <mi>I</mi> <mi>n</mi> </mrow> </msub> <mo>-</mo> <mfrac> <msub> <mi>S</mi> <mrow> <mi>I</mi> <mi>n</mi> </mrow> </msub> <mrow> <mo>|</mo> <mo>|</mo> <msub> <mi>S</mi> <mrow> <mi>I</mi> <mi>n</mi> </mrow> </msub> <mo>|</mo> <msup> <mo>|</mo> <mn>2</mn> </msup> </mrow> </mfrac> <mo>&lsqb;</mo> <mi>h</mi> <msup> <mrow> <mo>(</mo> <msup> <msub> <mi>S</mi> <mrow> <mi>I</mi> <mi>n</mi> </mrow> </msub> <mi>T</mi> </msup> <mo>(</mo> <mrow> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>-</mo> <msup> <mi>&delta;&delta;</mi> <mi>T</mi> </msup> </mrow> <mo>)</mo> <msub> <mi>S</mi> <mrow> <mi>I</mi> <mi>n</mi> </mrow> </msub> <mo>)</mo> </mrow> <mrow> <mn>1</mn> <mo>/</mo> <mn>2</mn> </mrow> </msup> <mo>+</mo> <mo>|</mo> <mo>|</mo> <mover> <mi>&alpha;</mi> <mo>^</mo> </mover> <mo>|</mo> <mo>|</mo> <mo>+</mo> <mfrac> <mn>1</mn> <mrow> <mn>4</mn> <mi>&epsiv;</mi> </mrow> </mfrac> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>3</mn> </munderover> <mo>|</mo> <msub> <mover> <mi>&alpha;</mi> <mo>^</mo> </mover> <mi>i</mi> </msub> <mo>|</mo> <mo>&rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>

其中,τnorm∈R3為標(biāo)稱控制量,用來(lái)消除標(biāo)稱量(-ω×Jω+(J+δδTe×ω),τcom∈R3為補(bǔ)償控制量,主要用于提高系統(tǒng)魯棒性,消除因慣量、擾動(dòng)、耦合等作用而引起的系統(tǒng)不確定項(xiàng),從而保證控制系統(tǒng)狀態(tài)能夠到達(dá)滑模面;0<γ≤ε,ε為足夠小實(shí)數(shù);參數(shù)自適應(yīng)律滿足r,h和ζ為實(shí)常數(shù);

2.外環(huán)快速終端滑模面:

其中,z1=σe1,χ1為指令濾波中設(shè)計(jì)的變量;D1=diag{d11,d12,d13},D2=diag{d21,d22,d23}為待設(shè)計(jì)參數(shù),且滿足d1i>0,d2i>0(i=1,2,3),SOu=[SOu1,SOu2,SOu3]T,|z1|psign(z1)=[|z11|psign(z11),|z12|psign(z12),|z13|psign(z13)]T,0.5<q<1,sign(z1)為符號(hào)函數(shù)。

外環(huán)控制律

其中,a1和η為待設(shè)計(jì)的參數(shù),

步驟3:以內(nèi)環(huán)控制律τ=τnormcom和外環(huán)控制律作為控制系統(tǒng)的輸入進(jìn)行撓性目標(biāo)衛(wèi)星捕獲后的姿態(tài)接管控制,并進(jìn)行穩(wěn)定性證明。

步驟4:設(shè)計(jì)帶壓電陶瓷驅(qū)動(dòng)器的撓性航天器的振動(dòng)抑制控制器控制η。

撓性航天器振動(dòng)抑制控制器設(shè)計(jì)為

<mrow> <msub> <mi>u</mi> <mi>p</mi> </msub> <mo>=</mo> <msup> <msub> <mi>F&delta;</mi> <mn>1</mn> </msub> <mi>T</mi> </msup> <mover> <mi>&eta;</mi> <mo>&CenterDot;</mo> </mover> </mrow>

式中,F(xiàn)為正常數(shù)。

當(dāng)前第2頁(yè)1 2 3 
網(wǎng)友詢問(wèn)留言 已有0條留言
  • 還沒(méi)有人留言評(píng)論。精彩留言會(huì)獲得點(diǎn)贊!
1