焦 健，吳 迎，于開平

（哈爾濱工業(yè)大學(xué) 航天學(xué)院，哈爾濱 150001）

高分辨率對地觀測衛(wèi)星在諸多民用及軍事領(lǐng)域發(fā)揮著重要作用，對國家安全具有重大的戰(zhàn)略意義，也是我國衛(wèi)星工程發(fā)展的重要方向，而制約有效載荷分辨率提高的重要因素之一就是衛(wèi)星振動[1]。因此，為獲得高分辨率所需的極端安靜的環(huán)境，必須對振動進(jìn)行控制[2]。

針對振動控制提出的各種方案中，Stewart并聯(lián)平臺[3]，作為目前最典型、應(yīng)用最廣并且隔振效果相對最好的并聯(lián)隔振機(jī)構(gòu)，具有能夠?qū)崿F(xiàn)多自由度隔振，且承載能力高、剛度大、在無外界能源輸入時可以保持穩(wěn)定以及對操作的誤差不敏感等顯著優(yōu)勢，目前已經(jīng)成為一種常用的平臺設(shè)計方案[4–11]。但由于其動力學(xué)模型復(fù)雜且運(yùn)動學(xué)正解較難得到，使其理論結(jié)果難以在實(shí)際工程中廣泛應(yīng)用。

隨著虛擬樣機(jī)技術(shù)的飛速發(fā)展，聯(lián)合仿真成為了目前機(jī)電一體化研究中的熱門方法之一。同傳統(tǒng)的機(jī)械設(shè)計方法相比，其優(yōu)勢在于不必消耗大量的人力物力財力[12]，可以大大減少研發(fā)成本[13]，縮短設(shè)計周期，提高設(shè)計質(zhì)量，尤其是對于復(fù)雜的機(jī)電控制系統(tǒng)而言其優(yōu)勢更加明顯。

本文提出一種Stewart并聯(lián)平臺構(gòu)型，并對其進(jìn)行了動力學(xué)模型的建立，推導(dǎo)出了其最終的動力學(xué)方程的矩陣表達(dá)式。在此基礎(chǔ)上通過ADAMS機(jī)械動力學(xué)分析軟件對其進(jìn)行虛擬樣機(jī)模型的建立，然后將建立的輸入與輸出變化量導(dǎo)入到MATLAB/Simulink中，并在Simulink中建立了控制系統(tǒng)模型，最終實(shí)現(xiàn)Stewart并聯(lián)平臺的振動控制聯(lián)合仿真。結(jié)果表明所建動力學(xué)模型準(zhǔn)確，并且Stewart并聯(lián)平臺具有良好的隔振性能。研究成果對于Stewart并聯(lián)平臺的結(jié)構(gòu)設(shè)計以及實(shí)際的物理樣機(jī)的制造具有理論指導(dǎo)意義，并為調(diào)試合理的控制算法提供了便利的方法。

1 Stewart平臺動力學(xué)方程

Stewart平臺幾何構(gòu)型是由基礎(chǔ)平臺、載荷和6個連接基礎(chǔ)平臺和載荷的可伸縮的支腿組成，如圖1所示。

圖1 平臺的模型

本文假設(shè)所有物體均是剛性的，并且所有支腿沒有差異性。為了描述Stewart平臺的運(yùn)動學(xué)特性，在此引入6組坐標(biāo)系。分別是慣性坐標(biāo)系O；局部坐標(biāo)系P和B以及支腿上3個局部坐標(biāo)系。其中，P和B的原點(diǎn)分別位于載荷和基礎(chǔ)平臺的幾何中心，坐標(biāo)系O、P和B的坐標(biāo)軸相互平行。因此，P和B到O的變換矩陣為

支腿的計算示意圖如圖2所示。每條支腿是由上半部分si、下半部分ci和電磁作動器組成。

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

支腿長度可表示為

圖2 支腿的計算示意圖

因此支腿的單位向量表示為

通過對支腿的運(yùn)動學(xué)分析可以得到上半部分si和下半部分ci質(zhì)心處的速度和加速度表達(dá)式為

再求出其偏速度和偏角速度，即可通過Kane方程[14]來建立系統(tǒng)的動力學(xué)方程，最終的矩陣表達(dá)式為[15]

2 ADAMS虛擬樣機(jī)模型

Stewart并聯(lián)平臺的虛擬樣機(jī)模型包括1個基礎(chǔ)平臺，6條上半支腿，6條下半支腿和1個載荷圓板；連接鉸鏈包括6個移動副和12個球鉸副。圖3是根據(jù)Stewart并聯(lián)平臺幾何尺寸參數(shù)在ADAMS中建立的虛擬樣機(jī)模型。

ADAMS與MATLAB/Simulink之間的數(shù)據(jù)交換是通過狀態(tài)變量來實(shí)現(xiàn)的，而非設(shè)計變量。在計算過程中，狀態(tài)變量是一個數(shù)組，包含一系列數(shù)值。而設(shè)計變量不能保存變值，只是一個常值。在定義輸入量和輸出量之前，需要先定義相應(yīng)的狀態(tài)變量。

用于輸入和輸出的狀態(tài)變量一般是系統(tǒng)模型元素的函數(shù)，其中輸入變量是系統(tǒng)被控制的量，而輸出變量是系統(tǒng)輸入到Simulink中的變量，它的值經(jīng)過預(yù)先設(shè)計好的控制方案后，返回到輸入變量，從而實(shí)現(xiàn)數(shù)據(jù)的交換從而達(dá)到聯(lián)合仿真的效果[16]。針對本文中的Stewart并聯(lián)平臺機(jī)構(gòu)，以6條上支腿質(zhì)心處的加速度響應(yīng)作為輸出變量，以施加在6個支腿移動副上的驅(qū)動力（模擬電磁作動器的出力）作為輸入變量。然后通過ADAMS/Control接口與MATLAB/Simulink進(jìn)行連接，如圖4所示。

表1 動力學(xué)模型的參數(shù)

圖3 Stewart平臺虛擬樣機(jī)

在MATLAB/Simulink中生成模塊文件，如圖5所示。

3 模型驗(yàn)證

為了驗(yàn)證動力學(xué)的準(zhǔn)確性，把在ADAMS中建立的虛擬樣機(jī)模型和試驗(yàn)樣機(jī)模型分別進(jìn)行了模態(tài)計算，并對比分析兩者的計算結(jié)果。

ADAMS計算得到的模態(tài)分析結(jié)果如圖3所示；另外根據(jù)模型參數(shù)建立了Stewart平臺的實(shí)物樣機(jī)，如圖6所示。

并進(jìn)行了模態(tài)試驗(yàn)。將兩者的計算結(jié)果進(jìn)行整理得到表2。

圖4 ADAMS/Control接口

圖5 ADAMS_sub模塊

圖6 平臺樣機(jī)實(shí)物圖

表2 固有頻率對比/Hz

從表中可以看出兩者的計算結(jié)果基本一致，誤差很小，因此可以證明所建立的仿真模型是正確的。

4 控制系統(tǒng)

本文采用經(jīng)典的PID控制方法對Stewart平臺進(jìn)行聯(lián)合仿真驗(yàn)證，通過計算載荷的減振效果來分析控制算法對于平臺模型的有效性。

PID控制器，由比例單元P、積分單元I和微分單元D組成。通過Kp，Ki和Kd三個參數(shù)設(shè)定。PID控制器主要適用于基本線性和動態(tài)特性不隨時間變化的系統(tǒng)。由于其具有結(jié)構(gòu)簡單、穩(wěn)定性好、工作可靠、調(diào)整方便的優(yōu)點(diǎn)，已成為工程實(shí)際中應(yīng)用最廣泛的控制規(guī)律[17]．Stewart并聯(lián)平臺中PID控制系統(tǒng)Simulink模型的原理如圖7所示。

5 Stewart并聯(lián)平臺聯(lián)合仿真及試驗(yàn)

這部分將對Stewart并聯(lián)平臺進(jìn)行動力學(xué)的仿真分析，模型即為之前建立的動力學(xué)模型，在基礎(chǔ)平臺的質(zhì)心處施加一個加速度幅值恒為1 m/s2、頻率帶為5 Hz～30 Hz的正弦掃頻信號，方向沿平臺的高度方向，即垂直于基礎(chǔ)平臺和載荷的方向，定義為Z方向，并采用對數(shù)掃頻的方式。仿真計算載荷質(zhì)心處Z方向的加速度響應(yīng)，因?yàn)槠渌麅蓚€方向X、Y方向不與Z方向耦合[18]，因此加速度響應(yīng)幾乎為零。

圖7 PID控制系統(tǒng)的Simulink流程圖

圖8 載荷加速度時域響應(yīng)

分別進(jìn)行了2組仿真計算，分別是開環(huán)無控和PID控制的情況下，時域仿真結(jié)果如圖8所示，頻域仿真結(jié)果如圖9所示。

圖9 載荷加速度頻域響應(yīng)

由時域仿真曲線可以看出，控制算法能顯著地降低載荷質(zhì)心處的Z方向加速度響應(yīng)，從開環(huán)時的7.892 m/s2降低到1 m/s2左右，降幅大約為18 dB。從頻域響應(yīng)曲線上可以得知，開環(huán)情況下響應(yīng)信號主要集中在10 Hz左右的頻帶內(nèi)，這和之前得到的系統(tǒng)固有頻率是吻合的。在PID控制情況下，響應(yīng)幅值在10 Hz頻帶內(nèi)較開環(huán)時有大幅度的降低，在20 Hz處稍有增加，這是引入控制系統(tǒng)導(dǎo)致的。仿真結(jié)果證明了針對本文提出的Stewart平臺所設(shè)計的PID控制算法的有效性。

此外還進(jìn)行了試驗(yàn)的驗(yàn)證，圖10所示即是控制前后載荷加速度響應(yīng)的試驗(yàn)結(jié)果曲線。

從試驗(yàn)結(jié)果可以看出，在開環(huán)情況下響應(yīng)峰值為8.141 m/s2，在PID控制后響應(yīng)峰值降為3.282 m/s2，降幅達(dá)7.9 dB，減振效果明顯，說明Stewart主動控制并聯(lián)平臺對于振動抑制的有效性。

圖10 試驗(yàn)結(jié)果

6 結(jié)語

本文利用ADAMS軟件建立了Stewart并聯(lián)平臺的虛擬樣機(jī)模型，并通過試驗(yàn)驗(yàn)證了模型的準(zhǔn)確性。之后在MATLAB/Simulink環(huán)境下建立了控制系統(tǒng)模型，最終通過二者的接口實(shí)現(xiàn)了交互式聯(lián)合仿真。仿真結(jié)果表明，Stewart并聯(lián)平臺對于振動的抑制作用效果明顯。

通過這種聯(lián)合仿真的方法，可以方便地對系統(tǒng)進(jìn)行參數(shù)優(yōu)化以及性能的預(yù)測，不僅減少研發(fā)成本，縮短設(shè)計周期，提高設(shè)計質(zhì)量，而且對于Stewart并聯(lián)平臺的結(jié)構(gòu)設(shè)計以及實(shí)際的物理樣機(jī)的制造具有理論指導(dǎo)意義，并為調(diào)試合理的控制算法提供了便利的方法。