'MOTOR ON
'SERVO ON
VelAuto% = 100 自动速度100%(设置机械手速度时 程序自动速度要先改)
VelAuto1% = 5 自动速度1 5%
VelAuto2% = 5 自动速度2 5%
Z_POS_SAFE! = 4.00 Z轴安全位置
Z_POS_SAFE1! = 20.00 Z轴安全位置1
Z_POS_CUR! = 0
CcdResult% = 0
PickResult% = 0
NgFlag%=0
PickRetryCntSet% = 5
PickRetryCntCur% = 0
IF DO2(0)=1 THEN IF条件句 DO2(0)=1 则执行下列语句
MOVE P, P3,Z =Z_POS_SAFE! , S=VelAuto%'Go Pick Out 移动至P点 P3点Z轴位置安全位置 速度为自动速度 (P3 NG弃料点)
GOSUB *UNPICK1 跳转到子程序 (*为标签)标签UNPICK1
ENDIF 结束IF语句
DO2(4, 5, 6, 7) = 0 '
DO2(0) = 0'Pick 吸嘴吸气
DO2(1) = 0'UnPick 吸嘴吹气
'SERVO ON
VelAuto% = 100 自动速度100%(设置机械手速度时 程序自动速度要先改)
VelAuto1% = 5 自动速度1 5%
VelAuto2% = 5 自动速度2 5%
Z_POS_SAFE! = 4.00 Z轴安全位置
Z_POS_SAFE1! = 20.00 Z轴安全位置1
Z_POS_CUR! = 0
CcdResult% = 0
PickResult% = 0
NgFlag%=0
PickRetryCntSet% = 5
PickRetryCntCur% = 0
IF DO2(0)=1 THEN IF条件句 DO2(0)=1 则执行下列语句
MOVE P, P3,Z =Z_POS_SAFE! , S=VelAuto%'Go Pick Out 移动至P点 P3点Z轴位置安全位置 速度为自动速度 (P3 NG弃料点)
GOSUB *UNPICK1 跳转到子程序 (*为标签)标签UNPICK1
ENDIF 结束IF语句
DO2(4, 5, 6, 7) = 0 '
DO2(0) = 0'Pick 吸嘴吸气
DO2(1) = 0'UnPick 吸嘴吹气