用Fanuc机器人进行上下料试验,在抓取有序排列的工件时,用了一段码垛指令;在放置工件时,又用了一段码垛指令,最后发现两段码垛指令的寄存器出现了干扰。已采用了不同的代码编号,程序如下:1 T5 g) J3 m' i( p2 h+ A* F [! A1 b9 n3 j7 l3 V
1:L P[1] 100mm/sec CNT50
$ i) x5 L' w/ Z8 u/ j# ^( m9 |0 \
2: L P[2] 100mm/sec CNT50
0 v, J' H, G3 y+ t+ q/ G
3: LBL[1]
; F- t: C+ X' ~/ A/ }+ ~
4: L P[3] 50mm/sec FINE
6 v' b5 g% ^' r: Y% v2 f( U& u
5:PALLETIZING-B_1 //抓取零件的码垛指令//
6 o3 ?" t# s' t7 U. L) B5 |
6: J PAL_1[A_1] 30% FINE
, n0 h# `) A# [0 D
7: J PAL_1[BTM] 10% FINE
- U3 z3 w9 s) l
8:DO[4:ON:SUCTION]=ON //气缸吸气,抓取工件//
1 L7 d% H6 U4 P+ A/ l
9: WAIT 1.50(sec)
0 F# O! o" g9 o; D: N) W- U
10: J PAL_1[R_1] 30% FINE
# U1 Y, y; N) S# R+ E @% r
11: PALLETIZING-END_1
v& S* ?/ i/ |+ @5 G4 S! \1 r
12: J P[4] 80% FINE
3 K b! o* d7 l7 R! D8 H
13: J P[5] 80% FINE
9 e: j3 T7 t& t9 A" G# b7 T* t
14: J P[6] 50% FINE
) {# {" W) P8 s$ H4 a+ I* l+ \
15:PALLETIZING-B_2 //放置零件的码垛指令//
: W& T: S# f; L. Z! z
16: J PAL_2[A_1] 30% FINE
) T1 x8 \$ y0 D3 E0 \
17: J PAL_2[BTM] 10% FINE
! Q' i7 m# s2 e6 {4 a$ o3 S
18:DO[4:ON:SUCTION]=OFF //气缸停止吸气,放置工件//
# g f5 \5 w, Q% M- B2 Y/ U
19: WAIT 1.50(sec)
. I) E$ s8 s% @+ m! [2 O
20: J PAL_2[R_1] 30% FINE
7 n a# R$ a' t1 N9 q$ i
21: PALLETIZING-END_2
7 e5 n0 D {6 V3 P5 f! q# r
22: J P[7] 100% FINE
4 Z+ Q- T0 n# M# M- T0 {$ Y
23: JMP LBL[1]
7 B$ d6 s$ i$ v& [+ z
[End]
4 s/ ] J0 G* r0 W8 o: R! L |