基于DSP的移动机器人的设计与实现

——

作者：时间：2007-02-06来源：电子技术应用收藏

基于DSP的移动机器人的设计与实现
上海交通大学电子信息学院(200030) 王洪升田蔚风金志华
杭州浙江科技学院教育技术学系(310021) 陈以蒙

　　摘　要：智能交通系统是21世纪城市交通的发展方向,移动机器人作为智能车辆控制系统实验平台的一个主要部分,对智能交通系统的关键技术的研究具有十分重要的意义。介绍了面向智能交通系统的SJTNC-1移动机器人的组成和结构,并详细叙述了基于数字信号处理器TMS320LF2407A的控制系统的设计和实现。
　　关键词：智能交通系统移动机器人 数字信号处理器

　　智能交通系统(ITS)的概念是美国智能交通学会于1990年提出的,它将先进的信息技术、通信技术、自动控制技术、电子技术及计算机处理技术综合运用于整个运输管理系统中,通过对交通信息的采集、传输和处理,对交通运输进行协调和管理,建立起实时、准确、高效的综合交通运输管理体系,从而提高了交通效率和安全了,实现性交通运输服务和管理的智能化。
　　智能车辆的导航与定位、自动驾驶与控制和车辆的预警防碰等智能交通系统关键技术的研究,近年来受到国内外越来越广泛的关注,也取得了丰硕的成果。但真正的实验研究还是很少,基本上只进行了仿真试验。鉴于理论上的模拟和实际应用情况可能相差甚远,选择了具有智能性、易扩展性和移动性等优点的车型移动机器人作为ITS关键技术的研究平台中的主要部分——车辆模拟器。
　　本文所阐述的移动机器人SJTNC-1,就是面向ITS提出的。考虑到关键技术研究中需进行大量的计算,如模糊控制、卡尔曼滤波和路径导引等,并且系统对数据的实时性要求很高,所以采用数字信号处理器(DSP)作为移动机器人主控CPU。

1 TMS320LF2407A简介
　　TMS320LF2407A(以下简称F2407)是TI公司在TMS320系列DSP的基础上,专为数字电机控制而设计的。除了具有一般DSP的改进的哈佛结构、多总线结构和流水线结构等优点外,它还采用高性能静态CMOS技术,电压从5V降为3.3V,减少了功耗。并且指令执行速度提高到40MIPS,几乎所有指令都可以在25ns的单周期内完成。如此高的运算速度使其可以通过采用高级控制算法如模糊控制、卡尔曼滤波以及状态控制等来提高系统的性能。而且,它具有电机控制应用所必需的外设,如:32K片内FLASH、2K单访问RAM、串行外设接口(SPI)、串行通信接口(SCI)、两个事件管理模块、16通道双10位A/D转换器和CAN控制器模块。

2 移动机器人的运动机构
　　考虑到该移动机器人是面向ITS的,所以采用的是车型结构(四轮结构)。前两轮通过减速比为8:1的齿轮减速机构与转向电机进行连接,实现移动机器人的转向功能;后两轮通过减速比为6:1的齿轮减速机构与驱动电机进行连接,实现移动机器人的驱动。电机的选型可根据实际情况选择小型步进电机或小型直流电机。这里选用的是瑞士Minimotor公司生产的直流电机,这种电机具有体积小、转矩大等特点。

3 移动机器人控制系统
　　控制系统以控制器F2407为核心,由无线通信、电机驱动、速度传感器、数字罗盘、差分GPS(DGPS)接收机和4转1串口通信模块等组成,如图1所示。无线通信模块根据自行约定的通信协议接收上位机的规划好的路径信息,整个控制系统通过控制驱动电机和转向电机使移动机器人跟踪该路径行驶。电机采用PWM调速方式,其中驱动电机采用双闭环(速度和电流)PID控制策略,而转向电机则通过把数字罗盘的航向信息作为转向的反馈量进行PID控制。整个控制系统把DGPS接收机的位置信息作为系统的位置反馈信息,用以完成整个系统的位置闭环控制。