对于不同的主控系统，机器人发送当前位置数据的方式也多种多样。如果使用PC机作为上位机来读取机器人实时位置信息，那么我们就可以通过使用IRC5OPCServer来读取机器人位置数据，然后再发送给PC上位机；当然，也可以通过PCSDK对机器人控制器进行二次开发，然后通过PCInterface选项，直接读取控制器中机器人的位置信息。如果是使用PLC作为上位机来读取机器人实时位置信息，那么我们就可以通过工业现场通信，如ProfiBus、ProfiNet、DeviceNet等，然后使用ABB机器人内置的数据处理指令编写实时位置数据发送程序，来实现机器人位置数据的发送。
本期，就来为大家介绍一下ABB机器人通过现场通信形式，向西门子PLC发送实时位置数据的方法。
变量声明
机器人的当前位置就是工具末端的当前位置，也就是TCP的当前坐标，它是由x、y、z的坐标值以及分别绕x、y、z轴旋转的角度值组成，这些数据的类型均是实数类型。在ABB机器人中，使用num与dnum来表示实数，其中num类型与西门子PLC中的real类型一致，都是32位的单精度实数；而dnum类型数据是64位的双精度实数。因此，在机器人中，我们可以声明num类型变量来存放机器人的当前位置数据。同时，声明其他类型的数据变量，作为数据处理的中间转换变量。变量声明代码如下所示。
变量声明程序代码如下所示：
!声明机器人当前位姿变量VARrobtargetpCurrentPos;!声明机器人位姿存储变量VARnumx;VARnumy;VARnumz;VARnumrx;VARnumry;VARnumrz;!声明机器人位姿通用数据容器中间转换变量VARrawbytesrawbyte_x;VARrawbytesrawbyte_y;VARrawbytesrawbyte_z;VARrawbytesrawbyte_rx;VARrawbytesrawbyte_ry;VARrawbytesrawbyte_rz;!声明机器人位姿字节型中间数据转换变量VARbytebyte_x{4};VARbytebyte_y{4};VARbytebyte_z{4};VARbytebyte_rx{4};VARbytebyte_ry{4};VARbytebyte_rz{4};!声明双精度类型机器人位姿数据变量VARdnumdn_x;VARdnumdn_y;VARdnumdn_z;VARdnumdn_rx;VARdnumdn_ry;VARdnumdn_rz;!声明中断数据变量VARintnumTrapNum;组输出信号配置ABB机器人传输实数数据的方式大致可以分为两种：一、使用模拟量输出信号传输实数数据，由于模拟量信号自身抗干扰性能差，并且需要加装价格昂贵的模量信号扩展模块，因此，在传输大量的实数数据的场合中，一般很少使用模拟量信号；二、使用组输出信号传输实数数据，组输出信号不仅可以通过加装价格相对低廉的数字量I/O信号扩展模块实现，也可以通过加装现场通信模块的方式实现。本例，使用第二种方式，通过ProfiBus现场总线通信的形式来传输机器人当前位置数据。
由于机器人当前位置数据都是32位的单精度实数类型，所以，我们定义的每一个组输出信号长度也应该是32位。
中断子程序编写
创建中断子例行程序，并在其中编写读取机器人当前位置x、y、z坐标数据程序。由于ABB机器人系统中使用四元数形式表示TCP绕相应坐标轴的旋转角度，因此，这里需要使用EulerZYX指令将以四元数形式表示的角度数据转换为欧拉角形式表示的旋转角度数据。完整的中断子程序代码如下所示。
中断子程序代码如下所示：
TRAPiTrap!中断程序iTrap!读取机器人当前位置，并将读取数据赋值给pCurrentPospCurrentPos:=CRobT();!将读取到的机器人当前位置x、y、z坐标值分别赋值给变量x、y、zx:=pCurrentPos.trans.x;y:=pCurrentPos.trans.y;z:=pCurrentPos.trans.z;!将将读取到的机器人当前位置四元数角度值转换为欧拉角之后，分别赋值给变量rx、ry、rzrx:=EulerZYX(\x,pCurrentPos.rot);ry:=EulerZYX(\y,pCurrentPos.rot);rz:=EulerZYX(\z,pCurrentPos.rot);!调用发送机器人当前位置例行程序send_pCurrentPos;ENDTRAP机器人当前位置数据发送子程序编写创建发送机器人当前位置数据子例行程序，并将其在中断子程序中调用。首先，将读取的机器人当前位置数据使用PackRawBytes指令按照Float形式进行打包，然后将其存放到已经声明的rawbyte类型容器变量的连续四个字节中。
然后使用FOR指令进行循环解包操作，即将打包好的数据使用UnpackRawBytes指令解包到声明的byte类型四维数组变量中，每一个字节对应数组变量中的一维byte元素。
由于西门子PLC中数据采用大端存储模式，而ABB机器人中的数据采用的是小端存储模式，为了发送的数据能够被PLC正确解析，因此，我们需要对机器人的位置数据进行移位操作。所谓的大端模式（Big-endian），是指数据的高字节，保存在内存的低地址中，而数据的低字节，保存在内存的高地址中，地址由小向大增加，而数据从高位往低位放；小端模式（Little-endian）是指数据的高字节保存在内存的高地址中，而数据的低字节保存在内存的低地址中，这种存储模式将地址的高低和数据位权值有效结合起来，高地址部分权值高，低地址部分权值低，和我们的逻辑方法一致。
对于ABB机器人当前位置数据的移位操作：首先使用NumToDnum指令将解包后的byte类型数据转换为dnum类型，然后按照西门子PLC中实数类型数据高低字节顺序进行移位操作，数据移位指令使用BitLShDnum。同时，将四个移位后的byte类型数据使用BitOrDnum指令进行“逻辑或”运算，重新组成32位的单精度数据，并将其存放到声明好的dnum类型变量中。当然，这个移位操作，我们也可以在PLC中实现。
最后，使用setgo指令将转换好的机器人当前位置数据赋值到相应的组输出信号，然后发送给PLC。
机器人当前位置数据发送子程序代码如下所示：
PROCsend_pCurrentPos()!发送机器人当前位置例行程序!清空机器人位姿通用数据容器中间转换变量ClearRawBytesrawbyte_x;ClearRawBytesrawbyte_y;ClearRawBytesrawbyte_z;ClearRawBytesrawbyte_rx;ClearRawBytesrawbyte_ry;ClearRawBytesrawbyte_rz;!将机器人当前位置数据按照float形式打包PackRawBytesx,rawbyte_x,RawBytesLen(rawbyte_x)1\Float4;PackRawBytesy,rawbyte_y,RawBytesLen(rawbyte_y)1\Float4;PackRawBytesz,rawbyte_z,RawBytesLen(rawbyte_z)1\Float4;PackRawBytesrx,rawbyte_rx,RawBytesLen(rawbyte_rx)1\Float4;PackRawBytesry,rawbyte_ry,RawBytesLen(rawbyte_ry)1\Float4;PackRawBytesrz,rawbyte_rz,RawBytesLen(rawbyte_rz)1\Float4;!将机器人位姿通用数据容器里的前4个字节数据分别保存到字节数组变量中FORiFROM1TO4DOUnpackRawBytesrawbyte_x,i,byte_x{i}\Hex1;UnpackRawBytesrawbyte_y,i,byte_y{i}\Hex1;UnpackRawBytesrawbyte_z,i,byte_z{i}\Hex1;UnpackRawBytesrawbyte_rx,i,byte_rx{i}\Hex1;UnpackRawBytesrawbyte_ry,i,byte_ry{i}\Hex1;UnpackRawBytesrawbyte_rz,i,byte_rz{i}\Hex1;ENDFOR!机器人数据格式转换（西门子PLC高低字节与机器人高低字节定义相反）dn_x:=BitLShDnum(NumToDnum(byte_x{1}),24);!将单精度数据byte_x{1}转换为双精度类型后，左移24位，然后赋值给dn_xdn_x:=BitOrDnum(dn_x,BitLShDnum(NumToDnum(byte_x{2}),16));!将单精度数据byte_x{2}转换为双精度类型后，左移16位，并与dn_x做或运算，然后赋值给自己dn_x:=BitOrDnum(dn_x,BitLShDnum(NumToDnum(byte_x{3}),8));!将单精度数据byte_x{2}转换为双精度类型后，左移8位，并与dn_x做或运算，然后赋值给自己dn_x:=BitOrDnum(dn_x,NumToDnum(byte_x{4}));!将单精度数据byte_x{2}转换为双精度类型后，与dn_x做或运算，然后赋值给自己!机器人数据格式转换dn_y:=BitLShDnum(NumToDnum(byte_y{1}),24);dn_y:=BitOrDnum(dn_y,BitLShDnum(NumToDnum(byte_y{2}),16));dn_y:=BitOrDnum(dn_y,BitLShDnum(NumToDnum(byte_y{3}),8));dn_y:=BitOrDnum(dn_y,NumToDnum(byte_y{4}));!机器人数据格式转换dn_z:=BitLShDnum(NumToDnum(byte_z{1}),24);dn_z:=BitOrDnum(dn_z,BitLShDnum(NumToDnum(byte_z{2}),16));dn_z:=BitOrDnum(dn_z,BitLShDnum(NumToDnum(byte_z{3}),8));dn_z:=BitOrDnum(dn_z,NumToDnum(byte_z{4}));!机器人数据格式转换dn_rx:=BitLShDnum(NumToDnum(byte_rx{1}),24);dn_rx:=BitOrDnum(dn_rx,BitLShDnum(NumToDnum(byte_rx{2}),16));dn_rx:=BitOrDnum(dn_rx,BitLShDnum(NumToDnum(byte_rx{3}),8));dn_rx:=BitOrDnum(dn_rx,NumToDnum(byte_rx{4}));!机器人数据格式转换dn_ry:=BitLShDnum(NumToDnum(byte_ry{1}),24);dn_ry:=BitOrDnum(dn_ry,BitLShDnum(NumToDnum(byte_ry{2}),16));dn_ry:=BitOrDnum(dn_ry,BitLShDnum(NumToDnum(byte_ry{3}),8));dn_ry:=BitOrDnum(dn_ry,NumToDnum(byte_ry{4}));!机器人数据格式转换dn_rz:=BitLShDnum(NumToDnum(byte_rz{1}),24);dn_rz:=BitOrDnum(dn_rz,BitLShDnum(NumToDnum(byte_rz{2}),16));dn_rz:=BitOrDnum(dn_rz,BitLShDnum(NumToDnum(byte_rz{3}),8));dn_rz:=BitOrDnum(dn_rz,NumToDnum(byte_rz{4}));!使用相应的组输出信号，将机器人当前位置数据进行输出setgogo_cx,dn_x;setgogo_cy,dn_y;setgogo_cz,dn_z;setgogo_crx,dn_rx;setgogo_cry,dn_ry;setgogo_crz,dn_rz;ENDPROC机器人主程序编写在主程序中编写定时器中断程序，中断时间间隔为0.5s，即每个0.5s读取一次机器人当前位置，并将当前位置数据发送给PLC。完整机器人主程序代码如下所示。
机器人主程序代码如下所示：
PROCmain()IDeleteTrapNum;!取消识别号为TrapNum的中断CONNECTTrapNumWITHiTrap;!将识别号为TrapNum的中断与中断程序iTrap连接ITimer0.5,TrapNum;!循环调用中断程序TrapNum，循环周期为0.5s!循环执行机器人运动程序WHILETRUEDOMoveAbsJjpos10\NoEOffs,v50,z50,tool0;MoveJp10,v50,z50,tool0;MoveJp20,v50,z50,tool0;MoveAbsJjpos10\NoEOffs,v50,z50,tool0;ENDWHILEENDPROC完整的机器人程序代码如下所示。
完整的机器人程序代码如下所示：
MODULEModule1CONSTjointtargetjpos10:=[[0,0,0,0,30,0],[9E09,9E09,9E09,9E09,9E09,9E09]];CONSTrobtargetp10:=[[392.836308491,-156.6306903,309.536253784],[0.165037067,-0.000000128,0.986287365,0.000000003],[-1,0,-1,0],[9E09,9E09,9E09,9E09,9E09,9E09]];CONSTrobtargetp20:=[[392.836306583,149.260106132,309.53614795],[0.165037087,-0.000000142,0.986287362,0],[0,-1,0,0],[9E09,9E09,9E09,9E09,9E09,9E09]];!声明机器人当前位姿变量VARrobtargetpCurrentPos;!声明机器人位姿存储变量VARnumx;VARnumy;VARnumz;VARnumrx;VARnumry;VARnumrz;!声明机器人位姿通用数据容器中间转换变量VARrawbytesrawbyte_x;VARrawbytesrawbyte_y;VARrawbytesrawbyte_z;VARrawbytesrawbyte_rx;VARrawbytesrawbyte_ry;VARrawbytesrawbyte_rz;!声明机器人位姿字节型中间数据转换变量VARbytebyte_x{4};VARbytebyte_y{4};VARbytebyte_z{4};VARbytebyte_rx{4};VARbytebyte_ry{4};VARbytebyte_rz{4};!声明双精度类型机器人位姿数据变量VARdnumdn_x;VARdnumdn_y;VARdnumdn_z;VARdnumdn_rx;VARdnumdn_ry;VARdnumdn_rz;!声明中断数据变量VARintnumTrapNum;PROCmain()IDeleteTrapNum;!取消识别号为TrapNum的中断CONNECTTrapNumWITHiTrap;!将识别号为TrapNum的中断与中断程序iTrap连接ITimer0.5,TrapNum;!循环调用中断程序TrapNum，循环周期为0.5s!循环执行机器人运动程序WHILETRUEDOMoveAbsJjpos10\NoEOffs,v50,z50,tool0;MoveJp10,v50,z50,tool0;MoveJp20,v50,z50,tool0;MoveAbsJjpos10\NoEOffs,v50,z50,tool0;ENDWHILEENDPROCTRAPiTrap!中断程序iTrap!读取机器人当前位置，并将读取数据赋值给pCurrentPospCurrentPos:=CRobT();!将读取到的机器人当前位置x、y、z坐标值分别赋值给变量x、y、zx:=pCurrentPos.trans.x;y:=pCurrentPos.trans.y;z:=pCurrentPos.trans.z;!将将读取到的机器人当前位置四元数角度值转换为欧拉角之后，分别赋值给变量rx、ry、rzrx:=EulerZYX(\x,pCurrentPos.rot);ry:=EulerZYX(\y,pCurrentPos.rot);rz:=EulerZYX(\z,pCurrentPos.rot);!调用发送机器人当前位置例行程序send_pCurrentPos;ENDTRAPPROCsend_pCurrentPos()!发送机器人当前位置例行程序!清空机器人位姿通用数据容器中间转换变量ClearRawBytesrawbyte_x;ClearRawBytesrawbyte_y;ClearRawBytesrawbyte_z;ClearRawBytesrawbyte_rx;ClearRawBytesrawbyte_ry;ClearRawBytesrawbyte_rz;!将机器人当前位置数据按照float形式打包PackRawBytesx,rawbyte_x,RawBytesLen(rawbyte_x)1\Float4;PackRawBytesy,rawbyte_y,RawBytesLen(rawbyte_y)1\Float4;PackRawBytesz,rawbyte_z,RawBytesLen(rawbyte_z)1\Float4;PackRawBytesrx,rawbyte_rx,RawBytesLen(rawbyte_rx)1\Float4;PackRawBytesry,rawbyte_ry,RawBytesLen(rawbyte_ry)1\Float4;PackRawBytesrz,rawbyte_rz,RawBytesLen(rawbyte_rz)1\Float4;!将机器人位姿通用数据容器里的前4个字节数据分别保存到字节数组变量中FORiFROM1TO4DOUnpackRawBytesrawbyte_x,i,byte_x{i}\Hex1;UnpackRawBytesrawbyte_y,i,byte_y{i}\Hex1;UnpackRawBytesrawbyte_z,i,byte_z{i}\Hex1;UnpackRawBytesrawbyte_rx,i,byte_rx{i}\Hex1;UnpackRawBytesrawbyte_ry,i,byte_ry{i}\Hex1;UnpackRawBytesrawbyte_rz,i,byte_rz{i}\Hex1;ENDFOR!机器人数据格式转换（西门子PLC高低字节与机器人高低字节定义相反）dn_x:=BitLShDnum(NumToDnum(byte_x{1}),24);!将单精度数据byte_x{1}转换为双精度类型后，左移24位，然后赋值给dn_xdn_x:=BitOrDnum(dn_x,BitLShDnum(NumToDnum(byte_x{2}),16));!将单精度数据byte_x{2}转换为双精度类型后，左移16位，并与dn_x做或运算，然后赋值给自己dn_x:=BitOrDnum(dn_x,BitLShDnum(NumToDnum(byte_x{3}),8));!将单精度数据byte_x{2}转换为双精度类型后，左移8位，并与dn_x做或运算，然后赋值给自己dn_x:=BitOrDnum(dn_x,NumToDnum(byte_x{4}));!将单精度数据byte_x{2}转换为双精度类型后，与dn_x做或运算，然后赋值给自己!机器人数据格式转换dn_y:=BitLShDnum(NumToDnum(byte_y{1}),24);dn_y:=BitOrDnum(dn_y,BitLShDnum(NumToDnum(byte_y{2}),16));dn_y:=BitOrDnum(dn_y,BitLShDnum(NumToDnum(byte_y{3}),8));dn_y:=BitOrDnum(dn_y,NumToDnum(byte_y{4}));!机器人数据格式转换dn_z:=BitLShDnum(NumToDnum(byte_z{1}),24);dn_z:=BitOrDnum(dn_z,BitLShDnum(NumToDnum(byte_z{2}),16));dn_z:=BitOrDnum(dn_z,BitLShDnum(NumToDnum(byte_z{3}),8));dn_z:=BitOrDnum(dn_z,NumToDnum(byte_z{4}));!机器人数据格式转换dn_rx:=BitLShDnum(NumToDnum(byte_rx{1}),24);dn_rx:=BitOrDnum(dn_rx,BitLShDnum(NumToDnum(byte_rx{2}),16));dn_rx:=BitOrDnum(dn_rx,BitLShDnum(NumToDnum(byte_rx{3}),8));dn_rx:=BitOrDnum(dn_rx,NumToDnum(byte_rx{4}));!机器人数据格式转换dn_ry:=BitLShDnum(NumToDnum(byte_ry{1}),24);dn_ry:=BitOrDnum(dn_ry,BitLShDnum(NumToDnum(byte_ry{2}),16));dn_ry:=BitOrDnum(dn_ry,BitLShDnum(NumToDnum(byte_ry{3}),8));dn_ry:=BitOrDnum(dn_ry,NumToDnum(byte_ry{4}));!机器人数据格式转换dn_rz:=BitLShDnum(NumToDnum(byte_rz{1}),24);dn_rz:=BitOrDnum(dn_rz,BitLShDnum(NumToDnum(byte_rz{2}),16));dn_rz:=BitOrDnum(dn_rz,BitLShDnum(NumToDnum(byte_rz{3}),8));dn_rz:=BitOrDnum(dn_rz,NumToDnum(byte_rz{4}));!使用相应的组输出信号，将机器人当前位置数据进行输出setgogo_cx,dn_x;setgogo_cy,dn_y;setgogo_cz,dn_z;setgogo_crx,dn_rx;setgogo_cry,dn_ry;setgogo_crz,dn_rz;ENDPROCENDMODULE运行测试在PLC中进行组态编程，然后运行机器人，同时对PLC中相应的数据寄存器进行监视，可以看到机器人的实时位置数据已经发送过来了，并且每隔0.5s刷新一次。西门子老版本的PLC实数数据的高低位字节顺序与ABB机器人的实数数据的高低位顺序是相反的；新版本的PLC，小编还没有测试过，若是使用新版本的PLC，测试时可以注意一下。如果高低位字节顺序是一致的，那么只需要把发送机器人当前位置数据子例行程序中的数据移位程序删除即可。对于三菱PLC、欧姆龙PLC或是其他品牌的PLC，读取机器人当前位置的程序都是类似的，感兴趣的小伙伴可以自己测试一下。
TheEnd
上一篇：Robotstudio软件：机床上下料工作站机器人主逻辑编写与仿真运行
~
#13530941186#
ABB的modulebus属于什么通信,现场总线吗? - ******
#延烟# 现场总线
#13530941186#
ABB机器人UAS是什么呢?ABB机器人UAS是什么呢? ******
#延烟# ABB机器人UAS概述:控制器用户授权系统(UAS),该系统规定了不同用户对机器人的操作权限.该系统能避免控制器功能和数据的未授权使用. 用户授权由控制器管理,这意味着无论运行哪个系统控制器都可保留 UAS 设置.这也意味着 UAS 设置可应用于所有与控制器通信的工具,如 RobotStudio 或 FlexPendant. UAS 设置定义可访问控制器的用户和组,以及他们授予访问的动作.
#13530941186#
ABB机器人新型产品IRB2600的特征有哪些? ******
#延烟# 主要特征及用途: 全新的紧凑型设计:使机器人的最高荷重可达20 kg,并使其在物料搬运、上下料以及弧焊应用中的工作范围得到最优化. IRB 2600具有同类产品中最高的精确度及加速度,可确保高产量及低废品率从而提高生产率. 灵活的安装方式:包括落地安装、斜置安装, 壁挂安装, 倒置安装以及支架安装, 有助于减少占地面积以及增加设备的有效应用. 壁挂式安装的表现尤为显著. 这些特点使工作站的设计更具创意,并且优化了各种工业领域及应用中的机器人占地面积.
#13530941186#
与ABB机器人相关技术都有哪些呢?与ABB机器人相关技术都有哪些? ******
#延烟# ABB机器人相关技术:与点焊、搬运等运动控制所不同的是,激光切割是基于连续工艺状态下的运动控制,除了要求机器人具有较高的运动点的精度和重复定位精度外,还对机器人运动的轨迹即机器人的直线和圆弧轨迹插补的精度提出了很高的要求.激光切割中的倒角切割和小圆切割的精度和稳定性能够很好的衡量机器人的运动控制能力.ABB利用自身强大的研发实力开发了一系列的高端技术,来满足市场的需求.所开发的True Move和Quick
#13530941186#
Abb机器人的通信程序指什么 - ******
#延烟# 买硬件 PROFINET模块(主从看需要) 西门子加PROFINET 程序问ABB.
