喇啟云，周徐斌，呂 旺，周春華

（1.上海衛(wèi)星工程研究所，上海201109； 2.上海航天技術(shù)研究院，上海 201109）

日趨增加的航天任務(wù)難度伴隨著航天器及其附件朝著大型化、低剛度、弱阻尼和模態(tài)密集的方向發(fā)展。航天器在工作過程中，大型空間撓性體會受到工作環(huán)境（熱輻射、空間碎片、溫度沖擊、太陽風(fēng)等）和內(nèi)部擾動作用（姿態(tài)調(diào)整、軌道變化、載荷活動等）的影響[1－2]。這些因素對空間撓性體帶來的影響無法避免，非常容易激起撓性體的振動。撓性振動具有時間長、頻率低、幅度大等特性，它消耗航天器能量，并對航天器的安全帶來巨大隱患。當(dāng)航天器主體運(yùn)動與撓性振動耦合時，會對航天器的指向精度和姿態(tài)穩(wěn)定產(chǎn)生極大的影響。因此抑制空間大撓性體的振動尤為重要。

針對航天器撓性體的振動抑制問題，主要有兩種振動控制方法：被動振動控制和主動振動控制。被動振動控制主要是利用阻尼材料或者在撓性體上安裝阻尼器[3]來改變系統(tǒng)特性，其對于高頻振動抑制效果較好，但應(yīng)對環(huán)境變化的能力差。近年來，以分力合成、輸入成型和智能材料振動控制為代表的主動振動控制方法的研究取得了重要進(jìn)展。陜晉軍等[4]將分力合成方法與閉環(huán)控制相結(jié)合，應(yīng)用氣浮模擬器，基于三自由度撓性系統(tǒng)進(jìn)行實(shí)驗(yàn)，驗(yàn)證了該方法的可行性，證明其能夠提高航天器的姿態(tài)控制精度。以壓電元件為主的智能材料振動控制方法是將控制作用直接施加于撓性體進(jìn)行振動控制。陳春強(qiáng)等[5]將懸臂板設(shè)計(jì)成電流變夾層結(jié)構(gòu)，利用變剛度控制降低懸臂板的振動水平。孫杰等[6]將壓電纖維復(fù)合材料分布式布置在撓性體表面，采用線性二次型最優(yōu)控制算法進(jìn)行主動控制，可以實(shí)現(xiàn)對航天器撓性振動的快速抑制。

但是，以壓電元件為主的智能材料控制撓性振動的方法對于振幅大、基頻小的撓性振動存在驅(qū)動力不足的問題。此外，在空間大型撓性體上布置壓電驅(qū)動器會影響撓性體的收攏和展開過程，增加系統(tǒng)的附加質(zhì)量，降低系統(tǒng)的可靠性。由于六自由度Stewart 平臺具有剛度質(zhì)量比大，承載能力高、穩(wěn)定性好、抗干擾能力強(qiáng)等特性[7]，并且可以直接通過串聯(lián)安裝在航天器本體和撓性體之間，避免對撓性體的展開和收攏產(chǎn)生影響。因此本文采用在大型撓性體根部安裝Stewart平臺的方法控制撓性振動。

Wang 等[8]將積分力傳感器與基于FxLMS 的自適應(yīng)反饋結(jié)合，用于壓電型Stewart 平臺的振動抑制。Ko 等[9]提出了基于迭代學(xué)習(xí)控制的Stewart 平臺振動控制方法。Beijen等[10]僅考慮了Stewart平臺自身建模參數(shù)的不確定性，忽略載荷撓性模態(tài)，設(shè)計(jì)前饋控制器，降低了建模不確定性對振動控制性能的影響。上述研究未充分考慮建模不確定性對振動控制性能的影響，本文考慮了撓性體動力學(xué)模型和Stewart 平臺動力學(xué)模型的不確定性，建立了以Stewart 平臺跟蹤誤差和撓性體模態(tài)位移為狀態(tài)量的復(fù)合動力學(xué)模型，并結(jié)合LQR設(shè)計(jì)了復(fù)合振動控制器，實(shí)現(xiàn)對撓性體的振動控制。

1 動力學(xué)建模

1.1 Stewart運(yùn)動平臺

Stewart 平臺是一種精度高、剛度大的六自由度并聯(lián)機(jī)構(gòu)，主要由負(fù)載平臺、集成作動器的支腿和基平臺通過約束副連接組成。Stewart 平臺的構(gòu)型較多，其中具有標(biāo)準(zhǔn)立方體構(gòu)型的6 支撐桿平臺以其獨(dú)特的動力學(xué)特性而更廣受關(guān)注。立方體構(gòu)型的Stewart平臺具有各方向剛度和控制能力一致、機(jī)械構(gòu)造簡單、運(yùn)動學(xué)和動力學(xué)原理簡單、執(zhí)行機(jī)構(gòu)控制系統(tǒng)的設(shè)計(jì)方便等優(yōu)點(diǎn)。本文選用立方體UPS（一端球鉸、一端萬向鉸）構(gòu)型的Stewart 平臺進(jìn)行撓性振動控制設(shè)計(jì)。

撓性振動控制平臺的坐標(biāo)系如圖1所示。負(fù)載平臺固聯(lián)坐標(biāo)系fp(opxpypzp)和基平臺固聯(lián)坐標(biāo)系fb(obxbybzb)分別固聯(lián)在負(fù)載平臺和基平臺的質(zhì)心，fe(oexeyeze)為慣性坐標(biāo)系。定義負(fù)載平臺質(zhì)心的位姿 向 量 為X=[x,y,z,φ,θ,φ]T，其中[x,y,z]T和[φ,θ,φ]T分別是負(fù)載平臺質(zhì)心的位置坐標(biāo)和采用卡爾丹角表示的姿態(tài)角。

圖1 坐標(biāo)系統(tǒng)圖

支腿向量的表達(dá)式：

式中：li為第i根支腿的位置向量，pi和bi分別是慣性坐標(biāo)系中第i根支腿與負(fù)載平臺和基平臺鉸接點(diǎn)的位置向量。t為負(fù)載平臺質(zhì)心在慣性坐標(biāo)系中的位置向量。

支腿的長度為：

支腿的方向向量為：

支腿與上平臺的關(guān)系為：

式中：J為雅可比矩陣，它將上平臺和支腿聯(lián)系在一起。雅可比矩陣J的詳細(xì)定義為：

式中：p×i(i=1,2,3,4,5,6)為向量的pi的叉乘矩陣。

由牛頓歐拉法得到Stewart平臺的動力學(xué)模型：

式中：M為慣性矩陣；C為阻尼矩陣；K為剛度矩陣；Δ為負(fù)載平臺動力學(xué)模型的不確定性；τ為支腿的廣義驅(qū)動力向量；Br為Stewart負(fù)載平臺與撓性體的轉(zhuǎn)動耦合系數(shù)；Bt為Stewart負(fù)載平臺與撓性體的平動耦合系數(shù)。

1.2 空間撓性體

通過有限元法求得撓性體上第k個節(jié)點(diǎn)的振型為：

式中：k=1,2,…,n，n為采用有限元法獲得的節(jié)點(diǎn)總數(shù)，N為振型截?cái)鄶?shù)。

若模態(tài)坐標(biāo)向量η表示為：

則第k個節(jié)點(diǎn)線位移hk表示為：

使用第二類拉格朗日方程推導(dǎo)撓性體的運(yùn)動方程。撓性體的動能為：

式中：rk=χ+ρk+hk，ρk為撓性體第k個節(jié)點(diǎn)在P系中的位置矢量。ωb和vb分別是相對慣性系的角速度和線速度。

撓性體的應(yīng)變勢能為：

式中：Kk表示第k個節(jié)點(diǎn)的剛度矩陣，根據(jù)振型Φk的正交性質(zhì)，有diag(ω21ω22…ω2N)表示用有限元法求得的撓性體的各階模態(tài)頻率。

撓性體的拉格朗日函數(shù)為：

撓性體的拉格朗日動力學(xué)方程為：

將式（10）和式（11）代入式（13）得撓性體的動力學(xué)方程：

式中：ξ=diag(ξ1,ξ2,…,ξN)為撓性體阻尼矩陣。

2 考慮建模不確定性的復(fù)合振動控制器設(shè)計(jì)

由式（14）可知，Stewart 負(fù)載平臺的加速度可為撓性體提供控制作用，分開設(shè)計(jì)振動控制器和Stewart 平臺運(yùn)動控制器。LQR 控制方法僅適用于撓性體動力學(xué)表達(dá)式（14）的控制律，得到期望的Stewart平臺位姿Xdc后設(shè)計(jì)Stewart 平臺運(yùn)動控制器，以跟蹤期望位姿Xdc。

撓性體第k個節(jié)點(diǎn)在fe(oexeyeze)系中的位置矢量為：

當(dāng)Stewart 負(fù)載平臺的跟蹤誤差exd=Xd-X和撓性體的振動為0 時，撓性體和Stewart 負(fù)載平臺的運(yùn)動等效為剛體運(yùn)動，其中Xd為負(fù)載平臺的位姿指令。為了抑制撓性體的振動，得到期望的負(fù)載平臺位姿Xdc，相應(yīng)的跟蹤誤差為ex=Xdc-X。當(dāng)ex和exd為0 時，由兩個跟蹤誤差相減可得exm=exd-ex=Xd-Xdc為0，因此可以Xdc跟蹤Xd。誤差exm的相應(yīng)動力學(xué)方程可以寫為：

式中：a1和a2是常系數(shù)矩陣，F(xiàn)是虛擬控制力，可控制exm趨于0。

誤差ex的動力學(xué)方程可寫為：

式中：b1和b2是常系數(shù)矩陣，由Stewart 平臺的控制律確定，δ為Stewart 平臺動力學(xué)模型的不確定性和撓性體動力學(xué)模型的不確定性之和。

將式（17）代入式（16），可得誤差exd的動力學(xué)方程：

再將式（18）代入式（14），得復(fù)合動力學(xué)方程為：

式中：B=[BTt BTr]

將式（19）進(jìn)一步寫為：

式中：ξh和Λh分別為阻尼矩陣和剛度矩陣，Bh為控制增益矩陣。

由式（20）得狀態(tài)空間方程：

式中：

利用LQR 控制方法設(shè)計(jì)振動控制器得到虛擬控制力F。定義系統(tǒng)的二次型性能泛函為：

式中：Q為半正定矩陣，R為正定矩陣。為了確保Z取到極小值，需要在從t0開始到無限時刻結(jié)束的區(qū)間內(nèi)，尋找并計(jì)算得到最優(yōu)控制量F，系統(tǒng)從初始狀態(tài)X0向穩(wěn)態(tài)方向發(fā)展。

系統(tǒng)Riccati方程為：

最優(yōu)控制量：

式中：P由系統(tǒng)Riccati方程求得，F(xiàn)可由U獲得。

3 撓性太陽陣振動控制仿真分析

用于撓性體振動控制的閉環(huán)系統(tǒng)原理框圖見圖2。由狀態(tài)空間方程式（21）以及LQR控制方法得到虛擬控制力F，將F代入誤差exm的動力學(xué)方程（16）中得到期望的負(fù)載平臺位姿Xdc，由于滑?？刂品椒垢蓴_魯棒性好，適應(yīng)于變體控制系統(tǒng)，因此本文選用滑?？刂圃O(shè)計(jì)Stewart平臺的控制器，跟蹤負(fù)載平臺期望位姿Xdc。

圖2 閉環(huán)控制系統(tǒng)圖

選擇大型撓性太陽陣作為仿真對象，太陽陣的質(zhì)量特性參數(shù)和撓性參數(shù)以及立方體UPS 構(gòu)型的Stewart平臺的基本參數(shù)如表1所示。

表1 太陽陣和Stewart平臺的基本參數(shù)

太陽陣尺寸/m太陽陣質(zhì)心（fp坐標(biāo)系）/m太陽陣轉(zhuǎn)動慣量/（kg·m2）太陽陣前3階頻率/Hz太陽陣前3階阻尼比ξ平動耦合系數(shù)Bt 3×1.5×0.015[0.007 0 1.9]T diag[69.23,2.69,68.61]0.705,1.293,1.783 0.01,0.01,0.01■ ■■■2.80 0 0 0 0 0 0 2.83 0■ ■■■轉(zhuǎn)動耦合系數(shù)Br負(fù)載平臺半徑/m基礎(chǔ)平臺半徑/m平臺高度/m負(fù)載平臺轉(zhuǎn)動慣量/（kg·m2）作動器阻尼矩陣/N·s·m-1作動器剛度矩陣/N·m-1 0 7.64 0 0 0 -1.44-7.61 0 0 0.256 0.256 0.1732 diag[0.154,0.308,0.154]diag[20,20,20,20,20,20]diag[1,1,1,1,1,1]×105■ ■■■■ ■■■

復(fù)合動力學(xué)方程中常系數(shù)矩陣a1、a2、b1、b2取值分別為：

a1=diag(20…20)18×18

a2=diag(30…30)18×18

b1=b2=diag(10…10)18×18

最優(yōu)控制器的控制參數(shù)Q和R分別為：

Q=diag(500…500)18×18

R=diag(0.5…0.5)18×18

選取慣性坐標(biāo)系fe與初始負(fù)載平臺固連坐標(biāo)系fp重合，Stewart 負(fù)載平臺的初始位姿X0=[0,0,0,0,0,1]T。前10 s 關(guān)閉Stewart 平臺控制器，Stewart負(fù)載平臺開始以平衡位姿[0,0,0,0,0,0]T為中心進(jìn)行回復(fù)運(yùn)動，周期為1.42 s，在Stewart負(fù)載平臺回復(fù)運(yùn)動的激勵下，太陽陣產(chǎn)生衰減振動，兩種運(yùn)動相互耦合。第10 s開啟Stewart平臺的控制器，抑制太陽陣的振動。太陽陣的模態(tài)響應(yīng)曲線如圖3所示。激勵主要引起太陽陣1 階彎曲振動，第10 s后1階振動得到迅速抑制。

圖3 太陽陣模態(tài)響應(yīng)曲線

圖4是Stewart平臺6條支腿作動器的廣義驅(qū)動力曲線，支腿作動器1、2和6主要為抑制太陽陣1階彎曲振動提供驅(qū)動力。圖5是由復(fù)合控制器獲得的Stewart 平臺的期望位姿Xdc和實(shí)際位姿X，從第10 s開始，實(shí)際位姿X跟隨期望位姿Xdc變化使太陽陣的撓性振動迅速衰減，且Stewart 平臺的位姿趨于穩(wěn)定。

圖4 6條支腿廣義驅(qū)動力曲線

圖5 Stewart平臺位姿曲線

4 結(jié)語

本文針對空間大型撓性體的振動控制問題，采用在撓性體根部安裝Stewart 平臺的方法來控制撓性振動，并提出一種復(fù)合振動控制器的設(shè)計(jì)方法。主要結(jié)論如下：

（1）為了便于執(zhí)行機(jī)構(gòu)控制系統(tǒng)的設(shè)計(jì)，更加快速準(zhǔn)確跟蹤控制指令，選用立方體UPS 構(gòu)型的Stewart平臺，采用牛頓歐拉法建立Stewart平臺動力學(xué)模型。撓采用有限元法結(jié)合拉格朗日函數(shù)建立空間撓性體的振動方程。

（2）針對Stewart平臺動力學(xué)和空間撓性體動力學(xué)建模不確定性，設(shè)計(jì)了復(fù)合振動控制器，利用LQR控制方法設(shè)計(jì)跟蹤誤差和模態(tài)位移的復(fù)合動力學(xué)的控制律，得到Stewart 上平臺的期望位姿χdc，然后設(shè)計(jì)Stewart 平臺運(yùn)動滑?？刂破?，以跟蹤期望位姿χdc，實(shí)現(xiàn)對撓性體的振動抑制。

（3）仿真結(jié)果表明，所采用的基于Stewart 平臺的空間撓性體振動復(fù)合控制方法能夠有效抑制撓性振動，同時該方法可應(yīng)用于空間大型撓性體的精確定位和振動抑制。但本文尚未考慮低頻模態(tài)密集情況下的控制問題，尚未進(jìn)行姿態(tài)機(jī)動過程中撓性體振動控制效果的研究，這些需在后續(xù)研究中進(jìn)一步考慮。