基于FPGA EtherCAT的六自由度机器人视觉伺服控制设计.docx

《基于FPGA EtherCAT的六自由度机器人视觉伺服控制设计.docx》由会员分享，可在线阅读，更多相关《基于FPGA EtherCAT的六自由度机器人视觉伺服控制设计.docx（5页珍藏版）》请在第一文库网上搜索。

1、基于FPGAEtherCAT的六自由度机器人视觉伺服控制设计概述中国制造2025是中国政府实施制造强国战略的第一个十年行动纲领，是全面提升中国制造业发展质量和水平的重大战略部署，其中明确指出了围绕工业机器人创新技术的重要地位。目前工U技术已经广泛应用在汽车加工、食物分拣、自动化生产装配等领域。工业现场通信技术是智能制造业的核心技术之一，随着智能制造业的快速发展，对节点间通信的实时性、可靠性以及通信带宽提出了更高的要求。工业以太网主站可以在多种平台上运行,只需便性提供一个标准的网口。因此，成本低廉、简单灵活、高速实时的嵌入式平台在硬件上可以作为工业以太网主站使用，从而提供一种新的网络化、信息化、

2、智能化的解决方案。传统的硬件平台采用DSP对图像进行处理,其处理速度较慢，无法满足图像处理实时性要求，限制了机器视觉的应用。FPGA作为一种硬件平台，用于数字图像处理，具有速度快、集成度高、可靠性强等优点。为了提高图像的质量和增强系统处理图像的实时性，本文提出了一种伊瑟特的六自由度机器人视觉伺服控制系统，将摄像头集成到基于Zynq的伊瑟特主站上，提高了视觉伺服的实时性。经测试，该平台能够对视觉检测目标的变化做出及时的反应，为础宜动化提供了一套切实可行的方案。本文针对基于机器视觉的工业机器人进行研究，主要工作包括以下几点：（1）设计了基于伊瑟特的六自由度机器人视觉伺服控制系统总体方案。以ESR6

3、B机器人、Zynq和摄像头为硬件基础，搭建了六自由度机器人视觉平台。（2）设计了基于FPGA的视觉检测方案。利用西林提供的H1S和CV库对从摄像头采集到的像素流进行实时处理，并设计了一套识别物块坐标位置的程序流程，便于伊瑟特主站实时地读取物块坐标值，处理后的图像通过HDM1接口输出到显示屏。（3）完成了伊瑟特对伺服的位置控制。利用Zynq的P1层进行了伊瑟特以太网帧的收发和主站时钟的校准,在PS层运行苏姆的裸机程序，并将六自由度串联机器人逆解算法移植到主站代码里,进行机器人末端位置对于视觉反馈的实时跟随控制。（4）通过实验验证了本设计的对物块识别的准确性和实时性，并使用自主研发的六自由度串联机

4、器人进行实际的运动控制实验。实验证明，机器人可以实时地跟随屏幕上显示的物块运动。主要创新点本设计难点在于如何提高视觉检测的实时性和机器人运动控制的实时性，创新地采用了XiIinX的ZynQ异构处理器,将FPGA作为视觉处理的主要单元，并将伊瑟特主站移植到Zynq平台，这样，在一块芯柱里就完成了实时的视觉检测和运动控制。本设计采用H1S进行视觉处理，对代码进行了优化，使得整个视觉处理模块的延时仅为18.6ms。同时，在通信方面，本设计使用FPGA进行伊瑟特帧的收发和校验，使得直流电同步周期抖动稳定在小于W时间。实时的视觉检测和运动控制在工业机器人视觉伺服中有着广阔的应用，本实验将集成摄像头的伊瑟

5、特主站应用在自主研发的六自由度串联机器人上，将机器人运动学算法编写入伊瑟特主站，使得机器人可以随着摄像头检测到的物体做实时的运动。实验结果表明，本设计的实时性远大于PC平台的视觉处理，并完成了沿机器人X轴方向的实时视觉跟随运动。系统架构1. ESR6B机器人硬件系统设计ESR6B机器人是自主研发的机器人，是典型的多自由度串联机器人，机器人本体如图2-1所示。图2-1ESR6B机器人本体基于视觉引导的机器人硬件系统主要由机器人本体、控制台、Zynq和视觉硬件等组成，如图2-2所示。天个伺登驱动器六个向服电机六个减速机通信和接口电露0V5640携像头*rr上Fr图2-2系统总体方案2. ESR6B

6、机器人基本设计参数机器人有6个自由度，其主要技术参数包括自由度、负载能力、重复定位精度、定位精度以及工作空间等，这些参数是反映机器人性能优劣的主要指标。ESR6B机器人的基本技术参数如表2-1所示。表2-1ESR6B机器人基本技术参数自由度6自由度机械结构形式串联关节型负载能力3Kg重复定位精度0.6mm定位精度6mm最大展开半径600mm各关节最大运动范围关节1:-170f170。关节2:-1350M5关节3:0。内0。关节4:480*71800关节5735。71350关节6:-36073607FPGA技术江湖3. 机器人视觉系统硬件平台搭建机器人视觉系统的硬件选择直接影响图像采集，图像的质

7、量和后期的处理，并影响整个控制系统的实时性，所以应根据要求和这些硬件性能，严格选择硬件。基于伊瑟特的六自由度机器人视觉伺服控制系统主要包括摄像头、Zynq、存储、显示、通信等模块。Zynq是Xi1inx设计的一种包含FPGA+ARM的异构芯片,在Zynq系统芯片中，包含了基于艾尔M的处理系统(PS)和可编程逻辑单元(P1)O伊瑟特主站和IinUX操作系统运行在PS端，图像算法在FPGA进行硬件加速，放在PI端。通过阿希总线互联技术将FPGA与手臂整合在一起，从而充分发挥出两种器件结构的优势。摄像头的主要特性参数有：分辨率、帧率和色彩空间等。根据这些特性参数，选择满足实验需求的摄像头。本系统设计

8、中，选取型号为OV5640的CMOS类型数字图像传感器,该传感器支持输出最大为500万像素的图像(2592x1944)分辨率)、支持使用VGA时序输出图像数据，输出图像的数据格式支持YUV(422/420)YCbCr422、RGB565以及JPEG格式，本次设计采用RGB565格式数据读取。图2-3OV5640摄像头本设计中，图像数据由OV5640摄像头采集，然后由FPGA对其进行图像预处理和坐标检测，数据流经VDMA通过HPO口进入DDR3内存，然后再通过HPO返回，经过VDMA.最后通过HDM1接口输出视频。光源的主要参数有：对比度、亮度、表面纹理和光源均匀性。根据上述光源的特性，选择上海

9、东冠科技的环形光源,型号为Rin-90-6RTOW、光源为白色的发光二极管。实物图如图2-4所示。图2-4环形光源实物图基于伊瑟特的六自由度机器人视觉伺服控制系统如图2-5所示。存储模块电源模块图2-5基于弛TCAI的六自由度机器人视觉伺服控渤杀铲GA宾本江湖设计演示视觉伺服性能分析视觉伺服要求从对目标的识别到控制之间的延时要很短，才能体现控制的实时性。本文设计了一组对照实验，方案一为采用在Zynq板上集成摄像头的伊瑟特主站，方案二为PC机连接蟠摄像头，并采用广告将坐标数据传输给TWinCAT主站的方案。两种方案使用相同的图像处理算法，主站都处于CSP模式下。图4-5性能测试平台延时计算平台为STM32+TFT彩屏和基于XMC4300的伊瑟特步进从站，当屏幕开始刷新红色时，定时器开始计时,当接收到步进从站的脉冲时停止计时，对比方案一和方案二的延时（单位我们），如图4-6所示。视觉检测延时1SOOOOOAZZ/10000SOOooO方*一方富二图4-6方案对照可以看出本设计的检测延时平均仅为58亳秒，而方案二却长达2.48s,在运行相同图像检测算法情况下，FPGA的延时更低，同时由于本设计将摄像头直接集成到主站板上，图像传输延时更低，成本更低。