黎 波 嚴(yán) 駿 曾擁華 郭 剛
解放軍理工大學(xué),南京,210007
電控挖掘機(jī)通過電液伺服系統(tǒng)控制挖掘臂完成各項動作。為實現(xiàn)預(yù)定的軌跡跟蹤,需控制各液壓缸頻繁啟動與制動,系統(tǒng)多數(shù)時間處于瞬態(tài)響應(yīng)過程。研究挖掘臂關(guān)節(jié)伺服系統(tǒng)的動態(tài)特性,有助于更好地了解系統(tǒng),優(yōu)化系統(tǒng)設(shè)計,提高控制精度。
為簡化分析過程,以往人們大都建立挖掘臂伺服系統(tǒng)的線性模型[1-3],或僅考慮系統(tǒng)死區(qū)非線性[4]。對閥控非對稱液壓缸系統(tǒng)動態(tài)特性的研究發(fā)現(xiàn),這類系統(tǒng)具有復(fù)雜的非線性(正反方向系統(tǒng)響應(yīng)特性不對稱、液壓缸非線性摩擦力、可壓縮液壓油的非線性彈簧力等)特征。本文在前人工作基礎(chǔ)上,分別建立電液比例閥、閥控非對稱液壓缸及挖掘臂非線性動力學(xué)模型,得到了系統(tǒng)非線性狀態(tài)空間方程。最后,通過實驗驗證系統(tǒng)中存在的復(fù)雜非線性特性。
為實現(xiàn)挖掘臂的自動控制,需對普通挖掘機(jī)液壓控制系統(tǒng)進(jìn)行改造[1],采用計算機(jī)控制代替人工操作,圖1所示為實驗室改造后的電控挖掘機(jī)樣機(jī)。為進(jìn)行準(zhǔn)確的位置和力控制,在動臂、斗桿、鏟斗安裝了傾角傳感器,在液壓泵出口及液壓缸進(jìn)回油口安裝了壓力傳感器。整個系統(tǒng)由電液比例閥、閥控液壓缸、控制器、傳感器等組成。挖掘臂關(guān)節(jié)伺服系統(tǒng)如圖2所示。
圖1 電液控制挖掘機(jī)
圖2 挖掘臂關(guān)節(jié)伺服系統(tǒng)框圖
挖掘臂電液比例系統(tǒng)包括先導(dǎo)比例減壓閥及滑閥模塊。比例閥存在死區(qū),滑閥存在油封行程(等效為死區(qū)),控制輸入與滑閥閥芯開度的動態(tài)關(guān)系可等效為
式中,τv為時間常數(shù);xv為滑閥有效位移;kv為電液比例系統(tǒng)增益;u為死區(qū)補償后控制器的有效輸出。
先導(dǎo)控制的閥控非對稱液壓缸原理如圖3所示,其動力學(xué)模型由滑閥負(fù)載流量方程、液壓缸流量連續(xù)方程及液壓缸力平衡方程組成。圖3中,y為液壓缸活塞桿位移,m為等效質(zhì)量,Bp為黏性阻尼系數(shù),F(xiàn)f為非線性摩擦力,F(xiàn)s為非線性彈簧力,F(xiàn)l為等效負(fù)載力,p1、p2分別為無桿腔和有桿腔的壓力,A1、A2分別為無桿腔和有桿腔的作用面積,Q1、Q2分別為無桿腔和有桿腔的流量,ps、pr分別為液壓泵的輸出壓力和回油壓力。
圖3 閥控非對稱液壓缸示意圖
滑閥負(fù)載流量方程:
式中,Cd為流量系數(shù);w為閥口面積梯度;ρ為液壓油密度。
液壓缸流量連續(xù)方程:
式中,βe為有效體積彈性模量;Ci、Ce分別為內(nèi)外泄漏系數(shù);V1、V2分別為無桿腔和有桿腔的有效容積。
液壓缸力平衡方程:
受壓的液壓油會產(chǎn)生彈簧力,在挖掘機(jī)液壓傳動系統(tǒng)中,液壓彈簧呈硬彈簧特性。非線性彈簧力可表示為
式中,k1、k3為彈簧模型參數(shù)。
圖4a所示為Streibeck摩擦曲線,區(qū)域1為邊界潤滑區(qū),區(qū)域2為混合潤滑區(qū),區(qū)域3為流體動壓潤滑區(qū)。圖4b所示為摩擦力與速度關(guān)系曲線。根據(jù)文獻(xiàn)[5]可將系統(tǒng)非線性摩擦模型表示為
式中,a0、a1、a2為摩擦模型參數(shù)。
圖4 摩擦力-速度關(guān)系曲線
液壓缸行程通過關(guān)節(jié)幾何關(guān)系轉(zhuǎn)化為角度輸出。以斗桿關(guān)節(jié)為例,如圖5所示,T為等效關(guān)節(jié)力矩,r為質(zhì)心到關(guān)節(jié)距離。為簡化建模,設(shè)D、O、X三點一線,且與水平面平行,得如下關(guān)系:
圖5 斗桿關(guān)節(jié)受力示意圖
令狀態(tài)變量x1=y(tǒng),x2=dy/dt,x3=p1,x4=p2,x5=xv。設(shè)回油壓力pr=0,聯(lián)立式(1)~式(9)得關(guān)節(jié)伺服系統(tǒng)非線性狀態(tài)空間方程:
通過機(jī)理建??芍?,系統(tǒng)存在比例閥死區(qū)、滑閥流量非線性、非對稱液壓缸的不對稱動態(tài)特性、非線性摩擦力、非線性彈簧力及非線性等效負(fù)載力。另外機(jī)理建模還存在未建模動態(tài)特性(如飽和、間隙等)。綜上所述,挖掘臂關(guān)節(jié)伺服系統(tǒng)非線性模型整理后如圖6所示。
圖6 系統(tǒng)非線性模型框圖
在實驗樣機(jī)上[1],以斗桿關(guān)節(jié)為例,進(jìn)行幅值不同但幅值差相等的3組開環(huán)階躍響應(yīng)實驗,當(dāng)系統(tǒng)輸入階躍信號為2.60V、2.65V及2.70V時,其響應(yīng)如圖7所示。從圖7a可見,當(dāng)輸入開環(huán)階躍激勵時,響應(yīng)角度隨時間變化不呈線性關(guān)系,這主要受系統(tǒng)整體非線性特性的影響。圖7b中系統(tǒng)響應(yīng)速度隨輸入量增大而增大,但增量不呈等比關(guān)系,這是受非線性摩擦力的影響,由式(8)與圖4b可知,摩擦力與速度不是線性關(guān)系。由圖7b還可得知,在激勵不變情況下,受式(7)中非線性液壓彈簧力的影響,系統(tǒng)響應(yīng)速度隨液壓缸活塞桿位移增大呈非線性的下降趨勢。
圖7 開環(huán)階躍激勵響應(yīng)對比圖
圖8所示為斗桿關(guān)節(jié)方波伺服跟蹤響應(yīng)曲線,受系統(tǒng)死區(qū)影響,存在很大的穩(wěn)態(tài)誤差。圖9所示為系統(tǒng)開環(huán)正弦響應(yīng)實驗曲線,當(dāng)系統(tǒng)受正弦激勵時,因死區(qū)影響,明顯存在“平頂”現(xiàn)象,即低幅值輸入時響應(yīng)速度為零。從圖9所示響應(yīng)角度曲線還可見,輸入為正弦對稱信號,而輸出卻呈現(xiàn)上升趨勢,即正反方向動態(tài)特性不對稱。從圖9所示響應(yīng)速度曲線可知,系統(tǒng)響應(yīng)速度不僅在小輸入量時不連續(xù),受非線性摩擦力的影響,響應(yīng)速度在過渡段(圖4a中的區(qū)域2)也有明顯擾動。
圖8 伺服跟蹤響應(yīng)曲線
(1)系統(tǒng)中電液比例閥存在死區(qū)非線性,這使得系統(tǒng)伺服跟蹤存在穩(wěn)態(tài)誤差且系統(tǒng)正弦響應(yīng)存在“平頂”現(xiàn)象。
(2)系統(tǒng)中液壓缸存在非線性液壓彈簧力,這使得系統(tǒng)響應(yīng)速度隨液壓缸位移呈非線性變化。
(3)系統(tǒng)中液壓缸存在非線性摩擦,導(dǎo)致系統(tǒng)響應(yīng)速度存在較大的非線性干擾。
圖9 開環(huán)正弦激勵響應(yīng)曲線
(4)系統(tǒng)中閥控非對稱液壓缸正反方向響應(yīng)特性不對稱,這使得正弦響應(yīng)呈現(xiàn)上升趨勢。
[1]Yan Jun,Li Bo,Tu Qunzhang,et al.Automatization of Excavator and Study of Its Autocontrol[C]//Third International Conference on Measuring Technology and Mechatronics Automation.Shanghai,2011:604-609.
[2]He Qinghua,Hao Peng,Zhang Daqing.Modeling and Parameter Estimation for Hydraulic System of Excavator’s Arm[J].Journal of Central South University of Technology(English Edition),2008,15(3):382-386.
[3]呂廣明,孫立寧,薛淵.神經(jīng)網(wǎng)絡(luò)在液壓挖掘機(jī)工裝軌跡控制中的應(yīng)用[J].機(jī)械工程學(xué)報,2005,41(5):199-122.
[4]張海濤,何清華,張新海,等.機(jī)器人液壓挖掘機(jī)運動系統(tǒng)的建模與控制[J].機(jī)器人,2005,27(2):13-16.
[5]Shahram T.Identification of Frictional Effects and Structural Dynamics for Improved Control of Hydraulic Manipulators[D].Vancouver:University of British Columbia,1997.