工况:胶枪固定,机器人走轨迹进行侧板涂胶
前开始两个点,中间循环14次,收尾2个点。从而形成了16个Z字型涂胶轨迹。
一、坐标系定义(现场统一规范)
以**工件基准坐标系(BASE)**为参照,三轴方向定义如下:
X轴:前后方向——为涂胶整体长度方向,也是阵列循环递进方向,整排Z字沿X轴前后延伸;
Y轴:左右方向——为涂胶宽度方向,仅做Z字形左右横向走位,控制胶路宽度,不参与长距离阵列排布;
Z轴:上下方向——高度补偿方向,用于斜坡工件自动贴合,保证胶枪与工件表面距离恒定,不飘胶、不堆胶、不断胶。
所有点位偏移、循环阵列、斜坡补偿均以此坐标系为基准执行。
二、核心运动参数说明
本文涉及的机器人系统参数、工艺参数均统一释义,所有可调数值全部纳入包含文件管理,调试时只改参数、不动程序逻辑,稳定性更强。
1. $APO.CDIS 轨迹逼近平滑参数
$APO.CDIS
全称:Corner Distance,拐角逼近距离
单位:mm
作用1:控制机器人LIN直线段之间的拐角圆滑程度,取消点位停车,实现连续不间断轨迹,是涂胶防断胶、防堆胶的核心参数;
作用2:配合程序内Y向±2mm偏移量,优化Z字转角过渡效果,让拐角弧度更规整流畅,从根源避免转角处出胶堆积、胶丝拉长、轨迹变形问题;
现场常用值:8mm,兼顾轨迹定位精度与胶路连续性,适配绝大多数涂胶工况。
2. Z字转角Y向±2mm偏移优化逻辑(核心工艺细节)
本程序在Z字上下沿点位,特意设置Y向-2mm、+2mm的微量偏移,配合C_DIS连续轨迹实现完美转角,核心原理与作用如下:
2.1. 规避直角硬转角,拉长过渡弧度:机器人纯直角转角会出现瞬间减速、姿态突变,极易导致出胶积压、拉丝断胶;通过Y向提前微量偏移,把直角转角转化为平缓圆弧过渡,配合C_DIS逼近距离,全程无停车、无顿挫,转角胶路均匀顺滑。
2.2. 一减一加闭环复位,不偏移整体轨迹:上一段转角做-2mm偏移预留过渡空间,下一段同步做+2mm偏移复位,全程只优化转角轨迹,不改变Z字总宽度、不偏移阵列基准线,最终成型尺寸完全符合工件要求。
2.3. 适配胶阀出胶滞后性,工艺更稳定:胶阀出胶与机器人运动存在微小滞后,转角提前偏移可以抵消滞后误差,保证转角处胶量均匀,杜绝堆胶、缺胶、拉丝问题。
3. $VEL 系统运动速度参数
$VEL = {CP 0.236, ORI1 200, ORI2 200}
CP:直线运动速度,单位 m/s,直接决定涂胶出胶均匀性;
ORI1 / ORI2:机器人姿态旋转速度,单位 °/s,保证姿态平稳、胶枪不抖动;
涂胶作业建议速度:CP 0.2~0.3 m/s,姿态速度 150~200 °/s。
4. POFFSETBASE 基准偏移功能
程序以示教基准点 XGlueStrat为原点,通过偏移实现整排Z字路径:
第1位:X轴前后偏移(长度阵列方向)
第2位:Y轴左右偏移(Z字宽度方向)
第3位:Z轴高度偏移(斜坡补偿方向)
后续为姿态保持参数,保证胶枪角度全程不变。
5. 斜坡补偿系数(0.2143)
斜坡系数用于工件前后存在高度差的场景,计算公式为:
斜坡系数 = (起点Z坐标 − 终点Z坐标) ÷ (终点X坐标 − 起点X坐标)
程序中通过系数与循环次数 I 联动,实现每前进一排,Z高度自动补偿一次,使胶路全程贴合斜面。
三、包含文件(参数集中管理)
所有工艺、速度、尺寸、补偿参数统一放入 DAT 包含文件,便于批量修改、多程序共用、现场快速调试。
;==============================
; 涂胶工艺参数统一管理文件
; X=前后 Y=左右 Z=上下
;==============================
; 轨迹逼近参数
DECL REAL GLUE_CDIS
GLUE_CDIS = 8.0
; 运动速度参数
DECL REAL GLUE_CP_VEL
DECL REAL GLUE_ORI_VEL
GLUE_CP_VEL = 0.236
GLUE_ORI_VEL = 200.0
; 尺寸参数
DECL REAL GLUE_LONG ; X轴前后步距
DECL REAL GLUE_WIDTH ; Y轴左右Z字宽度
GLUE_LONG = -60.46667
GLUE_WIDTH = 72.0
; 斜坡补偿系数
DECL REAL SLOPE
SLOPE = 0.2143
; 胶阀输出信号
DECL INT OUT_GLUE_ON
OUT_GLUE_ON = 15
ENDDAT
四、完整Z字涂胶程序
本程序以X轴前后为长度递进、Y轴左右为Z字宽度,循环14次完成阵列涂胶,包含进刀、开胶、循环走胶、收尾、关胶、抬枪完整流程,可直接复制使用。
; 加载包含文件参数
$APO.CDIS = GLUE_CDIS
$VEL = {CP GLUE_CP_VEL, ORI1 GLUE_ORI_VEL, ORI2 GLUE_ORI_VEL}
; 进刀至起始上点位
LIN POFFSETBASE(XGlueStrat, GLUE_LONG*0, 11.5, 0,0,0,1,2) C_DIS
; 打开胶阀,出胶稳定
$OUT[OUT_GLUE_ON] = TRUE
WAIT SEC 0.2
; 移动至起始下点位,开始Z字路径
LIN POFFSETBASE(XGlueStrat, GLUE_LONG*0, GLUE_WIDTH-2, 0,0,0,1,2) C_DIS
;==============================
; 14次Z字循环(X前后递进排布)
;==============================
FOR I = 1 TO 14
; Z字上沿:斜坡补偿高度
LIN POFFSETBASE(XGlueStrat, GLUE_LONG*I, 0 - SLOPE*I + 2, 0,0,0,1,2) C_DIS
; Z字下沿:宽度+斜坡补偿
LIN POFFSETBASE(XGlueStrat, GLUE_LONG*I, GLUE_WIDTH - SLOPE*I - 2, 0,0,0,1,2) C_DIS
ENDFOR
; 收尾路径,保证末端胶路完整
LIN POFFSETBASE(XGlueStrat, GLUE_LONG*15, 0-2, 0,0,0,1,2) C_DIS
LIN POFFSETBASE(XGlueStrat, GLUE_LONG*15, GLUE_WIDTH-8.5, 0,0,0,1,2) C_DIS
; 关闭胶阀
$OUT[OUT_GLUE_ON] = FALSE
WAIT SEC 0.2
; 抬枪离开工件
LIN_REL {Z 30} #TOOL
END
五、程序逻辑总结
1. 以X轴前后为长度方向实现整排阵列递进,完全贴合现场工件布局;
2. 以Y轴左右实现Z字形宽度往复,配合±2mm转角偏移优化,胶路顺滑无棱角;
3. 斜坡系数随循环自动联动补偿Z高度,斜面工件全程贴合,胶距恒定;
4. 所有关键工艺、尺寸、速度参数放入包含文件统一管理,现场调试只改参数、不动逻辑,安全稳定、不易出错;
5. 全程C_DIS连续轨迹+转角偏移优化,双保障实现拐角圆滑、无断胶、无堆胶、无拉丝,成型效果达标。
夜雨聆风