版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、0 引 言移动机构是清洁机器人的主体,决定了清洁机器人的运动空间,一般采用轮式结构。传感器系统一般采用超声波传感器、红外光电传感器、接触传感器等构成多传感器系统。随着近年来控制技术、传感技术以及移动机器人技术等技术的迅速发展,智能清洁机器人控制系统的研究和开发已具备了坚实的基础和良好的发展前景。吸尘系统在原理上与传统立式吸尘器相同,主要是在结构设计上更多考虑结构尺寸、集成度以及一些辅助机构的合理布置和利用,以此来提高能源利用率和工作效率。本文主要研究智能清洁机器人测控系统的设计与实现,最终目标是通过软硬件的合理设计,使智能清洁机器人能够自动避开障碍物,实现一般家居环境下的自主清洁工作。1 测控
2、系统组成及功能智能清洁机器人测控系统主要包括控制器核心系统、传感器系统和驱动系统等。其原理如图1所示。基于清洁机器人自身体积尽可能小的原则,本设计将控制器核心系统、传感器系统、行走驱动及相关电路集成在一块电路板上。为防止干扰,通过光电隔离器件将各模块在电气上隔离开来。利用超声波传感器、红外反射式传感器和接触传感器组成多传感器系统,检测信号经调理电路处理后送控制器;采用8位单片机SST89E554RC作为控制器,控制器对传感器信号加以判断,根据判断结果,选定相应的控制策略,并控制语音系统发出相应的报警信号;在相应的控制策略下,通过专用驱动器驱动直流电机,带动驱动轮,两轮独立驱动,实现避障功能;同
3、时,控制器控制小型双风机真空吸尘系统对经过的地面进行必要的清扫。图1 系统原理该新型智能清洁机器人实验平台如图2所示,该平台为圆形结构,两轮独立驱动,具备完整的吸尘系统和电源系统等功能模块。最终将在该平台上对本文所介绍的测控系统的性能进行实验验证。图2 智能清洁机器人实验平台2 测控系统硬件设计2.1 CPU控制模块CPU采用美国SST公司制造的8位单片机SST89E554RC。器件使用与8051完全相同的指令集,并与标准的8051器件管脚对管脚兼容。片内拥有1 kB字节RAM空间,3个16位定时计数器,4个8位I/O端口,拥有可编程计数阵列(PCA,可提供5路256级PWM调速,可通过全双工
4、增强型串口实现人机通讯。2.2 驱动模块2.3 障碍物检测模块超声波是一种一定频率范围的声波,频率为40kHz的超声波信号在空气中的传播效率最佳。本文选用中心频率40kHz,测距范围在5m以内的普通超声波传感器。传感器发射探头和接收探头安装在机器人正前方,系统工作时,通过汇编程序由P3.7口产生精确的40kHz发射脉冲,每隔25ms发射一组脉冲,每组的脉冲个数取610个,以保证发射波具备良好的传播性和反射性。发射波遇到障碍物反射回来,被接收器接收,转变成电信号脉冲,对该信号进行放大、滤波、比较和整形等处理后送入单片机外部中断口INT1,触发单片机外部中断,进入中断处理程序,获取从发射波发出到收
5、到反射波时的时间间隔即测距时间,由此即可根据超声波测距原理计算出障碍物的距离。主程序中设定机器人行走过程中距离障碍物的最小距离,当被测距离小于最小距离时,控制器向驱动系统发出避障指令,避开障碍物。本设计中利用软件延时去除串扰带来的误操作,即在发射波发出一段时间后,再打开外部中断,避免发射波不经反射就直接被接收器接收而引起假中断。 该模块用于主动探测机器人周边障碍物和地面落差。选用JY043W型红外反射式传感器,该型传感器调理电路简单,安装调试方便,每一路的检测距离可以达到 7cm,满足本文设计的需要。该部分由6路检测单元组成,其中在机器人左前方和右前方各安装2路,配合超声波传感器实现周边障碍物
6、的检测。另2路分别安装在机器人前端左下方和右下方,探头距离地面4cm,用于检测地面是否有台阶等落差,防止机器人跌落。红外反射式传感器具体工作过程为,发现障碍物时,发射管发出红外信号遇到障碍物反射回来,接收管接收到反射信号后导通,则信号处理电路的输出端变为低电平,该低电平直接送入控制器P2的一个端口,当控制器检测到这个端口的低电平变化时则表明该方位发现障碍物。接触传感器具有检测范围大、信号无需调理、占用控制器资源少等一系列优点。本文选择小型接触开关作为接触传感器,安装在机器人前端的缓冲器上,作用在于通过轻微的碰撞接触,检测那些未能被超声波传感器和红外反射式传感器检测到杆状或微小障碍物,如座椅腿等
7、。3 测控系统软件设计3.1 传感器信息处理当各路传感器检测到障碍物时,控制器必须获得障碍物的准确信息后,才能发出正确的避障指令。为了获得有效信息,程序代码中为每一路检测信息都设定一个标志位,主程序不断检测各个标志位的值的有效性,以此作为障碍物方位信息。对于不同的传感器,其信息判断标志位有效值也可能不同。在本文所提到的3种传感器中,超声波传感器的信号处理程序最为复杂,其流程如图3所示。图3 超声波传感器信号处理程序流程3.2 驱动控制表1 控制信号与电机动作关系3.3 避障算法描述根据模糊控制思想并结合实际行走试验设计避障算法。以传感器系统9路传感器的检测距离和障碍物所在的方位为模糊控制输入量
8、,以驱动轮的前进、旋转和后退动作为模糊控制输出量。超声波传感器检测最小距离设定为15cm,距离远;红外传感器检测距离为7cm,距离适中;接触传感器是在发生碰撞后才能检测到障碍物,因此检测距离最近。据此设距离信号(记作:D的模糊语言集合为:D近,中,远设定其相应的语言变量,记作:ND近,MD中,LD远以各路传感器在机器人上的安装位置作为障碍物所在方位(记作:A。超声波传感器安装在正前方,在其左右两边依次是接触传感器、下方红外传感器和周边红外传感器。则设方位信号的模糊语言集合为:A最左,较左,左,左下,中,右下,右,较右,最右设定其相应的语言变量,记作:BL最左,ML较左,L左,LD左下,M中,R
9、右,RD右下,MR较右,BR最右设机器人驱动轮的动作集合为:右转,稍微右转,后退,减速,前进,稍微左转,左转设定其相应的语言变量,记作:TR右转,TRL稍微右转,GB后退,SD减速,GA前进,TLL稍微左转,TL左转对于清洁机器人来说,在避障的同时,还要能够对清洁区域进行遍历。在保证避障和遍历的前提下,为了减少控制器的计算量并避免程序复杂化,本文采用逐一查询方式获得模糊控制量之一障碍物方位,根据障碍物方位即可获得另一输入量即机器人与障碍物间的距离。容易理解,采用逐一查询方法意味着控制器获得的障碍物信息来自于最先被传感器系统检测到的障碍物,而且控制器将根据最先获得的障碍物信息来调用相应的避障策略
10、。因此,当有2个或2个以上方位有障碍物时,执行避障策略时机器人有可能与障碍物发生碰撞。试验发现,只有当左边的最左、较左方位和右边的最右、较右方位都有一个或2个发现障碍物时,才有可能导致机器人与障碍物发生碰撞。为了避免这种情况发生,将机器人左右两边都发现障碍物的情况也作为一个障碍物方位变量,不论机器人左右2边是同时发现一个还是2个障碍物,都仅设其模糊语言为左右,设定相应的语言变量为LR。根据有利于避碰的原则,将障碍物方位信息的查询顺序确定为:LD,RD,LR,M,BL,BR,ML,MR,L,R(左下,右下,左右,中,最左,最右,较左,较右,左,右从机器人有效避障并保证尽量少的重复先前行走轨迹的角
11、度出发,当确定了障碍物的方位和机器人离障碍物的距离后,我们希望模糊控制的输出量不仅仅是机器人动作集合中某一种动作,而是集合里某几种动作的合理组合。因此,针对不同方位的障碍物信息,对机器人左右驱动轮动作集合的7种动作 (TR,TRL,GB,SD,GA,TLL,TL进行合理组合,即得到相应的合成输出量,记作Fi(i1,2,3。根据前述方法,最终可归纳出 10种控制规则,即避障策略,如表2所示。表2 控制规则表按照障碍物方位信息的查询顺序,其形式是:if(Ai and Dthen Fii1,2,310按照此种方法,在不影响机器人有效避障和相关功能的情况下,有效避障的控制规则大大减少,使避障算法简单化。4 实验结果在智能清洁机器人实验平台上对整个测控系统进行测试。实验在一间约10m2的房间中进行,在房间中随机摆放几件日常物品作为障碍物,将通过智能清洁机器人的行走实验,对本文所述的智能清洁机器人测控系统的软硬件性能进行验证。实验中,智能清洁机器人始终保持直线行走,遇到障碍物时,根据障碍物信息选择合适的避障策略避开障碍物,然后继
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 2024年度电商渠道加盟协议书3篇
- 二零二四年度商业租赁合同的标的与属性分析
- 二零二四年度办公室地板采购合同
- 二零二四年度版权许可使用合同(音乐作品)
- 二零二四年度涉外税收优惠政策合同
- 二零二四年度铝合金模板企业员工培训合同
- 二零二四年度影视制作合同的服务条款
- 滨涯幼儿园2024年度学生健康体检合同
- 二零二四年度技术开发合同之技术成果共享与保密
- 二零二四年度煤矿通风系统改善工程承包合同
- 粗骨料质量评定表
- (整理)制氢站着火应急演练方案
- 氖气安全技术说明书
- 《OperationsManagement》课程实施方案(教学大纲)
- 工程造价控制形考4参考答案
- 四年级上册英语试题Module 8 练习(含答案)外研版(一起)
- (完整ppt)隧道施工方法课件
- 离婚登记申请受理回执单(民法典版)
- 失禁性皮炎的护理--PPT课件
- 2002年挑战杯作品文集 (65)
- 控压钻井技术及实践(装备与实例)课件
评论
0/150
提交评论