扫地机器人原理及实现

精品文档 1欢迎下载 扫扫地地机机器器人人结结构构及及控控制制系系统统设设计计 自动清扫机器人是当今服务机器人领域一个热门的研究方向 从理论和技术上讲 自 动清扫机器人比较具体地体现了移动机器人的多项关键技术 具有较强的代表性 从市场 前景角度讲 自动清扫机器人将大大降低劳动强度 提高劳动效率 适用于宾馆 酒店 图书馆 办公场所和大众家庭 因此开发自动清扫机器人既具有科研上的挑战性又具有广 阔的市场前景 家用智能清扫机 包括计算机 传感器 电机与动力传动机构 电源 吸尘器 电源 开关 操作电位计等 在清扫机的顶部共设有三个超声波距离传感器 清扫机底部前方边 沿安装有5个接近开关 接近开关与超声波距离传感器一起 构成清扫机测距系统 清扫机 装有两台直流电机 在清扫机的底部安装有吸尘器机构 自动清扫机器人的功能是自动完 成房间空旷地面尤其是家居空旷地面的清扫除尘任务 打扫前 要把房间里的物体紧靠四 周墙壁 腾出空旷地面 清扫机完成的主要功能 能自动走遍所以可进入的房间 可以自 动清扫吸尘 可在遥控和手控状态下清扫吸尘 本文所介绍的自动清扫机器人的总体布局方案如图1所示 前后两轮为万向轮 左右两 轮为驱动轮 驱动轮设计采用两轮独立且各由两台步进电动机驱动的转向方式 通过控制 左右两轮的速度差来实现转向 考虑到机器人实际应用的实用性 本驱动系统设计成一个 独立的可方便替换的模块 当机器人驱动系统发生故障时 只需简单步骤就可以对驱动部 分进行替换 同时为了机器人能够灵活的运动 从动轮选用万向轮 下图为自动清扫机的三维立体图 精品文档 2欢迎下载 自动清扫机器人车箱体采用框架式结构 从下至上分隔成三个空间 第一层装配各运 动部件的驱动电机 传动机构 第二层为垃圾存储空间 第三层装配机器人控制系统 接 精品文档 3欢迎下载 线板 电源电池 开关等 自动清扫机器人控制系统硬件主要 是以单片机 AT89C51 作为核心 辅助其 外围电路 电机驱动电路 传感器检测 电路以及红外遥控电路等 各模块在单 片机的控制下 相互协调工作 保证自 动清扫机器人各种功能的实现 该控制 系统框图如图 2 所示 传感器在清扫机 器人上的布置如图下所示 图中红色的 圆点代表六个红外传感器的位置 下图为清扫机的硬件系统 步进电机作为执行元件 广泛应用于各种自动化设备中 步进电机和普通电动机不同 之处在于它是一种可以将电脉冲信号转化为角位移的执行机构 工作中传递转矩的同时还 可以控制角位移或速度 本研究中采用两台步进电机分别驱动两个驱动轮 通过通电方式 的不同使自动清扫机器人的行走机构达到前进 后退 左转 右转的运动姿态 自动清扫 机器人的吸尘器则采用直流电机 H 桥式电路 驱动 精品文档 4欢迎下载 下图为步进电机驱动电路 采用以 AT89C51 单片机为核心的红外接收电路和步进电机驱动电路 红外遥控器发射 不同的码值来控制步进电机的正转 反转 加速减速以及启动停止 单片机通过对红外信号 的解码来实现步进电机的变速 红外 发射器原理图如下所示 设计行走功能模块程序 设计系统选用了图 3 所示的行走 方案 程序设计时要考虑 吸尘器 在外圈行走时 为了避免接近开 关中断对程序运行的干扰 应对 接近开关的中断处 理程序做 相 应处理 由于吸尘器两动力轮的 中心与车体中心不重合 故采用 以一轮为中心的旋转方式并通过 精品文档 5欢迎下载 检测转弯标志位 1 或 0 来判断转向 在墙角转弯时处 根据吸尘器外形的几何尺寸计 算吸尘器遇墙停止后 后退再转弯的时间 吸尘器内圈行走时的转弯依靠转弯设定值实现 当超声波传感器 1 的值小于等于设定值时 吸尘器转弯 考虑到超声波传感器的最小量程 为 0 5 m 第一圈内圈行走的转弯设定值设定为 50 cm 以后每圈的转弯设定值递增 30 cm 吸尘器单向 行驶至转弯结束的过程称为一次单向清扫过程 若某 次单向行驶结束后检测到超声波传感器 1 的值小于转 弯设定值 则吸尘器原地再次转弯 然后前进至墙停 止 整个房间清扫完毕 设计躲避障碍物功能模块程序设计避障总规则 利用超声波实测值与已测得的房间长 宽 值的比较 判断某次单向清扫途中是否有障碍物 若有障碍物 行走时若为左转 采 用左避让规则 行走时若为右转 采用右避让规则 障碍物避开后按行走规则继续行进 若无障碍物 按行走规则继续行进 在转弯前应判断是否有足够的空间供机器人吸尘器转 弯 若吸尘器可以转弯 则转弯 本次单向清扫完毕 若吸尘器不能转弯 说明下次单向 清扫起始点处有障碍物 后退 避开障碍物后再转弯 前进至通过障碍物边线后 本次单向 清扫完毕 避障功能是在行走功能基础上实现 的 分为内圈避障程序设计和外圈程序设计 清扫完毕的判断方案 用外圈行走结束后清扫 区域的精确长 宽值与内圈行走轨迹宽度 30 cm 相除 商即为长 宽方向上各自所需的单向 清扫次数 有余数则说明还有一块宽度小于 30 cm 的矩形区域需要清扫 在执行内圈避障时 只要长或宽任意方向上的单向清扫次数达到所 需的次数 即认为清扫完毕 剩余矩形区域的 清扫在终止模块中完成 车体姿态调整功能模块程序设计 为保证车体运 行时不偏离轨道 采用陀螺仪传感器监视车体运动状 况 当车体偏移量达到一定值时 通过控制行进方式 调整车体姿态 当车体偏转角度大于 10 时 开始调 整车体姿态 首先判断车体偏转的方向并记录车体偏 精品文档 6欢迎下载 转角度 为使车体能最大限度地回到原位置 采用一个动力轮不动 另一动力轮倒转的方 式实现车体姿态调整 使用该方案调整车体位置后 车体并不一定能恰好回到原位置 但 误差已经很小 可以满足系统设计要求 车体姿态调整程序流程如图所示 主控程序是吸尘器工作的主体逻辑 在主控程序中需要完成DSP的初始化设置 考虑各 功能模块间的逻辑关系 实现对各子程序的调用 并要充分考虑到各级中断信号对程序运 行的影响 做出正确的处理 协调 主控程序流程如图所示 用户操作键盘时接近开关可能会工作 这有可能导致程序运 行出错 故DSP需在程序最开始首先屏蔽所有中断 键盘的检测由单片机实现 用户若想通 过键盘设定吸尘器工作方式 则必须在开机后20 s内开始操作 该20 s的延时由DSP提供 20 s后若无键按下 则认为用户未设定吸尘器工作状态 系统按自动方式开始工作 20 s 后若有键按下 则将等待用户输入完毕后 按照用户设定要求工作 系统初始化程序设计 系统的初始化程序是系统各功能实现的前提 给状态寄存器赋 值 保证子程序调用或进入中断时实现CPU 各种状态的保存 数据存储区配置 输出口的 选择及功能设定 中断的相关寄存器处理 累加器的溢出方式选择及系统的时钟频率的选 定等功能都在初始化程序中实现 系统中断处理 系统设计中共有4路中断信号需要处理 其中8路接近开关和4路超声波 传感器共用优先级为1级的外部中断X INT1 两个事件管理模块EVA和EVB在产生PWM 波形时 用到了优先级为2级的定时器1和定时器3的周期中断 此外 陀螺仪的测量值经ADC 转换时 用到了中断优先级为6级的ADC 中断 外部中断X INT1的处理 由于8路接近开关和超声波传感器共用XINT1中断 故在响应 该中断时应首先判断是哪个外部设备产生的中断请求 然后进行相应的处理 若为接近开 关中断 单片机向双口RAM8040h单元写0 若为超声波中断则写1 DSP通过读8040h单元内 容来判断是哪个外设产生的中断 若为超声波传感器发出的中断 在其中断服务程序中只 需重新开中断即可 这是因为进入中断服务程序时 系统自动关闭中断 若为接近开关 中断 需判断该接近开关是否工作 工作时 则在中断服务程序中还要执行停止程序 否 则只需开中断即可 是第几个接近开关工作 单片机就在双口RAM 8033h单元中写几 若同 时有多个接近开关工作 则单片机从8033 单元的最低位起将其序号依次写入 DSP 只需依 照此规则便可根据8033h单元内容判断是哪个接近开关工作 ADC中断处理 吸尘器在测距模块中车体旋转180 左 右转及姿态调整的过程中都 会响应ADC 中断 故在执行上述功能的程序时分别向012Eh单元写0 1 2 3 功能实现后 精品文档 7欢迎下载 再向012Eh单元写4 这样 响应中断时便可在中断服务程序中通过查询012Eh单元的内容来 判断车体的运动情况 从而执行不同的服务程序 定时器周期中断处理 定时器周期中断的处理相对简单 只需在中断服务程序中将计 数器1和计数器3重新设置计数初值并开中断即可 结束语 扫地机器人控制系统主控及主要功能模块程序的调试和仿真表明 主控模块 通