清扫机器人的结构设计

1、 毕业设计（论文）题目： 清扫机器人结构设计 院 (系)： 专 业： 姓 名： 学 号： 指导教师： 二 年 月 日 摘 要清扫机器人属于服务机器人的一种，世界各国尤其是西方发达国家都在致力于研究开发和广泛使用服务机器人。如果清扫机器人的性价比足够高，那么清扫机器人的市场将会被看好。本文介绍了清洁机器人在国内外发展现状和应用情况，侧重研究了清洁机器人的避障控制系统。结合实验室实际条件，设计了机器人样机。其主要工作内容包括:小车机械本体设计、控制理论的介绍、AT89C51单片机控制系统硬件电路及检测电路设计、控制系统软件设计和机器人避障性能测试试验。通过实验表明所设计的机器人样机能够实现自主避碰

2、的功能，达到设计要求。关键词:清洁机器人 避障 AT89C51单片机Abstract Cleaning robot is one part of the serving robot.Serving robot is beingresearched and developed in the countries all over the world,and which is beingused widely in the west developed countries.If the rate of quality and price of thecleaning robot is highly

3、enough ,the market of the cleaning robot would beprospered.The paper studies the applications and developments of cleaning robot athome and abroad, and researches the control system of the cleaning robot avoidinga obstacle mainly.The model is designed under the actual condition of the lab. The main

4、work of the paper is as follows. The mechanical design of cleaning robot,thetheory of the control system, the design of control system of hardware circuit andsoftware based on AT89C51 SCM, the design of inspective circuit and theexperiment of performance of the cleaning robot avoiding a obstacle.The

5、 result of the experiment shows that the robot designed has the functionsof avoiding a obstacle, so it fills the demand of the task.KEY WORD:cleaning robot avoid a obstacle AT89C51 SCM.目录第一章 绪论1第一节 研究的目的和意义1第二节 设计的重点和难点1第三节 家庭清扫机器人的关键技术1第四节 论文主要完成工作2第二章 总体结构设计3第一节 整体结构布局3第二节 驱动部分4第三节 吸尘部分6第四节 电源部分6第

6、五节 路径规划算法6第六节 仿真结果8第三章 硬件控制部分设计9第一节 AT89系列单片机简介9第二节 外围电路9结论11致谢12参考文献13第一章 绪论第一节 研究的目的和意义清扫机器人将移动机器人技术和吸尘器技术有机地融合起来，实现室内环境（地面）的半自动或全自动清洁，替代传统繁重的人工清洁工作，近年来已受到国内外的研究人员重视。作为智能移动机器人的一个特殊应用，从技术方面讲，智能化清扫机器人比较具体地体现了移动机器人的多项关键技术，具有较强的代表性。从市场前景角度讲，清扫机器人将大大降低劳动强度、提高劳动效率，适用于家庭和公共场馆的室内清洁。因此，开发自主智能吸尘器既具有科研上的挑战性，

7、又具有广阔的市场前景。融合现代传感器以及机器人领域的关键技术，本课题旨在开发一部价格便宜，全区域覆盖，能够充分满足家庭需求且方便适用的智能家庭清扫机器人。使它可以替代传统的家庭人工清扫方式，使家庭生活电气化、智能化，使科技更好地为人类服务。第二节 设计的重点和难点由前面的设计家庭清洁机器人的工作内容和要求，在宽400高100的体积下如何设计和布置好清扫机构，行走机构，吸尘机构和储存垃圾机构。路径方式的选择，以及如何用软件控制实现其避障功能。第三节 家庭清扫机器人的关键技术家庭清洁机器人的关键技术吸尘机器人系统通常由四个部分组成:移动机构、感知系统、控制系统和吸尘系统。移动机构是吸尘机器人的主体

8、,决定了吸尘器的运动空间,一般采用轮式机构。感知系统一般采用超声波测距仪、接触和接近传感器、红外线传感器等。随着近年来计算机技术、人工智能技术、传感技术以及移动机器人技术的迅速发展,清扫机器人控制系统的研究和开发已具备了坚实的基础和良好的发展前景。清扫机器人的控制与工作环境往往是不确定的或多变的,因此必须兼顾安全可靠性、抗干扰性以及清洁度。用传感器探测环境、分析信号,以及通过适当的建模方法来理解环境,具有特别重要的意义。目·展较快、对清扫机器人发展影响较大的关键技术是:传感技术、智能控制技术、路径规划技术、吸尘技术、电源技术等。传感技术为了让吸尘机器人正常工作,必须对机器人位置、姿态

9、、速度和系统内部状态进行监控,还要感知机器人所处工作环境的静态和动态信息,使得吸尘机器人相应的工作顺序和操作内容能自然地适应工作环境的变化。第四节 论文主要完成工作课题主要完成的工作包括清洁机器人结构设计，驱动电机选择，传感器的选择，控制算法的研究，硬件电路设计和软件编程及试验。一.机械结构部分 包括机器人构成方案选择、机器人本体机构设计和驱动电机的选择二.避障系统控制方案 包括机器人障碍检测系统、定位系统的确定和控制算法的选择三.控制系统硬件部分包括AT89C51单片机控制系统硬件电路设计、电机驱动电路设计和传感器检测硬件电路设计四.控制系统软件部分包括AT89C51单片机控制系统系统软件设

10、计第二章 总体结构设计第一节 整体结构布局整个机器人的结构由车体,吸尘装置,传感部分,控制部分组成。传感部分包括车身两侧的光电传感器和前面的碰板和光电开关组成的接触式传感器。机器人前轮为随动轮,后轮采用差动式驱动,光电编码器装在前随动轮上,与随动轮同轴。当发生碰撞时,碰板带动光开关移动产生信号变化。光电传感器对车体侧面进行探测，判断左右转弯是否可行。如结构简图2所示：碰板光电传感器检测悬空的光电传感器随动轮两独立驱动轮吸尘入口两反向旋转的边刷 图2.1 清扫机器人结构示意图考虑到机构和控制的复杂性,本清扫机器人采用圆形车体,圆形车体的最大优点是运动灵活,控制简单,不会发生卡死的现象。车体前端是

11、一个碰板系统由一套机械装置和光电开关组成,用于检测运动前方的障碍物。左右二个后轮独立驱动,每个轮子都有电机、光电传感器,各自是一个独立的系统,只接受控制系统的控制信号和反馈给控制系统运动信息。中间镂空的部分是清扫系统,包括二个电机驱动的一个清扫装置和一个吸尘装置。车体左右二侧装有二个光电传感器,用于对小车转弯可行性判断。前轮的支撑部分是一个垂直方向可滑动杆,中间有弹簧做缓冲(运动的时候也有减震的作用)。 本机器人没有采用阵列式碰撞传感器。而是独立设计了一块碰板和光电开关组成,它可以检测到车体前方的一切障碍物,不存在任何盲点。弧形的碰板通过2个连杆和车体铰接在一起,连杆和碰板连接的部分可以沿碰板

12、外径方向滑动,而和车体连接的部分可以旋转,碰板二端和光电开关相连,当碰撞引发碰板移动后,通过光电开关的变化把信号反馈给控制系统。碰板可以把障碍物的位置分为3类:正前方,前方,右前方。通过2个光电开关的组合状态给出,如果2个光电开关的初始状态是0。如表1所示。表2.1 碰撞检测对照表左光电开关0011右光电开关0101障碍物位置未碰撞右前左前正前整个清扫系统通过后方的圆孔和车体相铰接,可以作很小幅度的摆动,这样的设计将使机器人对地面的适应性有很大提高,整个清扫系统又可以分为清扫部分和吸尘部分,每部分各有1个电机提供动力,清扫部分在前端,由电机带动2个旋转方向不同的滚刷转动,从而把纸片等大块垃圾清

13、扫进后面的灰尘箱。后面的吸尘系统类似一个吸尘器,橡胶制成的吸尘端口与地面相接。这样双选择性的清扫比一般地单一清扫方式效果要好的多。第二节 驱动部分驱动部分是由两个四相步进电机以及相应的驱动机构组成的。步进电机带动两驱动轮，后轮， 从而推动吸尘器运动。前轮不再采用传统的双轮结构, 而采用了应用非常广泛的平面轴承, 这既减小了结构复度, 又提高了转弯的灵活性 图2.2 驱动结构通过改变作用于步进电机的脉冲信号的频率, 可以对步进电机实现较高精度的调速。同时在对两电机分别施相同或不同脉冲信号时, 通过差速方式, 可以方便的实现吸尘器前进、左转、右转、后退、调头等功能。这一设计的最大优点是吸尘器能够在

14、任意半径下, 以任意速度实现转弯, 甚至当两后轮相互反向运动时, 实现零转弯半径􀀁即绕轴中点原地施转动。同时转弯的速度可通过改变单片机的程序来调节。根据所需的驱动力矩和其它结构要求，驱动电机选用北京四通集团公司的57BYG250E-SAFRML-0152型两相混合式步进电动机。其参数如表2.2所示;表2.2 57BYG250E-SAFRML-0152步进电机参数 相数2步距角（°）0.9/1.8静态相电流（A）1.5相电阻（）1.0相电感（Mh）5.3保持转矩（Nm）1.5定位转矩（Nm）0.06空载启动频率（半步方式）（KHz）3重量（Kg）1.5转动惯量（gc）

15、330第三节 吸尘部分吸尘部分是由封闭在壳体中的小型吸尘器完成的。包括气泵，吸室，吸道和吸嘴。在吸尘器爬行的过程中，通过底盘上开的吸嘴将扫过的地面上的灰尘吸入吸室。 第四节 电源部分由于智能吸尘器是以自主方式工作的，因而所用的电源不是一般脱线方式，而是采用随身携带的蓄电池，这样不但可实现无人控制，而且工作时比较灵活。一次充电可以连续工作几个小时。第五节 路径规划算法在本算法中,机器人的路径大体分为两类: 面覆盖的过程,机器人走直线,相当于一个”迂回推进”的过程; 从当前点到目标点的寻径过程,从定位的准确性考虑,路径段也为直线。开始的时候机器人选择房间的一个角落( 2座墙壁的交接点,便于机器人定

16、位)作为初始点,坐标为(0, 0) ,即机器人上的p点坐标为(0, 0) (本文中的坐标都是指p点坐标) ,沿一侧墙的方向建立X轴,第一次清扫沿X 轴的方向,完成后,返回原点,沿Y轴方向进行第二次清扫。这样既保证了清洁质量,又在很大程度上避免了1次清扫所带来的死角问题。而且由于2个方向的互补性,并不需要为了遍历的完整性而采用更为烦杂的算法,通过2次数据融合就可以得到较为精确的环境信息机器人的路径为迂回前进的路径段,每个路径段的间隔为机器人清洁机构的清扫直径,碰到障碍物后,机器人的转向90°并且侧移20cm ,在转向90°，这个动作由控制系统做好保存,直接调用,记为micro

17、1 。(在前进过程中,发生碰撞时,机器人的转向所采取的方向,取值可以为”左”或者”右”,由碰撞次数的奇偶性决定。前可行的方法就是通过建立被控制对象的模糊模型来实现模糊控制器。所谓建立被控制对象的模糊模型就是用“如果一一那么”的形式来描述被控对象的动态特性。一条“如果那么”表达式就是一条控制规则，因此被控制对象的模型是由多条控制规则组成的，这样通过该模型就可以从输入推理得出输出。具体到本课题，模糊规则设定如下:规则1:如果机器人前方为阶梯（沿X轴方向遍历），那么它应该左转一前行一再左转；(把此类型障碍物当作墙来处理)规则2:如果机器人前方有障碍物（沿X轴方向遍历），同时左侧也有障碍物，那么它应该

18、原地转弯180度；（记为左转为不可行）规则3:如果机器人悬空，那么它应该执行电源关操作规则4:如果机器人前方为阶梯（沿Y轴方向遍历），那么它应该从右转一前行一再右转；(把此类型障碍物当作墙来处理) 规则5:如果机器人前方有障碍物（沿Y轴方向遍历），同时右侧也有障碍物，那么它应该原地转弯180度；（记为右转为不可行）规则6:如果机器人右前方没有障碍物，那么它应该直线前行；规则7:如果机器人沿X轴方向遍历完成，那么执行沿Y轴方向的遍历；（完成与否的判定根据是否有连续两次转弯不可行）规则8:如果机器人完成了沿X轴和Y轴方向的遍历，那么小车执行回充电插座充电。第六节 仿真结果由于只是表达路径规划的算法

19、,为了描述清晰及简便,采用矩形环境边缘,障碍物也选用边缘规则的矩形,U型等,而实际上由于采用碰撞作为边缘触发条件。经过机器人路径的规划设计对机器人的路径以达到清扫能到达的角落，不留清扫盲区。第三章 硬件控制部分设计 在实际应用中，机器人车体下部需安装吸尘或清扫等辅助机构，故控制系统安装在小车底板的上面。控制系统硬件主要包括AT89C51单片机控制系统及其外围电路、电机驱动电路和传感器检测电路。第一节 AT89系列单片机简介 机器人的控制系统采用的是AT89C51单片机。AT89系列单片机是ATMEL公司的系列产品。其主要特点如下: 1.与MCS-51'”产品兼容 2.1000次重复编程

20、/擦写 3.具有2. 7V低电压型号表3.1 AT89系列单片机的性能参数功能参数AT89C51AT89C5289C105189C2051闪速式存储器（字节）4K8K1K2K内存（字节）12825664128工作频率（MHz）24242424输入/输出线3232151516位定时器/数器2312中断源5835串行口1101第二节 外围电路一电源AT89C51单片机正常工作时，其40脚(Vcc)接+SV电源，20脚(VSS接地。AJMP LOOP1 DLY： MOV R4，#M ;通过改变M,M1的值调整转速DLY1：MOV A，#M1 LOOP2: DEC A JNZ LOOP2DJNZ R4

21、，DLY1 RET二、 左轮控制程序： ZLKZ: PUSH A ；保护现场 MOV A，R0 MOV P1.3，A ；输出控制脉冲 ACALL DLY ；调用延时程序 INC R0 ；控制字存储地址增1 MOV A，#00H ORL A，R0 ；是结束标志转移 JZ TPL LOOP1： DJNZ R3，LOOP ；步数不为0，转移 POP A RET TPL： MOV A，R0 ；恢复控制字首址 SUBB A，#06H MOV R0，A AJMP LOOP1 DLY： MOV R4，#M ;通过改变M,M1的值调整转速DLY1：MOV A，#M1 LOOP2: DEC A JNZ LOOP

22、2DJNZ R4，DLY1 RET结论虽然清扫机器人的研究已经取得了很大进步,进入了实用阶段,但是自主能力、工作效率方面还不理想,需要在技术上解决传感器技术、定位和环境建模技术.在此基础上,自主吸尘机器人可以向着高度智能化、多功能集成、低成本的方向发展。清扫机器人作为服务机器人领域中的一个新产品,将使人们能在无人看守情况下轻松地完成室内环境的吸尘等清洁工作。因此,只要生产成本兼顾到日用电器批量大、价格低的特点, 清扫机器人将具有诱人的市场前景,有关资料也预测清扫机器人是未来几年需求量最大的服务机器人。特别是日用清洁电器不论是在市场上或者是在产品的创新上,绝对是所有小家电产品中最活跃的,未来仍有相当大的成长空间。致谢随着毕业设计的完成，我的大学生涯很快就要划上句号。临近毕业，更多的是眷恋与不舍，三年，一段不短的时间，让我从青涩走向成熟。