足球机器人控制系统设计.doc

安徽建筑工业学院毕 业 设 计 （论 文）课 题： 足球机器人的控制系统设计 专 业： 机械设计制造及其自动化 班 级： 08机械1班 学生姓名： 肖后昆 学 号： 08210010143 指导教师： 李辉 2012 年6月1日摘要机器人足球和足球机器人是近几年在国际上迅速开展起来得高技术对抗活动。本文以机器人世界杯为背景，采用数字信号处理器(DSP)作为核心芯片，研究足球机器人的控制系统设计以及相应的控制算法应用。通过研究足球机器人的运动特性及控制，能为将来进一步探讨例如机器人路径规划、人工智能及多机器人合作等研究打下基础。本文首先介绍了足球机器人的兴起，足球机器人的现状及其意义。接着讨论了足球机器人的体系结构，机器人比赛的系统的组成，工作模式及系统结构，然后简要介绍了足球机器人的比赛的要求，并在最后讨论了控制的对象即我们设计的足球机器人的机电系统结构，包括所选用的电机及其各种运动结构的设计。第三 、四、五章是本文的核心部分，第三章讲述了关于机器人控制系统的硬件电路设计。首先根据控制要求分析系统所需的硬件结构，然后针对每一部分进行电路设计分析。第四章是关于控制系统的软件策略。首先根据系统的控制求介绍了软件控制的总体思想与机构，然后分析机器人的动力学和运动学模型，在建立模型的基础上阐述算法的应用。第五章是关于足球机器人的决策子系统的体系结构及其模型的建立。关键词：足球机器人、TMS320LF2407、运动控制、建模、决策子系统ABSTRACTSoccer robots and RoboCup are the high technology activities in recent years that have attracted wide concerns among many countries. Based on RoboCup，this paper deal with the design and research of control system of robot by using a new core CPU (DSP). The main concerns of this paper are soccer robots and I hope with the design of soccer robots, some research on their locomotive properties and control systems, this could build up solid foundation for further research in such areas as Mobile Robot Path Planning, Artificial Intelligence and Multi-Agent Collaborative Behavior.Having introduced the rise of the soccer robot at first, current situation and meaning of the soccer robot. the impact of medium-sized group of robot competition system, the working model and system architecture, and then briefly introduced robot soccer competition requirements, and discussed in the final control of the object that we design the mechanical and electrical soccer robot system architecture, including the selection of the motor and the design of the structure of a wide variety of sports.Chapter three , four and five is mainly concerned. Chapter three is concenred with the hard ware design of control system. It firstly analyzes the hard ware structures and then there are detailed design and analysis on each structure. Chapter four deal with software strategies. Firstly it discusses he software structures according to the system requirements, and then it analyzes Dynamic Model and Movement Model，It analyzes use of some control arithmetic.The fifth chapter is on the soccer robot decision-making subsystem architecture modelKey words: Soccer robot、TMS320LF2407、Motion control、Modeling、Decision subsystem摘要2ABSTRACT3第一章 绪论51.1 足球机器人的简介51.2.1 RoboCup中型组足球机器人研究现状81.2.2 RoboCup中型组足球机器人研究意义91.4本章小结10第二章 足球机器人的体系结构102.1机器人足球的系统原理组成112.2足球机器人的系统工作模式132.3足球机器人的系统结构组成142.4足球机器人的技术要求152.5足球机器人机电结构系统17第三章 足球机器人控制系统硬件设计213.1控制系统的硬件电路的组成结构213.2.1 TMS320LF2407的简介223.2.2基于TMS320LF2407的主控系统设计233.3电机驱动电路设计253.3.1直流电机调速控制原理253.3.2直流电机驱动设计263.4传感器电路设计283.4.1加速度传感器电路设计283.4.2近红外探测传感器的电路设计31第四章 足球机器人的控制对象建模344.1控制系统的具体要求344.2足球机器人的动力学建模354.3足球机器人的运动学建模39第五章中型足球机器人决策子系统分析与设计435.1 决策子系统分析435.1.1 决策子系统的任务435.1.2 决策子系统的特点455.2 决策子系统的体系结构455.2.1 决策子系统模型465.2.2 自上而下的分层递阶决策推理模型47第六章 总结与展望516.1 总结516.2 对今后工作的展望52参考文献53致 谢55附录一 英文科技文献翻译56附录二 毕业设计任务书66第一章 绪论1.1 足球机器人的简介一、起源 机器人足球的最初想法由 University of British Columbia, Canada 的 Alan Mackworth 教授于1992年正式提出。 他在 On Seeing Robots 一文中以机器人足球为例，指出传统的机器人研究中存在的不足：Definite Knowledge, Complete Knowledge, Static Environment, Deterministic World, Discrete Sequential Actions. 为解决这些不足，他和同事提出了一种新的机器人体系 - Situated Agents ，并实际设计了踢足球的机器人（见下图）。他们指出：1-1 踢足球的机器人随后，众多学者和科技人员对机器人足球的可行性及技术问题进行了研究。在一些实验室或研究所之间也相继开展了小型的比赛。 二、世界性比赛 目前许多国家都开展了机器人足球比赛。在世界上比较有影响的比赛主要有两个： FIRA （Federation of International Robot-soccer Association 国际机器人足球联合会）1995年，韩国的 Jong-Hwan Kim 教授提出设想1996年11月在韩国举行了第一届赛事1997年正式成立了FIRARoboCup （The Robot World Cup Soccer Games and Conferences 机器人足球世界杯赛及学术大会） 1993年，日本的 Minoru Asada 等学者创办了RoboCup1997年8月，在日本举行了第一届 RoboCup 赛事。三、机器人足球赛的主要类型及规则 机器人足球有仿真赛和实物赛两种。仿真赛是在计算机上进行的虚拟比赛。由比赛举办方提供仿真平台，参赛双方用各自开发的程序控制“运动员”进行比赛。 实物赛是由实际的机器人在指定的场地上进行的比赛，以下的分类都是对实物赛而言的。 从机器人的自主性方面看，有半自主型和全自主型。半自主型机器人比赛中，允许参赛方用一台主机对机器人进行集中控制；全自主型中的机器人则是完全独立的， 机器人只能依靠自身的设备去获取信息、做出判断、配合队友及实施行动。 从机器人的行走方式看，有轮式和足式。轮式机器人靠轮子行走的，早期的机器人足球都是这种型式的；足式机器人用脚行走，又可分为多足和两足机器人。1999年，RoboCup 首次开展四足机器人足球比赛。完全类似人的两足机器人足球是机器人足球比赛的最高目标，但其涉及较为复杂的技术，目前还只是在足球赛上进行行走、避障碍、点球等表演，还不能真正进行足球比赛。 发展至今，机器人足球比赛已经拥有一整套规范和规则，诸如对球场、球、机器人的尺寸规定，对角球、界外球、任意球、点球等的定义，对球员犯规的判罚等 。 机器人足球比赛每个半场一般只有十几分钟。由于目前机器人的视觉系统主要依靠色彩信息对物体进行识别，所以球场内外各设备和器材的颜色都有比较严格的规定，参赛双方的机器人也必须贴上醒目的颜色标识。 主机与机器人或机器人与机器人之间靠无线电进行通讯，所以对无线电的使用也有相应规定。 四、机器人足球的相关技术 机器人足球是一个综合性的项目，它涉及众多的传统理论和前沿技术。 机器人制造本身就集合了结构工程、电子电路、精密机械、仿生材料等多种技术，而计算机、自动控制、传感、无线通讯等技术则是机器人能够运动和踢球所不可缺少的， 多个机器人之间的配合更是涉及比较复杂的关于多主体的协调、合作与策略等问题。 五、机器人足球的意义和目标 在第15届国际人工智能联合大会上，由Kitano, Veloso和Tambe等来自美、日、瑞典的9位国际著名或知名学者联合发表重要论文"The RoboCup synthetic agent challenge 97"， 系统阐述了机器人足球的研究意义、目标、阶段设想、近期主要内容和评价原则。概括的说，过去50年中人工智能研究的主要问题是“单主体静态可预测环境中的问题求解”，其标准问题是国际象棋人机对抗赛； 未来50年中，人工智能的主要问题是“多主体动态不可预测环境中的问题求解”，其标准问题是足球的机机对抗赛和人机对抗赛。由此可见机器人足球具有重要的意义。 机器人足球是人工智能的新兴研究领域，是联系理论与应用的一个有效手段。它以体育竞赛为载体，集中展示了各国高新科技的发展，并且检验了参赛国的技术水平， 从而促进科技的发展和人才的培养。 机器人足球的最终目标是建立仿人机器人足球队，让机器人像人一样踢足球，甚至打败人类足球队。实现这一目标将是一个艰巨而漫长的过程。 六、中国机器人足球的发展情况 目前机器人足球发展比较好的国家有欧美、日韩、澳大利亚等国家和地区。中国在这方面虽然起步较晚，但近年来有较大的发展。 2001年6月，中国自动化学会机器人竞赛工作委员会 成立，每年举办包括 RoboCup 和 FIRA 两个项目在内的中国机器人足球比赛。 1.2 Robocup中型组足球机器人在RoboCup 中型组比赛中，机器人要求具有全自主行为，每个队员是一个独立的主体，即感知、行为、决策、通讯等都由机器人自身完成，所有功能都集中在机器人内部。 RoboCup 中型组足球机器人的结构从功能上可以分为四个子系统：感知系统、决策系统、执行系统、通讯系统。感知系统通过传感器实时采集比赛信息，经处理得到敌方机器人、己方机器人、球、球门的识别和定位信息。对应的信息送到决策系统，由决策系统根据比赛场上情况和策略产生相应的控制指令；控制指令是指对执行系统电机的具体控制命令，从而驱动电机的运动。机器人可以通过无线通讯系统与其他机器人进行信息的交换。1.2.1 RoboCup中型组足球机器人研究现状我国对自主式足球机器人的研究起步较晚，多年以来，仅有上海交通大学、中科院自动化所、同济大学等少数几个单位从事自主式足球机器人的研究。2003年以来，东北大学、华南理工大学等一批单位陆续开始参与这个项目的研究，近两年参赛队伍明显增加。2004年有9支队伍参加“广州理想杯”中国足球机器人大赛中型组比赛，2005年8月参加“新科导航杯”中国机器人大赛中型组比赛的队伍剧增到21支。在参赛队伍数量增多的同时，比赛的整体水平也在不断提高。2004年之前，中国足球机器人大赛中型组只有1：1和2：2两个比赛项目，2005年的比赛整体升级，设立了2：2和4：4两个项目，同时为了与国际接轨，比赛采用就是当年国际比赛的规则。客观地说，国内自主式足球机器人的研究水平和国外先进水平相比还是有较大差距的，这既是压力也是动力，中国的足球机器人研究者正在加倍努力、奋起直追。我国在这个项目上的研究已呈现出蓬勃发展的趋势，相信在不久的将来，一定会有中国的队伍在RoboCup中型组比赛中取得优异成绩。1.2.2 RoboCup中型组足球机器人研究意义RoboCup 中型组足球机器人比赛是近几年国内外新兴的一个组别,它要求多个机器人在完全自主的状态下完成控球,传球, 配合,射门等动作,相当于一个分布式多智能体控制系统。其中需要解决的关键问题包括：图像采集以及信号处理、路径规划、无线通讯、控制决策、多传感器信息融合等技术。因此,中型组机器人足球比赛最具挑战性,也最能体现研究单位的科研实力。对智能足球机器人的研究成果可广泛用于军事、民用等众多领域。1.3 论文的主要内容 中型自主足球机器人赛在Robdcup国际足球机器人世界杯具有重要地位，中型自主足球机器人要求控制系统感应灵敏、响应速度准确、重量轻、体积小。本课题主要是研究设计一种Robocup中型足球机器人控制系统，着重从电路设计方面提高其感应灵敏性，响应迅速性。1.4本章小结足球机器人是人工智能的新兴领域，是联系理论和实际应用的一个有效手段，它以体育竞赛为载体，集中展示了各国高科技的发展，并且检验了参赛国的技术水平，从而促进科技的发展和人才的培养。目前足球机器人发展比较好的国家有欧美，日韩等，中国在这方面虽然起步比较晚，但今年来有较大的发展。世界上比较有影响的比赛主要有两个FIRA和RoboCup，其中RoboCup的最终目标是建立仿人机器人足球队，让机器人像人一样踢足球，甚至打败人类足球队。实现这一目标将是一个艰巨而漫长的过程。 第二章 足球机器人的体系结构足球机器人是机器人足球系统中的本体部分，一切控制策略及算法最终都是通过足球机器人来实现的。所以中型组足球机器人的本体设计对比赛起了至关重要的作用。不同的控制要求决定了不同机器人的结构设计和控制策略。所以本章首先讨论机器人足球赛中型组比赛的系统组成、工作模式及系统结构。然后简要 足球机器人的比赛的要求。图2-1足球机器人比赛场景2.1机器人足球的系统原理组成RoboCup中型组比赛是由两支各有多个自主式足球机器人的球队在标准场地进行的比赛，自主式足球机器人系统如图2-2所示，场上的每个机器人都具有完全的自主能力，自身具有独立的传感器系统、决策系统以及执行机构，机器人将各自搜集到的信息同本队的其它自主机器人沟通，通过机器人本体或场外监控站上数据融合得到所需的信息，然后根据这些信息进行决策，并执行相应的动作。图2-2 自主式足球机器人系统足球机器人系统分为下面几个部分： 1）机器人小车子系统 2）视觉子系统 3）无线通讯子系统 4）机器人控制子系统 5）决策子系统上述五个子系统构成了大的闭环系统，如图2-3所示。决策系统的指令通过无线通讯系统发送给机器人小车系统，控制子系统根据指令控制机器人相应的运动，再由视觉子系统采集场地信息，反馈给决策系统，完成闭环控制。 下面分别简要介绍各部分的组成以及系统对各部分的设计要求。无线通讯子系统视觉子系统机器人小车子系统控制子系统决策子系统图2-3 足球机器人系统组成原理图机器人小车子系统是比赛的本体部分，其性能的好坏直接关系到比赛的结果。它设计的关键在于机器人的软硬件设计。视觉子系统是整个比赛的最终检测反馈机构，它扮演机器人的“眼睛”。它的主要任务是利用摄像头实时采集比赛场地上的图像信息，通过图像卡处理并且辨别这些图像，得到场地上运动物体(包括双方8个机器人和球)的相关数据，主要是每个机器人的横坐标X、纵坐标Y和其方向角度，并且将这些数据传给主机，以供主机上的决策系统进行分析决策使用。无线通讯子系统的作用主要是完成决策指令的传输，将决策系统的结果发送给各个机器人，使其执行相关的动作。决策系统上接视觉子系统，下连通讯子系统，是整个智能系统的中心枢纽，是系统的“大脑”，它主要功能是根据图像系统提供的一系列的场景信息与及各种传感器信息，对本方机器人的运动做出最佳的决策，同时将机器人的运动指令通过无线通讯系统传给机器人。它的优劣关系到机器人的智能化水平以及比赛的成败。控制系统是决策系统和机器人本体之间的联接部分，它是机器人运动的核心处理部分，如果决策系统是教练，那控制系统就是队员的本领，它的好坏关系到机器人体现决策系统指令的好坏。它的作用就是根据一定的算法来解析决策系统的指令将它转化为具体的机器人的运动指令，并且控制机器人实现相应运动。2.2足球机器人的系统工作模式明白了足球机器人的系统组成，对于我们来说，选择合适的硬件和软件系统还得考虑机器人系统的整体工作模式。根据机器人的决策部分在整个系统的作用位置，可以将足球机器人系统工作模式分为以下两种：(i)基于视觉的足球机器人系统 (Vision-Based Mobile Robot System)；(ii)基于机器人的足球机器人系统(Robot-Based Mobile Robot System)，而根据机器人智能程度，(i)又可以分为：基于视觉遥控的无智能足球机器人系统(Remote Brainless Vision-Based Mobile Robot System)，简称遥控机器人； 基于视觉智能足球机器人系统(Brain On-board Vision-Based Mobile Robot System)；这样就可以得到三种足球机器人的系统工作模式：第一种基于视觉遥控的无智能足球机器人系统，它所有的视觉处理、策略决策和位置控制都在主机上完成，就像遥控小车一样。第二种基于视觉智能足球机器人系统，这个时候机器人本体具有速度控制、位置控制和自动避障等功能。主机仅通过视觉数据来进行决策处理，然后发出命令给各个机器人，机器人在根据命令做出行动反应，为了实现自动避障和速度控制，机器人上面都装有红外、加速度等传感器。第三种基于机器人的足球机器人系统，这时足球机器人具有很多自主性，所有的计算包括决策、控制都在机器人上面完成，而主机只处理视觉数据，然后将有关信息传给机器人。这个时候视觉系统就类似于一种传感器。不过，任何一种模式的机器人都应该具备一些基本模块：驱动模块、通讯模块和CPU控制模块。不过采用的模式不同，其设计方案都不同而已。本文系统的设计就是基于第二种模式(即基于视觉智能机器人系统)来设计的。2.3足球机器人的系统结构组成有了前面的足球机器人系统的组成，而最终要实现整个系统的运行还要硬件来实现。系统的硬件方面包括以下几个方面：足球机器人小车系统、无线通讯系统、视觉系统和通讯系统。下面讨论一下系统的硬件组成，以方便后面控制平台硬件系统的设计。1足球机器人小车系统一般来说，足球机器人小车包括CPU模块、电机驱动模块、无线通讯接收模块和传感器模块。而这除了无线通讯接收模块外都属于控制平台的硬件系统。运动电机通常都是单独驱动，大部分都采用轮式结构，也有采用履带结构的。为了得到足球机器人更好的运动特性，我们采用的是四轮设计，可以实现全向运动的全方位机器人。2.无线通讯系统对机器人指令传送采用的是无线数字通讯。主机的信息经过RS-232由发射模块发送出去，而由机器人上面的接受模块接收数据。在比赛规则中以不妨碍对方的前提下，双方的频率大小不加以限制。采用的通讯模块是英国的Radiometrix，它具有433MHZ/418 MHZ两个频段。3.视觉系统视觉系统主要由摄像头、图像采集卡等硬件设备和处理软件组成。在比赛中，规定每方机器人采用黄色或者蓝色作为自己的队标，队标规定采用直径为 40mm的圆，贴在机器人的上方的中央部分。而机器人的号码识别所采用的色彩不加以限制。它的主要功能就是完成图像信息的采集与分析功能。4.主机系统为了提高系统的计算速度，主机系统一般采用一台P4的计算机，不过也有的队伍采用双CPU的计算机。主机的功能主要是处理经过处理的图像数据，得出球和队员的位置、方向和速度，根据比赛场上的攻守局势，做出决策，并且将数据通过串口传给发射器。2.4足球机器人的技术要求足球机器人小车在整个足球机器人系统中相当于执行机构，但它的作用又不仅限与此。从比赛的角度来说。它是上场比赛的队员；从表演的角度来说，它又是登台表演的演员。导演的创作艺术或者教练的战术意图最终都是通过机器人来实现。所有机器人本体整体性能的好坏对整个系统都起着举足轻重的作用。设计机器人本体应该满足以下的技术要求：1.大小要求RoboCup中型机器人组的场地大小相当于9个兵乓球台，机器人的直径不超过50cm，高度在30cm-80cm之间，每个队由4台机器人组成，采用橙色足球进行对抗比赛。 图2-4 RoboCup中型组比赛场地示意图 中型组比赛场地是一个结构化、彩色化的环境，如图2-4所示。结构化是指场地上的固定物体或标识都有比较规则的几何形状：球门由三个平面构成，角柱是一个圆柱体，场地标识线由直线、圆、圆弧构成。同样，彩色化指场地上的每个物体都对应一种颜色或颜色的组合：球场底色为绿色，一方球门为蓝色，另一方为黄色，角柱中间三分之一为对方球门颜色、场地标识线为白色，比赛用球为橙红色的5号标准足球，机器人主体为黑色。 2.基本功能 总体来讲，足球机器人应能准确接收主机指令并迅速做出反应，完成带球、传球、拦截、射门、防守等技术动作。因此机器人应该具备了以下功能：无线信号的接受、电机驱动及其调速、障碍识别与避障还有就是对机器人各部分功能的控制以及上述功能的协同。3.运动性能为适应激烈对抗的比赛环境，机器人还应具备高度的机动性能和灵活性，能平稳快速的完成各种前进、后退、转向及急停等基本动作，且满足以下要求： 1）前进后退：尽量走直线 2）转向：转弯半径尽量小 3）急停/碰撞：不能翻倒为满足上述要求，机器人要求总体质量轻，重心低，尽量处在机器人对称轴线上，运动系统灵活、可靠，系统转动惯量小，连接部件牢固、防松，整体刚性好，具备良好的撞击性能。4.其它性能 比赛中机器人之间的顶牛现象经常发生，所有要求机器人具有良好的坚固性，一旦碰撞时，机器人不能变形，各种接插件不能松动，零部件不能脱落。同时应该避免顶牛时候，电路元器件不能烧毁。由于比赛时候的工作环境毕竟恶劣，有许多来自外面的干扰，所以机器人的结构以及控制系统的设计都应该具有高可靠性，在强干扰下不死机或者失控。对于足球机器人而己，可维护性是很重要的，包括软件和硬件的维护，在硬件结构的设计方面，考虑便于安装测试和检修；软件设计上面要便于调试、纠错和升级。同时经济性也是在设计中必须考虑的问题。2.5足球机器人机电结构系统 整个足球机器人硬件系统设计包括两个方面：控制系统设计和机电系统设计。所有在进行机器人控制系统设计前，必须对它的控制对象足球机器人的机电系统设计阐述清楚，这样以便于后面的控制系统的选型和控制电路设计。机电系统设计包括控制电机选型及性能参数、机器人底盘选型和设计，由于机电系统的设计不是本文的重点，所以这里概要阐述一下足球机器人的机电系统的结构。机器人的运动离不开电机的选择，对于移动小机器人的控制电机，均选用微电机，其有直流电机和步进电机两种选择。我们在充分考虑步进电机与直流电机的优缺点的时候，最后选用的是调速性能优良、调速方便、平滑范围广的直流电机。根据电机转矩、功率损耗、转速和外形尺寸，经过我们的设计计算，最后我们采用的是瑞士的Maxon电机。根据上面机器人设计要求，为了实现各种基本功能，所以我们设计的足球机器人主体结构主要由机体、行走机构、带球机构、击球机构和各种传感器组成。为了获得良好的机动性和灵活性，我们设计的足球机器人的行走机构采用的三轮式驱动机构，三个车轮互呈120，分布在同一个圆周上面，如图2-6。每个车轮分别由直流伺服电机(主动电机)、齿轮减速器、码盘和车轮等零部件组成，同时每个车轮都采用全方位轮。全方位轮的机构是圆形大轮的圆周上密布小滚动轮子，车轮可以沿周向和轴向两个方向作滚动运动。，这样无论直线移动，还是转弯，总以滚动代替滑动，大大减少摩擦力。采用这样的机构可以很方便地实现任何方向地直线运动 图2-6 足球机器人的行走机构和全方位轮击球机构设计主要考虑蓄能和瞬间释放机构，弹簧应为首选方案。已设计的击球机构主要由电机，蜗杆，蜗轮，扇形齿轮，齿条击杆，压缩弹簧，击球板等组成。其设计思路为：不击球时弹簧始终处于压缩状态，击球时，控制信号让电机转动，带动蜗杆蜗轮，与蜗轮共轴的扇形齿轮与齿条脱离啮合，弹簧力推动击杆击球，当扇形齿轮与齿条重新进入啮合，击杆回收，当扇形齿轮转过一定的角度时，击杆回收到位，控制信号让电机停转，依靠蜗杆蜗轮自锁性，保持击杆处于回收状态。如图2-7。 图2-7 足球机器人的击球机构带球就是需要球和机器人粘在一起，机器人在比赛过程中往往需要带球运行，寻找最佳射门点或传球点，所以带球机构是足球机器人中又一个不可缺少的关键机构。机器人能够实现在前进，转弯，后退等运行状态下带球是带球机构所要达到的目标。根据RoboCup比赛规则：机器人持球的时候，从上往下看必须有80%的球的面积在控球装置外面，所以不能采用抱球的机构。我们从运动学角度出发，利用相对运动关系设计了我们的带球机构，如图2-8。其关键设计思想为：机器人在前进，转弯，后退的运动中对球产生一个驱动力或力矩，使球产生相应的运动，并使球始终保持与机器人在一起，为此运动过程中，需要两者速度满足匹配关系。 图2-8 足球机器人的带球机构 根据以上设计思路我们设计了由电机，齿轮及带传动机构，滚轮，支架等组成的带球机构。在机构设计中，关键是使球产生相对机器人运动结构，用一个具有一定弹性的滚轮与小球发生滚动式接触，靠摩擦力产生的转矩带动球在地面产生朝向机器人的滚动。这里设计的重点是弹性滚轮与球之间的摩擦力以及滚轮转速，最终作用效果为球心的水平运动速度。除了击球、带球功能外，在机器人车体上同时安装了六路近距离红外传感器，如图2-9所示。6是正前方传感器，4是正后方传感器，3, 5是另外两主运动方向的传感器，1, 2是击球和控球动作中找球传感器，位于机器人正前下方。目的就是为了保证机器人的击球机构击球的准确性和带球机构能够顺利带球以及在运动过程中实现自动避障。同时为了能够更好的控制机器人的运动，在机器人上面安装加速度传感器，来实时检测系统的运动速度。图2-9 足球机器人传感器2.6本章小结本章主要对足球机器人的体系结构做了系统设计,主要包括以下内容：（1）足球机器人的系统原理组成，通过机器人小车子系统、视觉子系统、无线通讯子系统、机器人的控制子系统及决策子系统组成构成了大的闭环系统。（2）足球机器人的系统工作模式，根据机器人的决策部分在整个系统作用位置来决定，本文设计的是用基于视觉智能机器人系统来设计的。 (3)足球机器人控制系统总体结构分为两个：决策控制和运动控制。 (4)足球机器人的系统结构组成包括无线通讯子系统、决策子系统、视觉子系统、机器人车体子系统等组成。(5)机器人总体结构结构设计包括：尺寸限制、功能要求运动功能等(6)机电机构设计，驱动机构、带球机构、击球机构。第三章 足球机器人控制系统硬件设计了解了足球机器人的体系结构，在分析完足球机器人的机电机构后，现在来进行控制系统的设计，它是本论文的核心部分。本章首先根据控制对象的控制要求来分析系统所需要的硬件结构，然后针对每一部分进行详细的电路设计分析。3.1控制系统的硬件电路的组成结构前面谈到了足球机器人的系统结构，它主要包括CPU模块、无线通讯接收模块和传感器模块。但是在实际当中要实现以CPU电机驱动模块为核心的控制系统设计时候，CPU模块每个模块都要进行相应的扩展，从而来实现具体的控制系统。CPU模块：CPU+时钟复位电路+外围扩展电路等等；电机驱动模块：电机控制回路+电机驱动放大回路+电机反馈回路；无线通讯接收模块：无线通讯信号的接受+通讯的接口，主要是和核心CPU连接部分；传感器模块：红外传感器发送和接收电路+加速度计电路；这样整个系统的硬件就由图2-2扩展为下图： 图3-1 硬件控制系统组成框图3.2基于TMS320LF2407的主控系统设计足球机器人性能的优劣除了由可靠、有效的机械结构来保证外，它的主控系统硬件电路是机器人动作的大脑，而核心CPU作为这个大脑的灵魂部分。它的选择不仅决定了主控系统设计的性能，同时制约了其它系统的设计。目前，足球机器人控制器大部分是采用8位或者16位单片机，甚至32位单片机作为微控制器，例如康奈尔采用MOTOROLA的MC68HC16、日本采用HITACH公司的SH7043系列等单片机。由于目前的足球机器人车体多为三轮或四轮，采用单片机对实现多电机控制来说，其硬件设计存在结构相对复杂，算法控制实时性差等缺点，所以我们采用美国TI(德州仪器)公司的TMS320LF2407A微控制器，2407 DSP控制器具有丰富的外围接口，它将DSP的高速控制能力和面向电机的高效控制能力集于一体，使机器人控制系统外围电路的设计大大简化，而且算法控制的实时行提高，使系统更为简单，稳定可靠。3.2.1 TMS320LF2407的简介TMS320LF2407 DSP是美国TI公司推出的C2xxx系列产品，它是为了满足大范围的数字电机控制应用而设计的。它具有实时运算，工作灵活，功耗低(采用3. 3V工作电压)等优点 其基本的特点如下：1)LF2407具有16位定点CPU内核，其运行速度为40MIPS，指令执行时间为25ns；2)整个程序和数据存储容量为 128K*16位 存储空间，其中32K*16位片上FLASH, 2.5k的片上数据存储空间，并具有64k的I/0寻址空间；3)16路10位的片上A/D接口；4)丰富的电机控制接口：存在多路PWM控制输出、正交解码接口、脉冲捕获单元和3路定时器，满足实时电机控制要求；5)丰富的通讯接口：UART串行接口(SCI)、CAN总线标准接口，具有SPI同步串行外设接口；6)具有片上安全监控功能：如看门狗，电源驱动保护等；7)丰富的I/0口。TMS320LF2407A丰富的片上资源：正交解码电路、串行通讯接口、多电机PWM驱动接口、多定时/计数器、多路A/D、脉冲边缘捕获电路等，使其非常适用于足球机器人控制系统实现的需要。而且由于DSP的高性能的运算能力，为采用复杂控制算法例如PID控制、自适应控制以及卡尔曼滤波等等提供了高可靠性和可编程性，从而提高了电机控制的实时性和整个系统的性能。3.2.2基于TMS320LF2407的主控系统设计上章己经阐述过我们研制的中型足球机器人的机电系统设计，它是采用三主动轮驱动结构，机器人运动的灵活性有了显著的提高。同时也分析了足球机器人所需要的各种功能结构，所以机器人主控系统要实现的具体功能如下： 1)驱动三个独立的主运动电机，使机器人具有运动功能； 2)驱动两个独立的带球，击球电机，使机器人具有带球和击球的功能；3)六路近红外传感器检测，用以实现小车控制的近距离避障以及检测球是否在机器人被控范围，从而提高击球的准确性； 4)三路主电机的电流信号检测，从而实时完成电机的电流控制； 5)加速度计传感器检测，用以计算机器人车体的加速度信息，从而进行机器人控制； 6)与无线通讯系统接口，实现决策信息的接受；7)三主运动电机码盘信号的检测，实时完成电机速度控制。为了实现上述机器人的功能，采用2407A微处理器，扩展系统的程序和数据RAM分别为64K方便程序调试，同时外扩64K的程序ROM，使系统有足够的程序空间。主控系统硬件框图如下图3-2所示。图3-2 足球机器人主控系统硬件结构图由于需要检测机器人的三个主电机的码盘信号，而DSP内部只有两路正交解码电路，因此必须基于DSP外扩一组码盘信号检测电路。我们采用码盘接口芯片HCTL2000与DSP接口来实现第三路码盘信号的检测、相、计数。由于HCTL2000芯片内部集成正交脉冲鉴向电路和信号四倍频电路，内有12位加减可逆计数器，并且通过总线连接方式接口，其最大工作频率为14M Hz，从而使码盘信号检测方便、可靠实现。设计中通过采用GAL译码，将HCTL2000芯片作为DSP的I/O外设映射TMS320LF2407A DSP的I/O空间的0X0000地址，DSP通过I/