正运动EtherCAT总线运动控制器在并联机械手上的应用-专业自动化论坛-中国工控网论坛

正运动EtherCAT总线运动控制器在并联机械手上的应用点击：2989 | 回复：65

zxh359655360

精华：0帖
求助：0帖
帖子：14帖 | 129回
年度积分：0
历史总积分：0
注册：2013年6月26日

发表于：2018-11-08 10:14:54

楼主

一、并联机械手简介

1.1 结构组成及特点

传统的机械手结构末端执行器与基座之间只有一条运动链，我们称为串联机械手，而并联机械手末端执行器至少有两条运动链与基座相连。根据运动链的条数n不同，把并联机械手称为n轴并联机械手，常见的一般为3轴机械手或4轴机械手。

机械手1.jpg

与串联机械手相比，并联机械手具备以下几个优势：

1. 刚度大，多条运动链可以分享载荷。

2. 精度高，误差由多条运动链均分，不会像串联结构那样误差累计。

3. 运动平稳，主要部件都连接在基座，质心靠近不同的基座，所以运动惯量低。

4. 成本低，结构基本都是标准件。

1.2 基本参数

机械手参数.jpg

图 3并联机械手基本参数

R: 大臂旋转中心到基座中心的距离。

L1：大臂长度，两端旋转中心距离。

L2：小臂长度，两端旋转中心距离。

r：小臂末端连接中心到底座中心的距离。

LX: 末端工作点相对于底座中心的X偏移，（负向为负数）。

LY: 末端工作点相对于底座中心的Y偏移，（负向为负数）。

LZ: 末端工作点相对于底座中心的Z偏移，（负向为负数）。

二、正运动EtherCAT总线控制器

正运动技术致力于做更好的运动控制器，非总线的ZMC运动控制器采用华为 IPD-CMM 软件开发流程开发，使得产品具备电信级的稳定性；结合了最新的控制理论及网络控制技术；以太网,RS232,RS485, USB,CAN 等多种接口；单控制器最多可以控制多达 32 个轴。同时结合了传统PLC和运动控制卡，即可进行逻辑控制，又可进行运动控制，精简了工业现场的控制设备。

而在发现了市场上对于EtherCAT总线控制器的需求后，正运动技术更进一步，潜心开发出了EtherCAT总线运动控制器、总线IO扩展和总线轴扩展等一系列产品。本次就采用ZMC464总线控制器对3轴并联机械手进行控制，外观如下图。

ZMC464(lt).jpg

图 4 ZMC464总线运动控制器

ZMC464在非总线运动控制器的基础上，优化了以下几点。

最多达 64 轴运动控制(3 脉冲轴+64ECAT 轴)；

支持最多达 16 轴同时直线插补、任意空间圆弧插补、螺旋插补；

支持多机台同时联动；

ECAT 最快 100μs 的刷新周期；

每轴最大输出脉冲频率 8MHz；

EtherCAT总线控制器的出现，使得运动控制的响应速度更快，精度更高。现场接线更加简洁、简单，驱动器不再需要一一与控制器上的轴接口一一对应，只需要用网线串接驱动器即可，现场控制电箱体积更小。

三、正运动控制方案

本方案使用的3轴并联机械手如下图5，基本参数如图6。

机械手2.jpg

对于并联机械手的控制而言，最为关键的是如何将关节轴坐标系转换为笛卡尔坐标系，操作末端执行器在笛卡尔坐标系中运动，关节轴要能够自动解算出响应的关节轴坐标，这个过程就是逆解，需要编写相应的算法。

为了更方便的使用，正运动已经将不同的机械结构算法进行了封装，使用的时候只需要设置好然机械结构的参数，然后使用CONNFRAME指令调用3轴并联机械手结构即可。建立连接后，我们就可以通过操作3个虚拟轴使末端执行器移动到笛卡尔坐标系中的指定位置，此时3个关节轴会自动解算需要旋转的角度。

本方案主要实现直线运动和圆弧运动。

3.1 控制器接线

使用网线通过EtheaCAT接口将ZMC464与伺服驱动器连接，驱动器要支持EtherCAT总线驱动，这里使用的是迈信EP3驱动器。连接好第一个驱动器后，用网线依次串接剩余驱动器即可，如下图。

接线1.jpg

图 7 ZMC464总线运动控制器接线

3.2 控制器设置

ZMC总线控制器通过axis_address指令可以设置驱动器绑定的轴号。通过atype()指令可以设置轴的控制类型。本方案采用atype=65位置闭环模式控制机械手。

可以通过DRIVER类型指令直接对驱动器设置，比如drive_mode可以设置驱动器的控制模式（对应驱动器数据字典）。DRIVE_CONTROLWORD设置驱动功能。

也可以通过SDO_READ和SDO_WRITE直接对驱动器进行读写。

3.3 控制程序

过程控制的程序可以通过Zdevelop编写，使用了Zbasic编程环境。根据需要的功能，可以自定义编写相应功能的SUB，使程序结构更清晰易读。本方案包含的功能主要有机械手结构正解逆解的切换、相对绝对模式的切换、G代码操作、手动操作等。

运动时的实时参数也可通过zdevelop的轴参数查看。

轴参数1.jpg

图 8轴参数列表

3.4 HMI人机界面

正运动开发了自己的HMI人机界面和手持盒，并加入到ZDevelop编程软件中，与Basic联合编程，使得在Basic编程的同时也可以进行HMI界面设计，程序将一同下载到控制器。通过网线连接控制器与手持盒，会自动显示出HMI界面。

图 9 HMI界面

3.5 机械手运动方式

程序中建立了与标准G代码功能相同的自定义G代码，如下图。

G代码.jpg

图 10 G代码

操作者可以直接使用G代码来编写运动程序，控制3轴机械手的运动轨迹，实现了脱离PC端编程。本方案中主要使用了G01直线运动和G02顺圆指令，在笛卡尔坐标系中运动轨迹为，原点位置(0,0,-294)->(0,0,-450)->(180,0,-450)->(180,0,-450)->顺时针画整圆->回原点(0,0,-294)。