鄭 杰 尚祖躍 竇益華 楊 旭

(1.西安石油大學(xué)機(jī)械工程學(xué)院 2.西安特種設(shè)備檢驗(yàn)檢測院 3.西北工業(yè)大學(xué)動力與能源學(xué)院)

0 引 言

管道已成為能源輸送、生活供水和生產(chǎn)化工等領(lǐng)域的主要運(yùn)輸載體[1-2]，但隨著使用時(shí)間的延長，管道會由于運(yùn)輸物質(zhì)的腐蝕、自身材料的老化以及施工質(zhì)量等，出現(xiàn)泄漏或破損等情況，造成環(huán)境污染，甚至嚴(yán)重威脅人類的生存安全，給國家?guī)聿豢晒懒康慕?jīng)濟(jì)損失，所以對管道進(jìn)行檢測很有必要[3-5]。然而，為了不占用土地資源，輸氣管道通常埋在地下，因此管線的維修檢測和及時(shí)更換成為一大難題[6-9]。針對此類問題，管道機(jī)器人應(yīng)運(yùn)而生，并成為國內(nèi)外相關(guān)領(lǐng)域研究的重點(diǎn)[10]。

我國在管道機(jī)器人領(lǐng)域的研究進(jìn)展迅速[11]，一些高等院校和科研院所[7]致力于研發(fā)不同種類的管道機(jī)器人。孫樂辰等[12]基于超聲波檢測技術(shù)，設(shè)計(jì)了一種能夠自主運(yùn)行，保證較大范圍變徑及適應(yīng)較小直徑管道檢測的內(nèi)檢測機(jī)器人。中國石油大學(xué)賈仕豪等[13]研究了一種油氣管道內(nèi)退磁檢測機(jī)器人，該機(jī)器人采用電機(jī)驅(qū)動輪結(jié)構(gòu)，可以通過攜帶磁體環(huán)的方式對管道進(jìn)行在線退磁。韓傳軍等[14]設(shè)計(jì)了一種管道內(nèi)封堵導(dǎo)流機(jī)器人，可快速解決管道的泄漏問題，并在管道不停輸?shù)那闆r下進(jìn)行管道封堵。李智強(qiáng)等[15]設(shè)計(jì)了一種搭載獨(dú)立驅(qū)動模塊的支撐式機(jī)器人，該機(jī)器人在管道內(nèi)可以完成直行、螺旋及轉(zhuǎn)彎等運(yùn)動，并能進(jìn)行姿態(tài)調(diào)整，具有較強(qiáng)的適應(yīng)性和穩(wěn)定性；但其機(jī)構(gòu)復(fù)雜且控制難度大。楊彩霞等[16-17]提出一種支撐式油氣管道機(jī)器人，該機(jī)器人采用一種集齒輪機(jī)構(gòu)、雙旋向絲杠螺母機(jī)構(gòu)、彈簧預(yù)緊機(jī)構(gòu)于一身的變徑機(jī)構(gòu)，優(yōu)化后螺母水平推力減小了 41.5%。

早在 20 世紀(jì) 90 年代，國外就開始了井下機(jī)器人的研制，目前技術(shù)已非常成熟[18]。國外學(xué)者研制出一種名為PIG的機(jī)械設(shè)備，俗稱管道豬[19]。A.OYAMA等[20]針對小直徑管道設(shè)計(jì)了一種蠕動式管道機(jī)器人，該機(jī)器人對不同管徑具有良好的適應(yīng)性，但牽引力不足導(dǎo)致應(yīng)用有限。T.HALSTED等[21]設(shè)計(jì)了一種由雙模塊組成的管道機(jī)器人，該機(jī)器人的一種引導(dǎo)模塊由一組平行于管道軸線運(yùn)動的輪子引導(dǎo)，另一驅(qū)動模塊由一組傾斜的輪子圍繞管道的軸線而旋轉(zhuǎn)，被迫跟隨運(yùn)動。上述成果主要是面向輸氣管道內(nèi)部缺陷檢測機(jī)器人的研究而形成，但仍然存在工作時(shí)牽引力不足、結(jié)構(gòu)復(fù)雜、變徑范圍小等問題。本文針對以上幾種不足，以直徑300～400 mm管道為例，設(shè)計(jì)了一種能夠?qū)崿F(xiàn)同步自主變徑的模塊化輸氣管道檢測機(jī)器人。

1 機(jī)構(gòu)設(shè)計(jì)及工作原理

1.1 工況需求分析及整體結(jié)構(gòu)設(shè)計(jì)

針對直徑為300～400 mm的輸氣管道內(nèi)壁進(jìn)行檢測而設(shè)計(jì)自主變徑的管道機(jī)器人，設(shè)計(jì)要求機(jī)器人在行走過程中具有良好的力學(xué)性能，保證能夠跨越多種障礙且能夠通過≥90°彎管、45°斜坡和豎直管道；模塊化設(shè)計(jì)可以使其能夠搭載其他單元，促進(jìn)其在實(shí)際工作時(shí)能夠適應(yīng)管徑的變化，實(shí)現(xiàn)一定范圍的變徑功能。機(jī)器人單次工作距離不超過300 m，行走速度不低于16 cm/s，工作時(shí)所提供的最大牽引力不小于400 N。因此，為直觀地了解機(jī)械結(jié)構(gòu)，利用三維數(shù)字化建模軟件SolidWorks對該機(jī)器人結(jié)構(gòu)進(jìn)行設(shè)計(jì)，根據(jù)實(shí)際工況需求，所設(shè)計(jì)的管道機(jī)器人結(jié)構(gòu)主要包括伸縮變徑機(jī)構(gòu)、支撐機(jī)構(gòu)，如圖1所示。

圖1 管道機(jī)器人三維圖Fig.1 3D diagram of pipeline robot

1.2 支撐機(jī)構(gòu)的設(shè)計(jì)及工作原理

通過對比幾種支撐方式的優(yōu)缺點(diǎn)，本設(shè)計(jì)支撐機(jī)構(gòu)采用絲杠螺母支撐設(shè)計(jì)，其原理如圖2所示。該支撐機(jī)構(gòu)傳動穩(wěn)定，通過電機(jī)的轉(zhuǎn)動帶動絲杠左旋或右旋，從而達(dá)到根據(jù)管徑變化主動調(diào)節(jié)支撐機(jī)構(gòu)張開角度的目的。支撐機(jī)構(gòu)包含有四桿機(jī)構(gòu)、雙四桿機(jī)構(gòu)以及剪叉機(jī)構(gòu)。在支撐機(jī)構(gòu)機(jī)架上安裝有支撐輪，可以隨四桿機(jī)構(gòu)共同運(yùn)動；雙四桿機(jī)構(gòu)可以調(diào)節(jié)支撐輪的高度和角度，通過伸縮缸帶動主動桿來帶動支撐臂運(yùn)動，從而達(dá)到變徑適應(yīng)的目的；剪叉機(jī)構(gòu)通過中間2根交叉十字桿的剪叉運(yùn)動實(shí)現(xiàn)支撐輪的升降。

圖2 支撐機(jī)構(gòu)原理圖Fig.2 Schematic diagram of support mechanism

管道機(jī)器人的詳細(xì)結(jié)構(gòu)如圖3所示。

1—伸縮電機(jī)；2—驅(qū)動桿；3—伸縮變徑齒輪副；4—絲杠螺母；5—支撐臂連接桿；6—驅(qū)動腿；7—驅(qū)動輪；8—錐齒輪副；9—驅(qū)動電機(jī)；10—支撐腿。圖3 管道機(jī)器人結(jié)構(gòu)圖Fig.3 Structure of pipeline robot

工作原理：機(jī)器人的伸縮電機(jī)驅(qū)動伸縮變徑齒輪副運(yùn)動，齒輪副的轉(zhuǎn)動傳遞給絲杠螺母，通過支撐臂連接桿的作用，實(shí)現(xiàn)驅(qū)動腿和支撐腿的擴(kuò)張和收縮運(yùn)動。此時(shí)利用驅(qū)動桿實(shí)現(xiàn)兩側(cè)機(jī)構(gòu)的同步運(yùn)動，從而實(shí)現(xiàn)管內(nèi)變徑動作。當(dāng)伸縮電機(jī)不再工作時(shí)，驅(qū)動電機(jī)開始運(yùn)轉(zhuǎn)，通過錐齒輪副將動力傳遞到驅(qū)動輪上，從而實(shí)現(xiàn)機(jī)器人的管內(nèi)運(yùn)動。

1.3 模塊化連接結(jié)構(gòu)設(shè)計(jì)

應(yīng)用模塊化思維可將該機(jī)器人分為多個(gè)模塊，每個(gè)模塊可以發(fā)揮不同工況的檢測、定位等作用。根據(jù)設(shè)計(jì)目標(biāo)，該機(jī)器人需通過直徑300～400 mm的直管、不小于90°的彎管、45°斜坡和豎直管道。在直管和彎管中的運(yùn)動方式有所差異，直管中主要為直行運(yùn)動，而彎管中的行進(jìn)受管道影響，后續(xù)模塊需要與相鄰模塊連接處有一定的角度偏差，所以選用的模塊化連接機(jī)構(gòu)必須具備可以360°轉(zhuǎn)動的功能。參考相關(guān)文獻(xiàn)與設(shè)計(jì)，決定選用萬向節(jié)作為連接機(jī)構(gòu)。其結(jié)構(gòu)如圖4所示。萬向節(jié)保證了各機(jī)器人可以相互連接，適應(yīng)模塊化布置。結(jié)構(gòu)設(shè)計(jì)中還可以通過增加機(jī)器人數(shù)量提升整機(jī)的牽引力，以確保該機(jī)器人在長距離作業(yè)時(shí)有足夠的牽引力，從而滿足長距離作業(yè)的要求。

圖4 模塊化連接結(jié)構(gòu)圖Fig.4 Modular connection structure diagram

2 常見工況力學(xué)分析

2.1 直管運(yùn)動工作特性分析

管道機(jī)器人在實(shí)際工作時(shí)遇到最多的工況就是直管運(yùn)動。假設(shè)機(jī)器人在工作時(shí)每個(gè)輪子與管道內(nèi)壁充分接觸，則此時(shí)機(jī)器人的中心軸線與管道中心軸線應(yīng)為重合狀態(tài)，如圖5所示。

圖5 管道機(jī)器人直管運(yùn)動狀態(tài)示意圖Fig.5 Schematic diagram for motion state of pipeline robot in straight pipe

如圖5所示，在管道內(nèi)建立全局坐標(biāo)系(x，y，z)，管道的中心軸線與z軸重合，通過右手定則確定坐標(biāo)系方向；機(jī)身上建立局部坐標(biāo)系(x1，y1，z1)，其中原點(diǎn)O1位于3個(gè)支撐輪與管道軸線相交點(diǎn)，該坐標(biāo)系在全局坐標(biāo)系中為(0，0，z)T，此時(shí)z軸與z1軸共線，x1軸與支撐臂平行。但在實(shí)際工作中機(jī)器人會受到外部因素干擾，局部坐標(biāo)系會發(fā)生偏轉(zhuǎn)，產(chǎn)生偏移夾角，將此時(shí)局部坐標(biāo)系與全局坐標(biāo)系之間所產(chǎn)生的偏移夾角稱為姿態(tài)角α。機(jī)器人作業(yè)時(shí)2組輪腿上的驅(qū)動電機(jī)工作狀態(tài)一致，在輪軸上建立第二個(gè)局部坐標(biāo)系(x2，y2，z2)，取管道半徑為R，輪子半徑為r，則該局部坐標(biāo)系原點(diǎn)O2在第一個(gè)局部坐標(biāo)系(x1，y1，z1)中記作(R-r，0，0)T，此時(shí)2條x軸共線，2條y軸與z軸相平行。

由坐標(biāo)變換原理可得，機(jī)器人的坐標(biāo)變換關(guān)系可以由下式表示：

(2)

為了簡便計(jì)算，將各個(gè)輪子與管道的接觸看作點(diǎn)接觸，接觸點(diǎn)為P，P點(diǎn)即位于x2O2z2平面，該點(diǎn)坐標(biāo)記為：

2P=(r00)T

(3)

由位置變換可以將P點(diǎn)轉(zhuǎn)換到全局坐標(biāo)系，其數(shù)學(xué)關(guān)系式為：

(4)

式中：

(5)

由式(4)和式(5)可以得到：

(6)

管道機(jī)器人作業(yè)時(shí)，其運(yùn)行長度z可以表示為移動速度v與時(shí)間t的乘積，則機(jī)器人在直管內(nèi)部的軌跡方程為：

(7)

式中：v為機(jī)器人移動速度，cm/s；t為機(jī)器人運(yùn)行時(shí)間，s。

在MATLAB軟件中對該軌跡方程進(jìn)行求解，管道直徑為300 mm，管道機(jī)器人行走速度為16 cm/s，計(jì)算得出機(jī)器人直管工作軌跡如圖6所示。圖6表明，機(jī)器人在直管中工作時(shí)運(yùn)行平穩(wěn)，運(yùn)動軌跡始終為一條直線。

2.2 彎管運(yùn)動分析

彎道運(yùn)行也是管道機(jī)器人作業(yè)時(shí)常有的工況，管道機(jī)器人的最大外形尺寸必須滿足彎管的幾何約束。將輸氣管道的管道機(jī)器人類比為圓柱體(所有輪腿與管壁接觸的最大面積)，則管道機(jī)器人直角彎道處的通行與卡死情況如圖7所示。

圖7 輸氣管道機(jī)器人通過90°彎管時(shí)的條件Fig.7 Conditions for gas pipeline robot to passe through 90° bend

依據(jù)圖7建立數(shù)學(xué)模型，設(shè)管道的彎曲半徑為R、彎曲角度為γ，管道內(nèi)徑為D，其中γ通常最小為90°，D取300～400 mm。管道機(jī)器人的主要參數(shù)有機(jī)器人的主體長度L、主體徑向最大尺寸d。

由圖7可知，輸氣管道機(jī)器人處于彎道時(shí)的卡死情況可分為2種(臨界點(diǎn)選取彎管與直管交界處)：

(8)

管道機(jī)器人的2個(gè)端面在彎管的彎管部分時(shí)，如圖7b所示，則該管道機(jī)器人的最大幾何尺寸應(yīng)該滿足下式：

(9)

由于此次設(shè)計(jì)的輸氣管道機(jī)器人應(yīng)用于300～400 mm管徑，且選用的為輪式和支撐式相結(jié)合的結(jié)構(gòu)，所以只需要考慮圖7b的情況。

從式(9)可以得出結(jié)論：管道機(jī)器人的最大長度Lmax隨彎道半徑R的增大而增大，隨主體最大徑向尺寸d的增大而減小。

如在最小尺寸為300 mm的管道中行駛，則D=300 mm；根據(jù)GB 12459—1990《鋼制對焊無縫管件90°彎頭尺寸表》可知，若D=300 mm時(shí)R=305 mm，機(jī)器人寬度d可初步設(shè)定為250 mm，根據(jù)式(9)可得Lmax=415 mm。

根據(jù)計(jì)算和零件選型，得出輸氣管道機(jī)器人總體長度不大于415 mm時(shí)，該機(jī)器人能夠順利通過彎道，因此本文管道機(jī)器人的長度取400 mm。

3 動力學(xué)仿真分析

3.1 直管通過性分析

將建立的虛擬樣機(jī)模型導(dǎo)入管徑為400 mm的直管內(nèi)，對其通過性進(jìn)行分析。仿真過程如圖8所示。運(yùn)行過程中行走平穩(wěn)，無運(yùn)動干涉，圖8中的白色線為機(jī)器人輪子的軌跡線。

圖8 直管通過性仿真過程Fig.8 Simulation process of straight pipe passability

機(jī)器人各輪及樣機(jī)質(zhì)心在z軸方向位移隨時(shí)間的變化曲線(s-t)如圖9所示。

圖9 各質(zhì)心z方向位移變化曲線Fig.9 Shift variation curve of each centroid over time in the z axis direction

各輪質(zhì)心在z軸方向上速度時(shí)間變化曲線(v-t)如圖10所示。

圖10 各輪質(zhì)心在z軸方向上速度時(shí)間變化曲線Fig.10 Velocity variation of each wheel’s centroid over time in the z axis direction

當(dāng)仿真開始后管道機(jī)器人的速度在極短時(shí)間增大到10 m/min，然后保持穩(wěn)定，且此時(shí)各輪質(zhì)心的曲線重合，位移時(shí)間變化曲線與速度時(shí)間變化曲線表明，管道機(jī)器人的輪子之間速度相同且無相對運(yùn)動，該機(jī)器人結(jié)構(gòu)設(shè)計(jì)合理；仿真過程中曲線比例穩(wěn)定，說明管道機(jī)器人能夠穩(wěn)定工作，各輪子與管道內(nèi)壁的接觸無打滑現(xiàn)象。

為確保管道機(jī)器人工作時(shí)的穩(wěn)定性，繼續(xù)對其瞬時(shí)速度進(jìn)行測量，得到的機(jī)器人質(zhì)心x和y方向v-t變化曲線如圖11所示，驅(qū)動輪質(zhì)心的x和y方向速度變化曲線如圖12所示。

圖11 機(jī)器人質(zhì)心x和y方向速度變化曲線Fig.11 Velocity variation of robot centroid in the x and y axes directions

圖12 驅(qū)動輪質(zhì)心x和y方向速度變化曲線Fig.12 Velocity variation of driving wheel centroid in the x and y axes directions

由圖11和圖12可見，驅(qū)動輪速度波動曲線的波動范圍始終為-4.5～4.5 mm/s。在仿真過程中，x與y方向的速度曲線出現(xiàn)較大波動，這種情況在豎直管道內(nèi)部的實(shí)際工作時(shí)是難以避免的。管道機(jī)器人的速度變化在9 mm/s范圍內(nèi)，位移在0.5 mm范圍內(nèi)，所得偏差在允許范圍之內(nèi)，可忽略不計(jì)。綜上所述，管道機(jī)器人在直管內(nèi)部能夠?qū)崿F(xiàn)平穩(wěn)的運(yùn)動，具有良好的直管通過性。

3.2 彎管通過性分析

對管道機(jī)器人通過彎管的極限情況(90°彎管)進(jìn)行仿真分析，仿真過程如圖13所示，機(jī)器人的質(zhì)心位移變化曲線如圖14所示。

圖13 彎管通過性仿真過程Fig.13 Simulation process of bent pipe passability

圖14 機(jī)器人的質(zhì)心位移變化曲線Fig.14 Shift variation of robot centroid

由圖14可見：樣機(jī)在z軸方向的速度始終近似為0。在0～7.3 s樣機(jī)還未進(jìn)入彎道時(shí)，其在直管中勻速運(yùn)動；在轉(zhuǎn)彎初始時(shí)，由于各輪轉(zhuǎn)彎半徑不同，導(dǎo)致外輪轉(zhuǎn)速高于內(nèi)輪轉(zhuǎn)速，即x方向速度小于y方向速度，同時(shí)機(jī)器人的質(zhì)心速度也增大；在11.2 s之后樣機(jī)完全走出彎管，繼續(xù)勻速直線行走，x軸方向速度出現(xiàn)大幅度差值，這是因?yàn)闃訖C(jī)在剛進(jìn)入彎管時(shí)，機(jī)身向x方向傾斜，當(dāng)機(jī)身完全走過彎管時(shí)，x軸方向的速度曲線逐漸平穩(wěn)，此時(shí)y軸出現(xiàn)變化的原因與x軸相反。因此使得管道機(jī)器人在過彎時(shí)運(yùn)行平穩(wěn)。

圖15為樣機(jī)質(zhì)心速度變化曲線。

圖16為樣機(jī)驅(qū)動輪的質(zhì)心角速度變化曲線。如圖16所示，樣機(jī)在準(zhǔn)備過彎時(shí)圖線穩(wěn)定，數(shù)據(jù)此時(shí)還無明顯波動；行走至過渡階段，前部3個(gè)輪子在剛進(jìn)入彎道時(shí)會有輪子與管壁接觸不充分的現(xiàn)象，所以圖像中測得的位移、速度曲線會呈現(xiàn)一定的波動，這屬于正常現(xiàn)象；當(dāng)管道機(jī)器人走出彎管重新進(jìn)入直管段時(shí)，其所有輪子與管壁充分接觸，圖像恢復(fù)平穩(wěn)。

圖16 樣機(jī)驅(qū)動輪的質(zhì)心角速度變化曲線Fig.16 Angular velocity variation of driving wheel centroid of prototype

3.3 豎直管道通過性分析

豎直管道內(nèi)部的參數(shù)設(shè)置與水平管道參數(shù)設(shè)置相同，僅改變重力的方向，使管道中心軸線與重力的方向重合，其仿真過程如圖17所示。

圖17 豎直管通過性仿真過程Fig.17 Simulation process of vertical pipe passability

仿真得到了驅(qū)動輪2的質(zhì)心在x及y軸方向位移隨時(shí)間的變化曲線，如圖18所示。

得到的驅(qū)動輪4的質(zhì)心在x及y軸方向位移隨時(shí)間的變化曲線如圖19所示。

圖19 驅(qū)動輪4質(zhì)心在x及y軸方向位移隨時(shí)間的變化曲線Fig.19 Shift variation of centroid of No.4 driving wheel over time in the x and y axes directions

2驅(qū)動輪的速度波動曲線不一致，但其波動范圍均在-4.5～5.5 mm/s之間，此處選取驅(qū)動輪4進(jìn)行說明。

由圖18、圖19可知，在仿真過程中，x與y方向的速度曲線出現(xiàn)較大波動，說明管道機(jī)器人在豎直管道內(nèi)部的受力存在不穩(wěn)定的現(xiàn)象，這在實(shí)際工作時(shí)難以避免，其運(yùn)動過程中存在的震動會直接影響到管道機(jī)器人質(zhì)心的位置變化，其在x及y方向的位移變化時(shí)間較短，且頻率過高，導(dǎo)致管道機(jī)器人速度波動極為明顯，這在誤差范圍內(nèi)，屬于正常現(xiàn)象。受重力影響，2圖中機(jī)器人的速度波動曲線范圍均不超過10 mm/s，這表明其在直管運(yùn)動時(shí)運(yùn)動方向上無重力阻礙，速度波動可以忽略不計(jì)。綜上所述，管道機(jī)器人在豎直管道內(nèi)部可以實(shí)現(xiàn)穩(wěn)定行走，其具有良好的豎直管道通過性。

4 結(jié) 論

(1)設(shè)計(jì)的管道機(jī)器人采用對稱的支撐輪式同步變徑結(jié)構(gòu)，可以實(shí)現(xiàn)機(jī)身2端同步自主變徑，變徑范圍為300～400 mm。

(2)驅(qū)動模塊由電動機(jī)帶動驅(qū)動輪轉(zhuǎn)動，額定爬行速度16 cm/s，最小過彎半徑660 mm，牽引力不小于400 N。

(3)在機(jī)器人模塊化連接結(jié)構(gòu)中創(chuàng)新使用了萬向節(jié)，適應(yīng)了管道機(jī)器人模塊化布置需求，大大增加了牽引力及運(yùn)行穩(wěn)定性。

(4)對建立的虛擬樣機(jī)模型進(jìn)行動力學(xué)仿真分析，其在直管、彎管及豎直管道的速度仿真曲線誤差均不超過10 mm/s，具有良好的管道通過性。