堆垛和卸垛練習(xí)：

PTP fa2 Vel=100 % PDAT3 Tool[1]:1 Base[10]:g

for n=1 to 4 計(jì)算出16個點(diǎn)的位置值

for m=1 to 4

tp1[n,m]=xfa1 提取放件位置的數(shù)據(jù)

tp2[n,m]=xfa1 提取預(yù)放件位置的數(shù)據(jù)

tp1[n,m].y=tp1[n,m].y+80*(n-1)

tp1[n,m].x=tp1[n,m].x+65*(m-1)

tp2[n,m].z=tp2[n,m].z+100 預(yù)放件位置的Z軸方向要抬高100mm

tp2[n,m].y=tp2[n,m].y+80*(n-1)

tp2[n,m].x=tp2[n,m].x+65*(m-1)

endfor

endfor

PTP fa3 Vel=20 % PDAT4 Tool[1]:1 Base[10]:g

for n=1 to 4

for m=1 to 4

zhua() 循環(huán)執(zhí)行抓件程序

PTP fa4 Vel=10 % PDAT5 Tool[1]:1 Base[10]:g

ptp tp2[n,m] 運(yùn)行到預(yù)放件位置

wait sec 0.5

lin tp1[n,m] 運(yùn)行到放件位置

wait sec 0.2

SET GRIPPER State= GDAT1 打開夾爪

lin tp1[n,m]

ptp tp2[n,m] 運(yùn)行到抬起位置

endfor

endfor

PTP P1 Vel=50 % PDAT1 Tool[1]:1 Base[10]:g

編輯：jq