王瑞霄 朱雅光 馬云祥 黃純收

（長安大學 工程機械學院，西安 710064）

移動機器人是最早研究、應用最廣泛的一類特種機器人[1]。它們所采用的運動方式主要有輪式、履帶式、足式、飛行式等，其中，相比輪式和履帶式的移動方式，足式移動機器人可通過一系列與地面相接觸的離散點作業(yè)，具有較好的越障性能[2]。坡度障礙是移動機器人常見的障礙之一，具有良好的爬坡性能對于移動機器人有重要意義。其中，爬坡速度、爬坡穩(wěn)定性及最大爬坡角度是衡量爬坡性能的重要指標。步態(tài)是指機器人行走時各條腿的相位關系[3]。六足式機器人具有多種步態(tài)，面對不同坡度，機器人采用何種步態(tài)能發(fā)揮最佳爬坡性能，是本研究的主要內(nèi)容。

本研究涉及的腿型為半圓弧腿。其最初在移動機器人RHex[4]上采用，近年來，學者們對弧腿機器人的研究工作主要有弧腿結構設計[5]、運動特性分析[6-7]、弧腿機器人應用[8-9]等。

1 爬坡步態(tài)分析

1.1 機器人結構

六足式弧腿機器人由中央控制器、驅(qū)動模塊、弧腿機構、供電模塊、外殼體組成，如圖1所示。其每條腿只有一個自由度，降低了控制的復雜度。

圖1 機器人結構

1.2 爬坡步態(tài)

六足機器人在正常工作時，其步態(tài)通常是規(guī)則且周期性的，典型的有三角步態(tài)、四足步態(tài)和波動步態(tài)。三角步態(tài)，即由一側(cè)前足、后足與另一側(cè)中足構成的兩組足交替擺動支撐實現(xiàn)機器人的移動；四足步態(tài)，機器人在任一時刻的狀態(tài)均為四足支撐的同時兩側(cè)各有一足向前擺動同步步態(tài)；波形步態(tài)在每一時刻均有五足支撐，六足按照一定的順序依次擺動[10]，如圖2所示。另外，六足任一刻均同步動作，稱為同步步態(tài)，由于該步態(tài)能承受較大載荷，故對坡度越障極為有益。

圖2 三種步態(tài)示意圖

為使機器人爬坡時機身平面時刻與坡面平行，以保證工作時的基本穩(wěn)定，三角步態(tài)和同步步態(tài)將作為兩種爬坡步態(tài)被討論。

1.3 爬坡步態(tài)參數(shù)

六足機器人在工作時，根據(jù)足部狀態(tài)的不同，可分為接地相[11]和飛行相[12]。接地相是機器人足部接觸地面時的狀態(tài)，飛行相是機器人足部離開地面時的狀態(tài)。用tgi表示第i號足處于接地相的時間，T為足完成一個循環(huán)運動的時間，T’表示時間T內(nèi)機身被支撐的時間，即機身運動的時間，則占空系數(shù)β可以用接地相的時間tgi與一個循環(huán)周期T的比值來表示，即：

βi表表示第i號足的占空系數(shù)。

2 爬坡速度及穩(wěn)定性分析

2.1 爬坡速度對比

將六足機器人兩側(cè)的足依次標號為1-6[13]，如圖3所示。

圖3 腿部編號

當機器人處于三角步態(tài)，且第1、3、5足處于接地相時，第2、4、6足處于飛行相，因此有：

當機器人處于同步步態(tài)，其六條足同時處于接地相或飛行相，故有：

則對于三角步態(tài)：

對于同步步態(tài)：

因此，當驅(qū)動弧腿的電機轉(zhuǎn)速相同時，在同一個循環(huán)周期T內(nèi)，有：其中，v三是三角步態(tài)下機身的速度，v同是同步步態(tài)下機身的速度。

可以看出，當機器人分別以以上兩種步態(tài)爬坡時，在電機轉(zhuǎn)速相同的條件下，以三角步態(tài)作業(yè)時速度更快。

2.2 穩(wěn)定性分析

靜態(tài)穩(wěn)定裕度法（static stability Margin，ssM）是由Mc Ghee＆Iswandhi 于1976年在重心投影法的基礎上提出的新的機器人靜態(tài)穩(wěn)定性判據(jù)[14]。其指在給定的支撐區(qū)域內(nèi)，機器人重心投影到支撐區(qū)域水平投影各個邊界距離的最小值。其數(shù)學表達式為：

式中，(sssM)min=lMN＞0為靜態(tài)穩(wěn)定裕度；lMO為支撐腿數(shù)，lMG1為重心投影至支撐多邊形第i條邊的距離。當sssM＞0時，機器人處于穩(wěn)定狀態(tài)；反之，則是不穩(wěn)定的。

六足機器人以三角步態(tài)爬坡時，其兩組足交替擺動，顯然，在足狀態(tài)發(fā)生切換時，其穩(wěn)定性最差，且穩(wěn)定裕度最小。圖4中，M為機器人重心在水平區(qū)域的投影，G1、G2、G3分別是三個處于接地相的足的接地點在水平區(qū)域的投影,a為機身寬度，b為機身長度，θ表示坡面角度，可以看出：

lMN可通過lMG1和φ求得，而在投影區(qū)域確定的條件下，若能得到lMO，則可通過三角形MOG1求得lMG1和φ，，進而得到 lMN，即 (sssM)min。

h為此時重心的垂直高度，其與弧腿直徑有關。

可以看出其推導較繁瑣，故本研究將從幾何關系上得出結論。

六足機器人以同步步態(tài)爬坡時，在足狀態(tài)發(fā)生切換時，其穩(wěn)定性最差，且穩(wěn)定裕度最小。如圖5所示，此時機器人的六個足全部接地，其在水平區(qū)域投影分別是G1、G2、而在圖4中不難推出，總大于l。

圖4 三角步態(tài)穩(wěn)定裕度分析圖

圖5 同步步態(tài)穩(wěn)定裕度分析圖

因此，得出結論，對于同一結構參數(shù)的六足式弧腿機器人，在爬坡作業(yè)時無論其采用三角步態(tài)或是同步步態(tài)，均處于穩(wěn)定狀態(tài)，但采用同步步態(tài)時，其最小穩(wěn)定裕度相比于三角步態(tài)下更大，故穩(wěn)定性更好。

3 不同步態(tài)下的爬坡角度推導

先對機器人弧腿進行受力分析，如圖6所示。機器人爬坡作業(yè)過程中，其腿部受電機驅(qū)動力矩T，弧腿自重F’，由機身自重在弧腿髖部產(chǎn)生力F，F(xiàn)1、F2分別是坡面對弧腿的支持力和摩擦力。假設弧腿自重不計。

圖6 腿部動力學模型

根據(jù)力矩平衡原理，可得：

假設電機所能提供的最大驅(qū)動力矩為Ts，由Tmax≤Ts，得：

即為當前機器人的最大爬坡角。

從（17）可以看出，當Ts、d一定時，θmax僅取決于F的大小。

設機器人機身重為P，由圖3可知，當機器人采用三角步態(tài)時，可得

代入（17）中，可得：

當機器人采用同步步態(tài)時，可得：

顯然：

另外，只有當坡面提供足夠的摩擦力時，式（23）才可成立，即：其中，f是摩擦系數(shù)。

因此，得出結論，對于結構參數(shù)、腿部材料相同的六足式弧腿機器人，在爬坡作業(yè)時，相比三角步態(tài)，若采用同步步態(tài)，其最大爬坡角度更大。

4 軟件仿真及實驗研究

本文利用ADMAs對虛擬樣機進行仿真，以驗證上述對六足式機器人爬坡作業(yè)的性能分析。表1給出了樣機的結構參數(shù)。

表1 樣機結構參數(shù)

如圖7，設定弧腿轉(zhuǎn)速，πrad/s?；⊥扰c坡面間的靜摩擦系數(shù)為0.4，坡面角度20°，可看出在經(jīng)歷相同的時間后，相比于同步步態(tài)，采用三角步態(tài)的機器人行進距離更大，由于坡面角度不大，故作業(yè)過程中兩種步態(tài)都表現(xiàn)出良好的穩(wěn)定性。

圖7 軟件仿真

在軟件仿真基礎上，裝配出了實際的物理樣機。為驗證不同坡面角度下六足機器人的可爬性、爬坡速度及穩(wěn)定性，以坡面角度為實驗變量、爬行距離為常量，分別在5°、10°、15°、20°、30°坡面上進行實驗，得到成功系數(shù)、爬行速度。實驗結果如表2所示，成功系數(shù)為0.5表示機器人可以在當前坡面角度下啟動，但由于行進穩(wěn)定性較差而失穩(wěn)。

表2 實驗結果

通過對實驗結果的分析，可以看出當爬坡角度較小時（5°、10°），無論采用三角步態(tài)還是同步步態(tài)，均能成功完成爬坡作業(yè)，但三角步態(tài)下的爬坡速度更快，對比數(shù)據(jù)可發(fā)現(xiàn)近似成兩倍的關系，這驗證了對機器人爬坡速度的理論分析；當爬坡角度較大時（15°），以三角步態(tài)行進時由于穩(wěn)定性較差，發(fā)生失穩(wěn)，導致爬坡失?。划斉榔陆嵌葹?0°時，采用三角步態(tài)會導致力矩超過額定轉(zhuǎn)矩，視為爬坡失??；當爬坡角度為30°時，根據(jù)式（21），采用同步步態(tài)本該完成爬坡作業(yè)，但由于不滿足式（24），即坡面無法提供足夠的摩擦力，導致爬坡失敗。

5 結論

針對六足式弧腿機器人的坡度越障，本文從爬坡速度、爬坡穩(wěn)定性及最大爬坡角度三方面，通過對步態(tài)參數(shù)和穩(wěn)定裕度的分析，以及對弧腿動力學模型的建立，研究了三角步態(tài)和同步步態(tài)下機器人的爬坡性能，實驗研究表明：對于同一結構參數(shù)的六足式弧腿機器人，相比采用同步步態(tài)，三角步態(tài)下機器人爬坡速度更快，但其穩(wěn)定性較差，且最大爬坡角度較小。另外，本文推導出了不同結構參數(shù)下的最大爬坡角，可利用計算值與傳感裝置所檢測的當前坡度值相比，以做出最優(yōu)的步態(tài)選擇。