張建斌 宋榮貴 陳偉海 張廣萍

(北京航空航天大學(xué) 機械工程及自動化學(xué)院,北京 100191)

基于運動靈活性的蟑螂機器人機構(gòu)參數(shù)優(yōu)化

張建斌 宋榮貴 陳偉海 張廣萍

(北京航空航天大學(xué) 機械工程及自動化學(xué)院,北京 100191)

從仿生蟑螂機器人機構(gòu)特點出發(fā),基于運動靈活性,選擇橢圓形身體布局,分別以單腿工作空間和整機雅克比矩陣的條件數(shù)倒數(shù)作為靈巧度指標(biāo),在兼顧運動靈活性和可靠性的基礎(chǔ)上,對機器人機構(gòu)參數(shù)進行優(yōu)化配置,選擇了最優(yōu)的桿長比例.利用分析得出的優(yōu)化尺寸建立 ADAMS參數(shù)化仿真模型進行實驗研究,仿真結(jié)果與理論分析相吻合,驗證了優(yōu)化配置的可行性和正確性,為樣機的研制和機器人的驅(qū)動及控制等進一步研究奠定了基礎(chǔ),也為其他六足機器人的開發(fā)提供了參考.

仿生蟑螂機器人;靈活性;優(yōu)化;雅克比矩陣

仿生蟑螂機器人是基于蟑螂運動靈活穩(wěn)定,對地形適應(yīng)能力強等優(yōu)點而開發(fā)的并聯(lián)運動機構(gòu),通常采用三角步態(tài)行進[1],具有較好的機動性,對不平路面適應(yīng)能力突出,可以輕松跨過較大障礙物.因此在抗震救災(zāi)、搜索救援、外星探索等領(lǐng)域有著廣泛的應(yīng)用[2].

從機構(gòu)學(xué)角度看,仿生蟑螂是一個復(fù)雜的冗余驅(qū)動多支鏈并聯(lián)機構(gòu),優(yōu)化配置其機構(gòu)參數(shù),提高運動靈活性和穩(wěn)定性極其重要,目前主要是采用工作空間和靈巧度進行優(yōu)化[3-5].

工作空間是機器人的操作區(qū)域,是機器人運動性能的重要指標(biāo).而靈巧度則可以認(rèn)為是表征機器人自主改變其位姿或方向以及傳遞力和力矩的能力[6],常用雅克比矩陣條件數(shù)和可操作度[2-3]表示.

國內(nèi)外許多學(xué)者基于雅克比矩陣條件數(shù)、工作空間以及全局靈巧度指標(biāo)[4]對多種機器人進行了研究[7-10].采用工作空間和基于雅克比矩陣的靈巧度指標(biāo),對機器人的結(jié)構(gòu)參數(shù)進行優(yōu)化配置,其結(jié)果更加可靠和準(zhǔn)確,在體現(xiàn)運動靈活性的基礎(chǔ)上,保證了運動的準(zhǔn)確和可靠性,同時也可以使機器人盡量遠(yuǎn)離奇異空間.

本文從仿生蟑螂機器人的機構(gòu)學(xué)特點出發(fā),基于運動靈活性,分別以單腿工作空間和整機雅克比矩陣的條件數(shù)倒數(shù)作為靈巧度指標(biāo),對其機構(gòu)參數(shù)進行優(yōu)化配置.利用分析得出的優(yōu)化尺寸建立了參數(shù)化模型進行仿真研究,驗證了優(yōu)化配置的可行性和正確性,為樣機的研制鋪平了道路,也為其他六足機器人的開發(fā)提供了參考.

1 蟑螂機器人機體結(jié)構(gòu)

蟑螂有 6條腿,對稱式分布,一般研究常用的機器蟑螂結(jié)構(gòu)如圖 1a所示.機體成長方形,六足對稱分布,每條腿有 4個關(guān)節(jié),分別為髖關(guān)節(jié)、大腿、小腿和踝關(guān)節(jié),其中前 3個關(guān)節(jié)為驅(qū)動關(guān)節(jié),各關(guān)節(jié)之間的連桿分別稱為基節(jié)、股節(jié)和脛節(jié).

圖1 蟑螂機器人機構(gòu)簡圖

實際蟑螂及大多數(shù)昆蟲的身體都不是長方形,而是呈橢圓形[11],后者運動性能更好.

圖2為等長寬比、不同結(jié)構(gòu)的髖關(guān)節(jié)擺動范圍及支撐三角形,陰影部分表示髖關(guān)節(jié)可達到的轉(zhuǎn)角范圍.圖 3為支撐三角形對比,DE與 D′E′為表征機器人運動穩(wěn)定性的重要指標(biāo)[12]:縱向穩(wěn)定裕量 SL.可以看出,橢圓形布局減少了腿的碰撞,增大了髖關(guān)節(jié)轉(zhuǎn)動范圍,提高了運動靈活性;同時明顯增大了縱向穩(wěn)定裕量,提高了機器人的運動穩(wěn)定性.因此,本研究中的仿生蟑螂機器人采用橢圓型的身體結(jié)構(gòu).

圖2 兩種結(jié)構(gòu)髖關(guān)節(jié)擺角及支撐三角形

圖3 支撐三角形對比

2 基于單腿工作空間的參數(shù)優(yōu)化

機器人擺動腿可視為串聯(lián)機械臂,其足端所能到達的工作空間可以參照機械臂工作空間求得,并作為衡量機器人運動能力的重要指標(biāo).

2.1 仿生蟑螂步行足工作空間求解

蟑螂機器人足端工作空間就是機器人足端在機構(gòu)限制下所能達到的空間點的集合,決定了機器人所能選擇的立足點范圍.工作空間越大,機器人末端操作空間越大,步行足的靈活性也越大.

應(yīng)用蒙特卡洛法隨機選取關(guān)節(jié)空間變量組合,然后根據(jù)機器人正向運動學(xué)計算出足端坐標(biāo),這些坐標(biāo)值的集合就形成了機器人足端的工作空間[13].

取機器人一條腿為研究對象,根據(jù) D-H法建立坐標(biāo)系,如圖 4所示,表 1為其 D-H參數(shù).

圖4 步行足 D-H坐標(biāo)系示意圖

表 1 步行足D-H參數(shù)表

由機器人前向運動學(xué)可知,步行足末端 A在固定坐標(biāo)系 O-xyz中的坐標(biāo)為

在各個關(guān)節(jié)變量的變化范圍內(nèi),隨機生成 n組關(guān)節(jié)變量的組合,由式(1)求出其固定坐標(biāo)值,將 n組點同時顯示出來,就形成了機器人步行足擺動腿的工作空間點云圖.

圖5所示為采用 30 000個隨機點,取 L1=50mm,L2=100mm,L3=200mm時步行足工作空間點云圖及其在 xy平面的投影.

圖5 擺動步行足工作空間及其 xy面投影

2.2 工作空間大小與關(guān)節(jié)長度的關(guān)系

機器蟑螂單腿工作空間的體積大小,直接決定了其躲避障礙和選擇立足點的空間大小.在各個關(guān)節(jié)轉(zhuǎn)角范圍一定的情況下,各個關(guān)節(jié)桿的長度比例是影響工作空間大小的主要因素.因此以工作空間體積大小為目標(biāo)合理配置關(guān)節(jié)桿長.

2.2.1 工作空間大小計算

工作空間點云圖顯示了工作空間的形狀,所得到的是一系列離散的數(shù)據(jù)點.其體積大小則需要根據(jù)這些離散點,采用微積分的思想求出[12].

具體步驟如下:1)沿 z向,將工作空間等分為 n塊平面片;2)對每個平面片,沿 x方向再次等分為 m個矩形條,用每個矩形條的面積和來近似實際面積;

3)求和得出每個平面片的面積,與 z向間距相乘后再求和,即可得出工作空間的近似體積.

對于可能存在的空洞,需要進行判斷:將 x方向等分的 m個矩形長條中的 y坐標(biāo)進行排序,然后判斷相鄰的兩個值是否相差很大,例如若超過等分間距的 3倍,即視為空洞,加以剔除.

2.2.2 工作空間大小與關(guān)節(jié)長度比例的關(guān)系

隨著各個關(guān)節(jié)桿長度比例的不同,機器人步行足工作空間大小在不斷變化,因此,需要選擇合理的長度比例配置,滿足工作空間最大的原則.

設(shè)機器人的單腿長度為 350mm,其中基節(jié)比例為 μ1,股節(jié)比例為 μ2,脛節(jié)則為 1-μ1-μ2.取μ1∈ [0,0.4],μ2∈ [0,0.6],編程計算關(guān)節(jié)比例和工作空間體積的關(guān)系,結(jié)果如圖 6所示.

圖6 關(guān)節(jié)比例與工作空間體積關(guān)系

可以看出,基節(jié)比例在[0,0.1]之間,股節(jié)比例在[0,0.3]之間時,工作空間體積較大,此時單腿的靈活性較高.機器人可以在較大的工作空間內(nèi)自主選擇立足點,從而可以更加靈活地適應(yīng)各種復(fù)雜的路面情況.

3 基于軀體靈巧度的參數(shù)優(yōu)化

蟑螂機器人處于站立或者采用三角步態(tài)行走時,其軀體從機構(gòu)學(xué)角度看,分別是一個由 6條、3條支撐腿組成的復(fù)合多變的多支鏈閉環(huán)并聯(lián)機構(gòu).

運動機構(gòu)應(yīng)該遠(yuǎn)離奇異形位.當(dāng)機器人接近奇異形位時,其雅克比矩陣為病態(tài)矩陣,逆矩陣精度降低,從而使輸入和輸出運動間的傳遞失真.

靈巧度就是衡量這種失真程度的指標(biāo),目前對于靈巧性的考察,主要有雅克比矩陣條件數(shù)、可操作度等指標(biāo).矩陣的條件數(shù)定量的表示矩陣求逆的精度和穩(wěn)定性,因此本文用矩陣條件數(shù)來表示機器人的靈巧性.

3.1 仿生蟑螂機體雅克比矩陣

對于仿生蟑螂這樣的多支鏈并聯(lián)機構(gòu),首先要研究其單腿的雅克比矩陣[14-15],建立相應(yīng)的坐標(biāo)系,如圖 7所示.

圖7 仿生蟑螂步行足相關(guān)坐標(biāo)系

從機體開始,單腿依次由一個球關(guān)節(jié)(與地接觸)和 3個轉(zhuǎn)動關(guān)節(jié)組成.球關(guān)節(jié)可以看成圖 8所示的 3個串聯(lián)轉(zhuǎn)動關(guān)節(jié)的組合.

圖8 球關(guān)節(jié)簡化為旋轉(zhuǎn)關(guān)節(jié)

主運動副軸線用單位矢量Si表示,相鄰軸線間公法線為單位矢量 a12,a23,…,aij,公法線間沿Si的偏距為 Si,公法線長度為 aij,公法線間轉(zhuǎn)角為 θj,坐標(biāo)系間轉(zhuǎn)角為 αij.

機器人單腿分支關(guān)節(jié)角與仿生蟑螂機體之間的關(guān)系見下式:

其中

P為機體重心在分支腿末端坐標(biāo)系中的坐標(biāo),根據(jù)幾何關(guān)系和各個關(guān)節(jié)桿的長度,向末端坐標(biāo)系進行投影可以獲得.初始時:S1=[0,0,1]T,a12=[cosθ1,sinθ1,0]T.

蟑螂機器人通常采用三角步態(tài)行走,有三條支撐腿,不妨取 1,3,5腿.在此位姿下,這 3個分支腿與機體的運動關(guān)系分別為

蟑螂機器人各分支中只有 4,5,6關(guān)節(jié)為主動關(guān)節(jié),因此,取出上面各矩陣的 4,5,6行組成:

3.2 基于靈巧度的機構(gòu)參數(shù)優(yōu)化

表 2為采用三足支撐爬行狀態(tài)下仿生蟑螂1,3,5腿的相關(guān)參數(shù).

表 2 仿生蟑螂支撐腿坐標(biāo)系相關(guān)參數(shù)

由式(2)～式(9)可計算出此位姿下機器人的雅克比矩陣.在固定的形位下,雅克比矩陣及其條件數(shù)和機器人的機構(gòu)尺寸關(guān)系緊密.因此,以雅克比矩陣的條件數(shù)倒數(shù)為靈巧度指標(biāo)優(yōu)化關(guān)節(jié)參數(shù).

采用 Frobenius范數(shù)計算雅克比矩陣條件數(shù),G表示雅克比矩陣,則靈巧度指標(biāo)為

根據(jù)不同的關(guān)節(jié)長度比例配置,以 η∈[0,1]為指標(biāo),在 MATLAB中編程計算出關(guān)節(jié)桿長和靈巧度的關(guān)系如圖 9所示.

圖9 靈巧度與關(guān)節(jié)長度比例關(guān)系

可以看出,當(dāng)基節(jié)比例在[0,0.1]之間,股節(jié)比例在[0.3,0.6]之間時,機器人靈巧度較大,接近奇異形位時,輸入和輸出之間的誤差最小,機器人可以穩(wěn)定可靠地執(zhí)行運動命令,整機運動性能較高且靈活可靠.

綜合可知,采用橢圓對稱型身體結(jié)構(gòu),基節(jié)桿長取為單腿總長的 0.05,股節(jié)比例取為 0.3,脛節(jié)比例為 0.65,蟑螂機器人單腿和整機的運動靈活性和可靠性都比較好,機器人可以在較大的范圍內(nèi)適應(yīng)復(fù)雜路面情況,靈活選擇合適的立足點,同時能保證較高的運動精度和可靠性.

4 仿真研究

利用 ADAMS參數(shù)化建模和評估功能,建立仿生蟑螂機器人的參數(shù)化模型,通過試驗設(shè)計(DOE,Design Of Experiments)的方法同時研究基節(jié)和股節(jié)比例變化對機器人整體的影響.

采用文獻[9]提出的評價指標(biāo)靈活度 F作為試驗設(shè)計的評價目標(biāo).

式中,Sx,Sy,Sz和 φx,φy,φz分別表示機器人沿 x,y,z 3個方向所能移動和轉(zhuǎn)動的最大范圍.

參照文獻[11],利用 ADAMS建立機器人參數(shù)化模型,見圖 10.將基節(jié)和股節(jié)的比例設(shè)置為參變量,以 F最大化為目標(biāo)進行 DOE計算,計算結(jié)果圖 11.基節(jié)比例范圍取[0.01,0.2],股節(jié)比例范圍取[0.3,0.5].

圖10 ADAMS中仿生蟑螂機器人參數(shù)化模型

圖11 ADAMS試驗設(shè)計結(jié)果

可以看出,當(dāng)基節(jié)比例較小時 (圖 11中0.01～0.045),由于容易發(fā)生干涉,F較小;當(dāng)基節(jié)比例為 0.045,股節(jié)比例為 0.3時,F最大,表明此時機器人機體所能運動的范圍和運動能力最大;之后隨著基節(jié)和股節(jié)比例的增大,F減小.

仿真結(jié)果表明:在不影響整機布置和裝配關(guān)系時,取基節(jié)比例 0.045,股節(jié)比例 0.3時,機器人具有較好的運動能力和靈活性.這與理論分析中所取的基節(jié)比例 0.05和股節(jié)比例 0.3相一致,從而驗證了理論分析的正確性和可行性.

5 結(jié) 論

本文從仿生蟑螂機器人的機構(gòu)學(xué)特點出發(fā),選擇采用橢圓形身體布局,基于運動靈活性分別以單腿的工作空間和整機的雅克比矩陣條件數(shù)倒數(shù)作為靈巧度目標(biāo),對其機構(gòu)參數(shù)進行優(yōu)化,確定了各個關(guān)節(jié)桿長的最優(yōu)配置.并通過 ADASMS仿真模型,進行了試驗設(shè)計,結(jié)果表明優(yōu)化后的機器人運動性能良好,運動靈活,與理論分析吻合,驗證了優(yōu)化配置的可行性和正確性,為其他六足機器人的驅(qū)動和控制等進一步研究奠定了基礎(chǔ).

References)

[1]Bai Shaoping,Low K H,Guo Weimiao.Kinematographic experimentson legmovements and body trajectoriesof cockroach walking on diffent terrain[C]//Proc of IEEE Inter Conf on Robotics and Automation.San Francisco:IEEE,2000:2605-2610

[2]Chen Weihai,Yang Guilin,Ho E H L,et al.Interactive motion controlofmodular reconfigurablemanipulators[C]//Inter Conf on Intelligent Robots and Systems.Las Vegas:IEEE,2003:1620-1625

[3]Gosselin CM,Angeles J.The optimum kinematic design ofa planar 3-DOF parallelmanipulators[J].ASME Journal of Mechanical Design,1998,110(1):35-40

[4]Gosselin C M,Angeles J.A global performance index for the kinematic optimization of robotic manipulators[J].ASME Journal of Mechanical Design,1991,113(3):220-226

[5]Kumar V.Characterization of workspacesofparallelmanipulators[J].ASME Journalof Mechanical Design,1992,114(3):368-375

[6]Xu Qingsong,Li Yangmin.K inematic analysis and optimization of a new compliant parallel Micromanipulator[J].Inter Journal of Advanced Robotic Systems,2006,3(4):351-358

[7]Kircanski M.Kinematic isotropy and optimal kinematic design of planar manipulators and a 3-DOF spatial manipulator[J].International Journal of Robotic Research,1996,15(1):61-77

[8]唐粲,贠超,欒勝.一種新型醫(yī)療機器人運動學(xué)及靈活性分析[J].北京航空航天大學(xué)學(xué)報,2005,31(7):748-752 Tang Can,Yun Chao,Luan Sheng.Analysis of kinematics and dexterity for new surgery robot[J].Journal of Beijing University of Aeronautics and Astronautics,2005,31(7):748-752(in Chinese)

[9]趙鐵石,趙永生,黃真.仿蟹步行機構(gòu)模型靈活度分析 [J].中國機械工程,1998,9(3):52-54 Zhao Tieshi,Zhao Yongsheng,Huang Zhen.The flexibility of walking machine imitating a crab[J].China Mechanical Engineering,1998,9(3):52-54(in Chinese)

[10]韓寶玲,王秋麗,羅慶生.六足仿生步行機器人足端工作空間和靈活度研究 [J].機械設(shè)計與研究,2006,22(4):10-12 Han Baoling,Wang Qiuli,Luo Qingsheng.Mechanical optimization and analyses of hex apod walking bio-robot[J].Machine Design and Research,2006,22(4):10-12(in Chinese)

[11]羅慶生,韓寶玲.現(xiàn)代仿生機器人設(shè)計[M].北京:電子工業(yè)出版社,2008:48-60 Luo Qingsheng,Han Baoling.The design ofmodern bionic robot[M].Beijing:Publish House of Electronics Industry,2008:48-60(in Chinese)

[12]曹毅.顯微外科手術(shù)機器人工作空間分析與綜合[D].天津:天津大學(xué)機械工程學(xué)院,2004 Cao Yi.Workspace analysisand synthesis ofmicrosurgical robot[D].Tianjing:School ofMechanical Engineering,TianjingUniversity,2004(in Chinese)

[13]張明.機器人工作空間仿真研究 [J].現(xiàn)代機械,2000(4):38-39 Zhang Ming.The simulation research of robot workspace[J].Modern Machinery,2000(4):38-39(in Chinese)

[14]黃真,孔令富,方躍法.并聯(lián)機器人機構(gòu)學(xué)理論及控制[M].北京:機械工業(yè)出版社,1997:91-103 Huang Zhen,Kong Lingfu,Fang Yuefa.Theory and control of mechanism for parallel robotics[M].Beijing:China Machine Press,1997:91-108(in Chinese)

[15]孫磊.仿生機器蟹原理樣機的研究[D].哈爾濱:哈爾濱工程大學(xué)機電工程學(xué)院,2005 Sun Lei.Research on theprototype of crab-like robot[D].Harbin:College of Mechanical and Electrical Engineering,Harbin Engineering University,2005(in Chinese)

(編 輯 :李 晶)

Mechanism optimization of bionic cock roach robot based on locomotion dexterity

Zhang Jianbin Song Ronggui Chen Weihai Zhang Guangping

(School of Mechanical Engineering and Automation,Beijing University of Aeronautics and Astronautics,Beijing 100191,China)

The oval body con figuration based on the characteristic of mechanism and the locomotion dexterity ofa bionic cockroach robot was chosen.The workspace of a single leg and the dexterity denoted by the reciprocal of condition number of the whole body's Jacobian matrix were used to optimize and configure the parameters of mechanism.The optimal length ratios of links were decided via dexterity and reliability.The parameterization simulation model was built in ADAMS.Simulation result according with the analysis by theory indicates that the optimization and con figuration are correct and suitable.This method provides a basis for the development of actual pro to and the control of bionic cockroach robot.It also can be referable for the design of other hexapod robots.

bionic cockroach robot;dexterity;optimization;Jacobian matrix

TP 242

A

1001-5965(2010)05-0513-05

2009-06-15

國家 863計劃資助項目(2008AA 04Z210);國家自然科學(xué)基金資助項目(60775059);北京市自然科學(xué)基金資助項目(3093021)

張建斌(1960-),男,江西萍鄉(xiāng)人,教授,jbzhang@buaa.edu.cn.