《摘要针对机器人比赛和电子设计竞赛中机器人寻线行走的》由会员分享，可在线阅读，更多相关《摘要针对机器人比赛和电子设计竞赛中机器人寻线行走的（6页珍藏版）》请在装配图网上搜索。
1、 . . . 摘要：针对机器人比赛和电子设计竞赛中机器人寻线行走的普遍要求,提出了一种通用的寻线行走机器人的设计方法。机器人的核心控制器包括实现控制算法的DSP和用于扩展功能实现的CPLD；对来自光电检测传感器的信号采用模糊控制规则进行综合,核心控制器根据模糊控制器输出调整机器人的行走路线,最终实现机器人寻线行走。关键词：机器人DSP模糊控制光电检测寻线 在最近的机器人比赛和电子设计竞赛中,较多参赛题目要求机器人沿场地白色或黑色指引线行进。一些研究人员提出了基于寻线的机器人设计策略,主要是关注指引线的检测,但对于机器人的整体设计未做说明。本文在总结此类赛事的基础上,提出了一种将DSP和CPLD
2、fComplex Programmable Logic Device作为核心处理器,采用模糊控制策略处理来自检测指引线传感器信号的机器人行走机构的通用性设计方法。1 车体机械设计 由于机器人比赛对参赛机器人有严格的尺寸限制,需要在有限的空间合理安排各个机构。本文给出车体最小尺寸时驱动轮、光电传感器以及控制芯片之间的相对位置,如图1所示。 机器人采用双直流步进电机驱动方式,其额定电压为24V。车体的前后端分别安装光电传感器检测板实现指引线的检测。相邻光电传感器距离略小于指引线宽度,保证同时有两个传感器可以检测到指引线。2 硬件电路设计 这部分主要介绍核心控制器。DSP与功能扩展芯片CPLD的连接
3、,简要介绍其它功能模块的硬件实现。系统整体结构如图2所示。21 核心控制器设计 稳压电路主要由LM7805芯片组成；信号输入电路由微动开关经反相器71HCl4后再送往DSP,微动开关输入电路有去耦电路,输出信号加上拉电阻；显示模块采用MAX7219芯片驱动,八位LED数码管,每个LED对应三个IO端口。22 光电检模块光电检测模块的功能是将指引线准确地检测出来。此处主要借助反射式光藕TCRT5000。这是一种自带发光二极管和光敏三极管的器件,其集电极电流如与反射距离d之间有图3所示关系。 TCRT5000的应用电路见如4所示。当检测到绿色地面时,由于反射率不高,IC1太小,三极管T2截止而输出
4、高电平。当检测到白色地面时,由于反射率较高,IC1较大,三极管T2饱和而输出低电平,从而实现了白线的检测。555构成了施密特触发器,用于去除反射性光耦产生的噪声和波形的整形。2.3 动作电机控制电路 在机器人寻线行走过程中,需要完成规定的动作。这些动作的完成不需要控制相应动作电机的转速,本文直接利用I/O输出控制信号驱动固态继电器进而使直流电机动作。固态继电器选用松下电器公司双刀双掷型,型号为DS2Y-S-DC5V。尽管此继电器控制电压为5V,可与TrL的逻辑电平相兼容,但一般TTL芯片的输出电流还达不到其输入电流40mA。集电极开路的门电路可增大输出电流,并且继电器两控制端的输入电阻刚好可以
5、作为OC门电路输出需要的上拉电阻。具体选用具有OC门结构的芯片ULN2003,它是由7个NPN达林顿管组成的高电压、高电流达林顿驱动器。因为每个DS2Y-S-DC5V提供两组常开端口,因此如果在两组端口的N0,端口上分别连上电机电源的正极和地。则可以用两个继电器实现电机的正反转。由于继电器在切换电压时,继电器线圈会产生大的反电动势,需要在继电器切换电压的两端加续流二极管,以消除切换时的电火花,避免出现大的浪涌电流,减少继电器产生的电磁干扰。3 模糊控制策略 机器人的设计思想是利用光电检测传感器检测车体偏离指引线的大小来调整左右驱动步进电机的行进速度,使机器人沿指引线行进。这恰好符合模糊控制的思
6、想。 根据隶属函数的定义和选取规则,输入变量前部位置iF和后部位置iB的隶属度选择相同,如图5所示。输出变量左轮转速OUL和右轮转速OUR的隶属度选择相同,如图6所示。 根据多次的实验和修正,得到如表2的左轮转速控制规则表。模糊推理采用Mamdani法。反模糊化采用重心法,最终得到如表3所示的左轮转速控制信号输出表。在F240存储空间中以表格的形式存储表3,根据输入可得到相应输出。 上述模糊信号的获取通过EPM7128用VHDL语言编程实现,此部分的编程相对简单,不再赘述。由于光电传感器信号的改变可以实时反映在CPLD的输出上,F240只需定时读取此信号并做相应从处理即可。假设前光电检测板和后
7、光电检测板的信号分别保存在RE_CPLD字节的高半字节、低半字节中,若这两个信号大于lO则保持原数据不变,否则根据信号的大小计算此值在转速控制信号输出表中的偏移量： LDP #04hLACC #MATRIXL ADD ADDER_PS 其中#04h为保存转速表的页面,#MATRIXL为转速表起始地址在页面中的偏移量,ADDER_PS为查表值相对转速表起始地址的偏移量。若将查表得到的值变化后保存为控制步进电机转速的定时器的周期则可以实时改变步进电机的转速： LDP #04h LACC Ml_TlPR LDP #O0E8h SACL TlPR4 步进电机调速的实现步进电机是纯粹的数字控制电动机。它
8、将电脉冲信号转换成角位移,即给一个脉冲信号,电机转一定角度。步进电机控制器的输入端口有：VDD电机电源正极；GND电源地线；OPTO控制信号的公共阳极；DIR电机方向控制端；FREE脱机输入端；CP脉冲输入端。此处给DIR端加高电平,使机器人只向前行进,在程序中只需对CP端进行处理。 脉冲的产生通过控制IO端口的电平变化实现。在设定了定时中断的各种参数后,在定时器中断处理程序中使一个标志字不停地加1： LDP #04h LACC TESTl ADD #1 SACL TESTl 在主程序中可以设定行走距离,定时中断的时间间隔决定脉冲的频率,也即决定步进电机的运动速度： LDP #04h LACC TEST1 SUB #2000 BCND STOP,GT 其中,数值2000代表机器人行走的距离单位。利用模糊控制策略,改变控制两个步进电机的定时器定时周期的长短以及行进的距离,可以实现机器人的寻线行进。 在总结近期参加的机器人比赛和电子设计竞赛的基础上,针对机器人寻线行走的普遍要求,提出了一种基于DSP+CPLD和模糊控制策略的机器人实现方法。利用该方法设计的机器人参加了多种不同的机器人比赛,运行状况良好,取得了较理想的成绩,进而证实了此设计的有效性。6 / 6
摘要针对机器人比赛和电子设计竞赛中机器人寻线行走的
