《基于DSP的足球机器人运动控制系统设计.docx》由会员分享，可在线阅读，更多相关《基于DSP的足球机器人运动控制系统设计.docx（10页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、基于DSP的足球机器人运动控制系统设计张建福导语：通过对足球机器人的研究，本文对四轮足球机器人的控制系统进展了研究和设计。引言机器人足球的最初想法由UniversityofBritishColumbia,Canada的AlanMackworth教授于1992年度正式提出。他在OnSeeingRobots一文中以机器人足球为例，指出传统的机器人研究中存在的缺乏：DefiniteKnowledge,CompleteKnowledge,StaticEnvironment,DeterministicWorld,DiscreteSequentialActions.。随后，诸多学者和科技人员对机器人足球的
2、可行性及技术问题进展了研究。在一些实验室或者研究所之间也相继开展了小型的比赛。机器人足球是一个综合性的工程，它涉及诸多的传统理论和前沿技术。制造本身就集合了构造工程、电子电路、精细机械、仿生材料等多种技术，而计算机、自动控制、传感、无线通讯等技术那么是机器人可以运动和踢球所不可缺少的，多个机器人之间的配合更是涉及比拟复杂的关于多主体的协调、合作与策略等问题。在第15届国际人工智能结合大会上，由Kitano,Veloso和Tambe等来自美、日、瑞典的9位国际著名或者知名学者结合发表重要论文TheRoboCupsyntheticagentchallenge97，系统阐述了机器人足球的研究意义、目
3、的、阶段设想、近期主要内容和评价原那么。概括的讲，过去50年度中人工智能研究的主要问题是单主体静态可预测环境中的问题求解，其标准问题是国际象棋人机对抗赛；将来50年度中，人工智能的主要问题是多主体动态不可预测环境中的问题求解，其标准问题是足球的机机对抗赛和人机对抗赛。由此可见机器人足球具有重要的意义。运动控制器是挪动机器人的执行机构，对机器人的平稳运行起着重要作用。随着新的智能控制算法的不断涌现，挪动机器人正向着智能化方向开展，这就对运动控制系统性能提出了更高的要求。设计实现智能挪动机器人的控制系统，可以熟悉挪动机器人硬件和软件的开发，掌握挪动机器人的运动控制特性，为后续的挪动机器人的功能扩展
4、搭建一个可行、稳定的平台，而这个平台那么可以作为多种机器人开发的公共根底平台。实现智能挪动机器人控制系统的开发具有一定的现实意义，将为以后的挪动机器人开发奠定坚实的根底。1、足球机器人的系统原理组成RoboCup中型组比赛是由两支各有多个自主式足球机器人的球队在标准场地进展的比赛，自主式足球机器人系统如图1所示，场上的每个机器人都具有完全的自主才能，自身具有独立的传感器系统、决策系统和执行机构，机器人将各自搜集到的信息同本队的其它自主机器人沟通，通过机器人本体或者场外监控站上数据交融得到所需的信息，然后根据这些信息进展决策，并执行相应的动作。图1自主式足球机器人系统足球机器人系统分为下面几个局
5、部：1机器人小车子系统2视觉子系统3无线通讯子系统4机器人控制子系统5决策子系统上述五个子系统构成了大的闭环系统，如图2所示。决策系统的指令通过无线通讯系统发送给机器人小车系统，控制子系统根据指令控制机器人相应的运动，再由视觉子系统收集场地信息，反应给决策系统，完成闭环控制。图2足球机器人系统组成原理图机器人小车子系统是比赛的本体局部，其性能的好坏直接关系到比赛的结果。它设计的关键在于机器人的软硬件设计。视觉子系统是整个比赛的最终检测反应机构，它扮演机器人的眼睛。它的主要任务是利用摄像头实时收集比赛场地上的图像信息，通过图像卡处理并且区分这些图像，得到场地上运动物体(包括双方8个机器人和球)的
6、相关数据，主要是每个机器人的横坐标X、纵坐标Y和其方向角度，并且将这些数据传给主机，以供主机上的决策系统进展分析决策使用。无线通讯子系统的作用主要是完成决策指令的传输，将决策系统的结果发送给各个机器人，使其执行相关的动作。决策系统上接视觉子系统，下连通讯子系统，是整个智能系统的中心枢纽，是系统的大脑，它主要功能是根据图像系统提供的一系列的场景信息与及各种传感器信息，对本方机器人的运动做出最正确的决策，同时将机器人的运动指令通过无线通讯系统传给机器人。它的优劣关系到机器人的智能化程度和比赛的成败。控制系统是决策系统和机器人本体之间的联接局部，它是机器人运动的核心处理局部，假如决策系统是教练，那控
7、制系统就是队员的本领，它的好坏关系到机器人表达决策系统指令的好坏。它的作用就是根据一定的算法来解析决策系统的指令将它转化为详细的机器人的运动指令，并且控制机器人实现相应运动。2、足球机器人控制电路系统构造RoboCup小型组足球机器人在场上是实时、高速、高对抗的为了知足比赛要求，足球机器人控制电路系统必须具备以下功能： (1)MCU运算速度高，可以执行运算量大的控制算法，方便扩展各种接口电路； (2)能配合无线通讯模块实现波特率115200bps的无线信号接收； (3)可以以脉宽调制的方式驱动四路驱动轮电机； (4)可以处理四路以上的正交码盘信号、检测各驱动电机电枢电流信号盘来实时地对四组驱动
8、轮进展准确的闭环速度控制； (5)对机器人供电电池组进展DC-DC升压变换至200v，用以驱动踢球电磁铁高速击出球； (6)使用多路红外传感器和加速度计来感悟机器人状态。通过对足球电路系统功能和性能特点的分析，综合足球机器人体积和电源等方面的要求，我们将电路系统各种功能大胆交融、进展优化，提出本文所述的设计方案。电路系统是作为整体进展设计和优化的，可划分为以下几个功能模块：MCU模块。该模块的核心为采用主从工作形式的双DSP。MCU模块可配合无线通讯模块接收上位机(PC)发送的无线通讯信号，根据接收到的指令和自身传感器信息完成对机器人的实时控制。驱动电路模块。该模块在MCU模块的控制下，以脉宽
9、调制的方式对机器人驱动电机进展实时调速控制。DC-DC升压电路模块。足球机器人使用可充电镍氢电池组供电，电源变换模块将电压升高到DC200v，储存到大容量的电容中，作为击球电磁铁的电源。传感器电路模块。该模块使用红外发光管和红外接收管来探测机器人是否带到球和周围障碍物与机器人的间隔。足球机器人电路系统构成框图如图3所示：图3足球机器人电路系统框图3、MCU模块设计机器人控制MCU需要完成机器人速度轨迹跟随控制算法，还需要接收指令、处理多路传感器信号等。由于这些处理所需要的运算量相比照较庞大，而且需要使用大量的控制接口，所以一些传统的简单运算芯片(如8051等)和单片机无法知足我们的需求，我们采
10、用运算才能相对强大的DSP芯片。系统采用TI的DSP芯片TMS320LF2407A，它属于TI工公司DSP中专门用于电机控制的TMS320LF240X系列中的一种。它是TI在以TMS320C2xLP系列为内部运算核心的根底上，整和了丰富的外围控制电路和接口而形成的一类面向电机控制特殊片种。它具有以下一些优点：运算速度快、运算精度高；体积小、功耗低；指令系统功能强大、高效；存储空间大、扩展简便；片内外设丰富、接口简单；带有多个事件管理器方便对电机进展控制。TMS320LF2407A的详细参数为：最高内部频率为40MHz，时钟周期为25ns，具有40MIPS的处理才能；32K内部FLASH为，可加
11、密；两个事件管理器(EventManagers)，每个EM包括：两个16位时钟；8个通道的脉宽调制(PWM)单元；三个事件捕获单元(Cap)；10位AD转换器，16通道，375-500ns的转换时间；CAN20、异步串行口(SCI)、同步串行口(SPI)；40个管脚可用作通用10。4、DC-DC升压电路模块设计机器人在比赛中需要踢球，也就是将一个重量为46克的高尔夫球击出，所以需要设计一个击球系统，并要求将球击出的初速度最高到达5m/s并可以控制。经过分析和实验，使用200v以上的直流电压来驱动电磁铁可以使得机器人踢球的最大速度到达5m/s。这就需要设计DC-DC升压电路将10v的机器人电池电
12、压变换成200v以上。利用开关电源的原理，设计升压电路如图4所示：图4DC-DC升压电路模块原理图大功率MOS管是一个电子开关，PWM发电器发出的PWM波控制它的导通和关断。当MOS管导通时，电源与电感组成一个回路。此经过中，回路电流线性上升，电源将能量储存到电感线圈中。当MOS管关断时，电源电感与储能电容组成回路。此经过中，电感会因为电流下降而产生感应电压，该电压与电源电压叠加给储能电容冲电。这样储能电容两端就可以得到远高于电源电压的电压。PWM发生器发出的PWM波控制MOS管以3.6KHz高速地导通和关断，该升压电路就能不断的给储能电容充电。当储能电容中的电压到达我们预先设定的电压时，PW
13、M发生器停顿工作，充电电路停顿给储能电容充电。假如储能电容因为驱动电磁铁等原因造成电压下降，就会触发PWM发生器。PWM发生器将重新开场工作，给储能电容充电。通过这样的经过，就可以把储能电容中的电压维持在设定的电压上。5、软件设计机器人的控制系统采用双DSP的形式，降低了硬件系统的复杂度。但是，同时主、从DSP之间的耦合度较高，主、从DSP之间需要进展大量的数据交换、管理、及握手信号。这样就给DSP内的软件提出了要求。下面来介绍在主、从DSP的软件设计，讲明是怎样实现各种功能的。足球机器人的速度轨迹控制是一个重要的研究对象，因此需要执行速度轨迹控制算法的DSP中的程序可以很方便的改变。主DSP
14、对从DSP进展管理，上位机可以通过发送控制指令给主DSP，由主DSP来管理从DSP的控制算法程序。这样从DSP上的控制程序的执行就有了更大的灵敏性。无线模块接收的指令经过主DSP的接收和校验后，通过SCI发送从DSP。从DSP需要主DSP读取两组正交码盘信号的时候，主DSP也是通过SCI发送给从DSP的。也就是讲经过校验的指令和码盘信号都是通过同一个通道传送的。因此需要采用一定的机制来解决。实际设计中，使用了两个IO作为握手信号，主DSP根据握手信号发送不同的数据。两组数据都是通过封装好的帧的形式发送的，它们具有不同的数据头，从DSP通过数据头来判断接收的是指令还是码盘信号，进而将承受到的数据存储到不同的存放器中。两个IO可以表示四组状态，握手信号状态表如表1所示：表1SCI传输握手信号状态表