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