位置:51电子网 » 技术资料 » 测试测量

基于DSP和模糊控制的寻线行走机器人设计

发布时间:2008/6/3 0:00:00 访问次数:516

        

    

    

    来源:电子技术应用 作者:侯少云 曹卫华 吴敏 桂卫华 何艳丽

    

    摘要:针对机器人比赛和电子设计竞赛中机器人寻线行走的普遍要求,提出了一种通用的寻线行走机器人的设计方法。机器人的核心控制器包括实现控制算法的dsp和用于扩展功能实现的cpld;对来自光电检测传感器的信号采用模糊控制规则进行综合,核心控制器根据模糊控制器输出调整机器人的行走路线,最终实现机器人寻线行走。

    

    关键词:机器人dsp模糊控制光电检测寻线

    

    在最近的机器人比赛和电子设计竞赛中,较多参赛题目要求机器人沿场地内白色或黑色指引线行进。一些研究人员提出了基于寻线的机器人设计策略,主要是关注指引线的检测,但对于机器人的整体设计未做说明。本文在总结此类赛事的基础上,提出了一种将dsp(digital signal proces$or)和cpldfcomplex programmable logic device)作为核心处理器,采用模糊控制策略处理来自检测指引线传感器信号的机器人行走机构的通用性设计方法。

    

    1 车体机械设计

    由于机器人比赛对参赛机器人有严格的尺寸限制,需要在有限的空间内合理安排各个机构。本文给出车体最小尺寸时驱动轮、光电传感器以及控制芯片之间的相对位置,如图1所示。

    

    

    

    机器人采用双直流步进电机驱动方式,其额定电压为24v。车体的前后端分别安装光电传感器检测板实现指引线的检测。相邻光电传感器距离略小于指引线宽度,保证同时有两个传感器可以检测到指引线。

    

    2 硬件电路设计

    这部分主要介绍核心控制器。dsp与功能扩展芯片cpld的连接,简要介绍其它功能模块的硬件实现。系统整体结构如图2所示。

    

    

    2.1 核心控制器设计

    目前,机器人核心控制器多选用单片机。笔者考虑到单片机指令周期长、可用资源少,难以满足机器人实时控制的要求,在综合性价比、开发周期等因素后,核心控制器选用t1公司的电机数字控制专用dsp——tms320f240(以下简称’f240)。它具有运动控制非常有效的事件管理器,其中包括12路比较/pwm通道,可以非常方便地控制直流电机转速;利用其片内的3个可以工作于6种模式的16位通用定时器,可以完成机器人绝大部分动作的控制;16个10位a/d转换器可以方便地读取模拟信号。由于机器人指引线检测模块返回信号可看作反馈信号,因此机器人驱动电机选用步进电机。通过设置′f240定时器,利用i/o端口输出设定脉冲信号,该信号经步进电机驱动电路使步进电机行进设定距离。具体实现在软件设计部分介绍。′f240的其他片内i/o、pwm端口、a/d都引出输入输出线,方便扩展功能的实现。

    

    从′f240的特点可以看出,′f240可用于实现复杂控制算法和进行复杂的机器人动作控制。然而根据车体设计方案,需要在车体上安装20个光电检测传感器,占用控制器的20个i/o端口。这样,′f240可用于扩展功能的i/o端口大大减少。机器人在比赛中会有比较剧烈的撞击.如设计各种功能数字电路会严重降低控制板的可靠性。此处选用altem公司的epm7128作为核心处理器的扩展、模糊控制的输入。为满足dsp与cpld之间的协同处理,′f240与epm7128可采用如图2所示的电路连接。′f240的16根数据线和a12~a15共4根地址线连到epm7128,通过选择信号、写信号和读信号完成对epm7128的读写操作。epm7128的i/o端口主要在max+plusⅱ编程环境下通过软件和硬件管脚设置实现。这种dsp+cpld的结构可以在充分扩展系统功能的同时,使dsp更能发挥其运算功能强大的特点。

    

    稳压电路主要由lm7805芯片组成;信号输入电路由微动开关经反相器71hcl4后再送往dsp,微动开关输入电路有去耦电路,输出信号加上拉电阻;显示模块采用max7219芯片驱动,八位led数码管,每个led对应三个i/o端口。

    

    2.2 光电检谢模块

    光电检测模块的功能是将指引线准确地检测出来。此处主要借助反射式光藕tcrt5000。这是一种自带发光二极管和光敏三极管的

        

    

    

    来源:电子技术应用 作者:侯少云 曹卫华 吴敏 桂卫华 何艳丽

    

    摘要:针对机器人比赛和电子设计竞赛中机器人寻线行走的普遍要求,提出了一种通用的寻线行走机器人的设计方法。机器人的核心控制器包括实现控制算法的dsp和用于扩展功能实现的cpld;对来自光电检测传感器的信号采用模糊控制规则进行综合,核心控制器根据模糊控制器输出调整机器人的行走路线,最终实现机器人寻线行走。

    

    关键词:机器人dsp模糊控制光电检测寻线

    

    在最近的机器人比赛和电子设计竞赛中,较多参赛题目要求机器人沿场地内白色或黑色指引线行进。一些研究人员提出了基于寻线的机器人设计策略,主要是关注指引线的检测,但对于机器人的整体设计未做说明。本文在总结此类赛事的基础上,提出了一种将dsp(digital signal proces$or)和cpldfcomplex programmable logic device)作为核心处理器,采用模糊控制策略处理来自检测指引线传感器信号的机器人行走机构的通用性设计方法。

    

    1 车体机械设计

    由于机器人比赛对参赛机器人有严格的尺寸限制,需要在有限的空间内合理安排各个机构。本文给出车体最小尺寸时驱动轮、光电传感器以及控制芯片之间的相对位置,如图1所示。

    

    

    

    机器人采用双直流步进电机驱动方式,其额定电压为24v。车体的前后端分别安装光电传感器检测板实现指引线的检测。相邻光电传感器距离略小于指引线宽度,保证同时有两个传感器可以检测到指引线。

    

    2 硬件电路设计

    这部分主要介绍核心控制器。dsp与功能扩展芯片cpld的连接,简要介绍其它功能模块的硬件实现。系统整体结构如图2所示。

    

    

    2.1 核心控制器设计

    目前,机器人核心控制器多选用单片机。笔者考虑到单片机指令周期长、可用资源少,难以满足机器人实时控制的要求,在综合性价比、开发周期等因素后,核心控制器选用t1公司的电机数字控制专用dsp——tms320f240(以下简称’f240)。它具有运动控制非常有效的事件管理器,其中包括12路比较/pwm通道,可以非常方便地控制直流电机转速;利用其片内的3个可以工作于6种模式的16位通用定时器,可以完成机器人绝大部分动作的控制;16个10位a/d转换器可以方便地读取模拟信号。由于机器人指引线检测模块返回信号可看作反馈信号,因此机器人驱动电机选用步进电机。通过设置′f240定时器,利用i/o端口输出设定脉冲信号,该信号经步进电机驱动电路使步进电机行进设定距离。具体实现在软件设计部分介绍。′f240的其他片内i/o、pwm端口、a/d都引出输入输出线,方便扩展功能的实现。

    

    从′f240的特点可以看出,′f240可用于实现复杂控制算法和进行复杂的机器人动作控制。然而根据车体设计方案,需要在车体上安装20个光电检测传感器,占用控制器的20个i/o端口。这样,′f240可用于扩展功能的i/o端口大大减少。机器人在比赛中会有比较剧烈的撞击.如设计各种功能数字电路会严重降低控制板的可靠性。此处选用altem公司的epm7128作为核心处理器的扩展、模糊控制的输入。为满足dsp与cpld之间的协同处理,′f240与epm7128可采用如图2所示的电路连接。′f240的16根数据线和a12~a15共4根地址线连到epm7128,通过选择信号、写信号和读信号完成对epm7128的读写操作。epm7128的i/o端口主要在max+plusⅱ编程环境下通过软件和硬件管脚设置实现。这种dsp+cpld的结构可以在充分扩展系统功能的同时,使dsp更能发挥其运算功能强大的特点。

    

    稳压电路主要由lm7805芯片组成;信号输入电路由微动开关经反相器71hcl4后再送往dsp,微动开关输入电路有去耦电路,输出信号加上拉电阻;显示模块采用max7219芯片驱动,八位led数码管,每个led对应三个i/o端口。

    

    2.2 光电检谢模块

    光电检测模块的功能是将指引线准确地检测出来。此处主要借助反射式光藕tcrt5000。这是一种自带发光二极管和光敏三极管的

相关IC型号

热门点击

 

推荐技术资料

音频变压器DIY
    笔者在本刊今年第六期上着重介绍了“四夹三”音频变压器的... [详细]
版权所有:51dzw.COM
深圳服务热线:13751165337  13692101218
粤ICP备09112631号-6(miitbeian.gov.cn)
公网安备44030402000607
深圳市碧威特网络技术有限公司
付款方式


 复制成功!