各位大侠,能帮我解决一下这个问题吗?
* E$ t% U# l/ \8 D! |1,一台4轴直角坐标机器人,通过示教器示教得到空间中A,B,C , D.点.7 Y z6 U1 Y p) ~; @+ w
控制要求如下:直角坐标机器人按照A,B,C,D顺序对示教点进行再现。9 {3 t+ z3 X) E" s1 \
本人写了二套程序效果不是很理想,想请各位指点指点! & C' N! X+ K- O# ~6 j, O% B8 X
mode:
. _3 c4 Y R& b; r, pIF READ_OP(202)=1 THEN) r3 U+ }$ l$ x/ D1 O+ f; @
BASE(2,1,0,3)
1 x# a, |% u$ w u7 R. e0 [ MERGE AXIS(2)=ON- [, ]! `: n3 ?9 Q6 h9 ]
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标
) l; W1 `8 S; m3 W1 X; m. f/ S MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标: d$ ^* ?3 T5 t: i, W
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
5 \: ]' ~7 r, [9 U MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标: M7 c* N/ y& {* e2 P
MERGE AXIS(2)=OFF/ P2 R$ w" l; X
ENDIF
! u0 X1 X5 h/ DGOTO mode
1 M9 j" l) b% f2 R" N此程序在运行过程中的抖动,本人想是不是电机的旋转方向改变后引起的
/ |! f [5 V2 o电机抖动
6 s6 j4 L9 O2 Q. ~ mode1:: O! k6 F% H3 e5 L7 V% a5 I
IF READ_OP(202)=1 THEN: |( F& u. U" |2 i* \, u; }
BASE(2,1,0,3)) ^7 k. i9 J3 J; M# d) X4 g
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标& U: z5 Y" }6 j7 E
WAIT IDLE
4 t3 d& X& b( x6 r& F MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标
# O6 S; |# r* @( @3 b' M WAIT IDLE
$ t& `4 r4 M8 i MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
0 x0 {: L& N9 H WAIT IDLE. `: R9 n1 y9 E- [& h1 x
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标
% ~. ]" y' q( B+ _ WAIT IDLE
! L* l/ n$ I) k. W& U/ wENDIF* [( _4 a8 R2 _' i( L; y
GOTO mode 1
; L8 a! W+ N3 u' J此程序在运行过程中不抖动,但运行不平滑 。想请各位指点指点! 1 k3 N2 o& x7 g3 [
问题能得到解决,本人定有重谢 !联系电话:13782704927,杨 3 e' |1 |+ q8 Z8 ^5 ]+ g" I9 d" O
|