管內步伐式行走機器人

《管內步伐式行走機器人》由會員分享，可在線閱讀，更多相關《管內步伐式行走機器人（25頁珍藏版）》請在裝配圖網上搜索。

1、 1 管道機器人的發(fā)展 1.1課題的背景及來源 本課題來源于實際運輸煤氣作業(yè)中所遇到的困難，許多城市煤氣回收萘不徹底，造成在主管道內結萘，管內萘堵塞管內面積超過50%以上，嚴重影響煤氣的運輸，以清除管內結萘為目標，著手研制此管內步伐式機器人。 1.2管內機器人發(fā)展綜述 機器人是人類新世紀的偉大發(fā)明之一，是傳統(tǒng)的機構學與近代電子技術相結合的產物，是計算機科學、控制論、機構學、信息科學和傳感技術等多學科綜合性高科技產物，它是一種仿人操作、高速運行、重復操作和精度較高的自動化設備，機器人技術的出現(xiàn)和發(fā)展，不但使傳統(tǒng)的工業(yè)生產和科學研究發(fā)生根本性的變化，而且將對人類的社會生活產生深遠的影響

2、?？茖W技術是第一生產力，在各國之間綜合國力的競爭，很大程度上取決于高技術之間的競爭，作為機電一體化的最高成就——機器人技術作為高技術的一個重要分支，普遍受到了各國的重視，隨著計算機技術和現(xiàn)代設計制造水平的不斷提高，極大的推進了機器人的發(fā)展，現(xiàn)代機器人已經成為了一個龐大的家族。 1.2.1機器人的定義 機器人技術是一種面向未來的現(xiàn)代化技術，機器人技術與網絡技術、基因技術、通信技術、計算機技術等一樣，屬于高新技術。它設計的學科有材料科學、計算機技術、控制技術、傳感器技術、微電子技術、通訊技術、人工智能、數(shù)學方法、仿生學等等很多學科，所以機器人的定義也是多種多樣的，其原因是它具有一定的模糊性。目

3、前有幾個國際公認的定義： 1979年美國機器人協(xié)會將機器人定義為：“可重復編程的多功能操縱器，設計成通過不同的編程動作為執(zhí)行多種任務移動原料、部件。工具或專門的設備?！? 1984年12月國際標準化組織中的工業(yè)自動化系統(tǒng)委員會所屬工業(yè)用機器人分會作出的定義：機器人是一種自動控制下通過變成可完成某些操作或移動作業(yè)的機器。 1988年法國的埃斯皮奧將機器人學定義為：機器人學是指設計能根據(jù)傳感器信息實現(xiàn)預先規(guī)劃好的作業(yè)系統(tǒng)，并以此系統(tǒng)的使用方法作為研究對象。 我國科學家對機器人的定義是：“機器人是一種自動化的機器，所不同的是這種機器人具備一些與人或生物相似的智能能力，如感知能力、規(guī)劃能力、動

4、作能力和協(xié)同能力，是一種具有高度靈活性的自動化機器”。 1.2.2我國管道機器人的發(fā)展、 哈爾濱工業(yè)大學鄧宗全教授自1987年以來開展管內機器人行走機構，在國家自然科學基金的資助下，較全面的研究了不同類型的管道機器人行走機構模型，取得了很多的成果。在1995年哈工大與大慶油建公司合作研制成功的Φ660野外大孔徑管線對接焊縫工業(yè)X射線檢測系統(tǒng)，于1996年通過黑龍江科委主持的鑒定，在陜京管線上進行了工業(yè)應用，獲得成功。該機器人采用輪式行走機構，雙電機驅動，PWM直流脈寬調速，由工控機和MCS-552單片機共同控制，可自動進行圖像識別，在管內移動距離300m，在技術上解決了收放線的控制

5、問題和長距離強弱信號混傳干擾問題。該項目以達到國際先進水平。 圖1.1哈爾濱工業(yè)大學Φ660管道機器人 哈爾濱工業(yè)大學于1998年研制的水泥砂漿襯里噴涂補口作業(yè)機器人樣機（如下圖），該機器人采用輪履復合式行走方式，解決了穿越管內凹型障礙的技術難題，針對水泥砂漿的流變學特性，所設計的螺旋送料裝置及離心噴涂裝置解決了水泥砂漿的補口難題。 圖1.2 清華大學于2001年研制出了一種輪式管道檢測機器人Pipesbot-I，如下圖所示，該機器人采用全驅動直進式結構，由三個直流電機通過蝸輪蝸桿副，帶動三個徑向均布的驅動輪，通過一個剪形彈簧壓緊機構使驅動輪撐緊管壁，依靠摩擦力運動

6、。設計指標為：行走速度1km/h，探測長度1km/次，使用管徑Ф140mm-180mm。 圖1.3 2機器人總體設計方案 2.1模塊化設計理念 2.1.1模塊化設計理論基礎 模塊化設計是在產品設計和生產不斷發(fā)展的過程中逐步形成的，是一種設計方法。而模塊化設計思想?yún)s由來已久，其基本思想是以產品（系統(tǒng)）的總功能為對象，以功能分析為基礎，將整個產品分解為若干特定的模塊，然后通過模塊的不同組合，可以得到不同產品、不同功能的產品，以滿足市場的各種需求。 模塊化又稱模件化，模塊化的定義有很多種，但是按其概念有如下的定義：由若干具有不同用途（或性能）并可互換的模塊，經不同的組合，以滿

7、足不同需要的這種方法稱之為模塊化。由此可見模塊化應具有四個基本含義：①必須具有一定數(shù)量的模塊；②應用系統(tǒng)組合原理；③最終要獲得能基本滿足各種不同功能的需要；④模塊化的可分性。 進行模塊化設計時，必須首先把產品劃分為若干模塊，然后以模塊為基本單元進行設計。因此，模塊合理劃分與否將直接影響產品的性能、外觀以及模塊通用化的程度和成本。模塊化產品，通常按功能將產品劃分為若干單元，并使功能單元獨立化，這些單元被稱為功能模塊，然后由功能棉毛褲系統(tǒng)實現(xiàn)產品的總共能。 2.1.2管內步伐機器人的模塊化設計 模塊的設計問題是模塊化設計的核心問題，因此合理的劃分模塊并構造模塊的結構是模塊化設計的關鍵。我們依

8、據(jù)功能劃分的模塊化設計方法，將管內步伐式行走機器人劃分為加緊模塊和傳動模塊兩個主要部分，模塊之間除標準化的機械與電氣連接接口外，其設計相互獨立。 模塊化設計的核心思想是將產品進行模塊劃分后，通過對某些模塊進行重新設計或變異設計得到新的產品。根據(jù)此思想，我們可以對管內步伐式行走機器人進行各種變異設計，滿足不同使用要求和應用環(huán)境要求。 2.2管內步伐式行走機器人的用途及工作原理 2.2.1管內步伐式行走機器人的用途 近年來煤氣回收萘不徹底，造成主管道內結萘，管內結萘堵塞管內大部分面積，嚴重影響煤氣輸送，以清除管內萘為目標,研制管內步伐機器人，該機器人可以完成自動清除結在煤氣管道內壁的萘

9、，可實現(xiàn)在管道內雙向行走、自動隨管道彎度轉向，可在重載條件下使用。、 2.2.2管內步伐式機器人的工作原理 工作原理：管內步伐式行走機器人的運動模仿人在井筒中四肢扶壁上下運動的模式。機器人由鏡面對稱的兩個單元組成, 二單元中間由萬向節(jié)鉸鏈連接,可以自動適應管道彎度轉向，當管道有彎道時,后腳踩住管壁向前推進,機器人的前腿機構自動隨管道彎度轉向不需要專門控制。機器人的轉彎最小曲率半徑由機構決定。所以這種機器人是可以雙向運動的自動轉彎步伐式管內機器人。 主要工作過程： 圖2.1 A、初始狀態(tài):前腳踩在管壁上,后腳在抬起狀態(tài)前后腿外擺到最大角度.(見圖1.1a) B、第一前進步:前

10、后腿同時內擺到最大角度,在腿內擺過程中,前腳踩住管壁不動,連桿機構拖動身軀和后單元向前移動一步(圖1.1a到b) C、第一次交換支撐腳:后腳外伸踩住管壁,同時前腳縮回抬起離開管壁,實現(xiàn)支撐腳轉換,在交換支撐腳過程中,機器人沒有前后運動。(圖1.1b到c) D、第二前進步:前后單元的腿同時外擺到最大角度,在擺腿過程中,后腳踩住管壁不動,連桿機構拖動身軀和前單元向前移動了第二步.(圖1.1c到d) E、第二次交換支撐腳:后腳縮回抬起,前腳伸出踩住管壁, 同時前后腿外擺到最大角度恢復到初始位置,機器人沒有前后運動。(圖1.1d到a) 2.3管內步伐式行走機構 管內步伐式機器人的機構主要分為

11、3部分，有撐腳機構及其傳動、牽引機構及傳動、轉向機構等。下面分別介紹3種機構，下圖為管內步伐式機器人的機構簡圖。 圖2.2 2.3.1撐腳機構及其傳動 撐腳機構的作用是使管道機器人被支承在管道中心線上。其機構及傳動由電機(16)、小齒輪(15)、齒圈及平面螺紋(14)、滑桿(13)、腳靴(12)組成。當電機(16)帶動小齒輪(15)和齒圈(14)旋轉時，齒圈背面的平面螺紋驅動滑桿(13)在筒體(10)的徑向軌道內外伸推動腳靴踩在管壁上，電機反向旋轉時，滑桿內縮帶動腳靴徑向抬起離開管壁。腳靴三套在圓周上間隔120布置，三套腳靴同步伸縮,其動作與車床三爪卡盤的

12、動作類同。三套腳靴伸出踩在管壁上時,使機器人處在管道的中心線上。為了使機器人在腳靴縮回時, 仍能維持在中心線上,安裝4 組輔助支承輪(18),每組三套, 在圓周上間隔120安裝,支承輪通過支承柱(19)、彈簧(20)分別與支架(3)和筒體(10)固連。當撐腳縮回時支承輪使機器人基本上維持在管道中心線上。當機器人行走過程中支承輪遇到障礙時彈簧被壓縮通過障礙。 2.3.2牽引機構及其傳動 牽引機構的作用是拖動機器人前進。 牽引機構(見圖2) 由電機( 1)、 螺桿(2)、螺母(5)撥銷(4)、撥桿(7)和支承桿(9)組成。當電機(1)帶動螺桿轉動時,螺母受撥桿的約束不能轉動而沿螺桿軸向移動

13、,固連其上的撥銷(4) 撥動撥桿(7)順時針方向轉動, 由于腳靴(12) 鎖死在管壁上, 支承桿(9)不能向后運動,撥桿(7)通過銷(6)帶動支架(3)及其固連在(3)上的套筒(11)在筒體(10)內向前滑動, 同時通過萬向節(jié)(21)拖動機器人的后單元，此時后單元的腳靴在抬起狀態(tài))向前運動,整個機器人前進。當腳靴( 12)處在抬起位置時, 撥桿( 7)通過支承桿( 9)推動筒體在套筒(11)上向萬向節(jié)方向滑動改變了腿的姿勢。 2.3.3轉向機構 　　轉向機構的作用是使機器人能隨管道的彎曲自動轉向通過彎曲管道。管道行走機器人由兩個鏡面對稱的單元組成,兩個單元的套筒間由萬向節(jié)( 21)連接

14、, 這是一個十字萬向節(jié)機構,可使前后兩單元在任意方向上轉動。 當管道彎曲時萬向節(jié)可自動轉向適應彎曲管道,這樣機器人通過彎曲管道時無需專門進行檢測和控制。 2.4步伐機器人的本體技術要求 機器人設計的目的是靠行走來清除管道內的堵塞物，因此，首要的目標是使機器人能夠在較長的管道空間內安全可靠的爬行，在此基礎上，進一步的使機器人移動靈活，結構簡單，操作方便，滿足一定的技術經濟性要求。 2.4.1支撐機構的技術要求 根據(jù)步伐機器人的運動特點，撐腳機構是主體，所產生的支撐力應能保證機器人在單步運動中一端鎖定在管壁中，使機器人在單步工作中保持穩(wěn)定。在支撐-放松過程中能自

15、如的進行，有一定的機械自鎖能力提高安全性。 對撐腳機構的要求是：能夠產生足夠大的支撐力；放松和支撐能夠收放自如；結構簡單、輕量化。 2.4.2傳動機構 傳動機構應能保證一定的驅動力和傳送速度，有較高的工作效率，能夠有較高的傳動穩(wěn)定性。因此擬采用滾珠絲桿副。實用滾珠絲桿副有很多有點： ①滾珠絲桿副是一種新型的螺旋傳動元件，能夠適應高溫、低溫、無潤滑、水中，技術比較成熟。 ②滾珠絲桿副具有高效率和高精度的特點。 ③具有高速特性和耐磨損性及運動可逆性等特性，而且無回程間隙。 ④構件間的可動聯(lián)接通常不是借助于運動副本身，而是在絲杠和螺母兩構件間利用中間元件（滾珠）來實現(xiàn)。 ⑤軸向高度高

16、，摩擦阻力小，運動平穩(wěn)。 2.5本章小結 本章主要介紹了機器人的本體結構及技術要求，將機器人模塊劃分，為下面具體設計提供依據(jù)。 3管內步伐式機器人的有關參數(shù)選擇 3.1步伐式機器人移動方式的選擇 各常用移動方式的優(yōu)缺點見表1.1 移動方式 優(yōu)點 缺點 輪式 移動速度快，控制方便，轉彎容易 與壁面接觸面積小，越障礙能力差，易產生打滑。 履帶式 與壁面接觸面積大，承載能力大，移動速度快，對壁面的適應能力強 履帶磨損大，結構復雜，機動性較差。 腿式 越障礙能力強，承載能力大，機動性好，具有很強的壁面適應能力。 結構復雜，移動是間歇的，速

17、度慢，關節(jié)和足數(shù)多，控制復雜。 蠕動式 承載能力大，運動平穩(wěn)，控制簡便，對壁面適應能力比較強 運動速度慢，越障礙能力差 表3.1 我們經過多方案比較，設計了一種步伐式行走結構形式，該結構形式有前后兩段相互獨立的主體，主體上的接觸腳可伸縮鎖死在管壁上，能承受大載荷，適合在重載中使用。在行走機器人結構中用步伐式行走具有很多優(yōu)點，可實現(xiàn)在規(guī)則形狀的任意長的管道內運動。結構簡單緊湊、運行平穩(wěn)，控制簡便，還可以根據(jù)使用要求，做各種變形設計，具有較好的經濟技術效果。 此處省略NNNNNNNNNNNN字。如需要完整說明書和設計圖紙等.請聯(lián)系扣扣：九七一九二零八零零 另提供全套機械畢

18、業(yè)設計下載！該論文已經通過答辯 3.2機器人驅動方案的選擇 目前對于機器人的動力系統(tǒng)有多種不同的選擇方案，可以采用電氣驅 動、液壓驅動、氣壓驅動、機械驅動等不同的方式。不同的動力系統(tǒng)具有不同的特點，根據(jù)不同的工作環(huán)境和應用場合，按照具體的要求來選擇最合適的動力系統(tǒng)可以達到預定的目標。下表為不同的驅動方式的性能對照表。 項目 氣壓驅動 液壓驅動 電氣驅動 機械驅動 技術要求 較低 較高 最高 較低 動作快慢 較快 較慢 快 慢 速度穩(wěn)定性 較差 良好 較好 很好 驅動力 中等 最大 較大 較大 環(huán)境要求 適應性好 不怕震動

19、 要求高 一般 控制距離 中等 短 長 短 經濟性 便宜 較貴 較貴 一般 系統(tǒng)結構 簡單 復雜 復雜 稍復雜 使用維護 簡單 稍高 較高 簡單 速度調整 容易 很容易 稍困難 困難 表3.2 氣壓驅動使用壓力通常在0.4-0.6Mpa，最高可達1Mpa。氣壓驅動的優(yōu)點是響應速度快，結構簡單，控制方便。氣壓驅動的缺點是功率質量比少，裝置體積大，同時由于空氣的可壓縮性使得機器人在任意定位時，位姿精度不高。氣壓驅動不可避免的存在漏氣的問題和氣壓裝置體積較大，這一點不符合本步伐式機器人的工作空間要求，不適合在本系統(tǒng)中使用。液壓驅動系統(tǒng)用

20、2-15Mpa的油液驅動，體積較氣壓驅動小，功率質量比大，驅動平穩(wěn)，液壓驅動的缺點是易漏油，這影響工作穩(wěn)定性和定位精度。由于有漏油的問題，也不適合在本系統(tǒng)中使用。 電氣驅動是利用各種電機產生的力或轉矩，直接或經過減速機構去驅動負載，減少了由電能變?yōu)閴毫δ艿闹虚g環(huán)節(jié)，直接獲得要求的機器人運動。由于電氣驅動具有易于控制，運動精度高，響應快，使用方便，信號檢測、傳遞和處理方便，成本低廉，驅動效率高，不污染環(huán)境等諸多優(yōu)點，電氣驅動已經成為最為普遍，應用最多的驅動方式，符合本系統(tǒng)要求。所以選擇電氣驅動與機械驅動相結合的方案。 3.3電機類型的選擇 在上節(jié)中介紹到，電機驅動適合本步伐式機器人，在電動

21、執(zhí)行機構中，有直流電機、交流電機、步進電機和直接驅動電機等實現(xiàn)旋轉運動的電動機，以及實現(xiàn)直線運動的直線電機。目前在機器人的運動控制中較為常用的電機有直流伺服電機、交流伺服電機和步進電機，他們的特性、工作原理與控制方式如下表。 電機類型 主要特點 構造與工作原理 控制方式 直流伺服電機 接通直流電即可工作，控制簡單；啟動轉矩大、體積小、重量輕、轉速和轉矩容易控制、效率高；需要定時維護和更換電刷，使用壽命短、噪聲大 由永磁體定子、線圈轉子、電刷和轉向器構成。通過電刷和換向器使電流方向隨轉子的轉動角度而變化，實現(xiàn)連續(xù)轉動。 轉速控制采用電壓控制方式，兩者成正比。轉矩控制采用電流控

22、制方式，兩者成正比。 交流伺服電機 沒有電刷和換向器，無需維護，驅動電路復雜，價格高 按結構分為同步和異步電機。無刷直流電機結構與同步電機相同，特性與直流電機相同。 分為電壓控制與頻率控制兩種方式。異步電機通常采用電壓控制 步進電機 直接用數(shù)字信號控制，與計算機接口簡單，沒有電刷，維護方便，壽命長，缺點是能量轉換效率低，易失歩，過載能力弱 按產生轉矩的方式可分為：永磁式。反映式和混合式 永磁式是單向勵磁，精度高，但容易失步，反應式是雙相勵磁，輸出轉矩大，轉子過沖小，但效率低，混合式是單雙相勵磁，分辨率高，運轉平穩(wěn) 表3.3 步進電機作為一種新型的自動控制系統(tǒng)的執(zhí)行機構，得到

23、越來越廣泛的應用，進入了一些高、精、尖的控制領域。步進電機雖然有一些不足，如啟動頻率過高或負載過大時易出現(xiàn)失步或堵轉，停止時轉速過高易出現(xiàn)過沖，且一般無過載能力，往往需要選取有較大轉矩的電機來克服慣性力矩。但步進電機點位控制性能好，沒有累積誤差，易于實現(xiàn)開環(huán)控制，能夠在負載力矩適當?shù)那闆r下，以較小的成本與復雜度，實現(xiàn)電機的同步控制。綜合考慮控制要求、成本等多方面因素，本系統(tǒng)選用步進電機作為驅動電機。 3.4 夾緊機構設計 在管內步伐機器人當中，夾緊機構是保證機器人具有良好的爬坡能力和越障能力的關鍵。夾緊機構分為機械式和液壓式兩種，機械式夾緊機構采用平面螺旋副。驅動在圓周上均布的三個接觸腳壓

24、向管壁達到鎖緊的目的。平面螺旋盤的驅動靠電機一凸輪副或電機一輪副驅動。液壓式夾緊機構采用液性介質彈性夾緊機構。為此我們提出了三種結構方案： ①電機一凸輪副結構方案 圖3.4 電機--凸輪服結構圖 工作原理為：電機經偏心圓弧凸輪，驅動平面螺旋盤在一定的角度內轉動，再推動接觸腳外伸或回縮從而與管道鎖緊與放松。此結構需在平面螺旋盤的背面徑向開一個配合凸輪的滑槽。 ②液壓式夾緊機構 液壓式夾緊機構是利用液性介質將壓力傳遞給薄壁彈性套筒，使薄壁套筒產 生均勻的徑向

25、變形，與管壁夾緊。如圖 所示為液壓式夾緊機構。其工作原理為電機經柱塞驅動液性介質，使基體外圓四周的薄壁發(fā)生彈性變形，夾緊管道內壁。 液性介質一般采用液性塑料或油液。 圖3.5 液壓式夾緊機構 ③電機一齒輪副結構方案 圖3.6 電機--齒輪副結構圖 工作原理為：電機經內齒輪副，驅動平面螺旋盤回轉。推動接觸腳外伸或回縮，與管道內壁夾緊或放松。 總結： 相比較幾種夾緊機構，液壓夾緊機構可在管壁的一個環(huán)形帶上獲得較大且均

26、 布的夾緊力。采用液性塑料介質，單位壓力可達而且還有較高的 定心精度,一般可保證同軸度在,但是液壓夾緊機構夾緊效果但是 不易放松.還有一個不可忽視的問題是油漏，這特性不適合爬行機器人的工作空 間的要求。電機一凸輪副雖然可以達到夾緊的功能要求，但是只能在一定的角度 內回轉，性能不優(yōu)越且對制造的要求較高。齒輪副的傳動精度和效率較高，控制方便?？僧a生較大的動力，適應性能好，所以爬行機器人本體的夾緊機構選用電機一齒輪副夾緊結構。即方案③ 3.5 減速結構設計 常用的機械傳動裝置有帶傳動、鏈傳動、齒輪傳動和蝸桿傳動等 圖3.7 鏈傳動的特點:①和齒輪傳動比較,它可以在

27、兩軸中心相距較遠的情況下傳遞運動和動力;②能在低速、重載和高溫條件下及灰土飛揚的不良環(huán)境中工作;③和帶傳動比較,它能保證準確的平均傳動比,傳遞功率較大,且作用在軸和軸承上的力較小;④傳遞效率較高,一般可達0.95～0.97;⑤鏈條的鉸鏈磨損后,使得節(jié)距變大造成脫落現(xiàn)象;⑥安裝和維修要求較高.鏈輪材料一般是結構鋼等. 圖3.8 帶傳動(皮帶傳動)特點(優(yōu)點和缺點):①結構簡單,適用于兩軸中心距較大的傳動場合;②傳動平穩(wěn)無噪聲,能緩沖、吸振;③過載時帶將會在帶輪上打滑,可防止薄弱零部件損壞,起到安全保護作用;④不能保證精確的傳動比.帶輪材料一般是鑄鐵等. 圖3.9

28、 齒輪傳動的特點:①能保證瞬時傳動比恒定,平穩(wěn)性較高,傳遞運動準確可靠;②傳遞的功率和速度范圍較大;③結構緊湊、工作可靠,可實現(xiàn)較大的傳動比;④傳動效率高,使用壽命長;⑤齒輪的制造、安裝要求較高.齒輪材料一般是鑄鐵等. 圖3.10 渦輪蝸桿傳動最主要的特點就是具有反向自鎖的功能，而且相比其它傳動具有較大的速比，渦輪蝸桿的輸入、輸出軸不在同一軸線上，甚至不在同一個平面上。自身的缺點，那就是渦輪蝸桿的傳動效率不夠高，精度也不是很高。 3.6本章小結 本章介紹了有關機器人一些參數(shù)數(shù)據(jù)的選擇，包括移動方式、驅動方式、及電動機的選擇，對整體方案比

29、較選型給出了依據(jù)和要求，確定了動力系統(tǒng)的方案，選擇步進電機作為驅動元件。 4管內步伐式行走機器人的力學分析 4.1機器人腳底對管壁的壓緊力（見圖2.2）{機器人結構簡圖} 根據(jù)虛位移原理撐腳電機6的有效虛功與腳底虛功相等 =3 η1T1△θ= 3F1△L1 其中:　T1——電機6 的扭矩 　　 F1——單腳在管壁上的壓力 ——電機的微小轉角 　——電機 6微小轉角對應的腳底伸出量 　　——傳動效率 由于

30、 其中，i——電機6到腳的傳動比；P1——平面螺紋的節(jié)距。 將機器人參數(shù)T1=6kgcm,n1=159,p1=1cm， =0.5代入方程 得F1=8.37kgf 4.2 管內步伐式器人的牽引力 根據(jù)虛位移原理牽引電機1的有效虛功與牽引虛功相等： 其中，T2——電機1的扭矩； ——電機1的微小轉角； ——電機1微小轉角對應的螺母3相對于螺桿的移動量；

31、 ——傳動效率； L1——擺桿4上臂長度； L2——擺桿4下臂長度 F2——牽引力 由于： 將機器人參數(shù)T2=9kgcm,L1=75mm,P2=3mm, =0.8 代入方程 得：F2=209kgf 4.3 無防滑機構條件下管壁壓力與牽引力的關系及打滑條件 其中，f支撐腳底與管壁的摩擦系數(shù)。 又有： 將該機器人參數(shù)帶入不等式右端并取得：

32、 T1/T2>11.1 在無防滑機構情況下，撐腳電機扭矩要大于扭矩11.1倍，機器人才能不打滑正常牽引行走，即該機器人產生209kg牽引力，牽引電機扭矩9kgcm,撐腳電機扭矩需100kgcm以上。 4.4　管內步伐式機器人的防滑機構及力學分析 如前分析由加大腳底對管壁的正壓力,使腳底與管壁間存在足夠的摩擦力,以保證機器人行走時不打滑的條件為：撐腳電機的扭矩大于牽引電機扭矩11.1 倍。這必然導致?lián)文_傳動機構龐大,機器人自重增加,這樣機器人可轉彎的最小半徑將加大,通過彎曲管道的能力減小,而且非主要做功電機遠遠大于主要做功電機是不合理的,因此設計了撐腳防滑機構。 4.

33、4.1撐腳防滑機構的工作原理 撐腳防滑機構如圖3所示.其中長銷(2)靠過盈配合固連在膠靴(3)上，當滑桿(1)與膠靴(3)相對移動時，長銷(2)在滑桿(1)的長槽中滑動，在膠靴踩上管壁前，由于彈簧(6)的作用使滑桿(1)相對于膠靴上移，固聯(lián)在滑桿(1)上的短銷(5)迫使兩擺桿(4)的夾角增大，使兩擺桿(4)的端部縮回到膠靴底面以上。當滑桿外伸時首先膠靴底與管壁接觸，膠靴底接觸管壁后，滑桿壓縮彈簧(6)繼續(xù)下移，短銷也隨滑桿下移，放松了兩擺桿(4)，在彈簧(7)的作用下，兩擺桿(4)的夾角減小，兩擺桿的端部從膠靴底面上伸出壓在管壁上，擺桿長度設計保證擺桿此時與種新鮮的夾角小于擺桿材料與管壁摩擦

34、角，膠靴左右滑動時右擺桿起作用，向左滑動擺桿起作用，被鎖死在管壁上不能左右滑動，起防滑作用。 圖4.1 4.4.2防滑機構受力分析， 防滑機構受力分析圖如下圖： 當機器人受力F 時支撐腳上的擺桿OA 和O′A′有分別繞 O 和 O′向右轉動傾向，A 點和A′ 點受管壁限制，管壁產生了反作用力Q, 銷軸產生反作用力Q′ , Q 和Q′ 的作用線在擺桿與管壁的接觸點A、銷軸磨擦圓的相切線上。當角小于磨擦角時，接觸點A 不能移動，而使O 和 O′ 有向管道中心運動的趨向而將機器人支撐機構鎖死，當牽引力F消失后Q 也隨之消失。

35、 圖4.2 防滑機構受力分析 4.5 有防滑機構情況下支撐電機計算 按支承電機維持機器人在管道中心的要求 其中: Q——機器人的半重量 　P1——平面螺紋的節(jié)距 ——傳動效率 機器人的半重量Q= 21kg ,將機器人參數(shù)代入上式得 T1＞4.2kgcm 本機選用的支撐電機扭矩為6kgcm. 4.6本章小結 本章主要對機器人的力學設計做了分析，對壓緊力，牽引力等做了分析，按照模塊化設計思想進行結構設計，便于后續(xù)工作。對本體進行了受力分析，推導出壓緊力和牽引力計算公式，對電機扭矩進行了計

36、算。 5管內步伐行走機器人控制系統(tǒng) 5.1控制系統(tǒng)的具體要求及控制對象 5.1.1控制系統(tǒng)的要求 ①控制系統(tǒng)應有快速響應性。 ②可靠性高，控制簡單，成本低 ③良好的速度、位移控制能力。 5.1.2具體的控制對象 ①機器人支撐機構的控制。步伐行走機器人采用前部和后部相互配合的一種尺蠖蠕動爬行機構，前部和后部的支撐機構采用平面螺旋副來進行工作，通過小齒輪來驅動平面螺旋副，前部和后部分別有一個電機作為動力源。因此需要控制2個步進電機。 ②機器人的傳動機構的控制。步伐行走機器人的傳動機構是滾珠絲桿副，絲桿與前部相連，螺母與后部相連，用一個步進電機通過齒輪副來驅動絲桿旋轉，靠軸

37、向力使機器人不斷的進行運動。 在管內步伐行走機器人中，所有部件的運動均是通過電機進行動力傳遞的，對支撐機構和傳動機構有穩(wěn)定性好、操作方便的要求，因此對電機的控制方式選擇是非常重要的，根據(jù)系統(tǒng)的具體要求，選用采用可編程控制器（PLC）對電機進行控制。 5.2PLC的組成結構與特點 從機構上分，PLC分為固定式和模塊式兩種。固定PLC板、I/O板、顯示面板、內存塊、電源等，這些元素組合成一個不可拆卸的整體。模塊式PLC包括CPU模塊、I/O模塊、內存、電源模塊、底板或機架，這些模塊可以按照一定的規(guī)則組合配置。圖4.1為PLC的結構框圖。 圖5.1PLC結構框圖

38、本系統(tǒng)選用采用PLC對電機進行控制，主要是因為它有下列優(yōu)點：①PLC的軟硬件功能非常強大，其內部具有很多功能；②使用維護方便，PLC不需要像用計算機控制那樣在輸入輸出接口上做大量工作，它的輸入輸出接口是已經按不同需求做好的，可以直接與控制現(xiàn)場的設備相連接的接口；③運行穩(wěn)定可靠，同時采用了微電子技術，大量的開關動作由無觸電點的半導體電路來完成，同時還才用了屏蔽、濾波、隔離等抗干擾措施，所以其平均為故障時間在兩萬小時以上；④設計施工周期短，PLC采用面向控制過程和面向問題的梯形語言編程方法，既繼承了傳統(tǒng)控制路線清晰直觀的優(yōu)點，又考慮了大多數(shù)電氣控制技術人員的讀圖習慣及應用微機水平，很容易被電氣技術

39、人員接受。 5.3PLC控制單元的組成 PLC控制單元主要有PC+PLC的上下位機、點擊驅動器、電機四大部分組成。上位機為高性能的PC機，下位機PLC通過位置模塊控制各個步進電機的運動，通過開關量輸入/輸出模塊接受和輸出各類開關量；上下位機之間的通過串行通訊進行數(shù)據(jù)聯(lián)系。本系統(tǒng)選用了LG公司的MasterK200系列中的K3P-07BS PLC。其組成框圖如4.2所示。系統(tǒng)的主要配置如下，PLC硬件配置。 CPU模塊 K3P-07BS 電源模塊 G6M-PAFA 輸入模塊 1 G6I-D222A 輸入模塊 2 G6Q-RY2A 輸出模塊 1 G6Q-RY2A 輸

40、出模塊 2 G6Q-RY2A 位置模塊 1 G6F-PP30 位置模塊 2 G6F-PP30 圖5.2 PLC控制單元組成框圖（The structure of PLC control system） 5.4 PLC控制單元工作流程及程序框圖 PLC控制單元的工作流程是：首先通過PLC控制頭部的夾緊電機工作，使頭部鎖止在管壁中，傳動電機是絲桿帶動尾部前進，達到指定位置時，尾部夾緊電機工作，使其鎖止在管壁中，頭部夾緊電機逆向轉動使頭部放松，使頭部向前移動。 程序控制框圖如 5.3 所示 。 圖5.3

41、 5.5本章小結 本章主要介紹了機器人的控制系統(tǒng)，對控制系統(tǒng)提出了設計要求及PLC電機控制單元分析。 6結論 本文提出了管道步伐式機器人的設計方案，對系統(tǒng)中的關鍵技術環(huán)節(jié)進行了深入的分析，成功地完成了系統(tǒng)的設計。對移動方式及受力分析等進行了分析，對系統(tǒng)技術單元的穩(wěn)定性、可靠性進行了分析。 本文的主要研究成果如下： ①廣泛的查閱了當前有關管內機器人的文獻，了解了國內外的研究現(xiàn)狀，通過對管內機器人的移動結構的對比、分析和設計，結合本課題的設計要求，提出了一種管內步伐式行走機器人。 ②系統(tǒng)的研究了管內機器人的運動原理、驅動方式以及結構形式，詳細的討論了管內機器人本體研制的相關技術問題。管內機器人的本體結構是本文的重點內容，對本體的支撐結構和傳動機構進行了具體的分析設計，在動力系統(tǒng)的驅動下在規(guī)定的管道中做步伐運動。機器人本體部分按功能劃分的模塊化設計方法進行設計，將本體結構分為支撐結構和傳動結構兩大模塊，對獨立的模塊可進行相應的變形設計。 ③設計了一種自鎖式安全保護裝置。 ④應用PLC作為控制核心，實現(xiàn)準確控制。 25