李俊辰， 唐杰 ， 區(qū)杰 勇， 徐杰 ， 崔佳駿

（中國民航大學(xué)，天津 300300）

0 引言

在日常生活和工業(yè)生產(chǎn)中存在著各種各樣的管道，如自來水管道，油氣管道等。這些管道作為重要的物料運(yùn)輸設(shè)施得到了廣泛應(yīng)用。管道在經(jīng)過長時(shí)間的使用后，由于壓力、沖擊和腐蝕的影響，會出現(xiàn)管壁老化、裂紋、腐蝕、管壁異物附著等缺陷，因此在使用中經(jīng)常需要對管道內(nèi)壁進(jìn)行檢測，及時(shí)發(fā)現(xiàn)管道內(nèi)壁的情況，以便對管道進(jìn)行維護(hù)。而管道所處的環(huán)境往往是人們不易到達(dá)和直接進(jìn)入的，因此對管道的檢測和維護(hù)是工業(yè)生產(chǎn)中的一道難題。傳統(tǒng)的管道檢修方式存在效率低下，檢修困難等問題，且在檢修時(shí)必須停用管道，嚴(yán)重影響正常的生產(chǎn)工作。管道機(jī)器人正是為了解決這些問題而產(chǎn)生的[1-2]。

作為機(jī)器人系統(tǒng)中一個(gè)新興的種類和分支，管道機(jī)器人在21世紀(jì)得到了快速發(fā)展。但總體來看，目前管道機(jī)器人的研究總體還處于初始階段，離大規(guī)模投入應(yīng)用尚有很大距離。尤其是針對充滿液體的管道，由于管內(nèi)情況復(fù)雜，環(huán)境惡劣，因此關(guān)于這方面的研究不多[3]，只有少數(shù)論文提及。這導(dǎo)致輸送液體的管道無法在正常工作條件下得到有效的檢測和維護(hù)，從而對工業(yè)生產(chǎn)和人們的生活帶來很大的困擾。針對目前對液體環(huán)境下的管道進(jìn)行無損檢測的迫切需求，設(shè)計(jì)了一種依靠特殊支撐裝置抓緊管內(nèi)壁，并通過對稱安裝的電動機(jī)或噴水推進(jìn)器實(shí)現(xiàn)管道內(nèi)往復(fù)運(yùn)動的管道機(jī)器人。該型管道機(jī)器人采用模塊化內(nèi)部設(shè)計(jì)保證了設(shè)備的合理分配，并很好地控制了機(jī)器人的整體尺寸；采用STC15系列單片機(jī)進(jìn)行編程控制，通過攜帶的圖像傳感裝置實(shí)時(shí)將管道內(nèi)部圖像發(fā)送至管外顯示器，并能通過遙控手柄或手機(jī)軟件平臺操控機(jī)器人的運(yùn)動。該型管道機(jī)器人系統(tǒng)可在不妨礙管道正常輸送液體的情況下對管內(nèi)進(jìn)行無損檢測，對提高管道檢修效率，加速工業(yè)生產(chǎn)具有重要意義。本文主要研究管道機(jī)器人系統(tǒng)的結(jié)構(gòu)設(shè)計(jì)和控制系統(tǒng)設(shè)計(jì)，其中包括機(jī)器人內(nèi)部結(jié)構(gòu)，外部支撐裝置結(jié)構(gòu)，機(jī)器人運(yùn)動形態(tài)，工作機(jī)制等。

1 管道機(jī)器人結(jié)構(gòu)設(shè)計(jì)

圖1 管道機(jī)器人的幾種常見形態(tài)

目前，管道機(jī)器人類型大致可分為自驅(qū)動（自帶動力源）、利用流體推力、通過彈性桿外加推力3種，其中以自驅(qū)動占大多數(shù)。而按照行進(jìn)方式分類，管道機(jī)器人又可分為活塞式、履帶式、滾輪式、足腿式等數(shù)種，如圖1所示。這些類型的管道機(jī)器人大部分針對的都是管徑較大且內(nèi)部為空氣介質(zhì)的管道。對于充滿液體或運(yùn)輸液體的管道，由于管內(nèi)環(huán)境復(fù)雜，研究成果相對較少[4-5]。本文結(jié)合上述幾種管道機(jī)器人的類型，提出了一種適應(yīng)較復(fù)雜液體環(huán)境的管道機(jī)器人系統(tǒng)，如圖2所示。該型機(jī)器人系統(tǒng)克服了防水問題和管徑狹小，水流環(huán)境復(fù)雜等問題，在保證管道能正常工作的情況下簡化了檢測程序，提高了檢測效率。

通過對液體環(huán)境中管道機(jī)器人的設(shè)計(jì)和動力裝置相關(guān)文獻(xiàn)的解讀[6-12]，我們知道：一般情況下，液體環(huán)境中管道機(jī)器人的設(shè)計(jì)需要滿足3點(diǎn)基本要求：1）力封閉。移動機(jī)構(gòu)在行進(jìn)過程中，應(yīng)具備支撐在管道內(nèi)壁上而不失穩(wěn)的能力，即機(jī)器人的支撐機(jī)構(gòu)受到管道的徑向支反力而組成1個(gè)封閉的力多邊形。2）形封閉。機(jī)器人在管道中工作時(shí)，為了能夠保持一定的姿態(tài)，不出現(xiàn)顛覆、扭轉(zhuǎn)的現(xiàn)象，這要求管道對機(jī)器人施加1個(gè)封閉的形狀約束。也就是說行走機(jī)構(gòu)至少需要3個(gè)對稱支撐點(diǎn)。3）驅(qū)動行走。行進(jìn)機(jī)構(gòu)應(yīng)具有主動驅(qū)使機(jī)構(gòu)[13]。

該型機(jī)器人系統(tǒng)正是依照上述的3個(gè)要求設(shè)計(jì)，其基本外形是在膠囊型的外形上進(jìn)行了相應(yīng)的改進(jìn)，主要由殼體，動力裝置，隔板，控制裝置和支撐裝置組成。采用兩個(gè)對稱安裝的直流電動機(jī)或噴水推進(jìn)器作為動力輸入。其中，殼體部分由一個(gè)空心半球和一個(gè)帶圓頂?shù)目招膱A柱體用過渡配合的螺紋與密封圈連接而成，具有良好的防水性能。考慮到機(jī)器人便于維護(hù)和生產(chǎn)的需求，其內(nèi)部結(jié)構(gòu)采用模塊插接式設(shè)計(jì)，在空心圓柱體部分內(nèi)有兩道沿內(nèi)壁的溝槽，內(nèi)置兩塊可插接的帶孔隔板8，將主體分為3部分。底層放置電池組，中部放置兩個(gè)帶支撐架的直流電動機(jī)（或噴水推進(jìn)器）作為動力裝置，分別驅(qū)動位于首尾的兩套槳軸設(shè)備，以實(shí)現(xiàn)在管道內(nèi)的往復(fù)運(yùn)動。上部放置控制裝置3并與電池組2之間通過隔板上的小孔實(shí)現(xiàn)導(dǎo)線連接。這種設(shè)計(jì)使得內(nèi)部結(jié)構(gòu)緊湊，層次分明，方便設(shè)備安裝和維修，同時(shí)極大地縮小了機(jī)器人的體積，使得該型機(jī)器人可以在較狹窄的細(xì)長直管道內(nèi)執(zhí)行工作任務(wù)。同時(shí)，在圓柱體部分外壁連接有一透明可拆卸的空心圓頂，其與主體部分之間同樣為螺紋與密封圈相結(jié)合的連接，內(nèi)置舵機(jī)和傳感器6。在透明圓頂兩側(cè)還外伸有2個(gè)小型機(jī)械手臂7，用于在檢測時(shí)對管道進(jìn)行一定程度的維護(hù)，如清洗內(nèi)壁等。機(jī)械手底座與主體采用對稱布置的4個(gè)螺栓固定。

圖2 一種液體環(huán)境管道機(jī)器人系統(tǒng)結(jié)構(gòu)圖

圖3 管道機(jī)器人樣機(jī)進(jìn)行水下運(yùn)動測試

支撐裝置是系統(tǒng)的關(guān)鍵部分。該機(jī)器人配有一對可拆卸支撐裝置5，每個(gè)支撐裝置由支撐環(huán)9，支撐桿10，彈簧11，軸承滑輪12組成。支撐桿采用圓周對稱布置，用含一定阻尼程度的鉸鏈固定于支撐環(huán)上并與固定環(huán)上的彈簧相連。工作時(shí)，機(jī)器人往往會遇到管徑不斷變化的管道，管徑縮小時(shí)，彈簧將被拉長，支撐桿整體內(nèi)收并依靠彈簧彈力緊緊壓在管壁上以保證系統(tǒng)的平穩(wěn)運(yùn)動。管徑擴(kuò)大時(shí)，彈簧放松，支撐桿自然伸開用于保持與管壁的緊密配合，以適應(yīng)機(jī)器人在不同管徑的管道內(nèi)工作的需求。支撐裝置的加入不但使機(jī)器人運(yùn)動更為平穩(wěn)，防止在充滿液體的管道內(nèi)部因產(chǎn)生空泡或湍流等復(fù)雜環(huán)境時(shí)導(dǎo)致的機(jī)器人晃動。機(jī)器人選用電動機(jī)作為動力裝置時(shí)，還可以克服因?yàn)闃S轉(zhuǎn)動產(chǎn)生的轉(zhuǎn)矩，避免了機(jī)器人在液體中打轉(zhuǎn)這種情況的出現(xiàn)。為方便支撐裝置的安裝和拆卸，在機(jī)器人殼體兩側(cè)各有一道2～3 mm的環(huán)狀溝槽，使用時(shí)，將帶有支撐架的支撐環(huán)分別套在主體兩側(cè)，支撐裝置將自動卡進(jìn)預(yù)設(shè)的溝槽中，避免了機(jī)器人運(yùn)動過程中支撐環(huán)可能發(fā)生的軸向竄動。使用該機(jī)器人時(shí)，將3塊擋板分別插入半球體特別設(shè)置的凹槽中，并相應(yīng)地放置動力裝置、電池組和傳感器組件。并將1對支撐裝置套于外殼兩側(cè)，即可將該機(jī)器人置于管道中。由于支撐裝置上的彈簧的存在，其支撐裝置上的軸承滑輪將自動壓緊在管道內(nèi)壁，實(shí)現(xiàn)機(jī)器人與管壁緊密配合，如圖3所示。由于彈簧具有一定形變量，故該機(jī)器人可適應(yīng)不同口徑的管道。當(dāng)管道中充滿液體或輸送液體時(shí)，該機(jī)器人便可進(jìn)行工作。管外操作人員可通過遙控裝置，實(shí)時(shí)判斷機(jī)器人在管道中的位置和觀察管壁內(nèi)部的損傷情況，并可操作兩個(gè)小型機(jī)械手臂對管壁進(jìn)行簡單的檢修工作。

2 管道機(jī)器人控制系統(tǒng)設(shè)計(jì)

系統(tǒng)控制需要完成對機(jī)器人的運(yùn)動方向、速度、角度的控制，姿態(tài)的調(diào)整等，對電動機(jī)的驅(qū)動控制是整個(gè)控制系統(tǒng)的關(guān)鍵[14-15]。本研究控制系統(tǒng)的設(shè)計(jì)包括單片機(jī)控制程序的設(shè)計(jì)和手機(jī)軟件的開發(fā)兩方面。

2.1 STC15系列單片機(jī)控制程序設(shè)計(jì)

該機(jī)器人采用以STC15系列單片機(jī)為核心的電動機(jī)舵機(jī)兩用開發(fā)板，其控制對象包括2個(gè)直流電動機(jī)和至少3個(gè)小型舵機(jī)。對于直流電動機(jī)來說，其運(yùn)動參數(shù)包括正反轉(zhuǎn)和加減速。調(diào)速只需要改變直流電動機(jī)的電壓就可實(shí)現(xiàn)對速度的控制，最常見的方法是PWM脈寬調(diào)制，調(diào)節(jié)電動機(jī)的輸入占空比就可以控制電動機(jī)的平均電壓，進(jìn)而達(dá)到控制轉(zhuǎn)速的目的，占空比越大，電動機(jī)轉(zhuǎn)速越快。至于電動機(jī)的正反轉(zhuǎn)，只需要通過改變電動機(jī)的正負(fù)極就可以實(shí)現(xiàn)正反轉(zhuǎn)控制，改變電動機(jī)的正負(fù)極可使用繼電器實(shí)現(xiàn)。

舵機(jī)的工作原理是：控制信號由接收機(jī)的通道進(jìn)入信號調(diào)制芯片，獲得直流偏置電壓，其內(nèi)部有1個(gè)基準(zhǔn)電路，產(chǎn)生周期為20 ms、寬度為1.5 ms的基準(zhǔn)信號，將獲得的直流偏置電壓與電位器的電壓比較，獲得電壓差輸出。最后電壓差的正負(fù)輸出到電動機(jī)驅(qū)動芯片決定舵機(jī)的正反轉(zhuǎn)。當(dāng)舵機(jī)轉(zhuǎn)速一定時(shí)，通過級聯(lián)減速齒輪帶動電位器旋轉(zhuǎn)，電壓差為0時(shí)，舵機(jī)停止轉(zhuǎn)動。舵機(jī)的控制信號是PWM信號，利用占空比的變化改變舵機(jī)的位置。單片機(jī)系統(tǒng)若實(shí)現(xiàn)對舵機(jī)輸出轉(zhuǎn)角的控制，必須完成2個(gè)任務(wù)：首先是產(chǎn)生基本的PWM周期信號；其次是脈寬的調(diào)整，即單片機(jī)模擬PWM信號的輸出并且調(diào)整占空比。當(dāng)系統(tǒng)中只需要實(shí)現(xiàn)1個(gè)舵機(jī)的控制時(shí)，采用的控制方式是改變單片機(jī)的1個(gè)定時(shí)器中斷的初值，將信號分為2次中斷執(zhí)行，1次短定時(shí)中斷和1次長定時(shí)中斷，這樣使控制系統(tǒng)工作效率和控制精度都很高。本控制系統(tǒng)的部分程序如圖4所示。

圖4 遙控裝置控制電動機(jī)的部分程序

2.2 手機(jī)軟件的開發(fā)

圖5 手機(jī)app軟件的控制界面

手機(jī)app的應(yīng)用使得該型機(jī)器人的控制更加方便。該配套手機(jī)軟件包括二級界面，并與STC15系列單片機(jī)開發(fā)版通過藍(lán)牙連接。該app由智能小車控制軟件改進(jìn)而來，其界面如圖5所示。第1級界面主要功能為控制兩個(gè)直流電動機(jī)的轉(zhuǎn)向。界面包括4個(gè)電動機(jī)轉(zhuǎn)向調(diào)節(jié)鍵和兩個(gè)舵機(jī)轉(zhuǎn)速控制鍵。4個(gè)方向鍵分別可控制2個(gè)電動機(jī)的正反轉(zhuǎn)和單個(gè)電動機(jī)的正反轉(zhuǎn)。當(dāng)系統(tǒng)所裝舵機(jī)多于2個(gè)時(shí)可通過設(shè)置鍵內(nèi)的第二級界面進(jìn)行調(diào)節(jié)。設(shè)置鍵內(nèi)的第2級界面可調(diào)節(jié)2個(gè)電動機(jī)的行進(jìn)速度和至多6個(gè)舵機(jī)的轉(zhuǎn)速。拖動橫條即可實(shí)現(xiàn)速度的選擇控制。選擇完成后系統(tǒng)將自動退回第一級界面完成數(shù)據(jù)更新。該app軟件的使用方法與遙控手柄基本相同。使用前，只需點(diǎn)擊界面左上方的藍(lán)牙連接鍵即可實(shí)現(xiàn)與單片機(jī)的連接。當(dāng)使用遙控手柄修改轉(zhuǎn)速時(shí)，需進(jìn)入軟件的第2層界面進(jìn)行設(shè)置。軟件界面上的數(shù)據(jù)可以隨機(jī)器人工作速度的需要進(jìn)行編程修改，以適應(yīng)不同液體環(huán)境下的工作要求。

3 結(jié)語

本文針對當(dāng)前管道維護(hù)中存在的檢修困難，效率低下等問題及當(dāng)前液體環(huán)境下對管道無損檢修的需求，設(shè)計(jì)并制造了管道內(nèi)往復(fù)運(yùn)動的管道機(jī)器人樣機(jī)：1）該機(jī)器人系統(tǒng)通過1對特殊的彈性支撐裝置，可實(shí)現(xiàn)液體環(huán)境下水平直管道的檢測和維護(hù)工作。該系統(tǒng)可在管內(nèi)實(shí)現(xiàn)不同速度的往復(fù)運(yùn)動，通過系統(tǒng)攜帶的圖像傳感裝置實(shí)時(shí)向管外工作人員反映管內(nèi)壁的情況，從而做到對管道進(jìn)行及時(shí)有效的維護(hù)。2）整個(gè)系統(tǒng)使用基于STC15系列的控制板，并實(shí)現(xiàn)了遙控手柄和手機(jī)軟件平臺兩種控制，使機(jī)器人系統(tǒng)的操作更加便利。這種液體環(huán)境下的管道機(jī)器人體積小，結(jié)構(gòu)簡潔，維護(hù)方便，可同時(shí)實(shí)現(xiàn)管道內(nèi)的無損檢測和簡單檢修功能，極大地提高了管道的維護(hù)效率，對減少管道維護(hù)成本，加快工業(yè)生產(chǎn)具有重要意義，可廣泛應(yīng)用于管道運(yùn)輸行業(yè)。

[1] 陸麒,章亞男,沈林勇,等.適應(yīng)管徑變化的管道機(jī)器人[J].機(jī)械設(shè)計(jì),2007,24(1):16-19.

[2] 王殿君,李潤平,黃光明.管道機(jī)器人的研究進(jìn)展[J].機(jī)床與液壓,2008,36(4):185-187.

[3] 譚湘強(qiáng).液體中微機(jī)器人的運(yùn)動機(jī)理與實(shí)驗(yàn)研究[D].廣州:廣東工業(yè)大學(xué),2002.

[4] 甘小明,徐濱士,董世運(yùn),等.管道機(jī)器人的發(fā)展現(xiàn)狀[J].機(jī)器人技術(shù)與應(yīng)用,2003(6):5-10.

[5] 鐘映春,楊宜民.新型無纜管道機(jī)器人的研究[J].機(jī)械工程師,2004(8):3-5.

[6] 王宏剛.微小管道機(jī)器人結(jié)構(gòu)設(shè)計(jì)及動力學(xué)分析[D].長沙:國防科技大學(xué),2007.

[7] 朱永梅,孫小艷,張超.新型微型管道機(jī)器人結(jié)構(gòu)設(shè)計(jì)及其運(yùn)動可行性分析[J].江蘇科技大學(xué)學(xué)報(bào)(自然科學(xué)版),2013,27(4):351-355.

[8] 海波,包志炎.螺旋輪式微型管道機(jī)器人設(shè)計(jì)[J].機(jī)械工程師,2008(7):29-30.

[9] 湯婷潔,李朝東.微型管道機(jī)器人及其電驅(qū)動技術(shù)[J].微特電動機(jī),2005,33(4):36-38.

[10] 肖楠.尾部驅(qū)動微管道機(jī)器人[D].哈爾濱:哈爾濱工程大學(xué),2007.

[11]HAYASHI I,IWATSUKI N,MORIKAWA K,et al.An in-pipe operation microrobotbased on the principle ofscrewdevelopment of a prototype for running in long and bent pipes[C]//International Symposium on Micromechatronics and Human Science.IEEE,1997:125-129.

[12]馬榮朝,秦嵐.微小管道機(jī)器人移動機(jī)構(gòu)運(yùn)動學(xué)與動力學(xué)特性[J].重慶大學(xué)學(xué)報(bào)(自然科學(xué)版),2002,25(7):26-29.

[13] 權(quán)正漢.管道測試機(jī)器人系統(tǒng)設(shè)計(jì)研究[D].上海:上海大學(xué),2003.

[14]劉斌.管內(nèi)移動機(jī)器人控制系統(tǒng)的研究[D].天津：天津大學(xué)，2000.

[15]王立權(quán)，賈守波，郭黎濱，等.城市排水管道機(jī)器人控制系統(tǒng)研究[J]機(jī)床與液壓，2008（6）：96-98.