KUKA堆放件控制USER说明:
PTP VB=100% VE=0% ACC=100% RobWzg=1 Base=0 SPSTrig=5[1/100s] PU
1: FB PSPS = EIN
2: A23 = AUS
3: A18 = EIN
4: GOTO SPSLabel 3 = F940 F940如果抓手上没件
5: SPSLabel 2
6: WARTE BIS (E61 + E213) & M2 +M1 & F940
7: --重置为容器1-在容器为空时重置--
8: i51 ( E59 ) = 1 E59容器1内没有件,没有件就重置I51
9: --重置为容器2-在容器为空时重置-- -
10: i52 ( E209 ) = 1 E209容器2内没有件, 没有件就重置I52
11: i31 ( E61 ) = i51 E61料架1是否合格,可以进入,i31总计数,i51料架1计数器.
12: i31 ( E213 ) = i52 E213料架是否合格,可以进入,i31总计数,i52料架2计数器.
13: bin20 ( EIN ) = i31 反馈上一次计数值给PLC用于比较
14: A61 = E61 & !E213 机器人去料架1-A61
15: A213 = !E61 & E213 机器人去料架2-A213
16: --从PLC读取计数器状态--
17: i31 ( EIN ) = binin20 PLC将数值发给I31
18: bin20 ( EIN ) = i31 反馈计数值给PLC用于比
---下面的F916和F917是用来判断计数器I31的计数是否正确-----
19: F916 = i31 = 0 i31计数值=0就激活F916
20: F917 = i31 > 9 i31计数值>9就激活F917
-----------------
21: F918 = (F916 & !E917) +(!F916 & F917) F918是计数数值不正确
22: GOTO SPSLabel 2 = F918 计数数值不正确就再回第2步
23: SPSLabel 3
24: F901 = M2 & !E15 + F941& E15 M2/F901抓持上有件
25: WARTE BIS E63 & F901 &!E18 + E212 & F901 & !E18 + F940 & !F901
E63往鼠笼1放件,E212往鼠笼2放件, F940 & !F901抓持器上没有件
26: A18 = AUS
27: F902 = i51 < 10 鼠笼1数量在小于10以内
28: F903 = i52 < 10 鼠笼2数量在小于10以内
29: WARTE BIS F901 & (F902 +F903) + F940
等待F901抓持器上有件,F902/F903计数器在正常范围内或者F940抓持器上没有件
30: WARTE BIS E23
31: A23 = EIN
32: FB PSPS = M30
UP14 = E63 & F901 & F902 去鼠笼1放件
UP15 = E212 & F901 & F903 去鼠笼2放件
-------------------------
UP14 放件程序分析:
通过USE程序和计数器I31结合改变BASE值实现向鼠笼料架进行堆放件的程序编写.
PTP VB=100% VE=0% ACC=100% RobWzg=1 Base=3 SPSTrig=5[1/100s] P
Tech_T_Speicher Platz=Base+i31 FRG S-Platz = 63 EIN
VW_USR_R (#USR_ADV,107,2,1,1,1,63,1,TRUE)
开始放件步
LIN VB=250[mm/s] VE=100% ACC=100% RobWzg=1 Base=31 SPSTrig=0[1/100s] P
LIN VB=250[mm/s] VE=10% ACC=100% RobWzg=1 Base=31 SPSTrig=0[1/100s] P
放件点轨迹
LIN VB=250[mm/s] VE=0%ACC=100% RobWzg=1 Base=31 SPSTrig=5[1/100s] P
LIN VB=250[mm/s] VE=0% ACC=100% RobWzg=1 Base=31 SPSTrig=0[1/100s] P
ADV
CASE 107 ;
; VW_USR_R (#USR_ADV,107,2,1,1,1,63,1,TRUE)
P1 =2 偏移模式
P5 =63 与PLC进行IO通讯反馈
P7 = TRUE 激活USER
零件存放
IF(PAR7==TRUE)THEN 激活位置计算功能
CONTINUE
IF(PAR5>0)THEN 如果 PAR5有值
IF NOT $IN[PAR5] THEN 如果没有E63
CONTINUE
$OUT[PAR5] = TRUE 发出A63给PLC提示机器人开始进行偏移放件
nRintMsgNr[10] = 0
WHILE NOT $IN[PAR5]
当指令:当没有E63 时发出提示信息
IF(exists_krlMsg(nRintMsgNr[10])== FALSE)THEN
MLD(40,#StateMsg);零件编号 PLC中缺少
ENDIF
ENDWHILE
MSG_DEL = Clear_KrlMsg (nRintMsgNr[10])删除状态消息
ENDIF
ENDIF
CONTINUE
$COUNT_I[i_T_Speicher]=$B_IN[Binin_T_Sp] BIN20的数给I31
CONTINUE
WHILE($COUNT_I[i_T_Speicher]<1) OR ($COUNT_I[i_T_Speicher]>254)
当指令: 当I31 小于1,或大于254 发出提示信息
MLD(14,#QuitMsg);PLC存储器位置无效
$COUNT_I[i_T_Speicher]=$B_IN[Binin_T_Sp] I31 =Bin20
ENDWHILE
$B_OUT[Binout_T_Sp]=$B_IN[Binin_T_Sp]
将个给入的Bin20再发出去BINout20给PLC
设置零件存储位置1-254
CONTINUE
IF(BASE_TYPE[VW_MPARA_ACT.BASE_NO]==#BASE)THEN
只有当BASE_TYPE[1]被设置成#BASE时执行
CONTINUE
WHILE(T_Speicher[$COUNT_I[i_T_Speicher]].Z==0.0)
当T_Speicher的Z方向是0时提示信息
MLD(15,#QuitMsg);存储位置的坐标无效
ENDWHILE
SWITCH Par1 Par1=2
CASE 1
CONTINUE
BASE_DATA[31]=T_Speicher[$COUNT_I[i_T_Speicher]]
当 Par1=1时 BASE_DATA[31]直接由变量T_Speicherge[]给赋值
CASE 2 Par1=2时
CONTINUE 改变$BASE31的坐标值:当前使用的BASE值与T_Speicher的计算
BASE_DATA[31]=BASE_DATA[VW_MPARA_ACT.BASE_NO]:T_Speicher[$COUNT_I[i_T_Speicher]]
DEFAULT P1要是其他的值
MLD(20,#QuitMsg);选择错误
ENDSWITCH
ELSE BASE_TYPE[1]没有设置成#BASE需要提示报警
MLD(31,#QuitMsg);基本类型无效
ENDIF
;
ENDIF
FRAME T_Speicher[300] 程序中使用了9个空位
T_Speicher[1]={X 0.0,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[2]={X -180.300003,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[3]={X -360.600006,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[4]={X -540.900024,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[5]={X -721.200012,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[6]={X -901.5,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[7]={X -1081.80005,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[8]={X -1262.09998,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
T_Speicher[9]={X -1442.40002,Y 0.0,Z 0.100000001,A 0.0,B 0.0,C 0.0}
审核编辑:刘清
评论
查看更多