用Fanuc机器人进行上下料试验,在抓取有序排列的工件时,用了一段码垛指令;在放置工件时,又用了一段码垛指令,最后发现两段码垛指令的寄存器出现了干扰。已采用了不同的代码编号,程序如下:
) @9 H$ c: x) ]1 n, `: v: Y6 N' l, X y1 g+ F8 d" w
1:L P[1] 100mm/sec CNT50 3 @$ N- w; m* |0 x, w! \* \- k! Y
2: L P[2] 100mm/sec CNT50
& |, K1 ~4 a+ \+ a- y0 _' I3: LBL[1]
8 `6 H: K4 ? R r0 U4: L P[3] 50mm/sec FINE
6 O1 E: {$ ?" e5 M5: PALLETIZING-B_1 //抓取零件的码垛指令// 7 y( u+ C3 x4 B0 @% Z
6: J PAL_1[A_1] 30% FINE - r' n1 \- A0 D" m- B3 L6 I
7: J PAL_1[BTM] 10% FINE
6 U8 S+ i. {0 ]. D0 N6 T7 ?8: DO[4:ON:SUCTION]=ON //气缸吸气,抓取工件//
! K1 S) R% @- ^! X( O0 Z9: WAIT 1.50(sec) ( _- R- |% W4 a: G Z/ O3 \- w; \
10: J PAL_1[R_1] 30% FINE
' ~8 Q9 y7 \2 i" C4 U1 b3 E/ \11: PALLETIZING-END_1
; g7 a$ v' F6 \ j0 G$ L12: J P[4] 80% FINE
6 {& i W, r2 x13: J P[5] 80% FINE v4 _" e+ b0 n' v
14: J P[6] 50% FINE 1 e) K8 ^/ {' t1 p3 [4 X6 q
15: PALLETIZING-B_2 //放置零件的码垛指令//
6 `7 K+ b! N/ _% J; }; p: J16: J PAL_2[A_1] 30% FINE
! W3 p: Z- [, v17: J PAL_2[BTM] 10% FINE
% w. j, n: F% p, h% x18: DO[4:ON:SUCTION]=OFF //气缸停止吸气,放置工件//
& k- }6 o4 g! G0 }19: WAIT 1.50(sec) : |2 \9 J. `( w% z- Z
20: J PAL_2[R_1] 30% FINE
4 q" Z& B- R% q' l9 U9 T: a21: PALLETIZING-END_2
T9 c! r! f6 U5 F22: J P[7] 100% FINE . R/ _; ]( I: n: k: w, s2 n/ |$ ^
23: JMP LBL[1] - _: b4 u$ l0 d0 b
[End] " L6 C2 q1 L/ v$ Y
|