足球机器人毕业论文总体设计

更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要足球机器人毕业论文 1-总体设计 . 机器人移动方式的选择机器人在地面上移动的方式通常有三种：车轮式、履带式和步行式。步行移动方式模仿人类或动物的行走机理，用腿脚走路，对环境适应性好，智能程度也相对较高。正因如此，步行移动方式在机构和控制上是最复杂的，技术上也还不成熟，不适于在要求灵活和可靠性高的比赛中。履带式实际是一种自己为自己铺路的轮式车辆。它是将环状循环轨道履带卷绕在若干滚轮外，使车轮不直接与地面接触。履带式的的优点是着地面积比车轮式大，所以着地压强小；另外与路面黏着力强，能吸收较小的凸凹不平，适于松软不平的地面。因此，履带式广泛用在各类建筑机械及军用车辆上。车轮式移动是最常见的一种地面行进方式。车轮式移动的优点是：能高速稳定的移动，能量利用效率高，机构和控制简单，而且技术比较成熟。它的缺点是对路面要求较高，适于平整硬质路面。在本机器人足球比赛中，场地为室内光滑平整地面，非常适合车轮运动，因此本设计选用车轮式运动方式。2.3.2 机器人电路硬件选择根据规则所描述，要求机器人尺寸较为小巧，直径为cm，并且不允许人工干设其操作，需要自动控制。因此选用单片机为核心的控制器件，小型直流电机作为动力驱动，可以达到比赛的基本要求。单片机价格低廉，体积小巧，一般为引脚或引脚封装，其中包括了中央处理器，数据存储器、程序存储器输入输出设备。对于需要灵活机动，精度要求不高，有可扩展性及程序可擦写和简单成熟的编程平台等要求，单片机不失为最合适的选择。电机选择方面，考虑到机器人本身自重不大，必且场地尺寸有限，可选用小型直流伺服电机，可用电枢电压作为速度控制信号，但必须加装减速箱以适应低转速和大扭矩的应用环境。. 传感器元件及转换元件选择通过对比赛规则的解读可以发现，对于球和场地基板的设计是该项比赛中最具特色内容，它对机器人的核心设计传感器以及比赛的方式产生了决定性的影响。更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要发出红外光的足球意味着机器人必须有红外传感器来对其进行检测。红外线波长介于可见光和无线电波之间，大约-，而光电传感器其所用到的波长选择在近红外区，即-。常用的红外线接收元件为光电二极管和光电三极管。它们可以将接收到的光变化转变的电流变化。比赛的场地图纸为纵向的黑白灰度渐变，这意味着机器人对进攻方向作出正确判断必须要能读出场地的灰度变化信息。要实现这一功能，则要用到红外光电反射式传感器。该元件由红外发光管和接受管组成。发光管材料一般为砷化钾半导体，发光波长范围在-，小功率的管压降-，平均工作电流-，红外发管有指向角，光轴，波长，辉度等性能指标。红外接收管可用上述光电二极管或三极管。红外元件所接收的信号，根据情况的需要，要进行模拟-数字量的转换，因此需要转换芯片，转换的选择要根据所选用的的单片机来确定。本文所选用的系列单片机，由于其端口的限制，需要转换器具有串口数据输出功能。2.5.2 机器人运行算法的构想对比赛过程的规则进行分析后发现，比赛的进行与真实的足球比赛的思维过程是一致的，机器人需要完成下述动作循环图 2-4然而在这一过程中，最关键的一步是把球攻进正确的球门。其难点在于找球的传感器与地面方向的传感器是相互独立的两套系统，怎样才能让机器人判断当前状态是找球过程还是在带球进攻过程。如果单独执行找球程序，让机器人跟随球的方向前进，很有可能把球撞入己方球门；如果单独执行方向判断程序，机器人则无法知道当前球的位置，有可能在没有控球的情况下冲向对方球门而造成无效的进攻。怎样解决找球程序和进攻方向判断程序的衔接，避免乌龙球和无效的进攻，这是算法设计要解决的重要问题。然而笔者查阅过一些相关资料，一直没有找令人满意的算法解决方案。由于机器人套件的外形限制，在外形上做一些改动以适应算法需要的想法无法实现。而本设计这是利用了外形可以自行设计的优势，通过加装了一个“持球探测臂”来解决算法上找球程序和进攻方向判断程序的衔接的问题。更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 2-5如图所示，当机器人寻找到球，并把球控制在控球板内时，持球探测臂上垂直向下的持球传感器将接收到红外信号并转换为电流变化。利用该信号作为是否持球的判断标志，单片机不断查询该标志位。若该标志位无信号反馈，则说明机器人没有控球，执行找球程序；若该标位有信号反馈，则说明已经控球，则执行进攻方向判断及带球进攻程序。简要流程如下：更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 2-66 Rhino 绘制的机器人效果图图( 点击放大)各部分零件介绍：更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图图更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 2-10第三章 动力驱动部件与运动方式设计3.2.3 四轮移动配置和操舵方式3 轮机器人车体配置结构虽然简单，但稳定性差，遇到冲撞容易倾倒，与3 轮相比，4 轮稳定性更好。 4 轮典型配置有如下两种。图如图组合为前后轮为万向脚轮，左右两轮为独立驱动轮，其自转中心于车体中心重合，适于在狭窄场地运行。其灵活性稳定性都比较好。其缺点是前后轮不能同时着地，加速前进时可能出现俯冲。更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图该配置方式是常见的所谓汽车配置方式，车的稳定性较高。2 个操舵轮需要同一个操舵机构协调转向，为了减少后轮摩擦损耗，配备了差动齿轮装置，增加了机构复杂性。综合各种因素考虑，本设计采用图所示的四轮配置方案。第四章 硬件电路设计引言本章按照机器人系统结构模块，把本机器人分解为主控部分，传感器部分，AD转换部分，电源供电部分以及电机驱动部分。对每个部分的器件选用，主要功能以及各部分所组合成的总体系统作了分析介绍。4.1 机器人系统结构按照现代机器人理论，机器人分为机械手，环境，任务和控制器 4 个相互作用的部分。其系统结构图如下：更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图在本设计中根据实际情况的需要，对以上模型进行了简化，得到以下的系统结构图：图4.2 主控部分硬件电路4.2.1 主控部分硬件 89C4051本设计选用了 ATL 公司生产的 89C4051 单片机作为控制器。AT89C51 是一个含有 4K 可编程可擦写只读存储器的低功率高性能 CMOS 8 位单片机。该器件运用了 Atmel 公司的高密度不易丢失存储技术斌且兼容MCS-51 工业标准的设置和管角输出。片内的闪存允许用系统内模式编程或传更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要统的不易失程序编写器。由于集成了一个通用 8 位 CPU 和闪存，使得 Atml 的AT89C51 成为一片具有高灵活性，可有效解决大多嵌入式控制应用的高性能单片机。AT89C51 支持如下标准特性：4K 闪存，128 字 RAM,32 条 I/O 线路，双 16 位定时/计数器，5V 双电平中断机构，一个全双工串行口，片内震荡和时钟电路。综上，AT89C51 是按照静态逻辑操作停止到 0 频率设计的，并且支持两套由软件选择的功率存储模式。被空闲模式停止的 CUP 可有 RAM,j 定时/ 计数器，串口和中断系统使其继续运作。掉电模式用锁定振荡器停止一切芯片功能的方式存储 RAM 内的内容，直到下一次的硬件复位。图4.2.2 控制电路所应用到的端口功能介绍 VCC:为点片机提供+5V 主电源 RST/Vpd：单片机复位引脚。单片机上电时，各存储器处于随机状态，在该引脚上输入两个周期高电平，使单片机复位。 P1.0P1.7：8 个带内部上拉电阻的 I/O 口。其中 P1.4P1.7 四个口用作接到 L298 的 IN1IN4，用作了对直流电机的驱动控制。另外，8 个 I/O 口上都留有 LED 接口，这样可以通过程序将任何一个寄存器空间上的内容输出到 P1 口并由 LED 显示，方便了程序的调试和功能的扩展。 P3.0：串行口，向 AD 转换器 TLC1543 的 clock 口输出时钟频率，用于控制 AD 转换的器串行传输的频率以及 AD 转换器的转换/读写周期的切换。 P3.1：串行口，接 TLC1543 的 ADRESS 地址口，串行输出四位地址用以对 AD 转换器的 9 个模拟量输入口进行选通。 P3.4：串行口，接 TLC1543 的 DATA out 口，用以接收经过 AD 转换后的 8 数字量 P3.5：带上拉电阻的 I/O 口，接 TLC1543 的片选 CS 口，用于对 AD 转换器的转换/数据读取周期的控制。 更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要 P3.2：带上拉电阻的 I/O 口，外部中断 0 的输入，用于碰撞开关的中断输入口。 XTAL.1XTAL.2：借外部晶振的两条引脚。 GND：地线。 4.2.3 89C4051 线路连接图：图传感器部分硬件电路4.3.1 找球传感器：根据比赛用球为红外发射装置，故采用的传感器为红外接收的传感器，根据车体前方的两个红外传感器接收红外光输出电压不同比较来判断球的方位指导车体前进方向。该红外接收器由一只光电三极管构成，其电路图如下：更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图A当光电三极管接收到红外线信号时，其电阻减小，在管两端的电压分压减小，输出口电压上升，输入到 AD 转换芯片进行转换。4.3.2 控球判传感器控球判断传感器也是一只红外三极管，安装在控球探测臂上，感光方向为正下方（见第二章相关章节）其原理同上，因只需判断持球与否连个状态，所以不需要 AD 转换比较，输出量为数字量直接输入到单片机 P1.3 口进行判读。4.3.3 进攻方向判断传感器场地贴有按进攻黑白灰度渐变的基板帖纸，由两个位于车底的灰度传感器进行判断，当左右两个传感器值相等时，认为正对球门。灰度传感器由反射式红外光电判读器组成，即一个红外发光管和红外三极管并排绑定构成，其电路图如下更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图B当地面灰度变化时，对红外光的反射量随之变化，白色对红外光反射力强，输出电压高；黑色对红外光吸收力强，输出低电压。4.3.4 碰撞传感器当机器人与墙体发生碰撞时，装于持球检测臂上部的微动开关会被按下，导致一个中断脉冲，使机器人进入中断处理程序倒退，转向，避开障碍。由于碰撞开关安装高度大于球的直径，不会造成球碰到碰撞开关而造成误操作。碰撞传感器线路图见 89C4051 线路图，其中的电容 C4 电阻 R3 起到对碰撞信号稳定延迟的作用，使单片机能接收到一个可靠的中断信号。AD 转换部分硬件电路AD 转换芯片的选用TLC1543AD 转换器自用在于把接收到的红外线电压模拟信号转换成可被单片机计算比较的数字信号。其类型有积分型，逐次比较型等等。针对本设计，所选用的是20 管脚的单片机 89C4051,其并行输入口有限，并已用于驱动电机控制。而TLC1543 的模拟端口地址输入和数字量输出都用串行口，这样大大节省了 I/O口资源。虽然串行通讯速度慢于并行通讯，但对于本设计，串口速度远高于机更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要器人反应速度，可以满足需要。另外，该 AD 转换器有 11 个模拟量输入口，为今后的功能扩展留下很大空间。图TLC1543 与单片机的电路连接图所用到的管脚功能介绍 ADDRESS：串行输入地址端口，通过 4 位的串行地址选择需要的模拟量端口。 Vcc：芯片工作正电压。 更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要 REF+：高参考电压值（通常是 Vcc）输入到该管脚，其最大输入电压取决于该管脚与 REF-管脚上的电压差值。 REF-：低参考电压（通常接地）。 CS：片选信号。该位上一次由高到低的跳变将复位内部计数器和控制器，并使能 DATA OUT 和 ADDRESS,并且 I/O CLOCK 在最大建立时间内加两个下降沿到内部系统时钟。一次由低到高的跳变将禁止 DATAOUT 和ADDRESS,同样的加两个下降沿到内部时钟。 DATA OUT：三态串行输出口用于输出 AD 转换的结果。当 CS 高时DATAOUT 被置为高阻态，CS 低时被置为可用状态。I/O CLOCK：输入输出时钟。该管脚接受串行输入的时钟信号，并执行 4 种功能。1、前 4 个周期在 ADDRESS 上接收 4 位地址信号。2、接下来几个周期，被选中的模拟量端口电压进入 AD 转换器的电容阵列。3、把前一周期所选中的模拟端口转换结果从 DATA OUT 输出。4、在第十个下降沿控制内部控制器，使之开始转换。 EOC：结束转换信号。在第十个时钟周期该由高跳到低并保持，直到转换结束为止。 GND：接地端。 4.5 电源供应部分451 稳压块选用本系统所有芯片都需要+5V 的工作电压，而干电池足能提供的电压为 1.5V 的倍数的电压，并且随着使用时间的延长，其电压会逐渐下降，想要得到稳定的+5V 工作电压，则需要 L7805 稳压芯片。图452 电源选择虽然微处理器和微控制器不需要支持电路，功耗也很低，但必须要加以考虑。?单电池组：用一组电池同时给控制电路和驱动电机供电。可以使机器人的重量减轻，成本降低。?双电池组：用两组电池分别给控制电路和驱动电机供电，可减少电机开关时的能量波动。本设计才用双电池供电模式，四节 AA1.5V 碱性电池用于控制芯片供电，一节9V 电池用于驱动电机供电。更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要4.6 电机的驱动与控制 直流 H 桥集成功放电路驱动原理直流 H 桥功放电路是用于控制直流电机双向运动的基本电路，该电路使电机在单电源供电下可以双向运转。图示电路为用三极管构成的 H 桥集成功放电路基本形式。为使电机顺时针转，应接通三极管 A 和 D,对电机而言，其电压右负左正，通过改变不同的三极管导通状况，可改变电机两端电压，达到反转目的。图 L298 双通道直流电机驱动芯片L298 驱动芯片是性能优越的小型直流电机驱动芯片之一。它可被用来驱动两个直流电机或者是双极性步进电机。在 646V 的电压下，可以提供 2A 的额定电流。L298 还有过热自动关断功能，并有反馈电流检测功能。为保证 L298 正常工作，建议加装片外续流二极管。更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图L298 驱动双电机的电路连接图：更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图电机控制逻辑：4.7 硬件连接总图更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 4-12更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要第五章 软件程序设计引言在完成了硬件的设计之后，需要进行相应的软件设计，对机器人的控制的思想，是直接通过软件程序表达的。因此，软件设计是整个设计过程中最重要的部分之一，直接关系到机器人在赛场上的表现。本章先对程序运行的重要环节AD 转换器的读写控制进行了说明，再针对各个功能模块设计了相关软件，各模块间相互独立，可用于测试各个部件的运行状况。最后合成一个具有完整性能和多判断的比赛应用程序。5.1 AD 转换器的读写控制模块5.1.1 TLC1543 的时序分析在本设计中所使用的 AD 转换器为 TLC1543，它支持串行的地址/ 数据 输入输出，大大节省了单片机的 I/O 口数量，但是这种串行通行方式有着较为复杂的时序要求。深入理解它的时序图，是编写读写控制程序的前提。时序图如下：图 5-1由图可知，该芯片通过一个 EOC（End of Conversion） 信号把时序划分为两个大的周期，当 EOC 输出高电平时，芯片开始从串口接收地址数据并发送转换结果；当 EOC 输出低电平时，芯片进入 AD 转换周期，直到转换完毕，EOC 会再次跳高。在数据收发周期开始时，由 CS 片选信号跳低和 EOC 跳高为标志，由外部入输的 I/O CLOCK 作为串行通信的同步时钟，该周期被这个时钟信号划分为 10 个更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要小的时钟周期。在 ADDRESS 口上，前 4 个周期接收 4 位地址信号，通过这 4位地址信号来选中 11 个模拟量输入口其中的一个；在 DATA OUT 口上，10 个时钟周期输出 10 位 AD 转换的数字量结果。需要注意的是，该结果来自于上一个数据收发周期中所确定的那个模拟量输入口，而本周期所确定的模拟量输入口所读进的数字转换结果将在下一个读写周期输出。5.1.2 AD 转换器数据读取程序的编写虽然 89C4051 上有自带的串行口，但是 TLC1543 的串行通信较为特殊，需要在同一时钟周期内有两个 I/O 口在同时输入和输出，并且 51 自带的串口同步时钟难于保证在 1543 应用上的同步，于是本程序采用了用普通 I/O 口模拟串口的方法。单片机的 P3.0 口连接 AD 转换器的 I/O CLOCK 口，通过对 P3.0 口输出的信号进行翻转的方法来制造时钟信号。P3.4 连接 DATA OUT 口，用移位寄存器的方式接收串行数据。即用 P3.0 控制时钟，用标志位 C 作为数据和地址的传递媒体，把转换结果通过 C 传递到可进行位操作的地址空间 20H，接收一位，左移一位，直到 8 位传递完毕。同样，用 P3.1 连接到 ADDRESS 口，把地址数据存入可进行位操作的 21H 地址空间，通过标志位 C 把地址传入 ADDRESS,传送一位，右移一位，直到 4 位地址传完。在前 4 个周期，地址传送和结果接收同时进行，后四个周期，只进行数据接收，因 1543 共有 10 个周期，所以 8个周期完成后让 P3.0 空翻转两次，完成数据地址的收发过程，进入 AD 转换的过程，这时等待 EOC 的跳高信号，意味着转换完成，进入下一个数据收发过程。以上过程进行 4 个循环，分别读取左右红外和左右灰度 4 传感器的数据，分别存放在 02H,03H,04H,05H 四个地址单元中。5.2 运动控制程序模块 5.2.1 程序原理机器人在实际运用中，需要作出的动作有：前进、后退、左转和右转，其中，左右转可以根据需要分别有以车身中心为圆心转动和以车轮为圆心转动。其工作原理为，通过 89C51 的 P1 口向电机驱动芯片 L298 传送 4 位的控制信号，控制左右两个电机的正转反转，再调用一段延时程序，完成动作。其中，两个轮子反向转动时，可实现以车身中心为圆心转弯，当一个轮转动时，可实现以车轮为圆心转弯。5.2.2 运动控制模块?延时程序：通过循环调用，执行空语句实现DELAY: MOV R5,#04H ;延时 1sDLOOP6: MOV R7,#0FFH ;延时 250msDLOOP5: MOV R6,#0FFH ;DLOOP4: NOP ;更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要NOP ;DJNZ R6,DLOOP4 ;DJNZ R7,DLOOP5 ;DJNZ R5,DLOOP6 ;RET ?直行程序： MOV P1,#50H ACALL DELAYRET?后退程序： MOV P1,#A0H ACALL DELAYRET?轮心左转： MOV P1,#10 H ACALL DELAYRET?轮心右转： MOV P1,#40H ACALL DELAYRET?轴心左转： MOV P1,#90H ACALL DELAYRET?轴心右转： MOV P1,#60H ACALL DELAYRET5.3 找球程序模块5.3.1 编程思路找球的过程是通过对左右两个红外传感器的电压数字量比较实现的。当球在左前方时，左红外传感器接收光量大于右红外，电压数字量也大于右红外，这时控制机器人向左转。右转情况相同。当球在正前方时，左右传感器电压数字量相等，此时控制机器人直行。当球在背后时，两个红外传感器没有光接收，此时以车身中心为圆心进行转动，直到搜索到球为止。找球程序有以下几点值得注意。1） 找球目的在于尽快地接近球，于是当球不在正前方时，每次调整方向后，调入一段短距离直行程序，在修正方向的同时，不断地向球靠近；当球在正前方时，调入一段长距离执行程序，缩短找球时间。2） 由于 AD 转换以及传感器的误差的存在，即使球完全正对机器人，也不可能得到两个完全相等的电压数字量，于是在比较时应设一个阈值，当左右差值小于阈值时，认为正对足球，调用长直行；当差值大于阈值时，再进行左右大小判断，调用转弯程序。更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要3） 当进行阈值判断时，差值有可能得到负数，在此情况下应求其相反数。4） 当球不在红外传感器可视范围，即传感器接收到的红外信号为零时，由于周围环境的影响和暗电流的存在，其输出电压不可能为零，而是约 0.3 V 左右。5.3.2 找球程序流程图更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 5-25.4 进攻程序模块5.4.1 编程思路进攻方向的判断是根据对面灰度的增减比较来进行的。在接近白色的区域，对红外光的反射量大，光电判读器即灰度传感器的输出电压高，在接近黑色区域，输出电压则低。在此，默认从白到黑为进攻方向进行编程。当机器人找到球并持球时，程序进入进攻模块。该模块大致分为两个步骤，首先判断前进的方向是否是进攻的方向，之后，再判断前进的方向是否平行于边线正对球门。在进攻程序之前的找球程序模块中，多次用到读取 AD 转换结果的程序READ，在该程序中，每执行一次，将读进 4 个传感器的转换结果，其中左灰度和右灰度的转换结果存放在 04H 和 05H 两个地址单元里。在判断正确前进方向时，03H 和 04H 里存放着前一次的转换结果，先把它们转移到共工作寄存器 R1，R2 中，在读取当前的灰度转换结果，分别与前一次的结果进行比较，只要其中有一个值增大，就认定为前进方向错误，这时调用以车身中心为圆心的原地转动程序，当转过约 180 度后，读取当前灰度值保存，再调用一段短距离直行程序，再次比较灰度值变化趋势，直到左右两个灰度值都为减小，这时，机器人前进方向为正确进攻方向。在大方向调正之后，许要调整机器人的前进角度，即使前进方向平行于边线，正对球门。这个动作左右两个灰度传感器转换结果之间的比较完成。先读取当前灰度值，左右两个结果进行比较，如果左灰度大于右灰度，说明前进方向偏左，调用原地转动程序向右偏转，调整后，再次读取，比较，直到左右相等为止，这时方向正对球门，调用长距离直行程序，开始进攻，把球攻入球门。在两个灰度值大小比较时，与红外传感器有类似的问题需要注意：相减时出现负数时需要调整为相反数；判断相等时有传感器误差存在，需要设定阈值，差值小于阈值即认为相等。 更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 5-35.4.2 进攻程序模块流程图更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 5-4更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要5.5 碰撞避让程序模块5.5.1 碰撞避让程序的硬件实现本设计的碰撞避让系统，是通过 51 单片机的中断控制功能实现的。 MCS-51 系列单片机有 5 个中断源，可分为 2 个中断优先级。本碰撞避让系统所用到的中断源为 ，即外部中断 0。其请求信号由 P3.2 输入请求信号有效电平由 IT0 和设置，一旦输入信号有效，则将 TCON 中的 IE0 标志位置 1，可向 CUP 申请中断。5.5.2 中断控制设置MCS-51 系统中断控制由 4 个专用寄存器组成。 中断请求标志 TCON其中 IE0 为外部中断零的申请标志位。当外部中断源有请求时，该位置 1，其复位由触发方式来设置。IT0 为外部中断触发方式设置位，IT0=0 时，为电平触发方式，该方式下，CUP 每个机器周期对外部中断源采样，如果为低电平，则进入中断。该方式中 CUP 响应中断后不能自动清除 IE 标志位，所以中断返回前，外部中断源引脚上的低电平必须撤销。IT0=1 时为脉冲触发方式，即在两个相邻的机器周期内 上的电平发生由高到低的跳变即进入中断 IE=1 保持到CUP 响应中断时，才由硬件清除，该方式下，中断源低电平需要至少保持一个机器周期。 中断开放和屏蔽 IE其中，EA 为总中断允许位，EA=1 时开放中断，EA=0 时关断一切中断。EX0为外部中断 0 允许位，EX0=1 时允许。 中断优先级设定 IP更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要其中 PX0 为外部中断 0 优先级设定，PX0=1 时，为高优先级。5.5.3 碰撞系统模块程序中断控制设置：SETB IT0 ；选择触发方式为电平触发MOV IE,#85H ；EA=1,EX0=1,开放外部中断 0MOV IP,#01H ；PX0=1，外部中断零设为高优先级中断服务子程序INTR0: MOV P1,#50H ；后退ACALL DELAY01 ；ACALL TURN ；调头 RETI ；中断返回5.6 整体程序5.6.1 编程思想以上所述的几大功能模块，都可以独立使用，分别完成不同的任务，而把它们联系到一块，则可以形成一个完整的程序，使机器人在赛场上完成整场比赛。而把他们联系在一起的桥梁则是前中提到的持球探测壁以及其上的持球传感器。持球传感器也一个红外接收管，不需要 AD 转换，只需要逻辑判断，当机器人持球时，该传感器从 P3.6 口输入一个高电平。整个程序运行过程中，通过查询方式来判断是否持球。当 P3.6=0 时，执行找球程序，当 P3.6=1 时，执行进攻程序。在整个程序中，中断开放，实现任何状态下的碰撞避让。5.6.2 整体程序流程图：更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 5-5(点击放大)第六章 测试及设计总结6.1 足球机器人完成图更多相关参考论文设计文档资源请访问 http:/www.docin.com/lzj781219完整设计文件及源代码，资料请联系 68661508 索要图 6-1(点击放大) ： 足球机器人完成图6.2 功能测试6.2.1 找球功能模块测试 测试条件：用一个高功率红外发光管模拟比赛用球，在室内日光灯光源下进行测试。 测试软件：找球程序模块，差值阈值 0.05V，无红外情况输出电压0.45V。转弯延时 0.25 秒，直行延时 0.5 秒。 测试结果：机器人能在 40CM 距离左右发现球，在向球运动过程中，前半段由于基础电压小，差值小于阈值，直线前进；当靠近球时，电压增大，差值大于阈值，机器人左右调整方向，逐渐靠近小球。 6.2.2 碰撞功能模块测试 测试条件：面向墙壁直行，模拟碰撞场地挡板。 测试软件：装入直行程序，中断开放，中断服务程序为倒退延时 1 秒，原地转弯延时 1 秒。 测试结果：机器人在直行碰撞墙壁后，顺利进入中断服务程序，倒退并调头，之后中断返回继续直行。 6.2.3 方向判断功能模块测试