控制器_3.docx

《控制器_3.docx》由会员分享，可在线阅读，更多相关《控制器_3.docx（51页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、控制器正运动技术导语：使用一根网线将控制器的RTEX总线的RX端口与伺服驱动器的TX端口相连，使用另一根网线将控制器的RTEX总线的TX端口与伺服驱动器的RX端口相连。视频教程：?运动控制器RTEX总线使用入门?运动控制器RTEX总线使用入门01准备工作一、材料准备1.硬件A.ZMC460N控制器一台，带RTEX总线接口。B.松下RTEX伺服驱动器+电机一套。C.电脑一台。D.带屏蔽层网线假设干。E.24V直流电源一个。F.接线端子与连接线假设干。2.软件A.ZDevelopV3.10版本控制器编程软件。从正运动官网zmotion下载压缩包，解压后直接运行应用程序，无需安装。B.松下伺服驱动器

2、上位机调试软件。从松下官网下载后安装。二、硬件接线1.控制器接线控制器接口的用处参见下列图。A.主电源：将控制器主电源接线端子上的E+24V端子接入24V直流电源正极，将EGND端子接入24V直流电源负极。B.以太网EtherNET端口接线：使用一根网线将控制器的EtherNET端口与电脑的以太网口相连。C.RTEX伺服驱动器与控制器接线：RTEX总线用于接松下RTEX伺服驱动器，RTEX的接线方法参见下方的配置图。RTEX总线需要接两根线，TX为发送端、RX为接收端。TX需要连接至RX，RX需要连接至TX，所有的设备连接成一个回路，中间不允许断开。使用一根网线将控制器的RTEX总线的RX端口

3、与伺服驱动器的TX端口相连，使用另一根网线将控制器的RTEX总线的TX端口与伺服驱动器的RX端口相连。配置图连接多个RTEX驱动器时，控制器的TX端口与第一个伺服驱动器的RX端口相连，第一个伺服驱动器的TX端口再连接第二个驱动器的RX端口，以此类推，最后一个驱动器的TX端口连接到控制器的RX端口，构成完好的通讯回路。设备编号和驱动器编号按连接顺序自动从0开场编号，与EtherCAT总线编号规那么一样。2.驱动器接线伺服驱动器与电机和编码器的接线参见驱动器手册，将驱动器接上电源。02软件连接方法一、控制器与电脑网口通讯控制器与电脑可以通过串口或者网口连接，下面以网口连接例展开讲明。先将控制器与电

4、脑用网线连接好，接通控制器的电源，再翻开ZDevelop编程软件，点击菜单栏“控制器“连接，翻开“连接到控制器窗口。通过“连接到控制器窗口，可以快速查看本机IP，比照控制器与电脑是否处于同一网段。IP地址列表下拉选择时，会自动查找当前局域网可用的控制器IP地址(控制器上电POWER灯和RUN灯亮的时候就能查找到该控制器的IP地址)。同一个网络有多个控制器的时候，IP的下拉列表假设没有显示目的控制器的IP地址，可以采取IP扫描来查看当前所有可用的控制器IP地址，扫描完成之后确定关闭此窗口，重新在IP下拉列表选择。选择正确的IP地址，点击连接之后，编程软件与控制器连接成功，在线命令与输出窗口打印信

5、息提示。控制器出厂的缺省IP地址为192.168.0.11，“连接到控制器窗口能显示出本机IP地址，请注意设置有线网卡与无线网卡各自的IP。电脑需要设置IP地址与控制器IP处于同一网段才能连接，即四段的前三段要一样，最后一段不同才能通讯。假设控制器与电脑不处于同一网段，那么需要修改控制器或者电脑其中之一的IP地址，使二者处于同一网段。修改控制器IP地址需要先使用串口连接控制器，获取控制器IP地址，然后修改本机IP或者控制器IP使二者处于同一网段。二、驱动器软件与驱动器通信修改驱动器参数先连接驱动器，可选USB线或者WLAN连接驱动器，这里使用USB线连接电脑与驱动器端的X1端口，给驱动器上电，

6、翻开松下驱动器软件PANATERM，弹出“选择与驱动器通信窗口，选择与驱动器通过USB连接后，自动获取到驱动器信息显示在窗口内，点击OK连接成功，就能与驱动器通信，读取驱动器的参数设置，对驱动器参数进展变更。03RTEX总线驱动器参数设置一、驱动器参数修改RTEX修改驱动器参数类似EtherCAT，一是采用松下驱动器软件修改，二是使用指令修改，DRIVE_READ参数读取、DRIVE_WRITE参数写入，在总线开启后再使用指令修改，伺服参数的功能与设置参见松下RTEX驱动器手册描绘。语法：DRIVE_READ(参数,数据存储到VR的位置)语法：DRIVE_WRITE(参数,参数值)参数写法：不

7、同类型的参数读写语法不同参数分类*256+参数编号(Pr7.20=7*256+20)参数=130，读取钳位的状态,BIT0,BIT1表示两个通道的状态参数=$10000+(ssid)读取RTEX驱动器系统信息，字符串存储在VRSTRING参数=$20000+(报警功能码)+($1000*索引)读取报警信息参数=$30000+(监视功能码)+($1000*索引)读取监视器信息指令读写参数例如:BASE(0)选择轴0对应的驱动器DRIVE_WRITE(7*256+11,6)写Pr7.11参数为6DRIVE_WRITE(0*256+0,1)写Pr0.00参数为1DRIVE_READ(0*256+0)

8、读Pr0.00参数的值DRIVE_READ(0*256+0)AXIS(1)读Pr0.00参数的值,AXIS指定轴号，不指定读取轴0DRIVE_READ($10000+$01)读取厂商名，不指定存储位置时，直接打印出来驱动器修改参数例如：电机的旋转方向可以通过参数Pr0.00调整，可选择CW为正方向或者选择CCW为正方向。下列图选择CCW为正方向，即发送正方向的运动指令时，电机轴旋转方向为逆时针。参数修改完成之后，电机EEP按钮，将修改的参数写入驱动器的EEPROM里，给驱动器重新上电参数生效。电机旋转方向的定义：从负载侧的轴端看，顺时针为CW，逆时针为CCW。PR0.00参数方向设置参考：二、

9、电子齿轮比伺服电机电子齿轮比就是伺服对接收到的控制器脉冲频率进展放大或缩小，比值大于1就是放大，比值小于1就是缩小，比值等于1时电机承受脉冲数等于控制器发出脉冲数。电子齿轮比通过Pr0.09与Pr0.10的比值确定，电子齿轮比=Pr0.09/Pr0.10。计算公式：电机接收的实际脉冲数=控制器发送脉冲数*电子齿轮比例如：控制器发出脉冲10000个，电子齿轮比分子设为1，分母设为2，电子齿轮比为0.5，那么伺服实际运行按照5000个脉冲来进展。控制器发出脉冲10000个，电子齿轮比分子设为2，分母设为1，电子齿轮比为2，那么伺服实际运行按照20000个脉冲来进展。松下RTEX驱动器电子齿轮的比值

10、在1/1000-8000倍的范围内有效，超出此范围驱动器报错。电机旋转一圈的指令脉冲数通过Pr0.08设置，如上图设为10000，表示发送10000个脉冲能使电机旋转一圈。三、通讯周期控制器的周期必须与驱动器周期一致才可以成功通讯，控制器周期出厂默认为1ms，通过晋级固件修改控制器周期。Rtex总线驱动器的通讯周期目前有2种，0.5ms和1ms，通过设置驱动器参数P7.20和P7.21选择。注意P7.21参数一定要设置为1，否那么无法通讯。驱动器的周期可以通过指令修改，可以以通过驱动器软件找到上述参数直接修改。指令读写驱动器通讯周期例如：读取通讯周期，读取的数据存储在VR里DRIVE_READ

11、(7*256+20,0)Pr7.20=7*256+20，Rtex通讯周期：3-0.5ms，6-1msDRIVE_READ(7*256+21,1)Pr7.21=7*256+21，Rtex指令更新周期比：1修改通讯周期，修改完写入EEPROM，重启生效DRIVE_WRITE(7*256+20,SERVO_PERIOD/1000*6)Pr7.20=7*256+20，Rtex通讯周期：3-0.5ms，6-1msDRIVE_WRITE(7*256+21,1)Pr7.21=7*256+21，Rtex指令更新周期比：1DRIVE_WRITE(128,1)写EEPROM,修改完成后需要断电驱动器软件修改通讯周

12、期例如：连接驱动器软件，在参数窗口，找到参数分类7，修改Pr7.20和Pr7.21修改驱动器周期。四、驱动器IO映射驱动器IO映射需要先将DRIVE_PROFILE=1，表示带驱动器IO映射(DRIVE_PROFILE=0不带驱动器IO映射)，然后使用DRIVE_IO指令设置驱动器IO地址，映射的编号范围不要与总线上的其他设备的IO编号重复。映射完成，控制器就能通过映射的驱动器IO编号，操作驱动器IO电平。不映射无法通过控制器操作驱动器IO。DRIVE_IO(轴号)=输入输出IO起始编号。例如：DRIVE_PROFILE(iAxis)=1带驱动器IO映射DRIVE_IO(iAxis)=i_Io

13、Num设定驱动器输入/输出IO起始编号驱动器的IO操作，翻开参数窗口的参数分类4，对输出输出的进展设定。五、驱动器轴映射RTEX总线上连接的设备的设备号按照连接顺序从0开场自动编号，驱动器编号也是按连接顺序给驱动器设备自动从0开场编号的，只算总线上的驱动器设备，其他设备是没有驱动器编号的。RTEX总线上连接的驱动器需要使用指令映射驱动器的轴号，使用AXIS_ADDRESS指令映射，映射完成之后才能使用BASE指令选择驱动器轴号，发送脉冲，控制驱动器所连的电机运行。轴映射写在总线初始化程序中，总线扫描之后，开启总线之前。语法：AXIS_ADDRESS(轴号)=(槽位号16)+驱动器编号+1单总线

14、控制器的总线槽位号缺省为0，即只支持RTEX总线的控制器，RTEX从槽位号是0。使用ZMC460N时，由于是双总线控制器，EtherCAT总线槽位号为0，RTEX的槽位号为1。轴号为驱动器映射的目的轴号，映射时每个驱动器的轴号不重复，指向空闲轴号即可。例如：单总线RTEX槽位号填0，双总线RTEX槽位号为1。AXIS_ADDRESS(6)=(116)+0+1第一个RTEX驱动器，驱动器编号0，绑定为轴6AXIS_ADDRESS(7)=(116)+1+1第二个RTEX驱动器，驱动器编号1，绑定为轴7AXIS_ADDRESS(8)=(116)+2+1第三个RTEX驱动器，驱动器编号2，绑定为轴8A

15、TYPE(6)=50设置为RTEX轴类型，50-位置51-速度52-转矩ATYPE(7)=50ATYPE(8)=50六、驱动器控制形式RTEX总线的控制形式有三种，使用ATYPE指令设置，ATYPE=50位置形式，ATYPE=51速度形式，ATYPE=52力矩形式。位置形式采用运动指令控制轴运动，速度和力矩形式采用DAC指令控制轴运动，速度与力矩形式下切换其他形式的时候先将DAC置0，再修改ATYPE的值，防止发惹事故。控制形式由参数Pr0.01设定，选择0半闭环控制，此时可以使用ATYPE指令切换控制器的控制形式，例如位置、速度和力矩形式。1.ATYPE=50位置形式设置好轴参数，使用运动控

16、制器指令控制电机运行。2.ATYPE=51速度形式速度形式下使用DAC指令设置电机的运行速度，并持续运行，此形式下不能使用运动指令，故无需设置轴参数，将DAC=0停顿运行。速度形式下假设要切换形式，为防止事故，先将DAC置0后再使用ATYPE指令切换。RTEX速度形式下，通过参数Pr7.25设定速度单位，值为0对应单位：r/min，值为1对应单位：指令单位/s。速度形式使用DRIVE_READ读取速度的单位，如下列图值为0，此时单位是r/min。DRIVE_READ读取不填参数保存地址时直接打印出来。3.ATYPE=52力矩形式修改ATYPE切换到力矩形式之前，请先将驱动器参数Pr6.47的第

17、一位置为0，关闭2自由度控制形式。再通过参数Pr3.17设置速度限制，如下列图(参照松下Rtex手册)。Pr3.17(速度限制选择)的设定值是0时，通过Pr3.21设置速度限制，设定值是1时，可以通过SL_SW切换转矩控制时的速度限制值。DRIVE_WRITE指令设置参考：按轴号依次设置DRIVE_WRITE(6*256+47,0)AXIS(0)Pr6.47设为0，关闭2自由度控制形式DRIVE_WRITE(3*256+17,0)AXIS(0)Pr3.17速度限制选择设为0，通过Pr3.21设置速度限制DRIVE_WRITE(3*256+21,5000)AXIS(0)Pr3.21速度限制设为5

18、000DRIVE_READ指令读取驱动器设置情况:将所有介入运动的轴均按照以上参数设置完成，就可以切换力矩形式，使用DAC指令发送力矩控制电机持续运行，此形式下不能使用运动指令，故无需设置轴参数，将DAC=0停顿运行。力矩形式下假设要切换形式，为防止事故，先将DAC置0后再使用ATYPE指令切换。七、驱动器回零RTEX总线可使用控制器提供的回零方式DATUM(mode)，mode形式值选择查看ZBasic编程手册的DATUM指令。RTEX总线可以以使用驱动器本身的回零形式。驱动器本身回零使用DATUM(21,mode2)指令，mode2形式值要查驱动器手册，mode2填入对应驱动器回零形式值，

19、见下表松下驱动器提供的回零形式，注意此时的原点限位等信号要接在驱动器上，并使用指令设置这些特殊信号对应的IO口，所以要使用驱动器回零时需要对驱动器的IO进展映射。语法：DATUM(21,$11)按驱动器当前回零形式开场回零RTEX总线驱动器回零形式八、驱动器报警观察驱动器上LED面板上是否有报错信息，报错会显示错误码，根据驱动器手册排查错误，修正后将报警清零。假设控制器连接了ZDevelop软件，驱动器报错时，AXISSTATUS轴状态提示错误信息。翻开驱动器软件的报警窗口，也能看当前驱动器是否有警报，或者查询历史警报。04RTEX总线初始化程序一、初始化程序RTEX总线上连接的电机需要编写一

20、段RTEX总线初始化程序来进展使能。使能之后的应用与脉冲电机一致，运动指令都是一样的。初始化程序一般经过：1.使用SLOT_SCAN扫描设备，判断RETURN是否正确，未连接设备时会报错。2.通过NODE_INFO/NODE_AXIS_COUNT等对设备类型、信息等进展判断。3.依次设置AIXS_ADDRESS，ATYPE，DRIVE_PROFILE，DRIVE_IO等。4.SLOT_START启动设备。5.建立连接后主站和从站即可进展周期性数据交换。RTEX初始化程序与EtherCAT总线初始化类似，初始化参考程序如下：*RTEX总线初始化globalCONSTMAX_AXISNUM=60最

21、大轴数globalCONSTBus_Slot=1槽位号0(单总线控制器缺省0)globalCONSTPUL_AxisStart=0本地脉冲轴起始轴号globalCONSTPUL_AxisNum=0本地脉冲轴轴数量globalCONSTBus_AxisStart=0总线轴起始轴号globalCONSTBus_NodeNum=2总线配置节点数量,用于判断实际检测到的从站数量是否一致globalBus_InitStatus总线初始化完成状态Bus_InitStatus=-1globalBus_TotalAxisnum检查扫描的总轴数delay(3000)延时3S等待驱动器上电，详细根据驱动器调整延时

22、?总线通讯周期：,SERVO_PERIOD,usRtex_Init()初始化RTEX总线while(Bus_InitStatus=0)重新初始化Rtex_Init()wendend*RTEX总线初始化*初始流程:slot_scan(扫描总线)-从站节点映射轴/io-SLOT_START(启动总线)-初始化成功*globalsubRtex_Init()localNode_Num,Temp_AxisRAPIDSTOP(2)fori=0toMAX_AXISNUM-1初始化复原轴类型AXIS_ENABLE(i)=0atype(i)=0AXIS_ADDRESS(i)=0DELAY(10)防止所有驱动器全

23、部同时切换使能导致瞬间电流过大nextBus_InitStatus=-1Bus_TotalAxisnum=0SLOT_STOP(Bus_Slot)delay(200)SLOT_SCAN(Bus_Slot)扫描总线ifreturnthen?总线扫描成功,连接从站设备数：NODE_COUNT(Bus_Slot)ifNODE_COUNT(Bus_Slot)Bus_NodeNumthen判断总线检测数量是否为实际接线数量?扫描节点数量与程序配置数量不一致!,配置数量:Bus_NodeNum,检测数量：NODE_COUNT(Bus_Slot)Bus_InitStatus=0初始化失败。报警提示retur

24、nendif开场映射轴号forNode_Num=0toNODE_COUNT(Bus_Slot)-1遍历扫描到的所有从站节点ifNODE_AXIS_COUNT(Bus_Slot,Node_Num)0then判断当前节点是否有电机forj=0toNODE_AXIS_COUNT(Bus_Slot,Node_Num)-1根据节点带的电机数量循环配置轴参数(针对一拖多驱动器)Temp_Axis=Bus_AxisStart+Bus_TotalAxisnum轴号按NODE顺序分配Temp_Axis=Dirve_Alias轴号按驱动器设定的拨码分配(一拖多需要特殊处理)Sub_SetNodePara(Node

25、_Num,Temp_Axis)ifreturn=FALSEthenBus_InitStatus=0通讯周期不匹配returnendifbase(Temp_Axis)AXIS_ADDRESS=(116)+Bus_TotalAxisnum+1映射轴号ATYPE=50设置控制形式50-位置51-速度52-转矩disable_group(Temp_Axis)每轴单独分组Bus_TotalAxisnum=Bus_TotalAxisnum+1总轴数+1nextendifnext?轴号映射完成,连接总轴数：Bus_TotalAxisnumDELAY200SLOT_START(Bus_Slot)启动总线ifr

26、eturnthenwdog=1使能总开关?开场去除驱动器错误fori=Bus_AxisStarttoBus_AxisStart+Bus_TotalAxisnum-1BASE(i)DRIVE_CLEAR(0)DELAY50datum(0)去除控制器轴状态错误DELAY50轴使能AXIS_ENABLE=1nextBus_InitStatus=1?轴使能完成本地脉冲轴配置fori=0toPUL_AxisNum-1base(PUL_AxisStart+i)AXIS_ADDRESS=(-116)+iATYPE=4next?总线开启成功else?总线开启失败Bus_InitStatus=0endifels

27、e?总线扫描失败Bus_InitStatus=0endifendsub*从站节点特殊参数配置*通过DRIVE_READ/DRIVE_WRITE修改从站参数(详细参数查看驱动器手册)*globalsubSub_SetNodePara(iNode,Iaxis)base(Iaxis)vr(0)=0vr(1)=0DRIVE_READ(7*256+20,0)(Pr7.20=7*256+20)Rtex通讯周期3-0.5ms6-1msDRIVE_READ(7*256+21,1)(Pr7.21=7*256+21)Rtex指令更新周期比1if(vr(0)/6*1000SERVO_PERIOD)or(vr(1)1

28、)then判断驱动器周期和控制器周期是否匹配?总线周期不匹配：,控制周期-,SERVO_PERIOD,轴号-,Iaxis,伺服周期-,(vr(0)/6*1000*vr(1)DRIVE_WRITE(7*256+20,SERVO_PERIOD/1000*6)(Pr7.20=7*256+20)Rtex通讯周期3-0.5ms6-1msDRIVE_WRITE(7*256+21,1)(Pr7.21=7*256+21)Rtex指令更新周期比1DRIVE_WRITE(128,1)写EEPROM,修改完成后需要断电returnFALSEendifreturnTRUEendsub二、总线状态查看总线状态查看的前提是初始化操作成功，控制器与驱动器接线正确，否那么无法查看以下信息。1.在菜单栏“控制器“控制器状态窗口查看“槽位1节点，单总线控制器查看“槽位0节点。2.还可以通过在线命令发送?*RTEX打印RTEX总线上的全部设备信息。3.在菜单栏“调试“总线状态诊断翻开如下窗口查看控制器所有总线槽位接口的设备信息。实际运行效果参见视频尾部演示局部。?运动控制器RTEX总线使用入门?就讲到这里。更多学习视频及图文详解请关注我们的公众号“正运动小助手。本文由正运动技术原创，欢送大家转载，共同学习，一起进步中国智能制造程度。文章版权归正运动技术所有，如有转载请注明文章;。0