李明陽,何予鵬,李冠峰,馬帥超,李華樸
(1.河南農(nóng)業(yè)大學(xué) 機電工程學(xué)院,鄭州 450002;2.鄭州東風(fēng)日產(chǎn)汽車有限公司,鄭州 450000)
隨著科學(xué)技術(shù)的發(fā)展及農(nóng)業(yè)機械化的普及,特別是農(nóng)業(yè)中耕管理車輛在相應(yīng)場合的使用,降低了勞作強度;但是,大部分中耕管理車輛比較笨重,采用前輪機械轉(zhuǎn)向,操作不便。同時,大多農(nóng)田的農(nóng)藝都不與中耕管理車輛相匹配,導(dǎo)致用于轉(zhuǎn)向的空間非常狹窄,而現(xiàn)有的農(nóng)用車輛的轉(zhuǎn)彎半徑又太大,實行轉(zhuǎn)彎掉頭等動作時會碾壓作物造成損失。隨著四輪轉(zhuǎn)向技術(shù)在汽車上的成功應(yīng)用,汽車轉(zhuǎn)向半徑問題得到改善,從而為農(nóng)業(yè)裝備的發(fā)展提供了新思路。
采用四輪轉(zhuǎn)向技術(shù)的農(nóng)業(yè)中耕機械在國外很早就開始了研究,包括美國著名的凱斯公司、丹麥的哈迪公司及日本的久保田。丹麥哈迪公司開發(fā)的Alpha4100型高地隙自走式噴霧機,配備了58.8kW的柴油機和四輪負載傳感液壓轉(zhuǎn)向系統(tǒng),大大減小了轉(zhuǎn)彎半徑,使噴霧機更容易轉(zhuǎn)向或者掉頭。近年來,我國也開始了這方面的研究。陳文良[1]、何卿[2]已經(jīng)改善了農(nóng)業(yè)拖拉機的轉(zhuǎn)向系統(tǒng),均采用基于液壓動力的轉(zhuǎn)向系統(tǒng)。中國農(nóng)業(yè)大學(xué)張京等設(shè)計了四輪獨立轉(zhuǎn)向的農(nóng)用輪式機器人,并對其轉(zhuǎn)向控制進行了一定的理論闡述和試驗驗證,為四輪獨立轉(zhuǎn)向提供了依據(jù)[3]。
借鑒已有的研究成果,本文以電液比例閥技術(shù)為基礎(chǔ),研究實現(xiàn)農(nóng)業(yè)中耕車輛前輪轉(zhuǎn)向、四輪轉(zhuǎn)向和斜行行走幾種模式的設(shè)計。同時,介紹了電液比例閥轉(zhuǎn)向系統(tǒng)的工作原理、液壓轉(zhuǎn)向系統(tǒng)部件選擇和電液比例的數(shù)學(xué)模型;通過AMESim進行仿真,測試系統(tǒng)的動態(tài)特性;最后,加入PID控制算法來優(yōu)化系統(tǒng)的控制精度和響應(yīng)特性。
阿克曼轉(zhuǎn)向定理在車輛轉(zhuǎn)向中應(yīng)用廣泛,各種轉(zhuǎn)向方式應(yīng)盡可能遵守這一原則[4]。四輪轉(zhuǎn)向形式可分為高速轉(zhuǎn)向和低速低速兩種轉(zhuǎn)向模式,考慮中耕管理車的最高時速為18km/h,而田間作業(yè)時速度較低,所以選擇低速轉(zhuǎn)向模式。
本文設(shè)計的車輛在正常行駛工況下采用的是前輪轉(zhuǎn)向模式,這是最傳統(tǒng)的汽車使用方式。如果在小空間內(nèi)為了減小車輛的轉(zhuǎn)彎半徑,可以根據(jù)實際情況改用四輪轉(zhuǎn)向或者其他轉(zhuǎn)向方式,即可改善車輛對工作環(huán)境的適應(yīng)性。
常用的前輪轉(zhuǎn)向模式如圖1所示。與傳統(tǒng)汽車轉(zhuǎn)向模式一樣,各個輪子的轉(zhuǎn)向角公式為
(1)
四輪轉(zhuǎn)向模式如圖2所示。為了實現(xiàn)車輛的協(xié)調(diào)運動,四角關(guān)系符合阿克曼低速轉(zhuǎn)角關(guān)系公式(2)。由式(2)可看出:轉(zhuǎn)彎時前后輪轉(zhuǎn)向相反,可以很大程度上減小轉(zhuǎn)彎時的半徑[5]。
(2)
圖1 前輪轉(zhuǎn)向模式各輪位置
圖2 低速下的四輪轉(zhuǎn)向各輪位置
斜行行走模式如圖3所示。其運動方向與車身有一定的夾角,4個車輪的轉(zhuǎn)角相同,其角度關(guān)系為
δA=δB=δC=δD
(3)
圖3 斜行行走各輪位置
轉(zhuǎn)向系統(tǒng)分為轉(zhuǎn)向機構(gòu)和轉(zhuǎn)向液壓系統(tǒng)兩個部分。對于轉(zhuǎn)向機構(gòu),傳統(tǒng)的梯形機構(gòu)由于車輪之間存在相互制約,不能用于實現(xiàn)上述的轉(zhuǎn)向功能。為了實現(xiàn)車輪的獨立運動,對轉(zhuǎn)向機構(gòu)進行了重新設(shè)計,利用四桿機構(gòu)來實現(xiàn)轉(zhuǎn)向。整個轉(zhuǎn)向系統(tǒng)包括轉(zhuǎn)向機構(gòu)和電液比例控制系統(tǒng),機械結(jié)構(gòu)主要包括四桿機構(gòu)及轉(zhuǎn)向系統(tǒng)布局,如圖4所示。電液比例液壓系統(tǒng)包括液壓泵、比例方向閥、位移傳感器和轉(zhuǎn)向液壓缸等。
圖4 整體轉(zhuǎn)向系統(tǒng)圖
轉(zhuǎn)向液壓系統(tǒng)如圖5所示。轉(zhuǎn)向液壓泵提供動力驅(qū)動轉(zhuǎn)向液壓缸運動,而液壓缸驅(qū)動四桿機構(gòu)驅(qū)動車輪轉(zhuǎn)向。
圖5 轉(zhuǎn)向液壓系統(tǒng)圖
控制核心采用PLC(可編程序控制器)和單輪控制原理,如圖6所示。當(dāng)車輛需要轉(zhuǎn)彎時,駕駛員轉(zhuǎn)動與編碼器相連的方向盤;編碼器輸入的信號經(jīng)過PLC計算,然后通過D/A轉(zhuǎn)換輸出信號到比例方向閥,控制比例閥閥門的開口大小和方向來控制轉(zhuǎn)向液壓缸的伸縮情況;通過對A/D轉(zhuǎn)換,對油缸位置信號進行實時反饋,從而對油缸伸長量的控制來實現(xiàn)對轉(zhuǎn)向角的精確控制[6]。
圖6 控制流程圖
執(zhí)行部分是液壓缸,轉(zhuǎn)向液壓缸采用單柱塞液壓缸,兩種工作模式如圖7、圖8所示。
圖7 工進模式
圖8 回退模式
當(dāng)雙方的力平衡時,可以得到公式為
(4)
(5)
式中F—外部載荷(N);
P1—進油室壓力(Pa);
P2—回油室壓力(Pa);
D—液壓缸的直徑(mm);
d—活塞桿的直徑(mm);
ηm—液壓缸的機械效率。
比較這兩個公式,可以看出公式(5)中的F小于公式(4)中的F,所以用公式(5)來計算D。通過變形公式(5),可以得到液壓缸直徑的公式(6),即
(6)
根據(jù)實際情況估算,在轉(zhuǎn)向過程中車輪的最大阻力是6 000N,根據(jù)速度比的需求,一般采用d= (0.5~0.7)D[7]。根據(jù)工作條件,車輛系統(tǒng)壓力P1初定為16MPa,背壓值定為1.5MPa,ηm值為0.9,帶入式(7)中,則
(7)
參照GB/T t2348-1993,選擇液壓缸直徑0.04m,液壓桿直徑0.025m,總長度為0.45m。
根據(jù)電液比例控制系統(tǒng)常用的閉環(huán)系統(tǒng),結(jié)合車輛轉(zhuǎn)向的實際情況,得到控制系統(tǒng)框圖如圖9所示。
圖9 控制系統(tǒng)框圖Fig.9 Block diagram of control system
根據(jù)控制系統(tǒng)框圖各部分,依次建立各部件的數(shù)學(xué)模型及比例放大器。由于其轉(zhuǎn)折頻率比系統(tǒng)的頻寬高得多,故可近似為比例環(huán)節(jié)。位置傳感器的頻寬也比系統(tǒng)頻寬高得多,亦可近似為比例環(huán)節(jié)。根據(jù)相關(guān)文獻,比例方向閥被認為是一個二階系統(tǒng),其傳遞函數(shù)為
(8)
式中Kq—比例方向閥的流量增益(m3/s·A);
ων—比例方向閥的相位頻寬(rad/s);
δν—比例方向閥的阻尼比,其值變化范圍是0.5~0.7。
液壓缸是執(zhí)行元件,其數(shù)學(xué)模型視為一個積分與二階環(huán)節(jié)的組合。傳遞函數(shù)為
(9)
式中Ah—液壓缸的有效作用面積(m2);
δh—表示液壓缸負載質(zhì)量系統(tǒng)的阻尼比,其取值范圍為0.1~0.2;
ωh—液壓缸負載質(zhì)量的固有頻率(rad/s)[8-9]。
根據(jù)上述情況,得到采用比例方向閥的位置控制系統(tǒng)的數(shù)學(xué)模型,如圖10所示。
圖10 控制系統(tǒng)數(shù)學(xué)模型
對于液壓控制系統(tǒng),Amesim有著建模簡單且系統(tǒng)化的優(yōu)點。由于它采用基于鍵合圖的圖形化建模方法,直觀易操作,從而更加專注系統(tǒng)本身的優(yōu)化過程。對于本文電液比例液壓轉(zhuǎn)向系統(tǒng),在Amesim的建模如圖11所示[10]。
圖11 電液比例控制系統(tǒng)原理圖
為了研究方向盤對控制信號的響應(yīng),同時對控制系統(tǒng)進行優(yōu)化,將系統(tǒng)分析成兩種狀態(tài)—不增加PID算法和加入PID算法,進行對比得出結(jié)論。系統(tǒng)仿真時,為了更為直觀地觀察系統(tǒng)穩(wěn)定狀態(tài),輸入信號設(shè)置為階躍信號,其目標(biāo)值是讓液壓缸伸長至0.2m,仿真時間設(shè)置為5s,觀察間隔設(shè)置為0.01s,從而可以從曲線中看出振蕩情況。同時,經(jīng)過多次實驗選取PID參數(shù):KP=5,KI=0.02,KD=0。
圖12為液壓缸活塞的位移曲線圖,反映出對于階躍信號的響應(yīng)特性。圖13為活塞桿的速度曲線圖,可以反映出活塞桿工作中速度的變化。圖12、圖13中,實線是不帶PID控制器的曲線,可以看出:系統(tǒng)穩(wěn)定無超調(diào),但上升緩慢,活塞桿速度較慢,導(dǎo)致到達目標(biāo)位置的時間過長;虛線表示的帶有PID控制器的響應(yīng)曲線,不難看出同樣無超調(diào)但帶有PID控制器的系統(tǒng)響應(yīng)更快,從原來響應(yīng)時間3s下降至1.5s,同時其曲線更為光滑。對于活塞的速度曲線,相比不帶PID控制器的曲線,響應(yīng)更為迅速,速度值也更大,使液壓缸更好、更快地推到目標(biāo)位置。對于精度,模擬方向盤的階躍信號輸入為0.2m,在沒帶有PID控制器的穩(wěn)定狀態(tài)于目標(biāo)值的誤差小于0.015m;加入PID控制器的穩(wěn)定狀態(tài)與目標(biāo)值的誤差小于0.003。仿真結(jié)果表明:所設(shè)計轉(zhuǎn)向控制系統(tǒng)基本能滿足農(nóng)用車的轉(zhuǎn)向需求,且控制中加有PID控制器的系統(tǒng)精度更高,速度更快。
圖12 活塞桿位移曲線圖Fig.12 The piston rod displacement curve
圖13 活塞桿的速度曲線圖Fig.13 The velocity curve of the piston rod
設(shè)計了用于四輪轉(zhuǎn)向中耕管理車輛的轉(zhuǎn)向機構(gòu)和電液比例控制系統(tǒng),使中耕管理車的轉(zhuǎn)向系統(tǒng)更加靈活及自動化。通過對液壓元件的選擇和控制系統(tǒng)數(shù)學(xué)模型的建立,詳細闡述了電液比例控制的原理。將PID控制算法加入到控制系統(tǒng)中,使系統(tǒng)精度和響應(yīng)特性得到了優(yōu)化。系統(tǒng)的轉(zhuǎn)向性能通過AMESim軟件驗證,結(jié)果表明:該系統(tǒng)具有良好的可靠性和動態(tài)響應(yīng)特性,能較好地滿足農(nóng)業(yè)中耕管理車輛轉(zhuǎn)向的要求。