各位大俠,能幫我解決一下這個問題嗎?
; O% O4 Y( l9 g* E: C& y6 a1,一臺4軸直角坐標機器人,通過示教器示教得到空間中A,B,C , D.點.
" ?6 u5 O" h# |" t: V1 y控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現。
8 a4 ]5 n, _, C8 l: ~. ?# a本人寫了二套程序效果不是很理想,想請各位指點指點! ; E+ C+ E1 X2 V
mode:2 M' f- w' ^% k4 O2 v
IF READ_OP(202)=1 THEN- Y6 H" v* I5 m( @, [: \( ?
BASE(2,1,0,3)3 P, h* I; U% @) `
MERGE AXIS(2)=ON% z/ ^9 Q/ I: f" Z3 z
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標4 G% Y: `2 D+ j: L6 |3 s' ?4 u
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標" w& u9 \" T5 g4 X& A6 g
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
9 G3 W6 b2 G X2 X9 p& K2 _ MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標& J/ C# H+ ?& ]7 u; }' g
MERGE AXIS(2)=OFF
3 {7 Q H6 o f8 Y7 Z! Y* QENDIF
1 S3 A0 D& S$ i# J! A; JGOTO mode
3 n- g, }: M: g0 P, @此程序在運行過程中的抖動,本人想是不是電機的旋轉方向改變后引起的
$ ^- z- N2 v6 b, g2 E電機抖動
& T* b' K; p3 Y/ Z- S$ e mode1:
3 y8 Q3 ~0 v) n, p" a( @IF READ_OP(202)=1 THEN
( w4 N& T7 \$ a2 u' d0 T BASE(2,1,0,3)1 k, u1 v! Z- g2 q
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標
+ I0 j5 ]: r. H/ i4 u" e3 B WAIT IDLE! _/ O6 ~3 r4 m) M( {( m# l
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標
( \. y9 y, D6 U2 Q3 _9 S WAIT IDLE. ]+ d! u) @6 l. t7 Q% E
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
. S, H4 p0 L h; B WAIT IDLE- ~9 Q8 o7 ?% z
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標3 T, k P. ~* u; `7 m; M' g
WAIT IDLE1 ]+ s) J6 E( A. Q; N
ENDIF* i9 F/ i- X, w: C' r" j1 d
GOTO mode 1 1 @: C6 Y2 F3 _1 X
此程序在運行過程中不抖動,但運行不平滑 。想請各位指點指點! 1 F E) U4 T1 T4 L$ {9 k. G* h h
問題能得到解決,本人定有重謝 !聯系電話:13782704927,楊 0 t4 t2 I- S8 Z' ^+ }0 {
|