曲夢可，王洪波，榮 譽

（1. 燕山大學(xué)河北省并聯(lián)機器人與機電系統(tǒng)實驗室，秦皇島 066004；2. 河北科技師范學(xué)院城市建設(shè)學(xué)院，秦皇島 066004；3. 燕山大學(xué)先進(jìn)鍛壓成形技術(shù)與科學(xué)教育部重點實驗室，秦皇島 066004）

輪腿混合四足機器人六自由度并聯(lián)機械腿設(shè)計

曲夢可1,2,3，王洪波1,3※，榮 譽2

（1. 燕山大學(xué)河北省并聯(lián)機器人與機電系統(tǒng)實驗室，秦皇島 066004；2. 河北科技師范學(xué)院城市建設(shè)學(xué)院，秦皇島 066004；3. 燕山大學(xué)先進(jìn)鍛壓成形技術(shù)與科學(xué)教育部重點實驗室，秦皇島 066004）

為了設(shè)計一種可以同時實現(xiàn)邁步行走、有動力輪式機動、無動力輪旱冰式滑行3種運動方式的輪腿混合農(nóng)業(yè)四足機器人，提出了一種基于3-UPS機構(gòu)的六自由度并聯(lián)機械腿，選取結(jié)構(gòu)參數(shù)并給出設(shè)計方案。首先，通過矢量回路法推導(dǎo)出機構(gòu)的位置反解方程，并建立機構(gòu)的速度映射模型；采用搜索法對機構(gòu)的工作空間進(jìn)行分析，并繪制出工作空間三維分布圖，揭示出機構(gòu)結(jié)構(gòu)參數(shù)和工作空間之間的關(guān)系；基于速度映射模型繪制出雅可比矩陣條件數(shù)在工作空間內(nèi)的三維分布圖。接著，定義了一組運動靈活性評價指標(biāo)，對機械腿的機構(gòu)進(jìn)行運動靈活性分析，并繪制出結(jié)構(gòu)參數(shù)與運動靈活性評價指標(biāo)關(guān)系曲線，揭示出結(jié)構(gòu)參數(shù)對機構(gòu)運動靈活性的影響規(guī)律。然后，基于工作空間特性和運動靈活性評價指標(biāo)，采用蒙特卡羅法進(jìn)行結(jié)構(gòu)參數(shù)設(shè)計，通過建立各結(jié)構(gòu)參數(shù)的概率模型空間選取了一組綜合性能較好的結(jié)構(gòu)參數(shù)：機械腿固定平臺萬向副分布直角邊長為230 mm，運動平臺球面副分布直角邊長為70 mm，支鏈最大直徑為60 mm，各支鏈套筒和伸縮桿長度均為500 mm。最后，采用選取的結(jié)構(gòu)參數(shù)設(shè)計出機械腿及輪腿混合四足機器人整體的虛擬樣機，并對虛擬樣機進(jìn)行邁步運動仿真，結(jié)果表明：機械腿的各驅(qū)動參數(shù)變化非常平穩(wěn)且峰值均在合理范圍之內(nèi)，證明機械腿的設(shè)計方案和結(jié)構(gòu)參數(shù)較為合理。該研究為拓展輪腿混合四足機器人在農(nóng)業(yè)工程領(lǐng)域的應(yīng)用提供了參考。

機器人；運動學(xué)；設(shè)計；并聯(lián)機械腿；工作空間分析；性能評價指標(biāo)

0 引 言

目前，農(nóng)業(yè)工程運輸、勘察及作業(yè)處理是機器人的主要應(yīng)用領(lǐng)域之一[1-2]。已有的應(yīng)用于農(nóng)業(yè)作業(yè)的可移動式機器人多為履帶式、輪式、足式結(jié)構(gòu)[3-8]，其中：履帶式機器人在障礙和不規(guī)則路面的通過能力較強[9]，但是體積和自重較大，而且運動不夠靈活；輪式機器人的移動速度較快[10]，但是通過障礙的能力較差；足式機器人具有較好的障礙通過能力和運動靈活性[11-13]，但是在遠(yuǎn)距離移動過程中只能通過邁步方式行走，無法有效利用已有公路或平整路面，所以其運動過程中能量損失較大且無法根據(jù)不同路面切換不同運動模式。輪腿混合式農(nóng)業(yè)機器人能夠兼具輪式機器人和足式機器人的優(yōu)點，在平整路面可以通過輪式高速機動，在農(nóng)業(yè)作業(yè)區(qū)域可以通過足式邁步前進(jìn)通過障礙。

已有的輪腿混合式機器人主要包括：第一類，Rolling-Wolf式輪腿機器人，代表性的是美國噴氣推進(jìn)實驗室開發(fā)的系列星際探索機器人[14-15]；第二類，可以在邁步行走和輪式機動方式間轉(zhuǎn)換的機器人，代表性的是美國宇航局的ATHLETE[16-17]；第三類，通過旱冰滑行方式采用無動力輪的機器人，代表性的是哈爾濱工業(yè)大學(xué)研制的HIT-HYBTOR機器人[18-19]。如果能夠在同一個機器人身上同時實現(xiàn)上述3種運動方式，將使機器人具有極大的運動靈活性和環(huán)境適應(yīng)能力。要使一個機器人的機械腿能夠同時實現(xiàn)邁步行走、有動力輪式機動、無動力輪式旱冰滑行，其每條機械腿必須能實現(xiàn)6個自由度運動，如果采用傳統(tǒng)的串聯(lián)機械腿構(gòu)型，6個自由度對應(yīng)的驅(qū)動系統(tǒng)將導(dǎo)致機械腿的結(jié)構(gòu)十分龐大笨重。

并聯(lián)機構(gòu)能夠在結(jié)構(gòu)緊湊的同時獲得較多的運動自由度數(shù)量和較好的運動靈活性，適合用于輪腿混合機器人的機械腿的結(jié)構(gòu)。已有的采用并聯(lián)機械腿的機器人主要有：上海交通大學(xué)高峰團(tuán)隊研發(fā)的小象機器人、章魚機器人系列[20-28]；燕山大學(xué)王洪波團(tuán)隊研發(fā)的四足/兩足步行器[29]等。然而，上述機器人一般只采用邁步方式行走，而沒有采用輪式機動。因此，研究一種具有6個自由度且結(jié)構(gòu)緊湊、運動靈活的并聯(lián)結(jié)構(gòu)機械腿具有重要意義，可以大大提高輪腿混合機器人的運動靈活性，從而拓展其應(yīng)用領(lǐng)域。

本文提出一種用于輪腿混合四足機器人的六自由度并聯(lián)機械腿，其可以同時實現(xiàn)邁步行走、有動力輪式機動、無動力輪旱冰式滑行3種運動方式。在此基礎(chǔ)上，采用矢量回路法對機械腿的機構(gòu)進(jìn)行了運動學(xué)分析與運動靈活性評價，基于運動靈活性評價指標(biāo)的分布情況，對機械腿進(jìn)行了結(jié)構(gòu)參數(shù)選取，并設(shè)計出機械腿及輪腿混合四足機器人整體的虛擬樣機，通過對虛擬樣機進(jìn)行邁步運動仿真。

1 六自由度并聯(lián)機械腿構(gòu)型介紹

為了使輪腿混合四足機器人的機械腿在結(jié)構(gòu)緊湊的同時具有6個線性無關(guān)的自由度，本文提出一種基于3-UPS機構(gòu)的并聯(lián)機械腿，其機構(gòu)構(gòu)型如圖1所示。

圖1 機械腿3-UPS機構(gòu)簡圖Fig.1 Sketch map of mechanical leg’s 3-UPS mechanism

3-UPS機構(gòu)由固定平臺、運動平臺和兩者之間的3條相同的UPS支鏈構(gòu)成。這里，U、P、S分別代表萬向副、移動副和球面副。其中，每條UPS支鏈的一端通過萬向副與機構(gòu)的固定平臺連接，另一端通過球面副與機構(gòu)的運動平臺連接，在每條分支的萬向副和球面副之間是一個由伸縮套筒構(gòu)成的移動副。3條支鏈與機構(gòu)固定平臺連接的3個萬向副回轉(zhuǎn)中心點呈等腰直角三角形布局，3條支鏈與運動平臺連接的3個球面副回轉(zhuǎn)中心點也呈等腰直角三角形布局。根據(jù)螺旋理論，通過采用此種等腰直角三角形布局，可以實現(xiàn)機械腿足的3個轉(zhuǎn)動運動之間解耦，同時使足的3個移動運動之間僅存在弱耦合，從而使機械腿的傳遞方程成為解耦傳遞方程，實現(xiàn)各驅(qū)動運動副之間輸入力/力矩的解耦，提高機械腿的運動靈活性。

根據(jù)螺旋理論[30]，該機構(gòu)每個支鏈均具有6個線性無關(guān)的自由度，所以其運動平臺具有6個線性無關(guān)的自由度。為了實現(xiàn)對運動平臺的六自由度伺服驅(qū)動，需要在每個支鏈選擇2個驅(qū)動運動副，將3個支鏈的移動副作為移動驅(qū)動運動副，將3個支鏈萬向副靠近固定平臺的轉(zhuǎn)動副作為轉(zhuǎn)動驅(qū)動運動副。

2 機械腿機構(gòu)運動學(xué)分析

2.1 運動平臺姿態(tài)描述

基于圖1中坐標(biāo)系的定義，可以構(gòu)造出連體坐標(biāo)系A(chǔ)i-uipiwi（i=1,2,3）的旋轉(zhuǎn)矩陣為

式中sψi=sinψi，cψi=cosψi，sθi=sinθi，cθi=cosθi；ui、pi和wi分別為軸ui、軸pi和軸wi在固定坐標(biāo)系A(chǔ)1-x1y1z1中的單位主矢量；xi、yi和zi分別為軸xi、軸yi和軸zi在固定坐標(biāo)系A(chǔ)1-x1y1z1中的單位主矢量；xi和yi為坐標(biāo)系A(chǔ)i-xiyizi的坐標(biāo)軸；ψi為支鏈i繞xi軸的旋轉(zhuǎn)角度，(°)；θi為支鏈i繞pi軸的旋轉(zhuǎn)角度，(°)。

經(jīng)分析可知，ψi（i=1,2,3）即為各支鏈的轉(zhuǎn)動驅(qū)動輸入轉(zhuǎn)角值。在選取運動平臺參考點時，由于A1B1支鏈處于機構(gòu)的對稱面上，所以選取點B1為運動平臺參考點。考慮到運動平臺在固定參考坐標(biāo)系A(chǔ)1-x1y1z1中的姿態(tài)描述等效于先繞x1軸轉(zhuǎn)γ角，再繞y1軸轉(zhuǎn)β角，然后繞z1軸轉(zhuǎn)α角獲得，則運動坐標(biāo)系B1-upw相對于固定坐標(biāo)系A(chǔ)1?x1y1z1的旋轉(zhuǎn)變換矩陣R為

式中sα=sinα，cα=cosα，sβ，cβ，sγ，cγ的含義以此類推；u、p和w分別為軸u、p和w在固定坐標(biāo)系A(chǔ)1-x1y1z1中的單位主矢量；x1、y1和z1為坐標(biāo)系A(chǔ)1-x1y1z1的坐標(biāo)軸；γ為運動平臺繞x1軸的旋轉(zhuǎn)角度，(°)；β為運動平臺繞y1軸的旋轉(zhuǎn)角度，(°)；α為運動平臺繞z1軸的旋轉(zhuǎn)角度，(°)。

2.2 位置反解分析

機械腿的3-UPS機構(gòu)的位置反解分析就是已知運動平臺參考點B1在固定坐標(biāo)系A(chǔ)1-x1y1z1中的位置矢量l1=[x y z]T和運動平臺的姿態(tài)角α、β和γ，求解各支鏈移動驅(qū)動運動副的桿長li（i=1,2,3）和轉(zhuǎn)動驅(qū)動運動副的轉(zhuǎn)角ψi（i=1,2,3）的過程。在運動坐標(biāo)系B1-upw中的任意一個向量B1p都可通過坐標(biāo)變換到固定坐標(biāo)系A(chǔ)1-x1y1z1中描述為

式中Gp的上標(biāo)G代表向量p在固定坐標(biāo)系A(chǔ)1-x1y1z1中的描述，GpB1代表運動坐標(biāo)系B1-upw的原點B1在固定坐標(biāo)系A(chǔ)1-x1y1z1中的描述，且

對此3-UPS機構(gòu)而言，點A2、A3在固定坐標(biāo)系A(chǔ)1-x1y1z1中的向量為

點B2、B3在運動坐標(biāo)系B1-upw中的向量為

通過坐標(biāo)變換，可以得到上述各點在固定坐標(biāo)系A(chǔ)1-x1y1z1中的向量分別為

在固定坐標(biāo)系A(chǔ)1-x1y1z1中，建立位置閉環(huán)矢量約束方程

式中l(wèi)i和wi（i=1,2,3）分別表示支鏈i的桿長和單位矢量，a2表示矢量A1A2，a3表示矢量A1A3，b2表示矢量B1B2，b3表示矢量B1B3。由式（11）等號兩邊同時取范數(shù)，可得

據(jù)此，通過式（1）可以求出連體坐標(biāo)系A(chǔ)i-uipiwi（i=1,2,3）相對于輔助參考坐標(biāo)系A(chǔ)i-xiyizi（i=1,2,3）的姿態(tài)角ψi和θi分別為

由式（11）－（13）可以得出

將求得的wi代入式（17）即可求出相應(yīng)的轉(zhuǎn)動驅(qū)動運動副的轉(zhuǎn)角ψi（i=1,2,3）。

2.3 速度映射分析

機械腿的3-UPS機構(gòu)的速度映射分析指的是運動平臺參考點B1在固定坐標(biāo)系A(chǔ)1-x1y1z1中的廣義速度矢量V=[vTωT]T與各支鏈軸向移動驅(qū)動運動副輸入速度i=[i1i2i3]T及轉(zhuǎn)動驅(qū)動運動副輸入角速度之間的映射關(guān)系，通過速度映射分析可以得到機構(gòu)的速度雅可比矩陣，并基于雅可比矩陣分析機構(gòu)的運動學(xué)特性。

通過求解式（11）－（13）關(guān)于時間t的導(dǎo)數(shù)，可得

式中v表示點B1的線速度，ω表示運動平臺的角速度矢量，li分別表示支鏈i（i=1,2,3）整體的移動驅(qū)動運動副伸縮速度。

根據(jù)向量幾何學(xué)可知wi·(ωi×wi)=0，（i=1,2,3）。因此，對式（20）兩端同時點乘w1，對式（21）兩端同時點乘w2，對式（22）兩端同時點乘w3，可得

將式（23）－（25）整理成矩陣形式表達(dá)就可以得到3-UPS機構(gòu)的移動驅(qū)動運動副輸入速度與運動平臺的廣義速度矢量V1=[vTωT]T之間映射關(guān)系

用矢量表達(dá)式（26）可得

式中i=[i1i2i3]T為移動驅(qū)動運動副的輸入速度，且J1∈R3×6。根據(jù)角速度疊加原理，可得

根據(jù)向量幾何學(xué)可知pi×pi=0，（i=1,2,3）。因此，

對式（28）兩邊同時叉乘pi（i=1,2,3），可得

根據(jù)向量幾何學(xué)可知pi×wi=0，（i=1,2,3）。因此，對式（20）兩端同時點乘p1，對式（21）兩端同時點乘p2，對式（22）兩端同時點乘p3，可得

將式（29）中pi×ωi，（i=1,2,3）分別代入式（30）－（32），可得

將式（33）－（35）整理成矩陣形式表達(dá)就可以得到3-UPS機構(gòu)的轉(zhuǎn)動驅(qū)動運動副輸入角速度與運動平臺的廣義速度矢量V=[vTωT]T之間映射關(guān)系

用矢量表達(dá)式（36）可得

式中J=[J1J2]T為雅可比矩陣，且J∈R6×6，為機構(gòu)的輸入速度矢量，V=[vTωT]T為機構(gòu)的運動平臺輸出廣義速度矢量。

3 機械腿機構(gòu)工作空間分析

分析機械腿的3-UPS機構(gòu)工作空間與其結(jié)構(gòu)參數(shù)之間的關(guān)系，可以為機械腿各構(gòu)件的尺寸參數(shù)選取提供依據(jù)[31]。3-UPS機構(gòu)的工作空間是在考慮各運動副有效作用范圍和各構(gòu)件非碰撞狀態(tài)時，運動平臺參考點B1能夠到達(dá)的位置集合，這里V表示。定義運動平臺的初始位姿為：運動平臺與固定平臺平行，且二者之間距離位于總變化范圍的中間值h。因為本文主要進(jìn)行初步結(jié)構(gòu)設(shè)計與尺寸參數(shù)選取，所以在工作空間條件設(shè)定時，采用極限條件進(jìn)行分析，而有效工作空間及奇異性分析與機器人樣機制造過程中的零部件加工、裝配工藝相關(guān)，在初步方案設(shè)計過程中暫不考慮。

3.1 機構(gòu)約束條件與工作空間形狀分析

機械腿的機構(gòu)工作空間主要由各支鏈的長度、支鏈之間的物理干涉、各運動副的物理有效范圍等因素決定，為求解工作空間，設(shè)定約束條件。

各支鏈長度變化范圍：limin≤li≤limax(mm) （i=1,2,3），其中l(wèi)imin為各支鏈最小長度，limax為各支鏈最大長度。萬向副2個回轉(zhuǎn)軸線的轉(zhuǎn)角ψi和θi（i=1,2,3）的變化范圍：?ψmax≤ψi≤ψmax(i=1,2,3)，?θmax≤θi≤θmax(i=1,2,3)，其中ψmax和θmax是萬向副的極限轉(zhuǎn)角值。球面副3個回轉(zhuǎn)軸線的轉(zhuǎn)角ηi（i=1,2,3）的變化范圍：0≤ηi≤ηmax(i=1,2,3)，其中ηi=arcos(qi·li),，qi(i=1,2,3)是球面副的球窩座與運動平臺固接點的單位法相矢量。各支鏈移動伸縮套筒的實際直徑d限定了各支鏈間的接近程度，則任意2個支鏈間的最短距離dij（i≠j,且i、j=1,2,3）的變化范圍：dij≥d（i≠j,且i、j=1,2,3）。

要進(jìn)行工作空間分析，需要首先基于經(jīng)驗給機械腿指定一組結(jié)構(gòu)參數(shù)，本文根據(jù)文獻(xiàn)[20-28]的研究成果，確定初選結(jié)構(gòu)參數(shù)：固定平臺萬向副分布半徑a=150 mm，運動平臺球面副分布半徑b=50 mm，li∈(500,900) mm，h=700 mm，ηmax=35°，d=50 mm，ψimax=θimax=60°。采用這組結(jié)構(gòu)參數(shù)，根據(jù)式（3）－（16）和式（39）－（42）進(jìn)行結(jié)構(gòu)約束分析，采用漸變步長的搜索法在笛卡爾坐標(biāo)空間內(nèi)進(jìn)行逐點計算并繪制出機械腿3-UPS機構(gòu)的工作空間分布圖，如圖2所示。

圖2 機械腿工作空間3D分布圖Fig.2 3D workspace map of mechanical leg

由圖2可知，機械腿的工作空間主要呈現(xiàn)軸對稱分布，其核心部分是由3個球冠交集構(gòu)成，且各向分布均勻，說明該機構(gòu)具有很好的各向同性；在垂直方向變化的同時截面先平穩(wěn)增大后離散減小，可見其工作空間中垂直方向中、下部分布較好，可作為結(jié)構(gòu)設(shè)計優(yōu)選區(qū)域。

3.2 機械腿的結(jié)構(gòu)參數(shù)與工作空間關(guān)系分析

機械腿的3-UPS機構(gòu)為對稱3分支并聯(lián)機構(gòu)，為了使分析更具有普遍性，這里主要分析機構(gòu)各主要結(jié)構(gòu)參數(shù)之間比例值對工作空間的影響?；谏鲜龀踹x結(jié)構(gòu)參數(shù)，選定limin/limax（i=1,2,3）的分析取值范圍：0.25～1；b/a的分析取值范圍：0.25～1.7；a/limax（i=1,2,3）的分析取值范圍：0.1～0.7?；谏鲜龇治鋈≈捣秶捎脝我蛩胤治龇?，即將非分析參數(shù)取初選值，分析參數(shù)在取值范圍內(nèi)連續(xù)變化，繪制出結(jié)構(gòu)參數(shù)比例值與工作空間關(guān)系變化曲線，如圖3所示。

圖3 結(jié)構(gòu)參數(shù)與工作空間的關(guān)系Fig.3 Relationship of structural parameters and workspace

通過圖3可知，在limin/limax（i=1,2,3）的取值逐漸增大同時，工作空間體積V逐漸減?。划?dāng)b/a的取值逐漸增大同時，工作空間體積V隨之先增大然后逐漸減小，當(dāng)b/a的取值為1附近的時候，工作空間體積V最大，此時機械腿的固定平臺和運動平臺大小接近；當(dāng)a/limax（i=1,2,3）的取值逐漸增大同時，工作空間體積V逐漸減小。

4 機械腿的機構(gòu)運動靈活性分析

本文提出的輪腿混合四足機器人設(shè)計目標(biāo)是同時實現(xiàn)輪式、邁步式和旱冰式運動，這就要求其每條機械腿都具有極大的運動靈活性，通過建立機械腿的結(jié)構(gòu)參數(shù)與運動靈活性之間的映射關(guān)系，可以為機械腿的結(jié)構(gòu)參數(shù)選取提供依據(jù)。

4.1 機械腿的運動靈活性指標(biāo)

機構(gòu)學(xué)領(lǐng)域?qū)⑺俣妊趴杀染仃嚨臈l件數(shù)k作為運動學(xué)靈活性的一個重要評價指標(biāo)[32]

式中σmax、σmin是雅可比矩陣的最大、最小奇異值。

基于前文的一組初選結(jié)構(gòu)參數(shù)，將機械腿的機構(gòu)工作空間坐標(biāo)系進(jìn)行網(wǎng)格分區(qū)，采用數(shù)學(xué)計算軟件Matlab計算評價指標(biāo)k在機構(gòu)工作空間內(nèi)的分布，如圖4所示。

通過圖4可知，3-UPS機構(gòu)的雅可比矩陣條件數(shù)在工作空間內(nèi)分布均勻平穩(wěn)，不存在奇異區(qū)域和躍變情況，說明機構(gòu)的運動學(xué)傳遞性能較好。因為雅可比矩陣條件數(shù)是機構(gòu)在每個位姿時的瞬時指標(biāo)，為了全面揭示機構(gòu)的運動學(xué)性能，將雅可比矩陣條件數(shù)k在機構(gòu)的工作空間內(nèi)全域均值定義為機械腿的另一個運動靈活性評價指標(biāo)[32]

式中k為雅可比矩陣條件數(shù)在機構(gòu)的工作空間內(nèi)全域均值。

圖4 雅可比矩陣條件數(shù)分布圖Fig.4 3D map of condition number of Jacobian matrix

為了揭示機構(gòu)運動靈活性在其工作空間內(nèi)的變化規(guī)律，將雅可比矩陣條件數(shù)k在機構(gòu)的工作空間內(nèi)的標(biāo)準(zhǔn)差也作為一個機械腿的運動靈活性評價指標(biāo)[33]

式中k%為雅可比矩陣條件數(shù)在機構(gòu)的工作空間內(nèi)標(biāo)準(zhǔn)差。

通過Matlab軟件中的取樣和計算功能，計算出圖4中各分布區(qū)域的k和k%的數(shù)值，對于機械腿而言，k的值越小說明機構(gòu)的運動靈活性越好，k%的值越小說明機構(gòu)運動靈活性在工作空間內(nèi)的一致性越好。

4.2 運動靈活性與結(jié)構(gòu)參數(shù)關(guān)系分析

機械腿的各項結(jié)構(gòu)參數(shù)選取目標(biāo)是使機構(gòu)的各項運動靈活性評價指標(biāo)都處于最優(yōu)值附近，且使機構(gòu)的工作空間體積和分布也比較合理。為了實現(xiàn)結(jié)構(gòu)參數(shù)的最優(yōu)選取，將k和k%作為機構(gòu)結(jié)構(gòu)參數(shù)基于雅可比矩陣的函數(shù)，可得

式中Kk是全域均值運動靈活性評價指標(biāo)函數(shù)，Kk%是標(biāo)準(zhǔn)差運動靈活性評價指標(biāo)函數(shù)。

在各結(jié)構(gòu)參數(shù)中，分主要結(jié)構(gòu)參數(shù)和次要結(jié)構(gòu)參數(shù)，這里選取固定平臺萬向副分布半徑a、運動平臺球面副分布半徑b、支鏈1的最大和最小長度差Δl1=(l1max?l1min)、各支鏈的直徑d作為主要參數(shù)，采用單因素分析法，即將非分析參數(shù)取初選值，分析參數(shù)在取值范圍內(nèi)連續(xù)變化，繪制出結(jié)構(gòu)參數(shù)與運動靈活性評價指標(biāo)關(guān)系變化曲線，如圖5所示。

圖5 結(jié)構(gòu)參數(shù)與k、k%關(guān)系曲線Fig.5 Relationship curve of structure parameters andk,k%

由圖5可知，k、k%值隨著a值增大而呈波動式減??；k、k%值隨著b值增大而呈波動式增大；k、k%值隨著Δl1值增大而緩慢減?。籯、k%值隨著d值增大而緩慢增大。

5 機械腿設(shè)計

5.1 機械腿的結(jié)構(gòu)參數(shù)選取

在機械腿的結(jié)構(gòu)參數(shù)選取時，需要同時考慮各種運動靈活性評價指標(biāo)和機構(gòu)的工作空間，這里采用基于評價指標(biāo)的蒙特卡羅法，根據(jù)前文分析結(jié)果，規(guī)定主要結(jié)構(gòu)參數(shù)的分析取值范圍為：a∈(100, 350) mm，b∈(20,120) mm，Δl1∈(250,500) mm，d∈(30,80) mm，考慮到工作空間因素，limin/limax∈(0.25,1)，b/a∈(0.25,1.7)，a/limax∈(0.25,0.7)。將運動靈活性評價指標(biāo)中間值作為概率模型，V=7.7×107mm3、k=4.3、k%=0.47。通過在各結(jié)構(gòu)參數(shù)取值范圍抽樣，以各評價指標(biāo)概率模型為目標(biāo)指標(biāo)，采用Matlab的統(tǒng)計概率函數(shù)進(jìn)行各結(jié)構(gòu)參數(shù)抽樣值分布規(guī)律，繪制出離散概率柱狀分布，如圖6所示。

分析圖6可以獲得各結(jié)構(gòu)參數(shù)的優(yōu)選值區(qū)間，通過權(quán)衡各評價指標(biāo)與各結(jié)構(gòu)參數(shù)優(yōu)選值區(qū)間的重疊區(qū)域，從而確定一組兼顧各方面性能的結(jié)構(gòu)參數(shù)值，如表1所示。機械腿固定平臺萬向副分布直角邊長為230 mm，運動平臺球面副分布直角邊長為70 mm，支鏈最大直徑為60 mm，各支鏈套筒和伸縮桿長度均為500 mm。

采用表1結(jié)構(gòu)參數(shù)值，結(jié)合制造工藝因素，設(shè)計出六自由度并聯(lián)機械腿方案，如圖7a所示。

圖6 結(jié)構(gòu)參數(shù)概率離散柱狀圖Fig.6 Probabilistic discrete histogram of structure parameters

表1 并聯(lián)機械腿樣機結(jié)構(gòu)參數(shù)Table 1 Structure parameters of parallel mechanical leg prototype

圖7 機器人及機械腿方案圖Fig.7 Prototype of mechanical leg and robot

基于圖7a所示的機械腿方案，設(shè)計出輪腿混合四足機器人整體方案，如圖7b所示。

5.2 虛擬樣機運動仿真

本文提出的輪腿混合四足機器人可實現(xiàn)3種運動模式：1）如圖7b所示，通過每個輪足上的驅(qū)動電機實現(xiàn)有動力的輪式機動，此時每條機械腿的六自由度伺服運動主要用于為輪調(diào)姿以適應(yīng)崎嶇路面；2）將每條腿的輪置于水平讓輪側(cè)面著地，如圖8所示，此時每個輪側(cè)面成為足的腳掌，機器人通過邁步方式機動；3）通過每條機械腿的六自由度伺服運動，使4個輪在無動力狀態(tài)實現(xiàn)旱冰式滑行機動。在上述3種運動模式中，第二種即邁步機動方式時，對機械腿的運動靈活性要求最高，因此，通過工程動力學(xué)分析軟件Adams仿真分析機器人邁步運動，如圖8所示，從而揭示機械腿6個驅(qū)動運動副的速度變化規(guī)律，驗證機械腿設(shè)計方案和結(jié)構(gòu)參數(shù)的正確性。這里，為了更全面驗證機械腿的性能，設(shè)定機器人按照1-2-3循環(huán)步態(tài)進(jìn)行仿真運動分析，即機器人邁步時采用1條腿邁步-2條腿邁步-3條腿邁步循環(huán)的方式進(jìn)行前進(jìn)，從而模擬四足動物的邁步規(guī)律。

圖8 機器人行走仿真圖Fig.8 Image of robot’s walking simulation

通過圖8所示的機器人邁步仿真運動的線速度分析，采集過程中同一條機械腿的3個移動驅(qū)動副和3個轉(zhuǎn)動驅(qū)動副的驅(qū)動線速度、角速度絕對值并繪制出其隨時間變化曲線，如圖9所示。

圖9 機械腿各支鏈驅(qū)動速度仿真曲線Fig.9 Each branches’ driving velocity simulation curves of mechanical leg

由圖9可知，本文提出的基于3-UPS機構(gòu)的六自由度并聯(lián)機械腿在機器人行走過程中，3個移動驅(qū)動運動副的線速度和3個轉(zhuǎn)動驅(qū)動運動副的角速度隨時間變化非常平穩(wěn)均勻，不存在速度突變和階躍情況，且各支鏈的速度變化規(guī)律較相近，速度峰值均在合理范圍內(nèi)，說明機械腿的設(shè)計方案和結(jié)構(gòu)參數(shù)較為合理。

6 結(jié) 論

1）提出了一種基于3-UPS機構(gòu)的六自由度并聯(lián)機械腿，對機械腿的機構(gòu)進(jìn)行了運動學(xué)分析，通過建立機構(gòu)的位置映射方程，繪制出其工作空間分布規(guī)律，通過建立機構(gòu)的速度映射方程繪制出雅可比矩陣條件數(shù)分布規(guī)律。分布規(guī)律表明，機構(gòu)的工作空間中、下部分分布均勻，且運動靈活性較好。

2）在定義運動靈活性評價指標(biāo)的基礎(chǔ)上對機構(gòu)的運動靈活性做出評價，基于機構(gòu)的運動學(xué)模型分析結(jié)構(gòu)參數(shù)和運動靈活性評價指標(biāo)之間關(guān)系，揭示出結(jié)構(gòu)參數(shù)取值對運動靈活性的影響規(guī)律。

3）綜合考慮機構(gòu)的工作空間及各項運動靈活性評價指標(biāo)，采用蒙特卡羅法建立出各結(jié)構(gòu)參數(shù)的概率模型空間，選取一組綜合性能較好的結(jié)構(gòu)參數(shù)：固定平臺結(jié)構(gòu)參數(shù)為230 mm，運動平臺70 mm，各分支直徑為60 mm，各支鏈套筒和伸縮桿長度均為500 mm。采用選取的結(jié)構(gòu)參數(shù)設(shè)計出機械腿及輪腿混合四足機器人整體的虛擬樣機，對虛擬樣機的邁步運動仿真表明，機械腿的各驅(qū)動參數(shù)變化平穩(wěn)且峰值均在合理范圍之內(nèi)，證明機械腿的設(shè)計方案和結(jié)構(gòu)參數(shù)較為合理。

[1] 高峰，郭為忠. 中國機器人的發(fā)展戰(zhàn)略思考[J]. 機械工程學(xué)報，2016，52(7)：1－5. Gao Feng, Guo Weizhong. Thinking of the development strategy of robots in China[J]. Journal of Mechanical Engineering, 2016, 52(7): 1－5. (in Chinese with English abstract)

[2] Manyika J, Chui M, Bughin J. Disruptive Technologies: Advances that Will Transform Life, Business, and the Global Economy[M]. San Francisco, CA, USA: McKinsey Global Institute, 2013.

[3] Estier T, Crausaz Y, Bughin J. An innovative space rover with extended climbing abilities[C]//Proceedings: IEEE International Conference on Robotics and Automation, San Francisco, 2000(5): 24－28.

[4] Endo G, Hirose S. Study on roller-walker (multimode steering control and self-contained locomotion)[J]. Procof the ICRA '00. IEEE on Robotics and Automation, 2000(3): 2808－2814.

[5] Nakajima S, Nakano E. Adaptive gait for large rough terrain of a leg-wheel robot (fourth report: step-over gait)[J]. Journal of Robotics and Mechatronics, 2009, 21(2): 7－12.

[6] 郭麗峰，陳懇，趙旦譜. 一種輪腿式變結(jié)構(gòu)移動機器人研究[J]. 制造業(yè)自動化，2009，31(10)：1－8. Guo Lifeng, Chen Ken, Zhao Danpu. Study on a wheel-legged hybrid mobile robot[J]. Manufacturing Automation, 2009, 31(10): 1－8. (in Chinese with English abstract)

[7] 丁希侖， 徐坤. 一種新型變結(jié)構(gòu)輪腿式機器人的設(shè)計與分析[J]. 中南大學(xué)學(xué)報：自然科學(xué)版，2009，40(9)：91－101. Ding Xilun, Xu Kun. Design and analysis of a novel metamorphic wheel-legged rover mechanism[J]. Journal ofCentral South University: Science and Technology, 2009, 40(9): 91－101. (in Chinese with English abstract)

[8] 榮譽，金振林，崔冰艷. 六足農(nóng)業(yè)機器人并聯(lián)腿構(gòu)型分析與結(jié)構(gòu)參數(shù)設(shè)計[J]. 農(nóng)業(yè)工程學(xué)報，2012，28(15)：9－14. Rong Yu, Jin Zhenlin, Cui Bingyan. Configuration analysis and structure parameter design of six-leg agricultural robot with parallel-leg mechanisms[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(15): 9－14. (in Chinese with English abstract)

[9] 朱巖，王明輝，李斌，等. 基于目標(biāo)規(guī)劃的履帶可變形機器人結(jié)構(gòu)參數(shù)設(shè)計及驗證[J]. 農(nóng)業(yè)工程學(xué)報，2016，39(7)：39－47. Zhu Yan, Wang Minghui, Li Bin, et al. Mechanism-語parameters design and validation of transformable tracked robot based on goal programming[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 39(7): 39－47. (in Chinese with English abstract)

[10] 張京，陳度，王書茂，等. 農(nóng)用輪式機器人四輪獨立轉(zhuǎn)向驅(qū)動控制系統(tǒng)設(shè)計與試驗[J]. 農(nóng)業(yè)工程學(xué)報，2015，31(18)：63－70. Zhang Jing, Chen Du, Wang Shumao, et al. Design and experiment of four-wheel independent steering driving and control system for agricultural wheeled robot[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2015, 31(18): 63－70. (in Chinese with English abstract)

[11] 張金柱，金振林，陳廣廣. 六足步行機器人腿部機構(gòu)運動學(xué)分析[J]. 農(nóng)業(yè)工程學(xué)報，2016，32(9)：45－52. Zhang Jinzhu, Jin Zhenlin, Chen Guangguang. Kinematic analysis of leg mechanism of six-legged walking robot[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(9): 45－52. (in Chinese with English abstract)

[12] 劉呈則，嚴(yán)智，鄧景珊. 核電站應(yīng)急機器人研究現(xiàn)狀與關(guān)鍵技術(shù)分析[J]. 核科學(xué)與工程，2013，33(1)：98－105. Liu Chengze, Yan Zhi, Deng Jingshan. Study on accident response robot for nuclear power plant and analysis of key technologies[J]. Nuclear Science and Engineering, 2013, 33(1): 98－105. (in Chinese with English abstract)

[13] 劉波，王欣，吳王鎖. 機器人在核與輻射事故應(yīng)急中的應(yīng)用展望[J]. 工業(yè)安全與環(huán)保，2015，41(1)：62－64. Liu Bo, Wang Xin, Wu Wangsuo. The application prospect of robot in the nuclear and radiation emergency[J]. Industrial Safety and Environmental Protection, 2015, 41(1): 62－64. (in Chinese with English abstract)

[14] Volpe R, Balaram J, Ohm T. Rocky 7: A next generation Mars rover prototype[J]. Advanced Robotics, 1997, 11(4): 341－358.

[15] Kemurdjian A L. Planet rover as an object of the engineering design work[C]// Leuven Belgium: Proceedings of the 1998 IEEE International Conference on Robotics & Automation, 1998: 140－145.

[16] Collins C. Stiffness modeling and force distribution for the all-terrain hex-limbed extra-terrestrial explorer (ATHLETE)[C]//ASME 2007 International Design Engineering Technical Conferences & Computers and In-formation in Engineering Conference, September, 2007, Las Vegas, USA, 2007: 1－9.

[17] James A, Inna S, Michael T. PAW: a hybrid wheeled-leg robot[R]. Centre for Intelligent Machines Mc Gill University,Series A: Research Reports No. 30, Espoo, September 2007: 140－145.

[18] Wang Pengfei, Huang Bo, Sun Lining. Walking research on multi-motion mode quadruped bionic robot based on moving ZMP[C]//Proc. of the IEEE Int. Conf. on Mechatronics & Automation Niagara Falls, Canada, 2005: 1935－1940.

[19] Hirose S, Endo G. Study on roller-walker (multi-mode steering control and self-contained loco-motion)[J]. Procof the ICRA '00. IEEE on Robotics and Automation, 2000(3): 2808－2813.

[20] 潘陽. P_P結(jié)構(gòu)六足機器人性能設(shè)計與控制試驗研究[D].上海：上海交通大學(xué)，2014：29－55. Pan Yang. Performance Design and Control Experiment of a Novel Hexapod Robot with P-P Structure [D]. Shanghai: Shanghai Jiao Tong University, 2014: 29－55. (in Chinese with English abstract)

[21] 榮譽. 基于并聯(lián)機械腿的六足機器人分析與設(shè)計[D]. 秦皇島：燕山大學(xué)，2015：17－88. Rong Yu. Analysis and Design for Hexapod Robots with Parallel Mechanical Legs[D]. Qinhuangdao: Yanshan University, 2015: 17－88. (in Chinese with English abstract)

[22] 榮譽，金振林. 五自由度并聯(lián)機械腿靜力學(xué)性能評價與優(yōu)化設(shè)計[J]. 光學(xué)精密工程，2012，20(6)：1233－1242. Rong Yu, Jin Zhenlin. Statics performance evaluating and optimal design of 5-DOF parallel mechanical leg[J]. Optics and Precision Engineering, 2012, 20(6): 1233－1242. (in Chinese with English abstract)

[23] 榮譽，金振林，曲夢可. 六足步行機器人的并聯(lián)機械腿設(shè)計[J]. 光學(xué)精密工程，2012，20(7)：1532－1541. Rong Yu, Jin Zhenlin, Qu Mengke. The design of a parallel mechanical leg of the six-legged robot[J]. Optics and Precision Engineering, 2012, 20(7): 1532－1541. (in Chinese with English abstract)

[24] 榮譽，金振林. 3-DOF并聯(lián)機械腿動力學(xué)建模與伺服電機峰值預(yù)估[J]. 光學(xué)精密工程，2012，20(9)：1974－1983. Rong Yu, Jin Zhenlin. Dynamic modeling and peak prediction of servo motor for 3-DOF parallel mechanical leg[J]. Optics and Precision Engineering, 2012, 20(9): 1974－1983. (in Chinese with English abstract)

[25] 榮譽，金振林，曲夢可. 三自由度并聯(lián)機械腿靜力學(xué)分析與優(yōu)化[J]. 農(nóng)業(yè)工程學(xué)報，2012，28(20)：41－49. Rong Yu, Jin Zhenlin, Qu Mengke. Statics analysis and optimal design of 3-DOF parallel mechanical leg[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2012, 28(20): 41－49. (in Chinese with English abstract)

[26] 田興華，高峰，陳先寶，等. 四足仿生機器人混聯(lián)腿構(gòu)型設(shè)計及比較[J]. 機械工程學(xué)報，2013，49(6)：81－88. Tian Xinghua, Gao Feng, Chen Xianbao, et al. Mechanism design and comparison for quadruped robot with parallel-serial leg[J]. Journal of Mechanical Engineering, 2013, 49(6): 81－88. (in Chinese with English abstract)

[27] 榮譽，劉雙勇，韓勇. 六足制孔機器人三自由度并聯(lián)機械腿的誤差模型及驗證[J]. 農(nóng)業(yè)工程學(xué)報，2016，32(18)：18－25. Rong Yu, Liu Shuangyong, Han Yong. Error model and verification of three degrees of freedom parallel mechanical leg on hexapod drilling robot[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2016, 32(18): 18－25. (in Chinese with English abstract)

[28] 金振林，張金柱，高峰. 一種消防六足機器人及其腿部機構(gòu)運動學(xué)分析[J]. 中國機械工程，2016，27(7)：865－871. Jin Zhenlin, Zhang Jinzhu, Gao Feng. A firefighting six-legged robot and its kinematics analysis of leg mechanisms[J]. China Mechanical Engineering, 2016, 27(7): 865－871. (in Chinese with English abstract)

[29] 王洪波，齊政彥，胡正偉，等. 并聯(lián)腿機構(gòu)在四足/兩足可重組步行機器人中的應(yīng)用[J]. 機械工程學(xué)報，2009，45(8)：24－30.Wang Hongbo, Qi Zhengyan, Hu Zhengwei, et al. Application of parallel leg mechanisms in quadruped/biped reconfigurable walking robot[J]. Journal of Mechanical Engineering, 2009, 45(8): 24－30. (in Chinese with English abstract)

[30] 黃真，趙永生，趙鐵石. 高等空間機構(gòu)學(xué)[M]. 北京：高等教育出版社，2006：277－283.

[31] 于靖軍，劉辛軍，丁希倫，等. 機器人機構(gòu)學(xué)的數(shù)學(xué)基礎(chǔ)[M].北京：機械工業(yè)出版社，2008：11－12.

[32] Gosselin C, Angeles J. Global performance index for the kinematic optimization of robotic manipulators[J]. Journal of Mechanisms, Transmissions, and Automation in Design, 1991, 113(3): 220－226.

[33] Huang Tian, Gosselin C. Analytic approach for optimal design of a type of spherical parallel manipulators using dexterous performance indices[J]. IMechE Journal of Mechanical Engineering Science, Part C, 2003, 217(2): 203－207.

Design of 6-DOF parallel mechanical leg of wheel-leg hybrid quadruped robot

Qu Mengke1,2,3, Wang Hongbo1,3※, Rong Yu2
(1. Parallel Robot and Mechatronic System Laboratory of Hebei Province, Yanshan University, Qinhuangdao 066004, China; 2. College of Urban Construction, Hebei Normal University of Science and Technology, Qinhuangdao 066004, China; 3. Key Laboratory of Advanced Forging & Stamping Technology and Science of Ministry of Education, Yanshan University, Qinhuangdao 066004, China)

In the field of agricultural engineering, a lot of work is carried out on rough terrains, such as rugged mountains or hills. Mobile robots are very suitable to be used in these areas, and these kinds of robots can work in the rugged mountains or hills environment without caring about the safety of workers. The wheel-leg hybrid quadruped robot is very suitable to be used in agricultural engineering. It can move with the dynamic driving wheels in the road with high speed, and also can walk by stepping alternately in the ruins with its mechanical legs. The wheel-leg hybrid quadruped robot can also skate in a flat road by the wheels without dynamic driving, and in this state, the robot can obtain the maximum speed with the minimum energy consumption. In order to design a kind of wheel-leg hybrid agricultural quadruped robot, which can achieve walking, dynamic wheel moving, and roller-skating, a new mechanical leg based on the 3-UPS(U-universal joint, P-prismatic joint, S-spherical joint) parallel mechanism is proposed. The structure parameters of the mechanical leg are determined. The design schemes of the mechanical leg and the wheel-leg hybrid quadruped robot are given. First, using the vector chain method, the inverse position equation is presented, and the velocity transmission model is established. The workspace analysis of the leg mechanism is performed and the 3D (three-dimensional) map of the workspace is drawn by searching method. The relationship between the structural parameters of the mechanism and the workspace is revealed. The 3D map of condition number of Jacobian matrix is drawn in the workspace based on the velocity transmission model. Also, a set of kinematics performance evaluation indices are defined, and the kinematics dexterity of the leg mechanism is analyzed. And the relationship curves between structure parameters and the kinematics performance evaluation indices are drawn. These curves reveal the influence of structural parameters on the flexibility of the mechanism. Then, based on the indices of workspace and kinematics dexterity, the structure parameters are analyzed by Monte Carlo method. By establishing the probability space model of each structure parameter, an excellent set of structural parameters are found: The distance between two universal joint’s rotation center points of the fixed platform is 230 mm, the distance between two spherical joint’s rotation center points of the moving platform is 70 mm, the maximum diameter of the telescopic sleeve is 60 mm, and the lengths of each branch’s sleeve and the telescopic rod are both 500 mm. Finally, based on the excellent set of structural parameters, the virtual prototypes of wheel-leg hybrid quadruped robot and its parallel mechanical leg are designed. The motion simulation analysis of the virtual prototype is performed, and the driving speed curves of parallel mechanical leg’s driving joints are obtained. Simulation results show that: The driving parameters of the mechanical legs are very stable, and the peak values of the driving parameters are within the reasonable range. These prove that the design scheme and the structural parameters of the mechanical leg are very reasonable. The results provide the theoretical reference for further study of wheel-leg hybrid quadruped robot.

robots; kinematics; design; parallel mechanical leg; workspace analysis; performance evaluation index

10.11975/j.issn.1002-6819.2017.11.004

TP242.6

A

1002-6819(2017)-11-0029-09

曲夢可，王洪波，榮 譽. 輪腿混合四足機器人六自由度并聯(lián)機械腿設(shè)計[J]. 農(nóng)業(yè)工程學(xué)報，2017，33(11)：29－37.

10.11975/j.issn.1002-6819.2017.11.004 http://www.tcsae.org

Qu Mengke, Wang Hongbo, Rong Yu. Design of 6-DOF parallel mechanical leg of wheel-leg hybrid quadruped robot[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2017, 33(11): 29－37. (in Chinese with English abstract) doi：10.11975/j.issn.1002-6819.2017.11.004 http://www.tcsae.org

2016-11-15

2017-05-18

國家科技支撐計劃項目（2015BAI06B01）；河北省高等學(xué)?？茖W(xué)技術(shù)研究青年基金項目（QN2015185）；河北科技師范學(xué)院博士啟動基金項目（2015YB004）

曲夢可，女，黑龍江齊齊哈爾人，博士生，講師，主要從事并聯(lián)機器人理論與應(yīng)用方面的研究。秦皇島 燕山大學(xué)機械工程學(xué)院，066004。Email：lixiangcg@126.com

※通信作者：王洪波，男，教授、博士生導(dǎo)師，國家“千人計劃”特聘專家，主要從事康復(fù)機器人和微創(chuàng)手術(shù)機器人方面的研究。秦皇島 燕山大學(xué)機械工程學(xué)院，066004。Email：hongbo_w@ysu.edu.cn