基于DSP的机器人视觉伺服系统

1. 引言

　　视觉是领域中的重要研究方向，起源于80年代初，随着计算机技术、技术、控制理论的发展，取得了很大进步，有一些系统已投入使用。视觉伺服跟通常所说的有所不同，视觉伺服是利用的原理，进行图像的自动获取分析，从直接得到的反馈信息中，快速进行，在尽量短的时间内给出反馈信号，构成的位置闭环控制，实现对机器人的控制。正是由于系统以实现某种控制为目的，所以视觉中的图像处理过程必须快速准确。本文主要针对机器人视觉要求快速准确的特点，为满足项目研究的需要，讨论研究了基于的图像反馈机器人视觉伺服技术。

2 . 系统工作原理及硬件构成

　　基于图像的视觉伺服直接计算图像误差，产生控制信号，并变换到机器人运动空间，驱动机械手，完成伺服任务。该方法对标定误差和空间模型误差不敏感。

　　对于机器人视觉伺服系统,实时性问题一直是一个难以解决的重要问题。图像采集速度较低以及图像处理需要较长时间会给系统带来明显的时滞;此外视觉信息的引入也明显增大了系统的计算量。而图像处理速度是影响视觉伺服系统实时性的主要瓶颈之一。

　　实时图像处理设计的难点是如何在有限的时间内完成对大量图像数据的处理。从人的视觉理论分析，只有图像处理系统的处理速度达每秒25帧以上时才能达到实时的效果，即要求实时图像处理系统必须在40ms内完成对一帧l图像的运算处理，才能保证图像的实时性。为了达到该处理速度，我们采用了基于的图像视觉伺服方式，其结构如图1所示。

图1基于的图像反馈机器人视觉伺服结构图

2.1 WTC6201PA板简介

　　本文选用了闻亭公司的WTC6201PA板，其板上硬件组成如图2所示。

图2 WTC6201PA板硬件组成

　　WTC6201PA板属于EVM板中的一种，它采用了TI公司的DSP器件芯片。芯片的最高时钟频率为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板上的芯片、FPGA、SBSRAM、SDRAM、双口RAM、PCI总线、JTAG接口等硬件资源作为视觉图像处理单元，和PC主控机、图像采集卡、CCD摄像机和机器人控制系统组成系统，原理框图如图3所示。

图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机再将位置偏差数据信号送至伺服控制系统，完成伺服任务。

3 . 图像雅可比矩阵

　　对于图像反馈机器人视觉伺服系统控制机构，图像雅可比矩阵是很关键的，它描述了机器人空间中的运动与图像特征空间中的运动之间的关系：

　　式 （2），（4）是图像雅可比矩阵的两种表示形式，是基于图像反馈的视觉跟踪研究的基础。需要指出的是，为了确保得到唯一的图像特征矢量，图像特征空间维数应该大于或等于位姿空间维数（n≧m）。

　　计算图像雅可比矩阵的方法有在线估计法、经验方法和学习方法。在线估计法通过动态估算得到图像雅可比矩阵;经验法可以通过标定或先验模型知识得到图像雅可比矩阵;学习方法主要可以利用离线示教和神经网络方法得到雅可比矩阵。

结论

　　本文分析了机器人视觉伺服系统的基本原理，并设计了基于TMS320C6201和可编程逻辑器件FPGA协处理结构的视觉系统，实现了图像采集和图像目标的实时处理。在实验室中我们利用所设计的视觉系统构建了实验平台，通过实验验证了所设计的视觉系统满足机器人视觉伺服系统的实时要求。

　　本文作者创新点：对于机器人视觉伺服系统,实时性问题一直是一个难以解决的重要问题。本文创新采用TMS320C6201芯片来实现机器人视觉伺服的图像处理，并采用FPGA协处理，提高了图像处理速度，实验验证了所设计系统满足机器人视觉伺服的实时要求,具有广泛的工业应用前景。

参考文献：

　　[1] 付京逊,冈萨雷斯R C, LRR C S G.机器人学[M].北京:中国电子科学技术出版社1989.

　　 [2] S Hutchinson, G D Hager, P I Corke . A tutorial on visual servo control[J]. IEEE Trans. Robotics Automation, 1996,12（5）: 650-670

　　[3] 任丽香,马淑芬,李方慧.TMS320C6000系列DSPs的原理与应用[M].北京:电子工业出版社,2000

　　[4] TMS320C62xx peripherals reference guide[Z].Texas Instruments Incorporated, 1999

　　[5] 林靖，陈辉贵，王月娟，等.机器人视觉伺服系统的研究[J].控制理论与应用.2000,17（4）: 476-481

　　[6] 杨延西，刘丁，闰振杰.图像反馈机器人视觉伺服系统仿真[J].系统仿真学报，2003, 15 （12） :1737-1744.

　　[7] 应家驹，何永强.基于DSP和FPGA的超大视场红外目标检测图像处理系统设计[J]，微计算机信息，2006，3（2）:161-162.