基于EtherCAT实时工业以太网的视觉机器人从站控制系统的研究

作者姓名 指导教师
分类号 UDC 注 1
密级
学
位
论
文
基于 EtherCAT 实时工业以太网的 视觉机器人从站控制系统的研究
（题名和副题名）
张 峰
（作者姓名）
指导教师
叶玉堂 电子位名称）
申请学位级别 提交论文日期
硕 士 2014.04
学科专业
光 学 工 程 2014.05 2014 年 6 月 27 日
I
ABSTRACT
ABSTRACT
Photoelectric vision robot is an important branch of robots, and widely used in industrial production and manufacturing. Its research level can be regard as the important standard for national industrial automation. So far, the robot core technology is still controlled by foreign advanced groups, such as ABB, KUKA, AnChuan etc. Domestic robot market is monopolized by foreign countries, they mostly choose to import a complete set of machine abroad, because foreign robot has higher control accuracy and stability, but the cost is very high. The core technology of photoelectric vision robot is at identifying the object quickly and accurately, planning the optimal motion path, and real-time & high precision controlling. At present, the domestic robots are mostly based on MCU (Micro Controller Unit) without visual identification system, which restrict the using of robot in a large extent. And the mature communication interface module such as CAN (Controller Area Network) bus, serial port, and USB (Universal Serial Bus) can not meet the real-time requirements of robot. PC is used as the master of the control system, and it is responsible for sending motion instructions, displaying human-computer interaction interface, etc. The slave is constructed by FPGA (Field-Programmable GateArray), which has highly parallel execution ability. It is responsible for executing master’s commands. The communication interface of master and slave is EtherCAT real-time Ethernet, which has less than 100 us refresh cycle. EtherCAT can largely improve the control accuracy depends on the real-time data transmission. The higher position refresh efficiency is, the more accurate the master can plan the position. In this thesis, several hardware circuits are designed and produced, such as FPGA core board, EtherCAT real-time communication module, interface of servo drive and photoelectric sensor, and others. At the same time, the slave software codes are mainly divided into two parts, which are both completed in FPGA. The verilog hardware control codes are edited in the Quartus II, another part is built on NIOSII soft core for EtherCAT real-time Ethernet transport protocol. Transplanting EtherCAT real-time Ethernet in the robotic system has very important significance for robot control, because it greatly shortens the transmission and feedback cycle. Our photoelectric vision robot is successfully uesd in materials handling up and
III
目录
目 录
电 子 科 技 大 学
UNIVERSITY OF ELECTRONIC SCIENCE AND TECHNOLOGY OF CHINA
硕士学位论文
MASTER THESIS
（电子科技大学图标）
论文题目
基于 EtherCAT 实时工业以太网的 视觉机器人从站控制系统的研究
学科专业 学 号
光学工程 201121050109 张 峰 叶玉堂 教授
Major: Author: Advisor: School:
Optical Engineering Feng Zhang Yutang YE School of Optoelectronic Information
独创性声明
本人声明所呈交的学位论文是本人在导师指导下进行的研究工作 及取得的研究成果。据我所知，除了文中特别加以标注和致谢的地方 外，论文中不包含其他人已经发表或撰写过的研究成果，也不包含为 获得电子科技大学或其它教育机构的学位或证书而使用过的材料。与 我一同工作的同志对本研究所做的任何贡献均已在论文中作了明确的 说明并表示谢意。
作者签名：
日期：
年
月
日
论文使用授权
本学位论文作者完全了解电子科技大学有关保留、使用学位论文 的规定，有权保留并向国家有关部门或机构送交论文的复印件和磁盘， 允许论文被查阅和借阅。本人授权电子科技大学可以将学位论文的全 部或部分内容编入有关数据库进行检索，可以采用影印、缩印或扫描 等复制手段保存、汇编学位论文。 （保密的学位论文在解密后应遵守此规定） 作者签名： 导师签名： 日期： 年 月 日
摘要
摘
要
光电视觉机器人是机器人领域的一个重要分支，广泛应用于工业生产和制造 领域， 其研究水平高低可以作为衡量国家工业自动化水平的重要标准。 至今， ABB、 KUKA、 安川等国外研究团队技术较成熟。 中国国内机器人市场主要还是被国外所 垄断，一些机器人应用场合大都进口国外的整套机器，国外机器人控制精度和稳 定性比较高，但是成本非常高。光电视觉机器人的核心技术在于：快速精确识别 物体， 最优运动路径规划， 实时高精度控制。 目前， 国内的机器人大都是基于 MCU （Micro Controller Unit） 的无视觉识别的系统，缺少视觉模块在很大的程度上限制 了机器人的使用场合，而且现有的成熟通信接口模块如 CAN （ Controller Area Network）总线、串口、USB（Universal Serial Bus）等在实时性能上的限制都不能 满足机器人的要求。 本文中所研究的光电视觉机器人采用 PC 作为控制系统的上位机， 负责发送运 动 控 制 指 令 ， 显 示 人 机 交 互 界 面 等 。 下 位 机 采 用 高 并 行 执 行 能 力 的 FPGA （Field-Programmable GateArray）执行上位机指令，同时集成刷新周期小于 100 us 的 EtherCAT 实时以太网作为上、下位机的通信接口模块。该下位机模式可以很大 程度上提高控制精度，在数据传输实时性和执行指令并行性得到保证的前提下， 机械的位置刷新效率就更高，上位机对位置的规划也就越精确。 本论文中设计并制作了 FPGA 核心板、EtherCAT 实时通信模块、伺服驱动接 口、光电传感器接口等硬件电路。同时编写下位机软件代码，主要分为两个部分， 且均是在 FPGA 上完成。FPGA 分配一部分资源用来实现控制，在 Quartus II 编辑 器中完成 verilog 硬件控制代码，另外一部分资源用来构建 NIOS II 软核，NIOS II 中实现 EtherCAT 实时以太网传输协议。在机器人系统中成功移植 EtherCAT 实时 以太网，这对机器人控制有着非常重要的意义，其大幅缩短了传输和反馈周期。 通过本文中设计的基于 EtherCAT 从站控制系统对机器人的改进，其已成功在 企业的工业现场应用于物料上下搬运、器件打磨和码垛等作业中，机器人在工业 干扰环境中仍然能够稳定运行。其中，主从站数据刷新周期提高到 1 ms 大大提高 了通信实时性，使得机器人点重复精度为 0.02 mm，水平联动速度最快可以达到 5.6 m/s，各轴归零均能在 7 s 内完成，归零误差在 2 个脉冲数以内。 关键词：EtherCAT，工业以太网，机器人，FPGA（Field-Programmable GateArray） ， NIOS II