EtherCAT运动控制器Delta机械手应用

news2024/11/17 7:56:53

ZMC406硬件介绍

ZMC406是正运动推出的一款多轴高性能EtherCAT总线运动控制器,具有EtherCAT、EtherNET、RS232、CAN和U盘等通讯接口,ZMC系列运动控制器可应用于各种需要脱机或联机运行的场合。

在这里插入图片描述

ZMC406支持6轴运动控制,最多可扩展至32轴,支持直线插补、任意圆弧插补、空间圆弧、螺旋插补、电子凸轮、电子齿轮、同步跟随等功能。

ZMC406支持PLC、Basic、HMI组态三种编程方式。PC上位机API编程支持C#、C++、LabVIEW、Matlab、Qt、Linux、VB.Net、Python等接口。

在这里插入图片描述

ZMC406支持6轴运动控制,可采用脉冲轴(带编码器反馈)或EtherCAT总线轴,通用IO包含24路输入口和12路输出口,模拟量AD/DA各两路,EtherCAT最快125us的刷新周期。

此类运动控制器与PCI运动控制卡相比具有如下优点:

(1)不使用插槽,稳定性更好;

(2)可以选用MINI电脑或ARM工控电脑,降低整体成本;

(3)控制器直接做接线板使用,节省空间;

(4)控制器上可以并行运行程序,与PC只需要简单交互,降低PC软件的复杂性等优势。

ZMC控制器通过RTSys开发环境来调试,RTSys是一个方便的编程、编译和调试环境。RTSys可以通过串口、以太网、PCI和LOCAL与控制器建立连接。应用程序可以使用VC,VB,VS,C++Builder,C#等软件来开发。调试时可以把RTSys软件同时连接到控制器,程序运行时需要动态库zmotion.dll。

Delta机械手支持3-4轴,关节轴1+关节轴2+关节轴3+[末端旋转轴4]。后缀带R的控制器支持Delta机械手功能,例如ZMC406R。

ZMC406R可以采用脱机的方式将编辑好的程序下载到控制器上,可利用触摸屏示教的方式编辑想要运动的轨迹。也可以用PC API函数调用方式或者实时发送指令操作,在PC上位机C#,C++,Labview,Python等语言来开发Delta机械手的应用。

在这里插入图片描述

▶▶▶ 机械手相关概念

1、关节轴与虚拟轴

(1)关节轴:是指实际机械结构中的旋转关节,在程序中一般显示旋转角度(某些结构也是平移轴)。由于电机与旋转关节会存在减速比,所以设置脉冲当量UNITS(电机走1mm或者1°需要的脉冲数)时要按照实际关节旋转一圈来设置,同时TABLE中填写结构参数时也要按照旋转关节中心计算,而不是按照电机轴中心计算。

(2)虚拟轴:不是实际存在的,抽象为世界坐标系的6个自由度,依次为X、Y、Z、RX、RY、RZ。可以理解为直角坐标系的三个直线轴和三个旋转轴,用来确定机械手末端工作点的加工轨迹与坐标。

2、正解运动与逆解运动

(1)正解运动:通过操作关节坐标,再根据机械结构参数可以计算出末端位置在直角坐标系的空间位置,这个过程称为正解运动。此时操作的是实际关节轴,虚拟轴自动计算坐标。此时只能操作关节轴运动,正解模式一般用于手动调整关节位置或上电点位回零。

(2)逆解运动:给定一个直角坐标系中的空间位置,反推出各关节轴坐标,这个过程称为逆解运动。此时操作的是虚拟轴,实际关节轴自动解算坐标并运动。控制器使用CONNFRAME指令建立逆解模式,此指令作用在关节轴上,此时只能操作虚拟轴,对虚拟轴发送运动指令,可以在笛卡尔坐标系中做直线,圆弧,空间圆弧等运动,关节轴在CONNFRAME的作用下会自动运动到逆解后的位置。

▶▶▶ 机械手使用操作步骤

1、确认电机转向是否正确。

3个关节轴向下旋转时为正向。末端旋转轴逆时针旋转为正向(俯视)。连接上机械手仿真工具,通过Rtsys软件菜单栏的【工具】-【手动运动】,以较小的速度分别操作3个关节轴移动,观察各个关节轴下杆移动过程中是否趋向末端工作点,若是则说明电机转向是正确的。

在这里插入图片描述

2、TABLE寄存器(控制器上电后自动生成)依次存入机械手结构参数。

建立机械手连接时,需要将机械结构参数按照如下次序依次填写到TABLE数组中。Delta机械手FRAME12模型机械结构参数说明如下。

在这里插入图片描述

在这里插入图片描述

‘从TableNum编号开始依次机械手结构参数上间距半径、下间距半径、上杆长度、下杆长度、第一个关节轴旋转一圈的脉冲数、第二个关节轴旋转一圈的脉冲数、第三个关节轴旋转一圈的脉冲数、末端与下面中心点的X偏移、末端与下面中心点的Y偏移、末端与下面中心点的Z偏移、第四个关节轴旋转一圈的脉冲数到Table中。
TABLE(TableNum,Top_R,Under_R,Top_L,Under_L,OneCirPules_J1,OneCirPules_J2,OneCirPules_J3,Offset_X,Offset_Y,Offset_Z,OneCirPules_J4)

3、设置关节轴参数及虚拟轴参数。

各轴的轴类型和脉冲当量(units)要设置正确,设置为电机走1°需要的脉冲数。虚拟轴的units跟实际发送脉冲数无关,用于设置运动精度,虚拟轴的1mm的脉冲数一般建议设置为1000,表示精度为小数点后3位。

'关节轴设置
BASE(Axis_JList(0),Axis_JList(1),Axis_JList(2),Axis_JList(3))
'脉冲轴类型设置为1。若是总线轴类型,可设置为65 
ATYPE = 1,1,1,1 
UNITS = UnitsJList(0),UnitsJList(1),UnitsJList(2),UnitsJList(3)
'设置关节轴速度、加速度(一般设置为速度的10)、减速度(一般设置为速度的10)
SPEED = SpeedJList(0),SpeedJList(1),SpeedJList(2),SpeedJList(3) 
ACCEL = ADSpeedJList(0),ADSpeedJList(1),ADSpeedJList(2),ADSpeedJList(3)
DECEL = ADSpeedJList(0),ADSpeedJList(1),ADSpeedJList(2),ADSpeedJList(3)
'S曲线
SRAMP = SrampJ(0),SrampJ(1),SrampJ(2),SrampJ(3)
'虚拟轴设置
BASE(Axis_VList(0),Axis_VList(1),Axis_VList(2))
'虚拟轴轴类型设置为0
ATYPE = 0,0,0
'虚拟轴脉冲当量设置为1000--表示精度为小数点后3位
UNITS = 1000,1000,1000
'设置虚拟轴速度、加速度(一般设置为速度的10)、减速度(一般设置为速度的10)
SPEED = SpeedVList(0),SpeedVList(1),SpeedVList(2)
ACCEL = AccelV(0),AccelV(1),AccelV(2)
DECEL = DecelV(0),DecelV(1),DecelV(2)
'S曲线
SRAMP = SrampV(0),SrampV(1),SrampV(2)

4、移动各关节轴到规定的零点位置。

机械手算法建立时,需要有个零点位置作为参考。当Delta机械手各关节轴的连杆L1都处于水平位置时,认为是关节零点位置。实际现场机械手机台一般有定位销,没有定位销的话可以通过水平仪把连杆L1调整至水平。

在这里插入图片描述

5、根据需求建立正解或逆解控制机械手。

▶▶▶ 机械手指令说明

不同的机械手模型参数是有差异的,可通过“正运动机械手指令手册说明”(文章末尾扫码查看),查阅对应的机械手模型参数进行确认选择。

本文以Delta的FRAME12模型(有末端旋转轴,使用关节轴操作旋转轴)为例介绍,机械手正解与逆解的指令说明如下。

在这里插入图片描述

1、CONNREFRAME – 建立正解连接

指令描述:将虚拟轴的坐标与关节轴的坐标关联,关节轴运动后,虚拟轴自动走到相应的位置。

指令语法:

CONNREFRAME(frame,tablenum,Axis_J1,Axis_J2,Axis_J3,Axis_J4)

参数说明:

frame:坐标系类型。参考【正运动机械手指令手册说明】,frame是12,代表这款机械手模型是4轴Delta且关节轴操作末端旋转轴。

Tablenum:存储机械手结构参数的TABLE起始位置,依次存储对应模型的机械手结构参数。

Axis_J1:第1个关节轴轴号

Axis_J2:第2个关节轴轴号

Axis_J3:第3个关节轴轴号

Axis_J4:第4个关节轴轴号

2、CONNFRAME – 建立逆解连接

指令描述:将当前关节坐标系的目标位置与虚拟坐标系的位置关联;关节坐标系的运动最大速度受SPEED参数的限制;当关节轴告警等出错时,此运动会被CANCEL。

指令语法:

CONNFRAME(frame,tablenum,Axis_Vx,Axis_Vy,Axis_Vz,Axis_J4)

参数说明:

frame:坐标系类型。参考【正运动机械手指令手册说明】,frame是12,代表这款机械手模型是4轴Delta且关节轴操作末端旋转轴。

Tablenum:存储机械手结构参数的TABLE起始位置,依次存储对应模型的机械手结构参数。

Axis_Vx:第1个虚拟轴轴号

Axis_Vy:第2个虚拟轴轴号

Axis_Vz:第3个虚拟轴轴号

Axis_J4:第4个关节轴轴号

▶▶▶ Delta机械手模式建立

1、正解建立

以Delta机械手的Frame12模型为例。先将机械手结构参数从某个Table起始编号依次存储到Table数组中,然后选择对应模型的轴列表,使用CONNREFRAME指令建立正解模式。

指令说明可通过Rtsys软件菜单栏的【常用】-【帮助文档】-【RTBasic帮助】-【索引】,在查找栏搜索CONNREFRAME即可查看。

'将机械手参数从编号TableNum开始依次存储到Table数组中
TABLE(TableNum,Top_R,Under_R,Top_L,Under_L,OneCirPules_J1,OneCirPules_J2,OneCirPules_J3,Offset_X,Offset_Y,Offset_Z,OneCirPules_J4)
'选择轴列表
BASE(Axis_Vx,Axis_Vy,Axis_Vz,Axis_J4)
'建立机械手正解
CONNREFRAME(FrameType,TableNum,Axis_J1,Axis_J2,Axis_J3,Axis_J4)

若机械手正解建立成功,虚拟轴MTYPE(当前运动类型)将显示为34,此时只能操作关节轴在关节坐标系中调整机械手姿态,手动运动可通过RTSys软件菜单栏的【工具】-【手动运动】,待【手动运动】界面弹出之后选择关节轴轴编号(本文关节轴以轴0,轴1,轴2,末端旋转轴轴3为例),然后根据实际需求选择点动或者寸动。虚拟轴会自动计算末端工作点位于直角坐标系中的位置。

在这里插入图片描述

在这里插入图片描述

2、逆解建立

以Delta机械手的Frame12模型为例。先将机械手结构参数从某个Table起始编号依次存储到Table数组中,然后选择对应模型的轴列表,使用CONNFRAME指令建立正解模式。指令说明可通过Rtsys软件工具栏的【常用】-【帮助文档】-【RTBasic帮助】-【索引】,在查找栏搜索CONNFRAME查看。

'将机械手参数从编号TableNum开始依次存储到Table数组中
TABLE(TableNum,Top_R,Under_R,Top_L,Under_L,OneCirPules_J1,OneCirPules_J2,OneCirPules_J3,Offset_X,Offset_Y,Offset_Z,OneCirPules_J4)
'选择轴列表
BASE(Axis_J1,Axis_J2,Axis_J3,Axis_J4) 
'建立机械手逆解
CONNFRAME(FrameType,TableNum,Axis_Vx,Axis_Vy,Axis_Vz,Axis_J4)

若机械手逆解建立成功,关节轴MTYPE(当前运动类型)将显示为33,【手动运动】界面操作虚拟轴方法同上。此时加工工艺指令只能操作虚拟轴,事先编辑好运动的轨迹在直角坐标系中运动(本文虚拟轴以轴10,轴11,轴12为例),关节轴会自动计算在关节坐标系中如何联合运动。

在这里插入图片描述
在这里插入图片描述

▶▶▶ 程序编辑

RTSys软件支持Basic,HMI与PLC混合编程,本例程采用Basic结合HMI界面混合编程进行演示。可通过RTSys软件菜单栏的【HMI】-【工具箱】,选择控件进行拖拉摆放,设计交互界面。

在这里插入图片描述

在本次例程中均先在bas文件中定义全局的SUB子函数,编辑子函数的功能(工程源码见文章末尾)需求然后使用控件绑定,控件的动作均选择调用函数。操作流程如下图。

在这里插入图片描述

▶▶▶ 应用例程

1、需求描述

Delta机械手逆解建立时以零点位置为参考,确定一个安全高度。基本动作为机械手上升到安全高度去固定的取料点上方,然后下降打开Op口通过真空吸的方式去取料,延时抬升到安全高度然后运动到固定的2*2码盘位置,下降到码盘位置关闭Op进行放料,然后抬升依次循环直到将码盘放满后停止。

2、加工代码

'启动标志位置1
StartFlag = 1
LOCAL SafeHigh,i
'安全高度
SafeHigh = DPOS(Axis_VList(2))-25
'行,LOCAL Row,Col
'固定的取料点位置
LOCAL SrcBorrow_X,SrcBorrow_Y,SrcBorrow_Z
SrcBorrow_X = 5
SrcBorrow_Y = 5
SrcBorrow_Z = SafeHigh-20
'选择虚拟轴
BASE(Axis_VList(0),Axis_VList(1),Axis_VList(2))
'设置加工的速度、加速度、减速度
SPEED = SpeedVList(0)
ACCEL = AccelV(0)
DECEL = DecelV(0)
'打开连续插补
MERGE = ON
'每次启动临时总数清零
TmpSum = 0
'运动到零点位置参考的安全高度
MOVEABS(0,0,SafeHigh)
FOR Col=1 TO 2
    FOR Row=1 TO 2
        '运动到取料点上方
        MOVEABS(SrcBorrow_X,SrcBorrow_Y,SafeHigh)
        '下降到取料点
        MOVEABS(SrcBorrow_X,SrcBorrow_Y,SrcBorrow_Z)
        '打开Op口吸附取料
        MOVE_OP(8,ON)
        '延时
        MOVE_DELAY(300)
        '上升到安全高度
        MOVEABS(SrcBorrow_X,SrcBorrow_Y,SafeHigh)
        '运动到码盘放料点上方位置
        MOVEABS(-5*Row,5*Col,SafeHigh)
        '下降到码盘放料点位置
        MOVEABS(-5*Row,5*Col,SrcBorrow_Z)
        '关闭Op口进行放料
        MOVE_OP(8,OFF)
        '延时 
        MOVE_DELAY(300)
        '上升到安全高度
        MOVEABS(-5*Row,5*Col,SafeHigh)
        '临时总数自增
        TmpSum = TmpSum+1
    NEXT
NEXT
'等待所有轴停止
WAIT UNTIL IDLE(Axis_VList(0)) AND IDLE(Axis_VList(1)) AND IDLE(Axis_VList(2))
DELAY(10)
RAPIDSTOP(2)
DELAY(10)
'启动标志位置0
StartFlag = 0

▶▶▶ 调试分析

1、将程序下载到控制器运行,先后点击RTSys软件菜单栏的【工具】-【插件】-【XPLC SCREEN】。

在这里插入图片描述

2、待交互界面弹出后,在主界面机械手模式选择”机械手正解”。

在这里插入图片描述

3、建立正解连接之后,打开正运动机械手仿真软件ZRobotView,点击“连接”弹出”连接控制器”窗口,然后选择连接控制器的方式(仿真工具支持串口和网口连接)。这里以网口连接为例,在IP栏选择控制器的IP然后进行连接。

在这里插入图片描述

4、连接成功后,仿真工具上方会显示当前机械手类别,程序中存入Table中的机械手结构参数仿真工具也可以查看,且构建出相应参数的机械手模型。

在这里插入图片描述

5、切换到RTSys编程软件,先后点击菜单栏的【常用】-【示波器】。待示波器窗口弹出后选择XYZ模式,从三维空间观察动作演示效果。数据源选择DPOS(规划位置),数据源编号选择虚拟轴轴号。示波器参数确认后,先后点击【停止】-【启动】-【手动触发】。

在这里插入图片描述

6、切换到交互界面,在主界面机械手模式选择”机械手逆解”,建立逆解模式。然后点击“启动”,进行需求工艺的加工流程。

在这里插入图片描述

7、切换到RTSys软件的示波器界面观察加工效果,Delta机械手每次来回取放料过程,始终保持在安全高度下进行升降,这样确保在实际加工的平稳性。

在这里插入图片描述

教学视频。

EtherCAT运动控制器Delta机械手应用

在这里插入图片描述

本次,正运动技术EtherCAT运动控制器Delta机械手应用,就分享到这里。

更多精彩内容请关注“正运动小助手”公众号,需要相关开发环境与例程代码,请咨询正运动技术销售工程师。

本文由正运动技术原创,欢迎大家转载,共同学习,一起提高中国智能制造水平。文章版权归正运动技术所有,如有转载请注明文章来源。

在这里插入图片描述

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/1656132.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

【数据库原理及应用】期末复习汇总高校期末真题试卷08

试卷 一、选择题(每题 2 分,共 30 分)    1. ___ ____是长期存储在计算机内的有组织,可共享的数据集合. A.数据库管理系统 B.数据库系统 C.数据库 D.文件组织 2. 数据库类型是按照 来划分…

【ITK配准】第十期 进化优化配准样例

很高兴在雪易的CSDN遇见你 VTK技术爱好者 QQ:870202403 公众号:VTK忠粉 前言 本文分享ITK配准中的进化优化配准样例,希望对各位小伙伴有所帮助! 感谢各位小伙伴的点赞+关注,小易会继续努力分享,一起进步! 你的点赞就是我的动力(^U^)ノ~YO 进化优化配准 …

Baidu Comate:智能编码,编程效率的革新者

文章目录 一、何为智能编码助手?二、Baidu Comate智能编码助手简介三、Baidu Comate注册四、Baidu Comate体验Comate插件功能1.注释生成代码2.函数注释生成3.行间注释生成4.生成代码解释5. 调优建议 五、插件功能的使用体验感受和建议 🚩结语 一、何为智…

Linux|了解如何使用 awk 内置变量

引言 当我们揭开 Awk 功能部分时,我们将介绍 Awk 中内置变量的概念。您可以在 Awk 中使用两种类型的变量:用户定义的变量和内置变量。 内置变量的值已经在 Awk 中定义,但我们也可以仔细更改这些值,内置变量包括: FILEN…

三.搜索与图论(未完结)

DFS(深搜) 之前写过三篇关于dfs的 练习总结: 基础算法--递归搜索DFS练习总结(上)-CSDN博客 基础算法--递归搜索DFS练习总结(中)-CSDN博客 基础算法--递归搜索DFS练习总结(下)-CSDN博客 以下题目均为 补充练习: P1460 [USACO2.1] 健康的荷斯坦奶牛 Healthy Holsteins …

【隧道篇 / WAN优化】(7.4) ❀ 03. WAN优化的原理 ❀ FortiGate 防火墙

【简介】相信对WAN优化感兴趣的人都会有疑问,WAN优化真的有作用吗?如果真的有作用,那是根据什么原理呢?让我们来更深入的了解一下。 客户端和服务器端 其实很多人在一开始看到WAN优化这个词,就自然的以为上网速度太慢&…

C++学习第十三天(多态)

1、多态的概念 概念 就是指多种形态,具体点就是去完成某个行为,当不同的对象去完成时会产生不同的状态 2、多态的定义及实现 多态的构成条件 多态是在不同继承关系的类对象,去调用同一函数,产生了不同的行为。 要在继承中构成…

linux权限维持-HackerPermKeeper

🔒 HackerPermKeeper 通过渗透拿到权限之后,为了不让权限丢失,都会进行权限维持,而在进行权限维持的时候,红队需要花费大量的时候,来验证是否合适,因此在这款工具就诞生 HackerPermKeeper[黑客…

【动态规划】子数组、子串系列I|最大子数组和|环形子数组的最大和|乘积最大子数组|乘积为正数的最长子数组长度

一、最大子数组和 最大子数组和 算法原理: 💡细节: 1.返回值为dp表每个位置的最大值,而不是只看最后一个位置,因为可能最后一个位置都不选 2.可以直接在填dp表的时候就进行返回值的比较 3.如果初始化选择多开一个位…

vue+lodop实现web端打印标签功能

背景:项目要求在web端连接标签打印机,打印收件人信息 lodop打印插件地址:Lodop和C-Lodop官网主站 在项目中使用 1、去官网下载lodop包下载中心 - Lodop和C-Lodop官网主站 windows系统直接下载windows32版的就可以 2、解压安装 点击CLodop…

gtest的编译与使用

文章目录 gtest的编译与使用概述笔记CMake参数官方文档测试程序测试效果END gtest的编译与使用 概述 gTest是 googletest的缩写,如果直接找gTest项目,是找不到的。 库地址 https://github.com/google/googletest.git 迁出到本地后,切到最新…

vue中使用element的i18n语言转换(保姆式教程-保证能用)

1、项目中需要使用的插件,vue2或vue3、element、vue-i18n、js-cookie、vuex我是在vue2中使用 npm i element-ui -S npm i js-cookie -S npm i vue-i18n8.28.2 //因为我项目使用的vue2,直接安装报错了,就下载了固定的版本2、在main.js中引入i18n impor…

买手机参考

买手机一定要看cpu排行榜,避免受外界宣传或干扰等因素等的影响,导致买家消费者被割韭菜。是高等手机还是低等手机,cpu排行榜就是照妖镜。cpu综合处理能力(兼顾功耗)排行榜如图。 第二张 第三张 第四张

C#语言核心

一、面向对象基本概念 万物皆对象,用程序来抽象(形容)对象,用面向对象的思想来编程 用中文去形容一类对象,把一类对象的共同点提取出来,然后用程序语言把它翻译过来,带着对象的概念在程序中使…

Excel 查找值的位置后再用位置取值Excel处理

例题描述 Excel 文件中有下图所示的 3 个片区数据 (不同颜色标明)。 现在要算出1-12对应的一列数据,计算规则:在片区3中依次查找1-12,找到后在片区1对应位置取数,如果是0则取片区2同位置的数,如果是1则取F当前查找数。…

docker-compose管理jenkins

1.安装docker和compose 1.docker 更新系统:yum update 安装依赖项:yum install -y yum-utils device-mapper-persistent-data lvm2 配置镜像源:yum-config-manager --add-repo http://mirrors.aliyun.com/docker-ce/linux/centos/docker-ce…

出货300万片后,智舱界「小高通」浮出水面

‍作者 |张祥威 编辑 |德新 2024年北京车展,本土芯片公司开始截击外企供应商。 很长一段时间内,汽车行业智驾芯片看英伟达,座舱芯片看高通。英伟达Orin系列广受欢迎,高通8155席卷主流智能汽车,8295更是被视为最强配置…

Seata之AT 模式的使用

系列文章目录 文章目录 系列文章目录前言 前言 前些天发现了一个巨牛的人工智能学习网站,通俗易懂,风趣幽默,忍不住分享一下给大家。点击跳转到网站,这篇文章男女通用,看懂了就去分享给你的码吧。 Seata 是一款开源的…

STM32F4xx开发学习_USART串口通讯

USART串口通讯 USART简介 USART(universal synchronous asynchronous receiver transmitter),通用同步异步接收发射机,是一种全双工异步通信串行通讯方式,是STM32内部集成的硬件外设,以帧格式传输数据。搭…

NAT网络基本原理和认识,内网穿透的必备知识

NAT的基本介绍 NAT(Network Address Translation)是网络地址转换,它是一个IETF(Internet Engineering Task Force, Internet工程任务组)标准,允许一个整体机构以一个公用IP(Internet Protocol)地址出现在I…