各位大俠,,能幫我解決一下這個問題嗎,?
& l: R: C8 z# b* \+ Z3 m1,一臺4軸直角坐標機器人,,通過示教器示教得到空間中A,,B,C , D.點.- O e/ E- Z+ l0 n8 R, z [+ y
控制要求如下:直角坐標機器人按照A,B,C,D順序對示教點進行再現(xiàn),。5 A4 U+ X& H: S/ L/ O
本人寫了二套程序效果不是很理想,,想請各位指點指點! & ?3 h# X9 M# C- _6 n
mode:. P6 N2 O' M% g. ]+ l: j. N0 K2 [
IF READ_OP(202)=1 THEN
: ]4 q {; n9 I4 E% x* [6 } BASE(2,1,0,3)
' c# t7 s6 {: H: I9 L; [- } MERGE AXIS(2)=ON7 C' W* m1 s$ u" s: M: c% Q
MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標; I2 v: g( s6 ~* s. P. y4 F
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標5 x3 U9 z( K5 N$ ~. G. r3 w
MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標& ~ [1 r. ?( @! |, [
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標2 u0 r: g6 u: K( v
MERGE AXIS(2)=OFF
# l1 j' P+ z, B* C3 [ENDIF+ {$ c, c7 i. a1 U
GOTO mode
. B2 u# j7 J0 g& W9 @5 [此程序在運行過程中的抖動,本人想是不是電機的旋轉方向改變后引起的- Q3 i+ H* m9 l2 I" _* f' {# X1 D- E
電機抖動 8 K/ x: v1 p# G
mode1:
. O- l9 N/ j9 q* [- n7 q) x, pIF READ_OP(202)=1 THEN
0 R8 j4 |% x( g. W3 n7 Q1 K9 i BASE(2,1,0,3)
! B0 Q6 S0 i9 M. s O( t MOVEABS(VR(92),VR(91),VR(90),VR(93)) 'A點坐標
& q' I( y6 L2 y% Z* F WAIT IDLE
k+ Z7 V, K3 R# d( i MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'B點坐標* S6 L% P P6 k d, c
WAIT IDLE
' l s3 {3 b$ x MOVEABS(VR(82),VR(81),VR(80)+(VR(55)*10),VR(83))'C點坐標* s* E' g3 ]: k$ ^6 X8 ^. Z _9 {
WAIT IDLE5 H* I( B' t# N
MOVEABS(VR(92),VR(91),VR(90)+(VR(54)*10),VR(93))'D點坐標' }5 V* v) s/ t: D- Z
WAIT IDLE6 }. a$ H# D' s( _8 F
ENDIF* y8 J- c" w! c) J8 W
GOTO mode 1 ! s0 b# V" w0 z: t& |, A
此程序在運行過程中不抖動,,但運行不平滑 ,。想請各位指點指點!
' z+ T+ M' G) q- X: _2 F問題能得到解決,本人定有重謝 ,!聯(lián)系電話:13782704927,,楊 , J' ^; S- L3 I; }
|