寇重光，謝濤，陳瀟，游鵬輝，肖曉暉

?

面向電廠管道的攀爬機(jī)器人運(yùn)動(dòng)規(guī)劃與仿真

寇重光，謝濤，陳瀟，游鵬輝，肖曉暉

(武漢大學(xué) 動(dòng)力與機(jī)械學(xué)院，湖北 武漢，430072)

針對(duì)電廠管道檢測(cè)作業(yè)，圍繞多屏平行管道環(huán)境中直管、管間和管屏間的攀爬作業(yè)需求，設(shè)計(jì)一種5自由度攀爬機(jī)器人，并進(jìn)行運(yùn)動(dòng)規(guī)劃分析。首先，分析運(yùn)動(dòng)需求，確定攀爬機(jī)器人的構(gòu)型；其次，針對(duì)直管攀爬、管間過(guò)渡和管屏過(guò)渡的攀爬運(yùn)動(dòng)進(jìn)行規(guī)劃，提出3種步態(tài)；之后，采用基于D-H法建立的機(jī)器人運(yùn)動(dòng)學(xué)模型，采用逆運(yùn)動(dòng)學(xué)求解對(duì)應(yīng)位姿點(diǎn)的關(guān)節(jié)角度；再通過(guò)5次多項(xiàng)式插值得到角度?時(shí)間序列；最后，采用ADAMS虛擬樣機(jī)技術(shù)進(jìn)行仿真，分析攀爬過(guò)程中的能耗及各關(guān)節(jié)的受力情況。研究結(jié)果表明：所規(guī)劃的步態(tài)能夠滿足運(yùn)動(dòng)需求；直管攀爬中隨著步距由50 mm增大至150 mm，機(jī)器人最大轉(zhuǎn)矩增加17.76%，總能耗降低39.94%，在保證關(guān)節(jié)轉(zhuǎn)矩足夠的情況下可通過(guò)增大步距以降低能耗；各工況中，管間過(guò)渡的旋轉(zhuǎn)關(guān)節(jié)與管屏過(guò)渡的夾持手爪所需力矩最大，在步態(tài)優(yōu)化與樣機(jī)設(shè)計(jì)時(shí)需重點(diǎn)校核。

管道攀爬機(jī)器人；運(yùn)動(dòng)規(guī)劃；運(yùn)動(dòng)學(xué)；仿真分析

對(duì)在役管道進(jìn)行定期維護(hù)對(duì)管道安全至關(guān)重要，目前多采用人工作業(yè)，其工作量大，效率低，危險(xiǎn)性高。開(kāi)發(fā)一種能夠在管道環(huán)境中作業(yè)的攀爬機(jī)器人具有重要意義。在電廠多屏管道環(huán)境中，機(jī)器人沿直管攀爬、管間和管屏過(guò)渡的運(yùn)動(dòng)規(guī)劃，是實(shí)現(xiàn)自主作業(yè)的關(guān)鍵。SPENKO等[1?2]研制的仿蟑螂機(jī)器人RiSE能夠在地面和各種垂直建筑物表面攀爬；ZHANG等[3]研制了含主體、頭部和尾部模塊的仿毛蟲攀爬機(jī)器人，研究了機(jī)器人在壁面上直行、轉(zhuǎn)彎、旋轉(zhuǎn)與滾動(dòng)的運(yùn)動(dòng)能力；LAM等[4?5]研制的Treebot能夠以蠕動(dòng)的方式在含分支機(jī)構(gòu)的樹木上爬行。YOON等[6]研制的三自由度桁架攀爬機(jī)器人Shady 3D，能夠在細(xì)長(zhǎng)方形截面桿構(gòu)成的三維桁架內(nèi)移動(dòng)，但攀爬位姿嚴(yán)重受限；TAVAKOLI等[7?8]研制的四自由度3D Climber串行夾持攀爬機(jī)器人能夠克服彎頭、T型連接、法蘭和圓桿的直徑變化；HAN等[9?10]研制了一種遙控管道外攀爬機(jī)器人，通過(guò)2個(gè)攀爬驅(qū)動(dòng)模塊和1個(gè)運(yùn)動(dòng)連接臂的協(xié)調(diào)運(yùn)動(dòng)進(jìn)行攀爬，可越過(guò)法蘭、閥體、彎頭等障礙。以上機(jī)器人的攀爬對(duì)象為單一桿件，不能實(shí)現(xiàn)電廠環(huán)境中2根管道之間的過(guò)渡。曹志華等[11]研制了五自由度電力鐵塔攀爬機(jī)器人，通過(guò)電磁吸附實(shí)現(xiàn)沿電力鐵塔角鋼攀爬、越障和轉(zhuǎn)向；江勵(lì)等[12?14]研制了模塊化構(gòu)型的五自由度仿尺蠖攀爬機(jī)器人Climbot，可以滿足更多的運(yùn)動(dòng)需求；KIM等[15?16]研制了一種基于視覺(jué)的爬桿機(jī)器人，采用五自由度構(gòu)型，通過(guò)圖像處理與激光傳感器輔助機(jī)器人進(jìn)行自主抓夾；吳偉國(guó)等[17]針對(duì)空間桁架結(jié)構(gòu)設(shè)計(jì)了雙臂手移動(dòng)機(jī)器人，采用六自由度串聯(lián)機(jī)構(gòu)在桁架內(nèi)移動(dòng)。以上4種機(jī)器人已實(shí)現(xiàn)基本攀爬功能，但沒(méi)有具體應(yīng)用于電廠管道，尚未對(duì)管間、管屏過(guò)渡進(jìn)行深入研究?；诖?，本文作者針對(duì)電廠的多屏管道，設(shè)計(jì)1種管道攀爬機(jī)器人。首先分析運(yùn)動(dòng)需求，確定機(jī)器人構(gòu)型；然后進(jìn)行運(yùn)動(dòng)規(guī)劃與運(yùn)動(dòng)學(xué)分析，提出直管攀爬、管間過(guò)渡、管屏過(guò)渡3種步態(tài)；最后進(jìn)行虛擬樣機(jī)仿真，分析比較不同工況下的關(guān)節(jié)力矩與能耗，為運(yùn)動(dòng)規(guī)劃的優(yōu)化以及樣機(jī)設(shè)計(jì)提供依據(jù)。

1 運(yùn)動(dòng)需求分析與構(gòu)型設(shè)計(jì)

1.1 運(yùn)動(dòng)需求分析

電廠環(huán)境中的管道主要為多屏平行排管，如圖1所示。圖1中：Ⅰ與Ⅱ表示兩屏平行管道，管屏距為1；①與②表示同一屏管道中的相鄰管道，管間距為2。應(yīng)用于其中的攀爬機(jī)器人應(yīng)具備沿豎直管的攀爬、同屏管道中相鄰管的管間過(guò)渡以及相鄰管屏間的管屏過(guò)渡等運(yùn)動(dòng)能力。

圖1 電廠管道模型

1.2 機(jī)器人構(gòu)型設(shè)計(jì)

機(jī)器人在三維空間內(nèi)攀爬至少需要4個(gè)自由度，但過(guò)渡攀爬時(shí)攀爬位姿受到嚴(yán)格限制，無(wú)法滿足任務(wù)需求；六自由度機(jī)器人能夠?qū)崿F(xiàn)三維空間攀爬的任意位姿[18]，但其控制難度較大。

考慮本文所研究的作業(yè)對(duì)象中多屏管道平行的特點(diǎn)，擬減少1個(gè)自由度，采用五自由度構(gòu)型。所設(shè)計(jì)的機(jī)器人機(jī)構(gòu)簡(jiǎn)圖與三維模型如圖2所示，其中a~e這5個(gè)旋轉(zhuǎn)自由度關(guān)節(jié)依次串聯(lián)構(gòu)成機(jī)器人本體，夾持手爪S1和S2安裝在首尾兩端。機(jī)器人一端夾持時(shí)，通過(guò)5個(gè)旋轉(zhuǎn)關(guān)節(jié)配合，末端手爪可沿，和軸移動(dòng)，也可繞和軸旋轉(zhuǎn)，滿足多屏管道環(huán)境的工作需求。

(a) 機(jī)構(gòu)簡(jiǎn)圖；(b) 三維模型

2 運(yùn)動(dòng)規(guī)劃

機(jī)器人采用一端手爪固定，另一端手爪移動(dòng)，兩手爪交替夾持的方式進(jìn)行攀爬。根據(jù)電廠管道環(huán)境的要求，提出3種攀爬步態(tài)。

2.1 直管攀爬步態(tài)

直管攀爬是機(jī)器人攀爬的基本步態(tài)，擬定1個(gè)步距的攀爬步態(tài)，如圖3所示。

(a) 初始姿態(tài)；(b) “M”型姿態(tài)；(c) 結(jié)束姿態(tài)

圖3(a)中，機(jī)器人兩手爪均抓緊管道，處于初始位置。

圖3(b) 中，手爪S2張開(kāi)，S1仍保持夾緊，單獨(dú)支撐機(jī)器人。旋轉(zhuǎn)關(guān)節(jié)b，c和d協(xié)調(diào)轉(zhuǎn)動(dòng)，機(jī)器人本體收縮呈“M”型姿態(tài)，使手爪S2前進(jìn)1個(gè)步距。

圖3(c)中，手爪S2夾緊管道，S1張開(kāi)，轉(zhuǎn)換為手爪S1支撐機(jī)器人。旋轉(zhuǎn)關(guān)節(jié)b，c和d反向協(xié)調(diào)轉(zhuǎn)動(dòng)，機(jī)器人本體伸展，恢復(fù)至初始姿態(tài)，手爪S1夾緊管道。至此，機(jī)器人前進(jìn)1個(gè)步距。

2.2 管間過(guò)渡步態(tài)

機(jī)器人完成1根管道的攀爬后，需要過(guò)渡到同一屏管道中相鄰管繼續(xù)作業(yè)，擬定管間過(guò)渡步態(tài)如圖4所示。

圖4(a)~(b) 中，手爪S1夾緊管道①，支撐機(jī)器人。手爪S2張開(kāi)，旋轉(zhuǎn)關(guān)節(jié)c和d協(xié)調(diào)轉(zhuǎn)動(dòng)，將手爪S2抬起一定高度離開(kāi)管道①，為機(jī)器人管間過(guò)渡作準(zhǔn)備。

(a) 初始姿態(tài)；(b) 準(zhǔn)備姿態(tài)；(c) 過(guò)渡姿態(tài)1； (d) 過(guò)渡姿態(tài)2；(e) 過(guò)渡姿態(tài)3；(f) 結(jié)束姿態(tài)

圖4(b)~(c)中，旋轉(zhuǎn)關(guān)節(jié)a轉(zhuǎn)動(dòng)，整個(gè)機(jī)器人繞關(guān)節(jié)a旋轉(zhuǎn)，進(jìn)行管間跨越。手爪S2運(yùn)動(dòng)至管道②的位置后，關(guān)節(jié)c和d反向協(xié)調(diào)轉(zhuǎn)動(dòng)，放下手爪S2，對(duì)管道②進(jìn)行夾持。

圖4(d)中，手爪S2夾緊管道②，支撐機(jī)器人。手爪S1張開(kāi)，抬起離開(kāi)管道①。

圖4(d)和(e)與圖4(b)和(c)類似，旋轉(zhuǎn)關(guān)節(jié)e轉(zhuǎn)動(dòng)，整個(gè)機(jī)器人繞關(guān)節(jié)e旋轉(zhuǎn)，進(jìn)行管間跨越，手爪S1運(yùn)動(dòng)至管道②位置，機(jī)器人恢復(fù)初始姿態(tài)。

圖4(f) 中，手爪S1夾緊管道②。至此，完成由管道①向②的管間過(guò)渡。

2.3 管屏過(guò)渡步態(tài)

管屏過(guò)渡是機(jī)器人第2種過(guò)渡攀爬步態(tài)，擬定步態(tài)如圖5所示。

圖5(a)~(b)中，手爪S1夾緊管道Ⅰ，支撐機(jī)器人。手爪S2張開(kāi)，將手爪S2抬起一定高度離開(kāi)管道Ⅰ，為機(jī)器人管屏過(guò)渡做準(zhǔn)備。

圖5 (c)中，旋轉(zhuǎn)關(guān)節(jié)b，c和d協(xié)調(diào)轉(zhuǎn)動(dòng)，將手爪S2移動(dòng)到預(yù)定位置。此時(shí)，c和d之間的連接橫梁平行于管道，關(guān)節(jié)e垂直于管道。

圖5(d)中，通過(guò)關(guān)節(jié)b，c和d協(xié)調(diào)轉(zhuǎn)動(dòng)，在保證關(guān)節(jié)e與管道垂直的同時(shí)，調(diào)整手爪S2位置使其對(duì)準(zhǔn)管道Ⅱ。隨后，手爪S2夾緊管道Ⅱ，至此，管屏過(guò)渡完成第1階段。

圖5 (e)與圖5(b)類似，手爪S1松開(kāi)，并抬起一定高度。手爪S2夾緊管道Ⅱ支撐機(jī)器人。

(a) 初始姿態(tài)；(b) 準(zhǔn)備姿態(tài)；(c) 過(guò)渡姿態(tài)1；(d) 過(guò)渡姿態(tài)2；(e) 過(guò)渡姿態(tài)3；(f) 過(guò)渡姿態(tài)4；(g) 結(jié)束姿態(tài)

圖5(f)和(g)與圖5(c)和(d)類似，通過(guò)關(guān)節(jié)b，c和d協(xié)調(diào)轉(zhuǎn)動(dòng)，將手爪S1移動(dòng)至預(yù)定位置，此時(shí)，c和d間橫梁平行于管道，關(guān)節(jié)b垂直于管道。再調(diào)整手爪S1位置，使其對(duì)準(zhǔn)管道Ⅱ，同時(shí)機(jī)器人恢復(fù)初始姿態(tài)，手爪S1夾緊管道Ⅱ。至此，完成由管屏Ⅰ向管屏Ⅱ的過(guò)渡。

3 運(yùn)動(dòng)學(xué)分析

機(jī)器人運(yùn)動(dòng)學(xué)反映各個(gè)關(guān)節(jié)與末端執(zhí)行器間的運(yùn)動(dòng)關(guān)系，包括機(jī)器人的運(yùn)動(dòng)學(xué)建模和逆運(yùn)動(dòng)學(xué)求解。解出各關(guān)節(jié)變量后，插值求得機(jī)器人各關(guān)節(jié)運(yùn)動(dòng)角度?時(shí)間序列。

3.1 機(jī)器人運(yùn)動(dòng)學(xué)模型

管道攀爬機(jī)器人運(yùn)動(dòng)學(xué)模型如圖6所示?；谛拚鼶?H法[18?19]，機(jī)器人上端的夾持手爪S1固定時(shí)，以其夾持中心為參考坐標(biāo)系原點(diǎn)0，在各關(guān)節(jié)軸線上取原點(diǎn)1~5，依次建立坐標(biāo)系{0}~{5}。機(jī)器人D?H參數(shù)如表1所示。

圖6 管道攀爬機(jī)器人運(yùn)動(dòng)學(xué)模型

表1 機(jī)器人D-H參數(shù)

注：?1為繞X?1軸從Z?1旋轉(zhuǎn)到Z的角度；d為沿Z軸從X?1移動(dòng)到X的距離；為繞Z軸從X?1旋轉(zhuǎn)到X的 角度。

3.2 運(yùn)動(dòng)學(xué)方程

機(jī)器人末端夾持手爪S2的坐標(biāo)系相對(duì)于固定端S1處參考坐標(biāo)系的位姿轉(zhuǎn)換矩陣為

，，和均取1，2，3，4和5，下同。

3.3 逆運(yùn)動(dòng)學(xué)求解

或

或

由式(2)~(6)得：

或

或

其逆解存在多解，綜合考慮機(jī)器人結(jié)構(gòu)限制、位姿和工作空間等因素確定最優(yōu)解，得到各關(guān)節(jié)所需運(yùn)動(dòng)角度。

3.4 關(guān)節(jié)軌跡插值

為保證機(jī)器人運(yùn)動(dòng)平穩(wěn)、無(wú)沖擊，要求在所設(shè)計(jì)的攀爬步態(tài)須經(jīng)過(guò)的關(guān)鍵路徑點(diǎn)處各關(guān)節(jié)的速度、加速度為零。采用5次多項(xiàng)式函數(shù)對(duì)各路徑點(diǎn)的關(guān)節(jié)角度進(jìn)行插值，

約束條件：

式中：C為常量；f為運(yùn)行時(shí)間；0為前一路徑點(diǎn)關(guān)節(jié)角度；f為后一路徑點(diǎn)關(guān)節(jié)角度。

求解C得到5次多項(xiàng)式為

4 攀爬仿真分析

本機(jī)器人以電廠多屏平行管道為作業(yè)對(duì)象。圖1中管道尺寸參數(shù)為：管屏距1=600 mm，管間距2= 200 mm。圖6中機(jī)器人尺寸為：1=260 mm，2=3=180 mm。所設(shè)計(jì)的機(jī)器人各模塊參數(shù)如表2所示。

表2 機(jī)器人模塊參數(shù)

在ADAMS環(huán)境中建立虛擬樣機(jī)模型如圖7所示。通過(guò)對(duì)不同工況進(jìn)行仿真，驗(yàn)證機(jī)器人的運(yùn)動(dòng)能力，比較分析攀爬能耗以及各關(guān)節(jié)的受力情況。

4.1 直管攀爬仿真與分析

根據(jù)2.1節(jié)中規(guī)劃的步態(tài)進(jìn)行攀爬仿真。直管攀爬過(guò)程中，只需b，c和d這3個(gè)關(guān)節(jié)聯(lián)合運(yùn)動(dòng)，其中b與d這2個(gè)關(guān)節(jié)結(jié)構(gòu)對(duì)稱，受力情況近似。150 mm步距時(shí)，b和c這2個(gè)關(guān)節(jié)的力矩時(shí)程曲線如圖8 所示。

分析圖8可知：1) 旋轉(zhuǎn)關(guān)節(jié)力矩存在3處異常突變，分別在開(kāi)始運(yùn)動(dòng)時(shí)刻、7.5 s兩手抓交替夾持時(shí)刻、運(yùn)動(dòng)結(jié)束時(shí)刻。這是由于仿真模型中各零件全部設(shè)置為剛性接觸，而以上時(shí)刻2只手爪同時(shí)夾持，造成過(guò)約束，使得關(guān)節(jié)力矩突變。在實(shí)際工作過(guò)程中，由于機(jī)構(gòu)存在一定間隙與彈性，將不會(huì)發(fā)生這種情況；2) 在0.6~7.3 s，機(jī)器人逐漸收縮成“M”型姿態(tài)，旋轉(zhuǎn)關(guān)節(jié)b為主要承力關(guān)節(jié)，關(guān)節(jié)力矩隨機(jī)器人姿態(tài)變化逐漸增大，至7.3 s達(dá)到最大值4.31 N·m；3) 兩手爪在7.6 s交替夾持后，關(guān)節(jié)b轉(zhuǎn)變?yōu)閺膭?dòng)關(guān)節(jié)，關(guān)節(jié)力矩減小。

圖7 機(jī)器人虛擬樣機(jī)模型

旋轉(zhuǎn)關(guān)節(jié)：1—b；2—c。

取50，75，100，125和150 mm這5種攀爬步距，以相同的速度攀爬1 500 mm進(jìn)行仿真。機(jī)器人關(guān)節(jié)力矩及能量消耗有所不同，其最大關(guān)節(jié)力矩及總能耗見(jiàn)表3。

由表3可知：隨著攀爬步距增大，機(jī)器人最大關(guān)節(jié)轉(zhuǎn)矩增大，能量消耗降低。當(dāng)步距由50 mm增大至150 mm時(shí)，機(jī)器人最大轉(zhuǎn)矩增加17.76%，總能耗降低39.94%。在關(guān)節(jié)電機(jī)負(fù)載允許的條件下應(yīng)增大步距，以節(jié)省能量。

表3 以不同步距攀爬時(shí)關(guān)節(jié)轉(zhuǎn)矩及能耗

4.2 過(guò)渡攀爬仿真與分析

根據(jù)2.2節(jié)與2.3節(jié)中規(guī)劃的步態(tài)，進(jìn)行管間過(guò)渡與管屏過(guò)渡攀爬仿真，用時(shí)均為29 s。管間過(guò)渡需5個(gè)關(guān)節(jié)聯(lián)合運(yùn)動(dòng)，由于結(jié)構(gòu)對(duì)稱性，取a，b和c這3個(gè)關(guān)節(jié)進(jìn)行分析，其力矩時(shí)程曲線如圖9所示。管屏過(guò)渡取b和c這2個(gè)關(guān)節(jié)進(jìn)行分析，其力矩時(shí)程曲線如圖10所示。

分析圖9和圖10可知：

1) 與直管攀爬類似，管間過(guò)渡與管屏過(guò)渡運(yùn)動(dòng)中，除2只手爪同時(shí)夾持的3個(gè)時(shí)刻旋轉(zhuǎn)關(guān)節(jié)力矩存在異常突變外，機(jī)器人整體上運(yùn)動(dòng)平穩(wěn)。

2) 在管間過(guò)渡攀爬過(guò)程中，在6.4~10.1 s時(shí)，機(jī)器人一端夾持，旋轉(zhuǎn)關(guān)節(jié)a帶動(dòng)機(jī)器人向目標(biāo)管道移動(dòng)，是主要承力關(guān)節(jié)，其關(guān)節(jié)力矩隨著機(jī)器人的旋轉(zhuǎn)逐漸增大；在10.1 s運(yùn)動(dòng)至目標(biāo)位置后，達(dá)到最大值6.71 N·m。

旋轉(zhuǎn)關(guān)節(jié)：1—a；2—b；3—c。

旋轉(zhuǎn)關(guān)節(jié)：1—b；2—c。

3) 管屏過(guò)渡攀爬過(guò)程中，旋轉(zhuǎn)關(guān)節(jié)c是主要承力關(guān)節(jié)，其關(guān)節(jié)力矩在14.7 s手爪S2運(yùn)動(dòng)至目標(biāo)管道夾持時(shí)達(dá)到最大值3.99 N·m。

4.3 不同工況下各模塊關(guān)節(jié)力矩對(duì)比

在攀爬運(yùn)動(dòng)過(guò)程中，手爪的夾持性能對(duì)機(jī)器人的安全運(yùn)行至關(guān)重要。以管屏過(guò)渡為例，其手爪力矩時(shí)程曲線如圖11所示。

由圖11分析：手爪夾持管道的瞬間存在沖擊碰撞，力矩達(dá)到極值，隨后趨于平穩(wěn)；受重力影響，下端手爪S2夾持時(shí)所需驅(qū)動(dòng)力矩更大，在15.2 s達(dá)到最大值22.11 N·m。

夾持手爪：1—S1；2—S2。

不同工況下各模塊關(guān)節(jié)力矩如表4所示。從表4可以看出：機(jī)器人動(dòng)作幅度越大，關(guān)節(jié)力矩越大；在旋轉(zhuǎn)關(guān)節(jié)中，管間過(guò)渡過(guò)程中a關(guān)節(jié)所需力矩最大，為6.71 N·m；夾持手爪中，管屏過(guò)渡過(guò)程所需手爪力矩最大，為22.11 N·m。各關(guān)節(jié)最大力矩均小于電機(jī)額定負(fù)載(見(jiàn)表2)，驗(yàn)證了機(jī)器人的攀爬能力。

表4 不同工況下各模塊關(guān)節(jié)力矩

5 結(jié)論

1) 針對(duì)電廠的多屏管道環(huán)境設(shè)計(jì)了1種管道攀爬機(jī)器人，根據(jù)任務(wù)需求提出直管攀爬、管間過(guò)渡、管屏過(guò)渡這3種步態(tài)，并通過(guò)運(yùn)動(dòng)學(xué)理論規(guī)劃出各關(guān)節(jié)的角度?時(shí)間序列。

2) 通過(guò)ADAMS軟件進(jìn)行虛擬樣機(jī)仿真。仿真結(jié)果表明：機(jī)器人能實(shí)現(xiàn)所規(guī)劃的運(yùn)動(dòng)；直管攀爬應(yīng)增大步距以節(jié)省能量；各工況中，管間過(guò)渡的旋轉(zhuǎn)關(guān)節(jié)與管屏過(guò)渡的夾持手爪負(fù)載最大，對(duì)步態(tài)優(yōu)化與樣機(jī)設(shè)計(jì)具有指導(dǎo)意義。

[1] SPENKO M J, HAYNES G C, SAUNDERS J A, et al. Biologically inspired climbing with a hexapedal robot[J]. Journal of Field Robotics, 2008, 25(4/5): 223?242.

[2] AUTUMN K, BUEHLER M, CUTKOSKY M, et al. Robotics in scansorial environments[C]//Proceedings of SPIE: the International Society for Optical Engineering. Orlando, USA: SPIE, 2005: 291?302.

[3] ZHANG Houxiang, WANG Wei, GONZáLEZ-GóMEZ J, et al. Design and realization of a novel modular climbing caterpillar using low-frequency vibrating passive suckers[J]. Advanced Robotics, 2009, 23(7/8): 889?906.

[4] LAM T L, XU Y. A flexible tree climbing robot: Treebot-design and implementation[C]//Proceedings: IEEE International Conference on Robotics and Automation.Shanghai, China: IEEE, 2011: 5849?5854.

[5] LAM T L, XU Y. Climbing strategy for a flexible tree climbing robot?treebot[J]. IEEE Transactions on Robotics, 2011, 27(6): 1107?1117.

[6] YOON Y, RUS D. Shady 3D: a robot that climbs 3D trusses[C]//Proceedings: IEEE International Conference on Robotics and Automation. Rome, Italy: IEEE, 2007: 4071?4076.

[7] TAVAKOLI M, MARQUES L. 3DCLIMBER: climbing and manipulation over 3D structures[J]. Mechatronics, 2011, 21(1): 48?62.

[8] TAVAKOLI M, MARJOVI A, MARQUES L, et al. 3DCLIMBER: a climbing robot for inspection of 3D human made structures[C]//2008 IEEE/RSJ International Conference on Intelligent Robots and Systems, IROS. Nice, France: IEEE, 2008: 4130?4135.

[9] HAN S C, AN J, MOON H. A remotely controlled out-pipe climbing robot[C]//2013 10th International Conference on Ubiquitous Robots and Ambient Intelligence, URAI 2013. Jeju, Korea: IEEE, 2013: 126.

[10] HAN S, AHN J, MOON H. Remotely controlled prehensile locomotion of a two-module 3D pipe-climbing robot[J]. Journal of Mechanical Science and Technology, 2016, 30(4): 1875?1882.

[11] 曹志華, 陸小龍, 趙世平, 等. 電力鐵塔攀爬機(jī)器人的步態(tài)分析[J]. 西安交通大學(xué)學(xué)報(bào), 2011, 45(8): 67?72. CAO Zhihua, LU Xiaolong, ZHAO Shiping, et al. Gait analysis for electricity pylon climbing robot[J]. Journal of Xi’an Jiaotong University, 2011, 45(8): 67?72.

[12] 江勵(lì).雙手爪式模塊化仿生攀爬機(jī)器人的研究[D]. 廣州: 華南理工大學(xué)機(jī)械與汽車工程學(xué)院, 2012: 17?48. JIANG Li. Development and analysis of a bio-inspired modular biped climbing robot[D]. Guangzhou: South China University of Technology. School of Mechanical & Automotive Engineering, 2012: 17?48.

[13] 朱海飛, 管貽生, 蔡傳武, 等.具有多種運(yùn)動(dòng)方式的小型模塊化雙手爪機(jī)器人MiniBibot[J]. 機(jī)器人, 2012, 34(2): 176?181, 189. ZHU Haifei, GUAN Yisheng, CAI Chuanwu, et al. Minibibot: a miniature modular biped robot with multi-locomotion modes[J]. Robot, 2012, 34(2): 176?181, 189.

[14] 吳文強(qiáng). 可重構(gòu)模塊化機(jī)器人建模、優(yōu)化與控制[D]. 廣州: 華南理工大學(xué)機(jī)械與汽車工程學(xué)院, 2013: 17?32. WU Wenqiang. Modeling.Optimation and control of reconfigurable modular robot[D]. Guangzhou: South China University of Technology. School of Mechanical & Automotive Engineering, 2013: 17?32.

[15] KIM J H, LEE J C, CHOI Y R. Vision-based pipe grasping scheme for a pole climbing robot[C]//2012 International Symposium on Optomechatronic Technologies, ISOT. Paris, France: IEEE, 2012: 6403252.

[16] KIM J H, LEE J C, CHOI Y R, et al. Automatic grasping of a pole climbing robot using a visual camera with laser line beams[C]//The 3rd International Conference on Control, Mechatronics and Automation, ICCMA. Barcelona, Spain: EDP Sciences, 2016: 03005.

[17] 吳偉國(guó), 徐峰琳. 空間桁架用雙臂手移動(dòng)機(jī)器人設(shè)計(jì)與仿真分析[J]. 機(jī)械設(shè)計(jì)與制造, 2007(3): 110?112. WU Weiguo, XU Fenglin. Design and simulation analysis of a dual arm & hands mobile robot used in space truss[J]. Machinery Design & Manufacture, 2007(3): 110?112.

[18] 熊有倫, 丁漢, 劉恩滄. 機(jī)器人學(xué)[M]. 4版. 北京: 機(jī)械工業(yè)出版社, 1993: 20?48. XIONG Youlun, DING Han, LIU Encang. Robotics[M]. 4th ed. Beijing: China Machine Press, 1993: 20?48.

[19] 王潤(rùn). 串聯(lián)機(jī)器人運(yùn)動(dòng)學(xué)分析、結(jié)構(gòu)優(yōu)化設(shè)計(jì)及仿真研究[D]. 天津: 天津大學(xué)機(jī)械學(xué)院, 2012: 11?20. WANG Run. Research on the kinematics analysis, structural optimization design and simulation of serial robot[D]. Tianjin: Tianjin University. School of Mechanical Engineering, 2012: 11?20.

(編輯 陳燦華)

Motion planning and simulation of climbing robot for power plant pipeline

KOU Chongguang, XIE Tao, CHEN Xiao, YOU Penghui, XIAO Xiaohui

(School of Power and Mechanical Engineering, Wuhan University, Wuhan 430072, China)

To meet the kinematic demands of climbing task along a straight pipe, between pipes or between calandria pipelines in a multipanel paralleled pipelines environment, a 5-DOF climbing robot was analyzed and developed for power plant detection. Firstly, based on the motion demand analysis, the climbing robot structure configuration was designed. Secondly, climbing motions along a straight pipe between pipes and between calandria pipelines were planned, and three kinds of gaits were proposed. Afterwards, the kinematical model was established by using the Denavit?Hartenberg method and inverse kinematics was used to solve the corresponding position joint angle. Then angle-time series were obtained by quintic polynomial interpolation method. Finally, energy consumption and the torque of joints during the climbing process were analyzed by virtual prototyping simulation based on ADAMS. The results show that the planned gait can meet the needs of movement. With the increase of step distance from 50 mm to 150 mm in the straight pipe climbing, the maximum torque of the robot increases by 17.76% and the total energy consumption reduces by 39.94%,energy can be saved by increasing step in case of sufficient torque. In each condition, the load of rotating joints in climbing between pipes and clamping claw in the climbing between pipe screen are the maximun, and they should be checked in gait optimization and prototype design.

pipeline climbing robot; motion planning; kinematics; simulation analysis

TP242.2

A

1672?7207(2018)08?1936?08

2017?08?10；

2017?10?12

國(guó)家自然科學(xué)基金資助項(xiàng)目(51675385)(Project(51675385) supported by the National Natural Science Foundation of China)

肖曉暉，博士，教授，從事特種機(jī)器人與微操作機(jī)器人研究；E-mail：xhxiao@whu.edu.cn

10.11817/j.issn.1672?7207.2018.08.014