各位大侠,能帮我解决一下这个问题吗?& q& |2 t3 _* n5 e! s' G- w/ O
1,一台4轴直角坐标机器人,通过示教器示教得到空间中A,B,C , D.点.
; j) m* |7 P3 d控制要求如下:直角坐标机器人按照A,B,C,D顺序对示教点进行再现。
4 s) l8 S+ C1 e2 n; T' P0 W, d本人写了二套程序效果不是很理想,想请各位指点指点!
7 J" f. c6 e4 i5 P4 z mode:
, s: J' x) E5 j2 H" u ^: R& @1 MIF READ_OP(202)=1 THEN- L3 S _1 T9 A- N2 n( [' f! p
BASE(2,1,0,3)
6 G" L) H2 z- F& o( B8 n MERGE AXIS(2)=ON: k+ {6 ]8 T8 \# E
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标
1 J/ B4 p. b* _' i' w MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标 N5 \4 K. q( L- B$ @
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标
T$ _( d# B& v! }* x- c MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标8 V, }7 p2 M9 d. ?6 q) M( A
MERGE AXIS(2)=OFF0 \: K8 d4 Q; w7 U8 N' K
ENDIF% c' O; u( }* R, f6 v
GOTO mode
# `( i0 b Z! m J' I+ U9 j此程序在运行过程中的抖动,本人想是不是电机的旋转方向改变后引起的
`) x8 ~% e H! w u+ J( V7 T+ [电机抖动
. r2 y, z* u( d- f" m mode1:: Y& F/ P F+ M( F
IF READ_OP(202)=1 THEN
, {9 N) A2 [. p T& e BASE(2,1,0,3)
* Q+ M' ?1 c r6 K/ y% p MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A点坐标8 G' Y9 U' j' {( c9 {
WAIT IDLE
2 E0 N3 h: R- Z MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B点坐标
7 [4 `: {# Y* }9 Y4 t% Y- W WAIT IDLE
- A; r3 Q( C6 V4 h; ` MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C点坐标- @% t0 s% ~/ C0 G3 c
WAIT IDLE
' E3 n4 a) k7 m- E+ I MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D点坐标
+ p. @# x# R. j5 J WAIT IDLE b6 j" s" a) \ ^5 D6 a- }
ENDIF
. K3 t: U# N n' L; LGOTO mode 1
7 I- y" a5 D A& ] D6 x# @9 ~此程序在运行过程中不抖动,但运行不平滑 。想请各位指点指点! $ Z6 `' b `0 W0 N2 z+ [2 x
问题能得到解决,本人定有重谢 !联系电话:13782704927,杨
9 w w( n J/ p: | |