一种新型智能清洁机器人测控系统的设计与实现

　　2.3 障碍物检测模块

　　2.3.1 超声波检浏部分

　　超声波是一种一定频率范围的声波，频率为40kHz的超声波信号在空气中的传播效率最佳。本文选用中心频率40kHz，测距范围在5m以内的普通超声波传感器。传感器发射探头和接收探头安装在机器人正前方，系统工作时，通过汇编程序由P3.7口产生精确的40kHz发射脉冲，每隔25ms发射一组脉冲，每组的脉冲个数取6～10个，以保证发射波具备良好的传播性和反射性。发射波遇到障碍物反射回来，被接收器接收，转变成电信号脉冲，对该信号进行放大、滤波、比较和整形等处理后送入单片机外部中断口INT1，触发单片机外部中断，进入中断处理程序，获取从发射波发出到收到反射波时的时间间隔即测距时间，由此即可根据超声波测距原理计算出障碍物的距离。主程序中设定机器人行走过程中距离障碍物的最小距离，当被测距离小于最小距离时，控制器向驱动系统发出避障指令，避开障碍物。本设计中利用软件延时去除串扰带来的误操作，即在发射波发出一段时间后，再打开外部中断，避免发射波不经反射就直接被接收器接收而引起假中断。

　　2.3.2 红外反射式传感器检测模块

　　该模块用于主动探测机器人周边障碍物和地面落差。选用JY043W型红外反射式传感器，该型传感器调理电路简单，安装调试方便，每一路的检测距离可以达到 7cm，满足本文设计的需要。该部分由6路检测单元组成，其中在机器人左前方和右前方各安装2路，配合超声波传感器实现周边障碍物的检测。另2路分别安装在机器人前端左下方和右下方，探头距离地面4cm，用于检测地面是否有台阶等落差，防止机器人跌落。红外反射式传感器具体工作过程为，发现障碍物时，发射管发出红外信号遇到障碍物反射回来，接收管接收到反射信号后导通，则信号处理电路的输出端变为低电平，该低电平直接送入控制器P2的一个端口，当控制器检测到这个端口的低电平变化时则表明该方位发现障碍物。

　　2.3.3 接触传感器检刚模块

　　接触传感器具有检测范围大、信号无需调理、占用控制器资源少等一系列优点。本文选择小型接触开关作为接触传感器，安装在机器人前端的缓冲器上，作用在于通过轻微的碰撞接触，检测那些未能被超声波传感器和红外反射式传感器检测到杆状或微小障碍物，如座椅腿等。

　　3 测控系统软件设计

　　3.1 传感器信息处理

　　当各路传感器检测到障碍物时，控制器必须获得障碍物的准确信息后，才能发出正确的避障指令。为了获得有效信息，程序代码中为每一路检测信息都设定一个标志位，主程序不断检测各个标志位的值的有效性，以此作为障碍物方位信息。对于不同的传感器，其信息判断标志位有效值也可能不同。在本文所提到的3种传感器中，超声波传感器的信号处理程序最为复杂，其流程如图3所示。

图3 超声波传感器信号处理程序流程

　　3.2 驱动控制

　　驱动控制模块是智能清洁机器人自主行为的执行机构。根据传感器信息判断当前环境状态，对不同的障碍物信息，控制器将调用不同的避障策略，策略与驱动控制的动作组合指令相对应，通过左右驱动电机动作的有效协作，实现机器人前进、后退、转弯等自主动作。单部电机的控制信号与电机动作之间的关系如表1所示，其中 P1.1和P1.2为电机方向控制信号端口，P1.3为PWM波调速端口，需要减速时只需要降低PWM波的占空比即可，理论上可以实现256级调速。

表1 控制信号与电机动作关系

　　3.3 避障算法描述

　　根据模糊控制思想并结合实际行走试验设计避障算法。以传感器系统9路传感器的检测距离和障碍物所在的方位为模糊控制输入量，以驱动轮的前进、旋转和后退动作为模糊控制输出量。超声波传感器检测最小距离设定为15cm，距离远；红外传感器检测距离为7cm，距离适中；接触传感器是在发生碰撞后才能检测到障碍物，因此检测距离最近。据此设距离信号(记作：D)的模糊语言集合为：