各位大俠,能幫我解決一下這個問題嗎?1 F. H. I. g! m. ?% p1 f1 s
1,一臺4軸直角坐標機器人,通過示教器示教得到空間中A,B,C , D.點.
& w8 @" v! c0 L! Z% f7 n控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現。
8 @ Q2 h" d1 w* N5 {! p本人寫了二套程序效果不是很理想,想請各位指點指點! , M( m0 Y0 k/ g! }7 f& C* s, h! q! U+ Z
mode:5 z& m/ L$ r; o' z9 T1 O; m4 u- g
IF READ_OP(202)=1 THEN2 t# r+ U, g8 t* z5 c' {1 \
BASE(2,1,0,3)0 x( m' `+ @1 @" j
MERGE AXIS(2)=ON
. ?. m( g5 t( O$ p6 H6 v MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標6 x" H" h9 O M% H7 d7 V
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標
B( q; ?4 W+ `4 F. {6 O( d. o MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標+ |5 n3 j3 m8 Z& r
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標% [6 A, [! X% a6 e7 ]' C! `5 _
MERGE AXIS(2)=OFF
h2 S) \ p K+ {- }/ h6 nENDIF
% l5 [' q. J! {* g: G4 o' q; OGOTO mode
5 |+ E5 ]; R. L" q- F此程序在運行過程中的抖動,本人想是不是電機的旋轉方向改變后引起的
* R' h& ?- \+ b: ?- x電機抖動
1 k7 O/ S4 U0 n1 e7 I mode1:/ F# [0 _5 l- ]5 y; |. p
IF READ_OP(202)=1 THEN3 W0 g+ Y2 r3 G$ g
BASE(2,1,0,3)' o0 B! n3 j; V/ u5 u4 q) W
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標! m6 ~" B# j! k& Z. K# D
WAIT IDLE
) E9 g% H/ X% x. q! M MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標+ X; ~/ w1 V! V8 i1 d
WAIT IDLE% \* o% ~, q4 h+ d% }! ]2 q4 J/ q
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標; ?* q! G- i8 U, q
WAIT IDLE
5 t1 e% W Z/ t: m. D: j; U' m MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標# C0 J6 u3 R3 X6 k: c1 l8 G
WAIT IDLE z9 {! x C9 y! }; R
ENDIF
7 d8 p2 O5 Q" [2 K( u5 zGOTO mode 1 ' P6 g; z& F3 D1 T* K
此程序在運行過程中不抖動,但運行不平滑 。想請各位指點指點! 2 x$ ]! y- g: `; m1 t* L. H
問題能得到解決,本人定有重謝 !聯系電話:13782704927,楊
- m2 k" y$ L3 d& R5 p2 b( o |