1.一種空間繩系機(jī)器人抓捕撓性目標(biāo)衛(wèi)星后的姿態(tài)接管控制方法,其特征在于步驟如下:
步驟1、建立空間繩系機(jī)器人抓捕撓性目標(biāo)后跟蹤誤差姿態(tài)動(dòng)力學(xué)方程:
其中,ω=[ω1 ω2 ω3]T∈R3,ω1,ω2和ω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(σe)ωd;
所述ωe=ω-R(σe)ωd中,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=ωe-ωc-χ2,χ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)控制律:τ=τnorm+τcom,其中,
其中,τnorm∈R3為標(biāo)稱控制量,用來(lái)消除標(biāo)稱量(-ω×Jω+(J+δδT)ωe×ω),τ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=σe-χ1,χ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)控制律τ=τnorm+τcom和外環(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ì)為
式中,F(xiàn)為正常數(shù)。