各位大侠,能帮我解决一下这个问题吗?2 o# s1 w. Q4 Y/ ]& {3 }/ `, j( {
1,一台4轴直角坐标机器人,通过示教器示教得到空间中A,B,C , D.点.
' Q( {4 `. T' X+ c6 {0 w4 N# E, J控制要求如下:直角坐标机器人按照A,B,C,D顺序对示教点进行再现。
0 q _4 c$ V+ u) r9 b/ e9 Z本人写了二套程序效果不是很理想,想请各位指点指点!
! a5 {( x- c: {- L( u# S mode:2 Y; y! F1 Y1 y. Z0 x
IF READ_OP(202)=1 THEN2 d. Y/ u# c) x3 s4 `2 {
BASE(2,1,0,3)
- c# o& y# \5 j3 k MERGE AXIS(2)=ON! f6 \9 A# S' X
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标) H% Q3 h; E5 T( ?2 X
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标1 B* m# q; V1 j% X4 S8 W' L
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
9 ]6 E; f1 U7 t4 G- E4 f- p. `( D( R MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标* H' `' s$ v, i! n1 x, D1 I
MERGE AXIS(2)=OFF! D6 k! {7 q* e. Z! j
ENDIF( T0 B0 i' |, b3 z- n5 T# Y, S
GOTO mode
& l( ~8 s: }- r0 R& J _# p此程序在运行过程中的抖动,本人想是不是电机的旋转方向改变后引起的
2 k, g" n1 \6 W7 K$ T- d/ Z电机抖动 8 j& q+ l2 `7 P7 O! H3 Z
mode1:! I4 B6 S; \" I. N7 m
IF READ_OP(202)=1 THEN
( h8 \% \0 Q4 p8 j+ U+ e BASE(2,1,0,3)
" b, |9 F* ~9 X1 E( e MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标
i6 s! J& C: V; N4 L! ]# O WAIT IDLE
2 J: h( h- k0 Y4 P& i: O { MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标 P8 t% o9 H6 p3 F
WAIT IDLE0 @. T; R' ]4 O' h+ |- E0 I
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
9 |4 S- |4 X8 k2 c3 O3 k WAIT IDLE8 m% g% B5 A: i! p, X+ Z: Q& Q
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标
B. f2 e0 s k& R WAIT IDLE5 e$ }& C) s# ?
ENDIF
3 j4 h' b3 z! U; d: z1 }GOTO mode 1
\: s1 l$ H6 B; P# m+ l# C ~6 G此程序在运行过程中不抖动,但运行不平滑 。想请各位指点指点! 9 S! m9 l" T o5 y
问题能得到解决,本人定有重谢 !联系电话:13782704927,杨 $ y' C# c c5 V* j& G
|