韋作霖,陳冠宇,王利娟
(1.鎮(zhèn)江賽爾尼柯自動化有限公司,江蘇 鎮(zhèn)江 212009;2.江蘇科技大學(xué),江蘇 鎮(zhèn)江 212003)
20世紀60年代,英國學(xué)者開創(chuàng)了六自由度并聯(lián)運動機構(gòu)的研究。經(jīng)過近60 a的研究與發(fā)展,這一研究已在機械工程、計算機科學(xué)、軟件工程、控制工程和系統(tǒng)仿真等多學(xué)科得到了發(fā)展,成為進行多學(xué)科研究的理想載體[1-2],在航天、航空、海洋裝備的開發(fā)上起著越來越重要的作用。
海浪載荷對于船舶甲板機械和船載設(shè)備運行的可靠性及壽命都有著顯著影響,對設(shè)備運行的可靠性和正常作業(yè)操作帶來的不利影響必須在上船前得以解決,因此甲板機械與船載設(shè)備的開發(fā)者們多年來一直尋求一種能在陸上檢驗其開發(fā)設(shè)備上船運行性能的模擬平臺。六自由度并聯(lián)運動平臺可通過波浪譜信號,實時控制6個液壓缸的并行工作、協(xié)同6個液壓缸的伸縮,模擬海浪給船舶造成的姿態(tài)變換,從而實現(xiàn)在陸上檢驗甲板機械和船載設(shè)備在海上風(fēng)浪環(huán)境下運行的可靠性[3-4]。依據(jù)此原理開發(fā)的六自由度液壓并聯(lián)搖擺實驗臺系統(tǒng),具有多變量、強耦合、非線性等特點,其控制與系統(tǒng)運動空間設(shè)計難度較大[5]。由于系統(tǒng)平臺的仿真模擬涉及液壓、控制與機械運動姿態(tài)等多個并發(fā)的工作機制,因而目前尚無一套完整的仿真軟件能夠勝任這一工作。能夠進行液壓、控制和機械運動姿態(tài)仿真的商用軟件AMESim、MATLAB和ADAMS彼此間存在孤島效應(yīng),只能在其軟件自身的工作能力范圍內(nèi),研究系統(tǒng)的某一特征,很難做到全面、準確、有效地運用上述3個學(xué)科領(lǐng)域的關(guān)聯(lián)運行參數(shù),分析整個平臺運動機構(gòu)的運動姿態(tài)與受控狀態(tài)。為此,本文依據(jù)波浪譜數(shù)據(jù)對搖擺實驗臺的液壓系統(tǒng)伺服驅(qū)動控制要求,結(jié)合PID傳遞函數(shù)控制算法,將ADAMS、AMESim與MATLAB的Simulink軟件構(gòu)建成相互耦合的并行仿真系統(tǒng),對搖擺實驗臺的六自由度并聯(lián)機構(gòu)的機械、液壓和控制多個系統(tǒng)進行并行耦合模擬仿真,得到搖擺試驗臺的PID伺服精度控制的傳遞函數(shù)模型,并利用實物平臺實驗,驗證其控制傳遞函數(shù)模型的精度,為利用多種海況波浪譜數(shù)據(jù)模擬控制搖擺實驗臺的運動系統(tǒng)開發(fā)奠定基礎(chǔ)。
并行搖擺實驗臺分3個系統(tǒng),即運動系統(tǒng)、液壓系統(tǒng)與控制調(diào)節(jié)系統(tǒng)。3個系統(tǒng)間通過強耦合形成六自由度閉環(huán)平臺,因此很難通過對單一的系統(tǒng)建模,獲得系統(tǒng)整體的運動與受控狀態(tài)特性;軟件功能的單一性與信息孤島特征,也很難支持軟件間的并行仿真。只有對各系統(tǒng)聯(lián)合建模,并使得模擬運動、液壓與控制的軟件進行并行聯(lián)合仿真,方能獲得系統(tǒng)的精確控制模型,使開發(fā)的系統(tǒng)控制單元能夠控制平臺機構(gòu)運行得更平穩(wěn),在接受到海浪模擬信號后能逼真模擬船舶在海浪中的運動狀況。
基于MATLAB/Simulink仿真為主的ADAMS、AMESim、MATLAB/Simulink并聯(lián)仿真系統(tǒng)是一種利用軟件間彼此控件進行傳遞函數(shù)數(shù)據(jù)轉(zhuǎn)移的傳遞仿真過程。MATLAB/Simulink將對ADAMS中的六自由度并聯(lián)運動平臺的PID控制傳遞函數(shù)通過ADAMS/Control接口輸入至ADAMS,控制六自由度并聯(lián)運動平臺的運動,同時ADAMS中的六自由度并聯(lián)運動平臺又將其機械運動的反饋動力學(xué)模型函數(shù),通過ADAMS-Sub接口反饋到MATLAB/Simulink中。AMESim與MATLAB/Simulink之間則是將AMESim模型編譯為S-Function導(dǎo)入至MATLAB/Simulink中,進行壓力驅(qū)動傳遞函數(shù)的轉(zhuǎn)移,MATLAB/Simulink依據(jù)ADAMS中六自由度并聯(lián)運動平臺動力學(xué)模型的反饋信息,將PID控制函數(shù)輸入至AMESimD液壓源的控制環(huán)節(jié)(閥),形成液壓元件驅(qū)動介質(zhì)的流量、壓力和桿件位移量函數(shù),同時該函數(shù)的輸出量又輸入至ADAMS中,控制六自由度并聯(lián)運動平臺各角點的位移、速度、角加速度模擬,在仿真系統(tǒng)中形成閉環(huán)。其原理見圖1。
圖1 搖擺實驗臺聯(lián)合函數(shù)傳遞運動與控制仿真原理圖
AMESim輸出的液壓驅(qū)動力函數(shù)為ADAMS的機械子模型提供了輸入動力的函數(shù),從而驅(qū)動液壓缸運動。輸出液壓缸位移和速度信號的函數(shù)反饋給Simulink中,作為PID控制模型的輸入傳遞函數(shù)。其反解算法和控制系統(tǒng)自動依據(jù)反饋得到的參數(shù)和負載進行PID控制。輸出的傳遞函數(shù)傳遞到AMESim中,形成電液伺服閥控制信號,控制AMESim模擬的液壓缸輸出相應(yīng)的液壓驅(qū)動力與伸縮長度函數(shù),該函數(shù)再驅(qū)動整個搖擺實驗臺系統(tǒng)模型完成持續(xù)的并聯(lián)運動仿真。
六自由度液壓并聯(lián)搖擺實驗臺機構(gòu)主要包括:上平面動工作平臺、下平面靜平臺、上平面擺動液壓缸驅(qū)動機構(gòu)、電液伺服閥控制系統(tǒng)、液壓動力恒定驅(qū)動站等。工作平臺與靜平臺間通過上、下2組各6個球鉸鏈與6個液壓缸柔性并聯(lián)相接,實現(xiàn)工作平面在6個液壓缸的協(xié)同驅(qū)動下,繞其最大空間包絡(luò)6個自由度方向運動[6-8],見圖2(a);圖2(b)為導(dǎo)入ADAMS的SolidWorks建立的三維幾何模型。將六自由度液壓并聯(lián)搖擺實驗臺的球鉸、液壓缸活塞的幾何模型在ADAMS內(nèi)定義為旋轉(zhuǎn)副、移動副,建立起單分量的力矩與輸入/輸出變量傳遞函數(shù),再將形成的ADAMS-Sub控制模型傳遞函數(shù)導(dǎo)入至MATLAB中,使ADAMS-Sub接受模擬的液壓缸驅(qū)動力傳遞函數(shù),輸出活塞桿的速度與位移函數(shù)。文獻[9]討論了搖擺臺的工作平臺在空間上的姿態(tài)變化的受控情況,通過反解求出各液壓缸的伸縮長度傳遞函數(shù)。在MATLAB/Simulink中建立六自由度液壓并聯(lián)搖擺實驗臺工作平面的反解傳遞函數(shù)(見圖3),分別給定工作平臺6個自由度上的運動約束的最大包絡(luò)空間,得到各液壓缸工作長度變化規(guī)律的傳遞函數(shù)[10],并將此函數(shù)反饋到Simulink反解器中求解,形成AMESim中動態(tài)伺服閥、液壓驅(qū)動力與液壓缸伸縮控制傳遞函數(shù)信號。
圖2 六自由度液壓并聯(lián)搖擺實驗臺實物模型與機構(gòu)模型
圖3 搖擺平臺運動學(xué)反解Simulink仿真模型
搖擺試驗臺由6組對稱電液伺服閥控制的非對稱缸構(gòu)成,并且參數(shù)相同。系統(tǒng)中最重要的控制元件是電液伺服閥,控制著相同運動仿真的進行。系統(tǒng)選用CSDY1-30型電液伺服閥,參數(shù)為:額定流量30 L/min,壓降20 MPa,頻率85 Hz,阻尼比0.8。
通過在AMESim中建立搖擺試驗臺6個液壓缸在六自由度空間內(nèi)的液壓并聯(lián)驅(qū)動傳遞函數(shù),將AMESim生成S-Function接口文件中的傳遞函數(shù)引入到Simulink中,就可通過MATLAB/Simulink的PID控制傳遞函數(shù)模型仿真控制AMESim的6個液壓缸仿真運行。
1.4.1 位移及反解算法
位移及平臺角點空間位置反解算法將搖擺試驗臺空間6個自由度的位姿反解成6個液壓缸的伸長量傳遞函數(shù),控制模塊依據(jù)反解得到的液壓缸伸長量傳遞函數(shù)控制平臺運動,以跟隨給定的輸入傳遞函數(shù)信號模擬船舶運動。
當(dāng)工作面運動時,上下對應(yīng)鉸支點間距離傳遞函數(shù)li計算公式為:
液壓缸伸縮量傳遞函數(shù)為:
Δli=li-l0
式中:l0為液壓缸初始長度,m。
1.4.2 MATLAB/Simulink反饋控制系統(tǒng)
MATLAB/Simulink反饋控制包括:期望輸入函數(shù)、反解函數(shù)、PID控制策略函數(shù);AMESim控制通過S-Function函數(shù),其對ADAMS中的幾何模型控制通過ADAMS-Sub接口,將運行輸出的壓力、位移數(shù)據(jù)傳遞給ADAMS,見圖4。在系統(tǒng)中加載模擬海浪波長的正弦信號作為期望輸入函數(shù),通過反解控制算法函數(shù),將工作平臺位姿信號反解為液壓缸位移量函數(shù)信號,通過PID反饋,輸出伺服閥控制函數(shù),得到經(jīng)過整定的模擬PID調(diào)節(jié)的3個環(huán)節(jié)的增益Kp=1.125 400;Ki=0.725 290;Kd=0.008 672。
3個軟件并行運行間的數(shù)據(jù)分別通過ADAMS,AMESim導(dǎo)入至Simulink中ADAMS-Sub和S-Function 接口實現(xiàn),其中PID反饋輸出函數(shù)控制AMESim的伺服閥開度,輸出控制液壓缸運行的位移與速度,對搖擺實驗臺并聯(lián)六自由度液壓系統(tǒng)進行全面的機械、液壓、控制并行仿真。
構(gòu)建好3個軟件平臺并聯(lián)關(guān)系傳遞函數(shù)后,以MATLAB/Simulink作為初始觸發(fā)平臺進行多系統(tǒng)并聯(lián)仿真。為驗證仿真對模擬的海浪波譜的跟隨性能,給系統(tǒng)施加正弦信號進行跟蹤仿真實驗。輸入400 mm幅值、頻率0.3 Hz的正弦波信號,當(dāng)工作平臺沿Z軸方向正弦運動時,強耦合會造成平臺運動的對稱性,因此,六個液壓缸運動狀態(tài)保持一致。通過仿真可在Simulink中得到液壓缸伸縮量隨時間變化的響應(yīng)函數(shù),1號液壓缸正弦響應(yīng)仿真見圖5。
圖5 1號液壓缸正弦響應(yīng)仿真圖
從圖中看出,雖然液壓油的阻尼特性會使執(zhí)行機構(gòu)產(chǎn)生滯后,但通過多系統(tǒng)并聯(lián)仿真,在控制系統(tǒng)設(shè)計上充分考慮了慣性環(huán)節(jié)的滯后因素,因此開發(fā)的液壓系統(tǒng)對正弦信號跟蹤特性較好,誤差約為3%,跟蹤穩(wěn)定時滯后約為0.02 s。此誤差對于液壓系統(tǒng)可忽略不計,仿真結(jié)果滿足平臺使用要求。
對搖擺實驗臺并聯(lián)六自由度液壓系統(tǒng)進行實機操作,以檢驗通過多平臺軟件并聯(lián)仿真建立的反饋控制模型正確性。實驗平臺由液壓泵站控制柜、液壓伺服泵站和六自由度搖擺實驗臺組成,控制柜依據(jù)控制系統(tǒng)反饋調(diào)節(jié)函數(shù)輸出電流信號,控制電液伺服閥的開度及通斷時間,實現(xiàn)對液壓缸的位移控制。液壓系統(tǒng)的驅(qū)動通過液壓泵站,在變頻電機、定量泵、蓄能器的調(diào)節(jié)下輸出恒壓,為系統(tǒng)提供工作壓力。選擇搖擺實驗臺并聯(lián)六自由度液壓缸沿Z軸方向進行正弦運動為傳遞函數(shù)的輸出,觀察6個液壓缸的運動狀態(tài),在LabVIEW中搭建對1號缸伸縮量變化實時監(jiān)控界面,檢測其工作平面運行狀況。
圖6為1號缸伸縮量的實際變化值與理論值變化曲線。從圖中可以看出液壓缸運動時其伸縮量的實際值與期望值存在一定的超調(diào)誤差,這是由于電壓對電磁閥開度增加而導(dǎo)致輸出流量呈比例增加。圖中伺服閥的開度變化導(dǎo)致瞬態(tài)下液壓缸壓力峰值的增加,使系統(tǒng)產(chǎn)生位移超調(diào)量,并在液壓阻尼的作用下,上升時間、下降時間和過度時間均滯后于理想狀態(tài),但誤差在允許范圍之內(nèi),液壓缸具有較好的正弦運動跟隨特性。
圖6 1號缸伸縮量實際值與期望值
平臺在周期運動實驗前,要將平臺垂直上升到中位進行初始化,通過平臺的垂蕩階躍響應(yīng)。以垂蕩階躍位姿軌跡作為實驗輸入信號,給定系統(tǒng)壓力5 MPa、油溫25 ℃分別進行PID為控制策略的垂蕩階躍運動,平臺垂蕩運動時6個液壓缸運動狀態(tài)一致。表1為PID控制策略下垂蕩階躍各缸響應(yīng)分析,可見在此控制策略內(nèi),系統(tǒng)的平均上升時間為3.95 s,平均超調(diào)量為7.63 %,平均穩(wěn)態(tài)誤差為0.47 mm。滿足系統(tǒng)設(shè)計要求。
表1 PID控制垂蕩階躍各缸響應(yīng)分析
針對搖擺試驗臺,利用ADAMS、AMESim和Simulink軟件,成功實現(xiàn)了對機械、液壓和控制系統(tǒng)的多平臺同步并行仿真。得到結(jié)論如下:
(1)根據(jù)并行仿真的結(jié)果,表明設(shè)計開發(fā)的實驗臺控制系統(tǒng)可以較好地跟隨給定位姿信號,系統(tǒng)控制精度較好,平臺運行平穩(wěn)、安全。
(2)利用聯(lián)合仿真的方法,研究電液伺服控制系統(tǒng)的動態(tài)特性可以更真實、準確、高效地反映物理平臺的真實控制與運動狀態(tài),能夠通過可視化模擬平臺的運動,使其運動空間更加清晰直觀,從而為開發(fā)多自由度的并行機構(gòu)提供了有力的手段與方法。
(3)通過進一步改進控制策略,如采用Fuzzy-PID策略,可以進一步減小系統(tǒng)的超調(diào)量,使系統(tǒng)運行得更加平穩(wěn)。