基于DSP的机器人视觉伺服系统研究
时间：04-17
来源：
点击：
1. 引言
机器人视觉伺服系统是机器人领域中的重要研究方向，起源于80年代初，随着计算机技术、图像处理技术、控制理论的发展，取得了很大进步，有一些系统已投入使用。视觉伺服跟通常所说的机器视觉有所不同，视觉伺服是利用机器视觉的原理，进行图像的自动获取分析，从直接得到的图像处理反馈信息中，快速进行图像处理，在尽量短的时间内给出反馈信号，构成机器人的位置闭环控制，实现对机器人的控制。正是由于系统以实现某种控制为目的，所以视觉伺服系统中的图像处理过程必须快速准确。本文主要针对机器人视觉伺服系统要求快速准确的特点，为满足项目研究的需要，讨论研究了基于DSP的图像反馈机器人视觉伺服技术。
2 . 系统工作原理及硬件构成
基于图像的视觉伺服直接计算图像误差，产生控制信号，并变换到机器人运动空间，驱动机械手，完成伺服任务。该方法对标定误差和空间模型误差不敏感。
对于机器人视觉伺服系统,实时性问题一直是一个难以解决的重要问题。图像采集速度较低以及图像处理需要较长时间会给系统带来明显的时滞;此外视觉信息的引入也明显增大了系统的计算量。而图像处理速度是影响视觉伺服系统实时性的主要瓶颈之一。
实时图像处理设计的难点是如何在有限的时间内完成对大量图像数据的处理。从人的视觉理论分析，只有图像处理系统的处理速度达每秒25帧以上时才能达到实时的效果，即要求实时图像处理系统必须在40ms内完成对一帧l图像的运算处理，才能保证图像的实时性。为了达到该处理速度，我们采用了基于DSP的图像视觉伺服方式，其结构如图1所示。
2.1 WTC6201PA板简介
本文选用了闻亭公司的WTC6201PA板，其板上硬件组成如图2所示。
WTC6201PA板属于EVM板中的一种，它采用了TI公司的DSP器件TMS320C6201芯片。TMS320C6201芯片的最高时钟频率为200MHZ，每个时钟周期最多可以执行8条指令，从而实现16000MIPS的定点运算能力，它具有如下主要特点：
采用了修正的哈佛总线结构，独立的程序总线、数据总线和DMA总线使得取指、读写数据和DMA操作可以并行。
采用流水线处理，使两个或多个不同的操作可以重叠执行，提高了程序执行速度。
具有高性能的外部存储器扩展接口EMIF，可以直接与同步突发静态存储器SBSRAM、同步动态存储器SDRAM连接，用于大容量、高速存储;还包括直接异步存储器接口，可与静态存储器SRAM、只读存储器EPROM连接，用于小容量的数据存储和程序存储;芯片内部集成的64K程序存储器可配置成CASHE，以提高程序执行效率。
16位主机口能够和其它CPU的存储区以及外围电路进行通信。且多通道DMA控制器可在没有CPU参与的情况下完成映射存储空间中的数据搬移，从而减轻CPU的工作量。
同时板上配置了高速同步存储器SBSRAM（128K×32Bit）和SDRAM（4M×32bit），两路A/D转换器，大容量的FPGA器件和外部I/O接口，板上还提供了一个McBSP接口，兼容5V TTL电平，方便用户与外部系统通信。WT6201PA板满足PCI Local Bus Revision 2.1 协议，主机可访问DSP的所有资源，用户可通过主机加载程序。WTC6201PA板提供了Win98和NT下的驱动软件及DSP的应用软件（APIs），利用这个硬件平台和底层软件库，用户可以很容易的进行软件开发。
2.2 系统硬件实现
我们选用了WTC6201PA板上的TMS320C6201芯片、FPGA、SBSRAM、SDRAM、双口RAM、PCI总线、JTAG接口等硬件资源作为视觉图像处理单元，和PC主控机、图像采集卡、CCD摄像机和机器人控制系统组成系统，原理框图如图3所示。
系统工作过程如下：
CCD摄像机输出标准制式的全电视信号，其中包含着图像信号、复合同步信号、行、场消隐信号、槽脉冲和前后均衡脉冲等七种信号。本系统采用了北京大恒公司的DH-PCI-H图像采集卡来实现视频信号的预处理。CCD摄像机将视频数据输入到图像采集卡，图像采集卡按照设定的窗口位置、大小和方式采集视频数据，采集的数据存储在计算机的内存中。图像传输由图像卡控制的，无需CPU参与，图像传输速度可达40MB/S。
设置图像采集卡的采集方式是25帧/s连续采集，则采集一帧的时间为40ms，每一帧图像由奇偶两场组成，场频为50HZ，即一场扫描时间为20ms。图像采集大小为512×512像素，量化为8bit，256灰度级，则一帧图像的数据量为512×512×8bit=256KB。图像数据存储方式为隔行存放，即奇、偶场的图像数据交叉存放，组成一帧完整图像函数。
C6201由BOOTMODE[4:0]设置芯片的自举方式，加载过程采用主机（HPI）引导方式。外部主机通过主机口初始化CPU的存储空间，主机完成所有的初始化后，将主机口控制寄存器中的DSPINT位设置为1，结束引导过程。CPU退出复位状态，开始执行地址0处的指令。
系统上电后，主机经HPI口对系统初始化，主要完成对各寄存器的设置，包括EMIF、中断、DMA等相关的寄存器初始化操作等。主机向HPI控制寄存器的DSPINT位写1触发DSP运行，系统进入等待状态。CCD摄像机实时采集图像，经图像采集卡处理后存储到主机内存。PC机内存缓冲区一帧存满，向DSP发中断信号，DSP应答后，通过PCI总线将图像数据从主机内存经HPI口传输到WTC6201PA板片外SDRAM。DSP控制波门范围内图像数据以DMA方式传输到内部数据存储器。由于DSP为指令结构处理芯片，具有可编程性好、可以处理大量复杂指令（由程序RAM地址空间的大小决定）等优点，但相对FPGA而言其处理速度比较慢;而FPGA为可编程逻辑器件，具有很强的细粒度并行处理和多级流水线处理能力，但其内部有限的逻辑资源使之不适合实现复杂逻辑运算。因此我们采用FPGA作为协处理器来完成底层操作，再由DSP完成高层操作，两种操作可以采用流水线的方式并行运行，共同完成高速图像处理。从FPGA到DSP之间的图像数据传输使用双端口RAM。处理完一帧图像后，DSP向主机发信息，主机应答后，将图像处理结果经PCI总线传输至PC机内存，PC机再将位置偏差数据信号送至伺服控制系统，完成伺服任务。
机器人视觉伺服系统是机器人领域中的重要研究方向，起源于80年代初，随着计算机技术、图像处理技术、控制理论的发展，取得了很大进步，有一些系统已投入使用。视觉伺服跟通常所说的机器视觉有所不同，视觉伺服是利用机器视觉的原理，进行图像的自动获取分析，从直接得到的图像处理反馈信息中，快速进行图像处理，在尽量短的时间内给出反馈信号，构成机器人的位置闭环控制，实现对机器人的控制。正是由于系统以实现某种控制为目的，所以视觉伺服系统中的图像处理过程必须快速准确。本文主要针对机器人视觉伺服系统要求快速准确的特点，为满足项目研究的需要，讨论研究了基于DSP的图像反馈机器人视觉伺服技术。
2 . 系统工作原理及硬件构成
基于图像的视觉伺服直接计算图像误差，产生控制信号，并变换到机器人运动空间，驱动机械手，完成伺服任务。该方法对标定误差和空间模型误差不敏感。
对于机器人视觉伺服系统,实时性问题一直是一个难以解决的重要问题。图像采集速度较低以及图像处理需要较长时间会给系统带来明显的时滞;此外视觉信息的引入也明显增大了系统的计算量。而图像处理速度是影响视觉伺服系统实时性的主要瓶颈之一。
实时图像处理设计的难点是如何在有限的时间内完成对大量图像数据的处理。从人的视觉理论分析，只有图像处理系统的处理速度达每秒25帧以上时才能达到实时的效果，即要求实时图像处理系统必须在40ms内完成对一帧l图像的运算处理，才能保证图像的实时性。为了达到该处理速度，我们采用了基于DSP的图像视觉伺服方式，其结构如图1所示。
2.1 WTC6201PA板简介
本文选用了闻亭公司的WTC6201PA板，其板上硬件组成如图2所示。
WTC6201PA板属于EVM板中的一种，它采用了TI公司的DSP器件TMS320C6201芯片。TMS320C6201芯片的最高时钟频率为200MHZ，每个时钟周期最多可以执行8条指令，从而实现16000MIPS的定点运算能力，它具有如下主要特点：
采用了修正的哈佛总线结构，独立的程序总线、数据总线和DMA总线使得取指、读写数据和DMA操作可以并行。
采用流水线处理，使两个或多个不同的操作可以重叠执行，提高了程序执行速度。
具有高性能的外部存储器扩展接口EMIF，可以直接与同步突发静态存储器SBSRAM、同步动态存储器SDRAM连接，用于大容量、高速存储;还包括直接异步存储器接口，可与静态存储器SRAM、只读存储器EPROM连接，用于小容量的数据存储和程序存储;芯片内部集成的64K程序存储器可配置成CASHE，以提高程序执行效率。
16位主机口能够和其它CPU的存储区以及外围电路进行通信。且多通道DMA控制器可在没有CPU参与的情况下完成映射存储空间中的数据搬移，从而减轻CPU的工作量。
同时板上配置了高速同步存储器SBSRAM（128K×32Bit）和SDRAM（4M×32bit），两路A/D转换器，大容量的FPGA器件和外部I/O接口，板上还提供了一个McBSP接口，兼容5V TTL电平，方便用户与外部系统通信。WT6201PA板满足PCI Local Bus Revision 2.1 协议，主机可访问DSP的所有资源，用户可通过主机加载程序。WTC6201PA板提供了Win98和NT下的驱动软件及DSP的应用软件（APIs），利用这个硬件平台和底层软件库，用户可以很容易的进行软件开发。
2.2 系统硬件实现
我们选用了WTC6201PA板上的TMS320C6201芯片、FPGA、SBSRAM、SDRAM、双口RAM、PCI总线、JTAG接口等硬件资源作为视觉图像处理单元，和PC主控机、图像采集卡、CCD摄像机和机器人控制系统组成系统，原理框图如图3所示。
系统工作过程如下：
CCD摄像机输出标准制式的全电视信号，其中包含着图像信号、复合同步信号、行、场消隐信号、槽脉冲和前后均衡脉冲等七种信号。本系统采用了北京大恒公司的DH-PCI-H图像采集卡来实现视频信号的预处理。CCD摄像机将视频数据输入到图像采集卡，图像采集卡按照设定的窗口位置、大小和方式采集视频数据，采集的数据存储在计算机的内存中。图像传输由图像卡控制的，无需CPU参与，图像传输速度可达40MB/S。
设置图像采集卡的采集方式是25帧/s连续采集，则采集一帧的时间为40ms，每一帧图像由奇偶两场组成，场频为50HZ，即一场扫描时间为20ms。图像采集大小为512×512像素，量化为8bit，256灰度级，则一帧图像的数据量为512×512×8bit=256KB。图像数据存储方式为隔行存放，即奇、偶场的图像数据交叉存放，组成一帧完整图像函数。
C6201由BOOTMODE[4:0]设置芯片的自举方式，加载过程采用主机（HPI）引导方式。外部主机通过主机口初始化CPU的存储空间，主机完成所有的初始化后，将主机口控制寄存器中的DSPINT位设置为1，结束引导过程。CPU退出复位状态，开始执行地址0处的指令。
系统上电后，主机经HPI口对系统初始化，主要完成对各寄存器的设置，包括EMIF、中断、DMA等相关的寄存器初始化操作等。主机向HPI控制寄存器的DSPINT位写1触发DSP运行，系统进入等待状态。CCD摄像机实时采集图像，经图像采集卡处理后存储到主机内存。PC机内存缓冲区一帧存满，向DSP发中断信号，DSP应答后，通过PCI总线将图像数据从主机内存经HPI口传输到WTC6201PA板片外SDRAM。DSP控制波门范围内图像数据以DMA方式传输到内部数据存储器。由于DSP为指令结构处理芯片，具有可编程性好、可以处理大量复杂指令（由程序RAM地址空间的大小决定）等优点，但相对FPGA而言其处理速度比较慢;而FPGA为可编程逻辑器件，具有很强的细粒度并行处理和多级流水线处理能力，但其内部有限的逻辑资源使之不适合实现复杂逻辑运算。因此我们采用FPGA作为协处理器来完成底层操作，再由DSP完成高层操作，两种操作可以采用流水线的方式并行运行，共同完成高速图像处理。从FPGA到DSP之间的图像数据传输使用双端口RAM。处理完一帧图像后，DSP向主机发信息，主机应答后，将图像处理结果经PCI总线传输至PC机内存，PC机再将位置偏差数据信号送至伺服控制系统，完成伺服任务。
- 基于DSP的自动避障小车(04-05)
- 基于DSP的双足机器人运动控制系统设计(06-21)
- 用于日本震后救援的机器人技术(03-03)
- 基于TMS32OLF2407A的教育机器人硬件系统设计 (08-21)
- 基于DSP的覆冰机器人控制系统设计(02-13)
- 基于DSP和FPGA的机器人声控系统设计(02-26)
闁诲繐绻愮€氫即銆傞懜鐢碘枖闁规崘灏欓悷褰掓煕閳哄喚鏀版い鏂垮瀵偄鈻庨幋鏃€鐓犻梺瑙勪航閸斿繐鐣烽敓锟�
- 婵°倕鍊瑰玻鎸庮殽閸モ晙鐒婇柛鏇ㄥ灱閺嗐儳鈧鎮堕崕鎶藉煝閼测晜鏆滈柛顐ｇ箓閹鏌熺€涙ê濮囬柣鎾规硶閹峰顢橀悢鍛婄暚缂備礁顑呴鍛淬€冨⿰鍛晳闁跨噦鎷�
闂佺ǹ绻堥崝宥夊蓟閻斿憡濯寸€广儱鎷嬮崝鍛槈閺冨倸孝闁汇劎濮甸敍鎰板箣濠婂懐鎳囨繛鎴炴尰濮樸劑鎮￠敍鍕珰闁糕槅鍘剧粈澶愭煙缂佹ê濮囩€规洖鐭傞幆宥夊棘閸喚宀涢悗瑙勬偠閸庢壆绱為弮鍫熷殑闁芥ê顦～鏃堟煥濞戞ǹ瀚板┑顕呬邯楠炲啴濡搁妷锕€娓愰梻渚囧亞閸犳劙宕瑰鑸碘拹濠㈣埖鐡曠粈瀣归崗鍧氱細妞ゎ偄鎳橀幆鍐礋椤愩倖顔忔俊顐ゅ閸ㄥ灚瀵奸幇顔剧煓閻庯綆浜為悷锟�...
- 婵炴垶鎼╅崢鐐殽閸モ晙鐒婇柛鏇ㄥ灱閺嗐儳鈧鎮堕崕鎶藉煝閼测晜鏆滈柛顐ｇ箓閹鏌熺€涙ê濮囬柣鎾规硶閹峰顢橀悢鍛婄暚缂備礁顑呴鍛淬€冨⿰鍛晳闁跨噦鎷�
缂備緡鍣ｇ粻鏍焵椤掑﹥瀚�30婵犮垼鍩栧畝绋课涢鍌欑剨闁告洦鍨奸弳銉╂煕閳哄喚鏀版い鏂垮閹风娀宕滆閺屻倝鏌ㄥ☉妯侯殭缂佹鎸鹃埀顒傤攰閸╂牕顔忕捄銊﹀珰闁规儳鎳愮粈澶愭煕閺傜儤娅呮い鎺斿枛瀹曘劌螣閻戞ê娓愰梻渚囧亞閸犳洟骞撻鍫濈濡鑳堕鍗炩槈閹垮啩绨婚柟顔奸叄瀵粙鎮℃惔锝嗩啅婵☆偆澧楅崹鍨閹邦喚鐭欓悗锝庝簽閻熷酣鏌ｉ妸銉ヮ伂妞も晪绠戞晥闁跨噦鎷�...
- Agilent ADS 闂佽桨鐒﹂悷銉╊敆閻旂厧鏄ョ痪顓炴媼閸炴煡鎮归崶褍鈷旈柍璇插悑缁鸿棄螖閸曞灚顥�
婵炴垶鎸婚幐鎼侇敊瀹ュ绠抽柛顐秵閸わ箓鏌ㄥ☉妯垮闁告瑥绻樺Λ鍐閿濆骸鏁奸柣鐔哥懐閺嬪儊S闂佸憡鑹剧€氼噣锝為幒妤€绀夐柣鏃囶嚙閸樻挳鏌涘⿰鍐濞村吋鍔楃划娆戔偓锝庝簽鐎瑰鏌ｉ姀鈺冨帨缂侀亶浜跺畷婵嬪煛閸屾矮鎲鹃梺鐑╁亾閸斿秴銆掗崼鏇熷剹妞ゆ挾濮甸悾閬嶆煛閸愩劎鍩ｆ俊顐ユ硶閳ь剚鍐荤紓姘辨閻у挷S...
- HFSS闁诲孩鍐荤紓姘卞姬閸曨垰鏄ョ痪顓炴媼閸炴煡鎮归崶褍鈷旈柍璇插悑缁鸿棄螖閸曞灚顥�
闁荤姍鍐仾缂佽鐒︾粙澶愬箻閹颁礁鏅欓梺鐟版惈閻楁劙顢氶幎鑺ユ櫖閻忕偠妫勫鍧楁⒒閸稑鐏辨い鏂款樀楠炴帡宕峰▎绂⊿闂佹眹鍔岀€氼剚鎱ㄥ☉銏″殑闁芥ê顦扮€氭煡骞栫€涙ɑ鈷掗柡浣靛€濋弫宥囦沪閽樺鐩庨梺鍛婃煛閺呮粓宕戝澶婄闁靛ň鏅滃銊х磼椤栨繂鍚圭紒顔芥そ瀹曠兘寮跺▎鎯уΤ婵炴垶姊绘慨鐢垫暜婢舵劕绠垫い鈥抽敪SS...
- CST閻庣敻鍋婇崰妤冧焊濠靛棭鍟呴柕澶堝€楃粙濠囨倵楠炲灝鈧洟鎮＄捄銊﹀妞ゆ挾鍠愬▓宀€绱掔€ｎ亶鍎忔い銊︾矌閹叉鏁撻敓锟�
闂佸搫顦€涒晛危閹存緷铏光偓锝傛櫅閻︽粓鎮规担绛嬪殝缂佽鲸绻堝畷妤呭Ω閳哄倹銆冮柣鐘辩瀵泛顔忕欢缍璗闂佸憡鑹剧€氫即濡村澶婄闁绘棁顕ч崢鎾煕濠婂啳瀚板ù鍏煎姉缁瑧鈧綆浜炵€瑰鏌ｉ姀鈺冨帨缂佽鲸绻堝畷婵嬪煛閸屾矮鎲鹃棅顐㈡祩閸嬪﹪鍩€椤掑倸鏋欓柛銈嗙矌閳ь剚鍐婚梽鍕暜婢舵劕绠垫い鈥愁敍T闁荤姳鐒﹀畷姗€顢橀崨濠冨劅闁哄啫鍊归弳锟�...
- 闁诲繐绻愮€氫即銆傞崼鏇炴槬闁惧繗顕栭弨銊╂煕閳哄喚鏀版い鏂垮閹风娀宕滆閺岋拷
婵炴垶鎸稿ú锝囩箔閳ь剙螖閸屾惮鎴﹀Χ婵傚摜宓侀柛鎰级閸曢箖鎮硅閸ゆ牜妲愬┑鍥ㄤ氦婵炲棗娴烽弰鍌炴偣閸パ冣挃闁宠鍚嬬粙澶嬫姜閹殿喚鈽夐梺闈╄礋閸斿矂鎯冮悩绛圭矗闁瑰鍋涜灇闂佸搫鐗滈崹鍫曘€傞锕€鏄ラ柣鏃€鐏氭禍锝夋倶閻愬瓨绀冮悗姘辨暬閹虫ê顫濋崜褏顦梺鐟扮仛閹搁绮崨鏉戦敜婵﹩鍓涢弶浠嬫煟閵娿儱顏х紒妤佹尰缁嬪顫濋鍌氭暏缂佺虎鍘搁崑锟�...
- 閻庣敻鍋婇崰妤冧焊濠靛牅鐒婇柛鏇ㄥ灱閺嗐儲绻涢弶鎴剶闁革絾妞介獮娆忣吋閸曨厾鈻曢梺绯曟櫇椤㈠﹪顢欓崟顓熷珰闁告挆鈧弻銈夋煕濮橆剛澧︽繛澶涙嫹
闁荤姵鍔﹂崢娲箯闁秴瑙﹂柛顐犲劜閼茬娀鏌￠崶銊︾稇闁汇倕瀚伴獮鍡涙偑閸涱垳顦紓鍌氬暞閸ㄧ敻宕规惔銊ノュ〒姘ｅ亾妞わ絽澧庨幏顐﹀矗濡搫纾块梺闈涙閼冲爼濡靛顑芥灃闁靛繒濮甸悵銈夋煏閸℃洘顦峰ǎ鍥э躬瀹曪綁鏌ㄧ€ｎ剛鍩嶉梺鎸庣☉閺堫剟宕瑰⿰鍛暫濞达絽婀辨竟澶愭煛瀹ュ妫戠紒銊ユ健閺屽懘鏁撻敓锟�...
栏目分类