机器人行走机构的通用性设计.doc

机器人行走机构的通用性设计摘要：针对机器人比赛和电子设计竞赛中机器人寻线行走的普遍要求，提出了一种通用的寻线行走机器人的设计方法。机器人的核心控制器包括实现控制算法的DSP和用于扩展功能实现的CPLD；对来自光电检测传感器的信号采用模糊控制规则进行综合，核心控制器根据模糊控制器输出调整机器人的行走路线，最终实现机器人寻线行走。关键词：机器人DSP模糊控制光电检测寻线??? 在最近的机器人比赛和电子设计竞赛中，较多参赛题目要求机器人沿场地内白色或黑色指引线行进。一些研究人员提出了基于寻线的机器人设计策略，主要是关注指引线的检测，但对于机器人的整体设计未做说明。本文在总结此类赛事的基础上，提出了一种将DSP(Digital Signal Proces$or)和CPLDfComplex Programmable Logic Device)作为核心处理器，采用模糊控制策略处理来自检测指引线传感器信号的机器人行走机构的通用性设计方法。1 车体机械设计??? 由于机器人比赛对参赛机器人有严格的尺寸限制，需要在有限的空间内合理安排各个机构。本文给出车体最小尺寸时驱动轮、光电传感器以及控制芯片之间的相对位置，如图1所示。 ??? 机器人采用双直流步进电机驱动方式，其额定电压为24V。车体的前后端分别安装光电传感器检测板实现指引线的检测。相邻光电传感器距离略小于指引线宽度，保证同时有两个传感器可以检测到指引线。2 硬件电路设计??? 这部分主要介绍核心控制器。DSP与功能扩展芯片CPLD的连接，简要介绍其它功能模块的硬件实现。系统整体结构如图2所示。 2．1 核心控制器设计??? 稳压电路主要由LM7805芯片组成；信号输入电路由微动开关经反相器71HCl4后再送往DSP，微动开关输入电路有去耦电路，输出信号加上拉电阻；显示模块采用MAX7219芯片驱动，八位LED数码管，每个LED对应三个I／O端口。2．2 光电检谢模块 光电检测模块的功能是将指引线准确地检测出来。此处主要借助反射式光藕TCRT5000。这是一种自带发光二极管和光敏三极管的器件，其集电极电流如与反射距离d之间有图3所示关系。 ??? TCRT5000的应用电路见如4所示。当检测到绿色地面时，由于反射率不高，IC1太小，三极管T2截止而输出高电平。当检测到白色地面时，由于反射率较高，IC1较大，三极管T2饱和而输出低电平，从而实现了白线的检测。555构成了施密特触发器，用于去除反射性光耦产生的噪声和波形的整形。2.3 动作电机控制电路??? 在机器人寻线行走过程中，需要完成规定的动作。这些动作的完成不需要控制相应动作电机的转速，本文直接利用I/O输出控制信号驱动固态继电器进而使直流电机动作。固态继电器选用松下电器公司双刀双掷(DPDT)型，型号为DS2Y-S-DC5V。尽管此继电器控制电压为5V，可与TrL的逻辑电平相兼容，但一般TTL芯片的输出电流还达不到其输入电流40mA。集电极开路的门电路(Open Collector Gate，简称OC门)可增大输出电流，并且继电器两控制端的输入电阻刚好可以作为OC门电路输出需要的上拉电阻。具体选用具有OC门结构的芯片ULN2003，它是由7个NPN达林顿管组成的高电压、高电流达林顿驱动器。因为每个DS2Y-S-DC5V提供两组常开端口，因此如果在两组端口的N．0，端口上分别连上电机电源的正极和地。则可以用两个继电器实现电机的正反转。由于继电器在切换电压时，继电器线圈会产生大的反电动势，需要在继电器切换电压的两端加续流二极管，以消除切换时的电火花，避免出现大的浪涌电流，减少继电器产生的电磁干扰。 3 模糊控制策略??? 机器人的设计思想是利用光电检测传感器检测车体偏离指引线的大小来调整左右驱动步进电机的行进速度，使机器人沿指引线行进。这恰好符合模糊控制的思想。??? 根据隶属函数的定义和选取规则，输入变量前部位置iF和后部位置iB的隶属度选择相同，如图5所示。输出变量左轮转速OUL和右轮转速OUR的隶属度选择相同，如图6所示。 ??? 根据多次的实验和修正，得到如表2的左轮转速控制规则表(右轮的转速控制规则表内容与左轮的转速控制规则表对应，例如iF为RB、iB为LB时对应的OUL为NB，类似可得到右轮转速控制规则表)。模糊推理采用Mamdani法。反模糊化采用重心法，最终得到如表3所示的左轮转速控制信号输出表(右轮转速控制信号输出表可用类似于右轮转速控制规则表推导的方法得到)。在′F240存储空间中以表格的形式存储表3，根据输入可得到相应输出。 ??? 上述模糊信号的获取通过EPM7128用VHDL语言编程实现，此部分的编程相对简单，不再赘述。由于光电传感器信号的改