各位大俠,能幫我解決一下這個問題嗎?& d4 D3 C4 K& n+ y
1,一臺4軸直角坐標機器人,通過示教器示教得到空間中A,B,C , D.點.% E( a& ]. O a8 e
控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現。
- o1 u [! ?1 z# F2 `本人寫了二套程序效果不是很理想,想請各位指點指點! 6 {3 R( h* x: U% E# ]
mode:8 J! H" ?6 v8 Z* m& ]. J
IF READ_OP(202)=1 THEN
* V; [0 ^7 o( |+ r6 m# S/ q BASE(2,1,0,3)6 ^8 l: w7 i3 o2 i6 z0 l' u
MERGE AXIS(2)=ON
( p, f' @: S: N+ e MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標$ p( P4 M6 v7 {% m; c2 l" E; `; U
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標
4 e1 b* x" G9 O+ v MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
0 r9 Q, ]( \; {* E! O5 c X MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標
6 O) }& R# ?; nMERGE AXIS(2)=OFF' r i. Y0 F5 v8 P/ Y0 m- d
ENDIF
* H2 B/ s8 K, _: }9 C; `, OGOTO mode6 l) S0 [3 S9 W n7 |$ z i# G
此程序在運行過程中的抖動,本人想是不是電機的旋轉方向改變后引起的! I1 I$ m8 n! x% e% {! J( x
電機抖動 * Y% z9 @, \$ W. k+ J
mode1:0 ~" K/ ?2 N; L5 m0 ]. X
IF READ_OP(202)=1 THEN. i/ J1 N; s# f& Z
BASE(2,1,0,3)8 F3 ?( n }: I9 B) }
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標
# I3 i- P# Y+ N& ] WAIT IDLE
$ g7 P7 k" D" c) O* H MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標0 m9 O, c! E& d
WAIT IDLE
2 L" Y9 b5 y6 q8 y MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
( a' h- ?+ Z" g- r& f WAIT IDLE7 y6 W1 V1 z, L1 b Q
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標5 V* i9 f r; S2 `) e7 l
WAIT IDLE/ ?7 \1 l' }3 E% G( }, S
ENDIF
+ T+ i: M/ y" r4 aGOTO mode 1
9 {4 E5 h G: |/ I: c7 M此程序在運行過程中不抖動,但運行不平滑 。想請各位指點指點!
! R5 [5 R0 s' P5 @問題能得到解決,本人定有重謝 !聯系電話:13782704927,楊 # G1 f& L& i7 x O
|