足球机器人控制系统设计(5)

2019-04-14 14:43

安徽建筑工业学院本科毕业设计(论文)

第三章双DSP为核心的控制系统电路设计

3.1 RoboCup小型组足球机器人控制电路系统结构

RoboCup小型组足球机器人在场上是实时、高速、高对抗的.为了满足比赛要求,足球机器人控制电路系统必须具备以下功能:

(1)MCU运算速度高,能够执行运算量大的控制算法,方便扩展各种接口电路;

(2)能配合无线通讯模块实现波特率115200bps的无线信号接收; (3)能够以脉宽调制的方式驱动四路驱动轮电机;

(4)可以处理四路以上的正交码盘信号、检测各驱动电机电枢电流信号盘来实时地对四组驱动轮进行精确的闭环速度控制;

(5)对机器人供电电池组进行DC-DC升压变换至200v,用以驱动“踢球”电磁铁高速击出“球”;

(6)使用多路红外传感器和加速度计来感知机器人状态。

通过对足球电路系统功能和性能特点的分析,综合足球机器人体积和电源等方面的要求,我们将电路系统各种功能大胆融合、进行优化,提出本文所述的设计方案。

电路系统是作为整体进行设计和优化的,可划分为以下几个功能模块: 。

①MCU模块。该模块的核心为采用主从工作模式的双DSP。MCU模块可配合无线通讯模块接收上位机(PC)发送的无线通讯信号,根据接收到的指令和自身传感器信息完成对机器人的实时控制。

②驱动电路模块。该模块在MCU模块的控制下,以脉宽调制的方式对机器人 21

安徽建筑工业学院本科毕业设计(论文)

驱动电机进行实时调速控制。

③DC-DC升压电路模块。足球机器人使用可充电镍氢电池组供电,电源变换模块将电压升高到DC200v,储存到大容量的电容中,作为击球电磁铁的电源。

④传感器电路模块。该模块使用红外发光管和红外接收管来探测机器人是否带到球以及周围障碍物与机器人的距离。

足球机器人电路系统构成框图如图3-l所示:

无线通讯板指令主MCU模块(2407)12V电源从MCU实现程序下载IO\\CAN\\SCI指令\\码盘信低层控制程序号从MCU模块(2407)DC DC12V 5Vi\\oFLASHMEMORY红外传感器控制信号光耦隔离号电路击挑球升压电路带球电机红外传感器螺线管运动电机驱动电路11VDC驱动电路信号处理电路220VDC驱动电路i\\oi\\opwm编码器信电机检测放大器信号电机电枢电流检测电路供电击挑球螺线管带球电机电机编码器电电电机机机编码编码编码器器器红外传感器红外传感器红外传感器

图3-1 足球机器人电路系统框图

3.2 MCU模块设计

机器人控制MCU需要完成机器人速度轨迹跟随控制算法,还需要接收指令、处理多路传感器信号等。由于这些处理所需要的运算量相对比较庞大,而且需要使用大量的控制接口,所以一些传统的简单运算芯片(如8051等)和单片机无法满足我们的需求,我们采用运算能力相对强大的DSP芯片。

系统采用TI的DSP芯片TMS320LF2407A,它属于TI工公司DSP中专门用于电机控制的TMS320LF240X系列中的一种。它是TI在以TMS320C2xLP系列为内部运算核心的基础上,整和了丰富的外围控制电路和接口而形成的一类面向电机控制特殊片种。它具有以下一些优点:运算速度快、运算精度高;体积小、功耗低;

22

安徽建筑工业学院本科毕业设计(论文)

指令系统功能强大、高效;存储空间大、扩展简便;片内“外设”丰富、接口简单;带有多个事件管理器方便对电机进行控制。TMS320LF2407A的具体参数为:最高内部频率为40MHz,时钟周期为25ns,具有40MIPS的处理能力;

32K内部FLASH为,可加密;两个事件管理器(Event Managers),每个EM包括:两个16位时钟;8个通道的脉宽调制(PWM)单元;三个事件捕获单元(Cap);

10位A/D转换器,16通道,375-500ns的转换时间;CAN2.0、异步串行口(SCI)、同步串行口(SPI);40个管脚可用作通用10。

本文所述的设计中,针对机器人控制算法和控制要求的特点,针对前两代足球机器人控制电路系统出现的做了体系结构上的改变。 1、双MCU系统特点

足球机器人控制电路系统的MCU在实际工作中要承担很大的运算量,它最大的两项系统开销是以115200bps的波特率来接受SCI通讯、以定时中断的方式实时的对四路驱动电机进行速度闭环控制。此外,还有驱动轮速度分配运算、无线指令校验解析、传感器信号处理等工作。

由于驱动轮控制的定时中断需要很高的系统开销,用于机器人控制的MCU无法以中断的方式配合无线通讯模块来进行高波特率的无线指令接收和处理。为了解决这一矛盾,在前两代机器人控制电路系统中,我们另行设计了一块电路版,使用专门的MCU来以中断的方式配合无线通讯模块来进行无线指令接收、校验和转发。而机器人控制用MCU以查询的方式,通过有线SCI的形式接收无线通讯电路转发的指令,这样较好的解决了这一矛盾。但是增加了一块电路板,大大的增加电路系统的体积、功耗、复杂性、可靠性。

另外,我们选用TMS320LF2407来作为控制用MCU有一个很大的因素是因为它的“事件管理器”具有正交码盘信号处理的能力,但是2407只有两个“事件管理器”。因此在以往的控制电路系统中,采用的方法是外扩两个正交码盘计数芯片,2407以扩展10空间的方式对码盘计数芯片读数。这样的方案成本高、系统复杂。

此外,原有的电路系统中存在内部定时器不够,导致PWM波频率无法优化的问题。

综合上面的问题,在四轮全向足球机器人的控制电路设计方案中,采用双DSP2407的来构建控制系统。

23

安徽建筑工业学院本科毕业设计(论文)

2、主要工作原理和方法

一片DSP2407为主MCU:

(1)主DSP以I/O口连接从DSP的错误!不能通过编辑域代码创建对象。错误!不能通过编辑域代码创建对象。等芯片控制端。这样主DSP就可以配置从DSP的工作状态,管理从DSP重启、从片内或者片外执行程序;

(2)主DSP配合无线通讯模块接收无线通讯指令。主DSP以SCI接收端与无线模块连接接收数据;以I/O连接无线模块的配置端,配置无线模块的工作状态、波特率、频点;主DSP以SCI接受中断的方式逐个字节的接受无线指令,并进行校验,将通过校验的无线指令从SCITX传送给从DSP。

(3)主DSP根据从DSP的请求,读取2路电机的码盘信号,从SCITX传送给从DSP。

(4)主DSP扩展了32K*16的SRAM作为片外程序RAM,用于通过JTAG进行仿真调试。

另一片DSP2407为从MCU,其相应工作为:

(1)接收主DSP处理完毕的无线指令,解析并执行指令,控制机器人运动、带球、击球。

(2)根据指令分配各驱动轮速度,以定时中断方式实现对四组驱动轮的速度控制。该过程应用机器人的速度轨迹跟随算法,控制机器人的运动。算法中的驱动电机速度控制需要应用驱动电机正交码盘信号作为反馈。其中两组正交码盘信号由从DSP自身“事件管理器”读出,另两组正交码盘信号向DSP请求,主DSP读出后通过SCI接口,发送给从DSP。

(3)使用AD读取多路电机电枢电流信号、传感器信号、控制带球电机和击球 电磁铁。

(4)从DSP扩展了32K*16的SRAM作为片外程序RAM,用于通过JTAG进行仿真调试。另外还可通过SPI接口扩展EEPROM,可对控制程序进行外部存储。必要的时候可支持控制程序的无线下载。

24

安徽建筑工业学院本科毕业设计(论文)

图3-2主从式DSP硬件结构图

3.3.主从工作模式下的软件设计

机器人的控制系统采用双DSP的形式,降低了硬件系统的复杂度。但是,同时主、从DSP之间的耦合度较高,主、从DSP之间需要进行大量的数据交换、管理、及握手信号。这样就给DSP内的软件提出了要求。下面来介绍在主、从DSP的软件设计,说明是如何实现各种功能的。

足球机器人的速度轨迹控制是一个重要的研究对象,因此需要执行速度轨迹控制算法的DSP中的程序能够很方便的改变。主DSP对从DSP进行管理,上位机可以通过发送控制指令给主DSP,由主DSP来管理从DSP的控制算法程序。这样从DSP上的控制程序的执行就有了更大的灵活性。

无线模块接收的指令经过主DSP的接收和校验后,通过SCI发送从DSP。从DSP需要主DSP读取两组正交码盘信号的时候,主DSP也是通过SCI发送给从DSP的。也就是说经过校验的指令和码盘信号都是通过同一个通道传送的。因而需要采用一定的机制来解决。实际设计中,使用了两个I/O作为握手信号,主DSP根

25


足球机器人控制系统设计(5).doc 将本文的Word文档下载到电脑 下载失败或者文档不完整,请联系客服人员解决!

下一篇:学校健康教育评价方案实施细则

相关阅读
本类排行
× 注册会员免费下载(下载后可以自由复制和排版)

马上注册会员

注:下载文档有可能“只有目录或者内容不全”等情况,请下载之前注意辨别,如果您已付费且无法下载或内容有问题,请联系我们协助你处理。
微信: QQ: