各位大侠,能帮我解决一下这个问题吗?& v: F' w* f1 }- e' C" M d
1,一台4轴直角坐标机器人,通过示教器示教得到空间中A,B,C , D.点.
* _7 g) h- U" o6 G控制要求如下:直角坐标机器人按照A,B,C,D顺序对示教点进行再现。7 |+ E, A: R2 h: d) c
本人写了二套程序效果不是很理想,想请各位指点指点! , L! \% \5 B/ B; O3 m" `
mode:) E7 z3 L2 z1 M( |6 l1 k9 k
IF READ_OP(202)=1 THEN1 O1 Y+ j$ P! c6 U; e& n! m1 u
BASE(2,1,0,3)7 _ m/ ] s" E2 T1 I. F( ~ U
MERGE AXIS(2)=ON
+ ]. H2 S" F$ E4 g0 O4 N MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标/ t! Z- K! C3 D
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标" J; k$ c8 W9 g6 Z5 _5 A8 t
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
: M$ U5 M8 Z9 S, h5 k7 z MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标$ `7 j& S6 M" p
MERGE AXIS(2)=OFF
9 m, H8 t3 {4 D, F4 F$ p% ^ AENDIF
* c9 D9 u; [0 e4 R9 \GOTO mode
* r! e @7 A' t此程序在运行过程中的抖动,本人想是不是电机的旋转方向改变后引起的
- W9 l/ ?: Q, O7 ?+ e电机抖动
5 }( ]+ D, G' W5 c& a# ?. P mode1: I. A* P/ J5 r; l$ z3 A8 G
IF READ_OP(202)=1 THEN
4 [9 X/ ~7 U, ?& B5 a& P BASE(2,1,0,3)( A0 O+ b% \1 {5 c! E
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标3 h4 `4 f8 t* i1 p" X* b0 }
WAIT IDLE5 g% G' X4 i7 b
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标
/ U+ k4 J8 I" {; Q WAIT IDLE
5 A D2 O' x; D" ? MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标6 _9 [: M! [2 f0 B9 ~4 ~
WAIT IDLE
& r, _$ j4 l: b0 ]7 j# I; X MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标
! r) J* Q5 b% ` WAIT IDLE
; H' U5 c+ r5 m2 L* N) y" _" AENDIF6 k- g3 b1 ^) q
GOTO mode 1 7 s# D0 N8 B; y! `: C. p
此程序在运行过程中不抖动,但运行不平滑 。想请各位指点指点!
- [9 {) e: O% }问题能得到解决,本人定有重谢 !联系电话:13782704927,杨
' N3 j& R+ |% T5 } |