晁智強， 李 勛， 李華瑩， 寧初明， 譚永營

(1. 陸軍裝甲兵學院車輛工程系， 北京 100072； 2. 軍事科學院系統(tǒng)工程研究院， 北京 100039)

近年來，隨著對步行機器人液壓系統(tǒng)研究的深入，步行機器人腿部液壓驅(qū)動單元的研究難點也逐漸凸顯出來。步行機器人行進過程中腿部運動可分為快速擺動和觸地支撐2個階段[1]：在快速擺動階段，需要腿部液壓驅(qū)動單元大范圍快速運動，即液壓系統(tǒng)要實現(xiàn)大流量的油液供給；在觸地支撐階段，需要系統(tǒng)提供足夠的壓力，以保證支撐的穩(wěn)定性以及小范圍運動，即液壓系統(tǒng)要實現(xiàn)高壓小流量的油液供給。因此，腿部運動的2種狀態(tài)決定了步行機器人液壓系統(tǒng)必須具有大范圍壓力和流量變化的特性[2]。步行機器人所采用的液壓系統(tǒng)主要通過控制換向閥的開度來調(diào)節(jié)系統(tǒng)流量。但是2種運動狀態(tài)對換向閥的控制要求存在極大差異，因此研究步行機器人液壓驅(qū)動單元的控制特性具有重要意義。

為改善腿部液壓驅(qū)動單元的控制性能，筆者在獲取步行機器人對角步態(tài)液壓驅(qū)動單元速度、力控制數(shù)據(jù)的基礎上，采用分階段雙PID控制方法對液壓驅(qū)動單元快速擺動階段和觸地支撐階段分別進行控制，并在AMESim平臺上對步行機器人腿部液壓驅(qū)動單元在外界力干擾下的控制性能進行了分析。

1 腿部液壓驅(qū)動單元建模

筆者所研究的機器人是一種液壓四足機器人，該機器人每條腿有3個主動自由度，且每個腿部關節(jié)都由一個液壓驅(qū)動單元控制，因此該機器人液壓系統(tǒng)包含12個相同的液壓驅(qū)動單元。由于每個液壓驅(qū)動單元結(jié)構和負載規(guī)律相似，因此選取右前腿髖前后擺關節(jié)作為研究對象。

1.1 機器人單腿結(jié)構模型

步行機器人腿部液壓驅(qū)動單元與腿部機械結(jié)構的相互配合、協(xié)調(diào)一致是實現(xiàn)機器人腿部運動的基礎，因此必須在建立步行機器人腿部結(jié)構的基礎上研究其腿部液壓驅(qū)動單元的控制特性，使其輸出速度、力與髖前后擺關節(jié)負載需求相互匹配，從而完成預設的腿部運動[3]。

首先利用SolidWorks建立了步行機器人單腿三維結(jié)構模型，如圖1所示。可以看出：其腿部包含髖側(cè)擺關節(jié)、髖前后擺關節(jié)和膝關節(jié)3個主動自由度。圖中:紅圈標示的是髖前后擺關節(jié)，該關節(jié)相較于髖側(cè)擺關節(jié)和膝關節(jié)具有擺動角度大、受力變化大等特點，因此選用髖前后擺關節(jié)進行后續(xù)研究。

1.2 腿部液壓驅(qū)動單元數(shù)學模型

步行機器人腿部液壓驅(qū)動單元主要包含伺服閥、液壓缸、速度傳感器、力傳感器等。該液壓驅(qū)動單元具有頻帶寬、響應快、結(jié)構簡單等特點[4]，能夠很好地滿足機器人腿部關節(jié)運動需求。將液壓驅(qū)動單元的動力機構進行簡化分解，可將其分解成為簡化閥控缸模型，如圖2所示。

利用SolidWorks建立步行機器人腿部液壓驅(qū)動單元的三維模型，如圖3所示。同時，該液壓驅(qū)動單元采用速度和力傳感器分別測量液壓缸出桿速度以及腿部所受地面的反作用力，并將數(shù)據(jù)反饋給控制單元以使得系統(tǒng)運動更加精確。

采用的三位四通電磁換向閥可簡化為理想情況下的零開口四通滑閥，則其線性化流量方程為

ΔQL=Kq·Δxv-KG·ΔpL，

(1)

式中：ΔQL為負載流量；Kq為滑閥在穩(wěn)態(tài)工作點附近的流量增益；Δxv為閥芯在穩(wěn)態(tài)工作點附近的位移變化量；KG為滑閥在穩(wěn)態(tài)工作點附近的流量——壓力系數(shù)；ΔpL為負載壓降變化量。

步行機器人運動過程中，可認為本文采用的三位四通換向閥是在穩(wěn)態(tài)工作點附近做微量運動，則式(1)可進一步改寫為

QL=Kq·xv-KG·pL。

(2)

由于液壓缸受油液壓縮性影響，活塞處于中間位置時固有頻率最低，阻尼最小，穩(wěn)定性最差。因此，只要活塞處于中間位置時能滿足整個運動過程的需求，則可保證液壓驅(qū)動單元穩(wěn)定工作[5]。液壓缸活塞處于中間位置時的流量連續(xù)性方程可表示為

近年來，隨著農(nóng)村城鎮(zhèn)化和整島城市化進程加快，土地流轉(zhuǎn)明顯遞增，規(guī)模經(jīng)營快速推進，以種養(yǎng)大戶、家庭農(nóng)場、農(nóng)民合作社、農(nóng)業(yè)龍頭企業(yè)為代表的各類新型農(nóng)業(yè)經(jīng)營主體迅猛發(fā)展，為推進現(xiàn)代農(nóng)業(yè)發(fā)展和農(nóng)業(yè)適度規(guī)模經(jīng)營發(fā)揮了重要作用。通過調(diào)查，全市的土地流轉(zhuǎn)和農(nóng)業(yè)規(guī)模經(jīng)營主要呈現(xiàn)以下特點：

(3)

式中：A為活塞有效面積；y為活塞位移；CtG為液壓缸總泄露系數(shù)；Vt為液壓缸油腔總?cè)莘e；βe為有效體積彈性模數(shù)。

考慮到步行機器人腿部液壓驅(qū)動單元結(jié)構緊湊、管路較短，且運動速度較慢，故忽略油液管路損失、庫倫摩擦等因素對系統(tǒng)的影響，可得液壓缸和負載的力平衡方程為

(4)

式中：m為活塞及負載總質(zhì)量；Be為活塞黏性阻尼系數(shù)；K為負載彈性剛度；F為液壓缸上的作用外力。

根據(jù)式(2)-(4)可得到閥控缸的框圖，如圖4所示。

根據(jù)圖4，利用梅森公式可得到系統(tǒng)傳遞函數(shù)為

A2+K(KG+CtG+Vts/4βe)/(A2s)]-1。

(5)

1.3 腿部液壓驅(qū)動單元仿真模型

AMESim作為經(jīng)典液壓仿真軟件，具有操作簡單、數(shù)據(jù)準確等優(yōu)點，且與MATLAB和Adams有進行交互的專用接口，方便進行聯(lián)合仿真[6]。在腿部液壓驅(qū)動單元仿真之前，已通過相關分析研究獲取了步行機器人在平坦地形加速、勻速以及減速前進時的速度和作用力數(shù)據(jù)[7]，因此只需搭建相應的液壓系統(tǒng)模型，并構建相應的控制單元即可實現(xiàn)液壓驅(qū)動單元的仿真。

圖5為步行機器人腿部液壓驅(qū)動單元仿真模型，其主要包含液壓驅(qū)動單元以及泵、溢流閥等元件，液壓驅(qū)動單元主要設計參數(shù)如表1所示。

參數(shù)數(shù)值介質(zhì)10#航空液壓油使用環(huán)境/℃-20～40額定工作壓力/MPa15伺服缸內(nèi)徑/mm28杠桿直徑/mm16液壓缸行程/mm100±0.5液壓缸啟動力/N100額定壓力下輸出力/N≥7 0005 kN負載下的速度/(m·s-1)≥0.245液壓驅(qū)動單元質(zhì)量/kg≤1.5液壓驅(qū)動單元帶寬/Hz≥30

2 腿部液壓驅(qū)動單元控制特性仿真分析

步行機器人行進過程主要分為快速擺腿和觸地支撐2個階段，2個階段對液壓系統(tǒng)的需求存在較大差異。快速擺動階段對于腿部作用力要求不高，但需要液壓系統(tǒng)供給足夠的油液，以保證關節(jié)能夠快速運動；觸地支撐階段需要機器人腿部關節(jié)輸出足夠的作用力以保證機器人機體穩(wěn)定，同時需要應對腿部與地面接觸產(chǎn)生的沖擊[8]。采用單PID控制難以協(xié)調(diào)2種運動狀態(tài)下對液壓驅(qū)動單元的控制要求，速度跟隨誤差較大，無法滿足控制精度要求，因此在仿真過程中采用分階段雙PID進行控制，分別滿足2個階段的控制需求。

步行機器人的行進過程，通常情況可以分為加速、勻速和減速3個階段。加速階段是機器人行進的第一階段，該階段機體行進速度逐漸加快，腿部關節(jié)運動幅度、頻率逐漸增大，對控制系統(tǒng)的控制性能要求較高[9-11]，故選取步行機器人加速行進過程進行仿真分析。

2.1 腿部液壓驅(qū)動單元負載規(guī)律分析

步行機器人腿部液壓驅(qū)動單元負載規(guī)律即步行機器人在行進過程中各關節(jié)液壓驅(qū)動單元所受外力的變化規(guī)律。步行機器人右前腿髖前后擺關節(jié)液壓驅(qū)動單元的負載規(guī)律如圖6所示。

圖6中：a階段為觸地支撐階段，該階段液壓驅(qū)動單元的負載力變化范圍大，而輸入信號始終在0附近波動；b階段為快速擺動階段，該階段液壓驅(qū)動單元負載力變化范圍較小，而輸入信號有較大的起伏。綜上，在觸地支撐階段，液壓驅(qū)動單元速度變化較小，但受力較大；而在快速擺動階段，液壓驅(qū)動單元速度變化較大，但受力較小。由此也反映了步行機器人液壓系統(tǒng)所具有的大范圍壓力和流量變化的特性[1]。圖6中a、b階段共同組成一個運動周期。輸入信號幅值在不同周期之間隨時間逐漸增大，而頻率變化相對較??；相應的液壓驅(qū)動單元的負載力也在不斷提高。這是因為：隨著輸入信號幅值的逐漸增大，液壓缸出桿速度逐漸提高，從而使步行機器人運動速度提高，與地面產(chǎn)生的沖擊逐漸增大。

2.2 分階段雙PID控制器設計

仿真過程中，液壓驅(qū)動單元采用速度控制，即將腿部關節(jié)液壓缸速度數(shù)據(jù)作為控制系統(tǒng)輸入信號，經(jīng)控制系統(tǒng)處理輸入到伺服閥中以控制伺服閥閥口開閉，進而控制液壓缸運動。同時，速度傳感器測量液壓缸活塞速度并將信號實時反饋給PID控制單元，從而實現(xiàn)液壓缸速度的精確控制。

為同時滿足腿部液壓驅(qū)動單元2個階段的控制精度要求，筆者采用了分階段雙PID控制方法。通過邏輯設定，當液壓驅(qū)動單元中液壓缸活塞的速度>0，即腿部處于快速擺動階段時，系統(tǒng)通過控制器PID1(圖5中元件b)進行控制，而關節(jié)速度<0(相對于活塞初始位置而言)，即腿部處于觸地支撐階段時，系統(tǒng)自動切換到控制器PID2(圖5中元件c)。

2.3 仿真分析

使用液壓缸出桿速度作為控制信號。將相關研究所得的加速階段速度控制數(shù)據(jù)經(jīng)處理后導入控制單元，可以實現(xiàn)對腿部液壓驅(qū)動單元的控制。步行機器人行進過程中腿部與地面會產(chǎn)生沖擊，反映到腿部關節(jié)將變?yōu)橐簤焊棕撦d力的變化。通過向腿部液壓驅(qū)動單元模型中的液壓缸進行模擬加載，可以模擬出機器人行進過程中腿部液壓驅(qū)動單元負載力的變化。

液壓缸有桿腔和無桿腔的油液壓力、流量變化曲線如圖7、8所示。從圖7可以看出：步行機器人行進過程中液壓缸中油液壓力最高約為13 MPa，而最低壓力不到4 MPa。從圖8可以看出：在快速擺動階段，液壓驅(qū)動單元最大流量可達到8 L/min，但在觸地支撐階段卻不到1 L/min。圖7、8說明：采用分階段雙PID控制方法可以實現(xiàn)液壓系統(tǒng)的大范圍壓力、流量變化，滿足機器人腿部液壓驅(qū)動單元的工作需求。

腿部液壓驅(qū)動單元分階段PID控制下液壓驅(qū)動單元輸入、輸出對應關系如圖9所示?？梢钥闯觯涸跈C器人腿部觸地(活塞速度為0)瞬間，輸出速度容易產(chǎn)生抖動，這是因為在腿部觸地瞬間，足端與地面接觸產(chǎn)生了較大沖擊，造成液壓缸速度抖動的現(xiàn)象。

單PID控制下液壓驅(qū)動單元輸入、輸出對應關系如圖10所示。圖中，單PID控制下液壓驅(qū)動單元的速度誤差主要集中于腿部觸地支撐階段，有2個主要特征：一是活塞速度接近于0時速度不穩(wěn)定，液壓缸產(chǎn)生振動；二是支撐階段無法達到速度峰值。

分階段PID與單PID控制下速度跟隨誤差對比曲線如圖11所示。根據(jù)圖中分階段PID控制下的速度跟隨誤差曲線可知：在機器人行進過程中，該關節(jié)速度誤差始終<0.01 m/s，因此能夠滿足機器人控制精度要求。而根據(jù)單PID控制下的速度跟隨誤差曲線可知：速度跟隨誤差發(fā)生突變，會產(chǎn)生較大峰值，這種現(xiàn)象將會導致液壓驅(qū)動單元中的速度和加速度沖擊，不符合機器人控制精度要求。圖11所示的2種誤差對比曲線說明了采用分階段PID控制效果優(yōu)于單PID控制效果。

步行機器人液壓驅(qū)動單元液壓缸位移曲線如圖12所示?？梢钥闯觯簩嶋H位移曲線和理想位移曲線總體上重合性較好，且曲線較為平滑；曲線也存在一定差異，但差異較小且主要存在于曲線極值處，這主要是因為速度曲線在零點附近的抖動造成的。因此，該液壓驅(qū)動單元的控制特性能夠滿足步行機器人的行進需求。

3 結(jié)論

筆者以步行機器人右前腿髖前后擺關節(jié)中的液壓驅(qū)動單元為研究對象，建立了步行機器人腿部液壓驅(qū)動單元的三維模型和數(shù)學模型，采用分階段雙PID控制的方法分別控制快速擺動階段和觸地支撐階段，利用AMESim對該液壓驅(qū)動單元進行了仿真。結(jié)果表明：通過合理調(diào)節(jié)系統(tǒng)中的各個參數(shù)，分階段雙PID控制方法能夠有效提高液壓驅(qū)動單元的控制精度，使系統(tǒng)的速度跟隨誤差始終保持在允許范圍內(nèi)，為提高步行機器人行進中的穩(wěn)定性打下了基礎。