李文章， 周明連

(北京交通大學 機械與電子控制工程學院， 北京 100044)

引言

隨著城市化的發(fā)展，我國城市地下空間被不斷的開發(fā)，而由地下工程活動引起的地面塌陷也越發(fā)頻繁，成為新的城市地質(zhì)災(zāi)害[1]，特別是城市地下排水管漏水后，土壤被沖刷，形成空腔，增加塌陷的危險[2]。地下排水管道常年埋于潮濕土壤中，并且遭受污水的腐蝕，會出現(xiàn)破損、老化、甚至斷裂，這些損傷引起的地面塌陷具有不確定、潛伏、偶發(fā)的特點。為了保證居民的日常生活和路面上的正常使用，在不對污水管道進行開挖的條件下，急需便捷方式對污水管道的損傷做檢測，以排除隱藏的危險[3-5]。

歐洲作為管道機器人研發(fā)先驅(qū)，法國的J.VWERTUT最早設(shè)計了輪腿式管內(nèi)模型IPRIV行走機構(gòu)[6-7]。日本的SHIGEO Hirose和HIDETAKA Ohno率先研制出了適應(yīng)50 mm管徑的Thes一代機器人[8-9]，在此基礎(chǔ)上又研發(fā)了適應(yīng)更大管徑的二、三代機器人。進入21世紀，美國的DAPHNE D’Zurko和HAGEN Schempf博士共同研制出用于遠程工作的EXLORER無纜線管道機器人[10]。德國的BEMHARD Klaassen、HERMANN Streich和FRANK Kirchner研制了具有多個蠕動關(guān)節(jié)的MAKRO機器人，機器人采用無線通信的方式控制，機器人整體有21個自由度，能夠完成跨越障礙與轉(zhuǎn)向的功能[11]。

雖然國內(nèi)的管道機器人起步較晚，但是在東北天然氣和石油工業(yè)大力發(fā)展的背景下，催生了以哈爾濱工業(yè)大學為代表的一批科研院校對管道機器人的科研投入。哈工大研制了輪式管道機器人，這是針對于一些空間與地理位置受限的大口徑管網(wǎng)自動化檢測[12]，由呂恬生、樸春日等率先研發(fā)了能自適應(yīng)管徑、還能進行越障、無線遙控的管道機器人[13]。

本研究設(shè)計的管道檢測機器人依靠全氣動控制系統(tǒng)，消除了易燃易爆的危險，同時具有行走速度快、圖像采集效率高、承載能力強等特點。

1 管道檢測機器人機械機構(gòu)設(shè)計

1.1 機器人整體機構(gòu)設(shè)計與建模

整個機器人的機械結(jié)構(gòu)主要包括兩大部分，一是行走機構(gòu)的設(shè)計，二是圖像采集機構(gòu)的設(shè)計，通過行走機構(gòu)下井，帶著圖像采集機構(gòu)完成相應(yīng)功能的工作任務(wù)。這兩大部分在設(shè)計的氣動邏輯下，協(xié)調(diào)完成檢測的功能，通過氣動調(diào)壓閥、節(jié)流閥等調(diào)節(jié)，實現(xiàn)機器人前進的速度與旋轉(zhuǎn)速度的變化?？紤]到各機構(gòu)布置的合理性，如圖1所示，完成了管道檢測機器人的整體設(shè)計圖。

圖1 管道檢測機器人整體設(shè)計圖

1.2 行走機構(gòu)設(shè)計與建模

1) 上撐壁機構(gòu)設(shè)計

機器人行走機構(gòu)要求能夠適應(yīng)600～1050 mm的不同管徑的污水管道，所以自適應(yīng)撐壁機構(gòu)的設(shè)計非常重要。

機器人在實際行走過程中，應(yīng)盡量降低底盤的高度，保證機器人重心下沉，增加機器人的穩(wěn)定性。污水井口的尺寸為550～600 mm，為了能達到1050 mm的污水管壁，考慮使用連桿機構(gòu)，連桿機構(gòu)大部分都是低副，這種面接觸對元件沖擊力小，承載能力強，加工容易，可以很方便的改變運動的行程大小。

設(shè)計如圖2所示的六桿機構(gòu)運動簡圖，這也是氣壓式連桿機構(gòu)的簡化模型。壓縮氣體進入氣缸的無桿腔，推動活塞桿移動，克服阻力，繞軸O2轉(zhuǎn)動，氣缸推動三角形鉸接板繞軸O1轉(zhuǎn)動，并通過鉸接板將力傳遞至撐壁桿，使得撐壁桿繞軸O轉(zhuǎn)動，要適應(yīng)600～1050 mm的內(nèi)徑管路，將O,O1,O2固定在安裝盤上，由O2固定上撐壁氣缸，氣缸接通氣源之后，活塞桿伸出，帶動三角形鉸接板繞O1轉(zhuǎn)動，可拉動支撐桿較大范圍調(diào)節(jié)，這是一種自適應(yīng)的上撐壁機構(gòu)，可以明顯觀察到，六桿機構(gòu)的撐壁可進行較大范圍的調(diào)節(jié)。

圖2 六桿機構(gòu)運動簡圖

根據(jù)撐壁桿的自適應(yīng)，為了使撐壁折疊機構(gòu)能夠更加可靠的展開與收回，通過氣缸加入驅(qū)動力，利用氣缸的往復運動使撐壁折疊機構(gòu)展開和收縮，使其對于不同管道的直徑有很好的適應(yīng)性，設(shè)計了如圖3所示的上撐壁機構(gòu)。

圖3 機器人上撐壁機構(gòu)

2) 行走機構(gòu)整體設(shè)計

根據(jù)蠕動式機器人爬行的特點，行走機構(gòu)主要包括前后撐壁機構(gòu)與中間的伸縮機構(gòu)，如圖4所示，中間的伸縮機構(gòu)直接選用一對伸縮氣缸代替，前后的撐壁機構(gòu)包括上撐壁與下?lián)伪跈C構(gòu)。

行走機構(gòu)在作業(yè)中，上撐壁機構(gòu)一直伸出，頂住管壁，效果相當于增加了整個機器人的自重，增大下支撐機構(gòu)與管壁的摩擦力，保證機器人在污水的沖擊下，還能可靠撐住管壁，機器人前進或者后退時，按照設(shè)計的氣動邏輯，由前盤的下?lián)伪跉飧讚巫」鼙冢炜s缸伸出，當伸縮缸觸動機動換向閥時，前盤的下?lián)伪跉飧卓s回，行走輪落地，后盤的下?lián)伪跉飧咨斐鰮巫」鼙冢炜s缸根據(jù)設(shè)計的氣動邏輯縮回，拖動整個前盤向前。如此循環(huán)，機器人蠕動向前，如果想要后退，只需1個換向閥控制即可實現(xiàn)。

圖4 機器人行走機構(gòu)

1.3 圖像采集系統(tǒng)設(shè)計與建模

圖像采集系統(tǒng)主要是在行走機構(gòu)的基礎(chǔ)上設(shè)計的，整個圖像采集系統(tǒng)的機械設(shè)計包括旋轉(zhuǎn)機構(gòu)與升降機構(gòu)。旋轉(zhuǎn)機構(gòu)要滿足能夠繞著管壁做回轉(zhuǎn)運動，除了行走機構(gòu)下部為掃描盲區(qū)，其余管壁應(yīng)全部掃描到，保證檢測的完整性。升降氣缸帶著圖像采集裝備作業(yè)，透明密封模塊可以抵達污水管的管壁。整個系統(tǒng)設(shè)計時，應(yīng)該注意考慮減速氣動馬達的回轉(zhuǎn)中心在管壁的中心，減速氣動馬達要與升降氣缸連接可靠，還要達到拆裝方便的效果，這樣才能提升整個機器人的使用性能。

對管道帶水檢測機器人的圖像采集機構(gòu)的各個零部件進行三維建模，如圖5所示，包括圖像采集模塊、旋轉(zhuǎn)馬達和減速箱控制的旋轉(zhuǎn)機構(gòu)、 升降氣缸控制的升降機構(gòu)。并將各個零件根據(jù)相應(yīng)配合關(guān)系進行裝配，完成圖像采集機構(gòu)的設(shè)計建模。

圖5 機器人圖像采集機構(gòu)

整個旋轉(zhuǎn)與升降機構(gòu)的執(zhí)行過程是在接通氣源的情況下，由升降氣缸伸出頂住管壁，旋轉(zhuǎn)馬達開始做自動旋轉(zhuǎn)，當?shù)诌_極限位置，由擋板觸動機動換向閥，機動換向閥接通氣源，旋轉(zhuǎn)馬達即可實現(xiàn)換向。

2 管道檢測機器人氣動控制系統(tǒng)的設(shè)計與仿真

管道檢測機器人將要在充滿易燃易爆的污水管道中作業(yè)，選擇全自動的氣動邏輯控制是非常有必要的，整個系統(tǒng)的執(zhí)行機構(gòu)都是氣壓驅(qū)動，實現(xiàn)機器人的行走與掃描。

2.1 氣動控制系統(tǒng)設(shè)計

在污水中實現(xiàn)自動采集圖像的機器人氣動控制方案在于通過不同的氣體控制閥與氣動控制元件控制，實現(xiàn)機器人在污水中的行走與圖像采集工作。如圖6所示，這是全氣動控制系統(tǒng)部分，當氣源13接通后，總分為3路。

第1路為二位五通的升降氣缸控制開關(guān)11，該手動開關(guān)的2口與4口分別接入升降氣缸的有桿腔與無桿腔；

第2路為二位三通的手動全收縮開關(guān)12，該手動全收縮開關(guān)12的2口又分為五路，第1路接的是下?lián)伪跉飧?的有桿腔，第2路接通的是前進缸組并聯(lián)后的有桿腔，第3路接通的是下?lián)伪跉飧?的有桿腔，第4路接通的是二位三通單向氣控閥5，第5路接通的是并聯(lián)后的上撐壁氣缸的有桿腔；

第3路就是總前進開關(guān)，該前進開關(guān)接通后又分為6路，第1路接通的是并聯(lián)后的上撐壁氣缸的無桿腔，第2路接通的是換向開關(guān)，第3路接通的是三位五通雙向氣控閥17的1口，第4路接通的是二位五通雙向氣控閥18的1口，第5路接通的是并聯(lián)后的前進缸機動閥，第6路接通的是并聯(lián)后的馬達機動閥。

2.2 氣動控制系統(tǒng)仿真

用FluidSIM氣動仿真軟件對檢測機器人的行走與檢測氣動控制系統(tǒng)建模與仿真，通過仿真結(jié)果確定設(shè)計的氣控邏輯的正確性。

如圖7所示，氣源設(shè)定為0.7 MPa，設(shè)計的全氣動控制系統(tǒng)可以實時檢測這些氣動元件的一些關(guān)鍵參數(shù)，在全氣動控制的系統(tǒng)中添加狀態(tài)表，通過點擊系統(tǒng)中的機動閥，改變氣控閥的閥芯位置，或者改變氣動馬達進出口的氣體流向，從而可以從狀態(tài)表中觀察到各個氣缸的工作狀態(tài)。

1.下?lián)伪跉飧? 2.上撐壁氣缸2 3.前進缸機動閥1 4.前進缸機動閥2 5、10、19.二位三通單向氣控閥 6.前進伸縮缸組7.下?lián)伪跉飧? 8.上撐壁氣缸1 9.升降氣缸 11.升降氣缸控制開關(guān) 12.全收縮開關(guān) 13.氣源 14.前進開關(guān)15.換向開關(guān) 16.單向氣控閥 17.三位五通雙向氣控閥 18.二位五通雙向氣控閥 20.馬達機動閥121.馬達機控閥2 22.減速氣動馬達圖6 管道帶水檢測機器人全氣動控制回路

圖7 氣路設(shè)計

如圖8所示的仿真結(jié)果可以說明，上撐壁氣缸1，2打開氣閥之后就可靠撐住了管壁，下?lián)伪诟?與下?lián)伪诟?的氣動邏輯相反，下?lián)伪跉飧走_到滿行程80 mm 后，下?lián)伪跉飧?全部縮回，當下?lián)伪诟?撐住管壁，下?lián)伪诟?離開管壁，伸縮氣缸1，2在以上邏輯完成之后，旋轉(zhuǎn)馬達旋轉(zhuǎn)，觸碰到機動換向閥，前進伸縮缸的行程從0開始變化到300 mm，整個邏輯發(fā)生改變，該仿真結(jié)果表明符合需要實現(xiàn)的氣路控制功能。

3 管道檢測機器人強度校核與受力分析

3.1 機器人安裝盤強度校核

當管道檢測機器人在實際工作的過程中，機器人的前后安裝盤不僅受到上下?lián)伪跈C構(gòu)的力，還要受到水流的阻力，特別是前安裝盤還要支撐圖像采集模塊。前后安裝盤受力情況復雜，對其采用ANSYS有限元分析軟件進行仿真分析。具體劃分的網(wǎng)格如圖9所示，

圖8 機器人氣路仿真狀態(tài)

之后在安裝盤上加載固定約束和所受力的大小方向，然后求解，經(jīng)過有限元軟件計算分析后，得到關(guān)于前后安裝盤的應(yīng)力及應(yīng)變的分析結(jié)果，具體如圖10、圖11所示。

3.2 上撐壁機構(gòu)受力分析

對上撐壁機構(gòu)在600 mm管內(nèi)進行受力分析，當上撐壁機構(gòu)撐住管壁時，整個撐壁系統(tǒng)處于靜止狀態(tài)，桿4與桿5都為二力桿，具體受力如圖12所示。

圖9 三維模型網(wǎng)格劃分

圖10 前安裝盤ANSYS仿真結(jié)果

圖11 后安裝盤ANSYS仿真結(jié)果圖

圖12 上撐壁折疊機構(gòu)受力分析

對該空間力系進行分析時，向O2，O3這2個簡化中心分別建立直角坐標系x1O2y1，xO3y，該力系中的F1，F(xiàn)2的作用點對點O2的矢徑以r1，r2表示，則力系的力系的主力矢F1，F(xiàn)2和主力矩M可用投影矩陣F(O2)和M(O2)表示為：

改寫成矩陣方程形式：

其中，F(xiàn)3，F(xiàn)4的作用點對點O3的矢徑以r3，r4表示，則力系的主力矢主力矩F3，F(xiàn)4和主力矩M可用投影矩陣F(O3)和M(O3)表示為:

改寫成矩陣方程形式：

將以上式子展開，導出投影表示的獨立方程，已知F1=1586 N，求解可得上撐壁機構(gòu)對污水管壁的壓力F4=882 N。

4 現(xiàn)場管道實驗

對機器人所需元器件進行了選型，并根據(jù)設(shè)計圖紙對非標準件進行加工。對行走機構(gòu)進行裝配與接管，對圖像采集機構(gòu)完成裝配，實現(xiàn)了機器人所有氣控系統(tǒng)的接線，完成攝像裝備接線處理，并成功進行了現(xiàn)場管道試驗，如圖13所示，驗證了機器人檢測的可行性。

圖13 現(xiàn)場管道實驗

5 結(jié)論

針對管徑為600～1050 mm的地下排水管道，研究管道檢測機器人，研制了全氣動邁步式執(zhí)行機構(gòu)，研制適應(yīng)不同管道直徑的自適應(yīng)撐壁機構(gòu)，污水中圖像采集的自動掃描機構(gòu)與機器人控制系統(tǒng)。同時對于機器人前后安裝盤和上撐壁機構(gòu)建立數(shù)學模型進行仿真實驗研究，驗證研究的可行性。最后，設(shè)計制作物理樣機進行現(xiàn)場管道試驗，從試驗結(jié)果推斷理論分析的正確性和設(shè)計方案的可行性。