扫地机器人结构详细

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

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

3、对驱动部分进行替 换。同时为了机器人能够灵活的运动,从动轮选用万向轮。下图为自动淸扫机的三维立体 图:扫地机器人结构详细丿j向轮传感器起尘刷驱动轮驱动电机挡尘盖清扫电机清扫刷集尘室传感器底盘驱动轮吸尘风机电源系统电路自动淸扫机器人车箱体采用框架式结构。从下至上分隔成三个空间：第一层装配各运动部件的驱动电机、传动机构;第二层为垃圾存储空间;第三层装配机器人控制系统、接线板、扫地机器人结构详细电源电池、开关等。自动清扫机器人控制系统碾件主要 就是以单片机AT89C51作为核心,辅助苴 外用电路、电机驱动电路、传感器检测电 路以及红外遥控电路等，各模块在单片机 的控制下，相互协调工作，保证自动淸扫

4、机器人各种功能的实现。该控制系统框图 如图2所示。传感器在淸扫机器人上的布 置如图下所示，图中红色的圆点代表六个 红外传感器的位置。下图为淸扫机的硬件系统：步进电机作为执行元件，广泛应用于各种自动化设备中。步进电机与普通电动机不同之 处在于它就是一种可以将电脉冲信号转化为角位移的执行机构，工作中传递转矩的同时还可 以控制角位移或速度。本研究中采用两台步进电机分別驱动两个驱动轮，通过通电方式的不 同使自动淸扫机器人的行走机构达到前进、后退、左转、右转的运动姿态。自动淸扫机器人 的吸尘器则采用直流电机（H桥式电路）驱动。下图为步进电机驱动电路:VI0M T- K2r Wq 宀0CT1OVT2 or

5、nOVMi - SN A亠 35K3ke?taDTA一 J 叫J I捲hr z - 1 ；tn H时eeiSA EXBOCT：ovnom0V74扫地机器人结构详细Mmt气上g JxceJ1C9 皿 W2 b?15 2w2 护采用以AT89C51单片机为核心的红外接收电路与步进电机驱动电路。红外遥控器发射不同的码值来控制步进电机的正转、反转、加速减速以及启动停I上。单片机通过对红外信号的解 码来实现步进电机的变速。红外发射 器原理图如下所示：设汁行走功能模块程序设汁系统选用了图3所示的行走 方案。程序设讣时要考虑:吸尘器 在外圈行走时，为了避免接近开 关中断对程序运行的干扰，应对 接近开关的中断

6、处理程序做相 应处理。由于吸尘器两动力轮的中 心与车体中心不重合，故采用以扫地机器人结构详细一轮为中心的旋转方式并通过检测转弯标志位（1或0）来判断转向在墙角转弯时处，根 据吸尘器外形的几何尺寸计算吸尘器遇墙停止后，后退再转弯的时间。吸尘器内圈行龙时的 转弯依靠转弯设左值实现。当超声波传感器1的值小于等于设左值时，吸尘器转弯。考虑到超声波传感器的最小量程为0、5m,第一圈内圈行 龙的转弯设泄值设立为50 cm,以后每圈的转弯设泄值 递增30 cm。吸尘器单向行驶至转弯结束的过程称为一 次单向淸扫过程。若某次单向行驶结束后检测到超声波 传感器1的值小于转弯设左值，则吸尘器原地再次转 弯，然后前进

7、至墙停止，整个房间淸扫完毕。设计躲避障碍物功能模块程序设计避障总规则：利用超声波实测值与已测得的房间长 （宽）值的比较，判断某次单向淸扫途中就是否有障碍物。若有障碍物：行走时若为左转， 采用左避让规则；行疋时若为右转，采用右避让规则。障碍物避开后按行疋规则继续行进; 若无障碍物：按行走规则继续行进，在转弯前应判断就是否有足够的空间供机器人吸尘器 转弯。若吸尘器可以转弯，则转弯，本次单向淸扫完毕；若吸尘器不能转弯，说明下次单向 清扫起始点处有障碍物，后退，避开障碍物后再转弯，前进至通过障碍物边线后，本次单向淸扫完毕。避障功能就是在行疋功能基础上实现的，分为内圈避障程序设计与外圈程序设汁。淸扫完毕

8、的判断方案：用外圈行走结束后淸扫区域的精确长、宽值与内圈行走轨迹宽度30 cm相除，商即为长、宽方向上各自所需的单向淸扫次数，有余数则说明还有一块宽度小于30cm的矩形区域需要淸扫。在执行内圈避障时,只要长或宽任意方向上的单向淸扫次数达到所需的次数，即认为淸扫完毕，剩余矩形区域的T停比电仇止转I O12EG4清扫在终止模块中完成。车体姿态调整功能模块程序设计,为保证车体运行时不偏离轨道，釆用陀螺仪传感器监视车体运动状况。当车体偏移量达到一左值时，通过控制行进方式调整车体姿态。当车体偏转角度大于10弔时，开始调壬体迩衣调螯了程用流稈图扫地机器人结构详细整车体姿态。首先判断车体偏转的方向并记录车体

9、偏转角度。为使车体能最大限度地回到原 位置，采用一个动力轮不动，列一动力轮倒转的方式实现车体姿态调整。使用该方案调整车 体位程后，车体并不一左能恰好回到原位宜，但误差已经很小，可以满足系统设计要求。车 体姿态调整程序流程如图所示。主控程序就是吸尘器工作的主体逻辑。在主控程序中需要完成DSP的初始化设置，考虑 各功能模块间的逻借关系，实现对各子程序的调用，并要充分考虑到各级中断信号对程序 运行的影响，做出正确的处理、协调。主控程序流程如图所示。用户操作键盘时接近开关可能会工作，这有可能导致程序运行 出错，故DSP需在程序最开始首先屏蔽所有中断。键盘的检测由单片机实现，用户若想通过 键盘设左吸尘器

10、工作方式，则必须在开机后20 s内开始操作，该20 s的延时由DSP提供，20 s 后若无键按下，则认为用户未设左吸尘器工作状态，系统按自动方式开始工作；20s后若有 键按下，则将等待用户输入完毕后，按照用户设定要求工作。系统初始化程序设计，系统的初始化程序就是系统各功能实现的前提。给状态寄存器賦 值，保证子程序调用或进入中断时实现CPU各种状态的保存；数据存储区配置；输出口的 选择及功能设宦；中断的相关寄存器处理；累加器的溢出方式选择及系统的时钟频率的选 龙等功能都在初始化程序中实现。系统中断处理，系统设计中共有4路中断信号需要处理，英中8路接近开关与4路超声波 传感器共用优先级为1级的外部

11、中断X INT1;两个事件管理模块EVA与EVB在产生PWM波形时 用到了优先级为2级的泄时器1与左时器3的周期中断；此外，陀螺仪的测量值经ADC转换时 用到了中断优先级为6级的ADC中断。外部中断X INT1的处理，由于8路接近开关与超声波传感器共用XIXT1中断，故在响应该 中断时应首先判断就是哪个外部设备产生的中断请求，然后进行相应的处理。若为接近开关 中断，单片机向双口RAM8040h单元写0,若为超声波中断则写1, DSP通过读8040h单元内容 来判断就是哪个外设产生的中断:若为超声波传感器发出的中断，在英中断服务程序中只 需重新开中断即可（这就是因为进入中断服务程序时，系统自动关

12、闭中断）；若为接近开 关中断，需判断该接近开关就是否工作。工作时，则在中断服务程序中还要执行停I匕程序, 否则只需开中断即可。就是第几个接近开关工作，单片机就在双口RAM 8033h单元中写几， 若同时有多个接近开关工作，则单片机从8033单元的最低位起将其序号依次写入。DSP只 需依照此规则便可根据8033h单元内容判断就是哪个接近开关工作。ADC中断处理，吸尘器在测距模块中车体旋转180 ,左、右转及姿态调整的过程中都会响扫地机器人结构详细应ADC中断，故在执行上述功能的程序时分别向012Eh单元写0、1、2、3,功能实现后再向 012Eh单元写4,这样，响应中断时便可在中断服务程序中通过查询012Eh单元的内容来判断 车体的运动情况，从而执行不同的服务程序。左时器周期中断处理，左时器周期中断的处