管道清灰机器人的设计毕业设计.doc

兰州理工大学 毕业设计（论文）兰 州 理 工 大 学LANZHOU UNIVERSITY TECHNOLOGY毕业设计（论文）题目： 管道清灰机器人的设计 专业： 机械设计及其自动化 班级： 2010级机械设计 姓名： 陆诗彧 指导老师：许军山 杨萍 日期： 2012年12月 目录前 言0第一章 概 述11.1机器人概述11.2管道机器人概述31.3国内外管道机器人的发展41.3.1国内外管道机器人的发展41.3.2国外管道机器人的发展51.3.3机器人的发展前景7第二章 总体方案的制定及比较92.1管道机器人设计参数和技术指标92.2总体结构的设计和比较92.2.1根据国内外的管道机器人的移动方式大致可分为六种：9第三章 部件的设计和计算153.1管道机器人工作计算153.2行走机构的设计和计算16（1）行走机构的驱动电机功率的预算16（2）行走机构结构的设计173.3撑开机构和放大杆组的设计223.4操作臂的设计23（1）吸尘器操作臂的设计23（2）卸料门的拉开杆件的设计23第四章 控制原理的设计244.1控制原理的分析和设计244.2主要控制流程图：27致 谢2930 前 言第一章 概 述1.1机器人概述机器人这一词最早使用始于1920年至1930年期间在捷克作家凯勒尔.凯佩克（KAREL CAPEK）的名为“罗萨姆的万能机器人”的幻想剧中，一些小的人造的和拟人的傀儡绝对地服从其主人的命令。这些傀儡被称为“机器人”。该单词起源于捷克语“ROBOTA”。意思是“强制的劳动”。机器人的组成与人类相似。举例说，人搬运某一物体的运动过程中可用图（a）所示的方块图来说明。首先，人听到外部的命令或用眼睛看到外部的指令，并由眼睛测量出距离。感觉到这种信息经过感觉神经送到大脑中，大脑经过分析计算，然后通过运动神经发出指令，手臂用最好的方式伸向物体，并将物体抓住，手上的感觉神经，感觉物体已经抓牢了，把信息传给大脑。大脑命令手抓起物体，同时指令脚移动到所要求到达的地点，最后放下物体。一般包括以下几个部分见图（b）：耳、眼脑手躯干脚对象环境感受、观测运动神经感觉神经行走操作（a）操作人员行走装置执行机构与操作人员联系装置感觉装置外界环境控制装置(b)1.控制中枢（相当于人的大脑），2.操作装置（相当于人的手）； 3.行走装置（相当于人的脚）；4.有感觉的机器人还必须有感觉装置以及与外界环境联系的装置（相当于人的口、耳、眼、鼻以及皮肤上的感觉神经）。实际的机器人在不同的程度上具有两种特有的属性：对环境的通用性和自动适应性。通用性：具有完成各种任务以及以不同的方式完成相同的结构或机械能力。这意味着机器人的机械结构具有可变的机械形状。自动适应性：是指一个机器人必须被设计成由自己去完成任务，尽管难以预知，但却可以有限的知道在完成任务期间环境的变化，通过改变路径、姿态等来处理所面对的问题，最终完成任务。为了对机器人进行分类，必须能够定义和区分不同的类型，因此根据不同的定义就有不同的分类方法。现在使用的有很多种。以下介绍日本工业机器人协会（JIRA）的分类方法：第一类：手工操作装置：一种由操作人员操作的具有若干个自由度（DOF）的装置；第二类：固有程序的机器人：依照预定的不变的方法按部就班执行任务的操作装置，对任务的执行顺序很难进行修改；第三类：可变程序的机器人：与第二类是同一种类型的操作装置，但其执行步骤可以修改；第四类：再现式机器人：操作人员 通过手动方式引导或控制机器人完成任务，而机器人控制装置则纪录其运动轨迹，需要时可以重新调出纪录的轨迹信息，机器人就能以自动的方式完成任务；第五类：数值控制机器人：由操作人员给机器人提供运动程序，而不是用手动方式教导机器人完成指定的作业任务；第六类：智能机器人：通过对环境变化的感知，改变其运动轨迹、姿态等措施圆满的完成任务。机器人的诞生和机器人学的建立无疑是20世纪人类科学技术的重大成就。自60年代初机器人问世以来，作为20世纪人类最伟大发明之一的机器人技术，经历了近半个世纪的发展，已取得了长足的进步。特别是到了20世纪90年代，随着计算机技术、微电子技术、网络技术等的快速发展，机器人技术也得到了飞速发展。除了用工业生产中从事焊接、喷漆、搬运和装配等作业的工业机器人的水平不断提高之外，各种用于非制造业的特种、智能机器人系统也有了长足发展。工业机器人在经历诞生成长成熟期后，已成为现代先进制造业中必不可少的核心装备，当今世界上约有上百万台工业机器人正与工人朋友并肩战斗在各条战线上。非制造业中的仿人性机器人、农业机器人、水下机器人、医疗机器人、军用机器人、娱乐机器人、服务机器人等各种用途的特种机器人也正以飞快的速度向实用化迈进。1.2管道机器人概述20世纪70年代以来，石油、化工、天然气及核工业等产业迅速发展，各种管道作为一种重要的物料输送设施，得到了广泛应用。由于腐蚀、重压等作用，管道不可避免地会出现漏孔、裂纹等现象。同时多数管道安装环境人们不能直接到达或不允许人们直接进入，为进行质量检测和故障诊断，采用传统的全面挖掘法、随机抽样法工程量大，准确率低，管道机器人就是为了解决这一实际问题产生的，它是由可沿管道内部或外部自动行走装置、携有一种或多种传感器及操作装置如：机械手、喷枪、焊枪、刷子。管道机器人的工作空间是复杂、封闭的各种管道，包括水平直管、各角度弯管、斜坡管、垂直管以及变径管接口等，所以需要在操作人员的遥控操作或计算机自动控制下，进行一系列管道作业。管道机器人可完成的管道作业有以下几类：1. 生产、安装过程中的管内质量检测。2. 恶劣环境下管道清扫 、喷漆、焊接、内部抛光等维护。3. 使用过程中焊缝情况、表面腐蚀、裂缝破损等故障诊断。4. 对埋地旧管道的修复。5. 管道内外器材运送、抢救等其它用途。1.3国内外管道机器人的发展1.3.1国内外管道机器人的发展国内在管道机器人方面的研究起步较晚，而且多数停留在实验阶段。哈尔滨工业大学邓宗全教授在国家“863”计划课题“X射线检测时成像管道机器人的研制”的支持下，开展了轮式行走方式的管道机器人研制，实现了管外机构同步运动作业无揽操作技术，并研制了链式和钢带式两种新型管外传动机构。该系统由六大部分组成（1）移动载体（2）视觉定位（3）收发线装置（4）X射线机（5）检测控制，系统控制（6）防护系统上海交通大学研发了小口径管道内蠕动式移动机构。它是模仿昆虫在地面爬行时蠕动前进与后退的动作设计的。其主要机构由撑脚机构、三个气缸（前气缸、中气缸、后气缸）、软轴、弹簧片、法兰盘组成。针对微小空间、微小管道时探测要求，研制成电磁驱动微小型管道机器人样机。微小管道机器人由四个电磁驱动单元组成。其驱动机理模拟生物的蠕动爬行。它是通过给管道加一系列的时序脉冲进行控制，依次使各单元动作，达到蠕动爬行的运动。西安交通大学设计制作了蠕动式微动直线自行走机构。这种行走机构以电动缩微位移器做驱动器，以电磁铁机构作为可吸附于行走表面的保持器。广州工业大学借用仿生学原理，研制成结构独特的，像蠕虫一样的微管道机器人的运动由电磁力驱动。机器人由前后两个电磁线圈和前后两个驱动器组成。当分别通电时，机器人的两个驱动器互相吸合收缩。当后电磁线圈断电时，后部突然放松，由此产生的推力将机器人前部（前驱动器）向前推进一段距离；反向运动依次类推。1.3.2国外管道机器人的发展国外关于燃气管道机器人的研究始于20世纪40年代，由于70年代的微电子技术，计算机技术、自动化技术的发展，管道检测机器人技术于90年代初，得到了迅猛发展并接近于应用水平。日本机器人的的发展经过了60年代的摇篮期，70年代的实用期，到80年代进入普及及提高期，开始在各个领域内广泛推广使用机器人。日本管道机器人众多，东京工业大学于1993年开始研究管道机器人，并且成功研制出THES系列的机器人，以下介绍THES2型管道机器人：其采用“电机蜗轮蜗杆驱动轮”的驱动方案，同时每个驱动轮都有一个倾斜角度测量轮，通过测量轮探测机器人的倾斜角度，并反馈给电机，从而保证管道机器人的驱动轮以垂直的姿态运动。该管道机器人系统通过CCD摄像头实现信息的采集，整个系统采用托揽控制式，检测距离超过100CM。美国是机器人的诞生地，早在1962年就研制出世界上第一台工业机器人，是世界上的机器人强国之一，其基础雄厚，技术先进，并有很多管道机器人产品。美国INUKTUN公司系列管道检测机器人VERSATRAX是国外现有的已成型管道机器人。美国纽约煤气集团公司(NYGAS)的DAPHNEDPZURKO和卡内基梅隆大学机器人技术学院的HAGENSCHEMPF博士在美国国家航空和宇宙行局（NASA）的资助下于2001年开发了长距离、无揽方式的管道机器人系统EXLORER，专门用于检测地下煤气管道是情况。该管道机器人系列EXLORER就有如下特征：（1）一次作业检测距离长，用无缆方式，自带电池并且电池可以多次反复充电，是管道机器人具有良好的自推能力。（2）可以在铸铁和钢质煤气管道中，低压和高压条件下工作。管道机器人的色彩摄像头采用嵌入式“鱼眼”镜头，结构非常紧凑。（3）可有利通过90的弯管接头和垂直管道。（4）与外部操作人员采用无线通讯方式。（5）该管道机器人可以探测煤气管道内部是否水渗透、碎片堆积；可以确定内部缺陷的确切位置并且定位相应的作业装置；采用视频图像的形式准确反映管道内部的状况条件。德国工业机器人的总数占世界第三位，仅次于日本和美国。德国学者BERNHARD KLAASSEN、HERMANN ST2REICH和FRANK KIRCHNER等人在德国教育部的资助下于2000年研制成功了多关节蠕虫式管道机器人系统MAKRO。该机器人由六节单元组成，其头部和尾部两个单元体完成相同，每个单元之间的节点由3个电动机驱动，使得MAKRO可以抬起或者弯曲机器人个体，从而可以轻松越过障碍物或实现拐弯运动，该管道机器人系统MAKRO具有21个自由度，长度为2M，质量为50Kg，采用无缆控制方式，MAKRO系统使用于直径为300600mm的管道。加拿大INUKTUN公司的双履带式管内机器人行走机构，履带采用刚性支承结构，两履带的夹角可以调节，以适应不同的作业管径。两履带调节到平行位置时，可以在平地或矩形管道内行走。但这种刚性支承的双履带式管内机器人行走机构的两履带夹角在行走过程中是无法改变的，因此不适合管径变化的作业场合。KAWAGUCH等研制的管道检测机器人系统只适用于500mm的管道，而且一次作业的检测距离不大于500m;KUNTZE等采用四轮独立屈服驱动方案研制成管道检测机器人系统KARO，该机器人系统只能实现对500mm管径的地下输水管道的检测，一次检测距离为400m，系统采用托缆控制式。1.3.3机器人的发展前景展望21世纪机器人技术的发展趋势，明显地向着智能化（INTELLECTUALIZATION）发展，包括机器人本身向智能机器人进化和实现机器人化（ROBOTIZATION）系统。具体说，传感型智能机器人发展较快，新型智能技术（如临场感、记忆材料、多智能体系统以及人工神经网络和专家系统等）在机器人得到开发与应用，采用模块化设计技术，进一步推动机器人工程，注意开发微型和小新机器人，重视研制行走机器人，研制应用于非结构环境下工作的非制造业机器人和服务机器人，开发敏捷制造系统，军用机器人将用于装配部队等。总的说来，虽然存在不少难关，甚至出现某些阴影，但新世纪机器人学的发展前景是十分光明和充满希望的。第二章 总体方案的制定及比较2.1管道机器人设计参数和技术指标（1）管道机器人的工作环境a.管道为金属冶炼厂烟气输送管道，管道为圆管，管道直径为600-700mm，管道底部每周可形成厚约100mm的烟灰堆积层；b.烟灰密度3.5g/cm；c.管道中有水平、小于30倾斜，3倍管道直径弯曲三种形式；d.管道底部每隔50m有一可自动打开的清洁，供机器人倾倒垃圾；（2）管道机器人的技术要求a.机器人必须小巧、灵活、拆卸方便；b.生产能力高，每小时清洁能力应在40m左右；c.机器人在工作过程中，其结构可适应不同管径的变化情况；d.机器人自动化程度高，控制方便灵活；2.2总体结构的设计和比较（1）行走机构的设计2.2.1根据国内外的管道机器人的移动方式大致可分为六种：（一）活塞移动方式（二）滚轮移动方式（三）履带移动方式（四）足脚移动方式（五）蠕动移动方式（六）螺旋移动方式（一）活塞移动式依靠其首尾两端管内流体形成的压差为驱动力，随着管内流体的流体的流动向前运动，其原理类似于活塞在汽缸内的运动，即把管道看做汽缸，把具有一定弹性和硬度的PIG看做活塞。其缺点是：越障碍能力和拐弯差。（二）滚轮移动式优点是移动速度快，转弯容易，结构简单，易小型化，采用多轮方式时牵引力随轮数增加。缺点是着地面积小，维持一定的附着力较困难，这使得结构复杂，越障碍能力有限。（三）履带移动式的优点是着地面积大，易产生较大的附着力，对路面的适应性强，牵引性能好，越障碍能力强。缺点是体积大不易小型化，拐弯半径大，结构复杂，还要保持履带的张紧。（四）足腿移动式的优点是对粗糙路面适应性能较好，越障碍能力极强，可适应不同管径的变化。缺点是结构和控制复杂，行走速度慢。（五）蠕动移动式的优点是适应微小管径，越障碍能力强。缺点是移动速度慢，控制复杂。（六）螺旋移动式的优点是有一定的越障碍能力，可适应不同管径的变化，可在直管道中行走。缺点是结构复杂，移动速度慢，驱动力要求高。根据设计参数和技术要求，所要言之的管道机器人必须要有高可靠性，高效率。所以采用上述行走机构的移动方式的组合来实现行走，这样可利用其综合优点避免单一移动方式的缺点。由于管道存在不同的弯管，这样要求机器人行走机构有一定的拐弯能力和越障碍能力。所以，设计了一种如下所示的机器人，其特点是：移动速度快、转弯比较容易、有较大牵引力、对粗糙路面适应性强、越障碍能力强；同时，可伸缩性使得机器人对变径管道有较好的自适应性。 （2）操作机构的设计根据管道机器人的操作对象是一些堆积的灰尘，并且灰尘在管道底部堆放的同时成疏松状，所以操作机构有以下两种方案： 借鉴挖掘机的工作原理。利用铲斗铲起灰尘，然后行走到管道底部的倾倒垃圾开口，倾倒灰尘。这种方案简单，可靠；但是由于管道直径的限制，其铲斗的容积比较小，同时垃圾开口每隔50m才有一个开口，其大部分时间都在行走上，所以机器人的工作效率很低。 借鉴吸尘器的工作原理。利用带有操作臂的吸尘器的吸头，灰尘通过吸尘器管道到主体内部，设计箱体的容积比较大，最后，移动到垃圾开口处倾倒垃圾，从而减少在往返的次数来提高工作效率。所以才用具有两个自由度的机械臂，臂未端附上吸尘器头，臂上附上塑料软管，软管最终以主体的垃圾箱密封连接。（3）撑开机构的设计由于管径的变化，需要撑开机构来适应管径的变化。在本机器人设计中，采用滚珠丝杠螺母副来和放大杆组来实现。1基座 2放大杆组 3撑开杆4丝杠 5丝杠螺母 6行走机构 当丝杠4旋转时，丝杠螺母5在丝杠上左右移动，从而拉动撑开杆3，撑开杆3铰接在放大杆组2上，从而改变其倾角来适应管径的变化。（4）最终方案的确定根据以上的分析和比较，最后得出最终方案。设计的管道清洁机器人包括以下五部分： （一） 行走装置（为整个行走提供动力）；（二） 撑开杆组（适应管径的变化）；（三） 操作臂装置（操作臂包括吸尘器的操作部分和倾倒垃圾部分）；（四） 信号采集装置（为控制提供信号和图像）；（五） 控制装置（控制管道清洁机器人行走和动作）。第三章 部件的设计和计算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)=arctan(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）行走机构的驱动电机功率的预算 预取管道清洁机器人 容积为V容： V容=35*35*35=42875cm； m=v=3.5*42875=1.50*10g=150Kg；G=mg=180*9.8=1470.6N管道机器人在装满的情况下，受力图F1F1F2F2G6060其中预取：F1=400N2*cos60*F2=G+F1F2=G+F1=1470.6+400=1870.6N由于履带是三组；成120分布；受到的是摩擦阻力；F驱2*F2+*F1（其中是橡胶与钢之间的摩擦系数）=2*0.8*1870.6+0.8*400=3312.96N管道机器人的工作行程速度V为：V=0.5m/sW总=F驱*V=3312.96*0.5=1656.48W（W总是有效功率）是三组履带，所以每个履带的驱动电机至少为：W=W总3=1656.483=552.16W选取电机的功率为800W；同时电机要能变速，才能在管道内转弯；所以选伺服电机，最终选择CGMAH-08A伺服电机（安川公司）。（2）行走机构结构的设计确定行走 机构履带的外形尺寸由于管道直径最小时，D=600mm；同时总体方案中已经确定采用3组履带，相对来说比较狭小；所以行走机构尺寸不能太大。首先，确定履带的宽度较小，那么它的工作所提供的驱动力就会减小；而其宽度太大时，所受到的阻力就会很大。通过作图的方法，取履带的宽度Wi为：Wi=150mm。其次，确定履带的长度。履带的长度越长其转弯的灵活就会受到影响。所以，履带的长度不能太长。所以其长度L为：L=580mm。最后，确定履带的高度。履带的高度受到管道直径的限制，同时还受到撑开杆组的影响；由于撑开杆组要能在600-700mm范围内变化，所以杆要达到给定的范围。通过对撑开杆组的设计，后最终确定高度H=175mm。确定行走机构的结构由于外形尺寸的限制，电机内置在履带组中，同时采用锥齿轮来换向，后驱动履带轮。确定行走机构中的履带轮和履带轮采用同步带的结构来设计履带。以下是同步带传动的优点：1.适用于两轴中心距较大传动，承载能力较大。2.带具有良好的弹性，可以缓冲、吸尘，传动平稳，噪声小。3.结构简单，制造和维护较为方便，价格低廉。首先，确定同步带的主要参数：（查机械设计手册13-42）齿形：梯形齿距制式：模数制型号：m7节距：Pb=21.991mm其次，设计带轮：（查机械设计手册13-50）（1）初选带轮的次数：z=17；（2）选择切削带轮齿形的刀具类型切出直线齿廓的特别刀具；（3）齿槽角：2=2=40；（4）节距：Pb=m=*7=21.991mm；（5）节圆直径：d=mz=7*17=119mm；（6）模数：m=7；（7）齿侧间隙：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）齿槽底宽：bw=7；（15）齿根圆角半径：rb=0.25m=0.25*7=1.75；（16）rt=0.25m=0.25*7=1.75；最后，设计履带：（查机械设计手册13-43）由于采用同步带的结构来设计履带，同时履带用于特殊的工作环境，所以能完全采用同步带的参数，根据具体的结构尺寸设计履带。（1）节距：Pb=21.991；（2）齿形角：2=40；（3）齿根厚：=10.06；（4）齿高：ht=4.2；（5）带高：hs=7.7；（6）齿顶厚：st=7；（7）节顶距：=1.75；（8）带宽：bs=115mm；确定大小锥齿轮参数整个行走装置里，锥齿轮的主要作用换向，传动动力。同时考虑到其完全在行走装置内部，尺寸受到限制。根据以上的因素，设计大小锥齿轮的具体参数。根据总体结构设计图，采用轴交角=90。齿轮类型为：直齿锥齿轮、齿形制为GB/T123691990，齿形角为20、齿顶高系数ha=1、顶系数c=0.2。（查机械设计手册14-200）大锥齿轮的次数z1=30；小锥齿轮的次数z2=23。大小锥齿轮的具体参数分别如下：（查机械设计手册14-201）大锥齿轮：（1）法向模数：mn=2.5；（2）齿数：z=30；（3）法向齿形角：an=20；（4）分度圆直径：d=mz=30*2.5=75mm；（5）分度圆锥角：1=arc cotz1/z2=arc cot30/23=523126；（6）齿顶圆直径：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）法向模数：mn=2.5；（2）齿数：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= arctan=3471（11）顶圆锥角：a=+a=372834+3143=413017（12）f=-f=372834-3471=334133（13）齿宽：b=25mm确定直齿轮的参数在整个行走装置中，直齿轮的作用，主要是传递动力。根据行走机构的结构和尺寸限制，同时为了减小零件的个数和降低成本，才用两个完全相同的直齿轮，齿顶高系数h*a=1、顶隙系数c*=0.25。齿数z=40，模数mn=2.5.具体参数如下：（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） 全齿高：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=300mm（由于在其之上安装了压力弹簧，其实际杆长为330380mm）。铰接处的位置：在放大杆组90mm处。3.4操作臂的设计操作臂包括吸尘器的操作臂和拉开卸料门的杆件机构。（1）吸尘器操作臂的设计由于管道的管径是变化的，同时灰尘主要分布在管道底部，所以要求操作臂要能适应管径的变化，不仅要在最小管径中能工作，也要在管径最大时也能正常工作。根据这些要求，设计了具有两个平面自由度的杆件机构来实现。其各个杆件的参数零件图。其驱动电机采用MAXON的直流伺服电机。功率为120W。（2）卸料门的拉开杆件的设计当垃圾箱装满时，重量能达到1470.6N，同时电机的驱动功率120W，驱动力较小；所以，在设计时采用“死点”的结构来实现卸料门的开合。工作原理：当卸料门闭合式，连杆处于死点位置即位置1，这是无论在卸料门上施加多大的力，卸料门也不会打开；当灰尘装满时，驱动电机通电，让连杆转动，从而破坏死点的状态，在灰尘的重力和连杆的拉力下，卸料门打开。当灰尘倾倒完后，连杆逆向转动，推动连杆向上移动从而使卸料门闭合，从而回到位置1。其结构简图各个杆件的长度，根据具体的结构尺寸，采用作图法计算出杆件的长度。其参数如下：连杆LAB：LAB=700mm连杆LBC：LBC=150mm连杆lCD：LCD=120mmABDC位置2位置1卸料门 第四章 控制原理的设计4.1控制原理的分析和设计我们拟将两对光电传感器（记为Ga组和Gb组）分别置于本管道清洁机器人前后两侧从而在前进或后退时都可以检测行径前方有无障碍物从而实现转弯。见下面示意图： 将一对超声波测距传感器（记为Ca和Cb）置于本管道清洁机器人车体前后适应位置，用来检测其前进或后退时管径的变化情况，以使CPU驱动相关电机做出相应的动作。另外，将一个光电传感器（记为GC）置于吸尘装置下方适应位置，用来检测下方管壁上的灰尘是否已清洁干净；又将一个压力传感器（记为YL）置于垃圾箱底板适当位置，用来检测垃圾箱是否已经装满，从而使本管道情节机器人