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

集成电路应用

■手DSP的移动机■人的设计与实曩

上海交通大学电子信息学院(200030)

王洪升

田蔚风金志华

杭州浙江科技学院教育技术学系(3l0021)

陈以蒙

要:智能交通系统是2l世纪城市交通的发展方向,移动机器人作为智能车辆控制系统实验

平台的一个主要部分,对智能交通系统的关键技术的研究具有十分重要的意义。介绍了面向智能交通系统的S盯NC一1移动机器人的组成和结构,并详细叙述了基于数字信号处理器TMS320LF2407A的控制系统的设计和实现。

关键词:智能交通系统

移动机器人

数字信号处理器

双10位A/D转换器和CAN控制器模块。

智能交通系统(nls)的概念是美国智能交通学会于1990年提出的,它将先进的信息技术、通信技术、自动控制技术、电子技术及计算机处理技术综合运用于整个运输管理系统中,通过对交通信息的采集、传输和处理,对交通运输进行协调和管理,建立起实时、准确、高效的综合交通运输管理体系,从而提高了交通效率和安全了,实现性交通运输服务和管理的智能化。

智能车辆的导航与定位、自动驾驶与控制和车辆的预警防碰等智能交通系统关键技术的研究,近年来受到国内外越来越广泛的关注,也取得了丰硕的成果。但真正的实验研究还是很少,基本上只进行了仿真试验。鉴于理论上的模拟和实际应用情况可能相差甚远,选择了具有智能性、易扩展性和移动性等优点的车型移动机器

2移动机器人的运动机构

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

3移动机器人控制系统

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

DGPs接收机

COM2

人作为rrS关键技术的研究平台中的主要部分——车

辆模拟器。

本文所阐述的移动机器人SJTNC一1,就是面向rrs提出的。考虑到关键技术研究中需进行大量的计算,如模糊控制、卡尔曼滤波和路径导引等,并且系统对数据的实时性要求很高,所以采用数字信号处理器(DSP)作为移动机器人主控CPU。

TMS320LF2407A简介

’rMS320LF2407A(以下简称F2407)是1rI公司在

4转1串口

通信模块COM3

COMl

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

64

转向数字

COM3

无线通信模块

罗盘

SCI

I/O

QEP

电机

A/D检流

驱动

模块

PWMPWM

图l控制系统结构框图

欢迎邮购本刊1995~1999年光盘版,每套lOO元

《电子技术应用》2004年第6期

集成电路应用

向的反馈量进行PID控制。整个控制系统把DGPs接收机的位置信息作为系统的位置反馈信息,用以完成整个系统的位置闭环控制。3.1无线通信模块

MC35是德国西门子公司生产的可二次开发的支持GPRS的双频GSM模块,可以通过标准串口与PC机相连。本系统用MC35作为移动机器人与上位机的通信模块。它具有GPRS技术带来的一切优点,如一直在线和提供高速价廉的数据传送服务等。该产品的特性如下:

・支持双频:EGSM900/GSMl800・支持GPRSClass8协议

・支持数据、语音、短消息和传真服务

・采用电路交换方式,最大传送速率为14.4kbps・支持的电压范围:8V一30V・采用标准工业接口・体积:65mm×74mm×33mm・重量:13093.2驱动模块

驱动电机和转向电机的驱动原理相同,都采用脉宽调制(PWM)方式进行调速,PWM信号由F2407产生。驱动电路采用H全桥方式,由4个达林顿管(2个TIPl32和2个TIPl37)、4个IN4001二极管及与非门组成。电路原理图如图2所示。当PWM2、PWM4为低电平而PWMl、PWM3为高电平时,T1、T4饱和导通,rI’2、T3截

块都采用RS一232异步串行通信,而F2407只有一个串行口,所以必须将4个串口数据通过转换处理来完成与F2407的串口通信。为此研制了基于分时复用方法的4转1串口通信模块。当F2407需要某个传感器(或无线通信模块)的数据时,就通过电路选通该传感器占用F2407串口进行通信;当需要另外传感器或无线通信模块数据时,则关断上次传感器的选通,同时选通该次传感器或无线通信模块。4转1串口通信模块由3—8译码器74LSl38、三态输出的四总线缓冲门74LSl25和电平转换器MAX232等组成,其电路原理图如图3所示。

止,电流从T1一电机一T4,电机正转;反之,当PWMl、

PWM3为低电平而PWM2、PWM4为高电平时,rIl2、rI’3饱

和导通,T1、T4截止,电流从,I'2一电机一,I.3,电机反转。

图34转l串口通信模块电路原理图

3.4定位传感器

3.4.1

DGPS接收机

GPS(全球定位系统)是基于卫星的无线电导航系统,它提供一种廉价实用的可在全球范围内确定位置、速度和时间的工具。GPs由24颗卫星(21颗工作星、3颗备份星)组成星座,星座分布在与地球赤道面倾角为55。的6个轨道面上,其运行周期为11小时58分,轨道半径为20200km,各轨道面夹角为60。。每颗卫星向地球发射L频段的特高连续波,调制两种伪随机码(军用高

图2电机驱动电路原理图

精度保密P码和民用C/A码)。这样的分布特点保证了用户在地球上任何地点、任何时间至少可以连续地收到

为防止T1、T3或,112、T4同时导通,形成短路而击穿器件,要用一对无重叠的PWM输出去正确地开启和关断这两对管子。在一个管子关断和另一个管子开启之间加入死区时间,这样就使得一个管子开启前,另一个管子已完全关断。F2407具有死区控制单元是其一大特色,从而可用软件确保功率电路上下桥臂开关元件的开通区间没有重叠,简化了硬件电路设计,提高了可靠性。

3.34转1串口通信模块

4颗以上卫星的导航信号,从而联立解算出接收机的三维坐标以及接收机和GPs间的时间偏移。三维坐标采用ECEF笛卡儿坐标系或大地坐标系如WGS84。

虽然美国政府于2001年5月取消了民用C/A码的可选择性保护,但民用导航型GPs接收机的单点实时定位精度只能达到25m左右,不能满足系统的定位导航要求。而采用实时差分GPS(DGPs),其定位精度可以达到2—5m,该精度已能满足系统定位和导航的要求。

为此研发了单基站DGPs(SRDGPs)系统,其结构框

由于DGPs接收机、磁罗盘、里程计和MC35通信模

《电子技术应用》2004年第6期本刊投稿邮箱:eta@ncse.com.cn

65

集成电路应用

图如图4所示。基准站由AUS’rAR

BASE

GPs接收机、其弊端。系统的框架如图5所示。下面对关键的几大模块进行简要的阐述。

天线和MDS无线电发射台、天线组成,流‘动站由SU-

PERSTAR

GPS接收机、天线和MDX无线电接收台、天

线组成。其中基准站安装在上海交大徐家汇校区教学一楼楼顶,该基准站能覆盖方圆30公里的范围,流动站安装在车载单元上。

GPS天线

电台天线

电台天线GpS天线

基准站部分

图4

流动站部分

DGPS的结构框图

图5软件控制系统框图

5.1串口通信模块

该模块程序采用串口中断方式实现,主程序主要由系统初始化、串口初始化、串口中断设置和等待中断组成。而中断子程序分为发送子程序和接收子程序。本文给出发送子程序流程图。主程序及发送子程序流程图如图6所示。

3.4.2数字罗盘和车速传感器

采用HoneyWell公司的HMR3300数字罗盘作为移动机器人的方向检测传感器。其主要技术指标为:(1)1度航向精度,0.1度分辨率;(2)0.5度重复性;(3)±60度倾斜俯仰范围;(4)15Hz响应时间;(5)一40±85度工作温度;(6)6—15V直流电压。

同时采用用于大众汽车公司桑塔纳2000型轿车的霍尔车速传感器作为移动机器人的车速传感器。其工作原理是以霍尔传感器为变换元件,将机械旋转量转化为电脉冲信号输出。主要技术指标为:(1)输出波形为矩形脉冲,占空比为50%;(2)每旋转一周产生6个脉冲;(3)额定电压为12V。

4电源模块

电源模块需分别给各传感器、DSP芯片、其它芯片和电机供电。其中,磁罗盘、码盘和DGPs接收机使用12V直流电压,DSP芯片使用3.3V直流电压,其它芯片使用5V直流电压,还有电机电源使用12V直流电压。所以,采用1节12V的直流蓄电池(4AH),直流5V通过ST半导体公司的L7805和扩流用的功率管实现,DSP芯片

用3.3V电源采用ON半导体公司的1SMB5913鹏实现。

F2407正常工作时,所有电源管脚都为3.3V;写入FL~SH存储器时,VCCP引脚为5V供电;复位时,复位电路会产生一个10斗s宽度的持续低电平使芯片复位。

图6串口通信模块主程序及发送子程序流程

5.2路径引导模块

该模块在移动机器人行驶中为其提供实时的速度和转向指令,从而引导它沿着上位机给定的路径行驶。主要包括行驶指令的产生和规划路径的跟踪两个环节。

根据预瞄跟随理论及驾驶员的开车行为特性,智能行驶和驾驶员操纵行为是内在一致的。通过研究有驾驶员操纵行为,发现主要根据两个因素决定车辆的前进速度,这两个因素分别是道路的弯曲程度和机器人相对参考路径上的方向偏差。

移动机器人的前进速度的控制不需要连续变化,可设置为三档,分别对应高、中和低三个速度。由此确定的前进速度跟踪规则为:

・当方向偏差小于10度时,路径基本为直线,前进速度设为高速;

・当方向偏差小于90度时,路径弯曲较严重,前进

(下转第70页)

5控制器程序结构

DsP程序由五大功能模块组成,分别为系统初始化模块、串口通信模块、路径引导模块、驱动电机控制模块和转向电机控制模块。TI公司提供了用于C语言开发的CC和CCS平台。该平台包括了ANSIC优化编译器,从而可以在源程序级进行开发调试。这种方式大大提高了软件的开发速度和可读性,方便了软件的修改和移植。但在某些情况下,代码的效率还是无法与手工编写的汇编代码的效率相比。此外,用C语言实现芯片的某些硬件控制也不如汇编程序方便,有些甚至无法用语言实现。为了充分利用芯片的资源,更好地发挥C语言和汇编语言进行软件开发的各自优点,采用混合编程方法将两者有机结合起来,兼顾两者的优点,避免

66

欢迎邮购本刊1995—1999年光盘版,每套100元《电子技术应用》2004年第6期

集成电路应用

i:f(pricestate=”000”aJldbutt-code/=”1011”)then

savedata(27downto24)<=butt_code;

pricestate:=”00l”;ledout<=”101”;

“+”,totalnum变成了2,而eachnum为l,然后授p

lul,

并没有操作,按下111后再按下“一”,但是因为之前并没有选择过,所以信号无变化。随后numdish扫描到01,dishled为0101表示选中了001号和011号菜。

图4是信息调整模块的仿真波形。图中,dressout为存储器的地址,key-valid为按键有效信号(实际上不应

—-循环接收(语句省略)菜的信息,包括口味和价钱,如果输入的数超过7位,

elsif(叫ce8t8te=”111”鲫d

一一重置语句(略)

butt.code=”1011”)then

该是有规律的,这里只是为了方便起见),1棚te、read分别为写、读信号,cs为使能信号,butLcode为4×3键盘的

一则以最后输入的7位为准

输入按键编码值,datain、d毗聊t分别表示从存储器读入

数据和向存储器输出数据,ledout为表示目前状态的三

3仿真结果

上述设计在MAX+PLUSII环境下仿真成功,并用FPGA芯片FLEXl0K实现。图3是控制模块的仿真波形。图中,smkey-Valid为键盘2的按键确认信号,sel为加减控制信号,为。时加,为1时减,由键盘2输入。scarl_f为分频后的信号,由键盘1模块输入。key-valid为键盘1的按键确认信号。8caIl_cntout为计效信号,当

.。.。n10.

幂‘j=叠D灯I‘反差萄芸霰簇。菇绿、黄、羞,绿色≮‘羞色表示

输入密码的正误,黄色表示正在重设密码。

在这里也可以根据前面的做法将操作时的数值显示在数码管上,既可以另加数码管,也可以利用原来的

价钱显示数码管。但在此设计中,采扇的是LED灯显示

状态。主要是为了简化电路,毕竟店方不是经常更改菜的信息。

下面对仿真结果进行说明。在这个例子中,假设初始密码是5555555,开机时从地址01100100读入储存的密码5555555,当按键连续输入7个5时,密码校对完成,可以开始操作。当按下100l号键(更改密码)时,假设需要更改成4444铂8,连续输入两次44d4448无误后即更改密码成功。dataout为4444448,随后输入菜号33(因为存储量很少,本文没有进行BcD与二进制的转换),表示对这个菜的信息进行更改。按确认键后,本例中故意输入8位菜的信息(应该输入7位)55515554以验证系统的容错能力。结果超过7位的数据系统可以成功地识别,并只取后7位5515554,dataout为5515554,完成信息修改。

参考文献

1林明权.vHDL数字控制系统设计范例.北京:电子工业出版社,2003

(收稿日期:2003—12—12)

key_Valid信号为1时,.对霉.的sc髓-cnt。u2即譬表此时所按下的键盘1的键的索引值。controladd为加减使能信

号,为1时表示加或减操作有效,可以进行加减运算,防

些力Ⅱ謦运算超出范围inu?disn.翼disllled登个信号控制菜名旁边的LED灯,前者为行使能,循环检测键盘1的

每一行,逐行使能,使得列使能信号dishled有效时点亮

弩粤紫LE竺灯:‘。talnum为菜的总数,each肌m为当前正在操作的菜望鳌量。

苎时,响应在.011号琴,,釜只按下“+”,警发锄key_V面ld,使con‘roladd为l,sel信号为0,表示加使能,totalnum和

下面对仿真结果进行说明。第一个key-vaild信号触

8achnum分型力11,在竖后凹numdish为01蔓,?1shled变成0001(表示第3个菜选中)。在后面的操作中又点中

了011号菜(选择一个比较特殊的情况),并按下“+”,totalnum和eachnum分别加1,随即又点r“一”,使得这两个信号各减了1。接下来001号菜被选中,并按下

(上接第66页)速度设为低速;

・其它情况时,前进速度为中速。5.3驱动电机和转向电机控制模块

驱动电机模块采取PID控制策略,将车速传感器检测的信号作为电机的反馈信号,进行PID控制,取得了很好的控制效果。转向控制模块的控制策略与驱动电机的类似,只是其反馈的信号为数字罗盘的方向信号。PID控制算式为:

列分别为PID控制算法的比例系数、积分常数和微分常数。

参考文献

l史新宏.智能交通系统的发展.北方交通大学学报,200226(1):29~34

2李现勇.Visualc++串口通信技术与工程实践.北京:人民邮电出版社,2002

3刘和平・TMS320LF240ⅨDsP结构、原理及应用.北京:北京航空航天大学出版社,2002

4黄英哲・TMs320c240原理与c语言控制应用实习.北京:

中国水利水电出版社,2003

5李庆中・移动机器人路径跟踪的智能预瞄控制方法研究,机器人,2002;24(3):252~255

(收稿日期:2003—12一12)

△“(后):勋【e(后)一e(_j}一1)]+尉.e(矗)+

尉fe(后)一2e(七一1)+e(尼一2)1

u(1j}):“(七一11+△M(Jc)

式中,口(后)为控制的输出;e(七)为尼时刻的偏差;勋、彪、

70

欢迎邮购本刊1995—1999年光盘版,每套100元《电子技术应用》2004年第6期

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

作者:作者单位:刊名:英文刊名:年,卷(期):被引用次数:

王洪升, 田蔚风, 金志华, 陈以蒙

王洪升,田蔚风,金志华(上海交通大学电子信息学院,200030), 陈以蒙(杭州浙江科技学院教育技术学系,310021)

电子技术应用

APPLICATION OF ELECTRONIC TECHNIQUE2004,30(6)5次

参考文献(5条)

1. 史新宏 智能交通系统的发展[期刊论文]-北方交通大学学报 2002(01)2. 李现勇 Visual C++串口通信技术与工程实践 20023. 刘和平 TMS320LF240X DSP结构、原理及应用 20024. 黄英哲 TMS320C240原理与C语言控制应用实习 2003

5. 李庆中 移动机器人路径跟踪的智能预瞄控制方法研究[期刊论文]-机器人 2002(03)

本文读者也读过(10条)

1. 杨扬. 颜文俊. YANG Yang. YAN Wen-jun 基于μC/OS-Ⅱ的机器人小车系统设计[期刊论文]-机电工程2006,23(7)2. 王洪升. 田蔚风. 金志华 一种面向智能交通的移动机器人控制系统[期刊论文]-自动化技术与应用2004,23(1)3. 童利标. 徐科军. 梅涛 基于IEEE 1451.1的网络化智能传感器设计[期刊论文]-单片机与嵌入式系统应用2002(7)4. 张兵. 张伟成. ZHANG BING. ZHANG WEICHENG 基于多DSP的滤波系统设计[期刊论文]-微计算机信息2007,23(17)5. 宋轶群. 杜华生. 王德新. 程刚 一种全自主移动机器人控制系统研究[期刊论文]-机械与电子2004(8)

6. 涂刚毅. 金世俊. 宋爱国. TU Gang-yi. JIN Shi-jun. SONG Ai-guo 基于多DSP的混合式结构自主移动机器人设计[期刊论文]-测控技术2007,26(12)

7. 兰自志. LAN Zizhi 四轮移动机器人运动控制系统设计[期刊论文]-南平师专学报2006,25(4)8. 陈磊 仿阿米巴机器人系统设计及其动力学仿真[学位论文]2010

9. 黄波 科学家研发出可垂直爬墙横越天花板的蜗牛机器人[期刊论文]-中小企业科技2006(2)10. 杨先碧 让机器人动感情[期刊论文]-世界科学2007(6)

引证文献(5条)

1. 姚楠. 曾连荪 基于CYGNAL内核开发的GPS/DR车载组合导航系统[期刊论文]-上海海事大学学报 2005(4)2. 宋巍巍. 王永. 李旺. 马海涛 基于巡线机器人的货物定位系统的设计和实现[期刊论文]-自动化仪表 2009(1)3. 陈以蒙. 王亦军 一种基于GPRS的DSP与PC机通信系统[期刊论文]-浙江科技学院学报 2004(4)4. 亢雪英 基于DSP的防爆机器人控制器的设计[学位论文]硕士 2005

5. 闫红力 基于DSP的液压双自由活塞发动机控制系统的研究[学位论文]硕士 2005

本文链接:http://d.g.wanfangdata.com.cn/Periodical_dzjsyy200406023.aspx

集成电路应用

■手DSP的移动机■人的设计与实曩

上海交通大学电子信息学院(200030)

王洪升

田蔚风金志华

杭州浙江科技学院教育技术学系(3l0021)

陈以蒙

要:智能交通系统是2l世纪城市交通的发展方向,移动机器人作为智能车辆控制系统实验

平台的一个主要部分,对智能交通系统的关键技术的研究具有十分重要的意义。介绍了面向智能交通系统的S盯NC一1移动机器人的组成和结构,并详细叙述了基于数字信号处理器TMS320LF2407A的控制系统的设计和实现。

关键词:智能交通系统

移动机器人

数字信号处理器

双10位A/D转换器和CAN控制器模块。

智能交通系统(nls)的概念是美国智能交通学会于1990年提出的,它将先进的信息技术、通信技术、自动控制技术、电子技术及计算机处理技术综合运用于整个运输管理系统中,通过对交通信息的采集、传输和处理,对交通运输进行协调和管理,建立起实时、准确、高效的综合交通运输管理体系,从而提高了交通效率和安全了,实现性交通运输服务和管理的智能化。

智能车辆的导航与定位、自动驾驶与控制和车辆的预警防碰等智能交通系统关键技术的研究,近年来受到国内外越来越广泛的关注,也取得了丰硕的成果。但真正的实验研究还是很少,基本上只进行了仿真试验。鉴于理论上的模拟和实际应用情况可能相差甚远,选择了具有智能性、易扩展性和移动性等优点的车型移动机器

2移动机器人的运动机构

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

3移动机器人控制系统

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

DGPs接收机

COM2

人作为rrS关键技术的研究平台中的主要部分——车

辆模拟器。

本文所阐述的移动机器人SJTNC一1,就是面向rrs提出的。考虑到关键技术研究中需进行大量的计算,如模糊控制、卡尔曼滤波和路径导引等,并且系统对数据的实时性要求很高,所以采用数字信号处理器(DSP)作为移动机器人主控CPU。

TMS320LF2407A简介

’rMS320LF2407A(以下简称F2407)是1rI公司在

4转1串口

通信模块COM3

COMl

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

64

转向数字

COM3

无线通信模块

罗盘

SCI

I/O

QEP

电机

A/D检流

驱动

模块

PWMPWM

图l控制系统结构框图

欢迎邮购本刊1995~1999年光盘版,每套lOO元

《电子技术应用》2004年第6期

集成电路应用

向的反馈量进行PID控制。整个控制系统把DGPs接收机的位置信息作为系统的位置反馈信息,用以完成整个系统的位置闭环控制。3.1无线通信模块

MC35是德国西门子公司生产的可二次开发的支持GPRS的双频GSM模块,可以通过标准串口与PC机相连。本系统用MC35作为移动机器人与上位机的通信模块。它具有GPRS技术带来的一切优点,如一直在线和提供高速价廉的数据传送服务等。该产品的特性如下:

・支持双频:EGSM900/GSMl800・支持GPRSClass8协议

・支持数据、语音、短消息和传真服务

・采用电路交换方式,最大传送速率为14.4kbps・支持的电压范围:8V一30V・采用标准工业接口・体积:65mm×74mm×33mm・重量:13093.2驱动模块

驱动电机和转向电机的驱动原理相同,都采用脉宽调制(PWM)方式进行调速,PWM信号由F2407产生。驱动电路采用H全桥方式,由4个达林顿管(2个TIPl32和2个TIPl37)、4个IN4001二极管及与非门组成。电路原理图如图2所示。当PWM2、PWM4为低电平而PWMl、PWM3为高电平时,T1、T4饱和导通,rI’2、T3截

块都采用RS一232异步串行通信,而F2407只有一个串行口,所以必须将4个串口数据通过转换处理来完成与F2407的串口通信。为此研制了基于分时复用方法的4转1串口通信模块。当F2407需要某个传感器(或无线通信模块)的数据时,就通过电路选通该传感器占用F2407串口进行通信;当需要另外传感器或无线通信模块数据时,则关断上次传感器的选通,同时选通该次传感器或无线通信模块。4转1串口通信模块由3—8译码器74LSl38、三态输出的四总线缓冲门74LSl25和电平转换器MAX232等组成,其电路原理图如图3所示。

止,电流从T1一电机一T4,电机正转;反之,当PWMl、

PWM3为低电平而PWM2、PWM4为高电平时,rIl2、rI’3饱

和导通,T1、T4截止,电流从,I'2一电机一,I.3,电机反转。

图34转l串口通信模块电路原理图

3.4定位传感器

3.4.1

DGPS接收机

GPS(全球定位系统)是基于卫星的无线电导航系统,它提供一种廉价实用的可在全球范围内确定位置、速度和时间的工具。GPs由24颗卫星(21颗工作星、3颗备份星)组成星座,星座分布在与地球赤道面倾角为55。的6个轨道面上,其运行周期为11小时58分,轨道半径为20200km,各轨道面夹角为60。。每颗卫星向地球发射L频段的特高连续波,调制两种伪随机码(军用高

图2电机驱动电路原理图

精度保密P码和民用C/A码)。这样的分布特点保证了用户在地球上任何地点、任何时间至少可以连续地收到

为防止T1、T3或,112、T4同时导通,形成短路而击穿器件,要用一对无重叠的PWM输出去正确地开启和关断这两对管子。在一个管子关断和另一个管子开启之间加入死区时间,这样就使得一个管子开启前,另一个管子已完全关断。F2407具有死区控制单元是其一大特色,从而可用软件确保功率电路上下桥臂开关元件的开通区间没有重叠,简化了硬件电路设计,提高了可靠性。

3.34转1串口通信模块

4颗以上卫星的导航信号,从而联立解算出接收机的三维坐标以及接收机和GPs间的时间偏移。三维坐标采用ECEF笛卡儿坐标系或大地坐标系如WGS84。

虽然美国政府于2001年5月取消了民用C/A码的可选择性保护,但民用导航型GPs接收机的单点实时定位精度只能达到25m左右,不能满足系统的定位导航要求。而采用实时差分GPS(DGPs),其定位精度可以达到2—5m,该精度已能满足系统定位和导航的要求。

为此研发了单基站DGPs(SRDGPs)系统,其结构框

由于DGPs接收机、磁罗盘、里程计和MC35通信模

《电子技术应用》2004年第6期本刊投稿邮箱:eta@ncse.com.cn

65

集成电路应用

图如图4所示。基准站由AUS’rAR

BASE

GPs接收机、其弊端。系统的框架如图5所示。下面对关键的几大模块进行简要的阐述。

天线和MDS无线电发射台、天线组成,流‘动站由SU-

PERSTAR

GPS接收机、天线和MDX无线电接收台、天

线组成。其中基准站安装在上海交大徐家汇校区教学一楼楼顶,该基准站能覆盖方圆30公里的范围,流动站安装在车载单元上。

GPS天线

电台天线

电台天线GpS天线

基准站部分

图4

流动站部分

DGPS的结构框图

图5软件控制系统框图

5.1串口通信模块

该模块程序采用串口中断方式实现,主程序主要由系统初始化、串口初始化、串口中断设置和等待中断组成。而中断子程序分为发送子程序和接收子程序。本文给出发送子程序流程图。主程序及发送子程序流程图如图6所示。

3.4.2数字罗盘和车速传感器

采用HoneyWell公司的HMR3300数字罗盘作为移动机器人的方向检测传感器。其主要技术指标为:(1)1度航向精度,0.1度分辨率;(2)0.5度重复性;(3)±60度倾斜俯仰范围;(4)15Hz响应时间;(5)一40±85度工作温度;(6)6—15V直流电压。

同时采用用于大众汽车公司桑塔纳2000型轿车的霍尔车速传感器作为移动机器人的车速传感器。其工作原理是以霍尔传感器为变换元件,将机械旋转量转化为电脉冲信号输出。主要技术指标为:(1)输出波形为矩形脉冲,占空比为50%;(2)每旋转一周产生6个脉冲;(3)额定电压为12V。

4电源模块

电源模块需分别给各传感器、DSP芯片、其它芯片和电机供电。其中,磁罗盘、码盘和DGPs接收机使用12V直流电压,DSP芯片使用3.3V直流电压,其它芯片使用5V直流电压,还有电机电源使用12V直流电压。所以,采用1节12V的直流蓄电池(4AH),直流5V通过ST半导体公司的L7805和扩流用的功率管实现,DSP芯片

用3.3V电源采用ON半导体公司的1SMB5913鹏实现。

F2407正常工作时,所有电源管脚都为3.3V;写入FL~SH存储器时,VCCP引脚为5V供电;复位时,复位电路会产生一个10斗s宽度的持续低电平使芯片复位。

图6串口通信模块主程序及发送子程序流程

5.2路径引导模块

该模块在移动机器人行驶中为其提供实时的速度和转向指令,从而引导它沿着上位机给定的路径行驶。主要包括行驶指令的产生和规划路径的跟踪两个环节。

根据预瞄跟随理论及驾驶员的开车行为特性,智能行驶和驾驶员操纵行为是内在一致的。通过研究有驾驶员操纵行为,发现主要根据两个因素决定车辆的前进速度,这两个因素分别是道路的弯曲程度和机器人相对参考路径上的方向偏差。

移动机器人的前进速度的控制不需要连续变化,可设置为三档,分别对应高、中和低三个速度。由此确定的前进速度跟踪规则为:

・当方向偏差小于10度时,路径基本为直线,前进速度设为高速;

・当方向偏差小于90度时,路径弯曲较严重,前进

(下转第70页)

5控制器程序结构

DsP程序由五大功能模块组成,分别为系统初始化模块、串口通信模块、路径引导模块、驱动电机控制模块和转向电机控制模块。TI公司提供了用于C语言开发的CC和CCS平台。该平台包括了ANSIC优化编译器,从而可以在源程序级进行开发调试。这种方式大大提高了软件的开发速度和可读性,方便了软件的修改和移植。但在某些情况下,代码的效率还是无法与手工编写的汇编代码的效率相比。此外,用C语言实现芯片的某些硬件控制也不如汇编程序方便,有些甚至无法用语言实现。为了充分利用芯片的资源,更好地发挥C语言和汇编语言进行软件开发的各自优点,采用混合编程方法将两者有机结合起来,兼顾两者的优点,避免

66

欢迎邮购本刊1995—1999年光盘版,每套100元《电子技术应用》2004年第6期

集成电路应用

i:f(pricestate=”000”aJldbutt-code/=”1011”)then

savedata(27downto24)<=butt_code;

pricestate:=”00l”;ledout<=”101”;

“+”,totalnum变成了2,而eachnum为l,然后授p

lul,

并没有操作,按下111后再按下“一”,但是因为之前并没有选择过,所以信号无变化。随后numdish扫描到01,dishled为0101表示选中了001号和011号菜。

图4是信息调整模块的仿真波形。图中,dressout为存储器的地址,key-valid为按键有效信号(实际上不应

—-循环接收(语句省略)菜的信息,包括口味和价钱,如果输入的数超过7位,

elsif(叫ce8t8te=”111”鲫d

一一重置语句(略)

butt.code=”1011”)then

该是有规律的,这里只是为了方便起见),1棚te、read分别为写、读信号,cs为使能信号,butLcode为4×3键盘的

一则以最后输入的7位为准

输入按键编码值,datain、d毗聊t分别表示从存储器读入

数据和向存储器输出数据,ledout为表示目前状态的三

3仿真结果

上述设计在MAX+PLUSII环境下仿真成功,并用FPGA芯片FLEXl0K实现。图3是控制模块的仿真波形。图中,smkey-Valid为键盘2的按键确认信号,sel为加减控制信号,为。时加,为1时减,由键盘2输入。scarl_f为分频后的信号,由键盘1模块输入。key-valid为键盘1的按键确认信号。8caIl_cntout为计效信号,当

.。.。n10.

幂‘j=叠D灯I‘反差萄芸霰簇。菇绿、黄、羞,绿色≮‘羞色表示

输入密码的正误,黄色表示正在重设密码。

在这里也可以根据前面的做法将操作时的数值显示在数码管上,既可以另加数码管,也可以利用原来的

价钱显示数码管。但在此设计中,采扇的是LED灯显示

状态。主要是为了简化电路,毕竟店方不是经常更改菜的信息。

下面对仿真结果进行说明。在这个例子中,假设初始密码是5555555,开机时从地址01100100读入储存的密码5555555,当按键连续输入7个5时,密码校对完成,可以开始操作。当按下100l号键(更改密码)时,假设需要更改成4444铂8,连续输入两次44d4448无误后即更改密码成功。dataout为4444448,随后输入菜号33(因为存储量很少,本文没有进行BcD与二进制的转换),表示对这个菜的信息进行更改。按确认键后,本例中故意输入8位菜的信息(应该输入7位)55515554以验证系统的容错能力。结果超过7位的数据系统可以成功地识别,并只取后7位5515554,dataout为5515554,完成信息修改。

参考文献

1林明权.vHDL数字控制系统设计范例.北京:电子工业出版社,2003

(收稿日期:2003—12—12)

key_Valid信号为1时,.对霉.的sc髓-cnt。u2即譬表此时所按下的键盘1的键的索引值。controladd为加减使能信

号,为1时表示加或减操作有效,可以进行加减运算,防

些力Ⅱ謦运算超出范围inu?disn.翼disllled登个信号控制菜名旁边的LED灯,前者为行使能,循环检测键盘1的

每一行,逐行使能,使得列使能信号dishled有效时点亮

弩粤紫LE竺灯:‘。talnum为菜的总数,each肌m为当前正在操作的菜望鳌量。

苎时,响应在.011号琴,,釜只按下“+”,警发锄key_V面ld,使con‘roladd为l,sel信号为0,表示加使能,totalnum和

下面对仿真结果进行说明。第一个key-vaild信号触

8achnum分型力11,在竖后凹numdish为01蔓,?1shled变成0001(表示第3个菜选中)。在后面的操作中又点中

了011号菜(选择一个比较特殊的情况),并按下“+”,totalnum和eachnum分别加1,随即又点r“一”,使得这两个信号各减了1。接下来001号菜被选中,并按下

(上接第66页)速度设为低速;

・其它情况时,前进速度为中速。5.3驱动电机和转向电机控制模块

驱动电机模块采取PID控制策略,将车速传感器检测的信号作为电机的反馈信号,进行PID控制,取得了很好的控制效果。转向控制模块的控制策略与驱动电机的类似,只是其反馈的信号为数字罗盘的方向信号。PID控制算式为:

列分别为PID控制算法的比例系数、积分常数和微分常数。

参考文献

l史新宏.智能交通系统的发展.北方交通大学学报,200226(1):29~34

2李现勇.Visualc++串口通信技术与工程实践.北京:人民邮电出版社,2002

3刘和平・TMS320LF240ⅨDsP结构、原理及应用.北京:北京航空航天大学出版社,2002

4黄英哲・TMs320c240原理与c语言控制应用实习.北京:

中国水利水电出版社,2003

5李庆中・移动机器人路径跟踪的智能预瞄控制方法研究,机器人,2002;24(3):252~255

(收稿日期:2003—12一12)

△“(后):勋【e(后)一e(_j}一1)]+尉.e(矗)+

尉fe(后)一2e(七一1)+e(尼一2)1

u(1j}):“(七一11+△M(Jc)

式中,口(后)为控制的输出;e(七)为尼时刻的偏差;勋、彪、

70

欢迎邮购本刊1995—1999年光盘版,每套100元《电子技术应用》2004年第6期

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

作者:作者单位:刊名:英文刊名:年,卷(期):被引用次数:

王洪升, 田蔚风, 金志华, 陈以蒙

王洪升,田蔚风,金志华(上海交通大学电子信息学院,200030), 陈以蒙(杭州浙江科技学院教育技术学系,310021)

电子技术应用

APPLICATION OF ELECTRONIC TECHNIQUE2004,30(6)5次

参考文献(5条)

1. 史新宏 智能交通系统的发展[期刊论文]-北方交通大学学报 2002(01)2. 李现勇 Visual C++串口通信技术与工程实践 20023. 刘和平 TMS320LF240X DSP结构、原理及应用 20024. 黄英哲 TMS320C240原理与C语言控制应用实习 2003

5. 李庆中 移动机器人路径跟踪的智能预瞄控制方法研究[期刊论文]-机器人 2002(03)

本文读者也读过(10条)

1. 杨扬. 颜文俊. YANG Yang. YAN Wen-jun 基于μC/OS-Ⅱ的机器人小车系统设计[期刊论文]-机电工程2006,23(7)2. 王洪升. 田蔚风. 金志华 一种面向智能交通的移动机器人控制系统[期刊论文]-自动化技术与应用2004,23(1)3. 童利标. 徐科军. 梅涛 基于IEEE 1451.1的网络化智能传感器设计[期刊论文]-单片机与嵌入式系统应用2002(7)4. 张兵. 张伟成. ZHANG BING. ZHANG WEICHENG 基于多DSP的滤波系统设计[期刊论文]-微计算机信息2007,23(17)5. 宋轶群. 杜华生. 王德新. 程刚 一种全自主移动机器人控制系统研究[期刊论文]-机械与电子2004(8)

6. 涂刚毅. 金世俊. 宋爱国. TU Gang-yi. JIN Shi-jun. SONG Ai-guo 基于多DSP的混合式结构自主移动机器人设计[期刊论文]-测控技术2007,26(12)

7. 兰自志. LAN Zizhi 四轮移动机器人运动控制系统设计[期刊论文]-南平师专学报2006,25(4)8. 陈磊 仿阿米巴机器人系统设计及其动力学仿真[学位论文]2010

9. 黄波 科学家研发出可垂直爬墙横越天花板的蜗牛机器人[期刊论文]-中小企业科技2006(2)10. 杨先碧 让机器人动感情[期刊论文]-世界科学2007(6)

引证文献(5条)

1. 姚楠. 曾连荪 基于CYGNAL内核开发的GPS/DR车载组合导航系统[期刊论文]-上海海事大学学报 2005(4)2. 宋巍巍. 王永. 李旺. 马海涛 基于巡线机器人的货物定位系统的设计和实现[期刊论文]-自动化仪表 2009(1)3. 陈以蒙. 王亦军 一种基于GPRS的DSP与PC机通信系统[期刊论文]-浙江科技学院学报 2004(4)4. 亢雪英 基于DSP的防爆机器人控制器的设计[学位论文]硕士 2005

5. 闫红力 基于DSP的液压双自由活塞发动机控制系统的研究[学位论文]硕士 2005

本文链接:http://d.g.wanfangdata.com.cn/Periodical_dzjsyy200406023.aspx


相关内容

  • 电气专业的一些毕业设计题目
  • 电气专业的一些毕业设计题目 电子类: 1.红外遥控照明灯(电路+程序+论文) 2.基于单片机的多功能智能小车设计论文(电路+程序+论文) 3.基于数字信号处理器(DSP)的异步电机直接转矩控制研究(硕士)(论文+上位机下位机软件+程序) 4.简单温度控制系统(仅论文) 5.漏电保护器(电路+程序+论 ...

  • DSP的应用及发展趋势
  • DSP的应用及发展趋势 一.引言DSP即为数字信号处理器(DigitalSignalProcessing),是在模拟信号变换成数字信号以后进行高速实时处理的专用处理器.它的工作原理是将现实世界的模拟信号转换成数字信号,再用数学方法处理此信号,得到相应的结果.自从数字信号处理器(DigitalSign ...

  • 嵌入式系统课程设计选题要求及题目
  • 嵌入式系统课程设计-选题要求及课题 1.嵌入式系统课程设计时长两星期,要求学生分组进行课程设计,每组学生人数为2-3人(可在不超过3人的范围内由指导教师具体规定),报告雷同超过60%者,成绩都记不及格! 2.学生需要在附后的设计题目总表中进行选题,原则上需要在6月17号前完成选题,并开始课程设计工作 ...

  • 机器人视觉识别系统研究毕业论文设计
  • 西南科技大学城市学院 毕业论文(设计) 论文题目: 机器人视觉识别系统研究 系 别: 机电工程系 专 业: 自动化 毕业设计(论文)原创性声明和使用授权说明 原创性声明 本人郑重承诺:所呈交的毕业设计(论文),是我个人在指导教 师的指导下进行的研究工作及取得的成果.尽我所知,除文中特别加 以标注和致 ...

  • 通风除尘管道清洗机器人的开发
  • 第21卷第12期清洗世界 VoL21No12 :!篮圭!:旦 :::::尘!::翌 2=::!: ・新技术.新工艺・ 通风除尘管道清洗机器人的开发 毛立民 (东华大学机械工程学院,上海200051) 摘要东华大学在原有一项发明专利基础上进行二次开发,发明了一种新型非等径.变截面管道机器人行走机构,并 ...

  • 自动化工程导论报告
  • 工程导论 供电系统设计 核心理论 When an application command S1 is supplied from a master power supply, a control circuit 11 sends a command S2 for application of pow ...

  • 微弱信号检测的前置放大电路设计
  • 文章编号:1008-0570(2009)08-2-0223-02 电子设计 微弱信号检测的前置放大电路设计 The design of preamplifier circuit based on weak signal detection (1.上海交通大学;2. 国家农业信息化工程技术研究中心) ...

  • 焊接机器人毕业设计
  • VI1.1论文的选题意义 第1章绪论 自动化的焊接机器人能提供稳定地焊接质量,减轻人的劳动强度,提高工作 效率,降低生产成本,在工业领域得到了广泛的应用.但应用于工业生产中的焊 接机器人大多是固定的,主要通过机械臂的活动来工作,又由于空间的限制使得 机器人的工作范围.工作对象大大受到限制.在大型工件 ...

  • 工业机器人1
  • 工业码垛机器人简介与分析 中文摘要: 本文简述了工业码垛机器人的诞生.发展概况.以及工业码垛机器人的结构介绍,机构分析以及空间运动分析,对码垛机器人的机构运用了数学分析推导, 推导了运动学正反解公式及最大工作空间的判断且规划了运动路径, 进行了图形仿真, 验证了运动轨迹的正确性,通过软件对机器人的空 ...