集成儲(chǔ)能泵控液壓挖掘機(jī)的軌跡控制

矦亞寧，夏連鵬，2，趙斌，權(quán)龍

（1.太原理工大學(xué)新型傳感器與智能控制教育部與山西省重點(diǎn)實(shí)驗(yàn)室，山西太原 030024；2.三一重機(jī)有限公司，江蘇蘇州 215300）

0 前言

液壓挖掘機(jī)是一種典型的多功能工程機(jī)械，在工、農(nóng)業(yè)生產(chǎn)，采礦業(yè)及軍事領(lǐng)域發(fā)揮著不可或缺的作用。對(duì)于傳統(tǒng)液壓挖掘機(jī)，操作員需手動(dòng)控制操作桿以完成各類(lèi)作業(yè)工況，存在諸如操作員腦力與體力消耗過(guò)大；火災(zāi)、地震、化學(xué)泄漏等工作環(huán)境危險(xiǎn)，不適宜操作員進(jìn)入；精度要求較高的作業(yè)任務(wù)需要經(jīng)驗(yàn)豐富、技藝高超的操作員來(lái)完成等各類(lèi)問(wèn)題［1］。因此，發(fā)展挖掘機(jī)自動(dòng)化作業(yè)顯得十分必要。

軌跡規(guī)劃和軌跡控制是挖掘機(jī)自動(dòng)化作業(yè)基礎(chǔ)和關(guān)鍵，而軌跡規(guī)劃又是軌跡控制的依據(jù)和前提。軌跡規(guī)劃分關(guān)節(jié)空間軌跡規(guī)劃［2］和笛卡爾空間軌跡規(guī)劃［3］，兩種方法各有其優(yōu)劣，需依據(jù)作業(yè)要求來(lái)選擇。軌跡規(guī)劃方法有期望曲線規(guī)劃［4］、多項(xiàng)式插值規(guī)劃［5］、非均勻B 樣條曲線規(guī)劃［6］等。軌跡跟蹤控制大多采用PID 或結(jié)合一些智能算法，中南大學(xué)的賀繼林等［7］利用小腦模型神經(jīng)網(wǎng)絡(luò)對(duì)挖掘機(jī)直線作業(yè)進(jìn)行控制，控制精度達(dá)到20 mm 之內(nèi)，具有良好的控制效果；哈爾濱工業(yè)大學(xué)的徐國(guó)勝等［8］基于高增益觀測(cè)器的滑模控制對(duì)液壓缸位移進(jìn)行控制，該方法簡(jiǎn)便易操作且減小了運(yùn)行過(guò)程中的誤差，提高了穩(wěn)定性；南京工業(yè)大學(xué)的宋倩玉等［9］對(duì)比傳統(tǒng)PID 控制器、經(jīng)典遺傳算法優(yōu)化的PID 控制器以及改進(jìn)遺傳算法優(yōu)化的PID 控制器斜坡作業(yè)時(shí)的控制效果，發(fā)現(xiàn)改進(jìn)遺傳算法優(yōu)化的PID 控制器響應(yīng)快速，軌跡跟蹤誤差小，具有實(shí)際應(yīng)用價(jià)值。此外，常用的智能控制算法還有模糊控制［10］、自適應(yīng)控制［11］等。以上都是利用智能算法對(duì)閥控液壓缸進(jìn)行控制，并明顯改善了軌跡跟蹤特性，但缺乏基于泵控液壓缸對(duì)挖掘機(jī)軌跡控制的研究。

此處基于集成儲(chǔ)能泵控液壓挖掘機(jī)研究軌跡控制，采用泵控缸的出發(fā)點(diǎn)是其較閥控缸更為節(jié)能。美國(guó)普渡大學(xué)Monika IVANTYSYNOVA 教授采用泵控缸與高、低壓蓄能器組合的系統(tǒng)使發(fā)動(dòng)機(jī)功率減小了50%［12］；福建工程學(xué)院的張樹(shù)忠等［13］對(duì)比泵控缸與閥控缸驅(qū)動(dòng)挖掘機(jī)執(zhí)行相同作業(yè)工況時(shí)的能耗特性，表明泵控系統(tǒng)較閥控系統(tǒng)節(jié)能約68%；浙江大學(xué)的趙鵬宇等［14］利用泵控復(fù)合液壓缸與蓄能器組合回收勢(shì)能的原理降低了挖掘機(jī)能耗，并通過(guò)能量管理策略使發(fā)動(dòng)機(jī)輸出功率降低了44%；太原理工大學(xué)的葛磊［15］利用非對(duì)稱(chēng)泵第三油口與蓄能器組合回收勢(shì)能的閉式泵控回路研究挖掘機(jī)動(dòng)臂、斗桿的能耗特性，結(jié)果表明：與進(jìn)出口獨(dú)立系統(tǒng)相比，能量利用率提高約50%。

因此，此處基于集成儲(chǔ)能泵控液壓挖掘機(jī)研究軌跡控制的目的是探索挖掘機(jī)節(jié)能化與智能化的統(tǒng)一。

1 挖掘機(jī)運(yùn)動(dòng)學(xué)分析

1.1 建立坐標(biāo)系及定義變量空間

采用D-H（Denavit-Hartenberg）方法建立挖掘機(jī)坐標(biāo)系，如圖1 所示，由于文中只研究平面內(nèi)動(dòng)臂、斗桿、鏟斗三自由度運(yùn)動(dòng)，不考慮上部回轉(zhuǎn)運(yùn)動(dòng)，故可定義關(guān)節(jié)轉(zhuǎn)角［θ2，θ3，θ4］為關(guān)節(jié)空間，動(dòng)臂、斗桿、鏟斗液壓缸行程［λ2，λ3，λ4］為驅(qū)動(dòng)空間，鏟斗齒尖末端在笛卡爾空間坐標(biāo)位置及鏟斗姿態(tài)角［x，z，φ］為位姿空間。

圖1 挖掘機(jī)工作裝置D-H 坐標(biāo)Fig.1 D-H coordinates of excavator working device

1.2 位姿空間與關(guān)節(jié)空間的轉(zhuǎn)換關(guān)系

從位姿空間求解關(guān)節(jié)空間是挖掘機(jī)運(yùn)動(dòng)學(xué)逆向求解的過(guò)程，也是對(duì)挖掘機(jī)作業(yè)任務(wù)進(jìn)行軌跡規(guī)劃和控制時(shí)對(duì)其運(yùn)動(dòng)控制量求解的第一步，之后再?gòu)年P(guān)節(jié)空間求解到驅(qū)動(dòng)空間。挖掘機(jī)不考慮上部回轉(zhuǎn)運(yùn)動(dòng)時(shí)，鏟斗齒尖末端在位姿空間內(nèi)可表示為［xL，zL，φ］，故位姿空間與關(guān)節(jié)空間的轉(zhuǎn)換關(guān)系式為

1.3 關(guān)節(jié)空間與驅(qū)動(dòng)空間的轉(zhuǎn)化關(guān)系

從某種意義上講，挖掘機(jī)軌跡規(guī)劃的實(shí)質(zhì)是對(duì)位姿空間和關(guān)節(jié)空間的規(guī)劃，而軌跡控制的實(shí)質(zhì)是對(duì)驅(qū)動(dòng)空間的控制。由于規(guī)劃后的位姿空間需傳遞到驅(qū)動(dòng)空間，因此需求解從關(guān)節(jié)空間到驅(qū)動(dòng)空間的轉(zhuǎn)換關(guān)系。關(guān)節(jié)空間與驅(qū)動(dòng)空間的轉(zhuǎn)換關(guān)系可通過(guò)三角函數(shù)求解，其轉(zhuǎn)換表達(dá)式為

1.4 軌跡規(guī)劃

為使挖掘機(jī)作業(yè)過(guò)程平穩(wěn)、無(wú)沖擊，需保證速度及加速度的連續(xù)性，為此，參照機(jī)器人軌跡規(guī)劃方法，利用正弦加減速法對(duì)挖掘機(jī)齒尖末端作軌跡規(guī)劃。圖2 所示為挖掘機(jī)整平作業(yè)時(shí)齒尖水平方向位移、速度、加速度規(guī)劃曲線，并依據(jù)逆運(yùn)動(dòng)學(xué)將位姿空間轉(zhuǎn)換到驅(qū)動(dòng)空間，在驅(qū)動(dòng)空間內(nèi)控制挖掘機(jī)各液壓缸跟蹤目標(biāo)軌跡以完成設(shè)定作業(yè)任務(wù)。

圖2 整平作業(yè)鏟斗齒尖位移-速度-加速度的規(guī)劃曲線Fig.2 Planning curves of displacement-velocity-acceleration of bucket tip in leveling operation

2 挖掘機(jī)工作裝置液壓系統(tǒng)分析研究

2.1 集成儲(chǔ)能泵控液壓挖掘機(jī)工作原理

研究發(fā)現(xiàn)，絕大多數(shù)的作業(yè)工況中，動(dòng)臂和斗桿工作裝置可回收能量占整機(jī)可回收能量的75%左右，而鏟斗等裝置可回收能量相對(duì)較少。因此集成儲(chǔ)能泵控液壓挖掘機(jī)中動(dòng)臂、斗桿采用閉式泵控集成液壓缸，鏟斗則采用開(kāi)式泵控，如圖3 所示。

圖3 集成儲(chǔ)能泵控液壓挖掘機(jī)回路原理Fig.3 Circuit principle of pump-controlled hydraulic excavator with integrated energy-storage

集成液壓缸A、B、C 三腔分別為柱塞腔、活塞腔、勢(shì)能回收腔，其中A、B 兩腔分別與泵的進(jìn)、出油口連接，C 腔與液壓蓄能器相連。工作時(shí)通過(guò)調(diào)節(jié)伺服電機(jī)的轉(zhuǎn)速使泵出口流量與負(fù)載流量平衡，消除節(jié)流損失；通過(guò)調(diào)節(jié)伺服電機(jī)轉(zhuǎn)向控制系統(tǒng)流量方向，進(jìn)而控制液壓缸的伸縮，且當(dāng)伺服電機(jī)改變轉(zhuǎn)向時(shí)由于A、B 兩腔面積比為1 ∶1，所以理論上講不存在由于A、B 兩腔面積不等而出現(xiàn)的流量不平衡問(wèn)題，但考慮到油液泄漏、壓縮等導(dǎo)致的油液損失，故用蓄能器連接液控單向閥為系統(tǒng)補(bǔ)油。開(kāi)式泵控則通過(guò)調(diào)節(jié)電機(jī)轉(zhuǎn)速平衡泵出口與負(fù)載流量以消除節(jié)流損失；通過(guò)切換換向閥開(kāi)關(guān)控制液壓缸運(yùn)行方向。

液壓挖掘機(jī)工作裝置在作業(yè)過(guò)程中頻繁升降，動(dòng)臂、斗桿的重力勢(shì)能經(jīng)液壓閥口節(jié)流轉(zhuǎn)化為熱能耗散，導(dǎo)致能量損耗，因此可通過(guò)勢(shì)能回收腔與蓄能器連接實(shí)現(xiàn)對(duì)重力勢(shì)能的回收利用。動(dòng)臂、斗桿下降時(shí)，在重力作用下液壓缸勢(shì)能回收腔中油液被擠壓到蓄能器，蓄能器儲(chǔ)能增加；工作裝置舉升時(shí)，蓄能器中油液進(jìn)入勢(shì)能回收腔，輔助柱塞腔共同舉升。通過(guò)蓄能器回收重力勢(shì)能的方法，無(wú)需再將液壓能轉(zhuǎn)化為諸如電能、機(jī)械能，化學(xué)能等其他形式能量，能量轉(zhuǎn)化路徑短，減少了轉(zhuǎn)化過(guò)程中的能量損耗，節(jié)能效果更好。

2.2 閉式泵控集成液壓缸數(shù)學(xué)模型

為進(jìn)一步凸顯泵控集成液壓缸節(jié)能特性和分析其動(dòng)態(tài)特性，建立該系統(tǒng)的數(shù)學(xué)模型?？紤]舉升過(guò)程與下降過(guò)程具有一定相似性，此處以動(dòng)臂液壓缸舉升過(guò)程為例搭建數(shù)學(xué)模型。

集成液壓缸動(dòng)力學(xué)方程為

式中：A1為集成液壓缸柱塞腔的截面積；A2為集成液壓缸有桿腔的橫截面；A3為集成液壓缸勢(shì)能回收腔的橫截面；p1為集成液壓缸柱塞腔的壓力；p2為集成液壓缸有桿腔的壓力；p3為集成液壓缸勢(shì)能回收腔的壓力；B為阻尼系數(shù)；FL為集成液壓缸上外負(fù)載力；Ff為集成液壓缸所受摩擦力；x為集成液壓缸位移。

定量泵流量連續(xù)方程為

式中：Wp為定量泵轉(zhuǎn)速；Dp為定量泵排量；Ctp為定量泵總泄漏系數(shù)；pp為定量泵出口壓力。

流入柱塞腔的流量連續(xù)方程為

流入勢(shì)能回收腔的流量連續(xù)方程為

式中：Ctc為液壓缸總泄漏系數(shù)；V1為柱塞腔容積；V3為勢(shì)能回收腔容積；βe為有效體積彈性模量。

蓄能器提供壓力為

舉升過(guò)程中，蓄能器釋放的能量為

式中：p0為蓄能器預(yù)充氣體壓力；V0為蓄能器預(yù)充氣體體積；ΔV為蓄能器中油液體積；v為液壓缸運(yùn)行速度。

對(duì)公式（3）—（6）作拉普拉斯變換，則：

聯(lián)立式（9）—（12），令Ctp＝Ctc＝C，且A3＝2A1，將A2P2當(dāng)作負(fù)載力與FL一同考慮，經(jīng)簡(jiǎn)化后泵控集成液壓缸傳遞函數(shù)為

由式（13）得，伺服電機(jī)驅(qū)動(dòng)泵控集成液壓缸舉升過(guò)程中其固有頻率和阻尼比為

由式（14）和式（15）可知：增大蓄能器容積，則勢(shì)能回收腔有效容積變大，故系統(tǒng)固有頻率減小，阻尼比增大；增大柱塞腔截面積，系統(tǒng)固有頻率增大，但阻尼比減小。為改善挖掘機(jī)工作裝置的控制性能，應(yīng)盡量提高其固有頻率和阻尼比。液壓缸橫截面積和蓄能器容積同時(shí)增大會(huì)對(duì)改裝空間、成本、構(gòu)件減重等方面產(chǎn)生不利影響，因此需盡量減小液壓缸橫截面積和蓄能器容積。

2.3 伺服電機(jī)驅(qū)動(dòng)泵控集成液壓缸位置速度復(fù)合控制策略

為使挖掘機(jī)鏟斗齒尖完成設(shè)定直線運(yùn)動(dòng)，需同時(shí)保證挖掘機(jī)各液壓缸的位置精度和速度精度。為此，將位置閉環(huán)與速度閉環(huán)引入控制系統(tǒng)提高位置、速度控制精度并使其具有一定的抗干擾性，同時(shí)考慮到泵控缸響應(yīng)速度較為緩慢，則將速度前饋環(huán)節(jié)引入控制系統(tǒng)以提高其響應(yīng)速度。因此，設(shè)計(jì)了液壓缸速度前饋、位置／速度反饋雙閉環(huán)的復(fù)合控制策略。圖4 為閉式泵控集成液壓缸速度位置復(fù)合控制原理框圖，開(kāi)式泵控可采用相同控制策略，根據(jù)求解所得的驅(qū)動(dòng)空間，設(shè)計(jì)相應(yīng)位移速度轉(zhuǎn)換器，當(dāng)位移偏差通過(guò)位移速度轉(zhuǎn)換器，可生成該位置點(diǎn)的控制速度，結(jié)合反饋速度后對(duì)伺服電機(jī)進(jìn)行控制。此外，前饋速度可對(duì)速度累積偏差進(jìn)行速度信號(hào)補(bǔ)償。

圖4 速度位置復(fù)合控制原理框圖Fig.4 Principle block diagram of speed position composite control

3 仿真研究

3.1 模型搭建

為了更直觀地觀察挖掘機(jī)軌跡規(guī)劃和控制效果，在前面理論分析的基礎(chǔ)上，在多學(xué)科仿真軟件SimulationX中搭建挖掘機(jī)機(jī)電液聯(lián)合仿真模型。第一步，將Pro／E 環(huán)境中搭建的挖掘機(jī)三維模型通過(guò)相應(yīng)接口導(dǎo)入SimulationX 中與機(jī)械庫(kù)元件耦合，并依據(jù)D-H 方法建立相關(guān)坐標(biāo)系，同時(shí)將挖掘機(jī)三維模型調(diào)整到設(shè)定直線運(yùn)動(dòng)的初始位置；第二步，根據(jù)集成儲(chǔ)能泵控液壓挖掘機(jī)工作原理搭建液壓系統(tǒng)，其中集成液壓缸用柱塞缸和單出桿液壓缸替代；第三步，根據(jù)控制策略搭建控制系統(tǒng)；最后，聯(lián)接各子系統(tǒng)對(duì)聯(lián)合仿真模型進(jìn)行仿真研究及分析其結(jié)果。仿真模型如圖5 所示。

圖5 集成儲(chǔ)能泵控液壓挖掘機(jī)仿真模型Fig.5 Simulation model of pump-controlled hydraulic excavator with integrated energy-storage

3.2 仿真結(jié)果

期望目標(biāo)軌跡為鏟斗齒尖末端從點(diǎn)（5 470，0，-500）mm 到點(diǎn)（5 290，0，-500）mm 的直線運(yùn)動(dòng)，仿真過(guò)程中各液壓缸跟隨設(shè)定好的軌跡運(yùn)動(dòng)。仿真實(shí)驗(yàn)得到各液壓缸輸入與輸出位移的對(duì)比以及鏟斗齒尖末端設(shè)定位移與實(shí)際位移的比較，如圖6 所示。圖7、圖8 分別為運(yùn)動(dòng)仿真效果與誤差曲線，其中最大誤差為17 mm，滿(mǎn)足大多數(shù)作業(yè)場(chǎng)景的要求。

圖6 位移跟蹤曲線Fig.6 Displacement tracking curves：（a）boom hydraulic cylinder；（b）stick hydraulic cylinder；（c）bucket hydraulic cylinder；（d）bucket tip end

圖7 仿真效果Fig.7 Simulation effect

圖8 鏟斗齒尖末端跟蹤誤差Fig.8 Tracking error of bucket tip end

圖9—11 為動(dòng)臂液壓缸、斗桿液壓缸、鏟斗液壓缸壓力變化曲線，總體而言壓力變化較為平緩。通過(guò)觀察各液壓缸壓力變化曲線，可知利用正弦加減速規(guī)劃挖掘機(jī)運(yùn)動(dòng)軌跡可以減小各液壓缸的沖擊和波動(dòng)，使之平穩(wěn)運(yùn)行。

圖9 動(dòng)臂液壓缸各腔壓力變化曲線Fig.9 Pressure change curves of each chamber of boom hydraulic cylinder

圖10 斗桿液壓缸各腔壓力變化曲線Fig.10 Pressure change curves of each chamber of stick hydraulic cylinder

圖11 鏟斗液壓缸各腔壓力變化曲線Fig.11 Pressure change curves of each chamber of the bucket hydraulic cylinder

3.3 能效分析

直線整平工況中，斗桿裝置勢(shì)能回收效果不很顯著，與鏟斗裝置相同，其節(jié)能主要由消除節(jié)流損耗導(dǎo)致，而動(dòng)臂裝置除消除節(jié)流損耗外勢(shì)能回收效果顯著。因此，此處僅對(duì)動(dòng)臂液壓系統(tǒng)的能耗特性作簡(jiǎn)要說(shuō)明。

進(jìn)一步仿真實(shí)驗(yàn)得出，當(dāng)鏟斗從外到里運(yùn)動(dòng)時(shí)，蓄能器將動(dòng)臂下降時(shí)回收的重力勢(shì)能釋放出來(lái)，輔助柱塞腔舉升動(dòng)臂，液壓泵消耗能量為540 J，蓄能器釋放能量為4 597 J；當(dāng)鏟斗從里向外運(yùn)動(dòng)時(shí)，動(dòng)臂重力與勢(shì)能回收腔液壓力基本平衡，因此活塞腔在很小的壓力作用下就能驅(qū)動(dòng)液壓缸下降，因此液壓泵輸出功率較小，消耗能量?jī)H為258 J，而蓄能器回收能量為4 732 J，具體見(jiàn)圖12、13，其中鏟斗由里向外運(yùn)動(dòng)時(shí)采用五次多項(xiàng)式進(jìn)行關(guān)節(jié)空間軌跡規(guī)劃。由此可知，動(dòng)臂勢(shì)能的回收再利用，顯著降低了液壓泵能耗。

圖12 蓄能器回收與釋放能量Fig.12 The energy recovered and released by the accumulator

圖13 泵消耗能量Fig.13 The energy consumed by the pump

由上述分析可知，同樣執(zhí)行直線整平作業(yè)，集成儲(chǔ)能泵控液壓挖掘機(jī)整機(jī)能耗較傳統(tǒng)閥控液壓挖掘機(jī)大有改善。

4 結(jié)論

（1）利用速度位置復(fù)合控制策略，挖掘機(jī)各液壓缸可快速響應(yīng)，并嚴(yán)格跟蹤設(shè)定曲線運(yùn)動(dòng)，控制精度較高，使鏟斗齒尖末端的誤差穩(wěn)定在合理范圍內(nèi)。

（2）采用正弦加減速規(guī)劃挖掘機(jī)作業(yè)軌跡，能減小運(yùn)動(dòng)過(guò)程中各液壓缸中壓力油的沖擊和波動(dòng)，從而使液壓缸和鏟斗齒尖末端運(yùn)行過(guò)程較為平緩。

（3）與閥控系統(tǒng)相比，泵控系統(tǒng)消除了節(jié)流損耗，同時(shí)集成液壓缸與蓄能器組合實(shí)現(xiàn)了能量的回收利用，因此利用集成儲(chǔ)能泵控液壓挖掘機(jī)研究軌跡控制，可實(shí)現(xiàn)挖掘機(jī)智能化與節(jié)能化的統(tǒng)一。