论文部分内容阅读
摘 要:随着科技发展,工业机器人的应用越来越广泛,从而简化了大型生产设备的结构,提升了工作效率。现从库卡机器人在锌智能电解大型设备工业应用上的偏移功能入手,结合伺服电机编码器数值换算驱动行程的功能以及激光传感器对物料边沿检测的可靠性,以高性价比的方式实现了机器人夹具对非工整物料的准确抓取,这种多技术组合应用的方式在类似自动化、智能化应用上为技术人员提供了参考。
关键词:工业机器人偏移功能;伺服驱动技术;激光检测技术;PLC
0 引言
科技进步引领经济发展,社会生产力不断提高,越来越多的工作环境恶劣的工种和需要高强度人力劳动的工种逐渐被工业机器人代替,工业机器人正成为工业发展进程中不可缺少的一部分,并将在未来工业生产活动中占据越来越重要的地位。工业机器人具有自动化能力,随着通信技术的发展,其信息化和智能化能力越来越突出。在工业应用场合下,生产设备使用机器人进行物料搬运得到了越来越广泛的应用,基于此,针对某智能化锌电解设备,将工业机器人搬运过程运动轨迹的偏移功能,通过信息化的手段与伺服驱动+激光传感器检测数据建立联系,能够在面对复杂工况时,以高性价比方式实现机器人对所取物料位置的准确判断,准确抓取,完成智能化生产。
1 库卡机器人的坐标偏移功能
库卡是世界知名品牌,其机器人工业应用非常广泛,如图1所示,库卡机器人主要由①控制柜、②机器人本体、③示教器组成。库卡机器人的直角坐标系的位置会用到FRAME/POS/E3POS/E6POS类型的数据,其中X、Y、Z表示直角坐标系直线坐标,A、B、C表示直角坐标系旋转坐标,S、T表示机器人的状态与转角,E1~E6表示外部轴的角度。
库卡机器人的欧拉角Euler-A-B-C对应的是Z→Y→X,其坐标转换遵循的准则为第一步:X、Y、Z变换(顺序无关);第二步:A、B、C变换(先A,再B,最后C)。
2 伺服驱动+激光测距傳感器
本项目使用了西门子V90伺服电机驱动机械部件移动,机械部件上左右各安装了1个IFM激光测距传感器O1D100,该传感器采用漫反射检测,可作用于物体和液体表面反射,光斑很小,有如下功能:
(1)可测量介于0.2~10 m的距离;
(2)具有10~19 m的背景抑制功能;
(3)在10段显示屏中显示测量值;
(4)可根据设定的输出功能产生4~20 mA信号接入PLC系统模拟量输入模块;
(5)迟滞功能:如果测量值在感应范围左右变动,则迟滞功能可保持输出信号的稳定,此功能对于保证数据的可靠性很重要。
传感器移动采用伺服电机驱动,具有位置闭环可控、控制精度高等特点。西门子V90伺服电机带绝对值编码器,伺服电机驱动激光测距仪前进,其距离通过电机编码器数值转换而来,可以精确到毫米级。
3 工业机器人偏移功能及伺服驱动+激光检测技术的组合应用流程
3.1 PLC和伺服驱动器、机器人的网络结构和工作原理
从图2可看出,本项目PLC选用西门子S7-1500控制系统,机器人、伺服电机驱动器和操作触摸屏通过PROFINET网络与PLC控制器通信,激光传感器发送4~20 mA信号到PLC模拟量输入模块。
伺服电机驱动激光测距传感器前进,PLC根据伺服电机编码器数值得到的移动距离和双激光传感器检测数据计算出机器人夹具抓取物料的偏移数值后,通过通信将偏移值发送到机器人控制器内,控制机器人完成相应的偏移抓取极板功能。在触摸屏上可对系统相关运行、故障等信息进行监控,并有参数设置功能,可设置必要的控制参数。
3.2 锌电解车间槽面阴阳极板放置情况
机器人夹具要能够准确抓取极板,则控制系统需要知道极板相对机器人的准确坐标位置,如果极板在槽内的放置位置固定且工整,则确定好基准后,机器人按照固定的偏移量偏移后夹具抓取极板即可。但从图3可以看出,极板在槽内实际上摆放很不工整,极板可能有变形、倾斜,则需要对每块极板的放置状况进行实时检测。
3.3 机器人偏移量计算
如图4所示,基准位置对应了伺服电机编码器的起始数值,同时也对应了机器人的基准点,伺服电机驱动机械部件带动左右双激光传感器前进,传感器激光点照射到电解液上或极板耳部位置,有不同的实时检测数值进入PLC,当激光数值大时表示照射到电解液上,激光数值小时表示照射到极板耳部,当左激光数值从大到小跳变时,表示随着伺服电机前进,左激光照射到极板耳部,根据伺服电机编码器数值和基准位置比较得到左激光前进了a mm,同理得到右激光前进了b mm,c=a-b mm。由于机器人夹具抓取极板找准的位置是极板中心点,所以x=c mm,极板耳部厚度已知为d mm,得到y=a-d=
(a+b+d)mm,即得到机器人所需偏移量y=(a+b+d)mm,PLC将偏移量发送到机器人控制器内。
3.4 库卡机器人夹具极板抓取程序
机器人夹具从电解槽内抓取极板时,其程序根据计算所得偏移量y=(a+b+d)mm执行,得到了很好的不工整极板位置定位,能够顺利抓取极板,完成生产。程序执行过程详见程序及注释如下:
SIGNAL allowR1_pick_B_1_yin $IN[113]
SIGNAL allowR1_pick_B_2_yin $IN[114]
SIGNAL allowR1_pick_B_3_yin $IN[115]
SIGNAL allowR1_pick_B_4_yin $IN[116]
SIGNAL allowR1_pick_B_5_yin $IN[117] SIGNAL allowR1_pick_B_6_yin $IN[118]
SIGNAL allowR1_pick_B_7_yin $IN[119]
SIGNAL allowR1_pick_B_8_yin $IN[120]
SIGNAL allowR1_pick_B_9_yin $IN[121]
SIGNAL allowR1_pick_B_10_yin $IN[122]
SIGNAL R1_allow_biggripper_open $OUT[26]
SIGNAL R1_allow_bigripper_close $OUT[27]
SIGNAL R1_going_B_pick_yin $OUT[32]
DECL INT X_LF
DECL REAL A_LR
DECL INT H
DECL POS ACTPOS
DECL POS MIDPOS
DECL INT x_l //定义计算所得偏移量变量
DECL INT H6
DECL POS ACTPOS6
DECL POS MIDPOS6
DECL E6POS Xjzd={X 1193.00293,Y-13.3004656,Z 1959.36523,A-1.18950045,B 0.000330173934,C 179.996307,S 2,T 2,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}//变量定义
h6=1300
WAIT FOR ( IN 113′allowR1_pick_B_1_yin′) OR ( IN 114′allowR1_pick_B_2_yin′) OR ( IN 115 ′allowR1_pick_B_
3_yin′) OR ( IN 116′allowR1_pick_B_4_yin′) OR ( IN 117 ′allowR1_pick_B_5_yin′) OR ( IN 118 ′allowR1_pick_B_6_
yin′) OR ( IN 119′allowR1_pick_B_7_yin′) OR ( IN 120 ′allowR1_pick_B_8_yin′) OR ( IN 121 ′allowR1_pick_B_9_
yin′) OR ( IN 122′allowR1_pick_B_10_yin′); //等待抓板條件
if NUM<=1 THEN
PTP jzd CONT Vel=100 % PDAT190 Tool[1]:nomaterial Base[0]; //本电解槽取第一块极板,走到基准点,即基准位置
endif
if NUM>1 THEN
midpos6=xjzd //机器人X,Y,Z,A,B,C六个方向坐标值,第一基准点位置坐标
actpos6=midpos6
actpos6.x=midpos6.x+x_l //抓板位置X坐标,根据偏移量计算模型得到偏移量,X方向基准点位置加上偏移量数值;偏移量由PLC实时通信发送到机器人控制器
actpos6.z=midpos6.z-h6 //Z方向偏移量,此偏移量为固定值,机器人升降高度为恒值h6=1300
LIN ACTPOS6 //基准点位置上走X,Z偏移量
endif
PULSE11″State=TRUETime=0.2 sec; //改变速度脉冲,发PLC
LIN ACTPOS //机器人夹具抓取极板
WAIT Time=0.2 sec;
OUT26′R1_allow_biggripper_open′State=FALSE;
OUT27′R1_allow_biggripper_close′State=TRUE;
4 结语
在采用机器人进行物料搬运的应用中,充分利用伺服电机驱动的精确性、激光测距数据的可靠性,使用各种自动化、网络化手段采集所需数据进行控制,合理的组合应用方案可以得到理想的具有高性价比的工业应用效果。
[参考文献]
[1] 黄刚.实时修正偏移量的循迹机器人控制系统研究与实现[J].仪器仪表学报,2015,36(11):2538-2547.
[2] 张艳清,刘峥.激光测距传感器技术在机器人中的应用[J].自动化与仪器仪表,2021(2):227-230.
[3] 机器人编程2.库卡系统软件8.培训资料[Z].
收稿日期:2021-05-10
作者简介:谢建荣(1979—),男,江西于都人,工程师,研究方向:机械装备自动控制。
关键词:工业机器人偏移功能;伺服驱动技术;激光检测技术;PLC
0 引言
科技进步引领经济发展,社会生产力不断提高,越来越多的工作环境恶劣的工种和需要高强度人力劳动的工种逐渐被工业机器人代替,工业机器人正成为工业发展进程中不可缺少的一部分,并将在未来工业生产活动中占据越来越重要的地位。工业机器人具有自动化能力,随着通信技术的发展,其信息化和智能化能力越来越突出。在工业应用场合下,生产设备使用机器人进行物料搬运得到了越来越广泛的应用,基于此,针对某智能化锌电解设备,将工业机器人搬运过程运动轨迹的偏移功能,通过信息化的手段与伺服驱动+激光传感器检测数据建立联系,能够在面对复杂工况时,以高性价比方式实现机器人对所取物料位置的准确判断,准确抓取,完成智能化生产。
1 库卡机器人的坐标偏移功能
库卡是世界知名品牌,其机器人工业应用非常广泛,如图1所示,库卡机器人主要由①控制柜、②机器人本体、③示教器组成。库卡机器人的直角坐标系的位置会用到FRAME/POS/E3POS/E6POS类型的数据,其中X、Y、Z表示直角坐标系直线坐标,A、B、C表示直角坐标系旋转坐标,S、T表示机器人的状态与转角,E1~E6表示外部轴的角度。
库卡机器人的欧拉角Euler-A-B-C对应的是Z→Y→X,其坐标转换遵循的准则为第一步:X、Y、Z变换(顺序无关);第二步:A、B、C变换(先A,再B,最后C)。
2 伺服驱动+激光测距傳感器
本项目使用了西门子V90伺服电机驱动机械部件移动,机械部件上左右各安装了1个IFM激光测距传感器O1D100,该传感器采用漫反射检测,可作用于物体和液体表面反射,光斑很小,有如下功能:
(1)可测量介于0.2~10 m的距离;
(2)具有10~19 m的背景抑制功能;
(3)在10段显示屏中显示测量值;
(4)可根据设定的输出功能产生4~20 mA信号接入PLC系统模拟量输入模块;
(5)迟滞功能:如果测量值在感应范围左右变动,则迟滞功能可保持输出信号的稳定,此功能对于保证数据的可靠性很重要。
传感器移动采用伺服电机驱动,具有位置闭环可控、控制精度高等特点。西门子V90伺服电机带绝对值编码器,伺服电机驱动激光测距仪前进,其距离通过电机编码器数值转换而来,可以精确到毫米级。
3 工业机器人偏移功能及伺服驱动+激光检测技术的组合应用流程
3.1 PLC和伺服驱动器、机器人的网络结构和工作原理
从图2可看出,本项目PLC选用西门子S7-1500控制系统,机器人、伺服电机驱动器和操作触摸屏通过PROFINET网络与PLC控制器通信,激光传感器发送4~20 mA信号到PLC模拟量输入模块。
伺服电机驱动激光测距传感器前进,PLC根据伺服电机编码器数值得到的移动距离和双激光传感器检测数据计算出机器人夹具抓取物料的偏移数值后,通过通信将偏移值发送到机器人控制器内,控制机器人完成相应的偏移抓取极板功能。在触摸屏上可对系统相关运行、故障等信息进行监控,并有参数设置功能,可设置必要的控制参数。
3.2 锌电解车间槽面阴阳极板放置情况
机器人夹具要能够准确抓取极板,则控制系统需要知道极板相对机器人的准确坐标位置,如果极板在槽内的放置位置固定且工整,则确定好基准后,机器人按照固定的偏移量偏移后夹具抓取极板即可。但从图3可以看出,极板在槽内实际上摆放很不工整,极板可能有变形、倾斜,则需要对每块极板的放置状况进行实时检测。
3.3 机器人偏移量计算
如图4所示,基准位置对应了伺服电机编码器的起始数值,同时也对应了机器人的基准点,伺服电机驱动机械部件带动左右双激光传感器前进,传感器激光点照射到电解液上或极板耳部位置,有不同的实时检测数值进入PLC,当激光数值大时表示照射到电解液上,激光数值小时表示照射到极板耳部,当左激光数值从大到小跳变时,表示随着伺服电机前进,左激光照射到极板耳部,根据伺服电机编码器数值和基准位置比较得到左激光前进了a mm,同理得到右激光前进了b mm,c=a-b mm。由于机器人夹具抓取极板找准的位置是极板中心点,所以x=c mm,极板耳部厚度已知为d mm,得到y=a-d=
(a+b+d)mm,即得到机器人所需偏移量y=(a+b+d)mm,PLC将偏移量发送到机器人控制器内。
3.4 库卡机器人夹具极板抓取程序
机器人夹具从电解槽内抓取极板时,其程序根据计算所得偏移量y=(a+b+d)mm执行,得到了很好的不工整极板位置定位,能够顺利抓取极板,完成生产。程序执行过程详见程序及注释如下:
SIGNAL allowR1_pick_B_1_yin $IN[113]
SIGNAL allowR1_pick_B_2_yin $IN[114]
SIGNAL allowR1_pick_B_3_yin $IN[115]
SIGNAL allowR1_pick_B_4_yin $IN[116]
SIGNAL allowR1_pick_B_5_yin $IN[117] SIGNAL allowR1_pick_B_6_yin $IN[118]
SIGNAL allowR1_pick_B_7_yin $IN[119]
SIGNAL allowR1_pick_B_8_yin $IN[120]
SIGNAL allowR1_pick_B_9_yin $IN[121]
SIGNAL allowR1_pick_B_10_yin $IN[122]
SIGNAL R1_allow_biggripper_open $OUT[26]
SIGNAL R1_allow_bigripper_close $OUT[27]
SIGNAL R1_going_B_pick_yin $OUT[32]
DECL INT X_LF
DECL REAL A_LR
DECL INT H
DECL POS ACTPOS
DECL POS MIDPOS
DECL INT x_l //定义计算所得偏移量变量
DECL INT H6
DECL POS ACTPOS6
DECL POS MIDPOS6
DECL E6POS Xjzd={X 1193.00293,Y-13.3004656,Z 1959.36523,A-1.18950045,B 0.000330173934,C 179.996307,S 2,T 2,E1 0.0,E2 0.0,E3 0.0,E4 0.0,E5 0.0,E6 0.0}//变量定义
h6=1300
WAIT FOR ( IN 113′allowR1_pick_B_1_yin′) OR ( IN 114′allowR1_pick_B_2_yin′) OR ( IN 115 ′allowR1_pick_B_
3_yin′) OR ( IN 116′allowR1_pick_B_4_yin′) OR ( IN 117 ′allowR1_pick_B_5_yin′) OR ( IN 118 ′allowR1_pick_B_6_
yin′) OR ( IN 119′allowR1_pick_B_7_yin′) OR ( IN 120 ′allowR1_pick_B_8_yin′) OR ( IN 121 ′allowR1_pick_B_9_
yin′) OR ( IN 122′allowR1_pick_B_10_yin′); //等待抓板條件
if NUM<=1 THEN
PTP jzd CONT Vel=100 % PDAT190 Tool[1]:nomaterial Base[0]; //本电解槽取第一块极板,走到基准点,即基准位置
endif
if NUM>1 THEN
midpos6=xjzd //机器人X,Y,Z,A,B,C六个方向坐标值,第一基准点位置坐标
actpos6=midpos6
actpos6.x=midpos6.x+x_l //抓板位置X坐标,根据偏移量计算模型得到偏移量,X方向基准点位置加上偏移量数值;偏移量由PLC实时通信发送到机器人控制器
actpos6.z=midpos6.z-h6 //Z方向偏移量,此偏移量为固定值,机器人升降高度为恒值h6=1300
LIN ACTPOS6 //基准点位置上走X,Z偏移量
endif
PULSE11″State=TRUETime=0.2 sec; //改变速度脉冲,发PLC
LIN ACTPOS //机器人夹具抓取极板
WAIT Time=0.2 sec;
OUT26′R1_allow_biggripper_open′State=FALSE;
OUT27′R1_allow_biggripper_close′State=TRUE;
4 结语
在采用机器人进行物料搬运的应用中,充分利用伺服电机驱动的精确性、激光测距数据的可靠性,使用各种自动化、网络化手段采集所需数据进行控制,合理的组合应用方案可以得到理想的具有高性价比的工业应用效果。
[参考文献]
[1] 黄刚.实时修正偏移量的循迹机器人控制系统研究与实现[J].仪器仪表学报,2015,36(11):2538-2547.
[2] 张艳清,刘峥.激光测距传感器技术在机器人中的应用[J].自动化与仪器仪表,2021(2):227-230.
[3] 机器人编程2.库卡系统软件8.培训资料[Z].
收稿日期:2021-05-10
作者简介:谢建荣(1979—),男,江西于都人,工程师,研究方向:机械装备自动控制。