各位大俠,能幫我解決一下這個問題嗎?7 m% b- A0 ^, v X# V
1,一臺4軸直角坐標機器人,通過示教器示教得到空間中A,B,C , D.點.
; u/ s0 n* C2 K, R. \& ^- d& z控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現(xiàn)。 Z: K# W* R$ e7 p2 q$ P! K* `" b
本人寫了二套程序效果不是很理想,想請各位指點指點! 1 @+ ~# i' w; N6 c: l5 G
mode:
4 s: C" L! z- N, R! A) v, VIF READ_OP(202)=1 THEN
0 e& T' @# {- r, ]' B BASE(2,1,0,3)
3 @9 C3 C& Y. l; g- C# u MERGE AXIS(2)=ON
! o5 i: S1 F9 U# A+ t. X U* | MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標1 _, C, b. m# j9 T) }+ l
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標
; {7 @ o% v; f, c- m0 K, x MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
2 N4 w; q% e8 J3 Q: g MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標! h3 J5 W2 m) u$ E2 t8 W
MERGE AXIS(2)=OFF
$ u) P7 ^0 s2 [6 G/ I; o: JENDIF$ d/ w# d, l, W; J6 |
GOTO mode1 A1 M9 G1 N/ q* o& x0 G- @
此程序在運行過程中的抖動,本人想是不是電機的旋轉方向改變后引起的
' P6 K; b2 b7 H0 v" m: p; L電機抖動
7 _+ i2 b/ `$ U u, H5 l mode1:
" V* k: k: P# n" NIF READ_OP(202)=1 THEN
1 P4 {; i2 I0 ]3 x T BASE(2,1,0,3)
4 t7 y. T! J# j; Y$ r" r MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標
; P7 X3 d$ F1 z. t3 ` WAIT IDLE
+ y4 b5 n7 ?. w; }/ j MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標+ O" ^+ g0 X0 u
WAIT IDLE, S2 `7 ^( d2 P1 u& G' ?+ p6 W
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標
% f# E/ y5 k1 H9 r& f WAIT IDLE7 s! T0 d- b9 R6 H. a6 U- |
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標
7 W9 N# Q# b5 _, Z6 J4 w6 J% v/ o" H WAIT IDLE
3 F: e% p) C' M7 bENDIF6 ]) M6 Q5 F4 j5 `6 P& ]7 E, x
GOTO mode 1
8 N4 C. U3 @# s% ?) @* H此程序在運行過程中不抖動,但運行不平滑 。想請各位指點指點!
6 I5 d0 ]4 b, V+ X, r) ~' p問題能得到解決,本人定有重謝 !聯(lián)系電話:13782704927,楊 , r6 }# _8 ^/ t# h" Q
|