Def Inte m1,m2 定義變量
Servo On 伺服電機打開
Accel 80,80 定義加減速度
Ovrd 50 定義全局速度
Mvs p0 移動到p0點
GoTo *ddd 調用子程序
*ddd 子程序名
Def Plt 1,p1,p2,p3,p4,4,3,1 定義托盤
For m1%=1 To 12 建立循環
p7=Plt 1,m1% 賦值給p7
JOvrd 50 關節速度
Mov p7 ,80 移動到p7上方80
Mvs p7 移動到p7
HClose 1 夾取工件
Dly 0.5 延時0.5秒
Mvs p7,80 移動到p7上方z軸80
If m2%=m1% Mod 2=1 Then 判斷奇偶性
JOvrd 50 定義關節速度
Mov p5,80 移動到p5上方80
Mvs p5 移動到p5
HOpen 1 松開工件
Dly 0.5 延時0.5秒
Mvs p5,80 移動到p5上方80的位置(安全點)
p5.Z=p5.Z+20 p5的點位沒循環一次增加20
Else 或
JOvrd 50 關節速度
Mov p6,80
Mov p6
HOpen 1
Dly 0.5
Mvs p6,80
p6.Z=p6.Z+20
EndIf 結束if循環
Next 結束for循環
End 結束程序
這是三菱的機械手的,參考一下