各位大侠,能帮我解决一下这个问题吗?3 l5 F% d1 }* [1 h% W! b
1,一台4轴直角坐标机器人,通过示教器示教得到空间中A,B,C , D.点.
# b0 m3 Y0 O* F& ]. N2 t5 C控制要求如下:直角坐标机器人按照A,B,C,D顺序对示教点进行再现。" k; @( @! b& ]9 C& Q8 i
本人写了二套程序效果不是很理想,想请各位指点指点!
0 c8 j8 `; ]$ \. [ mode:1 m5 e @& m& s- Y5 G4 a5 W7 F
IF READ_OP(202)=1 THEN
) N( d+ U( T6 F+ r1 | BASE(2,1,0,3). x( L- H% c8 |
MERGE AXIS(2)=ON
3 @$ z6 h: n/ O/ k8 Y: F MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标5 H5 J9 d- g0 `5 N+ S+ k+ o n* e* ^
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标
+ w$ O( E x+ b5 j5 Z5 ~ MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标6 p* W+ k. Q. w& n2 p/ H& Q7 Q
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标& i) t2 v1 i! R+ q
MERGE AXIS(2)=OFF
$ R/ w$ ]! C$ t% Y. u6 \ENDIF5 e ?, s$ K! b* O1 y2 ~7 k& Q \
GOTO mode
/ S5 C$ \) h2 D! E* a0 {此程序在运行过程中的抖动,本人想是不是电机的旋转方向改变后引起的( X6 B0 l1 Z( V4 p. G( ]
电机抖动 ( O7 Z! g, h" }" u# p8 l2 J
mode1:
- y) H1 L; d- c$ P5 L8 RIF READ_OP(202)=1 THEN/ Z5 Q( p7 B6 k G- m, d; |
BASE(2,1,0,3)$ L d" n G4 _6 H6 t
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标
$ D) I+ Z, a U8 ? x WAIT IDLE
5 Z. Z. J# I6 S( [' ]8 q* S( ]' B MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标
: n; @/ `5 `% V. O/ f WAIT IDLE7 v- K1 m! m3 B1 o
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标' N0 ^5 O0 s( B/ d, X
WAIT IDLE# u; e( H m. M C: u' \7 ^# D
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标
7 V' G v" ]' `/ I) O3 c* f; S WAIT IDLE
- t* w: P9 Y1 v( w9 \$ ?ENDIF
4 ^0 i0 }' ]. v2 d2 HGOTO mode 1
$ x& N& Z7 j2 d& H此程序在运行过程中不抖动,但运行不平滑 。想请各位指点指点!
7 A9 O7 h# d3 x) T4 b) l2 a问题能得到解决,本人定有重谢 !联系电话:13782704927,杨
* [* T7 k8 S" J1 [6 K |