管道清灰機器人的設計畢業(yè)設計.doc

《管道清灰機器人的設計畢業(yè)設計.doc》由會員分享，可在線閱讀，更多相關《管道清灰機器人的設計畢業(yè)設計.doc（35頁珍藏版）》請在裝配圖網(wǎng)上搜索。

1、蘭州理工大學 畢業(yè)設計（論文）蘭 州 理 工 大 學LANZHOU UNIVERSITY TECHNOLOGY畢業(yè)設計（論文）題目： 管道清灰機器人的設計 專業(yè)： 機械設計及其自動化 班級： 2010級機械設計 姓名： 陸詩彧 指導老師：許軍山 楊萍 日期： 2012年12月 目錄前 言0第一章 概 述11.1機器人概述11.2管道機器人概述31.3國內(nèi)外管道機器人的發(fā)展41.3.1國內(nèi)外管道機器人的發(fā)展41.3.2國外管道機器人的發(fā)展51.3.3機器人的發(fā)展前景7第二章 總體方案的制定及比較92.1管道機器人設計參數(shù)和技術指標92.2總體結構的設計和比較92.2.1根據(jù)國內(nèi)外的管道機器人的移

2、動方式大致可分為六種：9第三章 部件的設計和計算153.1管道機器人工作計算153.2行走機構的設計和計算16（1）行走機構的驅(qū)動電機功率的預算16（2）行走機構結構的設計173.3撐開機構和放大桿組的設計223.4操作臂的設計23（1）吸塵器操作臂的設計23（2）卸料門的拉開桿件的設計23第四章 控制原理的設計244.1控制原理的分析和設計244.2主要控制流程圖：27致 謝2930 前 言第一章 概 述1.1機器人概述機器人這一詞最早使用始于1920年至1930年期間在捷克作家凱勒爾.凱佩克（KAREL CAPEK）的名為“羅薩姆的萬能機器人”的幻想劇中，一些小的人造的和擬人的傀儡絕對地服

3、從其主人的命令。這些傀儡被稱為“機器人”。該單詞起源于捷克語“ROBOTA”。意思是“強制的勞動”。機器人的組成與人類相似。舉例說，人搬運某一物體的運動過程中可用圖（a）所示的方塊圖來說明。首先，人聽到外部的命令或用眼睛看到外部的指令，并由眼睛測量出距離。感覺到這種信息經(jīng)過感覺神經(jīng)送到大腦中，大腦經(jīng)過分析計算，然后通過運動神經(jīng)發(fā)出指令，手臂用最好的方式伸向物體，并將物體抓住，手上的感覺神經(jīng)，感覺物體已經(jīng)抓牢了，把信息傳給大腦。大腦命令手抓起物體，同時指令腳移動到所要求到達的地點，最后放下物體。一般包括以下幾個部分見圖（b）：耳、眼腦手軀干腳對象環(huán)境感受、觀測運動神經(jīng)感覺神經(jīng)行走操作（a）操作人

4、員行走裝置執(zhí)行機構與操作人員聯(lián)系裝置感覺裝置外界環(huán)境控制裝置(b)1.控制中樞（相當于人的大腦），2.操作裝置（相當于人的手）； 3.行走裝置（相當于人的腳）；4.有感覺的機器人還必須有感覺裝置以及與外界環(huán)境聯(lián)系的裝置（相當于人的口、耳、眼、鼻以及皮膚上的感覺神經(jīng)）。實際的機器人在不同的程度上具有兩種特有的屬性：對環(huán)境的通用性和自動適應性。通用性：具有完成各種任務以及以不同的方式完成相同的結構或機械能力。這意味著機器人的機械結構具有可變的機械形狀。自動適應性：是指一個機器人必須被設計成由自己去完成任務，盡管難以預知，但卻可以有限的知道在完成任務期間環(huán)境的變化，通過改變路徑、姿態(tài)等來處理所面對的

5、問題，最終完成任務。為了對機器人進行分類，必須能夠定義和區(qū)分不同的類型，因此根據(jù)不同的定義就有不同的分類方法?，F(xiàn)在使用的有很多種。以下介紹日本工業(yè)機器人協(xié)會（JIRA）的分類方法：第一類：手工操作裝置：一種由操作人員操作的具有若干個自由度（DOF）的裝置；第二類：固有程序的機器人：依照預定的不變的方法按部就班執(zhí)行任務的操作裝置，對任務的執(zhí)行順序很難進行修改；第三類：可變程序的機器人：與第二類是同一種類型的操作裝置，但其執(zhí)行步驟可以修改；第四類：再現(xiàn)式機器人：操作人員 通過手動方式引導或控制機器人完成任務，而機器人控制裝置則紀錄其運動軌跡，需要時可以重新調(diào)出紀錄的軌跡信息，機器人就能以自動的方式

6、完成任務；第五類：數(shù)值控制機器人：由操作人員給機器人提供運動程序，而不是用手動方式教導機器人完成指定的作業(yè)任務；第六類：智能機器人：通過對環(huán)境變化的感知，改變其運動軌跡、姿態(tài)等措施圓滿的完成任務。機器人的誕生和機器人學的建立無疑是20世紀人類科學技術的重大成就。自60年代初機器人問世以來，作為20世紀人類最偉大發(fā)明之一的機器人技術，經(jīng)歷了近半個世紀的發(fā)展，已取得了長足的進步。特別是到了20世紀90年代，隨著計算機技術、微電子技術、網(wǎng)絡技術等的快速發(fā)展，機器人技術也得到了飛速發(fā)展。除了用工業(yè)生產(chǎn)中從事焊接、噴漆、搬運和裝配等作業(yè)的工業(yè)機器人的水平不斷提高之外，各種用于非制造業(yè)的特種、智能機器人系

7、統(tǒng)也有了長足發(fā)展。工業(yè)機器人在經(jīng)歷誕生成長成熟期后，已成為現(xiàn)代先進制造業(yè)中必不可少的核心裝備，當今世界上約有上百萬臺工業(yè)機器人正與工人朋友并肩戰(zhàn)斗在各條戰(zhàn)線上。非制造業(yè)中的仿人性機器人、農(nóng)業(yè)機器人、水下機器人、醫(yī)療機器人、軍用機器人、娛樂機器人、服務機器人等各種用途的特種機器人也正以飛快的速度向?qū)嵱没~進。1.2管道機器人概述20世紀70年代以來，石油、化工、天然氣及核工業(yè)等產(chǎn)業(yè)迅速發(fā)展，各種管道作為一種重要的物料輸送設施，得到了廣泛應用。由于腐蝕、重壓等作用，管道不可避免地會出現(xiàn)漏孔、裂紋等現(xiàn)象。同時多數(shù)管道安裝環(huán)境人們不能直接到達或不允許人們直接進入，為進行質(zhì)量檢測和故障診斷，采用傳統(tǒng)的全

8、面挖掘法、隨機抽樣法工程量大，準確率低，管道機器人就是為了解決這一實際問題產(chǎn)生的，它是由可沿管道內(nèi)部或外部自動行走裝置、攜有一種或多種傳感器及操作裝置如：機械手、噴槍、焊槍、刷子。管道機器人的工作空間是復雜、封閉的各種管道，包括水平直管、各角度彎管、斜坡管、垂直管以及變徑管接口等，所以需要在操作人員的遙控操作或計算機自動控制下，進行一系列管道作業(yè)。管道機器人可完成的管道作業(yè)有以下幾類：1. 生產(chǎn)、安裝過程中的管內(nèi)質(zhì)量檢測。2. 惡劣環(huán)境下管道清掃 、噴漆、焊接、內(nèi)部拋光等維護。3. 使用過程中焊縫情況、表面腐蝕、裂縫破損等故障診斷。4. 對埋地舊管道的修復。5. 管道內(nèi)外器材運送、搶救等其它用

9、途。1.3國內(nèi)外管道機器人的發(fā)展1.3.1國內(nèi)外管道機器人的發(fā)展國內(nèi)在管道機器人方面的研究起步較晚，而且多數(shù)停留在實驗階段。哈爾濱工業(yè)大學鄧宗全教授在國家“863”計劃課題“X射線檢測時成像管道機器人的研制”的支持下，開展了輪式行走方式的管道機器人研制，實現(xiàn)了管外機構同步運動作業(yè)無攬操作技術，并研制了鏈式和鋼帶式兩種新型管外傳動機構。該系統(tǒng)由六大部分組成（1）移動載體（2）視覺定位（3）收發(fā)線裝置（4）X射線機（5）檢測控制，系統(tǒng)控制（6）防護系統(tǒng)上海交通大學研發(fā)了小口徑管道內(nèi)蠕動式移動機構。它是模仿昆蟲在地面爬行時蠕動前進與后退的動作設計的。其主要機構由撐腳機構、三個氣缸（前氣缸、中氣缸、后

10、氣缸）、軟軸、彈簧片、法蘭盤組成。針對微小空間、微小管道時探測要求，研制成電磁驅(qū)動微小型管道機器人樣機。微小管道機器人由四個電磁驅(qū)動單元組成。其驅(qū)動機理模擬生物的蠕動爬行。它是通過給管道加一系列的時序脈沖進行控制，依次使各單元動作，達到蠕動爬行的運動。西安交通大學設計制作了蠕動式微動直線自行走機構。這種行走機構以電動縮微位移器做驅(qū)動器，以電磁鐵機構作為可吸附于行走表面的保持器。廣州工業(yè)大學借用仿生學原理，研制成結構獨特的，像蠕蟲一樣的微管道機器人的運動由電磁力驅(qū)動。機器人由前后兩個電磁線圈和前后兩個驅(qū)動器組成。當分別通電時，機器人的兩個驅(qū)動器互相吸合收縮。當后電磁線圈斷電時，后部突然放松，由此

11、產(chǎn)生的推力將機器人前部（前驅(qū)動器）向前推進一段距離；反向運動依次類推。1.3.2國外管道機器人的發(fā)展國外關于燃氣管道機器人的研究始于20世紀40年代，由于70年代的微電子技術，計算機技術、自動化技術的發(fā)展，管道檢測機器人技術于90年代初，得到了迅猛發(fā)展并接近于應用水平。日本機器人的的發(fā)展經(jīng)過了60年代的搖籃期，70年代的實用期，到80年代進入普及及提高期，開始在各個領域內(nèi)廣泛推廣使用機器人。日本管道機器人眾多，東京工業(yè)大學于1993年開始研究管道機器人，并且成功研制出THES系列的機器人，以下介紹THES2型管道機器人：其采用“電機蝸輪蝸桿驅(qū)動輪”的驅(qū)動方案，同時每個驅(qū)動輪都有一個傾斜角度測量

12、輪，通過測量輪探測機器人的傾斜角度，并反饋給電機，從而保證管道機器人的驅(qū)動輪以垂直的姿態(tài)運動。該管道機器人系統(tǒng)通過CCD攝像頭實現(xiàn)信息的采集，整個系統(tǒng)采用托攬控制式，檢測距離超過100CM。美國是機器人的誕生地，早在1962年就研制出世界上第一臺工業(yè)機器人，是世界上的機器人強國之一，其基礎雄厚，技術先進，并有很多管道機器人產(chǎn)品。美國INUKTUN公司系列管道檢測機器人VERSATRAX是國外現(xiàn)有的已成型管道機器人。美國紐約煤氣集團公司(NYGAS)的DAPHNEDPZURKO和卡內(nèi)基梅隆大學機器人技術學院的HAGENSCHEMPF博士在美國國家航空和宇宙行局（NASA）的資助下于2001年開發(fā)

13、了長距離、無攬方式的管道機器人系統(tǒng)EXLORER，專門用于檢測地下煤氣管道是情況。該管道機器人系列EXLORER就有如下特征：（1）一次作業(yè)檢測距離長，用無纜方式，自帶電池并且電池可以多次反復充電，是管道機器人具有良好的自推能力。（2）可以在鑄鐵和鋼質(zhì)煤氣管道中，低壓和高壓條件下工作。管道機器人的色彩攝像頭采用嵌入式“魚眼”鏡頭，結構非常緊湊。（3）可有利通過90的彎管接頭和垂直管道。（4）與外部操作人員采用無線通訊方式。（5）該管道機器人可以探測煤氣管道內(nèi)部是否水滲透、碎片堆積；可以確定內(nèi)部缺陷的確切位置并且定位相應的作業(yè)裝置；采用視頻圖像的形式準確反映管道內(nèi)部的狀況條件。德國工業(yè)機器人的總

14、數(shù)占世界第三位，僅次于日本和美國。德國學者BERNHARD KLAASSEN、HERMANN ST2REICH和FRANK KIRCHNER等人在德國教育部的資助下于2000年研制成功了多關節(jié)蠕蟲式管道機器人系統(tǒng)MAKRO。該機器人由六節(jié)單元組成，其頭部和尾部兩個單元體完成相同，每個單元之間的節(jié)點由3個電動機驅(qū)動，使得MAKRO可以抬起或者彎曲機器人個體，從而可以輕松越過障礙物或?qū)崿F(xiàn)拐彎運動，該管道機器人系統(tǒng)MAKRO具有21個自由度，長度為2M，質(zhì)量為50Kg，采用無纜控制方式，MAKRO系統(tǒng)使用于直徑為300600mm的管道。加拿大INUKTUN公司的雙履帶式管內(nèi)機器人行走機構，履帶采用剛

15、性支承結構，兩履帶的夾角可以調(diào)節(jié)，以適應不同的作業(yè)管徑。兩履帶調(diào)節(jié)到平行位置時，可以在平地或矩形管道內(nèi)行走。但這種剛性支承的雙履帶式管內(nèi)機器人行走機構的兩履帶夾角在行走過程中是無法改變的，因此不適合管徑變化的作業(yè)場合。KAWAGUCH等研制的管道檢測機器人系統(tǒng)只適用于500mm的管道，而且一次作業(yè)的檢測距離不大于500m;KUNTZE等采用四輪獨立屈服驅(qū)動方案研制成管道檢測機器人系統(tǒng)KARO，該機器人系統(tǒng)只能實現(xiàn)對500mm管徑的地下輸水管道的檢測，一次檢測距離為400m，系統(tǒng)采用托纜控制式。1.3.3機器人的發(fā)展前景展望21世紀機器人技術的發(fā)展趨勢，明顯地向著智能化（INTELLECTUAL

16、IZATION）發(fā)展，包括機器人本身向智能機器人進化和實現(xiàn)機器人化（ROBOTIZATION）系統(tǒng)。具體說，傳感型智能機器人發(fā)展較快，新型智能技術（如臨場感、記憶材料、多智能體系統(tǒng)以及人工神經(jīng)網(wǎng)絡和專家系統(tǒng)等）在機器人得到開發(fā)與應用，采用模塊化設計技術，進一步推動機器人工程，注意開發(fā)微型和小新機器人，重視研制行走機器人，研制應用于非結構環(huán)境下工作的非制造業(yè)機器人和服務機器人，開發(fā)敏捷制造系統(tǒng)，軍用機器人將用于裝配部隊等。總的說來，雖然存在不少難關，甚至出現(xiàn)某些陰影，但新世紀機器人學的發(fā)展前景是十分光明和充滿希望的。第二章 總體方案的制定及比較2.1管道機器人設計參數(shù)和技術指標（1）管道機器人的

17、工作環(huán)境a.管道為金屬冶煉廠煙氣輸送管道，管道為圓管，管道直徑為600-700mm，管道底部每周可形成厚約100mm的煙灰堆積層；b.煙灰密度3.5g/cm；c.管道中有水平、小于30傾斜，3倍管道直徑彎曲三種形式；d.管道底部每隔50m有一可自動打開的清潔，供機器人傾倒垃圾；（2）管道機器人的技術要求a.機器人必須小巧、靈活、拆卸方便；b.生產(chǎn)能力高，每小時清潔能力應在40m左右；c.機器人在工作過程中，其結構可適應不同管徑的變化情況；d.機器人自動化程度高，控制方便靈活；2.2總體結構的設計和比較（1）行走機構的設計2.2.1根據(jù)國內(nèi)外的管道機器人的移動方式大致可分為六種：（一）活塞移動方

18、式（二）滾輪移動方式（三）履帶移動方式（四）足腳移動方式（五）蠕動移動方式（六）螺旋移動方式（一）活塞移動式依靠其首尾兩端管內(nèi)流體形成的壓差為驅(qū)動力，隨著管內(nèi)流體的流體的流動向前運動，其原理類似于活塞在汽缸內(nèi)的運動，即把管道看做汽缸，把具有一定彈性和硬度的PIG看做活塞。其缺點是：越障礙能力和拐彎差。（二）滾輪移動式優(yōu)點是移動速度快，轉(zhuǎn)彎容易，結構簡單，易小型化，采用多輪方式時牽引力隨輪數(shù)增加。缺點是著地面積小，維持一定的附著力較困難，這使得結構復雜，越障礙能力有限。（三）履帶移動式的優(yōu)點是著地面積大，易產(chǎn)生較大的附著力，對路面的適應性強，牽引性能好，越障礙能力強。缺點是體積大不易小型化，拐彎

19、半徑大，結構復雜，還要保持履帶的張緊。（四）足腿移動式的優(yōu)點是對粗糙路面適應性能較好，越障礙能力極強，可適應不同管徑的變化。缺點是結構和控制復雜，行走速度慢。（五）蠕動移動式的優(yōu)點是適應微小管徑，越障礙能力強。缺點是移動速度慢，控制復雜。（六）螺旋移動式的優(yōu)點是有一定的越障礙能力，可適應不同管徑的變化，可在直管道中行走。缺點是結構復雜，移動速度慢，驅(qū)動力要求高。根據(jù)設計參數(shù)和技術要求，所要言之的管道機器人必須要有高可靠性，高效率。所以采用上述行走機構的移動方式的組合來實現(xiàn)行走，這樣可利用其綜合優(yōu)點避免單一移動方式的缺點。由于管道存在不同的彎管，這樣要求機器人行走機構有一定的拐彎能力和越障礙能力

20、。所以，設計了一種如下所示的機器人，其特點是：移動速度快、轉(zhuǎn)彎比較容易、有較大牽引力、對粗糙路面適應性強、越障礙能力強；同時，可伸縮性使得機器人對變徑管道有較好的自適應性。 （2）操作機構的設計根據(jù)管道機器人的操作對象是一些堆積的灰塵，并且灰塵在管道底部堆放的同時成疏松狀，所以操作機構有以下兩種方案： 借鑒挖掘機的工作原理。利用鏟斗鏟起灰塵，然后行走到管道底部的傾倒垃圾開口，傾倒灰塵。這種方案簡單，可靠；但是由于管道直徑的限制，其鏟斗的容積比較小，同時垃圾開口每隔50m才有一個開口，其大部分時間都在行走上，所以機器人的工作效率很低。 借鑒吸塵器的工作原理。利用帶有操作臂的吸塵器的吸頭，灰塵通過

21、吸塵器管道到主體內(nèi)部，設計箱體的容積比較大，最后，移動到垃圾開口處傾倒垃圾，從而減少在往返的次數(shù)來提高工作效率。所以才用具有兩個自由度的機械臂，臂未端附上吸塵器頭，臂上附上塑料軟管，軟管最終以主體的垃圾箱密封連接。（3）撐開機構的設計由于管徑的變化，需要撐開機構來適應管徑的變化。在本機器人設計中，采用滾珠絲杠螺母副來和放大桿組來實現(xiàn)。1基座 2放大桿組 3撐開桿4絲杠 5絲杠螺母 6行走機構 當絲杠4旋轉(zhuǎn)時，絲杠螺母5在絲杠上左右移動，從而拉動撐開桿3，撐開桿3鉸接在放大桿組2上，從而改變其傾角來適應管徑的變化。（4）最終方案的確定根據(jù)以上的分析和比較，最后得出最終方案。設計的管道清潔機器人包

22、括以下五部分： （一） 行走裝置（為整個行走提供動力）；（二） 撐開桿組（適應管徑的變化）；（三） 操作臂裝置（操作臂包括吸塵器的操作部分和傾倒垃圾部分）；（四） 信號采集裝置（為控制提供信號和圖像）；（五） 控制裝置（控制管道清潔機器人行走和動作）。第三章 部件的設計和計算3.1管道機器人工作計算由于管道直徑是變化的，變化范圍為（600-700mm），通過計算當管道直徑為700mm時，且堆積相對底部為70mm，每50m最大工作量Gmax：Rabh 其中 h=70mm,d=700;R=d/2=700/2=350mm；a=R-h=350-70=280;b=210mm=arctan(b/a)=ar

23、ctan(210/280)=36.87s=R-1/2a2b=*350-1/2*2*280*210=2*10mm每隔50m才有一個開口，所以總的工作量：為50*10v=Sl=2*10*50*10=1.0*10mm因為煙灰的密度為3.5g/cmm=v=3.5*1.0*10*10=3.5*10g=3.5*10Kg 3.2行走機構的設計和計算 （1）行走機構的驅(qū)動電機功率的預算 預取管道清潔機器人 容積為V容： V容=35*35*35=42875cm； m=v=3.5*42875=1.50*10g=150Kg；G=mg=180*9.8=1470.6N管道機器人在裝滿的情況下，受力圖F1F1F2F2G6

24、060其中預取：F1=400N2*cos60*F2=G+F1F2=G+F1=1470.6+400=1870.6N由于履帶是三組；成120分布；受到的是摩擦阻力；F驅(qū)2*F2+*F1（其中是橡膠與鋼之間的摩擦系數(shù)）=2*0.8*1870.6+0.8*400=3312.96N管道機器人的工作行程速度V為：V=0.5m/sW總=F驅(qū)*V=3312.96*0.5=1656.48W（W總是有效功率）是三組履帶，所以每個履帶的驅(qū)動電機至少為：W=W總3=1656.483=552.16W選取電機的功率為800W；同時電機要能變速，才能在管道內(nèi)轉(zhuǎn)彎；所以選伺服電機，最終選擇CGMAH-08A伺服電機（安川公司

25、）。（2）行走機構結構的設計確定行走 機構履帶的外形尺寸由于管道直徑最小時，D=600mm；同時總體方案中已經(jīng)確定采用3組履帶，相對來說比較狹??；所以行走機構尺寸不能太大。首先，確定履帶的寬度較小，那么它的工作所提供的驅(qū)動力就會減??；而其寬度太大時，所受到的阻力就會很大。通過作圖的方法，取履帶的寬度Wi為：Wi=150mm。其次，確定履帶的長度。履帶的長度越長其轉(zhuǎn)彎的靈活就會受到影響。所以，履帶的長度不能太長。所以其長度L為：L=580mm。最后，確定履帶的高度。履帶的高度受到管道直徑的限制，同時還受到撐開桿組的影響；由于撐開桿組要能在600-700mm范圍內(nèi)變化，所以桿要達到給定的范圍。通過

26、對撐開桿組的設計，后最終確定高度H=175mm。確定行走機構的結構由于外形尺寸的限制，電機內(nèi)置在履帶組中，同時采用錐齒輪來換向，后驅(qū)動履帶輪。確定行走機構中的履帶輪和履帶輪采用同步帶的結構來設計履帶。以下是同步帶傳動的優(yōu)點：1.適用于兩軸中心距較大傳動，承載能力較大。2.帶具有良好的彈性，可以緩沖、吸塵，傳動平穩(wěn)，噪聲小。3.結構簡單，制造和維護較為方便，價格低廉。首先，確定同步帶的主要參數(shù)：（查機械設計手冊13-42）齒形：梯形齒距制式：模數(shù)制型號：m7節(jié)距：Pb=21.991mm其次，設計帶輪：（查機械設計手冊13-50）（1）初選帶輪的次數(shù)：z=17；（2）選擇切削帶輪齒形的刀具類型切出

27、直線齒廓的特別刀具；（3）齒槽角：2=2=40；（4）節(jié)距：Pb=m=*7=21.991mm；（5）節(jié)圓直徑：d=mz=7*17=119mm；（6）模數(shù)：m=7；（7）齒側(cè)間隙：Cm=1；（8）名義徑向間隙：e0=1.37；（9）徑向間隙：ee0+0.4m=1.37+0.4*7=3.836；（10）外圓直徑：d0=d-2=120-2*1.75=116.5mm（其中=1.75）；（11）外圓齒距：P0=d0/z=3.14*116.517=21.529mm；（12）外圓齒槽寬：b0=s+cm=10.06+1=11.06mm；（13）齒槽深：hg=ht+e=4.2+3.836=8.036；（14）齒

28、槽底寬：bw=7；（15）齒根圓角半徑：rb=0.25m=0.25*7=1.75；（16）rt=0.25m=0.25*7=1.75；最后，設計履帶：（查機械設計手冊13-43）由于采用同步帶的結構來設計履帶，同時履帶用于特殊的工作環(huán)境，所以能完全采用同步帶的參數(shù)，根據(jù)具體的結構尺寸設計履帶。（1）節(jié)距：Pb=21.991；（2）齒形角：2=40；（3）齒根厚：=10.06；（4）齒高：ht=4.2；（5）帶高：hs=7.7；（6）齒頂厚：st=7；（7）節(jié)頂距：=1.75；（8）帶寬：bs=115mm；確定大小錐齒輪參數(shù)整個行走裝置里，錐齒輪的主要作用換向，傳動動力。同時考慮到其完全在行走裝置

29、內(nèi)部，尺寸受到限制。根據(jù)以上的因素，設計大小錐齒輪的具體參數(shù)。根據(jù)總體結構設計圖，采用軸交角=90。齒輪類型為：直齒錐齒輪、齒形制為GB/T123691990，齒形角為20、齒頂高系數(shù)ha=1、頂系數(shù)c=0.2。（查機械設計手冊14-200）大錐齒輪的次數(shù)z1=30；小錐齒輪的次數(shù)z2=23。大小錐齒輪的具體參數(shù)分別如下：（查機械設計手冊14-201）大錐齒輪：（1）法向模數(shù)：mn=2.5；（2）齒數(shù)：z=30；（3）法向齒形角：an=20；（4）分度圓直徑：d=mz=30*2.5=75mm；（5）分度圓錐角：1=arc cotz1/z2=arc cot30/23=523126；（6）齒頂圓直

30、徑：da=d+2ham cos1=75+2*1*2.5*cos523126=78.044mm；（7）齒根圓直徑：df=d-2(ha+c)m cos1=75-2*(1+0.2)*2.5*cos523126=71.347mm；（8）錐距：R=mz/2sin1=m/2=2.5*/2=47.253mm（9）齒頂角：a=arctan= arctan=3143（10）齒根角：f= arctan= arctan=3471（11）頂圓錐角：a=+a=523126+3143=55339（12）f=-f=523126-3471=484425（13）齒寬：b=25mm小錐齒輪：（1）法向模數(shù)：mn=2.5；（2）齒

31、數(shù)：z=23；（3）法向齒形角：an=20；（4）分度圓直徑：d=mz=23*2.5=57.5mm；（5）分度圓錐角：1=arc cotz1/z2=arc cot30/23=372834；（6）齒頂圓直徑：da=d+2ham cos1=57.5+2*1*2.5*cos372834=61.467mm；（7）齒根圓直徑：df=d-2(ha+c)m cos1=57.5-2*(1+0.2)*2.5*cos372834=52.54mm；（8）錐距：R=mz/2sin1=m/2=2.5*/2=47.253mm（9）齒頂角：a=arctan= arctan=3143（10）齒根角：f= arctan= ar

32、ctan=3471（11）頂圓錐角：a=+a=372834+3143=413017（12）f=-f=372834-3471=334133（13）齒寬：b=25mm確定直齒輪的參數(shù)在整個行走裝置中，直齒輪的作用，主要是傳遞動力。根據(jù)行走機構的結構和尺寸限制，同時為了減小零件的個數(shù)和降低成本，才用兩個完全相同的直齒輪，齒頂高系數(shù)h*a=1、頂隙系數(shù)c*=0.25。齒數(shù)z=40，模數(shù)mn=2.5.具體參數(shù)如下：（1） 分度圓直徑：d1=mz=2.5*40=100（2） 齒頂高：ha=h*am=1*2.5=2.5（3） 齒根高：hf=（h*a+c*）m=(1+0.25)*2.5=3.125（4） 全齒

33、高：h=ha+hf=2.5+3.125=5.625（5） 齒頂圓直徑：da1=d+2ha=100+2*2.5=105mm（6） 齒根圓直徑：df1=d1-2hf=100-2*3.125=93.75mm（7） 齒厚：s=m/2=3.14*2.52=3.927（8） 齒根寬：e=m/2=3.14*2.5/2=3.927（9） 中心距：a=d=100mm（10） 頂隙：c=c*m=0.25*2.5=0.6253.3撐開機構和放大桿組的設計撐開機構采用絲杠螺母和放大桿組的結合，來適應管徑的變化。通過作圖法來模擬最小、最大管徑時的情況。最后量出各桿件的長度：撐開桿桿長：lc=200mm。放大桿桿長：lf

34、=300mm（由于在其之上安裝了壓力彈簧，其實際桿長為330380mm）。鉸接處的位置：在放大桿組90mm處。3.4操作臂的設計操作臂包括吸塵器的操作臂和拉開卸料門的桿件機構。（1）吸塵器操作臂的設計由于管道的管徑是變化的，同時灰塵主要分布在管道底部，所以要求操作臂要能適應管徑的變化，不僅要在最小管徑中能工作，也要在管徑最大時也能正常工作。根據(jù)這些要求，設計了具有兩個平面自由度的桿件機構來實現(xiàn)。其各個桿件的參數(shù)零件圖。其驅(qū)動電機采用MAXON的直流伺服電機。功率為120W。（2）卸料門的拉開桿件的設計當垃圾箱裝滿時，重量能達到1470.6N，同時電機的驅(qū)動功率120W，驅(qū)動力較??；所以，在設計

35、時采用“死點”的結構來實現(xiàn)卸料門的開合。工作原理：當卸料門閉合式，連桿處于死點位置即位置1，這是無論在卸料門上施加多大的力，卸料門也不會打開；當灰塵裝滿時，驅(qū)動電機通電，讓連桿轉(zhuǎn)動，從而破壞死點的狀態(tài)，在灰塵的重力和連桿的拉力下，卸料門打開。當灰塵傾倒完后，連桿逆向轉(zhuǎn)動，推動連桿向上移動從而使卸料門閉合，從而回到位置1。其結構簡圖各個桿件的長度，根據(jù)具體的結構尺寸，采用作圖法計算出桿件的長度。其參數(shù)如下：連桿LAB：LAB=700mm連桿LBC：LBC=150mm連桿lCD：LCD=120mmABDC位置2位置1卸料門 第四章 控制原理的設計4.1控制原理的分析和設計我們擬將兩對光電傳感器（記

36、為Ga組和Gb組）分別置于本管道清潔機器人前后兩側(cè)從而在前進或后退時都可以檢測行徑前方有無障礙物從而實現(xiàn)轉(zhuǎn)彎。見下面示意圖： 將一對超聲波測距傳感器（記為Ca和Cb）置于本管道清潔機器人車體前后適應位置，用來檢測其前進或后退時管徑的變化情況，以使CPU驅(qū)動相關電機做出相應的動作。另外，將一個光電傳感器（記為GC）置于吸塵裝置下方適應位置，用來檢測下方管壁上的灰塵是否已清潔干凈；又將一個壓力傳感器（記為YL）置于垃圾箱底板適當位置，用來檢測垃圾箱是否已經(jīng)裝滿，從而使本管道情節(jié)機器人停止繼續(xù)清灰塵轉(zhuǎn)而倒垃圾。另外一個超聲波傳感器（記為CC）置于裝灰塵的垃圾箱下方適應位置，在垃圾箱裝滿后通過檢測前方

37、一定距離范圍內(nèi)有沒有障礙物來判斷清潔口是否已經(jīng)打開，從而使CPU驅(qū)動相關電動機作出傾倒灰塵的動作；再將一個霍爾轉(zhuǎn)數(shù)檢測傳感器（記為HE）置于履帶輪軸附近適當位置，用來檢測置于履帶輪軸上的磁極的旋轉(zhuǎn)信號，從而測出履帶輪轉(zhuǎn)動圈數(shù)，進而通過CPU計算出本管道清潔機器人前進的距離。于是，控制過程實現(xiàn)過程如下： 吸塵器工作開始清潔灰塵，光電傳感器GA組、GC、超聲波傳感器CA以及壓力傳感器YL和霍爾轉(zhuǎn)數(shù)檢測傳感器HE工作實時檢測收集各信息； 一旦光電傳感器GC檢測到吸塵裝置下方的灰塵清理干凈，則CPU發(fā)送指令驅(qū)動主運動電機組（記為ZDJ）工作，即機器人 。又當GC檢測到吸塵裝置下方又有灰塵則CPU再次發(fā)

38、送指令使主電機組停止工作重新開始過程； 、步驟重復運行一段時間后，機器人的垃圾箱裝滿了灰塵，這時候置于垃圾箱底部的壓力傳感器就把檢測到的信號傳遞給CPU，則CPU發(fā)送指令令吸塵器和運動電機停止前進，同時停止接收霍爾轉(zhuǎn)數(shù)檢測傳感器HE的數(shù)據(jù)，并開始判斷本管道清潔機器人所走過的路程是否小于25m。若是則運行步驟，若否則運行步驟； CPU發(fā)送指令使主運動電機反轉(zhuǎn)即令機器人后退，并且開始收超聲波傳感器CC的信號，以判斷是否已經(jīng)請接口上方（超聲波傳感器CC位置一定要放恰當，以使垃圾能完全從請接口倒出），若否則繼續(xù)本步驟，若是則運行步驟； CPU發(fā)送指令使主運動電機正傳即令機器人前進，并且開始收超聲破傳感

39、器CC的信號，以判斷是否已到請接口上方，若否則繼續(xù)運行本步驟，則運行步驟； CPU再發(fā)送指令停止運動電機，即使機器人停下，然后驅(qū)動圾箱開關電動機打開垃圾箱來傾倒灰塵。期間，一旦壓力傳感器檢測到灰塵已經(jīng)倒完，則再驅(qū)動垃圾箱開關電動機關閉垃圾箱。然后CPU發(fā)送指令使機器人反向運動并且停止接收超聲波CC的信號而開始接收光電傳感器GC的信號以判斷是否已回到上次清潔干凈的位置。若是，則重新開始運行步驟，若否則繼續(xù)移動、檢測。 當本管道清潔機器人前進過程中CPU要光電傳感器組GA的實時信號，一旦檢測到前方有彎道則命令兩主運動電機產(chǎn)生速度差從而轉(zhuǎn)彎道；而當后退過程中則要接收光電傳感器組GB的實時信號，以使本管道清潔機器人能在后退時也順利轉(zhuǎn)過彎道。同樣的，在前進過程中還要檢測管徑的變化，通過超聲波傳感器CA收集的距離信息來使本管道清潔機器人自動適應管徑的變化；后退時則是通過超聲波傳感器CB來檢測信號從而使本管道清潔機器人在后退時也能自動適應管徑的變化。從而使其順利地完成工作。4.2主要控制流程圖：主要的控制流程圖，見圖（一）：開始初始化吸塵并停止前進管徑適應子程序1轉(zhuǎn)彎子程序1倒煙灰子程序是否干凈是否裝滿是否變徑管是否轉(zhuǎn)彎前進并記錄轉(zhuǎn)數(shù)YYNNNNYY主程序流程圖致 謝