扫地机器人原理及实现.pdf

《扫地机器人原理及实现.pdf》由会员分享，可在线阅读，更多相关《扫地机器人原理及实现.pdf（6页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、-扫地机器人构造及控制系统设计扫地机器人构造及控制系统设计自动清扫机器人是当今效劳机器人领域一个热门的研究方向。 从理论和技术上讲， 自动清扫机器人比较具体地表达了移动机器人的多项关键技术， 具有较强的代表性， 从市场前景角度讲， 自动清扫机器人将大大降低劳动强度、 提高劳动效率， 适用于宾馆、 酒店、 图书馆、办公场所和群众家庭。 因此开发自动清扫机器人既具有科研上的挑战性又具有广阔的市场前景。家用智能清扫机，包括计算机、传感器、电机与动力传动机构、电源、吸尘器、电源开关、操作电位计等，在清扫机的顶部共设有三个超声波距离传感器； 清扫机底部前方边沿安装有5个接近开关，接近开关与超声波距离传感

2、器一起，构成清扫机测距系统；清扫机装有两台直流电机； 在清扫机的底部安装有吸尘器机构。 自动清扫机器人的功能是自动完成房间空旷地面尤其是家居空旷地面的清扫除尘任务，清扫前，要把房间里的物体紧靠四周墙壁，腾出空旷地面。 清扫机完成的主要功能： 能自动走遍所以可进入的房间， 可以自动清扫吸尘，可在遥控和手控状态下清扫吸尘。本文所介绍的自动清扫机器人的总体布局方案如图1所示，前后两轮为万向轮，左右两轮为驱动轮。 驱动轮设计采用两轮独立且各由两台步进电动机驱动的转向方式， 通过控制左右两轮的速度差来实现转向。 考虑到机器人实际应用的实用性， 本驱动系统设计成一个独立的可方便替换的模块， 当机器人驱动系

3、统发生故障时， 只需简单步骤就可以对驱动局部进展替换。同时为了机器人能够灵活的运动，从动轮选用万向轮。以下图为自动清扫机的三维立体图：.z.-自动清扫机器人车箱体采用框架式构造。 从下至上分隔成三个空间： 第一层装配各运动部件的驱动电机、 传动机构； 第二层为垃圾存储空间； 第三层装配机器人控制系统、 接线板、.z.-电源电池、开关等。自动清扫机器人控制系统硬件主要是以单片机 AT89C51 作为核心， 辅助其外围电路、电机驱动电路、传感器检测电路以及红外遥控电路等，各模块在单片机的控制下，相互协调工作，保证自动清扫机器人各种功能的实现。该控制系统框图如图 2 所示。传感器在清扫机器人上的布置

4、如图下所示，图中红色的圆点代表六个红外传感器的位置。以下图为清扫机的硬件系统：步进电机作为执行元件， 广泛应用于各种自动化设备中。 步进电机和普通电动机不同之处在于它是一种可以将电脉冲信号转化为角位移的执行机构， 工作中传递转矩的同时还可以控制角位移或速度。 本研究中采用两台步进电机分别驱动两个驱动轮，通过通电方式的不同使自动清扫机器人的行走机构到达前进、后退、左转、右转的运动姿态。自动清扫机器人的吸尘器则采用直流电机 H 桥式电路驱动。以下图为步进电机驱动电路：采用以 AT89C51 单片机为核心的红外接收电路和步进电机驱动电路。红外遥控器发射不同的码值来控制步进电机的正转、反转、加速减速以

5、及启动停顿。单片机通过对红外信号的解码来实现步进电机的变速。红外发射器原理图如下所示：设计行走功能模块程序设计系统选用了图 3 所示的行走方案。 程序设计时要考虑:吸尘器在外圈行走时, 为了防止接近开关中断对程序运行的干扰, 应对接近开关的中断处 理程序做 相应处理。由于吸尘器两动力轮的中心与车.z.-体中心不重合, 故采用以一轮为中心的旋转方式并通过检测转弯标志位 ( 1 或 0)来判断转向。在墙角转弯时处，根据吸尘器外形的几何尺寸计算吸尘器遇墙停顿后 , 后退再转弯的时间。吸尘器圈行走时的转弯依靠转弯设定值实现。当超声波传感器 1 的值小于等于设定值时, 吸尘器转弯。考虑到超声波传感器的最

6、小量程为 0.5 m, 第一圈圈行走的转弯设定值设定为 50 cm, 以后每圈的转弯设定值递增 30 cm。吸尘器单向行驶至转弯完毕的过程称为一次单向清扫过程。假设*次单向行驶完毕后检测到超声波传感器 1 的值小于转弯设定值,则吸尘器原地再次转弯, 然后前进至墙停顿, 整个房间清扫完毕。设计躲避障碍物功能模块程序设计避障总规则: 利用超声波实测值与已测得的房间长(宽 )值的比较, 判断*次单向清扫途中是否有障碍物。假设有障碍物 : 行走时假设为左转, 采用左避让规则; 行走时假设为右转, 采用右避让规则。障碍物避开后按行走规则继续行进;假设无障碍物: 按行走规则继续行进, 在转弯前应判断是否有

7、足够的空间供机器人吸尘器转弯。 假设吸尘器可以转弯, 则转弯, 本次单向清扫完毕; 假设吸尘器不能转弯, 说明下次单向清扫起始点处有障碍物, 后退,避开障碍物后再转弯, 前进至通过障碍物边线后, 本次单向清扫完毕。避障功能是在行走功能根底上实现的,分为圈避障程序设计和外圈程序设计。 清扫完毕的判断方案: 用外圈行走完毕后清扫区域的准确长、 宽值与圈行走轨迹宽度 30 cm 相除, 商即为长、宽方向上各自所需的单向清扫次数, 有余数则说明还有一块宽度小于30cm 的矩形区域需要清扫。在执行圈避障时, 只要长或宽任意方向上的单向清扫次数到达所需的次数, 即认为清扫完毕, 剩余矩形区域的清扫在终止模

8、块中完成。车体姿态调整功能模块程序设计，为保证车体运行时不偏离轨道, 采用陀螺仪传感器监视车体运动状况。 当车体偏移量到达一定值时, 通过控制行进方式调.z.-整车体姿态。 当车体偏转角度大于 10%时, 开场调整车体姿态。 首先判断车体偏转的方向并记录车体偏转角度。为使车体能最大限度地回到原位置, 采用一个动力轮不动, 另一动力轮倒转的方式实现车体姿态调整。 使用该方案调整车体位置后, 车体并不一定能恰好回到原位置, 但误差已经很小, 可以满足系统设计要求。车体姿态调整程序流程如以下图。主控程序是吸尘器工作的主体逻辑。在主控程序中需要完成DSP的初始化设置, 考虑各功能模块间的逻辑关系, 实

9、现对各子程序的调用, 并要充分考虑到各级中断信号对程序运行的影响, 做出正确的处理、协调。主控程序流程如以下图。 用户操作键盘时接近开关可能会工作, 这有可能导致程序运行出错, 故DSP需在程序最开场首先屏蔽所有中断。键盘的检测由单片机实现, 用户假设想通过键盘设定吸尘器工作方式, 则必须在开机后20 s开场操作, 该20 s的延时由DSP提供, 20 s后假设无键按下, 则认为用户未设定吸尘器工作状态, 系统按自动方式开场工作; 20 s后假设有键按下, 则将等待用户输入完毕后,按照用户设定要求工作。系统初始化程序设计， 系统的初始化程序是系统各功能实现的前提。 给状态存放器赋值,保证子程序

10、调用或进入中断时实现CPU 各种状态的保存; 数据存储区配置; 输出口的选择及功能设定; 中断的相关存放器处理; 累加器的溢出方式选择及系统的时钟频率的选定等功能都在初始化程序中实现。系统中断处理，系统设计中共有4路中断信号需要处理, 其中8路接近开关和4路超声波传感器共用优先级为1级的外部中断* INT1;两个事件管理模块EVA和EVB在产生PWM 波形时用到了优先级为2级的定时器1和定时器3的周期中断; 此外, 陀螺仪的测量值经ADC 转换时用到了中断优先级为6级的ADC 中断。外部中断* INT1的处理，由于8路接近开关和超声波传感器共用*INT1中断, 故在响应该中断时应首先判断是哪个

11、外部设备产生的中断请求, 然后进展相应的处理。 假设为接近开关中断, 单片机向双口RAM8040h单元写0, 假设为超声波中断则写1, DSP通过读8040h单元容来判断是哪个外设产生的中断:假设为超声波传感器发出的中断, 在其中断效劳程序中只需重新开中断即可( 这是因为进入中断效劳程序时, 系统自动关闭中断)； 假设为接近开关中断, 需判断该接近开关是否工作。工作时, 则在中断效劳程序中还要执行停顿程序, 否则只需开中断即可。是第几个接近开关工作, 单片机就在双口RAM 8033h单元中写几, 假设同时有多个接近开关工作, 则单片机从8033 单元的最低位起将其序号依次写入。DSP 只需依照

12、此规则便可根据8033h单元容判断是哪个接近开关工作。.z.-ADC中断处理，吸尘器在测距模块中车体旋转180。, 左、右转及姿态调整的过程中都会响应ADC 中断, 故在执行上述功能的程序时分别向012Eh单元写0、1、2、3, 功能实现后再向012Eh单元写4, 这样, 响应中断时便可在中断效劳程序过查询012Eh单元的容来判断车体的运动情况, 从而执行不同的效劳程序。定时器周期中断处理， 定时器周期中断的处理相对简单, 只需在中断效劳程序中将计数器1和计数器3重新设置计数初值并开中断即可。完毕语：扫地机器人控制系统主控及主要功能模块程序的调试和仿真说明, 主控模块通过对各子程序的调用, 按一定时序完成了对吸尘器的控制, 各主要功能模块满足设计要求。如避障模块通过对采集到的超声波信号和接近开关信号的判断和处理, 很好地完成了对障碍物的自动感知和自主躲避; 步进电机及吸尘电机控制精度较高等。.z.