各位大俠,,能幫我解決一下這個問題嗎,?; e: K: Q B3 T9 t4 n1 k S
1,一臺4軸直角坐標機器人,,通過示教器示教得到空間中A,,B,C , D.點.
% Q+ M3 G6 M' B3 k* W, O控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現(xiàn),。
4 o7 m% O* r' N! Y" q5 l本人寫了二套程序效果不是很理想,,想請各位指點指點!
2 \% j" _7 B# } mode:
% D6 J6 P1 h+ \6 N& y2 JIF READ_OP(202)=1 THEN
* U+ R6 M% Y% l3 K D BASE(2,1,0,3)! C% g9 g$ i- F; y( a3 s
MERGE AXIS(2)=ON
: U2 b9 K) s& K. s1 ?. G2 Y MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標, z5 H/ X. K4 f
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標 q d, d- C, U3 |5 @# o+ ?/ O. @
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
& q8 C( Y6 s6 }0 _: w2 w MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標
! @6 G U0 f2 B9 M, w, RMERGE AXIS(2)=OFF) s' o: R) E5 ~1 x& \% @- v
ENDIF
3 P( ~4 [" h0 x/ gGOTO mode; Q0 a6 M; [2 f0 M' i
此程序在運行過程中的抖動,,本人想是不是電機的旋轉方向改變后引起的
5 }0 N, W O" r0 z; s0 B電機抖動 ' K% N6 {: f. f K
mode1:5 v1 f8 G9 D; A4 r. X7 I
IF READ_OP(202)=1 THEN: ^& i; T1 J0 R0 f X3 I$ i
BASE(2,1,0,3)9 F& I/ O+ o, |7 R1 g# B, P& Y
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標2 Z( ~) [7 V' [" ]; C, g: ], r
WAIT IDLE
$ w* L. p0 n, h5 z! k MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標* O1 R3 y3 @; J# M' ?1 N' [
WAIT IDLE
7 `! @7 y, y3 j+ a( z MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
. F6 w) a W. {; x, Z' E! ?% Y WAIT IDLE) `, ^" i+ \* |7 Y
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標9 |- r% k- q1 v7 }" N, C
WAIT IDLE+ q' M k+ u& r4 e
ENDIF2 k7 A" }0 l0 y1 Z" F- [6 Q
GOTO mode 1 2 F C: c6 u# [7 \
此程序在運行過程中不抖動,但運行不平滑 ,。想請各位指點指點!
! c2 V7 v' x3 D' A問題能得到解決,,本人定有重謝 ,!聯(lián)系電話:13782704927,,楊 # _2 Y3 H: p1 Y' M4 u
|